Absolute Pose Estimation of a Stair Cleaning Robot using Staircase Geometry and ToF sensors