Code to run the microcontrollers on the R5 competition bot
Dependencies: LineSensors mbed
Diff: DriveController.h
- Revision:
- 3:0d7687b6ef14
- Parent:
- 2:d0ce8e26cbc4
- Child:
- 4:ac6b2e5b240b
--- a/DriveController.h Fri Oct 03 03:48:39 2014 +0000 +++ b/DriveController.h Fri Oct 03 18:54:42 2014 +0000 @@ -1,28 +1,59 @@ #ifndef DRIVECONTROLLER_H #define DRIVECONTROLLER_H #include "mbed.h" +#include <list> +#include <string> enum Direction { - North, South, East, West; + NORTH, SOUTH, EAST, WEST }; struct Command { - Direction direction = NORTH; + Direction direction; int distance; }; class DriveController { private: - DigitalOut wheels[4] = {{PTC1}, {PTC2}, {PTE29}, {PTE30}}; + DigitalOut wheel1; + DigitalOut wheel2; + DigitalOut wheel3; + DigitalOut wheel4; + + List<DigitalInOut> sensors; - DigitalIn sensors[24] = {{PTC7}, {PTC0}, {PTC3}, {PTC4}, {PTC5}, {PTC6}, {PTC10}, {PTC11}, {PTC9}, - {PTC8}, {PTA5}, {PTA4}, {PTA12}, {PTD4}, {PTA2}, {PTA1}, {PTC12}, {PTC13}, {PTC16}, {PTC17}, - {PTD2}, {PTD0}, {PTD5}, {PTD13}}; + const string sensorPinNames[] = {"PTC7", "PTC0", "PTC3", "PTC4", "PTC5", "PTC6", "PTC10", "PTC11", "PTC9", "PTC8", "PTA5", "PTA4", "PTA12", + "PTD4", "PTA2", "PTA1", "PTC12", "PTC13", "PTC16", "PTC17", "PTD2M", "PTD0", "PTD5", "PTD13"} + + /*DigitalInOut sensor01; + DigitalInOut sensor02; + DigitalInOut sensor03; + DigitalInOut sensor04; + DigitalInOut sensor05; + DigitalInOut sensor06; + DigitalInOut sensor07; + DigitalInOut sensor08; + DigitalInOut sensor09; + DigitalInOut sensor10; + DigitalInOut sensor11; + DigitalInOut sensor12; + DigitalInOut sensor13; + DigitalInOut sensor14; + DigitalInOut sensor15; + DigitalInOut sensor16; + DigitalInOut sensor17; + DigitalInOut sensor18; + DigitalInOut sensor19; + DigitalInOut sensor20; + DigitalInOut sensor21; + DigitalInOut sensor22; + DigitalInOut sensor23; + DigitalInOut sensor24; */ - bool sensorStates[24] = {false}; + bool sensorStates[24]; Direction orientation;