tasks.c 31 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176
  1. #include <stdbool.h>
  2. #include "tasks.h"
  3. #include "iwdg.h"
  4. #include "gpio.h"
  5. #include "tim.h"
  6. #include "can_process.h"
  7. #include "uart_process.h"
  8. #include "eeprom_24c02.h"
  9. #include "eeprom_flash.h"
  10. #include "adc.h"
  11. #include "hall_sensor.h"
  12. #include "torque_sensor.h"
  13. #include "gas_sensor.h"
  14. #include "math_tools.h"
  15. #include "remain_distance.h"
  16. #include "protect_check.h"
  17. #include "fault_check.h"
  18. #include "key_driver.h"
  19. #include "encrypt.h"
  20. #include "light_driver.h"
  21. #include "enviolo_can.h"
  22. #include "light_driver.h"
  23. #include "MC_Globals.h"
  24. #include "MC_FOC_Driver.h"
  25. /************************全局变量************************/
  26. TrueOrFalse_Flag_Struct_t IsInitFinish_Flag = FALSE;
  27. To_Te_SendStep IsSendDataToTE_Step = HANDSHAKE;
  28. /**************************局部函数定义*********************/
  29. /**************************全局函数定义*********************/
  30. //1ms任务处理函数
  31. void HAL_SYSTICK_Callback(void)
  32. {
  33. static uint16_t TimeCnt_5ms = 0;
  34. static uint16_t TimeCnt_10ms = 0;
  35. static uint16_t TimeCnt_50ms = 0;
  36. static uint16_t TimeCnt_100ms = 0;
  37. static uint16_t TimeCnt_200ms = 0;
  38. static uint16_t TimeCnt_1000ms = 0;
  39. if(IsInitFinish_Flag == FALSE)
  40. {
  41. return;
  42. }
  43. //踏频传感器采集及计算
  44. if(VersionIdentifyFinishedFlag == TRUE)
  45. {
  46. if(MC_VerInfo.HW_Version[7] < 'C')
  47. CadenceSensor_Process1(&MC_CadenceResult, MC_ConfigParam1.StopTime, (MC_ConfigParam1.CadenceStarNum == 0) ? 2 : MC_ConfigParam1.CadenceStarNum, FALSE);
  48. else
  49. CadenceSensor_Process2(&MC_CadenceResult, MC_ConfigParam1.StopTime, (MC_ConfigParam1.CadenceStarNum == 0) ? 2 : MC_ConfigParam1.CadenceStarNum, FALSE);
  50. }
  51. //踏频传感器故障检测
  52. if(MC_WorkMode == MC_WorkMode_Run)
  53. {
  54. if(VersionIdentifyFinishedFlag == TRUE)
  55. {
  56. if(MC_VerInfo.HW_Version[7] < 'C')
  57. MC_Fault_CadenceSensor_Process1(ADC_SensorData.TorqueSensor, MC_RunInfo.BikeSpeed, &MC_ErrorCode);
  58. else
  59. MC_Fault_CadenceSensor_Process2(ADC_SensorData.TorqueSensor, MC_RunInfo.BikeSpeed, &MC_ErrorCode);
  60. }
  61. }
  62. //根据电机工作模式(MC_WorkMode)、力矩传感器和指拨AD值(ADC_SensorData)、控制档位(MC_ControlCode.GearSt)计算控制FOC输入值(MC_CalParam)
  63. MC_CalParam_Cal(MC_WorkMode, ADC_SensorData, MC_ControlCode.GearSt, IsBreakTrig_Flag, IsGearSensorTrig_Flag, &MC_CalParam);
  64. //更新控制参数备份值
  65. Update_MC_CalParam_Back();
  66. //更新力矩传感器零点值
  67. if(IsTorqueOffSetUpdateEnable == TRUE)
  68. {
  69. TorqueOffSetData_Present_Update(&TorqueOffSetData.PresentData, ADC1_Result[ADC1_RANK_TORQUE_SENSOR], MC_TorqueCorrectParam.K, &MC_ErrorCode);
  70. }
  71. //更新指拨零点值
  72. if(IsGasSensorConnectedFlag == TRUE)
  73. {
  74. GasSensorOffSetData_Update(&GasSensor_OffSet, ADC1_Result[ADC1_RANK_GAS], &MC_ErrorCode);
  75. }
  76. //ADC数据滑动滤波计算
  77. ADC_SensorData_Filt(ADC1_Result_Filt, ADC2_Result_Filt);
  78. //发送给TE的传感器数据采集
  79. MC_TE_SensorScan(&MC_TE_SensorData);
  80. //5ms任务
  81. TimeCnt_5ms++;
  82. if(TimeCnt_5ms >= 5)
  83. {
  84. TimeCnt_5ms = 0;
  85. }
  86. //10ms任务
  87. TimeCnt_10ms++;
  88. if(TimeCnt_10ms >= 10)
  89. {
  90. TimeCnt_10ms = 0;
  91. //计算整车传动比
  92. BikeRatioCal_Process(MC_RunInfo.MotorSpeed, MC_RunInfo.Cadence, MC_RunInfo.BikeSpeed, &Bike_RatioCalParam);
  93. }
  94. //50ms任务
  95. TimeCnt_50ms++;
  96. if(TimeCnt_50ms >= 50)
  97. {
  98. TimeCnt_50ms = 0;
  99. //计算TE同步时钟频率
  100. Cal_SyncClockFreq(&MC_TE_SyncClockFreqScan);
  101. }
  102. //100ms任务
  103. TimeCnt_100ms++;
  104. if(TimeCnt_100ms >= 100)
  105. {
  106. TimeCnt_100ms = 0;
  107. //踏频计算滑动均值滤波
  108. MC_RunInfo.Cadence = MovingAverageFilter(MC_CadenceResult.Cadence_Data, MC_Cadence_Array, sizeof(MC_Cadence_Array) / 2);
  109. }
  110. //200ms任务
  111. TimeCnt_200ms++;
  112. if(TimeCnt_200ms >= 200)
  113. {
  114. TimeCnt_200ms = 0;
  115. }
  116. //1000ms任务
  117. TimeCnt_1000ms++;
  118. if(TimeCnt_1000ms >= 1000)
  119. {
  120. TimeCnt_1000ms = 0;
  121. }
  122. }
  123. //CAN数据解析函数
  124. void CanRx_Process(void)
  125. {
  126. CAN_RxData_Process(&CAN_RxBuf_Struct_PBU, 500);
  127. CAN_RxData_Process(&CAN_RxBuf_Struct_BMS, 500);
  128. CAN_RxData_Process(&CAN_RxBuf_Struct_HMI, 500);
  129. CAN_RxData_Process(&CAN_RxBuf_Struct_CDL, 500);
  130. }
  131. //UART数据解析函数
  132. void UartRx_Process(void)
  133. {
  134. Uart_RxData_Process(&UART_RxBuff_Struct3, 500);
  135. }
  136. //MC运行信息更新
  137. void MC_RunInfo_Update(void)
  138. {
  139. static uint32_t PeriodTimeCnt = 0;
  140. if((HAL_GetTick() - PeriodTimeCnt) >= 200)
  141. {
  142. PeriodTimeCnt = HAL_GetTick();
  143. //计算电功率,额定功率高5位用于显示功率分频系数,低11位额定功率
  144. if((MC_MotorParam.Rate_Power >> 11) == 0) //旧程序未配
  145. {
  146. MC_RunInfo.Power = ((uint32_t)MC_RunInfo.BusCurrent) * 250 / (MC_ConfigParam1.CurrentLimit * 1000);
  147. }
  148. else //新程序高5位为显示最大功率分频系数,最大显示功率 = 配置额定功率 * 分频系数 / 32
  149. {
  150. MC_RunInfo.Power = ((uint32_t)MC_RunInfo.BusCurrent) * (((MC_MotorParam.Rate_Power & 0x07FF) * ((MC_MotorParam.Rate_Power >> 11) + 1)) >> 5) / (MC_ConfigParam1.CurrentLimit * 1000);
  151. }
  152. MC_RunInfo.Power = (MC_RunInfo.Power < 20) ? 0 : MC_RunInfo.Power;
  153. MotorPowerFltSum += ((int32_t)(MC_RunInfo.BusCurrent >> 7) * (MC_RunInfo.BusVoltage >> 7) * 67 - MotorPowerFltSum) >> 4; //平均功率,2^14 / 1000000 * 2^12
  154. //更新踏频方向
  155. MC_RunInfo.CadenceDir = MC_CadenceResult.Cadence_Dir;
  156. //计算力矩值
  157. MC_RunInfo.Torque = ADC_SensorData.TorqueSensor / 28;
  158. //踩踏功率计算
  159. PedalPowerFltSum += (((int32_t)(MC_RunInfo.Cadence * MC_RunInfo.Torque * 107) - PedalPowerFltSum) >> 4); //P = n * T / 9.55
  160. //当前助力档位
  161. MC_RunInfo.GearSt = MC_ControlCode.GearSt;
  162. //当前灯开关
  163. MC_RunInfo.LightSwitch = MC_ControlCode.LightSwitch;
  164. //剩余电量
  165. MC_RunInfo.SOC = (DeviceOnLine_Status.Status_Bit.BMS_OffLine == 1) ? Battery_SocCal(&Battery_Info, &BatteryCellInfo, MC_RunInfo.SOC, MC_MotorParam.Rate_Voltage)
  166. : BMS_RunInfo.SOC;
  167. //续航里程
  168. MC_RunInfo.RemainDistance = (DeviceOnLine_Status.Status_Bit.BMS_OffLine == 1) ? 0xEEEE : RemainDis.remainDistance;
  169. //骑行总里程计算
  170. static uint32_t WheelTurnCount = 0;
  171. static FlagStatus RefreshFlag = RESET;
  172. if(MC_ConfigParam1.SpeedSignal == MC_SPEED_COMMUNICATION) //根据通信获取的车轮旋转周期计算
  173. {
  174. static uint32_t WheelTurnCount_Temp = 0;
  175. //运算周期是200ms,根据车轮旋转周期计算200ms内旋转的圈数,存在小数,放大1024倍
  176. if(MC_SpeedSensorData.IsStopFlag == FALSE)
  177. {
  178. WheelTurnCount_Temp += 819200 / MC_SpeedSensorData.DiffTime_ms;
  179. MC_SpeedSensorData.WheelTurnCount = WheelTurnCount_Temp >> 12;
  180. }
  181. }
  182. else if(MC_ConfigParam1.SpeedSignal == MC_SPEED_CADENCE_CAL) //根据踏频计算
  183. {
  184. //车轮转过的圈数 = 踏频信号个数 / 120 * 2.4 * 前飞齿数 / 后飞齿数
  185. MC_SpeedSensorData.WheelTurnCount = MC_CadenceResult.TrigCount * MC_ConfigParam1.TeethNum_F / MC_ConfigParam1.TeethNum_B / 50;
  186. }
  187. else
  188. {
  189. //车轮转过的圈数在速度传感器中断已处理
  190. }
  191. if((MC_SpeedSensorData.WheelTurnCount - WheelTurnCount) >= (10000 / (MC_ConfigParam1.WheelSize + MC_ConfigParam1.WheelSizeAdj))) //0.1km车轮所需圈数
  192. {
  193. RefreshFlag = SET;
  194. WheelTurnCount = MC_SpeedSensorData.WheelTurnCount;
  195. }
  196. if(RefreshFlag == SET)
  197. {
  198. RefreshFlag = RESET;
  199. //更新骑行历史信息中ODO和TRIP里程
  200. MC_RideLog.ODO_Km++;
  201. MC_RunLog1.ODO_Km++;
  202. #if 0 //总里程是否自动归零
  203. if(MC_RideLog.ODO_Km > 999999)
  204. {
  205. MC_RideLog.ODO_Km = 0;
  206. MC_RideLog.ODO_Time = 0;
  207. }
  208. #endif
  209. MC_RideLog.TRIP_Km++;
  210. if(MC_RideLog.TRIP_Km > 99999) //超过9999.9km清零
  211. {
  212. MC_RideLog.TRIP_Km = 0;
  213. MC_RideLog.TRIP_Time = 0;
  214. }
  215. //更新运行信息中里程信息
  216. MC_RunInfo.Ride_Km++;
  217. MC_RunInfo.ODO_Km = MC_RideLog.ODO_Km / 10;
  218. #if 0 //自动存储骑行里程
  219. static uint8_t SavePeriodCount = 0;
  220. SavePeriodCount++;
  221. if(SavePeriodCount >= 30)//存储周期为3km
  222. {
  223. SaveParamToEEprom_24C02(&I2C_Handle_EEPROM, EEPROM_24C02_ADDR_RUN_LOG1, sizeof(MC_RunLog1_Struct_t), (uint8_t*)&MC_RunLog1.PowerOnCnt);
  224. SaveParamToEEprom_24C02(&I2C_Handle_EEPROM, EEPROM_24C02_ADDR_RIDE_LOG, sizeof(MC_RideLog_Struct_t), (uint8_t*)&MC_RideLog.ODO_Km);
  225. SavePeriodCount = 0;
  226. }
  227. #endif
  228. }
  229. //骑行时间计算
  230. static uint8_t Period_1sCnt = 0;
  231. static uint8_t Period_1minCnt = 0;
  232. static uint16_t SavePeriod_Cnt = 0;
  233. if(MC_RunInfo.BikeSpeed >= 30)
  234. {
  235. Period_1sCnt++;
  236. if(Period_1sCnt >= 5) //运行周期为200ms,计时周期200 * 5 = 1s
  237. {
  238. Period_1sCnt = 0;
  239. SavePeriod_Cnt++;
  240. MC_RunInfo.Ride_Time++;
  241. Period_1minCnt++;
  242. }
  243. }
  244. else
  245. {
  246. Period_1sCnt = 0;
  247. }
  248. if(Period_1minCnt >= 60) //1min
  249. {
  250. Period_1minCnt = 0;
  251. //更新骑行历史信息中骑行时间
  252. MC_RideLog.ODO_Time++;
  253. MC_RunLog1.ODO_Time++;
  254. MC_RideLog.TRIP_Time++;
  255. #if 0 //时间是否自动归零
  256. if(MC_RideLog.ODO_Time > 599999)
  257. MC_RideLog.ODO_Time = 0;
  258. if(MC_RideLog.TRIP_Info.TripTime_MaxSpeed.TRIP_Time > 599999)
  259. MC_RideLog.TRIP_Info.TripTime_MaxSpeed.TRIP_Time > 599999 = 0;
  260. #endif
  261. //骑行功率累计
  262. MC_AvgPower.PedalPowerSum += (PedalPowerFltSum >> 10); //Wmin
  263. }
  264. //存储骑行总时间
  265. #if 0 //根据骑行时间自动存储
  266. if(SavePeriod_Cnt >= 600) //累计骑行600s进行存储
  267. {
  268. SavePeriod_Cnt = 0;
  269. SaveParamToEEprom_24C02(&I2C_Handle_EEPROM, EEPROM_24C02_ADDR_RUN_LOG1, sizeof(MC_RunLog1_Struct_t), (uint8_t*)&MC_RunLog1.PowerOnCnt);
  270. SaveParamToEEprom_24C02(&I2C_Handle_EEPROM, EEPROM_24C02_ADDR_RIDE_LOG, sizeof(MC_RideLog_Struct_t), (uint8_t*)&MC_RideLog.ODO_Km);
  271. }
  272. #endif
  273. //平均功耗
  274. MC_RunInfo.PowerPerKm = RemainDis.Power_per_km_result / 10;
  275. //骑行信息计算
  276. do
  277. {
  278. uint16_t PowerAvg;
  279. //最大车速
  280. if(MC_AvgPower.SpeedMax < MC_RunInfo.BikeSpeed)
  281. MC_AvgPower.SpeedMax = MC_RunInfo.BikeSpeed;
  282. MC_RideInfo.SpeedMax = MC_AvgPower.SpeedMax;
  283. //平均车速
  284. if(MC_RideLog.TRIP_Time == 0)
  285. MC_RideInfo.SpeedAvg = 0;
  286. else
  287. MC_RideInfo.SpeedAvg = MC_RideLog.TRIP_Km * 60 / MC_RideLog.TRIP_Time;
  288. //卡路里
  289. if(MC_RideLog.ODO_Time == 0)
  290. PowerAvg = 0;
  291. else
  292. PowerAvg = MC_AvgPower.PedalPowerSum / MC_RideLog.ODO_Time;
  293. MC_RideInfo.Cal_Trip = (PowerAvg * 135 * MC_RideLog.TRIP_Time) >> 11; //Cal = P * 1.1 * 3.6 * t(h)
  294. MC_RideInfo.Cal_Once = ((PedalPowerFltSum >> 10) * 18 * MC_RunInfo.Ride_Time) >> 14; //Cal = P * 1.1 * 3.6 * t(h)
  295. //电机平均功率
  296. MC_RideInfo.MotorPowerAvg = MotorPowerFltSum >> 12;
  297. //踩踏平均功率
  298. MC_RideInfo.PedalPowerAvg = PedalPowerFltSum >> 10;
  299. }while(0);
  300. }
  301. }
  302. //调试信息更新
  303. void MC_DebugInfo_Update(void)
  304. {
  305. static uint32_t PeriodTimeCnt = 0;
  306. if((HAL_GetTick() - PeriodTimeCnt) >= 100)
  307. {
  308. PeriodTimeCnt = HAL_GetTick();
  309. MC_DebugInfo.SysFSM1 = MC_CalParam.AssistRunMode; //助力模式
  310. MC_DebugInfo.SysFSM2 = FOC_Status; //FOC状态
  311. MC_DebugInfo.SysFSM3 = 0;
  312. MC_DebugInfo.SysFSM4 = 0;
  313. MC_DebugInfo.IdRef = IdFluxLessRef; //IdRef
  314. MC_DebugInfo.IqRef = IqFluxLessRef; //IqRef
  315. MC_DebugInfo.UdRef = Stat_Volt_q_d.qV_Component2; //UdRef
  316. MC_DebugInfo.UqRef = Stat_Volt_q_d.qV_Component1; //UqRef
  317. MC_DebugInfo.PedalTorquePer = ADC_SensorData.TorqueSensor; //力矩AD,减去零点
  318. MC_DebugInfo.PedalTorqueAvg = ADC_SensorData.GasSensor; //转把AD,减去零点
  319. MC_DebugInfo.PedalTorqueByCad = MC_CadenceResult.torqueByCadence; //力矩AD,根据踏频滤波
  320. MC_DebugInfo.IdFdb = IdFdbFlt >> 10; //IdFdb
  321. MC_DebugInfo.IqFdb = IqFdbFlt >> 10; //IqFdb
  322. if(MC_CalParam.AssistRunMode == MC_AssistRunMode_TORQUE)
  323. MC_DebugInfo.AssistOut = MC_CalParam.Ref_Torque;
  324. else if(MC_CalParam.AssistRunMode == MC_AssistRunMode_WALK)
  325. MC_DebugInfo.AssistOut = MC_CalParam.Ref_Speed;
  326. else if(MC_CalParam.AssistRunMode == MC_AssistRunMode_GAS)
  327. {
  328. if(MC_GasMode_Param.Mode_bit.CrontrolMode == 0)
  329. MC_DebugInfo.AssistOut = MC_CalParam.Ref_Speed;
  330. else
  331. MC_DebugInfo.AssistOut = MC_CalParam.Ref_Torque;
  332. }
  333. else
  334. MC_DebugInfo.AssistOut = 0;
  335. }
  336. }
  337. //MC故障码发送
  338. void MC_SendErrorCode_Process(MC_ErrorCode_Struct_t ErrorCode)
  339. {
  340. static uint32_t PeriodTimeCnt = 0;
  341. if(IsSendDataToTE_Step == SENDUPDATA)
  342. {
  343. return;
  344. }
  345. if(ErrorCode.Code != 0x00000000)
  346. {
  347. if((HAL_GetTick() - PeriodTimeCnt) > 500)
  348. {
  349. PeriodTimeCnt = HAL_GetTick();
  350. SendData(ID_MC_BC, MODE_REPORT, 0x1104, (uint8_t*)&ErrorCode.Code);
  351. }
  352. }
  353. else
  354. {
  355. PeriodTimeCnt = HAL_GetTick();
  356. }
  357. }
  358. //MC主动发送运行信息
  359. void MC_SendRunInfo_Process(MC_WorkMode_Struct_t WorkMode)
  360. {
  361. static uint32_t PeriodTimeCnt = 0;
  362. if(WorkMode == MC_WorkMode_Config)
  363. {
  364. if((HAL_GetTick() - PeriodTimeCnt) >= 200)
  365. {
  366. SendData(ID_MC_BC, MODE_REPORT, 0x1020, (uint8_t*)&MC_RunInfo.BikeSpeed);
  367. PeriodTimeCnt = HAL_GetTick();
  368. }
  369. }
  370. else
  371. {
  372. PeriodTimeCnt = HAL_GetTick();
  373. }
  374. }
  375. //MC主动发送调试信息
  376. void MC_SendDebugInfo_Process(MC_WorkMode_Struct_t WorkMode)
  377. {
  378. static uint32_t PeriodTimeCnt = 0;
  379. if(WorkMode == MC_WorkMode_Debug)
  380. {
  381. if((HAL_GetTick() - PeriodTimeCnt) >= 200)
  382. {
  383. SendData(ID_MC_BC, MODE_REPORT, 0x1020, (uint8_t*)&MC_RunInfo.BikeSpeed);
  384. SendData(ID_MC_TO_CDL, MODE_REPORT, 0xBA20, (uint8_t*)&MC_DebugInfo.SysFSM1);
  385. PeriodTimeCnt = HAL_GetTick();
  386. }
  387. }
  388. else
  389. {
  390. PeriodTimeCnt = HAL_GetTick();
  391. }
  392. }
  393. //发给TE的传感器数据扫描
  394. void MC_TE_SensorScan(MC_TE_SensorData_Struct_t* p_MC_TE_SensorData)
  395. {
  396. static GPIO_PinState Cadence_Hall_1;
  397. static GPIO_PinState Cadence_Hall_2;
  398. static GPIO_PinState Motor_Hall_A;
  399. static GPIO_PinState Motor_Hall_B;
  400. static GPIO_PinState Break;
  401. static GPIO_PinState SpeedSensor;
  402. static TrueOrFalse_Flag_Struct_t IsFirstEnterFalg = TRUE;
  403. GPIO_PinState GPIO_PinState_Temp;
  404. //初始化变量
  405. if(IsFirstEnterFalg == TRUE)
  406. {
  407. Cadence_Hall_1 = HAL_GPIO_ReadPin(CADENCE_1_GPIO_Port, CADENCE_1_Pin);
  408. Cadence_Hall_2 = HAL_GPIO_ReadPin(CADENCE_2_GPIO_Port, CADENCE_2_Pin);
  409. Motor_Hall_A = HAL_GPIO_ReadPin(HALL_A_GPIO_Port, HALL_A_Pin);
  410. Motor_Hall_B = HAL_GPIO_ReadPin(HALL_B_GPIO_Port, HALL_B_Pin);
  411. Break = HAL_GPIO_ReadPin(BREAK_LEFT_GPIO_Port, BREAK_LEFT_Pin);
  412. SpeedSensor = HAL_GPIO_ReadPin(SPEED_SENSOR_GPIO_Port, SPEED_SENSOR_Pin);
  413. p_MC_TE_SensorData->CadenceHall_1_Cnt = 0;
  414. p_MC_TE_SensorData->CadenceHall_2_Cnt = 0;
  415. p_MC_TE_SensorData->MotorHall_A_Cnt = 0;
  416. p_MC_TE_SensorData->MotorHall_B_Cnt = 0;
  417. p_MC_TE_SensorData->BreakTrgiCnt = 0;
  418. p_MC_TE_SensorData->SpeedSensorTrigCnt = 0;
  419. IsFirstEnterFalg = FALSE;
  420. }
  421. //ADC数据更新采集
  422. p_MC_TE_SensorData->AD_BusCurrent = ADC1_Result_Filt[ADC1_RANK_CURRENT];
  423. p_MC_TE_SensorData->AD_CoilTemp = ADC1_Result_Filt[ADC1_RANK_NTC_COIL];
  424. p_MC_TE_SensorData->AD_TE_Voltage = 2048;
  425. p_MC_TE_SensorData->AD_Torque = ADC1_Result_Filt[ADC1_RANK_TORQUE_SENSOR];
  426. //踏频霍尔1
  427. GPIO_PinState_Temp = HAL_GPIO_ReadPin(CADENCE_1_GPIO_Port, CADENCE_1_Pin);
  428. if(Cadence_Hall_1 != GPIO_PinState_Temp)
  429. {
  430. p_MC_TE_SensorData->CadenceHall_1_Cnt++;
  431. }
  432. Cadence_Hall_1 = GPIO_PinState_Temp;
  433. //踏频霍尔2
  434. GPIO_PinState_Temp = HAL_GPIO_ReadPin(CADENCE_2_GPIO_Port, CADENCE_2_Pin);
  435. if(Cadence_Hall_2 != GPIO_PinState_Temp)
  436. {
  437. p_MC_TE_SensorData->CadenceHall_2_Cnt++;
  438. }
  439. Cadence_Hall_2 = GPIO_PinState_Temp;
  440. //马达霍尔A
  441. GPIO_PinState_Temp = HAL_GPIO_ReadPin(HALL_A_GPIO_Port, HALL_A_Pin);
  442. if(Motor_Hall_A != GPIO_PinState_Temp)
  443. {
  444. p_MC_TE_SensorData->MotorHall_A_Cnt++;
  445. }
  446. Motor_Hall_A = GPIO_PinState_Temp;
  447. //马达霍尔B
  448. GPIO_PinState_Temp = HAL_GPIO_ReadPin(HALL_B_GPIO_Port, HALL_B_Pin);
  449. if(Motor_Hall_B != GPIO_PinState_Temp)
  450. {
  451. p_MC_TE_SensorData->MotorHall_B_Cnt++;
  452. }
  453. Motor_Hall_B = GPIO_PinState_Temp;
  454. //刹车
  455. GPIO_PinState_Temp = HAL_GPIO_ReadPin(BREAK_LEFT_GPIO_Port, BREAK_LEFT_Pin);
  456. if(Break != GPIO_PinState_Temp)
  457. {
  458. p_MC_TE_SensorData->BreakTrgiCnt++;
  459. }
  460. Break = GPIO_PinState_Temp;
  461. //速度传感器
  462. GPIO_PinState_Temp = HAL_GPIO_ReadPin(SPEED_SENSOR_GPIO_Port, SPEED_SENSOR_Pin);
  463. if(SpeedSensor != GPIO_PinState_Temp)
  464. {
  465. p_MC_TE_SensorData->SpeedSensorTrigCnt++;
  466. }
  467. SpeedSensor = GPIO_PinState_Temp;
  468. //同步时钟频率
  469. p_MC_TE_SensorData->SynC_Clock_Freq = 1000; //1000KHz
  470. }
  471. //发给TE的传感器数据处理
  472. void MC_TE_SensorData_Process(MC_TE_SensorData_Struct_t* p_MC_TE_SensorData)
  473. {
  474. static uint32_t PeriodTimeCnt = 0;
  475. static uint16_t EnterCnt = 0;
  476. //数据发送
  477. if((HAL_GetTick() - PeriodTimeCnt) >= 500)
  478. {
  479. //计数超过20 * 500ms = 10s,进行一次清零
  480. EnterCnt++;
  481. if(EnterCnt >= 20)
  482. {
  483. if(MC_TE_SensorStatus.TE_ErrorCode.Status_Bit.BikeSpeed == 0)
  484. {
  485. MC_TE_SensorData.SpeedSensorTrigCnt = 0;
  486. }
  487. if(MC_TE_SensorStatus.TE_ErrorCode.Status_Bit.StopBreak == 0)
  488. {
  489. MC_TE_SensorData.BreakTrgiCnt = 0;
  490. }
  491. if(MC_TE_SensorStatus.TE_ErrorCode.Status_Bit.CadenseSensor_1 == 0)
  492. {
  493. MC_TE_SensorData.CadenceHall_1_Cnt = 0;
  494. }
  495. if(MC_TE_SensorStatus.TE_ErrorCode.Status_Bit.CadenseSensor_2 == 0)
  496. {
  497. MC_TE_SensorData.CadenceHall_2_Cnt = 0;
  498. }
  499. if(MC_TE_SensorStatus.TE_ErrorCode.Status_Bit.HallSensor_A == 0)
  500. {
  501. MC_TE_SensorData.MotorHall_A_Cnt = 0;
  502. }
  503. if(MC_TE_SensorStatus.TE_ErrorCode.Status_Bit.HallSensor_B == 0)
  504. {
  505. MC_TE_SensorData.MotorHall_B_Cnt = 0;
  506. }
  507. HAL_GPIO_TogglePin(SYC_IO_GPIO_Port, SYC_IO_Pin);
  508. EnterCnt = 0;
  509. }
  510. //发送
  511. if(IsSendDataToTE_Step == HANDSHAKE)//发送握手信息到TE,只发送一次
  512. {
  513. SendUartDataToTE(&UART_TxBuff_Struct3, 0x07FF, MODE_REPORT, 0x8800, (uint8_t*)NULL);
  514. IsSendDataToTE_Step = SENDSENSOR;
  515. }
  516. else if(IsSendDataToTE_Step == SENDSENSOR)//正常发送数据到TE
  517. {
  518. //发送指令,TE不控制12V电源
  519. static uint8_t Count = 0;
  520. uint8_t Data[1] = {0};
  521. if(Count++ <= 5)
  522. {
  523. SendUartDataToTE(&UART_TxBuff_Struct3, 0x07FF, MODE_WRITE, 0x1301, (uint8_t*)Data);
  524. HAL_Delay(10);
  525. }
  526. SendUartDataToTE(&UART_TxBuff_Struct3, 0x07FF, MODE_REPORT, 0x1014, (uint8_t*)&p_MC_TE_SensorData->AD_Torque);
  527. }
  528. PeriodTimeCnt = HAL_GetTick();
  529. }
  530. }
  531. //根据踏频和母线电流计算限流系数
  532. uint8_t MC_CadenceLimit_Cal(uint8_t Cadence, uint16_t Current, uint8_t T_Coil)
  533. {
  534. static uint32_t PeriodTimeCnt = 0;
  535. static uint32_t IdcFiltSum = 0;
  536. static uint8_t IdcFiltCnt = 0; //滤波输入值计算
  537. static uint16_t IdcFilt = 0; //滤波结果
  538. static uint16_t Limit_Cnt = 0; //限流计时值
  539. static uint16_t OK_Cnt = 0; //限流恢复计时值
  540. static FlagStatus LimitFlag = RESET;
  541. static uint8_t Result = 100;
  542. if((HAL_GetTick() - PeriodTimeCnt) >= 100)
  543. {
  544. PeriodTimeCnt = HAL_GetTick();
  545. //母线电流滤波
  546. IdcFiltSum += Current;
  547. IdcFiltCnt++;
  548. if(IdcFiltCnt >= 8)
  549. {
  550. IdcFilt = IdcFiltSum >> 3;
  551. IdcFiltCnt = 0;
  552. IdcFiltSum = 0;
  553. }
  554. //限流保护计时
  555. if((Cadence < 70) && (IdcFilt > 6000))
  556. {
  557. Limit_Cnt++;
  558. }
  559. else
  560. {
  561. Limit_Cnt = 0;
  562. }
  563. //限流恢复计时
  564. if(((Cadence > 70) || (IdcFilt < 5000)) && (T_Coil < 150))
  565. {
  566. OK_Cnt++;
  567. }
  568. else
  569. {
  570. OK_Cnt = 0;
  571. }
  572. //限流判断
  573. if(Limit_Cnt > 300)
  574. {
  575. Limit_Cnt = 0;
  576. LimitFlag = SET;
  577. }
  578. //限流恢复判断
  579. if(OK_Cnt > 100)
  580. {
  581. OK_Cnt = 0;
  582. LimitFlag = RESET;
  583. }
  584. //限流系数计算
  585. if(LimitFlag == SET)
  586. {
  587. if(Cadence < 70)
  588. {
  589. Result = 30 + Cadence;
  590. Result = (Result > 100) ? 100 : Result;
  591. }
  592. else
  593. {
  594. Result = 100;
  595. }
  596. }
  597. else
  598. {
  599. Result = 100;
  600. }
  601. }
  602. return Result;
  603. }
  604. //接收到关机指令处理
  605. void PowerOff_Process(TrueOrFalse_Flag_Struct_t ReturnEnable)
  606. {
  607. static FlagStatus SaveFlag = RESET;
  608. static uint32_t PeriodTimeCnt = 0;
  609. static uint8_t Count = 0;
  610. //关闭助力档位,关闭车灯
  611. MC_ControlCode.GearSt = MC_GearSt_OFF;
  612. MC_ControlCode.LightSwitch = MC_LightSwitch_OFF;
  613. Update_MC_ControlCode_Back();
  614. LightDriver_Process(MC_ConfigParam2.MC_Light_Mode, MC_ConfigParam2.HeadLightVol, MC_ConfigParam2.TailLightVol, IsBreakTrig_Flag, MC_ControlCode.LightSwitch);
  615. #if 1 //存储到Flash,下次开机时从Flash取出转移到EEPROM
  616. if(SaveFlag == RESET)
  617. {
  618. MC_PowerOffBkp.ODO_Km = MC_RideLog.ODO_Km;
  619. MC_PowerOffBkp.ODO_Time = MC_RideLog.ODO_Time;
  620. MC_PowerOffBkp.Trip_Km = MC_RideLog.TRIP_Km;
  621. MC_PowerOffBkp.Trip_Time = MC_RideLog.TRIP_Time;
  622. MC_PowerOffBkp.Run_Time = MC_RunLog1.RunTime;
  623. MC_PowerOffBkp.Log_ODO_Km = MC_RunLog1.ODO_Km;
  624. MC_PowerOffBkp.Log_ODO_Time = MC_RunLog1.ODO_Time;
  625. MC_PowerOffBkp.PedalPoweSum = MC_AvgPower.PedalPowerSum;
  626. SaveDataToEEPROM_Flash(EEPROM_FLASH_ADDR_POWEROFF_BKP, (uint8_t*)&MC_PowerOffBkp.ODO_Km, 40);//写入掉电临时保存数据,写入前该区域需擦除为0xFF才能操作成功
  627. SaveDataToEEPROM_Flash(EEPROM_FLASH_ADDR_POWEROFF_BKP_FLAG, (uint8_t*)"FLAG", 4); //掉电存储的数据标志更新
  628. SaveFlag = SET;
  629. }
  630. #endif
  631. //发送关机就绪信号
  632. SendData(ID_MC_BC, MODE_REPORT, 0x1305, (uint8_t*)"READY");
  633. //等待关机
  634. if(ReturnEnable == TRUE)
  635. {
  636. return;
  637. }
  638. else
  639. {
  640. PeriodTimeCnt = HAL_GetTick();
  641. Count = 0;
  642. while(Count < 10)
  643. {
  644. if((HAL_GetTick() - PeriodTimeCnt) > 100)
  645. {
  646. PeriodTimeCnt = HAL_GetTick();
  647. Count++;
  648. #if DEBUG
  649. HAL_IWDG_Refresh(&hiwdg);
  650. #endif
  651. }
  652. }
  653. }
  654. }
  655. //CAN设备PBU、HMI、BMS通信状态检测处理
  656. 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)
  657. {
  658. if(WorkMode == MC_WorkMode_Run) //不支持无PBU,且正常运行模式
  659. {
  660. if( NoPBU_Flag == MC_SUPPORT_DISABLE )
  661. {
  662. //PBU通信状态检测
  663. if(IsComOK_PBU.IsOK_Flag == TRUE)
  664. {
  665. if((HAL_GetTick() - IsComOK_PBU.OK_TrigTime) > 1000)
  666. {
  667. IsComOK_PBU.IsOK_Flag = FALSE;
  668. *GearSt = MC_GearSt_OFF;
  669. Update_MC_ControlCode_Back();
  670. DeviceOnLine_Status.Status_Bit.PBU_OffLine = 1;
  671. }
  672. else
  673. {
  674. DeviceOnLine_Status.Status_Bit.PBU_OffLine = 0;
  675. }
  676. }
  677. else
  678. {
  679. *GearSt = MC_GearSt_OFF;
  680. Update_MC_ControlCode_Back();
  681. DeviceOnLine_Status.Status_Bit.PBU_OffLine = 1;
  682. }
  683. //HMI通信状态检测
  684. if(NoHMI_Flag == MC_SUPPORT_ENABLE)
  685. {
  686. DeviceOnLine_Status.Status_Bit.HMI_OffLine = 0;
  687. }
  688. else
  689. {
  690. if(IsComOK_HMI.IsOK_Flag == TRUE)
  691. {
  692. if((HAL_GetTick() - IsComOK_HMI.OK_TrigTime) > 1000)
  693. {
  694. IsComOK_HMI.IsOK_Flag = FALSE;
  695. DeviceOnLine_Status.Status_Bit.HMI_OffLine = 1;
  696. }
  697. else
  698. {
  699. DeviceOnLine_Status.Status_Bit.HMI_OffLine = 0;
  700. }
  701. }
  702. else
  703. {
  704. DeviceOnLine_Status.Status_Bit.HMI_OffLine = 1;
  705. }
  706. }
  707. }
  708. //BMS通信状态检测
  709. if(IsComOK_BMS.IsOK_Flag == TRUE)
  710. {
  711. if((HAL_GetTick() - IsComOK_BMS.OK_TrigTime) > 5000)
  712. {
  713. IsComOK_BMS.IsOK_Flag = FALSE;
  714. DeviceOnLine_Status.Status_Bit.BMS_OffLine = 1;
  715. }
  716. else
  717. {
  718. DeviceOnLine_Status.Status_Bit.BMS_OffLine = 0;
  719. }
  720. }
  721. else
  722. {
  723. DeviceOnLine_Status.Status_Bit.BMS_OffLine = 1;
  724. }
  725. }
  726. }
  727. //UART设备TE通信状态检测处理
  728. void MC_UartRxCheck_Process(void)
  729. {
  730. //TE通信状态检测
  731. if(IsComOK_TE.IsOK_Flag == TRUE)
  732. {
  733. if((HAL_GetTick() - IsComOK_TE.OK_TrigTime) > 2000)
  734. {
  735. IsComOK_TE.IsOK_Flag = FALSE;
  736. }
  737. }
  738. }
  739. //运行总时间计算
  740. void MC_RunTime_Cal()
  741. {
  742. static uint32_t PeriodTimeCnt = 0;
  743. static uint32_t SavePeriodCount = 0;
  744. if((HAL_GetTick()- PeriodTimeCnt) >= 60000)
  745. {
  746. PeriodTimeCnt = HAL_GetTick();
  747. MC_RunLog1.RunTime++;
  748. SavePeriodCount++;
  749. }
  750. //自动存储历史数据
  751. if(SavePeriodCount >= 10) //自动存储周期10min
  752. {
  753. if(MC_CalParam.Foc_Flag == RESET)
  754. {
  755. SaveParamToEEprom_24C02(&I2C_Handle_EEPROM, EEPROM_24C02_ADDR_RUN_LOG1, sizeof(MC_RunLog1_Struct_t), (uint8_t*)&MC_RunLog1.PowerOnCnt);
  756. SaveParamToEEprom_24C02(&I2C_Handle_EEPROM, EEPROM_24C02_ADDR_RIDE_LOG, sizeof(MC_RideLog_Struct_t), (uint8_t*)&MC_RideLog.ODO_Km);
  757. SaveParamToEEprom_24C02(&I2C_Handle_EEPROM, EEPROM_24C02_ADDR_AVG_POWER, sizeof(MC_AvgPower_Struct_t), (uint8_t*)&MC_AvgPower.GearSt_ECO);
  758. SavePeriodCount = 0;
  759. }
  760. }
  761. }
  762. //设备授权校验
  763. void MC_DeviceCheck(Device_CheckInfo_Struct_t* p_Device, MC_ErrorCode_Struct_t* p_ErrorCode)
  764. {
  765. uint32_t SendPeriodTimeCnt = 0;
  766. uint8_t Send_MAC_ID_Cmd_Count = 0;
  767. uint8_t Send_Code_Cmd_Count = 0;
  768. uint8_t CalCodeResult[12];
  769. uint8_t CheckResult = 0;
  770. uint16_t Send_CanID;
  771. uint16_t Send_MAC_ID_Cmd;
  772. uint16_t Send_Code_Cmd;
  773. uint8_t DeviceSerial = 0;
  774. //确定校验设备类型
  775. if(p_Device == &BMS_CheckInfo)
  776. {
  777. DeviceSerial = 1;
  778. }
  779. else if(p_Device == &PBU_CheckInfo)
  780. {
  781. DeviceSerial = 2;
  782. }
  783. if(p_Device == &HMI_CheckInfo)
  784. {
  785. DeviceSerial = 3;
  786. }
  787. //根据设备类型定义发送指令
  788. switch(DeviceSerial)
  789. {
  790. case 1://校验电池
  791. {
  792. p_ErrorCode->ERROR_Bit.Fault_BMS_Check = 1;
  793. Send_CanID = ID_MC_TO_BMS;
  794. Send_MAC_ID_Cmd = 0x3100;
  795. Send_Code_Cmd = 0x3200;
  796. break;
  797. }
  798. case 2://校验按键
  799. {
  800. p_ErrorCode->ERROR_Bit.Fault_PBU_Check = 1;
  801. Send_CanID = ID_MC_TO_BMS;
  802. Send_MAC_ID_Cmd = 0x5100;
  803. Send_Code_Cmd = 0x5200;
  804. break;
  805. }
  806. case 3://校验仪表
  807. {
  808. p_ErrorCode->ERROR_Bit.Fault_HMI_Check = 1;
  809. Send_CanID = ID_MC_TO_BMS;
  810. Send_MAC_ID_Cmd = 0x7100;
  811. Send_Code_Cmd = 0x7200;
  812. break;
  813. }
  814. default:break;
  815. }
  816. //查询MAC ID,计算校验码,并与查询的授权码比较
  817. Send_MAC_ID_Cmd_Count = 4;
  818. SendData(Send_CanID, MODE_READ, Send_MAC_ID_Cmd, (uint8_t*)NULL);
  819. SendPeriodTimeCnt = HAL_GetTick();
  820. while(Send_MAC_ID_Cmd_Count)
  821. {
  822. CanRx_Process();
  823. if(CheckArrayIs0(p_Device->MAC_ID, 12) != 0) //检查是否接收到ID
  824. {
  825. CheckCodeCal(p_Device->MAC_ID, Secret_Key, CalCodeResult);//根据接收的ID计算授权码
  826. Send_Code_Cmd_Count = 4;
  827. SendData(Send_CanID, MODE_READ, Send_Code_Cmd, (uint8_t*)NULL);
  828. SendPeriodTimeCnt = HAL_GetTick();
  829. while(Send_Code_Cmd_Count)
  830. {
  831. CanRx_Process();
  832. if(CheckArrayIs0(p_Device->CheckCode, 12) != 0) ////检查是否接收到授权码
  833. {
  834. if(strncmp((char*)p_Device->CheckCode, (char*)CalCodeResult, 12) == 0)
  835. {
  836. CheckResult = 1;
  837. }
  838. Send_MAC_ID_Cmd_Count = 0;
  839. Send_Code_Cmd_Count = 0;
  840. break;
  841. }
  842. else
  843. {
  844. if((HAL_GetTick() - SendPeriodTimeCnt) > 100)
  845. {
  846. SendData(Send_CanID, MODE_READ, Send_Code_Cmd, (uint8_t*)NULL);
  847. Send_Code_Cmd_Count--;
  848. SendPeriodTimeCnt = HAL_GetTick();
  849. }
  850. }
  851. //看门狗清零
  852. #if DEBUG
  853. HAL_IWDG_Refresh(&hiwdg);
  854. #endif
  855. }
  856. }
  857. else
  858. {
  859. if((HAL_GetTick() - SendPeriodTimeCnt) > 100)
  860. {
  861. SendData(Send_CanID, MODE_READ, Send_MAC_ID_Cmd, (uint8_t*)NULL);
  862. Send_MAC_ID_Cmd_Count--;
  863. SendPeriodTimeCnt = HAL_GetTick();
  864. }
  865. }
  866. //看门狗清零
  867. #if DEBUG
  868. HAL_IWDG_Refresh(&hiwdg);
  869. #endif
  870. }
  871. //根据设备类型输出结果
  872. switch(DeviceSerial)
  873. {
  874. case 1://校验电池
  875. {
  876. if(CheckResult == 1)
  877. {
  878. p_ErrorCode->ERROR_Bit.Fault_BMS_Check = 0;
  879. }
  880. else
  881. {
  882. p_ErrorCode->ERROR_Bit.Fault_BMS_Check = 1;
  883. MC_RunLog1.BMS_Check_FaultCnt++;
  884. RunLogSaveIndex = 1;
  885. }
  886. break;
  887. }
  888. case 2://校验按键
  889. {
  890. if(CheckResult == 1)
  891. {
  892. p_ErrorCode->ERROR_Bit.Fault_PBU_Check = 0;
  893. }
  894. else
  895. {
  896. p_ErrorCode->ERROR_Bit.Fault_PBU_Check = 1;
  897. MC_RunLog1.PBU_Check_FaultCnt++;
  898. RunLogSaveIndex = 1;
  899. }
  900. break;
  901. }
  902. case 3://校验仪表
  903. {
  904. if(CheckResult == 1)
  905. {
  906. p_ErrorCode->ERROR_Bit.Fault_HMI_Check = 0;
  907. }
  908. else
  909. {
  910. p_ErrorCode->ERROR_Bit.Fault_HMI_Check = 1;
  911. MC_RunLog1.HMI_Check_FaultCnt++;
  912. RunLogSaveIndex = 1;
  913. }
  914. break;
  915. }
  916. default:break;
  917. }
  918. }
  919. //计算TIM2 ETR采集频率
  920. void Cal_SyncClockFreq(uint16_t* Result)
  921. {
  922. uint16_t Count = 0;
  923. Count = __HAL_TIM_GET_COUNTER(&htim2);
  924. *Result = Count * 20 / 1000;//50ms内计数值,单位转换为KHz
  925. __HAL_TIM_SET_COUNTER(&htim2, 0);
  926. }
  927. //温度历史信息处理
  928. void MC_TemperatureLogProcess(void)
  929. {
  930. static uint32_t PeriodTimeCnt = 0;
  931. static TrueOrFalse_Flag_Struct_t DataChangeFlag = FALSE;
  932. if(HAL_GetTick() < 10000) //开机前10s不处理
  933. {
  934. PeriodTimeCnt = HAL_GetTick();
  935. return;
  936. }
  937. if((HAL_GetTick() - PeriodTimeCnt) >= 5000) //判断周期5s
  938. {
  939. PeriodTimeCnt = HAL_GetTick();
  940. //PCB温度最小值
  941. if(MC_RunInfo.T_PCB < MC_RunLog1.T_PCB_Min)
  942. {
  943. MC_RunLog1.T_PCB_Min = MC_RunInfo.T_PCB;
  944. DataChangeFlag = TRUE;
  945. }
  946. //PCB温度最大值
  947. if(MC_RunInfo.T_PCB > MC_RunLog1.T_PCB_Max)
  948. {
  949. MC_RunLog1.T_PCB_Max = MC_RunInfo.T_PCB;
  950. DataChangeFlag = TRUE;
  951. }
  952. //绕组温度最小值
  953. if(MC_RunInfo.T_Coil < MC_RunLog1.T_Coil_Min)
  954. {
  955. MC_RunLog1.T_Coil_Min = MC_RunInfo.T_Coil;
  956. DataChangeFlag = TRUE;
  957. }
  958. //绕组温度最大值
  959. if(MC_RunInfo.T_Coil > MC_RunLog1.T_Coil_Max)
  960. {
  961. MC_RunLog1.T_Coil_Max = MC_RunInfo.T_Coil;
  962. DataChangeFlag = TRUE;
  963. }//MCU温度最小值
  964. if(MC_RunInfo.T_MCU < MC_RunLog1.T_MCU_Min)
  965. {
  966. MC_RunLog1.T_MCU_Min = MC_RunInfo.T_MCU;
  967. DataChangeFlag = TRUE;
  968. }
  969. //MCU温度最大值
  970. if(MC_RunInfo.T_MCU > MC_RunLog1.T_MCU_Max)
  971. {
  972. MC_RunLog1.T_MCU_Max = MC_RunInfo.T_MCU;
  973. DataChangeFlag = TRUE;
  974. }
  975. //自动存储
  976. #if 0
  977. static uint16_t SavePeriodCnt = 0;
  978. SavePeriodCnt++;
  979. if((SavePeriodCnt > 12) && (DataChangeFlag == TRUE)) //1min
  980. {
  981. SavePeriodCnt = 0;
  982. DataChangeFlag = FALSE;
  983. SaveParamToEEprom_24C02(&I2C_Handle_EEPROM, EEPROM_24C02_ADDR_RUN_LOG1, sizeof(MC_RunLog1_Struct_t), (uint8_t*)&MC_RunLog1.PowerOnCnt);
  984. }
  985. #endif
  986. }
  987. }
  988. //无码表模式初始化处理
  989. void NoPBUMode_Ini( void )
  990. {
  991. static TrueOrFalse_Flag_Struct_t NoPBUModeIniFinishedFlag = FALSE;
  992. if(HAL_GetTick() > 3000)
  993. {
  994. if( NoPBUModeIniFinishedFlag== FALSE )
  995. {
  996. NoPBUModeIniFinishedFlag = TRUE;
  997. if(MC_ConfigParam1.NoPBU_Flag == MC_SUPPORT_ENABLE)
  998. {
  999. MC_ControlCode.GearSt = MC_GearSt_SMART;
  1000. Update_MC_ControlCode_Back();
  1001. }
  1002. }
  1003. }
  1004. }
  1005. //车辆传动比计算,运行周期100ms
  1006. void BikeRatioCal_Process(uint16_t MotorSpeed, uint16_t Cadence, uint16_t BikeSpeed, Bike_RatioCal_Struct_t* p_Bike_RatioCal)
  1007. {
  1008. uint16_t AccCnt, DecCnt;
  1009. //车辆静止或滑行时不计算
  1010. if((BikeSpeed < 30) || ((BikeSpeed >= 30) && (MotorSpeed < 100) && (Cadence < 10)))
  1011. {
  1012. p_Bike_RatioCal->RatioPer = p_Bike_RatioCal->RatioDefault;
  1013. p_Bike_RatioCal->RatioResult = p_Bike_RatioCal->RatioDefault;
  1014. p_Bike_RatioCal->RatioFlt = p_Bike_RatioCal->RatioDefault;
  1015. p_Bike_RatioCal->RatioFltSum = 0;
  1016. return;
  1017. }
  1018. //根据车速、电机转速、踏频计算传动系数,系数 = 车速 / 电机转速 * 1024,其中车速单位为km/h,并放大了10倍
  1019. p_Bike_RatioCal->RatioPer = (((uint32_t)BikeSpeed << 18) * 10) / ((((uint32_t)MotorSpeed << 8) > ((uint32_t)Cadence * 2795)) ? ((uint32_t)MotorSpeed << 8) : ((uint32_t)Cadence * 2795));
  1020. //限制计算结果
  1021. p_Bike_RatioCal->RatioPer = (p_Bike_RatioCal->RatioPer < 500) ? 500 : ((p_Bike_RatioCal->RatioPer > 8000) ? 8000 : p_Bike_RatioCal->RatioPer);
  1022. //计算结果滤波
  1023. p_Bike_RatioCal->RatioFltSum += ((p_Bike_RatioCal->RatioPer << 10) - p_Bike_RatioCal->RatioFltSum) >> 5;
  1024. p_Bike_RatioCal->RatioFlt = p_Bike_RatioCal->RatioFltSum >> 10;
  1025. //目标值计算
  1026. #if 0
  1027. AccCnt = p_Bike_RatioCal->TargetAcc;
  1028. DecCnt = p_Bike_RatioCal->TargetDec;
  1029. if(p_Bike_RatioCal->RatioFlt - p_Bike_RatioCal->RatioResult >= AccCnt)
  1030. p_Bike_RatioCal->RatioResult += AccCnt;
  1031. else if(p_Bike_RatioCal->RatioResult - p_Bike_RatioCal->RatioFlt >= DecCnt)
  1032. p_Bike_RatioCal->RatioResult -= DecCnt;
  1033. else
  1034. p_Bike_RatioCal->RatioResult = p_Bike_RatioCal->RatioFlt;
  1035. #else
  1036. p_Bike_RatioCal->RatioResult = p_Bike_RatioCal->RatioFlt;
  1037. #endif
  1038. }
  1039. //设备心跳
  1040. void Device_Handshake_Process(void)
  1041. {
  1042. static uint32_t PeriodCnt = 0;
  1043. static uint8_t i = 0;
  1044. static uint8_t HandShakeFlag1 = 0, HandShakeFlag2 = 0;
  1045. //开机时判断是否发送心跳
  1046. if(HandShakeFlag1 == 0)
  1047. {
  1048. if(IsComOK_BMS.IsOK_Flag == TRUE)
  1049. HandShakeFlag1 = 1;
  1050. }
  1051. if(HandShakeFlag2 == 0)
  1052. {
  1053. if(IsComOK_PBU.IsOK_Flag == TRUE)
  1054. HandShakeFlag2 = 1;
  1055. }
  1056. //定时循环发送心跳
  1057. if((HAL_GetTick() - PeriodCnt) >= 1000)
  1058. {
  1059. PeriodCnt = HAL_GetTick();
  1060. if(i == 0)
  1061. {
  1062. //BMS
  1063. if(HandShakeFlag1 == 1)
  1064. SendData(ID_MC_TO_BMS, MODE_READ, 0x3009, (uint8_t*)"HANDSHAKE");
  1065. i = 1;
  1066. }
  1067. else if(i == 1)
  1068. {
  1069. //OBC
  1070. if(HandShakeFlag2 == 1)
  1071. SendData(ID_MC_TO_PBU, MODE_READ, 0x5009, (uint8_t*)"HANDSHAKE");
  1072. i = 0;
  1073. }
  1074. }
  1075. }
  1076. /**************************全局函数定义结束*****************/