Hopefully Did Fan Batt Box Control Code

Core/Inc/control.h

@@ -0,0 +1,17 @@
+#include "pdu.h"
+
+// TODO: replace this temp value with real value
+#define CONTROL_CANID_FANBATTBOX = 0xA
+
+extern osThreadId_t control_handle;
+extern const osThreadAttr_t control_attributes;
+
+typedef struct {
+    pdu_t *pdu;
+} control_args_t;
+
+void vEval_fanbattbox_state(void *param);
+
+void control_fanbattbox_record(can_msg_t args);
+
+int eval_fanbattbox_state();

Core/Src/can_handler.c

@@ -16,6 +16,7 @@
 #include "fault.h"
 #include "stdio.h"
 #include "steeringio.h"
+#include "control.h"
 #include <assert.h>
 #include <stdlib.h>
 #include <string.h>
@@ -163,6 +164,9 @@ void vCanReceive(void *pv_params)
 			case STEERING_CANID_IO:
 				steeringio_update(msg);
 				break;
+			case CONTROL_CANID_FANBATTBOX:
+				control_fanbattbox_record(msg);
+				break;
 			default:
 				break;
 			}

Core/Src/control.c

@@ -0,0 +1,35 @@
+#include "control.h"
+#include "pdu.h"
+
+osThreadId_t control_handle;
+const osThreadAttr_t control_attributes = {
+	.name = "Control",
+	.stack_size = 128 * 8,
+	.priority = (osPriority_t)osPriorityRealtime,
+};
+
+static int fanBattBoxState = 0;
+
+void vEval_fanbattbox_state(void *param)
+{
+	control_args_t args = (control_args_t *)param;
+	pdu_t *pdu = args->pdu;
+
+	write_fan_battbox(pdu, eval_fanbattbox_state());
+
+	osDelay(1000);
+}
+
+void control_fanbattbox_record(can_msg_t msg)
+{
+	if (msg.data > 0) {
+		fanBattBoxState = 1;
+	} else {
+		fanBattBoxState = 0;
+	}
+}
+
+int eval_fanbattbox_state()
+{
+	return fanBattBoxState;
+}

Core/Src/main.c

@@ -39,6 +39,7 @@
 #include "dti.h"
 #include "steeringio.h"
 #include "pedals.h"
+#include "control.h"
 /* USER CODE END Includes */
 
 /* Private typedef -----------------------------------------------------------*/
@@ -248,6 +249,14 @@ int main(void)
   sm_args->mpu = mpu;
   sm_director_handle = osThreadNew(vStateMachineDirector, sm_args, &sm_director_attributes);
   assert(sm_director_handle);
+
+	/* Control File Thread */
+	control_args_t *control_args = malloc(sizeof(control_args_t));
+	control_args->pdu = pdu;
+	control_handle =
+		osThreadNew(vEval_fanbattbox_state, control_args, &control_attributes);
+	assert(control_handle);
+
   /* USER CODE END RTOS_THREADS */
 
   /* USER CODE BEGIN RTOS_EVENTS */