main.c 60 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108
  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 "CadAssist.h"
  26. #include "bikeinformation.h"
  27. #include "FSM_1st.h"
  28. #include "FSM_2nd.h"
  29. #include "FuncLayerAPI.h"
  30. #include "usart.h"
  31. #include "cmdgennew.h"
  32. #include "canAppl.h"
  33. #include "flash_master.h"
  34. #include "string.h"
  35. #include "tmag5273.h"
  36. //#include "at32f421_wk_config.h"
  37. //#include "SEGGER_RTT.h"
  38. #include "UserGpio_Config.h"
  39. //#include "api_rt.h"
  40. //#include "profiler.h"
  41. #include "ti_msp_dl_config.h"
  42. /************************************************************************
  43. Exported Functions:
  44. ************************************************************************/
  45. void AppInit();
  46. void AppLoop();
  47. void LED_ResDispaly(void);
  48. //void delay_125us(void);
  49. void delay_125us(int count)
  50. {
  51. for(int i=0;i<count;i++)
  52. {
  53. delay_cycles(10000);
  54. }
  55. }
  56. /* This results in approximately 0.25s of delay assuming 80MHz CPU_CLK */
  57. #define DELAY (40000000)
  58. unsigned int ACnt; // Variable: speed control period counter
  59. /***************************************************************
  60. Function: main;
  61. Description:main function
  62. Call by:
  63. Input Variables: N/A
  64. Output/Return Variables: N/A
  65. Subroutine Call: N/A;
  66. Reference: N/A
  67. ****************************************************************/
  68. /*
  69. * Timer clock configuration to be sourced by / 1 (72000000 Hz)
  70. * timerClkFreq = (timerClkSrc / (timerClkDivRatio * (timerClkPrescale + 1)))
  71. * 72000000 Hz = 72000000 Hz / (1 * (0 + 1))
  72. */
  73. static const DL_TimerA_ClockConfig gPWM_0_COPYClockConfig = {
  74. .clockSel = DL_TIMER_CLOCK_BUSCLK,
  75. .divideRatio = DL_TIMER_CLOCK_DIVIDE_1,
  76. .prescale = 0U
  77. };
  78. static const DL_TimerA_PWMConfig gPWM_0_COPYConfig = {
  79. .pwmMode = DL_TIMER_PWM_MODE_CENTER_ALIGN,
  80. .period = 4500,
  81. .isTimerWithFourCC = false,
  82. .startTimer = DL_TIMER_STOP,
  83. };
  84. SYSCONFIG_WEAK void SYSCFG_DL_PWM_0_COPY_init(void) {
  85. DL_TimerA_reset(TIMA1);
  86. DL_TimerA_enablePower(TIMA1);
  87. delay_cycles(POWER_STARTUP_DELAY);
  88. DL_TimerA_setClockConfig(
  89. TIMA1, (DL_TimerA_ClockConfig *) &gPWM_0_COPYClockConfig);
  90. DL_TimerA_initPWMMode(
  91. TIMA1, (DL_TimerA_PWMConfig *) &gPWM_0_COPYConfig);
  92. DL_TimerA_setCaptureCompareOutCtl(TIMA1, DL_TIMER_CC_OCTL_INIT_VAL_LOW,
  93. DL_TIMER_CC_OCTL_INV_OUT_DISABLED, DL_TIMER_CC_OCTL_SRC_FUNCVAL,
  94. DL_TIMERA_CAPTURE_COMPARE_0_INDEX);
  95. DL_TimerA_setCaptCompUpdateMethod(TIMA1, DL_TIMER_CC_UPDATE_METHOD_IMMEDIATE, DL_TIMERA_CAPTURE_COMPARE_0_INDEX);
  96. DL_TimerA_setCaptureCompareValue(TIMA1, 2250, DL_TIMER_CC_0_INDEX);
  97. DL_TimerA_enableClock(TIMA1);
  98. DL_TimerA_enableInterrupt(TIMA1 , DL_TIMER_INTERRUPT_LOAD_EVENT |
  99. DL_TIMER_INTERRUPT_ZERO_EVENT);
  100. NVIC_SetPriority(TIMA1_INT_IRQn, 2);
  101. DL_TimerA_setCCPDirection(TIMA1 , DL_TIMER_CC0_OUTPUT );
  102. /* DL_TIMER_CROSS_TRIG_SRC is a Don't Care field when Cross Trigger Source is set to Software */
  103. DL_TimerA_configCrossTrigger(TIMA1, DL_TIMER_CROSS_TRIG_SRC_FSUB0,
  104. DL_TIMER_CROSS_TRIGGER_INPUT_DISABLED, DL_TIMER_CROSS_TRIGGER_MODE_ENABLED
  105. );
  106. DL_TimerA_setCaptureCompareInput(TIMA1, DL_TIMER_CC_INPUT_INV_NOINVERT, DL_TIMER_CC_IN_SEL_TRIG, DL_TIMER_CC_0_INDEX);
  107. /*
  108. * Determines the external triggering event to trigger the module (self-triggered in main configuration)
  109. * and triggered by specific timer in secondary configuration
  110. */
  111. DL_TimerA_setExternalTriggerEvent(TIMA1,DL_TIMER_EXT_TRIG_SEL_TRIG_1);
  112. DL_TimerA_enableExternalTrigger(TIMA1);
  113. uint32_t temp;
  114. temp = DL_TimerA_getCaptureCompareCtl(TIMA1, DL_TIMER_CC_0_INDEX);
  115. DL_TimerA_setCaptureCompareCtl(TIMA1, DL_TIMER_CC_MODE_COMPARE, temp | (uint32_t) DL_TIMER_CC_LCOND_TRIG_RISE, DL_TIMER_CC_0_INDEX);
  116. }
  117. int main(void)
  118. {
  119. SCB->VTOR =APP_START_Address;//
  120. /* Disable all interrupts */
  121. DISABLE_IRQ;
  122. /* MCU Core and GPIO configuration */
  123. SYSCFG_DL_init();
  124. SYSCFG_DL_PWM_0_COPY_init();
  125. Reset_POWER_LOCK_PORT();
  126. tmag5273_Init();
  127. //TIMA0 MOTOR_PWM
  128. DL_Timer_setCaptCompUpdateMethod(MOTOR_PWM_INST,DL_TIMER_CC_UPDATE_METHOD_ZERO_EVT,DL_TIMERA_CAPTURE_COMPARE_0_INDEX);
  129. DL_Timer_setCaptCompUpdateMethod(MOTOR_PWM_INST,DL_TIMER_CC_UPDATE_METHOD_ZERO_EVT,DL_TIMERA_CAPTURE_COMPARE_1_INDEX);
  130. DL_Timer_setCaptCompUpdateMethod(MOTOR_PWM_INST,DL_TIMER_CC_UPDATE_METHOD_ZERO_EVT,DL_TIMERA_CAPTURE_COMPARE_2_INDEX);
  131. NVIC_EnableIRQ(ADC12_0_INST_INT_IRQN);
  132. //DL_Timer_setCaptCompUpdateMethod(PWM_F_INST,DL_TIMER_CC_UPDATE_METHOD_ZERO_EVT,DL_TIMER_CC_1_INDEX);
  133. NVIC_EnableIRQ(HALLTIMER_INST_INT_IRQN); //
  134. DL_TimerA_setCaptureCompareValue(MOTOR_PWM_INST, 0, DL_TIMER_CC_0_INDEX);
  135. DL_TimerA_setCaptureCompareValue(MOTOR_PWM_INST, 0, DL_TIMER_CC_1_INDEX);
  136. DL_TimerA_setCaptureCompareValue(MOTOR_PWM_INST, 0, DL_TIMER_CC_2_INDEX);
  137. DL_Timer_clearInterruptStatus(MOTOR_PWM_INST,DL_TIMER_INTERRUPT_FAULT_EVENT|DL_TIMER_INTERRUPT_ZERO_EVENT);
  138. DL_Timer_clearEventsStatus(MOTOR_PWM_INST,1,DL_TIMER_EVENT_FAULT_EVENT);
  139. DL_TimerA_setCaptureCompareValue(MOTOR_PWM_INST,2, DL_TIMER_CC_4_INDEX);
  140. //HALL IO
  141. NVIC_EnableIRQ(GPIOA_INT_IRQn); //HALL GPIO
  142. NVIC_EnableIRQ(GPIOB_INT_IRQn); //HALL GPIO
  143. #if(EMCDEAL_EN!=0) //霍尔定时换相计时中断
  144. NVIC_EnableIRQ(HALL_CNT_INST_INT_IRQN);
  145. DL_TimerG_startCounter(HALL_CNT_INST);
  146. #endif
  147. //LED 前灯比较器
  148. // NVIC_EnableIRQ(COMP_FLEDCHECK_INST_INT_IRQN);
  149. // DL_COMP_enable(COMP_FLEDCHECK_INST);
  150. // over Cur CMP
  151. // DL_COMP_enable(COMP_0_INST);
  152. // NVIC_EnableIRQ(COMP_0_INST_INT_IRQN);
  153. //Start MOTOR 计数
  154. DL_TimerA_startCounter(MOTOR_PWM_INST);
  155. // DL_TimerA_startCounter(TIMER_0_INST);
  156. DL_TimerA_generateCrossTrigger(TIMA1);
  157. NVIC_EnableIRQ(TIMA1_INT_IRQn); //MOTOR PWM
  158. // DL_Timer_setCoreHaltBehavior(TIMA0,DL_TIMER_CORE_HALT_IMMEDIATE);
  159. NVIC_EnableIRQ(MOTOR_PWM_INST_INT_IRQN); //MOTOR PWM
  160. //LED pwm 开始计数
  161. // DL_TimerG_startCounter(TIMG12);
  162. // DL_TimerG_startCounter(PWM_R_INST);
  163. DL_TimerG_startCounter(PWM_F_INST);
  164. // DL_TimerG_startCounter(PWM_B_L_INST);
  165. // DL_GPIO_clearPins(OUTPUT_CAN_STB_PORT, OUTPUT_CAN_STB_PIN);
  166. // DL_GPIO_setPins(OUTPUT_CAN_STB_PORT, OUTPUT_CAN_STB_PIN);
  167. // DL_GPIO_togglePins(OUTPUT_CAN_STB_PORT, OUTPUT_CAN_STB_PIN);
  168. //
  169. // /* Set output voltage:
  170. // * DAC value (12-bits) = DesiredOutputVoltage x 4095
  171. // * -----------------------
  172. // * ReferenceVoltage
  173. //---over Cur of Valut
  174. #if((IPM_POWER_SEL == IPM_POWER_250W_6G) ||(IPM_POWER_SEL ==IPM_POWER_350W_6G))
  175. DL_COMP_setDACCode0(COMP_0_INST, 0xb5);//12G-100A-0x99-1.97V 6G-70A--0xb5-2.33V
  176. #else
  177. DL_COMP_setDACCode0(COMP_0_INST, 0x99);//12G-100A-0x99-1.97V 6G-60A--0xb5-2.33V
  178. #endif
  179. // hw_voHardwareSetup1();
  180. /* Api Init*/
  181. /* Api App Init*/
  182. AppInit();
  183. /* Peripheral configuration */
  184. hw_voHardwareSetup2();
  185. /* Timer enable */
  186. hw_voTimEn();
  187. /* Interrupts of peripherals enable*/
  188. hw_voEnInt();
  189. /* self test init */
  190. //stl_voRunTimeChecksInit();
  191. /* watchdog 1s */
  192. // wk_wdt_init();// hw_voIWDGInit(IWDG_Prescaler_32,2500);//1s 看门狗
  193. // que_voInit(&stFlashErrorLog);
  194. /* Error Log Read */
  195. // flash_voErrorRead();
  196. /* Enable all interrupts */
  197. NVIC_ClearPendingIRQ(UART_HMI_INST_INT_IRQN);
  198. NVIC_EnableIRQ(UART_HMI_INST_INT_IRQN);
  199. NVIC_ClearPendingIRQ(MCAN0_INST_INT_IRQN);
  200. NVIC_EnableIRQ(MCAN0_INST_INT_IRQN);
  201. ENABLE_IRQ;
  202. // DL_GPIO_setPins(LED_PORT, LED_LED1_PIN);
  203. // DL_GPIO_setPins(LED_PORT, LED_LED2_PIN);
  204. // delay_cycles(DELAY);
  205. // delay_cycles(DELAY);
  206. // delay_cycles(DELAY);
  207. // delay_cycles(DELAY);
  208. // delay_cycles(DELAY);
  209. // delay_cycles(DELAY);
  210. // delay_cycles(DELAY);
  211. // delay_cycles(DELAY);
  212. // delay_cycles(DELAY);
  213. // delay_cycles(DELAY);
  214. // tmag5273_Init();
  215. /* Enter infinite loop */
  216. #if(JSCOPE_EN!=0)
  217. Jscope_Init();
  218. #endif
  219. #if(EMCDEAL_EN!=0)
  220. // LED_ResDispaly();
  221. #endif
  222. // flash_voSysParaWrite();
  223. uwFlash_IRQ_Enble=1;
  224. // hw_voPWMOn();
  225. // DL_TimerG_setCaptureCompareValue(PWM_B_INST, 1000, GPIO_PWM_B_C1_IDX);
  226. while (1)
  227. {
  228. // DL_GPIO_togglePins(LED_PORT, LED_LED1_PIN);
  229. // DL_GPIO_togglePins(LED_PORT, LED_LED2_PIN);
  230. // DL_GPIO_togglePins(GPIO_B_LED_PORT, GPIO_B_LED_PIN_LED_B_EN_PIN);
  231. AppLoop();
  232. // PROFILER_BG();
  233. ACnt++;
  234. // Tempe = tmag5273_GetTemp();
  235. // DL_GPIO_setPins(GPIO_B_LED_PORT, GPIO_B_LED_PIN_LED_B_EN_PIN);
  236. Tmag5273_out.Angle = tmag5273_GetAngle();
  237. // Tmag5273_out.MagX = tmag5273_GetXData();
  238. // Tmag5273_out.MagY = tmag5273_GetYData();
  239. // Tmag5273_out.MagZ = tmag5273_GetZData();
  240. // Tmag5273_out.Temp = tmag5273_GetTemp();
  241. // DL_GPIO_clearPins(GPIO_B_LED_PORT, GPIO_B_LED_PIN_LED_B_EN_PIN);
  242. // MagX = tmag5273_GetXData();
  243. // MagY = tmag5273_GetYData();
  244. // MagZ = tmag5273_GetZData();
  245. // delay_cycles(DELAY);
  246. // DL_TimerA_setCaptureCompareValue(MOTOR_PWM_INST, 1875, DL_TIMER_CC_0_INDEX);
  247. // DL_TimerA_setCaptureCompareValue(MOTOR_PWM_INST, 1250, DL_TIMER_CC_2_INDEX);
  248. // DL_TimerA_setCaptureCompareValue(MOTOR_PWM_INST, 625, DL_TIMER_CC_3_INDEX);
  249. //
  250. // DL_TimerG_setCaptureCompareValue(LED_PWM_INST, 100, DL_TIMER_CC_0_INDEX);
  251. // DL_TimerG_setCaptureCompareValue(LED_PWM_INST, 100, DL_TIMER_CC_1_INDEX);
  252. }
  253. }
  254. /***************************************************************
  255. Function: mn_voParaSet;
  256. Description:software intial
  257. Call by:
  258. Input Variables: N/A
  259. Output/Return Variables: N/A
  260. Subroutine Call: N/A;
  261. Reference: N/A
  262. ****************************************************************/
  263. void mn_voParaSet(void)
  264. {
  265. flash_voSysParaRead();//i2c_voSysparaReadFromEE(&i2c_stRXCRCOut);
  266. flash_voErrorRead();
  267. flash_HistoryRead();
  268. flash_voProductParaRead();
  269. //flash_voMosResParaRead();
  270. i2c_stRXCRCOut.ReadFinishFlg = TRUE;
  271. if (i2c_stRXCRCOut.blHistoryParaFltFlg == FALSE)
  272. {
  273. ass_ParaSet.uwAsssistSelectNum =stHistoryPara.uwAssModSelect.uwReal; // I2C_uwHistoryParaRead[0];
  274. cp_stHistoryPara.uwOpenTimes = stHistoryPara.uwOpenTimes.uwReal ;//I2C_uwHistoryParaRead[1];
  275. cp_stHistoryPara.ulUsedTime =(((ULONG)stHistoryPara.uwUsedTimeH.uwReal)<<16) + stHistoryPara.uwUsedTimeL.uwReal ;// (((ULONG)I2C_uwHistoryParaRead[2]) << 16) + I2C_uwHistoryParaRead[3];
  276. cp_stHistoryPara.swNTCTempMaxCe = stHistoryPara.swNTCTempMaxCe.swReal ;//I2C_uwHistoryParaRead[4];
  277. cp_stHistoryPara.swNTCTempMinCe = stHistoryPara.swNTCTempMinCe.swReal ;//I2C_uwHistoryParaRead[5];
  278. cp_stHistoryPara.uwAlamHOcurTimes =stHistoryPara.uwAlamHOcurTimes.uwReal ;// I2C_uwHistoryParaRead[6];
  279. cp_stHistoryPara.uwAlamSOcurTimes =stHistoryPara.uwAlamSOcurTimes.uwReal ;// I2C_uwHistoryParaRead[7];
  280. cp_stHistoryPara.uwAlamOHeatTimes = stHistoryPara.uwAlamOHeatTimes.uwReal ;//I2C_uwHistoryParaRead[8];
  281. cp_stHistoryPara.uwAlamRotorLockTimes =stHistoryPara.uwAlamRotorLockTimes.uwReal ;// I2C_uwHistoryParaRead[9];
  282. cp_stHistoryPara.uwAlamPhsLossTimes =stHistoryPara.uwAlamPhsLossTimes.uwReal ;// I2C_uwHistoryParaRead[10];
  283. cp_stHistoryPara.uwAlamOVolTimes =stHistoryPara.uwAlamOVolTimes.uwReal ;// I2C_uwHistoryParaRead[11];
  284. cp_stHistoryPara.uwAlamUVolTimes = stHistoryPara.uwAlamUVolTimes.uwReal ;//I2C_uwHistoryParaRead[12];
  285. cp_stHistoryPara.uwAlamComOTimeTimes =stHistoryPara.uwAlamComOTimeTimes.uwReal ;// I2C_uwHistoryParaRead[13];
  286. cp_stHistoryPara.uwG1AvgPwrConsumption =stHistoryPara.uwG1AvgPwrConsumption.uwReal ;// I2C_uwHistoryParaRead[14];
  287. cp_stHistoryPara.uwG2AvgPwrConsumption =stHistoryPara.uwG2AvgPwrConsumption.uwReal ;// I2C_uwHistoryParaRead[15];
  288. cp_stHistoryPara.uwG3AvgPwrConsumption =stHistoryPara.uwG3AvgPwrConsumption.uwReal ;// I2C_uwHistoryParaRead[16];
  289. cp_stHistoryPara.uwG4AvgPwrConsumption =stHistoryPara.uwG4AvgPwrConsumption.uwReal ;// I2C_uwHistoryParaRead[17];
  290. cp_stHistoryPara.uwG5AvgPwrConsumption =stHistoryPara.uwG5AvgPwrConsumption.uwReal ;// I2C_uwHistoryParaRead[18];
  291. cp_stHistoryPara.ulODOTrip =(((ULONG)stHistoryPara.uwODOTripH.uwReal)<<16) + stHistoryPara.uwODOTripL.uwReal ;// (((ULONG)I2C_uwHistoryParaRead[19]) << 16) + I2C_uwHistoryParaRead[20];
  292. cp_stHistoryPara.ulODOTime =(((ULONG)stHistoryPara.uwODOTimeH.uwReal)<<16) +stHistoryPara.uwODOTimeL.uwReal ;// (((ULONG)I2C_uwHistoryParaRead[21]) << 16) + I2C_uwHistoryParaRead[22];
  293. cp_stHistoryPara.ulTripSum =(((ULONG)stHistoryPara.uwTripSumH.uwReal)<<16) +stHistoryPara.uwTripSumL.uwReal ;// (((ULONG)I2C_uwHistoryParaRead[23]) << 16) + I2C_uwHistoryParaRead[24];
  294. cp_stHistoryPara.ulTripSumTime =(((ULONG)stHistoryPara.uwTripSumTimeH.uwReal)<<16) +stHistoryPara.uwTripSumTimeL.uwReal ;// (((ULONG)I2C_uwHistoryParaRead[25]) << 16) + I2C_uwHistoryParaRead[26];
  295. cp_stHistoryPara.uwTorSensorAlamTimes =stHistoryPara.uwTorSensorAlamTimes.uwReal ;// I2C_uwHistoryParaRead[27];
  296. cp_stHistoryPara.uwCadSensorAlamTimes =stHistoryPara.uwCadSensorAlamTimes.uwReal ;// I2C_uwHistoryParaRead[28];
  297. cp_stHistoryPara.uwBikeSpdSensorAlamTimes = stHistoryPara.uwBikeSpdSensorAlamTimes.uwReal ;//I2C_uwHistoryParaRead[29];
  298. cp_stHistoryPara.uwPosSensorAlamTimes =stHistoryPara.uwPosSensorAlamTimes.uwReal ;// I2C_uwHistoryParaRead[30];
  299. cp_stHistoryPara.ulRealODOTrip =(((ULONG) stHistoryPara.uwRealODOTripH.uwReal)<<16) + stHistoryPara.uwRealODOTripL.uwReal; //(((ULONG)I2C_uwHistoryParaRead[31]) << 16) + I2C_uwHistoryParaRead[32];
  300. cp_stHistoryPara.ulRealODOTime =(((ULONG) stHistoryPara.uwRealODOTimeH.uwReal )<<16) + stHistoryPara.uwRealODOTimeL.uwReal ; // (((ULONG)I2C_uwHistoryParaRead[33]) << 16) + I2C_uwHistoryParaRead[34];
  301. }
  302. else
  303. {}
  304. // peripheral Para Set
  305. cadence_stFreGetCof.uwTorque_NumbersPulses = TORQUE_NUMBERS_PULSES;
  306. cadence_stFreGetCof.uwCad_NumbersPulses = CADENCE_NUMBERS_PULSES;
  307. bikespeed_stFreGetCof.uwNumbersPulses = BIKESPEED_NUMBERS_PULSES;
  308. torsensor_stTorSensorCof.uwMaxSensorTorquePu = ((ULONG)TORQUE_MAX_RANGE << 14) / TORQUEBASE; // Q14
  309. /////////////////////////////////
  310. if (cp_stFlg.ParaUseEEFlg == TRUE)
  311. {
  312. if (i2c_stRXCRCOut.ReadFinishFlg == TRUE)
  313. {
  314. if (i2c_stRXCRCOut.blMotorParaFltFlg == FALSE)
  315. {
  316. cp_stMotorPara.swMotrPolePairs =Syspara2.stMotorPara.uwPolePairs.uwReal;// I2C_uwMotorParaRead[0];
  317. cp_stMotorPara.swRsOhm =Syspara2.stMotorPara.uwRsmOhm.uwReal; // I2C_uwMotorParaRead[1];
  318. cp_stMotorPara.uwLdmH = Syspara2.stMotorPara.uwLduH.uwReal ;//I2C_uwMotorParaRead[2];
  319. cp_stMotorPara.uwLqmH = Syspara2.stMotorPara.uwLquH.uwReal ;//I2C_uwMotorParaRead[3];
  320. cp_stMotorPara.swFluxWb = Syspara2.stMotorPara.uwFluxmWb.uwReal ;//I2C_uwMotorParaRead[4];
  321. cp_stMotorPara.swIdMaxA = Syspara2.stMotorPara.uwIdMaxA.uwReal ;//I2C_uwMotorParaRead[5];
  322. cp_stMotorPara.swIdMinA =Syspara2.stMotorPara.uwIdMinA.uwReal ;// I2C_uwMotorParaRead[6];
  323. cp_stMotorPara.swRSpeedRpm = Syspara2.stMotorPara.uwRSpdRpm.uwReal ;//I2C_uwMotorParaRead[7];
  324. cp_stMotorPara.uwRPwrWt = Syspara2.stMotorPara.uwRPwrWt.uwReal ;//I2C_uwMotorParaRead[8];
  325. cp_stMotorPara.swRIarmsA =Syspara2.stMotorPara.uwRCurA.uwReal ;// I2C_uwMotorParaRead[9];
  326. cp_stMotorPara.swRUdcV = Syspara2.stMotorPara.uwRVolV.uwReal ;//I2C_uwMotorParaRead[10];
  327. cp_stMotorPara.swJD = Syspara2.stMotorPara.uwJD.uwReal ;//I2C_uwMotorParaRead[11];
  328. cp_stMotorPara.swTorMax = Syspara2.stMotorPara.uwTorMaxNm.uwReal ;//I2C_uwMotorParaRead[12];
  329. }
  330. else
  331. {}
  332. if (i2c_stRXCRCOut.blBikeParaFltFlg == FALSE)
  333. {
  334. ass_ParaCong.uwWheelPerimeter =Syspara2.stBikePara.uwWheelPerimeter.uwReal ;// I2C_uwBikeParaRead[0];
  335. ass_ParaCong.swDeltPerimeter = Syspara2.stBikePara.swDeltPerimeter.swReal ;//I2C_uwBikeParaRead[1];
  336. ass_ParaCong.uwMechRationMotorEEPROM=Syspara2.stBikePara.uwMechRationMotor.uwReal;
  337. ass_ParaCong.uwMechRationMotor = (UWORD)(((ULONG)ass_ParaCong.uwMechRationMotorEEPROM*1024)/1000);//(UWORD)(((ULONG)I2C_uwBikeParaRead[2]*1024)/1000);
  338. ass_ParaCong.uwThrottleMaxSpdKmH =Syspara2.stBikePara.uwThrottleMaxSpdKmH.uwReal ;// I2C_uwBikeParaRead[3];
  339. ass_ParaCong.uwCartSpdKmH =Syspara2.stBikePara.uwCartSpdKmH.uwReal ;// I2C_uwBikeParaRead[4];
  340. ass_ParaCong.uwNmFrontChainring =Syspara2.stBikePara.uwNmFrontChainring.uwReal ;// I2C_uwBikeParaRead[5];
  341. ass_ParaCong.uwNmBackChainring =Syspara2.stBikePara.uwNmBackChainring.uwReal ;// I2C_uwBikeParaRead[6];
  342. ass_ParaCong.uwAssistSelect1 =Syspara2.stBikePara.uwAssistSelect1.uwReal ;// I2C_uwBikeParaRead[7];
  343. ass_ParaCong.uwAssistSelect2 =Syspara2.stBikePara.uwAssistSelect2.uwReal ;// I2C_uwBikeParaRead[8];
  344. ass_ParaCong.uwLightConfig =Syspara2.stBikePara.uwLightConfig.uwReal ;// I2C_uwBikeParaRead[9];
  345. ass_ParaCong.uwStartMode =Syspara2.stBikePara.uwStartMode.uwReal ;// I2C_uwBikeParaRead[10];
  346. ass_ParaCong.uwAutoPowerOffTime =Syspara2.stBikePara.uwAutoPowerOffTime.uwReal ;// I2C_uwBikeParaRead[11];
  347. }
  348. else
  349. {}
  350. if (i2c_stRXCRCOut.blMControlParaFltFlg == FALSE)
  351. {
  352. cp_stFlg.ParaFirstSetFlg =Syspara2.stMControlPara.ParaFirstSetFlg.uwReal ;// I2C_uwMControlRead[0];
  353. // cp_stFlg.SpiOffsetFirstSetFlg =Syspara2.stMControlPara.SpiOffsetFirstSetFlg ;// I2C_uwMControlRead[1];
  354. // spi_stResolverOut.swSpiThetaOffsetOrignPu =Syspara2.stMControlPara.uwSPIPosOffsetOrigin ;// I2C_uwMControlRead[2];
  355. // spi_stResolverOut.swSpiThetaOffsetPu =Syspara2.stMControlPara.uwSPIPosOffsetNow ;// I2C_uwMControlRead[3];
  356. cp_stMotorPara.swIpeakMaxA = Syspara2.stMControlPara.uwIPeakMaxA.uwReal ;//I2C_uwMControlRead[4];
  357. cp_stControlPara.swAlmOverCurrentVal =Syspara2.stMControlPara.uwAlamOCurA.uwReal ;// I2C_uwMControlRead[5];
  358. cp_stControlPara.swAlmOverVolVal1 =Syspara2.stMControlPara.uwAlamOVolV.uwReal ;// I2C_uwMControlRead[6];
  359. cp_stControlPara.swAlmUnderVolVal1 =Syspara2.stMControlPara.uwAlamUVolV.uwReal ;//I2C_uwMControlRead[7];
  360. cp_stControlPara.swAlmOverSpdVal =Syspara2.stMControlPara.uwAlamOverSpdRpm.uwReal ;// I2C_uwMControlRead[8];
  361. cp_stControlPara.swAlmOverHeatCeVal =Syspara2.stMControlPara.uwAlamOverHeatCe.uwReal ;// I2C_uwMControlRead[9];
  362. cp_stControlPara.swAlmRecOHeatVal =Syspara2.stMControlPara.uwAlamRecHeatCe.uwReal ;// I2C_uwMControlRead[10];
  363. cp_stControlPara.swAlmPwrLimitStartTempVal =Syspara2.stMControlPara.uwPwrLimitStartCe.uwReal ;// I2C_uwMControlRead[11];
  364. cp_stControlPara.swAlmMotorOverHeatCeVal =Syspara2.stMControlPara.uwAlamMotorOverHeatCe.uwReal ;// I2C_uwMControlRead[12];
  365. cp_stControlPara.swAlmMotorRecOHeatVal = Syspara2.stMControlPara.uwAlamMotorRecHeatCe.uwReal ;//I2C_uwMControlRead[13];
  366. cp_stControlPara.swAlmPwrLimitMotorStartTempVal =Syspara2.stMControlPara.uwPwrLimitMotorStartCe.uwReal ;// I2C_uwMControlRead[14];
  367. cp_stControlPara.uwControlFunEN=Syspara2.stMControlPara.uwControlFunEN.uwReal ;//I2C_uwMControlRead[15];
  368. cp_stControlPara.swAlmRecOVVal =cp_stControlPara.swAlmOverVolVal1 - 10; //过压恢复值
  369. cp_stControlPara.swAlmRecUVVal =cp_stControlPara.swAlmUnderVolVal1 + 10;//欠压恢复值
  370. cp_stControlPara.swCvbConstantVolBrakeV =cp_stControlPara.swAlmRecOVVal;
  371. }
  372. else
  373. {
  374. cp_stFlg.RunPermitFlg = FALSE;
  375. }
  376. if (i2c_stRXCRCOut.blSensorParaFltFlg == FALSE)
  377. {
  378. torsensor_stTorSensorCof.uwTorqueOffsetOrign =Syspara2.stSensorPara.uwTorSensorOffsetOrigin.uwReal ;// I2C_uwSensorRead[0];
  379. torsensor_stTorSensorCof.uwTorqueOffsetNow1 =Syspara2.stSensorPara.uwTorSensorOffsetNow1.uwReal ;// I2C_uwSensorRead[1];
  380. torsensor_stTorSensorCof.uwTorqueOffsetNow2 =Syspara2.stSensorPara.uwTorSensorOffsetNow2.uwReal ;// I2C_uwSensorRead[2];
  381. torsensor_stTorSensorCof.uwTorqueOffsetNow3 =Syspara2.stSensorPara.uwTorSensorOffsetNow3.uwReal ;// I2C_uwSensorRead[3];
  382. torsensor_stTorSensorCof.uwTorqueOffsetNow4 =Syspara2.stSensorPara.uwTorSensorOffsetNow4.uwReal ;// I2C_uwSensorRead[4];
  383. torsensor_stTorSensorCof.uwMaxSensorTorquePu =Syspara2.stSensorPara.uwBikeTorMaxNm.uwReal ;// I2C_uwSensorRead[5];
  384. torsensor_stTorSensorCof.uwBikeTorStep1RealNm =Syspara2.stSensorPara.uwBikeTor1StepRealNm.uwReal ;// I2C_uwSensorRead[6];
  385. torsensor_stTorSensorCof.uwBikeTorStep1ADC =Syspara2.stSensorPara.uwBikeTor1StepADC.uwReal ;// I2C_uwSensorRead[7];
  386. torsensor_stTorSensorCof.uwBikeTorStep2RealNm =Syspara2.stSensorPara.uwBikeTor2StepRealNm.uwReal ;// I2C_uwSensorRead[8];
  387. torsensor_stTorSensorCof.uwBikeTorStep2ADC =Syspara2.stSensorPara.uwBikeTor2StepADC.uwReal ;// I2C_uwSensorRead[9];
  388. torsensor_stTorSensorCof.uwBikeTorStep3RealNm = Syspara2.stSensorPara.uwBikeTor3StepRealNm.uwReal ;//I2C_uwSensorRead[10];
  389. torsensor_stTorSensorCof.uwBikeTorStep3ADC =Syspara2.stSensorPara.uwBikeTor3StepADC.uwReal ;// I2C_uwSensorRead[11];
  390. torsensor_stTorSensorCof.uwBikeTorStep4RealNm =Syspara2.stSensorPara.uwBikeTor4StepRealNm.uwReal ;// I2C_uwSensorRead[12];
  391. torsensor_stTorSensorCof.uwBikeTorStep4ADC = Syspara2.stSensorPara.uwBikeTor4StepADC.uwReal ;//I2C_uwSensorRead[13];
  392. cadence_stFreGetCof.uwTorque_NumbersPulses = Syspara2.stSensorPara.uwTorque_SensorPulseNm.uwReal ;//I2C_uwSensorRead[14];
  393. bikespeed_stFreGetCof.uwNumbersPulses =Syspara2.stSensorPara.uwBikeSpdSensorPulseNm.uwReal ;// I2C_uwSensorRead[15];
  394. cadence_stFreGetCof.uwCad_NumbersPulses =Syspara2.stSensorPara.uwCad_SensorPulseNm.uwReal;// I2C_uwSensorRead[16];
  395. }
  396. else
  397. {
  398. cp_stFlg.RunPermitFlg = FALSE;
  399. }
  400. if (i2c_stRXCRCOut.blAssistParaFltFlg == FALSE)
  401. {
  402. ass_ParaSet.uwStartupCoef = Syspara2.stAssistPara.uwStartupGain.uwReal ;//I2C_uwAssistParaRead[0];
  403. ass_ParaSet.uwStartupCruiseCoef =Syspara2.stAssistPara.uwStartcruiseGain.uwReal ;// I2C_uwAssistParaRead[1];
  404. ass_ParaSet.uwAssistStartNm =Syspara2.stAssistPara.uwAssistStartNm.uwReal ;// I2C_uwAssistParaRead[2];
  405. ass_ParaSet.uwAssistStopNm =Syspara2.stAssistPara.uwAssistStopNm.uwReal ;// I2C_uwAssistParaRead[3];
  406. ass_ParaSet.uwStartUpGainStep =Syspara2.stAssistPara.uwStartUpGainStep.uwReal ;// I2C_uwAssistParaRead[4];
  407. ass_ParaSet.uwStartUpCadNm =Syspara2.stAssistPara.uwStartUpCadNm.uwReal ;// I2C_uwAssistParaRead[5];
  408. ass_ParaSet.uwTorLPFCadNm =Syspara2.stAssistPara.uwTorLPFCadNm.uwReal ;// I2C_uwAssistParaRead[6];
  409. ass_ParaSet.uwSpeedAssistSpdRpm =Syspara2.stAssistPara.uwSpeedAssistSpdRpm.uwReal ;// I2C_uwAssistParaRead[7];
  410. ass_ParaSet.uwSpeedAssistIMaxA =Syspara2.stAssistPara.uwSpeedAssistIMaxA.uwReal ;// I2C_uwAssistParaRead[8];
  411. ass_ParaSet.uwAssistLimitBikeSpdStart =Syspara2.stAssistPara.uwAssistLimitBikeSpdStart.uwReal ;// I2C_uwAssistParaRead[9];
  412. ass_ParaSet.uwAssistLimitBikeSpdStop =Syspara2.stAssistPara.uwAssistLimitBikeSpdStop.uwReal ;// I2C_uwAssistParaRead[10];
  413. ass_ParaSet.uwCadenceWeight =Syspara2.stAssistPara.uwCadenceAssistWeight.uwReal ;// I2C_uwAssistParaRead[11];
  414. ass_stCadAssSpdCtl.uwPidKp =Syspara2.stAssistPara.uwCadenceAssKp.uwReal ;// I2C_uwAssistParaRead[12];
  415. ass_stCadAssSpdCtl.swPidLimMax =Syspara2.stAssistPara.swCadenceVolStep.swReal ;// I2C_uwAssistParaRead[13];
  416. ass_stCadAssSpdCtl.swPidVolDec =Syspara2.stAssistPara.swCadenceVolDecStep.swReal ;// I2C_uwAssistParaRead[14];
  417. ass_stCadAssParaPro.swTargetAssCurAcc =Syspara2.stAssistPara.swCadenceCurStep.swReal ;// I2C_uwAssistParaRead[15];
  418. ass_stCadAssCoef.uwMaxCadRpm =Syspara2.stAssistPara.uwMaxCadRpm.uwReal ;// I2C_uwAssistParaRead[16];
  419. ass_stReservePara.uwReserve2 =Syspara2.stAssistPara.uwReserve2.uwReal ;// I2C_uwAssistParaRead[17];
  420. ass_stReservePara.uwReserve3 =Syspara2.stAssistPara.uwReserve3.uwReal ;// I2C_uwAssistParaRead[18];
  421. ass_stReservePara.uwReserve4 =Syspara2.stAssistPara.uwReserve4.uwReal ;// I2C_uwAssistParaRead[19];
  422. }
  423. else
  424. {}
  425. if (i2c_stRXCRCOut.blBikePara2FltFlg == FALSE)
  426. {
  427. ass_ParaCong.uwNoneOBCEnable = Syspara2.stBikePara2.uwNoneOBCEnable.uwReal ;// I2C_uwBikePara2Read[0];
  428. ass_ParaCong.uwRearLightCycle =Syspara2.stBikePara2.uwRearLightCycle.uwReal;// I2C_uwBikePara2Read[1];
  429. ass_ParaCong.uwRearLightDuty = Syspara2.stBikePara2.uwRearLightDuty.uwReal ;//I2C_uwBikePara2Read[2];
  430. ass_ParaCong.swDeltaBikeSpeedLimit =Syspara2.stBikePara2.swDeltaBikeSpeedLimit.swReal;// (SWORD) I2C_uwBikePara2Read[3];
  431. }
  432. else
  433. {}
  434. }
  435. // mn_voControlPareSet();
  436. cp_stFlg.ParaUseEEFinishFlg = TRUE;
  437. }
  438. else
  439. {}
  440. }
  441. void mn_voControlPareSet(void)
  442. {
  443. if (cp_stFlg.ParaUseEEFlg == TRUE)
  444. {
  445. cp_stFlg.RunModelSelect = Syspara2.flash_stPara.stTestParaInfo.RunModelSelect;
  446. cp_stFlg.ThetaGetModelSelect = Syspara2.flash_stPara.stTestParaInfo.ThetaGetModelSelect;
  447. cp_stFlg.CurrentSampleModelSelect = Syspara2.flash_stPara.stTestParaInfo.CurrentSampleModelSelect;
  448. cp_stFlg.RotateDirectionSelect = Syspara2.flash_stPara.stTestParaInfo.RotateDirectionSelect;
  449. cp_stControlPara.swAlignCurAp = Syspara2.flash_stPara.stTestParaInfo.uwInitPosCurAmp;
  450. cp_stControlPara.swDragVolAp = Syspara2.flash_stPara.stTestParaInfo.uwVFControlVolAmp;
  451. cp_stControlPara.swDragCurAp = Syspara2.flash_stPara.stTestParaInfo.uwIFControlCurAmp;
  452. cp_stControlPara.swDragSpdHz = Syspara2.flash_stPara.stTestParaInfo.uwVFIFTargetFreHz;
  453. cp_stControlPara.swSpeedAccRate = Syspara2.flash_stPara.stTestParaInfo.uwSpeedLoopAccRate;
  454. cp_stControlPara.swSpeedDccRate =Syspara2.flash_stPara.stTestParaInfo.uwSpeedLoopDecRate;
  455. cp_stControlPara.swAsrPIBandwidth = Syspara2.flash_stPara.stTestParaInfo.uwSpeedLoopBandWidthHz;
  456. cp_stControlPara.swAsrPIM = Syspara2.flash_stPara.stTestParaInfo.uwSpeedLoopCoefM;
  457. cp_stControlPara.swAcrPIBandwidth = Syspara2.flash_stPara.stTestParaInfo.uwCuerrentLoopBandWidthHz;
  458. cp_stControlPara.swAcrRaCoef = Syspara2.flash_stPara.stTestParaInfo.uwCurrentLoopCoefM;
  459. cp_stControlPara.swObsFluxPIDampratio =Syspara2.flash_stPara.stTestParaInfo.uwFluxObsCoefM ;
  460. cp_stControlPara.swObsFluxPICrossfreHz =Syspara2.flash_stPara.stTestParaInfo.uwFluxObsBandWidthHz ;
  461. cp_stControlPara.swObsSpdPLLM = Syspara2.flash_stPara.stTestParaInfo.uwThetaObsPLLCoefM;
  462. cp_stControlPara.swObsSpdPLLBandWidthHz = Syspara2.flash_stPara.stTestParaInfo.uwThetaObsPLLBandWidthHz;
  463. cp_stControlPara.swPWMMaxDuty = Syspara2.flash_stPara.stTestParaInfo.uwPWMMaxDuty;
  464. cp_stControlPara.swPWM7to5Duty = Syspara2.flash_stPara.stTestParaInfo.uwPWM7to5Duty;
  465. cp_stControlPara.swPwrLimitValWt = Syspara2.flash_stPara.stTestParaInfo.uwPwrLimit;
  466. cp_stControlPara.swPwrLimitErrWt = Syspara2.flash_stPara.stTestParaInfo.uwPwrLimitError;
  467. cp_stControlPara.swPwrLimitKpPu = Syspara2.flash_stPara.stTestParaInfo.uwPwrLimitKp;
  468. cp_stControlPara.swPwrLimitKiPu = Syspara2.flash_stPara.stTestParaInfo.uwPwrLimitKi;
  469. }
  470. }
  471. /***************************************************************
  472. Function: mn_voParaUpdate;
  473. Description:update pra from upper PC
  474. Call by:
  475. Input Variables: N/A
  476. Output/Return Variables: N/A
  477. Subroutine Call: N/A;
  478. Reference: N/A
  479. ****************************************************************/
  480. void mn_voParaUpdate(void)
  481. {
  482. if (cp_stFlg.ParaUpdateFlg == TRUE)
  483. {
  484. if (cp_stFlg.ParaMInfoUpdateFlg == TRUE)
  485. {
  486. cp_stMotorPara.swMotrPolePairs = MC_UpcInfo.stMotorInfo.uwPolePairs;
  487. cp_stMotorPara.swRsOhm = MC_UpcInfo.stMotorInfo.uwRsmOhm;
  488. cp_stMotorPara.uwLdmH = MC_UpcInfo.stMotorInfo.uwLduH;
  489. cp_stMotorPara.uwLqmH = MC_UpcInfo.stMotorInfo.uwLquH;
  490. cp_stMotorPara.swFluxWb = MC_UpcInfo.stMotorInfo.uwFluxmWb;
  491. cp_stMotorPara.swIdMaxA = MC_UpcInfo.stMotorInfo.uwIdMaxA;
  492. cp_stMotorPara.swIdMinA = MC_UpcInfo.stMotorInfo.uwIdMinA;
  493. cp_stMotorPara.swRSpeedRpm = MC_UpcInfo.stMotorInfo.uwRSpdRpm;
  494. cp_stMotorPara.uwRPwrWt = MC_UpcInfo.stMotorInfo.uwRPwrWt;
  495. cp_stMotorPara.swRIarmsA = MC_UpcInfo.stMotorInfo.uwRCurA;
  496. cp_stMotorPara.swRUdcV = MC_UpcInfo.stMotorInfo.uwRVolV;
  497. cp_stMotorPara.swJD = MC_UpcInfo.stMotorInfo.uwJD;
  498. cp_stMotorPara.swTorMax = MC_UpcInfo.stMotorInfo.uwTorMaxNm;
  499. cp_stFlg.ParaMotorDriveUpdateFinishFlg = TRUE;
  500. cp_stFlg.ParaMInfoUpdateFlg = FALSE;
  501. }
  502. if (cp_stFlg.ParaBikeInfoUpdateFlg == TRUE)
  503. {
  504. ass_ParaCong.uwWheelPerimeter = MC_UpcInfo.stBikeInfo.uwWheelPerimeter;
  505. ass_ParaCong.uwMechRationMotorEEPROM=MC_UpcInfo.stBikeInfo.uwMechRationMotor;
  506. ass_ParaCong.uwMechRationMotor = (UWORD)(((ULONG)ass_ParaCong.uwMechRationMotorEEPROM*1024)/1000);
  507. ass_ParaCong.uwThrottleMaxSpdKmH = MC_UpcInfo.stBikeInfo.uwThrottleMaxSpdKmH;
  508. ass_ParaCong.uwCartSpdKmH = MC_UpcInfo.stBikeInfo.uwCartSpdKmH;
  509. ass_ParaCong.uwNmFrontChainring = MC_UpcInfo.stBikeInfo.uwNmFrontChainring;
  510. ass_ParaCong.uwNmBackChainring = MC_UpcInfo.stBikeInfo.uwNmBackChainring;
  511. ass_ParaCong.uwAssistSelect1 = MC_UpcInfo.stBikeInfo.uwAssistSelect1;
  512. ass_ParaCong.uwAssistSelect2 = MC_UpcInfo.stBikeInfo.uwAssistSelect2;
  513. ass_ParaCong.uwLightConfig = MC_UpcInfo.stBikeInfo.uwLightConfig;
  514. ass_ParaCong.swDeltPerimeter = MC_UpcInfo.stBikeInfo.swWheelSizeAdjust;
  515. ass_ParaCong.uwStartMode = MC_UpcInfo.stBikeInfo.uwStartMode;
  516. ass_ParaCong.uwAutoPowerOffTime = MC_UpcInfo.stBikeInfo.uwAutoPowerOffTime;
  517. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  518. cp_stFlg.ParaBikeInfoUpdateFlg = FALSE;
  519. }
  520. if (cp_stFlg.ParaMCInfoUpdateFlg == TRUE)
  521. {
  522. cp_stFlg.ParaFirstSetFlg = MC_UpcInfo.stTestParaInfo.uwEEFirstDefaultSetFlg;
  523. // cp_stFlg.SpiOffsetFirstSetFlg = MC_UpcInfo.stTestParaInfo.uwSPIOffsetFirstSetFlg;
  524. // spi_stResolverOut.swSpiThetaOffsetOrignPu = MC_UpcInfo.stMContorlInfo.uwSPIPosOffsetOrigin;
  525. // spi_stResolverOut.swSpiThetaOffsetPu = MC_UpcInfo.stMContorlInfo.uwSPIPosOffsetNow;
  526. cp_stMotorPara.swIpeakMaxA = MC_UpcInfo.stMContorlInfo.uwIPeakMaxA;
  527. cp_stControlPara.swAlmOverCurrentVal = MC_UpcInfo.stMContorlInfo.uwAlamOCurA;
  528. cp_stControlPara.swAlmOverVolVal1 = MC_UpcInfo.stMContorlInfo.uwAlamOVolV;
  529. cp_stControlPara.swAlmUnderVolVal1 = MC_UpcInfo.stMContorlInfo.uwAlamUVolV;
  530. cp_stControlPara.swAlmOverSpdVal = MC_UpcInfo.stMContorlInfo.uwAlamOverSpdRpm;
  531. cp_stControlPara.swAlmOverHeatCeVal = MC_UpcInfo.stMContorlInfo.uwAlamOverHeatCe;
  532. cp_stControlPara.swAlmRecOHeatVal = MC_UpcInfo.stMContorlInfo.uwAlamRecHeatCe;
  533. cp_stControlPara.swAlmPwrLimitStartTempVal = MC_UpcInfo.stMContorlInfo.uwPwrLimitStartCe;
  534. cp_stControlPara.swAlmMotorOverHeatCeVal = MC_UpcInfo.stMContorlInfo.uwAlamMotorOverHeatCe;
  535. cp_stControlPara.swAlmMotorRecOHeatVal = MC_UpcInfo.stMContorlInfo.uwAlamMotorRecHeatCe;
  536. cp_stControlPara.swAlmPwrLimitMotorStartTempVal = MC_UpcInfo.stMContorlInfo.uwPwrLimitMotorStartCe;
  537. cp_stControlPara.uwControlFunEN=MC_UpcInfo.stMContorlInfo.uwControlFunEN;
  538. cp_stControlPara.swAlmRecOVVal=cp_stControlPara.swAlmOverVolVal1-10; //过压恢复值
  539. cp_stControlPara.swAlmRecUVVal=cp_stControlPara.swAlmUnderVolVal1+10;//欠压恢复值
  540. cp_stControlPara.swCvbConstantVolBrakeV=cp_stControlPara.swAlmRecOVVal;
  541. cp_stFlg.ParaMotorDriveUpdateFinishFlg = TRUE;
  542. cp_stFlg.ParaMCInfoUpdateFlg = FALSE;
  543. }
  544. if (cp_stFlg.ParaSensorInfoUpdateFlg == TRUE)
  545. {
  546. torsensor_stTorSensorCof.uwTorqueOffsetOrign = MC_UpcInfo.stSensorInfo.uwTorSensorOffsetOrigin;
  547. torsensor_stTorSensorCof.uwMaxSensorTorquePu = MC_UpcInfo.stSensorInfo.uwBikeTorMaxNm;
  548. torsensor_stTorSensorCof.uwBikeTorStep1RealNm = MC_UpcInfo.stSensorInfo.uwBikeTor1StepRealNm;
  549. torsensor_stTorSensorCof.uwBikeTorStep1ADC = MC_UpcInfo.stSensorInfo.uwBikeTor1StepADC;
  550. torsensor_stTorSensorCof.uwBikeTorStep2RealNm = MC_UpcInfo.stSensorInfo.uwBikeTor2StepRealNm;
  551. torsensor_stTorSensorCof.uwBikeTorStep2ADC = MC_UpcInfo.stSensorInfo.uwBikeTor2StepADC;
  552. torsensor_stTorSensorCof.uwBikeTorStep3RealNm = MC_UpcInfo.stSensorInfo.uwBikeTor3StepRealNm;
  553. torsensor_stTorSensorCof.uwBikeTorStep3ADC = MC_UpcInfo.stSensorInfo.uwBikeTor3StepADC;
  554. torsensor_stTorSensorCof.uwBikeTorStep4RealNm = MC_UpcInfo.stSensorInfo.uwBikeTor4StepRealNm;
  555. torsensor_stTorSensorCof.uwBikeTorStep4ADC = MC_UpcInfo.stSensorInfo.uwBikeTor4StepADC;
  556. cadence_stFreGetCof.uwTorque_NumbersPulses = MC_UpcInfo.stSensorInfo.uwTorque_SensorPulseNm;
  557. bikespeed_stFreGetCof.uwNumbersPulses = MC_UpcInfo.stSensorInfo.uwBikeSpdSensorPulseNm;
  558. cadence_stFreGetCof.uwCad_NumbersPulses=MC_UpcInfo.stSensorInfo.uwCad_SensorPulseNm;
  559. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  560. cp_stFlg.ParaSensorInfoUpdateFlg = FALSE;
  561. }
  562. if (cp_stFlg.ParaAInfoUpdateFlg == TRUE)
  563. {
  564. ass_ParaSet.uwStartupCoef = MC_UpcInfo.stAssistInfo.swStartupGain;
  565. ass_ParaSet.uwStartupCruiseCoef = MC_UpcInfo.stAssistInfo.swStartcruiseGain;
  566. ass_ParaSet.uwAssistStartNm = MC_UpcInfo.stAssistInfo.uwAssistStartNm;
  567. ass_ParaSet.uwAssistStopNm = MC_UpcInfo.stAssistInfo.uwAssistStopNm;
  568. ass_ParaSet.uwStartUpGainStep = MC_UpcInfo.stAssistInfo.uwStartUpGainStep;
  569. ass_ParaSet.uwStartUpCadNm = MC_UpcInfo.stAssistInfo.uwStartUpCadNm;
  570. ass_ParaSet.uwTorLPFCadNm = MC_UpcInfo.stAssistInfo.uwTorLPFCadNm;
  571. ass_ParaSet.uwSpeedAssistSpdRpm = MC_UpcInfo.stAssistInfo.uwSpeedAssistSpdRpm;
  572. ass_ParaSet.uwSpeedAssistIMaxA = MC_UpcInfo.stAssistInfo.uwSpeedAssistIMaxA;
  573. ass_ParaSet.uwAssistLimitBikeSpdStart = MC_UpcInfo.stAssistInfo.uwAssistLimitBikeSpdStart;
  574. ass_ParaSet.uwAssistLimitBikeSpdStop = MC_UpcInfo.stAssistInfo.uwAssistLimitBikeSpdStop;
  575. ass_ParaSet.uwCadenceWeight = MC_UpcInfo.stAssistInfo.uwCadenceAssistWeight;
  576. ass_stCadAssSpdCtl.uwPidKp = MC_UpcInfo.stAssistInfo.uwCadAssPidKp;
  577. ass_stCadAssSpdCtl.swPidLimMax = MC_UpcInfo.stAssistInfo.swCadAssPidLimMax;
  578. ass_stCadAssSpdCtl.swPidVolDec = MC_UpcInfo.stAssistInfo.swCadAssPidVolDec;
  579. ass_stCadAssParaPro.swTargetAssCurAcc = MC_UpcInfo.stAssistInfo.swCadAssTargetAssCurAcc;
  580. ass_stCadAssCoef.uwMaxCadRpm = MC_UpcInfo.stAssistInfo.uwMaxCadRpm;
  581. ass_stReservePara.uwReserve2 = MC_UpcInfo.stAssistInfo.reserve2;
  582. ass_stReservePara.uwReserve3 = MC_UpcInfo.stAssistInfo.reserve3;
  583. ass_stReservePara.uwReserve4 = MC_UpcInfo.stAssistInfo.reserve4;
  584. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  585. cp_stFlg.ParaAInfoUpdateFlg = FALSE;
  586. }
  587. if(cp_stFlg.TestParaInfoUpdateFlg == TRUE)
  588. {
  589. cp_stFlg.RunModelSelect = MC_UpcInfo.stTestParaInfo.RunModelSelect;
  590. cp_stFlg.ThetaGetModelSelect = MC_UpcInfo.stTestParaInfo.ThetaGetModelSelect;
  591. cp_stFlg.CurrentSampleModelSelect = MC_UpcInfo.stTestParaInfo.CurrentSampleModelSelect;
  592. cp_stFlg.RotateDirectionSelect = MC_UpcInfo.stTestParaInfo.RotateDirectionSelect;
  593. cp_stControlPara.swAlignCurAp = MC_UpcInfo.stTestParaInfo.uwInitPosCurAmp;
  594. cp_stControlPara.swDragVolAp = MC_UpcInfo.stTestParaInfo.uwVFControlVolAmp;
  595. cp_stControlPara.swDragCurAp = MC_UpcInfo.stTestParaInfo.uwIFControlCurAmp;
  596. cp_stControlPara.swDragSpdHz = MC_UpcInfo.stTestParaInfo.uwVFIFTargetFreHz;
  597. cp_stControlPara.swSpeedAccRate = MC_UpcInfo.stTestParaInfo.uwSpeedLoopAccRate;
  598. cp_stControlPara.swSpeedDccRate = MC_UpcInfo.stTestParaInfo.uwSpeedLoopDecRate;
  599. cp_stControlPara.swAsrPIBandwidth = MC_UpcInfo.stTestParaInfo.uwSpeedLoopBandWidthHz;
  600. cp_stControlPara.swAsrPIM = MC_UpcInfo.stTestParaInfo.uwSpeedLoopCoefM;
  601. cp_stControlPara.swAcrPIBandwidth = MC_UpcInfo.stTestParaInfo.uwCuerrentLoopBandWidthHz;
  602. cp_stControlPara.swAcrRaCoef = MC_UpcInfo.stTestParaInfo.uwCurrentLoopCoefM;
  603. cp_stControlPara.swObsFluxPICrossfreHz = MC_UpcInfo.stTestParaInfo.uwFluxObsBandWidthHz;
  604. cp_stControlPara.swObsFluxPIDampratio = MC_UpcInfo.stTestParaInfo.uwFluxObsCoefM;
  605. cp_stControlPara.swObsSpdPLLBandWidthHz = MC_UpcInfo.stTestParaInfo.uwThetaObsPLLBandWidthHz;
  606. cp_stControlPara.swObsSpdPLLM = MC_UpcInfo.stTestParaInfo.uwThetaObsPLLCoefM;
  607. cp_stMotorPara.swJD = MC_UpcInfo.stTestParaInfo.uwJm;
  608. cp_stControlPara.swPWMMaxDuty = MC_UpcInfo.stTestParaInfo.uwPWMMaxDuty;
  609. cp_stControlPara.swPWM7to5Duty = MC_UpcInfo.stTestParaInfo.uwPWM7to5Duty;
  610. cp_stControlPara.swPwrLimitValWt = MC_UpcInfo.stTestParaInfo.uwPwrLimit;
  611. cp_stControlPara.swPwrLimitErrWt = MC_UpcInfo.stTestParaInfo.uwPwrLimitError;
  612. cp_stControlPara.swPwrLimitKpPu = MC_UpcInfo.stTestParaInfo.uwPwrLimitKp;
  613. cp_stControlPara.swPwrLimitKiPu = MC_UpcInfo.stTestParaInfo.uwPwrLimitKi;
  614. cp_stFlg.ParaMotorDriveUpdateFinishFlg = TRUE;
  615. cp_stFlg.TestParaInfoUpdateFlg = FALSE;
  616. }
  617. if (cp_stFlg.ParaRideInfoUpdateFlg == TRUE)
  618. {
  619. ass_stCalCoef.ucAssistRatioGain[0] = MC_UpcInfo.stRideParaInfo.ucAssistRatioGain1;
  620. ass_stCalCoef.ucAssistRatioGain[1] = MC_UpcInfo.stRideParaInfo.ucAssistRatioGain2;
  621. ass_stCalCoef.ucAssistRatioGain[2] = MC_UpcInfo.stRideParaInfo.ucAssistRatioGain3;
  622. ass_stCalCoef.ucAssistRatioGain[3] = MC_UpcInfo.stRideParaInfo.ucAssistRatioGain4;
  623. ass_stCalCoef.ucAssistRatioGain[4] = MC_UpcInfo.stRideParaInfo.ucAssistRatioGain5;
  624. ass_stCalCoef.ucAssistAccelerationGain[0] = MC_UpcInfo.stRideParaInfo.ucAssistAccelerationGain1;
  625. ass_stCalCoef.ucAssistAccelerationGain[1] = MC_UpcInfo.stRideParaInfo.ucAssistAccelerationGain2;
  626. ass_stCalCoef.ucAssistAccelerationGain[2] = MC_UpcInfo.stRideParaInfo.ucAssistAccelerationGain3;
  627. ass_stCalCoef.ucAssistAccelerationGain[3] = MC_UpcInfo.stRideParaInfo.ucAssistAccelerationGain4;
  628. ass_stCalCoef.ucAssistAccelerationGain[4] = MC_UpcInfo.stRideParaInfo.ucAssistAccelerationGain5;
  629. ass_stCalCoef.ucMaxCurrentGain[0] = MC_UpcInfo.stRideParaInfo.ucMaxCurrentGain1;
  630. ass_stCalCoef.ucMaxCurrentGain[1] = MC_UpcInfo.stRideParaInfo.ucMaxCurrentGain2;
  631. ass_stCalCoef.ucMaxCurrentGain[2] = MC_UpcInfo.stRideParaInfo.ucMaxCurrentGain3;
  632. ass_stCalCoef.ucMaxCurrentGain[3] = MC_UpcInfo.stRideParaInfo.ucMaxCurrentGain4;
  633. ass_stCalCoef.ucMaxCurrentGain[4] = MC_UpcInfo.stRideParaInfo.ucMaxCurrentGain5;
  634. ass_stCalCoef.ucMaxTorqueGain[0] = MC_UpcInfo.stRideParaInfo.ucMaxTorqueGain1;
  635. ass_stCalCoef.ucMaxTorqueGain[1] = MC_UpcInfo.stRideParaInfo.ucMaxTorqueGain2;
  636. ass_stCalCoef.ucMaxTorqueGain[2] = MC_UpcInfo.stRideParaInfo.ucMaxTorqueGain3;
  637. ass_stCalCoef.ucMaxTorqueGain[3] = MC_UpcInfo.stRideParaInfo.ucMaxTorqueGain4;
  638. ass_stCalCoef.ucMaxTorqueGain[4] = MC_UpcInfo.stRideParaInfo.ucMaxTorqueGain5;
  639. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  640. cp_stFlg.ParaRideInfoUpdateFlg = FALSE;
  641. }
  642. if (cp_stFlg.ParaBikeInfo2UpdateFlg == TRUE)
  643. {
  644. ass_ParaCong.uwNoneOBCEnable = MC_UpcInfo.stBikeInfo2.uwNoneOBCEnable;
  645. ass_ParaCong.uwRearLightCycle = MC_UpcInfo.stBikeInfo2.uwRearLightCycle;
  646. ass_ParaCong.uwRearLightDuty = MC_UpcInfo.stBikeInfo2.uwRearLightDuty;
  647. ass_ParaCong.swDeltaBikeSpeedLimit = MC_UpcInfo.stBikeInfo2.swDeltaBikeSpeedLimit;
  648. cp_stFlg.ParaAssistUpdateFinishFlg = TRUE;
  649. cp_stFlg.ParaBikeInfo2UpdateFlg = FALSE;
  650. }
  651. cp_stFlg.ParaUpdateFlg = FALSE;
  652. }
  653. }
  654. /***************************************************************
  655. Function: mn_voEEUperParaUpdate;
  656. Description:software intial
  657. Call by:
  658. Input Variables: N/A
  659. Output/Return Variables: N/A
  660. Subroutine Call: N/A;
  661. Reference: N/A
  662. ****************************************************************/
  663. void mn_voEEUperParaUpdate(void)
  664. {
  665. if (MC_UpcInfo.stMotorInfo.uwSaveFlg == TRUE)
  666. {
  667. Syspara2.stMotorPara.uwPolePairs.uwReal = cp_stMotorPara.swMotrPolePairs;
  668. Syspara2.stMotorPara.uwRsmOhm.uwReal = cp_stMotorPara.swRsOhm;
  669. Syspara2.stMotorPara.uwLduH.uwReal = cp_stMotorPara.uwLdmH;
  670. Syspara2.stMotorPara.uwLquH.uwReal = cp_stMotorPara.uwLqmH;
  671. Syspara2.stMotorPara.uwFluxmWb.uwReal = cp_stMotorPara.swFluxWb;
  672. Syspara2.stMotorPara.uwIdMaxA.uwReal = cp_stMotorPara.swIdMaxA;
  673. Syspara2.stMotorPara.uwIdMinA.uwReal = cp_stMotorPara.swIdMinA;
  674. Syspara2.stMotorPara.uwRSpdRpm.uwReal = cp_stMotorPara.swRSpeedRpm;
  675. Syspara2.stMotorPara.uwRPwrWt.uwReal = cp_stMotorPara.uwRPwrWt;
  676. Syspara2.stMotorPara.uwRCurA.uwReal = cp_stMotorPara.swRIarmsA;
  677. Syspara2.stMotorPara.uwRVolV.uwReal = cp_stMotorPara.swRUdcV;
  678. Syspara2.stMotorPara.uwJD.uwReal = cp_stMotorPara.swJD;
  679. Syspara2.stMotorPara.uwTorMaxNm.uwReal = cp_stMotorPara.swTorMax;
  680. }
  681. if (MC_UpcInfo.stBikeInfo.uwSaveFlg == TRUE)
  682. {
  683. Syspara2.stBikePara.uwWheelPerimeter.uwReal = ass_ParaCong.uwWheelPerimeter;
  684. Syspara2.stBikePara.swDeltPerimeter.swReal = ass_ParaCong.swDeltPerimeter;
  685. Syspara2.stBikePara.uwMechRationMotor.uwReal= ass_ParaCong.uwMechRationMotorEEPROM; //Syspara2.stBikePara.uwMechRationMotor.uwReal = (UWORD)(((ULONG)ass_ParaCong.uwMechRationMotor*1000)/1024);
  686. Syspara2.stBikePara.uwThrottleMaxSpdKmH.uwReal = ass_ParaCong.uwThrottleMaxSpdKmH;
  687. Syspara2.stBikePara.uwCartSpdKmH.uwReal = ass_ParaCong.uwCartSpdKmH;
  688. Syspara2.stBikePara.uwNmFrontChainring.uwReal = ass_ParaCong.uwNmFrontChainring;
  689. Syspara2.stBikePara.uwNmBackChainring.uwReal = ass_ParaCong.uwNmBackChainring;
  690. Syspara2.stBikePara.uwAssistSelect1.uwReal = ass_ParaCong.uwAssistSelect1;
  691. Syspara2.stBikePara.uwAssistSelect2.uwReal = ass_ParaCong.uwAssistSelect2;
  692. Syspara2.stBikePara.uwLightConfig.uwReal = ass_ParaCong.uwLightConfig;
  693. Syspara2.stBikePara.uwStartMode.uwReal = ass_ParaCong.uwStartMode;
  694. Syspara2.stBikePara.uwAutoPowerOffTime.uwReal = ass_ParaCong.uwAutoPowerOffTime;
  695. }
  696. if (MC_UpcInfo.stMContorlInfo.uwSaveFlg == TRUE)
  697. {
  698. Syspara2.stMControlPara.ParaFirstSetFlg.uwReal = cp_stFlg.ParaFirstSetFlg;
  699. // Syspara2.stMControlPara.SpiOffsetFirstSetFlg.uwReal = cp_stFlg.SpiOffsetFirstSetFlg;
  700. // Syspara2.stMControlPara.uwSPIPosOffsetOrigin.uwReal = spi_stResolverOut.swSpiThetaOffsetOrignPu;
  701. // Syspara2.stMControlPara.uwSPIPosOffsetNow.uwReal = spi_stResolverOut.swSpiThetaOffsetPu;
  702. Syspara2.stMControlPara.uwIPeakMaxA.uwReal = cp_stMotorPara.swIpeakMaxA;
  703. Syspara2.stMControlPara.uwAlamOCurA.uwReal = cp_stControlPara.swAlmOverCurrentVal;
  704. Syspara2.stMControlPara.uwAlamOVolV.uwReal = cp_stControlPara.swAlmOverVolVal1;
  705. Syspara2.stMControlPara.uwAlamUVolV.uwReal = cp_stControlPara.swAlmUnderVolVal1;
  706. Syspara2.stMControlPara.uwAlamOverSpdRpm.uwReal = cp_stControlPara.swAlmOverSpdVal;
  707. Syspara2.stMControlPara.uwAlamOverHeatCe.uwReal = cp_stControlPara.swAlmOverHeatCeVal;
  708. Syspara2.stMControlPara.uwAlamRecHeatCe.uwReal = cp_stControlPara.swAlmRecOHeatVal;
  709. Syspara2.stMControlPara.uwPwrLimitStartCe.uwReal = cp_stControlPara.swAlmPwrLimitStartTempVal;
  710. Syspara2.stMControlPara.uwAlamMotorOverHeatCe.uwReal = cp_stControlPara.swAlmMotorOverHeatCeVal;
  711. Syspara2.stMControlPara.uwAlamMotorRecHeatCe.uwReal = cp_stControlPara.swAlmMotorRecOHeatVal;
  712. Syspara2.stMControlPara.uwPwrLimitMotorStartCe.uwReal = cp_stControlPara.swAlmPwrLimitMotorStartTempVal;
  713. Syspara2.stMControlPara.uwControlFunEN.uwReal=cp_stControlPara.uwControlFunEN;
  714. }
  715. if (MC_UpcInfo.stSensorInfo.uwSaveFlg == TRUE)
  716. {
  717. Syspara2.stSensorPara.uwTorSensorOffsetOrigin.uwReal = torsensor_stTorSensorCof.uwTorqueOffsetOrign;
  718. Syspara2.stSensorPara.uwTorSensorOffsetNow1.uwReal = torsensor_stTorSensorCof.uwTorqueOffsetNow1;
  719. Syspara2.stSensorPara.uwTorSensorOffsetNow2.uwReal = torsensor_stTorSensorCof.uwTorqueOffsetNow2;
  720. Syspara2.stSensorPara.uwTorSensorOffsetNow3.uwReal = torsensor_stTorSensorCof.uwTorqueOffsetNow3;
  721. Syspara2.stSensorPara.uwTorSensorOffsetNow4.uwReal = torsensor_stTorSensorCof.uwTorqueOffsetNow4;
  722. Syspara2.stSensorPara.uwBikeTorMaxNm.uwReal = torsensor_stTorSensorCof.uwMaxSensorTorquePu;
  723. Syspara2.stSensorPara.uwBikeTor1StepRealNm.uwReal = torsensor_stTorSensorCof.uwBikeTorStep1RealNm;
  724. Syspara2.stSensorPara.uwBikeTor1StepADC.uwReal = torsensor_stTorSensorCof.uwBikeTorStep1ADC;
  725. Syspara2.stSensorPara.uwBikeTor2StepRealNm.uwReal = torsensor_stTorSensorCof.uwBikeTorStep2RealNm;
  726. Syspara2.stSensorPara.uwBikeTor2StepADC.uwReal = torsensor_stTorSensorCof.uwBikeTorStep2ADC;
  727. Syspara2.stSensorPara.uwBikeTor3StepRealNm.uwReal = torsensor_stTorSensorCof.uwBikeTorStep3RealNm;
  728. Syspara2.stSensorPara.uwBikeTor3StepADC.uwReal = torsensor_stTorSensorCof.uwBikeTorStep3ADC;
  729. Syspara2.stSensorPara.uwBikeTor4StepRealNm.uwReal = torsensor_stTorSensorCof.uwBikeTorStep4RealNm;
  730. Syspara2.stSensorPara.uwBikeTor4StepADC.uwReal = torsensor_stTorSensorCof.uwBikeTorStep4ADC;
  731. Syspara2.stSensorPara.uwTorque_SensorPulseNm.uwReal = cadence_stFreGetCof.uwTorque_NumbersPulses;
  732. Syspara2.stSensorPara.uwBikeSpdSensorPulseNm.uwReal = bikespeed_stFreGetCof.uwNumbersPulses;
  733. Syspara2.stSensorPara.uwCad_SensorPulseNm.uwReal= cadence_stFreGetCof.uwCad_NumbersPulses;
  734. }
  735. if (MC_UpcInfo.stTestParaInfo.uwSaveFlg == TRUE )
  736. {
  737. memcpy(&Syspara2.flash_stPara.stTestParaInfo.uwTestParaSaveFlg, &MC_UpcInfo.stTestParaInfo.uwTestParaSaveFlg, sizeof(Syspara2.flash_stPara.stTestParaInfo));
  738. }
  739. if (MC_UpcInfo.stAssistInfo.uwSaveFlg == TRUE)
  740. {
  741. Syspara2.stAssistPara.uwStartupGain.uwReal = ass_ParaSet.uwStartupCoef;
  742. Syspara2.stAssistPara.uwStartcruiseGain.uwReal = ass_ParaSet.uwStartupCruiseCoef;
  743. Syspara2.stAssistPara.uwAssistStartNm.uwReal = ass_ParaSet.uwAssistStartNm;
  744. Syspara2.stAssistPara.uwAssistStopNm.uwReal = ass_ParaSet.uwAssistStopNm;
  745. Syspara2.stAssistPara.uwStartUpGainStep.uwReal = ass_ParaSet.uwStartUpGainStep;
  746. Syspara2.stAssistPara.uwStartUpCadNm.uwReal = ass_ParaSet.uwStartUpCadNm;
  747. Syspara2.stAssistPara.uwTorLPFCadNm.uwReal = ass_ParaSet.uwTorLPFCadNm;
  748. Syspara2.stAssistPara.uwSpeedAssistSpdRpm.uwReal = ass_ParaSet.uwSpeedAssistSpdRpm;
  749. Syspara2.stAssistPara.uwSpeedAssistIMaxA.uwReal = ass_ParaSet.uwSpeedAssistIMaxA;
  750. Syspara2.stAssistPara.uwAssistLimitBikeSpdStart.uwReal = ass_ParaSet.uwAssistLimitBikeSpdStart;
  751. Syspara2.stAssistPara.uwAssistLimitBikeSpdStop.uwReal = ass_ParaSet.uwAssistLimitBikeSpdStop;
  752. Syspara2.stAssistPara.uwCadenceAssistWeight.uwReal = ass_ParaSet.uwCadenceWeight;
  753. Syspara2.stAssistPara.uwCadenceAssKp.uwReal = ass_stCadAssSpdCtl.uwPidKp;
  754. Syspara2.stAssistPara.swCadenceVolStep.swReal = ass_stCadAssSpdCtl.swPidLimMax;
  755. Syspara2.stAssistPara.swCadenceVolDecStep.swReal = ass_stCadAssSpdCtl.swPidVolDec;
  756. Syspara2.stAssistPara.swCadenceCurStep.swReal = ass_stCadAssParaPro.swTargetAssCurAcc;
  757. Syspara2.stAssistPara.uwMaxCadRpm.uwReal = ass_stCadAssCoef.uwMaxCadRpm;
  758. Syspara2.stAssistPara.uwReserve2.uwReal = ass_stReservePara.uwReserve2;
  759. Syspara2.stAssistPara.uwReserve3.uwReal = ass_stReservePara.uwReserve3;
  760. Syspara2.stAssistPara.uwReserve4.uwReal = ass_stReservePara.uwReserve4;
  761. }
  762. }
  763. /***************************************************************
  764. Function: mn_voEEHistoryParaUpdate;
  765. Description:software intial
  766. Call by:
  767. Input Variables: N/A
  768. Output/Return Variables: N/A
  769. Subroutine Call: N/A;
  770. Reference: N/A
  771. ****************************************************************/
  772. void mn_voEEHistoryParaUpdate(void)
  773. {
  774. stHistoryPara.uwAssModSelect.uwReal = ass_ParaSet.uwAsssistSelectNum;
  775. stHistoryPara.uwOpenTimes.uwReal = cp_stHistoryPara.uwOpenTimes;
  776. stHistoryPara.uwUsedTimeH.uwReal = (UWORD)(cp_stHistoryPara.ulUsedTime >> 16);
  777. stHistoryPara.uwUsedTimeL.uwReal = (UWORD)cp_stHistoryPara.ulUsedTime;
  778. stHistoryPara.swNTCTempMaxCe.swReal = cp_stHistoryPara.swNTCTempMaxCe;
  779. stHistoryPara.swNTCTempMinCe.swReal = cp_stHistoryPara.swNTCTempMinCe;
  780. stHistoryPara.uwAlamHOcurTimes.uwReal = cp_stHistoryPara.uwAlamHOcurTimes;
  781. stHistoryPara.uwAlamSOcurTimes.uwReal = cp_stHistoryPara.uwAlamSOcurTimes;
  782. stHistoryPara.uwAlamOHeatTimes.uwReal = cp_stHistoryPara.uwAlamOHeatTimes;
  783. stHistoryPara.uwAlamRotorLockTimes.uwReal = cp_stHistoryPara.uwAlamRotorLockTimes;
  784. stHistoryPara.uwAlamPhsLossTimes.uwReal = cp_stHistoryPara.uwAlamPhsLossTimes;
  785. stHistoryPara.uwAlamOVolTimes.uwReal = cp_stHistoryPara.uwAlamOVolTimes;
  786. stHistoryPara.uwAlamUVolTimes.uwReal = cp_stHistoryPara.uwAlamUVolTimes;
  787. stHistoryPara.uwAlamComOTimeTimes.uwReal = cp_stHistoryPara.uwAlamComOTimeTimes;
  788. stHistoryPara.uwG1AvgPwrConsumption.uwReal = cp_stHistoryPara.uwG1AvgPwrConsumption;
  789. stHistoryPara.uwG2AvgPwrConsumption.uwReal = cp_stHistoryPara.uwG2AvgPwrConsumption;
  790. stHistoryPara.uwG3AvgPwrConsumption.uwReal = cp_stHistoryPara.uwG3AvgPwrConsumption;
  791. stHistoryPara.uwG4AvgPwrConsumption.uwReal = cp_stHistoryPara.uwG4AvgPwrConsumption;
  792. stHistoryPara.uwG5AvgPwrConsumption.uwReal = cp_stHistoryPara.uwG5AvgPwrConsumption;
  793. stHistoryPara.uwODOTripH.uwReal = (UWORD)(cp_stHistoryPara.ulODOTrip >> 16);
  794. stHistoryPara.uwODOTripL.uwReal = (UWORD)cp_stHistoryPara.ulODOTrip;
  795. stHistoryPara.uwODOTimeH.uwReal = (UWORD)(cp_stHistoryPara.ulODOTime >> 16);
  796. stHistoryPara.uwODOTimeL.uwReal = (UWORD)cp_stHistoryPara.ulODOTime;
  797. stHistoryPara.uwTripSumH.uwReal = (UWORD)(cp_stHistoryPara.ulTripSum >> 16);
  798. stHistoryPara.uwTripSumL.uwReal = (UWORD)cp_stHistoryPara.ulTripSum;
  799. stHistoryPara.uwTripSumTimeH.uwReal = (UWORD)(cp_stHistoryPara.ulTripSumTime >> 16);
  800. stHistoryPara.uwTripSumTimeL.uwReal = (UWORD)cp_stHistoryPara.ulTripSumTime;
  801. stHistoryPara.uwTorSensorAlamTimes.uwReal = cp_stHistoryPara.uwTorSensorAlamTimes;
  802. stHistoryPara.uwCadSensorAlamTimes.uwReal = cp_stHistoryPara.uwCadSensorAlamTimes;
  803. stHistoryPara.uwBikeSpdSensorAlamTimes.uwReal = cp_stHistoryPara.uwBikeSpdSensorAlamTimes;
  804. stHistoryPara.uwPosSensorAlamTimes.uwReal = cp_stHistoryPara.uwPosSensorAlamTimes;
  805. stHistoryPara.uwRealODOTripH.uwReal = (UWORD)(cp_stHistoryPara.ulRealODOTrip >> 16);
  806. stHistoryPara.uwRealODOTripL.uwReal = (UWORD)cp_stHistoryPara.ulRealODOTrip;
  807. stHistoryPara.uwRealODOTimeH.uwReal = (UWORD)(cp_stHistoryPara.ulRealODOTime >> 16);
  808. stHistoryPara.uwRealODOTimeL.uwReal = (UWORD)cp_stHistoryPara.ulRealODOTime;
  809. if (MC_UpcInfo.stRideParaInfo.uwSaveFlg == TRUE)
  810. {
  811. Syspara2.stRidePara.ucAssistRatioGain1.ucReal = ass_stCalCoef.ucAssistRatioGain[0];
  812. Syspara2.stRidePara.ucAssistRatioGain2.ucReal = ass_stCalCoef.ucAssistRatioGain[1];
  813. Syspara2.stRidePara.ucAssistRatioGain3.ucReal = ass_stCalCoef.ucAssistRatioGain[2];
  814. Syspara2.stRidePara.ucAssistRatioGain4.ucReal = ass_stCalCoef.ucAssistRatioGain[3];
  815. Syspara2.stRidePara.ucAssistRatioGain5.ucReal = ass_stCalCoef.ucAssistRatioGain[4];
  816. Syspara2.stRidePara.ucAssistAccelerationGain1.ucReal = ass_stCalCoef.ucAssistAccelerationGain[0];
  817. Syspara2.stRidePara.ucAssistAccelerationGain2.ucReal = ass_stCalCoef.ucAssistAccelerationGain[1];
  818. Syspara2.stRidePara.ucAssistAccelerationGain3.ucReal = ass_stCalCoef.ucAssistAccelerationGain[2];
  819. Syspara2.stRidePara.ucAssistAccelerationGain4.ucReal = ass_stCalCoef.ucAssistAccelerationGain[3];
  820. Syspara2.stRidePara.ucAssistAccelerationGain5.ucReal = ass_stCalCoef.ucAssistAccelerationGain[4];
  821. Syspara2.stRidePara.ucMaxCurrentGain1.ucReal = ass_stCalCoef.ucMaxCurrentGain[0];
  822. Syspara2.stRidePara.ucMaxCurrentGain2.ucReal = ass_stCalCoef.ucMaxCurrentGain[1];
  823. Syspara2.stRidePara.ucMaxCurrentGain3.ucReal = ass_stCalCoef.ucMaxCurrentGain[2];
  824. Syspara2.stRidePara.ucMaxCurrentGain4.ucReal = ass_stCalCoef.ucMaxCurrentGain[3];
  825. Syspara2.stRidePara.ucMaxCurrentGain5.ucReal = ass_stCalCoef.ucMaxCurrentGain[4];
  826. Syspara2.stRidePara.ucMaxTorqueGain1.ucReal = ass_stCalCoef.ucMaxTorqueGain[0];
  827. Syspara2.stRidePara.ucMaxTorqueGain2.ucReal = ass_stCalCoef.ucMaxTorqueGain[1];
  828. Syspara2.stRidePara.ucMaxTorqueGain3.ucReal = ass_stCalCoef.ucMaxTorqueGain[2];
  829. Syspara2.stRidePara.ucMaxTorqueGain4.ucReal = ass_stCalCoef.ucMaxTorqueGain[3];
  830. Syspara2.stRidePara.ucMaxTorqueGain5.ucReal = ass_stCalCoef.ucMaxTorqueGain[4];
  831. }
  832. if (MC_UpcInfo.stBikeInfo2.uwSaveFlg == TRUE)
  833. {
  834. Syspara2.stBikePara2.uwNoneOBCEnable.uwReal = (UWORD)ass_ParaCong.uwNoneOBCEnable;
  835. Syspara2.stBikePara2.uwRearLightCycle.uwReal = (UWORD)ass_ParaCong.uwRearLightCycle;
  836. Syspara2.stBikePara2.uwRearLightDuty.uwReal = (UWORD)ass_ParaCong.uwRearLightDuty;
  837. Syspara2.stBikePara2.swDeltaBikeSpeedLimit.swReal = (SWORD)ass_ParaCong.swDeltaBikeSpeedLimit;
  838. }
  839. }
  840. /***************************************************************
  841. Function: mn_voSoftwareInit;
  842. Description:software intial
  843. Call by:
  844. Input Variables: N/A
  845. Output/Return Variables: N/A
  846. Subroutine Call: N/A;
  847. Reference: N/A
  848. ****************************************************************/
  849. void mn_voSoftwareInit(void)
  850. {
  851. /* System coefficient calculate */
  852. cof_voSysInit();
  853. /* Event parameter init */
  854. event_voInit();
  855. /* Motor parameter init */
  856. // mn_voMtParInit();
  857. /* PowerInit */
  858. power_voPowerInit();
  859. /* Control Parameters init */
  860. mn_voMcParInit();
  861. /*cmd handle Initial */
  862. cmd_voCmdInit();
  863. /* FSM init */
  864. FSM_voInit();
  865. RUN_FSM_voInit();
  866. Switch_speed_FSMInit();
  867. /* TempInit */
  868. TempInit();
  869. /* BikeSpeedInit */
  870. bikespeed_voBikeSpeedInit();
  871. /* CadenceInit */
  872. cadence_voCadenceInit();
  873. Can_voInitMC_Run();
  874. mn_voControlPareSet();
  875. /* Alarm init */
  876. alm_voCoef();
  877. /* ADC init */
  878. adc_voSampleInit();
  879. adc_voSampleCoef(&adc_stCof);
  880. /* UART init */
  881. //uart_voMonitorInit();
  882. //profiler_init();
  883. }
  884. /************************************************************************
  885. Function: void mn_voMtParInit(void)
  886. Description:
  887. Call by:
  888. Input Variables:
  889. Output/Return Variables:
  890. Subroutine Call:
  891. Reference:
  892. ************************************************************************/
  893. void mn_voMtParInit(void)
  894. {
  895. mn_swIdTurn1Pu = ((SLONG)M_LD_TURN1_ID_AP << 14) / cof_uwIbAp; // Q14, saturation current of Ld
  896. mn_slLdTurn1Pu = ((SLONG)M_LD_TURN1_LD_MH << 10) / cof_uwLbHm; // Q10, saturation inductance of Ld
  897. mn_swIdTurn2Pu = ((SLONG)M_LD_TURN2_ID_AP << 14) / cof_uwIbAp; // Q14, saturation current of Ld
  898. mn_slLdTurn2Pu = ((SLONG)M_LD_TURN2_LD_MH << 10) / cof_uwLbHm; // Q10, saturation inductance of Ld
  899. if (mn_swIdTurn1Pu == mn_swIdTurn2Pu)
  900. {
  901. mn_swKLdSat = 0;
  902. }
  903. else
  904. {
  905. mn_swKLdSat = ((mn_slLdTurn2Pu - mn_slLdTurn1Pu) << 10) / (mn_swIdTurn2Pu - mn_swIdTurn1Pu); // Q10
  906. }
  907. mn_swIqTurn1Pu = ((SLONG)M_LQ_TURN1_IQ_AP << 14) / cof_uwIbAp; // Q14, saturation current of Lq
  908. mn_slLqTurn1Pu = ((SLONG)M_LQ_TURN1_LQ_MH << 10) / cof_uwLbHm; // Q10, saturation inductance of Lq
  909. mn_swIqTurn2Pu = ((SLONG)M_LQ_TURN2_IQ_AP << 14) / cof_uwIbAp; // Q14, saturation current of Lq
  910. mn_slLqTurn2Pu = ((SLONG)M_LQ_TURN2_LQ_MH << 10) / cof_uwLbHm; // Q10, saturation inductance of Lq
  911. if (mn_swIqTurn1Pu == mn_swIqTurn2Pu)
  912. {
  913. mn_swKLqSat = 0;
  914. }
  915. else
  916. {
  917. mn_swKLqSat = ((mn_slLqTurn2Pu - mn_slLqTurn1Pu) << 10) / (mn_swIqTurn2Pu - mn_swIqTurn1Pu); // Q10
  918. }
  919. }
  920. /************************************************************************
  921. Function: void mn_voMcParInit(void)
  922. Description:
  923. Call by:
  924. Input Variables:
  925. Output/Return Variables:
  926. Subroutine Call:
  927. Reference:
  928. ************************************************************************/
  929. void mn_voMcParInit(void)
  930. {
  931. align_voInit();
  932. // Align Parameters
  933. mn_uwAlignCurPu = CUR_AP2PU(cp_stControlPara.swAlignCurAp); // Q14
  934. mn_ulAlignRampTbcCt = TBC_MS2CT(cp_stControlPara.swAlignRampTMms);
  935. mn_ulAlignHoldTbcCt = TBC_MS2CT(cp_stControlPara.swAlignHoldTMms);
  936. if (mn_ulAlignRampTbcCt == 0)
  937. {
  938. mn_ulAlignCurIncPerTbcPu = 1;
  939. }
  940. else
  941. {
  942. mn_ulAlignCurIncPerTbcPu = ((ULONG)mn_uwAlignCurPu << 15) / mn_ulAlignRampTbcCt; // Q29
  943. if (mn_ulAlignCurIncPerTbcPu == 0)
  944. {
  945. mn_ulAlignCurIncPerTbcPu = 1;
  946. }
  947. }
  948. mn_slAlignAngInit = ANG_DEG2PU(cp_stControlPara.swAlignAngInitDeg);
  949. // Open Drag Parameters
  950. mn_uwDragCurPu = CUR_AP2PU(cp_stControlPara.swDragCurAp); // Q14
  951. mn_uwDragSpdPu = SPD_HZ2PU(cp_stControlPara.swDragSpdHz); // Q15
  952. mn_ulDragSpdRampTbcCt = TBC_MS2CT(cp_stControlPara.swDragSpdRampTMms);
  953. if (mn_ulDragSpdRampTbcCt == 0)
  954. {
  955. mn_ulDragSpdIncPerTbcPu = 1;
  956. }
  957. else
  958. {
  959. mn_ulDragSpdIncPerTbcPu = ((ULONG)mn_uwDragSpdPu << 14) / mn_ulDragSpdRampTbcCt; // Q29
  960. if (mn_ulDragSpdIncPerTbcPu == 0)
  961. {
  962. mn_ulDragSpdIncPerTbcPu = 1;
  963. }
  964. }
  965. // Open to Close Parameters
  966. mn_ulOpen2ClzCurRampTbcCt = TBC_MS2CT(cp_stControlPara.swOpen2ClzRampTMms);
  967. if (mn_ulOpen2ClzCurRampTbcCt == 0)
  968. {
  969. mn_ulOpen2ClzCurIncPerTbcPu = 1;
  970. }
  971. else
  972. {
  973. mn_ulOpen2ClzCurIncPerTbcPu = (ULONG)mn_uwDragCurPu / mn_ulOpen2ClzCurRampTbcCt;
  974. if (mn_ulOpen2ClzCurIncPerTbcPu == 0)
  975. {
  976. mn_ulOpen2ClzCurIncPerTbcPu = 1;
  977. }
  978. }
  979. // Stop Parameters
  980. mn_uwStopSpdRefPu = SPD_RPM2PU(cp_stControlPara.swStopSpdRefRpm);
  981. }
  982. void LED_ResDispaly(void)
  983. {
  984. uint32_t icnt;
  985. for(icnt=0;icnt<3;icnt++)
  986. {
  987. IO_FORWARDLED_ON();
  988. delay_125us(2000);
  989. IO_FORWARDLED_OFF();//关前灯
  990. delay_125us(2000);
  991. }
  992. }
  993. /*************************************************************************
  994. Copyright (c) 2018 Welling Motor Technology(Shanghai) Co. Ltd.
  995. All rights reserved.
  996. *************************************************************************/
  997. #ifdef _MAIN_C_
  998. #undef _MAIN_C_
  999. #endif
  1000. /*************************************************************************
  1001. End of this File (EOF)!
  1002. Do not put anything after this part!
  1003. *************************************************************************/