Sensor-based motion planning for mobile robots