06.01.2015 Views

Where am I? Sensors and Methods for Mobile Robot Positioning

Where am I? Sensors and Methods for Mobile Robot Positioning

Where am I? Sensors and Methods for Mobile Robot Positioning

SHOW MORE
SHOW LESS

You also want an ePaper? Increase the reach of your titles

YUMPU automatically turns print PDFs into web optimized ePapers that Google loves.

Chapter 9: Vision-Based <strong>Positioning</strong> 211<br />

9.2.2 Two-Dimensional <strong>Positioning</strong> Using Stereo C<strong>am</strong>eras<br />

Hager <strong>and</strong> Atiya [1993] developed a method that uses a stereo pair of c<strong>am</strong>eras to determine<br />

correspondence between observed l<strong>and</strong>marks <strong>and</strong> a pre-loaded map, <strong>and</strong> to estimate the twodimensional<br />

location of the sensor from the correspondence. L<strong>and</strong>marks are derived from vertical<br />

edges. By using two c<strong>am</strong>eras <strong>for</strong> stereo range imaging the algorithm can determine the twodimensional<br />

locations of observed points — in contrast to the ray angles used by single-c<strong>am</strong>era<br />

approaches.<br />

Hager <strong>and</strong> Atiya's algorithm per<strong>for</strong>ms localization by recognizing <strong>am</strong>biguous sets of correspondences<br />

between all the possible triplets of map points p i, p j, p k <strong>and</strong> those of observed points o a, o b, o c.<br />

It achieves this by trans<strong>for</strong>ming both observed data <strong>and</strong> stored map points into a representation that<br />

is invariant to translation <strong>and</strong> rotation, <strong>and</strong> directly comparing observed <strong>and</strong> stored entities. The<br />

permissible range of triangle par<strong>am</strong>eters due to sensor distortion <strong>and</strong> noise is computed <strong>and</strong> taken into<br />

account.<br />

3<br />

For n map points <strong>and</strong> m observed points, the off-line initialization stage consumes O(n log n)<br />

time to compute <strong>and</strong> sort all triangle par<strong>am</strong>eters from the map points. At run time, the worst case<br />

3 3<br />

complexity is O(m (n + log n)). However, an efficient strategy of marking <strong>and</strong> scanning reduces<br />

the search space <strong>and</strong> real-time per<strong>for</strong>mance (half a second) is demonstrated <strong>for</strong> five observed <strong>and</strong> 40<br />

stored l<strong>and</strong>marks.<br />

9.3 C<strong>am</strong>era-Calibration Approaches<br />

The c<strong>am</strong>era-calibration approaches are more complex than the two-dimensional localization<br />

algorithms discussed earlier. This is because calibration procedures compute the intrinsic <strong>and</strong> extrinsic<br />

c<strong>am</strong>era par<strong>am</strong>eters from a set of multiple features provided by l<strong>and</strong>marks. Their aim is to establish<br />

the three-dimensional position <strong>and</strong> orientation of a c<strong>am</strong>era with respect to a reference coordinate<br />

system. The intrinsic c<strong>am</strong>era par<strong>am</strong>eters include the effective focal length, the lens distortion<br />

par<strong>am</strong>eters, <strong>and</strong> the par<strong>am</strong>eters <strong>for</strong> image sensor size. The computed extrinsic par<strong>am</strong>eters provide<br />

three-dimensional position <strong>and</strong> orientation in<strong>for</strong>mation of a c<strong>am</strong>era coordinate system relative to the<br />

object or world coordinate system where the features are represented.<br />

The c<strong>am</strong>era calibration is a complex problem because of these difficulties:<br />

C All the intrinsic <strong>and</strong> extrinsic par<strong>am</strong>eters should be computed from the two-dimensional<br />

projections of a limited number of feature points,<br />

C the par<strong>am</strong>eters are inter-related, <strong>and</strong><br />

C the <strong>for</strong>mulation is non-linear due to the perspectivity of the pin-hole c<strong>am</strong>era model.<br />

The relationship between the three-dimensional c<strong>am</strong>era coordinate system (see Fig. 1)<br />

T<br />

X = [X, Y, Z] (9.2)<br />

<strong>and</strong> the object coordinate system<br />

T<br />

X W = [X W, Y W, Z W] (9.3)<br />

is given by a rigid body trans<strong>for</strong>mation

Hooray! Your file is uploaded and ready to be published.

Saved successfully!

Ooh no, something went wrong!