![](/media/cache/img/default_profile.jpg.50x50_q85.jpg)
Servo
Dependencies: mbed MODSERIAL Servo FastPWM
Diff: main.cpp
- Revision:
- 13:1a014f5b01df
- Parent:
- 12:515bacd56d07
--- a/main.cpp Tue Oct 29 11:00:26 2019 +0000 +++ b/main.cpp Fri Nov 01 12:37:44 2019 +0000 @@ -18,7 +18,7 @@ void servo() { - double theta_s= 500; // dit zijn allemaal waarden tussen de 500-2400 + double theta_s= 1300; // dit zijn allemaal waarden tussen de 500-2400 double theta_sout; // dit zijn allemaal waarden tussen de 500-2400 double q1=0; // 0.2*M_PI; // dit is in rad uit I.K double q2=0; //0.5*M_PI; // dit is in rad uit I.K @@ -41,6 +41,7 @@ mijnServo.SetPosition(theta_sout); pc.printf("De servo staat op %f graden. in de klapstand\n\r", theta_sout); } + else { theta_sout=theta_s-q1_ser+q2_ser;