From 92581c72033a906040b85ac1e92c21435f99c9d6 Mon Sep 17 00:00:00 2001
From: EPFLepuck <103180750+EPFLepuck@users.noreply.github.com>
Date: Tue, 10 May 2022 15:42:45 +0200
Subject: [PATCH] Fix LEDs

Main features are working
---
 check_collision.c | 8 ++++----
 main.c            | 6 ------
 motor_speed.c     | 1 -
 3 files changed, 4 insertions(+), 11 deletions(-)

diff --git a/check_collision.c b/check_collision.c
index 79f52af..c76c601 100644
--- a/check_collision.c
+++ b/check_collision.c
@@ -54,16 +54,16 @@ static THD_FUNCTION(CheckCollision, arg) {
     			//Toggle LED
     			clear_leds();
     			set_led(LED1, 1);
-    			set_rgb_led(LED2, 0, 0, 255);
-    			set_rgb_led(LED8, 0, 0, 255);
+    			set_rgb_led(LED2, 255, 255, 255);
+    			set_rgb_led(LED8, 255, 255, 255);
     		}else if( (i == 3) | (i == 4) ){
     			wall_detection = 2;
 
 				// Toggle LED
 				clear_leds();
 				set_led(LED5, 1);
-				set_rgb_led(LED4, 0, 0, 255);
-				set_rgb_led(LED6, 0, 0, 255);
+				set_rgb_led(LED4, 255, 255, 255);
+				set_rgb_led(LED6, 255, 255, 255);
     		}else{
 				wall_detection = 0;
 				clear_leds();
diff --git a/main.c b/main.c
index d22c348..a6d699a 100644
--- a/main.c
+++ b/main.c
@@ -85,12 +85,6 @@ int main(void)
     }
     /* Infinite loop. */
     while (1) {
-    	//chprintf((BaseSequentialStream *)&SD3, "AccX = %f \n",get_acc_x());
-    	//chprintf((BaseSequentialStream *)&SD3, "Case = %d \n",get_acc_case());
-    	//chprintf((BaseSequentialStream *)&SD3, "IR2 = %d \n",get_calibrated_prox(1));
-    	//chprintf((BaseSequentialStream *)&SD3, "IR1 = %d \n",get_calibrated_prox(0));
-    	//chprintf((BaseSequentialStream *)&SD3, "IR7 = %d \n",get_calibrated_prox(6));
-    	//chprintf((BaseSequentialStream *)&SD3, "IR8 = %d \n",get_calibrated_prox(7));
 
     	chThdSleepMilliseconds(1000);
     }
diff --git a/motor_speed.c b/motor_speed.c
index 43a1c99..817c975 100644
--- a/motor_speed.c
+++ b/motor_speed.c
@@ -37,7 +37,6 @@ static THD_FUNCTION(MotorSpeed, arg) {
 
     systime_t time;
 
-    //uint8_t  up_down = 0;
     float error = 0;
     float derivative = 0;
     float last_error = 0;
-- 
GitLab