user.h 25 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458
  1. /************************************************************************
  2. Project: Welling Motor Control Paltform
  3. Filename: user.h
  4. Partner Filename: Null
  5. Description: User parameters
  6. Complier: IAR Embedded Workbench for ARM 7.80, IAR Systems.
  7. CPU TYPE : STM32F30x
  8. *************************************************************************
  9. Copyright (c) 2019 Welling Motor Technology(Shanghai) Co. Ltd.
  10. All rights reserved.
  11. *************************************************************************
  12. *************************************************************************
  13. Revising History (ECL of this file):
  14. ************************************************************************/
  15. #ifndef USER_H
  16. #define USER_H
  17. /************************************************************************
  18. Compiler Directives
  19. *************************************************************************/
  20. #include "typedefine.h"
  21. /************************************************************************
  22. Definitions & Macros
  23. *************************************************************************/
  24. /*======================================================================*
  25. Update Time
  26. 2021-06-21 13:47:04
  27. *=======================================================================*/
  28. /*======================================================================*
  29. Software version
  30. *=======================================================================*/
  31. #define SOFTWARE_VERSION 0x1C10
  32. #define SOFTWARE_VERSION_WELLING 0x0001
  33. /*======================================================================*
  34. Motor Parameters
  35. *=======================================================================*/
  36. /*======================================================================*
  37. Motor Number Selection
  38. *=======================================================================*/
  39. #define MOTOR_WELLING_CITY 0x20
  40. #define MOTOR_WELLING_MTB 0x21
  41. #define MOTOR_ID_SEL MOTOR_WELLING_MTB //
  42. /*======================================================================*
  43. Motor Parameters
  44. *=======================================================================*/
  45. #if (MOTOR_ID_SEL == MOTOR_WELLING_MTB)
  46. #define M_POLE_PAIRS 7 // unit:Null,Pole pairs
  47. #define M_RS_OHM 170 // unit: 0.1mOhm, Phase resistance
  48. #define M_MATERIAL Al // unit:Null
  49. #define M_LD_NOLOAD_MH 11000 // unit: 0.01uH, D axis inductance
  50. #define M_LQ_NOLOAD_MH 11500 // unit: 0.01uH, Q axis inductance
  51. #define M_LD_TURN1_ID_AP 5000 // unit: 0.01A,
  52. #define M_LD_TURN1_LD_MH 11000 // unit: 0.01uH,D axis inductance
  53. #define M_LD_TURN2_ID_AP 700 // unit: 0.01A,
  54. #define M_LD_TURN2_LD_MH 11000 // unit: 0.01uH,D axis inductance
  55. #define M_LD_MIN_MH 11000 // unit: 0.01uH,D axis inductance
  56. #define M_LQ_TURN1_IQ_AP 200 // unit: 0.01A,
  57. #define M_LQ_TURN1_LQ_MH 11500 // unit: 0.01uH,Q axis inductance
  58. #define M_LQ_TURN2_IQ_AP 700 // unit: 0.01A,
  59. #define M_LQ_TURN2_LQ_MH 11500 // unit: 0.01uH,Q axis inductance
  60. #define M_LQ_MIN_MH 11500 // unit: 0.01uH,Q axis inductance
  61. #define M_JD 500 // unit: 10-7Kg*m2, Rotational inertia
  62. #define M_MAGNETIC_MATERIAL Ferrite // unit:Null
  63. #define M_FLUX_WB 5360 // unit: 0.001mWb, Flux linkage
  64. #define M_ID_MAX_AP 0 //-25 // unit: 0.01A, Max d axis current
  65. #define M_ID_MIN_AP -300 // unit: 0.01A, Min d axis current
  66. #define M_IS_PEAK_MAX_AP 5500 // unit: 0.01A, Max phase current(below base speed)
  67. #define M_POWER_MAX_WT 600 // unit: W, Max power
  68. #define M_R_SPD_RPM 5000 // unit: r/min, rate spd
  69. #define M_R_PWR_WT 250 // unit: W, rate power
  70. #define M_R_IRMS_A 2500 // unit: 0.01A, rate Irms
  71. #define M_R_UDC_v 360 // unit: 0.1V, rate Udc
  72. #define M_MAX_TOR_NM 30 // unit: 0.1Nm, Max tor
  73. #endif
  74. #if (MOTOR_ID_SEL == MOTOR_WELLING_CITY)
  75. #define M_POLE_PAIRS 7 // unit:Null,Pole pairs
  76. #define M_RS_OHM 150 // unit: 0.1mOhm, Phase resistance
  77. #define M_MATERIAL Al // unit:Null
  78. #define M_LD_NOLOAD_MH 7650 // unit: 0.01uH, D axis inductance
  79. #define M_LQ_NOLOAD_MH 10200 // unit: 0.01uH, Q axis inductance
  80. #define M_LD_TURN1_ID_AP 5000 // unit: 0.01A,
  81. #define M_LD_TURN1_LD_MH 7650 // unit: 0.01uH,D axis inductance
  82. #define M_LD_TURN2_ID_AP 700 // unit: 0.01A,
  83. #define M_LD_TURN2_LD_MH 7650 // unit: 0.01uH,D axis inductance
  84. #define M_LD_MIN_MH 7650 // unit: 0.01uH,D axis inductance
  85. #define M_LQ_TURN1_IQ_AP 200 // unit: 0.01A,
  86. #define M_LQ_TURN1_LQ_MH 10200 // unit: 0.01uH,Q axis inductance
  87. #define M_LQ_TURN2_IQ_AP 700 // unit: 0.01A,
  88. #define M_LQ_TURN2_LQ_MH 10200 // unit: 0.01uH,Q axis inductance
  89. #define M_LQ_MIN_MH 10200 // unit: 0.01uH,Q axis inductance
  90. #define M_JD 300 // unit: 10-7Kg*m2, Rotational inertia
  91. #define M_MAGNETIC_MATERIAL Ferrite // unit:Null
  92. #define M_FLUX_WB 4800//5056 // unit: 0.001mWb, Flux linkage
  93. #define M_ID_MAX_AP 0 //-25 // unit: 0.01A, Max d axis current
  94. #define M_ID_MIN_AP -300 // unit: 0.01A, Min d axis current
  95. #define M_IS_PEAK_MAX_AP 5500 // unit: 0.01A, Max phase current(below base speed)
  96. #define M_POWER_MAX_WT 600 // unit: W, Max power
  97. #define M_R_SPD_RPM 5000 // unit: r/min, rate spd
  98. #define M_R_PWR_WT 250 // unit: W, rate power
  99. #define M_R_IRMS_A 2500 // unit: 0.01A, rate Irms
  100. #define M_R_UDC_v 360 // unit: 0.1V, rate Udc
  101. #define M_MAX_TOR_NM 30 // unit: 0.1Nm, Max tor
  102. #endif
  103. /*======================================================================*
  104. IPM Paremeters
  105. *=======================================================================*/
  106. /* SL IPM */
  107. #define IPM_TURN_ON_TM_NS 300 // 86 // unit:ns
  108. #define IPM_TURN_OFF_TM_NS 300 // 105 // unit:ns
  109. #define IPM_DEAD_TM_NS 1000 // unit:ns
  110. #define IPM_HVIC_CHRG_TM 20 // unit: ms,Bootstrap capacitor charge time
  111. /*======================================================================*
  112. Alarm threshold value & time of duration define
  113. *=======================================================================*/
  114. /* Over current */
  115. #define ALM_OVR_CNT_VAL 6400 // unit: 0.01A, Threshold value
  116. #define ALM_OVR_CNT_TM 500 // unit: us, Time of duration(TBC)
  117. /* Phase loss */
  118. #define ALM_PHS_LOSS_VAL 50 // unit: 0.01A, Threshold value
  119. #define ALM_PHS_LOSS_TM 5 // unit: s, Time of duration(TBC)
  120. /* Rotor lock */
  121. #define ALM_ROTOR_LOCK_SPD_K 30 // unit: %, Q10, Ratio of resistance power and motor input power
  122. #define ALM_ROTOR_LOCK_TM 3 // unit: s, Time of duration(TBC)
  123. #define ALM_ROTOR_LOCK_IQ_ABS 4500 // unit: 0.01A, Threshold value
  124. #define ALM_ROTOR_LOCK_SPD 100 // unit: rpm, Threshold value
  125. /* Over voltage */
  126. //#define ALM_OVR_VLT_LVL1_VAL 460 // unit: 0.1V, Threshold value level1
  127. //#define ALM_OVR_VLT_LVL1_TM 2 // unit: s, Time of duration level1(TBS)
  128. //#define ALM_OVR_VLT_LVL2_VAL 470 // unit: 0.1V, Threshold value level2
  129. //#define ALM_OVR_VLT_LVL2_TM 100 // unit: ms, Time of duration level2(TBS)
  130. //#define ALM_OVR_VLT_LVL3_VAL 480 // unit: 0.1V, Threshold value level3
  131. //#define ALM_OVR_VLT_LVL3_TM 5 // unit: ms, Time of duration level3(TBS)
  132. #define ALM_OVR_VLT_LVL1_VAL 550 // unit: 0.1V, Threshold value level1
  133. #define ALM_OVR_VLT_LVL1_TM 2 // unit: s, Time of duration level1(TBS)
  134. #define ALM_OVR_VLT_LVL2_VAL 550 // unit: 0.1V, Threshold value level2
  135. #define ALM_OVR_VLT_LVL2_TM 100 // unit: ms, Time of duration level2(TBS)
  136. #define ALM_OVR_VLT_LVL3_VAL 550 // unit: 0.1V, Threshold value level3
  137. #define ALM_OVR_VLT_LVL3_TM 5 // unit: ms, Time of duration level3(TBS)
  138. /* Under voltage */
  139. #define ALM_UNDR_VLT_LVL1_VAL 280 // unit: 0.1V, Threshold value level1
  140. #define ALM_UNDR_VLT_LVL1_TM 2 // unit: s, Time of duration level1(TBS)
  141. #define ALM_UNDR_VLT_LVL2_VAL 260 // unit: 0.1V, Threshold value level2
  142. #define ALM_UNDR_VLT_LVL2_TM 2 // unit: ms, Time of duration level2(TBS)
  143. /* Over speed */
  144. #define ALM_OVR_SPD_VAL 6000 // unit: rpm, Threshold value
  145. #define ALM_OVR_SPD_TM 100 // unit: ms, Time of duration(TBS)
  146. /* ADC self detecting */
  147. #define ALM_ADC_DETE_LOW_VAL 155 // unit: 0.01V, ADC offset Voltage min
  148. #define ALM_ADC_DETE_HIG_VAL 175 // unit: 0.01V, ADC offset Voltage max
  149. /* IPM over heat */
  150. #define ALM_IPM_OVR_HEAT_VAL 105//50 //105 // unit: Ce, Threshold value
  151. #define ALM_IPM_OVR_TM 2 // unit: s, Time of duration(TBS)
  152. #define PWRLIM_START_THRESHOLD_TEMP 85//40 //80 // Q0,Ce
  153. /* Stop time of three phase short force */
  154. #define ALM_THR_PHS_SHRT_FRC_TM 200 // unit: ms, Time of duration(TBC)
  155. /* Stop time of pwm off */
  156. #define ALM_PWM_OFF_TM 200 // unit: ms, Time of duration(TBC)
  157. #define ALM_PWMOFF_SHRT1_SW_TM 100 // unit: ms, Time of duration(TBC)
  158. /* Stop time of three phase short */
  159. #define ALM_THR_PHS_SHRT_NORM_TM 100 // unit: ms, Time of duration(TBC)
  160. #define ALM_SHRT_PWMOFF_SW_TM 100 // unit: ms, Time of duration(TBC)
  161. /* Stop Minimum Current */
  162. #define ALM_STOP_IPM_OVER_CUR_TM 100 // unit: ms, Time of duration(TBC)
  163. /* Recover time of global */
  164. #define ALM_REC_ALL_TM 200 // unit: ms, Time of duration(TBC)
  165. /* Recover time of IPM OC */
  166. #define ALM_IPM_OC_REC_TM 200 // unit: ms, Time of duration(TBC)
  167. /* Recover time & value of over voltage */
  168. #define ALM_OVR_VLT_REC_VAL 450 // unit: 0.1V
  169. #define ALM_OVR_VLT_REC_TM 100 // unit: ms, Time of duration(TBC)
  170. #define ALM_OVR_VLT_REC_TM1 150 // unit: ms, Time of duration(TBC)
  171. /* Recover time & value of under voltage */
  172. #define ALM_UNDR_VLT_REC_VAL 300 // unit: 0.1V
  173. #define ALM_UNDR_VLT_REC_TM 200 // unit: ms, Time of duration(TBC)
  174. #define ALM_UNDR_VLT_REC_TM1 400 // unit: ms, Time of duration(TBC)
  175. /* Recover time & value of IPM over heat */
  176. #define ALM_IPM_OVR_HEAT_REC_VAL 90 // unit: Ce, Threshold value
  177. #define ALM_IPM_OVR_REC_TM 60 // unit: s, Time of duration(TBC)
  178. #define ALM_IPM_OVR_REC_TM1 120 // unit: s, Time of duration(TBC)
  179. /* Ebike sensor fault detect*/
  180. #define ALM_MOTORSPD_MIN_RPM 50 //unit: s
  181. #define ALM_BIKESPD_FLT_TS 10 //unit: s
  182. #define ALM_CADENCE_FLT_TS 2 //unit: s
  183. #define ALM_TORQ_MAX_VOL 30 //unit: 0.1V
  184. #define ALM_TORQ_MIN_VOL 1 //unit: 0.1V
  185. #define ALM_TORQ_FLT_TS 1 //unit: s
  186. #define ALM_THROTTLE_MAX_VOL 30 //unit: 0.1V
  187. #define ALM_THROTTLE_MIN_VOL 1 //unit: 0.1V
  188. #define ALM_THROTTLE_FLT_TS 1 //unit: s
  189. #define ALM_NTC_MAX_VOL 32 //unit: 0.1V
  190. #define ALM_NTC_MIN_VOL 3 //unit: 0.1V
  191. #define ALM_MOTORNTC_FLT_TS 1 //unit: s
  192. #define ALM_PCBNTC_FLT_TS 1 //unit: s
  193. /* Ebike sensor fault recover*/
  194. #define ALM_BIKE_REC_ALL_TM 1000 //unit: ms
  195. #define ALM_BIKESPD_REC_TM 200 //unit: ms
  196. #define ALM_CADENCE_REC_TM 200 //unit: ms
  197. #define ALM_TORQ_REC_TM 200 //unit: ms
  198. #define ALM_THROTTLE_REC_TM 200 //unit: ms
  199. #define ALM_MOTORNTC_REC_TM 200 //unit: ms
  200. #define ALM_PCBNTC_REC_TM 200 //unit: ms
  201. /*======================================================================*
  202. Motor start
  203. *=======================================================================*/
  204. /* Start mode */
  205. #define START_ALIGN 0 // Motor start with three stage
  206. #define START_MODE START_ALIGN // Motor start mode
  207. /* InitPosDet mode */
  208. #define INITPOS_ALIGN 0 // Motor start with three stage
  209. #define INITPOS_MODE INITPOS_ALIGN // Motor initposdet mode
  210. /* Park time & current */
  211. #define ALIGN_CUR_AP 1000 // unit: 0.01A, Park current value
  212. #define ALIGN_RAMP_TM_MS 500 // unit: ms, Time of current ramp
  213. #define ALIGN_HOLD_TM_MS 2000 // unit: ms, Time of current hold
  214. #define ALIGN_ANG_INIT 0 // unit: deg, Park angle init, can not be 90deg
  215. /* Drag speed & current */
  216. #define DRAG_CUR_AP 1000 // 1500 //100 Huawei // unit: 0.01A, Drag current value
  217. #define DRAG_VOL_AP 18 // 0.1v
  218. #define DRAG_SPD_HZ 20 // unit: Hz, Final speed of drag
  219. #define DRAG_SPD_RAMP_TM_MS 4000 // unit: ms, Time of speed from 0Hz to target Hz
  220. /* Open to close */
  221. #define OPEN2CLZ_CUR_RAMP_TM_MS 5000 // 5000//1000 Huawei // unit: ms, Time of current from drag value to 0
  222. /* Close loop */
  223. /* stop loop */
  224. #define STOP_SPD_REF_RPM 100 // unit: rpm, Speed reference value when status go to stop
  225. /*======================================================================*
  226. Flux observer
  227. *=======================================================================*/
  228. #define OBS_SPD_PLL_M 2 // Flux observer m coefficient
  229. #define OBS_SPD_PLL_BANDWIDTH_HZ 150 // Huawei // Flux observer PLL bandwidth
  230. #define OBS_FLUX_PI_DAMPRATIO 10 // unit:0.1, Flux observer PI regulator dampratio
  231. #define OBS_FLUX_PI_CROSSFREQ_HZ 10 // unit:Hz, Flux observer PI regulator crossfrequency
  232. /*======================================================================*
  233. Current loop PI regulation
  234. *=======================================================================*/
  235. #define ACR_PI_BANDWIDTH_FLX 300 // unit: Hz, Current loop bandwidth when flux observer run
  236. #define ACR_CUR_FLX_FBK_LPF_FRQ 8000 // unit: Hz, Frequency of current feedback LPF when flux observer run
  237. #define ACR_CUR_OUT_LIM 37837 // Q15, 2/sqrt(3)*Vdc for current output limit //18919
  238. #define ACR_RA_COEF 1 // Coefficient of Active Resistance
  239. #define ACR_UDCP_OUT_LIM 18918 // Q15, 2/3*Vdc for Udcp output limit //18918 //21845 //10923
  240. /*======================================================================*
  241. Speed loop PI regulation
  242. *=======================================================================*/
  243. #define ASR_PI_BANDWIDTH 3 //15 // unit: Hz, Speed loop bandwidth
  244. #define ASR_PI_M 4 //
  245. #define ASR_SPD_FBK_LPF_FRQ 50 //
  246. #define ASR_SPD_INER_RATE 1 //
  247. /*=====================================================================*
  248. PWM generation
  249. *=======================================================================*/
  250. #define PWM_MAX_DUTY_CYLE_IPM 880 // 938 // unit: 0.1%,Max duty cyle for compare value
  251. #define PWM_7SVM_TO_5SVM_DUTY_IPM 700 // unit: 0.1%, Switch ratio from 7 to 5 svpwm
  252. #define PWM_MIN_SAMPLE_DUTY1_IPM 5 * 10000 / PWM_PERIOD_US // unit: 0.1%, 5us TWO MIN ZERO VECTOR = two sample current steady time
  253. #define PWM_MIN_SAMPLE_DUTY2_IPM 10 * 10000 / PWM_PERIOD_US // unit: 0.1%, 10us TWO (one sample current steady time + one sample time)
  254. #define PWM_MIN_SAMPLE_DUTY3_IPM \
  255. ((ULONG)6 * 10000 / PWM_PERIOD_US) // unit: 0.1%, 6 us TWO (one Singel Resistance sample current steady time + one sample time)
  256. #define PWM_SAMPLE_TOSTEADY_IPM ((ULONG)8 * 10000 / PWM_PERIOD_US) // unit: 0.1%, 4us TWO sample current to steady time
  257. #define PWM_SAMPLE_SINGELRESIS_IPM ((ULONG)1 * 10000 / PWM_PERIOD_US) // unit: 0.1%, 1us TWO singel Resistance sample time
  258. #define PWM_1ST_SAMPLE_CTS_IPM 25//43 // 25 // unit: Null, first current sample counts
  259. #define PWM_2ND_SAMPLE_CTS_IPM 220//280 // 220 // unit: Null, second current sample counts
  260. #define PWM_MIN_EFF_VECTOR_CTS_IPM 245//323 // unit: Null, Min effective vector counts
  261. #define PWM_MIN_EFF_VECTOR_PU_IPM 892//1176 // 600 // unit: Q14, Min effective vector pu
  262. #define PWM_OVR_MDL_MIN_PHS 0 // SVPWM over modulation: min phase error
  263. #define PWM_OVR_MDL_MIN_AMP 1 // SVPWM over modulation: min amplitude error
  264. #define PWM_OVR_MDL_OPTIMUM 2 // SVPWM over modulation: amplitude and phase optimum
  265. #define PWM_OVR_MDL_SEL PWM_OVR_MDL_MIN_PHS //
  266. /*======================================================================*
  267. Flux Weakening
  268. *=======================================================================*/
  269. #define FW_VDC_MIN_CALC_TM 20 // unit: ms,50Hz=>20ms, period of Vdc fluctuate
  270. #define FW_VDC_LPF_FRQ 50 // unit: Hz, Frequency of Vdc LPF
  271. #define FW_PWM_MAX_DUTY_CYLE_IPM 880 // unit: 0.1%,PWM max duty cyle for flux weakening
  272. #define FW_ID_PI_OUT_MIN 1000 // unit: 0.01A, Min Id of PI outunit: 0.01A, Current Limit
  273. #define FW_ID_MIN_LIM_RATIO 80 // Q0:1%, Ratio of Min d axis current (Charactoristic current)
  274. #define FW_ID_KP_PU 10 // Q16, Kp for d axis current
  275. #define FW_ID_KI_PU 5 // Q16, Ki for d axis current
  276. #define FW_CHAR_CUR_CROSS_FREQ 2 // Q0,unit: SQRT(1/2piR)
  277. #define FW_CHAR_CUR_DAMP_RATIO 2 // Q0,unit: SQRT(pi/2R)
  278. /*======================================================================*
  279. Constant Voltage Braking Parameter define
  280. *=======================================================================*/
  281. #define CVB_CONSTANT_VOL_BRAKE_V 42 // unit:0.1V,Voltage limit of Constant Voltage Brake
  282. #define CVB_CONSTANT_SPD_LOW_RPM 1000 // unit:rpm,
  283. /*======================================================================*
  284. Power limit
  285. *=======================================================================*/
  286. #define PWRLIM_VAL 6500 // unit: 0.1w, Power limit value
  287. #define PWRLIM_ERR 500 // unit: 0.1w, Start power limit when "VAL - ERR"
  288. #define PWRLIM_LPF_FRQ 8000 // unit: Hz, Frequency of LPF in input power of motor
  289. #define PWR_IQ_LIMIT_KP_PU 20 // Q15
  290. #define PWR_IQ_LIMIT_KI_PU 3000 // Q15
  291. /*======================================================================*
  292. Deadband compensation
  293. *=======================================================================*/
  294. #define DBC_K_COEF 300 // unit:0.1V/A Deadband compensation slope coefficient
  295. /*======================================================================*
  296. Communication type define
  297. *=======================================================================*/
  298. #define UART_MONITOR 0 //
  299. #define UART_HOST 1 //
  300. #define UART_TYPE UART_HOST //
  301. /*==============================================================================
  302. Speed & Acc Constant parameters define
  303. ==============================================================================*/
  304. #define USER_MOTOR_45RPM2PU SPD_RPM2PU(45) // 45rpm,Q15
  305. #define USER_MOTOR_100RPM2PU SPD_RPM2PU(100)
  306. #define USER_MOTOR_200RPM2PU SPD_RPM2PU(200)
  307. #define USER_MOTOR_300RPM2PU SPD_RPM2PU(300)
  308. #define USER_MOTOR_400RPM2PU SPD_RPM2PU(400)
  309. #define USER_MOTOR_600RPM2PU SPD_RPM2PU(600) // 600rpm,Q15
  310. #define USER_MOTOR_800RPM2PU SPD_RPM2PU(800) // 800rpm,Q15
  311. #define USER_MOTOR_1000RPM2PU SPD_RPM2PU(1000) // 1000rpm,Q15
  312. #define USER_MOTOR_1500RPM2PU SPD_RPM2PU(1500) // 6000rpm,Q15
  313. #define USER_MOTOR_4000RPM2PU SPD_RPM2PU(4000) // 6000rpm,Q15
  314. #define USER_MOTOR_5500RPM2PU SPD_RPM2PU(5500)
  315. #define USER_MOTOR_100RPMPS2PU_Q29 SPD_ACC_RPM2PU(100) // 100rpm/s,(0x40000000/FTBS_Hz/cof_uwVbRpm*100)
  316. /*=======================================================================
  317. TBS&TBC Time Cnts Define
  318. =======================================================================*/
  319. #define TBCCNT_500us (((ULONG)500 * FTBC_HZ) / 1000000)
  320. #define TBCCNT_1ms (((ULONG)1 * FTBC_HZ) / 1000)
  321. #define TBCCNT_5ms (((ULONG)5 * FTBC_HZ) / 1000)
  322. #define TBCCNT_10ms (((ULONG)10 * FTBC_HZ) / 1000)
  323. #define TBCCNT_50ms (((ULONG)50 * FTBC_HZ) / 1000)
  324. #define TBCCNT_32ms (((ULONG)32 * FTBC_HZ) / 1000)
  325. #define TBCCNT_60ms (((ULONG)60 * FTBC_HZ) / 1000)
  326. #define TBCCNT_100ms (((ULONG)100 * FTBC_HZ) / 1000)
  327. #define TBCCNT_150ms (((ULONG)150 * FTBC_HZ) / 1000)
  328. #define TBCCNT_200ms (((ULONG)200 * FTBC_HZ) / 1000)
  329. #define TBCCNT_250ms (((ULONG)250 * FTBC_HZ) / 1000)
  330. #define TBCCNT_300ms (((ULONG)300 * FTBC_HZ) / 1000)
  331. #define TBCCNT_400ms (((ULONG)400 * FTBC_HZ) / 1000)
  332. #define TBCCNT_500ms (((ULONG)500 * FTBC_HZ) / 1000)
  333. #define TBCCNT_100ms (((ULONG)100 * FTBC_HZ) / 1000)
  334. #define EVE1MSCNT_1ms (((ULONG)1 * EVENT_1MS_HZ) / 1000)
  335. #define EVE1MSCNT_5ms (((ULONG)5 * EVENT_1MS_HZ) / 1000)
  336. #define EVE1MSCNT_10ms (((ULONG)10 * EVENT_1MS_HZ) / 1000)
  337. #define EVE1MSCNT_20ms (((ULONG)20 * EVENT_1MS_HZ) / 1000)
  338. #define EVE1MSCNT_50ms (((ULONG)50 * EVENT_1MS_HZ) / 1000)
  339. #define EVE1MSCNT_100ms (((ULONG)100 * EVENT_1MS_HZ) / 1000)
  340. #define EVE1MSCNT_200ms (((ULONG)200 * EVENT_1MS_HZ) / 1000)
  341. #define EVE10MSCNT_3s ((ULONG)3 * EVENT_1MS_HZ / 10)
  342. #define EVE10MSCNT_5s ((ULONG)5 * EVENT_1MS_HZ / 10)
  343. #define EVE10MSCNT_10s ((ULONG)10 * EVENT_1MS_HZ / 10)
  344. /************************************************************************
  345. Comment Table
  346. *************************************************************************/
  347. // /*======================================================================*
  348. // High Frequency Signal Injection
  349. // *=======================================================================*/
  350. // #define HFI_FREQ1_HZ 1200 // unit: Hz, Inject signal frequency 1
  351. // #define HFI_AMP1_VT 600 // unit: 0.1v, Inject signal voltage 1
  352. // #define HFI_FREQ2_HZ 1400 // unit: Hz, Inject signal frequency 2
  353. // #define HFI_AMP2_VT 700 // unit: 0.1v, Inject signal voltage 2
  354. // #define HFI_TM_INIPOS_MS 60 // unit: ms, Initial position detection time
  355. // #define HFI_WAITTM_INIPOS_MS 6 // unit: ms, Wait time after initial position detection
  356. // #define HFI_AMP_POR_VT 700 // unit: 0.1v, Polarity detection voltage amplitude
  357. // #define HFI_TM_POR_PULS_MS 1 // unit: ms, Polarity detection voltage pulse time
  358. // #define HFI_WAITTM_POR_PULS_MS 12 // Wunit: ms, ait time after voltage pulse
  359. // #define HFI_DELTA_CUR_MAG_POR_OK_AP 20 // unit: 0.01A, delta current for polarity detection ok
  360. // #define HFI_CUR_LPF_HZ 500 // unit: Hz, Cut-off frequency of current lpf
  361. // #define HFI_CUR_HPF_HZ 50 // unit: Hz, Cut-off frequency of current hpf
  362. // #define HFI_PLL_DAMPING_RATIO 35 // unit: Null, Pll damping ratio
  363. // #define HFI_PLL_CROSS_FREQ_HZ 20 // unit: Hz, Pll cross frequency
  364. // #define HFI_SPD_LPF_HZ 8 // unit: Hz, Cut-off frequency of spd lpf
  365. // #define HFI_MAG_SATR_AP 240 // unit: 0.01A, Magnetic saturation current
  366. /************************************************************************
  367. TypeDefs & Structure defines
  368. *************************************************************************/
  369. /************************************************************************
  370. Exported Variables:
  371. *************************************************************************/
  372. /************************************************************************
  373. RAM ALLOCATION:
  374. *************************************************************************/
  375. /************************************************************************
  376. Exported Function Call Prototypes (N/A)
  377. *************************************************************************/
  378. /************************************************************************
  379. Local Function Call Prototypes (N/A)
  380. *************************************************************************/
  381. /************************************************************************
  382. Head files (N/A)
  383. *************************************************************************/
  384. #include <stdlib.h>
  385. #include "gd32F30x.h"
  386. #include "CodePara.h"
  387. #include "classB.h"
  388. #include "hwsetup.h"
  389. #include "mathtool.h"
  390. #include "main.h"
  391. #include "spdctrFSM.h"
  392. #include "glbcof.h"
  393. #include "crdnt.h"
  394. #include "tbc.h"
  395. #include "tbs.h"
  396. #include "tbt.h"
  397. #include "alarm.h"
  398. #include "adc.h"
  399. #include "spi_master.h"
  400. #include "i2c_master.h"
  401. #include "spdctrmode.h"
  402. #include "acr.h"
  403. #include "asr.h"
  404. #include "torqobs.h"
  405. #include "obs.h"
  406. #include "dbc.h"
  407. #include "uart_appl.h"
  408. #include "uart_driver.h"
  409. #include "flxwkn.h"
  410. #include "pwm.h"
  411. #include "brake.h"
  412. #include "hfinj.h"
  413. #include "pwrlim.h"
  414. #include "bootloader.h"
  415. #include "brake.h"
  416. #include "uart_monitor_appl.h"
  417. #include "macroequ.h"
  418. #include "alignstartup.h"
  419. #include "switchhall.h"
  420. /************************************************************************
  421. Flag Define (N/A)
  422. *************************************************************************/
  423. #endif
  424. /*************************************************************************
  425. Copyright (c) 2019 Welling Motor Technology(Shanghai) Co. Ltd.
  426. All rights reserved.
  427. *************************************************************************
  428. End of this File (EOF)!
  429. Do not put anything after this part!
  430. *************************************************************************/