[paparazzi-commits] [4813] Onboard logger changes from Matt P for 0x98/timestamp protocol

[Allen Ibara]

Revision: 4813
          http://svn.sv.gnu.org/viewvc/?view=rev&root=paparazzi&revision=4813
Author:   aibara
Date:     2010-04-20 00:46:46 +0000 (Tue, 20 Apr 2010)
Log Message:
-----------
Onboard logger changes from Matt P for 0x98/timestamp protocol

Modified Paths:
--------------
    paparazzi3/trunk/sw/airborne/fms/onboard_logger.c

Modified: paparazzi3/trunk/sw/airborne/fms/onboard_logger.c
===================================================================
--- paparazzi3/trunk/sw/airborne/fms/onboard_logger.c   2010-04-20 00:45:58 UTC 
(rev 4812)
+++ paparazzi3/trunk/sw/airborne/fms/onboard_logger.c   2010-04-20 00:46:46 UTC 
(rev 4813)
@@ -31,10 +31,11 @@
     printf("checksum mismatch\n");
     return;
   }
-  //printf("Got pprz msg len %i, ckA %02x, ckB %02x (%02x %02x)\n", length, 
ck_A, ck_B, buf[length - 3], buf[length - 2]);
+  // printf("Got pprz msg len %i, ckA %02x, ckB %02x (%02x %02x)\n", length, 
ck_A, ck_B, buf[length - 3], buf[length - 2]);
   printf("%i.%06i ", (unsigned) ts->tv_sec - start_secs, (unsigned) 
ts->tv_usec);
-  printf("%i %i ", buf[1], buf[2]);
-  for(i = 2; i < length - 3; i++)
+  printf("%d ", (uint32_t) buf[1]);       // paparazzi timestamp; see 
udp_transport.h
+  printf("%i %i ", buf[5], buf[6]);       // AC_ID MSG_ID
+  for(i = 6; i < length - 3; i++)         
   {
     printf("%02x ", buf[i]);
   }
@@ -74,8 +75,8 @@
 
   i = 0;
   while (i < udp_length) {
-    if (payload[i] != 0x99) {
-      ///printf("missing start byte\n");
+    if (payload[i] != 0x98) {
+      // printf("missing start byte\n");
       break;
     } 
     i++;