FSLP_Controls_RGB_LEDs
main.cpp
- Committer:
- sethnuon
- Date:
- 2015-10-20
- Revision:
- 0:d56a10dcfd53
File content as of revision 0:d56a10dcfd53:
#include "mbed.h" Serial pc(USBTX, USBRX); DigitalInOut pinReference(p13); DigitalOut driveLine2(p14); AnalogIn senseLine3(p15); DigitalOut red1(p21); DigitalOut red2(p22); DigitalOut red3(p23); DigitalOut red4(p24); DigitalOut blue1(p28); DigitalOut blue2(p27); DigitalOut blue3(p26); DigitalOut blue4(p25); int main() { while(1) { pinReference.output(); pinReference = 0; driveLine2 = 1; float force = 0; force = senseLine3.read(); wait(0.001); pinReference.input(); driveLine2 = 0; float position = 0; position = senseLine3.read(); pc.printf("Force: %f", force); pc.printf(" Position: %f\r\n", position); wait(0.001); if( position ==0 ) { red1 = red2 = red3 = red4 = 0; wait(0.001); }else if( position < 0.35 ) { red1 = 1; red2 = red3 = red4 = 0; wait(0.001); } else if (position >= 0.35 && position < 0.62 ) { red1 = red2 = 1; red3 = red4 = 0; wait(0.001); } else if (position >= 0.62 && position < 0.9 ) { red1 = red2 = red3 = 1; red4 = 0; wait(0.001); } else if ( position >= 0.9) { red1 = red2 = red3 = red4 = 1; wait(0.001); } if ( position ==0 ) { red1 = red2 = red3 = red4 = blue1 = blue2 = blue3 = blue4 = 0; wait(0.001); }else if( position < 0.35 && force >=0.8) { red1 = red2 = red3 = red4 = 0; blue2 = blue3 = blue4 = 0; blue1 = 1; wait(0.001); } else if (position >= 0.35 && position < 0.62 && force >=0.8 ) { red1 = red2 = red3 = red4 = 0; blue3 = blue4 = 0; blue1 = blue2 = 1; wait(0.001); } else if (position >= 0.62 && position < 0.9 && force >=0.8) { red1 = red2 = red3 = red4 = 0; blue4 = 0; blue1 = blue2 = blue3 = 1; wait(0.001); } else if ( position >= 0.9 && force >=0.8) { red1 = red2 = red3 = red4 = 0; blue1 = blue2 = blue3 = blue4 = 1; wait(0.001); } wait(0.3); } }