Improved, thread compatible. Adds new features
Fork of GroveGPS by
GroveGPS.cpp@3:cc5c9faa1cc6, 2018-04-22 (annotated)
- Committer:
- JimCarver
- Date:
- Sun Apr 22 00:06:53 2018 +0000
- Revision:
- 3:cc5c9faa1cc6
- Child:
- 4:4615d6e99bb4
Improved
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
JimCarver | 3:cc5c9faa1cc6 | 1 | // ---------------------------------------------------------------------------- |
JimCarver | 3:cc5c9faa1cc6 | 2 | // Copyright 2016-2017 ARM Ltd. |
JimCarver | 3:cc5c9faa1cc6 | 3 | // |
JimCarver | 3:cc5c9faa1cc6 | 4 | // SPDX-License-Identifier: Apache-2.0 |
JimCarver | 3:cc5c9faa1cc6 | 5 | // |
JimCarver | 3:cc5c9faa1cc6 | 6 | // Licensed under the Apache License, Version 2.0 (the "License"); |
JimCarver | 3:cc5c9faa1cc6 | 7 | // you may not use this file except in compliance with the License. |
JimCarver | 3:cc5c9faa1cc6 | 8 | // You may obtain a copy of the License at |
JimCarver | 3:cc5c9faa1cc6 | 9 | // |
JimCarver | 3:cc5c9faa1cc6 | 10 | // http://www.apache.org/licenses/LICENSE-2.0 |
JimCarver | 3:cc5c9faa1cc6 | 11 | // |
JimCarver | 3:cc5c9faa1cc6 | 12 | // Unless required by applicable law or agreed to in writing, software |
JimCarver | 3:cc5c9faa1cc6 | 13 | // distributed under the License is distributed on an "AS IS" BASIS, |
JimCarver | 3:cc5c9faa1cc6 | 14 | // WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. |
JimCarver | 3:cc5c9faa1cc6 | 15 | // See the License for the specific language governing permissions and |
JimCarver | 3:cc5c9faa1cc6 | 16 | // limitations under the License. |
JimCarver | 3:cc5c9faa1cc6 | 17 | // ---------------------------------------------------------------------------- |
JimCarver | 3:cc5c9faa1cc6 | 18 | |
JimCarver | 3:cc5c9faa1cc6 | 19 | #include "mbed.h" |
JimCarver | 3:cc5c9faa1cc6 | 20 | |
JimCarver | 3:cc5c9faa1cc6 | 21 | #include "GroveGPS.h" |
JimCarver | 3:cc5c9faa1cc6 | 22 | |
JimCarver | 3:cc5c9faa1cc6 | 23 | Serial gps_serial(PE_8, PE_7, 9600); |
JimCarver | 3:cc5c9faa1cc6 | 24 | |
JimCarver | 3:cc5c9faa1cc6 | 25 | |
JimCarver | 3:cc5c9faa1cc6 | 26 | Thread gpsThread; |
JimCarver | 3:cc5c9faa1cc6 | 27 | GroveGPS gps; |
JimCarver | 3:cc5c9faa1cc6 | 28 | |
JimCarver | 3:cc5c9faa1cc6 | 29 | |
JimCarver | 3:cc5c9faa1cc6 | 30 | void service_serial(void) { |
JimCarver | 3:cc5c9faa1cc6 | 31 | gps.readCharacter(gps_serial.getc()); |
JimCarver | 3:cc5c9faa1cc6 | 32 | } |
JimCarver | 3:cc5c9faa1cc6 | 33 | |
JimCarver | 3:cc5c9faa1cc6 | 34 | |
JimCarver | 3:cc5c9faa1cc6 | 35 | int calc_cs(char * str) { |
JimCarver | 3:cc5c9faa1cc6 | 36 | char cs = 0; |
JimCarver | 3:cc5c9faa1cc6 | 37 | int x = 1; |
JimCarver | 3:cc5c9faa1cc6 | 38 | |
JimCarver | 3:cc5c9faa1cc6 | 39 | while(str[x] != '*') { |
JimCarver | 3:cc5c9faa1cc6 | 40 | cs ^= str[x++]; |
JimCarver | 3:cc5c9faa1cc6 | 41 | } |
JimCarver | 3:cc5c9faa1cc6 | 42 | return(cs); |
JimCarver | 3:cc5c9faa1cc6 | 43 | } |
JimCarver | 3:cc5c9faa1cc6 | 44 | |
JimCarver | 3:cc5c9faa1cc6 | 45 | void nema_send( void ) { |
JimCarver | 3:cc5c9faa1cc6 | 46 | |
JimCarver | 3:cc5c9faa1cc6 | 47 | char nema_mode[] = "$PMTK314,5,5,5,5,1,0,0,0,0,0,0,0,0,0,0,0,0,1,0*"; |
JimCarver | 3:cc5c9faa1cc6 | 48 | char nema_cmd[64]; |
JimCarver | 3:cc5c9faa1cc6 | 49 | int x = 0; |
JimCarver | 3:cc5c9faa1cc6 | 50 | sprintf( nema_cmd, "%s%x\r\n", nema_mode, calc_cs(nema_mode)); |
JimCarver | 3:cc5c9faa1cc6 | 51 | while(nema_cmd[x]) { |
JimCarver | 3:cc5c9faa1cc6 | 52 | gps_serial.putc(nema_cmd[x++]); |
JimCarver | 3:cc5c9faa1cc6 | 53 | } |
JimCarver | 3:cc5c9faa1cc6 | 54 | } |
JimCarver | 3:cc5c9faa1cc6 | 55 | |
JimCarver | 3:cc5c9faa1cc6 | 56 | int GPS_init() { |
JimCarver | 3:cc5c9faa1cc6 | 57 | |
JimCarver | 3:cc5c9faa1cc6 | 58 | gps_serial.attach( &service_serial, Serial::RxIrq ); |
JimCarver | 3:cc5c9faa1cc6 | 59 | gps.gps_gga.new_flag = 0; |
JimCarver | 3:cc5c9faa1cc6 | 60 | gps.gps_zda.new_flag = 0; |
JimCarver | 3:cc5c9faa1cc6 | 61 | gps.gps_vtg.new_flag = 0; |
JimCarver | 3:cc5c9faa1cc6 | 62 | nema_send(); |
JimCarver | 3:cc5c9faa1cc6 | 63 | return 0; |
JimCarver | 3:cc5c9faa1cc6 | 64 | } |