Sweep a servo according to Proximity sensor measure
Dependencies: Servo X_NUCLEO_6180XA1 mbed
Fork of HelloWorld_6180XA1 by
Diff: main.cpp
- Revision:
- 33:b903a0ec8803
- Parent:
- 32:724d2afb0ca2
- Child:
- 35:8b4a5cc0fb1f
--- a/main.cpp Thu Nov 12 11:55:28 2015 +0100 +++ b/main.cpp Tue Nov 17 17:08:33 2015 +0100 @@ -84,11 +84,11 @@ /* On board red slider position check */ enum OpModeIntPoll_t{ PollMeasure, IntMeasure }; -OperatingMode CheckSlider(STMPE1600DigiIn measure_type, enum OpModeIntPoll_t OpMode) -{ -int measure=measure_type; +OperatingMode CheckSlider(enum OpModeIntPoll_t OpMode) { + +OperatingMode ret; +int measure= board->RdSwitch(); -OperatingMode ret; switch (OpMode) { case PollMeasure: if(measure==RANGE) @@ -104,7 +104,7 @@ ret = als_continuous_interrupt; break; } - return ret; + return ret; } /* Print on USB Serial the started OperatingMode */ @@ -157,7 +157,7 @@ printf("Failed to init board!\n\r"); - operating_mode=CheckSlider(measure_type, IntMeasure); + operating_mode=CheckSlider(IntMeasure); status=board->sensor_top->StartMeasurement(operating_mode, SensorTopIRQ, NULL, NULL); if(!status) { @@ -180,7 +180,7 @@ printf("\nProgram stopped!\n\n\r"); break; } - operating_mode=CheckSlider(measure_type, IntMeasure); + operating_mode=CheckSlider(IntMeasure); if(operating_mode!=prev_operating_mode) { DisplayRefresh(prev_operating_mode); @@ -195,7 +195,6 @@ DisplayRefresh(operating_mode); } } - DisplayMsg("BYE"); delete board; } @@ -210,7 +209,7 @@ status=board->InitBoard(); if(status) printf("Failed to init board!\n\r"); - operating_mode=CheckSlider(measure_type, PollMeasure); + operating_mode=CheckSlider(PollMeasure); status=board->sensor_top->StartMeasurement(operating_mode, NULL, NULL, NULL); if(!status) { @@ -234,7 +233,7 @@ break; } - operating_mode=CheckSlider(measure_type, PollMeasure); + operating_mode=CheckSlider(PollMeasure); if(operating_mode!=prev_operating_mode) { DisplayRefresh(prev_operating_mode);