cube
Dependencies: BNO055_fusion_tom FastPWM mbed
Diff: main.cpp
- Revision:
- 34:2cdc880e4c29
- Parent:
- 33:2434fd576d34
- Child:
- 35:34a62f118eb0
diff -r 2434fd576d34 -r 2cdc880e4c29 main.cpp --- a/main.cpp Sat Apr 22 19:50:21 2017 +0000 +++ b/main.cpp Sat Apr 22 20:23:21 2017 +0000 @@ -26,10 +26,10 @@ BNO055_ID_INF_TypeDef bno055_id_inf; BNO055_EULER_TypeDef euler_angles; BNO055_VEL_TypeDef velocity; - //LQR 500 //LQR 1000 //Pole Placement -double Kbt = -83.4030; //-77.7950; //-67.5155; -double Kbv = -10.5874; //-9.8654; //-9.3610; -double Kwv = -0.00468; //-0.00337; //-0.0082; + //LQR2000 //LQR 500 //LQR 1000 //Pole P +double Kbt = -73.8411; //-83.4030; //-77.7950; //-67.5155; +double Kbv = -9.3563; //-10.5874; //-9.8654; //-9.3610; +double Kwv = -0.00244; //-0.00468; //-0.00337; //-0.0082; double speed; double wv; double bt;