Sensor fusion for floor detection