svoe
Dependencies: mbed mbed-STM32F103C8T6 MPU6050_1
Diff: gyro.h
- Revision:
- 8:891e4f54e9e2
- Parent:
- 6:6e89cdc3db92
- Child:
- 9:8f98b1c277a4
--- a/gyro.h Sun May 21 12:04:00 2017 +0000 +++ b/gyro.h Fri Aug 18 08:53:15 2017 +0000 @@ -13,7 +13,7 @@ void gyro_process(){ // reading - 500 uS // doesn't work in interrupt gyro.read(&gx,&gy,&gz,&ax,&ay,&az); //wifi.printf("gx %.1f, gy %.1f, gz %.1f, ax %.2f, ay %.2f, az %.2f\n",gx,gy,gz,ax,ay,az); - //wifi.printf("ay:%.2f, ",ay); + wifi.printf("%.4f %.2f ",ay,gz); gyro_v -= 0.05*100*ay; //0.05 -> realtime_step //inertial_navigation gyro_s += 0.05*gyro_v;