/*********************************************************************************
|
* Copyright: (C) Guo Wenxue<guowenxue@gmail.com>
|
* All rights reserved.
|
*
|
* Filename: gpsd.c
|
* Description: This is the RWME(Radiation Monitor Works Engine) gpsd applet entry point
|
*
|
* Version: 1.0.0(01/13/2013~)
|
* Author: Guo Wenxue <guowenxue@gmail.com>
|
* ChangeLog: 1, Release initial version on "01/13/2013 02:40:36 PM"
|
*
|
********************************************************************************/
|
#include "gpsd.h"
|
#include "cp_hal.h"
|
#include "cp_time.h"
|
|
static void usage_gpsd(const char *progname)
|
{
|
banner(progname);
|
|
printf("Usage: %s [OPTION]...\n", progname);
|
printf(" %s is a daemon program running on the device to locate the device\n", progname);
|
|
printf("\nMandatory arguments to long options are mandatory for short options too:\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 init_gpsd_context(GPSD_CONTEX *gps)
|
{
|
log_info("Initialize gpsd context.\n");
|
|
gps->pwr_status = POWER_OFF;
|
|
nmea_zero_INFO(&(gps->info));
|
|
/* Initialize the GPS dataport pointer */
|
gps->comport = comport_init(GPS_DATAPORT, 9600, "8N1N");
|
if(NULL == gps->comport)
|
{
|
log_err("Initialise GPS data port %s on 9600 with 8N1N failure\n", GPS_DATAPORT);
|
return -1;
|
}
|
|
if( comport_open(gps->comport) < 0)
|
{
|
log_err("Open GPS data port %s on 9600 with 8N1N failure\n", GPS_DATAPORT);
|
return -2;
|
}
|
|
log_dbg("Open GPS data port %s on 9600 with 8N1N successfully\n", GPS_DATAPORT);
|
return 0;
|
}
|
|
void term_gpsd_context(GPSD_CONTEX *gps)
|
{
|
comport_term(gps->comport);
|
|
#if 0
|
if( ON== hal_get_gps_power())
|
{
|
hal_turn_gps_power(OFF);
|
}
|
#endif
|
|
return ;
|
}
|
|
|
|
int start_gpsd_service(GPSD_CONTEX *gps)
|
{
|
int len;
|
char buf[1024];
|
|
while( !g_cp_signal.stop )
|
{
|
if( OFF== (gps->pwr_status=hal_get_gps_power()) )
|
{
|
hal_turn_gps_power(ON);
|
continue;
|
}
|
|
memset(buf, 0, sizeof(buf));
|
if( (len=comport_recv(gps->comport, buf, sizeof(buf), 3000)) > 0)
|
{
|
/* Data sample:
|
* $GPGGA,081803.000,3029.9100,N,11423.2012,E,1,05,1.6,38.7,M,-13.7,M,,0000*4C
|
* $GPGSA,A,3,18,24,21,22,15,,,,,,,,3.1,1.6,2.7*3A
|
* $GPRMC,081803.000,A,3029.9100,N,11423.2012,E,1.14,126.38,210113,,,A*62
|
*/
|
nmea_parse(buf, len, &(gps->info));
|
log_nrml("GPS get UTC time: %d-%d-%d %d:%d:%d.%d\n", gps->info.utc.year+1900, gps->info.utc.mon+1, gps->info.utc.day,
|
gps->info.utc.hour+8, gps->info.utc.min, gps->info.utc.sec, gps->info.utc.hsec);
|
log_nrml("GPS Sig[%d] Latitude:[%f] Longitude:[%f]\n", gps->info.sig, gps->info.lat, gps->info.lon);
|
}
|
|
micro_second_sleep(100);
|
}
|
|
return 0;
|
}
|
|
int gpsd_main(int argc, char **argv)
|
{
|
int opt;
|
int rv = 0;
|
int debug = 0;
|
char pid_file[64] = { 0 }; /* The file used to record the PID */
|
const char *progname=NULL;
|
char *log_file = GPSD_DEF_LOG_FILE;
|
int log_level = GPSD_DEF_LOG_LEVEL;
|
cp_logger *logger = NULL;
|
GPSD_CONTEX gpsd_ctx;
|
|
struct option long_options[] = {
|
{"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, "dl:vh", long_options, NULL)) != -1)
|
{
|
switch (opt)
|
{
|
case 'd': /* Set debug running */
|
debug = 1;
|
log_file = DBG_LOG_FILE;
|
break;
|
|
case 'l': /* Set the log level */
|
log_level = atoi(optarg);
|
break;
|
|
case 'v': /* Get software version */
|
banner(progname); /* Defined in version.h */
|
return EXIT_SUCCESS;
|
|
case 'h': /* Get help information */
|
usage_gpsd(progname);
|
return 0;
|
|
default:
|
break;
|
} /* end of "switch(opt)" */
|
}
|
|
if( !debug )
|
{
|
snprintf(pid_file, sizeof(pid_file), "%s/%s.pid", PID_FILE_PATH, progname);
|
if( check_daemon_running(pid_file) )
|
{
|
printf("Programe already running, exit now.\n");
|
return -1;
|
}
|
}
|
|
if ( !(logger=cp_log_init(NULL, log_file, log_level, GPSD_LOG_FILE_SIZE)) )
|
{
|
printf("Logger initialize failure with file: %s\n", logger->file);
|
return -1;
|
}
|
|
if ( cp_log_open() )
|
{
|
printf("Logger initialize failure with file: %s\n", logger->file);
|
return -1;
|
}
|
|
if( !debug )
|
{
|
if( set_daemon_running(pid_file) )
|
{
|
log_fatal("Set program \"%s\" running as daemon failure.\n", progname);
|
goto CleanUp;
|
}
|
}
|
|
cp_install_proc_signal();
|
|
if( init_gpsd_context(&gpsd_ctx) < 0 )
|
{
|
log_fatal("Initialise gpsd work context failure, rv=%d\n", rv);
|
goto CleanUp;
|
}
|
|
/* Start the GPS thread to locate the device */
|
if( (rv=start_gpsd_service(&gpsd_ctx)) < 0)
|
{
|
log_fatal("Start PPP thread failure, rv=%d\n", rv);
|
goto CleanUp;
|
}
|
|
CleanUp:
|
log_nrml("Terminate program \"%s\".\n", progname);
|
term_gpsd_context(&gpsd_ctx);
|
unlink(pid_file);
|
cp_log_term();
|
return rv;
|
}
|
