diff --git a/src/main.rs b/src/main.rs index 8882056..eb58ab3 100644 --- a/src/main.rs +++ b/src/main.rs @@ -615,7 +615,6 @@ fn handle_frame(frame: esp_radio::wifi::sniffer::PromiscuousPkt<'_>) { } // info!("Received frame with {} bytes", frame.len); - esp_println::print!("."); // TODO: debug only! unsafe { #[allow(static_mut_refs)] if let Some(ref mut led) = USER_LED.as_mut() { @@ -636,6 +635,7 @@ fn handle_frame(frame: esp_radio::wifi::sniffer::PromiscuousPkt<'_>) { Ok(packet) => { // drop hopped (for now) if packet.decoded.is_hopped() { + esp_println::print!("."); // TODO: debug only! return; } @@ -644,9 +644,15 @@ fn handle_frame(frame: esp_radio::wifi::sniffer::PromiscuousPkt<'_>) { // drop all unsupported message IDs and rate-limit SPATEMs if match message_id { #[cfg(feature = "denm")] - c_its_parser::standards::extensions::ItsMessageId::Denm => false, + c_its_parser::standards::extensions::ItsMessageId::Denm => { + esp_println::print!("D"); // TODO: debug only! + false + } #[cfg(feature = "cam")] - c_its_parser::standards::extensions::ItsMessageId::Cam => false, + c_its_parser::standards::extensions::ItsMessageId::Cam => { + esp_println::print!("C"); // TODO: debug only! + false + } #[cfg(feature = "spat")] c_its_parser::standards::extensions::ItsMessageId::Spatem => { // reduce SPAT rate per station ID @@ -662,7 +668,10 @@ fn handle_frame(frame: esp_radio::wifi::sniffer::PromiscuousPkt<'_>) { i.msg_count = i.msg_count.wrapping_add(1); if (i.msg_count % SPAT_RATE_LIMIT) > 0 { + esp_println::print!("s"); // TODO: debug only! drop_msg = true; + } else { + esp_println::print!("S"); // TODO: debug only! } }); } @@ -670,8 +679,14 @@ fn handle_frame(frame: esp_radio::wifi::sniffer::PromiscuousPkt<'_>) { drop_msg } #[cfg(feature = "spat")] - c_its_parser::standards::extensions::ItsMessageId::Mapem => false, - _ => true, + c_its_parser::standards::extensions::ItsMessageId::Mapem => { + esp_println::print!("M"); // TODO: debug only! + false + } + _ => { + esp_println::print!("?"); // TODO: debug only! + true + } } { return; }