基于末端名义点约束的串联工业机器人连杆参数标定方法技术

本发明专利技术属于工业机器人运动控制领域，并具体公开了一种基于末端名义点约束的串联工业机器人连杆参数标定方法，包括如下步骤：1)搭建测量平台，安装精密球和激光位移传感器；2)执行测量程序，精密球绕其球心名义位置连续旋转一圈，激光位移传感器测量球的位移，并计算球心的位置偏移；3)根据球心的位置偏移，球心的初始位置和运动学误差模型计算出连杆参数误差；4)将计算出的参数误差值补偿到机器人的控制器中，更新控制器中连杆参数的名义值。本发明专利技术采用激光位移传感器和精密球代替昂贵的标定设备，并结合设计的测量程序对连杆参数进行标定，操作简单，成本低且运行效率高。

Calibration Method of Connecting Rod Parameters for Series Industrial Robots Based on Nominal Point Constraints at the End

The invention belongs to the field of motion control of industrial robots, and specifically discloses a method for calibrating connecting rod parameters of serial industrial robots based on end nominal point constraints, including the following steps: 1) setting up a measuring platform, installing a precision ball and a laser displacement sensor; 2) executing a measuring program, the precision ball rotates continuously around the nominal position of its sphere center, and the laser displacement sensor measures the ball. Displacement, and calculate the position offset of the spherical center; 3) According to the position offset of the spherical center, the initial position of the spherical center and the kinematics error model, calculate the parameters error of the connecting rod; 4) Compensate the calculated parameters error value to the controller of the robot, update the nominal value of the parameters of the connecting rod in the controller. The invention adopts laser displacement sensor and precision ball instead of expensive calibration equipment, and calibrates connecting rod parameters with the designed measuring program. The method has the advantages of simple operation, low cost and high operation efficiency.

【技术实现步骤摘要】
基于末端名义点约束的串联工业机器人连杆参数标定方法
本专利技术属于工业机器人运动控制领域，更具体地，涉及一种基于末端名义点约束的串联工业机器人连杆参数标定方法。
技术介绍
工业机器人的定位精度通常分为绝对定位精度和重复定位精度，工业机器人的拖拽示教应用主要依靠重复定位精度，使得机器人实现重复性的动作，随着现代工业的迅猛发展，越来越多的工业机器人应用到加工，安装，焊接等对绝对定位精度要求较高的场合，然而机器人的绝对定位精度远低于其重复定位精度，常常不能满足实际应用要求，在工业中，通常通过对机器人的运动学参数进行标定和补偿提高绝对定位精度。机器人运动学标定方法主要分为两类：一种是开环测量方法，另一种是闭环测量方法。开环测量方法通过额外的测量设备比如激光跟踪仪，三坐标测量仪等直接测量得到机器人末端的实际位置，但是这种方法通常比较昂贵，操作复杂费时，需要专门的技术人员；闭环测量方法则通过对机器人末端增加点面等几何约束建立误差模型，这种方法操作简单，但是仍然存在缺陷，比如工业中常见的尖点标定方法，需要人工操作机器人使得末端与约束点进行多次重合，增加了人为误差且同样耗时。
技术实现思路
针对现有技术的以上缺陷或改进需求，本专利技术提供了一种基于末端名义点约束的串联工业机器人连杆参数标定方法，其采用将机器人末端绕其名义位置旋转一圈的方式，通过携带末端实际位置偏移信息的精密球和采集相对误差数据的激光位移传感器对运动学参数进行标定，由此解决目前因运动学误差导致机器人定位精度下降的技术问题，具有测量效率高，成本格低廉，操作简单等特点。为了解决上述技术问题，本专利技术采用的技术方案为：一种基于末端名义点约束的串联工业机器人连杆参数标定方法，包括如下步骤：S1、搭建测量平台，将精密球安装在机器人的第六关节上，将激光位移传感器放置在工作台上，并使激光束沿竖直方向，调整机器人使得机密求在激光位移传感器的测量范围之内；S2、通过激光位移传感器多次测量精密球初始位置，以及绕精密球球心名义位置旋转一圈后的位置，计算得到精密球球心在机器人基坐标下的实际位置同时并记录机器人的六个关节值，计算得到精密球球心在机器人基坐标下的名义位置以及机器人基坐标下精密球球心的位置偏移；S3、根据精密球球心的初始位置和运动学误差模型计算出连杆参数误差；S4、将计算出来的连杆参数误差值补偿到机器人的控制器中，更新控制器中连杆参数的名义值。所述步骤S2中，通过激光位移传感器多次测量精密球初始位置，以及绕精密球球心名义位置旋转一圈后的位置，计算得到精密球球心的实际位置的具体步骤为：通过控制机器人来调整精密球的位置，使激光位移传感器的激光束竖直通过球心，将此时激光位移传感器所在的位置记为位置1，通过激光位移传感器测量精密球在初始位置时其表面与激光位移传感器之间的距离控制机器人使其绕精密球球心的名义位置旋转一圈，将此时精密球球心的位置记为采样点k；记录机器人的六个关节值，并通过激光位移传感器测量精密球在采样点k处时其表面与激光位移传感器之间的距离将激光位移传感器向X正方向或者负方向移动距离d，将此时激光位移传感器所在的位置记为位置2，通过激光位移传感器测量精密球在初始位置时其表面与激光位移传感器之间的距离控制机器人使其绕精密球球心的名义位置旋转一圈，记录机器人的六个关节值，通过激光位移传感器测量精密球在采样点k处时其表面与激光位移传感器之间的距离记录的位移信息将激光位移传感器向Y正方向或者负方向移动距离d，将此时激光位移传感器所在的位置记为位置3，通过激光位移传感器测量精密球在初始位置时其表面与激光位移传感器之间的距离控制机器人使其绕绕精密球球心的名义位置旋转一圈，记录机器人的六个关节值，通过激光位移传感器测量精密球在采样点k处时其表面与激光位移传感器之间的距离记录的位移信息计算得到精密球球心的实际位置所述计算公式为：式中，R表示精密球的半径。所述步骤S3中，机器人的运动学误差模型为：其中，为精密球球心在采样点k处的实际位置，为精密球球心在采样点k处的名义位置，Jk为机器人在采样点k处的误差雅克比矩阵，ε为连杆参数误差矩阵，ai-1(i＝1...6)为第i个连杆的连杆长度，Δai-1为ai-1的误差值，αi-1为第i个连杆的连杆扭角，Δαi-1为αi-1的误差值，di为第i个连杆的连杆偏置，Δdi为di的误差值，θi为第i个连杆的连杆关节角，Δθi为θi的误差值；所述连杆参数误差计算具体是指，通过最小二乘法求出连杆参数误差矩阵ε，计算公式为：其中，为机器人末端精密球球心初始的实际位置，机器人末端精密球球心的名义位置。机器人末端精密球球心初始的实际位置的计算公式为：其中，lLDS为激光束的长度，pLDS为激光位移传感器安放在工作台上的位置相对于基坐标系的坐标。本专利技术与现有技术相比具有以下有益效果：本专利技术采用将机器人末端绕其名义位置旋转一圈，通过精密球携带末端实际位置偏移信息和激光位移传感器采集相对误差数据的方式，对机器人运动学参数进行标定，大大降低了采用昂贵设备标定的生产成本，避免了通过人眼对尖点标定方式所带来的人为误差，操作简单，效率高，易于实现工业自动化，适用于串联型的工业机器人。附图说明图1是本专利技术实施例中机器人和激光位移传感器的结构示意图；图2是本专利技术实施例提出的一种工业机器人连杆参数标定方法的流程图；图3是本专利技术实施例中机器人连杆坐标系建立示意图；图4是本专利技术实施例中采用的一种激光位移传感器外形示意图；图5是本专利技术的一种精密球的外形示意图；图6是本专利技术实施例中精密球的位置偏移原理图；图7是本专利技术实施例提出的一种工业机器人连杆参数标定方法对连杆参数进行补偿前后的对比图。具体实施方式为使本专利技术的技术方案和优点更加清楚，下面将结合具体实施例和附图，对本专利技术的技术方案进行清楚、完整地描述，显然，所描述的实施例是本专利技术的一部分实施例，而不是全部的实施例；基于本专利技术中的实施例，本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例，都属于本专利技术保护的范围。如图1所示，为本专利技术实施例提出的一种基于末端名义点约束的串联工业机器人连杆参数标定方法所用到的装置，该装置包括机器人本体7、机器人控制器、计算机、精密球8和激光位移传感器9；该机器人本体上设置有第一关节1，第二关节2，第三关节3，第四关节4，第五关节5，第六关节6。如图2所示，本专利技术实施例提出的一种基于末端名义点约束的串联工业机器人连杆参数标定方法，具体包括如下步骤：步骤(1)测量平台搭建，安装精密球和激光位移传感器将精密球安装在机器人的第六关节上，激光位移传感器放置在工作台上并使得激光位移传感器发出的激光光束方向向上，调整机器人使得精密球在激光位移传感器的测量范围之内；如图3所示，为本专利技术实施例中机器人连杆坐标系建立示意图；如图4所示为本实施例中采用的激光位移传感器外形示意图，本实施例中，激光位移传感器的型号为基恩士的LK-H020；图5是本实施例中采用的精密球的外形示意图；步骤(2)激光位移传感器测量精密球的位移，并计算球心的位置偏移。执行设定的测量程序，激光位移传感器分别在设定位置处对精密球进行采样，根据激光位移传感器获得的各采样点处精密球的位移和控制器记录的机器人六个关节值，计算出球心在测量过程中的位本文档来自技高网...

【技术保护点】
1.一种基于末端名义点约束的串联工业机器人连杆参数标定方法，其特征在于，包括如下步骤：S1、搭建测量平台，将精密球安装在机器人的第六关节上，将激光位移传感器放置在工作台上，并使激光束沿竖直方向，调整机器人使得机密求在激光位移传感器的测量范围之内；S2、通过激光位移传感器多次测量精密球初始位置，以及绕精密球球心名义位置旋转一圈后的位置，计算得到精密球球心在机器人基坐标下的实际位置

【技术特征摘要】
1.一种基于末端名义点约束的串联工业机器人连杆参数标定方法，其特征在于，包括如下步骤：S1、搭建测量平台，将精密球安装在机器人的第六关节上，将激光位移传感器放置在工作台上，并使激光束沿竖直方向，调整机器人使得机密求在激光位移传感器的测量范围之内；S2、通过激光位移传感器多次测量精密球初始位置，以及绕精密球球心名义位置旋转一圈后的位置，计算得到精密球球心在机器人基坐标下的实际位置同时并记录机器人的六个关节值，计算得到精密球球心在机器人基坐标下的名义位置以及机器人基坐标下精密球球心的位置偏移；S3、根据精密球球心的初始位置和运动学误差模型计算出连杆参数误差；S4、将计算出来的连杆参数误差值补偿到机器人的控制器中，更新控制器中连杆参数的名义值。2.根据权利要求1所述的一种基于末端名义点约束的串联工业机器人连杆参数标定方法，其特征在于，所述步骤S2中，通过激光位移传感器多次测量精密球初始位置，以及绕精密球球心名义位置旋转一圈后的位置，计算得到精密球球心的实际位置的具体步骤为：通过控制机器人来调整精密球的位置，使激光位移传感器的激光束竖直通过球心，将此时激光位移传感器所在的位置记为位置1，通过激光位移传感器测量精密球在初始位置时其表面与激光位移传感器之间的距离控制机器人使其绕精密球球心的名义位置旋转一圈，将此时精密球球心的位置记为采样点k；记录机器人的六个关节值，并通过激光位移传感器测量精密球在采样点k处时其表面与激光位移传感器之间的距离将激光位移传感器向X正方向或者负方向移动距离d，将此时激光位移传感器所在的位置记为位置2，通过激光位移传感器测量精密球在初始位置时其表面与激光位移传感器之间的距离控制机器人使其绕精密球球心...

【专利技术属性】
技术研发人员：宋宝，郭艺璇，陈天航，熊烁，唐小琦，周向东，金宏星，刘雄，王昌杰，占颂，
申请(专利权)人：武汉久同智能科技有限公司，
类型：发明
国别省市：湖北,42