23.11.2012 Views

Master Thesis - Hochschule Bonn-Rhein-Sieg

Master Thesis - Hochschule Bonn-Rhein-Sieg

Master Thesis - Hochschule Bonn-Rhein-Sieg

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.

5. Algorithms <strong>Master</strong> <strong>Thesis</strong> Björn Ostermann page 90 of 126<br />

In Figure 63e the rotational part of the matrix is determined. The camera’s coordinate system matrix is<br />

converted by using the unity matrix into the coordinate system of the robot. In parallel, all used<br />

conversions are applied to a unity matrix, which results in the rotation matrix (see Equation 11).<br />

�C<br />

�<br />

�<br />

C<br />

��<br />

C<br />

1x<br />

1y<br />

1z<br />

C<br />

C<br />

C<br />

�1<br />

�<br />

�<br />

0<br />

��<br />

0<br />

2x<br />

2 y<br />

2z<br />

0<br />

1<br />

0<br />

C<br />

C<br />

C<br />

3x<br />

3 y<br />

3z<br />

�<br />

�<br />

�<br />

�<br />

��<br />

0�<br />

0<br />

�<br />

�<br />

�<br />

1��<br />

�1<br />

�<br />

�<br />

0<br />

��<br />

0<br />

�a�<br />

�<br />

�<br />

d�<br />

��<br />

g�<br />

0<br />

1<br />

0<br />

b�<br />

e�<br />

h�<br />

0�<br />

0<br />

�<br />

�<br />

�<br />

1��<br />

c�<br />

�<br />

f �<br />

�<br />

�<br />

�<br />

i�<br />

��<br />

�R<br />

�<br />

�<br />

R<br />

��<br />

R<br />

�a<br />

�<br />

�<br />

d<br />

��<br />

g<br />

1x<br />

1y<br />

Equation 11: Determining a rotation matrix [61]<br />

The translation vector is determined, by rotating the position vector of the first point 0P 1 from the<br />

camera’s coordinate frame to the robot’s coordinate frame and by calculating the translation between<br />

this rotated first point with the original first point of the robot’s coordinate frame (see Equation 12).<br />

�k<br />

� �P<br />

� �<br />

�<br />

�<br />

�<br />

l<br />

� �<br />

P<br />

��<br />

m��<br />

��<br />

P<br />

R1x<br />

R1y<br />

R1z<br />

� �a<br />

�<br />

�<br />

�<br />

� �<br />

d<br />

��<br />

��<br />

g<br />

c � �P<br />

f<br />

�<br />

�<br />

�<br />

� �<br />

P<br />

i ��<br />

��<br />

P<br />

C1x<br />

C1y<br />

C1z<br />

Equation 12: Determining the translation vector [61]<br />

Graphically this can be described as rotating the camera’s point of origin – 0 – around the first<br />

measurement point – P 1 – and then calculating the shift between the rotated camera origin and the<br />

original robot origin – 0� – (see Figure 63f).<br />

b<br />

e<br />

h<br />

�<br />

�<br />

�<br />

��<br />

1z<br />

b<br />

e<br />

h<br />

R<br />

R<br />

R<br />

2x<br />

2 y<br />

2z<br />

c �<br />

f<br />

�<br />

�<br />

i ��<br />

R<br />

R<br />

R<br />

3x<br />

3 y<br />

3z<br />

�<br />

�<br />

�<br />

��

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

Saved successfully!

Ooh no, something went wrong!