svoe

Dependencies:   mbed mbed-STM32F103C8T6 MPU6050_1

Revision:
3:8e8458f45d19
Parent:
1:e2a6e523bf1f
Child:
4:904b737ef08a
--- a/realtime.h	Sat May 06 19:27:01 2017 +0000
+++ b/realtime.h	Sun May 07 08:37:22 2017 +0000
@@ -1,8 +1,9 @@
 Ticker rt_ticker;
 float tm_speed;
 
-void realtime(){
+void realtime(){ //35uS - (3.5mS @ 115200) - (500uS @ 921600)
     //myled = !myled;
+    test = 1;
     
     current_path += (motor_speed[1]+motor_speed[0])/2*0.05;
     current_angle += (motor_speed[0]-motor_speed[1])*0.05/16*57.3;//deg
@@ -36,6 +37,7 @@
     gyro_process();
     echo_step(1);
     
+    test = 0;
     //pc.printf("%d \n", proc_counter); proc_counter = 0;
   }