![](/media/cache/group/default_image.jpg.50x50_q85.jpg)
preliminary code
Dependencies: Motor TCS3472_I2C mbed
control.cpp
- Committer:
- ThatsAKnife
- Date:
- 2015-04-26
- Revision:
- 0:c16de5d05dd7
- Child:
- 1:789224bfa1e4
File content as of revision 0:c16de5d05dd7:
#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 }; };