Revision 1:fbc9c604df21, committed 2018-05-16

Comitter:

FDLKHM

Date:

Wed May 16 02:37:22 2018 +0000

Parent:

0:0389ce4f9789

Commit message:

for gps;

Changed in this revision

--- a/an_packet_protocol.c	Sat May 12 07:28:33 2018 +0000
+++ b/an_packet_protocol.c	Wed May 16 02:37:22 2018 +0000
@@ -32,6 +32,7 @@
 #include <string.h>
 #include "an_packet_protocol.h"
 
+
 /*
 * Function to calculate the CRC16 of data
 * CRC16-CCITT
@@ -99,7 +100,7 @@
 	an_packet_t *an_packet = NULL;
 	uint8_t header_lrc, id, length;
 	uint16_t crc;
-
+	
 	while (decode_iterator + AN_PACKET_HEADER_SIZE <= an_decoder->buffer_length)
 	{
 		header_lrc = an_decoder->buffer[decode_iterator++];

--- a/main.cpp	Sat May 12 07:28:33 2018 +0000
+++ b/main.cpp	Wed May 16 02:37:22 2018 +0000
@@ -23,43 +23,43 @@
     system_state_packet_t system_state_packet;
 
     an_decoder_initialise(&an_decoder);
-   
     pc.baud(115200);
     device.baud(115200);    
-     
+
       while(1) {
             
-            while(device.readable()) {
-
+             // an_decoder.buffer_length = 0;
+      while(device.readable()) {
+                //pc.printf("%d\r\n",sizeof(an_decoder.buffer));
+                //j = device.readable() ;
                 int i = an_decoder.buffer_length;
                 an_decoder.buffer[i+1] = device.getc();
                 an_decoder_increment(&an_decoder, 1);
-
-                
+                //pc.printf("%d\r\n",(an_decoder.buffer_length));
             }
             
             /* iterate through an example data dump from spatial */
-            if (40 < an_decoder.buffer_length)
+            if (40<an_decoder.buffer_length)
             { 
             
                 //calculate the number of bytes to copy
                 //bytes_to_copy = an_decoder_size(&an_decoder);
-        
+                
                 while ((an_packet = an_packet_decode(&an_decoder)) != NULL)
                 {   
                     //an_packet = an_packet_decode(&an_decoder);
-                    pc.printf("what is problem? \r\n"); 
                                         
                     if (an_packet->id == packet_id_system_state) //system state packet 
-                    {   pc.printf("what is problem?222"); 
+                    {  
         
                         //copy all the binary data into the typedef struct for the packet 
                         //this allows easy access to all the different values             
                         if (decode_system_state_packet(&system_state_packet, an_packet) == 0)
-                        {pc.printf("what is problem?222");
+                        {
                             pc.printf("System State Packet:\n");
                             pc.printf("\tLatitude = %f, Longitude = %f, Height = %f\n", system_state_packet.latitude * RADIANS_TO_DEGREES, system_state_packet.longitude * RADIANS_TO_DEGREES, system_state_packet.height);
                             pc.printf("\tRoll = %f, Pitch = %f, Heading = %f\n", system_state_packet.orientation[0] * RADIANS_TO_DEGREES, system_state_packet.orientation[1] * RADIANS_TO_DEGREES, system_state_packet.orientation[2] * RADIANS_TO_DEGREES);
+                            pc.printf("\tVelocity_north = %f, Velocith_east = %f, Velocity_down = %f\n", system_state_packet.velocity[0], system_state_packet.velocity[1], system_state_packet.velocity[2]);
                         }
                     }
                     else
@@ -67,6 +67,7 @@
                         pc.printf("Packet ID %u of Length %u\n", an_packet->id, an_packet->length);
                     }
                 }
+               
             }
         }