diff options
Diffstat (limited to 'source/Concept/Framework/main.cpp')
| -rw-r--r-- | source/Concept/Framework/main.cpp | 45 |
1 files changed, 35 insertions, 10 deletions
diff --git a/source/Concept/Framework/main.cpp b/source/Concept/Framework/main.cpp index cf80770..d6e1d92 100644 --- a/source/Concept/Framework/main.cpp +++ b/source/Concept/Framework/main.cpp @@ -13,26 +13,51 @@ int main() newEngine = NULL;
}
+ //Init Kicker
+ for(uint8 i = IO_KICKER_START; i < IO_KICKER_END; i++)
+ {
+ Kicker* newKicker = new Kicker(i);
+ localRobot->AddModule(newKicker);
+ newKicker = NULL;
+ }
+
//Init Sensors
for(uint8 i = IO_SENSOR_START; i < IO_SENSOR_END; i++)
{
- SensorTypes newSensorType;
-
switch(i)
{
- //Cases when sensor is digital:
- // newSensorType = SENSOR_TYPE_DIGITAL;
- // break;
-
+ //Create correct type of sensor
+ case IO_SENSOR_IR_0_DEG:
+ case IO_SENSOR_IR_30_DEG:
+ case IO_SENSOR_IR_60_DEG:
+ case IO_SENSOR_IR_100_DEG:
+ case IO_SENSOR_IR_180_DEG:
+ case IO_SENSOR_IR_260_DEG:
+ case IO_SENSOR_IR_300_DEG:
+ case IO_SENSOR_IR_330_DEG:
+ {
+ IR_Sensor* newSensor = new IR_Sensor(i);
+ localRobot->AddModule(newSensor);
+ newSensor = NULL;
+ break;
+ }
//Other cases
default:
- newSensorType = SENSOR_TYPE_ANALOG;
+ {
+ Sensor* newSensor = new Sensor(i);
+ localRobot->AddModule(newSensor);
+ newSensor = NULL;
break;
+ }
}
+ }
- Sensor* newSensor = new Sensor(i, newSensorType);
- localRobot->AddModule(newSensor);
- newSensor = NULL;
+ //Init Leds
+ for(uint8 i = IO_LED_START; i < IO_LED_END; i++)
+ {
+ Led* newLed = new Led(i);
+ localRobot->AddModule(newLed);
+ newLed = NULL;
}
//Run
|