test
Dependencies: GPS TextLCD mbed
Fork of GPS_classroom by
main.cpp
- Committer:
- fookies
- Date:
- 2015-05-23
- Revision:
- 2:8c0dcaa10883
- Parent:
- 1:326b1e0bbe56
- Child:
- 3:37086b58ab05
File content as of revision 2:8c0dcaa10883:
#include "mbed.h" #include "GPS.h" #include "TextLCD.h" GPS gps(PA_11,PA_12); I2C i2c_lcd(D14,D15); TextLCD_I2C lcd(&i2c_lcd, 0x4E, TextLCD::LCD16x2); Serial esp(D8,D2); uint8_t buffer[0x100]; uint16_t buffer_head; uint16_t buffer_tail; void rxcallback(void) { uint8_t chr; while (esp.readable()) { chr = esp.getc(); pc.putc(chr); buffer[buffer_head++] = chr; if (buffer_head == BUFFER_SIZE) { buffer_head = 0; } } } void flush_fifo(void) { while (esp.readable()) { (void)esp.getc(); } buffer_head = 0; buffer_tail = 0; } int find_response(const char *resp) { /* Give some delay for buffer to fill up */ wait_ms(10); int timeout = 0xFFFFFF; int len = strlen(resp); do { if (buffer_head > (buffer_tail + len)) { if (!memcmp(&buffer[buffer_tail], resp, len)) { flush_fifo(); return 0; } buffer_tail++; } }while(timeout--); flush_fifo(); return 1; } int main() { lcd.setMode(TextLCD::DispOn); lcd.setBacklight(TextLCD::LightOff); lcd.setCursor(TextLCD::CurOff_BlkOff); esp.attach(&rxcallback, Serial::RxIrq); lcd.setAddress(0,0); lcd.printf("Initial GPS...\n"); esp.printf("AT+RST\r\n"); while(1){ if(gps.sample()) { lcd.setAddress(0,1); lcd.printf("%6.3f,%7.3f",gps.latitude,gps.longitude); } wait(0.5); } }