[发明专利]基于物体图像特征点像素空间位置组合控制方法

说明书

本发明公开了基于物体图像特征点像素空间位置组合控制方法，该方法是安装2D视觉系统摄像头进行机械人末端轴抓取物体特征的图像采集，然后采用ORB特征点检测法测出图像中特征点的坐标集，计算坐标集对应点之间的几何距离，将几何距离大于其均值的点剔除；然后以机器人空间运动坐标系计算物体水平方向的速度、图像坐标系下的特征点的速度和位移，采用Lk光流计算各个特征点光流的角误差，以机械人动作控制信息求解的特征点位移作为光流的理想特征值，将角误差较大的点剔除；最后计算出特征点在像素坐标系下的动作速度误差并作为控制量进行控制。本发明不仅能够抑制机械人动作误差，还能够提高控制信息精度。

技术领域

本发明涉及一种7轴串联机械人(6轴机械人+滑轨(龙门))位置控制方法，特别是一种基于物体图像特征点像素空间位置组合控制方法。

背景技术

现有的7轴串联机械人，一般由6轴机械人和滑轨(龙门)构成；其中的6轴机械人自带控制，6轴机械人的控制在与滑轨(龙门)动作电机控制配合时会出现精度失锁及回程误差情况，而且该误差会随着时间和往返累积加大，导致动作误差发散严重，进而导致控制信息精度较低。因此，现有的7轴串联机械人控制时存在着动作误差发散严重和控制信息精度较低的问题。

发明内容

本发明的目的在于，提供一种基于物体图像特征点像素空间位置组合控制方法。本发明不仅能够抑制机械人动作误差，还能够提高控制信息精度。

本发明的技术方案：基于物体图像特征点像素空间位置组合控制方法，其特征在于，包括以下步骤：

a、安装2D视觉系统摄像头，使2D视觉系统摄像头的坐标系的x轴、y轴、z轴分别与机械人机体系的前后、左右、上下三个坐标轴相重合；

b、通过2D视觉系统摄像头进行机械人末端轴抓取物体特征的图像采集，在T₀时刻采集到的图像为I₀，在T_n时刻采集到的图像为I_n；

c、采用ORB特征点检测法检测出I₀中的特征点的坐标集P₀；

d、将I₀、P₀、I_n作为输入量，通过LK光流金字塔法得出I₀中的特征点在I_n中的坐标集

e、将I_n、I₀作为输入量，通过LK光流金字塔法得出特征点集P_n在图I中的坐标集

f、计算和对应点之间的几何距离d₀，然后求d₀的均值，将几何距离d₀大于d₀的均值的点剔除；

g、将机器人空间运动坐标系(即机械人机体系)定义为x、y、z、b坐标系，计算物体水平方向的速度，得A速度；

h、使用A速度计算图像坐标系下的特征点速度，得B速度；

i、使用B速度计算图像坐标系下的特征点位移；

j、采用Lk光流计算公式计算各个特征点光流的角误差，其中的n₀个特征点光流的理想特征值，第n_i个特征点使用LK金字塔光流算法所估计的光流变化值，k为两幅图像之间相隔的帧数；以机械人动作控制信息求解的特征点位移作为光流的理想特征值，将角误差较大的点剔除；