TorqueComSet.h 1.5 KB

1234567891011121314151617181920212223242526272829
  1. #ifndef __TORQUECOMSET_H_
  2. #define __TORQUECOMSET_H_
  3. #include <Myproject.h>
  4. /*转矩补偿使能位*/
  5. #define IQCOMPENSATEENBLE (0) //转矩补偿使能位
  6. #define OBS_K3T_SPEED_END _Q15(1200.0 / MOTOR_SPEED_BASE) //1200 2200
  7. #define OBS_K3T_SPEED_START _Q15(700.0 / MOTOR_SPEED_BASE) //700 1700
  8. #define TorqueCompensatePeakK_FEN (0) //补偿幅值分段使能位
  9. #define TorqueCompensatePeakKEnd _Q12(1.6)//1.2 // 补偿幅度最大值 0.9
  10. #define TorqueCompensatePeakKStart _Q12(1.6)//0.4 //补偿幅度最小值 小负载时
  11. #define TorqueCompensatePeakKStart2 _Q12(0.8)//0.8 //补偿幅度最小值 大负载时 1.2
  12. #define TorqueCompensatePeakK_K _Q12((float)(TorqueCompensatePeakKEnd-TorqueCompensatePeakKStart)/(float)(OBS_K3T_SPEED_END-OBS_K3T_SPEED_START))
  13. #define TorqueCompensatePeakK_K2 _Q12((float)(TorqueCompensatePeakKEnd-TorqueCompensatePeakKStart2)/(float)(OBS_K3T_SPEED_END-OBS_K3T_SPEED_START))
  14. #define TorqueCompensateTheta_KP _Q12(7.0)//8.0 1.0 3.0 2.0
  15. #define TorqueCompensateTheta_KI _Q15(0.65)//0.15 0.9 0.5 0.1
  16. #define TorqueCompensateEnterSpeed S_Value(2100.0)//进入转矩补偿的转速阈值
  17. #define TorqueCompensateExitSpeed S_Value(2200.0)//退出转矩补偿的转速阈值
  18. #endif