When calling the update_foot_trajectory function, only one (the latest received) state is passed. This state is used for transforming future world positions into the body frame, so using a predicted state from that point in time is more reasonable. This applies to foot_pos_desired_body_frame and step_height_body.
When calling the
update_foot_trajectory
function, only one (the latest received) state is passed. This state is used for transforming future world positions into the body frame, so using a predicted state from that point in time is more reasonable. This applies tofoot_pos_desired_body_frame
andstep_height_body
.