《哈尔滨工业大学学报》：机械臂视觉伺服路径规划研究进展（哈尔滨工业大学&上海交通大学）

第50卷第1期 哈尔滨工业大学学报 Vol 50 No. 1 2018年1月 JOURNAL OF HARBIN INSTITUTE OF TECHNOLOGY Jan.2018 DOI:10.l1918/ J. ISsn.0367-6234.2017143 机械臂视觉伺服路径规划研究进展 任秉银,魏坤',吴卓琦2 (1哈尔滨工业大学机电工程学院,哈尔滨15001;2.上海交通大学机械与动力工程学院,上海200240) 摘要:视觉伺服控制是机械臂完成各种复杂作业任务的有效手段,而机械臂在动态非结构环境下自主作业的路径规划方法 是视觉伺服控制领域的难点和关键.分析了动态非结构环境下视觉伺服路径规划中存在的两类约東及其处理方法,介绍并评 述了国内外在机械臂视觉伺服控制中路径规划方面的相关研究进展,讨论并分析了不同路径规划方法在收敛性和稳定性等 方面存在的不足,对未来的研究方向进行了展望 关键词:机械臂;视觉伺服;路径规划;约東;动态非结构环境;不确定性 中图分类号:TP391 文献标志码:A 文章编号:0367-6234(2018)01-0001-10 Research progress of path planning for visual servoing of robotic manipulator Ren Bingyin, WEI Kun, wU Zhuo (1. School of Mechatronics Engineering, Harbin Institute of Technology, Harbin 150001, China 2.School of Mechanical and Power Engineering, Shanghai Jiaotong University, Shanghai 200240, CI Abstract: Visual servoing control is an effective means for robotic manipulator to complete complex tasks and the path planning method of the robo tc manp bulator autonomous operation in dynamic unstructured environment is the difficulty and key in the field of visual servoing control. Two types of constraints that exist in the visual servoing path planning in dynamic unstructured environment and the processing methods of constraints are analyzed. The relevant research progresses of path planning in visual servoing control of robotic manipulator at home and abroad are reviewed, and the deficiencies in convergence and stability of different methods of path planning are als The future research direction is prospected based on current research progress Keywords: robotic manipulator; visual servoing; path planning; constraint; dynamic unstructured environment uncertainty 机械臂已经广泛应用于工业自动化领域,但大笛卡尔空间,后者将误差直接定义在二维图像空间 多数情况下,机械臂是在静态结构化环境下作业,即 IBVS对相机标定和建模误差有着较好的鲁棒 机械臂的作业过程是固定不变的,机械臂只需要重性局部稳定性和收敛性切.然而,BVS却经常会遇 复运行预先离线编制好的程序即可完成预定作业任到全局收敛性问题,尤其当目标初始位姿和期望位 务.在未来智能工厂中,需要机械臂能够在动态姿相差较大时,可能会导致视觉伺服失败.此外 变化的非结构环境下完成复杂作业任务,要求机械当图像特征在相机视野之外也会导致伺服任务失 臂具有智能感知外部复杂环境、自主规划作业路径败.当IⅤS不能对机械臂和相机有效控制时,可能 以及安全作业的能力 会因为机械臂与工作空间中的障碍物发生碰撞而导 视觉传感器作为非接触式外部传感器,可以感致机械臂无法执行预定操作.因为在大多数机械臂 知机械臂在定位和跟踪任务中环境的动态变化2.应用中都存在着目标的初始和期望位姿相差较大和 在视觉伺服中,通常将当前特征和期望特征之间的多重环境约束,所以融合路径规划技术的IBVS策 误差定义为反馈函数{,通过视觉传感器反馈信略可以改善视觉伺服过程的鲁棒性. 息实时引导机械臂运动,使这个误差趋向于零 视觉伺服路径规划的主要思想是在特定动态非 根据误差函数的定义,现有的视觉伺服方法主要结构环境约束下规划和生成可执行的图像轨迹,然 可以分为基于位置的视觉伺服( Position-Based visua后驱动机械臂沿着规划的轨迹完成作业任务9 Servoing,PBⅤS)和基于图像的视觉伺服( Image-Based 本文首先介绍存在于动态非结构环境视觉伺服 Visual servoing,IBVS)两大类,前者将误差定义在三维路径规划中的两类重要约束,即相机/图像约束和机 械臂/物理约束;其次,总结视觉伺服路径规划方法 收稿日期:2017-11-28 作者简介:任秉银(1966—),男,教授,博士生导师 的研究进展,并分析各种路径规划方法存在的不足 通信作者:任秉银, denby@ hit. edu.en 最后,对未来的研究方向进行展望

第 ５０ 卷 第 １ 期 ２ ０ １ ８ 年 １ 月 哈 尔 滨 工 业 大 学 学 报 ＪＯＵＲＮＡＬ ＯＦ ＨＡＲＢＩＮ ＩＮＳＴＩＴＵＴＥ ＯＦ ＴＥＣＨＮＯＬＯＧＹ Ｖｏｌ􀆰 ５０ Ｎｏ􀆰 １ Ｊａｎ． ２０１８ ＤＯＩ：１０．１１９１８ ／ ｊ．ｉｓｓｎ．０３６７⁃６２３４． ２０１７１１１４３ 机械臂视觉伺服路径规划研究进展 任秉银１ ， 魏 坤１ ， 吴卓琦２ （１．哈尔滨工业大学 机电工程学院， 哈尔滨 １５０００１； ２．上海交通大学 机械与动力工程学院， 上海 ２００２４０） 摘 要： 视觉伺服控制是机械臂完成各种复杂作业任务的有效手段，而机械臂在动态非结构环境下自主作业的路径规划方法 是视觉伺服控制领域的难点和关键． 分析了动态非结构环境下视觉伺服路径规划中存在的两类约束及其处理方法，介绍并评 述了国内外在机械臂视觉伺服控制中路径规划方面的相关研究进展，讨论并分析了不同路径规划方法在收敛性和稳定性等 方面存在的不足，对未来的研究方向进行了展望． 关键词： 机械臂；视觉伺服；路径规划；约束；动态非结构环境；不确定性 中图分类号： ＴＰ３９１ 文献标志码： Ａ 文章编号： ０３６７－６２３４（２０１８）０１－０００１－１０ Ｒｅｓｅａｒｃｈ ｐｒｏｇｒｅｓｓ ｏｆ ｐａｔｈ ｐｌａｎｎｉｎｇ ｆｏｒ ｖｉｓｕａｌ ｓｅｒｖｏｉｎｇ ｏｆ ｒｏｂｏｔｉｃ ｍａｎｉｐｕｌａｔｏｒ ＲＥＮ Ｂｉｎｇｙｉｎ １ ， ＷＥＩ Ｋｕｎ １ ， ＷＵ Ｚｈｕｏｑｉ ２ （１． Ｓｃｈｏｏｌ ｏｆ Ｍｅｃｈａｔｒｏｎｉｃｓ Ｅｎｇｉｎｅｅｒｉｎｇ， Ｈａｒｂｉｎ Ｉｎｓｔｉｔｕｔｅ ｏｆ Ｔｅｃｈｎｏｌｏｇｙ， Ｈａｒｂｉｎ １５０００１， Ｃｈｉｎａ； ２．Ｓｃｈｏｏｌ ｏｆ Ｍｅｃｈａｎｉｃａｌ ａｎｄ Ｐｏｗｅｒ Ｅｎｇｉｎｅｅｒｉｎｇ， Ｓｈａｎｇｈａｉ Ｊｉａｏｔｏｎｇ Ｕｎｉｖｅｒｓｉｔｙ，Ｓｈａｎｇｈａｉ ２００２４０， Ｃｈｉｎａ） Ａｂｓｔｒａｃｔ： Ｖｉｓｕａｌ ｓｅｒｖｏｉｎｇ ｃｏｎｔｒｏｌ ｉｓ ａｎ ｅｆｆｅｃｔｉｖｅ ｍｅａｎｓ ｆｏｒ ｒｏｂｏｔｉｃ ｍａｎｉｐｕｌａｔｏｒ ｔｏ ｃｏｍｐｌｅｔｅ ｃｏｍｐｌｅｘ ｔａｓｋｓ ａｎｄ ｔｈｅ ｐａｔｈ ｐｌａｎｎｉｎｇ ｍｅｔｈｏｄ ｏｆ ｔｈｅ ｒｏｂｏｔｉｃ ｍａｎｉｐｕｌａｔｏｒ ａｕｔｏｎｏｍｏｕｓ ｏｐｅｒａｔｉｏｎ ｉｎ ｄｙｎａｍｉｃ ｕｎｓｔｒｕｃｔｕｒｅｄ ｅｎｖｉｒｏｎｍｅｎｔ ｉｓ ｔｈｅ ｄｉｆｆｉｃｕｌｔｙ ａｎｄ ｋｅｙ ｉｎ ｔｈｅ ｆｉｅｌｄ ｏｆ ｖｉｓｕａｌ ｓｅｒｖｏｉｎｇ ｃｏｎｔｒｏｌ． Ｔｗｏ ｔｙｐｅｓ ｏｆ ｃｏｎｓｔｒａｉｎｔｓ ｔｈａｔ ｅｘｉｓｔ ｉｎ ｔｈｅ ｖｉｓｕａｌ ｓｅｒｖｏｉｎｇ ｐａｔｈ ｐｌａｎｎｉｎｇ ｉｎ ｄｙｎａｍｉｃ ｕｎｓｔｒｕｃｔｕｒｅｄ ｅｎｖｉｒｏｎｍｅｎｔ ａｎｄ ｔｈｅ ｐｒｏｃｅｓｓｉｎｇ ｍｅｔｈｏｄｓ ｏｆ ｃｏｎｓｔｒａｉｎｔｓ ａｒｅ ａｎａｌｙｚｅｄ． Ｔｈｅ ｒｅｌｅｖａｎｔ ｒｅｓｅａｒｃｈ ｐｒｏｇｒｅｓｓｅｓ ｏｆ ｐａｔｈ ｐｌａｎｎｉｎｇ ｉｎ ｖｉｓｕａｌ ｓｅｒｖｏｉｎｇ ｃｏｎｔｒｏｌ ｏｆ ｒｏｂｏｔｉｃ ｍａｎｉｐｕｌａｔｏｒ ａｔ ｈｏｍｅ ａｎｄ ａｂｒｏａｄ ａｒｅ ｒｅｖｉｅｗｅｄ， ａｎｄ ｔｈｅ ｄｅｆｉｃｉｅｎｃｉｅｓ ｉｎ ｃｏｎｖｅｒｇｅｎｃｅ ａｎｄ ｓｔａｂｉｌｉｔｙ ｏｆ ｄｉｆｆｅｒｅｎｔ ｍｅｔｈｏｄｓ ｏｆ ｐａｔｈ ｐｌａｎｎｉｎｇ ａｒｅ ａｌｓｏ ａｎａｌｙｚｅｄ． Ｔｈｅ ｆｕｔｕｒｅ ｒｅｓｅａｒｃｈ ｄｉｒｅｃｔｉｏｎ ｉｓ ｐｒｏｓｐｅｃｔｅｄ ｂａｓｅｄ ｏｎ ｃｕｒｒｅｎｔ ｒｅｓｅａｒｃｈ ｐｒｏｇｒｅｓｓ． Ｋｅｙｗｏｒｄｓ： ｒｏｂｏｔｉｃ ｍａｎｉｐｕｌａｔｏｒ； ｖｉｓｕａｌ ｓｅｒｖｏｉｎｇ； ｐａｔｈ ｐｌａｎｎｉｎｇ； ｃｏｎｓｔｒａｉｎｔ； ｄｙｎａｍｉｃ ｕｎｓｔｒｕｃｔｕｒｅｄ ｅｎｖｉｒｏｎｍｅｎｔ； ｕｎｃｅｒｔａｉｎｔｙ 收稿日期： ２０１７－１１－２８ 作者简介： 任秉银（１９６６—），男，教授，博士生导师． 通信作者： 任秉银，ｒｅｎｂｙ＠ ｈｉｔ．ｅｄｕ．ｃｎ． 机械臂已经广泛应用于工业自动化领域，但大 多数情况下，机械臂是在静态结构化环境下作业，即 机械臂的作业过程是固定不变的，机械臂只需要重 复运行预先离线编制好的程序即可完成预定作业任 务［１］ ． 在未来智能工厂中，需要机械臂能够在动态 变化的非结构环境下完成复杂作业任务，要求机械 臂具有智能感知外部复杂环境、自主规划作业路径 以及安全作业的能力． 视觉传感器作为非接触式外部传感器，可以感 知机械臂在定位和跟踪任务中环境的动态变化［２］ ． 在视觉伺服中，通常将当前特征和期望特征之间的 误差定义为反馈函数［３－４］ ，通过视觉传感器反馈信 息实时引导机械臂运动，使这个误差趋向于零． 根据误差函数的定义，现有的视觉伺服方法主要 可以分为基于位置的视觉伺服（Ｐｏｓｉｔｉｏｎ⁃Ｂａｓｅｄ Ｖｉｓｕａｌ Ｓｅｒｖｏｉｎｇ， ＰＢＶＳ）和基于图像的视觉伺服（Ｉｍａｇｅ⁃Ｂａｓｅｄ Ｖｉｓｕａｌ Ｓｅｒｖｏｉｎｇ， ＩＢＶＳ）两大类，前者将误差定义在三维 笛卡尔空间，后者将误差直接定义在二维图像空间［５－６］ ． ＩＢＶＳ 对相机标定和建模误差有着较好的鲁棒 性、局部稳定性和收敛性［７］ ． 然而，ＩＢＶＳ 却经常会遇 到全局收敛性问题，尤其当目标初始位姿和期望位 姿相差较大时，可能会导致视觉伺服失败［８］ ． 此外， 当图像特征在相机视野之外也会导致伺服任务失 败． 当 ＩＢＶＳ 不能对机械臂和相机有效控制时，可能 会因为机械臂与工作空间中的障碍物发生碰撞而导 致机械臂无法执行预定操作． 因为在大多数机械臂 应用中都存在着目标的初始和期望位姿相差较大和 多重环境约束，所以融合路径规划技术的 ＩＢＶＳ 策 略可以改善视觉伺服过程的鲁棒性． 视觉伺服路径规划的主要思想是在特定动态非 结构环境约束下规划和生成可执行的图像轨迹，然 后驱动机械臂沿着规划的轨迹完成作业任务［９］ ． 本文首先介绍存在于动态非结构环境视觉伺服 路径规划中的两类重要约束，即相机／ 图像约束和机 械臂／ 物理约束；其次，总结视觉伺服路径规划方法 的研究进展，并分析各种路径规划方法存在的不足； 最后，对未来的研究方向进行展望．

哈尔滨工业大学学报 第50卷 1路径规划中存在的约束 工作空间机械臂和物理障碍物的限制.这些约束包 括:1)机械臂运动学,例如关节限制和机械臂雅可 1998年,法国国家信息与自动化研究所比奇异;2)机械臂动力学;3)与障碍物发生碰撞或 (INRA)的 Chaumette对基于位置的视觉伺服和者自身碰撞;4)由障碍物和机械臂本体引起的遮挡 基于图像的视觉伺服问题进行了研究,讨论了约束或者目标自身遮挡 条件下的PBⅤS和IBⅤS可能存在的稳定性和收敛 过去几十年来,大量科技人员投入到规划可行 性问题,并将这些约束主要分为两大类:(1)相机/路径的研究中,以避免机械臂运动学或者动力学约 图像约束;(2)机械臂/物理约束. 束以及各种各样复杂环境中的物理障碍和自身碰 1.1相机/图像约束 撞121.有些路径规划方法在需要保证目标可见的 相机/图像约束主要是因为视觉系统感知限制,或应用中同时也考虑了遮挡约束-1 者因为“在图像空间中特征的变化率”与“由包含图像1.3约束的处理方法 特征的雅可比矩阵所定义的相机在笛卡尔空间中的移 自从 Chaumette l阐述了经典的视觉伺服中存 动速度”之间的相互关系.这些约束分为:相机视场限在收敛性和稳定性问题后,大量研究工作集中在如 制,图像局部最小化,图像雅可比奇异 何将相机/图像约束、机械臂/物理约束这两大类约 1.1.1相机视场限制 束集成在视觉伺服控制环中 任何相机的视场都是有限的,所获得的图像通 研究人员提出了解耦控制方法0,即相机 常是有限的矩形区域.如果三维物体在相机的视场部分自由度以IBVS方式控制,其余自由度用PBⅤS 内,则其特征投影到相机图像平面是可见的.尽管方式控制,充分利用了各自的优势,从而避免了以上 IBVS控制直接定义在图像平面上,但是当核心特征提及的一部分约束.但每种解耦方法在考虑前述约 在相机中的初始位姿与期望位姿相差很大时,容易束时都有各自的优缺点美国伊利诺伊大学的Gans 造成特征不在相机视场内 等2则用BⅤS详细比较了以上解耦方法的性能和 1.1.2图像局部最小化 效率.受混合系统理论的启发,一些研究人员提出 IBVS中的图像局部最小化是由于不可实现的了由不同视觉伺服控制器组成的混合策略和切换规 图像运动,造成的结果是相机速度为零,但图像误差则2-3,在需要时可切换相应控制器.切换策略增 并不能收敛到零.一般来说,不考虑相机与目标强了经典视觉伺服的稳定性区域,同时可以在不稳 在初始及期望的相对位置直接判断是否会出现图像定的控制器之间切换,提高总体系统的稳定性 最小化是很困难的,导致在视觉伺服任务中反复耗 针对在视觉伺服过程中目标特征可能不在相机 费大量时间搜索图像中的局部最小化.但对于视野内的问题,南开大学刘玺提出了一种移动机 PBVS,因为任务函数定义在笛卡尔空间,所以不存器人自适应主动视觉伺服方法.中国农业大学张春 在图像局部最小化问题 龙{2设计了具有圆柱面相机运动空间的主动视觉 1.1.3图像雅可比奇异 系统,研究了基于粒子群优化算法(PSO)的主动视 当岀现图像雅可比奇异时,图像特征在图像空觉伺服最佳取景方位搜索策略,仿真实现了果树点 间的运动不能驱动机械臂实现相应运动.云空间的主动视觉最佳取景方位搜索.南京航空航 Chaumette8分析了当图像特征矢量由3个共线点天大学刘玉月等2分析了基于视觉伺服的手部跟 组成或者3个点位于以相机光轴为轴线的圆柱面踪技术,并针对 Stewart机器人的动力学模型进行了 时,图像雅可比会出现奇异.虽然使用多于3个非仿真实验,结果表明该方法能够利用主动视觉解决 共面点可以避免奇异,但是图像雅可比仍然可能出手部跟踪运动过程中的自遮挡问题,能够完成手部 现奇异.例如,当视觉伺服任务中相机只绕其光轴跟踪的任务.南开大学李保全等针对单目视觉非 旋转180°时,不论使用多少个特征点定义任务函完整移动机器人系统,提出了一种基于主动视觉选 数,都会导致雅可比奇异. Chaumette也论证了使择策略的视觉伺服镇定控制方法,从而使目标特征 用线特征代替点特征有助于避免奇异,然而,却不能处于相机的视野内 完全消除图像空间的奇异.1997年,美国宾夕法尼 上述每一种解耦或者混合策略以及主动视觉策 亚州立大学的 Sharma等则提出了运动感知力的略都只是解决了其中一部分约束问题.在视觉伺服 概念,并将其作为接近图像奇异的衡量标准 控制环中,融合相机/图像约束和机械臂/物理约束 1.2机械臂/物理约束 (这两类约束在动态非结构环境中确实同时存在) 视觉伺服控制环中相机的运动不可避免地受到是非常具有挑战性的.因此,在视觉伺服控制中融

１ 路径规划中存在的约束 １９９８ 年， 法 国 国 家 信 息 与 自 动 化 研 究 所 （ＩＮＲＩＡ） 的 Ｃｈａｕｍｅｔｔｅ ［８］对基于位置的视觉伺服和 基于图像的视觉伺服问题进行了研究，讨论了约束 条件下的 ＰＢＶＳ 和 ＩＢＶＳ 可能存在的稳定性和收敛 性问题，并将这些约束主要分为两大类：（１） 相机／ 图像约束；（２）机械臂／ 物理约束． １．１ 相机／ 图像约束 相机／ 图像约束主要是因为视觉系统感知限制，或 者因为“在图像空间中特征的变化率”与“由包含图像 特征的雅可比矩阵所定义的相机在笛卡尔空间中的移 动速度”之间的相互关系． 这些约束分为：相机视场限 制，图像局部最小化，图像雅可比奇异． １．１．１ 相机视场限制 任何相机的视场都是有限的，所获得的图像通 常是有限的矩形区域． 如果三维物体在相机的视场 内，则其特征投影到相机图像平面是可见的． 尽管 ＩＢＶＳ 控制直接定义在图像平面上，但是当核心特征 在相机中的初始位姿与期望位姿相差很大时，容易 造成特征不在相机视场内． １．１．２ 图像局部最小化 ＩＢＶＳ 中的图像局部最小化是由于不可实现的 图像运动，造成的结果是相机速度为零，但图像误差 并不能收敛到零［１０］ ． 一般来说，不考虑相机与目标 在初始及期望的相对位置直接判断是否会出现图像 最小化是很困难的，导致在视觉伺服任务中反复耗 费大量时间搜索图像中的局部最小化． 但对于 ＰＢＶＳ，因为任务函数定义在笛卡尔空间，所以不存 在图像局部最小化问题． １．１．３ 图像雅可比奇异 当出现图像雅可比奇异时，图像特征在图像空 间 的 运 动 不 能 驱 动 机 械 臂 实 现 相 应 运 动． Ｃｈａｕｍｅｔｔｅ ［８］分析了当图像特征矢量由 ３ 个共线点 组成或者 ３ 个点位于以相机光轴为轴线的圆柱面 时，图像雅可比会出现奇异． 虽然使用多于 ３ 个非 共面点可以避免奇异，但是图像雅可比仍然可能出 现奇异． 例如，当视觉伺服任务中相机只绕其光轴 旋转 １８０°时，不论使用多少个特征点定义任务函 数，都会导致雅可比奇异． Ｃｈａｕｍｅｔｔｅ ［８］ 也论证了使 用线特征代替点特征有助于避免奇异，然而，却不能 完全消除图像空间的奇异． １９９７ 年，美国宾夕法尼 亚州立大学的 Ｓｈａｒｍａ 等［１１］则提出了运动感知力的 概念，并将其作为接近图像奇异的衡量标准． １．２ 机械臂／ 物理约束 视觉伺服控制环中相机的运动不可避免地受到 工作空间机械臂和物理障碍物的限制． 这些约束包 括：１）机械臂运动学，例如关节限制和机械臂雅可 比奇异；２）机械臂动力学；３）与障碍物发生碰撞或 者自身碰撞；４）由障碍物和机械臂本体引起的遮挡 或者目标自身遮挡． 过去几十年来，大量科技人员投入到规划可行 路径的研究中，以避免机械臂运动学或者动力学约 束以及各种各样复杂环境中的物理障碍和自身碰 撞［１２－１３］ ． 有些路径规划方法在需要保证目标可见的 应用中同时也考虑了遮挡约束［１４－１５］ ． １．３ 约束的处理方法 自从 Ｃｈａｕｍｅｔｔｅ ［８］ 阐述了经典的视觉伺服中存 在收敛性和稳定性问题后，大量研究工作集中在如 何将相机／ 图像约束、机械臂／ 物理约束这两大类约 束集成在视觉伺服控制环中． 研究人员提出了解耦控制方法［１６－２０］ ，即相机一 部分自由度以 ＩＢＶＳ 方式控制，其余自由度用 ＰＢＶＳ 方式控制，充分利用了各自的优势，从而避免了以上 提及的一部分约束． 但每种解耦方法在考虑前述约 束时都有各自的优缺点． 美国伊利诺伊大学的 Ｇａｎｓ 等［２１］则用 ＩＢＶＳ 详细比较了以上解耦方法的性能和 效率． 受混合系统理论的启发，一些研究人员提出 了由不同视觉伺服控制器组成的混合策略和切换规 则［２２－２５］ ，在需要时可切换相应控制器． 切换策略增 强了经典视觉伺服的稳定性区域，同时可以在不稳 定的控制器之间切换，提高总体系统的稳定性． 针对在视觉伺服过程中目标特征可能不在相机 视野内的问题，南开大学刘玺［２６］ 提出了一种移动机 器人自适应主动视觉伺服方法． 中国农业大学张春 龙［２７］设计了具有圆柱面相机运动空间的主动视觉 系统，研究了基于粒子群优化算法（ＰＳＯ）的主动视 觉伺服最佳取景方位搜索策略，仿真实现了果树点 云空间的主动视觉最佳取景方位搜索． 南京航空航 天大学刘玉月等［２８］ 分析了基于视觉伺服的手部跟 踪技术，并针对 Ｓｔｅｗａｒｔ 机器人的动力学模型进行了 仿真实验，结果表明该方法能够利用主动视觉解决 手部跟踪运动过程中的自遮挡问题，能够完成手部 跟踪的任务． 南开大学李保全等［２９］针对单目视觉非 完整移动机器人系统，提出了一种基于主动视觉选 择策略的视觉伺服镇定控制方法，从而使目标特征 处于相机的视野内． 上述每一种解耦或者混合策略以及主动视觉策 略都只是解决了其中一部分约束问题． 在视觉伺服 控制环中，融合相机／ 图像约束和机械臂／ 物理约束 （这两类约束在动态非结构环境中确实同时存在） 是非常具有挑战性的． 因此，在视觉伺服控制中融 ·２· 哈 尔 滨 工 业 大 学 学 报 第 ５０ 卷

第1期 任秉银,等:机械臂视觉伺服路径规划研究进展 3 合路径规划以解决上述约束问题是非常必要的 2视觉伺服路径规划 视觉伺服路径规划的主要思想是在考虑上述所 Goal gripper 有约束条件下规划和生成可行的图像轨迹,然后以 IBⅤsS驱动机械臂沿着规划的轨迹进行作业0.通 过将较大的初始误差离散化,使得在每个伺服周期 中的误差足够小,从而能够充分地利用IBVS出色 的局部稳定性与鲁棒性5 根据路径规划方法特点和所做的假设,与视觉 伺服相结合的路径规划方法可以分为以下5类:1) 图1虚拟手爪上的点沿直线平移 图像空间路径规划;2)基于优化的路径规划;3)基 Fig.1 Points on the virtual gl ipper moving along a straight line[ 35) 于势场法的路径规划;4)全局路径规划;5)不确定2.12射影单应性 性下视觉伺服路径规划. 法国国家信息与自动化研究所一直致力于图像 2.1图像空间路径规划 空间路径规划方面研究工作.为了避免计算可行相 图像空间路径规划技术旨在初始图像和期望图机路径依赖于相机标定和目标模型,1993年,该研 像之间插入一条路径而不需要任何相机标定或者目究所的 faugeras使用初始图像和期望图像建立 标模型.这种方法的难点在于规划的图像空间路径射影几何关系,由于定义在射影空间,相机在欧几里 可能不会对应唯一的相机路径.所以,学者们又研德空间的位移可以部分参数化,而不需要显式重建 究了规划图像路径对应无标定环境中可执行的相机欧几里德空间分量.射影单应性矩阵可以被应用在 路径.其中,对极几何、射影单应性和射影不变性等路径规划方法中,它体现了同一场景不同视野之间 射影几何知识被应用于图像空间路径规划中. 的关系,可以从两幅图像中的点、线、面和轮廓等特 2.1.1对极几何 征估计得到3-3 1995年,日本大阪大学 Hosoda等基于定义 2003年,NRIA的 Mezouar等又提出一种在 在由机械臂末端的立体相机(眼在手上配置)获得初始图像和期望图像之间插入共线矩阵来获得封闭 图像中的对极几何约束,直接在图像空间中设计视的共线路径的无标定路径规划方法,使用IVs跟 觉伺服轨迹生成器,然后利用基于雅可比估计器的踪求导后的图像特征轨迹.然而,这种方法在存在 无标定视觉伺服控制器跟踪规划好的图像轨迹,从视野约束时却不能保证收敛到期望位置.法国巴黎 而实现了在不需要任何系统或者相机标定等先验知第六大学 Schramm等则在上述研究基础上引入 识的前提下,保证机械臂末端执行器能够在未知环了可见性约束来扩展这种方法,通过引导目标上任 境中避开障碍物 意选择的参考点在图像中沿着直线运动,从而保证 2003年,澳州国立大学 Hartley等通过给定参考点始终处于相机视野内由此带来的问题是 同一场景的多个视角,也采用对极几何研究了无标相机不再沿着直线运动,并且其他特征也可能会不 定视觉伺服问题.在没有目标物体的任何三维信息在相机视野内,所以设计了深度模块,通过控制相机 的情况下,韩国先进科技学院Pak和 chung提出沿着光轴后退来保证无论何时一个特征到达相机视 了基于眼在手外的立体视觉抓取场景中的无标定图野边界时,其它特征都实时可见 像空间路径规划方法,在初始图像和期望图像的射 一些研究人员采用分解欧几里德单应性矩阵的 影空间中利用对极几何沿着一条直线生成机械臂手方法来规划图像路径,从而生成可执行的相机路径 爪的一系列中间视图,这些中间视图组成期望的图而不需要笛卡尔空间相机路径的重建.例如,拉彭 像轨迹,然后利用法国国家信息与自动化研究所兰塔科技大学Kyk等4提出一种基于单应性矩阵 (INRA)的Espa等提出的BVS方法控制机械部分位姿估计的最短路径规划方法,该方法直接沿 臂沿着图像轨迹运动,机械臂跟随轨迹的同时,手爪着单应性矩阵分解得到的方向移动手眼相机到达工 可以在三维工作空间走直线,整个运动过程中手爪作空间的期望位姿,同时保证位于目标物体中心虚 的特征点始终处在相机视野内,如图1所示,可以看拟点的可见性佛罗伦萨大学Aota等提出一个 岀末端执行器手抓虚拟点始终沿着直线运动,而未类似的基于单应性分解的方法,选择螺旋线路径代 逃离相机视野 替直线路径作为参考路径来表示相机从初始位姿到

合路径规划以解决上述约束问题是非常必要的． ２ 视觉伺服路径规划 视觉伺服路径规划的主要思想是在考虑上述所 有约束条件下规划和生成可行的图像轨迹，然后以 ＩＢＶＳ 驱动机械臂沿着规划的轨迹进行作业［３０］ ． 通 过将较大的初始误差离散化，使得在每个伺服周期 中的误差足够小，从而能够充分地利用 ＩＢＶＳ 出色 的局部稳定性与鲁棒性［３１］ ． 根据路径规划方法特点和所做的假设，与视觉 伺服相结合的路径规划方法可以分为以下 ５ 类：１） 图像空间路径规划；２）基于优化的路径规划；３） 基 于势场法的路径规划；４）全局路径规划；５） 不确定 性下视觉伺服路径规划． ２．１ 图像空间路径规划 图像空间路径规划技术旨在初始图像和期望图 像之间插入一条路径而不需要任何相机标定或者目 标模型． 这种方法的难点在于规划的图像空间路径 可能不会对应唯一的相机路径． 所以，学者们又研 究了规划图像路径对应无标定环境中可执行的相机 路径． 其中，对极几何、射影单应性和射影不变性等 射影几何知识被应用于图像空间路径规划中． ２．１．１ 对极几何 １９９５ 年，日本大阪大学 Ｈｏｓｏｄａ 等［３２］ 基于定义 在由机械臂末端的立体相机（眼在手上配置） 获得 图像中的对极几何约束，直接在图像空间中设计视 觉伺服轨迹生成器，然后利用基于雅可比估计器的 无标定视觉伺服控制器跟踪规划好的图像轨迹，从 而实现了在不需要任何系统或者相机标定等先验知 识的前提下，保证机械臂末端执行器能够在未知环 境中避开障碍物． ２００３ 年，澳州国立大学 Ｈａｒｔｌｅｙ 等［３３］ 通过给定 同一场景的多个视角，也采用对极几何研究了无标 定视觉伺服问题． 在没有目标物体的任何三维信息 的情况下，韩国先进科技学院 Ｐａｒｋ 和 Ｃｈｕｎｇ ［３４］提出 了基于眼在手外的立体视觉抓取场景中的无标定图 像空间路径规划方法，在初始图像和期望图像的射 影空间中利用对极几何沿着一条直线生成机械臂手 爪的一系列中间视图，这些中间视图组成期望的图 像轨迹，然后利用法国国家信息与自动化研究所 （ＩＮＲＩＡ）的 Ｅｓｐｉａｕ 等［３５］提出的 ＩＢＶＳ 方法控制机械 臂沿着图像轨迹运动，机械臂跟随轨迹的同时，手爪 可以在三维工作空间走直线，整个运动过程中手爪 的特征点始终处在相机视野内，如图 １ 所示，可以看 出末端执行器手抓虚拟点始终沿着直线运动，而未 逃离相机视野． I12 I12 I1 G1 Gk* Gk* G1 * GRk GRk kthvirtual gripper Initialgripper Goalgripper I11 k* k k 2 1 2 1 图 １ 虚拟手爪上的点沿直线平移［３５］ Ｆｉｇ．１ Ｐｏｉｎｔｓ ｏｎ ｔｈｅ ｖｉｒｔｕａｌ ｇｒｉｐｐｅｒ ｍｏｖｉｎｇ ａｌｏｎｇ ａ ｓｔｒａｉｇｈｔ ｌｉｎｅ ［３５］ ２．１．２ 射影单应性 法国国家信息与自动化研究所一直致力于图像 空间路径规划方面研究工作． 为了避免计算可行相 机路径依赖于相机标定和目标模型，１９９３ 年，该研 究所的 Ｆａｕｇｅｒａｓ ［３６］ 使用初始图像和期望图像建立 射影几何关系，由于定义在射影空间，相机在欧几里 德空间的位移可以部分参数化，而不需要显式重建 欧几里德空间分量． 射影单应性矩阵可以被应用在 路径规划方法中，它体现了同一场景不同视野之间 的关系，可以从两幅图像中的点、线、面和轮廓等特 征估计得到［３７－３８］ ． ２００３ 年，ＩＮＲＩＡ 的 Ｍｅｚｏｕａｒ 等［３９］ 又提出一种在 初始图像和期望图像之间插入共线矩阵来获得封闭 的共线路径的无标定路径规划方法，使用 ＩＢＶＳ 跟 踪求导后的图像特征轨迹． 然而，这种方法在存在 视野约束时却不能保证收敛到期望位置． 法国巴黎 第六大学 Ｓｃｈｒａｍｍ 等［４０］ 则在上述研究基础上引入 了可见性约束来扩展这种方法，通过引导目标上任 意选择的参考点在图像中沿着直线运动，从而保证 参考点始终处于相机视野内． 由此带来的问题是， 相机不再沿着直线运动，并且其他特征也可能会不 在相机视野内，所以设计了深度模块，通过控制相机 沿着光轴后退来保证无论何时一个特征到达相机视 野边界时，其它特征都实时可见． 一些研究人员采用分解欧几里德单应性矩阵的 方法来规划图像路径，从而生成可执行的相机路径 而不需要笛卡尔空间相机路径的重建． 例如，拉彭 兰塔科技大学 Ｋｙｒｋｉ 等［４１］提出一种基于单应性矩阵 部分位姿估计的最短路径规划方法，该方法直接沿 着单应性矩阵分解得到的方向移动手眼相机到达工 作空间的期望位姿，同时保证位于目标物体中心虚 拟点的可见性． 佛罗伦萨大学 Ａｌｌｏｔｔａ 等［４２］提出一个 类似的基于单应性分解的方法，选择螺旋线路径代 替直线路径作为参考路径来表示相机从初始位姿到 第 １ 期 任秉银， 等： 机械臂视觉伺服路径规划研究进展 ·３·

哈尔滨工业大学学报 第50卷 期望位姿的平移运动.威斯康星大学麦迪逊分校求解器解决优化问题,从而通过最小化已知权重的 Borgstadt等使用特殊的单应性矩阵分解为一个动能函数和来获得最优的图像路径,但是该方法只 已知模型的平面目标,从初始图像到期望图像之间能应用在二维和三维环境下的移动机器人 插入一条路径.由于目标模型已知,利用三维重建 为了解决基于优化的视觉伺服路径规划方法中 将插值好的期望路径转换到相机可执行的不与工作存在的问题,也有研究者引进各种参数化相机路径 空间边界碰撞的路径 的方法.2007年,意大利锡耶纳大学 Chesi等{利 21.3射影不变性 用多项式系数参数化相机路径,通过线性插值得到 2001年,法国雷恩大学 Malise4提出一个通过相机的平移路径,再通过凯利旋转表示法径向参数 射影变换定义在不变空间中的基于图像的路径规划化相机的旋转路径,使图像中的单一路径离图像边 方法.射影不变性的基本思想是构建一个相对相机界的距离很容易由多项式的根计算得到.因此,优 内参数不变的任务函数,只依赖于相机的位置相对化问题等价转化为在所有参数化路径中最大化图像 观测目标和它的3D结构.这使得在不变空间生成边界距离.在跟随规划好的图像路径时,假如相机 的特征矢量路径独立于相机内参数,同时对应相机没有标定误差,相机将会在工作空间跟随一条直线 在工作空间的路径是一条直线.此外,视觉系统安而事实上,标定误差是必然存在的,相机则不会走直 装电机驱动伸缩平台可以保证特征的可见性 线而是沿着不同的曲线移动,曲线离规划的直线的 综上所述,直接在图像空间路径规划的主要优距离也会随着标定误差的增大而变大 势在于无需考虑相机标定和目标模型;但是,由于在 Chesi等提出一种以最小化图像面积、轨迹 图像空间规划路径,所以这些方法不能很好解决复长度和曲率为优化目标,同时考虑相机视野、工作空 杂视觉伺服场景中的机械臂/物理约束. 间和关节限制约束的路径规划方法.设计了多项式 22基于优化的路径规划 参数化所有连接相机初始位姿和期望位姿的路径 在视觉伺服任务中,可能同时存在许多不同的相机位姿则是通过图像测量和目标模型的三维重建 相机路径,研究人员总是设法规划出优化的机器人获得.此外,设计的非凸型优化方法导致了多个可 路径.优化技术旨在从成本函数(图像边界距离,路行区域,并且每个区域存在多个局部最优解.因此 径长度和能量消耗等)中找到一条优化的路径 在所有可行区域中找到全局最优解是非常困难的 Mezouar等以最小能量和最小加速度为优化 Chesil4还通过齐次形式参数化从初始位姿到期望 目标在图像空间规划相机路径,在初始和期望图像之位姿的路径.利用合适的正则齐次形式建立约束模 间插入中间图像,该方法保证了收敛性,却没有考虑型,通过求解凸优化的线性矩阵不等式 可见性约束.因此,图像特征可能会不在相机视野内.( Linear MatrixInequalities,LMI)获得了合理可执行 1997年,美国宾夕法尼亚州立大学 Sharma的路径,从而使得期望的性能最优:包括特征离图像 等提出了基于感知控制流形( Perceptual Control边界的距离、相机离障碍物的距离以及规划的路径 Manifold,pPCM)的眼在手外的路径规划框架,PCM尽可能成直线 定义了机械臂关节空间和目标物体图像空间组成的 2007年,伊利诺伊大学香槟分校 bhattacharya 内积空间PCM被认为是从机械臂构型到可见图像等针对差分驱动机器人( Differential Driving 特征矢量的一种映射,可以将相机视野约束和机械 Robot,DDR)利用最优控制理论设计图像轨迹,使 臂关节限制以及障碍物映射到PCM可解空间;但其位于相机视野之内并满足路标的可见性,再将图 是,考虑到约束的数量和机械臂的自由度,这种映射形轨迹映射到笛卡尔空间,生成由直线和T型曲线 相当耗时.所以又提出各种优化准则(比如最小速构成的最短路径,图2给出了生成的T型最短路径 度、最小拦截时间和最少机械臂运动),在一系列可同时保证了可见性约束 行的PCM中找到最优路径.优化后的PCM方法结 西班牙萨拉戈萨大学Lope- Nicolas等设计 合全局场景的视觉伺服可以用在拦截一个轨迹已知了基于单应性矩阵元素的收敛性的切换视觉伺服控 的运动物体,而固定相机则可以同时观察到机械臂制器来跟踪这些最短路径.法国图卢兹大学 Havet 末端执行器和运动目标 等在杂乱障碍物环境下为DDR设计了完备的运 2002年,美国罗文大学 Zhang等提出的视觉动规划器将最优曲线段作为运动基元设计局部最 运动规划方法用一系列等式和不等式描述机器人沿优路径,从而满足障碍物和可见性约束下DDR路径 着视场边界的运动约束,可以为移动机器人满足可是可执行的.但是,由于障碍物被假定为透明的,所 见性约束下规划出最优的路径.利用拉格朗日数值以忽略了障碍物引起的遮挡问题.意大利比萨大学

期望位姿的平移运动． 威斯康星大学麦迪逊分校 Ｂｏｒｇｓｔａｄｔ 等［４３］ 使用特殊的单应性矩阵分解为一个 已知模型的平面目标，从初始图像到期望图像之间 插入一条路径． 由于目标模型已知，利用三维重建 将插值好的期望路径转换到相机可执行的不与工作 空间边界碰撞的路径． ２．１．３ 射影不变性 ２００１ 年，法国雷恩大学 Ｍａｌｉｓ ［４４］ 提出一个通过 射影变换定义在不变空间中的基于图像的路径规划 方法． 射影不变性的基本思想是构建一个相对相机 内参数不变的任务函数，只依赖于相机的位置相对 观测目标和它的 ３Ｄ 结构． 这使得在不变空间生成 的特征矢量路径独立于相机内参数，同时对应相机 在工作空间的路径是一条直线． 此外，视觉系统安 装电机驱动伸缩平台可以保证特征的可见性． 综上所述，直接在图像空间路径规划的主要优 势在于无需考虑相机标定和目标模型；但是，由于在 图像空间规划路径，所以这些方法不能很好解决复 杂视觉伺服场景中的机械臂／ 物理约束． ２．２ 基于优化的路径规划 在视觉伺服任务中，可能同时存在许多不同的 相机路径，研究人员总是设法规划出优化的机器人 路径． 优化技术旨在从成本函数（图像边界距离，路 径长度和能量消耗等）中找到一条优化的路径． Ｍｅｚｏｕａｒ 等［３９］以最小能量和最小加速度为优化 目标在图像空间规划相机路径，在初始和期望图像之 间插入中间图像，该方法保证了收敛性，却没有考虑 可见性约束． 因此，图像特征可能会不在相机视野内． １９９７ 年， 美 国 宾 夕 法 尼 亚 州 立 大 学 Ｓｈａｒｍａ 等［４５］提出了基于感知控制流形（ Ｐｅｒｃｅｐｔｕａｌ Ｃｏｎｔｒｏｌ Ｍａｎｉｆｏｌｄ， ＰＣＭ）的眼在手外的路径规划框架，ＰＣＭ 定义了机械臂关节空间和目标物体图像空间组成的 内积空间． ＰＣＭ 被认为是从机械臂构型到可见图像 特征矢量的一种映射，可以将相机视野约束和机械 臂关节限制以及障碍物映射到 ＰＣＭ 可解空间；但 是，考虑到约束的数量和机械臂的自由度，这种映射 相当耗时． 所以又提出各种优化准则（比如最小速 度、最小拦截时间和最少机械臂运动），在一系列可 行的 ＰＣＭ 中找到最优路径． 优化后的 ＰＣＭ 方法结 合全局场景的视觉伺服可以用在拦截一个轨迹已知 的运动物体，而固定相机则可以同时观察到机械臂 末端执行器和运动目标． ２００２ 年，美国罗文大学 Ｚｈａｎｇ 等［４６］提出的视觉 运动规划方法用一系列等式和不等式描述机器人沿 着视场边界的运动约束，可以为移动机器人满足可 见性约束下规划出最优的路径． 利用拉格朗日数值 求解器解决优化问题，从而通过最小化已知权重的 动能函数和来获得最优的图像路径，但是该方法只 能应用在二维和三维环境下的移动机器人． 为了解决基于优化的视觉伺服路径规划方法中 存在的问题，也有研究者引进各种参数化相机路径 的方法． ２００７ 年，意大利锡耶纳大学 Ｃｈｅｓｉ 等［４７］ 利 用多项式系数参数化相机路径，通过线性插值得到 相机的平移路径，再通过凯利旋转表示法径向参数 化相机的旋转路径，使图像中的单一路径离图像边 界的距离很容易由多项式的根计算得到． 因此，优 化问题等价转化为在所有参数化路径中最大化图像 边界距离． 在跟随规划好的图像路径时，假如相机 没有标定误差，相机将会在工作空间跟随一条直线． 而事实上，标定误差是必然存在的，相机则不会走直 线而是沿着不同的曲线移动，曲线离规划的直线的 距离也会随着标定误差的增大而变大． Ｃｈｅｓｉ 等［４８］ 提出一种以最小化图像面积、轨迹 长度和曲率为优化目标，同时考虑相机视野、工作空 间和关节限制约束的路径规划方法． 设计了多项式 参数化所有连接相机初始位姿和期望位姿的路径， 相机位姿则是通过图像测量和目标模型的三维重建 获得． 此外，设计的非凸型优化方法导致了多个可 行区域，并且每个区域存在多个局部最优解． 因此， 在所有可行区域中找到全局最优解是非常困难的． Ｃｈｅｓｉ ［４９］还通过齐次形式参数化从初始位姿到期望 位姿的路径． 利用合适的正则齐次形式建立约束模 型， 通 过 求 解 凸 优 化 的 线 性 矩 阵 不 等 式 （ＬｉｎｅａｒＭａｔｒｉｘＩｎｅｑｕａｌｉｔｉｅｓ， ＬＭＩ） 获得了合理可执行 的路径，从而使得期望的性能最优：包括特征离图像 边界的距离、相机离障碍物的距离以及规划的路径 尽可能成直线． ２００７ 年，伊利诺伊大学香槟分校 Ｂｈａｔｔａｃｈａｒｙａ 等［５０］ 针 对 差 分 驱 动 机 器 人 （ Ｄｉｆｆｅｒｅｎｔｉａｌ Ｄｒｉｖｉｎｇ Ｒｏｂｏｔ， ＤＤＲ） 利用最优控制理论设计图像轨迹，使 其位于相机视野之内并满足路标的可见性，再将图 形轨迹映射到笛卡尔空间，生成由直线和 Ｔ 型曲线 构成的最短路径，图 ２ 给出了生成的 Ｔ 型最短路径， 同时保证了可见性约束． 西班牙萨拉戈萨大学 Ｌｏｐｅｚ－Ｎｉｃｏｌａｓ 等［５１］ 设计 了基于单应性矩阵元素的收敛性的切换视觉伺服控 制器来跟踪这些最短路径． 法国图卢兹大学 Ｈａｙｅｔ 等［５２］在杂乱障碍物环境下为 ＤＤＲ 设计了完备的运 动规划器，将最优曲线段作为运动基元设计局部最 优路径，从而满足障碍物和可见性约束下 ＤＤＲ 路径 是可执行的． 但是，由于障碍物被假定为透明的，所 以忽略了障碍物引起的遮挡问题． 意大利比萨大学 ·４· 哈 尔 滨 工 业 大 学 学 报 第 ５０ 卷

任秉银,等:机械臂视觉伺服路径规划研究进展 Salaris等则将 Bhattacharya等研究的图像空 Mezouar和 Chalmette研究了基于势场法的 间中获得的最优曲线进行了扩展,以便利用IBVS手眼机械臂图像视觉伺服控制,考虑了相机视野和 控制器可以直接在图像空间执行,实现了通过李雅机械臂关节限制两种约束(如图3所示),分别给出 普诺夫函数( Lyapunov Function)使得图像中沿着这人工势场随着关节角度和图像视野的变化关系.为 些最优路径运动的反馈控制.然而,对于DDR,所有了获得合理的机械臂轨迹,首先在工作空间规划机 最短路径的完整特性和它们的解析描述仍没有得到械臂运动,然后投影到图像空间.定义在工作空间 完全解决 的吸引势场将机械臂拉向最终期望位姿,考虑到以 上约束,排斥势场定义在图像空间和关节空间驱使 Q 图像轨迹远离图像边界和避免关节限制.所以,作 用在机械臂总的合力是吸引势能和排斥势能沿负梯 度方向计算得到各自分力的权值之和.图像轨迹将 会沿着机械臂合力方向生成,然后随着时间离散化 之后,最终可以用IBⅤS方法跟踪这些图像轨迹.以 上策略可以应用在已知或者未知模型的目标,针对 后者情形,利用欧几里德重建可以获得工作空间的 相机路径,沿着特征轨迹的当前期望的图像特征来 更新图像雅可比,可以自动避免图像局部最小化 图2生成的最短路径 Fig 2 Generated T-type shortest path (50 加拿大康考迪亚大学 Keshmiri等提出了基 于优化预定义的轨迹规划方法,通过最小化图像特 征误差函数获得轨迹参数,利用深度估计算法为目 标轨迹规划提供深度信息,再利用视觉控制器补偿 期望特征匹配时产生的误差,从而生成了满足系统 始末条件的轨迹,该规划方法的优势在于将位置规 (a)关节约束排斥势场 划和姿态规划解耦,同时获得了末端执行器的速度 旋量 2017年,西安航空学院马翔宇等通过非线 性优化算法对其最短路径进行优化设计,计算其最 短路径下各关节对应的旋转角度和移动距离,并对 其稳定性进行了分析 尽管以上基于优化的路径规划方法考虑了实际 问题的复杂性并生成了最优路径,但是这些方法仍 或多或少局限于简单场景和系统.引入机械臂/物 (b)视野约束排斥势场 图3人工势场随着两种约束的变化关系 理约束很大程度上增加了优化问题的复杂性,因此, 在以上优化框架中考虑上述约束也大幅度增加了时1432 ariation of artificial potential field with two kinds of 间的复杂度 基于势场法的路径规划方法在添加实际物理约 23基于势场法的路径规划 束(如避障、遮挡)则总势场非常有可能陷入局部最 人工势场法在机械臂路径规划领域中被认为是小化.为了避免吸引力与排斥力之和引起的局部最 种很有前途的快速局部避障策略,可以为机械臂小化,1985年,加拿大滑铁卢大学 Kirkpatrick等{ 在约束环境下规划出实时安全的运动路径,主要利用模拟退火的方法调节初始温度和冷却速率来保 思路是构建人工势能场,“吸引势能之和”吸引机械证收敛到全局最小化.提出的规划框架采用了两种 臂朝向期望位置,“排斥势能之和”使机械臂远离各不同轨迹生成策略:方法一是相对静止的目标坐标 种约束(例如障碍物和机械臂关节限制),最终机械系规划末端执行器轨迹;方法二则是相对当前末端 臂将沿着势场负梯度方向到达目标位置 执行器坐标系规划目标轨迹.前者生成的相机路径

Ｓａｌａｒｉｓ 等［５３］ 则将 Ｂｈａｔｔａｃｈａｒｙａ 等［５０］ 研究的图像空 间中获得的最优曲线进行了扩展，以便利用 ＩＢＶＳ 控制器可以直接在图像空间执行，实现了通过李雅 普诺夫函数（Ｌｙａｐｕｎｏｖ Ｆｕｎｃｔｉｏｎ）使得图像中沿着这 些最优路径运动的反馈控制． 然而，对于 ＤＤＲ，所有 最短路径的完整特性和它们的解析描述仍没有得到 完全解决． O Q Q Q P Q Q Ⅰ Ⅱ Ⅲ’ Ⅳ T1P T2P T1Q Ⅱ’ Q Ⅰ’ T2 U T1U Ⅲ T2P Q T1P T2Q Q Ⅴ 图 ２ 生成的最短路径［５０］ Ｆｉｇ．２ Ｇｅｎｅｒａｔｅｄ Ｔ － ｔｙｐｅ ｓｈｏｒｔｅｓｔ ｐａｔｈ ［５０］ 加拿大康考迪亚大学 Ｋｅｓｈｍｉｒｉ 等［５４］ 提出了基 于优化预定义的轨迹规划方法，通过最小化图像特 征误差函数获得轨迹参数，利用深度估计算法为目 标轨迹规划提供深度信息，再利用视觉控制器补偿 期望特征匹配时产生的误差，从而生成了满足系统 始末条件的轨迹，该规划方法的优势在于将位置规 划和姿态规划解耦，同时获得了末端执行器的速度 旋量． ２０１７ 年，西安航空学院马翔宇等［５５］ 通过非线 性优化算法对其最短路径进行优化设计，计算其最 短路径下各关节对应的旋转角度和移动距离，并对 其稳定性进行了分析． 尽管以上基于优化的路径规划方法考虑了实际 问题的复杂性并生成了最优路径，但是这些方法仍 或多或少局限于简单场景和系统． 引入机械臂／ 物 理约束很大程度上增加了优化问题的复杂性，因此， 在以上优化框架中考虑上述约束也大幅度增加了时 间的复杂度． ２．３ 基于势场法的路径规划 人工势场法在机械臂路径规划领域中被认为是 一种很有前途的快速局部避障策略，可以为机械臂 在约束环境下规划出实时安全的运动路径［５６］ ，主要 思路是构建人工势能场，“吸引势能之和”吸引机械 臂朝向期望位置，“排斥势能之和”使机械臂远离各 种约束（例如障碍物和机械臂关节限制），最终机械 臂将沿着势场负梯度方向到达目标位置［５７］ ． Ｍｅｚｏｕａｒ 和 Ｃｈａｕｍｅｔｔｅ ［３０］ 研究了基于势场法的 手眼机械臂图像视觉伺服控制，考虑了相机视野和 机械臂关节限制两种约束（如图 ３ 所示），分别给出 人工势场随着关节角度和图像视野的变化关系． 为 了获得合理的机械臂轨迹，首先在工作空间规划机 械臂运动，然后投影到图像空间． 定义在工作空间 的吸引势场将机械臂拉向最终期望位姿，考虑到以 上约束，排斥势场定义在图像空间和关节空间驱使 图像轨迹远离图像边界和避免关节限制． 所以，作 用在机械臂总的合力是吸引势能和排斥势能沿负梯 度方向计算得到各自分力的权值之和． 图像轨迹将 会沿着机械臂合力方向生成，然后随着时间离散化 之后，最终可以用 ＩＢＶＳ 方法跟踪这些图像轨迹． 以 上策略可以应用在已知或者未知模型的目标，针对 后者情形，利用欧几里德重建可以获得工作空间的 相机路径，沿着特征轨迹的当前期望的图像特征来 更新图像雅可比，可以自动避免图像局部最小化． vq lj lj q lj min qlj qmax qmax qj min （ａ） 关节约束排斥势场 Vr um Vm UM VM （ｂ） 视野约束排斥势场 图 ３ 人工势场随着两种约束的变化关系［３０］ Ｆｉｇ． ３ Ｖａｒｉａｔｉｏｎ ｏｆ ａｒｔｉｆｉｃｉａｌ ｐｏｔｅｎｔｉａｌ ｆｉｅｌｄ ｗｉｔｈ ｔｗｏ ｋｉｎｄｓ ｏｆ ｃｏｎｓｔｒａｉｎｔｓ ［３０］ 基于势场法的路径规划方法在添加实际物理约 束（如避障、遮挡）则总势场非常有可能陷入局部最 小化． 为了避免吸引力与排斥力之和引起的局部最 小化，１９８５ 年，加拿大滑铁卢大学 Ｋｉｒｋｐａｔｒｉｃｋ 等［５８］ 利用模拟退火的方法调节初始温度和冷却速率来保 证收敛到全局最小化． 提出的规划框架采用了两种 不同轨迹生成策略：方法一是相对静止的目标坐标 系规划末端执行器轨迹；方法二则是相对当前末端 执行器坐标系规划目标轨迹． 前者生成的相机路径 第 １ 期 任秉银， 等： 机械臂视觉伺服路径规划研究进展 ·５·

哈尔滨工业大学学报 第50卷 在工作空间近乎直线,而后者目标原点的图像轨迹利用局部规划器在机械臂关节空间中跟踪这些路 受到约束,在图像中沿着近乎直线运动,减小了图像径,避免了关节限制和与障碍物发生碰撞,从而保障 特征不在相机视野内的几率 了机械臂可以顺利运动.斯坦福大学 Kuffner等6 针对人工势场法可能会进入局部极小这一缺和中国科学技术大学杜明博等6分别采用一个搜 陷,中国海洋大学唐彪等通过添加虚拟目标点来索树作为规划器,利用快速扩展随机树( Rapidly 改进人工势场法.该方法可以让机械臂逃离局部极 exploring Random Tree,RRT)算法在其中搜索可行 小点,实现机械臂的避障路径规划. 的路径,然后即可从搜索树中提取出连接相机初始 中国农业大学赵栋杰针对喷雾机器人的连位姿和期望位姿的路径,进而投影到图像空间获得 续运动作业模式,提出了一种基于改进势场法的喷采样特征轨迹作为一系列图像路径点.最终,这些 雰机械臂运动规划对靶实时控制算法,该算法在传路径点被时间参数化成三次样条曲线后利用IVS 统势场法基础上引入了速度势场、视场约束和关节进行跟踪. 极限位置约束,可规划出更优的喷雾机械臂运动轨 针对基本RRT算法和Bi-RRT(双向搜索树) 迹,有效提高喷雾机器人对靶控制的鲁棒性. 算法生成路径不光滑问题,任秉银提出了改进的S- 当然,也可以设计局部切换策略,即当沿着规划RRT光滑算法,并对上述三种RRT算法的自主避障 轨迹检测到接近图像局部最小化和图像奇异时从(人体模型为障碍物)路径规划结果进行了对比,如 IBⅤS切换到PBⅤS.该方法的不足之处在于为了避图4所示 免由于重复切换引起的不稳定性,切换策略只能使 用一次.然而,在系统切换到PBVS后也不能完全保 证仍然满足视野约束和关节限制 势场法的主要优势在于可以快速计算出驱动 力,非常适合实时视觉伺服应用.当跟踪图像轨迹 需要考虑到由于建模和标定对规划轨迹带来的偏差 影响时,即可应用以上策略 24全局路径规划 RATE 当考虑所有约束时,以上视觉伺服任务中的路 径规划方法会出现收敛性问题,所以研究者又探索 了全局路径规划方法.2002年,美国加州大学伯克 利分校 Cowan等6提出一种基于导航函数的全局 -rrt Rusic-RRT 稳定性策略,可以保证从任意初始位姿收敛到可见 期望位姿,同时保证所有特征沿着路径可见,而不需 43种RRT算法路径规划结果对比 要跟随预定义参考图像轨迹但是构建这种导航函Fg4 Comparison of path planning results of three kinds of 数受限于非常简单的应用场景 2008年,英属哥伦比亚大学 Bauman等使 由图4可知,基于RRT算法的全局路径规划方 用概率地图法( Probabilistic Road Map,PRM)为手法可使机械臂通过视觉伺服绕过障碍物到达期望位 眼相机相对于目标物体规划最少遮挡路径,使用姿,同时避免了在复杂环境任务中目标遮挡、逃离视 IBM托马斯沃森研究中心 Tarabanis等提出的技野和碰撞 术计算图像边界,将区域划分为目标可见区域和目 2017年,浙江大学滕根保研究了用改进随 标被工作空间障碍物遮挡不可见区域,提出的算法机扩展树求解体素空间表达型狭窄通道,将星形算 在可见区域之外为相机轨迹指定正比于相机平移距法中估价函数引入到随机扩展树的目标节点方向 离的惩罚度,但是该方法并没有考虑相机的姿态和上,降低采样的盲目性,提高搜索效率,并提出了基 视野限制. 于平滑样条对路径引导点序进行平滑处理,实现机 受加拿大西蒙弗雷泽大学Yao等明研究通用械臂在狭窄通道工况下安全、快速、平稳作业 末端执行器约束的全局路径规划的启发,2009年, 综上所述,全局路径规划方法需要完整和相对 Kazem等吲在手眼机械臂视觉伺服中结合了基于精确的环境信息、相机标定和目标模型.然而,这些 采样的全局路径规划方法,全局规划器在相机空间苛刻要求在许多视觉伺服场景中是受限制的.在规 中搜索满足视野限制和遮挡约束的相机路径,然后划阶段考虑建模和标定不确定性可以降低对上述先

在工作空间近乎直线，而后者目标原点的图像轨迹 受到约束，在图像中沿着近乎直线运动，减小了图像 特征不在相机视野内的几率． 针对人工势场法可能会进入局部极小这一缺 陷，中国海洋大学唐彪等［５９］通过添加虚拟目标点来 改进人工势场法． 该方法可以让机械臂逃离局部极 小点，实现机械臂的避障路径规划． 中国农业大学赵栋杰［６０］ 针对喷雾机器人的连 续运动作业模式，提出了一种基于改进势场法的喷 雾机械臂运动规划对靶实时控制算法，该算法在传 统势场法基础上引入了速度势场、视场约束和关节 极限位置约束，可规划出更优的喷雾机械臂运动轨 迹，有效提高喷雾机器人对靶控制的鲁棒性． 当然，也可以设计局部切换策略，即当沿着规划 轨迹检测到接近图像局部最小化和图像奇异时从 ＩＢＶＳ 切换到 ＰＢＶＳ． 该方法的不足之处在于为了避 免由于重复切换引起的不稳定性，切换策略只能使 用一次． 然而，在系统切换到 ＰＢＶＳ 后也不能完全保 证仍然满足视野约束和关节限制． 势场法的主要优势在于可以快速计算出驱动 力，非常适合实时视觉伺服应用． 当跟踪图像轨迹 需要考虑到由于建模和标定对规划轨迹带来的偏差 影响时，即可应用以上策略． ２．４ 全局路径规划 当考虑所有约束时，以上视觉伺服任务中的路 径规划方法会出现收敛性问题，所以研究者又探索 了全局路径规划方法． ２００２ 年，美国加州大学伯克 利分校 Ｃｏｗａｎ 等［６１］ 提出一种基于导航函数的全局 稳定性策略，可以保证从任意初始位姿收敛到可见 期望位姿，同时保证所有特征沿着路径可见，而不需 要跟随预定义参考图像轨迹，但是构建这种导航函 数受限于非常简单的应用场景． ２００８ 年，英属哥伦比亚大学 Ｂａｕｍａｎｎ 等［６２］ 使 用概率地图法（ Ｐｒｏｂａｂｉｌｉｓｔｉｃ Ｒｏａｄ Ｍａｐ， ＰＲＭ） 为手 眼相机相对于目标物体规划最少遮挡路径，使用 ＩＢＭ 托马斯沃森研究中心 Ｔａｒａｂａｎｉｓ 等［６３］ 提出的技 术计算图像边界，将区域划分为目标可见区域和目 标被工作空间障碍物遮挡不可见区域，提出的算法 在可见区域之外为相机轨迹指定正比于相机平移距 离的惩罚度，但是该方法并没有考虑相机的姿态和 视野限制． 受加拿大西蒙弗雷泽大学 Ｙａｏ 等［６４］ 研究通用 末端执行器约束的全局路径规划的启发，２００９ 年， Ｋａｚｅｍｉ 等［６５］在手眼机械臂视觉伺服中结合了基于 采样的全局路径规划方法，全局规划器在相机空间 中搜索满足视野限制和遮挡约束的相机路径，然后 利用局部规划器在机械臂关节空间中跟踪这些路 径，避免了关节限制和与障碍物发生碰撞，从而保障 了机械臂可以顺利运动． 斯坦福大学 Ｋｕｆｆｎｅｒ 等［６６］ 和中国科学技术大学杜明博等［６７］ 分别采用一个搜 索树作为规划器，利用快速扩展随机树（Ｒａｐｉｄｌｙ － ｅｘｐｌｏｒｉｎｇ Ｒａｎｄｏｍ Ｔｒｅｅ，ＲＲＴ） 算法在其中搜索可行 的路径，然后即可从搜索树中提取出连接相机初始 位姿和期望位姿的路径，进而投影到图像空间获得 采样特征轨迹作为一系列图像路径点． 最终，这些 路径点被时间参数化成三次样条曲线后利用 ＩＢＶＳ 进行跟踪． 针对基本 ＲＲＴ 算法和 Ｂｉ－ＲＲＴ（双向搜索树） 算法生成路径不光滑问题，任秉银提出了改进的 Ｓ－ ＲＲＴ 光滑算法，并对上述三种 ＲＲＴ 算法的自主避障 （人体模型为障碍物）路径规划结果进行了对比，如 图 ４ 所示． Bi￾RRT Basic￾RRT S￾RRT 图 ４ ３ 种 ＲＲＴ 算法路径规划结果对比 Ｆｉｇ．４ Ｃｏｍｐａｒｉｓｏｎ ｏｆ ｐａｔｈ ｐｌａｎｎｉｎｇ ｒｅｓｕｌｔｓ ｏｆ ｔｈｒｅｅ ｋｉｎｄｓ ｏｆ ＲＲＴ ａｌｇｏｒｉｔｈｍｓ 由图 ４ 可知，基于 ＲＲＴ 算法的全局路径规划方 法可使机械臂通过视觉伺服绕过障碍物到达期望位 姿，同时避免了在复杂环境任务中目标遮挡、逃离视 野和碰撞． ２０１７ 年，浙江大学滕根保［６８］ 研究了用改进随 机扩展树求解体素空间表达型狭窄通道，将星形算 法中估价函数引入到随机扩展树的目标节点方向 上，降低采样的盲目性，提高搜索效率，并提出了基 于平滑样条对路径引导点序进行平滑处理，实现机 械臂在狭窄通道工况下安全、快速、平稳作业． 综上所述，全局路径规划方法需要完整和相对 精确的环境信息、相机标定和目标模型． 然而，这些 苛刻要求在许多视觉伺服场景中是受限制的． 在规 划阶段考虑建模和标定不确定性可以降低对上述先 ·６· 哈 尔 滨 工 业 大 学 学 报 第 ５０ 卷

任秉银,等:机械臂视觉伺服路径规划研究进展 验知识的要求 高视觉伺服系统的收敛性和稳定性,进而提高机械 2.5不确定性下视觉伺服路径规划 臂在动态非结构环境下的自主作业的能力 由于视觉伺服系统中存在不确定性,机械臂可 现阶段对于视觉伺服路径规划的研究主要针对 能不会准确跟踪规划好的路径.事实上,在一些情简单静态环境下的视觉伺服任务,为了提高机械臂 形下,工作空间和图像空间跟踪的路径与理想规划在复杂环境下作业的灵活性和可靠性,未来机械臂视 好的路径相差非常大,就会不满足一些约束条件.觉伺服路径规划的研究可以从以下几个方面展开 INRIA的 Espiau研究了相机内、外参数误差对视 1)动态非结构环境下的视觉伺服路径规划 觉伺服性能的影响.拉普兰塔理工大学 Kyrki等m 静态环境障碍物都是已知的,约束也都是单 则分析了图像误差传播对位姿估计和视觉伺服控制的,而在动态环境中,障碍物都是未知或动态的,可 律的影响 能会造成目标的遮挡或与机械臂发生碰撞,而且同 一些硏究人员提出局部规划技术,使得在规划时存在两类约束.为了保证机械臂在复杂动态环境 阶段就能考虑执行时可能存在的偏差.例如,使用下作业的可靠性和稳定性,非常有必要针对这些问 势场法局部考虑这些偏差,但是却很容易像之前所题做进一步的研究 述,陷入局部最小化.一种解决未建模的不确定性 2)基于多算法融合的视觉伺服路径规划 方法是当违背约束条件时让相机迅速撤退或者重新 面对动态非结构环境中的复杂多约束和诸多不 规划.德国不来梅大学Iang等提出变量缩放技确定性,单一路径规划方法有其缺陷和不足,不能很 术,当被障碍物遮挡时让目标在可见范围内迅速后好地解决视觉伺服中存在的难题,未来研究应结合 退,这种缩放效应通过降低固定尺寸物体(相机从多种算法优点,基于多算法切换和融合的路径规划 ˉ定距离观测)的测量噪声,从而很大程度上改善方法是十分必要的 了IBⅤS的性 3)考虑动力学因素的视觉伺服路径规划 2006年, INRIA的 Comport等提出了一种基 在机械臂作业过程中,有时需要考虑机械臂和 于增强现实的视觉伺服方法.尽管他们的方法主要环境的接触力等动力学因素,而当前路径规划基本 集中在通过虚拟视觉伺服进行相机位姿估计,但是上只考虑运动学,故今后非常有必要研究融合动力 可以扩展到由于未建模的不确定性导致目标上的特学的视觉伺服路径规划,提高机械臂面对复杂特殊 征点可能不在视野场景内这一情况.使用增强现实作业的稳定性和快速性 方法可以从混杂已知特征的场景中的其它物体获得 4)融合机器学习方法的视觉伺服路径规划 的原始信息(如直线、边缘等)定位图像中丢失的特 机器学习方法,如深度学习和强化学习以及二 征点.在这种情形下,目标被用作视觉伺服的主要者的结合等,不需要对系统建立模型,只需要离线训 对象,而其它图像特征有利于位姿估计,最终有利于练就可以很好地利用其良好的逼近泛化能力,根据 伺服任务,只有非常少的特征点可能会不在相机视图像空间的视觉特征进行智能路径规划,机器学习 野内 可以很好地作为传统路径规划方法的有效补充,基 综上所述,机械臂视觉伺服系统中存在诸多不于机器学习的视觉伺服路径规划是未来机器人学领 确定性,包括相机内外参数不确定性、机械臂运动学域的重要硏究方向. 和动力学参数不确定性等.不确定性的存在严重影 5)基于多相机融合的视觉伺服路径规划 响了视觉伺服路径规划的跟踪精度,现有方法主要 单相机的视野范围和分辨率是有限的,使用多 集中在局部路径规划中考虑上述不确定性,但是非相机可以扩展视野范围,并且相机之间相互配合可 常容易陷入局部最小化和没有考虑所有约束类型.以提高系统的可靠性和灵活性.未来可以针对多相 在完全未知环境中,解决各种不确定性下的全局视机冗余视觉系统的控制以及视觉伺服路径规划展开 觉伺服路径规划问题的研究工作任重道远 研究 3总结和展望 参考文献 本文对存在于机械臂视觉伺服路径规划中的两〔谭民,王硕.机器人技术研究进展[J].自动化学报,2013,39 类约束进行了简要介绍,对主要的路径规划方法研 (7):963-972.DOl10.3724/sP.J.1004.2013.00963 究进展进行了评述.动态非结构环境下路径规划的 TAN Min, WANG Shuo. Research progress on robotics[J].Acta Automatica Sinica, 2013, 39(7): 963-972 DOl 10 3724/SPJ 难点在于需要同时处理两类约束,并且在诸多视觉 1004.2013.00963. 伺服系统不确定性因素下规划出可行路径,从而提[2]夏群峰,彭勇刚.基于视觉的机器人抓取系统应用硏究综述[门

验知识的要求． ２．５ 不确定性下视觉伺服路径规划 由于视觉伺服系统中存在不确定性，机械臂可 能不会准确跟踪规划好的路径． 事实上，在一些情 形下，工作空间和图像空间跟踪的路径与理想规划 好的路径相差非常大，就会不满足一些约束条件． ＩＮＲＩＡ 的 Ｅｓｐｉａｕ ［６９］研究了相机内、外参数误差对视 觉伺服性能的影响． 拉普兰塔理工大学 Ｋｙｒｋｉ 等［７０］ 则分析了图像误差传播对位姿估计和视觉伺服控制 律的影响． 一些研究人员提出局部规划技术，使得在规划 阶段就能考虑执行时可能存在的偏差． 例如，使用 势场法局部考虑这些偏差，但是却很容易像之前所 述，陷入局部最小化． 一种解决未建模的不确定性 方法是当违背约束条件时让相机迅速撤退或者重新 规划． 德国不来梅大学 Ｌａｎｇ 等［７１］ 提出变量缩放技 术，当被障碍物遮挡时让目标在可见范围内迅速后 退，这种缩放效应通过降低固定尺寸物体（相机从 一定距离观测） 的测量噪声，从而很大程度上改善 了 ＩＢＶＳ 的性能． ２００６ 年，ＩＮＲＩＡ 的 Ｃｏｍｐｏｒｔ 等［７２］ 提出了一种基 于增强现实的视觉伺服方法． 尽管他们的方法主要 集中在通过虚拟视觉伺服进行相机位姿估计，但是 可以扩展到由于未建模的不确定性导致目标上的特 征点可能不在视野场景内这一情况． 使用增强现实 方法可以从混杂已知特征的场景中的其它物体获得 的原始信息（如直线、边缘等）定位图像中丢失的特 征点． 在这种情形下，目标被用作视觉伺服的主要 对象，而其它图像特征有利于位姿估计，最终有利于 伺服任务，只有非常少的特征点可能会不在相机视 野内． 综上所述，机械臂视觉伺服系统中存在诸多不 确定性，包括相机内外参数不确定性、机械臂运动学 和动力学参数不确定性等． 不确定性的存在严重影 响了视觉伺服路径规划的跟踪精度，现有方法主要 集中在局部路径规划中考虑上述不确定性，但是非 常容易陷入局部最小化和没有考虑所有约束类型． 在完全未知环境中，解决各种不确定性下的全局视 觉伺服路径规划问题的研究工作任重道远． ３ 总结和展望 本文对存在于机械臂视觉伺服路径规划中的两 类约束进行了简要介绍，对主要的路径规划方法研 究进展进行了评述． 动态非结构环境下路径规划的 难点在于需要同时处理两类约束，并且在诸多视觉 伺服系统不确定性因素下规划出可行路径，从而提 高视觉伺服系统的收敛性和稳定性，进而提高机械 臂在动态非结构环境下的自主作业的能力． 现阶段对于视觉伺服路径规划的研究主要针对 简单静态环境下的视觉伺服任务，为了提高机械臂 在复杂环境下作业的灵活性和可靠性，未来机械臂视 觉伺服路径规划的研究可以从以下几个方面展开： １）动态非结构环境下的视觉伺服路径规划 静态环境障碍物都是已知的，约束也都是单一 的，而在动态环境中，障碍物都是未知或动态的，可 能会造成目标的遮挡或与机械臂发生碰撞，而且同 时存在两类约束． 为了保证机械臂在复杂动态环境 下作业的可靠性和稳定性，非常有必要针对这些问 题做进一步的研究． ２）基于多算法融合的视觉伺服路径规划 面对动态非结构环境中的复杂多约束和诸多不 确定性，单一路径规划方法有其缺陷和不足，不能很 好地解决视觉伺服中存在的难题，未来研究应结合 多种算法优点，基于多算法切换和融合的路径规划 方法是十分必要的． ３）考虑动力学因素的视觉伺服路径规划 在机械臂作业过程中，有时需要考虑机械臂和 环境的接触力等动力学因素，而当前路径规划基本 上只考虑运动学，故今后非常有必要研究融合动力 学的视觉伺服路径规划，提高机械臂面对复杂特殊 作业的稳定性和快速性． ４）融合机器学习方法的视觉伺服路径规划 机器学习方法，如深度学习和强化学习以及二 者的结合等，不需要对系统建立模型，只需要离线训 练就可以很好地利用其良好的逼近泛化能力，根据 图像空间的视觉特征进行智能路径规划，机器学习 可以很好地作为传统路径规划方法的有效补充，基 于机器学习的视觉伺服路径规划是未来机器人学领 域的重要研究方向． ５）基于多相机融合的视觉伺服路径规划 单相机的视野范围和分辨率是有限的，使用多 相机可以扩展视野范围，并且相机之间相互配合可 以提高系统的可靠性和灵活性． 未来可以针对多相 机冗余视觉系统的控制以及视觉伺服路径规划展开 研究． 参考文献 ［１］ 谭民， 王硕． 机器人技术研究进展［ Ｊ］． 自动化学报， ２０１３，３９ （７）：９６３－９７２．ＤＯＩ １０．３７２４ ／ ＳＰ．Ｊ．１００４．２０１３．００９６３． ＴＡＮ Ｍｉｎ， ＷＡＮＧ Ｓｈｕｏ． Ｒｅｓｅａｒｃｈ ｐｒｏｇｒｅｓｓ ｏｎ ｒｏｂｏｔｉｃｓ ［ Ｊ］． Ａｃｔａ Ａｕｔｏｍａｔｉｃａ Ｓｉｎｉｃａ， ２０１３， ３９ （ ７）： ９６３ － ９７２． ＤＯＩ １０． ３７２４ ／ ＳＰ．Ｊ． １００４．２０１３．００９６３． ［２］ 夏群峰，彭勇刚． 基于视觉的机器人抓取系统应用研究综述［Ｊ］． 第 １ 期 任秉银， 等： 机械臂视觉伺服路径规划研究进展 ·７·

哈尔滨工业大学学报 第50卷 机电工程,2014,31(6):697-701,710.DOl:10.3969/jism tomation,2001,17(4):507-515.DOl;10.1109/70.954764 100l-4551.2014.06.004. [17]DEGUCHI K. Optimal motion control for image-based visual servo- XIA Qunfeng, PENG Yonggang. Review on application research of ing by decoupling translation and rotation[ C//IEEE/RSJ Interna- robots scraping system based on visual[J]. Journal of Mechanical tional Conference on Intelligent Robots and Systems. Victoria: Electrical Engineering, 2014, 31(6): 697-701, 710. DOl: 10 IEEE,1998:705-711.DO:10.1109/ROs.1998.72727 3969/isn.1001-4551.2014.06.004. [ 18]MAHONY R, HAMEL T, CHAUMETTE F. A decoupled image [3] HUTCHINSON S, HAGER G D, CORKE P L. A tutorial on visual space approach to visual servo control [J]. IEEE Transactions on Robotics&Automation IEEE International Conference on Robotics and Automation 996,12(5):651-670.DOl:10.109/70.538972 Washington, DC: IEEE, 2002: 3781-3786. DOl: 10.1109/ROBOT. [4 ESPIAU B, CHAUMETTE F, RIVES P. A new approach to visual 2002.1014305 servoing in robotics[J]. IEEE Transactions on Robotics Automa- [19]MALIS E, CHAUMETTE F, BOUDET S. 2-1/2-D visual servoing tion,1992,8(3):313-326.DOl;10.1109/70.143350 [JJ. IEEE Transactions on Robotics& Automation, 1999, 15(2) [5] CHAUMETTE F, HUTCHINSON S. Visual servo control part I 238-250.DOI:10.1109/70.7603 basic approaches[]. IEEE Robotics Automation Magazine, [ 20]MOREL G, LIEBEZEIT T, BOUDETS, et al. Explicit incorporation 2006,13(4):82-90.D0l:10.109/MRA.2006.250573 of 2D constraints i [6]CHAUMETTE F, HUTCHINSON S. Visual servo control part ll: ad- The Sixth International Symposium on Experimental Robotics VI anced approaches [J]. IEEE Robotics Automation Magazine London: Springer-Verlag, 1999: 99-108. DOl: 10. 1007, 2007,14(1):109-118.DOl:10.109/MRA.2007339609 BFb119389 [刀]方勇纯.机器人视觉伺服研究综述[冂.智能系统学报,2008,321] GANS N R, HUTCHINSON S A, CORKE P I. Performance tests 2):109-114.DOl:10.3969/jisn.1673-4785.2008.02002 control systems, with application to partitione FANG Yongchun. A survey of robot visual servoing[ J]. CAAl approaches to visual servo control [J]. International Joumal of Ro- Transactions On Intelligent Systems, 2008, 3(2): 109-114. DOl ties research,2003,22(10):95-984.DOl;10.1177 10.3969/ J-Issn.1673-4785.2008.02.002. 027836490302210011 [8 CHAUMETTE F Potential problems of stability and convergence in [22 ]CHESI G, HASHIMOTO K, PRATTICHIZZO D, et al. Keeping image-based and position-based visual servoing[ C]//The conflu- features in the field of view in eye-in-hand visual servoing: a switc- ence of vision and control. London: Springer, 1998: 66-78. DOl ing approach[J]. IEEE Transactions on Robotics &Automation 10.1007/BFb0109663. 2004,20(5):908-914.DOl:10.1109/TRO.2004.829456 [9]贾丙西,刘山,张凯祥,等机器人视觉伺服研究进展:视觉系[23] DENG L, JANABI- SHARIFI F, WILSON WJ. Hvbrid motion con 统与控制策略[J].自动化学报,2015,41(5):861-873.DO1:10. trol and planning strategies for visual servoing[ J]. IEEE T 16383/jas.2015.c140724 tions on Industrial Electronics, 2005, 52(4): 1024-1040 DOI JIA Bingxi. LIU Shan, ZHANG Kaixiang, et al. Survey on robot 109/TE.2005.851651 visual servo control; vision system and control strategies[ J]. Acta [24 ]GANS N R, HUTCHINSON S A. Stable visual servoing through hy Automatica Sinica,2015,41(5):861-873.DOl:10.16383 brid switched-system control[J]. IEEE Transactions on Robotics 015.c140724 2007,23(3):530-540.DOl;l0.1109/TRO.2007.895067. [10]KERMORGANT 0, CHAUMETTE F. Dealing with constraints [25]HASHIMOTO K, NORITSUGU T Potential problems and switching sensor-based robot control [J]. IEEE Transactions on Robotics ontrol for visual servoing[ C]//IEEE/RSJ International Conferen 014,30(1):244-257.DOl:10.09/TRO.2013.2281560. Intelligent Robots and Systems. Takamatsu: IEEE. 2000: 423 [11]SHARMA R, HUTCHINSON S. Motion perceptibility and its appli- 428.DOl:10.1109/ROs.2000.894641 cation to active vision- based servo control[门]。 IEEE Transactions[26]刘玺.移动机器人主动视觉伺服技术研究[D]天津:南开大 on Robotics Automation, 1997, 13(4): 607-617 DOl: 10.1109/ 学,2010.DO1:10.7666/d.y1814223 70.611333 [12] BARRAQUAND J, LATOMBE, J. Robot motion planning: a dis- Tianjin: Nankai University, 2010. DOl: 10.7666/d. y1814223 tributed representation approach[J]. International Journal of Robot-[27]张春龙.自然环境下农业机器人作业目标信息获取与视觉伺服 ies research,1991,10(6):628-649.DOl:10.1177 策略研究[D].北京:中国农业大学,2014 027836499101000604 ZHANG Chunlong. Research on target information acquisition and [13]LAVALLE S. Planning algorithms[ M]. Cambridge: Cambridge U- sion Servo strategy of agricultural robot in natural environment [D] diversity Press_2006. Beijing China Agricultural University, 2014 [14] LAVALLE S,⑥ ONZALEZ- BANOS H, BECKER C,etal. Motion[28]刘玉月,吴东苏,顾宏斌基于视觉伺服的手部跟踪仿真研究 strategies for maintaining visibility of a moving target[C]//IEEE In- 门].信息技术,2012(5):9-15.DO:10.3969/jisn.1009-2552 ternational Conference on Robotics and Automation. Albuquerque 201205.003 IEEE,1997:731-736.DOl:10.1109/ ROBOT.1997620122 LIU Yuyue, WU Dongsu, GU Hongbin. Research and simulation of [15]MICHELT P, SCHEURERTT C, KUFFNERT J, et al. Planning for and tracking based on visual servo[J]. Information Technology robust execution of humanoid motions using future perceptive capa- 2012(5):9-15.DO1:10.3969/jisn.1009-25522012.05.003 bility[CJ//lEE/ RSJ International Conference on Intelligent Ro-[29]李宝全,方勇纯,张雪波,等.基于选择策略的移动机器人视觉 bots and Systems. San Diego: IEEE, 2007: 3223-3228. DOl: 10 伺服镇定方法[J].系统科学与数学,2012,32(6):750-767 1109/IROs.20074399249 LI Baoquan, FANG Yongchun, ZHANG Xuebo, et al. Selection- 16]CORKE P, HUTCHINSON S. A new partitioned approach to image- strategy-based visual servo regulation of wheeled mobile robots[J] based visual servo control [J]. IEEE Transactions on Robotics &Au- Joumal of Systems Science and Mathematical Sciences, 2012

机电工程，２０１４，３１ （ ６）： ６９７ － ７０１， ７１０． ＤＯＩ： １０． ３９６９ ／ ｊ． ｉｓｓｎ ． １００１－４５５１．２０１４．０６．００４． ＸＩＡ Ｑｕｎｆｅｎｇ， ＰＥＮＧ Ｙｏｎｇｇａｎｇ． Ｒｅｖｉｅｗ ｏｎ ａｐｐｌｉｃａｔｉｏｎ ｒｅｓｅａｒｃｈ ｏｆ ｒｏｂｏｔｓ ｓｃｒａｐｉｎｇ ｓｙｓｔｅｍ ｂａｓｅｄ ｏｎ ｖｉｓｕａｌ［Ｊ］． Ｊｏｕｒｎａｌ ｏｆ Ｍｅｃｈａｎｉｃａｌ ＆ Ｅｌｅｃｔｒｉｃａｌ Ｅｎｇｉｎｅｅｒｉｎｇ， ２０１４， ３１ （ ６）： ６９７ － ７０１， ７１０． ＤＯＩ： １０． ３９６９ ／ ｊ．ｉｓｓｎ．１００１－４５５１． ２０１４． ０６．００４． ［３］ ＨＵＴＣＨＩＮＳＯＮ Ｓ， ＨＡＧＥＲ Ｇ Ｄ， ＣＯＲＫＥ Ｐ Ｉ． Ａ ｔｕｔｏｒｉａｌ ｏｎ ｖｉｓｕａｌ ｓｅｒｖｏ ｃｏｎｔｒｏｌ ［ Ｊ］． ＩＥＥＥ Ｔｒａｎｓａｃｔｉｏｎｓ ｏｎ Ｒｏｂｏｔｉｃｓ ＆ Ａｕｔｏｍａｔｉｏｎ， １９９６，１２（５）：６５１－６７０． ＤＯＩ： １０．１１０９ ／ ７０．５３８９７２． ［４］ ＥＳＰＩＡＵ Ｂ， ＣＨＡＵＭＥＴＴＥ Ｆ， ＲＩＶＥＳ Ｐ． Ａ ｎｅｗ ａｐｐｒｏａｃｈ ｔｏ ｖｉｓｕａｌ ｓｅｒｖｏｉｎｇ ｉｎ ｒｏｂｏｔｉｃｓ［Ｊ］． ＩＥＥＥ Ｔｒａｎｓａｃｔｉｏｎｓ ｏｎ Ｒｏｂｏｔｉｃｓ ＆ Ａｕｔｏｍａ⁃ ｔｉｏｎ， １９９２，８（３）：３１３－３２６． ＤＯＩ： １０．１１０９ ／ ７０．１４３３５０． ［５］ ＣＨＡＵＭＥＴＴＥ Ｆ， ＨＵＴＣＨＩＮＳＯＮ Ｓ． Ｖｉｓｕａｌ ｓｅｒｖｏ ｃｏｎｔｒｏｌ ｐａｒｔ Ｉ： ｂａｓｉｃ ａｐｐｒｏａｃｈｅｓ ［ Ｊ ］． ＩＥＥＥ Ｒｏｂｏｔｉｃｓ ＆ Ａｕｔｏｍａｔｉｏｎ Ｍａｇａｚｉｎｅ， ２００６，１３（４）：８２－９０．ＤＯＩ： １０．１１０９ ／ ＭＲＡ．２００６．２５０５７３． ［６］ ＣＨＡＵＭＥＴＴＥ Ｆ， ＨＵＴＣＨＩＮＳＯＮ Ｓ． Ｖｉｓｕａｌ ｓｅｒｖｏ ｃｏｎｔｒｏｌ ｐａｒｔ ＩＩ： ａｄ⁃ ｖａｎｃｅｄ ａｐｐｒｏａｃｈｅｓ ［ Ｊ］． ＩＥＥＥ Ｒｏｂｏｔｉｃｓ ＆ Ａｕｔｏｍａｔｉｏｎ Ｍａｇａｚｉｎｅ， ２００７，１４（１）：１０９－１１８． ＤＯＩ： １０．１１０９ ／ ＭＲＡ．２００７．３３９６０９． ［７］ 方勇纯． 机器人视觉伺服研究综述［ Ｊ］． 智能系统学报， ２００８，３ （２）：１０９－１１４．ＤＯＩ： １０．３９６９ ／ ｊ．ｉｓｓｎ．１６７３－４７８５．２００８．０２．００２． ＦＡＮＧ Ｙｏｎｇｃｈｕｎ． Ａ ｓｕｒｖｅｙ ｏｆ ｒｏｂｏｔ ｖｉｓｕａｌ ｓｅｒｖｏｉｎｇ ［ Ｊ ］． ＣＡＡＩ Ｔｒａｎｓａｃｔｉｏｎｓ Ｏｎ Ｉｎｔｅｌｌｉｇｅｎｔ Ｓｙｓｔｅｍｓ，２００８，３ （ ２）： １０９ － １１４． ＤＯＩ： １０．３９６９ ／ ｊ．ｉｓｓｎ．１６７３－４７８５．２００８．０２．００２． ［８］ ＣＨＡＵＭＥＴＴＥ Ｆ． Ｐｏｔｅｎｔｉａｌ ｐｒｏｂｌｅｍｓ ｏｆ ｓｔａｂｉｌｉｔｙ ａｎｄ ｃｏｎｖｅｒｇｅｎｃｅ ｉｎ ｉｍａｇｅ⁃ｂａｓｅｄ ａｎｄ ｐｏｓｉｔｉｏｎ⁃ｂａｓｅｄ ｖｉｓｕａｌ ｓｅｒｖｏｉｎｇ ［ Ｃ］ ／ ／ Ｔｈｅ ｃｏｎｆｌｕ⁃ ｅｎｃｅ ｏｆ ｖｉｓｉｏｎ ａｎｄ ｃｏｎｔｒｏｌ． Ｌｏｎｄｏｎ： Ｓｐｒｉｎｇｅｒ，１９９８：６６ － ７８． ＤＯＩ： １０．１００７ ／ ＢＦｂ０１０９６６３． ［９］ 贾丙西， 刘山， 张凯祥， 等． 机器人视觉伺服研究进展：视觉系 统与控制策略［Ｊ］． 自动化学报， ２０１５，４１（５）：８６１－８７３．ＤＯＩ：１０． １６３８３ ／ ｊ．ａａｓ．２０１５．ｃ１４０７２４． ＪＩＡ Ｂｉｎｇｘｉ， ＬＩＵ Ｓｈａｎ， ＺＨＡＮＧ Ｋａｉｘｉａｎｇ， ｅｔ ａｌ． Ｓｕｒｖｅｙ ｏｎ ｒｏｂｏｔ ｖｉｓｕａｌ ｓｅｒｖｏ ｃｏｎｔｒｏｌ： ｖｉｓｉｏｎ ｓｙｓｔｅｍ ａｎｄ ｃｏｎｔｒｏｌ ｓｔｒａｔｅｇｉｅｓ［ Ｊ］． Ａｃｔａ Ａｕｔｏｍａｔｉｃａ Ｓｉｎｉｃａ， ２０１５，４１（ ５）： ８６１－ ８７３．ＤＯＩ：１０．１６３８３ ／ ｊ． ａａｓ． ２０１５．ｃ１４０７２４． ［１０］ ＫＥＲＭＯＲＧＡＮＴ Ｏ， ＣＨＡＵＭＥＴＴＥ Ｆ． Ｄｅａｌｉｎｇ ｗｉｔｈ ｃｏｎｓｔｒａｉｎｔｓ ｉｎ ｓｅｎｓｏｒ⁃ｂａｓｅｄ ｒｏｂｏｔ ｃｏｎｔｒｏｌ ［ Ｊ ］． ＩＥＥＥ Ｔｒａｎｓａｃｔｉｏｎｓ ｏｎ Ｒｏｂｏｔｉｃｓ， ２０１４，３０（１）：２４４－２５７． ＤＯＩ： １０．１１０９ ／ ＴＲＯ．２０１３．２２８１５６０． ［１１］ＳＨＡＲＭＡ Ｒ， ＨＵＴＣＨＩＮＳＯＮ Ｓ． Ｍｏｔｉｏｎ ｐｅｒｃｅｐｔｉｂｉｌｉｔｙ ａｎｄ ｉｔｓ ａｐｐｌｉ⁃ ｃａｔｉｏｎ ｔｏ ａｃｔｉｖｅ ｖｉｓｉｏｎ－ｂａｓｅｄ ｓｅｒｖｏ ｃｏｎｔｒｏｌ［ Ｊ］． ＩＥＥＥ Ｔｒａｎｓａｃｔｉｏｎｓ ｏｎ Ｒｏｂｏｔｉｃｓ ＆ Ａｕｔｏｍａｔｉｏｎ， １９９７， １３（４）：６０７－６１７．ＤＯＩ： １０．１１０９ ／ ７０．６１１３３３． ［１２］ ＢＡＲＲＡＱＵＡＮＤ Ｊ， ＬＡＴＯＭＢＥ， Ｊ． Ｒｏｂｏｔ ｍｏｔｉｏｎ ｐｌａｎｎｉｎｇ： ａ ｄｉｓ⁃ ｔｒｉｂｕｔｅｄ ｒｅｐｒｅｓｅｎｔａｔｉｏｎ ａｐｐｒｏａｃｈ［Ｊ］． Ｉｎｔｅｒｎａｔｉｏｎａｌ Ｊｏｕｒｎａｌ ｏｆ Ｒｏｂｏｔ⁃ ｉｃｓ Ｒｅｓｅａｒｃｈ， １９９１， １０ （ ６ ）： ６２８ － ６４９． ＤＯＩ： １０． １１７７ ／ ０２７８３６４９９１０１０００６０４． ［１３］ＬＡＶＡＬＬＥ Ｓ． Ｐｌａｎｎｉｎｇ ａｌｇｏｒｉｔｈｍｓ［Ｍ］． Ｃａｍｂｒｉｄｇｅ： Ｃａｍｂｒｉｄｇｅ Ｕ⁃ ｎｉｖｅｒｓｉｔｙ Ｐｒｅｓｓ，２００６． ［１４］ＬＡＶＡＬＬＥ Ｓ， ＧＯＮＺＡＬＥＺ－ＢＡＮＯＳ Ｈ， ＢＥＣＫＥＲ Ｃ， ｅｔ ａｌ． Ｍｏｔｉｏｎ ｓｔｒａｔｅｇｉｅｓ ｆｏｒ ｍａｉｎｔａｉｎｉｎｇ ｖｉｓｉｂｉｌｉｔｙ ｏｆ ａ ｍｏｖｉｎｇ ｔａｒｇｅｔ［Ｃ］ ／ ／ ＩＥＥＥ Ｉｎ⁃ ｔｅｒｎａｔｉｏｎａｌ Ｃｏｎｆｅｒｅｎｃｅ ｏｎ Ｒｏｂｏｔｉｃｓ ａｎｄ Ａｕｔｏｍａｔｉｏｎ． Ａｌｂｕｑｕｅｒｑｕｅ： ＩＥＥＥ， １９９７：７３１－７３６．ＤＯＩ： １０．１１０９ ／ ＲＯＢＯＴ．１９９７．６２０１２２． ［１５］ＭＩＣＨＥＬＴ Ｐ， ＳＣＨＥＵＲＥＲＴＴ Ｃ， ＫＵＦＦＮＥＲＴ Ｊ， ｅｔ ａｌ． Ｐｌａｎｎｉｎｇ ｆｏｒ ｒｏｂｕｓｔ ｅｘｅｃｕｔｉｏｎ ｏｆ ｈｕｍａｎｏｉｄ ｍｏｔｉｏｎｓ ｕｓｉｎｇ ｆｕｔｕｒｅ ｐｅｒｃｅｐｔｉｖｅ ｃａｐａ⁃ ｂｉｌｉｔｙ［ Ｃ］ ／ ／ ＩＥＥＥ／ ＲＳＪ Ｉｎｔｅｒｎａｔｉｏｎａｌ Ｃｏｎｆｅｒｅｎｃｅ ｏｎ Ｉｎｔｅｌｌｉｇｅｎｔ Ｒｏ⁃ ｂｏｔｓ ａｎｄ Ｓｙｓｔｅｍｓ． Ｓａｎ Ｄｉｅｇｏ： ＩＥＥＥ，２００７：３２２３ － ３２２８． ＤＯＩ： １０． １１０９ ／ ＩＲＯＳ．２００７．４３９９２４９． ［１６］ＣＯＲＫＥ Ｐ， ＨＵＴＣＨＩＮＳＯＮ Ｓ． Ａ ｎｅｗ ｐａｒｔｉｔｉｏｎｅｄ ａｐｐｒｏａｃｈ ｔｏ ｉｍａｇｅ⁃ ｂａｓｅｄ ｖｉｓｕａｌ ｓｅｒｖｏ ｃｏｎｔｒｏｌ［Ｊ］． ＩＥＥＥ Ｔｒａｎｓａｃｔｉｏｎｓ ｏｎ Ｒｏｂｏｔｉｃｓ ＆ Ａｕ⁃ ｔｏｍａｔｉｏｎ， ２００１，１７（４）：５０７－５１５．ＤＯＩ： １０．１１０９ ／ ７０．９５４７６４． ［１７］ＤＥＧＵＣＨＩ Ｋ． Ｏｐｔｉｍａｌ ｍｏｔｉｏｎ ｃｏｎｔｒｏｌ ｆｏｒ ｉｍａｇｅ⁃ｂａｓｅｄ ｖｉｓｕａｌ ｓｅｒｖｏ⁃ ｉｎｇ ｂｙ ｄｅｃｏｕｐｌｉｎｇ ｔｒａｎｓｌａｔｉｏｎ ａｎｄ ｒｏｔａｔｉｏｎ［Ｃ］ ／ ／ ＩＥＥＥ／ ＲＳＪ Ｉｎｔｅｒｎａ⁃ ｔｉｏｎａｌ Ｃｏｎｆｅｒｅｎｃｅ ｏｎ Ｉｎｔｅｌｌｉｇｅｎｔ Ｒｏｂｏｔｓ ａｎｄ Ｓｙｓｔｅｍｓ． Ｖｉｃｔｏｒｉａ： ＩＥＥＥ，１９９８：７０５－７１１． ＤＯＩ： １０．１１０９ ／ ＩＲＯＳ．１９９８．７２７２７４． ［１８］ ＭＡＨＯＮＹ Ｒ， ＨＡＭＥＬ Ｔ， ＣＨＡＵＭＥＴＴＥ Ｆ． Ａ ｄｅｃｏｕｐｌｅｄ ｉｍａｇｅ ｓｐａｃｅ ａｐｐｒｏａｃｈ ｔｏ ｖｉｓｕａｌ ｓｅｒｖｏ ｃｏｎｔｒｏｌ ｏｆ ａ ｒｏｂｏｔｉｃ ｍａｎｉｐｕｌａｔｏｒ［Ｃ］ ／ ／ ＩＥＥＥ Ｉｎｔｅｒｎａｔｉｏｎａｌ Ｃｏｎｆｅｒｅｎｃｅ ｏｎ Ｒｏｂｏｔｉｃｓ ａｎｄ Ａｕｔｏｍａｔｉｏｎ． Ｗａｓｈｉｎｇｔｏｎ， ＤＣ：ＩＥＥＥ，２００２：３７８１－３７８６．ＤＯＩ： １０．１１０９ ／ ＲＯＢＯＴ． ２００２．１０１４３０５． ［１９］ＭＡＬＩＳ Ｅ， ＣＨＡＵＭＥＴＴＥ Ｆ， ＢＯＵＤＥＴ Ｓ． ２－１ ／ ２－Ｄ ｖｉｓｕａｌ ｓｅｒｖｏｉｎｇ ［Ｊ］． ＩＥＥＥ Ｔｒａｎｓａｃｔｉｏｎｓ ｏｎ Ｒｏｂｏｔｉｃｓ ＆ Ａｕｔｏｍａｔｉｏｎ，１９９９，１５（ ２）： ２３８－２５０．ＤＯＩ： １０．１１０９ ／ ７０．７６０３４５． ［ ２０］ＭＯＲＥＬ Ｇ， ＬＩＥＢＥＺＥＩＴ Ｔ， ＢＯＵＤＥＴＳ， ｅｔ ａｌ． Ｅｘｐｌｉｃｉｔ ｉｎｃｏｒｐｏｒａｔｉｏｎ ｏｆ ２Ｄ ｃｏｎｓｔｒａｉｎｔｓ ｉｎ ｖｉｓｉｏｎ ｂａｓｅｄ ｃｏｎｔｒｏｌ ｏｆ ｒｏｂｏｔ ｍａｎｉｐｕｌａｔｏｒｓ［Ｃ］ ／ ／ Ｔｈｅ Ｓｉｘｔｈ Ｉｎｔｅｒｎａｔｉｏｎａｌ Ｓｙｍｐｏｓｉｕｍ ｏｎ Ｅｘｐｅｒｉｍｅｎｔａｌ Ｒｏｂｏｔｉｃｓ ＶＩ． Ｌｏｎｄｏｎ： Ｓｐｒｉｎｇｅｒ⁃Ｖｅｒｌａｇ， １９９９： ９９－１０８． ＤＯＩ： １０． １００７ ／ ＢＦｂ０１１９３８９． ［２１］ＧＡＮＳ Ｎ Ｒ， ＨＵＴＣＨＩＮＳＯＮ Ｓ Ａ， ＣＯＲＫＥ Ｐ Ｉ． Ｐｅｒｆｏｒｍａｎｃｅ ｔｅｓｔｓ ｆｏｒ ｖｉｓｕａｌ ｓｅｒｖｏ ｃｏｎｔｒｏｌ ｓｙｓｔｅｍｓ， ｗｉｔｈ ａｐｐｌｉｃａｔｉｏｎ ｔｏ ｐａｒｔｉｔｉｏｎｅｄ ａｐｐｒｏａｃｈｅｓ ｔｏ ｖｉｓｕａｌ ｓｅｒｖｏ ｃｏｎｔｒｏｌ［ Ｊ］． Ｉｎｔｅｒｎａｔｉｏｎａｌ Ｊｏｕｒｎａｌ ｏｆ Ｒｏ⁃ ｂｏｔｉｃｓ Ｒｅｓｅａｒｃｈ， ２００３， ２２ （ １０ ）： ９５５ － ９８４． ＤＯＩ： １０． １１７７ ／ ０２７８３６４９０３０２２１００１１． ［２２］ ＣＨＥＳＩ Ｇ， ＨＡＳＨＩＭＯＴＯ Ｋ， ＰＲＡＴＴＩＣＨＩＺＺＯ Ｄ， ｅｔ ａｌ． Ｋｅｅｐｉｎｇ ｆｅａｔｕｒｅｓ ｉｎ ｔｈｅ ｆｉｅｌｄ ｏｆ ｖｉｅｗ ｉｎ ｅｙｅ⁃ｉｎ⁃ｈａｎｄ ｖｉｓｕａｌ ｓｅｒｖｏｉｎｇ： ａ ｓｗｉｔｃ⁃ ｈｉｎｇ ａｐｐｒｏａｃｈ［ Ｊ］． ＩＥＥＥ Ｔｒａｎｓａｃｔｉｏｎｓ ｏｎ Ｒｏｂｏｔｉｃｓ ＆ Ａｕｔｏｍａｔｉｏｎ， ２００４， ２０（５）：９０８－９１４．ＤＯＩ： １０．１１０９ ／ ＴＲＯ．２００４．８２９４５６． ［２３］ＤＥＮＧ Ｌ， ＪＡＮＡＢＩ⁃ＳＨＡＲＩＦＩ Ｆ， ＷＩＬＳＯＮ Ｗ Ｊ． Ｈｙｂｒｉｄ ｍｏｔｉｏｎ ｃｏｎ⁃ ｔｒｏｌ ａｎｄ ｐｌａｎｎｉｎｇ ｓｔｒａｔｅｇｉｅｓ ｆｏｒ ｖｉｓｕａｌ ｓｅｒｖｏｉｎｇ［ Ｊ］． ＩＥＥＥ Ｔｒａｎｓａｃ⁃ ｔｉｏｎｓ ｏｎ Ｉｎｄｕｓｔｒｉａｌ Ｅｌｅｃｔｒｏｎｉｃｓ， ２００５， ５２（４）：１０２４－１０４０．ＤＯＩ： １０． １１０９ ／ ＴＩＥ．２００５．８５１６５１． ［２４］ＧＡＮＳ Ｎ Ｒ， ＨＵＴＣＨＩＮＳＯＮ Ｓ Ａ． Ｓｔａｂｌｅ ｖｉｓｕａｌ ｓｅｒｖｏｉｎｇ ｔｈｒｏｕｇｈ ｈｙ⁃ ｂｒｉｄ ｓｗｉｔｃｈｅｄ⁃ｓｙｓｔｅｍ ｃｏｎｔｒｏｌ ［ Ｊ］． ＩＥＥＥ Ｔｒａｎｓａｃｔｉｏｎｓ ｏｎ Ｒｏｂｏｔｉｃｓ， ２００７， ２３（３）：５３０－５４０． ＤＯＩ： １０．１１０９ ／ ＴＲＯ．２００７．８９５０６７． ［２５］ＨＡＳＨＩＭＯＴＯ Ｋ， ＮＯＲＩＴＳＵＧＵ Ｔ． Ｐｏｔｅｎｔｉａｌ ｐｒｏｂｌｅｍｓ ａｎｄ ｓｗｉｔｃｈｉｎｇ ｃｏｎｔｒｏｌ ｆｏｒ ｖｉｓｕａｌ ｓｅｒｖｏｉｎｇ［Ｃ］ ／ ／ ＩＥＥＥ／ ＲＳＪ Ｉｎｔｅｒｎａｔｉｏｎａｌ Ｃｏｎｆｅｒｅｎｃｅ ｏｎ Ｉｎｔｅｌｌｉｇｅｎｔ Ｒｏｂｏｔｓ ａｎｄ Ｓｙｓｔｅｍｓ． Ｔａｋａｍａｔｓｕ： ＩＥＥＥ， ２０００： ４２３ － ４２８．ＤＯＩ： １０．１１０９ ／ ＩＲＯＳ．２０００．８９４６４１． ［２６］刘玺． 移动机器人主动视觉伺服技术研究［Ｄ］． 天津：南开大 学， ２０１０． ＤＯＩ：１０．７６６６ ／ ｄ．ｙ１８１４２２３． ＬＩＵ Ｘｉ． Ｒｅｓｅａｒｃｈ ｏｎ ｔｈｅ ａｃｔｉｖｅ ｖｉｓｕａｌ ｓｅｒｖｏｉｎｇ ｏｆ ｍｏｂｉｌｅ ｒｏｂｏｔ［Ｄ］． Ｔｉａｎｊｉｎ： Ｎａｎｋａｉ Ｕｎｉｖｅｒｓｉｔｙ， ２０１０． ＤＯＩ： １０．７６６６ ／ ｄ．ｙ１８１４２２３． ［２７］张春龙． 自然环境下农业机器人作业目标信息获取与视觉伺服 策略研究［Ｄ］． 北京：中国农业大学， ２０１４． ＺＨＡＮＧ Ｃｈｕｎｌｏｎｇ． Ｒｅｓｅａｒｃｈ ｏｎ ｔａｒｇｅｔ ｉｎｆｏｒｍａｔｉｏｎ ａｃｑｕｉｓｉｔｉｏｎ ａｎｄ ｖｉｓｉｏｎ Ｓｅｒｖｏ ｓｔｒａｔｅｇｙ ｏｆ ａｇｒｉｃｕｌｔｕｒａｌ ｒｏｂｏｔ ｉｎ ｎａｔｕｒａｌ ｅｎｖｉｒｏｎｍｅｎｔ［Ｄ］． Ｂｅｉｊｉｎｇ： Ｃｈｉｎａ Ａｇｒｉｃｕｌｔｕｒａｌ Ｕｎｉｖｅｒｓｉｔｙ， ２０１４． ［２８］刘玉月， 吴东苏， 顾宏斌． 基于视觉伺服的手部跟踪仿真研究 ［ Ｊ］． 信息技术， ２０１２（５）：９－１５． ＤＯＩ：１０．３９６９ ／ ｊ．ｉｓｓｎ．１００９－２５５２． ２０１２．０５．００３． ＬＩＵ Ｙｕｙｕｅ， ＷＵ Ｄｏｎｇｓｕ， ＧＵ Ｈｏｎｇｂｉｎ． Ｒｅｓｅａｒｃｈ ａｎｄ ｓｉｍｕｌａｔｉｏｎ ｏｆ ｈａｎｄ ｔｒａｃｋｉｎｇ ｂａｓｅｄ ｏｎ ｖｉｓｕａｌ ｓｅｒｖｏ ［ Ｊ］． Ｉｎｆｏｒｍａｔｉｏｎ Ｔｅｃｈｎｏｌｏｇｙ， ２０１２（５）：９－１５． ＤＯＩ：１０．３９６９ ／ ｊ．ｉｓｓｎ．１００９－２５５２．２０１２．０５．００３． ［２９］李宝全， 方勇纯， 张雪波，等． 基于选择策略的移动机器人视觉 伺服镇定方法［Ｊ］． 系统科学与数学， ２０１２， ３２（６）：７５０－７６７． ＬＩ Ｂａｏｑｕａｎ， ＦＡＮＧ Ｙｏｎｇｃｈｕｎ， ＺＨＡＮＧ Ｘｕｅｂｏ， ｅｔ ａｌ． Ｓｅｌｅｃｔｉｏｎ⁃ ｓｔｒａｔｅｇｙ⁃ｂａｓｅｄ ｖｉｓｕａｌ ｓｅｒｖｏ ｒｅｇｕｌａｔｉｏｎ ｏｆ ｗｈｅｅｌｅｄ ｍｏｂｉｌｅ ｒｏｂｏｔｓ［ Ｊ］． Ｊｏｕｒｎａｌ ｏｆ Ｓｙｓｔｅｍｓ Ｓｃｉｅｎｃｅ ａｎｄ Ｍａｔｈｅｍａｔｉｃａｌ Ｓｃｉｅｎｃｅｓ， ２０１２， ·８· 哈 尔 滨 工 业 大 学 学 报 第 ５０ 卷

任秉银,等:机械臂视觉伺服路径规划研究进展 32(6):750-767 2001937592 [30]MEZOUAR Y, CHAUMETTE F. Path planning for robust image- [45]SHARMA R, SUTANTO H A framework for robot motion planning based control [J]. IEEE Transactions on Robotics&Automation th sensor constraints[J]. IEEE Transactions on Robotics&Auto- 2002,18(4):534-549.DOl:10.109/TRA.2002802218 mation,1997,13(1):61-73.DOl:l0.1109/70.554347 [31]陶波,龚泽宇,丁汉.机器人无标定视觉伺服控制研究进展[46] ZHANG H, OSTROWSKIJ P. isual motion planning for mobile [冂].力学学报,2016,48(4):767-783.DO1:10.6052/0459 robots[J]. IEEE Transactions on Robotics Automation, 2002,18 1879-16-161 (2):199-208.DOl:10.1109/TRA.20029948 TAO Bo, GONG Zeyu, DING Han. Survey on uncalibrated robot [47]CHESI G, PRATTICHIZZO D, VICINO A Straight line path-plan- seroing ing in visual servoing[J] Journal of Dynamic Systems Measure- Applied Mechanics,2016,48(4):767-783.DOl:10.60520459- ment& Control,2007,129(4):541-543.DOl:10.1115/1 1879-16-161 2745882 [ 32]HOSODA K, SAKAMOTO K, ASADA M. Trajectory generation for [48]CHESI G, HUNG Y S. Global path-planning for constrained and obstacle avoidance of uncalibrated stereo visual servoing without timal visual servoing[ J]. IEEE Transactions on Robotics, 2007 reconstruction[C]//IEEE/RSJ Intemational Conference on Intelli- 23(5):1050-1060.DOl;10.1109/TRO.2007903817 nt Robots and Systems. Pittsburgh: IEEE, 1995: 29-34.DO1: 10. [49]CHESI G. Visual servoing path planning via homogeneous forms and 1109/IROs.1995.525771 LMI optimizations[J]. IEEE Transactions on Robotics, 2009, 25 [33]HARTLEY R, ZISSERMAN A. Multiple view geometry in computer (2):281-291.DOl:10.1109/TRO.2009.2014131 vision[J]. Kybernetes, 2003, 30(9/10): 1865-1872 DO1: 10. [50]BHATTACHARYA S, MURRIETA-CID R, HUTCHINSON SOp- 1108/k.2001.30.910.1333.2 timal paths for landmark-based navigation by differential-drive vehi- [34]PARK JS, CHUNG M J. Path planning with uncalibrated stereo rig cles with field-of-view constraints [J]. IEEE Transactions o for image-based visual servoing under large pose discrepancy [J] Robotics,2007,23(1):47-59.DOl:10.1109/TRO.2006. IEEE Transactions on Robotics Automation, 2003, 19(2): 250 258.DOl:10.1109/TRA.2003.808861 [51]LOPEZ-NICOLAS G, BHATTACHARYA S, GUERRERO J, et al. [35]ESPIAU B, CHAUMETTE F, RIVES P. A new approach to visual Switched homography-hased visual control of differential drive vehi- servoing in robotics[J]. IEEE Transactions on Robotics &Automa- cles with field-of-view constraints[ C ]//IEEE International Confer tion,1992,8(3):313-326.DOl:10.1109/70.143350. ence on Robotics and Automation. Roma: IEEE. 2007. 4238-4244. [36] FAUGERAS O. Three-dimensional computer vision, a geometric DOl:10.1109/ ROBOT.2007.364131 93:187-205. [52]HAYET J B, ESTEVES C, MURRIETACID R A motionplanner for [37]CHESI G, MALIS E, CIPOLLA R. Automatic segmentation and aintaining landmark visibility with a differential drive robot M]// matching of planar contours for visual servoing[ C]//IEEE Interma- Algorithmic Foundation of robotics vIll. heidelberg tional Conference on Robotics and Automation. San francisco 2009:33-347.DOl:10.1007/978-3-642-00312-7-21 IEEE,2000:2753-2758.DOl:10.1109/ ROBOT.2000.846444 53]SALARIS P, BELO F, FONTANELLI D, et al. Optimal paths in [38]MALIS E, CHAUMETTE F 2 1/2 D visual with respect to constrained image plane for purely image-based parking [C]// placement[J]. International Joumal of Computer Vision, 2000, 37 tems.Nice:[s.n.],2008:1673-1680.DOl:10.109/ROS.2008 (1):79-97DOl:10.1023/A:1008181530296 [39]MEZOUAR Y, CHAUMETTE F. Optimal trajectory with [54]KESHMIRI M, XIE W. Image-based visual servoing image-based control[ J]. Intemational Journal of Robotics Research mized trajectory planning technique[J]. IEEE/ASME Transactions 003,22(10):781-804.DOl:10.1177/027836490302210001. on Mechatronics, 2017, 22(1): 359-370 DOl: 10. 1109/TMECH. [40]SCHRAMM F, MOREL G. Ensuring visibility in calibration-free 2016.2602325. h planning for image- based visual servoing[J]. IEEE Transac-[55]马翔宇,李阿为,刘冠云.基于躯体反射的焊接机械手位姿路 ons on Robotics, 2006, 22(4): 848-854 DOl; 10. 1109/TRO 径规划[J].西安航空学院学报,2017,35(1):29-33.DO 10.3969/j-isn.1008-9233201701.006 [41]KYRKI V, KRAGIC D, CHRISTENSEN H L. New shortest-path MA Xiangyu, LI Awei, LIU Guanyun. Pose path planning of approaches to visual servoing [C]// IEEE/RSJ Internationa welding manipulator based on body reflection [J]. Joumal of XIAN Conference on Intelligent Robots and Systems. Sendai: IEEE, 2004: Aeronautical University, 2017, 35(1): 29-33 DO1: 10. 3969/j 349-354DOl:10.1109/ROs.2004.1389376 1008-9233.2017.01.006. [42]ALLOTTA B, FIORAVANTI D. 3D motion planning for image- [56]KHATIB O Real-time obstacle avoidance for manipulators and mo- based visual servoing tasks[ C]//IEEE Intemational Conference on ile robots[J ]. International Journal of Robotics Research, 1986 Robotics and Automation. Barcelona. IEEE. 2005.2173-2178DOI 5(1):90-98.DOl:10.1177/027836498600500106. 10.1109/ ROBOT2005.1570435 [57]何兆楚,何元烈,曾碧.RRT与人工势场法结合的机械臂避障 [43 ]BORGSTADT J A, FERRIER N J. Visual servoing: pati 规划[J.工业工程,2017,20(2):56-63.DO1:10.3969/j on by homography decomposition [ CJ//IEEE Conference on Robotics and Automation. Seoul: IEEE. 26 HE Zhaochu, HE Yuanlie, ZENG Bi Obstacle avoidence path plan- 730.DOl:10.1109/ ROBOT.2001.932636 ning for robot arm based on mixed algorithm of artificial potential [44]MALIS E. Visual servoing invariant to changes in IntrinsIc field method and RRT[J]. Industrial Engineering Journal parameters[ C]//Eighth IEEE Intermational Conference on Computer 20(2):56-63.DOl:10.3969 J-Issn.1007-7375.c17-2002. Vision. Vancouver: IEEE, 2001: 704-709. DOl: 10. 1109/ICCV. [58 ]KIRKPATRICK S, GELATT Jr C, VECCHI M P Optimization by

３２（６）： ７５０－７６７． ［３０］ ＭＥＺＯＵＡＲ Ｙ， ＣＨＡＵＭＥＴＴＥ Ｆ． Ｐａｔｈ ｐｌａｎｎｉｎｇ ｆｏｒ ｒｏｂｕｓｔ ｉｍａｇｅ⁃ ｂａｓｅｄ ｃｏｎｔｒｏｌ ［ Ｊ］． ＩＥＥＥ Ｔｒａｎｓａｃｔｉｏｎｓ ｏｎ Ｒｏｂｏｔｉｃｓ ＆ Ａｕｔｏｍａｔｉｏｎ， ２００２， １８（４）：５３４－５４９． ＤＯＩ： １０．１１０９ ／ ＴＲＡ．２００２．８０２２１８． ［３１］陶波， 龚泽宇， 丁汉． 机器人无标定视觉伺服控制研究进展 ［Ｊ］． 力学学报， ２０１６，４８（ ４）：７６７ － ７８３． ＤＯＩ： １０． ６０５２ ／ ０４５９ － １８７９－１６－１６１ ＴＡＯ Ｂｏ， ＧＯＮＧ Ｚｅｙｕ， ＤＩＮＧ Ｈａｎ． Ｓｕｒｖｅｙ ｏｎ ｕｎｃａｌｉｂｒａｔｅｄ ｒｏｂｏｔ ｖｉｓｕａｌ ｓｅｒｖｏｉｎｇ ｃｏｎｔｒｏｌ ［ Ｊ ］． Ｃｈｉｎｅｓｅ Ｊｏｕｒｎａｌ ｏｆ Ｔｈｅｏｒｅｔｉｃａｌ ａｎｄ Ａｐｐｌｉｅｄ Ｍｅｃｈａｎｉｃｓ， ２０１６， ４８（４）： ７６７－７８３．ＤＯＩ： １０．６０５２ ／ ０４５９－ １８７９－１６－１６１． ［３２］ＨＯＳＯＤＡ Ｋ， ＳＡＫＡＭＯＴＯ Ｋ， ＡＳＡＤＡ Ｍ． Ｔｒａｊｅｃｔｏｒｙ ｇｅｎｅｒａｔｉｏｎ ｆｏｒ ｏｂｓｔａｃｌｅ ａｖｏｉｄａｎｃｅ ｏｆ ｕｎｃａｌｉｂｒａｔｅｄ ｓｔｅｒｅｏ ｖｉｓｕａｌ ｓｅｒｖｏｉｎｇ ｗｉｔｈｏｕｔ ３Ｄ ｒｅｃｏｎｓｔｒｕｃｔｉｏｎ［Ｃ］ ／ ／ ＩＥＥＥ／ ＲＳＪ Ｉｎｔｅｒｎａｔｉｏｎａｌ Ｃｏｎｆｅｒｅｎｃｅ ｏｎ Ｉｎｔｅｌｌｉ⁃ ｇｅｎｔ Ｒｏｂｏｔｓ ａｎｄ Ｓｙｓｔｅｍｓ．Ｐｉｔｔｓｂｕｒｇｈ：ＩＥＥＥ，１９９５：２９－ ３４．ＤＯＩ： １０． １１０９ ／ ＩＲＯＳ．１９９５．５２５７７１． ［３３］ＨＡＲＴＬＥＹ Ｒ， ＺＩＳＳＥＲＭＡＮ Ａ． Ｍｕｌｔｉｐｌｅ ｖｉｅｗ ｇｅｏｍｅｔｒｙ ｉｎ ｃｏｍｐｕｔｅｒ ｖｉｓｉｏｎ［Ｊ］． Ｋｙｂｅｒｎｅｔｅｓ， ２００３， ３０（ ９ ／ １０）：１８６５ － １８７２．ＤＯＩ： １０． １１０８ ／ ｋ．２００１．３０．９＿１０．１３３３．２． ［３４］ＰＡＲＫ Ｊ Ｓ， ＣＨＵＮＧ Ｍ Ｊ． Ｐａｔｈ ｐｌａｎｎｉｎｇ ｗｉｔｈ ｕｎｃａｌｉｂｒａｔｅｄ ｓｔｅｒｅｏ ｒｉｇ ｆｏｒ ｉｍａｇｅ－ｂａｓｅｄ ｖｉｓｕａｌ ｓｅｒｖｏｉｎｇ ｕｎｄｅｒ ｌａｒｇｅ ｐｏｓｅ ｄｉｓｃｒｅｐａｎｃｙ［ Ｊ］． ＩＥＥＥ Ｔｒａｎｓａｃｔｉｏｎｓ ｏｎ Ｒｏｂｏｔｉｃｓ ＆ Ａｕｔｏｍａｔｉｏｎ， ２００３， １９（２）：２５０－ ２５８． ＤＯＩ： １０．１１０９ ／ ＴＲＡ．２００３．８０８８６１． ［３５］ＥＳＰＩＡＵ Ｂ， ＣＨＡＵＭＥＴＴＥ Ｆ， ＲＩＶＥＳ Ｐ． Ａ ｎｅｗ ａｐｐｒｏａｃｈ ｔｏ ｖｉｓｕａｌ ｓｅｒｖｏｉｎｇ ｉｎ ｒｏｂｏｔｉｃｓ［Ｊ］． ＩＥＥＥ Ｔｒａｎｓａｃｔｉｏｎｓ ｏｎ Ｒｏｂｏｔｉｃｓ ＆ Ａｕｔｏｍａ⁃ ｔｉｏｎ， １９９２， ８（３）：３１３－３２６．ＤＯＩ： １０．１１０９ ／ ７０．１４３３５０． ［３６］ ＦＡＵＧＥＲＡＳ Ｏ． Ｔｈｒｅｅ⁃ｄｉｍｅｎｓｉｏｎａｌ ｃｏｍｐｕｔｅｒ ｖｉｓｉｏｎ， ａ ｇｅｏｍｅｔｒｉｃ ｖｉｅｗｐｏｉｎｔ［Ｍ］． Ｃａｍｂｒｉｄｇｅ： ＭＩＴ Ｐｒｅｓｓ， １９９３：１８７－２０５． ［３７］ ＣＨＥＳＩ Ｇ， ＭＡＬＩＳ Ｅ， ＣＩＰＯＬＬＡ Ｒ． Ａｕｔｏｍａｔｉｃ ｓｅｇｍｅｎｔａｔｉｏｎ ａｎｄ ｍａｔｃｈｉｎｇ ｏｆ ｐｌａｎａｒ ｃｏｎｔｏｕｒｓ ｆｏｒ ｖｉｓｕａｌ ｓｅｒｖｏｉｎｇ［Ｃ］ ／ ／ ＩＥＥＥ Ｉｎｔｅｒｎａ⁃ ｔｉｏｎａｌ Ｃｏｎｆｅｒｅｎｃｅ ｏｎ Ｒｏｂｏｔｉｃｓ ａｎｄ Ａｕｔｏｍａｔｉｏｎ． Ｓａｎ Ｆｒａｎｃｉｓｃｏ： ＩＥＥＥ， ２０００： ２７５３－２７５８．ＤＯＩ： １０．１１０９ ／ ＲＯＢＯＴ．２０００．８４６４４４． ［３８］ＭＡＬＩＳ Ｅ， ＣＨＡＵＭＥＴＴＥ Ｆ． ２ １ ／ ２ Ｄ ｖｉｓｕａｌ ｓｅｒｖｏｉｎｇ ｗｉｔｈ ｒｅｓｐｅｃｔ ｔｏ ｕｎｋｎｏｗｎ ｏｂｊｅｃｔｓ ｔｈｒｏｕｇｈ ａ ｎｅｗ ｅｓｔｉｍａｔｉｏｎ ｓｃｈｅｍｅ ｏｆ ｃａｍｅｒａ ｄｉｓ⁃ ｐｌａｃｅｍｅｎｔ［Ｊ］． Ｉｎｔｅｒｎａｔｉｏｎａｌ Ｊｏｕｒｎａｌ ｏｆ Ｃｏｍｐｕｔｅｒ Ｖｉｓｉｏｎ， ２０００， ３７ （１）：７９－９７．ＤＯＩ： １０．１０２３ ／ Ａ：１００８１８１５３０２９６． ［３９］ ＭＥＺＯＵＡＲ Ｙ， ＣＨＡＵＭＥＴＴＥ Ｆ． Ｏｐｔｉｍａｌ ｃａｍｅｒａ ｔｒａｊｅｃｔｏｒｙ ｗｉｔｈ ｉｍａｇｅ⁃ｂａｓｅｄ ｃｏｎｔｒｏｌ［Ｊ］． Ｉｎｔｅｒｎａｔｉｏｎａｌ Ｊｏｕｒｎａｌ ｏｆ Ｒｏｂｏｔｉｃｓ Ｒｅｓｅａｒｃｈ， ２００３， ２２（１０）：７８１－８０４． ＤＯＩ： １０．１１７７ ／ ０２７８３６４９０３０２２１０００１． ［４０］ ＳＣＨＲＡＭＭ Ｆ， ＭＯＲＥＬ Ｇ． Ｅｎｓｕｒｉｎｇ ｖｉｓｉｂｉｌｉｔｙ ｉｎ ｃａｌｉｂｒａｔｉｏｎ⁃ｆｒｅｅ ｐａｔｈ ｐｌａｎｎｉｎｇ ｆｏｒ ｉｍａｇｅ⁃ｂａｓｅｄ ｖｉｓｕａｌ ｓｅｒｖｏｉｎｇ ［ Ｊ］． ＩＥＥＥ Ｔｒａｎｓａｃ⁃ ｔｉｏｎｓ ｏｎ Ｒｏｂｏｔｉｃｓ， ２００６， ２２ （ ４）：８４８ － ８５４． ＤＯＩ： １０． １１０９ ／ ＴＲＯ． ２００６．８７８９５５． ［４１］ ＫＹＲＫＩ Ｖ， ＫＲＡＧＩＣ Ｄ， ＣＨＲＩＳＴＥＮＳＥＮ Ｈ Ｉ． Ｎｅｗ ｓｈｏｒｔｅｓｔ⁃ｐａｔｈ ａｐｐｒｏａｃｈｅｓ ｔｏ ｖｉｓｕａｌ ｓｅｒｖｏｉｎｇ ［ Ｃ ］ ／ ／ ＩＥＥＥ ／ ＲＳＪ Ｉｎｔｅｒｎａｔｉｏｎａｌ Ｃｏｎｆｅｒｅｎｃｅ ｏｎ Ｉｎｔｅｌｌｉｇｅｎｔ Ｒｏｂｏｔｓ ａｎｄ Ｓｙｓｔｅｍｓ．Ｓｅｎｄａｉ：ＩＥＥＥ，２００４： ３４９－３５４．ＤＯＩ： １０．１１０９ ／ ＩＲＯＳ．２００４．１３８９３７６． ［４２］ ＡＬＬＯＴＴＡ Ｂ， ＦＩＯＲＡＶＡＮＴＩ Ｄ． ３Ｄ ｍｏｔｉｏｎ ｐｌａｎｎｉｎｇ ｆｏｒ ｉｍａｇｅ⁃ ｂａｓｅｄ ｖｉｓｕａｌ ｓｅｒｖｏｉｎｇ ｔａｓｋｓ［Ｃ］ ／ ／ ＩＥＥＥ Ｉｎｔｅｒｎａｔｉｏｎａｌ Ｃｏｎｆｅｒｅｎｃｅ ｏｎ Ｒｏｂｏｔｉｃｓ ａｎｄ Ａｕｔｏｍａｔｉｏｎ． Ｂａｒｃｅｌｏｎａ：ＩＥＥＥ，２００５：２１７３－２１７８．ＤＯＩ： １０．１１０９ ／ ＲＯＢＯＴ．２００５．１５７０４３５． ［４３］ＢＯＲＧＳＴＡＤＴ Ｊ Ａ， ＦＥＲＲＩＥＲ Ｎ Ｊ． Ｖｉｓｕａｌ ｓｅｒｖｏｉｎｇ： ｐａｔｈ ｉｎｔｅｒｐｏｌａ⁃ ｔｉｏｎ ｂｙ ｈｏｍｏｇｒａｐｈｙ ｄｅｃｏｍｐｏｓｉｔｉｏｎ ［ Ｃ ］ ／ ／ ＩＥＥＥ Ｉｎｔｅｒｎａｔｉｏｎａｌ Ｃｏｎｆｅｒｅｎｃｅ ｏｎ Ｒｏｂｏｔｉｃｓ ａｎｄ Ａｕｔｏｍａｔｉｏｎ． Ｓｅｏｕｌ：ＩＥＥＥ，２００１：７２３ － ７３０．ＤＯＩ： １０．１１０９ ／ ＲＯＢＯＴ．２００１．９３２６３６． ［４４］ＭＡＬＩＳ Ｅ． Ｖｉｓｕａｌ ｓｅｒｖｏｉｎｇ ｉｎｖａｒｉａｎｔ ｔｏ ｃｈａｎｇｅｓ ｉｎ ｃａｍｅｒａ ｉｎｔｒｉｎｓｉｃ ｐａｒａｍｅｔｅｒｓ［Ｃ］ ／ ／ Ｅｉｇｈｔｈ ＩＥＥＥ Ｉｎｔｅｒｎａｔｉｏｎａｌ Ｃｏｎｆｅｒｅｎｃｅ ｏｎ Ｃｏｍｐｕｔｅｒ Ｖｉｓｉｏｎ． Ｖａｎｃｏｕｖｅｒ： ＩＥＥＥ， ２００１： ７０４ － ７０９． ＤＯＩ： １０． １１０９ ／ ＩＣＣＶ． ２００１．９３７５９２． ［４５］ＳＨＡＲＭＡ Ｒ， ＳＵＴＡＮＴＯ Ｈ． Ａ ｆｒａｍｅｗｏｒｋ ｆｏｒ ｒｏｂｏｔ ｍｏｔｉｏｎ ｐｌａｎｎｉｎｇ ｗｉｔｈ ｓｅｎｓｏｒ ｃｏｎｓｔｒａｉｎｔｓ［Ｊ］． ＩＥＥＥ Ｔｒａｎｓａｃｔｉｏｎｓ ｏｎ Ｒｏｂｏｔｉｃｓ ＆ Ａｕｔｏ⁃ ｍａｔｉｏｎ， １９９７， １３（１）：６１－７３．ＤＯＩ： １０．１１０９ ／ ７０．５５４３４７． ［４６］ ＺＨＡＮＧ Ｈ， ＯＳＴＲＯＷＳＫＩ Ｊ Ｐ． Ｖｉｓｕａｌ ｍｏｔｉｏｎ ｐｌａｎｎｉｎｇ ｆｏｒ ｍｏｂｉｌｅ ｒｏｂｏｔｓ［Ｊ］． ＩＥＥＥ Ｔｒａｎｓａｃｔｉｏｎｓ ｏｎ Ｒｏｂｏｔｉｃｓ ＆ Ａｕｔｏｍａｔｉｏｎ， ２００２， １８ （２）：１９９－２０８． ＤＯＩ： １０．１１０９ ／ ＴＲＡ． ２００２．９９９６４８． ［４７］ＣＨＥＳＩ Ｇ， ＰＲＡＴＴＩＣＨＩＺＺＯ Ｄ， ＶＩＣＩＮＯ Ａ． Ｓｔｒａｉｇｈｔ ｌｉｎｅ ｐａｔｈ⁃ｐｌａｎ⁃ ｎｉｎｇ ｉｎ ｖｉｓｕａｌ ｓｅｒｖｏｉｎｇ［ Ｊ］． Ｊｏｕｒｎａｌ ｏｆ Ｄｙｎａｍｉｃ Ｓｙｓｔｅｍｓ Ｍｅａｓｕｒｅ⁃ ｍｅｎｔ ＆ Ｃｏｎｔｒｏｌ， ２００７， １２９ （ ４ ）： ５４１ － ５４３． ＤＯＩ： １０． １１１５ ／ １． ２７４５８８２． ［４８］ＣＨＥＳＩ Ｇ， ＨＵＮＧ Ｙ Ｓ． Ｇｌｏｂａｌ ｐａｔｈ⁃ｐｌａｎｎｉｎｇ ｆｏｒ ｃｏｎｓｔｒａｉｎｅｄ ａｎｄ ｏｐｔｉｍａｌ ｖｉｓｕａｌ ｓｅｒｖｏｉｎｇ［ Ｊ］． ＩＥＥＥ Ｔｒａｎｓａｃｔｉｏｎｓ ｏｎ Ｒｏｂｏｔｉｃｓ， ２００７， ２３（５）：１０５０－１０６０． ＤＯＩ： １０．１１０９ ／ ＴＲＯ．２００７．９０３８１７． ［ ４９］ＣＨＥＳＩ Ｇ． Ｖｉｓｕａｌ ｓｅｒｖｏｉｎｇ ｐａｔｈ ｐｌａｎｎｉｎｇ ｖｉａ ｈｏｍｏｇｅｎｅｏｕｓ ｆｏｒｍｓ ａｎｄ ＬＭＩ ｏｐｔｉｍｉｚａｔｉｏｎｓ［ Ｊ］． ＩＥＥＥ Ｔｒａｎｓａｃｔｉｏｎｓ ｏｎ Ｒｏｂｏｔｉｃｓ， ２００９， ２５ （２）：２８１－２９１． ＤＯＩ： １０．１１０９ ／ ＴＲＯ．２００９．２０１４１３１． ［５０］ＢＨＡＴＴＡＣＨＡＲＹＡ Ｓ， ＭＵＲＲＩＥＴＡ⁃ＣＩＤ Ｒ， ＨＵＴＣＨＩＮＳＯＮ Ｓ． Ｏｐ⁃ ｔｉｍａｌ ｐａｔｈｓ ｆｏｒ ｌａｎｄｍａｒｋ⁃ｂａｓｅｄ ｎａｖｉｇａｔｉｏｎ ｂｙ ｄｉｆｆｅｒｅｎｔｉａｌ⁃ｄｒｉｖｅ ｖｅｈｉ⁃ ｃｌｅｓ ｗｉｔｈ ｆｉｅｌｄ⁃ｏｆ⁃ｖｉｅｗ ｃｏｎｓｔｒａｉｎｔｓ ［ Ｊ ］． ＩＥＥＥ Ｔｒａｎｓａｃｔｉｏｎｓ ｏｎ Ｒｏｂｏｔｉｃｓ， ２００７， ２３ （ １ ）： ４７ － ５９． ＤＯＩ： １０． １１０９ ／ ＴＲＯ． ２００６． ８８６８４１． ［５１］ＬＯＰＥＺ－ＮＩＣＯＬＡＳ Ｇ， ＢＨＡＴＴＡＣＨＡＲＹＡ Ｓ， ＧＵＥＲＲＥＲＯ Ｊ， ｅｔ ａｌ． Ｓｗｉｔｃｈｅｄ ｈｏｍｏｇｒａｐｈｙ⁃ｂａｓｅｄ ｖｉｓｕａｌ ｃｏｎｔｒｏｌ ｏｆ ｄｉｆｆｅｒｅｎｔｉａｌ ｄｒｉｖｅ ｖｅｈｉ⁃ ｃｌｅｓ ｗｉｔｈ ｆｉｅｌｄ⁃ｏｆ⁃ｖｉｅｗ ｃｏｎｓｔｒａｉｎｔｓ［Ｃ］ ／ ／ ＩＥＥＥ Ｉｎｔｅｒｎａｔｉｏｎａｌ Ｃｏｎｆｅｒ⁃ ｅｎｃｅ ｏｎ Ｒｏｂｏｔｉｃｓ ａｎｄ Ａｕｔｏｍａｔｉｏｎ． Ｒｏｍａ： ＩＥＥＥ， ２００７：４２３８－４２４４． ＤＯＩ： １０．１１０９ ／ ＲＯＢＯＴ．２００７．３６４１３１． ［５２］ＨＡＹＥＴ Ｊ Ｂ， ＥＳＴＥＶＥＳ Ｃ， ＭＵＲＲＩＥＴＡＣＩＤ Ｒ． Ａ ｍｏｔｉｏｎｐｌａｎｎｅｒ ｆｏｒ ｍａｉｎｔａｉｎｉｎｇ ｌａｎｄｍａｒｋ ｖｉｓｉｂｉｌｉｔｙ ｗｉｔｈ ａ ｄｉｆｆｅｒｅｎｔｉａｌ ｄｒｉｖｅ ｒｏｂｏｔ［Ｍ］ ／ ／ Ａｌｇｏｒｉｔｈｍｉｃ Ｆｏｕｎｄａｔｉｏｎ ｏｆ Ｒｏｂｏｔｉｃｓ ＶＩＩＩ． Ｈｅｉｄｅｌｂｅｒｇ： Ｓｐｒｉｎｇｅｒ， ２００９：３３３－３４７． ＤＯＩ： １０．１００７ ／ ９７８－３－６４２－００３１２－７－２１． ［５３］ＳＡＬＡＲＩＳ Ｐ， ＢＥＬＯ Ｆ， ＦＯＮＴＡＮＥＬＬＩ Ｄ， ｅｔ ａｌ． Ｏｐｔｉｍａｌ ｐａｔｈｓ ｉｎ ａ ｃｏｎｓｔｒａｉｎｅｄ ｉｍａｇｅ ｐｌａｎｅ ｆｏｒ ｐｕｒｅｌｙ ｉｍａｇｅ⁃ｂａｓｅｄ ｐａｒｋｉｎｇ ［ Ｃ ］ ／ ／ ＩＥＥＥ／ ＲＳＪ Ｉｎｔｅｒｎａｔｉｏｎａｌ Ｃｏｎｆｅｒｅｎｃｅ ｏｎ Ｉｎｔｅｌｌｉｇｅｎｔ Ｒｏｂｏｔｓ ａｎｄ Ｓｙｓ⁃ ｔｅｍｓ． Ｎｉｃｅ：［ｓ． ｎ．］，２００８：１６７３ － １６８０．ＤＯＩ： １０． １１０９ ／ ＩＲＯＳ． ２００８． ４６５１０５０． ［５４］ＫＥＳＨＭＩＲＩ Ｍ， ＸＩＥ Ｗ． Ｉｍａｇｅ－ｂａｓｅｄ ｖｉｓｕａｌ ｓｅｒｖｏｉｎｇ ｕｓｉｎｇ ａｎ ｏｐｔｉ⁃ ｍｉｚｅｄ ｔｒａｊｅｃｔｏｒｙ ｐｌａｎｎｉｎｇ ｔｅｃｈｎｉｑｕｅ［ Ｊ］． ＩＥＥＥ／ ＡＳＭＥ Ｔｒａｎｓａｃｔｉｏｎｓ ｏｎ Ｍｅｃｈａｔｒｏｎｉｃｓ， ２０１７， ２２（１）：３５９－３７０．ＤＯＩ： １０．１１０９ ／ ＴＭＥＣＨ． ２０１６．２６０２３２５． ［５５］马翔宇， 李阿为， 刘冠云． 基于躯体反射的焊接机械手位姿路 径规划［ Ｊ］． 西安航空学院学报， ２０１７， ３５ （ １）：２９ － ３３． ＤＯＩ： １０．３９６９ ／ ｊ．ｉｓｓｎ．１００８－９２３３．２０１７．０１．００６． ＭＡ Ｘｉａｎｇｙｕ， ＬＩ Ａｗｅｉ， ＬＩＵ Ｇｕａｎｙｕｎ． Ｐｏｓｅ ｐａｔｈ ｐｌａｎｎｉｎｇ ｏｆ ｗｅｌｄｉｎｇ ｍａｎｉｐｕｌａｔｏｒ ｂａｓｅｄ ｏｎ ｂｏｄｙ ｒｅｆｌｅｃｔｉｏｎ［ Ｊ］． Ｊｏｕｒｎａｌ ｏｆ ＸＩＡＮ Ａｅｒｏｎａｕｔｉｃａｌ Ｕｎｉｖｅｒｓｉｔｙ， ２０１７，３５（１）：２９－３３．ＤＯＩ：１０．３９６９ ／ ｊ．ｉｓｓｎ． １００８－９２３３．２０１７．０１．００６． ［５６］ＫＨＡＴＩＢ Ｏ． Ｒｅａｌ⁃ｔｉｍｅ ｏｂｓｔａｃｌｅ ａｖｏｉｄａｎｃｅ ｆｏｒ ｍａｎｉｐｕｌａｔｏｒｓ ａｎｄ ｍｏ⁃ ｂｉｌｅ ｒｏｂｏｔｓ［ Ｊ］． Ｉｎｔｅｒｎａｔｉｏｎａｌ Ｊｏｕｒｎａｌ ｏｆ Ｒｏｂｏｔｉｃｓ Ｒｅｓｅａｒｃｈ， １９８６， ５（１）：９０－９８． ＤＯＩ： １０．１１７７ ／ ０２７８３６４９８６００５００１０６． ［５７］何兆楚， 何元烈， 曾碧． ＲＲＴ 与人工势场法结合的机械臂避障 规划［Ｊ］． 工业工程， ２０１７，２０（２）： ５６－６３．ＤＯＩ： １０．３９６９ ／ ｊ．ｉｓｓｎ． １００７－７３７５．ｅ１７－２００２． ＨＥ Ｚｈａｏｃｈｕ， ＨＥ Ｙｕａｎｌｉｅ， ＺＥＮＧ Ｂｉ．Ｏｂｓｔａｃｌｅ ａｖｏｉｄｅｎｃｅ ｐａｔｈ ｐｌａｎ⁃ ｎｉｎｇ ｆｏｒ ｒｏｂｏｔ ａｒｍ ｂａｓｅｄ ｏｎ ｍｉｘｅｄ ａｌｇｏｒｉｔｈｍ ｏｆ ａｒｔｉｆｉｃｉａｌ ｐｏｔｅｎｔｉａｌ ｆｉｅｌｄ ｍｅｔｈｏｄ ａｎｄ ＲＲＴ ［ Ｊ］． Ｉｎｄｕｓｔｒｉａｌ Ｅｎｇｉｎｅｅｒｉｎｇ Ｊｏｕｒｎａｌ， ２０１７， ２０（２）：５６－６３． ＤＯＩ： １０．３９６９ ／ ｊ．ｉｓｓｎ．１００７－７３７５．ｅ１７－２００２． ［５８］ＫＩＲＫＰＡＴＲＩＣＫ Ｓ， ＧＥＬＡＴＴ Ｊｒ Ｃ， ＶＥＣＣＨＩ Ｍ Ｐ． Ｏｐｔｉｍｉｚａｔｉｏｎ ｂｙ 第 １ 期 任秉银， 等： 机械臂视觉伺服路径规划研究进展 ·９·

哈尔滨工业大学学报 第50卷 simulated annealing[ J]. Science, 1983, 220( 4598): 606-615. Conference on Robotics and Automation San Francisco. IEEE- 2000 DOl:10.1126/ scIence.220.4598.67 995-1001.DOl:10.1109/ ROBOT2000.844730. 59]唐彪,何波改进人工势场法的机械臂避障路径规划研究[冂].[6]杜明博,梅涛,陈佳佳,等.复杂环境下基于RRT的智能车辆 无线互联科技,2017(3):115-117DOl:10.3969/jisn.1672 运动规划算法[J].机器人,2015,37(4):443-450.DOl:10 694.2017.03.046 13973/ i cnki robot.20150443 TANG Biao, HE Bo. Research on obstacle avoidance path planning DU Mingbo, MEI Tao, CHEN Jiajia, et al. RRT-basedmotion plan- of manipulator with improved artificial potential field method [J] ning algorithm for intelligent vehicle in complex environments [J] Wuxian Hulian Keji, 2017(3): 115-117. DOl: 10.3969/j.issn. Rob,2015,37(4):443-450.Dol:10.13973/ i-enki. robot.2015 1672-694.2017.03.046 [60]赵栋杰对靶喷雾机器人视觉伺服控制系统硏究[υ]·北京:中〔68]膝根保.面向狭窄通道的机械臂避障规划与示教技术硏究及应 用D].杭州:浙江大学,2017 ZHAO Dongjie. Research on visual servo control system TENG Genbao. Research and application of obstacle avoidance plan- spraying robot [D]. Beijing: China Agricultural University ning and teaching technology for narrow-channel manipulators[D] [ 61]COWAN N, WEINGARTEN J, KODITSCHEK D. Visual Hangzhou: Zhejiang University, 2017 via navigation functions[J]. IEEE Transactions on Robotics& Auto- [69 JESPIAU B. Effect of camera calibration errors on visual servoing in mation,2002,18(4):521-533.DOl:10.109/TRA.2002.802202 robotics[C ]//The International Symposium on Experimental [ 62]BAUMANN M, DUPUIS D, LEONARD S, et al.Occlusion-free Robotics Ill. London: Springer-Verlag, 1993: 182-192. DO1; 10. th planning with a probabilistic roadmap[C]//IEEE/RSJ Intema- 1007/BFb027594. tional Conference on Intelligent Robots and Systems. Nice: IEEE, [70]KYRKI V, KRAGIC D, CHRISTENSEN H L. Measurement errors 2008:2151-2156DO:10.1109/R0s.2008.4651035 visual servoing[J]. Robotics Autonomous Systems, 2006, 54 [63]TARABANIS K, TSAI R Y, KAUL A Computing occlusion-free 0):815-827.DOl:10.1016/ j- robot.200605.002 viewpoints[ M]. Champaign: IEEE Computer Society, 1992. DO1: [71]LANG 0, GRASER A. Visual control of 6 DOF robots with constant 109/CvPR.1992.223168. object size in the image by means of zoom camera[ C]//The 25th [ 64]YAO Z, GUPTA K. Path planning with general end-effector con- Annual Conference of the IEEE Industrial Electronics Society Pro- straints[J]. Robotics& Autonomous Systems, 2007, 55(4):316 ceedings. San Jose: IEEE, 1999: 1342-1347 DOl: 10. 1109/IECON. 327DOl:10.1016/ i. robot.2006.11.004 999819406 [ 65]KAZEMI M, GUPTA K, MEHRANDEZH M Global path [72]COMPORT A I, MARCHAND E, PRESSIGOUT M, et al. Real- for robust visual servoing in complex environments[C]//. me markerless tracking for augmented reality. the virtual visual ser- national Conference on Robotics and Automation. Kobe voing framework [J]. IEEE Transactions on Visualization 2009:326-332.DOl:10.1109/ ROBOT2009.5152453 Computer Graphics, 2006, 12(4): 615-628. DOl: 10.1109/TVCG. [ 66]KUFFNER J J, LAVALLE S M. RRT-connect: an efficient gle-query path planning[C]// IEEE International (编辑杨波)

ｓｉｍｕｌａｔｅｄ ａｎｎｅａｌｉｎｇ［ Ｊ］． Ｓｃｉｅｎｃｅ， １９８３， ２２０ （ ４５９８）： ６０６ － ６１５． ＤＯＩ： １０．１１２６ ／ ｓｃｉｅｎｃｅ．２２０．４５９８．６７１ ［５９］唐彪， 何波． 改进人工势场法的机械臂避障路径规划研究［ Ｊ］． 无线互联科技， ２０１７（ ３）：１１５－ １１７．ＤＯＩ： １０．３９６９ ／ ｊ．ｉｓｓｎ．１６７２－ ６９４４．２０１７． ０３．０４６ ＴＡＮＧ Ｂｉａｏ， ＨＥ Ｂｏ． Ｒｅｓｅａｒｃｈ ｏｎ ｏｂｓｔａｃｌｅ ａｖｏｉｄａｎｃｅ ｐａｔｈ ｐｌａｎｎｉｎｇ ｏｆ ｍａｎｉｐｕｌａｔｏｒ ｗｉｔｈ ｉｍｐｒｏｖｅｄ ａｒｔｉｆｉｃｉａｌ ｐｏｔｅｎｔｉａｌ ｆｉｅｌｄ ｍｅｔｈｏｄ ［ Ｊ］． Ｗｕｘｉａｎ Ｈｕｌｉａｎ Ｋｅｊｉ， ２０１７ （ ３）：１１５ － １１７． ＤＯＩ： １０． ３９６９ ／ ｊ． ｉｓｓｎ． １６７２－６９４４．２０１７． ０３．０４６ ［６０］赵栋杰． 对靶喷雾机器人视觉伺服控制系统研究［Ｄ］．北京：中 国农业大学， ２０１７． ＺＨＡＯ Ｄｏｎｇｊｉｅ． Ｒｅｓｅａｒｃｈ ｏｎ ｖｉｓｕａｌ ｓｅｒｖｏ ｃｏｎｔｒｏｌ ｓｙｓｔｅｍ ｏｆ ｔａｒｇｅｔ ｓｐｒａｙｉｎｇ ｒｏｂｏｔ ［Ｄ］．Ｂｅｉｊｉｎｇ： Ｃｈｉｎａ Ａｇｒｉｃｕｌｔｕｒａｌ Ｕｎｉｖｅｒｓｉｔｙ， ２０１７． ［６１］ＣＯＷＡＮ Ｎ， ＷＥＩＮＧＡＲＴＥＮ Ｊ， ＫＯＤＩＴＳＣＨＥＫ Ｄ． Ｖｉｓｕａｌ ｓｅｒｖｏｉｎｇ ｖｉａ ｎａｖｉｇａｔｉｏｎ ｆｕｎｃｔｉｏｎｓ［Ｊ］． ＩＥＥＥ Ｔｒａｎｓａｃｔｉｏｎｓ ｏｎ Ｒｏｂｏｔｉｃｓ ＆ Ａｕｔｏ⁃ ｍａｔｉｏｎ， ２００２，１８（４）： ５２１－５３３．ＤＯＩ： １０．１１０９ ／ ＴＲＡ．２００２．８０２２０２． ［６２］ ＢＡＵＭＡＮＮ Ｍ， ＤＵＰＵＩＳ Ｄ， ＬＥＯＮＡＲＤ Ｓ， ｅｔ ａｌ． Ｏｃｃｌｕｓｉｏｎ⁃ｆｒｅｅ ｐａｔｈ ｐｌａｎｎｉｎｇ ｗｉｔｈ ａ ｐｒｏｂａｂｉｌｉｓｔｉｃ ｒｏａｄｍａｐ［Ｃ］ ／ ／ ＩＥＥＥ／ ＲＳＪ Ｉｎｔｅｒｎａ⁃ ｔｉｏｎａｌ Ｃｏｎｆｅｒｅｎｃｅ ｏｎ Ｉｎｔｅｌｌｉｇｅｎｔ Ｒｏｂｏｔｓ ａｎｄ Ｓｙｓｔｅｍｓ． Ｎｉｃｅ： ＩＥＥＥ， ２００８：２１５１－２１５６．ＤＯＩ： １０．１１０９ ／ ＩＲＯＳ．２００８．４６５１０３５． ［６３］ＴＡＲＡＢＡＮＩＳ Ｋ， ＴＳＡＩ Ｒ Ｙ， ＫＡＵＬ Ａ． Ｃｏｍｐｕｔｉｎｇ ｏｃｃｌｕｓｉｏｎ⁃ｆｒｅｅ ｖｉｅｗｐｏｉｎｔｓ［Ｍ］． Ｃｈａｍｐａｉｇｎ： ＩＥＥＥ Ｃｏｍｐｕｔｅｒ Ｓｏｃｉｅｔｙ， １９９２． ＤＯＩ： １０．１１０９ ／ ＣＶＰＲ．１９９２． ２２３１６８． ［６４］ＹＡＯ Ｚ， ＧＵＰＴＡ Ｋ． Ｐａｔｈ ｐｌａｎｎｉｎｇ ｗｉｔｈ ｇｅｎｅｒａｌ ｅｎｄ⁃ｅｆｆｅｃｔｏｒ ｃｏｎ⁃ ｓｔｒａｉｎｔｓ［Ｊ］． Ｒｏｂｏｔｉｃｓ ＆ Ａｕｔｏｎｏｍｏｕｓ Ｓｙｓｔｅｍｓ，２００７，５５ （ ４）：３１６ － ３２７．ＤＯＩ： １０．１０１６ ／ ｊ．ｒｏｂｏｔ．２００６．１１．００４． ［６５］ＫＡＺＥＭＩ Ｍ， ＧＵＰＴＡ Ｋ， ＭＥＨＲＡＮＤＥＺＨ Ｍ． Ｇｌｏｂａｌ ｐａｔｈ ｐｌａｎｎｉｎｇ ｆｏｒ ｒｏｂｕｓｔ ｖｉｓｕａｌ ｓｅｒｖｏｉｎｇ ｉｎ ｃｏｍｐｌｅｘ ｅｎｖｉｒｏｎｍｅｎｔｓ［Ｃ］ ／ ／ ＩＥＥＥ Ｉｎｔｅｒ⁃ ｎａｔｉｏｎａｌ Ｃｏｎｆｅｒｅｎｃｅ ｏｎ Ｒｏｂｏｔｉｃｓ ａｎｄ Ａｕｔｏｍａｔｉｏｎ． Ｋｏｂｅ： ＩＥＥＥ， ２００９：３２６－３３２．ＤＯＩ： １０．１１０９ ／ ＲＯＢＯＴ．２００９．５１５２４５３． ［ ６６ ］ ＫＵＦＦＮＥＲ Ｊ Ｊ， ＬＡＶＡＬＬＥ Ｓ Ｍ． ＲＲＴ⁃ｃｏｎｎｅｃｔ： ａｎ ｅｆｆｉｃｉｅｎｔ ａｐｐｒｏａｃｈ ｔｏ ｓｉｎｇｌｅ⁃ｑｕｅｒｙ ｐａｔｈ ｐｌａｎｎｉｎｇ ［ Ｃ］ ／ ／ ＩＥＥＥ Ｉｎｔｅｒｎａｔｉｏｎａｌ Ｃｏｎｆｅｒｅｎｃｅ ｏｎ Ｒｏｂｏｔｉｃｓ ａｎｄ Ａｕｔｏｍａｔｉｏｎ．ＳａｎＦｒａｎｃｉｓｃｏ：ＩＥＥＥ，２０００： ９９５－１００１．ＤＯＩ： １０．１１０９ ／ ＲＯＢＯＴ．２０００．８４４７３０． ［６７］杜明博， 梅涛， 陈佳佳， 等． 复杂环境下基于 ＲＲＴ 的智能车辆 运动规划算法［ Ｊ］． 机器人， ２０１５，３７ （ ４）： ４４３ － ４５０． ＤＯＩ：１０． １３９７３ ／ ｊ．ｃｎｋｉ．ｒｏｂｏｔ．２０１５．０４４３． ＤＵ Ｍｉｎｇｂｏ， ＭＥＩ Ｔａｏ， ＣＨＥＮ Ｊｉａｊｉａ， ｅｔ ａｌ． ＲＲＴ⁃ｂａｓｅｄｍｏｔｉｏｎ ｐｌａｎ⁃ ｎｉｎｇ ａｌｇｏｒｉｔｈｍ ｆｏｒ ｉｎｔｅｌｌｉｇｅｎｔ ｖｅｈｉｃｌｅ ｉｎ ｃｏｍｐｌｅｘ ｅｎｖｉｒｏｎｍｅｎｔｓ［ Ｊ］． Ｒｏｂｏｔ， ２０１５， ３７（４）： ４４３－４５０． ＤＯＩ：１０．１３９７３ ／ ｊ．ｃｎｋｉ．ｒｏｂｏｔ．２０１５． ０４４３． ［６８］滕根保． 面向狭窄通道的机械臂避障规划与示教技术研究及应 用［Ｄ］． 杭州：浙江大学， ２０１７． ＴＥＮＧ Ｇｅｎｂａｏ． Ｒｅｓｅａｒｃｈ ａｎｄ ａｐｐｌｉｃａｔｉｏｎ ｏｆ ｏｂｓｔａｃｌｅ ａｖｏｉｄａｎｃｅ ｐｌａｎ⁃ ｎｉｎｇ ａｎｄ ｔｅａｃｈｉｎｇ ｔｅｃｈｎｏｌｏｇｙ ｆｏｒ ｎａｒｒｏｗ⁃ｃｈａｎｎｅｌ ｍａｎｉｐｕｌａｔｏｒｓ［Ｄ］． Ｈａｎｇｚｈｏｕ： Ｚｈｅｊｉａｎｇ Ｕｎｉｖｅｒｓｉｔｙ， ２０１７ ［６９］ＥＳＰＩＡＵ Ｂ． Ｅｆｆｅｃｔ ｏｆ ｃａｍｅｒａ ｃａｌｉｂｒａｔｉｏｎ ｅｒｒｏｒｓ ｏｎ ｖｉｓｕａｌ ｓｅｒｖｏｉｎｇ ｉｎ ｒｏｂｏｔｉｃｓ ［ Ｃ ］ ／ ／ Ｔｈｅ Ｉｎｔｅｒｎａｔｉｏｎａｌ Ｓｙｍｐｏｓｉｕｍ ｏｎ Ｅｘｐｅｒｉｍｅｎｔａｌ Ｒｏｂｏｔｉｃｓ ＩＩＩ． Ｌｏｎｄｏｎ： Ｓｐｒｉｎｇｅｒ －Ｖｅｒｌａｇ， １９９３：１８２ － １９２． ＤＯＩ：１０． １００７ ／ ＢＦｂ００２７５９４． ［７０］ＫＹＲＫＩ Ｖ， ＫＲＡＧＩＣ Ｄ， ＣＨＲＩＳＴＥＮＳＥＮ Ｈ Ｉ． Ｍｅａｓｕｒｅｍｅｎｔ ｅｒｒｏｒｓ ｉｎ ｖｉｓｕａｌ ｓｅｒｖｏｉｎｇ［ Ｊ］． Ｒｏｂｏｔｉｃｓ ＆ Ａｕｔｏｎｏｍｏｕｓ Ｓｙｓｔｅｍｓ， ２００６， ５４ （１０）：８１５－８２７．ＤＯＩ： １０．１０１６ ／ ｊ．ｒｏｂｏｔ．２００６．０５．００２ ［ ７１］ＬＡＮＧ Ｏ， ＧＲＡＳＥＲ Ａ． Ｖｉｓｕａｌ ｃｏｎｔｒｏｌ ｏｆ ６ ＤＯＦ ｒｏｂｏｔｓ ｗｉｔｈ ｃｏｎｓｔａｎｔ ｏｂｊｅｃｔ ｓｉｚｅ ｉｎ ｔｈｅ ｉｍａｇｅ ｂｙ ｍｅａｎｓ ｏｆ ｚｏｏｍ ｃａｍｅｒａ［Ｃ］ ／ ／ Ｔｈｅ ２５ｔｈ Ａｎｎｕａｌ Ｃｏｎｆｅｒｅｎｃｅ ｏｆ ｔｈｅ ＩＥＥＥ Ｉｎｄｕｓｔｒｉａｌ Ｅｌｅｃｔｒｏｎｉｃｓ Ｓｏｃｉｅｔｙ Ｐｒｏ⁃ ｃｅｅｄｉｎｇｓ． Ｓａｎ Ｊｏｓｅ：ＩＥＥＥ，１９９９：１３４２－１３４７．ＤＯＩ： １０．１１０９ ／ ＩＥＣＯＮ． １９９９．８１９４０６． ［７２］ＣＯＭＰＯＲＴ Ａ Ｉ， ＭＡＲＣＨＡＮＤ Ｅ， ＰＲＥＳＳＩＧＯＵＴ Ｍ， ｅｔ ａｌ． Ｒｅａｌ⁃ ｔｉｍｅ ｍａｒｋｅｒｌｅｓｓ ｔｒａｃｋｉｎｇ ｆｏｒ ａｕｇｍｅｎｔｅｄ ｒｅａｌｉｔｙ： ｔｈｅ ｖｉｒｔｕａｌ ｖｉｓｕａｌ ｓｅｒ⁃ ｖｏｉｎｇ ｆｒａｍｅｗｏｒｋ ［ Ｊ ］． ＩＥＥＥ Ｔｒａｎｓａｃｔｉｏｎｓ ｏｎ Ｖｉｓｕａｌｉｚａｔｉｏｎ ＆ Ｃｏｍｐｕｔｅｒ Ｇｒａｐｈｉｃｓ， ２００６， １２（４）：６１５－６２８．ＤＯＩ： １０．１１０９ ／ ＴＶＣＧ． ２００６．７８． （编辑 杨 波） ·１０· 哈 尔 滨 工 业 大 学 学 报 第 ５０ 卷