mirror of
https://gitee.com/dlmu-cone/bf_original_balance_chassis
synced 2026-07-24 19:47:44 +08:00
添加速度位置闭环分离和电机离线保护
This commit is contained in:
@@ -11,16 +11,14 @@
|
||||
#define BALANCE_GRAVITY_BIAS 0
|
||||
#define ROLL_GRAVITY_BIAS 0
|
||||
#define MAX_ACC_REF 0.9f
|
||||
#define MAX_DIST_TRACK 1.0f
|
||||
#define MAX_VEL_TRACK 0.5f
|
||||
|
||||
// 驱动轮质量
|
||||
#define WHEEL_MASS 0.58f
|
||||
|
||||
// IMU距离中心的距离
|
||||
#define CENTER_IMU_W 0
|
||||
#define CENTER_IMU_L 0.1f
|
||||
#define CENTER_IMU_H -0.055f
|
||||
#define CENTER_IMU_W -0.024f
|
||||
#define CENTER_IMU_L 0.09f
|
||||
#define CENTER_IMU_H -0.1f
|
||||
|
||||
#define VEL_PROCESS_NOISE 10 // 速度过程噪声
|
||||
#define VEL_MEASURE_NOISE 2000 // 速度测量噪声
|
||||
|
||||
Reference in New Issue
Block a user