CN114779791B - 一种波浪滑翔器位置保持方法及系统 - Google Patents

一种波浪滑翔器位置保持方法及系统 Download PDF

Info

Publication number
CN114779791B
CN114779791B CN202210694037.3A CN202210694037A CN114779791B CN 114779791 B CN114779791 B CN 114779791B CN 202210694037 A CN202210694037 A CN 202210694037A CN 114779791 B CN114779791 B CN 114779791B
Authority
CN
China
Prior art keywords
wave glider
current position
center point
ordinate
abscissa
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
Application number
CN202210694037.3A
Other languages
English (en)
Other versions
CN114779791A (zh
Inventor
孙秀军
桑宏强
周莹
于佩元
张帅
孙超
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Qingdao Haizhou Technology Co ltd
Original Assignee
Qingdao Haizhou Technology Co ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Qingdao Haizhou Technology Co ltd filed Critical Qingdao Haizhou Technology Co ltd
Priority to CN202210694037.3A priority Critical patent/CN114779791B/zh
Publication of CN114779791A publication Critical patent/CN114779791A/zh
Application granted granted Critical
Publication of CN114779791B publication Critical patent/CN114779791B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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
    • Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T70/00—Maritime or waterways transport
    • Y02T70/50—Measures to reduce greenhouse gas emissions related to the propulsion system
    • Y02T70/5218—Less carbon-intensive fuels, e.g. natural gas, biofuels
    • Y02T70/5236—Renewable or hybrid-electric solutions

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

本发明涉及一种波浪滑翔器位置保持方法及系统，涉及波浪滑翔器技术领域，方法包括实时获取波浪滑翔器当前位置和位置保持信息；所述位置保持信息包括位置保持中心点和限制圆半径；根据所述波浪滑翔器当前位置和所述位置保持中心点确定所述波浪滑翔器与所述位置保持中心点之间的距离；判断所述距离是否大于所述限制圆半径，得到判断结果；若是，则利用LOS算法根据所述波浪滑翔器当前位置和所述位置保持中心点确定期望航向角；若否，则利用位置保持算法根据所述波浪滑翔器当前位置和所述位置保持中心点控制打舵操作。本发明能够提高波浪滑翔器的定位精度并降低能源消耗。

Description

一种波浪滑翔器位置保持方法及系统
技术领域
本发明涉及波浪滑翔器领域，特别是涉及一种波浪滑翔器位置保持方法及系统。
背景技术
波浪滑翔器是一型利用波浪能为驱动力的无人自主航行器，利用船上的太阳能电池板为波浪滑翔器导航、通讯和运动控制等模块提供能源供给，具有长期连续航行、自主导航定位、人工智能识别等功能，可以实现对海洋水下、水面和空中信息的检测。
波浪滑翔器位置保持是指波浪滑翔器在目标点一定范围内进行位置保持的控制，以便于能够长期锚定在所设置的目标点，完成对更好的执行各种各样的海洋探测，目前，国内外有很多的波浪滑翔器位置保持方法，但普遍其定位精度不高，并在波浪滑翔器执行锚泊任务时能量消耗较大，存在很大的局限性。
发明内容
本发明的目的是提供一种波浪滑翔器位置保持方法及系统，以提高波浪滑翔器的定位精度并降低能源消耗。
为实现上述目的，本发明提供了如下方案：
一种波浪滑翔器位置保持方法，包括：
实时获取波浪滑翔器当前位置和位置保持信息；所述位置保持信息包括位置保持中心点和限制圆半径；
根据所述波浪滑翔器当前位置和所述位置保持中心点确定所述波浪滑翔器与所述位置保持中心点之间的距离；
判断所述距离是否大于所述限制圆半径，得到判断结果；
若所述判断结果为是，则利用LOS算法根据所述波浪滑翔器当前位置和所述位置保持中心点确定期望航向角；所述期望航向角用于控制舵机进行打舵操作；
若所述判断结果为否，则利用位置保持算法根据所述波浪滑翔器当前位置和所述位置保持中心点控制打舵操作。
可选地，所述距离的表达式为：
Figure 294185DEST_PATH_IMAGE001
其中，D表示距离，
Figure 511408DEST_PATH_IMAGE002
代表波浪滑翔器当前位置的横坐标，
Figure 683DEST_PATH_IMAGE003
代表波浪滑翔器当前位置的纵坐标，
Figure 102500DEST_PATH_IMAGE004
代表波浪滑翔器位置保持中心点的横坐标，
Figure 357901DEST_PATH_IMAGE005
代表波浪滑翔器位置保持中心点的纵坐标。
可选地，所述利用位置保持算法根据所述波浪滑翔器当前位置和所述位置保持中心点控制打舵操作，具体包括：
根据所述波浪滑翔器当前位置和所述位置保持中心点之间的坐标系夹角进行转换，得到平台期望航向角；
根据所述平台期望航向与当前航向角的差值进行打舵操作。
可选地，所述根据所述波浪滑翔器当前位置和所述位置保持中心点之间的坐标系夹角进行转换，得到平台期望航向角，具体包括：
当波浪滑翔器当前位置的纵坐标大于所述位置保持中心点的纵坐标时，确定所述平台期望航向角为
Figure 636041DEST_PATH_IMAGE006
；其中，
Figure 140840DEST_PATH_IMAGE007
代表波浪滑翔器当前位置的横坐标，
Figure 515190DEST_PATH_IMAGE008
代表波浪滑翔器当前位置的纵坐标，
Figure 625097DEST_PATH_IMAGE009
代表波浪滑翔器位置保持中心点的横坐标，
Figure 796840DEST_PATH_IMAGE010
代表波浪滑翔器位置保持中心点的纵坐标；
当波浪滑翔器当前位置的纵坐标小于所述位置保持中心点的纵坐标且当波浪滑翔器当前位置的横坐标大于或者等于所述位置保持中心点的横坐标时，确定所述平台期望航向角为
Figure 992198DEST_PATH_IMAGE011
；
当波浪滑翔器当前位置的纵坐标小于所述位置保持中心点的纵坐标且当波浪滑翔器当前位置的横坐标小于所述位置保持中心点的横坐标时，确定所述平台期望航向角为
Figure 373501DEST_PATH_IMAGE012
；
当波浪滑翔器当前位置的纵坐标等于所述位置保持中心点的纵坐标且当波浪滑翔器当前位置的横坐标大于所述位置保持中心点的横坐标时，确定所述平台期望航向角为
Figure 72335DEST_PATH_IMAGE013
；
当波浪滑翔器当前位置的纵坐标等于所述位置保持中心点的纵坐标且当波浪滑翔器当前位置的横坐标小于所述位置保持中心点的横坐标时，确定所述平台期望航向角为
Figure 412050DEST_PATH_IMAGE014
。
一种波浪滑翔器位置保持系统，包括：
实时获取模块，用于实时获取波浪滑翔器当前位置和位置保持信息；所述位置保持信息包括位置保持中心点和限制圆半径；
距离确定模块，用于根据所述波浪滑翔器当前位置和所述位置保持中心点确定所述波浪滑翔器与所述位置保持中心点之间的距离；
判断模块，用于判断所述距离是否大于所述限制圆半径，得到判断结果；
LOS算法规划模块，用于若所述判断结果为是，则利用LOS算法根据所述波浪滑翔器当前位置和所述位置保持中心点确定期望航向角；所述期望航向角用于控制舵机进行打舵操作；
位置保持模块，用于若所述判断结果为否，则利用位置保持算法根据所述波浪滑翔器当前位置和所述位置保持中心点控制打舵操作。
可选地，所述距离的表达式为：
Figure 300896DEST_PATH_IMAGE001
其中，D表示距离，
Figure 17048DEST_PATH_IMAGE002
代表波浪滑翔器当前位置的横坐标，
Figure 39231DEST_PATH_IMAGE003
代表波浪滑翔器当前位置的纵坐标，
Figure 549846DEST_PATH_IMAGE004
代表波浪滑翔器位置保持中心点的横坐标，
Figure 923059DEST_PATH_IMAGE005
代表波浪滑翔器位置保持中心点的纵坐标。
可选地，所述位置保持模块，具体包括：
平台期望航向角确定子模块，用于根据所述波浪滑翔器当前位置和所述位置保持中心点之间的坐标系夹角进行转换，得到平台期望航向角；
打舵子模块，用于根据所述平台期望航向与当前航向角的差值进行打舵操作。
可选地，所述平台期望航向角确定子模块，具体包括：
第一确定单元，用于当波浪滑翔器当前位置的纵坐标大于所述位置保持中心点的纵坐标时，确定所述平台期望航向角为
Figure 649094DEST_PATH_IMAGE006
；其中，
Figure 791362DEST_PATH_IMAGE007
代表波浪滑翔器当前位置的横坐标，
Figure 738459DEST_PATH_IMAGE008
代表波浪滑翔器当前位置的纵坐标，
Figure 333388DEST_PATH_IMAGE009
代表波浪滑翔器位置保持中心点的横坐标，
Figure 391343DEST_PATH_IMAGE010
代表波浪滑翔器位置保持中心点的纵坐标；
第二确定单元，用于当波浪滑翔器当前位置的纵坐标小于所述位置保持中心点的纵坐标且当波浪滑翔器当前位置的横坐标大于或者等于所述位置保持中心点的横坐标时，确定所述平台期望航向角为
Figure 379328DEST_PATH_IMAGE011
；
第三确定单元，用于当波浪滑翔器当前位置的纵坐标小于所述位置保持中心点的纵坐标且当波浪滑翔器当前位置的横坐标小于所述位置保持中心点的横坐标时，确定所述平台期望航向角为
Figure 497326DEST_PATH_IMAGE012
；
第四确定单元，用于当波浪滑翔器当前位置的纵坐标等于所述位置保持中心点的纵坐标且当波浪滑翔器当前位置的横坐标大于所述位置保持中心点的横坐标时，确定所述平台期望航向角为
Figure 110710DEST_PATH_IMAGE013
；
第五确定单元，用于当波浪滑翔器当前位置的纵坐标等于所述位置保持中心点的纵坐标且当波浪滑翔器当前位置的横坐标小于所述位置保持中心点的横坐标时，确定所述平台期望航向角为
Figure 237935DEST_PATH_IMAGE014
。
根据本发明提供的具体实施例，本发明公开了以下技术效果：
本发明实时获取波浪滑翔器当前位置和位置保持信息；所述位置保持信息包括位置保持中心点和限制圆半径；根据所述波浪滑翔器当前位置和所述位置保持中心点确定所述波浪滑翔器与所述位置保持中心点之间的距离；判断所述距离是否大于所述限制圆半径，得到判断结果；若所述判断结果为是，则利用LOS算法根据所述波浪滑翔器当前位置和所述位置保持中心点确定期望航向角；所述期望航向角用于控制舵机进行打舵操作；若所述判断结果为否，则利用位置保持算法根据所述波浪滑翔器当前位置和所述位置保持中心点控制打舵操作。本发明通过位置保持控制算法减小了因外界环境而造成的定位误差和能量消耗，将波浪滑翔机的运动区域限制在一定范围内，保证波浪滑翔器在海上工作的可靠性。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案，下面将对实施例中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动性的前提下，还可以根据这些附图获得其他的附图。
图1为本发明提供的波浪滑翔器位置保持方法流程图；
图2为本发明提供的波浪滑翔器位置保持方法效果示意图；
图3为本发明提供的波浪滑翔器位置保持方法示意图。
具体实施方式
下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。
本发明的目的是提供一种波浪滑翔器位置保持方法及系统，以提高波浪滑翔器的定位精度并降低能源消耗。
为使本发明的上述目的、特征和优点能够更加明显易懂，下面结合附图和具体实施方式对本发明作进一步详细的说明。
如图1所示和图3所示，本发明提供的一种波浪滑翔器位置保持方法，包括：
步骤101：实时获取波浪滑翔器当前位置和位置保持信息；所述位置保持信息包括位置保持中心点和限制圆半径。
设置波浪滑翔器位置保持中心点
Figure 620375DEST_PATH_IMAGE015
，引入限制圆，给出限制圆半径R，并建立直角坐标系。限制圆半径一般为500米。
步骤102：根据所述波浪滑翔器当前位置和所述位置保持中心点确定所述波浪滑翔器与所述位置保持中心点之间的距离。所述距离的表达式为：
Figure 381045DEST_PATH_IMAGE001
其中，D表示距离，
Figure 684987DEST_PATH_IMAGE002
代表波浪滑翔器当前位置的横坐标，
Figure 819165DEST_PATH_IMAGE003
代表波浪滑翔器当前位置的纵坐标，
Figure 790532DEST_PATH_IMAGE004
代表波浪滑翔器位置保持中心点的横坐标，
Figure 250332DEST_PATH_IMAGE005
代表波浪滑翔器位置保持中心点的纵坐标。
步骤103：判断所述距离是否大于所述限制圆半径，得到判断结果。若所述判断结果为是，则执行步骤104；若所述判断结果为否，则执行步骤105。
步骤104：利用LOS算法根据所述波浪滑翔器当前位置和所述位置保持中心点确定期望航向角；所述期望航向角用于控制舵机进行打舵操作。
步骤105：利用位置保持算法根据所述波浪滑翔器当前位置和所述位置保持中心点控制打舵操作。所述利用位置保持算法根据所述波浪滑翔器当前位置和所述位置保持中心点控制打舵操作，具体包括：
根据所述波浪滑翔器当前位置和所述位置保持中心点之间的坐标系夹角进行转换，得到平台期望航向角；所述根据所述波浪滑翔器当前位置和所述位置保持中心点之间的坐标系夹角进行转换，得到平台期望航向角，具体包括：
当波浪滑翔器当前位置的纵坐标大于所述位置保持中心点的纵坐标时，确定所述平台期望航向角为
Figure 310080DEST_PATH_IMAGE006
；其中，
Figure 513528DEST_PATH_IMAGE007
代表波浪滑翔器当前位置的横坐标，
Figure 604981DEST_PATH_IMAGE008
代表波浪滑翔器当前位置的纵坐标，
Figure 704524DEST_PATH_IMAGE009
代表波浪滑翔器位置保持中心点的横坐标，
Figure 45375DEST_PATH_IMAGE010
代表波浪滑翔器位置保持中心点的纵坐标。
当波浪滑翔器当前位置的纵坐标小于所述位置保持中心点的纵坐标且当波浪滑翔器当前位置的横坐标大于或者等于所述位置保持中心点的横坐标时，确定所述平台期望航向角为
Figure 321023DEST_PATH_IMAGE011
。
当波浪滑翔器当前位置的纵坐标小于所述位置保持中心点的纵坐标且当波浪滑翔器当前位置的横坐标小于所述位置保持中心点的横坐标时，确定所述平台期望航向角为
Figure 594879DEST_PATH_IMAGE012
。
当波浪滑翔器当前位置的纵坐标等于所述位置保持中心点的纵坐标且当波浪滑翔器当前位置的横坐标大于所述位置保持中心点的横坐标时，确定所述平台期望航向角为
Figure 662061DEST_PATH_IMAGE013
。
当波浪滑翔器当前位置的纵坐标等于所述位置保持中心点的纵坐标且当波浪滑翔器当前位置的横坐标小于所述位置保持中心点的横坐标时，确定所述平台期望航向角为
Figure 427892DEST_PATH_IMAGE014
。
根据所述平台期望航向与当前航向角的差值进行打舵操作。
本发明设计波浪滑翔器位置保持算法，有效的增加了波浪滑翔器在海上的定位精度并减小了波浪滑翔器的能源消耗，进而保证波浪滑翔器在海上工作的可靠性，实现精确的海洋监测和资料获取。
如图3所示，本发明还提供了波浪滑翔器位置保持方法在实际应用中的具体工作流程：
第一步获取位置信息确定航行算法：波浪滑翔器航行在海面上，依靠自身携带的GPS进行实时定位，获取波浪滑翔器当前位置
Figure 456632DEST_PATH_IMAGE016
，通过通讯卫星给予波浪滑翔器一个位置保持中心点
Figure 257098DEST_PATH_IMAGE017
和限制圆半径R，位置保持点为限制圆中心，波浪滑翔器的主控系统计算当前位置坐标和目标点坐标得出两者之间的距离D，通过比较D和R的大小来确定波浪滑翔器的控制算法。其中，目标点即为限制圆中心点。
第二步未进入到限制圆时：通过罗盘采集当前航向角
Figure 229602DEST_PATH_IMAGE018
，利用LOS算法计算期望航向角
Figure 217150DEST_PATH_IMAGE019
，执行打舵使波浪滑翔器进入限制圆，通过GPS模块对波浪滑翔器进行实时定位，获取波浪滑翔器当前位置
Figure 300512DEST_PATH_IMAGE020
。当D>R时，即波浪滑翔器未进入到限制圆的时候，波浪滑翔器执行路径规划算法，通过自身的电子罗盘采集当前航向角
Figure 489573DEST_PATH_IMAGE018
，利用现有导航算法LOS算法计算当前位置
Figure 101820DEST_PATH_IMAGE020
和位置保持中心点
Figure 638980DEST_PATH_IMAGE021
来得出期望航向角
Figure 729296DEST_PATH_IMAGE019
，波浪滑翔器主控系统依据前航向角
Figure 504354DEST_PATH_IMAGE022
和期望航向角
Figure 290432DEST_PATH_IMAGE019
计算得来的差值来控制舵机进行打舵操作，使得波浪滑翔器朝着位置保持中心点
Figure 518151DEST_PATH_IMAGE021
的方向航行。
如图2所示，第三步进入限制圆后，根据目标点和滑翔机的实时位置来获得所需的航向执行位置保持算法，将滑翔机的运动区域限制在一定的范围内。进入到限制圆时：当D<R时，即波浪滑翔器进入到限制圆中在进入限制圆后，根据波浪滑翔器进入限制圆时的瞬时状态，执行位置保持算法。位置保持算法通过计算波浪滑翔器当前位置与目标点位置之间的坐标系夹角换算为平台期望航向角，波浪滑翔器主控系统计算期望航向角和电子罗盘采集的当前航向角的差值，舵机进行打舵操作，控制使波浪滑翔器由当前位置驶向目标位置点，实现平台的位置锚定。
位置保持算法如下：当平台当前位置的
Figure 208895DEST_PATH_IMAGE023
大于目标位置的
Figure 369618DEST_PATH_IMAGE024
时，则波浪滑翔器的期望航向角为
Figure 589247DEST_PATH_IMAGE025
当平台当前位置的
Figure 572771DEST_PATH_IMAGE026
小于目标位置的
Figure 270468DEST_PATH_IMAGE027
，平台当前位置的
Figure 20119DEST_PATH_IMAGE028
大于等于目标位置的
Figure 145069DEST_PATH_IMAGE029
，则波浪滑翔器的期望航向角为
Figure 347381DEST_PATH_IMAGE030
，当平台当前位置的
Figure 379928DEST_PATH_IMAGE023
小于目标位置的
Figure 975295DEST_PATH_IMAGE024
，平台当前位置的
Figure 67885DEST_PATH_IMAGE028
小于目标位置的
Figure 491913DEST_PATH_IMAGE029
，则波浪滑翔器的期望航向角为
Figure 265834DEST_PATH_IMAGE031
，当平台当前位置的
Figure 521235DEST_PATH_IMAGE023
等于目标位置的
Figure 990918DEST_PATH_IMAGE024
，平台当前位置的
Figure 902242DEST_PATH_IMAGE028
大于目标位置的
Figure 542171DEST_PATH_IMAGE029
，则波浪滑翔器的期望航向角为
Figure 917658DEST_PATH_IMAGE032
，当平台当前位置的
Figure 558242DEST_PATH_IMAGE023
等于目标位置的
Figure 956862DEST_PATH_IMAGE024
，平台当前位置的
Figure 869323DEST_PATH_IMAGE028
小于目标位置的
Figure 302579DEST_PATH_IMAGE029
，则波浪滑翔器的期望航向角为
Figure 376714DEST_PATH_IMAGE033
，如果波浪滑翔器驶出限制圆后，则重复之前的步骤，通过上述步骤，实现波浪滑翔器更高的定位精度。其中，位置保持算法中波浪滑翔器的期望航向角即为平台期望航向角。
其中，波浪滑翔器位置保持算法的表达式为：
Figure 731472DEST_PATH_IMAGE034
其中，
Figure 450554DEST_PATH_IMAGE035
代表波浪滑翔器当前位置坐标，
Figure 3895DEST_PATH_IMAGE036
代表波浪滑翔器位置保持中心点坐标。
在波浪滑翔器进行位置保持的过程中，波浪滑翔器会因强烈的外界干扰而导致其偏离目标点，对滑翔机采用稳健高效的运动控制策略具有重要意义，本发明设计了位置保持控制算法减小了因外界环境而造成的定位误差和能量消耗，将波浪滑翔机的运动区域限制在一定范围内，保证波浪滑翔器在海上工作的可靠性。
本发明提供的一种波浪滑翔器位置保持系统，包括：
实时获取模块，用于实时获取波浪滑翔器当前位置和位置保持信息；所述位置保持信息包括位置保持中心点和限制圆半径。
距离确定模块，用于根据所述波浪滑翔器当前位置和所述位置保持中心点确定所述波浪滑翔器与所述位置保持中心点之间的距离。
判断模块，用于判断所述距离是否大于所述限制圆半径，得到判断结果；
LOS算法规划模块，用于若所述判断结果为是，则利用LOS算法根据所述波浪滑翔器当前位置和所述位置保持中心点确定期望航向角；所述期望航向角用于控制舵机进行打舵操作。
位置保持模块，用于若所述判断结果为否，则利用位置保持算法根据所述波浪滑翔器当前位置和所述位置保持中心点控制打舵操作。
作为一种可选地实施方式，所述距离的表达式为：
Figure 514511DEST_PATH_IMAGE001
其中，D表示距离，
Figure 887723DEST_PATH_IMAGE002
代表波浪滑翔器当前位置的横坐标，
Figure 141987DEST_PATH_IMAGE003
代表波浪滑翔器当前位置的纵坐标，
Figure 564483DEST_PATH_IMAGE004
代表波浪滑翔器位置保持中心点的横坐标，
Figure 511579DEST_PATH_IMAGE005
代表波浪滑翔器位置保持中心点的纵坐标。
作为一种可选地实施方式，所述位置保持模块，具体包括：
平台期望航向角确定子模块，用于根据所述波浪滑翔器当前位置和所述位置保持中心点之间的坐标系夹角进行转换，得到平台期望航向角。
打舵子模块，用于根据所述平台期望航向与当前航向角的差值进行打舵操作。
作为一种可选地实施方式，所述平台期望航向角确定子模块，具体包括：
第一确定单元，用于当波浪滑翔器当前位置的纵坐标大于所述位置保持中心点的纵坐标时，确定所述平台期望航向角为
Figure 106509DEST_PATH_IMAGE006
；其中，
Figure 164464DEST_PATH_IMAGE007
代表波浪滑翔器当前位置的横坐标，
Figure 426818DEST_PATH_IMAGE008
代表波浪滑翔器当前位置的纵坐标，
Figure 282166DEST_PATH_IMAGE009
代表波浪滑翔器位置保持中心点的横坐标，
Figure 895550DEST_PATH_IMAGE010
代表波浪滑翔器位置保持中心点的纵坐标；
第二确定单元，用于当波浪滑翔器当前位置的纵坐标小于所述位置保持中心点的纵坐标且当波浪滑翔器当前位置的横坐标大于或者等于所述位置保持中心点的横坐标时，确定所述平台期望航向角为
Figure 960458DEST_PATH_IMAGE011
。
第三确定单元，用于当波浪滑翔器当前位置的纵坐标小于所述位置保持中心点的纵坐标且当波浪滑翔器当前位置的横坐标小于所述位置保持中心点的横坐标时，确定所述平台期望航向角为
Figure 874056DEST_PATH_IMAGE012
。
第四确定单元，用于当波浪滑翔器当前位置的纵坐标等于所述位置保持中心点的纵坐标且当波浪滑翔器当前位置的横坐标大于所述位置保持中心点的横坐标时，确定所述平台期望航向角为
Figure 631796DEST_PATH_IMAGE013
。
第五确定单元，用于当波浪滑翔器当前位置的纵坐标等于所述位置保持中心点的纵坐标且当波浪滑翔器当前位置的横坐标小于所述位置保持中心点的横坐标时，确定所述平台期望航向角为
Figure 204248DEST_PATH_IMAGE014
。
本发明能够克服波浪滑翔器在海面上运动时的强烈外界干扰而导致定位精度不高并能耗太大的问题，该算法能将滑翔机的运动区域限制在一定范围内，实现精确的波浪滑翔器位置保持。本发明所涉及的一种波浪滑翔器位置保持方法也可扩展到与波浪滑翔器结构类似的其他多体机构的航行器上。
本说明书中各个实施例采用递进的方式描述，每个实施例重点说明的都是与其他实施例的不同之处，各个实施例之间相同相似部分互相参见即可。对于实施例公开的系统而言，由于其与实施例公开的方法相对应，所以描述的比较简单，相关之处参见方法部分说明即可。
本文中应用了具体个例对本发明的原理及实施方式进行了阐述，以上实施例的说明只是用于帮助理解本发明的方法及其核心思想；同时，对于本领域的一般技术人员，依据本发明的思想，在具体实施方式及应用范围上均会有改变之处。综上所述，本说明书内容不应理解为对本发明的限制。

Claims (4)

1.一种波浪滑翔器位置保持方法，其特征在于，包括：
实时获取波浪滑翔器当前位置和位置保持信息；所述位置保持信息包括位置保持中心点和限制圆半径；
根据所述波浪滑翔器当前位置和所述位置保持中心点确定所述波浪滑翔器与所述位置保持中心点之间的距离；
判断所述距离是否大于所述限制圆半径，得到判断结果；
若所述判断结果为是，则利用LOS算法根据所述波浪滑翔器当前位置和所述位置保持中心点确定期望航向角；所述期望航向角用于控制舵机进行打舵操作；
若所述判断结果为否，则利用位置保持算法根据所述波浪滑翔器当前位置和所述位置保持中心点控制打舵操作；
所述利用位置保持算法根据所述波浪滑翔器当前位置和所述位置保持中心点控制打舵操作，具体包括：
根据所述波浪滑翔器当前位置和所述位置保持中心点之间的坐标系夹角进行转换，得到平台期望航向角；
根据所述平台期望航向与当前航向角的差值进行打舵操作；
所述根据所述波浪滑翔器当前位置和所述位置保持中心点之间的坐标系夹角进行转换，得到平台期望航向角，具体包括：
当波浪滑翔器当前位置的纵坐标大于所述位置保持中心点的纵坐标时，确定所述平台期望航向角为
Figure DEST_PATH_IMAGE001
；其中，
Figure DEST_PATH_IMAGE002
代表波浪滑翔器当前位置的横坐标，
Figure DEST_PATH_IMAGE003
代表波浪滑翔器当前位置的纵坐标，
Figure DEST_PATH_IMAGE004
代表波浪滑翔器位置保持中心点的横坐标，
Figure DEST_PATH_IMAGE005
代表波浪滑翔器位置保持中心点的纵坐标；
当波浪滑翔器当前位置的纵坐标小于所述位置保持中心点的纵坐标且当波浪滑翔器当前位置的横坐标大于或者等于所述位置保持中心点的横坐标时，确定所述平台期望航向角为
Figure DEST_PATH_IMAGE006
；
当波浪滑翔器当前位置的纵坐标小于所述位置保持中心点的纵坐标且当波浪滑翔器当前位置的横坐标小于所述位置保持中心点的横坐标时，确定所述平台期望航向角为
Figure DEST_PATH_IMAGE007
；
当波浪滑翔器当前位置的纵坐标等于所述位置保持中心点的纵坐标且当波浪滑翔器当前位置的横坐标大于所述位置保持中心点的横坐标时，确定所述平台期望航向角为
Figure DEST_PATH_IMAGE008
；
当波浪滑翔器当前位置的纵坐标等于所述位置保持中心点的纵坐标且当波浪滑翔器当前位置的横坐标小于所述位置保持中心点的横坐标时，确定所述平台期望航向角为
Figure DEST_PATH_IMAGE009
。
2.根据权利要求1所述的波浪滑翔器位置保持方法，其特征在于，所述距离的表达式为：
Figure DEST_PATH_IMAGE010
其中，D表示距离，
Figure DEST_PATH_IMAGE011
代表波浪滑翔器当前位置的横坐标，
Figure DEST_PATH_IMAGE012
代表波浪滑翔器当前位置的纵坐标，
Figure DEST_PATH_IMAGE013
代表波浪滑翔器位置保持中心点的横坐标，
Figure DEST_PATH_IMAGE014
代表波浪滑翔器位置保持中心点的纵坐标。
3.一种波浪滑翔器位置保持系统，其特征在于，包括：
实时获取模块，用于实时获取波浪滑翔器当前位置和位置保持信息；所述位置保持信息包括位置保持中心点和限制圆半径；
距离确定模块，用于根据所述波浪滑翔器当前位置和所述位置保持中心点确定所述波浪滑翔器与所述位置保持中心点之间的距离；
判断模块，用于判断所述距离是否大于所述限制圆半径，得到判断结果；
LOS算法规划模块，用于若所述判断结果为是，则利用LOS算法根据所述波浪滑翔器当前位置和所述位置保持中心点确定期望航向角；所述期望航向角用于控制舵机进行打舵操作；
位置保持模块，用于若所述判断结果为否，则利用位置保持算法根据所述波浪滑翔器当前位置和所述位置保持中心点控制打舵操作；
所述位置保持模块，具体包括：
平台期望航向角确定子模块，用于根据所述波浪滑翔器当前位置和所述位置保持中心点之间的坐标系夹角进行转换，得到平台期望航向角；
打舵子模块，用于根据所述平台期望航向与当前航向角的差值进行打舵操作；
所述平台期望航向角确定子模块，具体包括：
第一确定单元，用于当波浪滑翔器当前位置的纵坐标大于所述位置保持中心点的纵坐标时，确定所述平台期望航向角为
Figure 925747DEST_PATH_IMAGE001
；其中，
Figure 718254DEST_PATH_IMAGE002
代表波浪滑翔器当前位置的横坐标，
Figure 573690DEST_PATH_IMAGE003
代表波浪滑翔器当前位置的纵坐标，
Figure 437741DEST_PATH_IMAGE004
代表波浪滑翔器位置保持中心点的横坐标，
Figure 393058DEST_PATH_IMAGE005
代表波浪滑翔器位置保持中心点的纵坐标；
第二确定单元，用于当波浪滑翔器当前位置的纵坐标小于所述位置保持中心点的纵坐标且当波浪滑翔器当前位置的横坐标大于或者等于所述位置保持中心点的横坐标时，确定所述平台期望航向角为
Figure 294149DEST_PATH_IMAGE006
；
第三确定单元，用于当波浪滑翔器当前位置的纵坐标小于所述位置保持中心点的纵坐标且当波浪滑翔器当前位置的横坐标小于所述位置保持中心点的横坐标时，确定所述平台期望航向角为
Figure 451197DEST_PATH_IMAGE007
；
第四确定单元，用于当波浪滑翔器当前位置的纵坐标等于所述位置保持中心点的纵坐标且当波浪滑翔器当前位置的横坐标大于所述位置保持中心点的横坐标时，确定所述平台期望航向角为
Figure 118939DEST_PATH_IMAGE008
；
第五确定单元，用于当波浪滑翔器当前位置的纵坐标等于所述位置保持中心点的纵坐标且当波浪滑翔器当前位置的横坐标小于所述位置保持中心点的横坐标时，确定所述平台期望航向角为
Figure 928763DEST_PATH_IMAGE009
。
4.根据权利要求3所述的波浪滑翔器位置保持系统，其特征在于，所述距离的表达式为：
Figure 755DEST_PATH_IMAGE010
其中，D表示距离，
Figure 896030DEST_PATH_IMAGE011
代表波浪滑翔器当前位置的横坐标，
Figure 833375DEST_PATH_IMAGE012
代表波浪滑翔器当前位置的纵坐标，
Figure 700968DEST_PATH_IMAGE013
代表波浪滑翔器位置保持中心点的横坐标，
Figure 271757DEST_PATH_IMAGE014
代表波浪滑翔器位置保持中心点的纵坐标。
CN202210694037.3A 2022-06-20 2022-06-20 一种波浪滑翔器位置保持方法及系统 Active CN114779791B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202210694037.3A CN114779791B (zh) 2022-06-20 2022-06-20 一种波浪滑翔器位置保持方法及系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202210694037.3A CN114779791B (zh) 2022-06-20 2022-06-20 一种波浪滑翔器位置保持方法及系统

Publications (2)

Publication Number Publication Date
CN114779791A CN114779791A (zh) 2022-07-22
CN114779791B true CN114779791B (zh) 2022-09-13

Family

ID=82421998

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202210694037.3A Active CN114779791B (zh) 2022-06-20 2022-06-20 一种波浪滑翔器位置保持方法及系统

Country Status (1)

Country Link
CN (1) CN114779791B (zh)

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115061482B (zh) * 2022-08-19 2022-11-25 中国海洋大学 一种波浪滑翔器全局路径规划方法及系统
CN115991271A (zh) * 2023-03-23 2023-04-21 中国海洋大学 一种基于螺旋桨推进的波浪滑翔器导航方法及系统
CN116027671B (zh) * 2023-03-28 2023-07-14 中国海洋大学 一种波浪滑翔器的锚定方法及系统

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
GB2440088B (en) * 2005-04-15 2009-12-30 Mitsui Shipbuilding Eng Automatic vessel position holding control method and controller
CN103345259B (zh) * 2013-07-01 2015-09-30 哈尔滨工程大学 动力定位船舶实现定位旋转的几何坐标变换导引控制方法
CN109769211A (zh) * 2018-12-05 2019-05-17 深圳市闻迅数码科技有限公司 一种走锚提醒方法、船舶管理装置及计算机可读存储介质
CN111142541A (zh) * 2020-01-13 2020-05-12 天津工业大学 波浪滑翔器虚拟锚泊导航控制算法
CN111623781A (zh) * 2020-06-09 2020-09-04 青岛海洋科学与技术国家实验室发展中心 用于波浪滑翔器的实时路径导航方法及系统
CN111722627A (zh) * 2020-06-09 2020-09-29 青岛海洋科学与技术国家实验室发展中心 用于水面无人航行器的动态虚拟锚泊控制方法及系统

Also Published As

Publication number Publication date
CN114779791A (zh) 2022-07-22

Similar Documents

Publication Publication Date Title
CN114779791B (zh) 一种波浪滑翔器位置保持方法及系统
CN105511464B (zh) 一种船舶自主航行控制系统及控制方法
CN108803612A (zh) 一种海流影响下的无人巡检船直线航迹跟踪实现方法
CN108860454B (zh) 一种全天候长航程无人帆船设计方法
CN102323820A (zh) 一种智能舵系统及其控制方法
CN104267736A (zh) 一种帆船自主控制方法、装置及帆船
CN113885534B (zh) 一种基于智能预测控制的水面无人船路径跟踪方法
CN110308719A (zh) 一种水面无人艇路径跟踪控制方法
CN111026135B (zh) 一种无人艇高性能航行前馈控制系统及其控制方法
CN103985952B (zh) 船载a-e-c三轴卫星通信天线极化偏差角实时修正方法
CN112036099B (zh) 一种基于帆船风帆攻角确定最小回转半径的方法
CN111142541A (zh) 波浪滑翔器虚拟锚泊导航控制算法
CN112558642A (zh) 一种适用于异构多无人系统的海空联合围捕方法
CN108594807A (zh) 一种无人水面艇折线路径跟踪控制系统及方法
CN116627043B (zh) 一种联合锚泊系统的区域动力定位控制方法
CN103913163A (zh) 船载卫星通信地球站a-e-c三轴天线坐标计算方法
CN107942095A (zh) 波浪滑翔器实际航向预测方法
CN102162733A (zh) 一种基于svm的auv舰位推算导航误差实时修正方法
CN113625544A (zh) 一种波浪滑翔器的内外环pid路径跟踪控制方法
TWI645145B (zh) 追日系統與追日方法
CN104648613A (zh) 一种基于激光引导技术的船模操纵性试验装置
CN111722627A (zh) 用于水面无人航行器的动态虚拟锚泊控制方法及系统
Elkaim et al. Station keeping and segmented trajectory control of a wind-propelled autonomous catamaran
CN111176292B (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