Master Thesis - Hochschule Bonn-Rhein-Sieg
Master Thesis - Hochschule Bonn-Rhein-Sieg
Master Thesis - Hochschule Bonn-Rhein-Sieg
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 />
��