机器人学第七章.doc

第七章 机器人动力学的凯恩方法 7.1 引言 机器人动力学凯恩方程方法是建立在凯恩动力学方程基础上的，因而本章首先介绍凯恩动力学方程。 7.1.1 质点系的凯恩动力学方程 设一质点系具有n个质点，该质点系的动力学普遍方程为 （7-1） 式中 ——作用于第i质点主动力矢量； ——质点i的质量； ——质点i的加速度矢量； ——质点i在参考坐标系中的位置矢量； ——质点i的微分位移； “·”——数量积符号。 设质点系为完全系，即它具有l个自由度和l个广义坐标，则 （7-2） 式中 ――广义坐标； t——时间变量； 质点i的线速度为 式中 　　　　　　 　 　　　　（7-3） 凯恩（kane）定义为质点I相对于广义速度的偏速度。 微分可表示为 　　　　　　　　　（7-4） 将（7-4）代入（7-1）式，得 交换求和符号，得 因为是独立变量，故 j=1,2,．．．，l （7-5） 或 这就是质点系的凯恩动力学方程(Kane Dynamics Equation),可以改写为 （7-6） 7.1.2 刚体的凯恩动力学方程 如图7-1所示将刚体看成是由n个质点组成的。设刚体的质心为C，以C为力的简化中心并设作用于刚体的主动力的合力为，合力矩为： （7-7） （7-8） 当刚体以角速度旋转时，其中点i的速度为 其中 ——点到质心C的位置矢量； ——质心C的线速度。 ?点对广义速度的偏速度为 或 （7-9） 式中的偏速度： （7-10） ——刚体相对于的偏角速度： （7-11） 于是作用在刚体上相对于的广义力为 或 （7-12） 相对于的广义惯性力为 而 式中动量矩用刚体的惯性张量表示为 （7-13） 因此 （7-14） 得广义惯性力表示为 （7-15） 将（7-12）和（7-15）式合并，从而得到刚体的凯恩动力学方程为 （7-16） 式中 I——刚体相对于质心C的惯性张量。 7.2 机器人杆件速度、加速度及偏速度的递推计算公式 如图???所示，杆件坐标系均设置在各杆件上编号关节处个自由度的机器人有个关节。图中 ——指定杆件坐标系各轴方向的单位矢量，共有i=0，1，2，．．．，n个，它们均是以杆件坐标系描述的常矢量，； ——以杆件坐标系｛i-1｝的原点为始点到以｛i｝系原点为终点的矢量，但它是以｛i｝系描述的矢量； ——以杆件坐标系｛i｝描述的第i号杆件质心的位置矢量； 两相邻坐标系{i-1}及{i}中速度、加速度等的关系可用变换矩阵中的旋转子矩阵及相联系。仿照第六章处理杆件坐标系及杆件质心的速度及加速度的方法，并考虑到坐标系设置方法上的区别，不难得到如下所述的速度及加速度递推计算公式： （7-17） 式中 ——广义坐标对时间的1阶导数，即关节轴的数量速度； ——广义坐标对时间的2阶导数，即关节轴的数量加速度； ——关节类型识别符号； （7-18） 与第六章相同，令 （7-19） 式中 g——重力加速度。上式是假定绝对参考系的轴垂直于地面且指向向上的。若轴垂直于地面，则其中负号表示轴指向地心（于重力场同方向）。 偏速度的递推公式为： （7-20） 例7-1 如图7-3所示的平面包2自由度机器人，、为已知，试用（7-17）及（7-20）式计算各杆的速度、加速度及偏速度。杆件的质心均在杆件的末端。 解： ， ， ，，， ，，。 式中 g——重力加速度。轴与重力场反向，故g取正。 i=1时： i=2时： ， ， （同上式） 此例所得各质心的速度及加速度的计算结果与上一章的计算方法得到的结果是完全相同（例7-2将用此例的偏速度）。 7.3 关节驱动力或力矩的求解 以下分末端执行器有无负载的两种情形进行讨论。 7.3.1 无负载时关节力或力矩 设末端杆件为旋转关节，相对于的广义力计算简图如图7-4所示。 图中 ——作用在末端杆件坐标系中的主动力; ——在末端