added first code for OBD2 via CAN and K-Line

Software/src/can.cpp

@@ -49,21 +49,6 @@ void Init_CAN()
     CAN0.setMode(MCP_NORMAL);
 }
 
-/**
- * @brief Processes CAN messages and sends a CAN debug message periodically.
- *
- * This function processes CAN messages and sends a CAN debug message periodically based on a time interval.
- */
-void CAN_Process()
-{
-    static uint32_t previousMillis = 0;
-
-    if (millis() - previousMillis >= 100)
-    {
-        sendCANDebugMessage();
-        previousMillis = millis();
-    }
-}
 /**
  * @brief Processes CAN messages to determine the wheel speed based on the configured CAN source.
  *
@@ -115,6 +100,16 @@ uint32_t Process_CAN_WheelSpeed()
         MaintainDTC(DTC_NO_CAN_SIGNAL, (millis() > lastRecTimestamp + 10000 ? true : false));
     }
 
+#ifdef CAN_DEBUG_MESSAGE
+    static uint32_t previousMillis = 0;
+
+    if (millis() - previousMillis >= 1000)
+    {
+        sendCANDebugMessage();
+        previousMillis = millis();
+    }
+#endif
+
     return milimeters_to_add;
 }