File content as of revision 1:678d09a36fcb:

//Test program using robo class function
//Created 10/12/2011 by MLD 427

#include "mbed.h"
#include "Servo.h"
#include "robo.h"

robo arm(p21, p22, p23, p24, p25);

int main() {
//servo.period_ms(20);
// This code tests each servo by commanding it to move within a certain range
float i;
        for (i=0;i<100;i++){
            arm.writeSpin(i);
            wait(.05);
             }
        for (i=0;i<100;i++){
            arm.writeBase(i);
            wait(.05);
             }     
        for (i=0;i<100;i++){
            arm.writeElbow(i);
            wait(.05);
             }
        for (i=0;i<60;i++){
            arm.writeWrist(i);
            wait(.05);
             }
             arm.writeClaw(0);
             wait(.05);                                 
        for (i=0;i<100;i++){
           arm.writeClaw(i);
            wait(.05);
             } 

}