![](/media/cache/img/default_profile.jpg.50x50_q85.jpg)
3 button servo control for HS422 with mbed
main.cpp
- Committer:
- asloop18
- Date:
- 2016-01-08
- Revision:
- 1:a00c2b3c73e8
- Parent:
- 0:c21f0ed70bcd
File content as of revision 1:a00c2b3c73e8:
/* Servo controller mini-project. Three button control for HS422 servo, left 10*, right 10*, reset to center. Austin Sloop, 1/7/16 */ #include "mbed.h" DigitalIn right(p5); //Right button, CW DigitalIn left(p9); //Left button, CCW DigitalIn reset(p7); //Middle button, reset to 0 PwmOut servo(p21); //Servo Control DigitalOut L(LED1); //Debug LED DigitalOut R(LED3); //Debugging Purposes DigitalOut C(LED2); //Debug LED int i=1500; //value of servo position int main(){ servo.period(0.020); while(1){ if (right==1){ wait(0.05); if (right==0){ i=i+100; R=1; wait(.1); R=0; } } if (left==1) { wait(0.05); if (left==0){ i=i-100; L=1; wait(.1); L=0; } } if (reset==1) { wait(0.05); if (reset==0){ i=1500; C=1; wait(.1); C=0; } } if (i>2400) {i=2400;} //Prevention of over-extention of servo if (i<600) {i=600;} servo.pulsewidth_us(i); } }