teach ublox parser about the SSP

berthubert · Sep 11, 2022 · 855e41c · 855e41c
1 parent 6702f01
commit 855e41c
Show file tree

Hide file tree

Showing 2 changed files with 7 additions and 2 deletions.
diff --git a/ubx.cc b/ubx.cc
@@ -66,7 +66,7 @@ basic_string<uint8_t> getInavFromSFRBXMsg(std::basic_string_view<uint8_t> msg,
                                           basic_string<uint8_t>& reserved2,
                                           basic_string<uint8_t>& sar,
                                           basic_string<uint8_t>& spare,
-                                          basic_string<uint8_t>& crc)
+                                          basic_string<uint8_t>& crc, uint8_t* ssp)
 {
   // byte order adjustment
   std::basic_string<uint8_t> payload;
@@ -87,6 +87,11 @@ basic_string<uint8_t> getInavFromSFRBXMsg(std::basic_string_view<uint8_t> msg,
   crc.clear();
   for(i=0; i < 3; ++i)
     crc.append(1, getbitu(payload.c_str()+16,82+i*8,8));
+
+  if(ssp) {
+    *ssp=getbitu(payload.c_str()+16,82+24,8);
+  }
+
 
   std::basic_string<uint8_t> inav;
 

diff --git a/ubx.hh b/ubx.hh
@@ -11,7 +11,7 @@ std::basic_string<uint8_t> getInavFromSFRBXMsg(std::basic_string_view<uint8_t> m
                                                std::basic_string<uint8_t>& reserved2,
                                                std::basic_string<uint8_t>& sar,
                                                std::basic_string<uint8_t>& spare,
-                                               std::basic_string<uint8_t>& crc);
+                                               std::basic_string<uint8_t>& crc, uint8_t* ssp=0);
 
 std::basic_string<uint8_t> getGPSFromSFRBXMsg(std::basic_string_view<uint8_t> msg);
 std::basic_string<uint8_t> getGlonassFromSFRBXMsg(std::basic_string_view<uint8_t> msg);