tasks.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782
  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. TorqueOffSetData_Present_Update(&TorqueOffSetData.PresentData, ADC1_Result[ADC1_RANK_TORQUE_SENSOR], MC_TorqueCorrectParam.K, &MC_ErrorCode);
  50. //更新指拨零点值
  51. GasSensorOffSetData_Update(&GasSensor_OffSet, ADC1_Result[ADC1_RANK_GAS], &MC_ErrorCode);
  52. //5ms任务
  53. TimeCnt_5ms++;
  54. if(TimeCnt_5ms >= 5)
  55. {
  56. TimeCnt_5ms = 0;
  57. ICM20600Sensor.UpdateEn = ENABLE;
  58. }
  59. //10ms任务
  60. TimeCnt_10ms++;
  61. if(TimeCnt_10ms >= 10)
  62. {
  63. TimeCnt_10ms = 0;
  64. }
  65. //50ms任务
  66. TimeCnt_50ms++;
  67. if(TimeCnt_50ms >= 50)
  68. {
  69. TimeCnt_50ms = 0;
  70. //计算TE同步时钟频率
  71. Cal_SyncClockFreq(&MC_TE_SyncClockFreqScan);
  72. }
  73. //100ms任务
  74. TimeCnt_100ms++;
  75. if(TimeCnt_100ms >= 100)
  76. {
  77. TimeCnt_100ms = 0;
  78. //踏频计算滑动均值滤波
  79. MC_RunInfo.Cadence = MovingAverageFilter(MC_CadenceResult.Cadence_Data, MC_Cadence_Array, sizeof(MC_Cadence_Array) / 2);
  80. }
  81. //1000ms任务
  82. TimeCnt_1000ms++;
  83. if(TimeCnt_1000ms >= 1000)
  84. {
  85. TimeCnt_1000ms = 0;
  86. }
  87. }
  88. //CAN数据解析函数
  89. void CanRx_Process(void)
  90. {
  91. CAN_RxData_Process(&CAN_RxBuf_Struct_PBU, 500);
  92. CAN_RxData_Process(&CAN_RxBuf_Struct_BMS, 500);
  93. CAN_RxData_Process(&CAN_RxBuf_Struct_HMI, 500);
  94. CAN_RxData_Process(&CAN_RxBuf_Struct_CDL, 500);
  95. }
  96. //UART数据解析函数
  97. void UartRx_Process(void)
  98. {
  99. Uart_RxData_Process(&UART_RxBuff_Struct3, 500);
  100. }
  101. //MC运行信息更新
  102. void MC_RunInfo_Update(void)
  103. {
  104. static uint32_t PeriodTimeCnt = 0;
  105. if((HAL_GetTick() - PeriodTimeCnt) >= 200)
  106. {
  107. PeriodTimeCnt = HAL_GetTick();
  108. //计算电功率
  109. MC_RunInfo.Power = (uint16_t)((uint32_t)(MC_RunInfo.BusCurrent / 100 * MC_RunInfo.BusVoltage / 100) / 100) / 2;
  110. MC_RunInfo.Power = (MC_RunInfo.Power < 20) ? 0 : MC_RunInfo.Power;
  111. //更新踏频方向
  112. MC_RunInfo.CadenceDir = MC_CadenceResult.Cadence_Dir;
  113. //计算力矩值
  114. MC_RunInfo.Torque = ADC_SensorData.TorqueSensor / 28;
  115. //当前助力档位
  116. MC_RunInfo.GearSt = MC_ControlCode.GearSt;
  117. //当前灯开关
  118. MC_RunInfo.LightSwitch = MC_ControlCode.LightSwitch;
  119. //剩余电量
  120. MC_RunInfo.SOC = (DeviceOnLine_Status.Status_Bit.BMS_OffLine == 1) ? Battery_SocCal(MC_RunInfo.BusVoltage * 36 / MC_MotorParam.Rate_Voltage, MC_RunInfo.BusCurrent)
  121. : BMS_RunInfo.SOC;
  122. //续航里程
  123. MC_RunInfo.RemainDistance = RemainDis.remainDistance;
  124. //骑行总里程计算
  125. static uint32_t WheelTurnCount = 0;
  126. static FlagStatus RefreshFlag = RESET;
  127. if(MC_ConfigParam1.No_SpeedSensor_Flag != MC_SUPPORT_ENABLE) //不支持无速度传感器
  128. {
  129. if((MC_SpeedSensorData.WheelTurnCount - WheelTurnCount) >= (10000 / (MC_ConfigParam1.WheelSize + MC_ConfigParam1.WheelSizeAdj))) //0.1km车轮所需圈数
  130. {
  131. RefreshFlag = SET;
  132. WheelTurnCount = MC_SpeedSensorData.WheelTurnCount;
  133. }
  134. }
  135. else //支持无速度传感器
  136. {
  137. //车轮转过的圈数 = 踏频信号个数 / 120 * 2.4 * 前飞齿数 / 后飞齿数
  138. if(((MC_CadenceResult.TrigCount - WheelTurnCount) * MC_ConfigParam1.TeethNum_F / MC_ConfigParam1.TeethNum_B / 50) >= (10000 / (MC_ConfigParam1.WheelSize + MC_ConfigParam1.WheelSizeAdj))) //0.1km车轮所需圈数
  139. {
  140. RefreshFlag = SET;
  141. WheelTurnCount = MC_CadenceResult.TrigCount;
  142. }
  143. }
  144. if(RefreshFlag == SET)
  145. {
  146. RefreshFlag = RESET;
  147. //更新骑行历史信息中ODO和TRIP里程
  148. MC_RideLog.ODO_Km++;
  149. MC_RideLog.ODO_Km = (MC_RideLog.ODO_Km > 999999) ? 0 : MC_RideLog.ODO_Km; //超过99999.9km清零
  150. MC_RideLog.TRIP_Km++;
  151. MC_RideLog.TRIP_Km = (MC_RideLog.TRIP_Km > 99999) ? 0 : MC_RideLog.TRIP_Km;//超过9999.9km清零
  152. //更新运行信息中里程信息
  153. MC_RunInfo.Ride_Km++;
  154. MC_RunInfo.ODO_Km = MC_RideLog.ODO_Km / 10;
  155. #if 1 //自动存储骑行里程
  156. static uint8_t SavePeriodCount = 0;
  157. SavePeriodCount++;
  158. if(SavePeriodCount >= 30)//存储周期为3km
  159. {
  160. SaveParamToEEprom_24C02(&I2C_Handle_EEPROM, EEPROM_24C02_ADDR_RUN_LOG1, sizeof(MC_RunLog1_Struct_t), (uint8_t*)&MC_RunLog1.PowerOnCnt);
  161. SaveParamToEEprom_24C02(&I2C_Handle_EEPROM, EEPROM_24C02_ADDR_RIDE_LOG, sizeof(MC_RideLog_Struct_t), (uint8_t*)&MC_RideLog.ODO_Km);
  162. SavePeriodCount = 0;
  163. }
  164. #endif
  165. }
  166. //骑行时间计算
  167. static uint8_t Period_1sCnt = 0;
  168. static uint8_t Period_1minCnt = 0;
  169. static uint16_t SavePeriod_Cnt = 0;
  170. if(MC_RunInfo.BikeSpeed >= 30)
  171. {
  172. Period_1sCnt++;
  173. if(Period_1sCnt >= 5) //运行周期为200ms,计时周期200 * 5 = 1s
  174. {
  175. Period_1sCnt = 0;
  176. SavePeriod_Cnt++;
  177. MC_RunInfo.Ride_Time++;
  178. Period_1minCnt++;
  179. }
  180. }
  181. else
  182. {
  183. Period_1sCnt = 0;
  184. }
  185. if(Period_1minCnt >= 60) //1min
  186. {
  187. Period_1minCnt = 0;
  188. //更新骑行历史信息中骑行时间
  189. MC_RideLog.ODO_Time++;
  190. MC_RideLog.ODO_Time = (MC_RideLog.ODO_Time > 599999) ? 0 : MC_RideLog.ODO_Time; //超过9999h59min,清零
  191. MC_RideLog.TRIP_Time = (MC_RideLog.TRIP_Time > 599999) ? 0 : MC_RideLog.TRIP_Time;//超过9999h59min,清零
  192. MC_RideLog.TRIP_Time++;
  193. }
  194. //存储骑行总时间
  195. if(SavePeriod_Cnt >= 600) //累计骑行600s进行存储
  196. {
  197. SavePeriod_Cnt = 0;
  198. SaveParamToEEprom_24C02(&I2C_Handle_EEPROM, EEPROM_24C02_ADDR_RUN_LOG1, sizeof(MC_RunLog1_Struct_t), (uint8_t*)&MC_RunLog1.PowerOnCnt);
  199. SaveParamToEEprom_24C02(&I2C_Handle_EEPROM, EEPROM_24C02_ADDR_RIDE_LOG, sizeof(MC_RideLog_Struct_t), (uint8_t*)&MC_RideLog.ODO_Km);
  200. }
  201. //平均功耗
  202. MC_RunInfo.PowerPerKm = RemainDis.Power_per_km_result / 10;
  203. }
  204. }
  205. //MC故障码发送
  206. void MC_SendErrorCode_Process(MC_ErrorCode_Struct_t ErrorCode)
  207. {
  208. static uint32_t PeriodTimeCnt = 0;
  209. if(IsSendDataToTE_Step == SENDUPDATA)
  210. {
  211. return;
  212. }
  213. if(ErrorCode.Code != 0x00000000)
  214. {
  215. if((HAL_GetTick() - PeriodTimeCnt) > 500)
  216. {
  217. PeriodTimeCnt = HAL_GetTick();
  218. SendData(ID_MC_BC, MODE_REPORT, 0x1104, (uint8_t*)&ErrorCode.Code);
  219. }
  220. }
  221. else
  222. {
  223. PeriodTimeCnt = HAL_GetTick();
  224. }
  225. }
  226. //MC主动发送运行信息
  227. void MC_SendRunInfo_Process(MC_WorkMode_Struct_t WorkMode)
  228. {
  229. static uint32_t PeriodTimeCnt = 0;
  230. if(WorkMode == MC_WorkMode_Config)
  231. {
  232. if((HAL_GetTick() - PeriodTimeCnt) >= 200)
  233. {
  234. SendData(ID_MC_BC, MODE_REPORT, 0x1020, (uint8_t*)&MC_RunInfo.BikeSpeed);
  235. PeriodTimeCnt = HAL_GetTick();
  236. }
  237. }
  238. else
  239. {
  240. PeriodTimeCnt = HAL_GetTick();
  241. }
  242. }
  243. //发给TE的传感器数据处理
  244. void MC_TE_SensorData_Process(uint16_t Speed, MC_TE_SensorData_Struct_t* p_MC_TE_SensorData)
  245. {
  246. static uint32_t PeriodTimeCnt = 0;
  247. static GPIO_PinState Cadence_Hall_1;
  248. static GPIO_PinState Cadence_Hall_2;
  249. static GPIO_PinState Motor_Hall_A;
  250. static GPIO_PinState Motor_Hall_B;
  251. static GPIO_PinState Break;
  252. static GPIO_PinState SpeedSensor;
  253. static TrueOrFalse_Flag_Struct_t IsFirstEnterFalg = TRUE;
  254. GPIO_PinState GPIO_PinState_Temp;
  255. //初始化变量
  256. if(IsFirstEnterFalg == TRUE)
  257. {
  258. Cadence_Hall_1 = HAL_GPIO_ReadPin(CADENCE_1_GPIO_Port, CADENCE_1_Pin);
  259. Cadence_Hall_2 = HAL_GPIO_ReadPin(CADENCE_2_GPIO_Port, CADENCE_2_Pin);
  260. Motor_Hall_A = HAL_GPIO_ReadPin(HALL_A_GPIO_Port, HALL_A_Pin);
  261. Motor_Hall_B = HAL_GPIO_ReadPin(HALL_B_GPIO_Port, HALL_B_Pin);
  262. Break = HAL_GPIO_ReadPin(BREAK_LEFT_GPIO_Port, BREAK_LEFT_Pin);
  263. SpeedSensor = HAL_GPIO_ReadPin(SPEED_SENSOR_GPIO_Port, SPEED_SENSOR_Pin);
  264. p_MC_TE_SensorData->CadenceHall_1_Cnt = 0;
  265. p_MC_TE_SensorData->CadenceHall_2_Cnt = 0;
  266. p_MC_TE_SensorData->MotorHall_A_Cnt = 0;
  267. p_MC_TE_SensorData->MotorHall_B_Cnt = 0;
  268. p_MC_TE_SensorData->BreakTrgiCnt = 0;
  269. p_MC_TE_SensorData->SpeedSensorTrigCnt = 0;
  270. IsFirstEnterFalg = FALSE;
  271. }
  272. //ADC数据更新采集
  273. p_MC_TE_SensorData->AD_BusCurrent = ADC1_Result_Filt[ADC1_RANK_CURRENT];
  274. p_MC_TE_SensorData->AD_CoilTemp = ADC1_Result_Filt[ADC1_RANK_NTC_COIL];
  275. p_MC_TE_SensorData->AD_TE_Voltage = ADC1_Result_Filt[ADC1_RANK_3V3_TE];
  276. p_MC_TE_SensorData->AD_Torque = ADC1_Result_Filt[ADC1_RANK_TORQUE_SENSOR];
  277. //踏频霍尔1
  278. GPIO_PinState_Temp = HAL_GPIO_ReadPin(CADENCE_1_GPIO_Port, CADENCE_1_Pin);
  279. if(Cadence_Hall_1 != GPIO_PinState_Temp)
  280. {
  281. p_MC_TE_SensorData->CadenceHall_1_Cnt++;
  282. }
  283. Cadence_Hall_1 = GPIO_PinState_Temp;
  284. //踏频霍尔2
  285. GPIO_PinState_Temp = HAL_GPIO_ReadPin(CADENCE_2_GPIO_Port, CADENCE_2_Pin);
  286. if(Cadence_Hall_2 != GPIO_PinState_Temp)
  287. {
  288. p_MC_TE_SensorData->CadenceHall_2_Cnt++;
  289. }
  290. Cadence_Hall_2 = GPIO_PinState_Temp;
  291. //马达霍尔A
  292. GPIO_PinState_Temp = HAL_GPIO_ReadPin(HALL_A_GPIO_Port, HALL_A_Pin);
  293. if(Motor_Hall_A != GPIO_PinState_Temp)
  294. {
  295. p_MC_TE_SensorData->MotorHall_A_Cnt++;
  296. }
  297. Motor_Hall_A = GPIO_PinState_Temp;
  298. //马达霍尔B
  299. GPIO_PinState_Temp = HAL_GPIO_ReadPin(HALL_B_GPIO_Port, HALL_B_Pin);
  300. if(Motor_Hall_B != GPIO_PinState_Temp)
  301. {
  302. p_MC_TE_SensorData->MotorHall_B_Cnt++;
  303. }
  304. Motor_Hall_B = GPIO_PinState_Temp;
  305. //刹车
  306. GPIO_PinState_Temp = HAL_GPIO_ReadPin(BREAK_LEFT_GPIO_Port, BREAK_LEFT_Pin);
  307. if(Break != GPIO_PinState_Temp)
  308. {
  309. p_MC_TE_SensorData->BreakTrgiCnt++;
  310. }
  311. Break = GPIO_PinState_Temp;
  312. //速度传感器
  313. GPIO_PinState_Temp = HAL_GPIO_ReadPin(SPEED_SENSOR_GPIO_Port, SPEED_SENSOR_Pin);
  314. if(SpeedSensor != GPIO_PinState_Temp)
  315. {
  316. p_MC_TE_SensorData->SpeedSensorTrigCnt++;
  317. }
  318. SpeedSensor = GPIO_PinState_Temp;
  319. //同步时钟频率
  320. p_MC_TE_SensorData->SynC_Clock_Freq = 1000; //1000KHz
  321. //数据发送
  322. static uint16_t EnterCnt = 0;
  323. if((HAL_GetTick() - PeriodTimeCnt) >= 500)
  324. {
  325. //计数超过20 * 500ms = 10s,进行一次清零
  326. EnterCnt++;
  327. if(EnterCnt >= 20)
  328. {
  329. if(MC_TE_SensorStatus.TE_ErrorCode.Status_Bit.BikeSpeed == 0)
  330. {
  331. MC_TE_SensorData.SpeedSensorTrigCnt = 0;
  332. }
  333. if(MC_TE_SensorStatus.TE_ErrorCode.Status_Bit.StopBreak == 0)
  334. {
  335. MC_TE_SensorData.BreakTrgiCnt = 0;
  336. }
  337. if(MC_TE_SensorStatus.TE_ErrorCode.Status_Bit.CadenseSensor_1 == 0)
  338. {
  339. MC_TE_SensorData.CadenceHall_1_Cnt = 0;
  340. }
  341. if(MC_TE_SensorStatus.TE_ErrorCode.Status_Bit.CadenseSensor_2 == 0)
  342. {
  343. MC_TE_SensorData.CadenceHall_2_Cnt = 0;
  344. }
  345. if(MC_TE_SensorStatus.TE_ErrorCode.Status_Bit.HallSensor_A == 0)
  346. {
  347. MC_TE_SensorData.MotorHall_A_Cnt = 0;
  348. }
  349. if(MC_TE_SensorStatus.TE_ErrorCode.Status_Bit.HallSensor_B == 0)
  350. {
  351. MC_TE_SensorData.MotorHall_B_Cnt = 0;
  352. }
  353. HAL_GPIO_TogglePin(SYC_IO_GPIO_Port, SYC_IO_Pin);
  354. EnterCnt = 0;
  355. }
  356. //发送
  357. if(IsSendDataToTE_Step == HANDSHAKE)//发送握手信息到TE,只发送一次
  358. {
  359. SendUartDataToTE(&UART_TxBuff_Struct3, 0x07FF, MODE_REPORT, 0x8800, (uint8_t*)NULL);
  360. IsSendDataToTE_Step = SENDSENSOR;
  361. }
  362. else if(IsSendDataToTE_Step == SENDSENSOR)//正常发送数据到TE
  363. {
  364. SendUartDataToTE(&UART_TxBuff_Struct3, 0x07FF, MODE_REPORT, 0x1014, (uint8_t*)&p_MC_TE_SensorData->AD_Torque);
  365. }
  366. PeriodTimeCnt = HAL_GetTick();
  367. }
  368. }
  369. //根据踏频和母线电流计算限流系数
  370. uint8_t MC_CadenceLimit_Cal(uint8_t Cadence, uint16_t Current, uint8_t T_Coil)
  371. {
  372. static uint32_t PeriodTimeCnt = 0;
  373. static uint32_t IdcFiltSum = 0;
  374. static uint8_t IdcFiltCnt = 0; //滤波输入值计算
  375. static uint16_t IdcFilt = 0; //滤波结果
  376. static uint16_t Limit_Cnt = 0; //限流计时值
  377. static uint16_t OK_Cnt = 0; //限流恢复计时值
  378. static FlagStatus LimitFlag = RESET;
  379. static uint8_t Result = 100;
  380. if((HAL_GetTick() - PeriodTimeCnt) >= 100)
  381. {
  382. PeriodTimeCnt = HAL_GetTick();
  383. //母线电流滤波
  384. IdcFiltSum += Current;
  385. IdcFiltCnt++;
  386. if(IdcFiltCnt >= 8)
  387. {
  388. IdcFilt = IdcFiltSum >> 3;
  389. IdcFiltCnt = 0;
  390. IdcFiltSum = 0;
  391. }
  392. //限流保护计时
  393. if((Cadence < 70) && (IdcFilt > 6000))
  394. {
  395. Limit_Cnt++;
  396. }
  397. else
  398. {
  399. Limit_Cnt = 0;
  400. }
  401. //限流恢复计时
  402. if(((Cadence > 70) || (IdcFilt < 5000)) && (T_Coil < 150))
  403. {
  404. OK_Cnt++;
  405. }
  406. else
  407. {
  408. OK_Cnt = 0;
  409. }
  410. //限流判断
  411. if(Limit_Cnt > 300)
  412. {
  413. Limit_Cnt = 0;
  414. LimitFlag = SET;
  415. }
  416. //限流恢复判断
  417. if(OK_Cnt > 100)
  418. {
  419. OK_Cnt = 0;
  420. LimitFlag = RESET;
  421. }
  422. //限流系数计算
  423. if(LimitFlag == SET)
  424. {
  425. if(Cadence < 70)
  426. {
  427. Result = 30 + Cadence;
  428. Result = (Result > 100) ? 100 : Result;
  429. }
  430. else
  431. {
  432. Result = 100;
  433. }
  434. }
  435. else
  436. {
  437. Result = 100;
  438. }
  439. }
  440. return Result;
  441. }
  442. //接收到关机指令处理
  443. void PowerOff_Process(void)
  444. {
  445. static FlagStatus SaveFlag = RESET;
  446. //关闭助力档位
  447. MC_ControlCode.GearSt = MC_GearSt_OFF;
  448. Update_MC_ControlCode_Back();
  449. #if 1 //存储到Flash,下次开机时从Flash取出转移到EEPROM
  450. if(SaveFlag == RESET)
  451. {
  452. MC_PowerOffBkp.ODO_Km = MC_RideLog.ODO_Km;
  453. MC_PowerOffBkp.ODO_Time = MC_RideLog.ODO_Time;
  454. MC_PowerOffBkp.Trip_Km = MC_RideLog.TRIP_Km;
  455. MC_PowerOffBkp.Trip_Time = MC_RideLog.TRIP_Time;
  456. MC_PowerOffBkp.Run_Time = MC_RunLog1.RunTime;
  457. SaveDataToEEPROM_Flash(EEPROM_FLASH_ADDR_POWEROFF_BKP, (uint8_t*)&MC_PowerOffBkp.ODO_Km, 40);//写入掉电临时保存数据,写入前该区域需擦除为0xFF才能操作成功
  458. SaveDataToEEPROM_Flash(EEPROM_FLASH_ADDR_POWEROFF_BKP_FLAG, (uint8_t*)"FLAG", 4); //掉电存储的数据标志更新
  459. SaveFlag = SET;
  460. }
  461. #endif
  462. //发送关机就绪信号
  463. SendData(ID_MC_BC, MODE_REPORT, 0x1305, (uint8_t*)"READY");
  464. }
  465. //CAN设备PBU、HMI、BMS通信状态检测处理
  466. 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)
  467. {
  468. if((WorkMode == MC_WorkMode_Run) && (NoPBU_Flag == MC_SUPPORT_DISABLE)) //不支持无PBU,且正常运行模式
  469. {
  470. //PBU通信状态检测
  471. if(IsComOK_PBU.IsOK_Flag == TRUE)
  472. {
  473. if((HAL_GetTick() - IsComOK_PBU.OK_TrigTime) > 1000)
  474. {
  475. IsComOK_PBU.IsOK_Flag = FALSE;
  476. *GearSt = MC_GearSt_OFF;
  477. Update_MC_ControlCode_Back();
  478. DeviceOnLine_Status.Status_Bit.PBU_OffLine = 1;
  479. }
  480. else
  481. {
  482. DeviceOnLine_Status.Status_Bit.PBU_OffLine = 0;
  483. }
  484. }
  485. else
  486. {
  487. *GearSt = MC_GearSt_OFF;
  488. Update_MC_ControlCode_Back();
  489. DeviceOnLine_Status.Status_Bit.PBU_OffLine = 1;
  490. }
  491. //HMI通信状态检测
  492. if(NoHMI_Flag == MC_SUPPORT_ENABLE)
  493. {
  494. DeviceOnLine_Status.Status_Bit.HMI_OffLine = 0;
  495. }
  496. else
  497. {
  498. if(IsComOK_HMI.IsOK_Flag == TRUE)
  499. {
  500. if((HAL_GetTick() - IsComOK_HMI.OK_TrigTime) > 1000)
  501. {
  502. IsComOK_HMI.IsOK_Flag = FALSE;
  503. DeviceOnLine_Status.Status_Bit.HMI_OffLine = 1;
  504. }
  505. else
  506. {
  507. DeviceOnLine_Status.Status_Bit.HMI_OffLine = 0;
  508. }
  509. }
  510. else
  511. {
  512. DeviceOnLine_Status.Status_Bit.HMI_OffLine = 1;
  513. }
  514. }
  515. //BMS通信状态检测
  516. if(IsComOK_BMS.IsOK_Flag == TRUE)
  517. {
  518. if((HAL_GetTick() - IsComOK_BMS.OK_TrigTime) > 1000)
  519. {
  520. IsComOK_BMS.IsOK_Flag = FALSE;
  521. DeviceOnLine_Status.Status_Bit.BMS_OffLine = 1;
  522. }
  523. else
  524. {
  525. DeviceOnLine_Status.Status_Bit.BMS_OffLine = 0;
  526. }
  527. }
  528. else
  529. {
  530. DeviceOnLine_Status.Status_Bit.BMS_OffLine = 1;
  531. }
  532. }
  533. }
  534. //UART设备TE通信状态检测处理
  535. void MC_UartRxCheck_Process(void)
  536. {
  537. //TE通信状态检测
  538. if(IsComOK_TE.IsOK_Flag == TRUE)
  539. {
  540. if((HAL_GetTick() - IsComOK_TE.OK_TrigTime) > 2000)
  541. {
  542. IsComOK_TE.IsOK_Flag = FALSE;
  543. }
  544. }
  545. }
  546. //运行总时间计算
  547. void MC_RunTime_Cal(uint32_t* p_Runtime)
  548. {
  549. static uint32_t PeriodTimeCnt = 0;
  550. static uint8_t SavePeriodCount = 0;
  551. if((HAL_GetTick()- PeriodTimeCnt) >= 60000)
  552. {
  553. PeriodTimeCnt = HAL_GetTick();
  554. (*p_Runtime)++;
  555. //存储运行总时间
  556. SavePeriodCount++;
  557. if(SavePeriodCount >= 10) //自动存储周期10min
  558. {
  559. SaveParamToEEprom_24C02(&I2C_Handle_EEPROM, EEPROM_24C02_ADDR_RUN_LOG1, sizeof(MC_RunLog1_Struct_t), (uint8_t*)&MC_RunLog1.PowerOnCnt);
  560. SavePeriodCount = 0;
  561. }
  562. }
  563. }
  564. //设备在线检测
  565. void MC_OnLineCheck(OnLine_Status_Struct_t* p_OnLineStatus, MC_ErrorCode_Struct_t* p_ErrorCode)
  566. {
  567. uint8_t SendTimeCnt;
  568. uint32_t PeriodTimeCnt;
  569. //发送指令查询PBU是否在线
  570. PeriodTimeCnt = HAL_GetTick();
  571. SendTimeCnt = 0;
  572. do
  573. {
  574. CAN_RxData_Process(&CAN_RxBuf_Struct_PBU, 500);
  575. if((HAL_GetTick() - PeriodTimeCnt) >= 50)
  576. {
  577. PeriodTimeCnt = HAL_GetTick();
  578. SendTimeCnt++;
  579. SendData(ID_MC_TO_PBU, MODE_READ, 0x5009, (uint8_t*)"HANDSHAKE");
  580. }
  581. //看门狗清零
  582. #if DEBUG
  583. HAL_IWDG_Refresh(&hiwdg);
  584. #endif
  585. }while((p_OnLineStatus->Status_Bit.PBU_OffLine == 1) && (SendTimeCnt <= 4));
  586. p_ErrorCode->ERROR_Bit.Fault_PBU_Check = p_OnLineStatus->Status_Bit.PBU_OffLine;
  587. //发送指令查询HMI是否在线
  588. if(PBU_ConfigParam.NoHMI_Flag == MC_SUPPORT_DISABLE)
  589. {
  590. PeriodTimeCnt = HAL_GetTick();
  591. SendTimeCnt = 0;
  592. do
  593. {
  594. CAN_RxData_Process(&CAN_RxBuf_Struct_HMI, 500);
  595. if((HAL_GetTick() - PeriodTimeCnt) >= 50)
  596. {
  597. PeriodTimeCnt = HAL_GetTick();
  598. SendTimeCnt++;
  599. SendData(ID_MC_TO_HMI, MODE_READ, 0x7009, (uint8_t*)"HANDSHAKE");
  600. }
  601. //看门狗清零
  602. #if DEBUG
  603. HAL_IWDG_Refresh(&hiwdg);
  604. #endif
  605. }while((p_OnLineStatus->Status_Bit.HMI_OffLine == 1) && (SendTimeCnt <= 4));
  606. }
  607. else
  608. {
  609. p_OnLineStatus->Status_Bit.HMI_OffLine = 0;
  610. }
  611. p_ErrorCode->ERROR_Bit.Fault_HMI_Check = p_OnLineStatus->Status_Bit.HMI_OffLine;
  612. //发送指令查询BMS是否在线
  613. PeriodTimeCnt = HAL_GetTick();
  614. SendTimeCnt = 0;
  615. do
  616. {
  617. CAN_RxData_Process(&CAN_RxBuf_Struct_BMS, 500);
  618. if((HAL_GetTick() - PeriodTimeCnt) >= 50)
  619. {
  620. PeriodTimeCnt = HAL_GetTick();
  621. SendTimeCnt++;
  622. SendData(ID_MC_TO_BMS, MODE_READ, 0x3009, (uint8_t*)"HANDSHAKE");
  623. }
  624. //看门狗清零
  625. #if DEBUG
  626. HAL_IWDG_Refresh(&hiwdg);
  627. #endif
  628. }while((p_OnLineStatus->Status_Bit.BMS_OffLine == 1) && (SendTimeCnt <= 4));
  629. p_ErrorCode->ERROR_Bit.Fault_BMS_Check = p_OnLineStatus->Status_Bit.BMS_OffLine;
  630. }
  631. //设备授权校验
  632. void MC_DeviceCheck(MC_ErrorCode_Struct_t* p_ErrorCode)
  633. {
  634. uint8_t T[16];
  635. CheckCodeCal(NULL, Secret_Key, T);
  636. }
  637. //计算TIM2 ETR采集频率
  638. void Cal_SyncClockFreq(uint16_t* Result)
  639. {
  640. uint16_t Count = 0;
  641. Count = __HAL_TIM_GET_COUNTER(&htim2);
  642. *Result = Count * 20 / 1000;//50ms内计数值,单位转换为KHz
  643. __HAL_TIM_SET_COUNTER(&htim2, 0);
  644. }
  645. //温度历史信息处理
  646. void MC_TemperatureLogProcess(void)
  647. {
  648. static uint32_t PeriodTimeCnt = 0;
  649. static uint16_t SavePeriodCnt = 0;
  650. static TrueOrFalse_Flag_Struct_t DataChangeFlag = FALSE;
  651. if((HAL_GetTick() - PeriodTimeCnt) >= 5000) //判断周期5s
  652. {
  653. PeriodTimeCnt = HAL_GetTick();
  654. //PCB温度最小值
  655. if(MC_RunInfo.T_PCB < MC_RunLog1.T_PCB_Min)
  656. {
  657. MC_RunLog1.T_PCB_Min = MC_RunInfo.T_PCB;
  658. DataChangeFlag = TRUE;
  659. }
  660. //PCB温度最大值
  661. if(MC_RunInfo.T_PCB > MC_RunLog1.T_PCB_Max)
  662. {
  663. MC_RunLog1.T_PCB_Max = MC_RunInfo.T_PCB;
  664. DataChangeFlag = TRUE;
  665. }
  666. //绕组温度最小值
  667. if(MC_RunInfo.T_Coil < MC_RunLog1.T_Coil_Min)
  668. {
  669. MC_RunLog1.T_Coil_Min = MC_RunInfo.T_Coil;
  670. DataChangeFlag = TRUE;
  671. }
  672. //绕组温度最大值
  673. if(MC_RunInfo.T_Coil > MC_RunLog1.T_Coil_Max)
  674. {
  675. MC_RunLog1.T_Coil_Max = MC_RunInfo.T_Coil;
  676. DataChangeFlag = TRUE;
  677. }//MCU温度最小值
  678. if(MC_RunInfo.T_MCU < MC_RunLog1.T_MCU_Min)
  679. {
  680. MC_RunLog1.T_MCU_Min = MC_RunInfo.T_MCU;
  681. DataChangeFlag = TRUE;
  682. }
  683. //MCU温度最大值
  684. if(MC_RunInfo.T_MCU > MC_RunLog1.T_MCU_Max)
  685. {
  686. MC_RunLog1.T_MCU_Max = MC_RunInfo.T_MCU;
  687. DataChangeFlag = TRUE;
  688. }
  689. //自动存储
  690. SavePeriodCnt++;
  691. if((SavePeriodCnt > 12) && (DataChangeFlag == TRUE)) //1min
  692. {
  693. SavePeriodCnt = 0;
  694. DataChangeFlag = FALSE;
  695. SaveParamToEEprom_24C02(&I2C_Handle_EEPROM, EEPROM_24C02_ADDR_RUN_LOG1, sizeof(MC_RunLog1_Struct_t), (uint8_t*)&MC_RunLog1.PowerOnCnt);
  696. }
  697. }
  698. }
  699. /**************************全局函数定义结束*****************/