Takeuchi Kouichi
エレキジャックweb mbed入門 GPS 課題5です。GPS-GT720Fの60進数形式の緯度経度をGoogleマップなどのアプリケーションでよく使われる10進数形式に変換して表示します。
Diff: main.cpp
- Revision:
- 0:f3ff53b5b707
--- /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
+
+
+