2.845

2023影响因子

(CJCR)

  • 中文核心
  • EI
  • 中国科技核心
  • Scopus
  • CSCD
  • 英国科学文摘

留言板

尊敬的读者、作者、审稿人, 关于本刊的投稿、审稿、编辑和出版的任何问题, 您可以本页添加留言。我们将尽快给您答复。谢谢您的支持!

姓名
邮箱
手机号码
标题
留言内容
验证码

基于旋翼无人机近地面空间应急物联网节点动态协同部署

王巍 彭力 赵继军 朱天宇 崔益豪 田立勤

曹海昕,  郝运嵩,  林静正,  卢彪,  方勇纯.  绳长时变情况下轮胎式集装箱起重机非线性防摆控制算法.  自动化学报,  2021,  47(8): 1876−1884 doi: 10.16383/j.aas.c200859
引用本文: 王巍, 彭力, 赵继军, 朱天宇, 崔益豪, 田立勤. 基于旋翼无人机近地面空间应急物联网节点动态协同部署. 自动化学报, 2021, 47 (8): 2002−2015 doi: 10.16383/j.aas.c180146
Cao Hai-Xin,  Hao Yun-Song,  Lin Jing-Zheng,  Lu Biao,  Fang Yong-Chun.  Nonlinear anti-swing control for rubber tyre container gantry crane with rope length variation.  Acta Automatica Sinica,  2021,  47(8): 1876−1884 doi: 10.16383/j.aas.c200859
Citation: Wang Wei, Peng Li, Zhao Ji-Jun, Zhu Tian-Yu, Cui Yi-Hao, Tian Li-Qin. Dynamic cooperative deployment of emergency internet of things near ground space based on drone. Acta Automatica Sinica, 2021, 47 (8): 2002−2015 doi: 10.16383/j.aas.c180146

基于旋翼无人机近地面空间应急物联网节点动态协同部署

doi: 10.16383/j.aas.c180146
基金项目: 

国家重点研发计划 2018YFF0301004

国家重点研发计划 2018YFD0400902

国家自然科学基金 61802107

国家自然科学基金 61873112

教育部–中国移动科研基金 MCM20170204

河北省自然科学基金 F2015402108

河北省物联网数据采集与处理工程技术研究中心开放课题 2016-2

江苏省博士后科研资助计划项目 1601085C

详细信息
    作者简介:

    彭力    江南大学教授. 2002年获得北京科技大学控制理论与控制工程博士学位. 主要研究方向为视觉物联网.E-mail: pengli@jiangnan.edu.cn

    赵继军    河北工程大学教授. 2003年获得北京邮电大学电磁场与微波技术博士学位. 主要研究方向为宽带通信网, 传感网与物联网.E-mail: zjijun@hebeu.edu.cn

    朱天宇   河北工程大学信息与电气工程学院硕士研究生.主要研究方向为无人机, SLAM.E-mail: zihan126410@sina.com

    崔益豪   河北工程大学信息与电气工程学院硕士研究生.主要研究方向为物联网监测系统.E-mail: yihaocui1994@163.com

    田立勤   华北科技学院教授. 2009年获得北京科技大学计算机应用技术博士学位.主要研究方向为物联网远程信息监控、网络用户行为认证.E-mail: tianliqin@ncist.edu.cn

    通讯作者:

    王巍    河北工程大学副教授. 2012年获得北京科技大学信息工程学院控制科学与工程博士学位. 主要研究方向为公共安全物联网, 隐式人机交互. 本文通信作者.E-mail: wangwei83@hebeu.edu.cn

Dynamic Cooperative Deployment of Emergency Internet of Things Near Ground Space Based on Drone

Funds: 

National Key Research and Development Program of China 2018YFF0301004

National Key Research and Development Program of China 2018YFD0400902

National Natural Science Foundation of China 61802107

National Natural Science Foundation of China 61873112

Education Ministry and China Mobile Science Research Foundation MCM20170204

Natural Science Foundation of Hebei Province of China F2015402108

Foundation of Internet of Things Data Acquisition and Processing Engineering Technology Research Center in Hebei Province 2016-2

Jiangsu Planned Projects for Postdoctoral Research Funds 1601085C

More Information
    Author Bio:

    PENG Li    Professor at Jiangnan University. He received his Ph. D. degree from University of Science & Technology Beijing in 2002. His main research is visual internet of things

    ZHAO Ji-Jun    Professor at Hebei University of Engineering. He received his Ph. D. degreer from Beijing University of Posts and Telecommunications in 2003. His research interest covers broadband communication network, sensor network and internet of things

    ZHU Tian-Yu   Master student at School of Information & Electrical Engineering, Hebei University of Engineering. His research interest covers UAV and SLAM

    CUI Yi-Hao   Master student at School of Information & Electrical Engineering, Hebei University of Engineering. His main research is monitoring system of internet of things

    TIAN Li-Qin   Professor at North China Institute of Science and Technology. He received his Doctor degree from University of Science & Technology Beijing in 2009. His research interest covers remote monitoring of Internet of Things, network user behavior authentication

    Corresponding author: WANG Wei    Associate professor at Hebei University of Engineering. He received his Ph. D. degree from University of Science & Technology Beijing in 2012. His research interest covers public safety internet of things and implicit human-computer interaction. Corresponding author of this paper
  • 摘要: 针对基于旋翼无人机的近地面空间应急物联网在缺少地面基站和能量受限的情况下, 可靠节能地远距离传输重点区域全信息的要求, 研究由无人机组成的移动Ad-Hoc网络的远距离通信问题, 提出近地面空间应急物联网空地节点动态协同部署方法. 首先, 对该类物联网进行系统建模; 其次, 根据所建模型中无人机编队大范围、队列化、微漂移地分散于监测区域的特点和编队的联合分布情况, 在提供可靠通信的同时, 将系统通信能耗和移动能耗的计算构建成二次约束二次规划问题; 再次, 根据Gerschgorin圆盘定理和根的存在性定理, 证明了此问题为凸优化问题, 进而可求解得到移动地面站的最佳路径点, 实现近地面空间应急物联网空地节点动态协同部署. 最后, 通过实验, 从通信耗能和运动耗能两方面验证了本文所提方法的有效性, 同时, 也分析了影响本文所述方法效能的因素.
    Recommended by Associate Editor CHEN Ji-Ming
  • 集装箱起重机是一种常见的工业设备, 在世界各港口的生产运输中发挥着重要作用. 长期以来, 集装箱起重机主要由驾驶员凭借操作经验进行控制, 作业过程中负载往往存在着较大幅度的摆动, 不仅影响生产效率, 还存在一定的安全隐患. 对于港口常见的四绳轮胎式集装箱起重机 (以下简称为四绳起重机) 而言, 造成负载摆动的主要因素如下: 首先起重机自身的欠驱动特性导致对于负载摆动缺乏直接的控制手段, 特殊的四绳吊具结构也使负载摆动情况更加复杂; 其次, 在运送数十吨的集装箱时, 轮胎式集装箱起重机的胎压会出现较大变化, 导致桥架的倾斜晃动与负载的摆动; 除此之外, 港口恶劣的大风天气也会干扰负载的平稳运送. 近年来, 建设智能化、无人化码头已成为业界的发展趋势, 但是作为港口自动化改造的重点之一, 四绳起重机由于前文中提到的各种问题, 在工业应用中尚缺乏高效的控制策略, 对其进行定位与防摆算法的研究具有很强的实际意义.

    对于门式起重机控制方案的研究, 国内外学者已经基于最优控制[1-4]、滑模控制[5-6]、鲁棒控制[7-8]、模糊控制[9]、预测控制[10-11]等理论提出了多种控制方法[12-14]. 具体来说, 文献[8]通过引入基于台车定位误差的滑模面, 设计了一种有限时间跟踪的鲁棒控制器, 降低了对参数变化的敏感性, 在负载质量不确定的情况下实现了台车的准确定位与负载摆幅的有效抑制, 但该文尚未考虑到绳长变化带来的影响; Smoczek等[11]提出了一种基于多变量模型预测控制和粒子群优化算法的新型优化算法, 可以较好地消除负载的瞬时摆动与残余摆动, 并在实验室环境下验证了其可行性, 但是模型部分较为复杂, 部分参数需要在线估计, 实时性与稳定性可能难以满足工业场景的要求; 文献[15]基于起重机动态特性与输入整形技术设计的控制方法在吊绳长度变化较大的情况下实现了对负载摆动的有效抑制, 但应对外界强干扰的能力不强, 更适合于室内等相对稳定的作业环境.

    以上算法大都是针对传统单绳起重机进行控制, 对于集装箱起重机而言, 由于负载体积较大, 常常需要四组以上的吊绳来确保吊运过程中的稳定与安全. 此时负载已不再适合用质点来进行描述, 摆动特性也变得更加复杂, 对其进行分析与控制的难度大大增加. 很长一段时间内, 研究人员都是通过线性化或近似处理的方式来对其进行分析. 文献[3]提出一种基于控制向量参数化方法的时间最优控制问题快速求解算法, 采用光滑化代价函数路径约束处理方法降低了起重机模型求解难度, 并进行了仿真测试; 文献[16-18]中通过将负载近似处理为质点的方式, 将集装箱起重机简化为单绳起重机, 在此基础上再通过自适应控制、滑模控制等方法来进行控制器的设计. 这样做虽然简化了后续分析, 但在实际情况下, 一旦简化的假设条件不再成立, 控制系统的表现将会受到极大影响. 为了提高模型精度, 达到更好的控制效果, Lu等[19]提出了一种基于拉格朗日方程的建模方法, 在未做简化处理的情况下为四绳起重机建立了精确模型. 在此基础上, Lu等将更多的负载摆动信息引入非线性控制器的设计, 在模拟的集装箱起重机平台上完成了实验验证并取得了良好的控制效果[20]. 但是在实际作业中, 常常是台车位置与吊绳长度同时变化, 文献[19-20]在建模分析中将绳长考虑为定值, 系统只存在两个自由度 (台车位置与负载摆角), 不能完整反映出实际系统各状态间的耦合关系, 同时文献[20]所进行的各项实验都是在吊绳长度不变的前提下进行, 这样限制了负载的吊运路径, 不利于作业效率的提高.

    为了解决上述问题, 本文在文献[19-20]的研究基础上, 对四绳吊具摆动情况进行拓展分析, 将绳长作为变量引入系统的动力学模型中, 设计了一种非线性反馈控制器, 该控制器具有如下优点: 首先, 控制器的结构相对简单, 对反馈信息与计算资源的要求不高, 这样保证了控制系统的实时性; 其次, 控制器中引入绳长变量使得负载可以在水平与竖直两个维度上同时运动, 相较于传统的“门型” 运动方式 (只能在一个维度动作), 不但运送路径可选择性更多, 效率也将得到极大提升; 另外, 不同于大多数在实验室或仿真环境下运行的算法, 本文的控制方案最终在港口的实际起重机平台上进行了验证, 运送效率相比于熟练工人的操作有了较大程度的提升, 为理论与实践的结合提供了有力支撑.

    本文的其他部分组织如下: 第1节对绳长变化情况下四绳起重机吊具的摆动情况进行了建模分析并对其控制问题进行了描述; 第2节基于改造后的系统能量函数设计了一种非线性反馈控制器; 第3节通过Lyapunov方法对控制器进行了稳定性分析; 第4节展示了控制方案在港口实际设备上与熟练工人操作的对比结果; 第5节则对所做工作进行了总结与展望.

    在模型分析之前, 为了简化表述定义如下缩写:

    $$ \begin{split} &{s_i} = \sin {\theta _i},\; {c_i} = \cos {\theta _i},\; {s_{i \pm j}} = \sin \;({\theta _i} \pm {\theta _j})\\ &{c_{i \pm j}} = \cos\; ({\theta _i} \pm {\theta _j}),\; i,j = 1,2,3 \;(i \ne j) \end{split} $$

    四绳起重机吊具摆动模型如图1所示, 其中, $2d$$2a$分别表示台车与吊具上两吊绳连接点间的距离, $b$表示集装箱重心$P$与吊具上吊绳连接点所成直线的距离, $l$代表绳长, ${F_x}$${F_l}$分别为台车与吊绳的驱动力, $M$$m$分别代表台车与负载的质量, ${\theta _1}$${\theta _2}$分别代表两侧吊绳与竖直方向的夹角, ${\theta _3}$表示集装箱的摆动角度. 考虑到负载摆动的实际情况, 做出如下假设:

    图 1  四绳起重机吊具摆动模型
    Fig. 1  Swing model of four-rope crane spreader
    $$ - \frac{\pi }{2} < {\theta _1}, {\theta _2}, {\theta _3}, ({\theta _1} + {\theta _3}), ({\theta _2} + {\theta _3}) < \frac{\pi }{2}$$

    根据图1中吊绳与摆角的几何关系, 可以得到如下约束:

    $$l{s_1} + 2a{c_3} - l{s_2} - 2d = 0$$ (1)
    $$l{c_1} + 2a{s_3} - l{c_2} = 0$$ (2)

    基于文献[20]中的分析基础, 从式(1)与(2)的约束关系中可以得出${\theta _1}$${\theta _2}$${\theta _3}$$l$四个变量中只有两个独立, 假设${\theta _1}$$l$为独立变量, 则${\theta _2}$${\theta _3}$可表示为与独立变量相关的函数:

    $$\begin{split} &{\theta _2} = h({\theta _1},l) \;\; \Rightarrow \;\; {{\dot \theta }_2} = {h_\theta }{{\dot \theta }_1} + {h_l}\dot l \\ & {\theta _3} = g({\theta _1},l) \;\; \Rightarrow \;\; {{\dot \theta }_3} = {g_\theta }{{\dot \theta }_1} + {g_l}\dot l \end{split} $$ (3)

    其中$h({\theta _1},l)$$g({\theta _1},l)$为未知函数, ${g_\theta },{g_l},{h_\theta },{h_l}$为相应的偏导数, 可以计算如下:

    $$\begin{split} & {g_\theta } = \frac{{l{s_{1 - 2}}}}{{2a{c_{2 + 3}}}}, \;\; {g_l} = \frac{{1 - {c_{1 - 2}}}}{{2a{c_{2 + 3}}}} \\ &{h_\theta } = \frac{{{c_{1 + 3}}}}{{{c_{2 + 3}}}}, \;\;\;\;\;\; {h_l} = \frac{{{s_{1 + 3}} - {s_{2 + 3}}}}{{l{c_{2 + 3}}}} \end{split} $$ (4)

    由于四绳吊具结构的对称性, 负载稳定时最终会停留在台车正下方, 左右两侧吊绳与竖直方向夹角大小相等, 方向相反, 负载处于水平状态, 偏转角度为零. 因此, 系统状态的期望平衡点可以表示如下:

    $${\left[ {x\;l \;{\theta _1} \;{\theta _2}\; {\theta _3}} \right]^{\rm{T}}} = {\left[ {{x_d}\; {l_d} \;{\theta _{1d}} \;{\theta _{2d}}\; {\theta _{3d}}} \right]^ {\rm{T}} }$$ (5)

    其中${x_d}$${l_d}$分别代表台车与绳长的期望位置, ${\theta _{1d}}, {\theta _{2d}}, {\theta _{3d}} $分别代表平衡状态下${\theta _1}, {\theta _2}, {\theta _3} $的期望值, 且有如下关系成立:

    $$ {\theta _{1d}} = \arcsin \left( {\frac{{d - a}}{{{l_d}}}} \right) = - {\theta _{2d}}, \;\; {\theta _{3d}} = 0$$

    基于上述四绳吊具结构的分析, 结合Lagrange方程, 可以得到如下的系统动力学模型:

    $$M({\boldsymbol{q}}){\ddot{\boldsymbol{q}}} + C({\boldsymbol{q}},{\dot{\boldsymbol{q}}}){\dot{\boldsymbol{q}}} + G({\boldsymbol{q}}) = {\boldsymbol{u}}$$ (6)

    其中${\boldsymbol{q}}(t) = {\left[ {x(t)\; l(t)\; {\theta _1}(t)} \right]^{\rm{T}} } \in {{\bf{R}}^3}$用于描述广义坐标, $M({\boldsymbol{q}}), C({\boldsymbol{q}},{\dot{\boldsymbol{q}}}) \in {{\bf{R}}^{3 \times 3}}$, $ G({\boldsymbol{q}}), {\boldsymbol{u}} \in {{\bf{R}}^3}$分别代表了惯量矩阵、向心 — 柯氏力矩阵、重力向量及控制向量. 为了便于表述, $M({\boldsymbol{q}}), C({\boldsymbol{q}},{\dot{\boldsymbol{q}}}), G({\boldsymbol{q}}), {\boldsymbol{ u}}$可以进一步表示如下:

    $$ \begin{split} M({\boldsymbol{q}}) =\;& {N^ {\rm{T}} }{M_1}N, G({\boldsymbol{q}}) = {N^ {\rm{T}} }{G_1}, {\boldsymbol{u}} = {N^ {\rm{T}} }{{\boldsymbol{u}}_1}\\ &C({\boldsymbol{q}},{\dot{\boldsymbol{q}}}) = {N^ {\rm{T}} }{M_1}\dot N + {N^{\rm{T}}}{C_1}N \end{split}$$ (7)

    其中各矩阵表示如下:

    $$ {M_1} = \left[ {\begin{array}{*{20}{c}} {M + m}&{\dfrac{1}{2}m({s_1} + {s_2})}&{\dfrac{1}{2}ml{c_1}}&{\dfrac{1}{2}ml{c_2}}&{ - mb{c_3}} \\ {\dfrac{1}{2}m({s_1} + {s_2})}&{\dfrac{1}{2}m(1 + {c_{1 - 2}})}&{ - \dfrac{1}{4}ml{s_{1 - 2}}}&{\dfrac{1}{4}ml{s_{1 - 2}}}&{ - \dfrac{1}{2}mb({s_{1 + 3}} + {s_{2 + 3}})} \\ {\dfrac{1}{2}ml{c_1}}&{ - \dfrac{1}{4}ml{s_{1 - 2}}}&{\dfrac{1}{4}m{l^2}}&{\dfrac{1}{4}m{l^2}{c_{1 - 2}}}&{ - \dfrac{1}{2}mbl{c_{1 + 3}}} \\ {\dfrac{1}{2}ml{c_2}}&{\dfrac{1}{4}ml{s_{1 - 2}}}&{\dfrac{1}{4}m{l^2}{c_{1 - 2}}}&{\dfrac{1}{4}m{l^2}}&{ - \dfrac{1}{2}mbl{c_{2 + 3}}} \\ { - mb{c_3}}&{ - \dfrac{1}{2}mb({s_{1 + 3}} + {s_{2 + 3}})}&{ - \dfrac{1}{2}mbl{c_{1 + 3}}}&{ - \dfrac{1}{2}mbl{c_{2 + 3}}}&{m{b^2}} \end{array}} \right] $$
    $$ {C_1} \!=\!\left[\!\!\! {\begin{array}{*{20}{c}} 0&{\dfrac{1}{2}m({c_1}{{\dot \theta }_1} \!+\! {c_2}{{\dot \theta }_2})}&{\dfrac{1}{2}m{c_1}\dot l \!-\! \dfrac{1}{2}ml{s_1}{{\dot \theta }_1}}&{\dfrac{1}{2}m{c_2}\dot l \!-\! \dfrac{1}{2}ml{s_2}{{\dot \theta }_2}}&{mb{s_3}{{\dot \theta }_3}} \\ 0&{\dfrac{1}{4}m{s_{1 \!-\! 2}}({{\dot \theta }_2} \!-\! {{\dot \theta }_1})}&{ \!-\! \dfrac{1}{4}m{s_{1 \!-\! 2}}\dot l \!-\! \frac{1}{4}ml(1 \!+\! {c_{1 \!- \!2}}){{\dot \theta }_1}}&{\dfrac{1}{4}m{s_{1 \!-\! 2}}\dot l \!-\!\dfrac{1}{4}ml(1 + {c_{1 \!-\! 2}}){{\dot \theta }_2}}&{ \!-\! \dfrac{1}{2}mb({c_{1 \!+\! 3}} + {c_{2 \!+\! 3}}){{\dot \theta }_3}} \\ 0&{\dfrac{1}{4}ml{{\dot \theta }_1} \!+\! \dfrac{1}{4}ml{c_{1 \!-\! 2}}{{\dot \theta }_2}}&{\dfrac{1}{4}ml\dot l}&{\dfrac{1}{4}ml{c_{1 \!-\! 2}}\dot l\! +\! \dfrac{1}{4}m{l^2}{s_{1 \!-\! 2}}{{\dot \theta }_2}}&{\dfrac{1}{2}mbl{s_{1 \!+\! 3}}{{\dot \theta }_3}} \\ 0&{\dfrac{1}{4}ml{{\dot \theta }_2} \!+\! \dfrac{1}{4}ml{c_{1 \!-\! 2}}{{\dot \theta }_1}}&{\dfrac{1}{4}ml{c_{1\! -\! 2}}\dot l \!-\! \dfrac{1}{4}m{l^2}{s_{1 \!-\! 2}}{{\dot \theta }_1}}&{\dfrac{1}{4}ml\dot l}&{\dfrac{1}{2}mbl{s_{2 \!+\! 3}}{{\dot \theta }_3}} \\ 0&{ \!-\! \dfrac{1}{2}mb({c_{1 \!+\! 3}}{{\dot \theta }_1} \!+\! {c_{2 \!+\! 3}}{{\dot \theta }_2})}&{\dfrac{1}{2}mbl{s_{1 \!+\! 3}}{{\dot \theta }_1} \!-\! \dfrac{1}{2}mb{c_{1 \!+\! 3}}\dot l}&{\dfrac{1}{2}mbl{s_{2 \!+ \!3}}{{\dot \theta }_2} \!-\! \dfrac{1}{2}mb{c_{2 \!+\! 3}}\dot l}&0 \end{array}} \!\!\!\right] $$
    $$\begin{split} &N = \left[ {\begin{array}{*{20}{c}} 1&0&0 \\ 0&1&0 \\ 0&0&1 \\ 0&{{h_l}}&{{h_\theta }} \\ 0&{{g_l}}&{{g_\theta }} \end{array}} \right] \\ &{{\boldsymbol{G}}_1} = \left[ {\begin{array}{*{20}{c}} 0 \\ { - \dfrac{1}{2}mg({c_1} + {c_2})} \\ {\dfrac{1}{2}mgl{s_1}} \\ {\dfrac{1}{2}mgl{s_2}} \\ {mgb{s_3}} \end{array}} \right], {{\boldsymbol{u}}_1} = \left[ {\begin{array}{*{20}{c}} {{F_x}} \\ {{F_l}} \\ 0 \\ 0 \\ 0 \end{array}} \right] \end{split}$$

    考虑到实际应用场景中各种不确定性干扰的影响, 必须采用反馈控制来确保系统的稳定性与鲁棒性. 反馈项的设计应兼顾台车定位与负载消摆性能, 基于文献[20]中反馈项的设计思路, 除台车位置$x$外, 引入负载摆幅信息来增强台车位置与负载摆幅间的耦合关系, 得到的综合反馈项具有如下形式:

    $${\chi _p} = x + {\lambda _1}l{s_1} + {\lambda _2}l{s_2} + {\lambda _3}{s_3}$$ (8)

    其中

    $${\lambda _1} = {\lambda _2} = k\frac{{ - m}}{{2(M + m)}}, {\lambda _3} = k\frac{{mb}}{{M + m}}$$ (9)

    其中$k$为正控制增益. 结合式(5)与式(9), 当系统达到期望平衡点处, 有如下结论成立:

    $${\chi _p} = {x_d}, \;\; l = {l_d}$$ (10)

    进一步可以定义误差信号如下:

    $$\begin{split} &{\varepsilon _p} = {\chi _p} - {x_d} \;\; \Rightarrow \;\; {{\dot \varepsilon }_p} = {{\dot \chi }_p} \\ &{\varepsilon _l} = l - {l_d} \;\; \Rightarrow \;\; {{\dot \varepsilon }_l} = \dot l \end{split} $$ (11)

    接下来将对四绳起重机系统的能量函数进行分析并重新构造, 引入负载摆动的能量信息, 以便于李雅普诺夫候选函数的选取与控制器的设计. 系统的能量可以表示如下:

    $$\begin{split} E = \;&\frac{1}{2}{{{\dot{\boldsymbol{q}}}}^{\rm{T}} }M({\boldsymbol{q}}){\dot{\boldsymbol{q}}} + mg\left[ \frac{l}{2}\left( {\frac{1}{{{c_{1d}}}} - {c_1}} \right)+ \right.\\ & \left.\frac{l}{2}\left( {\frac{1}{{{c_{2d}}}} - {c_2}} \right) + b(1 - {c_3}) \right] \geq 0 \end{split} $$ (12)

    基于系统的无源性, 对式(12)求导可以得到:

    $$\dot E = {F_x}\dot x + \left( {{F_l} + \frac{{mg}}{{2{c_{1d}}}} + \frac{{mg}}{{2{c_{2d}}}}} \right)\dot l$$ (13)

    为了引入负载摆动信息, 采用式(8)中构造的综合反馈项${\chi _p}$代替式(13)中的位置反馈项$x,$ 得到如下结果:

    $$ \begin{split} {{\dot E}_n} =\;& {F_x}{{\dot \chi }_p} + (1 + k)\left( {{F_l} + \frac{{mg}}{{2{c_{1d}}}} + \frac{{mg}}{{2{c_{2d}}}}} \right)\dot l =\\ &\dot E + {{\dot E}_a} \end{split} $$ (14)

    其中

    $$ \begin{split} {{\dot E}_a} =\;& {F_x}\left[ {{\lambda _1}(\dot l{s_1} \!+\! l{c_1}{{\dot \theta }_1}) \!+\! {\lambda _2}(\dot l{s_2}\! +\! l{c_2}{{\dot \theta }_2}) \!+\! {\lambda _3}{c_3}{{\dot \theta }_3}} \right]+ \\ &k\left( {{F_l} + \frac{{mg}}{{2{c_{1d}}}} + \frac{{mg}}{{2{c_{2d}}}}} \right)\dot l \\[-10pt]\end{split} $$ (15)

    结合式(13)可以得到:

    $${E_n} = E + {E_a}$$ (16)

    ${E_a}$反映了通过综合反馈项${\chi _p}$引入的负载摆动能量信息, 其与系统原有能量$E$组合在一起构成了广义能量函数${E_n}$, 附录A中证明了${E_n}$为一非负函数, 因此可以构造李雅普诺夫候选函数如下:

    $$V = {E_n} + \frac{1}{2}{k_\alpha }\varepsilon _p^2 + \frac{{1 + k}}{2}{k_p}\varepsilon _l^2$$ (17)

    对式(17)求导, 结合式(11)与式(14)中的结论得到:

    $$ \begin{split} \dot V =\;& ({F_x} + {k_\alpha }{\varepsilon _p}){{\dot \varepsilon }_p} +\\ & (1 + k)\left( {{F_l} + \frac{{mg}}{{2{c_{1d}}}} + \frac{{mg}}{{2{c_{2d}}}} + {k_p}{\varepsilon _l}} \right){{\dot \varepsilon }_l} \end{split} $$ (18)

    根据式(18)的结构, 控制器可以设计为如下形式:

    $$\begin{split} &{F_x} = - {k_\alpha }{\varepsilon _p} - {k_\beta }{{\dot \varepsilon }_p} \\ &{F_l} = - {k_p}{\varepsilon _l} - {k_d}{{\dot \varepsilon }_l} - \frac{{mg}}{{2{c_{1d}}}} - \frac{{mg}}{{2{c_{2d}}}} \end{split} $$ (19)

    其中${k_\alpha },\;{k_\beta },\;{k_p},\;{k_d}$均为正控制增益.

    定理 1. 对于文中提出的四绳轮胎式起重机模型, 式(19)中提出的非线性控制器能够保证系统状态渐近收敛于期望平衡点, 也即:

    $$\mathop {\lim }\limits_{t \to \infty } {\left[ {x \; l \;{\theta _1} \; \dot x \;\dot l \; {{\dot \theta }_1}} \right]^{\rm{T}} } = {\left[ {{x_d} \; {l_d} \;\arcsin \left(\frac{{d - a}}{{{l_d}}}\right) \;0 \; 0 \; 0} \right]^ {\rm{T}} }$$ (20)

    证明. 将所设计的控制输入(19)代入式(18)中, 可以得到:

    $$\dot V = - {k_\beta }\dot \varepsilon _p^2 - (1 + k){k_d}\dot \varepsilon _l^2 \leq 0$$ (21)

    进一步得到:

    $$ V \in {L_\infty } \Rightarrow \dot x, \dot l, {{\dot \theta }_1}, {{\dot \theta }_2}, {{\dot \theta }_3}, x, l, {\varepsilon _p}, {\varepsilon _l} \in {L_\infty } $$ (22)

    为了完成证明, 定义如下集合:

    $$\Omega = \left\{ {(x, l, {\theta _1}, {\theta _2}, {\theta _3}, \dot x, \dot l, {{\dot \theta }_1}, {{\dot \theta }_2}, {{\dot \theta }_3})|\dot V(t) = 0} \right\}$$ (23)

    定义$\Phi $$\Omega $中的最大不变集, 则基于最大不变集特性可以得到$\dot V(t) = 0$时在集合$\Phi $中有如下结论成立:

    $$\dot V = - {k_\beta }\dot \varepsilon _p^2 - (1 + k){k_d}\dot \varepsilon _l^2 = 0$$ (24)

    考虑到$k,\;\;{k_\beta },\;{k_d}$均为正控制增益, 可以得到:

    $$\left\{\begin{aligned} {{\dot \varepsilon }_p} =\;& \dot x + {\lambda _1}(\dot l{s_1} + l{c_1}{{\dot \theta }_1}) + {\lambda _2}(\dot l{s_2} + l{c_2}{{\dot \theta }_2}) +\\ &{\lambda _3}{c_3}{{\dot \theta }_3} = 0 \\ {{\dot \varepsilon }_l} =\;& \dot l = 0 \end{aligned}\right. $$ (25)

    从而可以得到:

    $${\varepsilon _p} = {\chi _p} - {x_d} = {\gamma _1}, \;\; {\ddot \varepsilon _p} = 0$$ (26)
    $${\varepsilon _l} = l - {l_d} = {\varLambda _1}, \;\;\;\; {\ddot \varepsilon _l} = \ddot l = 0$$ (27)

    其中${\gamma _1}$${\varLambda _1}$均为待确定的常数, 结合式(19)与式(25) ~ (27), 可以进一步得到:

    $$\left\{\begin{aligned} &{F_x} = - {k_\alpha }{\gamma _1} \\ &{F_l} = - {k_p}{\varLambda _1} - \frac{{mg}}{{2{c_{1d}}}} - \frac{{mg}}{{2{c_{2d}}}} \end{aligned}\right. $$ (28)

    根据式(11)中的定义与式(26)中的结论, ${\ddot \varepsilon _p}$可以表示为如下形式:

    $$\begin{split} {{\ddot \varepsilon }_p} =\;& \ddot x + {\lambda _1}({s_1}\ddot l + l{c_1}{{\ddot \theta }_1} + 2{c_1}{{\dot \theta }_1}\dot l - l{s_1}\dot \theta _1^2)+ \\ &{\lambda _2}({s_2}\ddot l + l{c_2}{{\ddot \theta }_2} + 2{c_2}{{\dot \theta }_2}\dot l - l{s_2}\dot \theta _2^2)+ \\ & {\lambda _3}({c_3}{{\ddot \theta }_3} - l{s_3}\dot \theta _3^2) = 0 \end{split} $$ (29)

    将式(9)代入式(29), 可以进一步得到:

    $$ \begin{split} \frac{{M + m}}{k}\ddot x =\;& \frac{1}{2}m({s_1} + {s_2})\ddot l + \frac{1}{2}ml{c_1}{{\ddot \theta }_1} + \frac{1}{2}ml{c_2}{{\ddot \theta }_2}- \\ & mb{c_3}{{\ddot \theta }_3} - \frac{1}{2}ml{s_1}\dot \theta _1^2 - \frac{1}{2}ml{s_2}\dot \theta _2^2 +\\ & mb{s_3}\dot \theta _3^2 + m{c_1}{{\dot \theta }_1}\dot l + m{c_2}{{\dot \theta }_2}\dot l \\[-8pt]\end{split} $$ (30)

    同时将矩阵形式的式(6)展开, 可以得到如下结论:

    $$ \begin{split} {F_x} =\;& (M + m)\ddot x + \frac{1}{2}m({s_1} + {s_2})\ddot l + \frac{1}{2}ml{c_1}{{\ddot \theta }_1}+ \\ & \frac{1}{2}ml{c_2}{{\ddot \theta }_2} - mb{c_3}{{\ddot \theta }_3} - \frac{1}{2}ml{s_1}\dot \theta _1^2 - \frac{1}{2}ml{s_2}\dot \theta _2^2 +\\ & mb{s_3}\dot \theta _3^2 + m{c_1}{{\dot \theta }_1}\dot l + m{c_2}{{\dot \theta }_2}\dot l\\[-8pt] \end{split} $$ (31)

    结合式(30)与式(31), 再将式(28)的结论代入, 得到:

    $$\ddot x = - \frac{k}{{(k + 1)(M + m)}}{k_\alpha }{\gamma _1}$$ (32)

    将式(32)两边对时间积分, 有如下结论:

    $$\dot x = - \frac{k}{{(k + 1)(M + m)}}{k_\alpha }{\gamma _1}t + {\gamma _2}$$ (33)

    ${\gamma _2}$同样为待定常数. 如果${\gamma _1} \ne 0$, 那么$t \to \infty $$\dot x(t) \to \infty $, 这与式(22)中$\dot x(t) \in {L_\infty }$相矛盾, 因此可以得到${\gamma _1} = 0$, 从而有如下结论成立:

    $$\ddot x, {\varepsilon _p}, {F_x} = 0, \dot x = {\gamma _2} \;\; \Rightarrow \;\; x = {\gamma _2}t + {\gamma _3}$$ (34)

    ${\gamma _3}$同样为待定常数, 与证明${\gamma _1} = 0$的过程相似, 同理可以得到:

    $$\dot x = {\gamma _2} = 0, \;\; x = {\gamma _3}$$ (35)

    基于式(21) ~ (35)的分析, 可以得到的结论为:

    $$\dot x, \; \ddot x, \; \dot l, \; \ddot l, \; {F_x} = 0$$ (36)

    接下来证明在最大不变集$\Phi $中有如下结论:

    $$ \begin{split} &x(t) = {x_d}, \; l(t) = {l_d}, \; {{\dot \theta }_1}(t) = {{\dot \theta }_2}(t) = {{\dot \theta }_3}(t) = 0 \\ &{\theta _1}(t) = \arcsin \left( {\frac{{d - a}}{{{l_d}}}} \right) = - {\theta _2}(t), {\theta _3}(t) = 0 \end{split} $$

    结合式(25)与式(36)可以得到:

    $${\lambda _1}l{c_1}{\dot \theta _1} + {\lambda _2}l{c_2}{\dot \theta _2} + {\lambda _3}{c_3}{\dot \theta _3} = 0$$ (37)

    再代入式(9)得到:

    $$l{c_1}{\dot \theta _1} + l{c_2}{\dot \theta _2} - 2b{c_3}{\dot \theta _3} = 0$$ (38)

    将式(6)两端同乘${\dot{\boldsymbol{q}}^ {\rm{T}} }$并展开, 再将式(36)中的结论代入得到:

    $$ \begin{split} &\frac{{\rm{d}}}{{{\rm{d}}t}}\left[ \begin{aligned} & \frac{1}{8}m{l^2}(\dot \theta _1^2 + \dot \theta _2^2) + \frac{1}{2}m{b^2}\dot \theta _3^2 + \frac{1}{4}m{l^2}{c_{1 - 2}}{{\dot \theta }_1}{{\dot \theta }_2}- \\ & \frac{1}{2}mbl{c_{1 + 3}}{{\dot \theta }_1}{{\dot \theta }_3} - \frac{1}{2}mbl{c_{2 + 3}}{{\dot \theta }_2}{{\dot \theta }_3} \end{aligned} \right] +\\ & \quad\qquad mg\left( {\frac{l}{2}{s_1}{{\dot \theta }_1} + \frac{l}{2}{s_2}{{\dot \theta }_2} + b{s_3}{{\dot \theta }_3}} \right) = 0 \\[-15pt]\end{split} $$ (39)

    经过简化, 根据式(38)的结论, 式(39)可以进一步整理为:

    $$\begin{split} &\frac{{\rm{d}}}{{{\rm{d}}t}}[{(l{s_1}{{\dot \theta }_1} + l{s_2}{{\dot \theta }_2} + 2b{s_3}{{\dot \theta }_3})^2}] +\\ & \qquad4g(l{s_1}{{\dot \theta }_1} + l{s_2}{{\dot \theta }_2} + 2b{s_3}{{\dot \theta }_3}) = 0 \end{split} $$ (40)

    为了便于后续的表述, 定义中间变量$H = l{s_1}{\dot \theta _1} + $$ l{s_2}{\dot \theta _2} + 2b{s_3}{\dot \theta _3} \in {L_\infty }$, 则式(40)可以写为如下形式:

    $$2H\dot H + 4gH = 0$$ (41)

    如果$H(t) \ne 0$, 则可以得到:

    $$\dot H = - 2g \;\; \Rightarrow \;\; H = - 2gt + {\gamma _4}$$ (42)

    $t \to \infty $$H(t) \to \infty $, 与前述$H \in {L_\infty }$的结果相矛盾, 因此可以得到:

    $$H = l{s_1}{\dot \theta _1} + l{s_2}{\dot \theta _2} + 2b{s_3}{\dot \theta _3} = 0$$ (43)

    结合式(3)与式(36), 式(43)可以表示为:

    $$H = (l{s_1} + l{s_2}{h_\theta } + 2b{s_3}{g_\theta }){\dot \theta _1} = 0$$ (44)

    此时可以得到 $l{s_1} + l{s_2}{h_\theta } + 2b{s_3}{g_\theta } = 0$ ${\dot \theta _1} = $$ 0$, 首先假设${\dot \theta _1} = 0$, 则根据式(3)与式(36)中 $\dot l = $$ 0$ 的结论, 得到:

    $${\dot \theta _1}, {\dot \theta _2}, {\dot \theta _3} = 0 \;\; \Rightarrow \;\; {\ddot \theta _1}, {\ddot \theta _2}, {\ddot \theta _3} = 0$$ (45)

    将式(45)中的结论代入式(6), 再结合$\ddot x, \ddot l = 0$, 得到:

    $$l{s_1} + l{s_2}{h_\theta } + 2b{s_3}{g_\theta } = 0$$ (46)

    因此, 无论${\dot \theta _1}$是否为0, 式(46)中的结论恒成立, 再将式(4)代入式(46), 得到:

    $$\frac{{a{c_{2 + 3}}{s_1} + a{c_{1 + 3}}{s_2} + b{s_{1 - 2}}{s_3}}}{{a{c_{2 + 3}}}} = 0$$ (47)

    根据之前提出的假设$ - \dfrac{\pi }{2} < ({\theta _2} + {\theta _3}) < \dfrac{\pi }{2}$, 得到$a{c_{2 + 3}} > 0$, 再基于式(1) ~ (2)的约束关系, 得到如下方程组:

    $$\left\{ \begin{aligned} &l{s_1} + 2a{c_3} - l{s_2} - 2d = 0 \\ &l{c_1} + 2a{s_3} - l{c_2} = 0 \\ & a({c_{2 + 3}}{s_1} + {c_{1 + 3}}{s_2}) + b{s_{1 - 2}}{s_3} = 0 \end{aligned} \right.$$ (48)

    根据文献[20]中的分析, 可以确定上述方程组仅在${\theta _3} = 0$时有解, 解为如下形式:

    $${\theta _3} = 0, {\theta _1} = \arcsin \left( {\frac{{d - a}}{{{l_d}}}} \right) = - {\theta _2}$$ (49)

    由此可以得到${\dot \theta _1}, {\dot \theta _2}, {\dot \theta _3}, {\ddot \theta _1}, {\ddot \theta _2}, {\ddot \theta _3} = 0$, 同时, 将上述结果代入式(6)的系统动力学方程, 得到:

    $${F_l} = - \frac{{mg}}{{2{c_{1d}}}} - \frac{{mg}}{{2{c_{2d}}}}$$ (50)

    结合式(28)中的分析, 得到:

    $${\varLambda _1} = 0 \;\; \Rightarrow \;\; {\varepsilon _l} = 0 \;\; \Rightarrow \;\; l = {l_d}$$ (51)

    再由式(34)与式(49)中的结论得到:

    $${\varepsilon _p} = 0 \;\; \Rightarrow \;\; x = {x_d}$$ (52)

    基于式(36)以及式(49) ~ (52)的分析, 证明系统平衡点是渐近稳定的.

    在经过理论分析与实验室先期测试后, 本文选取港口的40.5 t四绳轮胎式集装箱起重机作为实验平台, 通过长距离、短距离、空载及带箱等多种作业模式对控制算法进行测试, 并采集熟练司机作业时的各项数据作为对比.

    在港口实际作业流程中, 集装箱会在集卡车道与堆场内的六个箱位间移动, 因此长距离运送选取集卡车道到六号箱位作为台车运动路径, 短距离运送则选取集卡车道到三号箱位为台车运动路径, 同时台车运动过程中绳长也在不断变化, 最大程度地贴合现场作业情况, 实验平台如图2所示.

    图 2  四绳轮胎式集装箱起重机
    Fig. 2  Four-rope rubber-tyre container crane

    四绳轮胎式集装箱起重机原有的人工作业架构通过可编程逻辑控制器 (Programmable logic controller, PLC) 完成控制, 编码器将台车和吊具的速度及位置等各项信息传回PLC, 同时PLC接收驾驶员的指令控制电机. 算法控制则是在原有架构上增加惯性测量单元 (Inertial measurement unit, IMU)与工控机等设备, IMU安装在吊具上方, 测量负载摆动角度${\theta _3}$, 再由式(1)与式(2)中的约束关系计算得到${\theta _1}$${\theta _2}$, 工控机负责收集反馈信息并向PLC下发控制指令, 控制结构如图3所示. 整个控制算法基于Windows 10系统下的Visual Studio 2015平台开发, 通过C语言实现. 为了便于现场的调试工作, 控制算法暂时运行在工控机上, 通过Modbus通讯协议与PLC进行数据交互, 效果稳定后会将算法直接集成到PLC当中, 简化控制架构, 提高通信稳定性.

    图 3  控制架构
    Fig. 3  Control architecture

    需要说明的是, 由于实际起重机设备采用速度控制的方式来驱动电机, 算法在应用中做出了部分调整: 首先将控制器计算出的驱动力转换为加速度, 再通过积分处理为速度指令下发, 控制器的各项参数如下:

    $$ {k_\alpha } = 200, \; {k_\beta } = 320, \;{k_p} = 100, \; {k_d} = 140, \; k = 10 $$

    实验平台各项参数如下:

    $M = 45 \;{\rm{t}}, m = 21 \;{\rm{t}}$(无箱状态下为$13.5 \;{\rm{t}}$), $2a = $$ 1 \;{\rm{m}}, 2d = 3 \;{\rm{m}}, b = 1.4 \;{\rm{m}}$

    首先是长距离无箱运送时算法与人工控制的效果对比, 选取集卡车道到六号箱位作为台车运动路径 (从距离起始点0.5 m处运动至17.5 m处), 同时吊具从距地面15 m处下降8 m, 模拟实际作业中空吊具移动到目标箱位上方准备抓箱的任务.

    图4中可以看到, 人工作业时台车和吊绳都难以精准到达指定位置. 负载摆角也没有得到很好的抑制, 表1列出了相关数据对比, 人工控制时台车与起升位置误差均达到了20 cm以上, 而在下一步的对箱操作 (吊具与集装箱进行锁孔对接) 中, 台车最大容许误差为5 cm, 此时则需要对台车位置进行微小调整, 这将对后续操作的效率造成很大影响, 而算法控制时台车位置误差为4 cm, 最大摆角为1.1度, 不仅在定位精度上有极大提高, 作业用时也缩短了7秒左右.

    图 4  长距离无箱运送实验结果
    Fig. 4  Results of long-distance transportation without container
    表 1  不同作业模式下数据对比
    Table 1  Data comparison of different operation modes
    作业模式台车位置
    误差 (cm)
    起升高度
    误差 (cm)
    最大摆
    角 (°)
    作业用
    时 (s)
    长距离无箱运送人工控制24232.631.8
    算法控制411.123.9
    长距离带箱运送人工控制43733.132.7
    算法控制401.424.6
    短距离带箱运送人工控制15672.523.8
    算法控制221.217.3
    下载: 导出CSV 
    | 显示表格

    长距离带箱运送的实验结果如图5所示, 台车和吊具的运动路径与无箱运送时相同, 吊具下方载有7.5 t的集装箱, 模拟实际作业中抓取集装箱后移动到目标位置准备放箱的任务. 从表1中可以得到, 带箱运送时人工作业的定位精度更低, 台车误差达到了40 cm以上, 负载最大摆动也超过3度. 相比之下, 算法控制则在带箱与无箱状态下都具有良好的效果, 负载质量的变化对定位精度及负载摆幅影响不大, 证明算法具有较强的鲁棒性与稳定性, 适合工业场景下的应用.

    图 5  长距离带箱运送实验结果
    Fig. 5  Results of long-distance transportation with container

    短距离运送选取集卡车道到三号箱位为台车运动路径 (距离起始点0.5 m处运动至9.5 m处), 同时吊具从14.7 m处下降6 m.

    实验结果如图6所示, 可以看到, 人工操作时台车位置会有15 cm左右的超调, 这意味着在目标箱位上方来回移动台车, 将会造成时间的浪费与吊具的摆动, 而算法控制在短距离运送时仍然具有良好的效果, 负载最大摆角不超过1.2度, 可以在集装箱稳定的前提下保证台车与吊具的精准到位.

    图 6  短距离带箱运送实验结果
    Fig. 6  Results of short-distance transportation with container

    综合以上分析, 算法控制在无箱与带箱运送时都能够保证台车的精准到位及绳长变化情况下负载摆幅的有效抑制, 说明控制算法在集装箱质量发生变化时也具有良好的消摆能力. 在作业时长方面, 短距离运送下算法控制作业时间相较于人工缩短6秒, 长距离运送时间则缩短8秒左右, 效率提升约25 %, 具有良好的实际应用前景.

    为了解决四绳起重机运送过程中摆幅较大的问题, 提高港口装卸集装箱的作业效率, 文章在多绳起重机模型分析的基础上, 将绳长作为变量引入到控制算法的设计当中, 根据起重机动力学特性设计了一种非线性控制器, 可以在确保台车、吊绳精准到位的情况下大幅抑制集装箱的摆动, 并基于Lyapunov方法证明了其在期望平衡点处的渐近稳定性. 最终, 在港口的实际起重机设备上进行了实验验证, 在精准性、安全性、作业效率等方面相较人工操作都有了很大程度的提升. 未来会增加视觉检测、轨迹规划等功能来完善控制算法, 实现集装箱从检测到移动的完整作业流程, 为建设自动化港口提供一些新的方案.

    致谢

    感谢广东省机器人与智能系统重点实验室, 中国科学院深圳先进技术研究院对本工作的支持!

    附录A

    对于式(15)中的${\dot E_a}$, 可以将其分为如下两个部分:

    $${\dot E_a} = {\dot D_1} + {\dot D_2}\tag{A1}$$

    其中

    $$ \begin{split} {{\dot D}_1} =\;& [{F_x} - (M + m)\ddot x][{\lambda _1}(\dot l{s_1} + l{c_1}{{\dot \theta }_1})\;+ \\ & {\lambda _2}(\dot l{s_2} + l{c_2}{{\dot \theta }_2}) + {\lambda _3}{c_3}{{\dot \theta }_3}] \\ {{\dot D}_2} =\;& (M + m)\ddot x[{\lambda _1}(\dot l{s_1} + l{c_1}{{\dot \theta }_1}) \;+\\ & {\lambda _2}(\dot l{s_2} + l{c_2}{{\dot \theta }_2}) + {\lambda _3}{c_3}{{\dot \theta }_3}] + k\left( {{F_l} + \frac{{mg}}{{{c_{1d}}}}} \right)\dot l \end{split} \tag{A2}$$

    经过积分、移项等处理, 最终得到:

    $$ \begin{split} {D_1} = \;&- \frac{{km}}{{2(M + m)}}\bigg[\frac{1}{4}m{({s_1} + {s_2})^2}{{\dot l}^2} + \frac{1}{4}m{l^2}c_1^2\dot \theta _1^2 \;+\\ & \frac{1}{4}m{l^2}c_2^2\dot \theta _2^2 + m{b^2}c_3^2\dot \theta _3^2 + \frac{1}{2}ml({s_1} + {s_2}){c_1}{{\dot \theta }_1}\dot l\; +\\ & \frac{1}{2}ml({s_1} + {s_2}){c_2}{{\dot \theta }_2}\dot l - mb({s_1} + {s_2}){c_3}{{\dot \theta }_3}\dot l \;+\\ & \frac{1}{2}m{l^2}{c_1}{c_2}{{\dot \theta }_1}{{\dot \theta }_2} - mbl{c_1}{c_3}{{\dot \theta }_1}{{\dot \theta }_3} - mbl{c_2}{c_3}{{\dot \theta }_2}{{\dot \theta }_3}\bigg] \\ {D_2} =\;& \frac{k}{2}\bigg[\frac{1}{4}m{l^2}\dot \theta _1^2 + \frac{1}{4}m{l^2}\dot \theta _2^2 + m{b^2}\dot \theta _3^2 \;+\\ &\frac{1}{2}m(1 + {c_{1 - 2}}){{\dot l}^2} - \frac{1}{2}ml{s_{1 - 2}}{c_2}{{\dot \theta }_1}\dot l \;+\\ &\frac{1}{2}ml{s_{1 - 2}}{{\dot \theta }_2}\dot l - mb({s_{1 + 3}} + {s_{2 + 3}}){{\dot \theta }_3}\dot l \;+\\ & \frac{1}{2}m{l^2}{c_{1 - 2}}{{\dot \theta }_1}{{\dot \theta }_2} - mbl{c_{1 + 3}}{{\dot \theta }_1}{{\dot \theta }_3} - mbl{c_{2 + 3}}{{\dot \theta }_2}{{\dot \theta }_3}\bigg] \end{split} \tag{A3}$$

    考虑到$0 < \frac{m}{{M + m}} < 1$以及$k > 0$, 可以得到:

    $$\begin{split} {D_1} + {D_2} \geq\;& \frac{{km}}{2}{\left( {\frac{l}{2}{s_1}{{\dot \theta }_1} + \frac{l}{2}{s_2}{{\dot \theta }_2} + b{s_3}{{\dot \theta }_3}} \right)^2}+ \\ & kmg[\frac{l}{2}\left( {\frac{1}{{{c_{1d}}}} - {c_1}} \right) + \frac{l}{2}\left( {\frac{1}{{{c_{2d}}}} - {c_2}} \right) +\\ & b(1 - {c_3})] \geq 0 \end{split} \tag{A4}$$

    结合式(A1), 式(A4)可以得到:

    $$\small{{E_a} \geq 0 \;\; \Rightarrow \;\; {E_n} = E + {E_a} \geq 0}\tag{A5}$$

  • 本文责任编委 陈积明
  • 图  1  系统模型

    Fig.  1  System model

    图  2  位置关系

    Fig.  2  Position relationship

    图  3  Drones cube中无人机空基监测平台立体结构

    Fig.  3  The three-dimensional structure of the air based monitoring platform for unmanned aerial vehicle in drones cube

    图  4  不同分布的最佳路径点$(h_{\text{min}} = 160 \text{m})$

    Fig.  4  The optimal path points in different distribution condition $(h_{\text{min}} = 160 \text{m})$

    图  5  三种Drones cube分布下的MES移动距离

    Fig.  5  MES moving distance under three kinds of drones cube distribution

    图  6  不同分布的Drones cube静态通信能量$(H = 160 \text{m})$

    Fig.  6  Static communication energy under different kinds of Drones cube distribution $(H = 160 \text{m})$

    图  7  直线分布Drones cube静态通信能耗纵向不均衡率

    Fig.  7  Vertical disequilibrium rate of energy consumption in Drones cube static communication under linear distribution

    图  8  三种Drones cube分布下的静态通信能耗增长率

    Fig.  8  Energy consumption growth rate of static communication under three kinds of Drones cube distribution

    图  9  直线分布的Drones cube静态通信能耗与HD的关系

    Fig.  9  The relationship between the energy consumption of drones cube static communication and H and D

    图  10  直线分布的Drones cube静态通信能耗拟合

    Fig.  10  Energy consumption fitting of drones cube static communication under linear distribution

    图  11  直线分布的Drones cube动态通信能耗$(H = 150, D = 75)$

    Fig.  11  Dynamic communication energy consumption of drones cube under linear distribution$(H = 150, D = 75)$

    表  1  国内外相关研究

    Table  1  Related works

    文献 内容 网络类型 无人机数量 不足
    [4] 无人机最优部署与移动 D2D通信网络 一个 未研究上行通信
    [5] 无人机最优轨迹 Ad-hoc网络 多个 未研究无人机运动
    [6] 静态地面用户与无人机联合最优部署 IoT (Internet of things) 多个 未研究地面用户的动态问题
    [7] 高效地数据采集与簇头充电方法 WSN (Wireless sensor networks) 多个 只针对静态传感网, 未研究最优部署问题
    [8-9] 节能的上行传输策略 IoT M2M (Machine-to machine)网络 未考虑设备的运动
    [10-11] 过载和中断预防方法 蜂窝网络 多个 未研究无人机覆盖性能
    [12] 无人机最优轨迹 WSN 多个 只针对静态传感设备
    [13-14] 蜂窝网与D2D (Device-to-device)设备共存 蜂窝网络 一个 未研究无人机的覆盖和通信性能
    下载: 导出CSV

    表  2  仿真参数

    Table  2  Simulation parameters

    参数 描述
    $f_{c}$ 载波频率 $\text{2 GHz}$
    $v_{\cdot}^{t}$ 地面移动中继的速度 $\text{3.6 km/h}$
    $E$ 各簇旋翼无人机用于通信总能量 $\text{3 J}$
    $\delta$ 误码率要求 $10^{-8}$
    $\varepsilon$ 视距通信概率要求 0.95
    $N_{\text{o}}$ 噪声功率谱密度 $-170$ dBm/Hz
    $R_{\text{b}}$ 数据传输速率 $\text{200 kbps}$
    $B$ 传输带宽 $\text{200 kHz}$
    $\eta$ 附加路径损耗 $\text{5 dB}$
    $\psi$ 环境参数1 11.95
    $\beta$ 环境参数2 0.14
    下载: 导出CSV

    表  3  旋翼无人机数量与算法运行时长

    Table  3  Number of drones and algorithm running 09:39:56

    分布形式 数量$K$ 算法运行时长$(\text{s})$ 平均时长$(\text{s})$
    第1次 第2次 第3次 第4次 第5次
    直线 96 10.773 10.722 10.683 10.731 10.689 10.719
    108 10.788 10.753 10.761 10.742 10.814 10.772
    120 10.795 10.821 10.728 10.801 10.722 10.773
    三角 96 10.821 10.791 10.844 10.861 10.742 10.811
    108 10.994 11.069 10.711 10.670 10.781 10.845
    120 10.892 10.931 10.897 10.911 10.821 10.890
    圆形 96 10.873 10.810 10.822 10.789 10.867 10.832
    108 10.849 10.872 10.893 10.812 10.827 10.851
    120 10.974 10.912 10.812 10.832 10.844 10.874
    下载: 导出CSV

    表  4  Drones cube簇数与算法运行时长

    Table  4  Number of drones cube and algorithm running 09:42:00

    分布形式 簇数$L$ 算法运行时长$(\text{s})$ 平均时长$(\text{s})$
    第1次 第2次 第3次 第4次 第5次
    直线 3 10.644 10.685 10.673 10.731 10.508 10.648
    4 10.788 10.753 10.761 10.742 10.814 10.772
    5 10.821 10.876 10.824 10.897 10.933 10.870
    三角 3 10.878 10.787 10.709 10.801 10.822 10.799
    4 10.994 11.069 10.711 10.670 10.781 10.845
    5 10.892 10.977 11.021 10.709 10.898 10.899
    圆形 3 10.842 10.801 10.756 10.722 10.793 10.782
    4 10.849 10.872 10.893 10.812 10.827 10.851
    5 10.910 10.953 10.871 11.213 10.945 10.978
    下载: 导出CSV
  • [1] Mozaffari M, Saad W, Bennis M, et al. Mobile internet of things: can UAVs provide an energy-efficient mobile architecture. In: Proceeding of the 2016 IEEE Global Communications Conference (GLOBECOM). Piscataway, USA: IEEE, 2016. 1-6
    [2] Sánchez-García J, García-Campos J M, Arzamendia M, et al. A survey on unmanned aerial and aquatic vehicle multi-hop networks: Wireless communications, evaluation tools and applications. Computer Communications, 2018, 119: 43-65 http://www.sciencedirect.com/science/article/pii/S0140366416304315
    [3] Jawhar I, Mohamed N, Al-Jaroodi J, et al. Communication and networking of UAV-based systems: Classification and associated architectures. Journal of Network and Computer Applications, 2017, 84: 93-108 doi: 10.1016/j.jnca.2017.02.008
    [4] Mozaffari M, Saad W, Bennis M, and et al. Unmanned aerial vehicle with underlaid device-to-device communications: Performance and tradeoffs. IEEE Transaction on Wireless Communications, 2016, 15 (6): 3949-3963 doi: 10.1109/TWC.2016.2531652
    [5] Han Z, Swindlehurst A L, Liu K. Optimization of MANET connectivity via smart deployment/movement of unmanned air vehicles. IEEE Transaction on Vehicular Technology, 2009, 58 (7): 3533-3546 doi: 10.1109/TVT.2009.2015953
    [6] Mozaffari M, Saad W, Bennis M, et al. Optimal transport theory for power-efficient deployment of unmanned aerial vehicles. In: Proceeding of the 2016 IEEE International Conference on Communications (ICC). Piscataway, USA: IEEE, 2016. 1-6
    [7] Pang Y, Zhang Y, Gu Y, et al. Efficient data collection for wireless rechargeable sensor clusters in harsh terrains using UAVs. In: Proceeding of the 2016 IEEE Global Communications Conference (GLOBECOM). Piscataway, USA: IEEE, 2014. 234-239
    [8] Abuzainab N, Saad W, Poor H V. Cognitive hierarchy theory for heterogeneous uplink multiple access in the internet of things. In: Proceeding of the 2016 IEEE International Symposium on Information Theory (ISIT). Piscataway, USA: IEEE, 2016. 1252-1256
    [9] Tu C Y, Ho C Y, Huang C Y. Energy-efficient algorithms and evaluations for massive access management in cellular based machine to machine communications. In: Proceeding of the 2011 IEEE Vehicular Technology Conference (VTC). Piscataway, USA: IEEE, 2011. 1-5
    [10] Daniel K, Wietfeld C. Using public network infrastructures for UAV remote sensing in civilian security operations. Tech. Rep., 2011
    [11] Rohde S, Wietfeld C. Interference aware positioning of aerial relays for cell overload and outage compensation. In: Proceeding of the 2012 IEEE Vehicular Technology Conference (VTC). Piscataway, USA: IEEE, 2012. 1-5
    [12] Jiang F, Swindlehurst A L. Optimization of UAV heading for the ground-to-air uplink. IEEE Journal on Selected Areas in Communications, 2012, 30 (5): 993-1005 doi: 10.1109/JSAC.2012.120614
    [13] Shalmashi S, Bjornson E, Kountouris M, et al. Energy efficiency and sum rate tradeoffs for massive MIMO systems with underlaid device-to-device communications. EURASIP Journal on Wireless Communications and Networking, 2016, 2016 (1): 175 doi: 10.1186/s13638-016-0678-1
    [14] Lin X, Heath R, Andrews J. The interplay between massive MIMO and underlaid D2D networking. IEEE Transaction on Wireless Communications, 2015, 14 (6): 1-10 doi: 10.1109/TWC.2015.2434891
    [15] 白天翔, 王帅, 沈震, 等. 平行机器人与平行无人系统: 框架、结构、过程、平台及其应用. 自动化学报, 2017, 43 (2): 161-175 doi: 10.16383/j.aas.2017.y000002

    Bai Tian-Xiang, Wang Shuai, Shen Zhen, et al. Parallel robotics and parallel unmanned systems: Framework, structure, process, platform and applications. Acta Automatica Sinica, 2017, 43 (2): 161-175 doi: 10.16383/j.aas.2017.y000002
    [16] 胡向东, 王瑞, 胡蓉. 一种改进的物联网感知层簇维护优化算法. 系统工程与电子技术, 2017, 39 (1): 198-205 https://www.cnki.com.cn/Article/CJFDTOTAL-XTYD201701031.htm

    Hu Xiang-Dong, Wang Rui, Hu Rong. Improved optimization algorithm of clusters maintenance for sensing layer of the internet of things. Systems Engineering and Electronics, 2017, 39 (1): 198-205 https://www.cnki.com.cn/Article/CJFDTOTAL-XTYD201701031.htm
    [17] 陈珍萍, 黄友锐, 唐超礼, 等. 物联网感知层低能耗时间同步方法研究. 电子学报, 2017, 44 (1): 193-199 https://www.cnki.com.cn/Article/CJFDTOTAL-DZXU201601028.htm

    Chen Zhen-Ping, Huang You-Rui, Tang Chao-Li, et al. Research on low energy consumption time synchronization method for internet of things' perception layer. Acta Electronica Sinica, 2016, 44 (1): 193-199 https://www.cnki.com.cn/Article/CJFDTOTAL-DZXU201601028.htm
    [18] Hourani A, Kandeepan S, Jamalipour A. Modeling air-to-ground path loss for low altitude platforms in urban environments. In: Proceeding of the 2014 IEEE Global Communications Conference (GLOBECOM). Piscataway, USA: IEEE, 2014. 2898-2904
    [19] Fei Z, Li B, Yang S, et al. A survey of multi-objective optimization in wireless sensor networks: metrics, algorithms and open problems. IEEE Communications Surveys & Tutorials, 2017, 19: 550-586 http://ieeexplore.ieee.org/document/7570253
    [20] 张霞, 周刚, 于宏毅. 一种协作和中继混合的传感网寿命最大化路由算法. 软件学报, 2013, 24 (12): 2859-2870 https://www.cnki.com.cn/Article/CJFDTOTAL-RJXB201312007.htm

    Zhang Xia, Zhou Gang, Yu Hong-Yi. Cooperative and forwarding hybrid routing algorithm for network lifetime maximization in wireless sensor network. Journal of Software, 2013, 24 (12): 2859-2870 https://www.cnki.com.cn/Article/CJFDTOTAL-RJXB201312007.htm
    [21] 侯定仁. 内点算法研究[硕士论文], 中国科学技术大学, 中国2001

    Hou Ding-Ren. Research on Interior-point Algorithm[Master thesis], University of Science and Technology of China, China 2001
    [22] 刘美杏. 不等式约束优化新型SQCQP算法研究[硕士论文], 广西大学, 中国2014

    Liu Mei-Xing. Research on New SQCQP Algorithms for Inequality Constrained Optimization[Master thesis], Guangxi University, China 2014
  • 期刊类型引用(10)

    1. 何培彬,马珂. 基于改进差分进化算法的起重机防摆控制技术. 机械与电子. 2024(01): 76-80 . 百度学术
    2. 李刚,马昕,李轾,李贻斌. 带有双球面摆和变绳长效应的桥式起重机轨迹规划. 自动化学报. 2024(05): 911-923 . 本站查看
    3. 商国旭,李航,王勋,朱晓杰. 塔式起重机负载能量耦合下消摆控制方法仿真. 计算机仿真. 2024(05): 446-449+511 . 百度学术
    4. 叶润青. 建筑用塔式起重机定位防摆自动控制方法研究. 工程机械与维修. 2024(06): 14-16 . 百度学术
    5. 文天赐,方勇纯,卢彪. 采用神经网络的双吊车自适应防摆控制. 自动化学报. 2023(01): 111-121 . 本站查看
    6. 吴世安,计三有. 桥式起重机起升系统非线性建模及仿真. 起重运输机械. 2023(07): 45-50 . 百度学术
    7. 王晓勇. 基于加速度传感器的起重机械制动器失效预警. 机械与电子. 2023(07): 57-61 . 百度学术
    8. 江雷,辛鹏,郭达明,钱武,周信,祝勇. 液压旋转起重塔吊伸缩臂瞬态动力学研究. 机械设计与制造工程. 2023(10): 41-45 . 百度学术
    9. 马珂,何培彬. 基于模糊PID融合的特种起重机伸缩臂自动控制. 机械与电子. 2023(11): 63-67 . 百度学术
    10. 冷祥彪,陈保刚,蒋亮,梁春宇,欧镜锋. 基于遗传算法的塔式起重机自动控制方法. 机械与电子. 2023(12): 43-47 . 百度学术

    其他类型引用(5)

  • 加载中
  • 图(11) / 表(4)
    计量
    • 文章访问数:  1107
    • HTML全文浏览量:  365
    • PDF下载量:  220
    • 被引次数: 15
    出版历程
    • 收稿日期:  2018-03-14
    • 录用日期:  2018-08-17
    • 刊出日期:  2021-08-20

    目录

    /

    返回文章
    返回