tasks.c 24 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958
  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 = 2048;
  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. //发送指令,TE不控制12V电源
  397. static uint8_t Count = 0;
  398. uint8_t Data[1] = {0};
  399. if(Count++ <= 5)
  400. {
  401. SendUartDataToTE(&UART_TxBuff_Struct3, 0x07FF, MODE_WRITE, 0x1301, (uint8_t*)Data);
  402. HAL_Delay(10);
  403. }
  404. SendUartDataToTE(&UART_TxBuff_Struct3, 0x07FF, MODE_REPORT, 0x1014, (uint8_t*)&p_MC_TE_SensorData->AD_Torque);
  405. }
  406. PeriodTimeCnt = HAL_GetTick();
  407. }
  408. }
  409. //根据踏频和母线电流计算限流系数
  410. uint8_t MC_CadenceLimit_Cal(uint8_t Cadence, uint16_t Current, uint8_t T_Coil)
  411. {
  412. static uint32_t PeriodTimeCnt = 0;
  413. static uint32_t IdcFiltSum = 0;
  414. static uint8_t IdcFiltCnt = 0; //滤波输入值计算
  415. static uint16_t IdcFilt = 0; //滤波结果
  416. static uint16_t Limit_Cnt = 0; //限流计时值
  417. static uint16_t OK_Cnt = 0; //限流恢复计时值
  418. static FlagStatus LimitFlag = RESET;
  419. static uint8_t Result = 100;
  420. if((HAL_GetTick() - PeriodTimeCnt) >= 100)
  421. {
  422. PeriodTimeCnt = HAL_GetTick();
  423. //母线电流滤波
  424. IdcFiltSum += Current;
  425. IdcFiltCnt++;
  426. if(IdcFiltCnt >= 8)
  427. {
  428. IdcFilt = IdcFiltSum >> 3;
  429. IdcFiltCnt = 0;
  430. IdcFiltSum = 0;
  431. }
  432. //限流保护计时
  433. if((Cadence < 70) && (IdcFilt > 6000))
  434. {
  435. Limit_Cnt++;
  436. }
  437. else
  438. {
  439. Limit_Cnt = 0;
  440. }
  441. //限流恢复计时
  442. if(((Cadence > 70) || (IdcFilt < 5000)) && (T_Coil < 150))
  443. {
  444. OK_Cnt++;
  445. }
  446. else
  447. {
  448. OK_Cnt = 0;
  449. }
  450. //限流判断
  451. if(Limit_Cnt > 300)
  452. {
  453. Limit_Cnt = 0;
  454. LimitFlag = SET;
  455. }
  456. //限流恢复判断
  457. if(OK_Cnt > 100)
  458. {
  459. OK_Cnt = 0;
  460. LimitFlag = RESET;
  461. }
  462. //限流系数计算
  463. if(LimitFlag == SET)
  464. {
  465. if(Cadence < 70)
  466. {
  467. Result = 30 + Cadence;
  468. Result = (Result > 100) ? 100 : Result;
  469. }
  470. else
  471. {
  472. Result = 100;
  473. }
  474. }
  475. else
  476. {
  477. Result = 100;
  478. }
  479. }
  480. return Result;
  481. }
  482. //接收到关机指令处理
  483. void PowerOff_Process(TrueOrFalse_Flag_Struct_t ReturnEnable)
  484. {
  485. static FlagStatus SaveFlag = RESET;
  486. static uint32_t PeriodTimeCnt = 0;
  487. static uint8_t Count = 0;
  488. //关闭助力档位,关闭车灯
  489. MC_ControlCode.GearSt = MC_GearSt_OFF;
  490. MC_ControlCode.LightSwitch = MC_LightSwitch_OFF;
  491. Update_MC_ControlCode_Back();
  492. LightDriver_Process(MC_ConfigParam2.MC_TailLight_Mode, MC_ConfigParam2.HeadLightVol, MC_ConfigParam2.TailLightVol, IsBreakTrig_Flag, MC_ControlCode.LightSwitch);
  493. #if 1 //存储到Flash,下次开机时从Flash取出转移到EEPROM
  494. if(SaveFlag == RESET)
  495. {
  496. MC_PowerOffBkp.ODO_Km = MC_RideLog.ODO_Km;
  497. MC_PowerOffBkp.ODO_Time = MC_RideLog.ODO_Time;
  498. MC_PowerOffBkp.Trip_Km = MC_RideLog.TRIP_Km;
  499. MC_PowerOffBkp.Trip_Time = MC_RideLog.TRIP_Time;
  500. MC_PowerOffBkp.Run_Time = MC_RunLog1.RunTime;
  501. SaveDataToEEPROM_Flash(EEPROM_FLASH_ADDR_POWEROFF_BKP, (uint8_t*)&MC_PowerOffBkp.ODO_Km, 40);//写入掉电临时保存数据,写入前该区域需擦除为0xFF才能操作成功
  502. SaveDataToEEPROM_Flash(EEPROM_FLASH_ADDR_POWEROFF_BKP_FLAG, (uint8_t*)"FLAG", 4); //掉电存储的数据标志更新
  503. SaveFlag = SET;
  504. }
  505. #endif
  506. //发送关机就绪信号
  507. SendData(ID_MC_BC, MODE_REPORT, 0x1305, (uint8_t*)"READY");
  508. //等待关机
  509. if(ReturnEnable == TRUE)
  510. {
  511. return;
  512. }
  513. else
  514. {
  515. PeriodTimeCnt = HAL_GetTick();
  516. Count = 0;
  517. while(Count < 10)
  518. {
  519. if((HAL_GetTick() - PeriodTimeCnt) > 100)
  520. {
  521. PeriodTimeCnt = HAL_GetTick();
  522. Count++;
  523. #if DEBUG
  524. HAL_IWDG_Refresh(&hiwdg);
  525. #endif
  526. }
  527. }
  528. }
  529. }
  530. //CAN设备PBU、HMI、BMS通信状态检测处理
  531. 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)
  532. {
  533. if(WorkMode == MC_WorkMode_Run) //不支持无PBU,且正常运行模式
  534. {
  535. if( NoPBU_Flag == MC_SUPPORT_DISABLE )
  536. {
  537. //PBU通信状态检测
  538. if(IsComOK_PBU.IsOK_Flag == TRUE)
  539. {
  540. if((HAL_GetTick() - IsComOK_PBU.OK_TrigTime) > 1000)
  541. {
  542. IsComOK_PBU.IsOK_Flag = FALSE;
  543. *GearSt = MC_GearSt_OFF;
  544. Update_MC_ControlCode_Back();
  545. DeviceOnLine_Status.Status_Bit.PBU_OffLine = 1;
  546. }
  547. else
  548. {
  549. DeviceOnLine_Status.Status_Bit.PBU_OffLine = 0;
  550. }
  551. }
  552. else
  553. {
  554. *GearSt = MC_GearSt_OFF;
  555. Update_MC_ControlCode_Back();
  556. DeviceOnLine_Status.Status_Bit.PBU_OffLine = 1;
  557. }
  558. //HMI通信状态检测
  559. if(NoHMI_Flag == MC_SUPPORT_ENABLE)
  560. {
  561. DeviceOnLine_Status.Status_Bit.HMI_OffLine = 0;
  562. }
  563. else
  564. {
  565. if(IsComOK_HMI.IsOK_Flag == TRUE)
  566. {
  567. if((HAL_GetTick() - IsComOK_HMI.OK_TrigTime) > 1000)
  568. {
  569. IsComOK_HMI.IsOK_Flag = FALSE;
  570. DeviceOnLine_Status.Status_Bit.HMI_OffLine = 1;
  571. }
  572. else
  573. {
  574. DeviceOnLine_Status.Status_Bit.HMI_OffLine = 0;
  575. }
  576. }
  577. else
  578. {
  579. DeviceOnLine_Status.Status_Bit.HMI_OffLine = 1;
  580. }
  581. }
  582. }
  583. //BMS通信状态检测
  584. if(IsComOK_BMS.IsOK_Flag == TRUE)
  585. {
  586. if((HAL_GetTick() - IsComOK_BMS.OK_TrigTime) > 1000)
  587. {
  588. IsComOK_BMS.IsOK_Flag = FALSE;
  589. DeviceOnLine_Status.Status_Bit.BMS_OffLine = 1;
  590. }
  591. else
  592. {
  593. DeviceOnLine_Status.Status_Bit.BMS_OffLine = 0;
  594. }
  595. }
  596. else
  597. {
  598. DeviceOnLine_Status.Status_Bit.BMS_OffLine = 1;
  599. }
  600. }
  601. }
  602. //UART设备TE通信状态检测处理
  603. void MC_UartRxCheck_Process(void)
  604. {
  605. //TE通信状态检测
  606. if(IsComOK_TE.IsOK_Flag == TRUE)
  607. {
  608. if((HAL_GetTick() - IsComOK_TE.OK_TrigTime) > 2000)
  609. {
  610. IsComOK_TE.IsOK_Flag = FALSE;
  611. }
  612. }
  613. }
  614. //运行总时间计算
  615. void MC_RunTime_Cal(uint32_t* p_Runtime)
  616. {
  617. static uint32_t PeriodTimeCnt = 0;
  618. static uint8_t SavePeriodCount = 0;
  619. if((HAL_GetTick()- PeriodTimeCnt) >= 60000)
  620. {
  621. PeriodTimeCnt = HAL_GetTick();
  622. (*p_Runtime)++;
  623. //存储运行总时间
  624. SavePeriodCount++;
  625. if(SavePeriodCount >= 10) //自动存储周期10min
  626. {
  627. SaveParamToEEprom_24C02(&I2C_Handle_EEPROM, EEPROM_24C02_ADDR_RUN_LOG1, sizeof(MC_RunLog1_Struct_t), (uint8_t*)&MC_RunLog1.PowerOnCnt);
  628. SavePeriodCount = 0;
  629. }
  630. }
  631. }
  632. //设备授权校验
  633. void MC_DeviceCheck(Device_CheckInfo_Struct_t* p_Device, MC_ErrorCode_Struct_t* p_ErrorCode)
  634. {
  635. uint32_t SendPeriodTimeCnt = 0;
  636. uint8_t Send_MAC_ID_Cmd_Count = 0;
  637. uint8_t Send_Code_Cmd_Count = 0;
  638. uint8_t CalCodeResult[12];
  639. uint8_t CheckResult = 0;
  640. uint16_t Send_CanID;
  641. uint16_t Send_MAC_ID_Cmd;
  642. uint16_t Send_Code_Cmd;
  643. uint8_t DeviceSerial = 0;
  644. //确定校验设备类型
  645. if(p_Device == &BMS_CheckInfo)
  646. {
  647. DeviceSerial = 1;
  648. }
  649. else if(p_Device == &PBU_CheckInfo)
  650. {
  651. DeviceSerial = 2;
  652. }
  653. if(p_Device == &HMI_CheckInfo)
  654. {
  655. DeviceSerial = 3;
  656. }
  657. //根据设备类型定义发送指令
  658. switch(DeviceSerial)
  659. {
  660. case 1://校验电池
  661. {
  662. p_ErrorCode->ERROR_Bit.Fault_BMS_Check = 1;
  663. Send_CanID = ID_MC_TO_BMS;
  664. Send_MAC_ID_Cmd = 0x3100;
  665. Send_Code_Cmd = 0x3200;
  666. break;
  667. }
  668. case 2://校验按键
  669. {
  670. p_ErrorCode->ERROR_Bit.Fault_PBU_Check = 1;
  671. Send_CanID = ID_MC_TO_BMS;
  672. Send_MAC_ID_Cmd = 0x5100;
  673. Send_Code_Cmd = 0x5200;
  674. break;
  675. }
  676. case 3://校验仪表
  677. {
  678. p_ErrorCode->ERROR_Bit.Fault_HMI_Check = 1;
  679. Send_CanID = ID_MC_TO_BMS;
  680. Send_MAC_ID_Cmd = 0x7100;
  681. Send_Code_Cmd = 0x7200;
  682. break;
  683. }
  684. default:break;
  685. }
  686. //查询MAC ID,计算校验码,并与查询的授权码比较
  687. Send_MAC_ID_Cmd_Count = 4;
  688. SendData(Send_CanID, MODE_READ, Send_MAC_ID_Cmd, (uint8_t*)NULL);
  689. SendPeriodTimeCnt = HAL_GetTick();
  690. while(Send_MAC_ID_Cmd_Count)
  691. {
  692. CanRx_Process();
  693. if(CheckArrayIs0(p_Device->MAC_ID, 12) != 0) //检查是否接收到ID
  694. {
  695. CheckCodeCal(p_Device->MAC_ID, Secret_Key, CalCodeResult);//根据接收的ID计算授权码
  696. Send_Code_Cmd_Count = 4;
  697. SendData(Send_CanID, MODE_READ, Send_Code_Cmd, (uint8_t*)NULL);
  698. SendPeriodTimeCnt = HAL_GetTick();
  699. while(Send_Code_Cmd_Count)
  700. {
  701. CanRx_Process();
  702. if(CheckArrayIs0(p_Device->CheckCode, 12) != 0) ////检查是否接收到授权码
  703. {
  704. if(strncmp((char*)p_Device->CheckCode, (char*)CalCodeResult, 12) == 0)
  705. {
  706. CheckResult = 1;
  707. }
  708. Send_MAC_ID_Cmd_Count = 0;
  709. Send_Code_Cmd_Count = 0;
  710. break;
  711. }
  712. else
  713. {
  714. if((HAL_GetTick() - SendPeriodTimeCnt) > 100)
  715. {
  716. SendData(Send_CanID, MODE_READ, Send_Code_Cmd, (uint8_t*)NULL);
  717. Send_Code_Cmd_Count--;
  718. SendPeriodTimeCnt = HAL_GetTick();
  719. }
  720. }
  721. //看门狗清零
  722. #if DEBUG
  723. HAL_IWDG_Refresh(&hiwdg);
  724. #endif
  725. }
  726. }
  727. else
  728. {
  729. if((HAL_GetTick() - SendPeriodTimeCnt) > 100)
  730. {
  731. SendData(Send_CanID, MODE_READ, Send_MAC_ID_Cmd, (uint8_t*)NULL);
  732. Send_MAC_ID_Cmd_Count--;
  733. SendPeriodTimeCnt = HAL_GetTick();
  734. }
  735. }
  736. //看门狗清零
  737. #if DEBUG
  738. HAL_IWDG_Refresh(&hiwdg);
  739. #endif
  740. }
  741. //根据设备类型输出结果
  742. switch(DeviceSerial)
  743. {
  744. case 1://校验电池
  745. {
  746. if(CheckResult == 1)
  747. {
  748. p_ErrorCode->ERROR_Bit.Fault_BMS_Check = 0;
  749. }
  750. else
  751. {
  752. p_ErrorCode->ERROR_Bit.Fault_BMS_Check = 1;
  753. MC_RunLog1.BMS_Check_FaultCnt++;
  754. SaveParamToEEprom_24C02(&I2C_Handle_EEPROM, EEPROM_24C02_ADDR_RUN_LOG1, sizeof(MC_RunLog1_Struct_t), (uint8_t*)&MC_RunLog1.PowerOnCnt);
  755. }
  756. break;
  757. }
  758. case 2://校验按键
  759. {
  760. if(CheckResult == 1)
  761. {
  762. p_ErrorCode->ERROR_Bit.Fault_PBU_Check = 0;
  763. }
  764. else
  765. {
  766. p_ErrorCode->ERROR_Bit.Fault_PBU_Check = 1;
  767. MC_RunLog1.PBU_Check_FaultCnt++;
  768. SaveParamToEEprom_24C02(&I2C_Handle_EEPROM, EEPROM_24C02_ADDR_RUN_LOG1, sizeof(MC_RunLog1_Struct_t), (uint8_t*)&MC_RunLog1.PowerOnCnt);
  769. }
  770. break;
  771. }
  772. case 3://校验仪表
  773. {
  774. if(CheckResult == 1)
  775. {
  776. p_ErrorCode->ERROR_Bit.Fault_HMI_Check = 0;
  777. }
  778. else
  779. {
  780. p_ErrorCode->ERROR_Bit.Fault_HMI_Check = 1;
  781. MC_RunLog1.HMI_Check_FaultCnt++;
  782. SaveParamToEEprom_24C02(&I2C_Handle_EEPROM, EEPROM_24C02_ADDR_RUN_LOG1, sizeof(MC_RunLog1_Struct_t), (uint8_t*)&MC_RunLog1.PowerOnCnt);
  783. }
  784. break;
  785. }
  786. default:break;
  787. }
  788. }
  789. //计算TIM2 ETR采集频率
  790. void Cal_SyncClockFreq(uint16_t* Result)
  791. {
  792. uint16_t Count = 0;
  793. Count = __HAL_TIM_GET_COUNTER(&htim2);
  794. *Result = Count * 20 / 1000;//50ms内计数值,单位转换为KHz
  795. __HAL_TIM_SET_COUNTER(&htim2, 0);
  796. }
  797. //温度历史信息处理
  798. void MC_TemperatureLogProcess(void)
  799. {
  800. static uint32_t PeriodTimeCnt = 0;
  801. static uint16_t SavePeriodCnt = 0;
  802. static TrueOrFalse_Flag_Struct_t DataChangeFlag = FALSE;
  803. if(HAL_GetTick() < 10000) //开机前10s不处理
  804. {
  805. PeriodTimeCnt = HAL_GetTick();
  806. return;
  807. }
  808. if((HAL_GetTick() - PeriodTimeCnt) >= 5000) //判断周期5s
  809. {
  810. PeriodTimeCnt = HAL_GetTick();
  811. //PCB温度最小值
  812. if(MC_RunInfo.T_PCB < MC_RunLog1.T_PCB_Min)
  813. {
  814. MC_RunLog1.T_PCB_Min = MC_RunInfo.T_PCB;
  815. DataChangeFlag = TRUE;
  816. }
  817. //PCB温度最大值
  818. if(MC_RunInfo.T_PCB > MC_RunLog1.T_PCB_Max)
  819. {
  820. MC_RunLog1.T_PCB_Max = MC_RunInfo.T_PCB;
  821. DataChangeFlag = TRUE;
  822. }
  823. //绕组温度最小值
  824. if(MC_RunInfo.T_Coil < MC_RunLog1.T_Coil_Min)
  825. {
  826. MC_RunLog1.T_Coil_Min = MC_RunInfo.T_Coil;
  827. DataChangeFlag = TRUE;
  828. }
  829. //绕组温度最大值
  830. if(MC_RunInfo.T_Coil > MC_RunLog1.T_Coil_Max)
  831. {
  832. MC_RunLog1.T_Coil_Max = MC_RunInfo.T_Coil;
  833. DataChangeFlag = TRUE;
  834. }//MCU温度最小值
  835. if(MC_RunInfo.T_MCU < MC_RunLog1.T_MCU_Min)
  836. {
  837. MC_RunLog1.T_MCU_Min = MC_RunInfo.T_MCU;
  838. DataChangeFlag = TRUE;
  839. }
  840. //MCU温度最大值
  841. if(MC_RunInfo.T_MCU > MC_RunLog1.T_MCU_Max)
  842. {
  843. MC_RunLog1.T_MCU_Max = MC_RunInfo.T_MCU;
  844. DataChangeFlag = TRUE;
  845. }
  846. //自动存储
  847. SavePeriodCnt++;
  848. if((SavePeriodCnt > 12) && (DataChangeFlag == TRUE)) //1min
  849. {
  850. SavePeriodCnt = 0;
  851. DataChangeFlag = FALSE;
  852. SaveParamToEEprom_24C02(&I2C_Handle_EEPROM, EEPROM_24C02_ADDR_RUN_LOG1, sizeof(MC_RunLog1_Struct_t), (uint8_t*)&MC_RunLog1.PowerOnCnt);
  853. }
  854. }
  855. }
  856. //无码表模式初始化处理
  857. void NoPBUMode_Ini( void )
  858. {
  859. static TrueOrFalse_Flag_Struct_t NoPBUModeIniFinishedFlag = FALSE;
  860. if(HAL_GetTick() > 3000)
  861. {
  862. if( NoPBUModeIniFinishedFlag== FALSE )
  863. {
  864. NoPBUModeIniFinishedFlag = TRUE;
  865. if(MC_ConfigParam1.NoPBU_Flag == MC_SUPPORT_ENABLE)
  866. {
  867. MC_ControlCode.GearSt = MC_GearSt_SMART;
  868. Update_MC_ControlCode_Back();
  869. }
  870. }
  871. }
  872. }
  873. /**************************全局函数定义结束*****************/