Course-keeping of inward-and-outward low speed ship
-
摘要: 为了在船舶进出港时, 船舶处于浅水域并以低速航行, 在风、浪等强扰动作用下, 增强航向控制性能, 减小能源损耗, 选择三阶Nomoto模型, 将航速和水深变化反映到模型参数的变化上, 基于闭环增益成形算法设计出一种具有适应性的鲁棒PID控制器, 建立基于风、浪干扰的非线性船舶运动数学模型, 并用S函数来实现。用PID控制器对非线性船舶运动数学模型进行控制, 在Simulink环境中对各种水深、船速及海况进行航向控制仿真。从仿真曲线可看出其航向跟踪效果良好, 静差为0, 且施舵合理, 所设计的控制器对非线性船舶运动数学模型具有良好的控制性能。Abstract: In order to improve ship control performance, reduce ship energy consumption when ship navigates at low speed in inward-and-outward shallow water under strong wind and wave disturbance, third-order Nomoto model was chosen, ship speed and water depth were reflected into the changes of its parameters, a robust PID controller with adaptability based on closed-loop gain shaping algorithm was designed.The nonlinear mathematical model of ship motion with wind and wave disturbance was built and realized through programming its S-function.The designed PID controller was used to control the nonlinear mathematical model of ship motion in the conditions of various water depths, ship speeds and sea states.The simulation result shows that the course-tracking effect is satisfactory, the steady state error is zero, the rudder angle is reasonable, and the designed controller has good performance for the nonlinear mathematical model.
-
0. 引言
板式轨道是20世纪60年代在日本新干线高速铁路上发展起来的一种新型轨道结构, 主要在日本铁路中使用, 中国在秦沈客运专线部分地段也铺设了板式轨道。长期以来, 有关板式轨道的研究多限于静力学分析。文献[1]将轨道板划分为许多三角形单元, 用有限元法[2]对板式轨道进行了静力分析。文献[3]用有限元法研究了单个和多个移动荷载下连续粘弹性基础支承长梁的动力响应。本文用有限元法分析板式轨道在移动荷载作用下的动力响应。板式轨道因其结构左右对称, 故可取一股钢轨进行研究。为了简化计算, 视板式轨道为钢轨为离散粘弹性支点支承的长梁, 轨道板为连续粘弹性基础支承的短梁, 见图 1。本文视板式轨道及移动荷载为一个系统, 运用弹性系统动力学总势能不变值原理[4~6]及形成矩阵的“对号入座”法则[5~7]建立该系统的振动方程组, 研究了移动荷载的速度、钢轨的类型和钢轨支点的弹性系数对钢轨及轨道板动力响应的影响。
1. 系统振动方程组的建立
文献[8]对建立系统振动方程的3种方法: 弹性系统动力学总势能不变值原理、Hamilton原理和Lagrange方程进行了比较分析, 指出了弹性系统动力学总势能不变值原理的正确性及优越性。由弹性系统动力学总势能不变值原理, 建立的系统有限元形式振动方程组为
[Μ]{¨q}+[C]{˙q}+[Κ]{q}={F(t)} (1)
式中: [M]、[C]、[K]分别为系统质量、阻尼、刚度矩阵; {¨q}、{˙q}、{q}分别为系统加速度、速度、位移列阵; {F (t) }为系统的节点荷载列阵。
1.1 单元划分和梁单元形函数
对于板式轨道, 钢轨(以下称为上层长梁) 总长为L, 梁单元长度取为上层长梁离散支点的间距, 用l表示, 设上层梁单元数为n1个, 则节点数为n1+1个。为计算方便, 所取的梁单元长度相等, 节点的位移为坐标轴内的竖向位移和转角位移, 忽略轴向变形, 则上层梁的自由度数为2n1+2个(暂不考虑上层梁的边界条件)。轨道板(以下称为下层短梁) 单元长度有2种, 每一根短梁端部两侧单元长度取为l/2, 其他单元长度取为l。忽略轴向变形, 只计节点在坐标轴内的竖向位移和转角位移, 设整个下层梁的单元数为n2个, 整个下层梁的节点数为n3个, 则整个下层梁的自由度数为2n3个(暂不考虑下层梁的边界条件), 那么, 系统的总自由度数为2 (n1+n3+1) 个。梁单元的节点力为剪力Q和弯矩M, 单元的节点位移为竖向位移y和转角位移y′ (小变形情况, 转角位移可视为竖向位移的一阶导数), 梁单元的节点力和节点位移见图 2, 图中节点力和节点位移的方向均为正。
梁单元弯曲形函数采用Hermitian 3次方插值函数, 在发生弯曲变形时, 梁单元内任一点的竖向位移y (x) 可用节点的竖向位移和转角位移表示
y(x)=[Ν]{qi}e (2)[Ν]=[Ν1 Ν2 Ν3 Ν4]{qi}e=[yi y′i yi+1 y′i+1]ΤΝ1=1-3(x/l)2+2(x/l)3Ν2=x-2x2/l+x/l2Ν3=3(x/l)2-2(x/l)3Ν4=-x2/l+x3/l2
1.2 系统参数计算
根据弹性系统动力学总势能不变值原理[4~6], 系统刚度矩阵、阻尼矩阵、质量矩阵、节点荷载列阵可由系统总势能的一阶变分导出。对于外荷载作用下的板式轨道整个系统, 将该系统进行有限元离散后, 系统总势能Π可用下式表示
Π=∑Uui+∑Ulj+∑Udi+∑Ucj+
∑Vui+∑Vlj+∑Vdi+∑Vcj+V (3)
式中: Uui为第i个上层梁单元(以下简称为第i个单元) 的弯曲应变能; Ulj为第j个下层梁单元(以下简称为第j个单元) 的弯曲应变能; Udi为第i个单元与第j个单元之间离散支点的弹簧应变能; Ucj为第j个单元下部的连续弹性基础应变能; Vui为第i个单元的惯性力势能; Vlj为第j个单元的惯性力势能; Vdi为第i个单元与第j个单元之间离散支点的粘滞阻尼力势能; Vcj为第j个单元下部的连续基础粘滞阻尼力势能; V为外荷载势能。
1.2.1 系统刚度矩阵的建立
第i个单元的弯曲应变能为
Uui=∫l012EuΙu[y″u(x)]2dx
式中: Eu为上层梁的弹性模量; Iu为上层梁对水平轴的惯性矩; y″u (x) 为上层梁单元内某点的曲率。对Uui变分, 可以得到上层梁单元的弯曲刚度矩阵[ku]e, 即
δUui=δ{qui}eΤ[ku]e{qui}e (4){qui}e=[yui y′ui yu(i+1) y′u(i+1)]Τ[ku]e=EuΙu∫l0[Ν″]Τ[Ν″]dx=EuΙu⋅ [12/l36/l2-12/l36/l26/l24/l-6/l22/l-12/l3-6/l212/l3-6/l26/l22/l-6/l24/l] (5)
式中: {qui}e为第i个单元的节点位移矢量列阵; δ{qui}eT为{qui}e的一阶变分的转置; [ku]e为上层梁单元的弯曲刚度矩阵.
同理得第j个单元弯曲应变能Ulj变分表达式
δUlj=δ{qlj}eΤ[kl]e{qlj}e (6){qlj}e=[ylj y′lj yl(j+1) y′l(j+1)]Τ
式中: {qlj}e为第j个单元的节点位移矢量列阵; δ{qlj}eT为{qlj}e的一阶变分的转置; [kl]e为下层梁单元的弯曲刚度矩阵, [kl]e的表达式与式(5) [ku]e相似, 只需将式(5) 中的EuIu换成ElIl即可, El为下层梁的弹性模量, Il为下层梁对水平轴的惯性矩。第i个单元与第j个单元之间支点的弹簧应变能为
Udi=12kd[(yui-ylj)2+(yu(i+1)-yl(j+1))2]
式中: kd为上下层梁之间离散支点弹簧的弹性系数; ylj、yl (j+1) 分别为第j个单元2个节点的竖向位移。
对Udi变分, 有
δUdi=kd (yui-ylj) (δyui-δylj) +kd (yu (i+1) -yl (j+1) ) (δyu (i+1) -δyl (j+1) ) =δyuikdyui+δyu (i+1) kdyu (i+1) +δyljkdylj+δyl (j+1) kdyl (j+1) -δyuikdylj-δyljkdyui-δyu (i+1) kdyl (j+1) -δyl (j+1) kdyu (i+1) (7)
第j个单元下部的连续弹性基础应变能为
Ucj=∫l012kc[yl(x)]2dx
式中: kc为连续弹性基础的弹性系数; yl (x) 为下层梁单元内某点的竖向位移。对连续弹性基础应变能Ucj变分, 可以得到连续弹性基础贡献的单元刚度矩阵[kc]e, 即
δUcj=δ{qlj}eΤ[kc]e{qlj}e (8)[kc]e=kc∫l0[Ν]Τ[Ν]dx=kcl420⋅ [15622l54-13l22l4l213l-3l25413l156-22l-13l-3l2-22l4l2] (9)
将式(4)、式(6) ~ (8) 按形成矩阵的“对号入座”法则[5~7]建立系统的刚度矩阵[K]。
1.2.2 系统阻尼矩阵的建立
第i个单元与第j个单元之间离散支点的粘滞阻尼力势能为
Vdi=cd[(˙yui-˙ylj)(yui-ylj)+(˙yu(i+1)-˙yl(j+1))⋅(yu(i+1)-yl(j+1)]
式中: cd为上下层梁之间离散支点的粘滞阻尼系数; ˙yui和˙yu(i+1)分别为第i个单元两端节点的竖向速度; ˙yli和˙yl(i+1)分别为第j个单元两端节点的竖向速度。对Vdi变分, 有
δVdi=cd(˙yui-˙ylj)(δyui-δylj)+cd(˙yu(i+1)-˙yl(j+1))⋅(δyu(i+1)-δyl(j+1))=δyuicd˙yui+δyu(i+1)cd˙yu(i+1)+δyljcd˙ylj+δyl(j+1)cd˙yl(j+1)-δyuicd˙ylj-δyljcd˙yui-δyu(i+1)cd˙yl(j+1)-δyl(j+1)cd˙yu(i+1) (10)
第j个单元下部连续基础粘滞阻尼力势能为
Vcj=∫l0cc˙yl(x)yl(x)dx
式中: cc为连续基础粘滞阻尼系数; ˙yl(x)为下层梁单元内某点的竖向速度。对Vcj变分, 可以得到连续基础粘滞阻尼贡献的单元阻尼矩阵[cc]e
δVci=δ{qlj}eΤ[cc]e{˙qlj}e (11){˙qlj}e=[˙ylj ˙y′lj ˙yl(j+1) ˙y′l(j+1)]Τ
式中: {˙qlj}e为第j个单元的节点速度矢量列阵。[cc]e的表达式与式(9) [kc]e相似, 只需将式(9) 中的kc换成cc即可。将式(10) 和式(11) 按形成矩阵的“对号入座”法则[5~7]建立系统的阻尼矩阵[C]。
1.2.3 系统质量矩阵的建立
第i个上层梁单元的惯性力势能为
Vui=∫l0ˉmu¨yu(x)yu(x)dx
式中: ˉmu为上层梁的单位长度质量; ¨yu(x)为上层梁单元内某点的加速度。对Vui变分, 可以得到上层梁单元的质量矩阵[mu]e, 即
δVui=δ{qui}eΤ[mu]e{¨qui}e (12) {¨qui}e=[¨yui ¨y′ui ¨yu(i+1) ¨y′u(i+1)]Τ
[mu]e=ˉmu∫l0[Ν]Τ[Ν]dx=ˉmul420⋅[15622l54-13l22l4l213l-3l25413l156-22l-13l-3l2-22l4l2] (13)
式中: {¨qui}e为第i个单元的节点加速度矢量列阵。
同理得第j个单元惯性力势能Vlj变分表达式
δVlj=δ{qlj}eΤ[ml]e{¨qlj}e (14){¨qlj}e=[¨ylj ¨y′lj ¨yl(j+1) ¨y′l(j+1)]Τ
式中: {¨qlj}e为第j个单元的节点加速度矢量列阵; [ml]e为下层梁单元的质量矩阵。[ml]e的表达式与式(13) [mu]e相似, 只需将式(13) 中的ˉmu换成ˉml即可, 其中ˉml为下层梁的单位长度质量。
将式(12) 和式(14) 按形成矩阵的“对号入座”法则[5~7]建立系统的质量矩阵[M]。
1.2.4 系统节点荷载列阵的建立
假设集中荷载P在t时刻位于第i个单元距第i个节点x0处, 见图 3, 则集中荷载P的势能为
Vep=-Ρyu(x)=-Ρ[Ν]{qui}e
集中荷载P的势能一阶变分为
δVep=-δ{qui}eΤ{F(t)}e{F(t)}e=[ΡΝ1ΡΝ2ΡΝ3ΡΝ4]Τx=x0
式中: {F (t) }e为梁单元的节点荷载列阵。如果整个系统只有一个集中荷载P作用, 则系统的节点荷载列阵{F (t) }为
{F (t) }=[0 … N1PN2PN3PN4P…0]T
系统的节点荷载列阵{F (t) }中的N1P和N2P
表示t时刻集中荷载P在第i个节点的等效节点力, N3P和N4P表示t时刻集中荷载P在第i+1个节点的等效节点力; {F (t) }中共有2 (n1+n3+1) 个元素, 其中只有4个非零元素。如果有多个集中荷载作用, 需要考虑集中荷载之间的距离与梁单元长度的关系, 则系统的节点荷载列阵{F (t) }可利用形成矩阵的“对号入座”法则形成。
2. 参数对板式轨道动力响应的影响
2.1 荷载移动速度及钢轨类型的影响
板式轨道在平顺的钢轨上有竖直集中荷载P以速度v移动, 试计算钢轨中点和钢轨中点对应的轨道板中点处的最大竖向位移, 有关的计算参数如下: 对于不同的轨道结构, 单位长度钢轨质量和对水平轴惯性矩不同, 对于50型钢轨ˉmu=51.514kg/m‚Ιu=2.037×10-5m4‚60型钢轨ˉmu=60.64kg/m‚Ιu=3.217×10-5m4‚75型钢轨ˉmu=74.414kg/m‚Ιu=4.489×10-5m4; 对于不同的轨道结构, 相同的计算参数为Ρ=112800Ν‚Eu=2.06×1011Ρa‚L=37.467m‚l=0.543m‚kd=6×107Ν/m‚cd=7.5×104Ν⋅s/m‚ˉml=557.81kg/m‚El=2.1×1010 Pa, Il=6.6874×10-4 m4, 轨道板长度Ll=2.172 m, kc=6.25×107 N/m, cc=8.3×104 N·s/m, 下层简化为17根短梁, 每一根下层短梁与上层长梁(钢轨) 之间均有4个离散的粘弹性支点相连。在集中荷载P以不同速度移动的条件下, 不同类型钢轨和轨道板的最大竖向位移见表 1。
表 1 钢轨和轨道板的最大竖向位移Table 1. Maximum vertical defection of rail and slab/10-4m 荷载移动速度/m·s-1 50型钢轨板式轨道的钢轨最大竖向位移 50型钢轨板式轨道的轨道板最大竖向位移 60型钢轨板式轨道的钢轨最大竖向位移 60型钢轨板式轨道的轨道板最大竖向位移 75型钢轨板式轨道的钢轨最大竖向位移 75型钢轨板式轨道的轨道板最大竖向位移 静止荷载 11.8936 5.1256 10.4434 4.6284 9.4778 4.2787 v=15 11.9139 5.1922 10.4584 4.6858 9.4894 4.3288 v=30 11.9371 5.2264 10.4745 4.7122 9.5020 4.3506 v=50 11.9978 5.3124 10.5204 4.7786 9.5393 4.4054 v=70 12.1191 5.4425 10.6027 4.8795 9.6031 4.4890 v=85 12.2269 5.5712 10.6888 4.9740 9.6747 4.5686 v=100 12.3764 5.7478 10.8014 5.1122 9.7668 4.6786 正如表 1的数据所示: 在其他参数相同的条件下, 使用较重型的钢轨有利于减小钢轨和轨道板的动力响应; 随着移动荷载速度的提高, 钢轨和轨道板的动力响应有所增大, 但增幅不大。
2.2 钢轨支点弹性系数的影响
为了研究钢轨支点的弹性系数对板式轨道动力响应的影响, 在其他参数相同的条件下, 分别计算当kd=3×107 N/m和kd=1.2×108 N/m时钢轨和轨道板的最大竖向位移, 表 2给出了移动荷载速度v=50 m/s下钢轨和轨道板的最大竖向位移。正如表 2的数据所示: 在其他参数相同的条件下, 使用较重型的钢轨有利于减小钢轨和轨道板的动力响应; 增大钢轨支点的弹性系数, 钢轨的动力响应减小。
表 2 钢轨和轨道板的最大竖向位移Table 2. Maximum vertical defection of rail and slab/10-4m 钢轨支点的弹性系数kd/N·m-1 50型钢轨板式轨道的钢轨最大竖向位移 50型钢轨板式轨道的轨道板最大竖向位移 60型钢轨板式轨道的钢轨最大竖向位移 60型钢轨板式轨道的轨道板最大竖向位移 75型钢轨板式轨道的钢轨最大竖向位移 75型钢轨板式轨道的轨道板最大竖向位移 3.0×107 16.9232 5.1113 14.9475 4.6123 13.6525 4.2700 6.0×107 11.9978 5.3124 10.5204 4.7786 9.5393 4.4054 1.2×108 9.1386 5.3261 7.9632 4.7704 7.1677 4.3717 3. 结语
用有限元法分析了板式轨道在移动荷载作用下的动力响应。视钢轨为离散粘弹性支点支承的长梁, 轨道板为连续粘弹性基础支承的短梁, 梁单元弯曲形函数采用Hermitian 3次方插值函数。运用弹性系统动力学总势能不变值原理及形成矩阵的“对号入座”法则建立了系统的刚度矩阵、质量矩阵、阻尼矩阵和节点荷载列阵, 得到了系统有限元形式的振动方程组。研究了移动荷载的速度、钢轨的类型和钢轨支点的弹性系数对钢轨及轨道板动力响应的影响, 在其他参数相同的情况下, 增大钢轨支点的弹性系数, 钢轨的动力响应减小, 且变化幅度较大; 使用较重型的钢轨有利于减小钢轨和轨道板的动力响应; 随着移动荷载速度的提高, 钢轨和轨道板的动力响应增大, 对于平顺钢轨而言, 动力响应增幅不大。该技术和结果有利于板式轨道的设计和维修。
-
表 1 Mariner轮的主要尺寸
Table 1. Main parameters of mariner ship
船长/m 160.93 舵展弦比 1.67 船宽/m 23.17 桨直径/m 6.707 吃水/m 8.23 桨螺距比 1.038 方形系数 0.588 排水量/m3 18 541 舵叶面积/m2 30.012 航速/kn 15 表 2 K、T与水深的关系
Table 2. Relationship of K、T and water depth
h/d ∞ 2.50 1.93 1.50 1.21 K′ 2.386 2.848 2.449 0.957 0.234 T′1 2.749 3.244 2.678 1.072 0.231+0.153 1i T′2 0.367 0.381 0.356 0.362 0.231-0.153 1i T′3 0.729 0.788 0.585 0.477 0.277 T1+T2 3.116 3.626 3.034 1.434 0.462 T1T2 1.009 1.239 0.953 0.388 0.077 -
[1] 贾欣乐, 杨盐生. 船舶运动数学模型[M]. 大连: 大连海事大学出版社, 1999. [2] 贾欣乐, 张显库. 船舶运动智能控制与H∞鲁棒控制[M]. 大连: 大连海事大学出版社, 2002. [3] Zhang Xian-ku, Jia Xin-le. Simplification of H∞ mixed sensitivity algorithmandits application[J]. Automatic Control and Computer Sciences, 2002, 36(3): 28—33. [4] 张显库, 贾欣乐. 闭环增益成形算法在船舶自动舵中的应用[J]. 中国航海, 1999, 41(2): 89—93. https://www.cnki.com.cn/Article/CJFDTOTAL-ZGHH199902019.htmZhang Xian-ku, Jia Xin-le. Application of closed-loop gain shaping algorithmon autopilot for ships[J]. Navigation of China, 1999, 41(2): 89—93. (in Chinese) https://www.cnki.com.cn/Article/CJFDTOTAL-ZGHH199902019.htm [5] 张显库, 贾欣乐. 用镜像映射方法求非稳定过程的鲁棒控制器[J]. 系统工程与电子技术, 2000, 22(4): 10—12. https://www.cnki.com.cn/Article/CJFDTOTAL-XTYD200004003.htmZhang Xian-ku, Jia Xin-le. Solving robust controller of unstable process using mirror-injection method[J]. Systems Engineering and Electronics, 2000, 22(4): 10—12. (in Chinese) https://www.cnki.com.cn/Article/CJFDTOTAL-XTYD200004003.htm [6] 张显库, 贾欣乐. 基于闭环增益成形的鲁棒PID算法及在液位控制中的应用[J]. 中国造船, 2000, 41(3): 35—39. https://www.cnki.com.cn/Article/CJFDTOTAL-ZGZC200003005.htmZhang Xian-ku, Jia Xin-le. Robust PID algorithm based on closed-loop gain shaping and its application on level control[J]. Shipbuilding of China, 2000, 41(3): 35—39. (in Chinese) https://www.cnki.com.cn/Article/CJFDTOTAL-ZGZC200003005.htm [7] 张显库, 贾欣乐. 求PID参数新方法[J]. 系统工程与电子技术, 2000, 22(8): 4—5. https://www.cnki.com.cn/Article/CJFDTOTAL-XTYD200008001.htmZhang Xian-ku, Jia Xin-le. A new method for solving PID Parameters[J]. Systems Engineering and Electronics, 2000, 22(8): 4—5. (in Chinese) https://www.cnki.com.cn/Article/CJFDTOTAL-XTYD200008001.htm [8] 张显库, 贾欣乐. 用闭环增益成形算法的精馏塔鲁棒控制[J]. 系统工程与电子技术, 2001, 23(5): 15—18. https://www.cnki.com.cn/Article/CJFDTOTAL-XTYD200105005.htmZhang Xian-ku, Jia Xin-le. Robust control of a high purity distillation column using closed-loop gain shaping algorithm[J]. Systems Engineering and Electronics, 2001, 23(5): 15—18. (in Chinese) https://www.cnki.com.cn/Article/CJFDTOTAL-XTYD200105005.htm [9] 张显库, 张丽坤, 贾欣乐. 非方阵被控对象闭环增益成形算法及其应用[J]. 大连海事大学学报, 2001, 27(2): 63—67. https://www.cnki.com.cn/Article/CJFDTOTAL-DLHS200102014.htmZhang Xian-ku, Zhang Li-kun, Jia Xin-le. Closed-loop gain shaping algorithm with unsquare matrix plant and its application[J]. Journal of Dalian Maritime University, 2001, 27(2): 63—67. (in Chinese) https://www.cnki.com.cn/Article/CJFDTOTAL-DLHS200102014.htm [10] 赵月林, 古文贤. 浅水低速状态下操纵运动数学模型研究[J]. 大连海运学院学报, 1993, 18(3): 242—246. https://www.cnki.com.cn/Article/CJFDTOTAL-DLHS199203003.htmZhao Yue-lin, Gu Wen-xian. Research on mathematic ship motion model under shoal water and low speed[J]. Journal of Dalian Maritime University, 1993, 18(3): 242—246. (in Chi-nese). https://www.cnki.com.cn/Article/CJFDTOTAL-DLHS199203003.htm [11] 杨盐生. 船舶运动控制研究[J]. 交通运输工程学报, 2003, 3(2): 34—39. http://transport.chd.edu.cn/article/id/200302008Yang Yan-sheng. Review on ship motion control[J]. Journal of Traffic and Transportation Engineering, 2003, 3(2): 34—39. (in Chinese) http://transport.chd.edu.cn/article/id/200302008 -