Generation 2 of the Harp project
Dependencies: Servo TMP36 GZ chan_fatfs_sd buffered-serial1 nmea_parser watchdog mbed-rtos mbed
GPS/GPS.cpp
- Committer:
- tylerjw
- Date:
- 2012-02-24
- Revision:
- 6:204487243310
- Parent:
- 5:8444ec4245e7
File content as of revision 6:204487243310:
#include "GPS.h" GPS::GPS(PinName tx, PinName rx) : _gps(tx, rx) { _gps.baud(4800); nmea_longitude = 0.0; nmea_latitude = 0.0; utc_time = 0; ns = ' '; ew = ' '; lock = 0; satelites = 0; hdop = 0.0; msl_altitude = 0.0; msl_units = ' '; rmc_status = ' '; speed_k = 0.0; course_d = 0.0; date = 0; dec_longitude = 0.0; dec_latitude = 0.0; gll_status = ' '; course_t = 0.0; // ground speed true course_t_unit = ' '; course_m = 0.0; // magnetic course_m_unit = ' '; speed_k_unit = ' '; speed_km = 0.0; // speek km/hr speed_km_unit = ' '; altitude_ft = 0.0; #ifdef OPEN_LOG is_logging = false; #endif } #ifdef OPEN_LOG void GPS::start_log() { is_logging = true; } void GPS::new_file(void) { _openLog.newFile(); } void GPS::stop_log(void) { is_logging = false; } #endif float GPS::nmea_to_dec(float deg_coord, char nsew) { int degree = (int)(deg_coord/100); float minutes = deg_coord - degree*100; float dec_deg = minutes / 60; float decimal = degree + dec_deg; if (nsew == 'S' || nsew == 'W') { // return negative decimal *= -1; } return decimal; } int GPS::sample() { int line_parsed = 0; if (_gps.readable()) { getline(); #ifdef OPEN_LOG if (is_logging && lock) { format_for_log(); _openLog.write(bfr); } #endif // Check if it is a GPGGA msg (matches both locked and non-locked msg) if (sscanf(msg, "GPGGA,%f,%f,%c,%f,%c,%d,%d,%f,%f,%c", &utc_time, &nmea_latitude, &ns, &nmea_longitude, &ew, &lock, &satelites, &hdop, &msl_altitude, &msl_units) >= 1) { line_parsed = GGA; } // Check if it is a GPRMC msg else if (sscanf(msg, "GPRMC,%f,%c,%f,%c,%f,%c,%f,%f,%d", &utc_time, &rmc_status, &nmea_latitude, &ns, &nmea_longitude, &ew, &speed_k, &course_d, &date) >= 1) { line_parsed = RMC; } // GLL - Geographic Position-Lat/Lon else if (sscanf(msg, "GPGLL,%f,%c,%f,%c,%f,%c", &nmea_latitude, &ns, &nmea_longitude, &ew, &utc_time, &gll_status) >= 1) { line_parsed = GLL; } // VTG-Course Over Ground and Ground Speed else if (sscanf(msg, "GPVTG,%f,%c,%f,%c,%f,%c,%f,%c", &course_t, &course_t_unit, &course_m, &course_m_unit, &speed_k, &speed_k_unit, &speed_km, &speed_km_unit) >= 1) { line_parsed = VTG; } } if (!lock) { return NO_LOCK; } else if (line_parsed) { return line_parsed; } else { return NOT_PARSED; } } float GPS::trunc(float v) { if (v < 0.0) { v*= -1.0; v = floor(v); v*=-1.0; } else { v = floor(v); } return v; } void GPS::getline() { while (_gps.getc() != '$'); // wait for the start of a line for (int i=0; i<1022; i++) { msg[i] = _gps.getc(); if (msg[i] == '\r') { msg[i] = 0; return; } } error("Overflow in getline"); } void GPS::format_for_log() { bfr[0] = '$'; for (int i = 0; i < 1022; i++) { bfr[i+1] = msg[i]; if (msg[i] == 0) { bfr[i+1] = '\r'; bfr[i+2] = '\n'; bfr[i+3] = 0; return; } } error("Overflow in format"); } float GPS::get_msl_altitude() { if (!lock) return 0.0; else return msl_altitude; } int GPS::get_satelites() { if (!lock) return 0; else return satelites; } float GPS::get_nmea_longitude() { if (!lock) return 0.0; else return nmea_longitude; } float GPS::get_dec_longitude() { dec_longitude = nmea_to_dec(nmea_longitude, ew); if (!lock) return 0.0; else return dec_longitude; } float GPS::get_nmea_latitude() { if (!lock) return 0.0; else return nmea_latitude; } float GPS::get_dec_latitude() { dec_latitude = nmea_to_dec(nmea_latitude, ns); if (!lock) return 0.0; else return dec_latitude; } float GPS::get_course_t() { if (!lock) return 0.0; else return course_t; } float GPS::get_course_m() { if (!lock) return 0.0; else return course_m; } float GPS::get_speed_k() { if (!lock) return 0.0; else return speed_k; } float GPS::get_speed_km() { if (!lock) return 0.0; else return speed_km; } float GPS::get_altitude_ft() { if (!lock) return 0.0; else return 3.280839895*msl_altitude; }