Gorazd Kovacic
/
mbed-os-example-blinky-LIGHTNING_copy
test
main.cpp
- Committer:
- gorazdko
- Date:
- 2019-06-02
- Revision:
- 48:4ac030bc2910
- Parent:
- 47:70468e4f985f
- Child:
- 49:6ebde58afad3
File content as of revision 48:4ac030bc2910:
#include "mbed.h" //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 544 #define MAX 2400 #define STEP 50 //Time delay between steps in milliseconds #define TIME 20 //100 #define DELTA 50 DigitalOut myLed(LED1); DigitalIn myButton(USER_BUTTON); DigitalIn myButton_2(D0); PwmOut myServo(D3); void motor_on(void) { //myServo.period_ms(20); myServo.pulsewidth_us(MID); //NB in microseconds } void motor_off(void) { myServo.pulsewidth_us(MIN+2*DELTA); //NB in microseconds } bool button_change = false; int main() { wait(1); // if (myButton) while (1) { if (myButton) { for (int i=MAX; i>MIN; i=i-10) { myServo.pulsewidth_us(i); //NB in microseconds wait_ms(25); } for (int i=MIN; i<MAX; i=i+10) { myServo.pulsewidth_us(i); //NB in microseconds wait_ms(25); } // wait(1); } } }