tasks.c 23 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898
  1. #include "tasks.h"
  2. #include "iwdg.h"
  3. #include "gpio.h"
  4. #include "tim.h"
  5. #include "can_process.h"
  6. #include "uart_process.h"
  7. #include "eeprom_24c02.h"
  8. #include "eeprom_flash.h"
  9. #include "adc.h"
  10. #include "hall_sensor.h"
  11. #include "torque_sensor.h"
  12. #include "gas_sensor.h"
  13. #include "math_tools.h"
  14. #include "remain_distance.h"
  15. #include "protect_check.h"
  16. #include "fault_check.h"
  17. #include "key_driver.h"
  18. #include "encrypt.h"
  19. #include "ICM20600.h"
  20. /************************全局变量************************/
  21. TrueOrFalse_Flag_Struct_t IsInitFinish_Flag = FALSE;
  22. To_Te_SendStep IsSendDataToTE_Step = HANDSHAKE;
  23. /**************************局部函数定义*********************/
  24. /**************************全局函数定义*********************/
  25. //1ms任务处理函数
  26. void HAL_SYSTICK_Callback(void)
  27. {
  28. static uint16_t TimeCnt_5ms = 0;
  29. static uint16_t TimeCnt_10ms = 0;
  30. static uint16_t TimeCnt_50ms = 0;
  31. static uint16_t TimeCnt_100ms = 0;
  32. static uint16_t TimeCnt_1000ms = 0;
  33. if(IsInitFinish_Flag == FALSE)
  34. {
  35. return;
  36. }
  37. //踏频传感器采集及计算
  38. CadenceSensor_Process(&MC_CadenceResult, MC_ConfigParam1.StopTime, (MC_ConfigParam1.CadenceStarNum == 0) ? 2 : MC_ConfigParam1.CadenceStarNum, Bike_Attitude.UpWardSlope_flag);
  39. //踏频传感器故障检测
  40. if(MC_WorkMode == MC_WorkMode_Run)
  41. {
  42. MC_Fault_CadenceSensor_Process(ADC_SensorData.TorqueSensor, MC_RunInfo.BikeSpeed, &MC_ErrorCode);
  43. }
  44. //根据电机工作模式(MC_WorkMode)、力矩传感器和指拨AD值(ADC_SensorData)、控制档位(MC_ControlCode.GearSt)计算控制FOC输入值(MC_CalParam)
  45. MC_CalParam_Cal(MC_WorkMode, ADC_SensorData, MC_ControlCode.GearSt, IsBreakTrig_Flag, IsGearSensorTrig_Flag, &MC_CalParam);
  46. //更新控制参数备份值
  47. Update_MC_CalParam_Back();
  48. //更新力矩传感器零点值
  49. if(IsTorqueOffSetUpdateEnable == TRUE)
  50. {
  51. TorqueOffSetData_Present_Update(&TorqueOffSetData.PresentData, ADC1_Result[ADC1_RANK_TORQUE_SENSOR], MC_TorqueCorrectParam.K, &MC_ErrorCode);
  52. }
  53. //更新指拨零点值
  54. GasSensorOffSetData_Update(&GasSensor_OffSet, ADC1_Result[ADC1_RANK_GAS], &MC_ErrorCode);
  55. //ADC数据滑动滤波计算
  56. ADC_SensorData_Filt(ADC1_Result_Filt, ADC2_Result_Filt);
  57. //发送给TE的传感器数据采集
  58. MC_TE_SensorScan(&MC_TE_SensorData);
  59. //5ms任务
  60. TimeCnt_5ms++;
  61. if(TimeCnt_5ms >= 5)
  62. {
  63. TimeCnt_5ms = 0;
  64. ICM20600Sensor.UpdateEn = ENABLE;
  65. }
  66. //10ms任务
  67. TimeCnt_10ms++;
  68. if(TimeCnt_10ms >= 10)
  69. {
  70. TimeCnt_10ms = 0;
  71. }
  72. //50ms任务
  73. TimeCnt_50ms++;
  74. if(TimeCnt_50ms >= 50)
  75. {
  76. TimeCnt_50ms = 0;
  77. //计算TE同步时钟频率
  78. Cal_SyncClockFreq(&MC_TE_SyncClockFreqScan);
  79. }
  80. //100ms任务
  81. TimeCnt_100ms++;
  82. if(TimeCnt_100ms >= 100)
  83. {
  84. TimeCnt_100ms = 0;
  85. //踏频计算滑动均值滤波
  86. MC_RunInfo.Cadence = MovingAverageFilter(MC_CadenceResult.Cadence_Data, MC_Cadence_Array, sizeof(MC_Cadence_Array) / 2);
  87. }
  88. //1000ms任务
  89. TimeCnt_1000ms++;
  90. if(TimeCnt_1000ms >= 1000)
  91. {
  92. TimeCnt_1000ms = 0;
  93. }
  94. }
  95. //CAN数据解析函数
  96. void CanRx_Process(void)
  97. {
  98. CAN_RxData_Process(&CAN_RxBuf_Struct_PBU, 500);
  99. CAN_RxData_Process(&CAN_RxBuf_Struct_BMS, 500);
  100. CAN_RxData_Process(&CAN_RxBuf_Struct_HMI, 500);
  101. CAN_RxData_Process(&CAN_RxBuf_Struct_CDL, 500);
  102. }
  103. //UART数据解析函数
  104. void UartRx_Process(void)
  105. {
  106. Uart_RxData_Process(&UART_RxBuff_Struct3, 500);
  107. }
  108. //MC运行信息更新
  109. void MC_RunInfo_Update(void)
  110. {
  111. static uint32_t PeriodTimeCnt = 0;
  112. if((HAL_GetTick() - PeriodTimeCnt) >= 200)
  113. {
  114. PeriodTimeCnt = HAL_GetTick();
  115. //计算电功率
  116. MC_RunInfo.Power = (uint16_t)((uint32_t)(MC_RunInfo.BusCurrent / 100 * MC_RunInfo.BusVoltage / 100) / 100) / 2;
  117. MC_RunInfo.Power = (MC_RunInfo.Power < 20) ? 0 : MC_RunInfo.Power;
  118. //更新踏频方向
  119. MC_RunInfo.CadenceDir = MC_CadenceResult.Cadence_Dir;
  120. //计算力矩值
  121. MC_RunInfo.Torque = ADC_SensorData.TorqueSensor / 28;
  122. //当前助力档位
  123. MC_RunInfo.GearSt = MC_ControlCode.GearSt;
  124. //当前灯开关
  125. MC_RunInfo.LightSwitch = MC_ControlCode.LightSwitch;
  126. //剩余电量
  127. MC_RunInfo.SOC = (DeviceOnLine_Status.Status_Bit.BMS_OffLine == 1) ? Battery_SocCal(MC_RunInfo.BusVoltage * 36 / MC_MotorParam.Rate_Voltage, MC_RunInfo.BusCurrent)
  128. : BMS_RunInfo.SOC;
  129. //续航里程
  130. MC_RunInfo.RemainDistance = (DeviceOnLine_Status.Status_Bit.BMS_OffLine == 1) ? 0xEEEE : RemainDis.remainDistance;
  131. //骑行总里程计算
  132. static uint32_t WheelTurnCount = 0;
  133. static FlagStatus RefreshFlag = RESET;
  134. if(MC_ConfigParam1.SpeedSignal == MC_SPEED_COMMUNICATION) //根据通信获取的车轮旋转周期计算
  135. {
  136. static uint32_t WheelTurnCount_Temp = 0;
  137. //运算周期是200ms,根据车轮旋转周期计算200ms内旋转的圈数,存在小数,放大100倍
  138. if(MC_SpeedSensorData.IsStopFlag == FALSE)
  139. {
  140. WheelTurnCount_Temp += 20000 / MC_SpeedSensorData.DiffTime_ms;
  141. MC_SpeedSensorData.WheelTurnCount = WheelTurnCount_Temp / 100;
  142. }
  143. }
  144. else if(MC_ConfigParam1.SpeedSignal == MC_SPEED_CADENCE_CAL) //根据踏频计算
  145. {
  146. //车轮转过的圈数 = 踏频信号个数 / 120 * 2.4 * 前飞齿数 / 后飞齿数
  147. MC_SpeedSensorData.WheelTurnCount = MC_CadenceResult.TrigCount * MC_ConfigParam1.TeethNum_F / MC_ConfigParam1.TeethNum_B / 50;
  148. }
  149. else
  150. {
  151. //车轮转过的圈数在速度传感器中断已处理
  152. }
  153. if((MC_SpeedSensorData.WheelTurnCount - WheelTurnCount) >= (10000 / (MC_ConfigParam1.WheelSize + MC_ConfigParam1.WheelSizeAdj))) //0.1km车轮所需圈数
  154. {
  155. RefreshFlag = SET;
  156. WheelTurnCount = MC_SpeedSensorData.WheelTurnCount;
  157. }
  158. if(RefreshFlag == SET)
  159. {
  160. RefreshFlag = RESET;
  161. //更新骑行历史信息中ODO和TRIP里程
  162. MC_RideLog.ODO_Km++;
  163. #if 0 //总里程是否自动归零
  164. if(MC_RideLog.ODO_Km > 999999)
  165. {
  166. MC_RideLog.ODO_Km = 0;
  167. MC_RideLog.ODO_Time = 0;
  168. }
  169. #endif
  170. MC_RideLog.TRIP_Km++;
  171. if(MC_RideLog.TRIP_Km > 99999) //超过9999.9km清零
  172. {
  173. MC_RideLog.TRIP_Km = 0;
  174. MC_RideLog.TRIP_Time = 0;
  175. }
  176. //更新运行信息中里程信息
  177. MC_RunInfo.Ride_Km++;
  178. MC_RunInfo.ODO_Km = MC_RideLog.ODO_Km / 10;
  179. #if 1 //自动存储骑行里程
  180. static uint8_t SavePeriodCount = 0;
  181. SavePeriodCount++;
  182. if(SavePeriodCount >= 30)//存储周期为3km
  183. {
  184. SaveParamToEEprom_24C02(&I2C_Handle_EEPROM, EEPROM_24C02_ADDR_RUN_LOG1, sizeof(MC_RunLog1_Struct_t), (uint8_t*)&MC_RunLog1.PowerOnCnt);
  185. SaveParamToEEprom_24C02(&I2C_Handle_EEPROM, EEPROM_24C02_ADDR_RIDE_LOG, sizeof(MC_RideLog_Struct_t), (uint8_t*)&MC_RideLog.ODO_Km);
  186. SavePeriodCount = 0;
  187. }
  188. #endif
  189. }
  190. //骑行时间计算
  191. static uint8_t Period_1sCnt = 0;
  192. static uint8_t Period_1minCnt = 0;
  193. static uint16_t SavePeriod_Cnt = 0;
  194. if(MC_RunInfo.BikeSpeed >= 30)
  195. {
  196. Period_1sCnt++;
  197. if(Period_1sCnt >= 5) //运行周期为200ms,计时周期200 * 5 = 1s
  198. {
  199. Period_1sCnt = 0;
  200. SavePeriod_Cnt++;
  201. MC_RunInfo.Ride_Time++;
  202. Period_1minCnt++;
  203. }
  204. }
  205. else
  206. {
  207. Period_1sCnt = 0;
  208. }
  209. if(Period_1minCnt >= 60) //1min
  210. {
  211. Period_1minCnt = 0;
  212. //更新骑行历史信息中骑行时间
  213. MC_RideLog.ODO_Time++;
  214. #if 0 //时间是否自动归零
  215. MC_RideLog.ODO_Time = (MC_RideLog.ODO_Time > 599999) ? 0 : MC_RideLog.ODO_Time; //超过9999h59min,清零
  216. MC_RideLog.TRIP_Time = (MC_RideLog.TRIP_Time > 599999) ? 0 : MC_RideLog.TRIP_Time;//超过9999h59min,清零
  217. #endif
  218. MC_RideLog.TRIP_Time++;
  219. }
  220. //存储骑行总时间
  221. if(SavePeriod_Cnt >= 600) //累计骑行600s进行存储
  222. {
  223. SavePeriod_Cnt = 0;
  224. SaveParamToEEprom_24C02(&I2C_Handle_EEPROM, EEPROM_24C02_ADDR_RUN_LOG1, sizeof(MC_RunLog1_Struct_t), (uint8_t*)&MC_RunLog1.PowerOnCnt);
  225. SaveParamToEEprom_24C02(&I2C_Handle_EEPROM, EEPROM_24C02_ADDR_RIDE_LOG, sizeof(MC_RideLog_Struct_t), (uint8_t*)&MC_RideLog.ODO_Km);
  226. }
  227. //平均功耗
  228. MC_RunInfo.PowerPerKm = RemainDis.Power_per_km_result / 10;
  229. }
  230. }
  231. //MC故障码发送
  232. void MC_SendErrorCode_Process(MC_ErrorCode_Struct_t ErrorCode)
  233. {
  234. static uint32_t PeriodTimeCnt = 0;
  235. if(IsSendDataToTE_Step == SENDUPDATA)
  236. {
  237. return;
  238. }
  239. if(ErrorCode.Code != 0x00000000)
  240. {
  241. if((HAL_GetTick() - PeriodTimeCnt) > 500)
  242. {
  243. PeriodTimeCnt = HAL_GetTick();
  244. SendData(ID_MC_BC, MODE_REPORT, 0x1104, (uint8_t*)&ErrorCode.Code);
  245. }
  246. }
  247. else
  248. {
  249. PeriodTimeCnt = HAL_GetTick();
  250. }
  251. }
  252. //MC主动发送运行信息
  253. void MC_SendRunInfo_Process(MC_WorkMode_Struct_t WorkMode)
  254. {
  255. static uint32_t PeriodTimeCnt = 0;
  256. if(WorkMode == MC_WorkMode_Config)
  257. {
  258. if((HAL_GetTick() - PeriodTimeCnt) >= 200)
  259. {
  260. SendData(ID_MC_BC, MODE_REPORT, 0x1020, (uint8_t*)&MC_RunInfo.BikeSpeed);
  261. PeriodTimeCnt = HAL_GetTick();
  262. }
  263. }
  264. else
  265. {
  266. PeriodTimeCnt = HAL_GetTick();
  267. }
  268. }
  269. //发给TE的传感器数据扫描
  270. void MC_TE_SensorScan(MC_TE_SensorData_Struct_t* p_MC_TE_SensorData)
  271. {
  272. static GPIO_PinState Cadence_Hall_1;
  273. static GPIO_PinState Cadence_Hall_2;
  274. static GPIO_PinState Motor_Hall_A;
  275. static GPIO_PinState Motor_Hall_B;
  276. static GPIO_PinState Break;
  277. static GPIO_PinState SpeedSensor;
  278. static TrueOrFalse_Flag_Struct_t IsFirstEnterFalg = TRUE;
  279. GPIO_PinState GPIO_PinState_Temp;
  280. //初始化变量
  281. if(IsFirstEnterFalg == TRUE)
  282. {
  283. Cadence_Hall_1 = HAL_GPIO_ReadPin(CADENCE_1_GPIO_Port, CADENCE_1_Pin);
  284. Cadence_Hall_2 = HAL_GPIO_ReadPin(CADENCE_2_GPIO_Port, CADENCE_2_Pin);
  285. Motor_Hall_A = HAL_GPIO_ReadPin(HALL_A_GPIO_Port, HALL_A_Pin);
  286. Motor_Hall_B = HAL_GPIO_ReadPin(HALL_B_GPIO_Port, HALL_B_Pin);
  287. Break = HAL_GPIO_ReadPin(BREAK_LEFT_GPIO_Port, BREAK_LEFT_Pin);
  288. SpeedSensor = HAL_GPIO_ReadPin(SPEED_SENSOR_GPIO_Port, SPEED_SENSOR_Pin);
  289. p_MC_TE_SensorData->CadenceHall_1_Cnt = 0;
  290. p_MC_TE_SensorData->CadenceHall_2_Cnt = 0;
  291. p_MC_TE_SensorData->MotorHall_A_Cnt = 0;
  292. p_MC_TE_SensorData->MotorHall_B_Cnt = 0;
  293. p_MC_TE_SensorData->BreakTrgiCnt = 0;
  294. p_MC_TE_SensorData->SpeedSensorTrigCnt = 0;
  295. IsFirstEnterFalg = FALSE;
  296. }
  297. //ADC数据更新采集
  298. p_MC_TE_SensorData->AD_BusCurrent = ADC1_Result_Filt[ADC1_RANK_CURRENT];
  299. p_MC_TE_SensorData->AD_CoilTemp = ADC1_Result_Filt[ADC1_RANK_NTC_COIL];
  300. p_MC_TE_SensorData->AD_TE_Voltage = ADC1_Result_Filt[ADC1_RANK_3V3_TE];
  301. p_MC_TE_SensorData->AD_Torque = ADC1_Result_Filt[ADC1_RANK_TORQUE_SENSOR];
  302. //踏频霍尔1
  303. GPIO_PinState_Temp = HAL_GPIO_ReadPin(CADENCE_1_GPIO_Port, CADENCE_1_Pin);
  304. if(Cadence_Hall_1 != GPIO_PinState_Temp)
  305. {
  306. p_MC_TE_SensorData->CadenceHall_1_Cnt++;
  307. }
  308. Cadence_Hall_1 = GPIO_PinState_Temp;
  309. //踏频霍尔2
  310. GPIO_PinState_Temp = HAL_GPIO_ReadPin(CADENCE_2_GPIO_Port, CADENCE_2_Pin);
  311. if(Cadence_Hall_2 != GPIO_PinState_Temp)
  312. {
  313. p_MC_TE_SensorData->CadenceHall_2_Cnt++;
  314. }
  315. Cadence_Hall_2 = GPIO_PinState_Temp;
  316. //马达霍尔A
  317. GPIO_PinState_Temp = HAL_GPIO_ReadPin(HALL_A_GPIO_Port, HALL_A_Pin);
  318. if(Motor_Hall_A != GPIO_PinState_Temp)
  319. {
  320. p_MC_TE_SensorData->MotorHall_A_Cnt++;
  321. }
  322. Motor_Hall_A = GPIO_PinState_Temp;
  323. //马达霍尔B
  324. GPIO_PinState_Temp = HAL_GPIO_ReadPin(HALL_B_GPIO_Port, HALL_B_Pin);
  325. if(Motor_Hall_B != GPIO_PinState_Temp)
  326. {
  327. p_MC_TE_SensorData->MotorHall_B_Cnt++;
  328. }
  329. Motor_Hall_B = GPIO_PinState_Temp;
  330. //刹车
  331. GPIO_PinState_Temp = HAL_GPIO_ReadPin(BREAK_LEFT_GPIO_Port, BREAK_LEFT_Pin);
  332. if(Break != GPIO_PinState_Temp)
  333. {
  334. p_MC_TE_SensorData->BreakTrgiCnt++;
  335. }
  336. Break = GPIO_PinState_Temp;
  337. //速度传感器
  338. GPIO_PinState_Temp = HAL_GPIO_ReadPin(SPEED_SENSOR_GPIO_Port, SPEED_SENSOR_Pin);
  339. if(SpeedSensor != GPIO_PinState_Temp)
  340. {
  341. p_MC_TE_SensorData->SpeedSensorTrigCnt++;
  342. }
  343. SpeedSensor = GPIO_PinState_Temp;
  344. //同步时钟频率
  345. p_MC_TE_SensorData->SynC_Clock_Freq = 1000; //1000KHz
  346. }
  347. //发给TE的传感器数据处理
  348. void MC_TE_SensorData_Process(MC_TE_SensorData_Struct_t* p_MC_TE_SensorData)
  349. {
  350. static uint32_t PeriodTimeCnt = 0;
  351. static uint16_t EnterCnt = 0;
  352. //数据发送
  353. if((HAL_GetTick() - PeriodTimeCnt) >= 500)
  354. {
  355. //计数超过20 * 500ms = 10s,进行一次清零
  356. EnterCnt++;
  357. if(EnterCnt >= 20)
  358. {
  359. if(MC_TE_SensorStatus.TE_ErrorCode.Status_Bit.BikeSpeed == 0)
  360. {
  361. MC_TE_SensorData.SpeedSensorTrigCnt = 0;
  362. }
  363. if(MC_TE_SensorStatus.TE_ErrorCode.Status_Bit.StopBreak == 0)
  364. {
  365. MC_TE_SensorData.BreakTrgiCnt = 0;
  366. }
  367. if(MC_TE_SensorStatus.TE_ErrorCode.Status_Bit.CadenseSensor_1 == 0)
  368. {
  369. MC_TE_SensorData.CadenceHall_1_Cnt = 0;
  370. }
  371. if(MC_TE_SensorStatus.TE_ErrorCode.Status_Bit.CadenseSensor_2 == 0)
  372. {
  373. MC_TE_SensorData.CadenceHall_2_Cnt = 0;
  374. }
  375. if(MC_TE_SensorStatus.TE_ErrorCode.Status_Bit.HallSensor_A == 0)
  376. {
  377. MC_TE_SensorData.MotorHall_A_Cnt = 0;
  378. }
  379. if(MC_TE_SensorStatus.TE_ErrorCode.Status_Bit.HallSensor_B == 0)
  380. {
  381. MC_TE_SensorData.MotorHall_B_Cnt = 0;
  382. }
  383. HAL_GPIO_TogglePin(SYC_IO_GPIO_Port, SYC_IO_Pin);
  384. EnterCnt = 0;
  385. }
  386. //发送
  387. if(IsSendDataToTE_Step == HANDSHAKE)//发送握手信息到TE,只发送一次
  388. {
  389. SendUartDataToTE(&UART_TxBuff_Struct3, 0x07FF, MODE_REPORT, 0x8800, (uint8_t*)NULL);
  390. IsSendDataToTE_Step = SENDSENSOR;
  391. }
  392. else if(IsSendDataToTE_Step == SENDSENSOR)//正常发送数据到TE
  393. {
  394. SendUartDataToTE(&UART_TxBuff_Struct3, 0x07FF, MODE_REPORT, 0x1014, (uint8_t*)&p_MC_TE_SensorData->AD_Torque);
  395. }
  396. PeriodTimeCnt = HAL_GetTick();
  397. }
  398. }
  399. //根据踏频和母线电流计算限流系数
  400. uint8_t MC_CadenceLimit_Cal(uint8_t Cadence, uint16_t Current, uint8_t T_Coil)
  401. {
  402. static uint32_t PeriodTimeCnt = 0;
  403. static uint32_t IdcFiltSum = 0;
  404. static uint8_t IdcFiltCnt = 0; //滤波输入值计算
  405. static uint16_t IdcFilt = 0; //滤波结果
  406. static uint16_t Limit_Cnt = 0; //限流计时值
  407. static uint16_t OK_Cnt = 0; //限流恢复计时值
  408. static FlagStatus LimitFlag = RESET;
  409. static uint8_t Result = 100;
  410. if((HAL_GetTick() - PeriodTimeCnt) >= 100)
  411. {
  412. PeriodTimeCnt = HAL_GetTick();
  413. //母线电流滤波
  414. IdcFiltSum += Current;
  415. IdcFiltCnt++;
  416. if(IdcFiltCnt >= 8)
  417. {
  418. IdcFilt = IdcFiltSum >> 3;
  419. IdcFiltCnt = 0;
  420. IdcFiltSum = 0;
  421. }
  422. //限流保护计时
  423. if((Cadence < 70) && (IdcFilt > 6000))
  424. {
  425. Limit_Cnt++;
  426. }
  427. else
  428. {
  429. Limit_Cnt = 0;
  430. }
  431. //限流恢复计时
  432. if(((Cadence > 70) || (IdcFilt < 5000)) && (T_Coil < 150))
  433. {
  434. OK_Cnt++;
  435. }
  436. else
  437. {
  438. OK_Cnt = 0;
  439. }
  440. //限流判断
  441. if(Limit_Cnt > 300)
  442. {
  443. Limit_Cnt = 0;
  444. LimitFlag = SET;
  445. }
  446. //限流恢复判断
  447. if(OK_Cnt > 100)
  448. {
  449. OK_Cnt = 0;
  450. LimitFlag = RESET;
  451. }
  452. //限流系数计算
  453. if(LimitFlag == SET)
  454. {
  455. if(Cadence < 70)
  456. {
  457. Result = 30 + Cadence;
  458. Result = (Result > 100) ? 100 : Result;
  459. }
  460. else
  461. {
  462. Result = 100;
  463. }
  464. }
  465. else
  466. {
  467. Result = 100;
  468. }
  469. }
  470. return Result;
  471. }
  472. //接收到关机指令处理
  473. void PowerOff_Process(void)
  474. {
  475. static FlagStatus SaveFlag = RESET;
  476. //关闭助力档位
  477. MC_ControlCode.GearSt = MC_GearSt_OFF;
  478. Update_MC_ControlCode_Back();
  479. #if 1 //存储到Flash,下次开机时从Flash取出转移到EEPROM
  480. if(SaveFlag == RESET)
  481. {
  482. MC_PowerOffBkp.ODO_Km = MC_RideLog.ODO_Km;
  483. MC_PowerOffBkp.ODO_Time = MC_RideLog.ODO_Time;
  484. MC_PowerOffBkp.Trip_Km = MC_RideLog.TRIP_Km;
  485. MC_PowerOffBkp.Trip_Time = MC_RideLog.TRIP_Time;
  486. MC_PowerOffBkp.Run_Time = MC_RunLog1.RunTime;
  487. SaveDataToEEPROM_Flash(EEPROM_FLASH_ADDR_POWEROFF_BKP, (uint8_t*)&MC_PowerOffBkp.ODO_Km, 40);//写入掉电临时保存数据,写入前该区域需擦除为0xFF才能操作成功
  488. SaveDataToEEPROM_Flash(EEPROM_FLASH_ADDR_POWEROFF_BKP_FLAG, (uint8_t*)"FLAG", 4); //掉电存储的数据标志更新
  489. SaveFlag = SET;
  490. }
  491. #endif
  492. //发送关机就绪信号
  493. SendData(ID_MC_BC, MODE_REPORT, 0x1305, (uint8_t*)"READY");
  494. }
  495. //CAN设备PBU、HMI、BMS通信状态检测处理
  496. void MC_CanRxCheck_Process(MC_SupportFlag_Struct_t NoPBU_Flag, MC_SupportFlag_Struct_t NoHMI_Flag, MC_WorkMode_Struct_t WorkMode, MC_GearSt_Struct_t* GearSt)
  497. {
  498. if((WorkMode == MC_WorkMode_Run) && (NoPBU_Flag == MC_SUPPORT_DISABLE)) //不支持无PBU,且正常运行模式
  499. {
  500. //PBU通信状态检测
  501. if(IsComOK_PBU.IsOK_Flag == TRUE)
  502. {
  503. if((HAL_GetTick() - IsComOK_PBU.OK_TrigTime) > 30000) //防止中控异常重启,重启过程持续10+s
  504. {
  505. IsComOK_PBU.IsOK_Flag = FALSE;
  506. *GearSt = MC_GearSt_OFF;
  507. Update_MC_ControlCode_Back();
  508. DeviceOnLine_Status.Status_Bit.PBU_OffLine = 1;
  509. }
  510. else
  511. {
  512. DeviceOnLine_Status.Status_Bit.PBU_OffLine = 0;
  513. }
  514. }
  515. else
  516. {
  517. *GearSt = MC_GearSt_OFF;
  518. Update_MC_ControlCode_Back();
  519. DeviceOnLine_Status.Status_Bit.PBU_OffLine = 1;
  520. }
  521. //HMI通信状态检测
  522. if(NoHMI_Flag == MC_SUPPORT_ENABLE)
  523. {
  524. DeviceOnLine_Status.Status_Bit.HMI_OffLine = 0;
  525. }
  526. else
  527. {
  528. if(IsComOK_HMI.IsOK_Flag == TRUE)
  529. {
  530. if((HAL_GetTick() - IsComOK_HMI.OK_TrigTime) > 1000)
  531. {
  532. IsComOK_HMI.IsOK_Flag = FALSE;
  533. DeviceOnLine_Status.Status_Bit.HMI_OffLine = 1;
  534. }
  535. else
  536. {
  537. DeviceOnLine_Status.Status_Bit.HMI_OffLine = 0;
  538. }
  539. }
  540. else
  541. {
  542. DeviceOnLine_Status.Status_Bit.HMI_OffLine = 1;
  543. }
  544. }
  545. //BMS通信状态检测
  546. if(IsComOK_BMS.IsOK_Flag == TRUE)
  547. {
  548. if((HAL_GetTick() - IsComOK_BMS.OK_TrigTime) > 1000)
  549. {
  550. IsComOK_BMS.IsOK_Flag = FALSE;
  551. DeviceOnLine_Status.Status_Bit.BMS_OffLine = 1;
  552. }
  553. else
  554. {
  555. DeviceOnLine_Status.Status_Bit.BMS_OffLine = 0;
  556. }
  557. }
  558. else
  559. {
  560. DeviceOnLine_Status.Status_Bit.BMS_OffLine = 1;
  561. }
  562. }
  563. }
  564. //UART设备TE通信状态检测处理
  565. void MC_UartRxCheck_Process(void)
  566. {
  567. //TE通信状态检测
  568. if(IsComOK_TE.IsOK_Flag == TRUE)
  569. {
  570. if((HAL_GetTick() - IsComOK_TE.OK_TrigTime) > 2000)
  571. {
  572. IsComOK_TE.IsOK_Flag = FALSE;
  573. }
  574. }
  575. }
  576. //运行总时间计算
  577. void MC_RunTime_Cal(uint32_t* p_Runtime)
  578. {
  579. static uint32_t PeriodTimeCnt = 0;
  580. static uint8_t SavePeriodCount = 0;
  581. if((HAL_GetTick()- PeriodTimeCnt) >= 60000)
  582. {
  583. PeriodTimeCnt = HAL_GetTick();
  584. (*p_Runtime)++;
  585. //存储运行总时间
  586. SavePeriodCount++;
  587. if(SavePeriodCount >= 10) //自动存储周期10min
  588. {
  589. SaveParamToEEprom_24C02(&I2C_Handle_EEPROM, EEPROM_24C02_ADDR_RUN_LOG1, sizeof(MC_RunLog1_Struct_t), (uint8_t*)&MC_RunLog1.PowerOnCnt);
  590. SavePeriodCount = 0;
  591. }
  592. }
  593. }
  594. //设备授权校验
  595. void MC_DeviceCheck(Device_CheckInfo_Struct_t* p_Device, MC_ErrorCode_Struct_t* p_ErrorCode)
  596. {
  597. uint32_t SendPeriodTimeCnt = 0;
  598. uint8_t Send_MAC_ID_Cmd_Count = 0;
  599. uint8_t Send_Code_Cmd_Count = 0;
  600. uint8_t CalCodeResult[12];
  601. uint8_t CheckResult = 0;
  602. uint16_t Send_CanID;
  603. uint16_t Send_MAC_ID_Cmd;
  604. uint16_t Send_Code_Cmd;
  605. uint8_t DeviceSerial = 0;
  606. //确定校验设备类型
  607. if(p_Device == &BMS_CheckInfo)
  608. {
  609. DeviceSerial = 1;
  610. }
  611. else if(p_Device == &PBU_CheckInfo)
  612. {
  613. DeviceSerial = 2;
  614. }
  615. if(p_Device == &HMI_CheckInfo)
  616. {
  617. DeviceSerial = 3;
  618. }
  619. //根据设备类型定义发送指令
  620. switch(DeviceSerial)
  621. {
  622. case 1://校验电池
  623. {
  624. p_ErrorCode->ERROR_Bit.Fault_BMS_Check = 1;
  625. Send_CanID = ID_MC_TO_BMS;
  626. Send_MAC_ID_Cmd = 0x3100;
  627. Send_Code_Cmd = 0x3200;
  628. break;
  629. }
  630. case 2://校验按键
  631. {
  632. p_ErrorCode->ERROR_Bit.Fault_BMS_Check = 1;
  633. Send_CanID = ID_MC_TO_BMS;
  634. Send_MAC_ID_Cmd = 0x5100;
  635. Send_Code_Cmd = 0x5200;
  636. break;
  637. }
  638. case 3://校验仪表
  639. {
  640. p_ErrorCode->ERROR_Bit.Fault_BMS_Check = 1;
  641. Send_CanID = ID_MC_TO_BMS;
  642. Send_MAC_ID_Cmd = 0x7100;
  643. Send_Code_Cmd = 0x7200;
  644. break;
  645. }
  646. default:break;
  647. }
  648. //查询MAC ID,计算校验码,并与查询的授权码比较
  649. Send_MAC_ID_Cmd_Count = 4;
  650. SendData(Send_CanID, MODE_READ, Send_MAC_ID_Cmd, (uint8_t*)NULL);
  651. SendPeriodTimeCnt = HAL_GetTick();
  652. while(Send_MAC_ID_Cmd_Count)
  653. {
  654. CanRx_Process();
  655. if(CheckArrayIs0(p_Device->MAC_ID, 12) != 0) //检查是否接收到ID
  656. {
  657. CheckCodeCal(p_Device->MAC_ID, Secret_Key, CalCodeResult);//根据接收的ID计算授权码
  658. Send_Code_Cmd_Count = 4;
  659. SendData(Send_CanID, MODE_READ, Send_Code_Cmd, (uint8_t*)NULL);
  660. SendPeriodTimeCnt = HAL_GetTick();
  661. while(Send_Code_Cmd_Count)
  662. {
  663. CanRx_Process();
  664. if(CheckArrayIs0(p_Device->CheckCode, 12) != 0) ////检查是否接收到授权码
  665. {
  666. if(strncmp((char*)p_Device->CheckCode, (char*)CalCodeResult, 12) == 0)
  667. {
  668. CheckResult = 1;
  669. }
  670. Send_MAC_ID_Cmd_Count = 0;
  671. Send_Code_Cmd_Count = 0;
  672. break;
  673. }
  674. else
  675. {
  676. if((HAL_GetTick() - SendPeriodTimeCnt) > 100)
  677. {
  678. SendData(Send_CanID, MODE_READ, Send_Code_Cmd, (uint8_t*)NULL);
  679. Send_Code_Cmd_Count--;
  680. SendPeriodTimeCnt = HAL_GetTick();
  681. }
  682. }
  683. //看门狗清零
  684. #if DEBUG
  685. HAL_IWDG_Refresh(&hiwdg);
  686. #endif
  687. }
  688. }
  689. else
  690. {
  691. if((HAL_GetTick() - SendPeriodTimeCnt) > 100)
  692. {
  693. SendData(Send_CanID, MODE_READ, Send_MAC_ID_Cmd, (uint8_t*)NULL);
  694. Send_MAC_ID_Cmd_Count--;
  695. SendPeriodTimeCnt = HAL_GetTick();
  696. }
  697. }
  698. //看门狗清零
  699. #if DEBUG
  700. HAL_IWDG_Refresh(&hiwdg);
  701. #endif
  702. }
  703. //根据设备类型输出结果
  704. switch(DeviceSerial)
  705. {
  706. case 1://校验电池
  707. {
  708. if(CheckResult == 1)
  709. {
  710. p_ErrorCode->ERROR_Bit.Fault_BMS_Check = 0;
  711. }
  712. else
  713. {
  714. p_ErrorCode->ERROR_Bit.Fault_BMS_Check = 1;
  715. MC_RunLog1.BMS_Check_FaultCnt++;
  716. SaveParamToEEprom_24C02(&I2C_Handle_EEPROM, EEPROM_24C02_ADDR_RUN_LOG1, sizeof(MC_RunLog1_Struct_t), (uint8_t*)&MC_RunLog1.PowerOnCnt);
  717. }
  718. break;
  719. }
  720. case 2://校验按键
  721. {
  722. if(CheckResult == 1)
  723. {
  724. p_ErrorCode->ERROR_Bit.Fault_PBU_Check = 0;
  725. }
  726. else
  727. {
  728. p_ErrorCode->ERROR_Bit.Fault_PBU_Check = 1;
  729. MC_RunLog1.PBU_Check_FaultCnt++;
  730. SaveParamToEEprom_24C02(&I2C_Handle_EEPROM, EEPROM_24C02_ADDR_RUN_LOG1, sizeof(MC_RunLog1_Struct_t), (uint8_t*)&MC_RunLog1.PowerOnCnt);
  731. }
  732. break;
  733. }
  734. case 3://校验仪表
  735. {
  736. if(CheckResult == 1)
  737. {
  738. p_ErrorCode->ERROR_Bit.Fault_HMI_Check = 0;
  739. }
  740. else
  741. {
  742. p_ErrorCode->ERROR_Bit.Fault_HMI_Check = 1;
  743. MC_RunLog1.HMI_Check_FaultCnt++;
  744. SaveParamToEEprom_24C02(&I2C_Handle_EEPROM, EEPROM_24C02_ADDR_RUN_LOG1, sizeof(MC_RunLog1_Struct_t), (uint8_t*)&MC_RunLog1.PowerOnCnt);
  745. }
  746. break;
  747. }
  748. default:break;
  749. }
  750. }
  751. //计算TIM2 ETR采集频率
  752. void Cal_SyncClockFreq(uint16_t* Result)
  753. {
  754. uint16_t Count = 0;
  755. Count = __HAL_TIM_GET_COUNTER(&htim2);
  756. *Result = Count * 20 / 1000;//50ms内计数值,单位转换为KHz
  757. __HAL_TIM_SET_COUNTER(&htim2, 0);
  758. }
  759. //温度历史信息处理
  760. void MC_TemperatureLogProcess(void)
  761. {
  762. static uint32_t PeriodTimeCnt = 0;
  763. static uint16_t SavePeriodCnt = 0;
  764. static TrueOrFalse_Flag_Struct_t DataChangeFlag = FALSE;
  765. if((IsSendDataToTE_Step == SENDUPDATA) || (IsComOK_TE.IsOK_Flag == FALSE)) //TE升级状态,或TE通讯失败状态下,不存储历史温度,TE无APP时对主控采集AD有影响
  766. {
  767. PeriodTimeCnt = HAL_GetTick();
  768. return;
  769. }
  770. if((HAL_GetTick() - PeriodTimeCnt) >= 5000) //判断周期5s
  771. {
  772. PeriodTimeCnt = HAL_GetTick();
  773. //PCB温度最小值
  774. if(MC_RunInfo.T_PCB < MC_RunLog1.T_PCB_Min)
  775. {
  776. MC_RunLog1.T_PCB_Min = MC_RunInfo.T_PCB;
  777. DataChangeFlag = TRUE;
  778. }
  779. //PCB温度最大值
  780. if(MC_RunInfo.T_PCB > MC_RunLog1.T_PCB_Max)
  781. {
  782. MC_RunLog1.T_PCB_Max = MC_RunInfo.T_PCB;
  783. DataChangeFlag = TRUE;
  784. }
  785. //绕组温度最小值
  786. if(MC_RunInfo.T_Coil < MC_RunLog1.T_Coil_Min)
  787. {
  788. MC_RunLog1.T_Coil_Min = MC_RunInfo.T_Coil;
  789. DataChangeFlag = TRUE;
  790. }
  791. //绕组温度最大值
  792. if(MC_RunInfo.T_Coil > MC_RunLog1.T_Coil_Max)
  793. {
  794. MC_RunLog1.T_Coil_Max = MC_RunInfo.T_Coil;
  795. DataChangeFlag = TRUE;
  796. }//MCU温度最小值
  797. if(MC_RunInfo.T_MCU < MC_RunLog1.T_MCU_Min)
  798. {
  799. MC_RunLog1.T_MCU_Min = MC_RunInfo.T_MCU;
  800. DataChangeFlag = TRUE;
  801. }
  802. //MCU温度最大值
  803. if(MC_RunInfo.T_MCU > MC_RunLog1.T_MCU_Max)
  804. {
  805. MC_RunLog1.T_MCU_Max = MC_RunInfo.T_MCU;
  806. DataChangeFlag = TRUE;
  807. }
  808. //自动存储
  809. SavePeriodCnt++;
  810. if((SavePeriodCnt > 12) && (DataChangeFlag == TRUE)) //1min
  811. {
  812. SavePeriodCnt = 0;
  813. DataChangeFlag = FALSE;
  814. SaveParamToEEprom_24C02(&I2C_Handle_EEPROM, EEPROM_24C02_ADDR_RUN_LOG1, sizeof(MC_RunLog1_Struct_t), (uint8_t*)&MC_RunLog1.PowerOnCnt);
  815. }
  816. }
  817. }
  818. /**************************全局函数定义结束*****************/