tasks.c 23 KB

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