CN110340887B - 一种基于图像的加油机器人视觉引导的方法 - Google Patents
一种基于图像的加油机器人视觉引导的方法 Download PDFInfo
- Publication number
- CN110340887B CN110340887B CN201910506364.XA CN201910506364A CN110340887B CN 110340887 B CN110340887 B CN 110340887B CN 201910506364 A CN201910506364 A CN 201910506364A CN 110340887 B CN110340887 B CN 110340887B
- Authority
- CN
- China
- Prior art keywords
- image
- robot
- visual guidance
- estimation
- refueling
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
- B25J19/02—Sensing devices
- B25J19/04—Viewing devices
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1679—Programme controls characterised by the tasks executed
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种基于图像的加油机器人视觉引导的方法,包括:基于提取的汽车圆角矩形油箱盖虚拟角点特征,对小孔成像模型的分析,建立末端相机位姿变化与图像空间特征点变化之间的定量映射关系模型;提出图像雅克比矩阵的基本概念和基于模型的图像雅克比具体表示形式,构建线性控制器进行基于有相机标定参数情况下的加油任务视觉引导仿真分析;通过卡尔曼滤波算法对无标定视觉引导任务中图像雅克比矩阵的在线估计;构建基于卡尔曼滤波估计的无标定视觉引导加油定位系统。本发明在MATLAB环境下对无标定视觉引导加油定位进行了仿真分析,验证了该方法对实现加油任务的有效性。仿真结果定位速度约10秒,机器人速度未超出安全速度,空间路径接近最优。
Description
技术领域
本发明属于工业机器人和视觉伺服领域,具体涉及一种基于图像的加油机器人视觉引导的方法。
背景技术
随着我国经济社会的快速发展、交通基础设施的不断改善和居民生活水平的不断提高,我国的机动车保有量快速增加。加油站作为汽车油料补给场所,已逐渐成为民众生活中不可或缺的一部分。截止2018年底,全国加油站数量已超12万座。可见我国加油站数量庞大且还在不断增加,加油站市场巨大。随着社会的进步和科学技术的发展,机器人技术得到迅猛发展,机器人自动化设备逐渐替代传统的人力走向社会生产和服务的更多领域,而汽车加油服务领域的自动化、智能化升级改造需求也促使机器人进入加油服务领域,为顾客提供便捷的自动化加油服务体验。
加油机器人则工作于加油站开放的室外环境中,加油机器人工作的室外环境状况具有多变性。加油机器人工作的加油站一般是全天不停歇营业,加油站室外存在着白天与夜晚、晴天与阴天等不同光照、阴影等变化环境影响。多变且复杂的加油站室外光照环境使得加油机器人对加油车辆目标的识别变得困难,要求加油机器人目标感知识别具有较强的鲁棒性和抗噪声能力。针对加油车辆停靠位姿随机性给自动加油运动带来的困难,需要对视觉伺服引导运动控制技术进行研究,
当前,机器人视觉引导有多种实现方式,根据视觉引导系统的反馈信息源不同,视觉引导方式可以分为基于位置的视觉引导和基于图像的视觉引导以及基于两种基本视觉引导方式提出的混合视觉引导方式。张文增等基于位置视觉引导方法构造了Eye-in-Hand激光焊接机器人视觉引导系统,曲道奎等人根据自动化装配与分拣应用需求,构建了基于位置的Eye-in-Hand型双目结构光视觉引导系统,王孙安团队构建了结合Eye-to-Hand和Eye-in-Hand的基于位置视觉引导系统用于果蔬采摘任务。基于位置的视觉引导系统在机器人三维工作空间中进行伺服控制,容易得到空间最优运动轨迹。但目标位姿估计对相机和手眼标定误差及目标模型正确性敏感,且末端运动过程目标可能脱离相机视野导致控制失败,三维位姿误差估计耗时,实时性较差。
发明内容
为了解决背景技术中存在的上述技术问题,本发明提供了一种基于图像的加油机器人视觉引导的方法,该方法根据相机透视模型建立了基于标定模型的图像视觉引导定位方法;其中,提出了基于自适应卡尔曼滤波的无标定视觉引导方法来提升加油机器人视觉引导加油定位的灵活性和鲁棒性,并在MATLAB环境下对无标定视觉引导加油定位进行了仿真分析,验证了所用方法对实现加油任务的有效性。
本发明采用如下技术方案来实现的:
一种基于图像的加油机器人视觉引导的方法,包括以下步骤:
1)基于提取的汽车圆角矩形油箱盖虚拟角点特征,通过对小孔成像模型的分析,建立末端相机位姿变化与图像空间特征点变化之间的定量映射关系模型;
2)提出图像雅克比矩阵的基本概念和基于模型的图像雅克比具体表示形式,并构建简单的线性控制器进行基于有相机标定参数情况下的加油任务视觉引导仿真分析;
3)提出通过卡尔曼滤波算法实现对无标定视觉引导任务中图像雅克比矩阵的在线估计;
4)构建基于卡尔曼滤波估计的无标定视觉引导加油定位系统。
本发明进一步的改进在于,步骤1)中将视觉引导系统中的机械臂关节作为理想的速度源,使用关节速度反馈来确保关节以要求的速度移动,外部的位置环使用视觉引导反馈来确定需要的关节速度以跟踪目标。
本发明进一步的改进在于,步骤2)中基于图像中的三个不共线特征点来研究特征点组的期望运动如何决定相机位姿的运动,具体方法如下:
式中:vx、vy、vz分别表示空间中的点在x、y、z方向的速度;ωx、ωy、ωz分别表示在图像空间中x、y、z方向的速度;
基于式(1)可以从图像特征点的给定特征速度计算得出相机的位姿运动速度,而目标点的特征速度通过构造线性控制器确定如下:
其中,λ满足:
通过λ保证给出的机器人末端速度控制量不会超过机器人的极限运动能力;该线性控制器将在图像空间中驱动特征点p向期望的目标位置p*运动,将式(2)和(3)带入式(1)可得:
该控制器将驱动相机运动,使目标特征点在图像空间中向期望的位置运动。
本发明进一步的改进在于,步骤3)中将系统噪声和观测噪声近似为高斯白噪声所带来的统计不确定性误差,采用Sage-Husa自适应滤波构造时变噪声估计估值器,实时修正系统噪声和测量噪声的统计特性,具体如下:
噪声qk,Qk,rk,Rk可以由时变的Sage-Husa自适应噪声统计估计器递推得到:
qk=(1-dk-1)qk-1+dk-1[xk-xk-1]
dk-1——遗忘因子;其满足:
式中:bk表示b的k次方;
针对上述算法中的状态初始化,Pk作为状态估计误差的协方差矩阵,其初值取为P0=105Imn,状态估计的初值即可采用最小二乘法获取:在加油机器人识别到油箱盖的初始视觉引导位置,通过任意给定的n步线性无关的试探运动ΔP1,…,ΔPn观察图像空间油箱盖特征变化Δf1,…,Δfn,基于试探运动所获得样本数据即可获得初始图像雅克比矩阵的估计值:
本发明进一步的改进在于,步骤4)中基于KF估计环节得出的图像雅克比矩阵,进行控制律计算,得出当前末端执行器的位姿变化速度,基于DX200机器人控制柜的精确末端速度控制,驱动加油机器人末端向目标加油工位运动。
本发明具有如下有益的技术效果:
本发明提供的一种基于图像的加油机器人视觉引导的方法,加油机器人的加油运动任务可分解为以下四个步骤:目标搜寻运动阶段、视觉引导定位运动阶段、加油工位固定加油运动阶段和返回待机工位运动阶段。在第二阶段中,由于其中车型期望加油工位指针对于某一型号的车型,由于其结构完全一致,因此,只要加油机器人加油末端执行器运动到相对汽车油箱口某一相对固定位姿,就可以按照与该车型对应预先示教好的固定加油运动轨迹,通过机器人的工作参考点位姿变换调整实现一系列的加油动作。车型固定加油运动轨迹起点的末端执行器位姿即为该车型的期望加油工位。在执行这一系列相对固定加油动作过程中,加油机器人末端执行器与对应车型的加油运动相对轨迹与车辆停靠位姿无关,只与车型油箱口结构相关。因此,自动加油运动任务的难点在于针对于停靠位姿具有一定随机性的待加油车辆,加油机器人如何从待机运动平面通过视觉系统的反馈引导准确运动到待加油车辆车型的期望加油工位的位姿,从而为该车辆的标准加油动作实现提供前提条件。而本方法主要对视觉引导运动控制技术进行研究,探究适合加油机器人系统的视觉引导机器人运动控制技术,实现了加油机器人对停靠位姿具有一定随机性的待加油车辆的目标加油工位的跟踪定位。
在使用卡尔曼滤波算法对图像雅克比矩阵元素状态向量进行估计时,由于系统的过程噪声方差Q和观测噪声方差R的统计特性难以确定,一般将其根据实际设置为符合标准高斯分布的高斯白噪声。根据经验设定的噪声统计特性如果与实际系统不符,会引起卡尔曼滤波发散。为解决这一问题,提升滤波的精度和收敛性,采用Sage-Husa自适应滤波方法构造噪声估计估值器,对系统噪声和观测噪声进行实时估计和修正。
本发明在MATLAB环境下对无标定视觉引导加油定位进行了仿真分析,验证了所用方法对实现加油任务的有效性。仿真结果定位速度约10秒,机器人速度未超出安全速度,空间路径接近最优。
附图说明
图1为加油机器人加油运动过程示意图。
图2为加油机器人基于图像的视觉引导位姿变换示意图。
图3基于自适应KF的图像视觉引导控制系统结构框图。
图4为图像空间油箱盖虚拟角点特征运动轨迹示意图,图中圆圈代表待加油汽车圆角矩形油箱盖的四个虚拟角点在机器人末端处于视觉伺服初始位姿时的图像特征点,星形代表末端到达期望加油工位时的油箱盖虚拟角点图像特征
图5为世界坐标系下机器人末端实际运动轨迹示意图。
图6为视觉引导油箱盖虚拟角点图像特征误差变化示意图。
图7为视觉引导油箱盖虚拟角点图像特征误差变化示意图。
具体实施方式
为使本发明的目的、技术方案和特点更加清楚明白,以下结合参考附图,对本发明进一步详细说明。
如图1至图3所示,本发明提供加油机器人运动过程中基于KF估计图像雅克比矩阵的无标定视觉引导控制的相关方法,包括以下步骤:
(2)计算观测矩阵:基于上一步控制变量V(k-1)计算观测矩阵Hk-1,
(3)更新状态向量:从第k-1步到第k步,状态向量Xk和输出向量Zk可以通过状态方程和观测方程进行更新计算。
(5)计算机器人末端控制量:计算当前步机器人末端执行器运动控制量V(k).
(6)驱动机器人运动:机器人控制器内部速度控制环基于(5)中计算的末端执行器运动量,控制机器人末端按照预定速度向目标位置运动,当图像特征误差ef(k)<ε时,机器人迭代运动完成,否则继续(2)-(6)步的迭代过程,直至达到允许误差结束。
视觉引导定位仿真分析
本发明基于上一小节中构建的加油机器人无标定视觉引导控制系统,在MATLAB仿真环境下,进行加油机器人视觉引导的仿真验证。
首先,通过示教,使机器人末端垂直于油箱盖中心法向远离油箱盖大约30cm位置,在此位置拍摄油箱盖图像,作为期望位置的期望油箱盖图像特征,并记录当前机器人末端期望标准位姿。
然后,设置机器人仿真的初始位姿,通过示教器移动机器人末端回到待机平面即Y=400mm平面附近,并调整其位姿随机,保证目标油箱盖图像保持在相机视野范围内,记录初始位姿机器人末端位姿。
通过以上仿真条件中设置的期望加油位位姿及期望图像特征及初始加油机器人位姿和初始图像特征,可以计算获得初始状态,初始圆角矩形油箱盖四边虚拟角点图像特征与期望图像特征之间的初始像素坐标误差如表1所示。
表1视觉伺服初始状态汽车圆角矩形油箱盖虚拟角点图像特征参数表
在以上初始条件下进行的加油机器人视觉引导定位仿真实验的油箱盖虚拟特征角点在图像空间中的运动轨迹如图4所示,图4与图5可以看出,在起始引导时刻,图像特征点运动路径呈现非光滑波动,随着迭代次数增加,图像特征点相对平滑收敛到目标特征位姿,这是由于起始状态向量采用标定模型和不准确深度信息进行的粗略估计,随着迭代优化,标定误差和深度不确定性引起的误差逐渐被减小,体现了卡尔曼滤波对图像雅可比矩阵在线最优估计性能。
视觉引导过程中,最为重要的就是保证当前末端相机中的图像特征能够收敛与目标图像特征,即使当前图形特征与期望图形特征不断减小到允许误差。基于卡尔曼滤波估计的图像视觉引导过程中,汽车油箱盖的四个虚拟角点的图像特征误差变化如图6所示。从图中可以看出,随着机器人末端的运动,油箱盖图像特征误差逐渐减小,在末端运动接近10s后,圆角矩形油箱盖的四个虚拟角点与期望位姿的期望特征点误差小于2个像素,完成视觉引导任务
从图7中可以看出,在当前设定的初始条件下,机器人末端速度在初始位姿附近速度较大,各线速度分量均小于1.2m/s,角速度分量小于0.16rad/s,通过查询安川MPX2600型机器人使用说明书可知,机器人末端的最大工作速度为2m/s,因此,视觉伺服规划的末端运动速度满足机器人的运动要求。
Claims (3)
1.一种基于图像的加油机器人视觉引导的方法,其特征在于,包括以下步骤:
1)基于提取的汽车圆角矩形油箱盖虚拟角点特征,通过对小孔成像模型的分析,建立末端相机位姿变化与图像空间特征点变化之间的定量映射关系模型;将视觉引导系统中的机械臂关节作为理想的速度源,使用关节速度反馈来确保关节以要求的速度移动,外部的位置环使用视觉引导反馈来确定需要的关节速度以跟踪目标;
2)提出图像雅克比矩阵的基本概念和基于模型的图像雅克比具体表示形式,并构建简单的线性控制器进行基于有相机标定参数情况下的加油任务视觉引导仿真分析;基于图像中的三个不共线特征点来研究特征点组的期望运动如何决定相机位姿的运动,具体方法如下:
式中:vx、vy、vz分别表示空间中的点在x、y、z方向的速度;ωx、ωy、ωz分别表示在图像空间中x、y、z方向的速度;
基于式(1)可以从图像特征点的给定特征速度计算得出相机的位姿运动速度,而目标点的特征速度通过构造线性控制器确定如下:
其中,λ满足:
通过λ保证给出的机器人末端速度控制量不会超过机器人的极限运动能力;该线性控制器将在图像空间中驱动特征点p向期望的目标位置p*运动,将式(2)和(3)带入式(1)可得:
该控制器将驱动相机运动,使目标特征点在图像空间中向期望的位置运动;
3)提出通过卡尔曼滤波算法实现对无标定视觉引导任务中图像雅克比矩阵的在线估计;
4)构建基于卡尔曼滤波估计的无标定视觉引导加油定位系统。
2.根据权利要求1所述的一种基于图像的加油机器人视觉引导的方法,其特征在于,步骤3)中将系统噪声和观测噪声近似为高斯白噪声所带来的统计不确定性误差,采用Sage-Husa自适应滤波构造时变噪声估计估值器,实时修正系统噪声和测量噪声的统计特性,具体如下:
噪声qk,Qk,rk,Rk可以由时变的Sage-Husa自适应噪声统计估计器递推得到:
qk=(1-dk-1)qk-1+dk-1[xk-xk-1]
dk-1——遗忘因子;其满足:
式中:bk表示b的k次方;
针对上述算法中的状态初始化,Pk作为状态估计误差的协方差矩阵,其初值取为P0=105Imn,状态估计的初值即可采用最小二乘法获取:在加油机器人识别到油箱盖的初始视觉引导位置,通过任意给定的n步线性无关的试探运动ΔP1,…,ΔPn观察图像空间油箱盖特征变化Δf1,…,Δfn,基于试探运动所获得样本数据即可获得初始图像雅克比矩阵的估计值:
3.根据权利要求2所述的一种基于图像的加油机器人视觉引导的方法,其特征在于,步骤4)中基于KF估计环节得出的图像雅克比矩阵,进行控制律计算,得出当前末端执行器的位姿变化速度,基于DX200机器人控制柜的精确末端速度控制,驱动加油机器人末端向目标加油工位运动。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910506364.XA CN110340887B (zh) | 2019-06-12 | 2019-06-12 | 一种基于图像的加油机器人视觉引导的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910506364.XA CN110340887B (zh) | 2019-06-12 | 2019-06-12 | 一种基于图像的加油机器人视觉引导的方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110340887A CN110340887A (zh) | 2019-10-18 |
CN110340887B true CN110340887B (zh) | 2021-02-19 |
Family
ID=68181896
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910506364.XA Active CN110340887B (zh) | 2019-06-12 | 2019-06-12 | 一种基于图像的加油机器人视觉引导的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110340887B (zh) |
Families Citing this family (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111459176B (zh) * | 2020-04-03 | 2023-09-01 | 重庆固高科技长江研究院有限公司 | 车自动充电定位控制方法、标定方法及车辆姿态计算方法 |
CN111553239B (zh) * | 2020-04-23 | 2023-04-28 | 厦门理工学院 | 一种机器人关节视觉伺服控制方法、终端设备及存储介质 |
CN112163470A (zh) * | 2020-09-11 | 2021-01-01 | 高新兴科技集团股份有限公司 | 基于深度学习的疲劳状态识别方法、系统、存储介质 |
CN113103235B (zh) * | 2021-04-20 | 2022-09-27 | 亿嘉和科技股份有限公司 | 一种基于rgb-d图像对柜体表面设备进行垂直操作的方法 |
CN113799127B (zh) * | 2021-09-15 | 2023-05-23 | 华南理工大学 | 光学双目定位系统下六自由度机械臂无标定位姿定位方法 |
CN114274147B (zh) * | 2022-02-10 | 2023-09-22 | 北京航空航天大学杭州创新研究院 | 目标跟踪控制方法及装置、机械臂控制设备和存储介质 |
CN114750147B (zh) * | 2022-03-10 | 2023-11-24 | 深圳甲壳虫智能有限公司 | 机器人的空间位姿确定方法、装置和机器人 |
CN114644315B (zh) * | 2022-03-11 | 2023-06-06 | 江阴市富仁高科股份有限公司 | 一种自动加油用油箱盖精确定位装置及方法 |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3666108B2 (ja) * | 1995-03-16 | 2005-06-29 | 株式会社デンソー | 外観検査装置 |
US6304050B1 (en) * | 1999-07-19 | 2001-10-16 | Steven B. Skaar | Means and method of robot control relative to an arbitrary surface using camera-space manipulation |
CN105196292B (zh) * | 2015-10-09 | 2017-03-22 | 浙江大学 | 一种基于迭代变时长视觉伺服控制方法 |
CN107627303B (zh) * | 2017-09-22 | 2021-03-09 | 哈尔滨工程大学 | 一种基于眼在手上结构的视觉伺服系统的pd-smc控制方法 |
CN109454638A (zh) * | 2018-10-31 | 2019-03-12 | 昆山睿力得软件技术有限公司 | 一种基于视觉引导的机器人抓取系统 |
CN109434839A (zh) * | 2018-12-25 | 2019-03-08 | 江南大学 | 一种基于单目视觉辅助定位的机器人自标定方法 |
CN109785428B (zh) * | 2019-01-21 | 2023-06-23 | 苏州大学 | 一种基于多态约束卡尔曼滤波的手持式三维重建方法 |
-
2019
- 2019-06-12 CN CN201910506364.XA patent/CN110340887B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN110340887A (zh) | 2019-10-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110340887B (zh) | 一种基于图像的加油机器人视觉引导的方法 | |
CN112987763B (zh) | 一种基于ros的自主导航机器人控制系统的智能小车 | |
CN107239076A (zh) | 基于虚拟扫描与测距匹配的agv激光slam方法 | |
CN109848983A (zh) | 一种高顺应性人引导机器人协同作业的方法 | |
JP5429901B2 (ja) | ロボット及び情報処理装置のプログラム | |
CN104808590B (zh) | 一种基于关键帧策略的移动机器人视觉伺服控制方法 | |
Sun et al. | A review of robot control with visual servoing | |
JP5068840B2 (ja) | ロボットのプログラム及び情報処理装置のプログラム | |
CN105676642A (zh) | 一种六自由度机器人工位布局与运动时间协同优化方法 | |
CN105196292A (zh) | 一种基于迭代变时长视觉伺服控制方法 | |
CN108427282A (zh) | 一种基于示教学习的机器人逆运动学求解方法 | |
CN113625702B (zh) | 基于二次规划的无人车同时路径跟踪与避障方法 | |
CN111752274A (zh) | 一种基于强化学习的激光agv的路径跟踪控制方法 | |
Quan et al. | AGV localization based on odometry and LiDAR | |
CN115416024A (zh) | 一种力矩控制的机械臂自主轨迹规划方法和系统 | |
Cherubini et al. | An image-based visual servoing scheme for following paths with nonholonomic mobile robots | |
CN108152829B (zh) | 一种加装直线导轨的二维激光雷达建图装置及其建图方法 | |
Li et al. | Vision-based imitation learning of needle reaching skill for robotic precision manipulation | |
CN108789426A (zh) | 表面处理机械人 | |
CN116038697A (zh) | 一种基于人工示教的牛仔裤自动喷涂方法和系统 | |
CN114800523B (zh) | 机械臂轨迹修正方法、系统、计算机及可读存储介质 | |
CN114667852B (zh) | 一种基于深度强化学习的绿篱修剪机器人智能协同控制方法 | |
CN113829351B (zh) | 一种基于强化学习的移动机械臂的协同控制方法 | |
CN113119123B (zh) | 一种办公转椅生产的运动控制方法 | |
Luo et al. | An effective search and navigation model to an auto-recharging station of driverless vehicles |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |