thread bug
Fork of GroveGPS by
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?
User | Revision | Line number | New 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 | } |