Feature/FanControlSystem

Core/Inc/control.h

@@ -0,0 +1,22 @@
+#ifndef CONTROL_H
+#define CONTROL_H
+
+#include "pdu.h"
+#include "can.h"
+
+#define CONTROL_CANID_FANBATTBOX 0xAAA
+
+extern osThreadId_t control_handle;
+extern const osThreadAttr_t control_attributes;
+
+typedef struct {
+	pdu_t *pdu;
+} control_args_t;
+
+void vControl(void *param);
+
+void control_fanbattbox_record(can_msg_t args);
+
+int eval_fanbattbox_state();
+
+#endif

Core/Src/can_handler.c

@@ -9,6 +9,10 @@
 #include "dti.h"
 #include "fault.h"
 #include "steeringio.h"
+#include "control.h"
+#include <assert.h>
+#include <stdlib.h>
+#include <string.h>
 
 #define CAN_MSG_QUEUE_SIZE 50 /* messages */
 
@@ -153,6 +157,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,31 @@
+#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 vControl(void *param)
+{
+	control_args_t *args = (control_args_t *)param;
+
+	for (;;) {
+		write_fan_battbox(args->pdu, fanBattBoxState);
+
+		osDelay(1000);
+	}
+}
+
+void control_fanbattbox_record(can_msg_t msg)
+{
+	if (msg.data > 0) {
+		fanBattBoxState = 1;
+	} else {
+		fanBattBoxState = 0;
+	}
+}