GPS and IMU reading works
Dependencies: mbed Servo SDFileSystem
Get.cpp
- Committer:
- dem123456789
- Date:
- 2015-09-10
- Revision:
- 25:30966ed7f7e8
- Parent:
- 20:a820531c78bc
- Child:
- 27:1be1f25be449
File content as of revision 25:30966ed7f7e8:
#include "Config.h" string decodeCommandGET(string cmd) { if (cmd == "IMU_Y") { return(IMU_Y); } else if (cmd == "IMU_P") { return(IMU_P); } else if (cmd == "IMU_R") { return(IMU_R); } else if (cmd == "GPS_Quality") { return(GPS_Quality); } else if (cmd == "GPS_UTC") { return(GPS_UTC); } else if (cmd == "GPS_Latitude") { return(GPS_Latitude); } else if (cmd == "GPS_Longtitude") { return(GPS_Longtitude); } else if (cmd == "GPS_Altitude") { return(GPS_Altitude); } else if (cmd == "GPS_Num_Satellite") { return(GPS_Num_Satellite); } else if (cmd == "GPS_HDOP") { return(GPS_HDOP); } else if (cmd == "GPS_VDOP") { return(GPS_VDOP); } else if (cmd == "GPS_PDOP") { return(GPS_PDOP); } else if (cmd == "GPS_Date") { return(GPS_Date); } else if (cmd == "GPS_VelocityKnot") { return(GPS_VelocityKnot); } else if (cmd == "GPS_VelocityKph") { return(GPS_VelocityKph); } else { return("Not valid command, example: @GET=GPS_Quality"); } } double getDistance(int task_id) { double cur_Latitude = D_GPS_Latitude; double cur_Logntitude = D_GPS_Longtitude; double dest_Latitude = Latitude_Path[task_id-1]; double dest_Longtitude = Longtitude_Path[task_id-1]; }