Processing math: 0%

欠驱动无人船单目视觉伺服镇定控制

何红坤, 王宁

何红坤, 王宁. 欠驱动无人船单目视觉伺服镇定控制[J]. 中国舰船研究, 2022, 17(5): 166–174, 183. DOI: 10.19693/j.issn.1673-3185.02853
引用本文: 何红坤, 王宁. 欠驱动无人船单目视觉伺服镇定控制[J]. 中国舰船研究, 2022, 17(5): 166–174, 183. DOI: 10.19693/j.issn.1673-3185.02853
HE H K, WANG N. Monocular visual servo-based stabilization control of underactuated unmanned surface vehicle[J]. Chinese Journal of Ship Research, 2022, 17(5): 166–174, 183. DOI: 10.19693/j.issn.1673-3185.02853
Citation: HE H K, WANG N. Monocular visual servo-based stabilization control of underactuated unmanned surface vehicle[J]. Chinese Journal of Ship Research, 2022, 17(5): 166–174, 183. DOI: 10.19693/j.issn.1673-3185.02853
何红坤, 王宁. 欠驱动无人船单目视觉伺服镇定控制[J]. 中国舰船研究, 2022, 17(5): 166–174, 183. CSTR: 32390.14.j.issn.1673-3185.02853
引用本文: 何红坤, 王宁. 欠驱动无人船单目视觉伺服镇定控制[J]. 中国舰船研究, 2022, 17(5): 166–174, 183. CSTR: 32390.14.j.issn.1673-3185.02853
HE H K, WANG N. Monocular visual servo-based stabilization control of underactuated unmanned surface vehicle[J]. Chinese Journal of Ship Research, 2022, 17(5): 166–174, 183. CSTR: 32390.14.j.issn.1673-3185.02853
Citation: HE H K, WANG N. Monocular visual servo-based stabilization control of underactuated unmanned surface vehicle[J]. Chinese Journal of Ship Research, 2022, 17(5): 166–174, 183. CSTR: 32390.14.j.issn.1673-3185.02853

欠驱动无人船单目视觉伺服镇定控制

基金项目: 国家自然科学基金资助项目(52271306);船舶总体性能创新研究开放基金资助项目(31422120)
详细信息
    作者简介:

    何红坤,男,1988年生,博士生。研究方向:无人船视觉伺服控制。E-mail: hehongkun4@163.com

    王宁,男,1983 年生,博士,教授,博士生导师。研究方向:海洋机器人、无人船和自主系统的智能控制。 E-mail:n.wang@ieee.org

    通讯作者:

    王宁

  • 中图分类号: U664.82

Monocular visual servo-based stabilization control of underactuated unmanned surface vehicle

知识共享许可协议
欠驱动无人船单目视觉伺服镇定控制何红坤,采用知识共享署名4.0国际许可协议进行许可。
  • 摘要:
      目的  针对全球定位系统拒止环境下的欠驱动无人船(USV)精准位姿镇定问题,提出一种基于单应性的欠驱动无人船单目视觉伺服镇定控制方法。
      方法  借助单应性分解技术,直接从当前图像和期望图像中重构出具有未知尺度因子的位姿误差,可完全摆脱相机外部参数标定和目标物先验信息;针对欠驱动约束,在连续时变输出反馈控制器中引入基于持续激励艏摇角的周期函数,使得欠驱动无人船能够在图像深度、运动速度、模型参数均未知的情况下实现镇定控制。
      结果  在李雅普诺夫理论框架下,采用芭芭拉引理严格证明了欠驱动无人船视觉伺服闭环控制系统的渐近稳定性。
      结论  仅采用船载单目相机,所提出的视觉伺服策略能够确保欠驱动无人船实现精准位姿镇定,为海上接驳对接、靠离泊、动力定位等实际需求提供重要技术支撑。
    Abstract:
      Objectives  Aiming at the accurate posture stabilization problem of an under-actuated unmanned surface vehicle (USV) in GPS-denied environments, a monocular visual servo stabilization control scheme is proposed based on homography.
      Methods  By virtue of the homography decomposition technique, posture errors with an unknown scale factor are directly reconstructed from current and desired images, which thoroughly removes the calibration of extrinsic camera parameters and priori information on visual targets; with respect to the under-actuation constraint, a periodic function to persistently excite the yaw angle is incorporated into the continuous time-variant output feedback controller, allowing the USV to be stabilized in the absence of image depth, movement velocities and model parameters.
      Results  Under the framework of the Lyapunov theory, the closed-loop visual servo system of the USV is rigorously proven to be asymptotically stable by Barbalat lemma.
      Conclusions  By installing an onboard monocular camera, USV posture errors can be precisely stabilized with the aid of the proposed visual servo strategy, providing significant technique support for practical applications including docking, berthing, dynamic positioning, etc.
  • 随着经济社会发展,人类水上活动日益频繁。无人船(USV)作为轻量化的水面机器人,可以将人类从重复和危险的作业任务中解脱出来,因而受到了各国研究者的广泛关注[1-4]。值得注意的是,运动控制是实现无人船自主作业的核心技术,其中镇定控制是无人船运动控制的基本问题,在入坞、靠离泊、接驳对接、动力定位等领域中具有巨大的应用价值和市场前景。

    为了减少重量和降低成本,无人船往往在船艉布置两个推进器或单桨单舵,但只能提供纵荡推力和艏摇力矩。实际上,这种动力配置方式为无人船镇定控制器设计带来很大困难。主要原因是无人船的欠驱动属性,即利用两个控制输入同时镇定无人船的3个运动状态,包括平面位置和艏摇角度。对于欠驱动无人船镇定系统,由于受到不可积的二阶非完整约束,不存在任何连续不时变的反馈控制律,使该系统在李雅普诺夫意义下渐近稳定[5]。此外,欠驱动无人船镇定系统具有高度的非线性,不能转换成积分链形式,使得标准的链式系统控制方法不能直接应用[6]。为解决欠驱动无人船镇定控制问题,各国学者相继提出了非连续时不变和连续时变控制器设计方法。在非连续时不变控制器设计方面,Reyhanoglu[7]提出σ变换法,在艏摇角误差不为0的前提下设计不连续的坐标变换,并在运动学上设计降阶系统控制输入,最终构造了时不变的非连续反馈控制律,保证了位姿误差以指数收敛速率渐近稳定;Ghommam等[8]提出了级联控制法,采用微分同胚坐标变换将无人船系统转化为级联形式,原问题由此简化为一个三阶链式系统的镇定控制问题,在艏摇角误差不为0的前提下,推导了时不变的非连续反馈控制律,保证系统全局一致渐近稳定。在连续时变控制器设计方面,Pettersen等[9]提出齐次法,采用坐标变换方法在附体坐标系下表示无人船镇定系统的动态,设计了具有周期震荡性能的时变反馈控制律,利用齐次度和平均理论证明了闭环系统指数收敛;Mazenc等[10]提出反步设计法,通过坐标变换巧妙地建立了等价的被控系统,在光滑时变的状态反馈控制器中引入周期函数,使得欠驱动无人船镇定系统在李雅普诺夫意义下全局一致渐近稳定;在级联控制框架下,Dong等[11]利用反步法设计了全局光滑时变控制律,使得闭环系统状态渐近收敛到原点。董早鹏等[12]提出了极坐标系下分块反步控制法,利用已知的侧滑角将无人船直角坐标系下的欠驱动镇定控制问题转化为极坐标系下的全驱动镇定控制问题,降低了控制器的设计难度。

    尽管欠驱动无人船镇定控制研究已经取得了丰硕的理论成果,但多数文献均假设无人船的位置是精确已知的。实际上,无人船常采用GPS装置来测量位置,甚至测量运动速度,一般定位精度只有米量级[13]。另外,在港口、河道等高大建筑或树木遮挡水域,GPS存在着信号衰减和丢失的问题,使得以上控制算法在该场景下不能使用。随着人工智能技术快速发展和计算机运算能力的飞速提升,视觉伺服方法依赖于光学相机的高精度定位能力,在无人船运动控制中展现出显著的优越性[14]。相较于双目视觉伺服和多目视觉伺服,单目视觉伺服处理的图像更少,更能满足伺服过程对计算实时性的要求。目前,单目视觉伺服多应用于无人船对接和靠离泊任务中。在国外,Martins等[15]假设黄色潜航器漂浮于水面,在单目相机内、外部参数均标定的条件下解算无人船与潜航器的相对位置和方向,根据二者之间的距离设计了事件触发控制策略,通过比例微分状态反馈控制两个螺旋桨转速,依次完成接近、对齐和对接任务;Dunbabin等[16]利用标定的单目相机高度和倾斜角定位水面目标物的位置,根据相对距离产生虚拟的吸引和排斥力,将它们的合力方向设定为无人船的期望艏摇角度,利用比例控制器调节两个螺旋桨的输出推力,改变无人船的位置和姿态,实现无人船与水面目标物的对接;Kim等[17]在距离较近时采用单目视觉确定目标物的位置和姿态,利用伪逆技术和强化学习方法分别设计了比例控制器和无模型控制策略,伺服控制无人船与水面机器人对接。在国内,徐海彬等[18]利用检测网络识别悬浮托架,根据其投影图像和相机内部参数计算无人船偏转角,在油门恒定的情况下,融合偏转角的比例微分信号设计了舵角S面控制器,通过实时控制舵角,使无人船不断靠近托架,直至完成对接任务;张山甲等[19]以红色矩形面作为单目相机识别标志物,利用当前图像、期望图像、相机内部参数和标志物标定高度计算无人船航向偏差角及偏航距离,并以此为控制变量设计了比例微分控制器,调节艉部两个推进电机电压,改变无人船纵荡速度和艏摇角速率,使欠驱动无人船沿着叠标线靠近泊位。由于利用了二维图像恢复三维空间信息是个欠约束问题,因此,以上单目视觉伺服方法在相对定位时需要提前标定相机外部参数或已知目标物模型信息。为便于实际应用,Wang等[20-22]在单目相机外部参数未标定的条件下,采用基于单应性的伺服策略,系统开展了全驱动无人船视觉伺服镇定控制研究。在文献[20]中,利用当前图像和期望图像直接获取具有尺度因子的无人船位姿误差,首次建立了基于单应性的无人船单目视觉伺服框架,采用参数自适应方法估计未知的图像深度,实现了无人船镇定系统渐近稳定。在文献[21]中,针对图像深度、无人船模型参数、外界扰动未知问题,采用单隐层神经网络辨识系统未知非线性,提出了基于极速学习的视觉伺服方法,通过李雅普诺夫函数设计控制器和自适应律,使得全驱动无人船位姿误差一致有界。进一步考虑到GPS拒止环境下无人船运动速度难以测量问题,文献[22]通过有限时间观测器恢复系统状态,形成了输出反馈的视觉伺服策略,只利用船载单目相机实现全驱动无人船镇定系统渐近稳定。

    受到以上文献启发,本文将开展欠驱动无人船单目视觉伺服镇定控制研究,仅依赖一只“眼睛”,实现欠驱动无人船渐渐靠近期望位姿。首先,采用单应性分解技术从当前图像和期望图像中直接重构无人船位姿误差,不需要提前标定相机外部参数或已知目标物模型信息。与采用GPS的控制系统不同的是,单应性分解技术必然导致未知的图像深度出现在无人船运动学子系统中,造成规避欠驱动约束的坐标变换方法[7-11]不再适用。其次,考虑到无人船运动速度和模型参数难以精确获取的实际问题,设计连续时变输出反馈控制器,克服不可积的二阶非完整约束,同时不依赖于速度状态和模型参数。然后,在李雅普诺夫理论框架下,利用芭芭拉引理严格证明闭环伺服控制系统的稳定性。最后,仿真实验验证该视觉伺服策略的有效性。本文提出的单目视觉伺服控制方案能够在图像深度、运动速度、模型参数均未知的条件下,实现欠驱动无人船镇定控制系统渐近稳定。这项研究工作可以扩大欠驱动无人船在GPS拒止场景下的应用、丰富欠驱动无人船镇定控制理论、提高欠驱动无人船的自主性和智能性。

    为了便于阅读,本文涉及的关键引理,如矩阵正定性判别方法、赫尔维茨判据、芭芭拉引理集中陈述如下。

    引理 1[23]:设矩阵{\boldsymbol{A}} \in {{\mathbf{R}}^{n \times n}}{\boldsymbol{A}} = {{\boldsymbol{A}}^{\text{T}}},其中,R表示实数集。若{\boldsymbol{A}} 的各阶顺序主子式 {\Delta _i} > 0 i= 1,\cdots , n ),则{\boldsymbol{A}} 正定。

    引理 2[24]:设二阶线性定常系统\dot {\boldsymbol{x}} = {\boldsymbol{Ax}}的特征多项式为{a_2}{s^2} + {a_1}s + {a_0} = 0。若 {a_i} > 0 i=0,1,2 ),则有一个正定矩阵 {\boldsymbol{P}} \in {{\mathbf{R}}^{2 \times 2}} 使李雅普诺夫方程 {{\boldsymbol{A}}^{\text{T}}}{\boldsymbol{P}} + {\boldsymbol{PA}} = - {\boldsymbol{I}} 有唯一解,单位矩阵 {\boldsymbol{I}} \in {{\mathbf{R}}^{2 \times 2}}

    引理 3[25]:设函数\varphi : [0,\infty ) \to {\mathbf{R}}平方可积,即\mathop {\lim }\limits_{t \to \infty } {\mkern 1mu}\displaystyle \int_0^t {{\varphi ^2}(s){\text{d}}s} < \infty 。若\dot \varphi (t)存在且有界,则\mathop {\lim }\limits_{t \to \infty } {\mkern 1mu} \varphi (t) = 0

    引理 4[26]:若函数\varphi : [0,\infty ) \to {\mathbf{R}} 一致连续,若\mathop {\lim }\limits_{t \to \infty } {\mkern 1mu} \displaystyle\int_0^t {\varphi (s){\text{d}}s} 存在且有界,则\mathop {\lim }\limits_{t \to \infty } \varphi (t) = 0

    对于欠驱动无人船在水面上完成靠离泊、对接、动力定位等操纵任务,可以将它们抽象为由当前位姿到期望位姿的镇定控制问题,其运动学和动力学数学模型可描述为[6-11]

    \left\{ \begin{aligned} &\dot {\boldsymbol{\eta}} {{ = }}{\boldsymbol{R}}{{(}}\psi {{)}}{\boldsymbol{\nu}} \\ & { {\boldsymbol{M}}}\dot {\boldsymbol{\nu}} = - {\boldsymbol{C}}({\boldsymbol{\nu}} ){\boldsymbol{\nu}} - {\boldsymbol{D}}({\boldsymbol{\nu}} ){\boldsymbol{\nu}} {{ + }}{\boldsymbol{\tau}} \\ \end{aligned} \right. (1)

    其中,

    {\boldsymbol{C}}({\boldsymbol{\nu}} ){{ = }}\left[ {\begin{array}{*{20}{c}} \begin{gathered} 0 \\ 0 \\ {m_{22}}v \\ \end{gathered} &\begin{gathered} 0 \\ 0 \\ - {m_{11}}u \\ \end{gathered} &\begin{gathered} - {m_{22}}v \\ {m_{11}}u \\ 0 \\ \end{gathered} \end{array}} \right]
    {\boldsymbol{R}}{{(}} * {{) = }}\left[ {\begin{array}{*{20}{c}} \begin{gathered} \cos ( * ) \\ \sin ( * ) \\ 0 \\ \end{gathered} &\begin{gathered} - \sin ( * ) \\ \cos ( * ) \\ 0 \\ \end{gathered} &\begin{gathered} 0 \\ 0 \\ 1 \\ \end{gathered} \end{array}} \right]

    式中: {\boldsymbol{\eta}} ={[x,y,\psi ]}^{\text{T}} ,为当前位姿向量,包括无人船在惯性坐标系下的位置 (x,y) 和艏摇角\psi ,位置变量单位为m,姿态变量单位为rad;{\boldsymbol{\nu}} ={[u,v,r]}^{{\rm{T}}},为速度向量,表示无人船在附体坐标系下的纵/横荡速度 (u,v) 和艏摇角速率 r ,线速度单位为{\text{m/s}},角速度单位为{\kern 1pt} {\text{rad/s}} {\boldsymbol{\tau}} ={[{\tau }_{u},0,{\tau }_{r}]}^{\text{T}} ,为系统控制输入向量,输入力单位为 {\text{N}} ,输入力矩单位为 {\text{N}} \cdot {\text{m}} {\boldsymbol M}=\text{diag}({m}_{11},{m}_{22},{m}_{33}) > 0 {\boldsymbol{D}}({\boldsymbol{\nu}} )=\text{diag}\left({d}_{11},{d}_{22},\right. \left.{d}_{33}\right) > 0分别为惯性质量矩阵和系统阻尼矩阵;{\boldsymbol{C}}({\boldsymbol{\nu}} )为科里奥利向心矩阵;{\boldsymbol{R}}( * ) 为关于姿态变量“ * ”的旋转矩阵函数。

    为了调节无人船由当前位姿到达期望位姿,定义位姿误差向量 {\boldsymbol{e}} = {{\boldsymbol{R}}^{\text{T}}}(\psi )({{\boldsymbol{\eta}} _{\text{d}}} -{\boldsymbol{ \eta }}) 。结合式(1),对 {\boldsymbol{e}} 求导,得到镇定误差动态如下:

    \left\{ \begin{aligned} &{{\dot e}_1} = - u + {e_2}r \\ &{{\dot e}_2} = - v - {e_1}r \\ &{{\dot e}_3} = - r \\ \end{aligned} \right. (2)

    式中: {\boldsymbol{e}}:={[{e}_{1},{e}_{2},{e}_{3}]}^{\text{T}} {{\boldsymbol{\eta}} }_{\text{d}}={[{x}_{\text{d}},{y}_{\text{d}},{\psi }_{\text{d}}]}^{\text{T}} ,为恒定的期望位姿向量。

    在GPS拒止环境下,无人船的当前位置 (x,y) 和期望位置 ({x}_{\text{d}},{y}_{\text{d}}) 是难以获得的。为此,将一个单目相机安装在无人船上,如图1 (a)所示,用来感知周围环境并实现相对定位。另外,在目标平面上布置一系列特征点(图1 (a)中的红色发光二极管),以此形成基于单应性的无人船单目视觉伺服镇定控制任务场景。

    图  1  欠驱动无人船单目视觉伺服系统
    Figure  1.  The monocular visual-servo system of underactuated USV

    为了便于接下来描述各参数的含义,按照右手定则建立与图1 (a)相对应的三维坐标系,如图1 (b)所示,包括地球惯性坐标系E-XYZ、无人船附体坐标系B-{X^{{b}}}{Y^{{b}}}{Z^{{b}}}和相机坐标系C-{X^{{c}}}{Y^{{c}}}{Z^{{c}}},其中原点 C 为相机光心,光轴{X^{{c}}}朝向船艏正前方;B-{X^{{b}}}{Y^{{b}}}{Z^{b}}位于C-{X^{{c}}}{Y^{{c}}}{Z^{{c}}}正下方,且与之保持固定的平行关系;与惯例相同,E-XYZ选择为北东下坐标系。另外,O-{X^o}{Y^o}为二维图像坐标系,原点 O 位于图像左上角, {X^o} 轴水平向右, {Y^o} 轴垂直向下。相应地,{B_{\rm{d}}}-{X^{\rm{d}}}{Y^{\rm{d}}}{Z^{\rm{d}}}{C_{\rm{r}}}-{X^{{c_{\rm{r}}}}}{Y^{{c_{\rm{r}}}}}{Z^{{c_{\rm{r}}}}}{O_{\rm{r}}}-{X^{{o_{\rm{r}}}}}{Y^{{o_{\rm{r}}}}}分别为无人船、相机和图像在期望位姿下的坐标系。

    E-XYZ下,特征点的三维坐标采用{{\boldsymbol{p}}_i}表示,其中下标 i 表示第 i 个特征点。作为参考信号,一张包含特征点的期望图像由单目相机在{C_{\rm{r}}}-{X^{{c_{\rm{r}}}}}{Y^{{c_{\rm{r}}}}}{Z^{{c_{\rm{r}}}}}下提前拍摄得到。对应地,实际信号由当前图像表示,可在C-{X^c}{Y^c}{Z^c}下实时获取。根据相机小孔成像模型[20],有

    {\boldsymbol{p}}_i^o = \frac{1}{{x_i^c}}{{\boldsymbol{T}}_c}{\boldsymbol{p}}_i^c ,\; {\boldsymbol{p}}_i^{{o_{\rm{r}}}} = \frac{1}{{x_i^{{c_{\rm{r}}}}}}{{\boldsymbol{T}}_c}{\boldsymbol{p}}_i^{{c_{\rm{r}}}} (3)

    其中,

    {{\boldsymbol{T}}_c} = \left[ {\begin{array}{*{20}{c}} \begin{gathered} x_c^o \\ y_c^o \\ 1 \\ \end{gathered} &\begin{gathered} {a_x} \\ 0 \\ 0 \\ \end{gathered} &\begin{gathered} 0 \\ {a_y} \\ 0 \\ \end{gathered} \end{array}} \right]

    式中: {{\boldsymbol{p}}}_{i}^{o}={[{x}_{i}^{o},{y}_{i}^{o},1]}^{\text{T}} {{\boldsymbol{p}}}_{i}^{{o}_{{\rm{r}}}}={[{x}_{i}^{{o}_{\rm{{r}}}},{y}_{i}^{{o}_{\rm{{r}}}},1]}^{\text{T}}分别表示{{\boldsymbol{p}}_i}O-{X^o}{Y^o}{O_{\rm{r}}}-{X^{{o_{\rm{r}}}}}{Y^{{o_{\rm{r}}}}}坐标系下的齐次投影坐标,单位为像素,可通过目标识别算法获得[27]{{\boldsymbol{p}}}_{i}^{c}={[{x}_{i}^{c},{y}_{i}^{c},{{\textit{z}}}_{i}^{c}]}^{{\rm{T}}}{{\boldsymbol{p}}}_{i}^{{c}_{\rm{{r}}}}={[{x}_{i}^{{c}_{\rm{{r}}}},{y}_{i}^{{c}_{\rm{{r}}}},{{\textit{z}}}_{i}^{{c}_{\rm{{r}}}}]}^{{\rm{T}}}分别为{{\boldsymbol{p}}_i}C-{X^c}{Y^c}{Z^c}{C_{\rm{r}}}-{X^{{c_{\rm{r}}}}}{Y^{{c_{\rm{r}}}}}{Z^{{c_{\rm{r}}}}}坐标系下的位置坐标;{{\boldsymbol{T}}_c} 为标定的相机内部参数矩阵[28] ({x}_{c}^{o},{y}_{c}^{o}) 为图像主点坐标;{a_x}{a_y}为对应方向上的焦距长度。

    实际上, {\boldsymbol{p}}_i^c {\boldsymbol{p}}_i^{{c_{\rm{r}}}}{{\boldsymbol{p}}_i}分别有如下坐标变换关系:

    {\boldsymbol{p}}_i^{\rm{c}} = {{\boldsymbol{R}}^{\text{T}}}(\psi )({{\boldsymbol{p}}_i} - {{\boldsymbol{p}}_c}) ,\; {\boldsymbol{p}}_i^{{c_{\rm{r}}}} = {{\boldsymbol{R}}^{\text{T}}}({\psi _{\rm{r}}})({{\boldsymbol{p}}_i} - {{\boldsymbol{p}}_{{c_{\rm{r}}}}}) (4)

    式中:{{\boldsymbol{p}}}_{c}={[x,y,-{h}_{\rm{c}}]}^{{\rm{T}}}{{\boldsymbol{p}}}_{{c}_{\rm{r}}}={[{x}_{\rm{r}},{y}_{\rm{r}},-{h}_{\rm{c}}]}^{{\rm{T}}}分别为光心 C {C_{\rm{r}}}E-XYZ坐标系下的位置坐标; {h_{\rm{c}}}为相机高度。另外,根据对极几何原理[21] {\boldsymbol{p}}_i^o {\boldsymbol{p}}_i^{{o_{\rm{r}}}}又有如下投影关系:

    {\boldsymbol{p}}_i^o = {{\boldsymbol{T}}_c}{\boldsymbol{HT}}_c^{ - 1}{\boldsymbol{p}}_i^{{o_{\rm{r}}}} (5)

    式中: {\boldsymbol{H}} \in {{\mathbf{R}}^{3 \times 3}} ,为欧几里得单应性矩阵,当 i \geqslant 3 时, {\boldsymbol{H}} 可以通过解算式(5)得到[29]

    将式(3)~式(5)相结合,可得

    {{\boldsymbol{p}}_i} - {{\boldsymbol{p}}_c} = \frac{{x_i^c}}{{x_i^{{c_{\rm{r}}}}}}{\boldsymbol{R}}(\psi ){\boldsymbol{H}}{{\boldsymbol{R}}^{\text{T}}}({\psi _{\rm{r}}})({{\boldsymbol{p}}_i} - {{\boldsymbol{p}}_{{c_{\rm{r}}}}}) (6)

    故,单应性矩阵{\boldsymbol{ H}} 可表示为

    {\boldsymbol{H}} = \frac{{x_i^{{c_{\rm{r}}}}}}{{x_i^c}}({\boldsymbol{R}}({e_3}) + \frac{{{\boldsymbol{t}}_{{c_{\rm{r}}}}^c}}{d}{\boldsymbol{n}}_{\rm{r}}^{\text{T}}) (7)

    式中:{\boldsymbol{t}}_{{c_{\rm{r}}}}^c = {{\boldsymbol{R}}^{\text{T}}}(\psi )({{\boldsymbol{p}}_{{c_{\rm{r}}}}} - {{\boldsymbol{p}}_c}) ,为相机平移向量 {[{e}_{1},{e}_{2},0]}^{\text{T}} d = {\boldsymbol{n}}_{\rm{r}}^{\text{T}}{{\boldsymbol{R}}^{\text{T}}}({\psi _{\rm{r}}})({{\boldsymbol{p}}_i} - {{\boldsymbol{p}}_{{c_{\rm{r}}}}}) > 0 ,为{C_{\rm{r}}}到目标平面的垂直距离,即固有未知的图像深度;{{\boldsymbol{n}}_{\rm{r}}} \in {{\mathbf{R}}^3} ,为{C_{\rm{r}}}-{X^{{c_{\rm{r}}}}}{Y^{{c_{\rm{r}}}}}{Z^{{c_{\rm{r}}}}}坐标系下目标平面的单位法向量。

    显然,单应性矩阵{\boldsymbol{ H}} 暗含有无人船镇定控制误差信息{\boldsymbol{e}}。利用单应性分解技术[30]分解矩阵{\boldsymbol{H}},可直接得到具有尺度因子的平移误差 ({e}_{x},{e}_{y}) 和旋转误差 {e_\psi } ,即

    {e_x} = \frac{{{e_1}}}{d} \text{,} {e_y} = \frac{{{e_2}}}{d} \text{,} {e_\psi } = {e_3} (8)

    因此,沿着式(1),式(2)和式(8)对可用误差 {e_x} {e_y} {e_\psi } 求导,得到如式(9)所示的欠驱动无人船单目视觉伺服镇定控制系统。

    \left\{ \begin{aligned} &d{{\dot e}_x} = - u + d{e_y}r \\ &d{{\dot e}_y} = - v - d{e_x}r \\ &{{\dot e}_\psi } = - r \\ &{m_{11}}\dot u = {m_{22}}vr - {d_{11}}u + {\tau _u} \\ &{m_{22}}\dot v = - {m_{11}}ur - {d_{22}}v \\ &{m_{33}}\dot r = ({m_{11}} - {m_{22}})uv - {d_{33}}r + {\tau _r} \\ \end{aligned} \right. (9)

    为了实现无人船单目视觉伺服镇定控制,本文作出如下假设。

    假设 1:无人船只安装有1个传感器,即广角单目相机,可使特征点始终处于视野之中,故图像深度 d 和运动速度 (u,v,r) 是未知的。

    假设 2:无人船运动特性可由经典的数学模型式(1)表示,即内部未建模的动态和外部扰动可忽略不计,其中无人船动力学模型参数 ({m}_{11}, {m}_{22}, {m}_{33}) ({d}_{11},{d}_{22},{d}_{33}) 是未经辨识的。

    控制目标:在满足假设 1和假设 2的条件下,仅利用单目相机测量信息 ({e}_{x},{e}_{y},{e}_{\psi }) ,为无人船运动系统式(1)设计控制律 {\tau _u} {\tau _r} ,使无人船的位姿误差 ({e}_{1},{e}_{2},{e}_{3}) 和运动速度 (u,v,r) 渐近稳定,从而实现欠驱动无人船镇定控制,即当t \to \infty 时,{\boldsymbol{\eta}} \to {{\boldsymbol{\eta}} _{\text{d}}}

    注意,尽管使用激光测距仪、多普勒计程仪和惯性导航单元可以直接测量图像深度 d 和无人船运动速度 (u,v,r) ,但搭载更多传感器必然会增加无人船的能源消耗及制造成本;另外,利用半经验方法、软件包和物理实验等可以辨识无人船惯性参数 ({m}_{11},{m}_{22},{m}_{33}) [31],但这种方式会花费大量人力和物力资源,且阻尼参数 ({d}_{11}, {d}_{22},{d}_{33}) 实际上非常难以或无法精确辨识[32]。因此,本文针对欠驱动无人船单目视觉伺服镇定控制面临的实际问题,给出了合理的假设 1和假设 2。显然,在图像深度、运动速度和模型参数均未知的前提下,无人船单目视觉伺服系统式(9)具有未知的运动学和动力学动态,导致解决欠驱动问题的坐标变换方法[7-11]不能适用。可见,仅利用单目视觉测量信息设计一个稳定的欠驱动无人船动力学控制器渐近镇定位姿误差,具有实际意义和理论挑战。

    除了闭环控制外,无人船单目视觉伺服系统还不可避免地涉及到图像处理、目标辨识、图像匹配、单应性矩阵计算与分解等运算,计算量较大。为了保证整个视觉伺服系统的实时性,本文不采用参数自适应方法[20]在线估计图像深度,也不设计观测器[22]重构无人船运动速度,从而可以降低控制器复杂度,减少运算消耗。图2为单目视觉伺服镇定控制系统框图。

    图  2  单目视觉伺服镇定控制系统框图
    Figure  2.  The block diagram of monocular visual-servo stabilization control system

    在无人船单目视觉伺服镇定控制系统中,首先利用期望图像和当前图像中的投影点{\boldsymbol{ p}}_i^{{o_{\rm{r}}}} {\boldsymbol{p}}_i^o 计算矩阵 {\boldsymbol{H}} ,然后采用单应性分解技术分解该矩阵,直接获得视觉伺服镇定误差 ({e}_{x},{e}_{y},{e}_{\psi }) ,最后在图像深度、运动速度、模型参数均未知的前提下,为了使欠驱动无人船单目视觉伺服系统式(9)渐近稳定,将连续时变输出反馈控制器设计为

    \left\{ \begin{gathered} {\tau _u} = {k_1}{e_x} \\ {\tau _r} = {k_2}{e_\psi } + {k_3}{e_y}\sin ({k_4}t) \\ \end{gathered} \right. (10)

    式中: 0 < {k_1} < \dfrac{{d{d_{11}}{d_{22}}}}{{{m_{11}}}} {k_2} > 0 {k_3} > 0 {k_4} \ne 0 ,均为设计调节参数。

    由式(10)可知,本文设计的输出反馈控制器只有4个调节参数,各具物理意义,便于调节控制性能。直观而言, {k_1} 为反馈增益,决定了控制输入{\tau _u}大小,用于调节纵向误差{e_x}收敛速率;{\tau _r}由姿态误差{e_\psi }和横向误差{e_y} 耦合而成;{k_2}{k_3}为反馈增益。当纵向误差{e_y} 不为0时,时变正弦函数将产生持续激励信号,{k_4}用于调节激励信号周期,以此改变无人船艏摇角,消除纵向误差{e_y},解决无人船的欠驱动问题;当纵向误差{e_y}为0时,{\tau _r}只反馈姿态误差{e_\psi },最终将无人船艏摇角镇定到期望的方向。

    定理1:考虑欠驱动无人船单目视觉伺服系统式(9),选择控制设计参数 0 < {k_1} < \dfrac{{d{d_{11}}{d_{22}}}}{{{m_{11}}}} {k_2} > 0 {k_3} > 0 {k_4} \ne 0 ,本文提出的连续时变输出反馈控制器式(10)能够在图像深度、无人船速度和模型参数均未知的前提下,仅利用船载单目相机测量信息 ({e}_{x},{e}_{y},{e}_{\psi }) 实现无人船位姿误差 ({e}_{1},{e}_{2},{e}_{3}) 和运动速度 (u,v,r) 渐近稳定。

    证明:系统状态 \left({e}_{1},\right. \left. u,{e}_{2},v \right) 一致有界;系统状态 ({e}_{3},r) 一致有界; 系统状态 ({e}_{1},u,{e}_{2},v,{e}_{3},r) 渐近稳定。

    将控制输入式(10)代入无人船单目视觉伺服系统式(9),得到闭环控制系统:

    {\dot e_x} = - \frac{u}{d} + {e_y}r (11)
    \dot u = \frac{{{k_1}{e_x}}}{{{m_{11}}}} - \frac{{{d_{11}}u}}{{{m_{11}}}} + \frac{{{m_{22}}vr}}{{{m_{11}}}} (12)
    {\dot e_y} = - \frac{v}{d} - {e_x}r (13)
    \dot v = - \frac{{{d_{22}}v}}{{{m_{22}}}} - \frac{{{m_{11}}ur}}{{{m_{22}}}} (14)
    {\dot e_\psi } = - r (15)
    \dot r = \frac{{{k_2}{e_\psi }}}{{{m_{33}}}} - \frac{{{d_{33}}r}}{{{m_{33}}}} + \frac{{({m_{11}} - {m_{22}})uv}}{{{m_{33}}}} + \frac{{{k_3}{e_y}\sin ({k_4}t)}}{{{m_{33}}}} (16)

    1)系统状态 ({e}_{1},u,{e}_{2},v) 一致有界。选择两个对称矩阵:

    {{\boldsymbol{P}}_1} = \left[ {\begin{array}{*{20}{c}} \begin{gathered} d \\ - \frac{{{m_{11}}}}{{{d_{22}}}} \\ \end{gathered} &\begin{gathered} - \frac{{{m_{11}}}}{{{d_{22}}}} \\ \frac{{{m_{11}}({d_{11}}{\text{ + }}{d_{22}})}}{{{k_1}{d_{22}}}} \\ \end{gathered} \end{array}} \right] (17)
    {{\boldsymbol{P}}_2} = \left[ {\begin{array}{*{20}{c}} \begin{gathered} d \\ - \frac{{{m_{22}}}}{{{d_{22}}}} \\ \end{gathered} &\begin{gathered} - \frac{{{m_{22}}}}{{{d_{22}}}} \\ \frac{{m_{22}^2({d_{11}}{\text{ + }}{d_{22}})}}{{{k_1}{m_{11}}{d_{22}}}} \\ \end{gathered} \end{array}} \right] (18)

    其中,d > 0。二者的行列式如下:

    \left| {{{\boldsymbol{P}}_1}} \right| = \frac{{{m_{11}}(d{d_{11}}{d_{22}} - {m_{11}}{k_1} + dd_{22}^2)}}{{{k_1}d_{22}^2}} > 0 (19)
    \left| {{{\boldsymbol{P}}_2}} \right| = \frac{{m_{22}^2(d{d_{11}}{d_{22}} - {m_{11}}{k_1} + dd_{22}^2)}}{{{k_1}{m_{11}}d_{22}^2}} > 0 (20)

    由引理 1可知, {{\boldsymbol{P}}_1} {{\boldsymbol{P}}_2} 为正定矩阵。利用 {{\boldsymbol{P}}_1} {{\boldsymbol{P}}_2} 的正定性,构造李雅普诺夫函数如下:

    {V_1} = {\boldsymbol{x}}_1^{\text{T}}{{\boldsymbol{P}}_1}{{\boldsymbol{x}}_1} + {\boldsymbol{x}}_2^{\text{T}}{{\boldsymbol{P}}_2}{{\boldsymbol{x}}_2} (21)

    式中: {{\boldsymbol{x}}}_{1}={[{e}_{x},u]}^{\text{T}} {{\boldsymbol{x}}}_{2}={[{e}_{y},v]}^{\text{T}}

    沿着式(11)~式(14)对 {V_1} 求导,得到

    {\dot V_1} = - \frac{1}{{{d_{22}}}}{\boldsymbol{x}}_1^{\text{T}}{\boldsymbol{Q}}{{\boldsymbol{x}}_1} - a{v^2} (22)

    其中:

    a = \dfrac{{{m_{22}}(d{d_{11}}{d_{22}} - {m_{11}}{k_1} + dd_{22}^2)}}{{{k_1}{m_{11}}d{d_{22}}}} > 0
    {\boldsymbol{Q}} = \left[ {\begin{array}{*{20}{c}} \begin{gathered} {k_1} \\ - {d_{11}} \\ \end{gathered} &\begin{gathered} - {d_{11}} \\ \frac{{d{d_{11}}{d_{22}} - {m_{11}}{k_1} + dd_{22}^2}}{{{k_1}d}} \\ \end{gathered} \end{array}} \right]

    {k_1} > 0

    \left| {\boldsymbol{Q}} \right| = \dfrac{{d{d_{11}}{d_{22}} - {m_{11}}{k_1}}}{d} > 0

    则由引理 1可知, {\boldsymbol{Q}} 为正定矩阵。由式(22)可得 {\dot V_1} \leqslant 0 ,即 {V_1}(t) \leqslant {V_1}(0) 。当初值 {V_1}(0) 有界且系统状态 ({e}_{x},u,{e}_{y},v) 一致有界,即 {e_x} \in {\mathcal{L}_\infty } u \in {\mathcal{L}_\infty } {e_y} \in {\mathcal{L}_\infty } v \in {\mathcal{L}_\infty }。由式(8)可知,系统状态 ({e}_{1},{e}_{2}) 也一致有界。

    2)系统状态 ({e}_{3},r) 一致有界。将系统式(15)和式(16)复写为如下向量形式:

    {\dot {\boldsymbol{x}}_3} = {\boldsymbol{A}}{{\boldsymbol{x}}_3} + {\boldsymbol{b }} (23)

    其中:

    {{\boldsymbol{x}}}_{3}={[{e}_{\psi },r]}^{\text{T}}
    {\boldsymbol{A}}{{ = }}\left[ {\begin{array}{*{20}{c}} \begin{gathered} 0 \\ \frac{{{k_2}}}{{{m_{33}}}} \\ \end{gathered} &\begin{gathered} - 1 \\ - \frac{{{d_{33}}}}{{{m_{33}}}} \\ \end{gathered} \end{array}} \right]
    {\boldsymbol{b}} = \Bigg[ 0, \dfrac{{({m_{11}} - {m_{22}})uv}}{{{m_{33}}}} + \dfrac{{{k_3}{e_y}\sin ({k_4}t)}}{{{m_{33}}}} \Bigg]^{\text{T}}

    式中: {{\boldsymbol{x}}}_{3} 表示系统状态向量;{\boldsymbol{A}}为增益矩阵;{\boldsymbol{b}} 可看作时变扰动。线性定常系统 {\dot {\boldsymbol{x}}_3} = {\boldsymbol{A}}{{\boldsymbol{x}}_3} 的特征多项式为{m_{33}}{s^2} + {d_{33}}s + {k_2} = 0,由引理 2可知,有唯一正定矩阵 {{\boldsymbol{P}}_3} \in {{\mathbf{R}}^{2 \times 2}},使 {{\boldsymbol{A}}^{\text{T}}}{{\boldsymbol{P}}_3} + {{\boldsymbol{P}}_3}{\boldsymbol{A}} = - {\boldsymbol{I}} 成立。

    构造李雅普诺夫函数如下:

    {V_2} = {\boldsymbol{x}}_3^{\text{T}}{{\boldsymbol{P}}_3}{{\boldsymbol{x}}_3} (24)

    沿着式(23)对函数V2求导,得到

    {{\dot V}_2} = - {\boldsymbol{x}}_3^{\text{T}}\left( {{{\boldsymbol{A}}^{\text{T}}}{{\boldsymbol{P}}_3} + {{\boldsymbol{P}}_3}{\boldsymbol{A}}} \right){{\boldsymbol{x}}_3} + {\boldsymbol{x}}_3^{\text{T}}{\boldsymbol{\delta}} =- {\boldsymbol{x}}_3^{\text{T}}{{\boldsymbol{x}}_3} + {\boldsymbol{x}}_3^{\text{T}}{\boldsymbol{\delta}} (25)

    式中, {\boldsymbol{\delta}} = 2{{\boldsymbol{P}}_3}{\boldsymbol{b}} 。由式(22)和式(23)可知,系统状态 ({e}_{y},u,v) 有界,故有一个上界值\bar \delta > 0且满足 \left\| {\boldsymbol{\delta}} \right\| \leqslant \bar \delta

    利用杨氏不等式(26),将式(25)写为式(27)的形式:

    {\boldsymbol{x}}_3^{\rm{T}}{\boldsymbol{\delta }} \leqslant \theta {\left\| {{{\boldsymbol{x}}_3}} \right\|^2} + \frac{{{{\bar \delta }^2}}}{{4\theta }} (26)
    {{\dot V}_2}\leqslant - (1 - \theta ){\left\| {{{\boldsymbol{x}}_3}} \right\|^2} + \frac{{{{\bar \delta }^2}}}{{4\theta }} \leqslant - \frac{{1 - \theta }}{{{\lambda _{\max }}({{\boldsymbol{P}}_3})}}{V_2} + \frac{{{{\bar \delta }^2}}}{{4\theta }} (27)

    式中: \theta \in (0,1) {\lambda _{\max }}({{\boldsymbol{P}}_3}) > 0 ,是正定矩阵 {{\boldsymbol{P}}_3} 的最大特征值。不等式(27)表明,当

    {V_2} > \dfrac{{{\lambda _{\max }}({{\boldsymbol{P}}_3}){{\bar \delta }^2}}}{{4\theta (1 - \theta )}},\;\;{\dot V_2} < 0

    系统状态 ({e}_{\psi },r) 收敛到集合

    {\boldsymbol{\varOmega }} = \Bigg\{ {V_2}\Bigg| {V_2} \leqslant \dfrac{{{\lambda _{\max }}({{\boldsymbol{P}}_3}){{\bar \delta }^2}}}{{4\theta (1 - \theta )}} \Bigg\}

    {e_\psi }{\kern 1pt} \in {\mathcal{L}_\infty }r \in {\mathcal{L}_\infty }。由{e_3} = {e_\psi }可知{e_3}是一致有界的。

    3)系统状态 ({e}_{1},u,{e}_{2},v,{e}_{3},r) 渐近稳定。因系统状态 ({e}_{x},{e}_{y},{e}_{\psi },u,v,r) 一致有界,由式(11)~式(16)可知其导数 \left({\dot{e}}_{x},{\dot{e}}_{y},{\dot{e}}_{\psi }, \dot{u},\dot{v},\dot{r}\right) 也是一致有界的。

    由式(22)可得

    \int_0^\infty {{v^2}(s){\text{d}}s} \leqslant - \frac{1}{a}\int_0^\infty {{{\dot V}_1}(s){\text{d}}s} = \frac{1}{a}\left( {{V_1}(0) - {V_1}(\infty )} \right) (28)

    v \in {\mathcal{L}_2},另\dot v \in {\mathcal{L}_\infty } \Rightarrow v是一致连续的。根据引理 3,有\mathop {\lim }\limits_{t \to \infty } v(t) = 0。同理,根据式(22)不难证明\mathop {\lim }\limits_{t \to \infty } {e_x}(t) = 0\mathop {\lim }\limits_{t \to \infty } u(t) = 0

    结合 {e_\psi } \in {\mathcal{L}_\infty } {\ddot e_\psi } = - \dot r \in {\mathcal{L}_\infty } \Rightarrow {\dot e_\psi } = - r 的一致连续性,根据引理 4,有\mathop {\lim }\limits_{t \to \infty } r(t) = 0

    又因 {\tau _r} = {k_2}{e_\psi } + {k_3}{e_y}\sin ({k_4}t) \in {\mathcal{L}_\infty },且

    \begin{split} & \;\;\;\;\; {{\ddot \tau }_r} = - {k_2}\dot r - \frac{{{k_3}}}{d}\dot v\sin ({k_4}t) - \frac{{{k_3}{k_4}}}{d}v\cos ({k_4}t) - \\ &{k_3}{{\dot e}_x}r\sin ({k_4}t) - {k_3}{e_x}\dot r\sin ({k_4}t) - {k_3}{k_4}{e_x}r\cos ({k_4}t) + \\ &\qquad\qquad{k_3}{k_4}{{\dot e}_y}\cos ({k_4}t) - {k_3}k_4^2\sin ({k_4}t) \\[-12pt] \end{split} (29)

    {\ddot \tau _r} \in {\mathcal{L}_\infty } \Rightarrow {\dot \tau _r} 是一致连续的。根据引理 4,有\mathop {\lim }\limits_{t \to \infty } {\dot \tau _r}(t) = 0。再利用\mathop {\lim }\limits_{t \to \infty } r(t) = 0\mathop {\lim }\limits_{t \to \infty } {\kern 1pt} {\kern 1pt} {\kern 1pt} v(t) = 0{\kern 1pt} \mathop {\lim }\limits_{t \to \infty } {\kern 1pt} {\kern 1pt} {\kern 1pt} {\kern 1pt} {e_x}(t) = 0,以及

    {\dot \tau _r} = - {k_2}r - \frac{{{k_3}}}{d}v\sin ({k_4}t) - {k_3}{e_x}r\sin ({k_4}t) + {k_3}{k_4}{e_y}\cos ({k_4}t) (30)

    可直接得到\mathop {\lim }\limits_{t \to \infty } {e_y}(t) = 0。因r \in {\mathcal{L}_\infty }

    \ddot r = - \frac{{{d_{33}}\dot r}}{{{m_{33}}}} + \frac{{({m_{11}} - {m_{22}})\dot uv}}{{{m_{33}}}} + \frac{{({m_{11}} - {m_{22}})u\dot v}}{{{m_{33}}}} + {\dot \tau _r} (31)

    \ddot r \in {\mathcal{L}_\infty } \Rightarrow \dot r 是一致连续的。根据引理 4可证明\mathop {\lim }\limits_{t \to \infty } \dot r(t) = 0。因\mathop {\lim }\limits_{t \to \infty } r(t) = 0\mathop {\lim }\limits_{t \to \infty } u(t) = 0\mathop {\lim }\limits_{t \to \infty } v(t) = 0\mathop {\lim }\limits_{t \to \infty } {e_y}(t) = 0,根据式(16)可最终证明\mathop {\lim }\limits_{t \to \infty } {e_\psi }(t) = 0

    综上,系统状态 ({e}_{x},u,{e}_{y},v,{e}_{\psi },r) 渐近稳定。根据式(8)可直接证明 ({e}_{1},{e}_{2},{e}_{3}) 同样渐近稳定,由此定理1得证。

    本文以著名的Cybership I欠驱动无人船为模型开展仿真实验,以验证连续时变输出反馈控制器式(10)的有效性。该无人船由挪威科技大学根据一艘大型供给船研制开发,缩尺比为1∶70,船长为1.19 m,重量为17.6 kg,其主要模型参数如表1所示。

    表  1  Cybership I无人船模型参数[33]
    Table  1.  Model parameters of the Cybership I[33]
    参数数值参数数值
    {m_{11}}19 {d_{11}}4
    {m_{22}}35.2{d_{22}}1
    {m_{33}}4.2{d_{33}}10
    下载: 导出CSV 
    | 显示表格

    为了建立无人船单目视觉伺服仿真场景,在目标平面上布置4个特征点,其三维空间位置分别为 {{\boldsymbol{p}}}_{1}={[0.8,-1,-0.2]}^{\text{T}} {{\boldsymbol{p}}}_{2}={[0.8,1,-0.2]}^{\text{T}} {{\boldsymbol{p}}}_{3}= {[0.8,1,-2.2]}^{\text{T}} {{\boldsymbol{p}}}_{4}={[0.8,-1,-2.2]}^{\text{T}} 。相机高度设定为{h_{\rm{c}}} = 1,无人船在 {{\boldsymbol{\eta }}}_{\text{d}}={[0,0,0]}^{\text{T}} 位姿下提前获得期望图像,故图像深度d = 0.8。为了使单目相机在初始时刻能够拍摄到特征点,无人船的初始状态设定为 {\boldsymbol{\eta }}(0)={[-10,-10,1.5]}^{\text{T}} {\boldsymbol{\nu}} (0)={[0,0,0]}^{\text{T}} ,即无人船处于静止状态。需要说明的是,对于无人船控制器,上述特征点的三维空间位置、相机高度、无人船模型参数、期望位姿、初始状态均未知。在无人船单目视觉伺服镇定控制中,首先,利用式(3)生成的初始图像和期望图像,通过识别算法可确定特征点的投影坐标 {\boldsymbol{p}}_i^o(0) {\boldsymbol{p}}_i^{{o_{\rm{r}}}};然后,利用标定的相机内部参数x_{\rm{c}}^o = y_{\rm{c}}^o = 512{a_x} = {a_y} = 200 解算式(5),得到单应性矩阵{\boldsymbol{H}}; 最后,采用单应性分解技术分解该矩阵,获得视觉伺服初始误差{e_x}(0) = {\text{13}}{\text{.35}}{e_y}(0) = - {\text{11}}{\text{.58}}{e_\psi }(0) = - {\text{1}}{\text{.5}}。由定理1可知,控制器式(10)的增益参数需满足条件: 0 < {k_1} < \dfrac{{d{d_{11}}{d_{22}}}}{{{m_{11}}}} {k_2} > 0 {k_3} > 0 {k_4} \ne 0 。Cybership I无人船的最大输入力和力矩分别约为{\text{2}}{\kern 1pt} {\kern 1pt} {\text{N}} 1.5\; {\text{N}} \cdot {\text{m}}

    综上,将增益参数保守地设定为较小值,即 {k_1} = {k_2} = {k_3}= 0.06,以满足增益参数选取要求和避免控制输入饱和。另外,为了避免过频激励,选取激励周期为30 s左右,设定{k_4} = 0.2。在仿真实验中,通过选择广角相机减小特征目标脱离视野的风险,则图像分辨率选取为1 024×1 024。

    仿真结果如图3图7所示。为了节省空间,将期望图像和每一时刻的当前图像绘制在同一张图中,形成了特征点在图像空间中的运动轨迹。随着无人船的运动,当前图像与期望图像趋向于重合,如图3所示。在视觉伺服过程中,利用当前图像与期望图像计算欧几里得单应性矩阵,并通过分解该矩阵获得与未知图像深度有关的位姿误差,如图4所示。因此,不需要提前标定相机外部参数或已知目标物模型信息,从而方便了视觉伺服方法的实际应用。由于无人船运动速度未知,本文设计了连续时变输出反馈控制器,以降低计算复杂度,保证整个伺服系统的运算实时性。

    图  3  特征点在图像空间中的运动轨迹
    Figure  3.  The trajectories of feature points in the image space
    图  4  具有尺度因子的位姿误差
    Figure  4.  Scaled posture errors
    图  5  控制输入
    Figure  5.  Control inputs
    图  6  纵/横荡速度和艏摇角速率
    Figure  6.  Surge/sway velocities and yaw rate

    两个控制输入如图5所示,其中连续时不变的控制输入{\tau _u}用于镇定纵向位置误差;连续时变的控制输入{\tau _r}根据纵向位置误差产生持续激励信号,改变无人船的艏摇角度,减小欠驱动无人船横向位置误差。此外,{\tau _r}还用于调节无人船的艏摇角,使其收敛至期望值。尽管无人船单目视觉镇定控制系统具有未知的图像深度、运动速度和模型参数,但在控制输入的作用下,欠驱动无人船的位姿误差依然渐近收敛到原点,运动速度也渐近收敛到至0,如图6所示,这与前述的稳定性分析相一致。欠驱动无人船根据船载单目相机的测量信息,不断调整自身位置和姿态,渐渐到达期望位姿,总体控制效果如图7所示。

    综上,本文设计的连续时变输出反馈控制器能够仅利用船载单目相机的图像信息,且在图像深度、运动速度、模型参数均未知的前提下,克服不可积的二阶非完整约束,实现欠驱动无人船单目视觉伺服镇定控制系统渐近稳定。

    图  7  欠驱动无人船运动轨迹
    Figure  7.  The trajectory of an underactuated USV

    为了解决欠驱动无人船在GPS拒止环境下的镇定控制问题,本文提出了连续时变输出反馈的单目视觉伺服方法,在图像深度、运动速度、模型参数均未知的情况下,实现了闭环控制系统渐近稳定。具体而言,采用单应性分解技术,将具有尺度因子的位姿误差直接从当前图像和期望图像中恢复,避免了提前标定相机外部参数和目标物模型信息的繁琐处理。为了克服无人船的欠驱动属性,将横向位置误差和艏摇角误差相耦合,通过引入时变周期函数设计了连续时变输出反馈控制器。值得一提的是,系统对未知的图像深度和运动速度并未作额外的估计或观测,这大大降低了控制器的计算复杂度。采用李雅普诺夫理论和芭芭拉引理严格证明了闭环控制系统的稳定性,仿真结果验证了所提单目视觉伺服镇定控制方法的有效性。未来研究工作将考虑欠驱动无人船受到的外部扰动,提高单目视觉伺服控制器的鲁棒性。

  • 图  1   欠驱动无人船单目视觉伺服系统

    Figure  1.   The monocular visual-servo system of underactuated USV

    图  2   单目视觉伺服镇定控制系统框图

    Figure  2.   The block diagram of monocular visual-servo stabilization control system

    图  3   特征点在图像空间中的运动轨迹

    Figure  3.   The trajectories of feature points in the image space

    图  4   具有尺度因子的位姿误差

    Figure  4.   Scaled posture errors

    图  5   控制输入

    Figure  5.   Control inputs

    图  6   纵/横荡速度和艏摇角速率

    Figure  6.   Surge/sway velocities and yaw rate

    图  7   欠驱动无人船运动轨迹

    Figure  7.   The trajectory of an underactuated USV

    表  1   Cybership I无人船模型参数[33]

    Table  1   Model parameters of the Cybership I[33]

    参数数值参数数值
    {m_{11}}19 {d_{11}}4
    {m_{22}}35.2{d_{22}}1
    {m_{33}}4.2{d_{33}}10
    下载: 导出CSV
  • [1] 刘祥, 叶晓明, 王泉斌, 等. 无人水面艇局部路径规划算法研究综述[J]. 中国舰船研究, 2021, 16(增刊 1): 1–10. doi: 10.19693/j.issn.1673-3185.02538

    LIU X, YE X M, WANG Q B, et al. Review on the research of local path planning algorithms for unmanned surface vehicles[J]. Chinese Journal of Ship Research, 2021, 16(Supp 1): 1–10 (in Chinese). doi: 10.19693/j.issn.1673-3185.02538

    [2] 欧阳子路, 王鸿东, 黄一, 等. 基于改进RRT算法的无人艇编队路径规划技术[J]. 中国舰船研究, 2020, 15(3): 18–24. doi: 10.19693/j.issn.1673-3185.01639

    OUYANG Z L, WANG H D, HUANG Y, et al. Path planning technologies for USV formation based on improved RRT[J]. Chinese Journal of Ship Research, 2020, 15(3): 18–24 (in Chinese). doi: 10.19693/j.issn.1673-3185.01639

    [3] 余亚磊, 苏荣彬, 冯旭, 等. 基于速变LOS的无人船反步自适应路径跟踪控制[J]. 中国舰船研究, 2019, 14(3): 163–171. doi: 10.19693/j.issn.1673-3185.01377

    YU Y L, SU R B, FENG X, et al. Tracking control of backstepping adaptive path of unmanned surface vessels based on surge-varying LOS[J]. Chinese Journal of Ship Research, 2019, 14(3): 163–171 (in Chinese). doi: 10.19693/j.issn.1673-3185.01377

    [4]

    WANG N, AHN C K. Hyperbolic-tangent LOS guidance-based finite-time path following of underactuated marine vehicles[J]. IEEE Transactions on Industrial Electronics, 2020, 67(10): 8566–8575. doi: 10.1109/TIE.2019.2947845

    [5]

    BROCKETT R W. Asymptotic stability and feedback stabilization[C]//Differential Geometric Control Theory. Boston, MA: Birkhäuser Boston, 1983: 181−191.

    [6]

    GHOMMAM J, MNIF F, DERBEL N. Global stabilisation and tracking control of underactuated surface vessels[J]. IET Control Theory & Applications, 2010, 4(1): 71–88.

    [7]

    REYHANOGLU M. Exponential stabilization of an underactuated autonomous surface vessel[J]. Automatica, 1997, 33(12): 2249–2254. doi: 10.1016/S0005-1098(97)00141-6

    [8]

    GHOMMAM J, MNIF F, BENALI A, et al. Asymptotic backstepping stabilization of an underactuated surface vessel[J]. IEEE Transactions on Control Systems Technology, 2006, 14(6): 1150–1157. doi: 10.1109/TCST.2006.880220

    [9]

    PETTERSEN K Y, FOSSEN T I. Underactuated dynamic positioning of a ship-experimental results[J]. IEEE Transactions on Control Systems Technology, 2000, 8(5): 856–863. doi: 10.1109/87.865859

    [10]

    MAZENC F, PETTERSEN K, NIJMEIJER H. Global uniform asymptotic stabilization of an underactuated surface vessel[J]. IEEE Transactions on Automatic Control, 2002, 47(10): 1759–1762. doi: 10.1109/TAC.2002.803554

    [11]

    DONG W J, GUO Y. Global time-varying stabilization of underactuated surface vessel[J]. IEEE Transactions on Automatic Control, 2005, 50(6): 859–864. doi: 10.1109/TAC.2005.849248

    [12] 董早鹏, 万磊, 李岳明, 等. 极坐标系下的欠驱动无人艇分块反步镇定控制[J]. 交通运输工程学报, 2015, 15(4): 61–68.

    DONG Z P, WAN L, LI Y M, et al. Block backstepping stabilization control of underactuated USV in polar coordinate system[J]. Journal of Traffic and Transportation Engineering, 2015, 15(4): 61–68 (in Chinese).

    [13] 丁文东, 徐德, 刘希龙, 等. 移动机器人视觉里程计综述[J]. 自动化学报, 2018, 44(3): 385–400. doi: 10.16383/j.aas.2018.c170107

    DING W D, XU D, LIU X L, et al. Review on visual odometry for mobile robots[J]. Acta Automatica Sinica, 2018, 44(3): 385–400 (in Chinese). doi: 10.16383/j.aas.2018.c170107

    [14]

    HE H K, WANG N. Monocular visual servo of unmanned surface vehicles with view-field constraints[C]//2012 33rd Chinese Control and Decision Conference (CCDC). Kunming, China: IEEE, 2021: 973−978.

    [15]

    MARTINS A, ALMEIDA J M, FERREIRA H, et al. Autonomous surface vehicle docking manoeuvre with visual information[C]//Proceedings 2007 IEEE International Conference on Robotics and Automation. Rome, Italy: IEEE, 2007: 4994−4999.

    [16]

    DUNBABIN M, LANG B, WOOD B. Vision-based docking using an autonomous surface vehicle[C]//2008 IEEE International Conference on Robotics and Automation. Pasadena, CA, USA: IEEE, 2008: 26−32.

    [17]

    KIM Y H, LEE S W, YANG H S, et al. Toward autonomous robotic containment booms: Visual servoing for robust inter-vehicle docking of surface vehicles[J]. Intelligent Service Robotics, 2012, 5(1): 1–18. doi: 10.1007/s11370-011-0100-0

    [18] 徐海彬, 刘畅, 田建东, 等. 基于视觉和定位系统的无人艇自主对接系统[J]. 计算机工程与设计, 2021, 42(9): 2606–2613. doi: 10.16208/j.issn1000-7024.2021.09.027

    XU H B, LIU C, TIAN J D, et al. Autonomous docking system for USV based on vision and position system[J]. Computer Engineering and Design, 2021, 42(9): 2606–2613 (in Chinese). doi: 10.16208/j.issn1000-7024.2021.09.027

    [19] 张山甲, 王建华, 郑翔, 等. 基于视觉伺服的欠驱动无人水面艇自主靠泊方法[J]. 船舶工程, 2020, 42(7): 144–151.

    ZHANG S J, WANG J H, ZHENG X, et al. Autonomous berthing method of underactuated unmanned surface vehicle based on visual servo[J]. Ship Engineering, 2020, 42(7): 144–151 (in Chinese).

    [20]

    WANG N, HE H K. Adaptive homography-based visual servo for micro unmanned surface vehicles[J]. The International Journal of Advanced Manufacturing Technology, 2019, 105(12): 4875–4882. doi: 10.1007/s00170-019-03994-7

    [21]

    WANG N, HE H K. Extreme learning-based monocular visual servo of an unmanned surface vessel[J]. IEEE Transactions on Industrial Informatics, 2021, 17(8): 5152–5163. doi: 10.1109/TII.2020.3033794

    [22]

    WANG N, HE H K. Dynamics-level finite-time fuzzy monocular visual servo of an unmanned surface vehicle[J]. IEEE Transactions on Industrial Electronics, 2020, 67(11): 9648–9658. doi: 10.1109/TIE.2019.2952786

    [23] 邹黎敏, 胡兴凯, 伍俊良. 正定矩阵的性质及判别法[J]. 中山大学学报(自然科学版), 2009, 48(5): 16–23. doi: 10.3321/j.issn:0529-6579.2009.05.004

    ZOU L M, HU X K, WU J L. The properties and discrimination of the positive definite matrices[J]. Acta Scientiarum Naturalium Universitatis Sunyatseni, 2009, 48(5): 16–23 (in Chinese). doi: 10.3321/j.issn:0529-6579.2009.05.004

    [24]

    HURWITZ A. Über algebraische gebilde mit eindeutigen transformationen in sich[J]. Mathematische Annalen, 1892, 41(3): 403–442. doi: 10.1007/BF01443420

    [25]

    TAO G. A simple alternative to the Barbalat lemma[J]. IEEE Transactions on Automatic Control, 1997, 42(5): 698. doi: 10.1109/9.580878

    [26] 闵颖颖, 刘允刚. Barbalat引理及其在系统稳定性分析中的应用[J]. 山东大学学报(工学版), 2007, 37(1): 51–55,114. doi: 10.3969/j.issn.1672-3961.2007.01.013

    MIN Y Y, LIU Y G. Barbalat lemma and its application in analysis of system stability[J]. Journal of Shandong University (Engineering Science), 2007, 37(1): 51–55,114 (in Chinese). doi: 10.3969/j.issn.1672-3961.2007.01.013

    [27]

    LOWE D G. Object recognition from local scale-invariant features[C]//Proceedings of the Seventh IEEE International Conference on Computer Vision. Kerkyra, Greece: IEEE, 1999, 2: 1150−1157.

    [28]

    ZHANG Z Y. Flexible camera calibration by viewing a plane from unknown orientations[C]//Proceedings of the Seventh IEEE International Conference on Computer Vision. Kerkyra, Greece: IEEE, 1999, 1: 666−673.

    [29]

    FANG Y C, DIXON W E, DAWSON D M, et al. Homography-based visual servo regulation of mobile robots[J]. IEEE Transactions on Systems, Man, and Cybernetics, Part B (Cybernetics), 2005, 35(5): 1041–1050. doi: 10.1109/TSMCB.2005.850155

    [30]

    FAUGERAS O D, LUSTMAN F. Motion and structure from motion in a piecewise planar environment[J]. International Journal of Pattern Recognition and Artificial Intelligence, 1988, 2(3): 485–508. doi: 10.1142/S0218001488000285

    [31]

    DO K D, PAN J. Global robust adaptive path following of underactuated ships[J]. Automatica, 2006, 42(10): 1713–1722. doi: 10.1016/j.automatica.2006.04.026

    [32]

    DAI S L, HE S D, LIN H, et al. Platoon formation control with prescribed performance guarantees for USVs[J]. IEEE Transactions on Industrial Electronics, 2018, 65(5): 4237–4246. doi: 10.1109/TIE.2017.2758743

    [33]

    GHOMMAM J, MNIF F, BENALI A, et al. Observer design for Euler Lagrange systems: application to path following control of an underactuated surface vessel[C]//2007 IEEE/RSJ International Conference on Intelligent Robots and Systems. San Diego, CA, USA: IEEE, 2007: 2883−2888.

  • 期刊类型引用(9)

    1. 王宁,贾薇,吴浩峻. 欠驱动无人船路径跟踪:一种有限时间正切漂角视线制导方法. 控制与决策. 2025(01): 187-195 . 百度学术
    2. 王宁,吴伟,王元元,孙赫男. 多特征融合的无人艇视觉目标长时相关鲁棒跟踪. 中国舰船研究. 2024(01): 62-74 . 本站查看
    3. 何红坤,王宁,张富宇,韩冰. 水面无人艇单目视觉伺服自主控制研究综述. 中国舰船研究. 2024(01): 15-28 . 本站查看
    4. 孙岩霆,王荣杰,蒋德松. 融合A~*与DWA算法的水面船艇动态路径规划. 仪器仪表学报. 2024(01): 301-310 . 百度学术
    5. 褚天仁,陈羽. 基于输入约束与模糊参数的无人艇航迹规划. 舰船电子对抗. 2024(04): 59-66 . 百度学术
    6. 王宁,吴伟,王元元,孙赫男,冯远. 多特征融合的无人艇视觉小目标鲁棒跟踪. 中国舰船研究. 2024(05): 65-78 . 本站查看
    7. 姚凤翔,黄振,褚天仁,何红坤,张海华,许凯玮,时英玉. 欠驱动无人船全局轨迹规划方法研究. 舰船电子对抗. 2024(05): 26-31+100 . 百度学术
    8. 王宁,武慧慧,张宇航. 考虑操纵约束的无人艇海域全覆盖路径规划. 中国舰船研究. 2024(06): 210-218 . 本站查看
    9. 吴伟,王宁,王元元,孙赫男. 多特征融合的无人船视觉目标跟踪. 大连海事大学学报. 2023(04): 37-45+56 . 百度学术

    其他类型引用(2)

  • 其他相关附件

图(7)  /  表(1)
计量
  • 文章访问数:  785
  • HTML全文浏览量:  123
  • PDF下载量:  118
  • 被引次数: 11
出版历程
  • 收稿日期:  2022-04-14
  • 修回日期:  2022-08-10
  • 录用日期:  2022-08-14
  • 网络出版日期:  2022-08-14
  • 刊出日期:  2022-10-23

目录

/

返回文章
返回