修改与轮电机固连杆,使用机体速度计算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

View File

@@ -15,7 +15,7 @@
#define SPEED_SMOOTH_COEF 0.85f
#define REDUCTION_RATIO_DRIVEN 1
#define ECD_ANGLE_COEF_LK (360.0f / 65536.0f)
#define CURRENT_TORQUE_COEF_LK 0.00512f // 电流设定值转换成扭矩的系数
#define CURRENT_TORQUE_COEF_LK 0.00512f // 电流设定值转换成扭矩的系数这里对应的是16T
typedef struct // 9025
{