[发明专利]一种基于双目视觉的机械臂运动学自标定方法

权利要求书

1.一种基于双目视觉的机械臂运动学自标定方法，其特征在于，其步骤如下：

步骤一：采集数据：通过双目相机获取机械臂末端位置信息，使用六轴陀螺仪获取机械臂各关节实际转动角度，将随机产生的指令集转换成角度作为理论转动角度；

步骤二：设计机械臂运动学混合模型参数辨识方法：将DH理论和手眼标定理论相融合，建立机械臂运动学混合模型；运用多种群自适应差分算法进行模型的训练，求解混合模型参数；

步骤三：设计伺服电机模型，通过训练获得补偿后的角度：通过拟合多项式的方法建立起各伺服电机模型，使用最小二乘法进行多项式参数的求解以及补偿预测。

2.根据权利要求1所述一种基于双目视觉的机械臂运动学自标定方法，其特征在于：所述步骤一具体包括以下步骤：

S1．随机生成n组指令构成指令集，将指令集中的指令转换为各舵机待转的角度作为理论转动角度；

S2．执行指令集中的指令，同时读取陀螺仪获取的机械臂各关节实际转动角度和双目相机获取的机械臂末端位置信息。

3.根据权利要求1所述一种基于双目视觉的机械臂运动学自标定方法，其特征在于：所述步骤二具体包括以下步骤：

S1．机械臂各关节构建笛卡尔空间坐标系，通过DH模型正向运动学推导获得机械臂底座到末端的转换关系，相邻坐标系i到i-1转换关系如公式(1)所示：

(1)

可推导为：

(2)

公式(2)中c表示cos，s表示sin；代表相邻连杆坐标系的旋转，代表相邻连杆坐标系的平移；

机械臂底座和机械臂末端转换矩阵如公式(3)所示：

(3)

S2．双目相机坐标系和机械臂底座坐标系之间的转换关系通过绕X、Y、Z三个轴的旋转平移获得，如公式(4)所示：

(4)

式中dx、dy、dz分别表示沿X、Y、Z轴平移的距离，ax、ay、az分别表示绕X、Y、Z轴旋转的角度；

S3．混合模型的转换关系如公式(5)所示：

(5)

T矩阵为4X4矩阵，以上推导结果可简化公式(6)：

(6)

公式(6)中表示i轴机械臂关节输入变量，表示相机坐标系下机械臂末端坐标，表示机械臂末端姿态。

4.根据权利要求1所述一种基于双目视觉的机械臂运动学自标定方法，其特征在于：所述步骤三具体包括以下步骤：

舵机误差模型的设计如公式(7)所示：

(7)

式中f(x)和x分别表示所采集的机械臂的理论转动角度和实际转动角度；

最小二乘法损失函数的设计如公式(8)所示：

(8)

对公式(8)求偏导，完成进一步优化：

……

使用最小二乘法求取多项式系数，完成舵机误差补偿。

5.一种基于双目视觉的机械臂运动学自标定方法，用于实现权利要求1-4任一项所属的基于双目视觉的机械臂运动学自标定方法，包括机械臂绝对定位精度标定的混合模型、舵机误差补偿及优化策略、多种群自适应差分算法；机械臂绝对定位精度标定的混合模型用于构建机械臂末端坐标系和相机坐标系的转换关系；舵机误差补偿及优化策略用于降低舵机误差对机械臂绝对定位精度的影响；多种群自适应差分算法在对机械臂混合模型参数优化过程中，动态改变差分算法参数中的缩放因子、交叉概率。