Diff: main.cpp

Revision:

2:7eb11afe02bd

Parent:

1:d1bb695fe3bc

diff -r d1bb695fe3bc -r 7eb11afe02bd main.cpp
--- a/main.cpp	Sat Dec 18 17:45:25 2010 +0000
+++ b/main.cpp	Sun Dec 19 09:11:48 2010 +0000
@@ -155,6 +155,7 @@
     { 0xFF ,NULL,"****UNKNOWN****"}
 };
 
+unsigned char Skytraq_System_Restart[] = {0x01,0x01};
 unsigned char Skytraq_QUERY_SOFTWARE_VERSION[] = {0x02,0x01};
 unsigned char Skytraq_set_rate[] = {
     0x12,   /* ID */
@@ -304,8 +305,6 @@
 
     logFile_Init();
 
-    lcd.cls();
-
     gps.format(8,Serial::None,1);
     gps.baud(115200);
     gps.recvStart();
@@ -314,12 +313,22 @@
 #ifdef OUTPUT_RATE_1HZ
     Skytraq_set_rate[1] = 0x00;
 #endif
+    lcd.locate(0,1);
+    lcd.printf("S1315F Restart");
+    Skytraq_bin_send(sizeof(Skytraq_System_Restart),Skytraq_System_Restart);
+    
+    wait(1.0);
+
+    lcd.locate(0,1);
+    lcd.printf("S1315F Configure");
+
     Skytraq_bin_send(sizeof(Skytraq_set_rate),Skytraq_set_rate);
-
     //Skytraq_bin_send(sizeof(Skytraq_QUERY_SOFTWARE_VERSION),Skytraq_QUERY_SOFTWARE_VERSION);
 
     timer.attach_us(timer_handler,1000*50);
 
+    lcd.cls();
+
     while(1) {
         if(do_disp){
             do_disp = 0;