GPS test

Dependencies:   mbed GYSFDMAXB

Committer:
cocorlow
Date:
Thu Apr 08 08:09:30 2021 +0000
Revision:
3:25e3289b0411
Parent:
1:020b393621e5
Child:
5:8301960b3ae8
asdf;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
cocorlow 0:f7f81e36e9d7 1 #include "mbed.h"
cocorlow 0:f7f81e36e9d7 2 #include <string.h>
cocorlow 1:020b393621e5 3 #include "GYSFDMAXB.hpp"
cocorlow 0:f7f81e36e9d7 4
cocorlow 3:25e3289b0411 5
cocorlow 0:f7f81e36e9d7 6 Serial pc(USBTX, USBRX);
cocorlow 1:020b393621e5 7 GYSFDMAXB gps(PC_12, PD_2);
cocorlow 0:f7f81e36e9d7 8
cocorlow 1:020b393621e5 9 void Display()
cocorlow 0:f7f81e36e9d7 10 {
cocorlow 1:020b393621e5 11 pc.printf("################################\r\n");
cocorlow 1:020b393621e5 12 pc.printf("%d h %d m %d s %d ms\r\n", gps.Hours, gps.Minutes, gps.Seconds, gps.Milliseconds);
cocorlow 1:020b393621e5 13 pc.printf("%d / %d / %d\r\n", gps.Year, gps.Month, gps.Day);
cocorlow 1:020b393621e5 14 pc.printf("latitude : %c %f\r\n", gps.N_S, gps.Latitude);
cocorlow 1:020b393621e5 15 pc.printf("longitude : %c %f\r\n", gps.E_W, gps.Longitude);
cocorlow 1:020b393621e5 16 pc.printf("elevation : %f\r\n", gps.Elevation);
cocorlow 1:020b393621e5 17 gps.Calcurate();
cocorlow 1:020b393621e5 18 pc.printf("Local X : %f\r\n", gps.Position.x);
cocorlow 1:020b393621e5 19 pc.printf("Local Y : %f\r\n", gps.Position.y);
cocorlow 1:020b393621e5 20 pc.printf("Local Z : %f\r\n", gps.Position.z);
cocorlow 3:25e3289b0411 21 pc.printf("UniversalZero X : %f\r\n", gps.UniversalZeroPosition.x);
cocorlow 3:25e3289b0411 22 pc.printf("UniversalZero Y : %f\r\n", gps.UniversalZeroPosition.y);
cocorlow 3:25e3289b0411 23 pc.printf("UniversalZero Z : %f\r\n", gps.UniversalZeroPosition.z);
cocorlow 3:25e3289b0411 24 pc.printf("Universal X : %f\r\n", gps.UniversalPosition.x);
cocorlow 3:25e3289b0411 25 pc.printf("Universal Y : %f\r\n", gps.UniversalPosition.y);
cocorlow 3:25e3289b0411 26 pc.printf("Universal Z : %f\r\n", gps.UniversalPosition.z);
cocorlow 0:f7f81e36e9d7 27 }
cocorlow 0:f7f81e36e9d7 28
cocorlow 0:f7f81e36e9d7 29 int main()
cocorlow 0:f7f81e36e9d7 30 {
cocorlow 0:f7f81e36e9d7 31 pc.baud(115200);
cocorlow 1:020b393621e5 32 Ticker ticker;
cocorlow 1:020b393621e5 33 ticker.attach(&Display, 0.3);
cocorlow 1:020b393621e5 34 gps.CalcurateUnit();
cocorlow 1:020b393621e5 35
cocorlow 0:f7f81e36e9d7 36 while (1)
cocorlow 0:f7f81e36e9d7 37 {
cocorlow 1:020b393621e5 38 gps.Update();
cocorlow 0:f7f81e36e9d7 39 }
cocorlow 1:020b393621e5 40 }
cocorlow 1:020b393621e5 41
cocorlow 1:020b393621e5 42
cocorlow 1:020b393621e5 43 // GPS baud rate
cocorlow 1:020b393621e5 44 /*
cocorlow 1:020b393621e5 45 Serial gps(PC_12, PD_2);
cocorlow 1:020b393621e5 46 int main()
cocorlow 1:020b393621e5 47 {
cocorlow 1:020b393621e5 48 gps.baud(9600);
cocorlow 1:020b393621e5 49 while (1)
cocorlow 1:020b393621e5 50 {
cocorlow 1:020b393621e5 51 gps.printf("$PMTK251,57600*2C\r\n");
cocorlow 1:020b393621e5 52 }
cocorlow 1:020b393621e5 53 }
cocorlow 3:25e3289b0411 54
cocorlow 1:020b393621e5 55
cocorlow 1:020b393621e5 56 /*
cocorlow 1:020b393621e5 57 $PMTK251,115200*1F\r\n
cocorlow 1:020b393621e5 58 $PMTK251,57600*2C\r\n
cocorlow 1:020b393621e5 59 $PMTK251,9600*17\r\n
cocorlow 3:25e3289b0411 60 */
cocorlow 3:25e3289b0411 61
cocorlow 3:25e3289b0411 62 /*
cocorlow 3:25e3289b0411 63 Serial pc(USBTX, USBRX);
cocorlow 3:25e3289b0411 64 Serial gps(PC_12, PD_2);
cocorlow 3:25e3289b0411 65
cocorlow 3:25e3289b0411 66 void gps_receive()
cocorlow 3:25e3289b0411 67 {
cocorlow 3:25e3289b0411 68 while (gps.readable())
cocorlow 3:25e3289b0411 69 {
cocorlow 3:25e3289b0411 70 char c;
cocorlow 3:25e3289b0411 71 c = gps.getc();
cocorlow 3:25e3289b0411 72 pc.putc(c);
cocorlow 3:25e3289b0411 73 }
cocorlow 3:25e3289b0411 74 }
cocorlow 3:25e3289b0411 75
cocorlow 3:25e3289b0411 76 int main()
cocorlow 3:25e3289b0411 77 {
cocorlow 3:25e3289b0411 78 pc.baud(115200);
cocorlow 3:25e3289b0411 79 gps.baud(57600);
cocorlow 3:25e3289b0411 80 gps.attach(gps_receive, Serial::RxIrq);
cocorlow 3:25e3289b0411 81 while (1)
cocorlow 3:25e3289b0411 82 {
cocorlow 3:25e3289b0411 83 }
cocorlow 3:25e3289b0411 84 }
cocorlow 3:25e3289b0411 85 */
cocorlow 3:25e3289b0411 86 /*
cocorlow 3:25e3289b0411 87 $GPGLL,3542.8886,N,13945.7717,E,071533.000,A,A*58
cocorlow 3:25e3289b0411 88 $GPGSA,A,3,21,22,08,194,195,01,,,,,,,2.14,1.90,1.00*07
cocorlow 3:25e3289b0411 89 $GPGSV,4,1,14,195,85,343,35,01,79,276,33,21,69,028,29,194,59,191,33*73
cocorlow 3:25e3289b0411 90 $GPGSV,4,2,14,08,48,067,32,22,47,142,34,14,34,314,16,28,29,316,16*7C
cocorlow 3:25e3289b0411 91 $GPGSV,4,3,14,30,28,267,,07,23,224,,27,16,087,,10,03,033,*7C
cocorlow 3:25e3289b0411 92 $GPGSV,4,4,14,193,,,,38,,,*4C
cocorlow 3:25e3289b0411 93 $GPRMC,071533.000,A,3542.8886,N,13945.7717,E,0.10,53.89,080421,,,A*56
cocorlow 3:25e3289b0411 94 $GPVTG,53.89,T,,M,0.10,N,0.19,K,A*03
cocorlow 3:25e3289b0411 95 $GPZDA,071533.000,08,04,2021,,*58
cocorlow 3:25e3289b0411 96 $GPGGA,071534.000,3542.8886,N,13945.7717,E,1,6,1.90,95.8,M,39.3,M,,*69
cocorlow 3:25e3289b0411 97 $GPGLL,3542.8886,N,13945.7717,E,071534.000,A,A*5F
cocorlow 3:25e3289b0411 98 $GPGSA,A,3,21,22,08,194,195,01,,,,,,,2.14,1.90,1.00*07
cocorlow 3:25e3289b0411 99 $GPGSV,4,1,14,195,85,343,35,01,79,276,33,21,69,028,29,194,59,191,33*73
cocorlow 3:25e3289b0411 100 $GPGSV,4,2,14,08,48,067,32,22,47,142,34,14,34,314,16,28,29,316,16*7C
cocorlow 3:25e3289b0411 101 $GPGSV,4,3,14,30,28,267,,07,23,224,,27,16,087,,10,03,033,*7C
cocorlow 3:25e3289b0411 102 $GPGSV,4,4,14,193,,,,41,,,*42
cocorlow 1:020b393621e5 103 */