floordetection algorithm for mobile robots using vision