Takeuchi Kouichi
/
2bk0123_GPS_Test05
エレキジャックweb mbed入門 GPS 課題5です。GPS-GT720Fの60進数形式の緯度経度をGoogleマップなどのアプリケーションでよく使われる10進数形式に変換して表示します。
Diff: main.cpp
- Revision:
- 0:f3ff53b5b707
diff -r 000000000000 -r f3ff53b5b707 main.cpp --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/main.cpp Wed Feb 02 06:03:53 2011 +0000 @@ -0,0 +1,88 @@ +//GPS GT-720F Test05 +#include "mbed.h" +#include "TextLCD0420.h" + +#define ON 1 +#define OFF 0 + +DigitalOut mled0(LED1); +DigitalOut mled1(LED2); + +TextLCD lcd(p24, p25, p26, p27, p28, p29, p30,20,4); // rs, rw, e, d0, d1, d2, d3 +Serial gps(p9,p10); + +int main() { + + char c; + int i,rlock,stn; + char gps_data[256]; + char ns,ew; + float time,hokui,tokei; + float g_hokui,g_tokei; + float d_hokui,m_hokui,d_tokei,m_tokei; + + gps.baud(9600); + lcd.cls(); + lcd.locate(0,0); + lcd.printf("*** GPS GT-720F ***"); + + while (1) { + i=0; + while(gps.getc()!='$'){ + } + + while( (gps_data[i]=gps.getc()) != '\r'){ + i++; + if(i==256){ + lcd.printf("*** Data read Error! ***\n"); + i=255; + break; + } + } + gps_data[i]='\0'; + + //test + /* Test data + rlock=1; + hokui=3532.25024; //=>35.537502 + tokei=13751.86820;//=>137.864471 + */ + if( sscanf(gps_data, "GPGGA,%f,%f,%c,%f,%c,%d,%d",&time,&hokui,&ns,&tokei,&ew,&rlock,&stn) >= 1){ + if(rlock >= 1){ + //hokui + d_hokui=int(hokui/100); + m_hokui=(hokui-d_hokui*100)/60; + g_hokui=d_hokui+m_hokui; + //tokei + d_tokei=int(tokei/100); + m_tokei=(tokei-d_tokei*100)/60; + g_tokei=d_tokei+m_tokei; + //g_hokui=int(hokui/100)+(hokui-int(hokui/100))/60; + //g_tokei=int(tokei/100)+(tokei-int(tokei/100))/60; + + lcd.cls(); + lcd.locate(0,0); + lcd.printf("*** GPS GT-720F ***"); + lcd.locate(0,1); + lcd.printf("Lock(%d),Stn(%d)",rlock,stn); + //Latitude=Hokui + lcd.locate(0,2); + lcd.printf("Lat/dd:%4.6f",g_hokui); + // Logitude=tokei + lcd.locate(0,3); + lcd.printf("Log/dd:%4.6f",g_tokei); + } + else{ + lcd.locate(0,1); + lcd.printf("Lock(%d),Stn(%d)",rlock,stn); + lcd.locate(0,2); + for(i=0;i<40;i++){ + lcd.printf("%c",gps_data[i]); + } + } + }//if + }//while +}//main + + +