Diff: control.cpp

Revision:

0:c16de5d05dd7

Child:

1:789224bfa1e4

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/control.cpp	Sun Apr 26 19:09:55 2015 +0000
@@ -0,0 +1,38 @@
+#include "mbed.h"
+#include "Motor.h"
+#include "TCS3472_I2C.h"
+
+PwmOut brightness(p22);
+TCS3472_I2C rgb(p28, p27);
+Timer time;
+int running=1;
+
+int rgb_data[4];
+float set_brightness = 1.0;
+
+int main(){
+    rgb.enablePowerAndRGBC();
+    rgb.setIntegrationTime(100);
+    brightness=set_brightness;
+    time.start();
+    //dc left fwd
+    //dc rght fwd    
+    while(running=1){
+        if(rgb_data[1]>120 && rgb_data[2]<100){ //red;recalibrate
+            while(rgb_data[1]>100){ //recalibrate
+                //dc left rev
+                //dc rght fwd
+                time.reset();
+                //dc left fwd
+                //dc rght fwd
+            };
+        };
+        if(rgb_data[2]>100){ //green;recalibrate
+            while(rgb_data[2]>90){ //recalibrate
+                //dc left fwd
+                //dc rght rev
+                time.reset();
+                //dc left fwd
+                //dc rght fwd
+            };
+        };
\ No newline at end of file