D-H坐标解算

《D-H坐标解算》由会员上传分享，免费在线阅读，更多相关内容在行业资料-天天文库。

1、第3章运动学数学建模3.1引言在研究一个复杂的系统之前，首先建立其数学模型。双足竞步机器人作一个复杂的机电系统具有多方面的特性。其中最主要的两个特性就是运动学和动力学特性，这些特性直接决定了其控制系统的设计等相关内容。双足竞步机器人运动学建模的目的旨在给定各个关节运动的前提下，确定双足机器人各个部分的运动学关系；双足竞步机器人本体设计结构复杂，在步行过程中，开链的单脚支撑区与闭链的双脚支撑期交替出现，而且，摆动腿着地时存在冲击，这些因素导致对其很难进行精确的数学建模。为了实现稳定行走和进行有效地步行控制，有必要深入的研究

2、其数学模型。3.2数学基础3.2.1位姿描述刚体参考点的位置和刚体的姿态统称为刚体的位姿，描述方法非常多，例如：齐次变换法、矢量法、旋转法和四元数法等等。在空间中，要确定一个物体的几何状态需要确定其3个位移坐标（或称位置自由度）和3个旋转坐标（或称姿态自由度）。在机器人学术语中，将一个空间物体上述的6个自由度状态称为该物体的位姿。同理，为了研究机器人的运动与操作，往往不仅要表示空间某个点的位置，而且需要表示物体的方位,有的关节有3个自由度---横滚、俯仰和侧摆的概念。本文采用了齐次变换法，其优点在于它能将运动、变换和映射

3、与矩阵联系起来，可以方便的运用矩阵理论解决相关问题。在直角坐标系中通常用一个位置矢量表示一个点。在坐标系{A}中用AP=[PxPyPz]T表示某一点P，Px,Py,Pz分别表示三个坐标分量：为了描述空间某刚体B的方位。另设一对直角坐标系{B}与此刚体固接，用坐标系{B}的三个单位主失量XB,YB,ZB相对坐标系{A}的方向余弦组成的3×3矩阵BAR=[AxBAyBAzB]来表示刚体B相对于坐标系{A}的方位，BAR称为旋转矩阵，BAR有9个元素，6个约束方程，所以只有3个元素是独立的。同时BAR也是正交矩阵，满足BAR-

4、1=BART，BAR=1。为了完全描述刚体B在空间的位姿，通常将物体B与某一坐标{B}相固接，{B}的坐标原点一般选在物体B的特征点上，如质心或对称中心等。相对参考系{A}，由位置矢量APB0和旋转矩阵BAR分别描述坐标系{B}的原点位置和坐标轴方位。因此，刚体B的位姿可由坐标系{B}来描述，即B={BAR，APB0}。当上式表示位置时，BAR=1，当表示方位时，APB0=0。3.2.2齐次坐标和其次变换坐标系{B}的原点与{A}的不重合，且坐标轴方位不同，此时可以用式通过BP描述AP，AP=BARBP+APB0（3-1

5、）定义三维空间内某点P的直角坐标和齐次坐标分别为P=[xyz1]T和P=[ωxωyωzω]T（其中ω是非零常数），并且规定[1000]T代表x轴上的无穷远点，非无穷远点[0001]T代表坐标原点。这样，利用齐次坐标不仅可以规定点的位置，还可以用来规定矢量的方向。当第四个元素非零时代代表点的位置；为零时，代表方向。式（3-1）所表示的复合变换对于BP是非齐次的，通过齐次坐标可变换为：（3-2）若仍然把齐次坐标记作和，并令，上式即为：，称为齐次变换矩阵。3.2.3连杆描述在机器人运动学求解过程中，为了进一步的求解与计算，需将

6、机器人腿简化成一系列的杆件和连接各杆件的关节，并将其参数化。本文将各参数定义如下(如图3.1)：(1)杆件长度：关节轴线和轴线公法线的长度；(2)扭转角：关节轴线与轴线在垂直于平面内的夹角；(3)杆件距离：杆件长度和在轴线上的交点之间的距离；(4)回转角：杆件长度和之间的夹角，由右手定则决定正负。图3.1转动关节连杆四参数示意图3.3运动学模型3.3.1机器人运动方程的表示在求解四足机器人运动方程之前需要两个准备工作，(1)建立各关节D-H坐标；(2)通过一定的矩阵变化，将各坐标系之间建立起一定的变换关系。具体定义请参考

7、文献[55]，本文主要引用其变换公式。如式(3-3)就可以表示第个连杆在基坐标中的位置。（3-3）3.3.2机器人D-H坐标建立原则机器人关节坐标系的建立主要是为了描述机器人各杆件的终端之间的相对运动，对建立运动方程和动力学研究是基础性的工作。D-H坐标建立法是目前机器人坐标系建立最常用的方法，它是1955年西门子公司两位工程师Denavit和Hartenberg提出的。其建立原则如下(如图3.2)：(1)原点：设在杆件长度与轴线的交点上；(2)轴：与关节轴重合，指向任意；(3)轴：与杆件长度重合，指向沿由轴线指向轴线；

8、(4)轴：按右手定则。图3.2D-H坐标建立示意图3.3.3广义变换矩阵广义变换矩阵是用来描述两杆件与之间的相对关系的，具体定义请参考文献[55]，本文引用其变换公式及展开矩阵。(3-4)展开可得：(3-5)矩阵中表面看上去有4个未知数，其实真正的变量只有一个。对于旋转关节，杆件长度，杆件距离，扭转角均为常量，只有回