From 6986e5dd3b788f38dc3d147a39d55eeea455c39d Mon Sep 17 00:00:00 2001
From: jazzpi <jasper@mezzo.de>
Date: Sun, 12 Jun 2022 13:37:28 +0200
Subject: [PATCH] Use status LEDs 1 & 2

---
 Core/Inc/main.h |  2 +-
 Core/Src/main.c | 14 ++++++++++++++
 2 files changed, 15 insertions(+), 1 deletion(-)

diff --git a/Core/Inc/main.h b/Core/Inc/main.h
index 2e1a4c5..015253f 100644
--- a/Core/Inc/main.h
+++ b/Core/Inc/main.h
@@ -53,7 +53,7 @@ extern "C" {
 void Error_Handler(void);
 
 /* USER CODE BEGIN EFP */
-
+void update_status_leds();
 /* USER CODE END EFP */
 
 /* Private defines -----------------------------------------------------------*/
diff --git a/Core/Src/main.c b/Core/Src/main.c
index d04373c..b74aede 100644
--- a/Core/Src/main.c
+++ b/Core/Src/main.c
@@ -24,6 +24,7 @@
 #include "BQ_Abstraction_Layer.h"
 
 #include "stm32f4xx_hal.h"
+#include "stm32f4xx_hal_gpio.h"
 /* USER CODE END Includes */
 
 /* Private typedef -----------------------------------------------------------*/
@@ -71,7 +72,19 @@ static void MX_USART6_UART_Init(void);
 
 /* Private user code ---------------------------------------------------------*/
 /* USER CODE BEGIN 0 */
+void update_status_leds() {
+  if ((HAL_GetTick() / 1000) % 2 == 0) {
+    HAL_GPIO_WritePin(STAT_LED1_GPIO_Port, STAT_LED1_Pin, GPIO_PIN_RESET);
+  } else {
+    HAL_GPIO_WritePin(STAT_LED1_GPIO_Port, STAT_LED1_Pin, GPIO_PIN_SET);
+  }
 
+  if (bq_status == BQ_OFF || bq_status == BQ_ERROR) {
+    HAL_GPIO_WritePin(STAT_LED2_GPIO_Port, STAT_LED2_Pin, GPIO_PIN_RESET);
+  } else {
+    HAL_GPIO_WritePin(STAT_LED2_GPIO_Port, STAT_LED2_Pin, GPIO_PIN_SET);
+  }
+}
 /* USER CODE END 0 */
 
 /**
@@ -121,6 +134,7 @@ int main(void) {
     /* USER CODE END WHILE */
 
     /* USER CODE BEGIN 3 */
+    update_status_leds();
     afe_measure();
   }
   /* USER CODE END 3 */