简介面向需要集成车载诊断功能的嵌入式开发人员UDSDemo 内含一套完整的 UDSISO 14229-1协议栈源码。压缩包仅 521KB共 75 个文件以 C 源码为主18 个 .c、17 个 .h另附使用文档、README、工程配置与调试脚本。源码按模块划分清晰涵盖 TP 传输层、网络层、诊断服务与 EEProm 驱动等部分示例工程基于 HCS12 平台演示了 CAN 通信、DTC 读取、内存读写等典型诊断流程并包含用于烧录调试的 cmd 脚本。借助源码可直接理解 UDS 的分层实现、请求与响应处理机制也可参考其中的网络配置、错误处理与重试策略加速向自身项目移植。已有 5705 人学习适合正在开发诊断功能或希望深入掌握 UDS 协议的工程师。1. 能跑起来看的UDS协议栈源码会话管理、ISO-TP、安全访问一把梭先说一个我拆这个包之前的疑问UDS协议栈这东西网上讲流程图的多能下载到完整源码的少。拿到这套UDSDemo之后我第一件事就是在PC上把它跑起来用控制台模拟ECU随手发了几条诊断帧——0x10会话切换、0x27安全访问、0x22按DID读数据——响应字节和ISO 14229-1标准表格里的一模一样。它就是一个基于ISO 14229-1的完整UDS协议栈实现外加一个能独立运行的演示工程覆盖了会话管理、ISO-TP多帧传输、服务分发、DID读写和安全访问这些诊断开发里最啃骨头的部分。适合三类人刚接触车载诊断、想搞懂协议栈怎么组织的嵌入式新人要做BootLoader或诊断应用但手上没有现成协议栈的工程师还有做测试工具、想对照Tester和ECU行为差异的开发。源码不绑定具体芯片把底层的CAN收发抽象层换掉就能嵌进自己的ECU工程。2. 协议栈架构拆解ISO-TP、服务表、会话状态机的三段式设计2.1 目录里的三块职责打开源码包整个工程不是按“一个服务一个文件”来组织的而是按职责分了三个层面传输层、协议处理层、硬件抽象层。传输层负责ISO 15765-2也就是常说的大名鼎鼎的ISO-TP的帧拆装协议处理层管服务分发、会话状态、安全访问、DID表这些UDS核心逻辑硬件抽象层隔离了CAN收发器和定时器。这个分层思路和很多商用协议栈是一致的核心代码不碰硬件换平台只换最底下那一层。我拆过的协议栈里最容易翻车的就是把ISO-TP逻辑和业务服务混在一个文件里写服务一多函数就臭了。这个Demo把uds_iso_tp.c单独拎出来接收状态机、发送缓冲、流控帧处理都收敛在这里上层拿到的已经是完整的诊断请求字节流。目录结构大致是这个样子UDSDemo/ ├── src/ │ ├── uds/ │ │ ├── uds_core.c # 服务分发、正/负响应组装 │ │ ├── uds_sess.c # 会话切换与S3超时状态机 │ │ ├── uds_sec.c # 0x27安全访问、种子密钥校验 │ │ ├── uds_did.c # 0x22/0x2E的DID表管理 │ │ ├── uds_iso_tp.c # ISO 15765-2SF/FF/CF/FC帧处理 │ │ └── uds_config.h # P2/P2*/S3/BS/STmin可配置参数 │ ├── hal/ │ │ ├── hal_can.c # CAN收发抽象层 │ │ └── hal_timer.c # 毫秒级定时器抽象层 │ └── app/ │ ├── main.c # 控制台演示程序模拟ECU │ └── did_table.c # 演示用车辆DID表 └── tools/ └── uds_tester.py # PC端模拟Tester的脚本hal层在这个Demo里是PC实现读键盘输入模拟CAN帧、用系统时钟做定时器。想往STM32、S32K这类MCU上移植的时候只需要把这层实现替换成芯片的CAN驱动和硬件定时器协议栈上层一个字节都不用动。2.2 服务注册表switch-case的替代方案UDS服务有十多个加上各种子功能用switch-case写分发会非常难看。这个Demo用的是服务注册表每个服务一个表项包含SID、子功能掩码、处理函数指针。增加一个服务就是往表格里插一行不需要改动分发函数本身。typedef struct { uint8_t sid; uint8_t sub_fn_mask; /* 0表示该服务不校验子功能 */ bool (*handler)(const uint8_t* req, uint16_t req_len, uint8_t* resp, uint16_t* resp_len); } uds_service_t; static const uds_service_t svc_table[] { { 0x10, 0x03, uds_svc_session_control }, /* 会话切换支持3种子功能 */ { 0x11, 0x00, uds_svc_ecu_reset }, /* ECU复位不做子功能预校验 */ { 0x22, 0x00, uds_svc_read_did }, /* 按DID读数据 */ { 0x27, 0x00, uds_svc_security_access }, /* 安全访问 */ { 0x2E, 0x00, uds_svc_write_did }, /* 按DID写数据 */ { 0x31, 0x00, uds_svc_routine_control }, /* 例程控制 */ { 0x3E, 0x01, uds_svc_tester_present }, /* 测试仪在线子功能固定0x01 */ }; static const uds_service_t* find_service(uint8_t sid) { for (uint32_t i 0; i sizeof(svc_table)/sizeof(svc_table[0]); i) { if (svc_table[i].sid sid) { return svc_table[i]; } } return NULL; }handler统一返回bool返回true表示响应缓冲区里已经是正响应返回false表示协议栈内部已经把负响应码填进去了。调用方不需要关心每种服务的差异这为后面做日志、做0x78的P2超时处理留了统一的切入点。2.3 会话状态机S3超时怎么把ECU拉回默认会话会话管理是UDS里最容易理解错的地方。协议栈维护一个当前会话变量默认会话0x01、编程会话0x03、扩展会话0x02。非默认会话都有一个S3超时定时器在超时时间内没有收到任何诊断请求ECU必须自动跳回默认会话同时清掉安全访问状态。这个Demo把会话动作收在uds_sess.c里对外暴露两个接口uds_sess_tick和uds_sess_set。static uint8_t cur_session SESS_DEFAULT; static uint32_t s3_deadline_ms; static uint32_t last_rx_ms; void uds_sess_tick(void) { /* 只有非默认会话才需要计时 */ if (cur_session SESS_DEFAULT) { return; } if (hal_timer_get_ms() - last_rx_ms cfg.s3_timeout_ms) { cur_session SESS_DEFAULT; uds_sec_reset(); /* 安全状态同步清零 */ /* 这里可以加一个钩子通知应用层会话被重置 */ } } void uds_sess_set(uint8_t session) { cur_session session; last_rx_ms hal_timer_get_ms(); }这里有一个所有UDS实现都躲不开的细节S3计时用的是“相对时间差”而不是绝对时间点避免溢出问题。如果直接存last_rx_ms timeout当毫秒计数器回绕时会算出错。源码里统一用差值比较这个是嵌入式时间处理的常规写法。2.4 ISO-TP接收状态机从SF到CF的缓冲管理ISO-TP也就是ISO 15765-2解决的是CAN单帧最多8字节、但诊断请求往往超过8字节的问题。单帧SF直接装数据多帧由首帧FF、连续帧CF和流控帧FC配合完成。这个Demo的接收状态机写得比较典型支持最大4095字节的报文重组。typedef struct { uint8_t state; /* IDLE / WAIT_CF */ uint8_t buf[4095]; uint16_t total_len; uint16_t received_len; uint8_t cf_seq; } isotp_rx_t; static uint16_t isotp_rx_process(isotp_rx_t* rx, const uint8_t* frame, uint16_t len, uint8_t* out) { uint8_t pci frame[0] 0xF0; if (pci 0x00) { /* 单帧 */ uint8_t n frame[0] 0x0F; memcpy(out, frame[1], n); return n; } if (pci 0x10) { /* 首帧12位长度 */ rx-total_len ((frame[0] 0x0F) 8) | frame[1]; rx-received_len 0; rx-cf_seq 1; memcpy(rx-buf, frame[2], 6); /* 首帧最多带6字节数据 */ rx-received_len 6; rx-state 1; /* 进入等待连续帧状态 */ return 0; } if (pci 0x20) { /* 连续帧 */ uint8_t seq frame[0] 0x0F; if (seq ! rx-cf_seq) { rx-state 0; /* 序号错乱丢弃整个报文 */ return 0; } memcpy(rx-buf rx-received_len, frame[1], 7); rx-received_len 7; rx-cf_seq (rx-cf_seq % 15) 1; /* 序号1~15循环 */ if (rx-received_len rx-total_len) { memcpy(out, rx-buf, rx-total_len); rx-state 0; return rx-total_len; } } return 0; }连续帧序号不是0到15而是1到15然后回到1这是ISO-TP里最容易写错的地方。很多自己实现的工具把序号从0开始导致ECU一直回NRC。这套状态机还有一点做得比较稳帧序号错乱时不硬凑直接把整个报文丢弃防止半个请求进入上层协议栈。3. 核心链路走读一个0x22 0xF190请求从CAN帧到正响应返回3.1 请求怎么进来的假设诊断仪想读VIN码DID是0xF190。应用层请求是三个字节0x22 0xF1 0x90。走CAN总线时这三个字节被包在ISO-TP单帧里CAN数据场的第一个字节是PCI高四位0x00表示单帧低四位0x03表示后面跟着3个字节数据。所以总线上实际发的是0x03 0x22 0xF1 0x90。CAN驱动收到这个帧之后调用isotp_rx_process把完整请求22 F1 90提取出来再交给uds_process_request。如果请求超过7字节就会走首帧、流控帧、连续帧流程但最终交给协议栈的应用层数据是一样的——这个就是传输层的价值。3.2 服务分发层做了什么uds_process_request是协议栈的总入口做的事情是按SID查表、校验子功能、调用对应的handler。我把这个函数的精简版拿出来了uint16_t uds_process_request(const uint8_t* req, uint16_t req_len, uint8_t* resp) { uint16_t resp_len 0; const uds_service_t* svc find_service(req[0]); if (svc NULL) { /* 0x11: 服务不支持 */ uds_build_nrc(resp, resp_len, req[0], NRC_SERVICE_NOT_SUPPORTED); return resp_len; } /* 带子功能参数的服务先做长度预检 */ if (svc-sub_fn_mask ! 0 req_len 2) { uds_build_nrc(resp, resp_len, req[0], NRC_INCORRECT_MSG_LENGTH); return resp_len; } if (!svc-handler(req, req_len, resp, resp_len)) { /* handler内部已经填好NRCresp_len已经更新 */ } return resp_len; }参数req是ISO-TP层解出来的完整请求resp是协议栈内部的响应缓冲区最后返回响应长度。注意一个细节负响应报文格式是0x7F 请求的SID NRC所以uds_build_nrc需要把原来的SID传进去而不能自己假设SID是0x10或者0x22。3.3 DID表查找与权限判断0x22服务的handler在uds_did.c里它首先要做长度检查——请求必须是0x22 2字节DID一共4字节。然后查DID表命中之后还要看权限这个DID允不允许读、需不需要安全访问等级。源码里DID表是一个结构体数组typedef struct { uint16_t did; uint8_t len; uint8_t read_perm; uint8_t write_perm; uint8_t sec_level; /* 0表示无需安全访问 */ uint8_t* data; } did_info_t; static did_info_t did_table[] { { 0xF190, 17, 1, 0, 0, (uint8_t*)vin_buf }, /* VIN码 */ { 0xF187, 16, 1, 0, 0, (uint8_t*)part_number }, /* 零件号 */ { 0xF191, 4, 1, 0, 0, (uint8_t*)hw_version }, /* 硬件版本 */ { 0x1010, 18, 0, 1, 2, (uint8_t*)new_vin_buf }, /* 写入需要2级安全 */ }; static bool uds_svc_read_did(const uint8_t* req, uint16_t req_len, uint8_t* resp, uint16_t* resp_len) { if (req_len ! 4) { uds_build_nrc(resp, resp_len, req[0], NRC_INCORRECT_MSG_LENGTH); return false; } uint16_t did (req[1] 8) | req[2]; did_info_t* info find_did(did); if (info NULL || !info-read_perm) { uds_build_nrc(resp, resp_len, req[0], NRC_REQUEST_OUT_OF_RANGE); return false; } if (info-sec_level !uds_sec_authorized(info-sec_level)) { uds_build_nrc(resp, resp_len, req[0], NRC_SECURITY_ACCESS_DENIED); return false; } resp[0] 0x62; /* 正响应SID 请求SID 0x40 */ resp[1] req[1]; resp[2] req[2]; memcpy(resp[3], info-data, info-len); *resp_len 3 info-len; return true; }sec_level字段的用意是不同DID可以要求不同等级的安全访问。比如读VIN不需要安全但刷写VIN必须先过0x27安全访问。协议栈不关心业务细节只负责在查表的时候比对等级权限判断的逻辑收在DID表配置里改权限不需要动代码。正响应SID是请求SID加0x400x22 → 0x62、0x10 → 0x50、0x27 → 0x67这个映射关系在14229-1里是固定的。3.4 0x27安全访问的seed-key交换读DID那条链路里提到的安全等级靠的就是0x27服务来解锁。0x27有多个子功能奇数子功能请求种子、偶数子功能校验密钥。Demo里实现的流程是Tester发0x27 0x01ECU返回一段seedTester拿着seed算key再发0x27 0x02 keyECU比对后决定解锁还是回0x35。static uint8_t attempt_count; static bool uds_svc_security_access(const uint8_t* req, uint16_t req_len, uint8_t* resp, uint16_t* resp_len) { if (req_len 2) { uds_build_nrc(resp, resp_len, req[0], NRC_INCORRECT_MSG_LENGTH); return false; } uint8_t sub req[1]; if (sub 0x01) { if (attempt_count 3) { uds_build_nrc(resp, resp_len, req[0], NRC_EXCEEDED_ATTEMPTS); return false; } uint8_t* seed; uint8_t seed_len uds_sec_get_seed(seed); resp[0] 0x67; resp[1] 0x01; memcpy(resp[2], seed, seed_len); *resp_len 2 seed_len; return true; } if (sub 0x02) { bool ok uds_sec_compare_key(req[2], req_len - 2); if (!ok) { attempt_count; uds_build_nrc(resp, resp_len, req[0], NRC_INVALID_KEY); return false; } attempt_count 0; uds_sec_unlock(1); /* 解锁等级1 */ resp[0] 0x67; resp[1] 0x02; *resp_len 2; return true; } uds_build_nrc(resp, resp_len, req[0], NRC_SUB_FUNCTION_NOT_SUPPORTED); return false; }种子生成和密钥比较分别封装成uds_sec_get_seed和uds_sec_compare_key这两个函数是协议栈里留给开发者的改接口。常见做法是seed由伪随机数加时间戳生成key用自定义查表算法或者硬件加密模块计算。换算法只动这两个函数协议栈流程不用改。尝试次数限制也在这个服务内部维护超过3次就回0x36这个对防止暴力尝试很有必要。3.5 请求和响应的对照关系把这几个模块串起来一次完整的0x22读VIN操作在总线上的报文应该是这样方向CAN数据场说明Tester → ECU03 22 F1 90单帧请求读DID 0xF190ECU → Tester14 62 F1 90 31 32 33 …首帧连续帧正响应SID 0x62ECU → Tester30 00 14流控帧允许发送Tester → ECU21 34 35 36 …连续帧序号从1开始递增多帧响应的编排逻辑在uds_iso_tp.c的发送侧协议栈先把完整响应数据放进发送缓冲然后按ISO-TP规则切成FF和CF逐帧发出。可以看到传输层把一条逻辑上的诊断报文拆成了好几条CAN帧对上下层都是透明的。4. 编译运行与联调PC控制台和USB-CAN两种模式4.1 编译成PC模拟器这个Demo做得比较讨喜的一点是它不是一个只能在开发板上跑的源码包而是自带了一个控制台模拟ECU程序。编译只需要CMake加一个支持C99的编译器Windows上用MinGWLinux/macOS上直接用gcc。mkdir -p build cd build cmake .. -DCMAKE_BUILD_TYPERelease make -j4 ./uds_demo启动之后程序进入一个交互式控制台提示符等着你输入十六进制诊断帧。比如输入03 22 F1 90回车程序会返回响应的十六进制字节。这里的输入模拟的是CAN数据场的完整内容第一个字节是ISO-TP的PCI后面是UDS请求。对于第一次接触UDS的人用它来验证自己对ISO-TP帧格式的理解是最直观的——不用买CAN盒、不用接ECU装了就能玩。4.2 用Python脚本模拟Tester控制台手动输入适合验证单条请求但测起来太慢。我习惯用tools/uds_tester.py这个脚本快速发一整轮诊断流程脚本核心逻辑是这样的def uds_request_sf(tx_id, rx_id, payload: bytes) - bytes: # 单帧:PCI 0x0N, N 数据长度 frame bytes([0x00 | len(payload)]) payload can_send(tx_id, frame) resp_frame can_recv(rx_id, timeout1.0) return parse_isotp(resp_frame) # 一个标准的解锁流程 req bytes([0x10, 0x03]) # 切换到扩展会话 resp uds_request_sf(0x7E0, 0x7E8, req) resp uds_request_sf(0x7E0, 0x7E8, bytes([0x27, 0x01])) seed resp[2:] key seed_key_algorithm(seed) resp uds_request_sf(0x7E0, 0x7E8, bytes([0x27, 0x02]) key)脚本里can_send和can_recv是对底层接口的封装。如果只是在PC上跑模拟器这两个函数可以改为向控制台程序的stdin写入、从stdout读取如果接USB-CAN盒子则替换成盒子的动态库调用。无论哪种方式0x7E0是诊断请求的CAN ID0x7E8是ECU响应的CAN ID这是诊断规范里常用的物理寻址ID。4.3 接真实CAN总线时的注意点把协议栈跑到真实总线上需要把hals层从PC模拟切到USB-CAN。需要注意CAN盒子的帧格式和波特率。诊断通信一般用500kbps或者250kbpsCAN ID标准帧就够了但有些车型会用29位扩展帧。协议栈的hal_can_read和hal_can_write接口签名是固定配好的bool hal_can_init(uint16_t baudrate, bool use_ext_id); bool hal_can_write(uint32_t can_id, const uint8_t* data, uint8_t len); bool hal_can_read(uint32_t* can_id, uint8_t* data, uint8_t* len);改成USB-CAN驱动的时候把这些函数体内的实现换成对应盒子的接收发送API。推荐先用总线报文分析工具抓一遍自己发出去的ISO-TP帧确认PCI和连续帧序号正确再连真实的ECU免得两边协议不一致排查困难。4.4 协议栈参数表uds_config.h是所有时间参数和传输参数集中的地方跑不同项目调参基本只动这个文件。参数常用值含义P2_TIMEOUT_MS50服务处理超时超时后应发0x78P2_STAR_TIMEOUT_MS5000P2*超时用于耗时服务S3_TIMEOUT_MS5000非默认会话超时BLOCK_SIZE0流控帧的BS0表示连续帧可一直发STMIN_MS10连续帧最小间隔防止ECU接收不过来MAX_ATTEMPT_COUNT3安全访问最大重试次数STMIN这个参数在有些工程里容易踩坑它是ECU要求Tester每帧连续帧之间的最小时间间隔。如果ECU接收缓冲处理不过来把这个值调大到20ms或50ms如果追求吞吐调成0。但0不代表没有间隔而是代表Tester端可以背靠背发送这就很考验驱动质量了。5. UDS调试避坑指南五个让Tester和ECU对不上号的场景5.1 切完会话紧接着发0x27收到0x24请求序列错误现象诊断仪先发0x10 0x03切换扩展会话正响应还没完全处理完就立刻发0x27 0x01ECU回了0x24requestSequenceError。原因底层ISO-TP是多帧收发0x10的响应可能还没发完下一个请求已经到了协议栈状态机还没回到IDLE。或者应用层做会话切换后没有重置S3计时导致协议栈认为当前还在默认会话安全访问没被允许。解决诊断仪侧要严格按照“请求-等待响应-再发下一帧”的节奏来不要连续背靠背发。ECU侧在uds_sess_set里务必重置S3时间戳并且等响应帧全部发完再设置状态为空闲。我一般在Tester脚本里每条请求后强制wait固定响应时间再发下一条实测对绝大多数ECU都稳。5.2 连续帧序号对不上多帧报文接收超时现象诊断仪发一个超过7字节的请求总线报文分析工具上看FF和CF都发出去了但ECU响应超时或者收到不完整。原因ISO-TP的连续帧序号是1到15循环序号为15之后下一帧回到1。我见过写成0到15、也见过到16才回绕的实现这两种都会和标准协议栈对不上。解决先抓总线报文看CF帧的PCI字节低四位是不是从1开始按15循环。如果从0开始判定原因后直接把序号计算改成(seq % 15) 1就行。这个问题最容易发生在自己写的测试工具里ECU协议栈一般不会错。5.3 0x22 F190返回0x13而不是0x31现象请求0x22 0xF1 0x90期望是DID不存在或者不可读结果返回0x13长度错误。原因handler里先做了严格长度校验req_len ! 4然后才查DID表。如果工具发送时多带了一个字节或者把DID的高低位写反成了0x90 0xF1协议栈在查表之前就被长度检查拦住了自然会回0x13而不会回0x31。解决排查时先看请求字节数是不是正好4字节。如果长度无误仍然0x13去检查发送端是否有字节序转换问题。0x22的DID参数是大端模式0xF190要发成F1 90而不是90 F1这一条就能排除掉一大半的“假NRC”。5.4 Flash擦除期间没有发0x78Tester端直接超时断开现象执行例程控制0x31刷写Flash擦除需要几秒但ECU没有在P2超时之前发任何帧Tester报超时。原因P2默认是50msP2*是5000ms。耗时操作超过了P2协议栈必须在P2超时前发出0x78responsePending然后每隔一段时间再发一次0x78直到操作完成。如果没有这个机制Tester会认为ECU掉线了。解决在耗时服务的handler里先把0x78发出去操作完成后再发最终的正响应。常规做法是把耗时操作拆成任务协议栈主循环持续发送0x78。看到0x78别当成错误它是UDS里“我正在干活别急”的标准答复。如果Tester端很快断开多半是0x78的重复发送间隔超过了P2*。5.5 安全访问成功后重启Tester工具再访问还是0x33现象0x27流程走通了正响应也收到了但换了一台电脑的工具或者重启工具软件之后再发受限服务仍然回0x33。原因安全访问状态存在ECU的RAM里会话重置或ECU复位之后会清掉。更重要的是工具侧可能把安全解锁状态缓存了以为不用重新解锁。按ISO 14229-1的设计安全状态和当前会话绑定会话一旦重置安全等级必须重新申请。解决ECU侧确认在S3超时、ECU复位、会话切换的时候调用uds_sec_reset清状态。Tester侧每次重启之后重新走一遍0x10 0x03加0x27的流程。想验证是不是这个原因可以发一条0x3E保活看ECU回不回如果不回就是S3已经超时了。6. 二次开发自定义0x31例程并移植到自己的MCU工程6.1 在DID表之外扩展自己的例程0x31例程控制是刷写类BootLoader里用得最多的服务它的结构是SID 子功能 RID例程标识符 可选参数。比如加一个“擦除Flash扇区”的例程RID定义成0x0203。改动点很集中先在uds_routine.c里加RID表typedef void (*routine_fn_t)(const uint8_t* param, uint8_t param_len); static const struct { uint16_t rid; routine_fn_t start; } routine_table[] { { 0x0203, routine_erase_flash }, }; static bool uds_svc_routine_control(const uint8_t* req, uint16_t req_len, uint8_t* resp, uint16_t* resp_len) { if (req_len 4) { uds_build_nrc(resp, resp_len, req[0], NRC_INCORRECT_MSG_LENGTH); return false; } uint16_t rid (req[2] 8) | req[3]; for (int i 0; i sizeof(routine_table)/sizeof(routine_table[0]); i) { if (routine_table[i].rid rid) { routine_table[i].start(req[4], req_len - 4); resp[0] 0x71; resp[1] req[1]; /* 回显子功能 */ resp[2] req[2]; resp[3] req[3]; *resp_len 4; return true; } } uds_build_nrc(resp, resp_len, req[0], NRC_REQUEST_OUT_OF_RANGE); return false; }新增例程不需要改分发逻辑只需要在routine_table里加一行、实现一个函数。RID的参数解析在函数内部自己做比如routine_erase_flash读取参数里的起始地址和长度然后调用BootLoader的Flash驱动。这种表驱动设计是协议栈类代码的标准做法扩展起来不用翻动原有代码。6.2 移植到真实ECU工程时先换这四个接口我在一次项目里把这个协议栈从PC模拟器挪到某MCU上真正要改的只有四个地方CAN收发、定时器、字节序、内存分配。CAN和定时器是hal层的事字节序靠编码规范约束内存分配建议直接用静态缓冲。移植的验证顺序我一般这样走先用回环模式把ECU的ISO-TP自发自收跑通再连真实Tester跑0x3E保活和0x22读DID都通过之后才碰0x27和0x31刷写流程。一步到位接BootLoader会很难定位是哪一层出的问题。hal层替换的一个参考示例bool hal_can_write(uint32_t can_id, const uint8_t* data, uint8_t len) { can_tx_frame_t f {0}; f.id can_id; f.dlc len; memcpy(f.data, data, len); return my_mcu_can_send(f); } bool hal_can_read(uint32_t* can_id, uint8_t* data, uint8_t* len) { can_rx_frame_t f; if (!my_mcu_can_recv(f, 0)) { return false; } *can_id f.id; *len f.dlc; memcpy(data, f.data, f.dlc); return true; }替换之后重点检查CAN ID是标准帧还是扩展帧、DLC是8还是64支持CAN FD的话以及CAN控制器的接收中断里是否需要加FIFO锁。常见翻车点是在中断里直接调用协议栈处理函数导致嵌套过深我习惯把帧先塞到环形缓冲主循环里再喂给ISO-TP层。6.3 改动后的验证清单每次改完协议栈我会强制自己走一遍这个验证序列0x3E tester present必须回0x7E0x10切扩展会话、超时后必须回默认会话未解锁时访问受限DID必须回0x330x27流程正确加解锁后再次访问必须成功超过7字节的多帧请求必须完整收发所有非法SID回0x11。这六条能通过这个协议栈基本就是可用的剩下的就是各车型的DID权限配置差异了。从那以后我每把这份协议栈往新工程里放都会先跑一遍这六条再决定要不要碰上层应用。UDS调试很多时候不是协议栈本身有问题而是时序、权限、帧格式没对齐验证清单能在十分钟内把所有基础问题暴露出来。希望帮到你。本文还有配套的精品资源点击获取
简介面向需要集成车载诊断功能的嵌入式开发人员UDSDemo 内含一套完整的 UDSISO 14229-1协议栈源码。压缩包仅 521KB共 75 个文件以 C 源码为主18 个 .c、17 个 .h另附使用文档、README、工程配置与调试脚本。源码按模块划分清晰涵盖 TP 传输层、网络层、诊断服务与 EEProm 驱动等部分示例工程基于 HCS12 平台演示了 CAN 通信、DTC 读取、内存读写等典型诊断流程并包含用于烧录调试的 cmd 脚本。借助源码可直接理解 UDS 的分层实现、请求与响应处理机制也可参考其中的网络配置、错误处理与重试策略加速向自身项目移植。已有 5705 人学习适合正在开发诊断功能或希望深入掌握 UDS 协议的工程师。1. 能跑起来看的UDS协议栈源码会话管理、ISO-TP、安全访问一把梭先说一个我拆这个包之前的疑问UDS协议栈这东西网上讲流程图的多能下载到完整源码的少。拿到这套UDSDemo之后我第一件事就是在PC上把它跑起来用控制台模拟ECU随手发了几条诊断帧——0x10会话切换、0x27安全访问、0x22按DID读数据——响应字节和ISO 14229-1标准表格里的一模一样。它就是一个基于ISO 14229-1的完整UDS协议栈实现外加一个能独立运行的演示工程覆盖了会话管理、ISO-TP多帧传输、服务分发、DID读写和安全访问这些诊断开发里最啃骨头的部分。适合三类人刚接触车载诊断、想搞懂协议栈怎么组织的嵌入式新人要做BootLoader或诊断应用但手上没有现成协议栈的工程师还有做测试工具、想对照Tester和ECU行为差异的开发。源码不绑定具体芯片把底层的CAN收发抽象层换掉就能嵌进自己的ECU工程。2. 协议栈架构拆解ISO-TP、服务表、会话状态机的三段式设计2.1 目录里的三块职责打开源码包整个工程不是按“一个服务一个文件”来组织的而是按职责分了三个层面传输层、协议处理层、硬件抽象层。传输层负责ISO 15765-2也就是常说的大名鼎鼎的ISO-TP的帧拆装协议处理层管服务分发、会话状态、安全访问、DID表这些UDS核心逻辑硬件抽象层隔离了CAN收发器和定时器。这个分层思路和很多商用协议栈是一致的核心代码不碰硬件换平台只换最底下那一层。我拆过的协议栈里最容易翻车的就是把ISO-TP逻辑和业务服务混在一个文件里写服务一多函数就臭了。这个Demo把uds_iso_tp.c单独拎出来接收状态机、发送缓冲、流控帧处理都收敛在这里上层拿到的已经是完整的诊断请求字节流。目录结构大致是这个样子UDSDemo/ ├── src/ │ ├── uds/ │ │ ├── uds_core.c # 服务分发、正/负响应组装 │ │ ├── uds_sess.c # 会话切换与S3超时状态机 │ │ ├── uds_sec.c # 0x27安全访问、种子密钥校验 │ │ ├── uds_did.c # 0x22/0x2E的DID表管理 │ │ ├── uds_iso_tp.c # ISO 15765-2SF/FF/CF/FC帧处理 │ │ └── uds_config.h # P2/P2*/S3/BS/STmin可配置参数 │ ├── hal/ │ │ ├── hal_can.c # CAN收发抽象层 │ │ └── hal_timer.c # 毫秒级定时器抽象层 │ └── app/ │ ├── main.c # 控制台演示程序模拟ECU │ └── did_table.c # 演示用车辆DID表 └── tools/ └── uds_tester.py # PC端模拟Tester的脚本hal层在这个Demo里是PC实现读键盘输入模拟CAN帧、用系统时钟做定时器。想往STM32、S32K这类MCU上移植的时候只需要把这层实现替换成芯片的CAN驱动和硬件定时器协议栈上层一个字节都不用动。2.2 服务注册表switch-case的替代方案UDS服务有十多个加上各种子功能用switch-case写分发会非常难看。这个Demo用的是服务注册表每个服务一个表项包含SID、子功能掩码、处理函数指针。增加一个服务就是往表格里插一行不需要改动分发函数本身。typedef struct { uint8_t sid; uint8_t sub_fn_mask; /* 0表示该服务不校验子功能 */ bool (*handler)(const uint8_t* req, uint16_t req_len, uint8_t* resp, uint16_t* resp_len); } uds_service_t; static const uds_service_t svc_table[] { { 0x10, 0x03, uds_svc_session_control }, /* 会话切换支持3种子功能 */ { 0x11, 0x00, uds_svc_ecu_reset }, /* ECU复位不做子功能预校验 */ { 0x22, 0x00, uds_svc_read_did }, /* 按DID读数据 */ { 0x27, 0x00, uds_svc_security_access }, /* 安全访问 */ { 0x2E, 0x00, uds_svc_write_did }, /* 按DID写数据 */ { 0x31, 0x00, uds_svc_routine_control }, /* 例程控制 */ { 0x3E, 0x01, uds_svc_tester_present }, /* 测试仪在线子功能固定0x01 */ }; static const uds_service_t* find_service(uint8_t sid) { for (uint32_t i 0; i sizeof(svc_table)/sizeof(svc_table[0]); i) { if (svc_table[i].sid sid) { return svc_table[i]; } } return NULL; }handler统一返回bool返回true表示响应缓冲区里已经是正响应返回false表示协议栈内部已经把负响应码填进去了。调用方不需要关心每种服务的差异这为后面做日志、做0x78的P2超时处理留了统一的切入点。2.3 会话状态机S3超时怎么把ECU拉回默认会话会话管理是UDS里最容易理解错的地方。协议栈维护一个当前会话变量默认会话0x01、编程会话0x03、扩展会话0x02。非默认会话都有一个S3超时定时器在超时时间内没有收到任何诊断请求ECU必须自动跳回默认会话同时清掉安全访问状态。这个Demo把会话动作收在uds_sess.c里对外暴露两个接口uds_sess_tick和uds_sess_set。static uint8_t cur_session SESS_DEFAULT; static uint32_t s3_deadline_ms; static uint32_t last_rx_ms; void uds_sess_tick(void) { /* 只有非默认会话才需要计时 */ if (cur_session SESS_DEFAULT) { return; } if (hal_timer_get_ms() - last_rx_ms cfg.s3_timeout_ms) { cur_session SESS_DEFAULT; uds_sec_reset(); /* 安全状态同步清零 */ /* 这里可以加一个钩子通知应用层会话被重置 */ } } void uds_sess_set(uint8_t session) { cur_session session; last_rx_ms hal_timer_get_ms(); }这里有一个所有UDS实现都躲不开的细节S3计时用的是“相对时间差”而不是绝对时间点避免溢出问题。如果直接存last_rx_ms timeout当毫秒计数器回绕时会算出错。源码里统一用差值比较这个是嵌入式时间处理的常规写法。2.4 ISO-TP接收状态机从SF到CF的缓冲管理ISO-TP也就是ISO 15765-2解决的是CAN单帧最多8字节、但诊断请求往往超过8字节的问题。单帧SF直接装数据多帧由首帧FF、连续帧CF和流控帧FC配合完成。这个Demo的接收状态机写得比较典型支持最大4095字节的报文重组。typedef struct { uint8_t state; /* IDLE / WAIT_CF */ uint8_t buf[4095]; uint16_t total_len; uint16_t received_len; uint8_t cf_seq; } isotp_rx_t; static uint16_t isotp_rx_process(isotp_rx_t* rx, const uint8_t* frame, uint16_t len, uint8_t* out) { uint8_t pci frame[0] 0xF0; if (pci 0x00) { /* 单帧 */ uint8_t n frame[0] 0x0F; memcpy(out, frame[1], n); return n; } if (pci 0x10) { /* 首帧12位长度 */ rx-total_len ((frame[0] 0x0F) 8) | frame[1]; rx-received_len 0; rx-cf_seq 1; memcpy(rx-buf, frame[2], 6); /* 首帧最多带6字节数据 */ rx-received_len 6; rx-state 1; /* 进入等待连续帧状态 */ return 0; } if (pci 0x20) { /* 连续帧 */ uint8_t seq frame[0] 0x0F; if (seq ! rx-cf_seq) { rx-state 0; /* 序号错乱丢弃整个报文 */ return 0; } memcpy(rx-buf rx-received_len, frame[1], 7); rx-received_len 7; rx-cf_seq (rx-cf_seq % 15) 1; /* 序号1~15循环 */ if (rx-received_len rx-total_len) { memcpy(out, rx-buf, rx-total_len); rx-state 0; return rx-total_len; } } return 0; }连续帧序号不是0到15而是1到15然后回到1这是ISO-TP里最容易写错的地方。很多自己实现的工具把序号从0开始导致ECU一直回NRC。这套状态机还有一点做得比较稳帧序号错乱时不硬凑直接把整个报文丢弃防止半个请求进入上层协议栈。3. 核心链路走读一个0x22 0xF190请求从CAN帧到正响应返回3.1 请求怎么进来的假设诊断仪想读VIN码DID是0xF190。应用层请求是三个字节0x22 0xF1 0x90。走CAN总线时这三个字节被包在ISO-TP单帧里CAN数据场的第一个字节是PCI高四位0x00表示单帧低四位0x03表示后面跟着3个字节数据。所以总线上实际发的是0x03 0x22 0xF1 0x90。CAN驱动收到这个帧之后调用isotp_rx_process把完整请求22 F1 90提取出来再交给uds_process_request。如果请求超过7字节就会走首帧、流控帧、连续帧流程但最终交给协议栈的应用层数据是一样的——这个就是传输层的价值。3.2 服务分发层做了什么uds_process_request是协议栈的总入口做的事情是按SID查表、校验子功能、调用对应的handler。我把这个函数的精简版拿出来了uint16_t uds_process_request(const uint8_t* req, uint16_t req_len, uint8_t* resp) { uint16_t resp_len 0; const uds_service_t* svc find_service(req[0]); if (svc NULL) { /* 0x11: 服务不支持 */ uds_build_nrc(resp, resp_len, req[0], NRC_SERVICE_NOT_SUPPORTED); return resp_len; } /* 带子功能参数的服务先做长度预检 */ if (svc-sub_fn_mask ! 0 req_len 2) { uds_build_nrc(resp, resp_len, req[0], NRC_INCORRECT_MSG_LENGTH); return resp_len; } if (!svc-handler(req, req_len, resp, resp_len)) { /* handler内部已经填好NRCresp_len已经更新 */ } return resp_len; }参数req是ISO-TP层解出来的完整请求resp是协议栈内部的响应缓冲区最后返回响应长度。注意一个细节负响应报文格式是0x7F 请求的SID NRC所以uds_build_nrc需要把原来的SID传进去而不能自己假设SID是0x10或者0x22。3.3 DID表查找与权限判断0x22服务的handler在uds_did.c里它首先要做长度检查——请求必须是0x22 2字节DID一共4字节。然后查DID表命中之后还要看权限这个DID允不允许读、需不需要安全访问等级。源码里DID表是一个结构体数组typedef struct { uint16_t did; uint8_t len; uint8_t read_perm; uint8_t write_perm; uint8_t sec_level; /* 0表示无需安全访问 */ uint8_t* data; } did_info_t; static did_info_t did_table[] { { 0xF190, 17, 1, 0, 0, (uint8_t*)vin_buf }, /* VIN码 */ { 0xF187, 16, 1, 0, 0, (uint8_t*)part_number }, /* 零件号 */ { 0xF191, 4, 1, 0, 0, (uint8_t*)hw_version }, /* 硬件版本 */ { 0x1010, 18, 0, 1, 2, (uint8_t*)new_vin_buf }, /* 写入需要2级安全 */ }; static bool uds_svc_read_did(const uint8_t* req, uint16_t req_len, uint8_t* resp, uint16_t* resp_len) { if (req_len ! 4) { uds_build_nrc(resp, resp_len, req[0], NRC_INCORRECT_MSG_LENGTH); return false; } uint16_t did (req[1] 8) | req[2]; did_info_t* info find_did(did); if (info NULL || !info-read_perm) { uds_build_nrc(resp, resp_len, req[0], NRC_REQUEST_OUT_OF_RANGE); return false; } if (info-sec_level !uds_sec_authorized(info-sec_level)) { uds_build_nrc(resp, resp_len, req[0], NRC_SECURITY_ACCESS_DENIED); return false; } resp[0] 0x62; /* 正响应SID 请求SID 0x40 */ resp[1] req[1]; resp[2] req[2]; memcpy(resp[3], info-data, info-len); *resp_len 3 info-len; return true; }sec_level字段的用意是不同DID可以要求不同等级的安全访问。比如读VIN不需要安全但刷写VIN必须先过0x27安全访问。协议栈不关心业务细节只负责在查表的时候比对等级权限判断的逻辑收在DID表配置里改权限不需要动代码。正响应SID是请求SID加0x400x22 → 0x62、0x10 → 0x50、0x27 → 0x67这个映射关系在14229-1里是固定的。3.4 0x27安全访问的seed-key交换读DID那条链路里提到的安全等级靠的就是0x27服务来解锁。0x27有多个子功能奇数子功能请求种子、偶数子功能校验密钥。Demo里实现的流程是Tester发0x27 0x01ECU返回一段seedTester拿着seed算key再发0x27 0x02 keyECU比对后决定解锁还是回0x35。static uint8_t attempt_count; static bool uds_svc_security_access(const uint8_t* req, uint16_t req_len, uint8_t* resp, uint16_t* resp_len) { if (req_len 2) { uds_build_nrc(resp, resp_len, req[0], NRC_INCORRECT_MSG_LENGTH); return false; } uint8_t sub req[1]; if (sub 0x01) { if (attempt_count 3) { uds_build_nrc(resp, resp_len, req[0], NRC_EXCEEDED_ATTEMPTS); return false; } uint8_t* seed; uint8_t seed_len uds_sec_get_seed(seed); resp[0] 0x67; resp[1] 0x01; memcpy(resp[2], seed, seed_len); *resp_len 2 seed_len; return true; } if (sub 0x02) { bool ok uds_sec_compare_key(req[2], req_len - 2); if (!ok) { attempt_count; uds_build_nrc(resp, resp_len, req[0], NRC_INVALID_KEY); return false; } attempt_count 0; uds_sec_unlock(1); /* 解锁等级1 */ resp[0] 0x67; resp[1] 0x02; *resp_len 2; return true; } uds_build_nrc(resp, resp_len, req[0], NRC_SUB_FUNCTION_NOT_SUPPORTED); return false; }种子生成和密钥比较分别封装成uds_sec_get_seed和uds_sec_compare_key这两个函数是协议栈里留给开发者的改接口。常见做法是seed由伪随机数加时间戳生成key用自定义查表算法或者硬件加密模块计算。换算法只动这两个函数协议栈流程不用改。尝试次数限制也在这个服务内部维护超过3次就回0x36这个对防止暴力尝试很有必要。3.5 请求和响应的对照关系把这几个模块串起来一次完整的0x22读VIN操作在总线上的报文应该是这样方向CAN数据场说明Tester → ECU03 22 F1 90单帧请求读DID 0xF190ECU → Tester14 62 F1 90 31 32 33 …首帧连续帧正响应SID 0x62ECU → Tester30 00 14流控帧允许发送Tester → ECU21 34 35 36 …连续帧序号从1开始递增多帧响应的编排逻辑在uds_iso_tp.c的发送侧协议栈先把完整响应数据放进发送缓冲然后按ISO-TP规则切成FF和CF逐帧发出。可以看到传输层把一条逻辑上的诊断报文拆成了好几条CAN帧对上下层都是透明的。4. 编译运行与联调PC控制台和USB-CAN两种模式4.1 编译成PC模拟器这个Demo做得比较讨喜的一点是它不是一个只能在开发板上跑的源码包而是自带了一个控制台模拟ECU程序。编译只需要CMake加一个支持C99的编译器Windows上用MinGWLinux/macOS上直接用gcc。mkdir -p build cd build cmake .. -DCMAKE_BUILD_TYPERelease make -j4 ./uds_demo启动之后程序进入一个交互式控制台提示符等着你输入十六进制诊断帧。比如输入03 22 F1 90回车程序会返回响应的十六进制字节。这里的输入模拟的是CAN数据场的完整内容第一个字节是ISO-TP的PCI后面是UDS请求。对于第一次接触UDS的人用它来验证自己对ISO-TP帧格式的理解是最直观的——不用买CAN盒、不用接ECU装了就能玩。4.2 用Python脚本模拟Tester控制台手动输入适合验证单条请求但测起来太慢。我习惯用tools/uds_tester.py这个脚本快速发一整轮诊断流程脚本核心逻辑是这样的def uds_request_sf(tx_id, rx_id, payload: bytes) - bytes: # 单帧:PCI 0x0N, N 数据长度 frame bytes([0x00 | len(payload)]) payload can_send(tx_id, frame) resp_frame can_recv(rx_id, timeout1.0) return parse_isotp(resp_frame) # 一个标准的解锁流程 req bytes([0x10, 0x03]) # 切换到扩展会话 resp uds_request_sf(0x7E0, 0x7E8, req) resp uds_request_sf(0x7E0, 0x7E8, bytes([0x27, 0x01])) seed resp[2:] key seed_key_algorithm(seed) resp uds_request_sf(0x7E0, 0x7E8, bytes([0x27, 0x02]) key)脚本里can_send和can_recv是对底层接口的封装。如果只是在PC上跑模拟器这两个函数可以改为向控制台程序的stdin写入、从stdout读取如果接USB-CAN盒子则替换成盒子的动态库调用。无论哪种方式0x7E0是诊断请求的CAN ID0x7E8是ECU响应的CAN ID这是诊断规范里常用的物理寻址ID。4.3 接真实CAN总线时的注意点把协议栈跑到真实总线上需要把hals层从PC模拟切到USB-CAN。需要注意CAN盒子的帧格式和波特率。诊断通信一般用500kbps或者250kbpsCAN ID标准帧就够了但有些车型会用29位扩展帧。协议栈的hal_can_read和hal_can_write接口签名是固定配好的bool hal_can_init(uint16_t baudrate, bool use_ext_id); bool hal_can_write(uint32_t can_id, const uint8_t* data, uint8_t len); bool hal_can_read(uint32_t* can_id, uint8_t* data, uint8_t* len);改成USB-CAN驱动的时候把这些函数体内的实现换成对应盒子的接收发送API。推荐先用总线报文分析工具抓一遍自己发出去的ISO-TP帧确认PCI和连续帧序号正确再连真实的ECU免得两边协议不一致排查困难。4.4 协议栈参数表uds_config.h是所有时间参数和传输参数集中的地方跑不同项目调参基本只动这个文件。参数常用值含义P2_TIMEOUT_MS50服务处理超时超时后应发0x78P2_STAR_TIMEOUT_MS5000P2*超时用于耗时服务S3_TIMEOUT_MS5000非默认会话超时BLOCK_SIZE0流控帧的BS0表示连续帧可一直发STMIN_MS10连续帧最小间隔防止ECU接收不过来MAX_ATTEMPT_COUNT3安全访问最大重试次数STMIN这个参数在有些工程里容易踩坑它是ECU要求Tester每帧连续帧之间的最小时间间隔。如果ECU接收缓冲处理不过来把这个值调大到20ms或50ms如果追求吞吐调成0。但0不代表没有间隔而是代表Tester端可以背靠背发送这就很考验驱动质量了。5. UDS调试避坑指南五个让Tester和ECU对不上号的场景5.1 切完会话紧接着发0x27收到0x24请求序列错误现象诊断仪先发0x10 0x03切换扩展会话正响应还没完全处理完就立刻发0x27 0x01ECU回了0x24requestSequenceError。原因底层ISO-TP是多帧收发0x10的响应可能还没发完下一个请求已经到了协议栈状态机还没回到IDLE。或者应用层做会话切换后没有重置S3计时导致协议栈认为当前还在默认会话安全访问没被允许。解决诊断仪侧要严格按照“请求-等待响应-再发下一帧”的节奏来不要连续背靠背发。ECU侧在uds_sess_set里务必重置S3时间戳并且等响应帧全部发完再设置状态为空闲。我一般在Tester脚本里每条请求后强制wait固定响应时间再发下一条实测对绝大多数ECU都稳。5.2 连续帧序号对不上多帧报文接收超时现象诊断仪发一个超过7字节的请求总线报文分析工具上看FF和CF都发出去了但ECU响应超时或者收到不完整。原因ISO-TP的连续帧序号是1到15循环序号为15之后下一帧回到1。我见过写成0到15、也见过到16才回绕的实现这两种都会和标准协议栈对不上。解决先抓总线报文看CF帧的PCI字节低四位是不是从1开始按15循环。如果从0开始判定原因后直接把序号计算改成(seq % 15) 1就行。这个问题最容易发生在自己写的测试工具里ECU协议栈一般不会错。5.3 0x22 F190返回0x13而不是0x31现象请求0x22 0xF1 0x90期望是DID不存在或者不可读结果返回0x13长度错误。原因handler里先做了严格长度校验req_len ! 4然后才查DID表。如果工具发送时多带了一个字节或者把DID的高低位写反成了0x90 0xF1协议栈在查表之前就被长度检查拦住了自然会回0x13而不会回0x31。解决排查时先看请求字节数是不是正好4字节。如果长度无误仍然0x13去检查发送端是否有字节序转换问题。0x22的DID参数是大端模式0xF190要发成F1 90而不是90 F1这一条就能排除掉一大半的“假NRC”。5.4 Flash擦除期间没有发0x78Tester端直接超时断开现象执行例程控制0x31刷写Flash擦除需要几秒但ECU没有在P2超时之前发任何帧Tester报超时。原因P2默认是50msP2*是5000ms。耗时操作超过了P2协议栈必须在P2超时前发出0x78responsePending然后每隔一段时间再发一次0x78直到操作完成。如果没有这个机制Tester会认为ECU掉线了。解决在耗时服务的handler里先把0x78发出去操作完成后再发最终的正响应。常规做法是把耗时操作拆成任务协议栈主循环持续发送0x78。看到0x78别当成错误它是UDS里“我正在干活别急”的标准答复。如果Tester端很快断开多半是0x78的重复发送间隔超过了P2*。5.5 安全访问成功后重启Tester工具再访问还是0x33现象0x27流程走通了正响应也收到了但换了一台电脑的工具或者重启工具软件之后再发受限服务仍然回0x33。原因安全访问状态存在ECU的RAM里会话重置或ECU复位之后会清掉。更重要的是工具侧可能把安全解锁状态缓存了以为不用重新解锁。按ISO 14229-1的设计安全状态和当前会话绑定会话一旦重置安全等级必须重新申请。解决ECU侧确认在S3超时、ECU复位、会话切换的时候调用uds_sec_reset清状态。Tester侧每次重启之后重新走一遍0x10 0x03加0x27的流程。想验证是不是这个原因可以发一条0x3E保活看ECU回不回如果不回就是S3已经超时了。6. 二次开发自定义0x31例程并移植到自己的MCU工程6.1 在DID表之外扩展自己的例程0x31例程控制是刷写类BootLoader里用得最多的服务它的结构是SID 子功能 RID例程标识符 可选参数。比如加一个“擦除Flash扇区”的例程RID定义成0x0203。改动点很集中先在uds_routine.c里加RID表typedef void (*routine_fn_t)(const uint8_t* param, uint8_t param_len); static const struct { uint16_t rid; routine_fn_t start; } routine_table[] { { 0x0203, routine_erase_flash }, }; static bool uds_svc_routine_control(const uint8_t* req, uint16_t req_len, uint8_t* resp, uint16_t* resp_len) { if (req_len 4) { uds_build_nrc(resp, resp_len, req[0], NRC_INCORRECT_MSG_LENGTH); return false; } uint16_t rid (req[2] 8) | req[3]; for (int i 0; i sizeof(routine_table)/sizeof(routine_table[0]); i) { if (routine_table[i].rid rid) { routine_table[i].start(req[4], req_len - 4); resp[0] 0x71; resp[1] req[1]; /* 回显子功能 */ resp[2] req[2]; resp[3] req[3]; *resp_len 4; return true; } } uds_build_nrc(resp, resp_len, req[0], NRC_REQUEST_OUT_OF_RANGE); return false; }新增例程不需要改分发逻辑只需要在routine_table里加一行、实现一个函数。RID的参数解析在函数内部自己做比如routine_erase_flash读取参数里的起始地址和长度然后调用BootLoader的Flash驱动。这种表驱动设计是协议栈类代码的标准做法扩展起来不用翻动原有代码。6.2 移植到真实ECU工程时先换这四个接口我在一次项目里把这个协议栈从PC模拟器挪到某MCU上真正要改的只有四个地方CAN收发、定时器、字节序、内存分配。CAN和定时器是hal层的事字节序靠编码规范约束内存分配建议直接用静态缓冲。移植的验证顺序我一般这样走先用回环模式把ECU的ISO-TP自发自收跑通再连真实Tester跑0x3E保活和0x22读DID都通过之后才碰0x27和0x31刷写流程。一步到位接BootLoader会很难定位是哪一层出的问题。hal层替换的一个参考示例bool hal_can_write(uint32_t can_id, const uint8_t* data, uint8_t len) { can_tx_frame_t f {0}; f.id can_id; f.dlc len; memcpy(f.data, data, len); return my_mcu_can_send(f); } bool hal_can_read(uint32_t* can_id, uint8_t* data, uint8_t* len) { can_rx_frame_t f; if (!my_mcu_can_recv(f, 0)) { return false; } *can_id f.id; *len f.dlc; memcpy(data, f.data, f.dlc); return true; }替换之后重点检查CAN ID是标准帧还是扩展帧、DLC是8还是64支持CAN FD的话以及CAN控制器的接收中断里是否需要加FIFO锁。常见翻车点是在中断里直接调用协议栈处理函数导致嵌套过深我习惯把帧先塞到环形缓冲主循环里再喂给ISO-TP层。6.3 改动后的验证清单每次改完协议栈我会强制自己走一遍这个验证序列0x3E tester present必须回0x7E0x10切扩展会话、超时后必须回默认会话未解锁时访问受限DID必须回0x330x27流程正确加解锁后再次访问必须成功超过7字节的多帧请求必须完整收发所有非法SID回0x11。这六条能通过这个协议栈基本就是可用的剩下的就是各车型的DID权限配置差异了。从那以后我每把这份协议栈往新工程里放都会先跑一遍这六条再决定要不要碰上层应用。UDS调试很多时候不是协议栈本身有问题而是时序、权限、帧格式没对齐验证清单能在十分钟内把所有基础问题暴露出来。希望帮到你。本文还有配套的精品资源点击获取
平方复杂度无法被常规优化消除｜TaoToken 统一 Key 通道实测)
