Preston Stephens
/
MiniProject5_LightTracker
Final
Fork of MiniProject5_LightTracker by
Diff: main.cpp
- Revision:
- 13:871d01d0d250
- Parent:
- 12:7bc0afbc651a
- Child:
- 14:69cad6d9a2e5
--- a/main.cpp Tue Jan 12 00:06:10 2016 +0000 +++ b/main.cpp Tue Jan 12 01:12:23 2016 +0000 @@ -8,16 +8,24 @@ AnalogIn sensor1(p19); AnalogIn sensor2(p20); +Serial pc(USBTX, USBRX); +float val1, val2; -float angle; +int angle; int main(){ SegInit(); ServoInit(); - - if(sensor1>sensor2){angle=angle+1;} - if(sensor1>sensor2){angle=angle+1;} + angle=0; +while(1) +{ + val1 = sensor1; + val2 = sensor2; + pc.printf("%.2f \t %.2f\n\r", val1, val2); + if((val1+0.01)<val2){angle=angle+5;} + if(val1>(val2+0.01)){angle=angle-5;} ServoControl(angle); - SegDisplay(10,1); + SegDisplay(angle); +} }