Diff: main.cpp

Revision:

7:3b14ddcf6d8e

Parent:

2:8f3478b5d434

Child:

8:eaae889bc6eb

--- a/main.cpp	Thu Mar 14 14:24:09 2013 +0000
+++ b/main.cpp	Mon Mar 02 15:20:18 2015 +0000
@@ -1,40 +1,119 @@
 #include "mbed.h"
 #include "USBHostSerial.h"
+#include "C12832_lcd.h"
+#include "Servo.h"
 
-DigitalOut led(LED1);
+DigitalOut led1(LED1);
+DigitalOut led3(LED3);
 Serial pc(USBTX, USBRX);
+C12832_LCD lcd;
+
+Servo tilt(p21);
+Servo rotate(p22);      
+AnalogIn ainLeft(p15);
+AnalogIn ainRight(p16);
+
+Mutex rx_mutex;
+
 
-void serial_task(void const*) {
-    USBHostSerial serial;
+int main()
+{
+    int pos = 1000;
+    tilt.Enable(1000,20000);
+    lcd.cls();
+    char buffer[128];
     
-    while(1) {
+    while (true)
+    { 
+     for(pos=1000;pos<=1250;pos+=1)
+        {
+            tilt.SetPosition(pos);
+            lcd.cls();
+            lcd.printf(" %d ", pos);
+            //wait(0.5);
+        }
+    
+    for(pos=1250;pos>=1000;pos-=1)
+        {  
+            tilt.SetPosition(pos);
+            lcd.printf(" %d ", pos);
+            //wait(0.5);
+        }
+    
+    }
+    
+    
     
-        // try to connect a serial device
-        while(!serial.connect())
-            Thread::wait(500);
-        
-        // in a loop, print all characters received
-        // if the device is disconnected, we try to connect it again
-        while (1) {
-        
-            // if device disconnected, try to connect it again
-            if (!serial.connected())
-                break;
+/*    while (true)
+    {
+        if(pc.readable()) 
+        {
+            rx_mutex.lock();
+            pc.gets(buffer,2); // set the number of bytes
+            
+            rx_mutex.unlock();
+            lcd.locate(0,1);
+            lcd.printf(buffer);
+        }
+        int x=atoi(buffer);
+        switch (x)
+        {
+            case 0:
+                lcd.cls();
+                lcd.locate(0,1);
+                lcd.printf("Do nothing");
+    
+            break;
+            
+            case 1:
+                lcd.cls();
+                lcd.locate(0,1);
+                lcd.printf("Right");
+                //thread servo right
+            break;
+            
+            case 2:
+                lcd.cls();
+                lcd.locate(0,1);
+                lcd.printf("down & right");
 
-            // print characters received
-            while (serial.available()) {
-                printf("%c", serial.getc());
-            }
+            break;
+            
+            case 3:
+                lcd.cls();
+                lcd.locate(0,1);
+                lcd.printf("down");
+            break;
+            
+            case 4:
+                lcd.cls();
+                lcd.locate(0,1);
+                lcd.printf("Ddown & left");
+            break;
+            
+            case 5:
+                lcd.cls();
+                lcd.locate(0,1);
+                lcd.printf("left");
+            break;
             
-            Thread::wait(50);
+            case 6:
+                lcd.cls();
+                lcd.locate(0,1);
+                lcd.printf("up & left");
+            break;
+            
+            case 7:
+                lcd.cls();
+                lcd.locate(0,1);
+                lcd.printf("up");
+            break;
+            
+            case 8:
+                lcd.cls();
+                lcd.locate(0,1);
+                lcd.printf("up & left");
+            break;
         }
-    }
+    } */
 }
-
-int main() {
-    Thread serialTask(serial_task, NULL, osPriorityNormal, 256 * 4);
-    while(1) {
-        led=!led;
-        Thread::wait(500);
-    }
-}
\ No newline at end of file