Kenji Arai / Mbed OS Frequency_Cntr_1PPS_F746ZG

Frequency counter using GPS 1PPS signal and temperature controlled 50MHz Base clock. Ported from F411 Frequency Counter.

Dependencies:   QEI DRV8830 PID ADT7410 TextLCD Frq_cuntr_Nucleo-F746ZG RingBuffer

Fork of Frequency_Counter_w_GPS_1PPS by Kenji Arai

Please refer following.
/users/kenjiArai/notebook/frequency-counters/

GPS_rcvr/GPSrcvr.cpp@15:ae0413277bc6, 2019-12-22 (annotated)

Committer:
kenjiArai
Date:
Sun Dec 22 06:29:39 2019 +0000
Revision:
15:ae0413277bc6
Parent:
13:1041596c416c 
Update os5 -> 0s5.15.0

Who changed what in which revision?

UserRevisionLine numberNew contents of line
kenjiArai 13:1041596c416c 1 /*
kenjiArai 13:1041596c416c 2 * mbed Application program / GPS receiver control and 1PPS output
kenjiArai 13:1041596c416c 3 *
kenjiArai 13:1041596c416c 4 * Copyright (c) 2004,'09,'10,'16 Kenji Arai / JH1PJL
kenjiArai 13:1041596c416c 5 * http://www.page.sannet.ne.jp/kenjia/index.html
kenjiArai 13:1041596c416c 6 * http://mbed.org/users/kenjiArai/
kenjiArai 13:1041596c416c 7 * Created: March 28th, 2004 Kenji Arai
kenjiArai 13:1041596c416c 8 * updated: July 25th, 2009 for PIC24USB
kenjiArai 13:1041596c416c 9 * updated: January 16th, 2010 change to GPS-GM318
kenjiArai 13:1041596c416c 10 * updated: April 24th, 2010 for mbed / NXP LPC1768
kenjiArai 15:ae0413277bc6 11 * Revised: Nomeber 22nd, 2016
kenjiArai 13:1041596c416c 12 */
kenjiArai 13:1041596c416c 13
kenjiArai 13:1041596c416c 14 // Include --------------------------------------------------------------------
kenjiArai 13:1041596c416c 15 #include <string.h>
kenjiArai 13:1041596c416c 16 #include "mbed.h"
kenjiArai 13:1041596c416c 17 #include "RingBuffer.h"
kenjiArai 13:1041596c416c 18 #include "GPSrcvr.h"
kenjiArai 13:1041596c416c 19
kenjiArai 13:1041596c416c 20 // Definition -----------------------------------------------------------------
kenjiArai 13:1041596c416c 21 //#define USE_DEBUG
kenjiArai 13:1041596c416c 22
kenjiArai 13:1041596c416c 23 #ifdef USE_DEBUG
kenjiArai 13:1041596c416c 24 #define U_DEBUGBAUD(x) pc.baud(x)
kenjiArai 13:1041596c416c 25 #define U_DEBUG(...) pc.printf(__VA_ARGS__)
kenjiArai 13:1041596c416c 26 #define DBG(c) pc.putc(c)
kenjiArai 13:1041596c416c 27 #else
kenjiArai 13:1041596c416c 28 #define U_DEBUGBAUD(x) {;}
kenjiArai 13:1041596c416c 29 #define U_DEBUG(...) {;}
kenjiArai 13:1041596c416c 30 #define DBG(c) {;}
kenjiArai 13:1041596c416c 31 #endif
kenjiArai 13:1041596c416c 32
kenjiArai 13:1041596c416c 33 #define GSP_BUF_B (128 * 3)
kenjiArai 13:1041596c416c 34 #define GPS_BUF_S (128 * 2)
kenjiArai 13:1041596c416c 35
kenjiArai 13:1041596c416c 36 // Object ---------------------------------------------------------------------
kenjiArai 13:1041596c416c 37 DigitalIn gps_rx(PD_2); // for checking GPS RX line
kenjiArai 15:ae0413277bc6 38 Serial gps(PC_12, PD_2); // GPS Data receive
kenjiArai 13:1041596c416c 39 RingBuffer rxbuf(1024); // can receive all information every one sec
kenjiArai 13:1041596c416c 40
kenjiArai 13:1041596c416c 41 extern Serial pc;
kenjiArai 13:1041596c416c 42
kenjiArai 13:1041596c416c 43 // RAM ------------------------------------------------------------------------
kenjiArai 13:1041596c416c 44 bool gps_is_okay_flag;
kenjiArai 13:1041596c416c 45 uint8_t gps_ready;
kenjiArai 13:1041596c416c 46 uint8_t gps_status;
kenjiArai 13:1041596c416c 47 uint8_t gps_rmc_ready;
kenjiArai 13:1041596c416c 48 char GPS_Buffer[GSP_BUF_B]; //GPS data buffer
kenjiArai 13:1041596c416c 49 char MsgBuf_RMC[GPS_BUF_S];
kenjiArai 13:1041596c416c 50 char MsgBuf_GSA[GPS_BUF_S];
kenjiArai 13:1041596c416c 51 char MsgBuf_GGA[GPS_BUF_S];
kenjiArai 13:1041596c416c 52
kenjiArai 13:1041596c416c 53 // Function prototypes --------------------------------------------------------
kenjiArai 13:1041596c416c 54 uint8_t check_gps_3d(void);
kenjiArai 13:1041596c416c 55 uint8_t check_gps_ready(void);
kenjiArai 13:1041596c416c 56 void get_time_and_date(struct tm *pt);
kenjiArai 13:1041596c416c 57 void getline_gps(void);
kenjiArai 13:1041596c416c 58 void gps_data_rcv(void);
kenjiArai 13:1041596c416c 59 void iGPSrcv_initialize(void);
kenjiArai 13:1041596c416c 60 int iGPS_readable(void);
kenjiArai 13:1041596c416c 61 int iGPS_getc(void);
kenjiArai 13:1041596c416c 62
kenjiArai 13:1041596c416c 63 ////////////////////////////////////////////////////////////////////////////////
kenjiArai 13:1041596c416c 64 // Receive GPS data using Interrupt handler
kenjiArai 13:1041596c416c 65 //
kenjiArai 13:1041596c416c 66 // !!! Takes urgent and dirty solution by due to IRQ restriction
kenjiArai 13:1041596c416c 67 // on mbed library (reason is unknown as of today)
kenjiArai 13:1041596c416c 68 // reference source file:stm32f746xx.h
kenjiArai 13:1041596c416c 69 // under /mbed-dev/targets/cmsis/TARGET_STM/TARGET_NUCLEO_F746ZG
kenjiArai 13:1041596c416c 70 ////////////////////////////////////////////////////////////////////////////////
kenjiArai 13:1041596c416c 71 // ------ Interrupt Function ------
kenjiArai 13:1041596c416c 72 void rx_handler(void)
kenjiArai 13:1041596c416c 73 {
kenjiArai 13:1041596c416c 74 uint32_t reg = UART5->ISR;
kenjiArai 13:1041596c416c 75 if (reg && USART_ISR_RXNE){ // data is ready to read
kenjiArai 13:1041596c416c 76 UART5->ISR &= ~(USART_ISR_RXNE + USART_ISR_PE + USART_ISR_FE
kenjiArai 13:1041596c416c 77 + USART_ISR_NE + USART_ISR_ORE);
kenjiArai 13:1041596c416c 78 rxbuf.save((unsigned char)UART5->RDR);
kenjiArai 13:1041596c416c 79 }
kenjiArai 13:1041596c416c 80 }
kenjiArai 13:1041596c416c 81
kenjiArai 13:1041596c416c 82 void iGPSrcv_initialize(void)
kenjiArai 13:1041596c416c 83 {
kenjiArai 13:1041596c416c 84 __disable_irq();
kenjiArai 13:1041596c416c 85 UART5->CR1 &= ~(USART_CR1_TE + USART_CR1_TCIE + USART_CR1_TXEIE
kenjiArai 13:1041596c416c 86 + USART_CR1_PEIE + USART_CR1_IDLEIE);
kenjiArai 13:1041596c416c 87 UART5->CR1 |= (USART_CR1_RXNEIE + USART_CR1_RE + USART_CR1_UE);
kenjiArai 13:1041596c416c 88 NVIC_SetVector(UART5_IRQn, (uint32_t)rx_handler);
kenjiArai 13:1041596c416c 89 NVIC_ClearPendingIRQ(UART5_IRQn);
kenjiArai 13:1041596c416c 90 NVIC_EnableIRQ(UART5_IRQn);
kenjiArai 13:1041596c416c 91 __enable_irq();
kenjiArai 13:1041596c416c 92 #if 0
kenjiArai 13:1041596c416c 93 printf("UART5->CR1 0x%08x:0x%08x\r\n", &UART5->CR1, UART5->CR1);
kenjiArai 13:1041596c416c 94 printf("UART5->CR2 0x%08x:0x%08x\r\n", &UART5->CR2, UART5->CR2);
kenjiArai 13:1041596c416c 95 printf("UART5->CR3 0x%08x:0x%08x\r\n", &UART5->CR3, UART5->CR3);
kenjiArai 13:1041596c416c 96 printf("UART5->BRR 0x%08x:0x%08x\r\n", &UART5->BRR, UART5->BRR);
kenjiArai 13:1041596c416c 97 printf("UART5->GTPR 0x%08x:0x%08x\r\n", &UART5->GTPR, UART5->GTPR);
kenjiArai 13:1041596c416c 98 printf("UART5->RTOR 0x%08x:0x%08x\r\n", &UART5->RTOR, UART5->RTOR);
kenjiArai 13:1041596c416c 99 printf("UART5->RQR 0x%08x:0x%08x\r\n", &UART5->RQR, UART5->RQR);
kenjiArai 13:1041596c416c 100 printf("UART5->ISR 0x%08x:0x%08x\r\n", &UART5->ISR, UART5->ISR);
kenjiArai 13:1041596c416c 101 printf("UART5->ICR 0x%08x:0x%08x\r\n", &UART5->ICR, UART5->ICR);
kenjiArai 13:1041596c416c 102 #endif
kenjiArai 13:1041596c416c 103 }
kenjiArai 13:1041596c416c 104
kenjiArai 13:1041596c416c 105 int iGPS_readable(void)
kenjiArai 13:1041596c416c 106 {
kenjiArai 13:1041596c416c 107 return rxbuf.check();
kenjiArai 13:1041596c416c 108 }
kenjiArai 13:1041596c416c 109
kenjiArai 13:1041596c416c 110 int iGPS_getc(void)
kenjiArai 13:1041596c416c 111 {
kenjiArai 13:1041596c416c 112 while(!rxbuf.check()){;} // wait receiving a character
kenjiArai 13:1041596c416c 113 return rxbuf.read();
kenjiArai 13:1041596c416c 114 }
kenjiArai 13:1041596c416c 115
kenjiArai 13:1041596c416c 116 ////////////////////////////////////////////////////////////////////////////////
kenjiArai 13:1041596c416c 117 // Parse GPS data
kenjiArai 13:1041596c416c 118 // Module Type: u-blux7 NEO-7M
kenjiArai 13:1041596c416c 119 ////////////////////////////////////////////////////////////////////////////////
kenjiArai 13:1041596c416c 120 // Get RMC & GAA data
kenjiArai 13:1041596c416c 121 void gps_data_rcv(void)
kenjiArai 13:1041596c416c 122 {
kenjiArai 13:1041596c416c 123 int8_t i;
kenjiArai 13:1041596c416c 124 time_t old_ave_sec[2];
kenjiArai 13:1041596c416c 125 uint32_t diff = 0;
kenjiArai 13:1041596c416c 126 time_t seconds;
kenjiArai 13:1041596c416c 127 struct tm t_gps;
kenjiArai 13:1041596c416c 128
kenjiArai 13:1041596c416c 129 seconds = time(NULL);
kenjiArai 13:1041596c416c 130 U_DEBUG("\r\nCurrent Time: %s\r\n", ctime(&seconds));
kenjiArai 13:1041596c416c 131 old_ave_sec[0] = 0;
kenjiArai 13:1041596c416c 132 old_ave_sec[1] = 0;
kenjiArai 13:1041596c416c 133 // Wait long interval (every 1sec)
kenjiArai 13:1041596c416c 134 for (uint32_t i = 0; i < 100000; i++){
kenjiArai 13:1041596c416c 135 if (gps_rx == 0){
kenjiArai 13:1041596c416c 136 i = 0;
kenjiArai 13:1041596c416c 137 }
kenjiArai 13:1041596c416c 138 }
kenjiArai 13:1041596c416c 139 U_DEBUG("GPS line is Hi\r\n");
kenjiArai 13:1041596c416c 140 // Clear GPS RX line errors(over run)
kenjiArai 13:1041596c416c 141 UART5->ICR = 0;
kenjiArai 13:1041596c416c 142 UART5->CR1 = 0;
kenjiArai 13:1041596c416c 143 UART5->CR1 = 5;
kenjiArai 13:1041596c416c 144 iGPSrcv_initialize();
kenjiArai 13:1041596c416c 145 U_DEBUG("Start GPS!!");
kenjiArai 13:1041596c416c 146 gps_is_okay_flag = false;
kenjiArai 13:1041596c416c 147 while(true) {
kenjiArai 13:1041596c416c 148 getline_gps(); // Get GPS data from UART
kenjiArai 13:1041596c416c 149 if (strncmp(GPS_Buffer, "$GPRMC",6) == 0) {
kenjiArai 13:1041596c416c 150 for (i=0; GPS_Buffer[i] != 0; i++) {// Copy msg to RMC buffer
kenjiArai 13:1041596c416c 151 MsgBuf_RMC[i] = GPS_Buffer[i];
kenjiArai 13:1041596c416c 152 }
kenjiArai 13:1041596c416c 153 MsgBuf_RMC[i+1] = 0;
kenjiArai 13:1041596c416c 154 #if 0
kenjiArai 13:1041596c416c 155 U_DEBUG("Get GPRMC\r\n");
kenjiArai 13:1041596c416c 156 #else
kenjiArai 13:1041596c416c 157 if (gps_is_okay_flag == false){
kenjiArai 13:1041596c416c 158 pc.printf("GPRMC,");
kenjiArai 13:1041596c416c 159 }
kenjiArai 13:1041596c416c 160 #endif
kenjiArai 13:1041596c416c 161 if (gps_ready == 3) {
kenjiArai 13:1041596c416c 162 U_DEBUG("3D condition\r\n");
kenjiArai 13:1041596c416c 163 get_time_and_date(&t_gps);
kenjiArai 13:1041596c416c 164 seconds = mktime(&t_gps);
kenjiArai 13:1041596c416c 165 if (old_ave_sec[0] == 0){
kenjiArai 13:1041596c416c 166 old_ave_sec[0] = seconds;
kenjiArai 13:1041596c416c 167 } else if (old_ave_sec[1] == 0){
kenjiArai 13:1041596c416c 168 old_ave_sec[1] = seconds;
kenjiArai 13:1041596c416c 169 } else {
kenjiArai 13:1041596c416c 170 if (old_ave_sec[0] >= old_ave_sec[1]){
kenjiArai 13:1041596c416c 171 diff = old_ave_sec[0] - old_ave_sec[1];
kenjiArai 13:1041596c416c 172 } else {
kenjiArai 13:1041596c416c 173 diff = old_ave_sec[1] - old_ave_sec[0];
kenjiArai 13:1041596c416c 174 }
kenjiArai 13:1041596c416c 175 if (diff > 100 ){
kenjiArai 13:1041596c416c 176 old_ave_sec[0] = seconds;
kenjiArai 13:1041596c416c 177 old_ave_sec[1] = 0;
kenjiArai 13:1041596c416c 178 } else {
kenjiArai 13:1041596c416c 179 if (old_ave_sec[0] > old_ave_sec[1]){
kenjiArai 13:1041596c416c 180 diff = seconds - old_ave_sec[0];
kenjiArai 13:1041596c416c 181 if (diff < 100){
kenjiArai 13:1041596c416c 182 old_ave_sec[1] = seconds;
kenjiArai 13:1041596c416c 183 }
kenjiArai 13:1041596c416c 184 } else {
kenjiArai 13:1041596c416c 185 diff = seconds - old_ave_sec[1];
kenjiArai 13:1041596c416c 186 if (diff < 100){
kenjiArai 13:1041596c416c 187 old_ave_sec[0] = seconds;
kenjiArai 13:1041596c416c 188 }
kenjiArai 13:1041596c416c 189 }
kenjiArai 13:1041596c416c 190 set_time(seconds);
kenjiArai 13:1041596c416c 191 U_DEBUG("Set time and GPS is okay!\r\n");
kenjiArai 13:1041596c416c 192 gps_is_okay_flag = true;
kenjiArai 13:1041596c416c 193 }
kenjiArai 13:1041596c416c 194 }
kenjiArai 13:1041596c416c 195 }
kenjiArai 13:1041596c416c 196 } else if (strncmp(GPS_Buffer, "$GPGSA",6) == 0) {
kenjiArai 13:1041596c416c 197 for (i=0; GPS_Buffer[i] != 0; i++) {// Copy msg to GSA buffer
kenjiArai 13:1041596c416c 198 MsgBuf_GSA[i] = GPS_Buffer[i];
kenjiArai 13:1041596c416c 199 }
kenjiArai 13:1041596c416c 200 MsgBuf_GSA[i+1] = 0;
kenjiArai 13:1041596c416c 201 gps_ready = check_gps_3d();
kenjiArai 13:1041596c416c 202 #if 0
kenjiArai 13:1041596c416c 203 U_DEBUG("Get GPGSA\r\n");
kenjiArai 13:1041596c416c 204 #else
kenjiArai 13:1041596c416c 205 if (gps_is_okay_flag == false){
kenjiArai 13:1041596c416c 206 pc.printf("GPGSA,");
kenjiArai 13:1041596c416c 207 }
kenjiArai 13:1041596c416c 208 #endif
kenjiArai 13:1041596c416c 209 } else if (strncmp(GPS_Buffer, "$GPGGA",6) == 0) {
kenjiArai 13:1041596c416c 210 for (i=0; GPS_Buffer[i] != 0; i++) {// Copy msg to GGA buffer
kenjiArai 13:1041596c416c 211 MsgBuf_GGA[i] = GPS_Buffer[i];
kenjiArai 13:1041596c416c 212 }
kenjiArai 13:1041596c416c 213 MsgBuf_GGA[i+1] = 0;
kenjiArai 13:1041596c416c 214 gps_status = check_gps_ready();
kenjiArai 13:1041596c416c 215 #if 0
kenjiArai 13:1041596c416c 216 U_DEBUG("Get GPGGA\r\n");
kenjiArai 13:1041596c416c 217 #else
kenjiArai 13:1041596c416c 218 if (gps_is_okay_flag == false){
kenjiArai 13:1041596c416c 219 pc.printf("GPGGA,");
kenjiArai 13:1041596c416c 220 }
kenjiArai 13:1041596c416c 221 #endif
kenjiArai 13:1041596c416c 222 }
kenjiArai 13:1041596c416c 223 }
kenjiArai 13:1041596c416c 224 }
kenjiArai 13:1041596c416c 225
kenjiArai 13:1041596c416c 226 bool check_gps_is_okay()
kenjiArai 13:1041596c416c 227 {
kenjiArai 13:1041596c416c 228 return gps_is_okay_flag;
kenjiArai 13:1041596c416c 229 }
kenjiArai 13:1041596c416c 230
kenjiArai 13:1041596c416c 231 // Get line of data from GPS
kenjiArai 13:1041596c416c 232 void getline_gps(void)
kenjiArai 13:1041596c416c 233 {
kenjiArai 13:1041596c416c 234 char *p = GPS_Buffer;
kenjiArai 13:1041596c416c 235
kenjiArai 13:1041596c416c 236 #if 1
kenjiArai 13:1041596c416c 237 while (iGPS_getc() != '$'){;}
kenjiArai 13:1041596c416c 238 #else
kenjiArai 13:1041596c416c 239 while (iGPS_getc() != '$') {
kenjiArai 13:1041596c416c 240 Thread::yield();
kenjiArai 13:1041596c416c 241 }
kenjiArai 13:1041596c416c 242 #endif
kenjiArai 13:1041596c416c 243 *p++ = '$';
kenjiArai 13:1041596c416c 244 #if 1
kenjiArai 13:1041596c416c 245 U_DEBUG("\r\n");
kenjiArai 13:1041596c416c 246 #else
kenjiArai 13:1041596c416c 247 pc.printf("\r\n");
kenjiArai 13:1041596c416c 248 #endif
kenjiArai 13:1041596c416c 249 for (char i= 0;i < 150;i++){
kenjiArai 13:1041596c416c 250 *p = iGPS_getc();
kenjiArai 13:1041596c416c 251 #if 1
kenjiArai 13:1041596c416c 252 DBG(*p);
kenjiArai 13:1041596c416c 253 #else
kenjiArai 13:1041596c416c 254 pc.putc(*p);
kenjiArai 13:1041596c416c 255 #endif
kenjiArai 13:1041596c416c 256 if (*p == '\r'){
kenjiArai 13:1041596c416c 257 *++p = '\n';
kenjiArai 13:1041596c416c 258 *++p = 0;
kenjiArai 13:1041596c416c 259 *++p = 0;
kenjiArai 13:1041596c416c 260 U_DEBUG("Get one GPS data\r\n");
kenjiArai 13:1041596c416c 261 return;
kenjiArai 13:1041596c416c 262 } else {
kenjiArai 13:1041596c416c 263 p++;
kenjiArai 13:1041596c416c 264 }
kenjiArai 13:1041596c416c 265 }
kenjiArai 13:1041596c416c 266 *++p = 0;
kenjiArai 13:1041596c416c 267 *++p = 0;
kenjiArai 13:1041596c416c 268 }
kenjiArai 13:1041596c416c 269
kenjiArai 13:1041596c416c 270 // ASCII to hex
kenjiArai 13:1041596c416c 271 uint8_t hex(char c){
kenjiArai 13:1041596c416c 272 if(c<= '/') return( ERR );
kenjiArai 13:1041596c416c 273 if(((c -= '0')<= 9 || 10 <= ( c -= 'A' - '0' - 10)) && c <= 15) {
kenjiArai 13:1041596c416c 274 return((uint8_t)c);
kenjiArai 13:1041596c416c 275 }
kenjiArai 13:1041596c416c 276 return(ERR);
kenjiArai 13:1041596c416c 277 }
kenjiArai 13:1041596c416c 278
kenjiArai 13:1041596c416c 279 // Search next ',' (comma)
kenjiArai 13:1041596c416c 280 char *next_comma( char *p ){
kenjiArai 13:1041596c416c 281 while (1) {
kenjiArai 13:1041596c416c 282 if ( *p== ',' ) {
kenjiArai 13:1041596c416c 283 return ++p;
kenjiArai 13:1041596c416c 284 } else if ( *p == 0 ) {
kenjiArai 13:1041596c416c 285 return (char*)-1;
kenjiArai 13:1041596c416c 286 } else {
kenjiArai 13:1041596c416c 287 p++;
kenjiArai 13:1041596c416c 288 }
kenjiArai 13:1041596c416c 289 }
kenjiArai 13:1041596c416c 290 }
kenjiArai 13:1041596c416c 291
kenjiArai 13:1041596c416c 292 // 2 digits ASCII char to one byte hex
kenjiArai 13:1041596c416c 293 unsigned char change_acii_hex( char*p ){
kenjiArai 13:1041596c416c 294 unsigned char c;
kenjiArai 13:1041596c416c 295
kenjiArai 13:1041596c416c 296 c = hex(*p++); /* No concern ERR condition! */
kenjiArai 13:1041596c416c 297 c = (c * 10) + hex(*p++);
kenjiArai 13:1041596c416c 298 return c;
kenjiArai 13:1041596c416c 299 }
kenjiArai 13:1041596c416c 300
kenjiArai 13:1041596c416c 301 // Skip number of comma
kenjiArai 13:1041596c416c 302 char *num_of_comma( char *p, int8_t n ){
kenjiArai 13:1041596c416c 303 for (; n> 0; n--) {
kenjiArai 13:1041596c416c 304 if ( (p = next_comma(p)) == (char*) -1 ) {
kenjiArai 13:1041596c416c 305 return (char*)-1;
kenjiArai 13:1041596c416c 306 }
kenjiArai 13:1041596c416c 307 }
kenjiArai 13:1041596c416c 308 return p;
kenjiArai 13:1041596c416c 309 }
kenjiArai 13:1041596c416c 310
kenjiArai 13:1041596c416c 311 // Get GPS status (1=Not fix, 2=2D, 3=3D)
kenjiArai 13:1041596c416c 312 uint8_t check_gps_3d(void){
kenjiArai 13:1041596c416c 313 char *p;
kenjiArai 13:1041596c416c 314 uint8_t x;
kenjiArai 13:1041596c416c 315 uint8_t d;
kenjiArai 13:1041596c416c 316
kenjiArai 13:1041596c416c 317 // pick-up time
kenjiArai 13:1041596c416c 318 p = MsgBuf_GSA;
kenjiArai 13:1041596c416c 319 p = num_of_comma(p,1); // skip ','
kenjiArai 13:1041596c416c 320 // reach to "Position Fix Indicator"
kenjiArai 13:1041596c416c 321 if (*p == 'A') {
kenjiArai 13:1041596c416c 322 ++p; //','
kenjiArai 13:1041596c416c 323 ++p; // 1 or 2 or 3
kenjiArai 13:1041596c416c 324 d = hex(*p++);
kenjiArai 13:1041596c416c 325 if (d != ERR) {
kenjiArai 13:1041596c416c 326 x = d;
kenjiArai 13:1041596c416c 327 } else {
kenjiArai 13:1041596c416c 328 x = 1;
kenjiArai 13:1041596c416c 329 }
kenjiArai 13:1041596c416c 330 } else {
kenjiArai 13:1041596c416c 331 x = 1;
kenjiArai 13:1041596c416c 332 }
kenjiArai 13:1041596c416c 333 return x;
kenjiArai 13:1041596c416c 334 }
kenjiArai 13:1041596c416c 335
kenjiArai 13:1041596c416c 336 // Get GPS status and number of satelites
kenjiArai 13:1041596c416c 337 uint8_t check_gps_ready(void){
kenjiArai 13:1041596c416c 338 char *p;
kenjiArai 13:1041596c416c 339 uint8_t x;
kenjiArai 13:1041596c416c 340 uint8_t d;
kenjiArai 13:1041596c416c 341
kenjiArai 13:1041596c416c 342 // pick-up time
kenjiArai 13:1041596c416c 343 p = MsgBuf_GGA;
kenjiArai 13:1041596c416c 344 p = num_of_comma(p,6); // skip ','
kenjiArai 13:1041596c416c 345 // reach to "Position Fix Indicator"
kenjiArai 13:1041596c416c 346 if (*p == '1' || *p == '2') {
kenjiArai 13:1041596c416c 347 ++p; //','
kenjiArai 13:1041596c416c 348 ++p; // Number
kenjiArai 13:1041596c416c 349 d = hex(*p++);
kenjiArai 13:1041596c416c 350 if (d != ERR) {
kenjiArai 13:1041596c416c 351 x = d * 10;
kenjiArai 13:1041596c416c 352 x += (uint32_t)hex(*p++);
kenjiArai 13:1041596c416c 353 if (*p != ',') {
kenjiArai 13:1041596c416c 354 x = 0;
kenjiArai 13:1041596c416c 355 }
kenjiArai 13:1041596c416c 356 } else {
kenjiArai 13:1041596c416c 357 x = 0;
kenjiArai 13:1041596c416c 358 }
kenjiArai 13:1041596c416c 359 } else {
kenjiArai 13:1041596c416c 360 x = 0;
kenjiArai 13:1041596c416c 361 }
kenjiArai 13:1041596c416c 362 return x;
kenjiArai 13:1041596c416c 363 }
kenjiArai 13:1041596c416c 364
kenjiArai 13:1041596c416c 365 // Get time(UTC) from GPS data
kenjiArai 13:1041596c416c 366 void get_time_and_date(struct tm *pt){
kenjiArai 13:1041596c416c 367 char *p;
kenjiArai 13:1041596c416c 368
kenjiArai 13:1041596c416c 369 p = MsgBuf_RMC;
kenjiArai 13:1041596c416c 370 p = num_of_comma(p,1); /* skip one ',' */
kenjiArai 13:1041596c416c 371 pt->tm_hour = change_acii_hex(p);
kenjiArai 13:1041596c416c 372 p += 2;
kenjiArai 13:1041596c416c 373 pt->tm_min = change_acii_hex(p);
kenjiArai 13:1041596c416c 374 p += 2;
kenjiArai 13:1041596c416c 375 pt->tm_sec = change_acii_hex(p);
kenjiArai 13:1041596c416c 376 p = MsgBuf_RMC;
kenjiArai 13:1041596c416c 377 p = num_of_comma(p,9); /* skip one ',' */
kenjiArai 13:1041596c416c 378 pt->tm_mday = change_acii_hex(p);
kenjiArai 13:1041596c416c 379 p += 2;
kenjiArai 13:1041596c416c 380 pt->tm_mon = change_acii_hex(p) - 1;
kenjiArai 13:1041596c416c 381 p += 2;
kenjiArai 13:1041596c416c 382 pt->tm_year = change_acii_hex(p) + 100;
kenjiArai 13:1041596c416c 383 }
kenjiArai 13:1041596c416c 384