Arnaud R. de Saint Vincent: Visual navigation for a mobile robot: Building a map of the occupied space from sparse 3-D stereo data. ICRA 1987: 1429-1435