Etusivu Tutki Apua
Kirjaudu sisään
avery
/
AC-Motor-FU6815
1
0
Fork 0
Tiedostot Ongelmat 0 Pull-pyynnöt 0 Wiki
Puu: 98b8484ed2
Haarat Tagit
AC-Motor-FU6815
/
User
/
include
/
Parameter.h

Parameter.h 13 KB
Historia Raaka

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213 
  1. /**************************** (C) COPYRIGHT 2018 Fortiortech shenzhen *****************************
    2. 

  2. * File Name          : Parameter.h
    3. 

  3. * Author             : Bruce,Fortiortech  RD
    4. 

  4. * Version            : V1.0
    5. 

  5. * Date               : 2017-12-20
    6. 

  6. * Description        : This file contains all FOC debug parameter.
    7. 

  7. ***************************************************************************************************
    8. 

  8. * All Rights Reserved
    9. 

  9. **************************************************************************************************/
    10. 

  10. 

  11. /* Define to prevent recursive inclusion --------------------------------------------------------*/
    12. 

  12. 

  13. #ifndef __Parameter_H_
    14. 

  14. #define __Parameter_H_
    15. 

  15. #include <Myproject.h>
    16. 

  16. /* Define to prevent recursive inclusion -------------------------------------*/
    17. 

  17. /* Q format define ---------------------------------------------------------------------------------*/
    18. 

  18. #define _Q7(A)                          (int8) ((A) * 0x7f)         ///< Q7 format   128*1  = 128
    19. 

  19. #define _Q8(A)                          (int16)((A) * 0xff)         ///< Q8 format   128*2  = 256
    20. 

  20. #define _Q9(A)                          (int16)((A) * 0x1ff)        ///< Q9 format   128*4  = 512
    21. 

  21. #define _Q10(A)                         (int16)((A) * 0x3ff)        ///< Q10 format  128*8  = 1024
    22. 

  22. #define _Q11(A)                         (int16)((A) * 0x07ff)       ///< Q11 format  128*16 = 2048
    23. 

  23. #define _Q12(A)                         (int16)((A) * 0x0fff)       ///< Q12 format  128*32 = 4096
    24. 

  24. #define _Q13(A)                         (int16)((A) * 0x1fff)       ///< Q13 format  128*64 = 8192
    25. 

  25. #define _Q14(A)                         (int16)((A) * 0x3fff)       ///< Q14 format  128*128= 18383
    26. 

  26. #define _Q15(A)                         (int16)((A) * 0x7fff)       ///< Q15 format  128*256= 32767
    27. 

  27. #define _Q16                            (65535.0)                   // Q16 format value
    28. 

  28. #define _2PI                            (3.1415926 * 2) 
    29. 

  29. /*芯片参数值------------------------------------------------------------------*/
    30. 

  30. /*CPU and PWM Parameter*/
    31. 

  31. #define PWM_CYCLE                       (1000.0 / PWM_FREQUENCY)                      // 周期us
    32. 

  32. #define SAMP_FREQ                       (PWM_FREQUENCY * 1000)                        // 采样频率(HZ)
    33. 

  33. #define TPWM_VALUE                      (1.0 / SAMP_FREQ)                             // 载波周期(S)
    34. 

  34. #define PWM_VALUE_LOAD                  (uint16)(MCU_CLOCK * 1000 *2 / PWM_FREQUENCY) // PWM 定时器重载值 20190514修改
    35. 

  35. 

  36. 

  37. 

  38. /*double resistor sample Parameter*/
    39. 

  39. #define DLL_TIME                        (1.3)            // 双电阻最小脉宽设置(us),建议值为死区时间值+0.2us以上
    40. 

  40. /*three resistor overmodule Parameter*/
    41. 

  41. #define OVERMOD_TIME                    (2.0)            // 三电阻过调制时间(us)，建议值2.0
    42. 

  42. /*deadtime compensation*/
    43. 

  43. #define DT_TIME                         (1.0)            // 死区补偿时间(us)适用于双电阻和三电阻，建议值是1/2死区时间
    44. 

  44. /*min pulse*/
    45. 

  45. #define GLI_TIME                        (0.5)            // 桥臂窄脉宽消除(us),建议值0.5
    46. 

  46. 

  47. /*deadtime Parameter*/
    48. 

  48. #define PWM_LOAD_DEADTIME               (PWM_DEADTIME * MCU_CLOCK)             // 死区设置值
    49. 

  49. #define PWM_OVERMODULE_TIME             (OVERMOD_TIME * MCU_CLOCK / 2)         // 过调制时间
    50. 

  50. #define PWM_DLOWL_TIME                  (DLL_TIME * MCU_CLOCK / 2)             //下桥臂最小时间
    51. 

  51. /*single resistor sample Parameter*/
    52. 

  52. #define PWM_TS_LOAD                     (uint16)(_Q16 / PWM_CYCLE * MIN_WIND_TIME / 16)            // 单电阻采样设置值
    53. 

  53. #define PWM_DT_LOAD                     (uint16)(_Q16 / PWM_CYCLE * DT_TIME / 16)                  // 死区补偿值
    54. 

  54. #define PWM_TGLI_LOAD                   (uint16)(_Q16 / PWM_CYCLE * (GLI_TIME + PWM_DEADTIME) / 16)  // 最小脉冲
    55. 

  55. 

  56. #define LPF_K(K)                        _Q15(_2PI / 1000 * K)
    57. 

  57. /*硬件板子参数设置值------------------------------------------------------------------*/
    58. 

  58. /*hardware current sample Parameter*/
    59. 

  59. /*电流基准的电路参数*/
    60. 

  60. #define HW_BOARD_CURR_MAX               (HW_ADC_REF / 2 / HW_AMPGAIN / HW_RSHUNT) // 最大采样电流,2.702A
    61. 

  61. #define HW_BOARD_CURR_MIN               (-HW_BOARD_CURR_MAX)                      // 最小采样电流,-2.702A
    62. 

  62. #define HW_BOARD_CURR_BASE              (HW_BOARD_CURR_MAX * 2)                   // 电流基准//5.4A
    63. 

  63. 

  64. /*hardware voltage sample Parameter*/
    65. 

  65. /*母线电压采样分压电路参数*/
    66. 

  66. #define HW_BOARD_VOLTAGE_BASE           (HW_BOARD_VOLT_MAX / 1.732)               // 电压基准
    67. 

  67. #define HW_BOARD_VOLTAGE_VC             ((RV1 + RV2 + RV3 * VC1) / (RV3 * VC1))
    68. 

  68. #define HW_BOARD_VOLTAGE_BASE_Start     (HW_ADC_REF * HW_BOARD_VOLTAGE_VC / 1.732)// 电压基准
    69. 

  69. /*功率参数*/
    70. 

  70.  #define P_Power(POWER)                  _Q15(POWER*2/HW_BOARD_CURR_BASE/HW_BOARD_VOLTAGE_BASE/1.5)
    71. 

  71.  #define P_PowerReal          	         (3*((uint32)mcFocCtrl.Powerlpf*HW_BOARD_CURR_BASE*HW_BOARD_VOLTAGE_BASE))/4/32767
    72. 

  72.  #define I_IReal_10          	           (uint32)(10*HW_BOARD_CURR_BASE*mcFocCtrl.IDQFlt/1.414/1.35)/32767
    73. 

  73.   
    74. 

  74. /*硬件过流保护DAC值*/
    75. 

  75. #define DAC_OvercurrentValue            (_Q8(I_ValueX(OverHardcurrentValue ))+0x7F)
    76. 

  76. /*转矩补偿时硬件过流保护DAC值*/
    77. 

  77. #define TorDAC_OvercurrentValue         (_Q8(I_ValueX(TorOverHardcurrentValue ))+0x7F) 
    78. 

  78. 

  79. 

  80. #define BASE_FREQ                       ((MOTOR_SPEED_BASE / 60) * Pole_Pairs)  // 基准频率
    81. 

  81. 

  82. 

  83. #define I_ValuePFCIAC(Curr_Value)       _Q15(Curr_Value * PFC_RSHUNT * PFC_AMPGAIN / HW_ADC_REF)
    84. 

  84. #define DAC_PFCOvercurrentValue         _Q8(PFCOverCurrentValue * PFC_RSHUNT * PFC_AMPGAIN / HW_ADC_REF)+0x3F
    85. 

  85. 

  86. 

  87. /*保护参数值------------------------------------------------------------------*/
    88. 

  88. /* protect value */
    89. 

  89. #define OVER_PROTECT_VALUE              _Q15(Over_Protect_Voltage  / HW_BOARD_VOLT_MAX)
    90. 

  90. #define UNDER_PROTECT_VALUE             _Q15(Under_Protect_Voltage / HW_BOARD_VOLT_MAX)
    91. 

  91. #define OVER_RECOVER_VALUE              _Q15(Over_Recover_Vlotage  / HW_BOARD_VOLT_MAX)
    92. 

  92. #define UNDER_RECOVER_VALUE             _Q15(Under_Recover_Vlotage / HW_BOARD_VOLT_MAX)
    93. 

  93. 

  94. /* motor speed set value */
    95. 

  95. #define Motor_Open_Ramp_ACC             _Q15(MOTOR_OPEN_ACC     / MOTOR_SPEED_BASE)
    96. 

  96. #define Motor_Open_Ramp_Min             _Q15(MOTOR_OPEN_ACC_MIN / MOTOR_SPEED_BASE)
    97. 

  97. 

  98. #define Motor_Omega_Ramp_Min            _Q15(MOTOR_OMEGA_ACC_MIN / MOTOR_SPEED_BASE)
    99. 

  99. #define Motor_Omega_Ramp_End            _Q15(MOTOR_OMEGA_ACC_END / MOTOR_SPEED_BASE)
    100. 

  100. 

  101. #define Motor_Loop_Speed                _Q15(MOTOR_LOOP_RPM / MOTOR_SPEED_BASE)
    102. 

  102. 

  103. #define Motor_Max_Speed                 _Q15(MOTOR_SPEED_MAX_RPM   / MOTOR_SPEED_BASE)
    104. 

  104. #define Motor_Min_Speed                 _Q15(MOTOR_SPEED_MIN_RPM   / MOTOR_SPEED_BASE)
    105. 

  105. #define Motor_Stop_Speed                _Q15(MOTOR_SPEED_STOP_RPM  / MOTOR_SPEED_BASE)
    106. 

  106. 

  107. #define Motor_Stall_Min_Speed           _Q15(MOTOR_SPEED_STAL_MIN_RPM / MOTOR_SPEED_BASE)
    108. 

  108. #define Motor_Stall_Max_Speed           _Q15(MOTOR_SPEED_STAL_MAX_RPM / MOTOR_SPEED_BASE)
    109. 

  109. 

  110.  #define S_Value(SpeedValue)          	_Q15(SpeedValue/MOTOR_SPEED_BASE)
    111. 

  111.  #define S_Value2          	           ((((uint32)(mcFocCtrl.SpeedFlt*MOTOR_SPEED_BASE)/32767)+30)/60)  //RPS  Hz
    112. 

  112. 

  113. 

  114. /* obsever parameter set value */
    115. 

  115. #define MAX_BEMF_VOLTAGE                ((MOTOR_SPEED_BASE*Ke)/(1000.0))
    116. 

  116. #define MAX_OMEG_RAD_SEC                ((float)(_2PI*BASE_FREQ))
    117. 

  117. 

  118. 

  119. 

  120. #if (EstimateAlgorithm==AO)
    121. 

  121.     #define OBS_K1T                         _Q11((3.0/(125.0*1.0))*(LQ/TPWM_VALUE)*(HW_BOARD_CURR_BASE/HW_BOARD_VOLTAGE_BASE))
    122. 

  122.     #define OBS_K2T                         _Q11(RS*HW_BOARD_CURR_BASE/HW_BOARD_VOLTAGE_BASE)
    123. 

  123.     #define OBS_K2T_Actual                  _Q11(RS*HW_BOARD_CURR_BASE/HW_BOARD_VOLTAGE_BASE)
    124. 

  124.     #define OBS_K3T                         _Q8(2.5)
    125. 

  125.     #define OBS_K4T                         _Q15(((LD-LQ)*TPWM_VALUE*MAX_OMEG_RAD_SEC)/(LD+RS*TPWM_VALUE))	
    126. 

  126. #else
    127. 

  127.     #define OBS_K1T                         _Q15(LD/(LD+RS*TPWM_VALUE))
    128. 

  128.     #define OBS_K2T                         _Q13((TPWM_VALUE/(LD+RS*TPWM_VALUE))*(HW_BOARD_VOLTAGE_BASE_Start/HW_BOARD_CURR_BASE))
    129. 

  129.     #define OBS_K2T_Actual                  _Q13((TPWM_VALUE/(LD+RS*TPWM_VALUE))*(HW_BOARD_VOLTAGE_BASE/HW_BOARD_CURR_BASE))
    130. 

  130.     #define OBS_K3T                         _Q15((TPWM_VALUE/(LD+RS*TPWM_VALUE))*(MAX_BEMF_VOLTAGE/HW_BOARD_CURR_BASE))
    131. 

  131.     #define OBS_K4T                         _Q15(((LD-LQ)*TPWM_VALUE*MAX_OMEG_RAD_SEC)/(LD+RS*TPWM_VALUE))
    132. 

  132. #endif
    133. 

  133. 

  134. 

  135. #define OBSW_KP_GAIN                    _Q12(2*_2PI*ATT_COEF*ATO_BW/BASE_FREQ)
    136. 

  136. #define OBSW_KI_GAIN                    _Q15(_2PI*ATO_BW*ATO_BW*TPWM_VALUE/BASE_FREQ)
    137. 

  137. 

  138. #define OBSW_KP_GAIN_RUN                _Q12(2*_2PI*ATT_COEF*ATO_BW_RUN/BASE_FREQ)
    139. 

  139. #define OBSW_KI_GAIN_RUN                _Q15(_2PI*ATO_BW_RUN*ATO_BW_RUN*TPWM_VALUE/BASE_FREQ)
    140. 

  140. 

  141. #define OBSW_KP_GAIN_RUN1               _Q12(2*_2PI*ATT_COEF*ATO_BW_RUN1/BASE_FREQ)
    142. 

  142. #define OBSW_KI_GAIN_RUN1               _Q15(_2PI*ATO_BW_RUN1*ATO_BW_RUN1*TPWM_VALUE/BASE_FREQ)
    143. 

  143. 

  144. #define OBSW_KP_GAIN_RUN2               _Q12(2*_2PI*ATT_COEF*ATO_BW_RUN2/BASE_FREQ)
    145. 

  145. #define OBSW_KI_GAIN_RUN2               _Q15(_2PI*ATO_BW_RUN2*ATO_BW_RUN2*TPWM_VALUE/BASE_FREQ)
    146. 

  146. 

  147. #define OBSW_KP_GAIN_RUN3               _Q12(2*_2PI*ATT_COEF*ATO_BW_RUN3/BASE_FREQ)
    148. 

  148. #define OBSW_KI_GAIN_RUN3               _Q15(_2PI*ATO_BW_RUN3*ATO_BW_RUN3*TPWM_VALUE/BASE_FREQ)
    149. 

  149. 

  150. #define OBSW_KP_GAIN_RUN4               _Q12(2*_2PI*ATT_COEF*ATO_BW_RUN4/BASE_FREQ)
    151. 

  151. #define OBSW_KI_GAIN_RUN4               _Q15(_2PI*ATO_BW_RUN4*ATO_BW_RUN4*TPWM_VALUE/BASE_FREQ)
    152. 

  152. 

  153. #define OBS_FBASE                       _Q15(BASE_FREQ*TPWM_VALUE)         // Fbase*Tpwm*32768
    154. 

  154. #define OBS_KLPF                        _Q15(_2PI*BASE_FREQ*TPWM_VALUE)    // 2PI*Fbase*Tpwm
    155. 

  155. #define SPEED_KLPF                      _Q15(_2PI*SPD_BW*TPWM_VALUE)       // 2PI*SPD_BW*Tpwm
    156. 

  156. #define OBS_EA_KS                       _Q15((2*MOTOR_SPEED_SMOMIN_RPM*_2PI*BASE_FREQ*TPWM_VALUE)/MOTOR_SPEED_BASE)     // SMO的最小速度
    157. 

  157. 

  158. #define OBSE_PLLKP_GAIN1                _Q11(((2*ATT_COEF*_2PI*E_BW1*LD - RS)*HW_BOARD_CURR_BASE)/HW_BOARD_VOLTAGE_BASE)
    159. 

  159. #define OBSE_PLLKI_GAIN1                _Q11((_2PI*E_BW1*_2PI*E_BW1*LD*TPWM_VALUE*HW_BOARD_CURR_BASE)/HW_BOARD_VOLTAGE_BASE)
    160. 

  160. 

  161. #define OBSE_PLLKP_GAIN2                _Q11(((2*ATT_COEF*_2PI*E_BW2*LD - RS)*HW_BOARD_CURR_BASE)/HW_BOARD_VOLTAGE_BASE)
    162. 

  162. #define OBSE_PLLKI_GAIN2                _Q11((_2PI*E_BW2*_2PI*E_BW2*LD*TPWM_VALUE*HW_BOARD_CURR_BASE)/HW_BOARD_VOLTAGE_BASE)
    163. 

  163. 

  164. #define OBSE_PLLKP_GAIN3                _Q11(((2*ATT_COEF*_2PI*E_BW3*LD - RS)*HW_BOARD_CURR_BASE)/HW_BOARD_VOLTAGE_BASE)
    165. 

  165. #define OBSE_PLLKI_GAIN3                _Q11((_2PI*E_BW3*_2PI*E_BW3*LD*TPWM_VALUE*HW_BOARD_CURR_BASE)/HW_BOARD_VOLTAGE_BASE)
    166. 

  166. 

  167. #define OBSE_PLLKP_GAIN4                _Q11(((2*ATT_COEF*_2PI*E_BW4*LD - RS)*HW_BOARD_CURR_BASE)/HW_BOARD_VOLTAGE_BASE)
    168. 

  168. #define OBSE_PLLKI_GAIN4                _Q11((_2PI*E_BW4*_2PI*E_BW4*LD*TPWM_VALUE*HW_BOARD_CURR_BASE)/HW_BOARD_VOLTAGE_BASE)
    169. 

  169. 

  170. #define OBSE_PLLKP_GAIN5                _Q11(((2*ATT_COEF*_2PI*E_BW5*LD - RS)*HW_BOARD_CURR_BASE)/HW_BOARD_VOLTAGE_BASE)
    171. 

  171. #define OBSE_PLLKI_GAIN5                _Q11((_2PI*E_BW5*_2PI*E_BW5*LD*TPWM_VALUE*HW_BOARD_CURR_BASE)/HW_BOARD_VOLTAGE_BASE)
    172. 

  172. 

  173. /* 运放模式选择 */
    174. 

  174. #define AMP_NOMAL                       (0)          ///< 外部放大
    175. 

  175. #define AMP_PGA_DUAL                    (1)          ///< 内部PGA 双端差分输入
    176. 

  176. 

  177. /* 内部PGA放大倍数选择 */
    178. 

  178. #define AMP2x                           (2)
    179. 

  179. #define AMP4x                           (4)
    180. 

  180. #define AMP8x                           (8)
    181. 

  181. #define AMP16x                          (16)
    182. 

  182. 

  183. /*Current Calib:enable or disable*/
    184. 

  184. #define Disable                         (0)                              //
    185. 

  185. #define Enable                          (1)                              //
    186. 

  186. #define CalibENDIS                      (Enable)
    187. 

  187. 

  188. #define CW                              (0)
    189. 

  189. #define CCW                             (1)
    190. 

  190. 

  191. /*SVPWM mode*/
    192. 

  192. #define SVPWM_5_Segment                 (0)                              // 五段式SVPWM
    193. 

  193. #define SVPWM_7_Segment                 (1)                              // 七段式SVPWM
    194. 

  194. #define SVPMW_Mode                      (SVPWM_7_Segment)
    195. 

  195. 

  196. /*double resistor sample mode*/
    197. 

  197. #define DouRes_1_Cycle                  (0)                              // 1 周期采样完 ia, ib
    198. 

  198. #define DouRes_2_Cycle                  (1)                              // 交替采用ia, ib, 2周期采样完成
    199. 

  199. #define DouRes_Sample_Mode              (DouRes_1_Cycle)
    200. 

  200. 

  201. #define VREF3_0                         (0xA0)          
    202. 

  202. #define VREF4_0                         (0xB0)
    203. 

  203. #define VREF4_5                         (0xC0)
    204. 

  204. #define VREF5_0                         (0xD0)
    205. 

  205. 

  206.  #define High_Level                     (0)                                     // 驱动高电平有效
    207. 

  207.  #define Low_Level                      (1)                                     // 驱动低电平有效
    208. 

  208.  #define UP_H_DOWN_L                    (2)                                     // 上桥臂高电平有效，下桥臂低电平有效
    209. 

  209.  #define UP_L_DOWN_H                    (3)                                     // 上桥臂低电平有效，下桥臂高电平有效
    210. 

  210.  
    211. 

  211. 

  212. 

  213. #endif
    214.