mo mo
/
F3RC2019_HAND_SERVO
servo
Diff: main.cpp
- Revision:
- 0:633c14df6aad
- Child:
- 1:3b148850fbb9
diff -r 000000000000 -r 633c14df6aad main.cpp --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/main.cpp Sat Sep 14 09:15:51 2019 +0000 @@ -0,0 +1,37 @@ +#include "mbed.h" +#include "PS_PAD.h" + +PS_PAD vsc3(PA_7,PA_6,PA_5,PB_6); + +PwmOut s1 (PC_9); +PwmOut s2 (PB_8); +PwmOut s3 (PB_9); + +int main(){ + + vsc3.init(); + + s1.period_us(20000); + s2.period_us(20000); + s3.period_us(20000); + + while(1){ + + vsc3.poll(); + if(vsc3.read(PS_PAD::PAD_TRIANGLE)){ + s1.pulsewidth_us(300); + }else if(vsc3.read(PS_PAD::PAD_RIGHT)){ + s2.pulsewidth_us(500); + }else if(vsc3.read(PS_PAD::PAD_TOP)){ + s3.pulsewidth_us(500); + }else if(vsc3.read(PS_PAD::PAD_X)){ + s1.pulsewidth_us(2400); + }else; if(vsc3.read(PS_PAD::PAD_LEFT)){ + s2.pulsewidth_us(2400); + }else; if(vsc3.read(PS_PAD::PAD_BOTTOM)){ + s3.pulsewidth_us(2400); + }else; + wait(0.05); + + } +} \ No newline at end of file