foc_config.h 3.4 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495
  1. #ifndef _FOC_CONFIG_H__
  2. #define _FOC_CONFIG_H__
  3. #include "math/fast_math.h"
  4. #include "bsp/bsp.h"
  5. #define CONFIG_DEFAULT_IDC_LIM CONFIG_MAX_VBUS_CURRENT
  6. #define CONFIG_DEFAULT_RPM_LIM CONFIG_MAX_MOT_RPM
  7. #define CONFIG_DEFAULT_EPM_PHASE_CURR 100
  8. #define CONFIG_DEFAULT_EPM_RPM 200
  9. #define CONFIG_DEFAULT_EPM_BK_PHASE_CURR 50
  10. #define CONFIG_DEFAULT_EPM_BK_RPM 170
  11. #define CONFIG_DEFAULT_EBRK_TORQUE 0 //0:means disable ebrake
  12. #define CONFIG_DEFAULT_EBRK_IDC_LIM 15
  13. #define CONFIG_SVM_MODULATION 1.0f//(1.0F/SQRT3_BY_2)
  14. #define CONFIG_BRK_SHUT_POWER_ENABLE 1
  15. #define CONFIG_AUTOHOLD_ENABLE 1
  16. #define CONFIG_DEFAULT_FW_ENABLE 1
  17. /* 转把 */
  18. #define CONFIG_THROTTLE_MIN_VALUE 0.4F /* 转把最小电压,低于这个值,不给启动 */
  19. #define CONFIG_THROTTLE_START_VALUE 1.2f /* 转把启动电压 */
  20. #define CONFIG_THROTTLE_END_VALUE 3.8f /* 转把停止电压 */
  21. #define CONFIG_THROTTLE_MAX_VALUE 4.8F /* 转把最大电压,大于这个值,不给启动 */
  22. #define CONFIG_MIN_CRUISE_RPM 1000 /* 能启动定速巡航的最小速度 */
  23. #define CONFIG_MIN_RPM_FOR_EBRAKE 800 //进入电流回收的最小转速
  24. #define CONFIG_MIN_RPM_EXIT_EBRAKE 250 //推出电流回收的最小转速
  25. #define CONFIG_IDQ_CTRL_TS FOC_PWM_FS
  26. #define CONFIG_SPD_CTRL_TS 1000
  27. #define CONFIG_SPD_CTRL_MS (1000/CONFIG_SPD_CTRL_TS)
  28. #define CONFIG_SPD_CTRL_US (CONFIG_SPD_CTRL_MS * 1000)
  29. #define CONFIG_FOC_VDQ_RAMP_TS 100
  30. #define CONFIG_FOC_VDQ_RAMP_FINAL_TIME 1000
  31. #define CONFIG_ZERO_SPEED_RPM 10
  32. #define CONFIG_ZERO_SPEED_RAMP_RMP 60 //从0速启动到结束的速度
  33. /* 电子刹车,动能回收,加速 */
  34. #define CONFIG_eCTRL_STEP_TS CONFIG_SPD_CTRL_MS /* 斜率给定的step的时间值,单位 ms */
  35. #define CONFIG_eCTRL_Brake_TIME 1500 /* 捏住刹车的时间,超过这个时间启动ebrake,单位 ms */
  36. #define CONFIG_ACC_TIME 200
  37. #define CONFIG_DEC_TIME 10
  38. #define CONFIG_EBRK_RAMP_TIME 50
  39. #define CONFIG_AUTOHOLD_DETECT_TIME 3000
  40. #define CONFIG_CRUISE_RAMP_TIME 2000
  41. #define CONFIG_LIMIT_RAMP_TIME (2 * 1000)
  42. #define CONFIG_MTPA_CALI_RAMP_TIME (10 * 1000)
  43. #define CONFIG_RAMP_SECOND_STEP (0.1F)
  44. #define CONFIG_RAMP_FIRST_TARGET (1.0F)
  45. #define CONFIG_RAMP_SECOND_TARGET (5.0F * 1.5F)
  46. #define CONFIG_RAMP_CROSS_ZERO_STEP (0.1F)
  47. #define CURRENT_LOOP_RAMP_COUNT 15 //1ms 完成ramp给定
  48. #define CONFIG_TORQUE_MODE_MIN_RPM 600
  49. #define CONFIG_CRUISE_ENABLE_ACCL 1 //定速巡航可以加速,油门回退,继续定速巡航
  50. #define CONFIG_MAX_NEG_TORQUE 0.0F
  51. #ifdef CONFIG_SPEED_LADRC
  52. #define CONFIG_LADRC_Wo 200.0F
  53. #define CONFIG_LADRC_Wcv 5.0F
  54. #define CONFIG_LADRC_B0 2500.0F
  55. #define CONFIG_LADRC_NOLOAD_Wcv 3.0F
  56. #define CONFIG_LADRC_NOLOAD_B0 2500.0F
  57. #define CONFIG_LADRC_EPM_Wcv 3.0F
  58. #define CONFIG_LADRC_EPMBK_B0 500.0F
  59. #define CONFIG_LADRC_EPM_B0 350.0F
  60. #endif
  61. #ifdef CONFIG_SMO_OBSERVER
  62. #define CONFIG_SMO_MIN_SPEED 1000 //RPM
  63. //#define CONFIG_SMO_PLL_BANDWITH 2000.0f //计算角度和速度的pll
  64. #define CONFIG_SMO_PLL_BANDWITH (200.0f * 2 * PI) //计算速度的pll
  65. #define CONFIG_SMO_LFP_WC (200.0F * 2* PI)
  66. #define CONFIG_SMO_GAIN_K 100.0f
  67. #define CONFIG_SMO_SIGMOID_MAX 120.0F
  68. #endif
  69. #ifdef CONFIG_LADRC_OBSERVER
  70. #define CONFIG_LADRC_OBSERVER_MIN_SPEED 1000 //RPM
  71. #define CONFIG_LADRC_OBSERVER_MIN_eVEL 400
  72. #define CONFIG_LADRC_OBSERVER_MIN_Wo (200 * 2 * PI)
  73. #define CONFIG_LADRC_OBSERVER_LPF_FREQ (100 * 2 * PI)
  74. #endif
  75. #endif /* _FOC_CONFIG_H__ */