/********************************************************************************* * Copyright: (C) 2023 LingYun IoT System Studio * All rights reserved. * * Filename: gpsd.c * Description: This file is GPS location parser program * * Version: 1.0.0(07/10/23) * Author: Guo Wenxue * ChangeLog: 1, Release initial version on "07/10/23 09:49:55" * ********************************************************************************/ #include #include #include #include "logger.h" #include "comport.h" #include "util_proc.h" typedef struct gps_fix_s { char time[32]; /* GPS UTC time, formt: hhmmss */ char status; /* A: Valid V:Invalid */ float latitude; /* Latitude */ char lat; /* N: North S: South */ float longitude; /* Longitude */ char lon; /* E: East W: West */ float speed; /* Speed over ground, meters/sec */ float track; /* Course made good (relative to true north) */ } gps_fix_t; int proc_gprmc(char *buf, int size, gps_fix_t *info); static inline void banner(const char *progname) { printf("%s program Version v1.0.0 Build on (%s)\n", progname, __DATE__); printf("Copyright (C) 2023 LingYun IoT System Studio.\n"); } static void program_usage(const char *progname) { banner(progname); printf("Usage: %s [OPTION]...\n", progname); printf(" %s is a MQTT subscribe daemon program to control relay. \n", progname); printf("\nMandatory arguments to long options are mandatory for short options too:\n"); printf(" -D[device ] Set GPS connect serial port device\n"); printf(" -d[debug ] Running in debug mode\n"); printf(" -l[level ] Set the log level as [0..%d]\n", LOG_LEVEL_MAX-1); printf(" -h[help ] Display this help information\n"); printf(" -v[version ] Display the program version\n"); return; } int main (int argc, char **argv) { const char *progname=NULL; int opt = 0; int rv = 0; int debug = 0; char pid_file[64] = { 0 }; /* The file used to record the PID */ char *log_file = "/tmp/gpsd.log"; int log_level = LOG_LEVEL_INFO; int log_size = 10; char buf[4096]; char *dev=NULL; comport_t comport; gps_fix_t info; struct option long_options[] = { {"device", required_argument, NULL, 'D'}, {"debug", no_argument, NULL, 'd'}, {"level", required_argument, NULL, 'l'}, {"version", no_argument, NULL, 'v'}, {"help", no_argument, NULL, 'h'}, {NULL, 0, NULL, 0} }; progname = basename(argv[0]); /* Parser the command line parameters */ while ((opt = getopt_long(argc, argv, "D:dl:vh", long_options, NULL)) != -1) { switch (opt) { case 'D': /* Set serial port device */ dev = optarg; break; case 'd': /* Set debug running */ debug = 1; log_file = "console"; log_level = LOG_LEVEL_DEBUG; log_size = ROLLBACK_NONE; break; case 'l': /* Set the log level */ rv = atoi(optarg); log_level = rv>LOG_LEVEL_MAX ? LOG_LEVEL_MAX-1 : rv; break; case 'v': /* Get software version */ banner(progname); /* Defined in version.h */ return EXIT_SUCCESS; case 'h': /* Get help information */ program_usage(progname); return 0; default: break; } /* end of "switch(opt)" */ } if( !dev ) { program_usage(progname); return 0; } if( (rv=log_open(log_file, log_level, log_size, LOG_LOCK_DISABLE)) < 0 ) { fprintf(stderr, "open logger failed, rv=%d\n", rv); return 1; } if( !debug ) { snprintf(pid_file, sizeof(pid_file), "/var/run/%s.pid", progname); log_info("check program running in daemon or not by pidfile [%s]\n", pid_file); if( check_daemon_running(pid_file) ) { printf("Programe already running, exit now.\n"); return 3; } if( set_daemon_running(pid_file) < 0 ) { printf("Programe already running, exit now.\n"); return 3; } } if( (rv=comport_open(&comport, dev, 4800, "8N1N")) < 0 ) { log_error("Open serial port \"%s\" failed, rv=%d\n", dev, rv); return 2; } log_info("Open serial port \"%s\" successfully\n", dev); while(1) { memset(buf, 0, sizeof(buf)); rv = comport_recv(&comport, buf, sizeof(buf), 3000); if( rv > 0 ) { proc_gprmc(buf, strlen(buf), &info); } } comport_close(&comport); return 0; } /* * $GPRMC,024216.000,A,3029.6651,N,11423.6251,E,0.08, 156.95,100723,,,A*65 * 1 024216.000 UTC time format: HHMMSS, 10:42:16(BeiJing) * 2 A Status of Fix: * A = Autonomous, valid; * D = Differential, valid; * V = invalid * * 3,4 3029.6651,N Latitude format: ddmm.mmmm, Latitude 30 deg. 29.6651 min North * 5,6 11423.6251,E Longitude: dddmm.mmmm, Longitude 114 deg. 23.6251 min East * 7 0.08 Speed over ground, Knots * 8 156.95 Course Made Good, True north * 9 100723 Date of fix ddmmyy. 2023-07-10 * 10,11 ,, Magnetic variation * 12 A FAA mode indicator (NMEA 2.3 and later) * A=autonomous, * D=differential, * E=Estimated, * M=Manual input mode, * N=not valid, * S=Simulator, * V=Valid * 13 *68 mandatory nmea_checksum */ #define DD(s) ((int)((s)[0]-'0')*10+(int)((s)[1]-'0')) int proc_gprmc(char *buf, int size, gps_fix_t *info) { char *ptr_start=NULL; char *ptr_end=NULL; char hhmmss[12]={0x0}; char ddmmyy[12]={0x0}; if( !buf || size<=0 || !info ) { log_error("Invalid input arguments\n"); return -1; } log_trace("GPS receive raw data\n:%s\n", buf); if( !(ptr_start=strstr(buf, "$GPRMC")) ) { log_warn("$GPRMC keywords not matched\n"); return -2; } if( !(ptr_end=strchr(ptr_start, 0x0D)) ) { log_warn("$GPRMC data not integrated\n"); } *ptr_end = '\0'; memset(info, 0, sizeof(*info)); sscanf(ptr_start, "$GPRMC,%[^,],%c,%f,%c,%f,%c,%f,%f,%[^,]", hhmmss, &info->status, &info->latitude, &info->lat, &info->longitude, &info->lon, &info->speed, &info->track, ddmmyy); snprintf(info->time, sizeof(info->time), "%04d-%02d-%02d %02d:%02d:%02d", DD(ddmmyy+4)+2000, DD(ddmmyy+2), DD(ddmmyy), DD(hhmmss)+8, DD(hhmmss+2), DD(hhmmss+4)); if( info->status == 'A' ) { log_info("NMEA0183: %s lat=%.2f(%c) lon=%.2f(%c) speed=%.2f, track=%.2f\n", info->time, info->latitude, info->lat, info->longitude, info->lon, info->speed, info->track); } else if( info->status == 'V' ) { log_info("NMEA0183: Invalid data\n"); } return 0; }