motor_param.h 3.1 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120
  1. #ifndef _MOTOR_PARAM_H__
  2. #define _MOTOR_PARAM_H__
  3. #include "bsp/bsp.h"
  4. #include "os/os_types.h"
  5. /* 电机外特性map, 每个转速点对应的最大扭矩 */
  6. typedef struct {
  7. s16 rpm;
  8. s16 torque;
  9. }motor_map_t;
  10. s16 get_max_torque_for_rpm(s16 rpm);
  11. #if CONFIG_MOT_TYPE==MOTOR_BLUESHARK_NEW1
  12. #define MOTOR_R 0.010f
  13. #define MOTOR_Ld (0.000120f*0.5f)
  14. #define MOTOR_Lq (0.000200f*0.5f)
  15. #define MOTOR_POLES 4
  16. #define MOTOR_ENC_OFFSET 0.0F
  17. #define CONFIG_MAX_MOTOR_TORQUE 40.0F
  18. #define TRQ_PI_KP 0.14F
  19. #define TRQ_PI_KI 0.15F
  20. #define CONFIG_CURRENT_BANDWITH 1000.0f /* 电流环带宽 */
  21. #define CONFIG_DEFAULT_PHASE_CURR_LIM 200
  22. #define CONFIG_MAX_FW_D_CURR 100.0F //d轴最大的退磁电流
  23. #define MOTOR_NR 0x11
  24. #elif CONFIG_MOT_TYPE==MOTOR_BLUESHARK_A1
  25. #define MOTOR_R 0.022f
  26. #define MOTOR_Ld (0.000140F*0.5f)
  27. #define MOTOR_Lq (0.000340f*0.5f)
  28. //#define MOTOR_R 0.033f
  29. //#define MOTOR_Ld (0.000168f * 0.5f)//(0.000140F*0.5f)
  30. //#define MOTOR_Lq (0.000330f * 0.5f)//(0.000340f*0.5f)
  31. #define MOTOR_POLES 4
  32. #define MOTOR_ENC_OFFSET 0.0F
  33. #define CONFIG_MAX_MOTOR_TORQUE 200.0F
  34. #define TRQ_PI_KP 0.05F
  35. #define TRQ_PI_KI 0.01F
  36. #define TRO_PI_KD 0.0F
  37. #define MOTOR_NR 0x16
  38. #define CONFIG_CURRENT_BANDWITH 1000.0f /* 电流环带宽 */
  39. #define CONFIG_DEFAULT_PHASE_CURR_LIM 500
  40. #define CONFIG_MAX_FW_D_CURR 250.0F //d轴最大的退磁电流
  41. #elif CONFIG_MOT_TYPE==MOTOR_BLUESHARK_NEW2
  42. #define MOTOR_R 0.013f
  43. #define MOTOR_Ld (0.000140f*0.5f)
  44. #define MOTOR_Lq (0.000320f*0.5f)
  45. #define MOTOR_POLES 4
  46. #define MOTOR_ENC_OFFSET 250.0F
  47. #define CONFIG_MAX_MOTOR_TORQUE 40.0F
  48. #define TRQ_PI_KP 0.14F
  49. #define TRQ_PI_KI 0.15F
  50. #define MOTOR_NR 0x12
  51. #define CONFIG_CURRENT_BANDWITH 1000.0f /* 电流环带宽 */
  52. #define CONFIG_DEFAULT_PHASE_CURR_LIM 200
  53. #define CONFIG_MAX_FW_D_CURR 100.0F //d轴最大的退磁电流
  54. #elif CONFIG_MOT_TYPE==MOTOR_BLUESHARK_ZD_100
  55. #define MOTOR_R 0.008f
  56. #define MOTOR_Ld (0.000125f*0.5f)
  57. #define MOTOR_Lq (0.000091f*0.5f)
  58. #define MOTOR_POLES 5
  59. #define MOTOR_ENC_OFFSET 145.0F
  60. #define CONFIG_MAX_MOTOR_TORQUE 200.0F
  61. #define TRQ_PI_KP 0.6F //0.13f
  62. #define TRQ_PI_KI 0.5F
  63. #define MOTOR_NR 0x13
  64. #define CONFIG_CURRENT_BANDWITH 1000.0f /* 电流环带宽 */
  65. #define CONFIG_DEFAULT_PHASE_CURR_LIM 200
  66. #define CONFIG_MAX_FW_D_CURR 100.0F //d轴最大的退磁电流
  67. #elif CONFIG_MOT_TYPE==MOTOR_BLUESHARK_OLD
  68. #define MOTOR_R 0.012f
  69. #define MOTOR_Ld (0.000143f*0.5f)
  70. #define MOTOR_Lq (0.000205f*0.5f)
  71. #define MOTOR_POLES 5
  72. #define MOTOR_ENC_OFFSET 180.0F
  73. #define CONFIG_MAX_MOTOR_TORQUE 40.0F
  74. #define TRQ_PI_KP 0.14F
  75. #define TRQ_PI_KI 0.15F
  76. #define MOTOR_NR 0x14
  77. #define CONFIG_CURRENT_BANDWITH 1000.0f /* 电流环带宽 */
  78. #define CONFIG_DEFAULT_PHASE_CURR_LIM 200
  79. #define CONFIG_MAX_FW_D_CURR 100.0F //d轴最大的退磁电流
  80. #elif CONFIG_MOT_TYPE==MOTOR_3505
  81. //编码器电机 3505
  82. #define MOTOR_R 0.08f
  83. #define MOTOR_Ld 0.000032f
  84. #define MOTOR_Lq 0.000032f
  85. #define MOTOR_POLES 10
  86. #define CONFIG_MAX_MOTOR_CURR 20.0F
  87. #define TRQ_PI_KP 0.14F
  88. #define TRQ_PI_KI 0.15F
  89. #define MOTOR_NR 0x15
  90. #define CONFIG_CURRENT_BANDWITH 1000.0f /* 电流环带宽 */
  91. #endif
  92. #endif /* _MOTOR_PARAM_H__ */