Data fusion for visual and ultrasonic map-building