//! RaptorQ FEC encoder — accumulates source symbols into blocks and generates repair symbols. use raptorq::{EncodingPacket, ObjectTransmissionInformation, PayloadId, SourceBlockEncoder}; use wzp_proto::error::FecError; use wzp_proto::FecEncoder; /// Maximum symbol size in bytes. Audio frames are typically < 200 bytes, /// but we pad to a uniform size within a block. /// Each symbol carries a 2-byte length prefix so recovered frames can be trimmed. const DEFAULT_MAX_SYMBOL_SIZE: u16 = 256; /// Length prefix size (u16 little-endian). const LEN_PREFIX: usize = 2; /// RaptorQ-based FEC encoder that groups audio frames into blocks /// and generates fountain-code repair symbols. pub struct RaptorQFecEncoder { /// Current block ID (wraps at u8). block_id: u8, /// Maximum source symbols per block. frames_per_block: usize, /// Accumulated source symbols for the current block. source_symbols: Vec>, /// Symbol size used for encoding (all symbols padded to this size). symbol_size: u16, } impl RaptorQFecEncoder { /// Create a new encoder. /// /// * `frames_per_block` — number of source symbols per FEC block. /// * `symbol_size` — max byte length of any single source symbol (frames are zero-padded). pub fn new(frames_per_block: usize, symbol_size: u16) -> Self { Self { block_id: 0, frames_per_block, source_symbols: Vec::with_capacity(frames_per_block), symbol_size, } } /// Create with default symbol size (256 bytes). pub fn with_defaults(frames_per_block: usize) -> Self { Self::new(frames_per_block, DEFAULT_MAX_SYMBOL_SIZE) } /// Build a contiguous data buffer from the accumulated source symbols, /// each prefixed with a 2-byte length and zero-padded to `symbol_size`. fn build_block_data(&self) -> Vec { let ss = self.symbol_size as usize; let mut data = vec![0u8; self.source_symbols.len() * ss]; for (i, sym) in self.source_symbols.iter().enumerate() { let max_payload = ss - LEN_PREFIX; let payload_len = sym.len().min(max_payload); let offset = i * ss; // Write 2-byte little-endian length prefix. data[offset..offset + LEN_PREFIX] .copy_from_slice(&(payload_len as u16).to_le_bytes()); // Write payload after prefix. data[offset + LEN_PREFIX..offset + LEN_PREFIX + payload_len] .copy_from_slice(&sym[..payload_len]); } data } } impl FecEncoder for RaptorQFecEncoder { fn add_source_symbol(&mut self, data: &[u8]) -> Result<(), FecError> { if self.source_symbols.len() >= self.frames_per_block { return Err(FecError::BlockFull { max: self.frames_per_block, }); } self.source_symbols.push(data.to_vec()); Ok(()) } fn generate_repair(&mut self, ratio: f32) -> Result)>, FecError> { if self.source_symbols.is_empty() { return Ok(vec![]); } let block_data = self.build_block_data(); let config = ObjectTransmissionInformation::with_defaults(block_data.len() as u64, self.symbol_size); let encoder = SourceBlockEncoder::new(self.block_id, &config, &block_data); let num_source = self.source_symbols.len() as u32; let num_repair = ((num_source as f32) * ratio).ceil() as u32; if num_repair == 0 { return Ok(vec![]); } // Generate repair packets starting from offset 0 (ESIs begin at num_source). let repair_packets: Vec = encoder.repair_packets(0, num_repair); let result: Vec<(u8, Vec)> = repair_packets .into_iter() .enumerate() .map(|(i, pkt): (usize, EncodingPacket)| { let idx = (num_source as u8).wrapping_add(i as u8); (idx, pkt.data().to_vec()) }) .collect(); Ok(result) } fn finalize_block(&mut self) -> Result { let completed = self.block_id; self.block_id = self.block_id.wrapping_add(1); self.source_symbols.clear(); Ok(completed) } fn current_block_id(&self) -> u8 { self.block_id } fn current_block_size(&self) -> usize { self.source_symbols.len() } } /// Build a length-prefixed, padded block data buffer from raw symbols. /// This matches what the encoder produces internally. fn build_prefixed_block_data(symbols: &[Vec], symbol_size: u16) -> Vec { let ss = symbol_size as usize; let mut data = vec![0u8; symbols.len() * ss]; for (i, sym) in symbols.iter().enumerate() { let max_payload = ss - LEN_PREFIX; let payload_len = sym.len().min(max_payload); let offset = i * ss; data[offset..offset + LEN_PREFIX] .copy_from_slice(&(payload_len as u16).to_le_bytes()); data[offset + LEN_PREFIX..offset + LEN_PREFIX + payload_len] .copy_from_slice(&sym[..payload_len]); } data } /// Helper: build source `EncodingPacket`s for a given block. Useful for /// the decoder tests and interleaving. pub fn source_packets_for_block( block_id: u8, symbols: &[Vec], symbol_size: u16, ) -> Vec { let ss = symbol_size as usize; let data = build_prefixed_block_data(symbols, symbol_size); (0..symbols.len()) .map(|i| { let offset = i * ss; let sym_data = data[offset..offset + ss].to_vec(); EncodingPacket::new(PayloadId::new(block_id, i as u32), sym_data) }) .collect() } /// Helper: generate repair packets for the given source symbols. pub fn repair_packets_for_block( block_id: u8, symbols: &[Vec], symbol_size: u16, ratio: f32, ) -> Vec { let data = build_prefixed_block_data(symbols, symbol_size); let config = ObjectTransmissionInformation::with_defaults(data.len() as u64, symbol_size); let encoder = SourceBlockEncoder::new(block_id, &config, &data); let num_source = symbols.len() as u32; let num_repair = ((num_source as f32) * ratio).ceil() as u32; encoder.repair_packets(0, num_repair) } #[cfg(test)] mod tests { use super::*; #[test] fn add_symbols_and_finalize() { let mut enc = RaptorQFecEncoder::with_defaults(5); assert_eq!(enc.current_block_id(), 0); assert_eq!(enc.current_block_size(), 0); for i in 0..5 { enc.add_source_symbol(&[i as u8; 100]).unwrap(); } assert_eq!(enc.current_block_size(), 5); // Block full assert!(enc.add_source_symbol(&[0u8; 100]).is_err()); let repair = enc.generate_repair(0.5).unwrap(); assert!(!repair.is_empty()); // 5 source * 0.5 = 3 repair (ceil) assert_eq!(repair.len(), 3); let id = enc.finalize_block().unwrap(); assert_eq!(id, 0); assert_eq!(enc.current_block_id(), 1); assert_eq!(enc.current_block_size(), 0); } #[test] fn block_id_wraps() { let mut enc = RaptorQFecEncoder::with_defaults(1); for expected in 0..=255u8 { assert_eq!(enc.current_block_id(), expected); enc.add_source_symbol(&[expected; 10]).unwrap(); enc.finalize_block().unwrap(); } // After 256 blocks, wraps back to 0 assert_eq!(enc.current_block_id(), 0); } }