Our first contribution is a real-time plane-segment estimation method using Lidar data without prior models of the staircase. We then integrate this solution with humanoid motion planning. Our second ...