zzzzzzzzzz / Mbed 2 deprecated LAB_10_control

preliminary code

Dependencies:   Motor TCS3472_I2C mbed

control.cpp@0:c16de5d05dd7, 2015-04-26 (annotated)

Committer:
ThatsAKnife
Date:
Sun Apr 26 19:09:55 2015 +0000
Revision:
0:c16de5d05dd7
Child:
1:789224bfa1e4
preliminary changes

Who changed what in which revision?

UserRevisionLine numberNew contents of line
ThatsAKnife 0:c16de5d05dd7 1 #include "mbed.h"
ThatsAKnife 0:c16de5d05dd7 2 #include "Motor.h"
ThatsAKnife 0:c16de5d05dd7 3 #include "TCS3472_I2C.h"
ThatsAKnife 0:c16de5d05dd7 4
ThatsAKnife 0:c16de5d05dd7 5 PwmOut brightness(p22);
ThatsAKnife 0:c16de5d05dd7 6 TCS3472_I2C rgb(p28, p27);
ThatsAKnife 0:c16de5d05dd7 7 Timer time;
ThatsAKnife 0:c16de5d05dd7 8 int running=1;
ThatsAKnife 0:c16de5d05dd7 9
ThatsAKnife 0:c16de5d05dd7 10 int rgb_data[4];
ThatsAKnife 0:c16de5d05dd7 11 float set_brightness = 1.0;
ThatsAKnife 0:c16de5d05dd7 12
ThatsAKnife 0:c16de5d05dd7 13 int main(){
ThatsAKnife 0:c16de5d05dd7 14 rgb.enablePowerAndRGBC();
ThatsAKnife 0:c16de5d05dd7 15 rgb.setIntegrationTime(100);
ThatsAKnife 0:c16de5d05dd7 16 brightness=set_brightness;
ThatsAKnife 0:c16de5d05dd7 17 time.start();
ThatsAKnife 0:c16de5d05dd7 18 //dc left fwd
ThatsAKnife 0:c16de5d05dd7 19 //dc rght fwd
ThatsAKnife 0:c16de5d05dd7 20 while(running=1){
ThatsAKnife 0:c16de5d05dd7 21 if(rgb_data[1]>120 && rgb_data[2]<100){ //red;recalibrate
ThatsAKnife 0:c16de5d05dd7 22 while(rgb_data[1]>100){ //recalibrate
ThatsAKnife 0:c16de5d05dd7 23 //dc left rev
ThatsAKnife 0:c16de5d05dd7 24 //dc rght fwd
ThatsAKnife 0:c16de5d05dd7 25 time.reset();
ThatsAKnife 0:c16de5d05dd7 26 //dc left fwd
ThatsAKnife 0:c16de5d05dd7 27 //dc rght fwd
ThatsAKnife 0:c16de5d05dd7 28 };
ThatsAKnife 0:c16de5d05dd7 29 };
ThatsAKnife 0:c16de5d05dd7 30 if(rgb_data[2]>100){ //green;recalibrate
ThatsAKnife 0:c16de5d05dd7 31 while(rgb_data[2]>90){ //recalibrate
ThatsAKnife 0:c16de5d05dd7 32 //dc left fwd
ThatsAKnife 0:c16de5d05dd7 33 //dc rght rev
ThatsAKnife 0:c16de5d05dd7 34 time.reset();
ThatsAKnife 0:c16de5d05dd7 35 //dc left fwd
ThatsAKnife 0:c16de5d05dd7 36 //dc rght fwd
ThatsAKnife 0:c16de5d05dd7 37 };
ThatsAKnife 0:c16de5d05dd7 38 };