CANoe_UDS-Bootloader刷写系列-含源码（五）CAPL实现$31服务例程控制

学习是个漫长且痛苦的过程道路艰辛而曲折希望我们都在时代的长河中做一颗闪闪发光的尘埃。只有持之以恒才能有所成就目录前言目录目录系列目录一RoutineControl例程控制0x31服务二协议相关请求报文格式肯定响应 否定响应NRC三CAPL实现系列目录《CANoe_UDS-Bootloader刷写系列-含源码一刷写基本流程》《CANoe_UDS-Bootloader刷写系列-含源码二CAPL实现$10服务》《CANoe_UDS-Bootloader刷写系列-含源码三CAPL实现$27服务密钥解锁》《CANoe_UDS-Bootloader刷写系列-含源码四CAPL实现$34 $36 $37服务数据传输》《CANoe_UDS-Bootloader刷写系列-含源码五CAPL实现$31服务例程控制》 --待续《CANoe_UDS-Bootloader刷写系列-含源码六CAPL实现$22 $2E 服务读写配置》《CANoe_UDS-Bootloader刷写系列-含源码七CAPL实现$85 $28服务预编程步骤》《CANoe_UDS-Bootloader刷写系列-含源码七干货 CAPL实现CRC数据校验》《CANoe_UDS-Bootloader刷写系列-含源码八干货 CANoe_Panel刷写上位机面板制作》《CANoe_UDS-Bootloader刷写系列-含源码九CAPL框架全流程测试及报文分析-查漏补缺》接上篇所述我们通过CAPL实现了$36服务$37服务的数据的写入传输。今天我们学习如何实现31服务的例程控制。在14229协议中对于31服务有很大的扩展部分企业可以自定义企标的内容进行RID定制以实现想要的功能。本篇仅对刷写方面需要执行的31服务RID进行实例化解读。一RoutineControl例程控制0x31服务客户端使用RoutineControl例程控制请求启动停止服务器的例程或请求例程结果。在刷写中0x31服务主要用于在做软件升级时应用于检查刷写前置条件是否满足、传输数据完整性擦除程序以及独立性检测。就拿编程前置条件检查为例如我们需要检查当前的车速电压挡位等情况是否是满足刷写条件此时测试仪发送一个31 特定RID给ECUECU会返回当前的状态来告知测试仪是否可以执行升级。二协议相关请求报文格式从下图我们知道31服务是由N个字节组成第一个字节是服务RoutineControl0x31此字段是不变的。第二个字节是子服务sub_function(0x00-0xFF)子服务由下图2所示从0x04 - 0x7F 为已保留字段此子服务允许由厂商根据实际情况在企标内自定义。下图为子服务的具体协议要求肯定响应 否定响应NRCNRC三CAPL实现发送逻辑与$10服务类似。区别在于发送31服务时需要将本地升级包计算成相关的CRC值与71返回的数值进行比较若相同则完整性校验通过若不相同则升级过程中传输的包有中断或者丢包。如以下代码所示int routine_control(byte MessageSelectFlag,int data_record_length,int block_number){ byte request[BUFFER_SIZE_1024]; int index0; dword key_secu; dword seed0; char k[20]; char m[20]; int n0; int h0; char CRCbyte1[10]0x; char CRCbyte2[10]0x; char CRCbyte3[10]0x; char CRCbyte4[10]0x; char CRC1byte[10]; char CRC2byte[10]; char CRC3byte[10]; char CRC4byte[10]; char CRC1byte_NULL[10]; char CRC2byte_NULL[10]; char CRC3byte_NULL[10]; char CRC4byte_NULL[10]; char dest[10]; request[0]0x31; request[1]0x01; if(MessageSelectFlag0block_number0) //MessageSelectFlag0发送;31/01/FF/00 { request[2]0xFF; request[3]0x00; request[4]0x01; //调试添加 } if(MessageSelectFlag0block_number1) //MessageSelectFlag0发送;31/01/FF/01 { request[2]0xFF; request[3]0x01; //调试添加 } if(MessageSelectFlag1) //MessageSelectFlag1发送31/01/02/03 { request[2]0x02; request[3]0x03; } if(MessageSelectFlag2block_number1){ //调试添加 request[2]0xDF; request[3]0x01; request[4]0x01; } if(MessageSelectFlag2) //MessageSelectFlag2发送31/01/02/02 { request[2]0xDF; request[3]0x01; /*********以下代码为将4个Byte组成的AppCRC转成16进制字符串然后拆成4个Byte的数值**********/ strncpy(CRCbyte1,CRC1byte_NULL,elCount(CRC1byte_NULL)); //执行下面代码之前先清空CRCbyte1 strncpy(CRCbyte2,CRC2byte_NULL,elCount(CRC2byte_NULL)); //执行下面代码之前先清空CRCbyte2 strncpy(CRCbyte3,CRC3byte_NULL,elCount(CRC3byte_NULL)); //执行下面代码之前先清空CRCbyte3 strncpy(CRCbyte4,CRC4byte_NULL,elCount(CRC4byte_NULL)); //执行下面代码之前先清空CRCbyte4 write(Null CRC1byte%s,CRCbyte1); write(Null CRC2byte%s,CRCbyte2); write(Null CRC3byte%s,CRCbyte3); write(Null CRC4byte%s,CRCbyte4); strncat(CRCbyte1,0x, 15); strncat(CRCbyte2,0x, 15); strncat(CRCbyte3,0x, 15); strncat(CRCbyte4,0x, 15); ltoa(AppCRC,k,16);//将AppCRC值转成16进制字符串 write(AppCRC%s,k); snprintf(m,elcount(m),%8s,k); for(n0;n8;n) { if(m[n] ) m[n]0; } write(m%s,m); substr_cpy(CRC1byte,m,0,2,elcount(CRC1byte));//提取CRC中的第一个Byte字符串 substr_cpy(CRC2byte,m,2,2,elcount(CRC2byte));//提取CRC中的第二个Byte字符串 substr_cpy(CRC3byte,m,4,2,elcount(CRC3byte));//提取CRC中的第三个Byte字符串 substr_cpy(CRC4byte,m,6,2,elcount(CRC4byte));//提取CRC中的第四个Byte字符串 strncat(CRCbyte1,CRC1byte,20);//在提取的每个Byte字符串前面增加0x比如输出0x11,0x12 strncat(CRCbyte2,CRC2byte,20);//在提取的每个Byte字符串前面增加0x比如输出0x11,0x12 strncat(CRCbyte3,CRC3byte,20);//在提取的每个Byte字符串前面增加0x比如输出0x11,0x12 strncat(CRCbyte4,CRC4byte,20);//在提取的每个Byte字符串前面增加0x比如输出0x11,0x12 write(CRC1byte%s,CRCbyte1); write(CRC2byte%s,CRCbyte2); write(CRC3byte%s,CRCbyte3); write(CRC4byte%s,CRCbyte4); request[4]atol(CRCbyte1);//将CRC的第一个Byte十六进制字符串转成数值显示比如字符串0x11转成数值17 request[5]atol(CRCbyte2);//将CRC的第二个Byte十六进制字符串转成数值显示比如字符串0x11转成数值17 request[6]atol(CRCbyte3);//将CRC的第三个Byte十六进制字符串转成数值显示比如字符串0x11转成数值17 request[7]atol(CRCbyte4);//将CRC的第四个Byte十六进制字符串转成数值显示比如字符串0x11转成数值17 } if(MessageSelectFlag3) //(STP2-e) EraseMemory:31/01/FF/00/44 xx xx xx xx xx xx xx xx;71 01 FF 00 { request[2]0xFF; request[3]0x00; request[4]0x44; request[5]AppBinFileData[33]; request[6]AppBinFileData[34]; request[7]AppBinFileData[35]; request[8]AppBinFileData[36]; request[9]AppBinFileData[37]; request[10]AppBinFileData[38]; request[11]AppBinFileData[39]; request[12]AppBinFileData[40]; } if(MessageSelectFlag7block_number5){ request[2]0xDF; request[3]0x01; request[4]0x00; } if(MessageSelectFlag4) //MessageSelectFlag2FlashDriver校验CRC发送31/01/02/02 { request[2]0xDF; request[3]0x01; /*********以下代码为将4个Byte组成的DriverCRC转成16进制数然后拆成4个Byte的数值**********/ strncpy(CRCbyte1,CRC1byte_NULL,elCount(CRC1byte_NULL)); //执行下面代码之前先清空CRCbyte1 strncpy(CRCbyte2,CRC2byte_NULL,elCount(CRC2byte_NULL)); //执行下面代码之前先清空CRCbyte2 strncpy(CRCbyte3,CRC3byte_NULL,elCount(CRC3byte_NULL)); //执行下面代码之前先清空CRCbyte3 strncpy(CRCbyte4,CRC4byte_NULL,elCount(CRC4byte_NULL)); //执行下面代码之前先清空CRCbyte4 write(Null CRC1byte%s,CRCbyte1); write(Null CRC2byte%s,CRCbyte2); write(Null CRC3byte%s,CRCbyte3); write(Null CRC4byte%s,CRCbyte4); strncat(CRCbyte1,0x, 15); strncat(CRCbyte2,0x, 15); strncat(CRCbyte3,0x, 15); strncat(CRCbyte4,0x, 15); ltoa(DriverCRC,k,16);//将AppCRC值转成16进制字符串 write(DriverCRC%s,k); snprintf(m,elcount(m),%8s,k); for(n0;n8;n) { if(m[n] ) m[n]0; } write(m%s,m); substr_cpy(CRC1byte,m,0,2,elcount(CRC1byte));//提取CRC中的第一个Byte字符串 substr_cpy(CRC2byte,m,2,2,elcount(CRC2byte));//提取CRC中的第二个Byte字符串 substr_cpy(CRC3byte,m,4,2,elcount(CRC3byte));//提取CRC中的第三个Byte字符串 substr_cpy(CRC4byte,m,6,2,elcount(CRC4byte));//提取CRC中的第四个Byte字符串 strncat(CRCbyte1,CRC1byte,20);//在提取的每个Byte字符串前面增加0x比如输出0x11,0x12 strncat(CRCbyte2,CRC2byte,20);//在提取的每个Byte字符串前面增加0x比如输出0x11,0x12 strncat(CRCbyte3,CRC3byte,20);//在提取的每个Byte字符串前面增加0x比如输出0x11,0x12 strncat(CRCbyte4,CRC4byte,20);//在提取的每个Byte字符串前面增加0x比如输出0x11,0x12 write(CRC1byte%s,CRCbyte1); write(CRC2byte%s,CRCbyte2); write(CRC3byte%s,CRCbyte3); write(CRC4byte%s,CRCbyte4); request[4]atol(CRCbyte1);//将CRC的第一个Byte十六进制字符串转成数值显示比如字符串0x11转成数值17 request[5]atol(CRCbyte2);//将CRC的第二个Byte十六进制字符串转成数值显示比如字符串0x11转成数值17 request[6]atol(CRCbyte3);//将CRC的第三个Byte十六进制字符串转成数值显示比如字符串0x11转成数值17 request[7]atol(CRCbyte4);//将CRC的第四个Byte十六进制字符串转成数值显示比如字符串0x11转成数值17 } if(MessageSelectFlag5) //(STP2-e) EraseMemory:31/01/FF/00/44 xx xx xx xx xx xx xx xx;71 01 FF 00 { request[2]0xFF; request[3]0x00; request[4]0x44; request[5]AppBinFileData[1]; request[6]AppBinFileData[2]; request[7]AppBinFileData[3]; request[8]AppBinFileData[4]; request[9]AppBinFileData[5]; request[10]AppBinFileData[6]; request[11]AppBinFileData[7]; request[12]AppBinFileData[8]; } //SOC升级 if (MessageSelectFlag8){ request[2]0xFF; request[3]0x00; request[4]0x02; } if (MessageSelectFlag9){ request[2]0xDF; request[3]0x01; request[4]0x00; } if (MessageSelectFlag10){ request[2]0xFF; request[3]0x01; } if (MessageSelectFlag11){ request[2]0xDF; request[3]0x01; request[4]0x02; } OSEKTL_DataReq(request,data_record_length); write(runing routine_control 31 Success); OSEKTL_DataInd(rxCount); return wait_server_response(request,timeout); }