fix: start the MCP2515 in normal mode for uds protocol

ElectronicCats · Dec 9, 2024 · 1280df5 · 1280df5
1 parent 9a100fa
commit 1280df5
Showing 1 changed file with 6 additions and 1 deletion.
diff --git a/Canbus_app/libraries/uds_library.c b/Canbus_app/libraries/uds_library.c
@@ -18,6 +18,7 @@ UDS_SERVICE* uds_service_alloc(
 // Init the mcp2515 with it respeclty mask and filters
 bool uds_init(UDS_SERVICE* uds_instance) {
     MCP2515* CAN = uds_instance->CAN;
+    CAN->mode = MCP_NORMAL;
     if(mcp2515_init(CAN) != ERROR_OK) return false;
 
     uint32_t mask = 0x7ff;
@@ -28,9 +29,13 @@ bool uds_init(UDS_SERVICE* uds_instance) {
 
     init_mask(CAN, 0, mask);
     init_filter(CAN, 0, uds_instance->id_to_received);
+    init_filter(CAN, 1, uds_instance->id_to_received);
 
     init_mask(CAN, 1, mask);
-    init_filter(CAN, 1, uds_instance->id_to_received);
+    init_filter(CAN, 2, uds_instance->id_to_received);
+    init_filter(CAN, 3, uds_instance->id_to_received);
+    init_filter(CAN, 4, uds_instance->id_to_received);
+    init_filter(CAN, 5, uds_instance->id_to_received);
 
     return true;
 }