[发明专利]一种基于双平面约束误差模型的机器人自标定方法

说明书

技术领域

本发明涉及一种机器人自标定方法，特别涉及一种基于双平面约束误差模型的机器人自标定方法。

背景技术

1.机器人定位精度是衡量其工作性能的一个重要指标，目前，国内外厂家生产出来的机器人由于制造、安装等因素，大多绝对定位精度不高，无法满足高精加工以及离线编程的需要，因此，对引起机器人定位误差的各种因素进行分析，最大可能地提高机器人绝对定位精度已经成为机器人技术研究中的核心内容。

2.为了降低成本等因素，很多研究人员提出了基于平面约束的机器人运动学误差模型，一定程度上提高了机器人的定位精度。然而，基于平面约束的标定方法，其精度不仅仅取决于约束平面的平面度，研究表明，实际约束点构成的平面与理论位置点拟合出的平面会存在一定偏差，该偏差会对运动学参数的辨识造成影响，因此，机器人标定精度可进一步提高。

3.针对上述技术情况，本发明提出一种基于双平面约束误差模型的机器人自标定方法。

发明内容

针对上述现有技术存在的不足：一般平面约束误差模型只通过单个约束平面上的约束点建立，导致实际约束点构成的平面与理论位置点拟合出的平面存在较大偏差，本发明提供一种基于双平面约束误差模型的机器人自标定方法，该方法需要对两个相互平行或垂直的约束平面进行接触式测量，误差模型与两个面上的约束点相关，因此根据理论位置点拟合出的单个平面，在保证自身平面度的同时，还需要满足与相关平面的垂直或平行关系，因此减小了实际约束点构成的平面与理论位置点拟合出的平面之间的偏差，进一步提高了标定精度。

本发明技术方案步骤如下：

(1)建立机器人运动学模型

建立D-H法与MD-H法相结合的机器人运动学模型，将坐标系i-1到坐标系i的变换过程描述为A_i，A_i＝f(α_i-1,a_i-1,d_i,θ_i,β)，则机器人末端坐标系n相对于基坐标系的位姿矩阵⁰T_n为：

⁰T_n＝A₀·A₁·...·A_n

(2)建立机器人末端位置误差模型

按照微分变换的思想对A_i进行全微分，得到由连杆几何参数误差造成的相邻坐标系间的微分摄动齐次矩阵dA_i：

δA_i是关节坐标系i相对于坐标系i-1的微分变换，则机器人相邻两连杆之间的实际齐次坐标变换即A_i+A_iδA_i，那么机器人末端坐标系相对于基坐标系的实际齐次变换矩阵T_R为：

将上式展开，并略去高阶摄动项，化简后得到下式：

其中，ΔP＝[dP_x dP_y dP_z]^T是机器人位置误差矩阵，J为3×(4n+1)连杆参数的微分变换雅可比矩阵，ΔX＝[Δα Δa Δθ Δd Δβ]^T为(4n+1)×1连杆参数误差矩阵；

(3)建立基于双平面约束的机器人运动学误差模型

设为约束平面Ⅰ上第i个接触点的名义位置值，可通过机器人正运动学直接计算，J_pi为该位置处的雅克比矩阵，可通过关节角度值计算得到，实际位置P_i^R＝P_i^N+J_piΔX，则相邻两接触点间的偏差向量：

其中，ΔJ_pi＝J_pi-J_pi-1；

同样地，那么由相邻的两个偏差向量可构建一垂直于平面Ⅰ的名义法向量：

约束平面Ⅱ与约束平面Ⅰ相垂直(平行)，为第i个接触点的名义位置值，那么由相邻的两个偏差向量可构建一垂直于平面Ⅱ的名义法向量：

若平面Ⅰ与平面Ⅱ垂直，那么：

若平面Ⅰ与平面Ⅱ平行，那么：

(4)驱动机器人对相关约束平面分别进行测量