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

Committer:
jkangwi
Date:
Thu Oct 16 18:45:41 2014 +0000
Revision:
0:f8b0e15576fe
This sucker may actually work;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
jkangwi 0:f8b0e15576fe 1 #include "mbed.h"
jkangwi 0:f8b0e15576fe 2 #include "Servo.h"
jkangwi 0:f8b0e15576fe 3
jkangwi 0:f8b0e15576fe 4
jkangwi 0:f8b0e15576fe 5
jkangwi 0:f8b0e15576fe 6 Servo myservo1(p21); //top
jkangwi 0:f8b0e15576fe 7 Servo myservo2(p22); //bottom
jkangwi 0:f8b0e15576fe 8
jkangwi 0:f8b0e15576fe 9 int main()
jkangwi 0:f8b0e15576fe 10 {
jkangwi 0:f8b0e15576fe 11 while(1) {
jkangwi 0:f8b0e15576fe 12
jkangwi 0:f8b0e15576fe 13 float servopos;
jkangwi 0:f8b0e15576fe 14 //servopos=0.38;
jkangwi 0:f8b0e15576fe 15
jkangwi 0:f8b0e15576fe 16
jkangwi 0:f8b0e15576fe 17
jkangwi 0:f8b0e15576fe 18 while(servopos=servopos+0.03; servopos<=.67) {
jkangwi 0:f8b0e15576fe 19 servopos=servopos+0.03;
jkangwi 0:f8b0e15576fe 20 myservo1=servopos+.28;
jkangwi 0:f8b0e15576fe 21 myservo2=servopos;
jkangwi 0:f8b0e15576fe 22 printf("Servo 1 position %.2f Servo 2 position %.2f\n\r", servopos, (servopos));
jkangwi 0:f8b0e15576fe 23 }
jkangwi 0:f8b0e15576fe 24 while(servopos>=.39) {
jkangwi 0:f8b0e15576fe 25 servopos=servopos-.03;
jkangwi 0:f8b0e15576fe 26 myservo1=servopos+.24;
jkangwi 0:f8b0e15576fe 27 myservo2=servopos;
jkangwi 0:f8b0e15576fe 28 printf("Servo 1 position %.2f Servo 2 position %.2f\n\r", servopos, (servopos));
jkangwi 0:f8b0e15576fe 29 }
jkangwi 0:f8b0e15576fe 30
jkangwi 0:f8b0e15576fe 31 }
jkangwi 0:f8b0e15576fe 32 }