4 * This file is part of BeRTOS.
6 * Bertos is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * (at your option) any later version.
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
16 * You should have received a copy of the GNU General Public License
17 * along with this program; if not, write to the Free Software
18 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
20 * As a special exception, you may use this file as part of a free software
21 * library without restriction. Specifically, if other files instantiate
22 * templates or use macros or inline functions from this file, or you compile
23 * this file and link it with other files to produce an executable, this
24 * file does not by itself cause the resulting executable to be covered by
25 * the GNU General Public License. This exception does not however
26 * invalidate any other reasons why the executable file might be covered by
27 * the GNU General Public License.
29 * Copyright 2009 Develer S.r.l. (http://www.develer.com/)
33 * \brief NMEA parser test.
35 * \author Daniele Basile <asterix@develer.com>
42 #include <struct/kfile_mem.h>
44 #include <cfg/debug.h>
47 #include <string.h> //strncmp
49 static nmeap_context_t nmea; /* parser context */
57 static char nmea_test_vector[] =
59 "$GPGGA,123519.021,3929.946667,N,11946.086667,E,1,08,0.9,545.4,M,46.9,M,,*4A\r\n" /* good */
60 "$xyz,1234,asdfadfasdfasdfljsadfkjasdfk\r\n" /* junk */
61 "$GPRMC,225446,A,4916.45,N,12311.120,W,000.5,054.7,191194,020.3,E*68\r\n" /* good */
62 "$GPRMC,225446,A,4916.45,N,12311.120,W,000.5,054.7,191194,020.3,E*48\r\n" /* checksum error */
63 "$GPGGA,091144.698,0000.0000,S,00000.0000,W,0,00,00.0,0.0,M,0.0,M,,*5C\r\n" /* acquired */
64 "$GPRMC,091144.698,V,0000.0000,S,00000.0000,W,0.00,0.00,051009,,,A*75\r\n" /* acquired */
65 "$GPVTG,0.00,T,,,0.00,N,0.00,K,A*70\r\n" /* acquired */
66 "$GPGGA,091145.698,0000.0000,S,00000.0000,W,0,00,00.0,0.0,M,0.0,M,,*5D\r\n" /* acquired */
67 "$GPGSV,1,1,02,1,,,41,12,,,35,,,,,,,,*4A\r\n" /* acquired */
68 "$GPRMC,091145.698,V,0000.0000,S,00000.0000,W,0.00,0.00,051009,,,A*74\r\n" /* acquired */
69 "$GPVTG,0.00,T,,,0.00,N,0.00,K,A*70\r\n" /* acquired */
70 "$GPGGA,170529.948,4351.0841,N,01108.8685,E,1,05,02.6,57.4,M,45.2,M,,*50\r\n"
71 "$GPRMC,170525.949,A,4351.0843,N,01108.8687,E,0.00,237.67,051009,,,A*61\r\n"
72 "$GPVTG,237.67,T,,,0.00,N,0.00,K,A*77\r\n"
73 "$GPGSV,3,1,09,3,78,302,37,6,87,031,,7,05,292,37,14,05,135,*48\r\n"
74 "$GPGGA,170527.949,4351.0842,N,01108.8685,E,1,05,02.6,57.4,M,45.2,M,,*5C\r\n"
79 * do something with the GGA data
81 static void gpgga_callout(nmeap_context_t *context, void *data, void *user_data)
85 NmeaGga *gga = (NmeaGga *)data;
87 kprintf("found GPGGA message %ld %ld %d %lu %d %d %d %d\n",
100 * called when a gpgga message is received and parsed
102 static void gprmc_callout(nmeap_context_t *context, void *data, void *user_data)
106 NmeaRmc *rmc = (NmeaRmc *)data;
108 kprintf("found GPRMC Message %lu %c %d %ld %ld %d %d\n",
120 * do something with the GGA data
122 static void gpgsv_callout(nmeap_context_t *context, void *data, void *user_data)
126 NmeaGsv *gsv = (NmeaGsv *)data;
128 kprintf("found GPGSV message %d %d %d %d %d %d %d\n",
140 * do something with the VTG data
142 static void gpvtg_callout(nmeap_context_t *context, void *data, void *user_data)
146 NmeaVtg *vtg = (NmeaVtg *)data;
148 kprintf("found GPVTG message %d %d %d\n",
155 int nmea_testSetup(void)
159 kfilemem_init(&mem, nmea_test_vector, sizeof(nmea_test_vector));
160 kprintf("Init test buffer..done.\n");
162 nmeap_init(&nmea, NULL);
163 kprintf("Init NMEA context..done.\n");
164 nmeap_addParser(&nmea, "GPGGA", nmea_gpgga, gpgga_callout, &gga);
165 kprintf("Init NMEA GPGGA parser..done.\n");
166 nmeap_addParser(&nmea, "GPRMC", nmea_gprmc, gprmc_callout, &rmc);
167 kprintf("Init NMEA GPRMC parser..done.\n");
168 nmeap_addParser(&nmea, "GPGSV", nmea_gpgsv, gpgsv_callout, &gsv);
169 kprintf("Init NMEA GPGSV parser..done.\n");
170 nmeap_addParser(&nmea, "GPVTG", nmea_gpvtg, gpvtg_callout, &vtg);
171 kprintf("Init NMEA GPVTG parser..done.\n");
176 int nmea_testTearDown(void)
181 int nmea_testRun(void)
183 nmea_poll(&nmea, &mem.fd);