Ricky Kwon / Mbed 2 deprecated wizArm_WIZwiki-W7500ECO

v0.1 : Servo Lib

Dependencies:   MeArm Servo mbed

main.cpp@0:7a4088ccf3bc, 2016-01-26 (annotated)

Committer:
Ricky_Kwon
Date:
Tue Jan 26 07:24:30 2016 +0000
Revision:
0:7a4088ccf3bc
wizArm_WIZwiki-W7500ECO

; v0.1 : Servo Lib

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Ricky_Kwon 0:7a4088ccf3bc 1 // Hello World to sweep a servo through its full range
Ricky_Kwon 0:7a4088ccf3bc 2
Ricky_Kwon 0:7a4088ccf3bc 3 #include "mbed.h"
Ricky_Kwon 0:7a4088ccf3bc 4 #include "Servo.h"
Ricky_Kwon 0:7a4088ccf3bc 5
Ricky_Kwon 0:7a4088ccf3bc 6 Servo myservo1(PC_9);
Ricky_Kwon 0:7a4088ccf3bc 7 Servo myservo2(PC_8);
Ricky_Kwon 0:7a4088ccf3bc 8 Serial pc(USBTX, USBRX);
Ricky_Kwon 0:7a4088ccf3bc 9 int main() {
Ricky_Kwon 0:7a4088ccf3bc 10 char Msg_c;
Ricky_Kwon 0:7a4088ccf3bc 11 pc.baud(115200);
Ricky_Kwon 0:7a4088ccf3bc 12 pc.printf("Hello Servo motor World!\r\n");
Ricky_Kwon 0:7a4088ccf3bc 13 float degree1, degree2= 0;
Ricky_Kwon 0:7a4088ccf3bc 14 float degree = 0;
Ricky_Kwon 0:7a4088ccf3bc 15
Ricky_Kwon 0:7a4088ccf3bc 16 while(1)
Ricky_Kwon 0:7a4088ccf3bc 17 {
Ricky_Kwon 0:7a4088ccf3bc 18 Msg_c = pc.getc();
Ricky_Kwon 0:7a4088ccf3bc 19
Ricky_Kwon 0:7a4088ccf3bc 20 if(Msg_c==0x31)
Ricky_Kwon 0:7a4088ccf3bc 21 {
Ricky_Kwon 0:7a4088ccf3bc 22 degree = -45;
Ricky_Kwon 0:7a4088ccf3bc 23 pc.printf("1 : %f\r\n", degree);
Ricky_Kwon 0:7a4088ccf3bc 24 myservo1.position(degree);
Ricky_Kwon 0:7a4088ccf3bc 25 myservo2.position(degree);
Ricky_Kwon 0:7a4088ccf3bc 26 }
Ricky_Kwon 0:7a4088ccf3bc 27 else if(Msg_c==0x32)
Ricky_Kwon 0:7a4088ccf3bc 28 {
Ricky_Kwon 0:7a4088ccf3bc 29 degree = 0;
Ricky_Kwon 0:7a4088ccf3bc 30 pc.printf("2 : %f\r\n", degree);
Ricky_Kwon 0:7a4088ccf3bc 31 myservo1.position(degree);
Ricky_Kwon 0:7a4088ccf3bc 32 myservo2.position(degree);
Ricky_Kwon 0:7a4088ccf3bc 33 }
Ricky_Kwon 0:7a4088ccf3bc 34 else if(Msg_c==0x33)
Ricky_Kwon 0:7a4088ccf3bc 35 {
Ricky_Kwon 0:7a4088ccf3bc 36 degree = 45;
Ricky_Kwon 0:7a4088ccf3bc 37 pc.printf("3 : %f\r\n", degree);
Ricky_Kwon 0:7a4088ccf3bc 38 myservo1.position(degree);
Ricky_Kwon 0:7a4088ccf3bc 39 myservo2.position(degree);
Ricky_Kwon 0:7a4088ccf3bc 40 }
Ricky_Kwon 0:7a4088ccf3bc 41 else if(Msg_c=='a')
Ricky_Kwon 0:7a4088ccf3bc 42 {
Ricky_Kwon 0:7a4088ccf3bc 43 degree1++;
Ricky_Kwon 0:7a4088ccf3bc 44 pc.printf("a degree1 : %f\r\n", degree1);
Ricky_Kwon 0:7a4088ccf3bc 45 myservo1.position(degree1);
Ricky_Kwon 0:7a4088ccf3bc 46 }
Ricky_Kwon 0:7a4088ccf3bc 47 else if(Msg_c=='s')
Ricky_Kwon 0:7a4088ccf3bc 48 {
Ricky_Kwon 0:7a4088ccf3bc 49 degree1--;
Ricky_Kwon 0:7a4088ccf3bc 50 pc.printf("s degree1 : %f\r\n", degree1);
Ricky_Kwon 0:7a4088ccf3bc 51 myservo1.position(degree1);
Ricky_Kwon 0:7a4088ccf3bc 52 }
Ricky_Kwon 0:7a4088ccf3bc 53 else if(Msg_c=='z')
Ricky_Kwon 0:7a4088ccf3bc 54 {
Ricky_Kwon 0:7a4088ccf3bc 55 degree2++;
Ricky_Kwon 0:7a4088ccf3bc 56 pc.printf("z degree2 : %f\r\n", degree2);
Ricky_Kwon 0:7a4088ccf3bc 57 myservo2.position(degree2);
Ricky_Kwon 0:7a4088ccf3bc 58 }
Ricky_Kwon 0:7a4088ccf3bc 59 else if(Msg_c=='x')
Ricky_Kwon 0:7a4088ccf3bc 60 {
Ricky_Kwon 0:7a4088ccf3bc 61 degree2--;
Ricky_Kwon 0:7a4088ccf3bc 62 pc.printf("x degree2 : %f\r\n", degree2);
Ricky_Kwon 0:7a4088ccf3bc 63 myservo2.position(degree2);
Ricky_Kwon 0:7a4088ccf3bc 64 }
Ricky_Kwon 0:7a4088ccf3bc 65 }
Ricky_Kwon 0:7a4088ccf3bc 66
Ricky_Kwon 0:7a4088ccf3bc 67 }
Ricky_Kwon 0:7a4088ccf3bc 68
Ricky_Kwon 0:7a4088ccf3bc 69