机器人学基础-第2章-数学基础-蔡自兴.ppt

1、1,中南大学蔡自兴，谢 斌zxcai,2010,机器人学基础第二章 数学基础,1,Fundamentals of Robotics,2,Review,2,Course Schedule Top 10 Robotics News of 2008 Development of Robotics Structure,Feature,and Classification of Robots Robotics and AI,Fundamentals of Robotics,3,Contents,Representation of Position and Attitude Coordinate Tran

2、sformation Homogeneous Transformation Transformation of Object General Rotation Transformation,3,Ch.2 Mathematical Foundations,4,4,Ch.2 Mathematic Basis,2.1 Representation of Position and Attitude 位置和姿态的表示Description of Position,2.1 Representation of Position and Attitude,5,5,2.1 Representation of P

3、osition and Attitude,Description of Orientation,2.1 Representation of Position and Attitude,6,6,Description of Frames 相对参考系A，坐标系B的原点位置和坐标轴的方位，分别由位置矢量(Position Vector)和旋转矩阵(Rotation Matrix)描述。这样，刚体的位姿（位置和姿态）可由坐标系B来描述，即,2.1 Representation of Position and Attitude,2.1 Representation of Position and Att

4、itude,7,Contents,Representation of Position and Attitude Coordinate Transformation Homogeneous Transformation Transformation of Object General Rotation Transformation,7,Ch.2 Mathematical Foundations,8,8,2.2 Coordinate Transformation 坐标变换,平移坐标变换(Translation Transform),2.2 Coordinate Transformation,9,

5、9,旋转坐标变换(Rotation Transform),2.2 Coordinate Transformation,2.2 Coordinate Transformation,10,10,Rotation about an axis,2.2 Coordinate Transformation,2.2 Coordinate Transformation,11,11,2.2 Coordinate Transformation,Rotation about an axis,2.2 Coordinate Transformation,12,12,复合变换(Composite Transform),2

6、.2 Coordinate Transformation,2.2 Coordinate Transformation,13,例2.1 已知坐标系B的初始位姿与A重合，首先B相对于坐标系A的zA轴转30，再沿A的xA轴移动12单位，并沿A的yA轴移动6单位。求位置矢量ApB0和旋转矩阵。假设点p在坐标系B的描述为Bp=3,7,0T，求它在坐标系A中的描述Ap。,13,2.2 Coordinate Transformation,解：,2.2 Coordinate Transformation,14,例2.1 已知坐标系B的初始位姿与A重合，首先B相对于坐标系A的zA轴转30，再沿A的xA轴移动12

7、单位，并沿A的yA轴移动6单位。求位置矢量ApB0和旋转矩阵。假设点p在坐标系B的描述为Bp=3,7,0T，求它在坐标系A中的描述Ap。,14,2.2 Coordinate Transformation,解：,2.2 Coordinate Transformation,15,例2.1 已知坐标系B的初始位姿与A重合，首先B相对于坐标系A的zA轴转30，再沿A的xA轴移动12单位，并沿A的yA轴移动6单位。求位置矢量ApB0和旋转矩阵。假设点p在坐标系B的描述为Bp=3,7,0T，求它在坐标系A中的描述Ap。,15,2.2 Coordinate Transformation,解：,2.2 Coo

8、rdinate Transformation,16,Contents,Representation of Position and Attitude Coordinate Transformation Homogeneous Transformation Transformation of Object General Rotation Transformation,16,Ch.2 Mathematical Foundations,17,已知一直角坐标系中的某点坐标，则该点在另一直角坐标系中的坐标可通过齐次坐标变换求得。所谓齐次坐标就是将一个原本是 n 维的向量用一个 n+1 维向量来表示。一

9、个向量的齐次表示是不唯一的，比如齐次坐标8,4,2、4,2,1表示的都是二维点2,1。齐次坐标提供了用矩阵运算把二维、三维甚至高维空间中的一个点集从一个坐标系变换到另一个坐标系的有效方法。,2.3 Homogeneous Transformation of the Coordinate Frames 齐次坐标变换,17,2.3 Homogeneous Transformation,18,18,Homogeneous TransformationMatrix Form：,2.3 Homogeneous Transformation of the Coordinate Frames,2.3 Hom

10、ogeneous Transformation,19,例2.2 已知坐标系B的初始位姿与A重合，首先B相对于坐标系A的zA轴转30，再沿A的xA轴移动12单位，并沿A的yA轴移动6单位。假设点p在坐标系B的描述为Bp=3,7,0T，用齐次变换方法求它在坐标系A中的描述Ap。,19,解：,2.3 Homogeneous Transformation of the Coordinate Frames,2.3 Homogeneous Transformation,20,例2.2 已知坐标系B的初始位姿与A重合，首先B相对于坐标系A的zA轴转30，再沿A的xA轴移动12单位，并沿A的yA轴移动6单位。

11、假设点p在坐标系B的描述为Bp=3,7,0T，用齐次变换方法求它在坐标系A中的描述Ap。,20,解：,2.3 Homogeneous Transformation of the Coordinate Frames,2.3 Homogeneous Transformation,21,21,Homogeneous Transformation of Translation空间中的某点用矢量ai+bj+ck描述，该点也可表示为：对已知矢量 u=x,y,z,wT 进行平移变换所得的矢量 v 为：,2.3 Homogeneous Transformation of the Coordinate Fram

12、es,2.3 Homogeneous Transformation,22,22,Homogeneous Transformation of Rotation,2.3 Homogeneous Transformation of the Coordinate Frames,2.3 Homogeneous Transformation,23,23,例2.3 已知点 u=7i+3j+2k，将 u绕 z 轴旋转90得到点 v，再将点 v 绕 y轴旋转90得到点w，求点v、w的坐标。,解：,2.3 Homogeneous Transformation of the Coordinate Frames,2.

13、3 Homogeneous Transformation,24,24,例2.3 已知点 u=7i+3j+2k，将 u绕 z 轴旋转90得到点 v，再将点 v 绕 y轴旋转90得到点w，求点v、w的坐标。,解：,如果把上述两变换组合在一起,2.3 Homogeneous Transformation of the Coordinate Frames,2.3 Homogeneous Transformation,25,25,若改变旋转次序，首先使 u 绕 y 轴旋转90，再绕 z 轴旋转90，会使 u 变换至与 w 不同的位置w1。,2.3 Homogeneous Transformation o

14、f the Coordinate Frames,2.3 Homogeneous Transformation,26,26,例2.4 已知点 u=7i+3j+2k，将 u绕 z 轴旋转90得到点 v，再将点 v 绕 y轴旋转90得到点w，最后进行平移变换4i-3j+7k，求最终的坐标。,解：,把上述三变换组合在一起,2.3 Homogeneous Transformation of the Coordinate Frames,2.3 Homogeneous Transformation,27,27,例2.4 已知点 u=7i+3j+2k，将 u绕 z 轴旋转90得到点 v，再将点 v 绕 y轴旋

15、转90得到点w，最后进行平移变换4i-3j+7k，求最终的坐标。,解：,则,2.3 Homogeneous Transformation of the Coordinate Frames,2.3 Homogeneous Transformation,28,28,We are given a single frame A and a position vector AP described in this frame.We then transform AP by first rotating it about by an angle,then rotating about by an angl

16、e.Determine the 3 3 rotation matrix operator,which describes this transformation.,例2.5（Example 2.5）,2.3 Homogeneous Transformation,Solution:Suppose the first rotation converts AP-AP,and the second rotation converts AP-A P”.Then we have:,29,29,We are given a single frame A and a position vector AP described in this frame.We then transform AP by first rotating it about by an angle,then rotating about by an angle.Determine the 3 3 rotation matrix operator,which describes this transformation.,Exampl