allow q0 instead of start_pos for footstep planner