/*********************************************************************************
|
* 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 <guowenxue@gmail.com>
|
* ChangeLog: 1, Release initial version on "07/10/23 09:49:55"
|
*
|
********************************************************************************/
|
|
#include <stdio.h>
|
#include <string.h>
|
#include <unistd.h>
|
|
#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;
|
}
|
