动机
在读完了RVC之后,我对于IBVS方法非常感兴趣。实验室内有一台UR5,所以我希望可以快速实践一下看看具体应用中汇出什么幺蛾子。
对于UR5的控制,如果直接采用MATLAB方法必然是最快捷的(因为可以借助RVC的工具箱),但是RVC的工具箱是PUMA560这个经典型的机器人为例子的。而且是以仿真为主的。而我目前开发机器人运动规划算法一般是基于MoveIt,所以希望尝试将RVC所述的IBVS算法移植到ROS上来(我搜了一下,目前ROS中似乎还没有类似的软件包)。充分利用Moveit中写好的防碰撞功能。
思路
IBVS算法在《RVC》的457页,截至到这页的算法只考虑了成像输入和相机位姿的世界坐标变换的输出。这就是我需要实现算法的第一部分,本质上这部分是完成机器人感知世界。该算法的流程为: