340 lines
12 KiB
C
340 lines
12 KiB
C
|
||
#include "uds_config.h"
|
||
#include "uds_nvm.h"
|
||
#include "24cxx.h"
|
||
#include "can.h"
|
||
#include "sys.h"
|
||
#include "dc300.h"
|
||
#include "adc.h"
|
||
#include "app_pwr_manage.h"
|
||
|
||
static uint32_t bootSwAddr;
|
||
|
||
extern DIDs gDIDCache;
|
||
extern void DTC_SignalInit(void);
|
||
extern void DID_SignalInit(void);
|
||
extern int8_t can_write2( CanTxMsg *TxMessage);
|
||
|
||
/* uds强制清除硬件自身DTC相关故障标志位 */
|
||
void UdsApi_HardwareFault_ForceClear(void)
|
||
{
|
||
//硬件强制清除自身DTC相关故障,请根据实际情况填入
|
||
}
|
||
|
||
#ifdef CS_TEMP_MODIFY
|
||
//extern bus_off_recovery_t* can_bus_off_recovery_info(uint8_t ch);
|
||
extern qiruibat_info_t QiruiBatteryInfo;
|
||
#endif
|
||
/* 硬件向UDS更新车身信号 */
|
||
void UdsApi_VehicleInfo2UdsProc(void)
|
||
{
|
||
vehicleInfo2uds.IgnSts = 1;
|
||
#ifdef CS_TEMP_MODIFY
|
||
vehicleInfo2uds.IgnSts = ChkInputIGN1();
|
||
|
||
if(battery_volt_state < NORM_VOLT)//供电电源低
|
||
vehicleInfo2uds.BattLow = 1;
|
||
else
|
||
vehicleInfo2uds.BattLow = 0;
|
||
|
||
if(battery_volt_state > NORM_VOLT)//供电电源高
|
||
vehicleInfo2uds.BattHigh = 1;
|
||
else
|
||
vehicleInfo2uds.BattHigh = 0;
|
||
|
||
|
||
vehicleInfo2uds.InOverVoltFault = mExistFdcFault( fault_grid_volt_over); // DCB是否有输入过压故障 0:false 1:true
|
||
vehicleInfo2uds.InUnderVoltFault =mExistFdcFault( fault_grid_volt_under); //DCB是否有输入欠压故障 0:false 1:true
|
||
vehicleInfo2uds.OutOverVoltFault =mExistFdcFault( fault_Bat_OverVolt); //DCB是否有输出过压故障 0:false 1:true
|
||
vehicleInfo2uds.OutUnderVoltFault =mExistFdcFault( fault_Bat_UnderVolt); //DCB是否有输出欠压故障 0:false 1:true
|
||
vehicleInfo2uds.InOverCurFault =mExistFdcFault( fault_grid_curr_over); //DCB是否有输入过流故障 0:false 1:true
|
||
|
||
vehicleInfo2uds.OutOverCurFault = 0; //DCB是否有输出过流故障 0:false 1:true
|
||
// vehicleInfo2uds.OutOverCurFault =mExistFdcFault( fault_grid_volt_over); //DCB是否有输出过流故障 0:false 1:true
|
||
|
||
vehicleInfo2uds.OverTemperture =mExistFdcFault( fault_temp_over); //FCDC环境过温保护故障 0:false 1:true
|
||
vehicleInfo2uds.InputShort =mExistFdcFault( fault_grid_input_reverse); //输入短路故障 0:false 1:true
|
||
vehicleInfo2uds.OutputShort =mExistFdcFault( fault_grid_output_reverse); //输出短路故障 0:false 1:true
|
||
|
||
// vehicleInfo2uds.PrechargeFault =0; //预充失败故障 0:false 1:true
|
||
// vehicleInfo2uds.FCDC_HardFault =0; //FCDC硬件故障 0:false 1:true
|
||
// vehicleInfo2uds.ChargeOverTemp =0; //充电座过温故障 0:false 1:true
|
||
// vehicleInfo2uds.FCDC_FanFault =0; //FCDC风扇故障 0:false 1:true
|
||
// vehicleInfo2uds.FCDC_CC1Fault =0; //FCDC检测CC1插枪检测故障 0:false 1:true
|
||
vehicleInfo2uds.FCDC_InAstVoltFault =mExistFdcFault( fault_power24_err); //FCDC输入辅助电源电压异常故障 0:false 1:true
|
||
// vehicleInfo2uds.FCDCIGBT_OverTempFault =0; //FCDCIGBT过温保护故障 0:false 1:true
|
||
|
||
|
||
|
||
// busoff计数器，进入busoff后每恢复一次就累加1。CAN总线正常后退出busoff就清零。
|
||
vehicleInfo2uds.BusoffCnt = can_bus_off_recovery_times(1); // busoff计数器，进入busoff后每恢复一次就累加1。CAN总线正常后退出busoff就清零。
|
||
|
||
vehicleInfo2uds.Snapshot.PowerMode = QiruiBatteryInfo.BCM_1.bits.KeySts ;//ECU供电模式(格式与诊断调查表 3_2_Snapshot&Extended Data List 一致)
|
||
|
||
|
||
vehicleInfo2uds.Snapshot.TolOdometerH = (QiruiBatteryInfo.ICM_1.bits.TotalOdometer_km >>16)&0xff; // 总里程高byte
|
||
vehicleInfo2uds.Snapshot.TolOdometerM = (QiruiBatteryInfo.ICM_1.bits.TotalOdometer_km >>8)&0xff; // 总里程中间byte
|
||
vehicleInfo2uds.Snapshot.TolOdometerL = (QiruiBatteryInfo.ICM_1.bits.TotalOdometer_km)&0xff; // 总里程低byte(格式与诊断调查表 3_2_Snapshot&Extended Data List 一致)
|
||
|
||
|
||
// vehicleInfo2uds.Snapshot.DateSec 时间 秒(格式与诊断调查表 3_2_Snapshot&Extended Data List 一致)
|
||
// vehicleInfo2uds.Snapshot.DateMin 时间 分(格式与诊断调查表 3_2_Snapshot&Extended Data List 一致)
|
||
// vehicleInfo2uds.Snapshot.DateHour 时间 小时(格式与诊断调查表 3_2_Snapshot&Extended Data List 一致)
|
||
// vehicleInfo2uds.Snapshot.DateDay 时间 日(格式与诊断调查表 3_2_Snapshot&Extended Data List 一致)
|
||
// vehicleInfo2uds.Snapshot.DateMonth 时间 月(格式与诊断调查表 3_2_Snapshot&Extended Data List 一致)
|
||
// vehicleInfo2uds.Snapshot.DateYear 时间 年(格式与诊断调查表 3_2_Snapshot&Extended Data List 一致)
|
||
// vehicleInfo2uds.Snapshot.VehSpeedH 车速高byte
|
||
// vehicleInfo2uds.Snapshot.VehSpeedL 车速低byte(格式与诊断调查表 3_2_Snapshot&Extended Data List 一致)
|
||
|
||
vehicleInfo2uds.Snapshot.DateSec = QiruiBatteryInfo.TBOX_2.bits.second;
|
||
vehicleInfo2uds.Snapshot.DateMin = QiruiBatteryInfo.TBOX_2.bits.minute;
|
||
vehicleInfo2uds.Snapshot.DateHour = QiruiBatteryInfo.TBOX_2.bits.hour;
|
||
vehicleInfo2uds.Snapshot.DateDay = QiruiBatteryInfo.TBOX_2.bits.day;
|
||
vehicleInfo2uds.Snapshot.DateMonth = QiruiBatteryInfo.TBOX_2.bits.month;
|
||
vehicleInfo2uds.Snapshot.DateYear = QiruiBatteryInfo.TBOX_2.bits.year;
|
||
vehicleInfo2uds.Snapshot.VehSpeedH = (uint8_t)(QiruiBatteryInfo.MCU_1.bits.MCU_SpeedVechile>>8);
|
||
vehicleInfo2uds.Snapshot.VehSpeedL = (uint8_t)(QiruiBatteryInfo.MCU_1.bits.MCU_SpeedVechile);
|
||
|
||
vehicleInfo2uds.Snapshot.BatVolt = (uint8_t)(Sample_DataS.VIN_Input_Voltage*10);// 蓄电池电压(格式与诊断调查表 3_2_Snapshot&Extended Data List 一致)
|
||
vehicleInfo2uds.Snapshot.SOCH = (uint8_t)((QiruiBatteryInfo.soc/5)>>8);// SOC(格式与诊断调查表 3_2_Snapshot&Extended Data List 一致)
|
||
vehicleInfo2uds.Snapshot.SOCL = (uint8_t)((QiruiBatteryInfo.soc/5)>>0);
|
||
/* 请根据实际情况填入
|
||
vehicleInfo2uds.IgnSts = ;
|
||
vehicleInfo2uds.BattLow = ;
|
||
vehicleInfo2uds.BattHigh = ;
|
||
vehicleInfo2uds.InOverVoltFault = ;
|
||
vehicleInfo2uds.InUnderVoltFault = ;
|
||
vehicleInfo2uds.OutOverVoltFault = ;
|
||
vehicleInfo2uds.OutUnderVoltFault = ;
|
||
vehicleInfo2uds.InOverCurFault = ;
|
||
vehicleInfo2uds.OutOverCurFault = ;
|
||
vehicleInfo2uds.OverTemperture = ;
|
||
vehicleInfo2uds.InputShort = ;
|
||
vehicleInfo2uds.OutputShort = ;
|
||
vehicleInfo2uds.PrechargeFault = ;
|
||
vehicleInfo2uds.FCDC_HardFault = ;
|
||
vehicleInfo2uds.ChargeOverTemp = ;
|
||
vehicleInfo2uds.FCDC_FanFault = ;
|
||
vehicleInfo2uds.FCDC_CC1Fault = ;
|
||
vehicleInfo2uds.FCDC_InAstVoltFault = ;
|
||
vehicleInfo2uds.FCDCIGBT_OverTempFault = ;
|
||
|
||
vehicleInfo2uds.BusoffCnt = ;
|
||
|
||
vehicleInfo2uds.Snapshot.PowerMode = ;
|
||
vehicleInfo2uds.Snapshot.TolOdometerH = ;
|
||
vehicleInfo2uds.Snapshot.TolOdometerM = ;
|
||
vehicleInfo2uds.Snapshot.TolOdometerL = ;
|
||
vehicleInfo2uds.Snapshot.DateSec = ;
|
||
vehicleInfo2uds.Snapshot.DateMin = ;
|
||
vehicleInfo2uds.Snapshot.DateHour = ;
|
||
vehicleInfo2uds.Snapshot.DateDay = ;
|
||
vehicleInfo2uds.Snapshot.DateMonth = ;
|
||
vehicleInfo2uds.Snapshot.DateYear = ;
|
||
vehicleInfo2uds.Snapshot.VehSpeedH = ;
|
||
vehicleInfo2uds.Snapshot.VehSpeedL = ;
|
||
vehicleInfo2uds.Snapshot.BatVolt = ;
|
||
vehicleInfo2uds.Snapshot.SOC = ;
|
||
*/
|
||
#endif
|
||
}
|
||
|
||
/* uds parameter init*/
|
||
void UdsApi_ParaInit(void)
|
||
{
|
||
#if BOOTLOADER_CODE_FLAG
|
||
memcpy(gDIDCache.DID_BootSoftware, BOOTLOADER_SOFTWARE_VERSION, DIDSize[BootSoftware]);
|
||
#else
|
||
memcpy(gDIDCache.DID_BootSoftwareNumber, (uint8_t *)bootSwAddr, DIDSize[BootSoftwareNumber]);
|
||
//以下请根据实际填入数据 ,长度不足用空格代替
|
||
memcpy(gDIDCache.DID_ECUManufacturerSparePartNumber, "2109140-SZ01", DIDSize[ECUManufacturerSparePartNumber]);
|
||
memcpy(gDIDCache.DID_SystemSupplierIdentifierData, " ", DIDSize[SystemSupplierIdentifierData]);
|
||
memcpy(gDIDCache.DID_SystemName, "DCU ", DIDSize[SystemName]);
|
||
memcpy(gDIDCache.DID_VehicleManufacturerECUHardwareNumber, "HW:A.1.0", DIDSize[VehicleManufacturerECUHardwareNumber]);
|
||
memcpy(gDIDCache.DID_VehicleManufacturerECUSoftwareNumber, "SW:DCU.1.34.01 ", DIDSize[VehicleManufacturerECUSoftwareNumber]);
|
||
memcpy(gDIDCache.DID_SystemSupplierECUHardwareNumber, " ", DIDSize[SystemSupplierECUHardwareNumber]);
|
||
memcpy(gDIDCache.DID_SystemSupplierECUSoftwareNumber, " ", DIDSize[SystemSupplierECUSoftwareNumber]);
|
||
|
||
// memcpy(gDIDCache.DID_ECUSerialNumber, "123456789012", DIDSize[ECUSerialNumber]);
|
||
#ifdef CS_TEMP_MODIFY
|
||
memcpy(gDIDCache.DID_BootSoftware, (uint8_t*)GetBootloaderSwVersionAddress(), DIDSize[BootSoftware]);
|
||
memset(gDIDCache.DID_ProgrammingDate, 0x00, DIDSize[ProgrammingDate]);
|
||
memset(gDIDCache.DID_TesterSerialNumber, 0x00, DIDSize[TesterSerialNumber]);
|
||
memset(gDIDCache.DID_VehicleIdentificationNumber, 0x00, DIDSize[VehicleIdentificationNumber]);
|
||
gDIDCache.DID_ActiveDiagnosticSession[0] = _UDS_DEFAULT_SESSION;
|
||
|
||
|
||
|
||
gDIDCache.DID_InputOvervoltageValue[0] = MSB(350);
|
||
gDIDCache.DID_InputOvervoltageValue[1] = LSB(350);
|
||
gDIDCache.DID_InputUndervoltageValue[0] = MSB(200);
|
||
gDIDCache.DID_InputUndervoltageValue[1] = LSB(200);
|
||
gDIDCache.DID_OutputOvervoltageValue[0] = MSB(130);
|
||
gDIDCache.DID_OutputOvervoltageValue[1] = LSB(130);
|
||
gDIDCache.DID_OutputUndervoltageValue[0] = MSB(60);
|
||
gDIDCache.DID_OutputUndervoltageValue[1] = LSB(60);
|
||
gDIDCache.DID_OutputOvercurrentFaultValue[0] = 120;
|
||
gDIDCache.DID_InputOvercurrentFaultValue[0] = 40;
|
||
gDIDCache.DID_OverTempertureProtectValue[0] = 85+40;
|
||
gDIDCache.DID_IGBTOverTempertureProtectValue[0] = 95+40;
|
||
gDIDCache.DID_ChargeOverTemperture[0] = 100+40;
|
||
#endif
|
||
#endif
|
||
}
|
||
|
||
/* uds 1ms task */
|
||
void UdsApi_1ms_task(void)
|
||
{
|
||
UdsProcTask();
|
||
}
|
||
|
||
/* uds 10ms task */
|
||
void UdsApi_10ms_task(void)
|
||
{
|
||
UdsApi_VehicleInfo2UdsProc();
|
||
}
|
||
|
||
/* uds can receive msg in */
|
||
void UdsApi_MsgQueueIn(CanRxMsg msg)
|
||
{
|
||
can_msg_t uds_msg;
|
||
|
||
uds_msg.id = msg.StdId;
|
||
uds_msg.dlc = msg.DLC;
|
||
memcpy(uds_msg.data, msg.Data, uds_msg.dlc);
|
||
UdsQueueCanIn(uds_msg);
|
||
}
|
||
|
||
/* uds transmit diag msg */
|
||
void UdsApi_MsgQueueOut(can_msg_t uds_msg)
|
||
{
|
||
CanTxMsg msg;
|
||
|
||
msg.IDE = CAN_Id_Standard;
|
||
msg.StdId = uds_msg.id;
|
||
msg.DLC = uds_msg.dlc;
|
||
msg.RTR = CAN_RTR_Data;
|
||
memcpy(msg.Data, uds_msg.data, msg.DLC);
|
||
// Can2_Send_Message(msg);
|
||
can_write2(&msg);
|
||
}
|
||
|
||
|
||
/* uds 生成随机数 */
|
||
uint32_t UdsApi_GetRandom(void)
|
||
{
|
||
static uint32_t Seed=0;
|
||
uint32_t Random;
|
||
|
||
if(Seed == 0)
|
||
{
|
||
Seed = SysTick->VAL;
|
||
Seed *= 91939597;
|
||
}
|
||
Random = Seed+SysTick->VAL;
|
||
Seed += 13957;
|
||
Random = (u32)( (u32)Random<<16)>>16;
|
||
Random |= ((Seed*5)<<16);
|
||
|
||
return Random;
|
||
}
|
||
|
||
/* eeprom write*/
|
||
uint8_t UdsApi_EE_WriteBytes(uint8_t *_pWriteBuf, uint16_t _usAddress, uint16_t _usSize)
|
||
{
|
||
return ee_WriteBytes(_pWriteBuf, _usAddress, _usSize);
|
||
}
|
||
|
||
/* eeprom read*/
|
||
uint8_t UdsApi_EE_ReadBytes(uint8_t *_pReadBuf, uint16_t _usAddress, uint16_t _usSize)
|
||
{
|
||
return ee_ReadBytes(_pReadBuf, _usAddress, _usSize);
|
||
}
|
||
|
||
/* NVM 初始化*/
|
||
void UdsApi_NVM_Init(void)
|
||
{
|
||
static uint8_t enter_flag = 0;
|
||
// Delay_MS(50);//等待电源稳定
|
||
if (!enter_flag) {
|
||
enter_flag = 1;
|
||
NVM_Init();
|
||
DID_SignalInit();
|
||
DTC_SignalInit();
|
||
}
|
||
}
|
||
|
||
/* 查询UDS是否使能常规通信报文发送 */
|
||
bool UdsApi_Is_UdsEnableNCMTx(void)
|
||
{
|
||
bool bRst=false;
|
||
|
||
if (udsInfo2Vehicle.NcmTxEnable) {
|
||
bRst = true;
|
||
}
|
||
return bRst;
|
||
}
|
||
|
||
/* 查询UDS是否使能网络管理报文发送 */
|
||
bool UdsApi_Is_UdsEnableNWMCMTx(void)
|
||
{
|
||
bool bRst=false;
|
||
|
||
if (udsInfo2Vehicle.NmcmTxEnable) {
|
||
bRst = true;
|
||
}
|
||
return bRst;
|
||
}
|
||
|
||
/* 查询UDS是否使能常规通信报文接收 */
|
||
bool UdsApi_Is_UdsEnableNCMRx(void)
|
||
{
|
||
bool bRst=false;
|
||
|
||
if (udsInfo2Vehicle.NcmRxEnable) {
|
||
bRst = true;
|
||
}
|
||
return bRst;
|
||
}
|
||
|
||
/* 查询UDS是否使能网络管理报文接收 */
|
||
bool UdsApi_Is_UdsEnableNWMCMRx(void)
|
||
{
|
||
bool bRst=false;
|
||
|
||
if (udsInfo2Vehicle.NmcmRxEnable) {
|
||
bRst = true;
|
||
}
|
||
return bRst;
|
||
}
|
||
|
||
/* 查询UDS是否在线 */
|
||
bool UdsApi_Is_UdsOnline(void)
|
||
{
|
||
bool bRst=false;
|
||
|
||
if (!udsInfo2Vehicle.UdsOffLine) {
|
||
bRst = true;
|
||
}
|
||
return bRst;
|
||
}
|
||
|
||
/* 查询是否为UDS响应消息 */
|
||
bool UdsApi_Is_UdsResponeMsg(uint16_t msg_id)
|
||
{
|
||
bool bRst=false;
|
||
|
||
if (msg_id == UDS_PHY_RX_ID) {
|
||
bRst = true;
|
||
}
|
||
return bRst;
|
||
}
|
||
|
||
/* 取BootLoader软件版本地址 */
|
||
void UdsApi_BootSwAddr_Get(void)
|
||
{
|
||
bootSwAddr = BKP->DR42;
|
||
bootSwAddr = (bootSwAddr << 16) | BKP->DR41;
|
||
}
|
||
|