机器人可变形操作臂参数标定方法技术

一种机器人可变形操作臂参数标定的方法。该方法针对机器人可变形操作臂在改变形状后需要重新标定自身参数的任务而提出。首先，给出了单目相机测量操作臂的位置和姿态的优化方法。然后，建立了可变形操作臂的D-H模型；最后，通过构造可变形操作臂参数的约束方程，求解并修正其参数。传统的操作臂参数标定方法，因成本高，操作复杂，不能适用于面向多种服务任务的可变形操作臂参数标定任务。本发明专利技术所述的标定方法，可以快速、准确地完成可变形操作臂在形状改变后的标定任务。仿真和实验表明，本发明专利技术简单实用，且对噪声具有很好的鲁棒性。

【技术实现步骤摘要】
机器人可变形操作臂参数标定方法
本专利技术属于机器人操作臂标定的
，特别是涉及一种可变形操作臂的标定方法。
技术介绍
众所周知，机器人操作臂自身参数标定是提高操作臂精度的一种有效方法。在得到精确的操作臂自身参数后，操作臂的正运动学、逆运动学的准确度都会相应提高，从而提高操作臂的作业精度。当前操作臂参数的标定方法，大多数应用于刚性的、物理结构不会发生改变的操作臂。而对于新颖的可变形操作臂，由于其自身物理结构、形状会发生改变，传统的应用于刚性操作臂标定方法已经不再适用。可变形操作臂的连杆能够在三维立体空间中任意弯曲成一定形状，并能保持相应形状，连杆弯曲时长度和大小基本稳定，且弯曲后具有一定的支撑力。该操作臂关节少，却拥有多关节操作臂才拥有的丰富的工作空间，可执行多自由度操作臂才能完成的任务。并且该操作臂具有多种用途，可实现复用同一支操作臂来适应多种多样的环境和任务。同时，该操作臂具有被动柔性，可降低对外界人和物体的伤害，保障了服务对象的安全[1]。可变形操作臂拥有诸多益处，而操作臂自身标定问题又是提高其精度、保证其正常作业的重要前提，因此，可变形操作臂的参数标定问题是亟待解决的。以往的机器人操作臂参数标定的方法，主要分为两类：借助外部测量设备的参数标定方法，及传统的利用相机的参数标定方法。这两类方法都有其自身的局限性，具体来说：借助外部设备的标定方法，需要使用昂贵的、笨重的测量系统。其缺点是成本高，标定时需要借助体积庞大的外部测量设备，使用不方便，因此这种方法不适合应用在家庭服务机器人的家居环境中。传统的单目相机参数标定方法，需要在机器人操作臂本体上装载单目相机，这种方法多应用体积较大的工业操作臂中。其缺点是，装载单目相机使得操作臂变得更为臃肿，并增加了操作臂的负载，为操作臂执行任务带来了不便。并且，家庭服务机器人的操作臂体积小，可承受负载较低，无法装载一个单目相机。
技术实现思路
有鉴于此，本专利技术目的是克服现有技术存在的上述不足，提供一种机器人可变形操作臂参数标定的方法。本专利技术提供的机器人可变形操作臂参数标定的方法包括：第1、给出单目相机测量操作臂的位置和姿态的方法；第2、建立可变形操作臂的D-H模型；第3、构造可变形操作臂形状改变后D-H参数的约束方程组；第4、给出操作臂D-H参数的求解方法，以及参数修正的方法。其中，第1步，给出单目相机测量操作臂的位置和姿态的方法在操作臂关节处贴标志块的原则和方法，即利用单目相机测量标志块从而得到关节的位置和姿态信息的方法。针对图1所示可变形操作臂，其参数标定的过程具体方法是：操作臂基座、关节3和关节4上分别贴有标志块0，标志块3，标志块4，标志块编号与对应关节相吻合；不存在标志块1，标志块2。单目相机可以识别标志块的位置和姿态。上述是基于4关节，2柔性连杆的可变形操作臂的参数标定方法。对于多关节、多柔性连杆的可变形操作臂，在标定参数时，需要符合以下规则：第1，发生形状改变的连杆两端关节上需要贴标志块。标志块位置尽量毗邻柔性连杆，会为构建约束方程组提供方便。第2，基座标系必须贴有标志块。第3，标志块的最少数量m，取决于形状改变的连杆的数量n，m＝n-1。若标志块数目大于n，会简化约束方程组的构造过程。第2步所述建立可变形操作臂的D-H模型(Denavit-Hartenbergmodel)的方法如下：图1指出本专利技术中可变性操作臂的D-H模型，以及标识块和相机的位置[2]。表1是常规D-H参数建模方法下的D-H参数表。表1、常规D-H参数建模方法下的D-H参数表为坐标系{i}相对于坐标系{i-1}的齐次变换阵，w是操作臂末端坐标系。为柔性操作臂末端坐标系与基坐标系和之间的齐次变换阵。在可变形操作臂建立D-H模型的过程中，遇到的问题及解决方案是：基坐标系与标志块0的坐标系相对位置已知且固定不变，基坐标系信息可由标志块0的坐标系信息得到；即单目相机通过识别标志块0坐标信息，即可得基座标系与相机坐标系间的齐次变换矩阵关节4坐标系与标志块4的坐标系相对位置已知且固定不变，关节4坐标系信息可由标志块4的坐标系信息得到；即单目相机通过识别标志块4的坐标系信息，即可得关节4坐标系与相机坐标系间的齐次变换矩阵关节3坐标系与标志块3的坐标系相对位置未知且会改变。单目相机通过识别标志块3的坐标系信息，标志块3坐标系与相机坐标系间的齐次变换矩阵但未能得到坐标系3与相机坐标系间的齐次变换矩阵关节3的坐标系{3}的原点已经不在操作臂本体上，而是在关节的Z轴延长线上，它们之间有一个偏移距离d33’。同时，我们发现，关节3坐标系的X轴即X3也发生了偏转，与标志块3坐标系的X轴即X3’。不过，X3与X3’都在一个平面内，它们都与Z3垂直，X3与X3’之间有一个夹角θ33′。如此，建立可变形操作臂的D-H模型，其D-H参数如表2所示。表2、D-H参数表中αi为关节i的Z轴与关节i-1的Z轴间的夹角，ai为关节i的Z轴与关节i-1的Z轴间的距离，θi为关节i的X轴与关节i-1的X轴间的夹角，di为关节i的X轴与关节i-1的X轴间的距离，i＝1，2，3，4。θ33′为关节3的X轴与关节3′的X轴间的夹角，d33′为关节3的X轴与关节3′的X轴间的距离。3′为一个虚拟关节，即标志块3的坐标系信息，它是关节3和关节4间的一个桥梁。在可变形操作臂的D-H参数表中，在柔性操作臂的形状发生改变后，D-H参数表中的部分参数需要标定的。需要标定的12个参数是：α3、α4、α3、α4、d2、d3、d33′、d4、θ2、θ3、θ33′、θ4。其余参数，是操作臂的已知量，且在操作臂形状发生改变的情况下，这些参数亦不改变。第3步所述的构造可变形操作臂形状改变后D-H参数的约束方程组的方法是：为使得计算简便，可以令关节角θ1＝0。首先，构造参数标定的约束方程组1单目相机可以得到和即可求其中qef(e，f＝1，2，3)和kx、ky、kz为通过单目相机得到的已知量。而在D-H模型下的表示为：由此可得参数标定的约束方程组1：q11＝cosθ33′cosθ4+cosα4sinθ33′sinθ4q12＝-cosθ33′sinθ4+cosα4sinθ33′cosθ4q13＝-sinα4sinθ33′q21＝-sinθ33′cosθ4+cosα4cosθ33′sinθ4q22＝sinθ33′sinθ4+cosα4cosθ33′cosθ4q23＝-sinα4cosθ33′q31＝sinθ4sinα4q32＝cosθ4sinα4q33＝cosα4kx＝α4cosθ33′-d4sinα4sinθ33′ky＝-a4sinθ33′-d4sinα4cosθ33′kz＝-d33′+d4cosα4。再次，构造参数标定的约束方程组2单目相机可得和则其中ref(e，f＝1，2，3)和px、py、pz为通过单目相机得到的已知量。而在D-H模型下的表示为：由此可得参数标定的约束方程组2：r11＝cos(θ3+θ33′)cosθ2-sin(θ3+θ33′)cosα3sinθ2r12＝-sin(θ3+θ33′)cosθ2-cos(θ3+θ33′)cosα3sinθ2r13＝sinα3sinθ2r21＝sin(θ3+θ33′)sinα3r22＝cos(θ3+θ3本文档来自技高网...

【技术保护点】
一种机器人可变形操作臂参数标定的方法，其特征是该方法包括：第1、给出单目相机测量操作臂的位置和姿态的方法；第2、建立可变形操作臂的D‑H模型；第3、构造可变形操作臂形状改变后D‑H参数的约束方程组；第4、给出操作臂D‑H参数的求解方法，以及参数修正的方法。

【技术特征摘要】
1.一种机器人可变形操作臂参数标定的方法，其特征是该方法包括：第1、给出单目相机测量操作臂的位置和姿态的方法；第2、建立可变形操作臂的D-H模型；第3、构造可变形操作臂形状改变后D-H参数的约束方程组；第4、给出操作臂D-H参数的求解方法，以及参数修正的方法；所述的单目相机测量机械臂位置和姿态的方法，是在操作臂关节处贴标志块的原则和方法，即利用单目相机测量标志块从而得到关节的位置和姿态信息的方法；所述的构造可变形操作臂形状改变后其D-H参数的约束方程组的方法是：q11＝cosθ33'cosθ4+cosα4sinθ33'sinθ4q12＝-cosθ33'sinθ4+cosα4sinθ33'cosθ4q13＝-sinα4sinθ33'q21＝-sinθ33'cosθ4+cosα4cosθ33'sinθ4q22＝sinθ33'sinθ4+cosα4cosθ33'cosθ4q23＝-sinα4cosθ33'q31＝sinθ4sinα4q32＝cosθ4sinα4q33＝cosα4kx＝a4cosθ33'-d4sinα4sinθ33'ky＝-a4sinθ33'-d4sinα4cosθ33'kz＝-d33'+d4cosα4r11＝cos(θ3+θ33')cosθ2-sin(θ3+θ33'...

【专利技术属性】
技术研发人员：刘景泰，郝洁，卢翔，李高峰，孙雷，
申请(专利权)人：南开大学，
类型：发明
国别省市：天津;12