main.c 37 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754
  1. /**
  2. * @mainpage
  3. * Project Name:
  4. * Author:
  5. * Complier:
  6. * CPU_TYPE:
  7. * @section Project description:
  8. * -项目详细描述
  9. * @section function description:
  10. * -#功能描述
  11. * @section Usage description:
  12. * -#用法描述
  13. * @attention
  14. * -#注意事项
  15. */
  16. #ifndef _MAIN_C_
  17. #define _MAIN_C_
  18. #endif
  19. /************************************************************************
  20. Included File
  21. *************************************************************************/
  22. #include "syspar.h"
  23. #include "user.h"
  24. #include "TimeTask_Event.h"
  25. #include "FSM_1st.h"
  26. #include "FSM_2nd.h"
  27. #include "can.h"
  28. #include "cmdgennew.h"
  29. #include "canAppl.h"
  30. #include "flash_master.h"
  31. #include "torquesensor.h"
  32. #include "power.h"
  33. #include "STLmain.h"
  34. #include "api_rt.h"
  35. #include "hwsetup.h"
  36. #include "app.h"
  37. #include "Temp.h"
  38. #include "enviolo_can.h"
  39. #include "giant_can.h"
  40. #include "profiler.h"
  41. /***************************
  42. *********************************************
  43. Exported Functions:
  44. ************************************************************************/
  45. /***************************************************************
  46. Function: main;
  47. Description:main function
  48. Call by:
  49. Input Variables: N/A
  50. Output/Return Variables: N/A
  51. Subroutine Call: N/A;
  52. Reference: N/A
  53. ****************************************************************/
  54. int main(void) /* parasoft-suppress GJB5369-4_2_1_10 "mismatch" */
  55. {
  56. #ifndef RUN_ARCH_SIM
  57. SCB->VTOR = 0x08003000;
  58. DISABLE_IRQ;
  59. /* MCU Core and GPIO configuration */
  60. hw_voHardwareSetup1();
  61. /* Peripheral configuration */
  62. hw_voHardwareSetup2();
  63. /* Api Init*/
  64. iRt_Init();
  65. /* Api App Init*/
  66. AppInit();
  67. /* Spi Position Comp */
  68. spi_voReadWriteSeneorReg();
  69. /* Error Log Read */
  70. flash_voErrorRead();
  71. /* MCU Self Test Init */
  72. stl_voRunTimeChecksInit();
  73. /* Watchdog 1s */
  74. hw_voIWDGInit(FWDGT_PSC_DIV32,1250);//1s
  75. /* Program load rate testing init */
  76. profiler_init();
  77. //Enviolo gear sensor init
  78. GearBox_Init();
  79. //ganir control data init
  80. giant_Init();
  81. /* Timer enable */
  82. hw_voTimEn();
  83. /* Interrupts of peripherals enable*/
  84. hw_voEnInt();
  85. /* Enable all interrupts */
  86. ENABLE_IRQ;
  87. /* Enter infinite loop */
  88. while (1)
  89. {
  90. PROFILER_BG();
  91. AppLoop();
  92. }
  93. return 0;
  94. #endif
  95. }
  96. /***************************************************************
  97. Function: mn_voSoftwareInit;
  98. Description:software intial
  99. Call by:
  100. Input Variables: N/A
  101. Output/Return Variables: N/A
  102. Subroutine Call: N/A;
  103. Reference: N/A
  104. ****************************************************************/
  105. void mn_voParaSet(void)
  106. {
  107. /* Read system parameter*/
  108. i2c_voSysparaReadFromEE(&i2c_stRXCRCOut);
  109. if (i2c_stRXCRCOut.blHistoryParaFltFlg == FALSE)
  110. {
  111. ass_stParaSet.uwAsssistSelectNum = I2C_uwHistoryParaRead[0];
  112. cp_stHistoryPara.uwOpenTimes = I2C_uwHistoryParaRead[1];
  113. cp_stHistoryPara.ulUsedTime = (((ULONG)I2C_uwHistoryParaRead[2]) << 16) + I2C_uwHistoryParaRead[3];
  114. cp_stHistoryPara.uwNTCTempMaxCe = I2C_uwHistoryParaRead[4];
  115. cp_stHistoryPara.uwNTCTempMinCe = I2C_uwHistoryParaRead[5];
  116. cp_stHistoryPara.uwAlamHOcurTimes = I2C_uwHistoryParaRead[6];
  117. cp_stHistoryPara.uwAlamSOcurTimes = I2C_uwHistoryParaRead[7];
  118. cp_stHistoryPara.uwAlamOHeatTimes = I2C_uwHistoryParaRead[8];
  119. cp_stHistoryPara.uwAlamRotorLockTimes = I2C_uwHistoryParaRead[9];
  120. cp_stHistoryPara.uwAlamPhsLossTimes = I2C_uwHistoryParaRead[10];
  121. cp_stHistoryPara.uwAlamOVolTimes = I2C_uwHistoryParaRead[11];
  122. cp_stHistoryPara.uwAlamUVolTimes = I2C_uwHistoryParaRead[12];
  123. cp_stHistoryPara.uwAlamComOTimeTimes = I2C_uwHistoryParaRead[13];
  124. cp_stHistoryPara.uwG1AvgPwrConsumption = I2C_uwHistoryParaRead[14];
  125. cp_stHistoryPara.uwG2AvgPwrConsumption = I2C_uwHistoryParaRead[15];
  126. cp_stHistoryPara.uwG3AvgPwrConsumption = I2C_uwHistoryParaRead[16];
  127. cp_stHistoryPara.uwG4AvgPwrConsumption = I2C_uwHistoryParaRead[17];
  128. cp_stHistoryPara.uwG5AvgPwrConsumption = I2C_uwHistoryParaRead[18];
  129. cp_stHistoryPara.ulODOTrip = (((ULONG)I2C_uwHistoryParaRead[19]) << 16) + I2C_uwHistoryParaRead[20];
  130. cp_stHistoryPara.ulODOTime = (((ULONG)I2C_uwHistoryParaRead[21]) << 16) + I2C_uwHistoryParaRead[22];
  131. cp_stHistoryPara.ulTripSum = (((ULONG)I2C_uwHistoryParaRead[23]) << 16) + I2C_uwHistoryParaRead[24];
  132. cp_stHistoryPara.ulTripSumTime = (((ULONG)I2C_uwHistoryParaRead[25]) << 16) + I2C_uwHistoryParaRead[26];
  133. cp_stHistoryPara.uwTorSensorAlamTimes = I2C_uwHistoryParaRead[27];
  134. cp_stHistoryPara.uwCadSensorAlamTimes = I2C_uwHistoryParaRead[28];
  135. cp_stHistoryPara.uwBikeSpdSensorAlamTimes = I2C_uwHistoryParaRead[29];
  136. cp_stHistoryPara.uwPosSensorAlamTimes = I2C_uwHistoryParaRead[30];
  137. cp_stHistoryPara.ulRealODOTrip = (((ULONG)I2C_uwHistoryParaRead[31]) << 16) + I2C_uwHistoryParaRead[32];
  138. cp_stHistoryPara.ulRealODOTime = (((ULONG)I2C_uwHistoryParaRead[33]) << 16) + I2C_uwHistoryParaRead[34];
  139. }
  140. else
  141. {}
  142. // peripheral Para Set
  143. cadence_stFreGetCof.uwNumbersPulses = CADENCE_NUMBERS_PULSES;
  144. bikespeed_stFreGetCof.uwNumbersPulses = BIKESPEED_NUMBERS_PULSES;
  145. torsensor_stTorSensorCof.uwMaxSensorTorquePu = ((ULONG)TORQUE_MAX_RANGE << 14) / TORQUEBASE; // Q14
  146. /////////////////////////////////
  147. if (cp_stFlg.ParaUseEEFlg == TRUE)
  148. {
  149. if (i2c_stRXCRCOut.ReadFinishFlg == TRUE)
  150. {
  151. if (i2c_stRXCRCOut.blMotorParaFltFlg == FALSE)
  152. {
  153. cp_stMotorPara.swMotrPolePairs = (SWORD)I2C_uwMotorParaRead[0];
  154. cp_stMotorPara.swRsOhm = (SWORD)I2C_uwMotorParaRead[1];
  155. cp_stMotorPara.swLdmH = (SWORD)I2C_uwMotorParaRead[2];
  156. cp_stMotorPara.swLqmH = (SWORD)I2C_uwMotorParaRead[3];
  157. cp_stMotorPara.swFluxWb = (SWORD)I2C_uwMotorParaRead[4];
  158. cp_stMotorPara.swIdMaxA = (SWORD)I2C_uwMotorParaRead[5];
  159. cp_stMotorPara.swIdMinA = (SWORD)I2C_uwMotorParaRead[6];
  160. cp_stMotorPara.swRSpeedRpm = (SWORD)I2C_uwMotorParaRead[7];
  161. cp_stMotorPara.swRPwrWt = (SWORD)I2C_uwMotorParaRead[8];
  162. cp_stMotorPara.swRIarmsA = (SWORD)I2C_uwMotorParaRead[9];
  163. cp_stMotorPara.swRUdcV = (SWORD)I2C_uwMotorParaRead[10];
  164. cp_stMotorPara.swJD = (SWORD)I2C_uwMotorParaRead[11];
  165. cp_stMotorPara.swTorMax = (SWORD)I2C_uwMotorParaRead[12];
  166. }
  167. else
  168. {}
  169. if (i2c_stRXCRCOut.blBikeParaFltFlg == FALSE)
  170. {
  171. ass_stParaCong.uwWheelPerimeter = I2C_uwBikeParaRead[0];
  172. ass_stParaCong.uwMechRationMotor = I2C_uwBikeParaRead[1];
  173. ass_stParaCong.uwAssistMaxSpdKmH = I2C_uwBikeParaRead[2];
  174. ass_stParaCong.uwThrottleMaxSpdKmH = I2C_uwBikeParaRead[3];
  175. ass_stParaCong.uwNmFrontChainring = I2C_uwBikeParaRead[4];
  176. ass_stParaCong.uwNmBackChainring = I2C_uwBikeParaRead[5];
  177. ass_stParaCong.uwAssistSelect1 = I2C_uwBikeParaRead[6];
  178. ass_stParaCong.uwAssistSelect2 = I2C_uwBikeParaRead[7];
  179. ass_stParaCong.uwLightVoltage = I2C_uwBikeParaRead[8];
  180. ass_stParaCong.swDeltPerimeter = (SWORD)I2C_uwBikeParaRead[9];
  181. ass_stParaCong.uwStartMode = I2C_uwBikeParaRead[10];
  182. ass_stParaCong.uwAutoPowerOffTime = I2C_uwBikeParaRead[11];
  183. ass_stParaCong.uwThrottleSmooth = I2C_uwBikeParaRead[12];
  184. }
  185. else
  186. {}
  187. if (i2c_stRXCRCOut.blMControlParaFltFlg == FALSE)
  188. {
  189. cp_stFlg.ParaFirstSetFlg = I2C_uwMControlRead[0];
  190. cp_stFlg.SpiOffsetFirstSetFlg = I2C_uwMControlRead[1];
  191. spi_stResolverOut.swSpiThetaOffsetOrignPu = (SWORD)I2C_uwMControlRead[2];
  192. spi_stResolverOut.swSpiThetaOffsetPu = (SWORD)I2C_uwMControlRead[3];
  193. cp_stMotorPara.swIpeakMaxA = (SWORD)I2C_uwMControlRead[4];
  194. cp_stControlPara.swAlmOverCurrentVal = (SWORD)I2C_uwMControlRead[5];
  195. cp_stControlPara.swAlmOverVolVal3 = (SWORD)I2C_uwMControlRead[6];
  196. cp_stControlPara.swAlmUnderVolVal2 = (SWORD)I2C_uwMControlRead[7];
  197. cp_stControlPara.swAlmOverSpdVal = (SWORD)I2C_uwMControlRead[8];
  198. cp_stControlPara.swAlmOverHeatCeVal = (SWORD)I2C_uwMControlRead[9];
  199. cp_stControlPara.swAlmRecOHeatVal = (SWORD)I2C_uwMControlRead[10];
  200. cp_stControlPara.swAlmPwrLimitStartTempVal = (SWORD)I2C_uwMControlRead[11];
  201. }
  202. else
  203. {
  204. cp_stFlg.RunPermitFlg = FALSE;
  205. }
  206. if (i2c_stRXCRCOut.blSensorParaFltFlg == FALSE)
  207. {
  208. torsensor_stTorSensorCof.uwTorqueOffsetOrign = I2C_uwSensorRead[0];
  209. torsensor_stTorSensorCof.uwTorqueOffsetNow1 = I2C_uwSensorRead[1];
  210. torsensor_stTorSensorCof.uwTorqueOffsetNow2 = I2C_uwSensorRead[2];
  211. torsensor_stTorSensorCof.uwTorqueOffsetNow3 = I2C_uwSensorRead[3];
  212. torsensor_stTorSensorCof.uwTorqueOffsetNow4 = I2C_uwSensorRead[4];
  213. torsensor_stTorSensorCof.uwMaxSensorTorquePu = I2C_uwSensorRead[5];
  214. torsensor_stTorSensorCof.uwBikeTorStep1RealNm = I2C_uwSensorRead[6];
  215. torsensor_stTorSensorCof.uwBikeTorStep1ADC = I2C_uwSensorRead[7];
  216. torsensor_stTorSensorCof.uwBikeTorStep2RealNm = I2C_uwSensorRead[8];
  217. torsensor_stTorSensorCof.uwBikeTorStep2ADC = I2C_uwSensorRead[9];
  218. torsensor_stTorSensorCof.uwBikeTorStep3RealNm = I2C_uwSensorRead[10];
  219. torsensor_stTorSensorCof.uwBikeTorStep3ADC = I2C_uwSensorRead[11];
  220. torsensor_stTorSensorCof.uwBikeTorStep4RealNm = I2C_uwSensorRead[12];
  221. torsensor_stTorSensorCof.uwBikeTorStep4ADC = I2C_uwSensorRead[13];
  222. cadence_stFreGetCof.uwNumbersPulses = I2C_uwSensorRead[14];
  223. bikespeed_stFreGetCof.uwNumbersPulses = I2C_uwSensorRead[15];
  224. }
  225. else
  226. {
  227. cp_stFlg.RunPermitFlg = FALSE;
  228. }
  229. if (i2c_stRXCRCOut.blAssistParaFltFlg == FALSE)
  230. {
  231. ass_stParaSet.uwStartupCoef = I2C_uwAssistParaRead[0];
  232. ass_stParaSet.uwStartupCruiseCoef = I2C_uwAssistParaRead[1];
  233. ass_stParaSet.uwAssistStartNm = 70;//I2C_uwAssistParaRead[2];
  234. ass_stParaSet.uwAssistStopNm = 30;//I2C_uwAssistParaRead[3];
  235. ass_stParaSet.uwStartUpGainStep = I2C_uwAssistParaRead[4];
  236. ass_stParaSet.uwStartUpCadNm = I2C_uwAssistParaRead[5];
  237. ass_stParaSet.uwTorLPFCadNm = I2C_uwAssistParaRead[6];
  238. ass_stParaSet.uwSpeedAssistSpdRpm = I2C_uwAssistParaRead[7];
  239. ass_stParaSet.uwSpeedAssistIMaxA = I2C_uwAssistParaRead[8];
  240. ass_stParaSet.uwAssistLimitBikeSpdStart = I2C_uwAssistParaRead[9];
  241. ass_stParaSet.uwAssistLimitBikeSpdStop = I2C_uwAssistParaRead[10];
  242. ass_stParaSet.uwCadenceWeight = I2C_uwAssistParaRead[11];
  243. // ass_stParaSet.uwTorWeight = Q12_1 - ass_stParaSet.uwCadenceWeight;
  244. }
  245. else
  246. {}
  247. }
  248. cp_stFlg.ParaUseEEFinishFlg = TRUE;
  249. }
  250. else
  251. {}
  252. if (i2c_stRXCRCOut.blGearBoxParaFltFlg == FALSE)
  253. {
  254. GearBox_OBC_SetParams.GearNum = I2C_uwGearBoxParaRead[0];
  255. GearBox_OBC_SetParams.CadenceMin = I2C_uwGearBoxParaRead[1];
  256. GearBox_OBC_SetParams.CadenceMax = I2C_uwGearBoxParaRead[2];
  257. }
  258. else
  259. {}
  260. }
  261. /***************************************************************
  262. Function: mn_voParaUpdate;
  263. Description:update pra from upper PC
  264. Call by:
  265. Input Variables: N/A
  266. Output/Return Variables: N/A
  267. Subroutine Call: N/A;
  268. Reference: N/A
  269. ****************************************************************/
  270. void mn_voParaUpdate(void)
  271. {
  272. if (cp_stFlg.ParaMInfoUpdateFlg == TRUE)
  273. {
  274. cp_stMotorPara.swMotrPolePairs = (SWORD)MC_UpcInfo.stMotorInfo.uwPolePairs;
  275. cp_stMotorPara.swRsOhm = (SWORD)MC_UpcInfo.stMotorInfo.uwRsmOhm;
  276. cp_stMotorPara.swLdmH = (SWORD)MC_UpcInfo.stMotorInfo.uwLduH;
  277. cp_stMotorPara.swLqmH = (SWORD)MC_UpcInfo.stMotorInfo.uwLquH;
  278. cp_stMotorPara.swFluxWb = (SWORD)MC_UpcInfo.stMotorInfo.uwFluxmWb;
  279. cp_stMotorPara.swIdMaxA = (SWORD)MC_UpcInfo.stMotorInfo.uwIdMaxA;
  280. cp_stMotorPara.swIdMinA = (SWORD)MC_UpcInfo.stMotorInfo.uwIdMinA;
  281. cp_stMotorPara.swRSpeedRpm = (SWORD)MC_UpcInfo.stMotorInfo.uwRSpdRpm;
  282. cp_stMotorPara.swRPwrWt = (SWORD)MC_UpcInfo.stMotorInfo.uwRPwrWt;
  283. cp_stMotorPara.swRIarmsA = (SWORD)MC_UpcInfo.stMotorInfo.uwRCurA;
  284. cp_stMotorPara.swRUdcV = (SWORD)MC_UpcInfo.stMotorInfo.uwRVolV;
  285. cp_stMotorPara.swJD = (SWORD)MC_UpcInfo.stMotorInfo.uwJD;
  286. cp_stMotorPara.swTorMax = (SWORD)MC_UpcInfo.stMotorInfo.uwTorMaxNm;
  287. cp_stFlg.ParaMotorDriveUpdateFinishFlg = TRUE;
  288. cp_stFlg.ParaMInfoUpdateFlg = FALSE;
  289. }
  290. if (cp_stFlg.ParaBikeInfoUpdateFlg == TRUE)
  291. {
  292. ass_stParaCong.uwWheelPerimeter = MC_UpcInfo.stBikeInfo.uwWheelPerimeter;
  293. ass_stParaCong.uwMechRationMotor = MC_UpcInfo.stBikeInfo.uwMechRationMotor;
  294. ass_stParaCong.uwAssistMaxSpdKmH = MC_UpcInfo.stBikeInfo.uwAssistMaxSpdKmH;
  295. ass_stParaCong.uwThrottleMaxSpdKmH = MC_UpcInfo.stBikeInfo.uwThrottleMaxSpdKmH;
  296. ass_stParaCong.uwNmFrontChainring = MC_UpcInfo.stBikeInfo.uwNmFrontChainring;
  297. ass_stParaCong.uwNmBackChainring = MC_UpcInfo.stBikeInfo.uwNmBackChainring;
  298. ass_stParaCong.uwAssistSelect1 = MC_UpcInfo.stBikeInfo.uwAssistSelect1;
  299. ass_stParaCong.uwAssistSelect2 = MC_UpcInfo.stBikeInfo.uwAssistSelect2;
  300. ass_stParaCong.uwLightVoltage = MC_UpcInfo.stBikeInfo.uwLightVoltage;
  301. ass_stParaCong.swDeltPerimeter = MC_UpcInfo.stBikeInfo.swWheelSizeAdjust;
  302. ass_stParaCong.uwStartMode = MC_UpcInfo.stBikeInfo.uwStartMode;
  303. ass_stParaCong.uwAutoPowerOffTime = MC_UpcInfo.stBikeInfo.uwAutoPowerOffTime;
  304. ass_stParaCong.uwThrottleSmooth = MC_UpcInfo.stBikeInfo.uwThrottleSmooth;
  305. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  306. cp_stFlg.ParaBikeInfoUpdateFlg = FALSE;
  307. }
  308. if (cp_stFlg.ParaMCInfoUpdateFlg == TRUE)
  309. {
  310. cp_stFlg.ParaFirstSetFlg = MC_UpcInfo.stTestParaInfo.uwEEFirstDefaultSetFlg;
  311. cp_stFlg.SpiOffsetFirstSetFlg = MC_UpcInfo.stTestParaInfo.uwSPIOffsetFirstSetFlg;
  312. spi_stResolverOut.swSpiThetaOffsetOrignPu = MC_UpcInfo.stMContorlInfo.uwSPIPosOffsetOrigin;
  313. spi_stResolverOut.swSpiThetaOffsetPu = MC_UpcInfo.stMContorlInfo.uwSPIPosOffsetNow;
  314. cp_stMotorPara.swIpeakMaxA = (SWORD)MC_UpcInfo.stMContorlInfo.uwIPeakMaxA;
  315. cp_stControlPara.swAlmOverCurrentVal = (SWORD)MC_UpcInfo.stMContorlInfo.uwAlamOCurA;
  316. cp_stControlPara.swAlmOverVolVal3 = (SWORD)MC_UpcInfo.stMContorlInfo.uwAlamOVolV;
  317. cp_stControlPara.swAlmUnderVolVal2 = (SWORD)MC_UpcInfo.stMContorlInfo.uwAlamUVolV;
  318. cp_stControlPara.swAlmOverSpdVal = (SWORD)MC_UpcInfo.stMContorlInfo.uwAlamOverSpdRpm;
  319. cp_stControlPara.swAlmOverHeatCeVal = (SWORD)MC_UpcInfo.stMContorlInfo.uwAlamOverHeatCe;
  320. cp_stControlPara.swAlmRecOHeatVal = (SWORD)MC_UpcInfo.stMContorlInfo.uwAlamRecHeatCe;
  321. cp_stControlPara.swAlmPwrLimitStartTempVal = (SWORD)MC_UpcInfo.stMContorlInfo.uwPwrLimitStartCe;
  322. cp_stFlg.ParaMotorDriveUpdateFinishFlg = TRUE;
  323. cp_stFlg.ParaMCInfoUpdateFlg = FALSE;
  324. }
  325. if (cp_stFlg.ParaSensorInfoUpdateFlg == TRUE)
  326. {
  327. torsensor_stTorSensorCof.uwTorqueOffsetOrign = MC_UpcInfo.stSensorInfo.uwTorSensorOffsetOrigin;
  328. torsensor_stTorSensorCof.uwMaxSensorTorquePu = MC_UpcInfo.stSensorInfo.uwBikeTorMaxNm;
  329. torsensor_stTorSensorCof.uwBikeTorStep1RealNm = MC_UpcInfo.stSensorInfo.uwBikeTor1StepRealNm;
  330. torsensor_stTorSensorCof.uwBikeTorStep1ADC = MC_UpcInfo.stSensorInfo.uwBikeTor1StepADC;
  331. torsensor_stTorSensorCof.uwBikeTorStep2RealNm = MC_UpcInfo.stSensorInfo.uwBikeTor2StepRealNm;
  332. torsensor_stTorSensorCof.uwBikeTorStep2ADC = MC_UpcInfo.stSensorInfo.uwBikeTor2StepADC;
  333. torsensor_stTorSensorCof.uwBikeTorStep3RealNm = MC_UpcInfo.stSensorInfo.uwBikeTor3StepRealNm;
  334. torsensor_stTorSensorCof.uwBikeTorStep3ADC = MC_UpcInfo.stSensorInfo.uwBikeTor3StepADC;
  335. torsensor_stTorSensorCof.uwBikeTorStep4RealNm = MC_UpcInfo.stSensorInfo.uwBikeTor4StepRealNm;
  336. torsensor_stTorSensorCof.uwBikeTorStep4ADC = MC_UpcInfo.stSensorInfo.uwBikeTor4StepADC;
  337. cadence_stFreGetCof.uwNumbersPulses = MC_UpcInfo.stSensorInfo.uwCadSensorPulseNm;
  338. bikespeed_stFreGetCof.uwNumbersPulses = MC_UpcInfo.stSensorInfo.uwBikeSpdSensorPulseNm;
  339. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  340. cp_stFlg.ParaSensorInfoUpdateFlg = FALSE;
  341. }
  342. if (cp_stFlg.ParaAInfoUpdateFlg == TRUE)
  343. {
  344. ass_stParaSet.uwStartupCoef = MC_UpcInfo.stAssistInfo.swStartupGain;
  345. ass_stParaSet.uwStartupCruiseCoef = MC_UpcInfo.stAssistInfo.swStartcruiseGain;
  346. ass_stParaSet.uwAssistStartNm = MC_UpcInfo.stAssistInfo.uwAssistStartNm;
  347. ass_stParaSet.uwAssistStopNm = MC_UpcInfo.stAssistInfo.uwAssistStopNm;
  348. ass_stParaSet.uwStartUpGainStep = MC_UpcInfo.stAssistInfo.uwStartUpGainStep;
  349. ass_stParaSet.uwStartUpCadNm = MC_UpcInfo.stAssistInfo.uwStartUpCadNm;
  350. ass_stParaSet.uwTorLPFCadNm = MC_UpcInfo.stAssistInfo.uwTorLPFCadNm;
  351. ass_stParaSet.uwSpeedAssistSpdRpm = MC_UpcInfo.stAssistInfo.uwSpeedAssistSpdRpm;
  352. ass_stParaSet.uwSpeedAssistIMaxA = MC_UpcInfo.stAssistInfo.uwSpeedAssistIMaxA;
  353. ass_stParaSet.uwAssistLimitBikeSpdStart = MC_UpcInfo.stAssistInfo.uwAssistLimitBikeSpdStart;
  354. ass_stParaSet.uwAssistLimitBikeSpdStop = MC_UpcInfo.stAssistInfo.uwAssistLimitBikeSpdStop;
  355. ass_stParaSet.uwCadenceWeight = MC_UpcInfo.stAssistInfo.uwCadenceAssistWeight;
  356. //ass_stParaSet.uwTorWeight = Q12_1 - ass_stParaSet.uwCadenceWeight;
  357. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  358. cp_stFlg.ParaAInfoUpdateFlg = FALSE;
  359. }
  360. if(cp_stFlg.TestParaInfoUpdateFlg == TRUE)
  361. {
  362. cp_stControlPara.swAlignCurAp = (SWORD)MC_UpcInfo.stTestParaInfo.uwInitPosCurAmp;
  363. cp_stControlPara.swDragVolAp = (SWORD)MC_UpcInfo.stTestParaInfo.uwVFControlVolAmp;
  364. cp_stControlPara.swDragCurAp = (SWORD)MC_UpcInfo.stTestParaInfo.uwIFControlCurAmp;
  365. cp_stControlPara.swDragSpdHz = (SWORD)MC_UpcInfo.stTestParaInfo.uwVFIFTargetFreHz;
  366. cp_stControlPara.swSpeedAccRate = (SWORD)MC_UpcInfo.stTestParaInfo.uwSpeedLoopAccRate;
  367. cp_stControlPara.swSpeedDccRate = (SWORD)MC_UpcInfo.stTestParaInfo.uwSpeedLoopDecRate;
  368. cp_stControlPara.swAsrPIBandwidth = (SWORD)MC_UpcInfo.stTestParaInfo.uwSpeedLoopBandWidthHz;
  369. cp_stControlPara.swAsrPIM = (SWORD)MC_UpcInfo.stTestParaInfo.uwSpeedLoopCoefM;
  370. cp_stControlPara.swAcrPIBandwidth = (SWORD)MC_UpcInfo.stTestParaInfo.uwCuerrentLoopBandWidthHz;
  371. cp_stControlPara.swAcrRaCoef = (SWORD)MC_UpcInfo.stTestParaInfo.uwCurrentLoopCoefM;
  372. cp_stControlPara.swObsFluxPICrossfreHz = (SWORD)MC_UpcInfo.stTestParaInfo.uwFluxObsBandWidthHz;
  373. cp_stControlPara.swObsFluxPIDampratio = (SWORD)MC_UpcInfo.stTestParaInfo.uwFluxObsCoefM;
  374. cp_stControlPara.swObsSpdPLLBandWidthHz = (SWORD)MC_UpcInfo.stTestParaInfo.uwThetaObsPLLBandWidthHz;
  375. cp_stControlPara.swObsSpdPLLM = (SWORD)MC_UpcInfo.stTestParaInfo.uwThetaObsPLLCoefM;
  376. cp_stMotorPara.swJD = (SWORD)MC_UpcInfo.stTestParaInfo.uwJm;
  377. cp_stControlPara.swPWMMaxDuty = (SWORD)MC_UpcInfo.stTestParaInfo.uwPWMMaxDuty;
  378. cp_stControlPara.swPWM7to5Duty = (SWORD)MC_UpcInfo.stTestParaInfo.uwPWM7to5Duty;
  379. cp_stControlPara.swPwrLimitValWt = (SWORD)MC_UpcInfo.stTestParaInfo.uwPwrLimit;
  380. cp_stControlPara.swPwrLimitErrWt = (SWORD)MC_UpcInfo.stTestParaInfo.uwPwrLimitError;
  381. cp_stControlPara.swPwrLimitKpPu = (SWORD)MC_UpcInfo.stTestParaInfo.uwPwrLimitKp;
  382. cp_stControlPara.swPwrLimitKiPu = (SWORD)MC_UpcInfo.stTestParaInfo.uwPwrLimitKi;
  383. cp_stFlg.ParaMotorDriveUpdateFinishFlg = TRUE;
  384. // cp_stFlg.TestParaInfoUpdateFlg = FALSE;
  385. }
  386. }
  387. /***************************************************************
  388. Function: mn_voSoftwareInit;
  389. Description:software intial
  390. Call by:
  391. Input Variables: N/A
  392. Output/Return Variables: N/A
  393. Subroutine Call: N/A;
  394. Reference: N/A
  395. ****************************************************************/
  396. void mn_voEEUperParaUpdate(void)
  397. {
  398. if (MC_UpcInfo.stMotorInfo.uwSaveFlg == TRUE)
  399. {
  400. Syspara2.stMotorPara.uwPolePairs.uwReal = (UWORD)cp_stMotorPara.swMotrPolePairs;
  401. Syspara2.stMotorPara.uwRsmOhm.uwReal = (UWORD)cp_stMotorPara.swRsOhm;
  402. Syspara2.stMotorPara.uwLduH.uwReal = (UWORD)cp_stMotorPara.swLdmH;
  403. Syspara2.stMotorPara.uwLquH.uwReal = (UWORD)cp_stMotorPara.swLqmH;
  404. Syspara2.stMotorPara.uwFluxmWb.uwReal = (UWORD)cp_stMotorPara.swFluxWb;
  405. Syspara2.stMotorPara.uwIdMaxA.uwReal = (UWORD)cp_stMotorPara.swIdMaxA;
  406. Syspara2.stMotorPara.uwIdMinA.uwReal = (UWORD)cp_stMotorPara.swIdMinA;
  407. Syspara2.stMotorPara.uwRSpdRpm.uwReal = (UWORD)cp_stMotorPara.swRSpeedRpm;
  408. Syspara2.stMotorPara.uwRPwrWt.uwReal = (UWORD)cp_stMotorPara.swRPwrWt;
  409. Syspara2.stMotorPara.uwRCurA.uwReal = (UWORD)cp_stMotorPara.swRIarmsA;
  410. Syspara2.stMotorPara.uwRVolV.uwReal = (UWORD)cp_stMotorPara.swRUdcV;
  411. Syspara2.stMotorPara.uwJD.uwReal = (UWORD)cp_stMotorPara.swJD;
  412. Syspara2.stMotorPara.uwTorMaxNm.uwReal = (UWORD)cp_stMotorPara.swTorMax;
  413. }
  414. Syspara2.stBikePara.swDeltPerimeter.swReal = ass_stParaCong.swDeltPerimeter;
  415. if (MC_UpcInfo.stBikeInfo.uwSaveFlg == TRUE)
  416. {
  417. Syspara2.stBikePara.uwWheelPerimeter.uwReal = ass_stParaCong.uwWheelPerimeter;
  418. Syspara2.stBikePara.uwMechRationMotor.uwReal = ass_stParaCong.uwMechRationMotor;
  419. Syspara2.stBikePara.uwAssistMaxSpdKmH.uwReal = ass_stParaCong.uwAssistMaxSpdKmH;
  420. Syspara2.stBikePara.uwThrottleMaxSpdKmH.uwReal = ass_stParaCong.uwThrottleMaxSpdKmH;
  421. Syspara2.stBikePara.uwNmFrontChainring.uwReal = ass_stParaCong.uwNmFrontChainring;
  422. Syspara2.stBikePara.uwNmBackChainring.uwReal = ass_stParaCong.uwNmBackChainring;
  423. Syspara2.stBikePara.uwAssistSelect1.uwReal = ass_stParaCong.uwAssistSelect1;
  424. Syspara2.stBikePara.uwAssistSelect2.uwReal = ass_stParaCong.uwAssistSelect2;
  425. Syspara2.stBikePara.uwLightVoltage.uwReal = ass_stParaCong.uwLightVoltage;
  426. Syspara2.stBikePara.swDeltPerimeter.swReal = ass_stParaCong.swDeltPerimeter;
  427. Syspara2.stBikePara.uwStartMode.uwReal = ass_stParaCong.uwStartMode;
  428. Syspara2.stBikePara.uwAutoPowerOffTime.uwReal = ass_stParaCong.uwAutoPowerOffTime;
  429. Syspara2.stBikePara.uwThrottleSmooth.uwReal = ass_stParaCong.uwThrottleSmooth;
  430. }
  431. if (MC_UpcInfo.stMContorlInfo.uwSaveFlg == TRUE)
  432. {
  433. Syspara2.stMControlPara.ParaFirstSetFlg.uwReal = cp_stFlg.ParaFirstSetFlg;
  434. Syspara2.stMControlPara.SpiOffsetFirstSetFlg.uwReal = cp_stFlg.SpiOffsetFirstSetFlg;
  435. Syspara2.stMControlPara.uwSPIPosOffsetOrigin.uwReal = spi_stResolverOut.swSpiThetaOffsetOrignPu;
  436. Syspara2.stMControlPara.uwSPIPosOffsetNow.uwReal = spi_stResolverOut.swSpiThetaOffsetPu;
  437. Syspara2.stMControlPara.uwIPeakMaxA.uwReal = (UWORD)cp_stMotorPara.swIpeakMaxA;
  438. Syspara2.stMControlPara.uwAlamOCurA.uwReal = (UWORD)cp_stControlPara.swAlmOverCurrentVal;
  439. Syspara2.stMControlPara.uwAlamOVolV.uwReal = (UWORD)cp_stControlPara.swAlmOverVolVal3;
  440. Syspara2.stMControlPara.uwAlamUVolV.uwReal = (UWORD)cp_stControlPara.swAlmUnderVolVal2;
  441. Syspara2.stMControlPara.uwAlamOverSpdRpm.uwReal = (UWORD)cp_stControlPara.swAlmOverSpdVal;
  442. Syspara2.stMControlPara.uwAlamOverHeatCe.uwReal = (UWORD)cp_stControlPara.swAlmOverHeatCeVal;
  443. Syspara2.stMControlPara.uwAlamRecHeatCe.uwReal = (UWORD)cp_stControlPara.swAlmRecOHeatVal;
  444. Syspara2.stMControlPara.uwPwrLimitStartCe.uwReal = (UWORD)cp_stControlPara.swAlmPwrLimitStartTempVal;
  445. }
  446. if (MC_UpcInfo.stSensorInfo.uwSaveFlg == TRUE)
  447. {
  448. Syspara2.stSensorPara.uwTorSensorOffsetOrigin.uwReal = torsensor_stTorSensorCof.uwTorqueOffsetOrign;
  449. Syspara2.stSensorPara.uwTorSensorOffsetNow1.uwReal = torsensor_stTorSensorCof.uwTorqueOffsetNow1;
  450. Syspara2.stSensorPara.uwTorSensorOffsetNow2.uwReal = torsensor_stTorSensorCof.uwTorqueOffsetNow2;
  451. Syspara2.stSensorPara.uwTorSensorOffsetNow3.uwReal = torsensor_stTorSensorCof.uwTorqueOffsetNow3;
  452. Syspara2.stSensorPara.uwTorSensorOffsetNow4.uwReal = torsensor_stTorSensorCof.uwTorqueOffsetNow4;
  453. Syspara2.stSensorPara.uwBikeTorMaxNm.uwReal = torsensor_stTorSensorCof.uwMaxSensorTorquePu;
  454. Syspara2.stSensorPara.uwBikeTor1StepRealNm.uwReal = torsensor_stTorSensorCof.uwBikeTorStep1RealNm;
  455. Syspara2.stSensorPara.uwBikeTor1StepADC.uwReal = torsensor_stTorSensorCof.uwBikeTorStep1ADC;
  456. Syspara2.stSensorPara.uwBikeTor2StepRealNm.uwReal = torsensor_stTorSensorCof.uwBikeTorStep2RealNm;
  457. Syspara2.stSensorPara.uwBikeTor2StepADC.uwReal = torsensor_stTorSensorCof.uwBikeTorStep2ADC;
  458. Syspara2.stSensorPara.uwBikeTor3StepRealNm.uwReal = torsensor_stTorSensorCof.uwBikeTorStep3RealNm;
  459. Syspara2.stSensorPara.uwBikeTor3StepADC.uwReal = torsensor_stTorSensorCof.uwBikeTorStep3ADC;
  460. Syspara2.stSensorPara.uwBikeTor4StepRealNm.uwReal = torsensor_stTorSensorCof.uwBikeTorStep4RealNm;
  461. Syspara2.stSensorPara.uwBikeTor4StepADC.uwReal = torsensor_stTorSensorCof.uwBikeTorStep4ADC;
  462. Syspara2.stSensorPara.uwCadSensorPulseNm.uwReal = cadence_stFreGetCof.uwNumbersPulses;
  463. Syspara2.stSensorPara.uwBikeSpdSensorPulseNm.uwReal = bikespeed_stFreGetCof.uwNumbersPulses;
  464. }
  465. if (MC_UpcInfo.stAssistInfo.uwSaveFlg == TRUE)
  466. {
  467. Syspara2.stAssistPara.uwStartupGain.uwReal = ass_stParaSet.uwStartupCoef;
  468. Syspara2.stAssistPara.uwStartcruiseGain.uwReal = ass_stParaSet.uwStartupCruiseCoef;
  469. Syspara2.stAssistPara.uwAssistStartNm.uwReal = ass_stParaSet.uwAssistStartNm;
  470. Syspara2.stAssistPara.uwAssistStopNm.uwReal = ass_stParaSet.uwAssistStopNm;
  471. Syspara2.stAssistPara.uwStartUpGainStep.uwReal = ass_stParaSet.uwStartUpGainStep;
  472. Syspara2.stAssistPara.uwStartUpCadNm.uwReal = ass_stParaSet.uwStartUpCadNm;
  473. Syspara2.stAssistPara.uwTorLPFCadNm.uwReal = ass_stParaSet.uwTorLPFCadNm;
  474. Syspara2.stAssistPara.uwSpeedAssistSpdRpm.uwReal = ass_stParaSet.uwSpeedAssistSpdRpm;
  475. Syspara2.stAssistPara.uwSpeedAssistIMaxA.uwReal = ass_stParaSet.uwSpeedAssistIMaxA;
  476. Syspara2.stAssistPara.uwAssistLimitBikeSpdStart.uwReal = ass_stParaSet.uwAssistLimitBikeSpdStart;
  477. Syspara2.stAssistPara.uwAssistLimitBikeSpdStop.uwReal = ass_stParaSet.uwAssistLimitBikeSpdStop;
  478. Syspara2.stAssistPara.uwCadenceAssistWeight.uwReal = ass_stParaSet.uwCadenceWeight;
  479. }
  480. }
  481. /***************************************************************
  482. Function: mn_voSoftwareInit;
  483. Description:software intial
  484. Call by:
  485. Input Variables: N/A
  486. Output/Return Variables: N/A
  487. Subroutine Call: N/A;
  488. Reference: N/A
  489. ****************************************************************/
  490. void mn_voEEHistoryParaUpdate(void)
  491. {
  492. Syspara2.stHistoryPara.uwAssModSelect.uwReal = ass_stParaSet.uwAsssistSelectNum;
  493. Syspara2.stHistoryPara.uwOpenTimes.uwReal = cp_stHistoryPara.uwOpenTimes;
  494. Syspara2.stHistoryPara.uwUsedTimeH.uwReal = (UWORD)(cp_stHistoryPara.ulUsedTime >> 16);
  495. Syspara2.stHistoryPara.uwUsedTimeL.uwReal = (UWORD)cp_stHistoryPara.ulUsedTime;
  496. Syspara2.stHistoryPara.uwNTCTempMaxCe.uwReal = cp_stHistoryPara.uwNTCTempMaxCe;
  497. Syspara2.stHistoryPara.uwNTCTempMinCe.uwReal = cp_stHistoryPara.uwNTCTempMinCe;
  498. Syspara2.stHistoryPara.uwAlamHOcurTimes.uwReal = cp_stHistoryPara.uwAlamHOcurTimes;
  499. Syspara2.stHistoryPara.uwAlamSOcurTimes.uwReal = cp_stHistoryPara.uwAlamSOcurTimes;
  500. Syspara2.stHistoryPara.uwAlamOHeatTimes.uwReal = cp_stHistoryPara.uwAlamOHeatTimes;
  501. Syspara2.stHistoryPara.uwAlamRotorLockTimes.uwReal = cp_stHistoryPara.uwAlamRotorLockTimes;
  502. Syspara2.stHistoryPara.uwAlamPhsLossTimes.uwReal = cp_stHistoryPara.uwAlamPhsLossTimes;
  503. Syspara2.stHistoryPara.uwAlamOVolTimes.uwReal = cp_stHistoryPara.uwAlamOVolTimes;
  504. Syspara2.stHistoryPara.uwAlamUVolTimes.uwReal = cp_stHistoryPara.uwAlamUVolTimes;
  505. Syspara2.stHistoryPara.uwAlamComOTimeTimes.uwReal = cp_stHistoryPara.uwAlamComOTimeTimes;
  506. Syspara2.stHistoryPara.uwG1AvgPwrConsumption.uwReal = cp_stHistoryPara.uwG1AvgPwrConsumption;
  507. Syspara2.stHistoryPara.uwG2AvgPwrConsumption.uwReal = cp_stHistoryPara.uwG2AvgPwrConsumption;
  508. Syspara2.stHistoryPara.uwG3AvgPwrConsumption.uwReal = cp_stHistoryPara.uwG3AvgPwrConsumption;
  509. Syspara2.stHistoryPara.uwG4AvgPwrConsumption.uwReal = cp_stHistoryPara.uwG4AvgPwrConsumption;
  510. Syspara2.stHistoryPara.uwG5AvgPwrConsumption.uwReal = cp_stHistoryPara.uwG5AvgPwrConsumption;
  511. Syspara2.stHistoryPara.uwODOTripH.uwReal = (UWORD)(cp_stHistoryPara.ulODOTrip >> 16);
  512. Syspara2.stHistoryPara.uwODOTripL.uwReal = (UWORD)cp_stHistoryPara.ulODOTrip;
  513. Syspara2.stHistoryPara.uwODOTimeH.uwReal = (UWORD)(cp_stHistoryPara.ulODOTime >> 16);
  514. Syspara2.stHistoryPara.uwODOTimeL.uwReal = (UWORD)cp_stHistoryPara.ulODOTime;
  515. Syspara2.stHistoryPara.uwTripSumH.uwReal = (UWORD)(cp_stHistoryPara.ulTripSum >> 16);
  516. Syspara2.stHistoryPara.uwTripSumL.uwReal = (UWORD)cp_stHistoryPara.ulTripSum;
  517. Syspara2.stHistoryPara.uwTripSumTimeH.uwReal = (UWORD)(cp_stHistoryPara.ulTripSumTime >> 16);
  518. Syspara2.stHistoryPara.uwTripSumTimeL.uwReal = (UWORD)cp_stHistoryPara.ulTripSumTime;
  519. Syspara2.stHistoryPara.uwTorSensorAlamTimes.uwReal = cp_stHistoryPara.uwTorSensorAlamTimes;
  520. Syspara2.stHistoryPara.uwCadSensorAlamTimes.uwReal = cp_stHistoryPara.uwCadSensorAlamTimes;
  521. Syspara2.stHistoryPara.uwBikeSpdSensorAlamTimes.uwReal = cp_stHistoryPara.uwBikeSpdSensorAlamTimes;
  522. Syspara2.stHistoryPara.uwPosSensorAlamTimes.uwReal = cp_stHistoryPara.uwPosSensorAlamTimes;
  523. Syspara2.stHistoryPara.uwRealODOTripH.uwReal = (UWORD)(cp_stHistoryPara.ulRealODOTrip >> 16);
  524. Syspara2.stHistoryPara.uwRealODOTripL.uwReal = (UWORD)cp_stHistoryPara.ulRealODOTrip;
  525. Syspara2.stHistoryPara.uwRealODOTimeH.uwReal = (UWORD)(cp_stHistoryPara.ulRealODOTime >> 16);
  526. Syspara2.stHistoryPara.uwRealODOTimeL.uwReal = (UWORD)cp_stHistoryPara.ulRealODOTime;
  527. }
  528. /***************************************************************
  529. Function: mn_voSoftwareInit;
  530. Description:software intial
  531. Call by:
  532. Input Variables: N/A
  533. Output/Return Variables: N/A
  534. Subroutine Call: N/A;
  535. Reference: N/A
  536. ****************************************************************/
  537. void mn_voSoftwareInit(void)
  538. {
  539. /* System coefficient calculate */
  540. cof_voSysInit();
  541. /* Motor parameter init */
  542. // mn_voMtParInit();
  543. /* Control Parameters init */
  544. mn_voMcParInit();
  545. /*cmd handle Initial */
  546. cmd_voCmdInit();
  547. /* FSM init */
  548. FSM_voInit();
  549. RUN_FSM_voInit();
  550. Switch_speed_FSMInit();
  551. /* TempInit */
  552. TempInit();
  553. /* CANInit */
  554. Can_voInitMC_Run();
  555. /* Alarm init */
  556. alm_voInit();
  557. alm_voCoef();
  558. /* ADC init */
  559. adc_voSampleInit();
  560. adc_voSampleCoef(&adc_stCof);
  561. /* UART init */
  562. uart_voMonitorInit();
  563. }
  564. /************************************************************************
  565. Function: void mn_voMtParInit(void)
  566. Description:
  567. Call by:
  568. Input Variables:
  569. Output/Return Variables:
  570. Subroutine Call:
  571. Reference:
  572. ************************************************************************/
  573. void mn_voMtParInit(void)
  574. {
  575. mn_swIdTurn1Pu = (SWORD)(((SLONG)M_LD_TURN1_ID_AP << 14) / (SWORD)cof_uwIbAp); // Q14, saturation current of Ld
  576. mn_slLdTurn1Pu = ((SLONG)M_LD_TURN1_LD_MH << 10) / cof_uwLbHm; // Q10, saturation inductance of Ld
  577. mn_swIdTurn2Pu = (SWORD)(((SLONG)M_LD_TURN2_ID_AP << 14) / (SWORD)cof_uwIbAp); // Q14, saturation current of Ld
  578. mn_slLdTurn2Pu = ((SLONG)M_LD_TURN2_LD_MH << 10) / cof_uwLbHm; // Q10, saturation inductance of Ld
  579. if (mn_swIdTurn1Pu == mn_swIdTurn2Pu)
  580. {
  581. mn_swKLdSat = 0;
  582. }
  583. else
  584. {
  585. mn_swKLdSat = (SWORD)(((mn_slLdTurn2Pu - mn_slLdTurn1Pu) << 10) / (mn_swIdTurn2Pu - mn_swIdTurn1Pu)); // Q10
  586. }
  587. mn_swIqTurn1Pu = (SWORD)(((SLONG)M_LQ_TURN1_IQ_AP << 14) / (SWORD)cof_uwIbAp); // Q14, saturation current of Lq
  588. mn_slLqTurn1Pu = ((SLONG)M_LQ_TURN1_LQ_MH << 10) / cof_uwLbHm; // Q10, saturation inductance of Lq
  589. mn_swIqTurn2Pu = (SWORD)(((SLONG)M_LQ_TURN2_IQ_AP << 14) / (SWORD)cof_uwIbAp); // Q14, saturation current of Lq
  590. mn_slLqTurn2Pu = ((SLONG)M_LQ_TURN2_LQ_MH << 10) / cof_uwLbHm; // Q10, saturation inductance of Lq
  591. if (mn_swIqTurn1Pu == mn_swIqTurn2Pu)
  592. {
  593. mn_swKLqSat = 0;
  594. }
  595. else
  596. {
  597. mn_swKLqSat = (SWORD)(((mn_slLqTurn2Pu - mn_slLqTurn1Pu) << 10) / (mn_swIqTurn2Pu - mn_swIqTurn1Pu)); // Q10
  598. }
  599. }
  600. /************************************************************************
  601. Function: void mn_voMcParInit(void)
  602. Description:
  603. Call by:
  604. Input Variables:
  605. Output/Return Variables:
  606. Subroutine Call:
  607. Reference:
  608. ************************************************************************/
  609. void mn_voMcParInit(void)
  610. {
  611. align_voInit();
  612. // Align Parameters
  613. mn_uwAlignCurPu = (UWORD)CUR_AP2PU(cp_stControlPara.swAlignCurAp); // Q14
  614. mn_ulAlignRampTbcCt = TBC_MS2CT(cp_stControlPara.swAlignRampTMms);
  615. mn_ulAlignHoldTbcCt = TBC_MS2CT(cp_stControlPara.swAlignHoldTMms);
  616. if (mn_ulAlignRampTbcCt == 0)
  617. {
  618. mn_ulAlignCurIncPerTbcPu = 1;
  619. }
  620. else
  621. {
  622. mn_ulAlignCurIncPerTbcPu = ((ULONG)mn_uwAlignCurPu << 15) / mn_ulAlignRampTbcCt; // Q29
  623. if (mn_ulAlignCurIncPerTbcPu == 0)
  624. {
  625. mn_ulAlignCurIncPerTbcPu = 1;
  626. }
  627. }
  628. mn_slAlignAngInit = ANG_DEG2PU(cp_stControlPara.swAlignAngInitDeg);
  629. // Open Drag Parameters
  630. mn_uwDragCurPu = (UWORD)CUR_AP2PU(cp_stControlPara.swDragCurAp); // Q14
  631. mn_swDragSpdPu = (SWORD)SPD_HZ2PU(cp_stControlPara.swDragSpdHz); // Q15
  632. mn_ulDragSpdRampTbcCt = TBC_MS2CT(cp_stControlPara.swDragSpdRampTMms);
  633. if (mn_ulDragSpdRampTbcCt == 0)
  634. {
  635. mn_ulDragSpdIncPerTbcPu = 1;
  636. }
  637. else
  638. {
  639. mn_ulDragSpdIncPerTbcPu = ((ULONG)mn_swDragSpdPu << 14) / mn_ulDragSpdRampTbcCt; // Q29
  640. if (mn_ulDragSpdIncPerTbcPu == 0)
  641. {
  642. mn_ulDragSpdIncPerTbcPu = 1;
  643. }
  644. }
  645. // Open to Close Parameters
  646. mn_ulOpen2ClzCurRampTbcCt = TBC_MS2CT(cp_stControlPara.swOpen2ClzRampTMms);
  647. if (mn_ulOpen2ClzCurRampTbcCt == 0)
  648. {
  649. mn_ulOpen2ClzCurIncPerTbcPu = 1;
  650. }
  651. else
  652. {
  653. mn_ulOpen2ClzCurIncPerTbcPu = (ULONG)mn_uwDragCurPu / mn_ulOpen2ClzCurRampTbcCt;
  654. if (mn_ulOpen2ClzCurIncPerTbcPu == 0)
  655. {
  656. mn_ulOpen2ClzCurIncPerTbcPu = 1;
  657. }
  658. }
  659. // Stop Parameters
  660. mn_swStopSpdRefPu = (SWORD)SPD_RPM2PU(cp_stControlPara.swStopSpdRefRpm);
  661. }
  662. /***************************************************************
  663. Function: mn_voIPMSeletion;
  664. Description:software intial
  665. Call by:
  666. Input Variables: N/A
  667. Output/Return Variables: N/A
  668. Subroutine Call: N/A;
  669. Reference: N/A
  670. ****************************************************************/
  671. // void mn_voIPMSelection(void)
  672. // {
  673. // //Dead band time and Turn on/off time
  674. // hw_uwPwmDeadBandTmNs = cp_stControlPara.swIPMDeadTimeNs;
  675. // mn_uwIpmDeadBandTmNs = cp_stControlPara.swIPMDeadTimeNs;
  676. // mn_uwIpmTurnOnTmNs = cp_stControlPara.swIPMTurnOnNs;
  677. // mn_uwIpmTurnOffTmNs = cp_stControlPara.swIPMTurnOffNs;
  678. // //HVIC charge parameters
  679. // mn_ulHvicChrgTmTbcCt = EVENT1MS_MS2CT(cp_stControlPara.swIPMHvicChrgMs);
  680. // //Max duty cyle
  681. // mn_uwPwmMaxDutyCyle = cp_stControlPara.swPWMMaxDuty;
  682. // mn_uwPwm7SvmTo5SvmDuty = cp_stControlPara.swPWM7to5Duty;
  683. // mn_uwPWMMinSample1Pu = cp_stControlPara.swPWMMinSampleDuty1;
  684. // mn_uwPWMMinSample2Pu = cp_stControlPara.swPWMMinSampleDuty2;
  685. // mn_uwFlxMaxDutyCyle = cp_stControlPara.swFwPWMMaxDuty;
  686. // //Current sample parameters
  687. // pwm_sw1stCurSmplCt = cp_stControlPara.swPWM1STSampleCnt;
  688. // pwm_sw2ndCurSmplCt = cp_stControlPara.swPWM2NDSampleCnt;
  689. // pwm_swMinDoubleCurSmplPu = (cp_stControlPara.swPWMMinEffVectorPu << 1);
  690. // pwm_swMinCurSmplCt = cp_stControlPara.swPWMMinEffVectorCnt;
  691. // pwm_swMinCurSmplPu = cp_stControlPara.swPWMMinEffVectorPu;
  692. // }
  693. /*************************************************************************
  694. Copyright (c) 2018 Welling Motor Technology(Shanghai) Co. Ltd.
  695. All rights reserved.
  696. *************************************************************************/
  697. #ifdef _MAIN_C_
  698. #undef _MAIN_C_ /* parasoft-suppress MISRA2004-19_6 "本项目无法更改,后续避免使用" */
  699. #endif
  700. /*************************************************************************
  701. End of this File (EOF)!
  702. Do not put anything after this part!
  703. *************************************************************************/