Merge pull request #87 from frickly-systems/tim/feat/0x14-clear-dtc

driftregion · web-flow · commit 902c172f54f0 · 2025-09-15T09:26:59.000-07:00
add 0x14 ClearDiagnosticInformation
diff --git a/iso14229.c b/iso14229.c
@@ -984,6 +984,29 @@ static UDSErr_t Handle_0x11_ECUReset(UDSServer_t *srv, UDSReq_t *r) {
     return UDS_PositiveResponse;
 }
 
+static UDSErr_t Handle_0x14_ClearDiagnosticInformation(UDSServer_t *srv, UDSReq_t *r) {
+    if (r->recv_len < UDS_0X14_REQ_MIN_LEN) {
+        return NegativeResponse(r, UDS_NRC_IncorrectMessageLengthOrInvalidFormat);
+    }
+
+    r->send_buf[0] = UDS_RESPONSE_SID_OF(kSID_CLEAR_DIAGNOSTIC_INFORMATION);
+    r->send_len = UDS_0X14_RESP_BASE_LEN;
+
+    UDSCDIArgs_t args = {
+        .groupOfDTC = (uint32_t)((r->recv_buf[1] << 16) | (r->recv_buf[2] << 8) | r->recv_buf[3]),
+        .hasMemorySelection = (r->recv_len >= 5),
+        .memorySelection = (r->recv_len >= 5) ? r->recv_buf[4] : 0,
+    };
+
+    UDSErr_t err = EmitEvent(srv, UDS_EVT_ClearDiagnosticInfo, &args);
+
+    if (err != UDS_PositiveResponse) {
+        return NegativeResponse(r, err);
+    }
+
+    return UDS_PositiveResponse;
+}
+
 static uint8_t safe_copy(UDSServer_t *srv, const void *src, uint16_t count) {
     if (srv == NULL) {
         return UDS_NRC_GeneralReject;
@@ -1724,7 +1747,7 @@ static UDSService getServiceForSID(uint8_t sid) {
     case kSID_ECU_RESET:
         return Handle_0x11_ECUReset;
     case kSID_CLEAR_DIAGNOSTIC_INFORMATION:
-        return NULL;
+        return Handle_0x14_ClearDiagnosticInformation;
     case kSID_READ_DTC_INFORMATION:
         return NULL;
     case kSID_READ_DATA_BY_IDENTIFIER:
diff --git a/iso14229.h b/iso14229.h
@@ -301,6 +301,7 @@ typedef enum UDSEvent {
     // Server Event ----------------- Argument Type
     UDS_EVT_DiagSessCtrl,         // UDSDiagSessCtrlArgs_t *
     UDS_EVT_EcuReset,             // UDSECUResetArgs_t *
+    UDS_EVT_ClearDiagnosticInfo,  // UDSCDIArgs_t *
     UDS_EVT_ReadDataByIdent,      // UDSRDBIArgs_t *
     UDS_EVT_ReadMemByAddr,        // UDSReadMemByAddrArgs_t *
     UDS_EVT_CommCtrl,             // UDSCommCtrlArgs_t *
@@ -487,13 +488,15 @@ typedef enum {
 #define UDS_MAX_DIAGNOSTIC_SERVICES 0x7F
 
 #define UDS_RESPONSE_SID_OF(request_sid) ((request_sid) + 0x40)
-#define UDS_REQUEST_SID_OF(response_sid) ((response_sid)-0x40)
+#define UDS_REQUEST_SID_OF(response_sid) ((response_sid) - 0x40)
 
 #define UDS_NEG_RESP_LEN 3U
 #define UDS_0X10_REQ_LEN 2U
 #define UDS_0X10_RESP_LEN 6U
 #define UDS_0X11_REQ_MIN_LEN 2U
 #define UDS_0X11_RESP_BASE_LEN 2U
+#define UDS_0X14_REQ_MIN_LEN 4U
+#define UDS_0X14_RESP_BASE_LEN 1U
 #define UDS_0X23_REQ_MIN_LEN 4U
 #define UDS_0X23_RESP_BASE_LEN 1U
 #define UDS_0X22_RESP_BASE_LEN 1U
@@ -882,6 +885,12 @@ typedef struct {
                                      a UDS_EVT_DoScheduledReset will be issued */
 } UDSECUResetArgs_t;
 
+typedef struct {
+    const uint32_t groupOfDTC;     /*! lower 3 bytes describe the groupOfDTC */
+    const bool hasMemorySelection; /*! `true` when a memory selection byte is present */
+    const uint8_t memorySelection; /*! memorySelection byte (optional) */
+} UDSCDIArgs_t;
+
 typedef struct {
     const uint16_t dataId; /*! RDBI Data Identifier */
     uint8_t (*copy)(UDSServer_t *srv, const void *src,
diff --git a/src/server.c b/src/server.c
@@ -120,6 +120,29 @@ static UDSErr_t Handle_0x11_ECUReset(UDSServer_t *srv, UDSReq_t *r) {
     return UDS_PositiveResponse;
 }
 
+static UDSErr_t Handle_0x14_ClearDiagnosticInformation(UDSServer_t *srv, UDSReq_t *r) {
+    if (r->recv_len < UDS_0X14_REQ_MIN_LEN) {
+        return NegativeResponse(r, UDS_NRC_IncorrectMessageLengthOrInvalidFormat);
+    }
+
+    r->send_buf[0] = UDS_RESPONSE_SID_OF(kSID_CLEAR_DIAGNOSTIC_INFORMATION);
+    r->send_len = UDS_0X14_RESP_BASE_LEN;
+
+    UDSCDIArgs_t args = {
+        .groupOfDTC = (uint32_t)((r->recv_buf[1] << 16) | (r->recv_buf[2] << 8) | r->recv_buf[3]),
+        .hasMemorySelection = (r->recv_len >= 5),
+        .memorySelection = (r->recv_len >= 5) ? r->recv_buf[4] : 0,
+    };
+
+    UDSErr_t err = EmitEvent(srv, UDS_EVT_ClearDiagnosticInfo, &args);
+
+    if (err != UDS_PositiveResponse) {
+        return NegativeResponse(r, err);
+    }
+
+    return UDS_PositiveResponse;
+}
+
 static uint8_t safe_copy(UDSServer_t *srv, const void *src, uint16_t count) {
     if (srv == NULL) {
         return UDS_NRC_GeneralReject;
@@ -860,7 +883,7 @@ static UDSService getServiceForSID(uint8_t sid) {
     case kSID_ECU_RESET:
         return Handle_0x11_ECUReset;
     case kSID_CLEAR_DIAGNOSTIC_INFORMATION:
-        return NULL;
+        return Handle_0x14_ClearDiagnosticInformation;
     case kSID_READ_DTC_INFORMATION:
         return NULL;
     case kSID_READ_DATA_BY_IDENTIFIER:
diff --git a/src/server.h b/src/server.h
@@ -85,6 +85,12 @@ typedef struct {
                                      a UDS_EVT_DoScheduledReset will be issued */
 } UDSECUResetArgs_t;
 
+typedef struct {
+    const uint32_t groupOfDTC;     /*! lower 3 bytes describe the groupOfDTC */
+    const bool hasMemorySelection; /*! `true` when a memory selection byte is present */
+    const uint8_t memorySelection; /*! memorySelection byte (optional) */
+} UDSCDIArgs_t;
+
 typedef struct {
     const uint16_t dataId; /*! RDBI Data Identifier */
     uint8_t (*copy)(UDSServer_t *srv, const void *src,
diff --git a/src/uds.h b/src/uds.h
@@ -7,6 +7,7 @@ typedef enum UDSEvent {
     // Server Event ----------------- Argument Type
     UDS_EVT_DiagSessCtrl,         // UDSDiagSessCtrlArgs_t *
     UDS_EVT_EcuReset,             // UDSECUResetArgs_t *
+    UDS_EVT_ClearDiagnosticInfo,  // UDSCDIArgs_t *
     UDS_EVT_ReadDataByIdent,      // UDSRDBIArgs_t *
     UDS_EVT_ReadMemByAddr,        // UDSReadMemByAddrArgs_t *
     UDS_EVT_CommCtrl,             // UDSCommCtrlArgs_t *
@@ -193,13 +194,15 @@ typedef enum {
 #define UDS_MAX_DIAGNOSTIC_SERVICES 0x7F
 
 #define UDS_RESPONSE_SID_OF(request_sid) ((request_sid) + 0x40)
-#define UDS_REQUEST_SID_OF(response_sid) ((response_sid)-0x40)
+#define UDS_REQUEST_SID_OF(response_sid) ((response_sid) - 0x40)
 
 #define UDS_NEG_RESP_LEN 3U
 #define UDS_0X10_REQ_LEN 2U
 #define UDS_0X10_RESP_LEN 6U
 #define UDS_0X11_REQ_MIN_LEN 2U
 #define UDS_0X11_RESP_BASE_LEN 2U
+#define UDS_0X14_REQ_MIN_LEN 4U
+#define UDS_0X14_RESP_BASE_LEN 1U
 #define UDS_0X23_REQ_MIN_LEN 4U
 #define UDS_0X23_RESP_BASE_LEN 1U
 #define UDS_0X22_RESP_BASE_LEN 1U
diff --git a/test/test_server.c b/test/test_server.c
