Hands-On: Complete Data Service Implementation

/* Lab: implement three DIDs in AUTOSAR DCM callback pattern */

/* DID 0xF190: Read VIN */
Std_ReturnType Did_F190_Read(Dcm_OpStatusType op, uint8* Data,
                              Dcm_NegativeResponseCodeType* Err)
{
    /* NvM block VIN: 17 bytes ASCII */
    Std_ReturnType r = NvM_ReadBlock(NVM_BLOCK_VIN, Data);
    if (r != E_OK) { *Err = DCM_E_CONDITIONSNOTCORRECT; return E_NOT_OK; }
    return E_OK;
}

/* DID 0x0101: Read oil grade */
Std_ReturnType Did_0101_Read(Dcm_OpStatusType op, uint8* Data,
                              Dcm_NegativeResponseCodeType* Err)
{
    Data[0] = g_oilGrade;  /* application variable; range: 0,5,10,15 */
    return E_OK;
}

/* DID 0x0101: Write oil grade */
Std_ReturnType Did_0101_Write(const uint8* Data, Dcm_OpStatusType op,
                               Dcm_NegativeResponseCodeType* Err)
{
    static const uint8 valid[] = {0, 5, 10, 15};
    for (uint8 i = 0; i < 4; i++) {
        if (Data[0] == valid[i]) {
            g_oilGrade = Data[0];
            NvM_WriteBlock(NVM_BLOCK_OIL_GRADE, Data);
            return E_OK;
        }
    }
    *Err = DCM_E_REQUESTOUTOFRANGE;
    return E_NOT_OK;
}

/* DID 0x0210: IO control (implemented in inputoutputcontrolbyidentifier lesson) */

#!/usr/bin/env python3
# Test all NRC conditions for the three DIDs
import udsoncan
from udsoncan.client import Client

def run_nrc_tests(client):
    results = []

    # Test 1: Write DID in Default Session → NRC 0x25
    client.change_session(udsoncan.services.DiagnosticSessionControl.Session.defaultSession)
    try:
        client.write_data_by_identifier(0x0101, bytes([0x05]))
        results.append(("FAIL", "Write in DS should have returned NRC 0x25"))
    except udsoncan.exceptions.NegativeResponseException as e:
        code = "PASS" if e.response.code == 0x25 else f"FAIL (got NRC 0x{e.response.code:02X})"
        results.append((code, "Write DID in Default Session → NRC 0x25"))

    # Enter Extended Session (no security yet)
    client.change_session(udsoncan.services.DiagnosticSessionControl.Session.extendedDiagnosticSession)

    # Test 2: Write DID without Security → NRC 0x33
    try:
        client.write_data_by_identifier(0x0101, bytes([0x05]))
        results.append(("FAIL", "Write without security should return NRC 0x33"))
    except udsoncan.exceptions.NegativeResponseException as e:
        code = "PASS" if e.response.code == 0x33 else f"FAIL (got NRC 0x{e.response.code:02X})"
        results.append((code, "Write DID without SecurityAccess → NRC 0x33"))

    # Test 3: Write out-of-range value → NRC 0x31
    # (requires security first — do SecurityAccess 0x27 in actual lab)
    # results.append(run_write_test(client, 0x0101, bytes([0x07]), 0x31, "out-of-range"))

    for status, desc in results:
        print(f"[{status}] {desc}")

#!/usr/bin/env python3
# IO Control lab: verify safety guard rejects control at speed > 10 km/h
import udsoncan
from udsoncan.client import Client

def test_io_control(client):
    # Enter Extended Session + SecurityAccess Level 1 (seed-key exchange)
    client.change_session(udsoncan.services.DiagnosticSessionControl.Session.extendedDiagnosticSession)
    # (SecurityAccess steps skipped here — see security module)

    # Step 1: set simulated speed > 10 km/h via Write DID (lab only)
    client.write_data_by_identifier(0xFFF0, bytes([0x00, 0x32]))  # 50 km/h

    # Step 2: attempt IO control → expect NRC 0x22 (conditions not correct)
    try:
        resp = client.io_control(0x0210, udsoncan.IOMasks(),
                                  control_option_record=bytes([0x03, 0x64]))  # 100%
        print("FAIL: Should have rejected at speed > 10 km/h")
    except udsoncan.exceptions.NegativeResponseException as e:
        print(f"{'PASS' if e.response.code == 0x22 else 'FAIL'}: Speed guard returned NRC 0x{e.response.code:02X}")

    # Step 3: set speed = 0 → IO control should succeed
    client.write_data_by_identifier(0xFFF0, bytes([0x00, 0x00]))  # 0 km/h
    resp = client.io_control(0x0210, udsoncan.IOMasks(),
                              control_option_record=bytes([0x03, 0x50]))  # 80%
    print(f"IO Control at 0 km/h: {'PASS' if resp.positive else 'FAIL'}")

    # Step 4: returnControlToECU
    resp = client.io_control(0x0210, udsoncan.IOMasks(),
                              control_option_record=bytes([0x00]))
    print(f"ReturnControlToECU: {'PASS' if resp.positive else 'FAIL'}")