first publish
Dependencies: MPU9150_DMP MotorControl QuaternionMath SimpleIOMacros mbed
Fork of cool_step by
Diff: main.cpp
- Revision:
- 9:ca52462f9ebc
- Parent:
- 8:63eff653d0ba
- Child:
- 10:09dbd00164b9
diff -r 63eff653d0ba -r ca52462f9ebc main.cpp --- 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) {