TuxMonkey/bf_original_balance_chassis
1
0
Fork 0
mirror of https://gitee.com/dlmu-cone/bf_original_balance_chassis synced 2026-07-24 11:37:45 +08:00
Code Issues Packages Projects Releases Wiki Activity

能动了！（小板凳）但是还是很抖

Browse Source
This commit is contained in:
TuxMonkey
2026-07-15 13:40:54 +08:00
parent 8a13444e48
commit b3da53745d
5 changed files with 74 additions and 65 deletions
Download Patch File Download Diff File Expand all files Collapse all files

11
application/chassis/balance.c
View File

@@ -28,10 +28,10 @@
#define STOOL_YAW_RATE_REF 3.5f
#define STOOL_ACC_REF 4.0f
#define STOOL_BRAKE_ACC_REF 8.0f
#define STOOL_PITCH_K 55.0f
#define STOOL_PITCH_W_K 7.0f
#define STOOL_VEL_K 10.0f
#define STOOL_STOP_DIST_K 8.0f
#define STOOL_PITCH_K 36.0f
#define STOOL_PITCH_W_K 10.0f
#define STOOL_VEL_K 6.0f
#define STOOL_STOP_DIST_K 3.0f
#define STOOL_VEL_LPF_RC 0.03f
#define STOOL_WHEEL_TORQUE_LIMIT 25.0f
#define STOOL_RC_DEADBAND 40
@@ -353,9 +353,6 @@ static void ControlSwitch()
if (DrivenMotorIsLost())
return;
if (!switch_is_up(rc_data[TEMP].rc.switch_right))
return;
chassis_cmd_recv.chassis_mode = CHASSIS_STOOL_MODE;
chassis_cmd_recv.vx = RCChannelToRatio(rc_data[TEMP].rc.rocker_r1) * STOOL_SPEED_REF;
chassis_cmd_recv.offset_angle = -RCChannelToRatio(rc_data[TEMP].rc.rocker_r_) * STOOL_YAW_RATE_REF;