波浪滑翔器实际航向预测方法技术

本发明专利技术提供的是一种波浪滑翔器实际航向预测方法。(1)通过GPS获得短时间内波浪滑翔器两点位置，得到波浪滑翔器的运动方向。(2)由上浮体和潜体各自携带的罗经得到上浮体的航向角和转艏角速度及潜体的航向角和转艏角速度。(3)建立波浪滑翔器运动系统的辨识算法模型，在k时刻根据前一时刻的估计参数计算出模型该时刻的输出，即波浪滑翔器运动系统的辨识算法模型的输出预报值，同时计算出预报误差。(4)将预报误差反馈到波浪滑翔器运动系统的辨识算法模型中，在准则下计算出k时刻的模型参数估计值，并更新模型参数，迭代下去直至其准则函数达到最小值。本发明专利技术的方法解算精度与距离无关，结构清晰，易于编写计算机程序实现。

【技术实现步骤摘要】
波浪滑翔器实际航向预测方法
本专利技术涉及的是一种波浪滑翔器的航向预测方法。具体地说是一种波浪滑翔器的实际航向预测方法。
技术介绍
波浪滑翔器是一款新型的海上无人移动的观测平台，具有大尺度，超长续航，经济环保的海洋环境观测能力。波浪滑翔器是由水面浮体母船、水下滑翔体和起连接两者作用的连接链索三部分组成。波浪滑翔器设计的原理是能依靠海洋中无处不在的波浪能转换为其向前的推进力，水面浮体甲板上搭载着太阳能电池板转化太阳能为电力来为搭载的仪器和传感器供电。波浪滑翔器在国外发展迅速，被广泛的应用在海洋科学研究等方面，技术也趋于成熟，但在国内才刚刚兴起，目前其技术垄断于美国，对于打破技术垄断，研制出科技水平含量较高的波浪滑翔器应用于国内各个行业有重大意义。波浪滑翔器在执行自主路径跟随任务时，需实时获取目标点制导信息，由于波浪滑翔器的结构特征导致波浪滑翔器的实际航向很难实时确定。当获取目标实时的目标制导信息时，需实时改变波浪滑翔器的航向，在该条件下，根据当下的浮体航向角，转艏角速度和潜体的航向角，转艏角速度来预报下一时刻波浪滑翔器的实际航向十分重要。当获取目标实时的目标制导信息时，需实时改变波浪滑翔器的航向，在该条件下，根据当下的浮体航向角，转艏角速度和潜体的航向角，转艏角速度来预报下一时刻波浪滑翔器的实际航向十分重要。哈尔滨工程大学廖煜雷等发表的论文《Theintelligentcontrolsystemforanunmannedwaveglider》中针对海洋环境扰动尤其是海流作用下波浪滑翔器路径跟踪存在的稳态误差问题，提出了一种自适应PID制导律以补偿海流对系统运动的不利影响。然而，该制导只适用于当前位置与目标位置较近的情况，当距离较远时计算误差较大，而且该方法无法满足实时改变波浪滑翔器航向的要求，当附近海况复杂时，无法满足要求。国家海洋技术中心史健等发表的论文《基于多传感器的波浪能滑翔器导航策略研究》中基于高斯大地线算法和PID控制算法，构成了波浪滑翔器导航策略。
技术实现思路
本专利技术的目的在于提供一种即适用于短距离又适用于较长距离，误差小的波浪滑翔器实际航向预测方法本专利技术的目的是这样实现的：(1)通过波浪滑翔器本身携带的GPS获得k和k1时刻波浪滑翔器两点位置，时间间隔为GPS的采样周期。设定在两个位置时，位移分别为是S1和S2,进而得到两点位移ΔS。根据速度计算公式，位移ΔS与Δt的比值为速度(此速度为矢量，包括速度大小和方向)，即得到整个波浪滑翔器的运动方向，得到波浪滑翔器的运动速度方向；(2)通过上浮体和潜体上各自的罗经，获得k时和k1时上浮体的航向角和转艏角速度及潜体的航向角和转艏角速度，分别记为和(3)建立波浪滑翔器运动系统的辨识算法模型，采用逐步逼近的办法在k时刻根据前一时刻的估计参数计算出模型该时刻的输出，即波浪滑翔器运动系统的辨识算法模型的输出预报值，同时计算出预报误差；(4)将预报误差反馈到波浪滑翔器运动系统的辨识算法模型中，在准则下计算出k时刻的模型参数估计值，并更新模型参数，这样迭代下去，直至其准则函数达到最小值，此时刻的输出及波浪滑翔器下一时刻的实际航向便是在准则下的逼近系统的输出。本专利技术提供了一种波浪滑翔器实际航向的预报方法，用于波浪滑翔器实际航行过程中实时预报下一时间实际航向，为波浪滑翔器控制决策提供重要参考依据。具体地说是一种波浪滑翔器在航行过程中，根据上浮体和下潜体各自的航向角及转艏角速度估计下一时刻波浪滑翔器的实际航向的方法。该方法适用于短距离(10以内)至较长距离(100以上)等各种距离条件下的波浪滑翔器实际航向估算及波浪滑翔器轨迹跟踪，航迹规划，海面避障方面有重要应用，根据算法迭代的原则，可以将误差降到很低。附图说明图1波浪滑翔器实际航向预测方法流程图。具体实施方式本专利技术的波浪滑翔器整体航向的预报方法主要用于波浪滑翔器航行总体航向的预报。波浪滑翔器主要由三部分组成，分别是水面上的上浮体，水下的滑翔体和负责连接这两部分的链索。在实际航行过程中，由于波浪和海流等因素的存在及波浪滑翔器本身运动的原理导致波浪滑翔器上面浮体和水下滑翔体的运动姿态并不完全一致，水面浮体和水下滑翔体实际的运动方向都不是波浪滑翔器整体的运动方向。但在实际用途中，很多情况下我们最想获得的就是波浪滑翔器下一时刻的运动方向。波浪滑翔器自身携带有GPS和磁罗经的获得自身位置信息和运动姿态信息的传感器，当在短时间内获取波浪滑翔器云动信息，由GPS获得波浪滑翔器在短时间内的两个位置差及可以获得波浪滑翔器的实际运动方向。在上浮体和潜体上各自安装一个磁罗经，即可获得上浮体的航向角及转艏角速度和潜体的航向角及转艏角速度。参考现代控制理论中的系统辨识方法，建立波浪滑翔器系统的输入输出时间函数来确定描述系统行为的数学模型，从而可以得出波浪滑翔器下一时刻的运动方向。由前一时刻上浮体的航向及转艏角速度和潜体的航向及转艏角速度推算出下一时刻波浪滑翔器整体的实际航向。真个系统的输入包括上一时刻上浮体的航向角及转艏角速度，潜体的航向角及转艏角速度，输出就是波浪滑翔器下一时刻的实际航向。本专利技术提供的波浪滑翔器实际航向的预报方法解算精度与距离无关，结构清晰，易于编写计算机程序实现。下面举例对本专利技术做更详细的描述。波浪滑翔器在海上工作时，执行自主路径跟随任务时，需实时获取目标点制导信息，主要包括当前位置距目标位置方位角和距离。在实际工作时，要求对波浪滑翔器的未来实际航向进行预测，进而优化波浪滑翔器的航向控制系统。波浪滑翔器拥有几乎无限续航力，活动范围较大，能达到数千甚至数万公里，此时，对波浪滑翔器实际航向的预测显得至关重要。本专利技术提供的波浪滑翔器实际航向的预测方法，旨在解决以下问题：已知波浪滑翔器上一时刻上浮体和潜体的航向角和转艏角速度，又已知前一时刻的位置经纬度信息P1(B1,L1)和当前时刻的位置经纬度信息P2(B2,L2)，即可已求得波浪滑翔器当前的实际航向。其中B表示纬度，L表示经度。本专利技术的主要思想为：通过在上浮体和潜体上安装的罗经测得上一时刻两者的航向角和转艏角速度，由携带的GPS测得当前的波浪滑翔器的实际航向，得到由一当前时刻的浮体的航向角和转艏角速度及潜体的航向角和转艏角速度推算出下一时刻波浪滑翔器整体的航向。具体包括四个部分(1)通过GPS获得短时间内波浪滑翔器两点位置，进而得到波浪滑翔器的运动方向。(2)由上浮体和潜体各自携带的罗经得到上浮体的航向角和转艏角速度及潜体的航向角和转艏角速度。(3)建立波浪滑翔器运动系统的辨识算法模型，为了得到模型参数的估计值，采用逐步逼近的办法。在k时刻根据前一时刻的估计参数计算出模型该时刻的输出，即波浪滑翔器运动系统的辨识算法模型的输出预报值，同时计算出预报误差。(4)将然将预报误差反馈到波浪滑翔器运动系统的辨识算法模型中，在准则下计算出k时刻的模型参数估计值，并更新模型参数，这样迭代下去，直至其准则函数达到最小值。此时刻的输出及波浪滑翔器下一时刻的实际航向便是在准则下的逼近系统的输出。结合图1，本专利技术的流程如下：(1)通过GPS获得波浪滑翔器两点位置P1(B1,L1)和P2(B2,L2)，设定在两个位置时，位移分别为是S1和S2,进而得到两点位移ΔS。与此同时，波浪滑翔器运动本文档来自技高网...

【技术保护点】
一种波浪滑翔器实际航向预测方法，其特征是：(1)通过波浪滑翔器本身携带的GPS获得k和k1时刻波浪滑翔器两点位置，时间间隔为GPS的采样周期，设定在两个位置时，位移分别为是S1和S2，进而得到两点位移ΔS，根据速度计算公式，位移ΔS与Δt的比值为速度，即得到整个波浪滑翔器的运动方向，得到波浪滑翔器的运动速度方向；(2)通过上浮体和潜体上各自的罗经，获得k时和k1时上浮体的航向角和转艏角速度及潜体的航向角和转艏角速度，分别记为

【技术特征摘要】
1.一种波浪滑翔器实际航向预测方法，其特征是：(1)通过波浪滑翔器本身携带的GPS获得k和k1时刻波浪滑翔器两点位置，时间间隔为GPS的采样周期，设定在两个位置时，位移分别为是S1和S2，进而得到两点位移ΔS，根据速度计算公式，位移ΔS与Δt的比值为速度，即得到整个波浪滑翔器的运动方向，得到波浪滑翔器的运动速度方向；(2)通过上浮体和潜体上各自的罗经，获得k时和k1时上浮体的航向角和转艏角速度及潜体的航向角和转艏角速...

【专利技术属性】
技术研发人员：张伟，李晔，王友康，廖煜雷，李一鸣，王磊锋，潘凯文，张尉新，
申请(专利权)人：哈尔滨工程大学，
类型：发明
国别省市：黑龙江,23