Dr. Davis and Dr. Dyer special studies robotics project
Dependencies: BSP_DISCO_F469NI LCD_DISCO_F469NI TS_DISCO_F469NI mbed Motordriver
Fork of Configurable_Robots by
Diff: Classes/RobotMVC/RobotModel.cpp
- Revision:
- 10:4dd8b18e07d0
- Parent:
- 7:0f8c3dfbbb86
- Child:
- 11:10a7bb4bc714
- Child:
- 14:c18a489789e6
--- a/Classes/RobotMVC/RobotModel.cpp Thu Feb 09 20:46:26 2017 +0000 +++ b/Classes/RobotMVC/RobotModel.cpp Tue May 09 18:48:47 2017 +0000 @@ -4,6 +4,16 @@ #include "RobotModel.h" +//Pin definitions +//Onboard LEDs +DigitalOut led_green(LED1); +DigitalOut led_orange(LED2); +DigitalOut led_red(LED3); +DigitalOut led_blue(LED4); + +//Input Pins +AnalogIn ain(A0); + //Constructors/Destructors RobotModel::~RobotModel() @@ -13,4 +23,28 @@ RobotModel::RobotModel() { _mode = 0; +} + +//initialize the robot's hardware +void RobotModel::init() +{ + led_green = 0; + led_orange = 0; + led_red = 0; + led_blue = 0; + wait_ms(200); + led_orange = 1; + led_red = 1; + led_blue = 1; +} + +//update the model based on the mode +int RobotModel::update() +{ + if(_mode == 0) + led_green = 0; + else + led_green = !led_green; + + return (int)(ain.read()*100); } \ No newline at end of file