[发明专利]一种基于视觉传感器的舞台机器人预测控制方法

说明书

一种基于视觉传感器的舞台机器人预测跟踪控制方法,包括以下步骤：1)建立舞台机器人运动学模型；2)采用基于图像的视觉伺服方法建立舞台机器人误差模型；3)考虑系统的不确定性，执行器饱和和数据异常问题，将系统转化为具有丢包和执行器饱和的不确定系统；4)定义性能指标函数并根据误差模型，确定预测方程；5)结合预测方程，设计稳定化状态反馈控制器。本发明提供了一种可以有效解决具数据丢失问题和具有输入约束的舞台机器人视觉伺服轨迹跟踪控制方法。

技术领域

本发明涉及舞台机器人的轨迹跟踪技术领域，具体涉及一种基于视觉传感器的舞台机器人预测控制方法。

背景技术

随着科学技术和控制技术的发展，计算机视觉在各个领域已有广泛的运用，视觉数据信息量丰富，处理手段丰富等特点使得基于视觉的移动机器人控制被广泛应用于娱乐、科研、军事、工业以及物流等领域。轨迹跟踪作为移动机器人运动控制中的基本问题之一，一直备受广泛关注。因此，针对基于视觉的移动机器人轨迹跟踪控制技术的研究，不仅可以丰富移动机器人运动控制的理论成果，还可以满足多领域对运动控制技术越来越高的要求，具有重大的理论和工程意义。

由于视觉伺服系统在采集舞台机器人位置信息时，需要在舞台机器人上做标记点。然而，在舞台机器人的运动过程中，车身晃动、地面不平以及光照不均匀都会影响摄像机的图像采集，甚至无效采集即连续一段的空采样，从而导致测量数据无法使用，需要主动丢弃这类异常数据包。另一方面，舞台环境较为复杂，由于无线网络的不可靠性，在数据传输过程中存在数据包丢失现象。同时，舞台机器人通过电机差速驱动，其控制输入为线速度和角速度。受电机最大转速的限制，使得舞台机器人的实际线速度和角速度具有饱和现象。因此，舞台机器人在实现轨迹跟踪的过程中有必要考虑数据包丢失和执行器饱和现象对跟踪精度的影响。

发明内容

为了克服现有技术无法解决舞台机器人视觉伺服轨迹跟踪预测控制中数据丢失和执行器饱和的不足，本发明针对舞台机器人数据丢包和执行器饱和问题提供了一种视觉伺服轨迹跟踪预测控制方法，通过将该问题建模为一类具有参数不确定的跟踪误差模型，基于该模型给出了相应的性能指标，同时也提供了反馈控制器增益的求解方法。

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

一种基于视觉传感器的舞台机器人预测控制方法，包括以下步骤：

1)建立舞台机器人运动学模型；

定义[x y θ]^T为舞台机器人在世界坐标系下的横、纵坐标以及机器人的方向角，则非完整性舞台机器人运动学模型为

其中，v为舞台机器人的线速度，w为舞台机器人的角速度；

2)将摄像头固定在悬架上，采用基于图像的视觉伺服方法建立舞台机器人误差模型；

其中，(x_m,y_m)^T为舞台机器人在像素坐标系下的坐标，(x,y)^T为舞台机器人在世界坐标系下的坐标，d是依赖摄像头深度信息的常数，θ₀为相机轴Y_t和世界坐标系轴X_w之间的夹角且θ₀为可测的，旋转矩阵为摄像机的光学中心在世界坐标系下的投影坐标；

定义如下图像坐标系下跟踪误差

结合式(1)和(2)并对式(3)求导得

对式(4)在平衡点线性化得误差模型