![](/media/cache/group/default_image.jpg.50x50_q85.jpg)
GPS test
main.cpp@3:25e3289b0411, 2021-04-08 (annotated)
- 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?
User | Revision | Line number | New 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 | */ |