Diff: AigamozuControlPackets.cpp

Revision:

24:ed71894a6952

Parent:

23:e5dcf0d15879

Child:

27:acadce784e2b

diff -r e5dcf0d15879 -r ed71894a6952 AigamozuControlPackets.cpp
--- a/AigamozuControlPackets.cpp	Wed May 13 08:43:00 2015 +0000
+++ b/AigamozuControlPackets.cpp	Fri May 15 07:00:14 2015 +0000
@@ -115,7 +115,7 @@
 // Robot -> Controller/Base //
 //////////////////////////////
 
-void AigamozuControlPackets::createReceiveStatusCommand(uint8_t fromID,uint8_t toID,double latitude,double longitude,double latitudeKalman,double longitudeKalman,double covarLati,double covarLongi)
+void AigamozuControlPackets::createReceiveStatusCommand(uint8_t fromID,uint8_t toID,int state, double latitude,double longitude,double latitudeKalman,double longitudeKalman,double covarLati,double covarLongi)
 {
     UNION_double_char latitude_data,longitude_data, latitudeKalman_data, longitudeKalman_data;
     UNION_double_char covarLati_data,covarLongi_data;
@@ -127,7 +127,8 @@
     covarLati_data.double_value=covarLati;
     covarLongi_data.double_value=covarLongi;
     
-    uint8_t tmp[] = {'A','G','S','R','F',fromID,'T',toID,'S',nowMode,71,80,83,
+    
+    uint8_t tmp[] = {'A','G','S','R','F',fromID,'T',toID,'S', state,71,80,83,
                     latitude_data.char_value[0],latitude_data.char_value[1],latitude_data.char_value[2],latitude_data.char_value[3],latitude_data.char_value[4],latitude_data.char_value[5],latitude_data.char_value[6],latitude_data.char_value[7],
                     longitude_data.char_value[0],longitude_data.char_value[1],longitude_data.char_value[2],longitude_data.char_value[3],longitude_data.char_value[4],longitude_data.char_value[5],longitude_data.char_value[6],longitude_data.char_value[7],
                     latitudeKalman_data.char_value[0],latitudeKalman_data.char_value[1],latitudeKalman_data.char_value[2],latitudeKalman_data.char_value[3],latitudeKalman_data.char_value[4],latitudeKalman_data.char_value[5],latitudeKalman_data.char_value[6],latitudeKalman_data.char_value[7],