Diff: main.cpp

Revision:

0:471306b12ae0

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Fri May 16 15:47:52 2014 +0000
@@ -0,0 +1,55 @@
+#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;
+        
+    }
+}
+ 
\ No newline at end of file