Jim Carver / GroveGPS

Improved, thread compatible. Adds new features

Dependents:   GroveGPS-Example

Fork of GroveGPS by Michael Ray

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?

UserRevisionLine numberNew 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 }