Jim Carver / GroveGPS_bug

thread bug

Fork of GroveGPS by Michael Ray

GroveGPS.cpp@2:e3f570014ab4, 2018-05-31 (annotated)

Committer:
JimCarver
Date:
Thu May 31 16:28:32 2018 +0000
Revision:
2:e3f570014ab4
Parent:
1:7ad98913098c 
bug

Who changed what in which revision?

UserRevisionLine numberNew contents of line
JimCarver 1:7ad98913098c 1 // ----------------------------------------------------------------------------
JimCarver 1:7ad98913098c 2 // Copyright 2016-2017 ARM Ltd.
JimCarver 1:7ad98913098c 3 //
JimCarver 1:7ad98913098c 4 // SPDX-License-Identifier: Apache-2.0
JimCarver 1:7ad98913098c 5 //
JimCarver 1:7ad98913098c 6 // Licensed under the Apache License, Version 2.0 (the "License");
JimCarver 1:7ad98913098c 7 // you may not use this file except in compliance with the License.
JimCarver 1:7ad98913098c 8 // You may obtain a copy of the License at
JimCarver 1:7ad98913098c 9 //
JimCarver 1:7ad98913098c 10 // http://www.apache.org/licenses/LICENSE-2.0
JimCarver 1:7ad98913098c 11 //
JimCarver 1:7ad98913098c 12 // Unless required by applicable law or agreed to in writing, software
JimCarver 1:7ad98913098c 13 // distributed under the License is distributed on an "AS IS" BASIS,
JimCarver 1:7ad98913098c 14 // WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
JimCarver 1:7ad98913098c 15 // See the License for the specific language governing permissions and
JimCarver 1:7ad98913098c 16 // limitations under the License.
JimCarver 1:7ad98913098c 17 // ----------------------------------------------------------------------------
JimCarver 1:7ad98913098c 18
JimCarver 1:7ad98913098c 19 #include "mbed.h"
JimCarver 1:7ad98913098c 20
JimCarver 1:7ad98913098c 21 #include "GroveGPS.h"
JimCarver 1:7ad98913098c 22
JimCarver 1:7ad98913098c 23 Serial gps_serial(PE_8, PE_7, 9600);
JimCarver 1:7ad98913098c 24
JimCarver 1:7ad98913098c 25
JimCarver 1:7ad98913098c 26
JimCarver 1:7ad98913098c 27 //Thread gpsThread;
JimCarver 1:7ad98913098c 28 GroveGPS gps;
JimCarver 1:7ad98913098c 29
JimCarver 1:7ad98913098c 30 Semaphore parse;
JimCarver 1:7ad98913098c 31 Thread parsethread(osPriorityBelowNormal);
JimCarver 1:7ad98913098c 32
JimCarver 1:7ad98913098c 33
JimCarver 1:7ad98913098c 34 static void parseLine() {
JimCarver 1:7ad98913098c 35 while(1) {
JimCarver 1:7ad98913098c 36 parse.wait();
JimCarver 1:7ad98913098c 37 if (gps._last_line.find("GPGGA") != std::string::npos) {
JimCarver 1:7ad98913098c 38 gps.parseGGA();
JimCarver 1:7ad98913098c 39 }
JimCarver 1:7ad98913098c 40 if (gps._last_line.find("GPZDA") != std::string::npos) {
JimCarver 1:7ad98913098c 41 gps.parseZDA();
JimCarver 1:7ad98913098c 42 }
JimCarver 1:7ad98913098c 43 if (gps._last_line.find("GPVTG") != std::string::npos) {
JimCarver 1:7ad98913098c 44 gps.parseVTG();
JimCarver 1:7ad98913098c 45 }
JimCarver 1:7ad98913098c 46 gps._last_line = "";
JimCarver 1:7ad98913098c 47 }
JimCarver 1:7ad98913098c 48 }
JimCarver 1:7ad98913098c 49
JimCarver 1:7ad98913098c 50
JimCarver 1:7ad98913098c 51 void readCharacter(char newCharacter) {
JimCarver 1:7ad98913098c 52 if (newCharacter == '\n') {
JimCarver 1:7ad98913098c 53 parse.release();
JimCarver 1:7ad98913098c 54 } else {
JimCarver 1:7ad98913098c 55 gps._last_line += newCharacter;
JimCarver 1:7ad98913098c 56 }
JimCarver 1:7ad98913098c 57 }
JimCarver 1:7ad98913098c 58
JimCarver 1:7ad98913098c 59
JimCarver 1:7ad98913098c 60 void service_serial(void) {
JimCarver 1:7ad98913098c 61 readCharacter(gps_serial.getc());
JimCarver 1:7ad98913098c 62 }
JimCarver 1:7ad98913098c 63
JimCarver 1:7ad98913098c 64
JimCarver 1:7ad98913098c 65 int calc_cs(char * str) {
JimCarver 1:7ad98913098c 66 char cs = 0;
JimCarver 1:7ad98913098c 67 int x = 1;
JimCarver 1:7ad98913098c 68
JimCarver 1:7ad98913098c 69 while(str[x] != '*') {
JimCarver 1:7ad98913098c 70 cs ^= str[x++];
JimCarver 1:7ad98913098c 71 }
JimCarver 1:7ad98913098c 72 return(cs);
JimCarver 1:7ad98913098c 73 }
JimCarver 1:7ad98913098c 74
JimCarver 1:7ad98913098c 75 void nema_send( void ) {
JimCarver 1:7ad98913098c 76
JimCarver 1:7ad98913098c 77 char nema_mode[] = "$PMTK314,0,0,5,5,0,0,0,0,0,0,0,0,0,0,0,0,0,1,0*";
JimCarver 1:7ad98913098c 78 char nema_cmd[64];
JimCarver 1:7ad98913098c 79 int x = 0;
JimCarver 1:7ad98913098c 80 sprintf( nema_cmd, "%s%x\r\n", nema_mode, calc_cs(nema_mode));
JimCarver 1:7ad98913098c 81 while(nema_cmd[x]) {
JimCarver 1:7ad98913098c 82 gps_serial.putc(nema_cmd[x++]);
JimCarver 1:7ad98913098c 83 }
JimCarver 1:7ad98913098c 84 }
JimCarver 1:7ad98913098c 85
JimCarver 1:7ad98913098c 86 int GPS_init() {
JimCarver 1:7ad98913098c 87 gps._last_line = "";
JimCarver 1:7ad98913098c 88 gps_serial.attach( &service_serial, Serial::RxIrq );
JimCarver 1:7ad98913098c 89 gps.gps_gga.new_flag = 0;
JimCarver 1:7ad98913098c 90 gps.gps_zda.new_flag = 0;
JimCarver 1:7ad98913098c 91 gps.gps_vtg.new_flag = 0;
JimCarver 1:7ad98913098c 92 nema_send();
JimCarver 1:7ad98913098c 93 printf("\r\nGPS Init\r\n");
JimCarver 1:7ad98913098c 94 parsethread.start(parseLine);
JimCarver 1:7ad98913098c 95 return 0;
JimCarver 1:7ad98913098c 96 }