Tangent Based-Path Path Planning with Distinctive Topologies in a Dynamic Environment

This manuscript proposes a novel tangent-graph-based method that provides all distinctive topology paths, as a set of trajectories that can not be transformed into each other by gradual bending and stretching without colliding with obstacles. As the global optimal trajectory (limited by dynamic constraints) may not correspond to the shortest path (almost without dynamic constraints), it is important to provide all distinctive topology paths rather than just the globally shortest one. One of the application is provide initial paths for trajectory planning methods, such as time elastic band (TEB) and dynamic window approach (DWA). Considering that a mobile platform is always working in a dynamic changing environment and that update the whole graph is time consuming, a dynamic rectify method is proposed to update tangents according to local map provided by sensor reading. Finally, results under real grid maps are presented.