v0.1 : Servo Lib
Dependencies: MeArm Servo mbed
Fork of wizArm_WIZwiki-W7500ECO by
main.cpp@0:7a4088ccf3bc, 2016-01-26 (annotated)
- Committer:
- Ricky_Kwon
- Date:
- Tue Jan 26 07:24:30 2016 +0000
- Revision:
- 0:7a4088ccf3bc
- Child:
- 1:ab8c34738e00
wizArm_WIZwiki-W7500ECO
; v0.1 : Servo Lib
Who changed what in which revision?
User | Revision | Line number | New 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 |