add lightTask

Core/Src/freertos.c

@@ -35,6 +35,7 @@
 #include "BSP_EE24.h"
 #include "BSP_INA.h"
 #include "BSP_POWER.h"
+#include "LightTask.h"
 /* USER CODE END Includes */
 
 /* Private typedef -----------------------------------------------------------*/
@@ -98,7 +99,7 @@ return __HAL_TIM_GetCounter(&htim2);
   */
 void MX_FREERTOS_Init(void) {
   /* USER CODE BEGIN Init */
-
+  BSP_POWER_Init();
   /* USER CODE END Init */
 
   /* USER CODE BEGIN RTOS_MUTEX */
@@ -128,6 +129,8 @@ void MX_FREERTOS_Init(void) {
   CanDataTask_start();
   ULOG_INFO("Setup CLS");
   CLS_Init();
+  ULOG_INFO("Setup LightTask");
+  LightTask_start();
   /* USER CODE END RTOS_THREADS */
 
   /* USER CODE BEGIN RTOS_EVENTS */
@@ -151,7 +154,8 @@ void StartDefaultTask(void *argument)
   /* init code for USB_DEVICE */
   MX_USB_DEVICE_Init();
   /* USER CODE BEGIN StartDefaultTask */
-
+  BSP_EE24_Init();
+  BSP_INA_Init();
 
   retSD = f_mount(&SDFatFS,SDPath,0);
   retSD =  f_open(&SDFile, "counter.bin", FA_READ);
@@ -173,17 +177,6 @@ void StartDefaultTask(void *argument)
     ULOG_INFO(output);
   }
 
-  uint16_t msg_global_light = GENERATE_CLS_ADDRESS(CLS_CODE_MESSAGE, GLOBAL_CAST_CLS_ADDRESS, CLS_CH_MSG_LIGHT);
-  CLS_BSP_TxHeaderType can_header = CREATE_BSP_CAN_HEADER(msg_global_light, CLS_BSP_DLC_BYTES_2);
-
-  uint8_t light_data[2] = {0};
-
-  BSP_EE24_Init();
-
-  BSP_INA_Init();
-
-  BSP_POWER_Init();
-
   char  INA_LOG[72];
 
   /* Infinite loop */
@@ -197,18 +190,9 @@ void StartDefaultTask(void *argument)
     float power_W = (float)power/1000.0;
     float voltage_V =(float) voltage /1000.0;
     
-
-
     snprintf(INA_LOG, sizeof(INA_LOG),"Voltage[mV] %.2f Current[mA] %d P[W]: %.2f", voltage_V, current, power_W);
     ULOG_INFO(INA_LOG);
 
-    light_data[0]++;
-    light_data[1] = (light_data[0]/10)%4;
-
-    CLS_BSP_CAN_AddMessageToSend(&can_header,light_data);
-    ULOG_INFO("UPDATE RGB LIGHT TEST");
-    
-
   }
   /* USER CODE END StartDefaultTask */
 }