[发明专利]一种基于滚动时域的机器人视觉伺服位姿估计方法

说明书

一种基于滚动时域的机器人视觉伺服位姿估计方法，包括以下步骤：1)利用相机投影模型进行特征点变换；2)建立离散时间模型；3)根据离散时间模型以及滚动时域策略，定义代价函数；4)确保代价函数达到最小，从而设计最优滚动时域估计器。本发明提供了一种基于滚动时域的机器人视觉伺服位姿估计方法，通过引入滚动时域目标函数来最小化代价函数，并确定最优预测方程的设计方案。

技术领域

本发明涉及机器人视觉伺服系统，尤其涉及的是基于滚动时域的位姿估计方法。

背景技术

随着科学技术和控制技术的发展，计算机视觉在各个领域已有广泛的运用，其中，机器人视觉伺服(RVS)系统的位姿估计问题一直备受广泛关注。位姿估计是指使用图像信息来确定相机相对于物体坐标系的位置和姿态，机器人系统能利用位置和姿态进行机器人运动的实时控制。针对机器人视觉伺服系统位姿估计的研究，不仅可以丰富机器人位姿估计的理论成果，还可以满足多领域对位姿估计技术越来越高的要求，具有实际的理论和工程意义。

然而在实际环境中，RVS系统的位姿估计有两个主要困难，分别是位姿估计的效率以及其鲁棒性。同时机器人在运动过程中总是存在噪声干扰，机器人的位姿估计问题实际上就成为一个带有噪声干扰的状态估计问题。目前主要是应用卡尔曼滤波方法来解决这些困难。对于线性系统的状态估计卡尔曼滤波已经能够很好地解决,但是在非线性系统中就不那么容易.目前已有的解决非线性问题的方法也都是线性系统卡尔曼滤波方法的扩展,如最常用的扩展卡尔曼滤波(extended Kalman filter,EKF),无迹卡尔曼滤波(unscentedKalman filter,UKF)等。Wang等在论文(3D relative position and orientationestimation using Kalman filtering for robot control)中，针对机器人位姿估计问题，提出了一种扩展卡尔曼滤波(EKF)方法。Shademan等在论文(Sensitivity analysis ofEKF and Iterated EKF for position-based visual servoing)中，主要是采用了迭代卡尔曼滤波(I-EKF)算法并与扩展卡尔曼滤波(EKF)算法进行对比。Ficocelli等在论文(Adaptive filtering for pose estimation in visual servoing)中，利用自适应卡尔曼滤波(A-EKF)算法来实现机器人位姿估计，但是，上述这些方法都没有完全解决RVS位姿估计的效率以及鲁棒性问题。因此，针对基于滚动时域的机器人视觉伺服系统位姿估计方法的研究很有必要。

发明内容

为了克服现有技术无法解决机器人视觉伺服位姿估计问题的不足，本发明提供一种基于滚动时域的机器人视觉伺服位姿估计方法，通过引入滚动时域目标函数来最小化代价函数，并确定最优预测方程的设计方案。

本发明解决其技术问题所采用的技术方案是：

一种基于滚动时域的机器人视觉伺服位姿估计方法，所述方法包括以下步骤：

1)特征点变换；

定义物体相对于相机的相对位姿为W＝[X,Y,Z,φ,α,ψ]^T，相机坐标系中第j个特征点的坐标向量为物体坐标系中第j个特征点的坐标向量为图像平面上第j个特征点的投影坐标为其中，j∈{1,2，…，5}，X，Y，Z表示物体坐标系相对于相机坐标系的相对位置，φ，α，ψ表示滚动，俯仰和偏航参数的相对姿态，则第j个特征点在物体坐标系与相机坐标系之间关系为

其中，

根据投影定律，特征点在图像平面上的投影坐标与的变换关系为

其中，P_X和P_Y分别为图像平面Xⁱ和Yⁱ轴上的像素间隔，F为焦距；