18
Wandering Wandering Standpoint Standpoint Algorithm Algorithm

Wandering Standpoint Algorithm. Wandering Standpoint Algorithm for local path planning Description: –Local path planning algorithm. Required: –Local distance

Embed Size (px)

Citation preview

Page 1: Wandering Standpoint Algorithm. Wandering Standpoint Algorithm for local path planning Description: –Local path planning algorithm. Required: –Local distance

Wandering Wandering Standpoint Standpoint AlgorithmAlgorithm

Page 2: Wandering Standpoint Algorithm. Wandering Standpoint Algorithm for local path planning Description: –Local path planning algorithm. Required: –Local distance

Wandering Standpoint Algorithm Wandering Standpoint Algorithm for local for local path planningpath planning

• Description: – Local path planning algorithm.

• Required: – Local distance sensor.

• Algorithm: 1. Try to reach goal from start in direct line. 2. When encountering an obstacle, measure

avoidance angle for turning left and for turning right, turn to smaller angle.

3. Continue with boundary-following around the object, until goal direction is clear again.

Page 3: Wandering Standpoint Algorithm. Wandering Standpoint Algorithm for local path planning Description: –Local path planning algorithm. Required: –Local distance

•Variant on robot

•Variant with existing map or vision from ceiling

– Try to reach goal from start in direct line.

Page 4: Wandering Standpoint Algorithm. Wandering Standpoint Algorithm for local path planning Description: –Local path planning algorithm. Required: –Local distance

MappingMapping

algorithmsalgorithms

Page 5: Wandering Standpoint Algorithm. Wandering Standpoint Algorithm for local path planning Description: –Local path planning algorithm. Required: –Local distance

MappingMapping• Mapping an unknown environment is

similar to the maze problem

• However, maze is very simple:– fixed size cells– only 90º angles

• Now: let us look at general environments

Page 6: Wandering Standpoint Algorithm. Wandering Standpoint Algorithm for local path planning Description: –Local path planning algorithm. Required: –Local distance

Mapping ideas

• Explore unknown environment

• Use infra-red PSD and infra-red proxy sensors only

• Apply DistBug algorithm for wall following once an obstacle is encountered

• Enter sensor measurement data in map

• Use visibility graph with configuration space representation

Page 7: Wandering Standpoint Algorithm. Wandering Standpoint Algorithm for local path planning Description: –Local path planning algorithm. Required: –Local distance

Exploring cells of the map – grid based

Grid or no grid? Grid or no grid?

Page 8: Wandering Standpoint Algorithm. Wandering Standpoint Algorithm for local path planning Description: –Local path planning algorithm. Required: –Local distance

Exploring obstacles in the map - general maps, shapes, no grid.

continuedcontinued

Page 9: Wandering Standpoint Algorithm. Wandering Standpoint Algorithm for local path planning Description: –Local path planning algorithm. Required: –Local distance

This slide explains how to use This slide explains how to use grids grids to draw the map based on sensor to draw the map based on sensor information and actions executed.information and actions executed.

Mapping based on GridsGrids

Page 10: Wandering Standpoint Algorithm. Wandering Standpoint Algorithm for local path planning Description: –Local path planning algorithm. Required: –Local distance

• Such parts can be next fixed based on general predetermined knowledge of the nature of walls, obstacles and sizes.

This slide explains how to use grids to draw the map based on sensor This slide explains how to use grids to draw the map based on sensor information and actions executed.information and actions executed.

Page 11: Wandering Standpoint Algorithm. Wandering Standpoint Algorithm for local path planning Description: –Local path planning algorithm. Required: –Local distance

The smaller the error the more accurate the map

Fixing errors from measurementsFixing errors from measurements

Page 12: Wandering Standpoint Algorithm. Wandering Standpoint Algorithm for local path planning Description: –Local path planning algorithm. Required: –Local distance

Experimental evaluation of errors for your labyrinths

Page 13: Wandering Standpoint Algorithm. Wandering Standpoint Algorithm for local path planning Description: –Local path planning algorithm. Required: –Local distance
Page 14: Wandering Standpoint Algorithm. Wandering Standpoint Algorithm for local path planning Description: –Local path planning algorithm. Required: –Local distance

You should collect these kinds of data for your robot environment of the demo. Think in advance where our robots will be demonstrated. Deans attrium? Near elevators? Not the lab!!

Page 15: Wandering Standpoint Algorithm. Wandering Standpoint Algorithm for local path planning Description: –Local path planning algorithm. Required: –Local distance

DistBug DistBug AlgorithmAlgorithm

Page 16: Wandering Standpoint Algorithm. Wandering Standpoint Algorithm for local path planning Description: –Local path planning algorithm. Required: –Local distance

DistBug Algorithm• Description:

– Algorithm combining local planning with global information, • guarantees convergence.

• Required: – Local sensor data plus global information.

• Algorithm: 1. Similar to wandering standpoint algorithm,

– but boundary-following stops only if goal is directly reachable – or if future hit-point with next obstacle would be closer to goal.

2. This global information together with detection of unreachable goal if robot has turned 360° guarantees convergence.

3. Although this algorithm has very nice theoretical properties, it is not always usable in practice, since it requires global information in the form of path intersection points of future possible collision points with objects.

Page 17: Wandering Standpoint Algorithm. Wandering Standpoint Algorithm for local path planning Description: –Local path planning algorithm. Required: –Local distance

Conclusions and to think about1.1. Search algorithms. Search algorithms. Now that you

understand one application of search, go read again the slides about search algorithms and think how they can be used in applications from last few sets of slides.

2. Fitness function. What can be the cost (fitness) functions?

3. Mapping. Think about other mapping algorithms. Can you use randomness?

Page 18: Wandering Standpoint Algorithm. Wandering Standpoint Algorithm for local path planning Description: –Local path planning algorithm. Required: –Local distance