forward
Dependencies: ADXL345 AigamozuControlPackets_for_auto HMC5843 ITG3200 MBed_Adafruit-GPS-Library XBee agzIDLIST mbed
Fork of Aigamozu_Robot_ver4_for_forward by
Diff: main.cpp
- Revision:
- 36:dea444b493b7
- Parent:
- 35:c18c96b92121
- Child:
- 37:dcd5905ea56f
diff -r c18c96b92121 -r dea444b493b7 main.cpp --- a/main.cpp Mon May 25 11:36:48 2015 +0000 +++ b/main.cpp Tue May 26 10:14:44 2015 +0000 @@ -199,14 +199,14 @@ } if(flag >= 16){ - if(abs(x_prev - agz.get_agzPoint_lati()) < 0.001 && abs(y_prev - agz.get_agzPoint_longi()) < 0.001){ +// if(abs(x_prev - agz.get_agzPoint_lati()) < 0.001 && abs(y_prev - agz.get_agzPoint_longi()) < 0.001){ Kalman(agz.get_agzPoint_lati(), agz.get_agzPoint_longi()); change = 1; - } +/* } else{ change = 0; } - if(save_counter < 10){ +*/ if(save_counter < 10){ fp = fopen(filename, "a"); fprintf(fp, "%d %.14lf %.14lf %.14lf %.14lf %.14le %.14le \n", change, agz.get_agzPoint_lati(),agz.get_agzPoint_longi(),