发明名称 基于视觉的手眼式低伺服精度机器人抓取移动目标的方法
摘要 本发明公开了一种基于视觉的手眼式低伺服精度机器人抓取移动目标的方法,按照如下步骤进行:步骤10捕捉目标物体的图像特征参数,并估计目标物体与摄像机之间的相对位姿;步骤20预测目标物体在下一个时钟周期后的位姿;步骤30对移动目标物体的抓取生成轨迹规划,机器人控制器控制机械臂接近目标物体实现抓取。本发明能够对移动目标的抓取的轨迹生成规划,提高抓取精度最终实现移动目标的抓取,解决了一直以来无法突破的低精度机械臂基于视觉伺服的技术难点。
申请公布号 CN101402199B 申请公布日期 2011.01.26
申请号 CN200810224562.9 申请日期 2008.10.20
申请人 北京理工大学 发明人 黄强;李辉;蒋志宏;黄远灿
分类号 B25J9/16(2006.01)I;B25J19/00(2006.01)I 主分类号 B25J9/16(2006.01)I
代理机构 北京三高永信知识产权代理有限责任公司 11138 代理人 何文彬
主权项 1.一种基于视觉的手眼式低伺服精度机器人抓取移动目标的方法,其特征在于,按照如下步骤进行:步骤10,机械臂上的摄像机捕捉目标物体的图像特征参数,根据得到的图像特征参数提取图像信息,并从图像信息估计目标物体与摄像机之间的相对位姿;步骤20,应用卡尔曼滤波器,预测目标物体在下一个时钟周期在机械臂基座标系下的位姿;步骤30,对移动目标物体的抓取生成轨迹规划,根据预测的下一时钟周期的目标物体位姿及机械臂末端当前位姿,按照运动误差计算补偿公式<img file="FSB00000195790300011.GIF" wi="474" he="74" />得到机械臂位姿的实际输入值,生成轨迹规划,机器人控制器控制机械臂接近目标物体实现抓取,其中,<img file="FSB00000195790300012.GIF" wi="51" he="75" />表示第i时间周期,轨迹规划机械臂末端输出位姿,<img file="FSB00000195790300013.GIF" wi="70" he="74" />表示第i+1时间周期,轨迹规划机械臂末端输出位姿,<img file="FSB00000195790300014.GIF" wi="56" he="58" />表示第i时间周期,机械臂末端的实际位姿,ΔD<sub>i</sub>表示第i时间周期,机械臂末端的期望位置与实际位置的误差,ΔR<sub>i</sub>表示第i次轨迹规划的期望值相对于当前时刻机械臂末端的位姿<img file="FSB00000195790300015.GIF" wi="50" he="58" />的增量,ΔR<sub>i+1</sub>表示第i+1次轨迹规划的期望值相对于当前时刻机械臂末端的位姿<img file="FSB00000195790300016.GIF" wi="70" he="58" />的增量,k为调节系数,k的值由实验确定,取k=1.0;所述步骤30中的轨迹规划包括跟踪调节阶段和抓取调节阶段的轨迹规划;跟踪调节阶段轨迹规划是使得机械臂末端由初始位置运动到目标物体前方的l处;抓取调节阶段的轨迹规划是保证机械臂的手爪始终正对目标物体的把手并接近目标物体,当目标物体与机械臂末端的相对位姿小到一定程度时,对目标物体进行抓取。
地址 100081 北京市海淀区中关村南大街5号北京理工大学宇航科学技术学院智能机器人研究所