Finn Quicke / Mbed 2 deprecated TDP3_ColourSensor_OOP

Dependencies:   mbed

Committer:
quickeman
Date:
Mon Mar 18 11:04:39 2019 +0000
Revision:
1:e4320a230347
Parent:
0:c3344ac96db1
Various updates; removed print statements

Who changed what in which revision?

UserRevisionLine numberNew contents of line
quickeman 0:c3344ac96db1 1 #include "mbed.h"
quickeman 0:c3344ac96db1 2 #include "ColourSensor_H.h"
quickeman 0:c3344ac96db1 3
quickeman 0:c3344ac96db1 4 Ticker detectColour;
quickeman 0:c3344ac96db1 5 Timeout readColour;
quickeman 0:c3344ac96db1 6 Timeout reactivateColour;
quickeman 0:c3344ac96db1 7
quickeman 0:c3344ac96db1 8 int main() {
quickeman 1:e4320a230347 9 //printf("Program has started\n\r");
quickeman 0:c3344ac96db1 10
quickeman 1:e4320a230347 11 ColourSensor ColourSensor(PTC16, PTC13, PTE20);
quickeman 0:c3344ac96db1 12
quickeman 0:c3344ac96db1 13 // Set call rate of colour detection function
quickeman 1:e4320a230347 14 detectColour.attach(callback(&ColourSensor, &ColourSensor::readIf), 0.5);
quickeman 0:c3344ac96db1 15
quickeman 1:e4320a230347 16 // int firstLoop = 1;
quickeman 0:c3344ac96db1 17
quickeman 0:c3344ac96db1 18 while (1) {
quickeman 0:c3344ac96db1 19 // main program loop
quickeman 1:e4320a230347 20 /*
quickeman 0:c3344ac96db1 21 if (firstLoop) {
quickeman 0:c3344ac96db1 22 printf("Main loop has started\n\r");
quickeman 0:c3344ac96db1 23 firstLoop--;
quickeman 0:c3344ac96db1 24 }
quickeman 1:e4320a230347 25 */
quickeman 0:c3344ac96db1 26
quickeman 0:c3344ac96db1 27 if (ColourSensor.toggleConst && ColourSensor.toggleA) {
quickeman 0:c3344ac96db1 28 // Call readColSenWhich after x seconds
quickeman 1:e4320a230347 29 //printf("Toggle A\n\r");
quickeman 0:c3344ac96db1 30
quickeman 1:e4320a230347 31 readColour.attach(callback(&ColourSensor, &ColourSensor::readWhich), 0.2);
quickeman 0:c3344ac96db1 32
quickeman 0:c3344ac96db1 33 ColourSensor.toggleA = 0;
quickeman 0:c3344ac96db1 34 }
quickeman 0:c3344ac96db1 35
quickeman 0:c3344ac96db1 36 if (ColourSensor.toggleConst && ColourSensor.toggleB) {
quickeman 0:c3344ac96db1 37 // Process colour sensor data
quickeman 1:e4320a230347 38 //printf("Toggle B\n\r");
quickeman 0:c3344ac96db1 39
quickeman 0:c3344ac96db1 40 ColourSensor.process();
quickeman 0:c3344ac96db1 41
quickeman 0:c3344ac96db1 42 reactivateColour.attach(callback(&ColourSensor, &ColourSensor::makeColourActive), 2.0);
quickeman 0:c3344ac96db1 43
quickeman 0:c3344ac96db1 44 ColourSensor.toggleB = 0;
quickeman 0:c3344ac96db1 45 }
quickeman 0:c3344ac96db1 46 }
quickeman 0:c3344ac96db1 47 }