Henrique Rosa
/
TESTE_SERVO_OK
servo
Revision 3:2848f736b75a, committed 21 months ago
- Comitter:
- henriquer
- Date:
- Mon Sep 05 19:34:06 2022 +0000
- Parent:
- 2:10498697e83b
- Commit message:
- servo
Changed in this revision
main.cpp | Show annotated file Show diff for this revision Revisions of this file |
--- a/main.cpp Fri Sep 03 12:16:55 2021 +0000 +++ b/main.cpp Mon Sep 05 19:34:06 2022 +0000 @@ -1,21 +1,33 @@ -// https://os.mbed.com/questions/1680/Analog-In-PWM-Out-to-control-rc-servo/ -// 2021-08-26 - #include "mbed.h" -PwmOut servo(D9); - -int main() - { - servo.period_us(20000); //20ms period, typical for analog RC servo - int servopulsewidth=1500; - servo.pulsewidth_us(servopulsewidth); //centers the servo. Usually a RC servos range is from 1000 to 2000us. - while(1) - { - //servo.pulsewidth_us(1500); //increments servopulsewidth with 1 - //wait(0.5); - servo.pulsewidth_us(1000); //increments servopulsewidth with 1 - wait(0.5); - servo.pulsewidth_us(2000); //increments servopulsewidth with 1 - wait(0.5); +//Program to 'sweep' test a 'standard RC type servo +//Define some parameters using compiler directive '#define' +//Check Servo DATA if 0.75ms to 2.25ms then use min=750 and max=2250 +//NB be values in microseconds (Following are generic values) +#define MID 1500 +#define MIN 1000 +#define MAX 2000 +#define STEP 50 +//Time delay between steps in milliseconds +#define TIME 400 + +DigitalOut myLed(LED1); +DigitalIn myButton(USER_BUTTON); + +PwmOut myServo(D11); + +int main() { + + myServo.period_ms(20); + myServo.pulsewidth_us(MID); //NB in microseconds + + while(true) { + for (int i=MIN;i<=MAX;i+=STEP){ + myServo.pulsewidth_us(i); + wait_ms(TIME); + } + for (int i=MAX;i>=MIN;i-=STEP){ + myServo.pulsewidth_us(i); + wait_ms(TIME); + } } } \ No newline at end of file