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