motor_param.h 1.3 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061
  1. #ifndef _MOTOR_PARAM_H__
  2. #define _MOTOR_PARAM_H__
  3. #include "bsp/bsp.h"
  4. #ifdef MOTOR_BLUESHARK_NEW1
  5. #define MOTOR_R 0.010f
  6. #define MOTOR_Ld (0.000120f*0.5f)
  7. #define MOTOR_Lq (0.000200f*0.5f)
  8. #define MOTOR_POLES 4
  9. #define MOTOR_ENC_OFFSET 0.0F
  10. #define TRQ_PI_KP 0.14F
  11. #define TRQ_PI_KI 0.15F
  12. #define MOTOR_NR 0x11
  13. #elif defined MOTOR_BLUESHARK_NEW2
  14. #define MOTOR_R 0.013f
  15. #define MOTOR_Ld (0.000140f*0.5f)
  16. #define MOTOR_Lq (0.000320f*0.5f)
  17. #define MOTOR_POLES 4
  18. #define MOTOR_ENC_OFFSET 0.0F
  19. #define TRQ_PI_KP 0.14F
  20. #define TRQ_PI_KI 0.15F
  21. #define MOTOR_NR 0x12
  22. #elif defined MOTOR_BLUESHARK_ZD_100
  23. #define MOTOR_R 0.008f
  24. #define MOTOR_Ld (0.000125f*0.5f)
  25. #define MOTOR_Lq (0.000091f*0.5f)
  26. #define MOTOR_POLES 5
  27. #define MOTOR_ENC_OFFSET 145.0F
  28. #define TRQ_PI_KP 0.13F
  29. #define TRQ_PI_KI 0.5F
  30. #define MOTOR_NR 0x13
  31. #elif defined MOTOR_BLUESHARK_OLD
  32. #define MOTOR_R 0.012f
  33. #define MOTOR_Ld (0.000143f*0.5f)
  34. #define MOTOR_Lq (0.000205f*0.5f)
  35. #define MOTOR_POLES 5
  36. #define MOTOR_ENC_OFFSET 180.0F
  37. #define TRQ_PI_KP 0.14F
  38. #define TRQ_PI_KI 0.15F
  39. #define MOTOR_NR 0x14
  40. #elif defined MOTOR_3505
  41. //编码器电机 3505
  42. #define MOTOR_R 0.08f
  43. #define MOTOR_Ld 0.000032f
  44. #define MOTOR_Lq 0.000032f
  45. #define MOTOR_POLES 10
  46. #define TRQ_PI_KP 0.14F
  47. #define TRQ_PI_KI 0.15F
  48. #define MOTOR_NR 0x15
  49. #endif
  50. #endif /* _MOTOR_PARAM_H__ */