here's a basic way to get the servos running back and not really forth. Next to come, integration of the servo.

Dependencies:   Servo mbed

main.cpp

Committer:
jkangwi
Date:
2014-10-16
Revision:
0:f8b0e15576fe

File content as of revision 0:f8b0e15576fe:

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



Servo myservo1(p21); //top
Servo myservo2(p22); //bottom

int main()
{
    while(1) {

        float servopos;
        //servopos=0.38;



        while(servopos=servopos+0.03; servopos<=.67) {
            servopos=servopos+0.03;
            myservo1=servopos+.28;
            myservo2=servopos;
            printf("Servo 1 position %.2f Servo 2 position %.2f\n\r", servopos, (servopos));
        }
        while(servopos>=.39) {
            servopos=servopos-.03;
            myservo1=servopos+.24;
            myservo2=servopos;
            printf("Servo 1 position %.2f Servo 2 position %.2f\n\r", servopos, (servopos));
        }

    }
}