Fix update of footstep positions for TSID contact tasks + Enable trunk task to take into account the next state reference computed by the MPC