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
            };
        };