Global Navigation using Gradient Path Planning (GPP)

Global Navigation using Gradient Path Planning (GPP) The goal of this project is to make able to find an optimal path from the current place of a Taxi to the goal place using Gradient Path Planning (GPP) algorithm in a city map: The GPP algorithm consist of creating a field in the target position that spread among the map using a search algorithms (such as BFS, A*, etc...) without crossing the obstacles of the map. The "wave" stops when we reach the initial position. FIRST STEP: CREATING THE GPP FIELD EXPANSION As we are using a Grid Map (The image returned from MAP.getMap() is a numpy matrix), each of the position of the matrix represents a "node". We will start the BFS in the node (matrix position) of the clicked point. Using GUI.getTargetPose() and then MAP.rowColumn(targetPoseInWorld) we can transform the coordinates of the target point from the world to the image matrix. We will do the same with the Taxi coordinates in order to work all the time using the ...