Colour sensors calibrated

Dependencies:   mbed-rtos mbed Servo QEI

Fork of ICRSEurobot13 by Thomas Branch

Files at this revision

API Documentation at this revision

Comitter:
rsavitski
Date:
Wed Apr 10 20:07:33 2013 +0000
Parent:
34:a49197572737
Child:
37:34f4b38039bb
Commit message:
; ;

Changed in this revision

Processes/AI/ai.cpp Show annotated file Show diff for this revision Revisions of this file
Processes/Kalman/Kalman.cpp Show annotated file Show diff for this revision Revisions of this file
Processes/Motion/motion.cpp Show annotated file Show diff for this revision Revisions of this file
--- a/Processes/AI/ai.cpp	Wed Apr 10 19:52:19 2013 +0000
+++ b/Processes/AI/ai.cpp	Wed Apr 10 20:07:33 2013 +0000
@@ -29,7 +29,7 @@
     
     while(1)
     {
-        Thread::wait(100);
+        Thread::wait(50);
         
         waypoint_flag_mutex.lock();
         if (checkWaypointStatus())
--- a/Processes/Kalman/Kalman.cpp	Wed Apr 10 19:52:19 2013 +0000
+++ b/Processes/Kalman/Kalman.cpp	Wed Apr 10 20:07:33 2013 +0000
@@ -19,7 +19,8 @@
 
 Ticker predictticker;
 
-DigitalOut OLED4(LED4);
+//DigitalOut OLED4(LED4);
+DigitalOut OLED4(p10);
 DigitalOut OLED1(LED1);
 DigitalOut OLED2(LED2);
 
--- a/Processes/Motion/motion.cpp	Wed Apr 10 19:52:19 2013 +0000
+++ b/Processes/Motion/motion.cpp	Wed Apr 10 20:07:33 2013 +0000
@@ -6,7 +6,7 @@
 ////////////////////////////////////////////////////////////////////////////////
 
 #include "motion.h"
-
+DigitalOut OLED4(LED4);
 namespace motion
 {
 
@@ -31,18 +31,17 @@
     if (distance_err < target_waypoint.pos_threshold)
     {
         distance_err = 0;
-        angle_err = constrainAngle(target_waypoint.theta - current_state.theta);
         
-        if (abs(angle_err) < target_waypoint.angle_threshold)
+        if (abs(constrainAngle(target_waypoint.theta - current_state.theta)) < target_waypoint.angle_threshold)
         {
             angle_err = 0;
         }
-    }
-    
+    } 
         
     AI::waypoint_flag_mutex.lock(); // proper way would be to construct a function to evaluate the condition and pass the function pointer to a conditional setter function for reached flag
     if (distance_err == 0 && angle_err == 0)
     {
+        OLED4 = 1;
         AI::setWaypointReached();
         return;
     }