cube
Dependencies: BNO055_fusion_tom FastPWM mbed
Diff: main.cpp
- Revision:
- 13:e41d32a48931
- Parent:
- 10:69eb22acaea3
- Child:
- 14:90ac96893fcd
diff -r 69eb22acaea3 -r e41d32a48931 main.cpp --- a/main.cpp Sun Apr 09 19:56:14 2017 +0000 +++ b/main.cpp Mon Apr 10 20:27:02 2017 +0000 @@ -15,6 +15,7 @@ PwmOut P1(PE_9); DigitalOut EN1(D0); +AnalogIn I1(A0); //PwmOut P2(PE_11); 1D FOCUS FOR NOW //PwmOut P3(PE_13); @@ -38,6 +39,9 @@ void pwmupdate() { myled = !myled; + cur1 = I1.read(); // Converts and read the analog input value (value from 0.0 to 1.0) + cur1 = (cur1-2.0)*5000.0; // Change the value to be in the 0 to 3300 range + r1 = (Kbt*euler_angles.h*3.14/180.0); r1 = (r1 + 6.0)/12.0 ; //Normalize for PWM output