forward
Dependencies: VNH5019
Fork of AigamozuControlPackets by
Diff: AigamozuControlPackets.cpp
- 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;