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

Committer:
blu12758
Date:
Tue May 09 18:48:47 2017 +0000
Revision:
10:4dd8b18e07d0
Parent:
7:0f8c3dfbbb86
Child:
11:10a7bb4bc714
Child:
14:c18a489789e6
UI update

Who changed what in which revision?

UserRevisionLine numberNew contents of line
blu12758 7:0f8c3dfbbb86 1 //OU Configurable Robot Project
blu12758 7:0f8c3dfbbb86 2 //Spring 2017
blu12758 7:0f8c3dfbbb86 3 //William Bonner
blu12758 7:0f8c3dfbbb86 4
blu12758 7:0f8c3dfbbb86 5 #include "RobotModel.h"
blu12758 7:0f8c3dfbbb86 6
blu12758 10:4dd8b18e07d0 7 //Pin definitions
blu12758 10:4dd8b18e07d0 8 //Onboard LEDs
blu12758 10:4dd8b18e07d0 9 DigitalOut led_green(LED1);
blu12758 10:4dd8b18e07d0 10 DigitalOut led_orange(LED2);
blu12758 10:4dd8b18e07d0 11 DigitalOut led_red(LED3);
blu12758 10:4dd8b18e07d0 12 DigitalOut led_blue(LED4);
blu12758 10:4dd8b18e07d0 13
blu12758 10:4dd8b18e07d0 14 //Input Pins
blu12758 10:4dd8b18e07d0 15 AnalogIn ain(A0);
blu12758 10:4dd8b18e07d0 16
blu12758 7:0f8c3dfbbb86 17
blu12758 7:0f8c3dfbbb86 18 //Constructors/Destructors
blu12758 7:0f8c3dfbbb86 19 RobotModel::~RobotModel()
blu12758 7:0f8c3dfbbb86 20 {
blu12758 7:0f8c3dfbbb86 21 //#TODO
blu12758 7:0f8c3dfbbb86 22 }
blu12758 7:0f8c3dfbbb86 23 RobotModel::RobotModel()
blu12758 7:0f8c3dfbbb86 24 {
blu12758 7:0f8c3dfbbb86 25 _mode = 0;
blu12758 10:4dd8b18e07d0 26 }
blu12758 10:4dd8b18e07d0 27
blu12758 10:4dd8b18e07d0 28 //initialize the robot's hardware
blu12758 10:4dd8b18e07d0 29 void RobotModel::init()
blu12758 10:4dd8b18e07d0 30 {
blu12758 10:4dd8b18e07d0 31 led_green = 0;
blu12758 10:4dd8b18e07d0 32 led_orange = 0;
blu12758 10:4dd8b18e07d0 33 led_red = 0;
blu12758 10:4dd8b18e07d0 34 led_blue = 0;
blu12758 10:4dd8b18e07d0 35 wait_ms(200);
blu12758 10:4dd8b18e07d0 36 led_orange = 1;
blu12758 10:4dd8b18e07d0 37 led_red = 1;
blu12758 10:4dd8b18e07d0 38 led_blue = 1;
blu12758 10:4dd8b18e07d0 39 }
blu12758 10:4dd8b18e07d0 40
blu12758 10:4dd8b18e07d0 41 //update the model based on the mode
blu12758 10:4dd8b18e07d0 42 int RobotModel::update()
blu12758 10:4dd8b18e07d0 43 {
blu12758 10:4dd8b18e07d0 44 if(_mode == 0)
blu12758 10:4dd8b18e07d0 45 led_green = 0;
blu12758 10:4dd8b18e07d0 46 else
blu12758 10:4dd8b18e07d0 47 led_green = !led_green;
blu12758 10:4dd8b18e07d0 48
blu12758 10:4dd8b18e07d0 49 return (int)(ain.read()*100);
blu12758 7:0f8c3dfbbb86 50 }