tasks.c 24 KB

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