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 Christopher Eubanks

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