一种基于快速扩展随机树和势场法的视觉伺服路径规划方法

摘要

本发明公开了一种结合快速扩展随机树和势场法的视觉伺服路径规划方法。先给出机器人任意位姿下目标物特征点的任务空间坐标与图像平面像素坐标的映射关系；然后在任务空间随机生产新的位姿，新的位姿要保证与最近的原有位姿之间没有障碍物，同时计算出相应位姿下目标物特征点图像平面像素坐标，使其保持在相机视野范围内；使用基于快速扩展随机树和势场法的路径规划方法在任务空间搜索可行的相机路径，得到相应的图像平面特征轨迹，最后利用基于图像的视觉伺服(IBVS)进行跟踪控制使机器人实现初始位姿到期望位姿的避障并满足视野约束的运动。本发明通过在机器人视觉伺服中引入路径规划技术，解决了机器人视觉伺服中的避障和特征可视问题。