Embedded Motion Control 2015 Group 3/Scan: Difference between revisions

From Control Systems Technology Group
Jump to navigation Jump to search
Line 18: Line 18:
Since the maze is axis alligned there are three possibilites:
Since the maze is axis alligned there are three possibilites:


# Intersection
# Crossroad
# T-junction
# T-junction
# Open space
# Open space


As an example consider an intersection, the left  
===== Crossroad =====
Consider an crossroad shown in the picture below, the left plot shows what pico sees when approaching this kind of junction. There are three maxima, which represent the possible directions PICO can go to. In between there are two minima that represent the corners between them. By slightly modifying the data the actual vision as seen in the simulator can be constructed, shown in (b).


[[File:detection.png|400px|thumb|center|The LRF data from PICO, (a) showing the data pico retrieves in this case 3 maxima and 2 minima, (b) showing the slightly modified data to show the actual corridors]]
[[File:detection.png|400px|thumb|center|The LRF data from PICO, (a) showing the data pico retrieves in this case 3 maxima and 2 minima, (b) showing the slightly modified data to show the actual corridors]]
===== T-junction =====
===== Open space =====


=== Constructing virtual walls ===
=== Constructing virtual walls ===

Revision as of 19:15, 7 June 2015

Scan

This page is part of the EMC03 CST-wiki.

In order to solve the maze successfully, the robot needs to be able to drive autonomously. One type of data that is available is the laser range finder data. The PICO robot has a 270 degrees view, with approximately thousand beams.

Potential field

Avoidance collision

The first level of saftey is provided by the potential field algoritm. Its resultant vector will always point towards the direction with the most room and therefore it is sufficient as first layer. However, avoidance collision is one of the top priorities since if Pico bumps into the wall the attempt of solving the maze is over. Another safety layer has been implemented to prevent the robot hitting walls or corners. The distance to the wals is continuosly measured and compared to a set safety margin. If the distance of multiple coextensive beams is smaller than this fixed parameter the robot will move in the oppositie direction.

Detection intersections

At this stage the basic skill of driving with the potential field based on LRF data is completed. Next, the different type of junctions and intersections must be recognized in order to solve the maze. Not only is recognition necassary for driving through the maze, it is also a important part of mapping the maze, see Mapping.

Since the maze is axis alligned there are three possibilites:

  1. Crossroad
  2. T-junction
  3. Open space
Crossroad

Consider an crossroad shown in the picture below, the left plot shows what pico sees when approaching this kind of junction. There are three maxima, which represent the possible directions PICO can go to. In between there are two minima that represent the corners between them. By slightly modifying the data the actual vision as seen in the simulator can be constructed, shown in (b).

The LRF data from PICO, (a) showing the data pico retrieves in this case 3 maxima and 2 minima, (b) showing the slightly modified data to show the actual corridors


T-junction
Open space

Constructing virtual walls