CN107462912A - 一种船用gnss的航速航向稳定输出的滤波方法 - Google Patents
一种船用gnss的航速航向稳定输出的滤波方法 Download PDFInfo
- Publication number
- CN107462912A CN107462912A CN201710567061.XA CN201710567061A CN107462912A CN 107462912 A CN107462912 A CN 107462912A CN 201710567061 A CN201710567061 A CN 201710567061A CN 107462912 A CN107462912 A CN 107462912A
- Authority
- CN
- China
- Prior art keywords
- mrow
- acc
- speed
- ship
- output
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Withdrawn
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/52—Determining velocity
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/53—Determining attitude
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Computer Networks & Wireless Communication (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
Abstract
本发明提供了一种船用GNSS的航速航向稳定输出的滤波方法,步骤包括:建立滤波时间参数T,滤波时间参数T的取值根据使用环境确定;对当前时刻输出的矢量速度Vacc_x和Vacc_y进行滤波计算,于是得到当前的即时速度Vacc,利用滤波后的当前时刻输出的矢量速度Vacc_x和Vacc_y计算滤波后的航向Cacc。该滤波方法通过输出与即时速度进行差分时间补偿,以达到航向与航速输出都比较稳定,尤其是风浪摇摆、颠簸环境下的低速航行时。
Description
技术领域
本发明涉及一种航速航向数据的滤波方法,尤其是一种船用GNSS的航速航向稳定输出的滤波方法。
背景技术
GNSS全球导航卫星系统,它泛指所有卫星导航系统,包括全球的区域的和增强的,如美国的GPS、俄罗斯的Glonass、欧洲的Galileo以及中国的北斗。利用其中的一个或多个系统可进行导航定位,在水运方面应用GNSS可以实现船舶导航。但是,在风浪摇摆、颠簸的航行环境中,使得在低速行驶时GNSS给出的航速和航向误差很大,导致在实际使用中受到很大的局限性,尤其是在捕鱼作业以及AIS应用上,不能及时正确反映船舶的真实动态信息,影响实际的使用效果。因此需要对GNSS实时信息进行科学的过滤,以得到相对准确的行驶数据。从而可以及时避免渔船拖网时靠拢判断不准确而导致渔具被损毁而严重影响正常作业,甚至船碰撞的严重后果。
发明内容
本发明要解决的技术问题是在风浪摇摆、颠簸的航行环境中船用GNSS给出的航速航向不准确,从而不能及时反映船舶真实动态信息的缺点。
为了解决上述技术问题,本发明提供了一种船用GNSS的航速航向稳定输出的滤波方法,包括如下步骤:
步骤1,建立滤波时间参数T,滤波时间参数T的取值根据使用环境确定;
步骤2,对当前时刻输出的矢量速度Vacc_x和Vacc_y进行滤波计算:
Vacc_x=Vacc_x-1+(Vt_x-Vacc_x-1)/T
Vacc_y=Vacc_y-1+(Vt_y-Vacc_y-1)/T
式中,Vt_x和Vt_y为当前时刻即时速度Vt分解到输出方向矢量X和Y方向上的两个分量,Vacc_x-1和Vacc_y-1为上一时刻的输出速度Vacc-1分解到输出方向矢量X和Y方向上的两个分量,于是得到当前的即时速度为:
步骤3,利用滤波后的当前时刻输出的矢量速度Vacc_x和Vacc_y计算滤波后的航向Cacc为:
式中,F(x)为弧度到角度的转换公式。
作为本发明的进一步限定方案,步骤1中,根据使用环境确定滤波时间参数T的具体计算公式为:
T=S/Vmax+M*(Vmax-Vmin) N
式中,S为船用GNSS的定位精度距离,Vmax为上一时刻滤波输出速度Vacc-1、上一时刻即时速度Vt-1以及当前时刻即时速度Vt中的最大值,Vmin为上一时刻滤波输出速度Vacc-1、上一时刻即时速度Vt-1以及当前时刻即时速度Vt中的最小值,M为Vmax与Vmin的速度差系数,N为Vmax与Vmin的速度平方差系数。
作为本发明的进一步限定方案,即时速度Vt由GNSS实时数据中的经纬度计算得到。
本发明的有益效果在于:通过实时输出与即时差分时间补偿,航向与航速输出都比较稳定,利用自动滤波时间的算法,又可以根据船舶实际的航行数据实时调整滤波时间常数,能够保证航行数据在不同航行情况下的航速和航向稳定输出。在渔业作业中,尤其是拖网船舶,高度稳定的航速航向可以避免在大风浪条件下因航速和方向的不准确而造成靠拢距离把握不准导致渔具损坏、碰撞的严重后果,在AIS应用上,稳定的航速和航向可以及时的反映船舶真实的数据,避免因数据不准确而导致船舶碰撞。
具体实施方式
本发明提供了一种船用GNSS的航速航向稳定输出的滤波方法,目的在于通过设计滤波算法,实现船用GNSS输出具备高度稳定的航速和航向的船舶行驶数据,具体步骤如下:
步骤1,建立滤波时间参数T,滤波时间参数T的取值根据使用环境确定;
步骤2,对当前时刻输出的矢量速度Vacc_x和Vacc_y进行滤波计算:
Vacc_x=Vacc_x-1+(Vt_x-Vacc_x-1)/T
Vacc_y=Vacc_y-1+(Vt_y-Vacc_y-1)/T
式中,Vt_x和Vt_y为当前时刻即时速度Vt分解到输出方向矢量X和Y方向上的两个分量,Vacc_x-1和Vacc_y-1为上一时刻的输出速度Vacc-1分解到输出方向矢量X和Y方向上的两个分量,于是得到当前的即时速度为:
步骤3,利用滤波后的当前时刻输出的矢量速度Vacc_x和Vacc_y计算滤波后的航向Cacc为:
式中,F(x)为弧度到角度的转换公式。
其中,步骤1中,根据使用环境确定滤波时间参数T的具体计算公式为:
T=S/Vmax+M*(Vmax-Vmin) N
式中,S为船用GNSS的定位精度距离,Vmax为上一时刻滤波输出速度Vacc-1、上一时刻即时速度Vt-1以及当前时刻即时速度Vt中的最大值,Vmin为上一时刻滤波输出速度Vacc-1、上一时刻即时速度Vt-1以及当前时刻即时速度Vt中的最小值,M为Vmax与Vmin的速度差系数,N为Vmax与Vmin的速度平方差系数。
另外,即时速度Vt和即时航向Ct由GNSS实时数据中的经纬度计算得到。
本发明的滤波方法通过实时输出与即时差分时间补偿,航向与航速输出都比较稳定,利用自动滤波时间的算法,又可以根据船舶实际的航行数据实时调整滤波时间常数,能够保证航行数据在不同航行情况下的航速和航向稳定输出。在渔业作业中,尤其是拖网船舶,高度稳定的航速航向可以避免在大风浪条件下因航速和方向的不准确而造成靠拢距离把握不准导致渔具损坏、碰撞的严重后果,在AIS应用上,稳定的航速和航向可以及时的反映船舶真实的数据,避免因数据不准确而导致船舶碰撞。
Claims (3)
1.一种船用GNSS的航速航向稳定输出的滤波方法,其特征在于,包括如下步骤:
步骤1,建立滤波时间参数T,滤波时间参数T的取值根据使用环境确定;
步骤2,对当前时刻输出的矢量速度Vacc_x和Vacc_y进行滤波计算:
Vacc_x=Vacc_x-1+(Vt_x-Vacc_x-1)/T
Vacc_y=Vacc_y-1+(Vt_y-Vacc_y-1)/T
式中,Vt_x和Vt_y为当前时刻即时速度Vt分解到输出方向矢量X和Y方向上的两个分量,Vacc_x-1和Vacc_y-1为上一时刻的输出速度Vacc-1分解到输出方向矢量X和Y方向上的两个分量,于是得到当前的即时速度为:
<mrow>
<msub>
<mi>V</mi>
<mrow>
<mi>a</mi>
<mi>c</mi>
<mi>c</mi>
</mrow>
</msub>
<mo>=</mo>
<msqrt>
<mrow>
<msubsup>
<mi>V</mi>
<mrow>
<mi>a</mi>
<mi>c</mi>
<mi>c</mi>
<mo>_</mo>
<mi>x</mi>
</mrow>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>V</mi>
<mrow>
<mi>a</mi>
<mi>c</mi>
<mi>c</mi>
<mo>_</mo>
<mi>y</mi>
</mrow>
<mn>2</mn>
</msubsup>
</mrow>
</msqrt>
<mo>;</mo>
</mrow>
步骤3,利用滤波后的当前时刻输出的矢量速度Vacc_x和Vacc_y计算滤波后的航向Cacc为:
<mrow>
<msub>
<mi>C</mi>
<mrow>
<mi>a</mi>
<mi>c</mi>
<mi>c</mi>
</mrow>
</msub>
<mo>=</mo>
<mi>A</mi>
<mi>T</mi>
<mi>A</mi>
<mi>N</mi>
<mrow>
<mo>(</mo>
<mfrac>
<msub>
<mi>V</mi>
<mrow>
<mi>a</mi>
<mi>c</mi>
<mi>c</mi>
<mo>_</mo>
<mi>y</mi>
</mrow>
</msub>
<msub>
<mi>V</mi>
<mrow>
<mi>a</mi>
<mi>c</mi>
<mi>c</mi>
<mo>_</mo>
<mi>x</mi>
</mrow>
</msub>
</mfrac>
<mo>)</mo>
</mrow>
<mo>*</mo>
<mi>F</mi>
<mrow>
<mo>(</mo>
<mi>x</mi>
<mo>)</mo>
</mrow>
</mrow>
式中,F(x)为弧度到角度的转换公式。
2.根据权利要求1所述的船用GNSS的航速航向稳定输出的滤波方法,其特征在于:步骤1中,根据使用环境确定滤波时间参数T的具体计算公式为:
T=S/Vmax+M*(Vmax-Vmin) N
式中,S为船用GNSS的定位精度距离,Vmax为上一时刻滤波输出速度Vacc-1、上一时刻即时速度Vt-1以及当前时刻即时速度Vt中的最大值,Vmin为上一时刻滤波输出速度Vacc-1、上一时刻即时速度Vt-1以及当前时刻即时速度Vt中的最小值,M为Vmax与Vmin的速度差系数,N为Vmax与Vmin的速度平方差系数。
3.根据权利要求1所述的船用GNSS的航速航向稳定输出的滤波方法,其特征在于:即时速度Vt由GNSS实时数据中的经纬度计算得到。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710567061.XA CN107462912A (zh) | 2017-07-12 | 2017-07-12 | 一种船用gnss的航速航向稳定输出的滤波方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710567061.XA CN107462912A (zh) | 2017-07-12 | 2017-07-12 | 一种船用gnss的航速航向稳定输出的滤波方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN107462912A true CN107462912A (zh) | 2017-12-12 |
Family
ID=60544239
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710567061.XA Withdrawn CN107462912A (zh) | 2017-07-12 | 2017-07-12 | 一种船用gnss的航速航向稳定输出的滤波方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107462912A (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109613523A (zh) * | 2018-10-23 | 2019-04-12 | 南通赛洋电子有限公司 | 一种测探仪信号预处理电路 |
CN112378400A (zh) * | 2020-10-30 | 2021-02-19 | 湖南航天机电设备与特种材料研究所 | 一种双天线gnss辅助的捷联惯导组合导航方法 |
CN113504556A (zh) * | 2021-09-10 | 2021-10-15 | 浙江特勤卫星导航科技有限公司 | 一种船用定位信息确定方法、系统及存储介质 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101915852A (zh) * | 2010-08-06 | 2010-12-15 | 北京交通大学 | 基于立体视觉的速度测量方法 |
CN103810905A (zh) * | 2014-01-15 | 2014-05-21 | 浙江海洋学院 | 船舶走锚评估及预警方法 |
-
2017
- 2017-07-12 CN CN201710567061.XA patent/CN107462912A/zh not_active Withdrawn
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101915852A (zh) * | 2010-08-06 | 2010-12-15 | 北京交通大学 | 基于立体视觉的速度测量方法 |
CN103810905A (zh) * | 2014-01-15 | 2014-05-21 | 浙江海洋学院 | 船舶走锚评估及预警方法 |
Non-Patent Citations (1)
Title |
---|
任守乐 等: "《高中物理 上册》", 31 December 1983 * |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109613523A (zh) * | 2018-10-23 | 2019-04-12 | 南通赛洋电子有限公司 | 一种测探仪信号预处理电路 |
CN109613523B (zh) * | 2018-10-23 | 2023-04-07 | 南通赛洋电子有限公司 | 一种测探仪信号预处理电路 |
CN112378400A (zh) * | 2020-10-30 | 2021-02-19 | 湖南航天机电设备与特种材料研究所 | 一种双天线gnss辅助的捷联惯导组合导航方法 |
CN113504556A (zh) * | 2021-09-10 | 2021-10-15 | 浙江特勤卫星导航科技有限公司 | 一种船用定位信息确定方法、系统及存储介质 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106643723B (zh) | 一种无人艇安全航行船位推算方法 | |
CN101793521B (zh) | 基于光纤陀螺惯性测量系统的舰船横纵荡信息测量方法 | |
CN108120987A (zh) | 一种大江大河的水下河道地形测量装置及测量方法 | |
CN107462912A (zh) | 一种船用gnss的航速航向稳定输出的滤波方法 | |
CN103308722B (zh) | 一种船舶风向风速测量仪误差修正方法 | |
RU2467914C1 (ru) | Способ контроля мореходности судна и устройство для его осуществления | |
US10723423B2 (en) | System and method of controlling marine vessels | |
CN102411657A (zh) | 自由航行状态下耙吸挖泥船动力定位的滤波器设计方法 | |
CN104880186A (zh) | 船舶离岸距离的检测方法及装置 | |
RU2277495C1 (ru) | Способ автоматической проводки судов | |
US20140126333A1 (en) | Doppler Angle of Attack Sensor System for Watercraft | |
Reinking et al. | Determination of sea surface height from moving ships with dynamic corrections | |
RU2501708C1 (ru) | Способ автоматической проводки судна | |
Hashimoto et al. | A case study on operational limitations by means of navigation simulation | |
Ariffin et al. | Real-time evaluation of second generation intact stability criteria | |
Ichinose et al. | Decrease of ship speed in actual seas of a bulk carrier in full load and ballast conditions-model test and onboard measurement | |
CN205620812U (zh) | 一种小型无人水面艇运动控制系统 | |
Verwilligen et al. | Full-scale measurements to assess squat and vertical motions in exposed shallow water | |
CN111984006B (zh) | 融合海流及尺度差异影响的无人艇多目标会遇避碰方法 | |
CN112964250A (zh) | 基于北斗和降维imu数据的船舶运动姿态估计方法 | |
Vantorre et al. | Ship motions in shallow water as the base for a probabilistic approach policy | |
Gourlay | Dynamic draught of container ships in shallow water | |
Sogihara et al. | Verification of calculation method on ship performance by onboard measurement | |
CN116106840B (zh) | 无人舰载机雷达测量误差确定方法、装置、设备及介质 | |
Beck et al. | SeaWASP: A small waterplane area twin hull autonomous platform for shallow water mapping |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
WW01 | Invention patent application withdrawn after publication |
Application publication date: 20171212 |
|
WW01 | Invention patent application withdrawn after publication |