CN106598051A - 一种基于动力矢量的航迹控制方法 - Google Patents
一种基于动力矢量的航迹控制方法 Download PDFInfo
- Publication number
- CN106598051A CN106598051A CN201611144765.8A CN201611144765A CN106598051A CN 106598051 A CN106598051 A CN 106598051A CN 201611144765 A CN201611144765 A CN 201611144765A CN 106598051 A CN106598051 A CN 106598051A
- Authority
- CN
- China
- Prior art keywords
- flight
- flight path
- ship
- sailing
- preset
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 17
- 238000004513 sizing Methods 0.000 claims description 2
- 239000007921 spray Substances 0.000 claims description 2
- 230000002153 concerted effect Effects 0.000 claims 1
- 238000001514 detection method Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000004590 computer program Methods 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
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)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种基于动力矢量的航迹控制方法,用于提高船舶航迹控制精度,使船舶沿预定航迹航行,本发明提供了一种基于动力矢量的航迹控制方法,步骤如下:测定船舶当前的预定航迹、航速、航向及当前位置,计算当前位置与预定航迹的偏航距离;若偏航距离H≥预定范围δ,选定校正航迹;由校正航迹计算船舶的动力矢量,分解至各个动力设备的控制量,并控制船舶航行。本发明航迹控制采用即时检测、即时控制的方式,周期性检测船舶与预定航迹的偏差,计算、选定校正航迹,由动力矢量提供动力,使船舶沿校正航迹驶回预定航迹,具有反应迅速、航迹控制精度高的特点,适于通过狭窄航道或执行区域全覆盖搜索。
Description
技术领域
本发明涉及船舶航迹控制技术领域,具体涉及到一种基于动力矢量的航迹控制方法。
背景技术
航迹控制是航海技术的重要组成部分。为了确保船舶安全、经济的航行,航海人员必须时刻把握船舶每一时刻准确位置和航向,由船舶当前位置、航向与给定计划航线计算出航向、航迹误差,根据航向、航迹误差给出舵角控制指令,使船舶沿预定的计划航线航向。
传统的航迹控制技术在“船舶航迹控制技术研究(张丹仁)”一文中有详细描述,将目标点作为闭环反馈进行控制,即运载器的目标航向始终指向目标,只考虑运载器的航向误差,不去考虑运载器的位置与航线的偏差;这种控制方法实现简单,但抗干扰能力弱。如图1所示,一旦出现外界扰动使运载器航迹偏移,就很难使运载器恢复到原定航迹。在某些情况下,如通过狭窄航道或执行区域全覆盖搜索、探测任务时,传统的航迹控制技术将难以满足要求。
发明内容
为了提高船舶航迹控制精度,使船舶沿预定航迹航行,本发明提供了一种基于动力矢量的航迹控制方法。
本发明采用的技术方案如下:
一种基于动力矢量的航迹控制方法,步骤如下:(a)测定船舶当前的预定航迹PQ、航速V、航向θ及当前位置A,计算当前位置A与预定航迹PQ的偏航距离H;(b)若偏航距离H<预定范围δ,正常航行;若偏航距离H≥预定范围δ,选定校正航迹;(c)由校正航迹计算船舶的动力矢量,分解至各个动力设备的控制量,并控制船舶航行;(d)船舶航行至二号航迹终点时数据清零,重复前述步骤。
所述校正航迹包括圆弧形的一号航迹与二号航迹,一号航迹起点与航向θ相切,二号航迹终点与预定航迹PQ相切,一号航迹终点与二号航迹起点平滑相切。
所述一号航迹的转弯半径为R1,其向心力为F1,且F1为动力矢量最大合力Fmax的一半,所述一号航迹包括驶向预定航迹PQ的S1航迹或驶离预定航迹PQ的S2航迹。
所述二号航迹的转弯半径为R2,且与S1、S2、PQ均相切,其向心力为F2,所述二号航迹包括靠近预定航迹PQ终点的S3航迹或靠近预定航迹PQ起点的S4航迹。
所述步骤b中,在S1航迹、S2航迹任选一条作为一号航迹,在S3航迹、S4航迹任选一条作为二号航迹,所有组合中的最短航迹即为所述校正航迹。
所述动力矢量包括双发动机分别带动的方向、大小可控的挂浆机或喷泵。
本发明的有益效果是:
本发明航迹控制采用即时检测、即时控制的方式,周期性检测船舶与预定航迹的偏差,计算、选定校正航迹,由动力矢量提供动力,使船舶沿校正航迹驶回预定航迹,具有反应迅速、航迹控制精度高的特点,适于通过狭窄航道或执行区域全覆盖搜索。
附图说明
图1是船舶现有航迹控制方法的示意图。
图2是本发明实施例中船舶当前航向与预定航迹夹角小于90°时的校正航迹示意图。
图3是本发明实施例中船舶当前航向与预定航迹夹角大于90°时的校正航迹示意图。
图4是本发明实施例中动力矢量的示意图。
图5是本发明实施例中航迹控制程序的流程图。
具体实施方式
下面结合附图与实施例对本发明作进一步说明。
实施例中,如图2、图3所示,分别为船舶当前航向θ与预定航迹PQ夹角小于90°、大于90°时的校正航迹。取一号航迹半径R1,其向心力为F1,且F1为动力矢量最大合力Fmax的一半,另航速V,由向心力公式可得R1值,结合船舶当前航向θ、及当前位置A坐标,可得驶向预定航迹PQ的S1航迹圆心O1、驶离预定航迹PQ的S2航迹圆心O2。
实施例中,如图2、图3所示,二号航迹与S1、S2、PQ均相切,由S1航迹、S2航迹、PQ的位置关系可得靠近预定航迹PQ终点的S3航迹圆心O3、靠近预定航迹PQ起点的S4航迹圆心O4,以及二号航迹半径R2,另航速V,可得此时向心力F2。
实施例中,如图2、图3,校正航迹可以S1/S2中任一条与S3/S4中任一条组合而成,根据不同情况,优选其中最短的航迹。
上述实施例中的一号航迹与二号航迹仅仅是校正航迹的一种选择,船舶也可根据实。际航向情况或航迹控制精度选择其他的形状的校正航迹。
实施例中,如图4所示,NL与NR为两台动力矢量装置提供的方向、大小可控的驱动力,M为船舶质心,Fz用来克服水面阻力位置航速,为已知的经验值或设定值,Fh为校正航迹提供向心力。在动力矢量装置与船舶质心位置确定的前提下,由力的分解与合成,容易由Fz、Fh计算得FL与NR,FL与NR的值即为航迹控制的直接控制参数。
实施例中,上述航迹控制过程在主控机程序控制系统循环进行,其主程序流程图如图5所示。
显然,本发明的上述实施例仅仅是为了说明本发明所作的举例,而并非对本发明的实施方式的限定。对于所属领域的普通技术人员来说,在上述说明的基础上还可以做出其他不同形式的变化或变动。这里无需也无法对所有的实施方式予以穷例。而这些属于本发明的实质精神所引申出的显而易见的变化或变动仍属于本发明的保护范围。
Claims (6)
1.一种基于动力矢量的航迹控制方法,其特征是具有如下步骤:(a)测定船舶当前的预定航迹PQ、航速V、航向θ及当前位置A,计算当前位置A与预定航迹PQ的偏航距离H;(b)若偏航距离H<预定范围δ,正常航行;若偏航距离H≥预定范围δ,选定校正航迹;(c)由校正航迹计算船舶的动力矢量,分解至各个动力设备的控制量,并控制船舶航行;(d)船舶航行至二号航迹终点时数据清零,重复前述步骤。
2.根据权利要求1所述的一种基于动力矢量的航迹控制方法,其特征在于:所述校正航迹包括圆弧形的一号航迹与二号航迹,一号航迹起点与航向θ相切,二号航迹终点与预定航迹PQ相切,一号航迹终点与二号航迹起点平滑相切。
3.根据权利要求2所述的一种基于动力矢量的航迹控制方法,其特征在于:所述一号航迹的转弯半径为R1,其向心力为F1,且F1为动力矢量最大合力Fmax的一半,所述一号航迹包括驶向预定航迹PQ的S1航迹或驶离预定航迹PQ的S2航迹。
4.根据权利要求3所述的一种基于动力矢量的航迹控制方法,其特征在于:所述二号航迹的转弯半径为R2,且与S1、S2、PQ均相切,其向心力为F2,所述二号航迹包括靠近预定航迹PQ终点的S3航迹或靠近预定航迹PQ起点的S4航迹。
5.根据权利要求4所述的一种基于动力矢量的航迹控制方法,其特征在于:所述步骤b中,在S1航迹、S2航迹任选一条作为一号航迹,在S3航迹、S4航迹任选一条作为二号航迹,所有组合中的最短航迹即为所述校正航迹。
6.根据权利要求1所述的一种基于动力矢量的航迹控制方法,其特征在于:所述动力矢量包括双发动机分别带动的方向、大小可控的挂浆机或喷泵。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611144765.8A CN106598051B (zh) | 2016-12-13 | 2016-12-13 | 一种基于动力矢量的航迹控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611144765.8A CN106598051B (zh) | 2016-12-13 | 2016-12-13 | 一种基于动力矢量的航迹控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106598051A true CN106598051A (zh) | 2017-04-26 |
CN106598051B CN106598051B (zh) | 2019-04-12 |
Family
ID=58801049
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201611144765.8A Active CN106598051B (zh) | 2016-12-13 | 2016-12-13 | 一种基于动力矢量的航迹控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106598051B (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106950955A (zh) * | 2017-03-17 | 2017-07-14 | 武汉理工大学 | 基于改进los引导算法的船舶航迹控制方法 |
CN108490944A (zh) * | 2018-04-09 | 2018-09-04 | 四方继保(武汉)软件有限公司 | 一种基于喷水推进器的船艇矢量控制系统及方法 |
CN108801262A (zh) * | 2018-05-31 | 2018-11-13 | 青岛中乌特种船舶研究设计院有限公司 | 一种船舶自动航行控制器航路规划与纠偏修正方法 |
WO2019051914A1 (zh) * | 2017-09-15 | 2019-03-21 | 广船国际有限公司 | 一种船舶tcs自动检测方法 |
CN112435449A (zh) * | 2020-11-24 | 2021-03-02 | 中国水产科学研究院南海水产研究所 | 一种全数字智能化渔业违规船舶识别排查系统及方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1800781A (zh) * | 2004-12-30 | 2006-07-12 | 中国科学院自动化研究所 | 一种航迹自动舵控制系统及其方法 |
WO2010007115A2 (de) * | 2008-07-15 | 2010-01-21 | Aerospy Sense And Avoid Technology Gmbh | System und verfahren zur kollisionsvermeidung |
CN101872195A (zh) * | 2010-06-21 | 2010-10-27 | 哈尔滨工程大学 | 船舶海上航行航迹解析偏差生成方法 |
CN102278986A (zh) * | 2011-06-21 | 2011-12-14 | 海华电子企业(中国)有限公司 | 电子海图航线设计最优化方法 |
CN104571129A (zh) * | 2014-12-26 | 2015-04-29 | 北京控制工程研究所 | 一种巡视器航向到位控制轨迹确定方法 |
-
2016
- 2016-12-13 CN CN201611144765.8A patent/CN106598051B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1800781A (zh) * | 2004-12-30 | 2006-07-12 | 中国科学院自动化研究所 | 一种航迹自动舵控制系统及其方法 |
WO2010007115A2 (de) * | 2008-07-15 | 2010-01-21 | Aerospy Sense And Avoid Technology Gmbh | System und verfahren zur kollisionsvermeidung |
CN101872195A (zh) * | 2010-06-21 | 2010-10-27 | 哈尔滨工程大学 | 船舶海上航行航迹解析偏差生成方法 |
CN102278986A (zh) * | 2011-06-21 | 2011-12-14 | 海华电子企业(中国)有限公司 | 电子海图航线设计最优化方法 |
CN104571129A (zh) * | 2014-12-26 | 2015-04-29 | 北京控制工程研究所 | 一种巡视器航向到位控制轨迹确定方法 |
Non-Patent Citations (1)
Title |
---|
吴友谦,等: "基于Dubins曲线的无人直升机轨迹规划", 《计算机工程与设计》 * |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106950955A (zh) * | 2017-03-17 | 2017-07-14 | 武汉理工大学 | 基于改进los引导算法的船舶航迹控制方法 |
CN106950955B (zh) * | 2017-03-17 | 2019-11-05 | 武汉理工大学 | 基于改进los引导算法的船舶航迹控制方法 |
WO2019051914A1 (zh) * | 2017-09-15 | 2019-03-21 | 广船国际有限公司 | 一种船舶tcs自动检测方法 |
CN108490944A (zh) * | 2018-04-09 | 2018-09-04 | 四方继保(武汉)软件有限公司 | 一种基于喷水推进器的船艇矢量控制系统及方法 |
CN108801262A (zh) * | 2018-05-31 | 2018-11-13 | 青岛中乌特种船舶研究设计院有限公司 | 一种船舶自动航行控制器航路规划与纠偏修正方法 |
CN112435449A (zh) * | 2020-11-24 | 2021-03-02 | 中国水产科学研究院南海水产研究所 | 一种全数字智能化渔业违规船舶识别排查系统及方法 |
Also Published As
Publication number | Publication date |
---|---|
CN106598051B (zh) | 2019-04-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106598051A (zh) | 一种基于动力矢量的航迹控制方法 | |
US10183733B2 (en) | Program, method and device for controlling movable body | |
US9213336B2 (en) | Guidance and control system for under-actuated marine surface ships and other autonomous-platforms | |
CN104267736B (zh) | 一种帆船自主控制方法、装置及帆船 | |
CN111487966B (zh) | 一种基于航路点的水面无人艇自适应路径跟踪控制方法 | |
CN104820430B (zh) | 一种基于偶极势场的auv回坞导引系统及导引方法 | |
CN106444838A (zh) | 一种自主水下航行器的精确航路跟踪控制方法 | |
JPWO2016104030A6 (ja) | 移動体制御装置、移動体制御方法、および移動体制御プログラム | |
CN106403957A (zh) | 一种全垫升气垫船航路点导引控制方法 | |
JP2004042884A (ja) | 移動体の操縦方法及び装置 | |
WO2012071211A3 (en) | System and method for a marine vessel autopilot | |
CN107585163A (zh) | 移动路线生成装置以及移动路线生成方法 | |
CN103760902A (zh) | 一种基于模糊控制的无人水面艇直线路径跟踪方法 | |
Liu et al. | Drift angle compensation-based adaptive line-of-sight path following for autonomous underwater vehicle | |
CN105045284A (zh) | 一种抗干扰无人飞行器路径跟踪控制方法 | |
JP6882243B2 (ja) | 避航支援装置 | |
CN114527744B (zh) | 基于天牛须搜索优化的无人帆船路径跟踪制导方法 | |
JP6686249B2 (ja) | 船舶の自動操縦システム、船舶、及び船舶の自動操縦方法 | |
CN111928838A (zh) | 一种基于舰载无人机前轮转弯技术的路径规划方法 | |
CN105094144B (zh) | 一种无人飞艇自适应抗风路径跟踪控制方法 | |
CN106919172B (zh) | 一种动力定位船舶跟踪的导引控制方法 | |
CN105825714B (zh) | 鲁棒航迹引导律的确定方法及装置 | |
JP6658220B2 (ja) | 航走制御方法および装置 | |
JP6487264B2 (ja) | ウェイポイント生成装置 | |
CN105911990A (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 |