basic version

Dependencies:   C12832_lcd USBHost mbed

Revision:
4:429d9a63eb79
Parent:
3:be269540df58
Child:
5:e82e00f12634
--- a/main.cpp	Wed Jan 14 16:59:30 2015 +0000
+++ b/main.cpp	Thu Jan 15 16:32:56 2015 +0000
@@ -33,7 +33,7 @@
     while(true){
         sonarDistance_mutex.lock();
         servoPosition_mutex.lock();
-            servoPosition = sonarDistance;
+            servoPosition = (sonarDistance - servoPosition) / 2;
         sonarDistance_mutex.unlock();
         servoPosition_mutex.unlock();
     }