Diff: main.cpp

Revision:

5:bc5081f0c063

Parent:

4:36a04230554d

Child:

6:2cc2aac35868

--- a/main.cpp	Thu Nov 07 15:31:52 2019 +0000
+++ b/main.cpp	Tue Nov 12 10:36:59 2019 +0000
@@ -6,6 +6,7 @@
 #include "TOF.h"
 #include "Motor.h"
 #include "power.h"
+#include "LED.h"
 
 Serial pc(SERIAL_TX, SERIAL_RX, 9600);    // set-up serial to pc
 
@@ -18,13 +19,14 @@
 //Class define
 cAdafruit_VL6180X VL6180X(TOF1,TOF4,TOF6,TOF7);  //Define TOF sensor class and initialise devices
 cPower cPower(VBATT, V5, V3);
+cRBG_LED cRBG_LED(DIAG_RED, DIAG_BLU, DIAG_GRN);
 
 int main()
 {
     uint8_t TOFRange[4]; //Array to store TOF measurements 0-sensor1, 1-sensor4, 2-sensor6, 3-sensor7
     float power_levels[3]; //Array to voltage levels
     
-    while(1) {
+    while(1){
         
         //Perform TOF measurements
         TOFRange[0] = serviceTOF(VL6180X, ADDR1);
@@ -40,7 +42,9 @@
         power_levels[0] = cPower.monitor_battery();
         power_levels[1] = cPower.monitor_5v_line();
         power_levels[2] = cPower.monitor_3v3_line();
-        printf("BATT:%4.2f, 5V:%4.2f, 3v3:%4.2f\n\r", power_levels[0], power_levels[1], power_levels[2]);  
+        printf("BATT:%4.2f, 5V:%4.2f, 3v3:%4.2f\n\r", power_levels[0], power_levels[1], power_levels[2]);
+        
+        cRBG_LED.yellow_led();    
 
     }
 }
\ No newline at end of file