Daisuke Sato
/
NucleoF401RE_pwmtest
F401RE Servo sample
Diff: main.cpp
- Revision:
- 0:c4a511752c16
diff -r 000000000000 -r c4a511752c16 main.cpp --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/main.cpp Wed May 04 07:59:28 2016 +0000 @@ -0,0 +1,20 @@ +#include "mbed.h" + +PwmOut servo(D3); +DigitalOut myled(D13); +DigitalIn bot(PC_13); + +int main() { + myled = 1; + servo.period(0.020); // servo requires a 20ms period + while (1) { + if(bot == 0){ + for(float offset=0.0; offset<0.001; offset+=0.0001) { + servo.pulsewidth(0.001 + offset); // servo position determined by a pulsewidth between 1-2ms + wait(0.25); + } + myled = !myled; + } + else if(bot == 1)servo = 1; + } +} \ No newline at end of file