[发明专利]一种新型机器人运动学建模方法

说明书

技术领域

本发明涉及一种机器人运动学建模方法，属于机器人建模技术领域。 

背景技术

随着机器人技术的快速发展，机器人的应用领域越来越广泛。在机器人应用领域中，机器人的运动学特性是机器人操作与控制的基础，而运动学建模是机器人运动学分析的前提。另外，随着机器人应用领域的发展，机器人的操作人员呈现大众化发展，机器人本身呈现多样化，多自由度发展，因此开展高效通用易懂的运动学建模方法研究具有重要意义。 

因内外学者围绕机器人运动学建模已经开展了相关研究工作。传统的机器人运动学建模方法主要为选择参考坐标系及末端工具坐标系后在机器人各连杆上建立固定于连杆的坐标系，通过求解连杆坐标系、参考坐标系及末端工具坐标系之间的变换矩阵，而进求解末端工具坐标系相对于参考坐标系的位姿及机器人雅克比矩阵等信息完成机器人运动学建模。其中最为经典的建模方法为DH法，由Denavit与Hartenberg提出，该方法通过一系列规定在机器人连杆上建立连杆坐标系，采用四个变量描述机器人连杆之间的变化关系，但该方法建立连杆坐标系过程太过复杂，对多自由度机器人，这个问题更加突出。Richard M.Murray采用旋量理论完成机器人运动学建模，该方法将机器人各关节运动视为运动旋量，通过旋量运算计算机器人运动传递。旋量方法只需建立机器人参考坐标系及末端工具坐标系，但该方法中间推导过程复杂，物理意义不明确，编程实现难度较大。 

针对上述情况，本发明在结合现有机器人运动学建模技术优点的基础上，提出了一种只需明确建立机器人参考坐标系及末端工具坐标系，中间坐标系自主生成且隐含于推导计算过程的运动学建模方法。该方法建模过程简单易懂，推导简明，物理意义明确，易于编程实现，适合于实际应用。 

发明内容

本发明的目的是针对现有运动学建模方法繁琐复杂的不足，提供一种简单易懂的运动学建模方法。 

本发明所采用的技术方案是：首先根据任务需求建模机器人参考坐标系及末端工具坐标系；其次由机器人零位构型(机器人所有关节位置为0时机器人的形态)及其尺寸参数，采用位置矢量及指向矢量(这两个矢量合称机器人运动学模型参数)在参考坐标系下对机器人各关节进行描述；然后通过所得的模型参数推导隐含关节坐标系及隐含关节坐标系之间的变换关系；最终通过矩阵变换，在给定机器人关节位置情况下，求解机器人末端工具坐标系相对于参考坐标系的位姿变换矩阵及雅克比矩阵。 

具体建模方法如下： 

(1)根据任务需求建立参考坐标系及末端工具坐标系，获取机器人零位构型下末端工具坐标系相对于参考坐标系的位姿及机器人各关节在参考坐标系下的描述M_i＝[P_i Z_i]，i＝1…n，n为机器人关节数量。 

(2)结合参考坐标系和末端工具坐标系，推导机器人各关节隐含坐标系及各坐标系间的变换关系。 

(3)根据矩阵变换关系，求解机器人在给定关节位置情况下末端工具坐标系相对于参考坐标系的位姿变换矩阵及雅克比矩阵。 

本发明的优点 

本发明主要涉及一种机器人的运动学建模方法，其优势在于(1)只需建立机器人参考坐标系及末端工具坐标系，无需建立机器人连杆坐标系；(2)通过关节隐含坐标系，由所得的模型参数直接推导各坐标系之间在零位构型下的变换矩阵；(3)表达形式清晰简洁，具有明确的物理意义，易于编程实现。将此方法应用于8自由度模块化机器人运动学建模，相比DH 建模方法，其建模过程简单易懂(见实施例1)。 

附图说明

图1是任意自由度机器人示意图及本发明建模方法说明图； 

图2是实例机器人零位构型及建模所得结果，其中， 

图2-A是实例机器人零位构型图； 

图2-B是实例机器人零位简化图及坐标系选取； 

图2-C是实例机器人建模结果。 

具体实施方式

本发明提供了一种新型的机器人运动学建模方法，下面结合附图对本发明作进一步说明。机器人由多个关节和连杆组成，其结构表示以及各杆件、关节以及坐标系的符号说明如图1所示，其中∑₀为机器人参考坐标系，∑_end为机器人末端工具坐标系，M_i为所提出建模方法第个关节的建模参数，P_i为第i个关节的位置矢量，Z_i为第i个关节的指向矢量，i＝1…n，n为机器人的关节数。 

(1)根据任务需求建立参考坐标系及末端工具坐标系。