v0.1 : Servo Lib

Dependencies:   MeArm Servo mbed

main.cpp

Committer:
Ricky_Kwon
Date:
2016-01-26
Revision:
0:7a4088ccf3bc

File content as of revision 0:7a4088ccf3bc:

 // 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);
        }
    }

}