Diff: main.cpp

Revision:

9:ca52462f9ebc

Parent:

8:63eff653d0ba

Child:

10:09dbd00164b9

--- a/main.cpp	Wed Apr 29 15:12:57 2015 +0000
+++ b/main.cpp	Tue May 05 09:07:11 2015 +0000
@@ -19,35 +19,6 @@
 Timer timer;
 Timer timer2;
 
-void initialize_connection(void);
- 
-void initialize_connection() 
-    {
-        RN42.putc('$'); // Enter command mode
-        RN42.putc('$'); //
-        RN42.putc('$'); //
-        wait(0.5);
-        RN42.putc('C'); //
-        RN42.putc(','); // Send MAC address
-        RN42.putc('0'); //
-        RN42.putc('0'); //
-        RN42.putc('0'); //
-        RN42.putc('6'); //
-        RN42.putc('6'); //
-        RN42.putc('6'); //
-        RN42.putc('A'); //
-        RN42.putc('0'); //
-        RN42.putc('4'); //
-        RN42.putc('E'); //
-        RN42.putc('1'); //
-        RN42.putc('A'); //
-        wait(0.5);
-        RN42.putc('-'); // Exit command mode
-        RN42.putc('-'); //
-        RN42.putc('-'); //
-        RN42.putc(0x0D); //
-        wait(0.5);
-    }
 
 
 char buffer[200];
@@ -86,6 +57,8 @@
         if(imu.getFifoCount() >= 48) {
             imu.getFifoBuffer(buffer,  48);
             led2 = !led2;
+            debug.printf("%d\r\n",timer2.read_ms());
+            timer2.reset();
         }
 
         if(timer.read_ms() > 50) {