Diff: handle/mavcommands.cpp

Revision:

64:d4818fb7813c

Parent:

61:aa32e17f6801

Child:

66:5d43988d100c

--- a/handle/mavcommands.cpp	Sun Apr 27 14:08:51 2014 +0000
+++ b/handle/mavcommands.cpp	Sun Apr 27 21:53:59 2014 +0000
@@ -27,6 +27,9 @@
     double nLat=DH::Locs().getC(LHType_targ,DH::Locs().getI(LHType_targ)).getLat();
     double nLon=DH::Locs().getC(LHType_targ,DH::Locs().getI(LHType_targ)).getLon();
     double nAlt=DH::Locs().getC(LHType_targ,DH::Locs().getI(LHType_targ)).getAlt();
+    USB::getSerial().printf("HM Lat %f\n",nLat);
+    USB::getSerial().printf("HM Lon %f\n",nLon);
+    USB::getSerial().printf("HM Alt %f\n",nAlt);
     if(moveValid&&cLat==nLat&&cLon==nLon&&cAlt==nAlt)return false;
     moveValid=false;
     cLat=nLat;
@@ -124,6 +127,7 @@
         }
         // Check for mission accepted
         if(myCmd[5]==MAVLINK_MSG_ID_MISSION_ACK){
+            USB::getSerial().printf("Ack\n");
             moveValid=true;
             if(startSetup&&ENABLE_MOTORS){
                 startSetup=false;