drivers: fake: sink: Add human friendly message

Signed-off-by: Patrick José Pereira <[email protected]>
joaoantoniocardoso · Sep 7, 2024 · 3f02501 · 3f02501
1 parent 2785e0e
commit 3f02501
Showing 1 changed file with 5 additions and 2 deletions.
diff --git a/src/drivers/fake.rs b/src/drivers/fake.rs
@@ -58,10 +58,13 @@ impl Driver for FakeSink {
                 }
             }
 
+            let mut bytes = mavlink::peek_reader::PeekReader::new(message.raw_bytes());
+            let (header, message): (mavlink::MavHeader, mavlink::ardupilotmega::MavMessage) =
+                mavlink::read_v2_msg(&mut bytes).unwrap();
             if self.print {
-                println!("Message received: {message:?}");
+                println!("Message received: {header:?} {message:?}");
             } else {
-                trace!("Message received: {message:?}");
+                trace!("Message received: {header:?} {message:?}");
             }
         }