main.cpp

00001 #include "mbed.h"
00002 #include "Servo.h"
00003 #include "Motor.h"
00004 
00005 Servo myservo1(p22);                        //inititalize motors and servo
00006 DigitalIn sw2(p17);
00007 DigitalIn sw3(p18);
00008 
00009 
00010 int main()
00011 {
00012     float servopos; //current position of servos
00013     float waittime=0.02;
00014     while(1) {
00015         if(sw2==1) {
00016             servopos=0.5;
00017             while(sw2==1) {
00018                 servopos+=0.0025;
00019                 wait(waittime);
00020                 myservo1=servopos;
00021                 
00022             }
00023         }
00024         if(sw3==1) {
00025             servopos=myservo1;
00026 
00027             while(sw3==1) {
00028                 servopos-=0.0025;
00029                 wait(waittime);
00030                 myservo1=servopos;
00031                 
00032             }
00033         }
00034     }
00035 }
00036 
00037 
00038