groep 16 / Mbed 2 deprecated BioRobotics_Project_Total

Dependencies:   mbed QEI MODSERIAL

Files at this revision

API Documentation at this revision

Comitter:
samzijp
Date:
Mon Oct 28 12:15:07 2019 +0000
Parent:
1:675b67b2ae02
Commit message:
Iets toegevoegd aan het geheel

Changed in this revision

main.cpp Show annotated file Show diff for this revision Revisions of this file
--- a/main.cpp	Tue Oct 22 08:43:25 2019 +0000
+++ b/main.cpp	Mon Oct 28 12:15:07 2019 +0000
@@ -2,9 +2,18 @@
 #include "MODSERIAL.h"
 #include "QEI.h"
 
+// LED's
+DigitalOut led_red(LED_RED);
+DigitalOut led_green(LED_GREEN);
+DigitalOut led_blue(LED_BLUE);
 
+// Modserial
 Serial pc(USBTX, USBRX);
 
+
+
+// ========= State Machine ========= //
+
 enum states {WAITING, MOTOR_ANGLE_CLBRT, EMG_CLBRT, HOMING, WAITING4SIGNAL, OPERATION, SHOOTING, DEMO, FAILURE_MODE};
 states currentState = WAITING;      // Start in waiting state
 
@@ -17,6 +26,10 @@
         break;
         
         case MOTOR_ANGLE_CLBRT:
+        // Description:
+        // In this state the robot moves to a mechanical limit of motion, 
+        // in order to calibrate the motors.
+        
         
         break;