[发明专利]一种移动机器人视觉伺服保性能跟踪控制方法

摘要

一种移动机器人视觉伺服保性能跟踪控制方法，包括以下步骤：1)考虑输入约束，将移动机器人视觉伺服跟踪控制问题建模成一类具有参数不确定的跟踪误差状态空间模型；2)设计保性能指标函数；3)基于保性能控制算法设计路径跟踪控制器；4)定义输入约束；5)设计保性能跟踪控制器。本发明提供了一种可以有效解决具有输入约束的移动机器人视觉伺服保性能路径跟踪控制方法。

主权项

1.一种移动机器人视觉伺服保性能控制方法，其特征在于，所述方法包括以下步骤：1)建立基于视觉的移动机器人模型，定义x和y为归一化后的相机横纵坐标，z_c为相机在z轴的坐标，相机在相机坐标系下的速度矢量为v_c和ω_c分别为移动机器人的在z轴线速度和x‑z平面角速度，机器人在自身坐标系下的速度矢量为v_r和ω_r分别为移动机器人的参考在z轴线速度和x‑z平面角速度，则基于视觉的移动机器人运动学模型为：2)建立跟踪误差模型，定义ρ1和ρ2代表特征点在像素坐标系下的实时位置定义yc是摄像机原点与特征点的高度差，对式(2)求导得定义(u^*,v^*)是特征点在像素坐标系的期望坐标，则特征点的期望值定义机器人的实时角度为θ，目标角度值为θ^*，定义e₁为对应ρ₁的像素误差和e₂为对应ρ₂的像素误差，e_θ为角度误差，误差信号表示为eθ＝θ‑θ*                       (4)把式(3)代入(5)中得将式(6)进行利用采样周期T的一阶泰勒级数展开法离散化得：e(k+1)＝A(ω(k))e(k)+Bu(k)                 (7)其中，k表示第k个采样周期，和u(k)＝v_c(k)是系统的输入；定义角速度更新规则为ωc(k+1)＝0.6ωc(k)+0.2e‑0.01kT              (8)由于ωc(k)是有界时变参数，将系统转化为参数不确定模型处理有界时变参数：其中，e₀表示初始误差；ΔA为不确定矩阵，用以表示系统中的参数不确定性；上述系统的不确定性具有范数有界性质，能将其表示为：ΔA＝DF(t)E其中，是一个时变参数矩阵，用来表示系统中的不确定信息且满足3)定义保性能指标函数其中，Q和R表示权重矩阵；定义李雅普诺夫函数V(e(k))＝eT(k)Pe(k)，则ΔV(k)＝eT(k+1)Pe(k+1)‑eT(k)Pe(k)≤‑[eT(k)Qe(k)+uT(k)Ru(k)]    (11)其中P是2维对称正定矩阵，即：eT(k)Qe(k)+uT(k)Ru(k)≤‑ΔV(k)              (12)对(12)两边求和，并利用闭环系统的渐近稳定性，得即：根据李雅普诺夫渐近稳定性理论可知，最小化V(e(k))等价于s.t.J≤eT(0)Pe(0)≤γ4)定义输入约束||u(k)||2≤umax                      (13)其中，umax表示输入的最大值，利用线性矩阵不等式方法将式(13)转化为以下不等式5)设计保性能跟踪控制器利用李雅普诺夫稳定性理论及线性矩阵不等式方法得到保证移动机器人移动到期望位置的充分条件：通过Matlab中的LMI工具箱求解得W,X，进一步得移动机器人跟踪问题反馈控制器的解为u(k)＝K(k)e(k)，其中，K＝WX‑1。