meister2013 control test program

Dependencies:   mbed

main.cpp

Committer:
YSB
Date:
2013-08-05
Revision:
0:6e1fdd3ca40d

File content as of revision 0:6e1fdd3ca40d:

#include "mbed.h"
//header to use rs405cb class
#include "RS405cb.h"

//make object
RS405cb servo(p28,p27,p21);//TX,RX,PERMIT  (PERMIT means RE/DE Pin of ltc485)

//main
int main() {
    TORQUE_ON(1); //means "make torque on of servo whose id is 1." 
    while(1) {
        Rotate_Servo_Float(1,-90.0);//means "change angle to -90.0 degree :ID=1"    angle scope:-90.0 to -90.0    
        wait(1.0);
        Rotate_Servo_Float(1,0.0);
        wait(1.0);
        Rotate_Servo_Float(1,90.0);
        wait(1.0);
        Rotate_Servo_Float(1,0.0);
        wait(1.0);
    }
}