50
This commit is contained in:
parent
4773c252f2
commit
c468fa59ce
@ -491,7 +491,7 @@ static void Chassis_ClimbControl(Chassis_t *c, const Chassis_CMD_t *c_cmd) {
|
||||
float theta_abs = fabsf(avg_theta);
|
||||
float contact_angle = c->param->climb.theta_retract_threshold * 0.5f;
|
||||
float tp_min = c->param->climb.tp_scale;
|
||||
float tp_initial = 0.8f; /* 初始Tp缩放,刚进入就削弱20% */
|
||||
float tp_initial = 0.5f; /* 初始Tp缩放,刚进入就削弱50% */
|
||||
float dynamic_scale;
|
||||
if (theta_abs < contact_angle) {
|
||||
dynamic_scale = tp_initial; /* 未撞到,从80%开始 */
|
||||
|
||||
Loading…
Reference in New Issue
Block a user