1. Introduction
Navigation has become a subject of significant interest in the last twenty years because it is open to a broad range of possible applications. Solutions of path planning algorithm have been proposed since the 1970s. A path planning algorithm among polyhedral obstacles based on the geometry graph was proposed in 1979 [1], and then, later extended to the Configuration Space approach. The algorithm proposed could generate very precise optimal trajectories and solve really difficult problems, especially in cluttered worlds, also taking into account non-homonymic constraints, but they are very time consuming [2], as the updating phase of the world model becomes a relevant part of the navigation. The information concerned with the environment plays a key role in all navigation algorithms. Once we have the accurate map description about the space, it will be easier to design a reasonable path.