<filename>nmea_parse.c</filename> Functions:-Parser for NMEA strings, generic and proprietary. Notes based on code as of Mon Apr 5 21:38:06 2010 -0400. static void do_lat_lon(char *field[], struct gps_fix_t *out) Reads a four element array containing the value and hemisphere of the latitude and longitude of a location as text. It converts them into signed (-ve for S and W) values. The gps_data_t structure is updated with the new value(s). static void merge_ddmmyy(char *ddmmyy, struct gps_device_t *session) If the century has not yet been stored in the nmea driver private data, take the supplied ddmmyy date and generate and store a ddmmyyyy date, using the century value compiled in from timebase.h. static void merge_hhmmss(char *hhmmss, struct gps_device_t *session) Stash the present hour value before updating it from the incoming data. If the new hour is less than the stashed value, we have passed midnight, so update the day value. Finally update the minutes, seconds and fractions of a second from the incoming data. static gps_mask_t processGPRMC(int count, char *field[], struct gps_device_t *session) Handle a $GPRMC sentence stored in an array of strings, one member per field.Check if the message is stamped valid or not.If it is invalid, set the status and fix mode to NO_FIX and save the corresponding flags locally; also save the online flag to indicate we have handled a known sentence.If the fix is autonomous and valid, start to decode the fields.First, test if there are enough fields available; then handle the date and time via merge_ddmmyy() and merge_hhmmss(), storing the TIME_SET flag and storing the fix time as a UNIX-epoch relative value.If the sentence time and this fix time are different, we have started a new cycle of observation, so update the sentence time and the store the CYCLE_START_SET flag.Whatever the number of fields, store the fix co-ordinates via do_lat_lon(), store the speed and the track and save the corresponding flags.Return the local aggregated flags to allow the main copy in the session data to be updated. static gps_mask_t processGPGLL(int count, char *field[], struct gps_device_t *session) Preload the local flag with the ERROR_SET flag.Check that the sentence is usable, exiting with the preset error flag if it is not.If it is usable, clear the local flags and start processing the fields, updating any local flag fields on the way.If the year is already known, update the time and check for the start of cycle (see processGPRMC() above).Handle the fix location and, if the number of received fixes is more than 8 and the status is differential, stash the new status as STATUS_DGPS_FIX; otherwise stash STATUS_FIX.If the present mode is less than 2D_FIX, update it to 2D_FIX.Write the stashed value of newstatus into the session status and return all the locally aggregated flags. static gps_mask_t processGPGGA(int c UNUSED, char *field[], struct gps_device_t *session) Stash the last fix time. Set the status to the value in the message and update the local flag variable.If the status is STATUS_NO_FIX, exit immediately, returning the locally aggregated flags. If there is a fix, process it.Handle the time as in processGPGLL() above. Handle the latitiude and longitude with a call to do_lat_lon() above and set the local flag.Update the satellites_used field and stash the altitude.If the altitude is empty, force the fix mode and status to 2D if it was 3D previously.If it is not empty, stash the old value of altitude and replace it with the new value stashed earlier and set the local flag variable. If the mode is presently less than 3D, update it to 3D and set the local flag.If the stashed old altitude is NaN or the stashed fix time and current fix time are equal, set the climb rate to 0 otherwise calculate it by dividing the altitude difference by the time difference and set the local flag.If the geoid separation is available, store it, otherwise store the value from wgs84_separation() that depends on current location.Finally, return all the locally aggregated flags. static gps_mask_t processGPGSA(int count, char *field[], struct gps_device_t *session) Start with a simple validity check on the number of fields (for i.Trek M3) and bail out with a simple indication of on-line status if it fails.Set the fix mode from the sentence and either clear the local flag variable (if an Antaris chipset says we are in dead-reckoning mode) or set the MODE_SET flag.Update all the DOP fields from the sentence, clear the count of used satellites, then scan all the satellite data.If any satellite is good (prn != 0), store the prn and increment the count of used satellites.Finally, set the local flags to indicate that DOPs are available and return all the locally aggregated flags. static gps_mask_t processGPGSV(int count, char *field[], struct gps_device_t *session) Check if the sentence has too few fields or the wrong number fo fields. In this case, clear the data for all satellites and return with an error indication.Start to parse the sentence. First, note how many sentences are to be expected to complete the data transfer.If the sentence number is invalid, clear the data for all satellites and return with an error indication.If this is the first sentence of the sequence, clear the data for all satellites.Loop through the sentence fields, updating the session's satellite data.If any satellite number is higher than the number of channels, clear all satellite data and break out of the loop.Assuming this is not a buggy chipset (e.g. Motorola Oncore GT+), update the satellite count and loop again.If this was the last sentence of the block and the number of satellites seen is not the same as the number reported, generate an error log.If this is not the last sentence of the block, exit early and return an error flag as a guard.Finally, on the last sentence, carry out a sanity check and either return an error flag or a SATELLITE_SET flag. static gps_mask_t processPGRME(int c UNUSED, char *field[], struct gps_device_t *session) Check that the error estimate data is good. If not, set all error estimate fields to 100m and return an error flag.If they are good, calculate the error value and store it. Return the appropriate flag values. static gps_mask_t processGPZDA(int c UNUSED, char *field[], struct gps_device_t *session) Set the local flag variable to indicate that the time is available.Store the actual time by a call to merge_hhmmss() and fill in the other fields from the sentence data.If the sentence is not timestamped the same as the fixtime, set the CYCLE_START_SET flag.Update the fixtime to the sentence timestamp.Finally, return all the locally aggregated flags. static gps_mask_t processTNTHTM(int c UNUSED, char *field[], struct gps_device_t *session) Set the local variable to indicate the unit is on-line.Fill all appropriate fields from the sentence and set the associated flags in the local flag variable.Set the fix status and return all the locally aggregated flags. static short nmea_checksum(char *sentence, unsigned char *correct_sum) Calculate and return the checksum of an NMEA sentence. gps_mask_t nmea_parse(char *sentence, struct gps_device_t *session) Test that the length of the NMEA sentence is acceptable, simply returning an on-line indication if it is too long to handle.If it is within limits, make a local copy and split it on the commas into an array, one field per element.Use the first element to match the command to the table of decodable commands.Check if it is supported and the number of fields is reasonable, invoke the correct decoder and return the value from that call.If it fails the check, simply return an on-line status.This function is also responsible for performing adaptive end-of-cycle detection. void nmea_add_checksum(char *sentence) Calculate the checksum then append '*' + the checksum + CR/LF to the end of an NMEA sentence, skipping any existing '*'. int nmea_write(struct gps_device_t *session, const char *fmt, ... ) Ship a string to an NMEA device, adding a checksum and CR/LF if needed. A checksum is added only if the sentence begins with '$'. Bytes written are returned. int nmea_send(struct gps_device_t *session, , const char *fmt, ... ) A wrapper around nmea_write() to give it sprintf-like varargs behavior.