Parameter.h 9.3 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156
  1. #ifndef __Parameter_H_
  2. #define __Parameter_H_
  3. #include <SystemDefinition.h>
  4. #define SystemPowerUpTime (15000) // 上电等待时间,cpu计数时钟
  5. /*芯片参数值------------------------------------------------------------------*/
  6. /*CPU and PWM Parameter*/
  7. /*CPU Parameter*/
  8. #define MCU_CLOCK (24.0) ///< (MHz) 主频
  9. #define PWM_CYCLE (1000.0 / PWM_FREQUENCY) ///< 周期us
  10. #define SAMP_FREQ (PWM_FREQUENCY * 1000) ///< 采样频率(HZ)
  11. #define TPWM_VALUE (1.0 / SAMP_FREQ) ///< 载波周期(S)
  12. #define PWM_VALUE_LOAD (uint16)(MCU_CLOCK * 1000 *2 / PWM_FREQUENCY) ///< PWM 定时器重载值 20190514修改
  13. #define SAcc_Value(SpeedValue) ((float)32767.0*(SpeedValue*LOOP_TIME/1000.0) / MOTOR_SPEED_BASE)
  14. /*three resistor overmodule Parameter*/
  15. #define OVERMOD_TIME (2.0) ///< 三电阻过调制时间(us),建议值2.0
  16. /*deadtime compensation*/
  17. #define DT_TIME (0.0) ///< 死区补偿时间(us),适用于双电阻和三电阻,建议值是1/2死区时间
  18. /*min pulse*/
  19. #define GLI_TIME (0.0) ///< 桥臂窄脉宽消除(us),建议值0.5
  20. /*deadtime Parameter*/
  21. #define PWM_LOAD_DEADTIME (PWM_DEADTIME * MCU_CLOCK) ///< 死区设置值
  22. #define PWM_OVERMODULE_TIME (OVERMOD_TIME * MCU_CLOCK / 2) ///< 过调制时间
  23. #define PWM_DLOWL_TIME (DLL_TIME * MCU_CLOCK / 2) ///<下桥臂最小时间
  24. /*single resistor sample Parameter*/
  25. #define PWM_TS_LOAD (uint16)(_Q16 / PWM_CYCLE * MIN_WIND_TIME / 16) ///< 单电阻采样设置值
  26. #define PWM_DT_LOAD (uint16)(_Q16 / PWM_CYCLE * DT_TIME / 16) ///< 死区补偿值
  27. #define PWM_TGLI_LOAD (uint16)(_Q16 / PWM_CYCLE * (GLI_TIME + PWM_DEADTIME) / 16) ///< 最小脉冲
  28. /*硬件板子参数设置值------------------------------------------------------------------*/
  29. /*hardware current sample Parameter*/
  30. #if (HW_ADC_VREF==VREF5_0)
  31. #define HW_ADC_REF (5.0) ///< (V) ADC参考电压
  32. #elif (HW_ADC_VREF==VREF4_5)
  33. #define HW_ADC_REF (4.5) ///< (V) ADC参考电压
  34. #elif (HW_ADC_VREF==VREF4_0)
  35. #define HW_ADC_REF (4.0) ///< (V) ADC参考电压
  36. #elif (HW_ADC_VREF==VREF3_0)
  37. #define HW_ADC_REF (3.0) ///< (V) ADC参考电压
  38. #endif
  39. #define RV ((RV1 + RV2 ) / RV2) ///< 分压比
  40. /* -----时间设置值----- */
  41. #define Calib_Time (1000)
  42. /* -----保护参数值----- */
  43. #define GetCurrentOffsetValueLow (16383-GetCurrentOffsetValue) ///< 偏置电压差值低点
  44. #define GetCurrentOffsetValueHigh (16383+GetCurrentOffsetValue) ///< 偏置电压差值高点
  45. /*电流基准的电路参数*/
  46. #define HW_BOARD_CURR_MAX (HW_ADC_REF / 2 / HW_AMPGAIN / HW_RSHUNT) ///< 最大采样电流
  47. #define HW_BOARD_CURR_MIN (-HW_BOARD_CURR_MAX) ///< 最小采样电流
  48. #define HW_BOARD_CURR_BASE (HW_BOARD_CURR_MAX * 2) ///< 电流基准
  49. /*hardware voltage sample Parameter*/
  50. /*母线电压采样分压电路参数*/
  51. #define HW_BOARD_VOLT_MAX (HW_ADC_REF * RV) ///< (V) ADC可测得的最大母线电压
  52. #define HW_BOARD_VOLTAGE_BASE (HW_BOARD_VOLT_MAX / 1.732) ///< 电压基准
  53. /*硬件过流保护DAC值*/
  54. #define DAC_OverCurrentValue _Q8(I_ValueX(HWOCValue)) + 0x7F ///< 该结果是进行了右移一位的结果
  55. #define Align_Theta _Q15((float)Align_Angle / 180.0)
  56. /* obsever parameter set value */
  57. #define BASE_FREQ ((MOTOR_SPEED_BASE / 60.0) * Pole_Pairs) ///< 基准频率
  58. #define MAX_BEMF_VOLTAGE ((MOTOR_SPEED_BASE*Ke)/(1000.0))
  59. #define MAX_OMEG_RAD_SEC ((float)(_2PI*BASE_FREQ))
  60. #define ATT_COEF (0.85) ///< 无需改动
  61. //自适应估算器模式使能
  62. #if (EstimateAlgorithm == AO)
  63. #define OBS_K1T _Q11((1.0*3.0/(125.0*1.0))*(LQ/TPWM_VALUE)*(HW_BOARD_CURR_BASE/HW_BOARD_VOLTAGE_BASE))
  64. #define OBS_K2T _Q11(0.8*RS*HW_BOARD_CURR_BASE/HW_BOARD_VOLTAGE_BASE)
  65. #define OBS_K3T _Q8(2.5)
  66. #define OBS_K4T _Q15(((LD-LQ)*TPWM_VALUE*MAX_OMEG_RAD_SEC)/(LD+RS*TPWM_VALUE))
  67. #else
  68. #define OBS_K1T _Q15(LD/(LD+RS*TPWM_VALUE))
  69. #define OBS_K2T _Q13(1.4*(TPWM_VALUE/(LD+RS*TPWM_VALUE))*(HW_BOARD_VOLTAGE_BASE/HW_BOARD_CURR_BASE))
  70. #define OBS_K3T _Q15((TPWM_VALUE/(LD+RS*TPWM_VALUE))*(MAX_BEMF_VOLTAGE/HW_BOARD_CURR_BASE))
  71. #define OBS_K4T _Q15(((LD-LQ)*TPWM_VALUE*MAX_OMEG_RAD_SEC)/(LD+RS*TPWM_VALUE))
  72. #endif
  73. #define OBSW_KP_GAIN_START _Q12(2*_2PI*ATT_COEF*ATO_BW_START/BASE_FREQ)
  74. #define OBSW_KI_GAIN_START _Q15(_2PI*ATO_BW_START*ATO_BW_START*TPWM_VALUE/BASE_FREQ)
  75. #define OBSW_KP_GAIN_RUN1 _Q12(2*_2PI*ATT_COEF*ATO_BW_RUN1/BASE_FREQ)
  76. #define OBSW_KI_GAIN_RUN1 _Q15(_2PI*ATO_BW_RUN1*ATO_BW_RUN1*TPWM_VALUE/BASE_FREQ)
  77. #define OBSW_KP_GAIN_RUN2 _Q12(2*_2PI*ATT_COEF*ATO_BW_RUN2/BASE_FREQ)
  78. #define OBSW_KI_GAIN_RUN2 _Q15(_2PI*ATO_BW_RUN2*ATO_BW_RUN2*TPWM_VALUE/BASE_FREQ)
  79. #define OBSW_KP_GAIN_RUN3 _Q12(2*_2PI*ATT_COEF*ATO_BW_RUN3/BASE_FREQ)
  80. #define OBSW_KI_GAIN_RUN3 _Q15(_2PI*ATO_BW_RUN3*ATO_BW_RUN3*TPWM_VALUE/BASE_FREQ)
  81. #define OBSW_KP_GAIN_RUN4 _Q12(2*_2PI*ATT_COEF*ATO_BW_RUN4/BASE_FREQ)
  82. #define OBSW_KI_GAIN_RUN4 _Q15(_2PI*ATO_BW_RUN3*ATO_BW_RUN4*TPWM_VALUE/BASE_FREQ)
  83. #define OBS_FBASE _Q15(BASE_FREQ*TPWM_VALUE) ///< Fbase*Tpwm*32768
  84. #define OBS_KLPF _Q15(_2PI*BASE_FREQ*TPWM_VALUE) ///< 2PI*Fbase*Tpwm
  85. #define SPEED_KLPF _Q15(_2PI*SPD_BW*TPWM_VALUE) ///< 2PI*SPD_BW*Tpwm
  86. #define OBS_EA_KS _Q15((2*MOTOR_SPEED_SMOMIN_RPM*_2PI*BASE_FREQ*TPWM_VALUE)/MOTOR_SPEED_BASE) // SMO的最小速度
  87. /*逆风判断时的估算算法设置值------------------------------------------------------------*/
  88. #define SPEED_KLPF_WIND _Q15(_2PI*SPD_BW_WIND*TPWM_VALUE) ///< 2PI*SPD_BW_Wind*Tpwm
  89. #define OBSW_KP_GAIN_WIND _Q12(2*_2PI*ATT_COEF*ATO_BW_WIND/BASE_FREQ)
  90. #define OBSW_KI_GAIN_WIND _Q15(_2PI*ATO_BW_WIND*ATO_BW_WIND*TPWM_VALUE/BASE_FREQ)
  91. #define OBSE_PLLKP_GAIN _Q11(((2*ATT_COEF*_2PI*E_BW*LD - RS)*HW_BOARD_CURR_BASE)/HW_BOARD_VOLTAGE_BASE)
  92. #define OBSE_PLLKI_GAIN _Q11((_2PI*E_BW*_2PI*E_BW*LD*TPWM_VALUE*HW_BOARD_CURR_BASE)/HW_BOARD_VOLTAGE_BASE)
  93. /* -----Current Calib----- *
  94. /* -----(Disable)---禁止-- */
  95. /* -----(Enable)----使能-- */
  96. #define CalibENDIS (Enable)
  97. /* -----SVPWM mode----- *
  98. /* -----(SVPWM_5_Segment)---五段式-- */
  99. /* -----(SVPWM_7_Segment)---七段式-- */
  100. #define SVPMW_Mode (SVPWM_7_Segment)
  101. /* -----double resistor sample mode----- *
  102. /* -----(DouRes_1_Cycle)---1 周期采样完 ia, ib-- */
  103. /* -----(DouRes_2_Cycle)---交替采用ia, ib, 2周期采样完成-- */
  104. #define DouRes_Sample_Mode (DouRes_1_Cycle)
  105. /* 电机启动参数值 */
  106. //open 算法启动参数
  107. #define MOTOR_OPEN_RAMP_ACC (30.0) ///< 强拖启动的增量(每载波周期加一次)
  108. #define MOTOR_OPEN_RAMP_MIN S_Value(0.0) ///< 强拖启动的初始速度
  109. #define MOTOR_OPEN_RAMP_CNT (100.0) ///< 强拖启动的执行次数(MOTOR_OPEN_ACC_CNT*256)
  110. /* 正常运行时估算算法的参数设置值 */
  111. #define OBS_KSLIDE _Q15(0.85) ///< SMO算法里的滑膜增益值
  112. #define E_BW (450.0) ///< PLL算法里的反电动势滤波值
  113. #define UADC_Value(Xn0) _Q15(Xn0/HW_ADC_REF)
  114. #define PROTECT_POWER(Xn0) ((float)Xn0*235.09)
  115. #define FG_Value (TIM4_Fre / BASE_FREQ / FG_K)
  116. #endif