CN111176292B - 一种基于侧边距的波浪滑翔器路径跟踪控制方法 - Google Patents
一种基于侧边距的波浪滑翔器路径跟踪控制方法 Download PDFInfo
- Publication number
- CN111176292B CN111176292B CN202010034315.3A CN202010034315A CN111176292B CN 111176292 B CN111176292 B CN 111176292B CN 202010034315 A CN202010034315 A CN 202010034315A CN 111176292 B CN111176292 B CN 111176292B
- Authority
- CN
- China
- Prior art keywords
- wave glider
- path
- heading
- expected
- side margin
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 26
- 238000010586 diagram Methods 0.000 description 2
- 238000004891 communication Methods 0.000 description 1
- 238000005265 energy consumption Methods 0.000 description 1
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/0206—Control of position or course in two dimensions specially adapted to water vehicles
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明公开了一种波浪滑翔器路径跟踪控制方法,根据波浪滑翔器距离期望路径的侧边距Hc与设定转向距离Hset的大小,决定波浪滑翔器的两种路径跟踪方式。当侧边距Hc大于设定值Hset时,波浪滑翔器会沿侧边距Hc的方向逼近期望轨迹,当波浪滑翔器移动到所在位置侧边距Hc小于设定值Hset时,波浪滑翔器将会采用视向算法(LOS)计算出期望航向。得到期望航向后,将罗盘回传的当前航向与期望航向的偏差输入至PID航向控制器,输出尾舵角度,使波浪滑翔器快速收敛至期望航向。本发明提供的波浪滑翔器的路径跟踪控制方法简化了控制流程,简单可靠。
Description
技术领域
本发明涉及一种基于侧边距的波浪滑翔器路径跟踪控制方法,特别涉及应用于波浪滑翔器运动控制领域。
背景技术
波浪滑翔器是一种新型的海洋移动观测平台,主要由浮体船、脐带缆、牵引机三部分组成。利用上述三部分组成的多刚体结构将波浪能转化为前向动力,利用太阳能电池板为波浪滑翔器导航、通讯和运动控制等提供能源供给,波浪滑翔器可实现长时间、大范围的海上自主航行。
波浪滑翔器模型的不确定性、非线性以及海洋环境的复杂多变使其路径跟踪控制变得尤为困难。为简化波浪滑翔器导航控制流程,降低导航控制模块运行功耗,本发明旨在提供一种简单易行的波浪滑翔器路径跟踪控制方法,节省导航控制***资源。
发明内容
本发明提供一种新型路径跟踪控制方法,实现波浪滑翔器快速可靠路径跟踪控制。本发明所涉及的一种波浪滑翔器路径跟踪控制方法也可扩展到与波浪滑翔器结构类似的其他水面无人航行器上。
本发明的实现步骤如下:
步骤一:波浪滑翔器启动侧边距路径跟踪方法,通过GPS实时定位给出波浪滑翔器当前位置(x,y),计算所述当前位置(x,y)与期望轨迹的侧边距Hc。设定波浪滑翔器路径跟踪转向距离Hset,通过判断所述侧边距Hc与转向距离Hset的大小决定波浪滑翔器的路径跟踪方式;
步骤二:当侧边距Hc大于设定值Hset时,波浪滑翔器会沿侧边距Hc的方向逼近期望轨迹,当波浪滑翔器移动到所在位置侧边距Hc小于设定值Hset时,波浪滑翔器将会采用视向算法(LOS)计算出期望航向。
步骤三:得到期望航向后,将罗盘回传的当前航向与期望航向的偏差输入至PID航向控制器,输出尾舵角度,使波浪滑翔器快速收敛至期望航向。
步骤四:判断波浪滑翔器是否完成当前目标路径的跟踪,如果未完成,重复步骤一、步骤二和步骤三直至路径跟踪到达目标点;如果完成则切换到下一条目标路径进行跟踪,直至完成所有的路径跟踪。
在波浪滑翔器目标路径跟踪控制过程中,期望航向的实时获取是保证波浪滑翔器路径导航控制的关键所在,因此,在满足波浪滑翔器导航控制精度前提下,快速有效获得波浪滑翔器期望航向角度,简化导航控制算法对提高波浪滑翔器控制鲁棒性和降低控制功耗具有重大作用。本发明的效果是:当波浪滑翔器所在位置侧边距Hc大于和小于设定值Hset时,采用两种不同的路径跟踪控制方法得到期望航向,通过简单易行的PID航向控制输出尾舵角度,保证波浪滑翔器简单可靠完成复杂海况下多干扰并存的路径跟踪控制。
附图说明
图1是基于侧边距的波浪滑翔器路径跟踪方法流程图;
图2是基于侧边距的波浪滑翔器路径跟踪方法框图;
图3是基于侧边距的波浪滑翔器路径跟踪方法示意图;
具体实施方式
下面结合附图和具体实施方式对本发明进行详细的描述。
如图1所示,首先波浪滑翔器启动侧边距路径跟踪方法,通过GPS实时定位给出波浪滑翔器当前位置,计算所述当前位置与期望轨迹的侧边距Hc。判断侧边距Hc与设定转向距离Hset的大小进行两种不同的路径跟踪方式。侧边距Hc大于设定值Hset时,波浪滑翔器会沿侧边距Hc的方向逼近期望轨迹,当波浪滑翔器移动到所在位置侧边距Hc小于设定值Hset时,波浪滑翔器将会采用视向算法(LOS)计算出期望航向。得到期望航向后,将罗盘回传的当前航向与期望航向的偏差输入至PID航向控制器,输出尾舵角度,使波浪滑翔器快速收敛至期望航向。判断波浪滑翔器是否完成当前目标路径的跟踪,如果未完成,重复步骤一、步骤二和步骤三直至路径跟踪到达目标点;如果完成则切换到下一条目标路径进行跟踪,直至完成所有的路径跟踪。
LOS算法获取期望航向角的方程为:
其中,ψlos为期望航向角,期望位置是P1=(xk+1,yk+1),波浪滑翔器的当前位置为P=(x,y)。
由图3可知,期望位置P1=(xk+1,yk+1)与波浪滑翔器当前位置在期望路径上的投影点相距Δ=nL,这里n=2~5。L为波浪滑翔器长度,Δ称为可视距离。此时,LOS算法可以写成:
其中,αk是正北方向与期望路径的夹角。
给出舵角δ与航向角偏差ψe的PID控制方程:
其中,k1,k2,k3为比例系数,ψe为航向角偏差,ψe=ψ-ψlos,其中ψ为实际航向角,ψlos为期望航向角。
本发明的特点体现在:
(1)当波浪滑翔器所在位置侧边距Hc大于和小于设定值Hset时,本发明所提方法采用两种不同的路径跟踪控制方法得到期望航向,在保证导航控制精度的前提下,简化了波浪滑翔器期望航向获取流程。
(2)本发明所提方法通过简单易行的PID航向控制输出尾舵角度,保证波浪滑翔器简单可靠完成复杂海况下多干扰并存的路径跟踪控制。
(3)本发明所提方法能在保证跟踪精度的同时,有效的降低波浪滑翔器跟踪能耗,提高波浪滑翔器的续航能力,具有实际工程意义。
Claims (2)
1.一种波浪滑翔器路径跟踪方法,其特征在于,提供一种波浪滑翔器路径跟踪控制方法,具有以下步骤:
步骤一:波浪滑翔器启动侧边距路径跟踪方法,通过GPS实时定位给出波浪滑翔器当前位置(x,y),计算当前位置(x,y)与期望轨迹的侧边距Hc,设定波浪滑翔器路径跟踪转向距离Hsct,通过判断所述侧边距Hc与转向距离Hsct的大小决定波浪滑翔器的路径跟踪方式;
步骤二:当侧边距Hc大于设定值Hset时,波浪滑翔器会沿侧边距Hc的方向逼近期望轨迹,当波浪滑翔器移动到所在位置侧边距Hc小于设定值Hset时,波浪滑翔器将会采用视向算法计算出期望航向;
期望航向角的求取,假设当前路径跟踪的期望位置是P1=(xk+1,yk+1),波浪滑翔器的当前位置为P=(x,y),那么期望航向角由下面公式得到:
步骤三:得到期望航向后,将罗盘回传的当前航向与期望航向的偏差输入至PID航向控制器,输出尾舵角度,使波浪滑翔器快速收敛至期望航向,具体为:
通过合理的设置PID参数,得到稳定收敛的控制规律,使航向角偏差趋于零;PID控制规律为:
其中,δ为舵角,ψe为航向角偏差,***存在一个较大的ψe,经PID控制便会产生一个舵角,从而控制波浪滑翔器向期望航向点航行,达到路径跟踪的效果;
步骤四:判断波浪滑翔器是否完成当前目标路径的跟踪,如果未完成,重复步骤一、步骤二和步骤三直至路径跟踪到达目标点:如果完成则切换到下一条目标路径进行跟踪,直至完成所有的路径跟踪。
2.根据权利要求1所述的一种波浪滑翔器路径跟踪方法,其特征在于,步骤一所述的侧边距为波浪滑翔器距离目标路径的垂直距离,通过GPS实时定位计算出波浪滑翔器当前的侧边距Hc,在大于侧边距Hc和小于侧边距Hc时采取不同的方法进行移动。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010034315.3A CN111176292B (zh) | 2020-01-13 | 2020-01-13 | 一种基于侧边距的波浪滑翔器路径跟踪控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010034315.3A CN111176292B (zh) | 2020-01-13 | 2020-01-13 | 一种基于侧边距的波浪滑翔器路径跟踪控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111176292A CN111176292A (zh) | 2020-05-19 |
CN111176292B true CN111176292B (zh) | 2022-11-22 |
Family
ID=70652691
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010034315.3A Active CN111176292B (zh) | 2020-01-13 | 2020-01-13 | 一种基于侧边距的波浪滑翔器路径跟踪控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111176292B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115973394B (zh) * | 2023-03-22 | 2023-10-20 | 中国海洋大学 | 一种波浪滑翔器铠装缆扭转检测解扭方法及装置 |
CN115991271A (zh) * | 2023-03-23 | 2023-04-21 | 中国海洋大学 | 一种基于螺旋桨推进的波浪滑翔器导航方法及*** |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105629976A (zh) * | 2016-02-22 | 2016-06-01 | 江苏大学 | 一种水产养殖作业船自动导航路径跟踪方法 |
CN106708068A (zh) * | 2017-01-19 | 2017-05-24 | 中国科学院自动化研究所 | 仿生波动鳍推进水下航行器路径跟踪控制方法 |
CN107168340A (zh) * | 2017-07-11 | 2017-09-15 | 江南大学 | 一种基于滑模变结构的移动机器人轨迹跟踪控制方法 |
CN107703973A (zh) * | 2017-09-11 | 2018-02-16 | 广州视源电子科技股份有限公司 | 轨迹跟踪方法、装置 |
CN109828458A (zh) * | 2019-02-26 | 2019-05-31 | 中国海洋大学 | 一种波浪滑翔器路径跟踪控制方法 |
CN109856965A (zh) * | 2019-03-08 | 2019-06-07 | 天津工业大学 | 一种波浪滑翔器航向跟踪控制方法 |
CN110501974A (zh) * | 2019-09-06 | 2019-11-26 | 天津工业大学 | 一种基于八参数五轴线性插补的非线性误差控制方法 |
-
2020
- 2020-01-13 CN CN202010034315.3A patent/CN111176292B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105629976A (zh) * | 2016-02-22 | 2016-06-01 | 江苏大学 | 一种水产养殖作业船自动导航路径跟踪方法 |
CN106708068A (zh) * | 2017-01-19 | 2017-05-24 | 中国科学院自动化研究所 | 仿生波动鳍推进水下航行器路径跟踪控制方法 |
CN107168340A (zh) * | 2017-07-11 | 2017-09-15 | 江南大学 | 一种基于滑模变结构的移动机器人轨迹跟踪控制方法 |
CN107703973A (zh) * | 2017-09-11 | 2018-02-16 | 广州视源电子科技股份有限公司 | 轨迹跟踪方法、装置 |
CN109828458A (zh) * | 2019-02-26 | 2019-05-31 | 中国海洋大学 | 一种波浪滑翔器路径跟踪控制方法 |
CN109856965A (zh) * | 2019-03-08 | 2019-06-07 | 天津工业大学 | 一种波浪滑翔器航向跟踪控制方法 |
CN110501974A (zh) * | 2019-09-06 | 2019-11-26 | 天津工业大学 | 一种基于八参数五轴线性插补的非线性误差控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN111176292A (zh) | 2020-05-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106950955B (zh) | 基于改进los引导算法的船舶航迹控制方法 | |
CN107168335B (zh) | 一种考虑混合多目标避障的水面无人艇路径跟踪制导方法 | |
CN105511464B (zh) | 一种船舶自主航行控制***及控制方法 | |
CN113625544A (zh) | 一种波浪滑翔器的内外环pid路径跟踪控制方法 | |
CN111580518B (zh) | 一种基于改进果蝇优化和动态窗口法的无人艇分层避障方法 | |
CN111176292B (zh) | 一种基于侧边距的波浪滑翔器路径跟踪控制方法 | |
Liu et al. | Ship trajectory tracking control system design based on sliding mode control algorithm | |
CN110609556A (zh) | 一种基于los导航法的多无人艇协同控制方法 | |
CN108876065B (zh) | 一种基于轨迹单元的无人艇运动规划方法 | |
CN114779791B (zh) | 一种波浪滑翔器位置保持方法及*** | |
CN113885534B (zh) | 一种基于智能预测控制的水面无人船路径跟踪方法 | |
CN111487966A (zh) | 一种基于航路点的水面无人艇自适应路径跟踪控制方法 | |
CN104765370A (zh) | 有环境干扰下考虑侧滑角的uuv航迹视线导引法 | |
CN111142541A (zh) | 波浪滑翔器虚拟锚泊导航控制算法 | |
CN103913163A (zh) | 船载卫星通信地球站a-e-c三轴天线坐标计算方法 | |
CN112558642A (zh) | 一种适用于异构多无人***的海空联合围捕方法 | |
CN116627043B (zh) | 一种联合锚泊***的区域动力定位控制方法 | |
CN103985952A (zh) | 船载a-e-c三轴卫星通信天线极化偏差角实时修正方法 | |
CN111722627A (zh) | 用于水面无人航行器的动态虚拟锚泊控制方法及*** | |
CN108958252B (zh) | 一种基于航迹偏差距离的动力浮标航迹控制方法 | |
CN113219970B (zh) | 一种无人船向量场路径跟踪控制器及设计方法 | |
CN113296505B (zh) | 一种基于速变los的无人船多模式路径跟踪控制方法 | |
CN113359737A (zh) | 一种考虑队形伸缩的船舶编队自适应事件触发控制方法 | |
CN116520834B (zh) | 一种低能耗的无人船巡航方法 | |
CN109814547B (zh) | 风浪干扰作用下的无人艇航向保持装置和方法 |
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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |