James Hilder / Mbed 2 deprecated PR_QuickServoDemo

Very simple program to demonstrate MX-28 servo; turns from -90 to +90 degrees and back.

Dependencies:   mbed

Fork of PR_RobotArmSetup by James Hilder

main.cpp

Committer:
jah128
Date:
2017-02-16
Revision:
1:311dbbc3aaa3
Parent:
0:03f84c95f73b

File content as of revision 1:311dbbc3aaa3:

// Dynamixel MX-28 Demo Code

#include "servo.h"
#include "mbed.h"
#include "SerialHalfDuplex.h"

Serial pc(USBTX,USBRX);
Servo servo(p9,p10);

int main()
{
    pc.baud(115200);
    pc.printf("Dynamixel MX-28 Servo Demo\n");
    int model = servo.GetModelNumber(1);
    if(model != MX28_MODEL) {
        pc.printf("Error: No MX-28 servo with ID 1 found...\n");
        while(1);
    }
    while(1){
        pc.printf("Set servo position to 1024");
        servo.SetGoal(1,1024,1);
        wait(1);   
        pc.printf("Set servo position to 2048");
        servo.SetGoal(1,2048,1);
        wait(1); 
        pc.printf("Set servo position to 3072");
        servo.SetGoal(1,3072,1);
        wait(1);   
        pc.printf("Set servo position to 2048");
        servo.SetGoal(1,2048,1);
        wait(1); 
    }
}