forward

Dependencies:   VNH5019

Fork of AigamozuControlPackets by aigamozu

Revision:
12:eaab0ccb9255
Parent:
11:4d71c9cc3b4a
Child:
13:a5bc425540a7
diff -r 4d71c9cc3b4a -r eaab0ccb9255 AigamozuControlPackets.cpp
--- a/AigamozuControlPackets.cpp	Mon Apr 13 10:09:30 2015 +0000
+++ b/AigamozuControlPackets.cpp	Mon Apr 13 11:33:06 2015 +0000
@@ -130,13 +130,19 @@
     
     bool out_flag = true;
     static bool out_count_flag = false;
-    
+    int i;
+    /*
     printf("Check Start\n");
     printf("agzPoint=%f,%f\n",agzPoint.x,agzPoint.y);
     printf("bsdrPoint1=%f,%f\n",basePoint[0].x,basePoint[0].y);
     printf("bsdrPoint2=%f,%f\n",basePoint[1].x,basePoint[1].y);
     printf("bsdrPoint3=%f,%f\n",basePoint[2].x,basePoint[2].y);
     printf("bsdrPoint4=%f,%f\n",basePoint[3].x,basePoint[3].y);
+    */
+    printf("-1, %f, %f\n",agzPoint.x,agzPoint.y);
+    for(i = 0; i < 4; i++){
+        printf(" %d, %f, %f\n", i, basePoint[i].x,basePoint[i].y);
+    }
     if(AigamozuControlPackets::checkGpsHit(basePoint[0],basePoint[1],basePoint[2],agzPoint)){
         printf("InArea\n");
         out_flag = false;