Tune the Number of Nodes

Use theNumNodesproperty on themobileRobotPRMobject to tune the algorithm.NumNodes指定数量的点,或节点,on the map, which the algorithm uses to generate a roadmap. Using theConnectionDistanceproperty as a threshold for distance, the algorithm connects all points that do not have obstacles blocking the direct path between them.

Increasing the number of nodes can increase the efficiency of the path by giving more feasible paths. However, the increased complexity increases computation time. To get good coverage of the map, you might need a large number of nodes. Due to the random placement of nodes, some areas of the map may not have enough nodes to connect to the rest of the map. In this example, you create a large and small number of nodes in a roadmap.

Load a map file as a logical matrix,simpleMaps, and create an occupancy grid.

loadexampleMaps.matmap = binaryOccupancyMap(simpleMap,2);

Create a simple roadmap with 50 nodes.

prmSimple = mobileRobotPRM(map,50); show(prmSimple)

Create a dense roadmap with 250 nodes.

prmComplex = mobileRobotPRM(map,250); show(prmComplex)

The additional nodes increase the complexity but yield more options to improve the path. Given these two maps, you can calculate a path using the PRM algorithm and see the effects.

Calculate a simple path.

startLocation = [2 1]; endLocation = [12 10]; path = findpath(prmSimple,startLocation,endLocation); show(prmSimple)

Calculate a complex path.

path = findpath(prmComplex, startLocation, endLocation); show(prmComplex)

Increasing the nodes allows for a more direct path, but adds more computation time to finding a feasible path. Because of the random placement of points, the path is not always more direct or efficient. Using a small number of nodes can make paths worse than depicted and even restrict the ability to find a complete path.

Tune the Connection Distance

Use theConnectionDistanceproperty on thePRMobject to tune the algorithm.ConnectionDistanceis an upper threshold for points that are connected in the roadmap. Each node is connected to all nodes within this connection distance that do not have obstacles between them. By lowering the connection distance, you can limit the number of connections to reduce the computation time and simplify the map. However, a lowered distance limits the number of available paths from which to find a complete obstacle-free path. When working with simple maps, you can use a higher connection distance with a small number of nodes to increase efficiency. For complex maps with lots of obstacles, a higher number of nodes with a lowered connection distance increases the chance of finding a solution.

Load a map as a logical matrix,simpleMap, and create an occupancy grid.

loadexampleMaps.matmap = binaryOccupancyMap(simpleMap,2);

Create a roadmap with 100 nodes and calculate the path. The defaultConnectionDistance设置为正无穷。拯救随机数生成年代吗ettings using the rng function. The saved settings enable you to reproduce the same points and see the effect of changingConnectionDistance.

rngState = rng; prm = mobileRobotPRM(map,100); startLocation = [2 1]; endLocation = [12 10]; path = findpath(prm,startLocation,endLocation); show(prm)

Reload the random number generation settings to have PRM use the same nodes. LowerConnectionDistanceto 2 m. Show the calculated path.

rng(rngState); prm.ConnectionDistance = 2; path = findpath(prm,startLocation,endLocation); show(prm)

Create or Update PRM

When using themobileRobotPRMobject and modifying properties, with each new function call, the object triggers the roadmap points and connections to be recalculated. Because recalculating the map can be computationally intensive, you can reuse the same roadmap by callingfindpathwith different starting and ending locations.

Load the map,simpleMap, from a.matfile as a logical matrix and create an occupancy grid.

load('exampleMaps.mat') map = binaryOccupancyMap(simpleMap,2);

Create a roadmap. Your nodes and connections might look different due to the random placement of nodes.

prm = mobileRobotPRM(map,100); show(prm)

Callupdateor change a parameter to update the nodes and connections.

update(prm) show(prm)

The PRM algorithm recalculates the node placement and generates a new network of nodes.