preliminary code
Dependencies: Motor TCS3472_I2C mbed
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