🐛 Makes step height dynamic
This commit is contained in:
@@ -52,7 +52,8 @@ class KinConfig {
|
|||||||
static constexpr float max_body_height = max_leg_reach * 0.9;
|
static constexpr float max_body_height = max_leg_reach * 0.9;
|
||||||
static constexpr float body_height_range = max_body_height - min_body_height;
|
static constexpr float body_height_range = max_body_height - min_body_height;
|
||||||
|
|
||||||
static constexpr float max_step_length = 1;
|
static constexpr float max_step_length = max_leg_reach * 0.8;
|
||||||
|
static constexpr float max_step_height = max_leg_reach / 2;
|
||||||
|
|
||||||
// Default constant
|
// Default constant
|
||||||
static constexpr float default_step_depth = 0.002;
|
static constexpr float default_step_depth = 0.002;
|
||||||
|
|||||||
@@ -76,7 +76,7 @@ class MotionService {
|
|||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
case MOTION_STATE::WALK: {
|
case MOTION_STATE::WALK: {
|
||||||
gait_state.step_height = KinConfig::default_step_height + command.s1;
|
gait_state.step_height = command.s1 * KinConfig::max_step_height;
|
||||||
gait_state.step_x = command.ly * KinConfig::max_step_length;
|
gait_state.step_x = command.ly * KinConfig::max_step_length;
|
||||||
gait_state.step_z = -command.lx * KinConfig::max_step_length;
|
gait_state.step_z = -command.lx * KinConfig::max_step_length;
|
||||||
gait_state.step_velocity = command.s;
|
gait_state.step_velocity = command.s;
|
||||||
|
|||||||
Reference in New Issue
Block a user