aboutsummaryrefslogtreecommitdiffstats
path: root/plugin_gps.c
diff options
context:
space:
mode:
Diffstat (limited to '')
-rw-r--r--plugin_gps.c307
1 files changed, 307 insertions, 0 deletions
diff --git a/plugin_gps.c b/plugin_gps.c
new file mode 100644
index 0000000..d5b2349
--- /dev/null
+++ b/plugin_gps.c
@@ -0,0 +1,307 @@
+/* $Id$
+ * $URL$
+ *
+ * gps plugin, code by michu / www.neophob.com, based on nmeap, http://sourceforge.net/projects/nmeap/
+ *
+ * Copyright (C) 2007 michu
+ * Copyright (C) 2004, 2005, 2006, 2007 The LCD4Linux Team <lcd4linux-devel@users.sourceforge.net>
+ *
+ * This file is part of LCD4Linux.
+ *
+ * LCD4Linux is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2, or (at your option)
+ * any later version.
+ *
+ * LCD4Linux is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
+ *
+ */
+
+/*
+ * exported functions:
+ *
+ * int plugin_init_gps (void)
+ * adds various functions
+ *
+ */
+
+
+/* define the include files you need */
+#include "config.h"
+
+#include <stdio.h>
+#include <stdlib.h>
+#include <string.h>
+#include <ctype.h>
+#include <unistd.h>
+#include <fcntl.h>
+#include <termios.h>
+#include <errno.h>
+#include <sys/types.h>
+#include <sys/stat.h>
+#include <sys/ioctl.h>
+#include <sys/io.h>
+
+/* these should always be included */
+#include "debug.h"
+#include "plugin.h"
+
+#ifdef WITH_DMALLOC
+#include <dmalloc.h>
+#endif
+
+#include "nmeap.h"
+
+
+#define SHOW_ALTITUDE 0x0000001
+#define SHOW_SPEED 0x0000010
+#define SHOW_COURSE 0x0000100
+#define SHOW_SATELLITES 0x0001000
+#define SHOW_QUALITY 0x0010000
+#define SHOW_WARN 0x0100000
+
+nmeap_gga_t g_gga;
+
+
+/* ---------------------------------------------------------------------------------------*/
+/* STEP 1 : allocate the data structures. be careful if you put them on the stack because */
+/* they need to be live for the duration of the parser */
+/* ---------------------------------------------------------------------------------------*/
+
+static nmeap_context_t nmea; /* parser context */
+static nmeap_gga_t gga; /* this is where the data from GGA messages will show up */
+static nmeap_rmc_t rmc; /* this is where the data from RMC messages will show up */
+static int user_data; /* user can pass in anything. typically it will be a pointer to some user data */
+static int fd;
+
+
+
+/*************************************************************************
+ * LINUX IO
+ */
+
+/*
+ * open the specified serial port for read/write
+ * @return port file descriptor or -1
+ */
+
+static int openPort(const char *tty, int baud)
+{
+ int status;
+ int fd;
+ struct termios newtio;
+
+ /* open the tty */
+ fd = open(tty, O_RDWR | O_NOCTTY);
+ if (fd < 0) {
+ error("open");
+ return fd;
+ }
+
+ /* flush serial port */
+ status = tcflush(fd, TCIFLUSH);
+ if (status < 0) {
+ error("tcflush");
+ close(fd);
+ return -1;
+ }
+
+ /* get current terminal state */
+ tcgetattr(fd, &newtio);
+
+ /* set to raw terminal type */
+ newtio.c_cflag = baud | CS8 | CLOCAL | CREAD;
+ newtio.c_iflag = IGNBRK | IGNPAR;
+ newtio.c_oflag = 0;
+
+ /* control parameters */
+ newtio.c_cc[VMIN] = 1; /* block for at least one charater */
+
+ /* set its new attrigutes */
+ status = tcsetattr(fd, TCSANOW, &newtio);
+ if (status < 0) {
+ error("tcsetattr() failed: %s", strerror(errno));
+ close(fd);
+ fd = -1;
+ return fd;
+ }
+ return fd;
+}
+
+
+
+static void printGps(nmeap_gga_t * gga, nmeap_rmc_t * rmc)
+{
+ float myCourse = rmc->course; /* I assume 0 degree = North */
+
+ char courses[8][3] = { "N ", "NO", "O ", "SO", "S ", "SW", "W ", "NW" };
+ float degrees[8] = { 22.5f, 67.5f, 112.5f, 157.5f, 202.5f, 247.5f, 292.5f, 337.5f };
+ int selectedDegree = 0;
+ int n;
+
+ for (n = 0; n < 8; n++) {
+ if (myCourse < degrees[n]) {
+ selectedDegree = n;
+ break;
+ }
+ }
+
+ debug("alt:%.0f speed:%.0f course:%s sat:%d quali:%d, warn:%c\n", gga->altitude, rmc->speed * 1.852f, /* knots -> km/h */
+ courses[selectedDegree], gga->satellites, gga->quality, rmc->warn /* A=active or V=Void */
+ );
+
+}
+
+
+/*
+#define SHOW_ALTITUDE 0x0000001
+#define SHOW_SPEED 0x0000010
+#define SHOW_COURSE 0x0000100
+#define SHOW_SATELLITES 0x0001000
+#define SHOW_QUALITY 0x0010000
+#define SHOW_WARN 0x0100000
+*/
+
+static void parse(RESULT * result, RESULT * theOptions)
+{
+ char *value = " ";
+ int finito = 0;
+
+ int rem;
+ int offset;
+ int status;
+ int len;
+ int lame;
+ long options;
+ char buffer[32];
+
+ options = R2N(theOptions);
+ if (options & SHOW_ALTITUDE)
+
+ while (finito == 0) {
+
+ /* ---------------------------------------- */
+ /* STEP 6 : get a buffer of input */
+ /* --------------------------------------- */
+ len = rem = read(fd, buffer, sizeof(buffer));
+ if (len <= 0) {
+ error("GPS Plugin, Error read from port");
+ break;
+ }
+
+ /* ---------------------------------------------- */
+ /* STEP 7 : process input until buffer is used up */
+ /* ---------------------------------------------- */
+
+ offset = 0;
+ lame = 0;
+
+ while (rem > 0) {
+ status = nmeap_parseBuffer(&nmea, &buffer[offset], &rem);
+ offset += (len - rem);
+
+ switch (status) {
+ case NMEAP_GPGGA:
+ /* GOT A GPGGA MESSAGE */
+ lame++;
+ break;
+ case NMEAP_GPRMC:
+ /* GOT A GPRMC MESSAGE */
+ lame++;
+ break;
+ default:
+ debug("unhandled status: %d", status);
+ break;
+ }
+ if (lame > 1) {
+ finito = 1;
+ printGps(&gga, &rmc);
+ }
+ }
+
+ }
+
+
+ /* store result */
+ SetResult(&result, R_STRING, value);
+
+ free(value);
+}
+
+
+
+/* plugin initialization */
+/* MUST NOT be declared 'static'! */
+int plugin_init_gps(void)
+{
+ int fd;
+ int status;
+ char *port = "/dev/usb/tty/1";
+ char *test;
+
+ if ((test = getenv("GPS_PORT"))) { /* define your port via env variable */
+ port = test;
+ }
+
+
+ /* --------------------------------------- */
+ /* open the serial port device */
+ /* using default 4800 baud for most GPS */
+ /* --------------------------------------- */
+ fd = openPort(port, B4800);
+ if (fd < 0) {
+ /* open failed */
+ error("GPS PLUGIN, Error: openPort %d", fd);
+ return fd;
+ }
+
+ /* --------------------------------------- */
+ /*STEP 2 : initialize the nmea context */
+ /* --------------------------------------- */
+ status = nmeap_init(&nmea, (void *) &user_data);
+ if (status != 0) {
+ error("GPS PLUGIN, Error: nmeap_init %d", status);
+ exit(1);
+ }
+
+ /* --------------------------------------- */
+ /*STEP 3 : add standard GPGGA parser */
+ /* -------------------------------------- */
+ status = nmeap_addParser(&nmea, "GPGGA", nmeap_gpgga, 0, &gga);
+ if (status != 0) {
+ error("GPS PLUGIN, Error: nmeap_add GPGGA parser, error:%d", status);
+ return -1;
+ }
+
+ /* --------------------------------------- */
+ /*STEP 4 : add standard GPRMC parser */
+ /* -------------------------------------- */
+ /* status = nmeap_addParser(&nmea,"GPRMC",nmeap_gprmc,gprmc_callout,&rmc); */
+ status = nmeap_addParser(&nmea, "GPRMC", nmeap_gprmc, 0, &rmc);
+ if (status != 0) {
+ error("GPS PLUGIN, Error: nmeap_add GPRMC parser, error:%d", status);
+ return -1;
+ }
+
+
+ /* register all our cool functions */
+ /* the second parameter is the number of arguments */
+ /* -1 stands for variable argument list */
+ AddFunction("gps::parse", 0, parse);
+
+ return 0;
+}
+
+void plugin_exit_gps(void)
+{
+ /* close the serial port */
+ close(fd);
+
+}
generated by cgit v1.2.3 (git 2.25.1) at 2024-12-17 17:11:38 +0000