v0.1 : Servo Lib
Dependencies: MeArm Servo mbed
Diff: main.cpp
- Revision:
- 0:7a4088ccf3bc
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/main.cpp Tue Jan 26 07:24:30 2016 +0000 @@ -0,0 +1,69 @@ + // Hello World to sweep a servo through its full range + +#include "mbed.h" +#include "Servo.h" + +Servo myservo1(PC_9); +Servo myservo2(PC_8); +Serial pc(USBTX, USBRX); +int main() { + char Msg_c; + pc.baud(115200); + pc.printf("Hello Servo motor World!\r\n"); + float degree1, degree2= 0; + float degree = 0; + + while(1) + { + Msg_c = pc.getc(); + + if(Msg_c==0x31) + { + degree = -45; + pc.printf("1 : %f\r\n", degree); + myservo1.position(degree); + myservo2.position(degree); + } + else if(Msg_c==0x32) + { + degree = 0; + pc.printf("2 : %f\r\n", degree); + myservo1.position(degree); + myservo2.position(degree); + } + else if(Msg_c==0x33) + { + degree = 45; + pc.printf("3 : %f\r\n", degree); + myservo1.position(degree); + myservo2.position(degree); + } + else if(Msg_c=='a') + { + degree1++; + pc.printf("a degree1 : %f\r\n", degree1); + myservo1.position(degree1); + } + else if(Msg_c=='s') + { + degree1--; + pc.printf("s degree1 : %f\r\n", degree1); + myservo1.position(degree1); + } + else if(Msg_c=='z') + { + degree2++; + pc.printf("z degree2 : %f\r\n", degree2); + myservo2.position(degree2); + } + else if(Msg_c=='x') + { + degree2--; + pc.printf("x degree2 : %f\r\n", degree2); + myservo2.position(degree2); + } + } + +} + +