修改与轮电机固连杆,使用机体速度计算LQR增益

This commit is contained in:
kai
2024-04-28 16:14:10 +08:00
parent 41e13aee44
commit b7e4c80cb4
8 changed files with 58 additions and 46 deletions

View File

@@ -11,7 +11,7 @@
#define CURRENT_SMOOTH_COEF 0.9f
#define SPEED_BUFFER_SIZE 5
#define HT_SPEED_BIAS -0.0109901428f // 电机速度偏差,单位rad/s
#define TORQUE_CONST_HT 3.5 // 扭矩数,单位N.m/A
#define TORQUE_COEF_HT 3.5 // 扭矩数,单位N.m/A
#define P_MIN -95.5f // Radians
#define P_MAX 95.5f