encoder.h 1.7 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465
  1. #ifndef _Encoder_H__
  2. #define _Encoder_H__
  3. #include "foc/core/PI_Controller.h"
  4. typedef struct {
  5. bool b_index_found; //I 对齐
  6. float enc_offset;
  7. u32 enc_count_off;
  8. u8 motor_poles;
  9. float pwm_angle;
  10. u32 pwm_count;
  11. float abi_angle;
  12. float cali_angle;
  13. float interpolation;
  14. float pll_bandwidth_shadow;
  15. float pll_bandwidth;
  16. float position;
  17. PLL_t est_pll;
  18. bool b_timer_ov;
  19. bool b_lock_pos;
  20. bool b_cali_err;
  21. s16 cpr;
  22. s16 last_cnt;
  23. s16 align_cnt; //z 中断的时候的cnt数,需要计算角度的是时候处理这个align
  24. s16 align_step;
  25. s16 z_index_cnt;
  26. u32 last_us;
  27. s8 direction; //motor running dir, 逆时针 正,顺时针负
  28. float est_vel_counts; //每秒多少个计数
  29. float est_vel_cnt_filter;
  30. float est_angle_counts;
  31. float rpm;
  32. //u8 *encoder_off_count;
  33. //s16 *encoder_off_map;
  34. bool produce_error;
  35. s16 last_delta_cnt;
  36. u32 start_dianostic_cnt;
  37. u8 enc_maybe_err;
  38. u32 pwm_time_ms;
  39. }encoder_t;
  40. #define ENCODER_NO_ERR 0
  41. #define ENCODER_PWM_ERR 1
  42. #define ENCODER_AB_ERR 2
  43. void encoder_init(void);
  44. void encoder_init_clear(void);
  45. float encoder_get_theta(void);
  46. float encoder_get_speed(void);
  47. void encoder_set_direction(s8 direction);
  48. float encoder_get_vel_count(void);
  49. void encoder_lock_position(bool enable);
  50. float encoder_get_pwm_angle(void);
  51. float encoder_zero_phase_detect(float *enc_off);
  52. bool ENC_Check_error(void);
  53. float encoder_get_abi_angle(void);
  54. float encoder_get_position(void);
  55. void encoder_clear_cnt_offset(void);
  56. u32 encoder_get_cnt_offset(void);
  57. bool encoder_get_cali_error(void);
  58. void encoder_epm_pll_band(bool epm);
  59. void encoder_produce_error(bool error);
  60. u8 encoder_may_error(void);
  61. #endif /* _Encoder_H__ */