From d42999d2adce5dffb864dc082c6db43c16d83f6b Mon Sep 17 00:00:00 2001
From: Robin Mueller <robin.mueller.m@gmail.com>
Date: Mon, 18 Sep 2023 00:57:25 +0200
Subject: [PATCH] thats enough for today

---
 satrs-core/src/hal/std/mod.rs                 |  1 +
 satrs-core/src/hal/std/tcp_server.rs          |  1 +
 .../src/hal/std/tcp_spacepackets_server.rs    | 32 +++++++++++++++++++
 3 files changed, 34 insertions(+)

diff --git a/satrs-core/src/hal/std/mod.rs b/satrs-core/src/hal/std/mod.rs
index 7ac107b..17ec012 100644
--- a/satrs-core/src/hal/std/mod.rs
+++ b/satrs-core/src/hal/std/mod.rs
@@ -2,4 +2,5 @@
 pub mod tcp_server;
 pub mod udp_server;
 
+mod tcp_spacepackets_server;
 mod tcp_with_cobs_server;
diff --git a/satrs-core/src/hal/std/tcp_server.rs b/satrs-core/src/hal/std/tcp_server.rs
index befcfc0..c2d4869 100644
--- a/satrs-core/src/hal/std/tcp_server.rs
+++ b/satrs-core/src/hal/std/tcp_server.rs
@@ -12,6 +12,7 @@ use crate::tmtc::{ReceivesTc, TmPacketSource};
 use thiserror::Error;
 
 // Re-export the TMTC in COBS server.
+pub use crate::hal::std::tcp_spacepackets_server::parse_buffer_for_ccsds_space_packets;
 pub use crate::hal::std::tcp_with_cobs_server::{
     parse_buffer_for_cobs_encoded_packets, CobsTcParser, CobsTmSender, TcpTmtcInCobsServer,
 };
diff --git a/satrs-core/src/hal/std/tcp_spacepackets_server.rs b/satrs-core/src/hal/std/tcp_spacepackets_server.rs
index e69de29..e541602 100644
--- a/satrs-core/src/hal/std/tcp_spacepackets_server.rs
+++ b/satrs-core/src/hal/std/tcp_spacepackets_server.rs
@@ -0,0 +1,32 @@
+use crate::tmtc::ReceivesTc;
+
+pub trait ApidLookup {
+    fn validate(&self, apid: u16) -> bool;
+}
+/// This function parses a given buffer for COBS encoded packets. The packet structure is
+/// expected to be like this, assuming a sentinel value of 0 as the packet delimiter:
+///
+/// 0 | ... Packet Data ... | 0 | 0 | ... Packet Data ... | 0
+///
+/// This function is also able to deal with broken tail packets at the end. If broken tail
+/// packets are detected, they are moved to the front of the buffer, and the write index for
+/// future write operations will be written to the `next_write_idx` argument.
+///
+/// The parser will write all packets which were decoded successfully to the given `tc_receiver`.
+pub fn parse_buffer_for_ccsds_space_packets<E>(
+    buf: &mut [u8],
+    apid_lookup: &dyn ApidLookup,
+    tc_receiver: &mut dyn ReceivesTc<Error = E>,
+    next_write_idx: &mut usize,
+) -> Result<u32, E> {
+    let mut start_index_packet = 0;
+    let mut start_found = false;
+    let mut last_byte = false;
+    let mut packets_found = 0;
+    for i in 0..buf.len() {
+        todo!();
+    }
+    // Split frame at the end for a multi-packet frame. Move it to the front of the buffer.
+    if start_index_packet > 0 && start_found && packets_found > 0 {}
+    Ok(packets_found)
+}