test Start!

Dependencies:   Servo mbed

main.cpp

Committer:
gaejun2
Date:
2014-05-16
Revision:
0:471306b12ae0

File content as of revision 0:471306b12ae0:

#include "mbed.h"
#include "Servo.h"
 
DigitalOut ledRed(LED_RED);
DigitalOut ledBlue(LED_BLUE);
DigitalOut ledGreen(LED_GREEN);

Servo myservo(PTD4);
//Serial pc(USBTX, USBRX);
 
int main() {
   // printf("Servo Calibration Controls:\n");
   // printf("1,2,3 - Position Servo (full left, middle, full right)\n");
   // printf("4,5 - Decrease or Increase range\n");
 
    float range = 0.0005;
    float position = 0.5;
    
    ledRed = 1;
    ledBlue = 1;
    ledGreen = 1;
    
    while(1) {                   
    /*    switch(pc.getc()) {
            case '1': position = 0.0; break;
            case '2': position = 0.5; break;
            case '3': position = 1.0; break;
            case '4': range += 0.0001; break; 
            case '5': range -= 0.0001; break; 
        }
        printf("position = %.1f, range = +/-%0.4f\n", position, range);*/
        ledRed = 0;
        position = 0.0;
        myservo.calibrate(range, 45.0); 
        myservo = position;
        wait(2);
        ledRed = 1;
        
        ledBlue = 0;
        position = 0.5;
        myservo.calibrate(range, 45.0); 
        myservo = position;
        wait(2);
        ledBlue = 1;
        
        ledGreen = 0;
        position = 1.0;
        myservo.calibrate(range, 45.0); 
        myservo = position;
        wait(2);
        ledGreen = 1;
        
    }
}