CN115061482B - Wave glider global path planning method and system - Google Patents
Wave glider global path planning method and system Download PDFInfo
- Publication number
- CN115061482B CN115061482B CN202210995147.3A CN202210995147A CN115061482B CN 115061482 B CN115061482 B CN 115061482B CN 202210995147 A CN202210995147 A CN 202210995147A CN 115061482 B CN115061482 B CN 115061482B
- Authority
- CN
- China
- Prior art keywords
- wave glider
- energy
- velocity
- cost evaluation
- energy cost
- 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 25
- 238000011156 evaluation Methods 0.000 claims abstract description 35
- 238000010845 search algorithm Methods 0.000 claims abstract description 8
- 239000000126 substance Substances 0.000 claims description 6
- 238000005265 energy consumption Methods 0.000 abstract description 6
- 238000004891 communication Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 3
- 108010002082 endometriosis protein-1 Proteins 0.000 description 3
- 230000000694 effects Effects 0.000 description 2
- 238000012544 monitoring process Methods 0.000 description 2
- 238000001514 detection method Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 230000007774 longterm Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 230000000750 progressive effect Effects 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 239000013535 sea water Substances 0.000 description 1
- 239000002344 surface layer Substances 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/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0221—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
-
- 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/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0223—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
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)
- Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
- Feedback Control In General (AREA)
Abstract
The invention relates to a wave glider global path planning method and a system, which relate to the field of path planning, and the method comprises the following steps: establishing a flow field model of ocean flow velocity based on the initial position and the target position; establishing a resultant velocity model according to the flow field model and the velocity of the wave glider; establishing an energy cost evaluation function according to the combined speed model and the quality of the wave glider; obtaining an extended node between the initial position and the target position by adopting an RRT algorithm; performing energy cost evaluation on the expansion node by adopting the energy cost evaluation function to obtain a first energy optimal node set; performing energy cost evaluation on the nodes in the first energy optimal node set by adopting the energy cost evaluation function through a graph search algorithm to obtain a second energy optimal node set; and fitting the nodes in the second energy optimal node set by adopting a B spline curve to obtain a final planned path. The invention reduces the energy consumption of the wave glider.
Description
Technical Field
The invention relates to the technical field of path planning, in particular to a wave glider global path planning method and system.
Background
The wave glider is an unmanned autonomous vehicle which converts wave fluctuation into forward power by using a special catamaran structure and mainly comprises a floating body ship, an umbilical cable and a tractor. The wave energy is converted into forward power by using a multi-rigid-body structure consisting of the three parts, and the solar cell panel on the floating body ship is used for providing energy supply for modules of wave glider navigation, communication, motion control and the like. The system has the functions of long-term continuous navigation, autonomous navigation positioning, artificial intelligent identification and the like, can realize 1-ten thousand kilometers of marine continuous navigation for 1 year at the speed of 0.5 to 1 meter/second without energy supply, thereby completing the continuous navigation measurement of environmental parameters such as temperature and salinity, flow fields, waves, wind, temperature, air pressure and the like of the surface layer of seawater and adding specific sound, light and electric sensors to realize the monitoring and detection of underwater, water surface and aerial targets.
The wave glider has weak mobility, is greatly influenced by ocean current interference, and has the problem of large task execution capacity consumption at present.
Disclosure of Invention
The invention aims to provide a wave glider global path planning method and a wave glider global path planning system, which reduce the energy consumption of the wave glider.
In order to achieve the purpose, the invention provides the following scheme:
a wave glider global path planning method comprises the following steps:
establishing a flow field model of ocean flow velocity based on the initial position and the target position;
establishing a resultant velocity model according to the flow field model and the velocity of the wave glider;
establishing an energy cost evaluation function according to the combined speed model and the quality of the wave glider;
obtaining an extended node between the initial position and the target position by adopting an RRT algorithm;
performing energy cost evaluation on the expansion node by adopting the energy cost evaluation function to obtain a first energy optimal node set;
performing energy cost evaluation on the nodes in the first energy optimal node set by adopting the energy cost evaluation function through a graph search algorithm to obtain a second energy optimal node set;
and fitting the nodes in the second energy optimal node set by adopting a B spline curve to obtain a final planned path.
Optionally, the flow field model is represented as:
wherein the content of the first and second substances,to representtThe velocity component of the current velocity in the forward direction of the wave glider at the moment,to representtThe velocity component of the current velocity in a direction perpendicular to the direction of travel of the wave glider at the moment.
Optionally, the resultant velocity model is represented as:
wherein the content of the first and second substances,representing the velocity of the wave glider.
Optionally, the energy cost evaluation function is expressed as:
wherein the content of the first and second substances,mrepresenting the mass of the wave glider.
The invention also discloses a wave glider global path planning system which at least comprises a processor, wherein the processor is used for executing the wave glider global path planning method.
According to the specific embodiment provided by the invention, the invention discloses the following technical effects:
the invention discloses a wave glider global path planning method and a system, wherein an energy cost evaluation function is established according to a combined speed model based on ocean current speed and the quality of a wave glider; and obtaining an extended node between the initial position and the target position by adopting an RRT algorithm, obtaining an energy optimal node set by adopting an energy cost evaluation function and a graph search algorithm, and obtaining a final planned path by adopting a B spline curve for fitting.
Drawings
In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the drawings needed in the embodiments will be briefly described below, and it is obvious that the drawings in the following description are only some embodiments of the present invention, and it is obvious for those skilled in the art to obtain other drawings without creative efforts.
FIG. 1 is a schematic flow chart of a wave glider global path planning method according to the present invention;
FIG. 2 is a schematic view of a flow field model setup of the present invention;
FIG. 3 is a schematic diagram of the velocity model building principle of the present invention;
FIG. 4 is a schematic diagram of node expansion of the RRT algorithm of the present invention;
FIG. 5 is a schematic of the graph search algorithm of the present invention;
FIG. 6 is a schematic structural diagram of a wave glider global path planning system according to the present invention.
Detailed Description
The technical solutions in the embodiments of the present invention will be clearly and completely described below with reference to the drawings in the embodiments of the present invention, and it is obvious that the described embodiments are only a part of the embodiments of the present invention, and not all of the embodiments. All other embodiments, which can be derived by a person skilled in the art from the embodiments given herein without making any creative effort, shall fall within the protection scope of the present invention.
The invention aims to provide a wave glider global path planning method and a wave glider global path planning system, which reduce the energy consumption of the wave glider.
In order to make the aforementioned objects, features and advantages of the present invention comprehensible, embodiments accompanied with figures are described in further detail below.
Fig. 1 is a schematic flow chart of a global path planning method for a wave glider according to the present invention, and as shown in fig. 1, the global path planning method for the wave glider includes the following steps:
step 101: and establishing a flow field model of the ocean flow velocity based on the starting position and the target position.
The flow field model is represented as:
wherein the content of the first and second substances,to representtThe velocity component of the current velocity in the forward direction of the wave glider at the moment,representtThe velocity component of the current velocity in the direction perpendicular to the advancing direction of the wave glider at the moment, the flow field model is shown in fig. 2, the abscissa in fig. 2 is the x axis, the ordinate is the y axis, the flow field velocity can be constructed according to the current background field data, and the current background field data can be downloaded on the internet.
Step 102: and establishing a resultant velocity model according to the flow field model and the velocity of the wave glider.
The resultant velocity model is represented as:
wherein the content of the first and second substances,the velocity of the wave glider, i.e. the sailing velocity of the wave glider without the influence of ocean currents, is represented, and the principle of establishing a resultant velocity model is shown in fig. 3.
The wave glider is of a double-body structure, a communication system and a sensor system are loaded on the floating body ship, and the tractor drives to advance by utilizing waves through buoyancy provided by the floating body. When the wave glider needs to execute a navigation task, the wave glider obtains the current position through a GPS module on the floating body ship, and the communication is carried out through a shore-based monitoring system to obtain the position information of a target point (target position).
Step 103: and establishing an energy cost evaluation function according to the combined speed model and the quality of the wave glider.
The energy cost evaluation function is expressed as:
wherein, the first and the second end of the pipe are connected with each other,mrepresenting the mass of the wave glider.
Step 104: and obtaining an extended node between the starting position and the target position by adopting an RRT algorithm.
The RRT algorithm belongs to a probabilistic algorithm, a random expanded tree is generated by taking an initial position as a root node and increasing leaf nodes through random sampling, and when the leaf nodes in the random tree contain target positions or enter a target area, a path consisting of tree nodes from the initial point to a target point can be found in the random tree.
Step 105: and performing energy cost evaluation on the expansion nodes by adopting the energy cost evaluation function to obtain a first energy optimal node set.
In step 105, the time for the determined target of each optimal node in the first energy optimal node set to reach the target point is the shortest.
And calculating the node with the minimum energy consumption, namely the node with the highest utilization rate according to the energy cost evaluation function. The first energy-optimal node set refers to an optimal node set among all nodes in the first-level search, and is not an overall optimal set.
Step 106: and performing energy cost evaluation on the nodes in the first energy optimal node set by adopting the energy cost evaluation function through a graph search algorithm to obtain a second energy optimal node set.
Step 107: and fitting the nodes in the second energy optimal node set by adopting a B spline curve to obtain a final planned path.
The method comprises the steps of searching in a random space by using an RRT algorithm, converting continuous space search into discrete space search, obtaining an expansion node by using the randomness of the search, evaluating the energy cost of the node by using an energy cost evaluation function within a certain range of the expansion node to obtain a first energy optimal node set, wherein the RRT algorithm searching process is shown as figure 4, and the RRT algorithm searching process is shown as figure 4rWhich represents the radius of the expansion and,q int indicating the node corresponding to the starting position,q near indicating distanceq int The closest point of the light beam to the light source,q rand which represents the random points that are generated by the random point,E pmax indicating the energy optimum point. Performing energy evaluation on the node set starting from the starting point by using the energy cost evaluation function again through a graph search algorithm frame to obtain a second energy optimal node set, wherein the search process is shown as figure 5, and the graph 5 showsδWhich represents the radius of the search,q abon indicating the node that was dropped and,A int it is shown that the search area is initialized,A endo1 indicating the proximity of the search area to the user,P endo1 indicating a proximity zoneA endo1 The optimum point in the (c) is,q goal representing the node corresponding to the target location.
The wave glider is provided with an energy optimal path under the ocean current interference, the wave glider is obtained through a global path planning method to obtain the energy optimal path from a starting point to a target point under the ocean current interference, and the task execution energy consumption of the wave glider is reduced; the energy consumption of task execution of the wave glider can be reduced, and the long-range sailing observation reliability is improved.
In order to implement the above global path planning method for the wave glider to achieve corresponding functions and technical effects, a global path planning system for the wave glider is provided below. A wave glider global path planning system at least comprises a processor, and the processor is used for executing the wave glider global path planning method.
As shown in fig. 6, the processor includes:
the flow field model establishing module 201 is configured to establish a flow field model of ocean flow velocity based on the starting position and the target position.
And a resultant velocity model establishing module 202, configured to establish a resultant velocity model according to the flow field model and the velocity of the wave glider.
And the energy cost evaluation function establishing module 203 is used for establishing an energy cost evaluation function according to the combined velocity model and the quality of the wave glider.
A node expansion module 204, configured to obtain an expansion node between the starting location and the target location by using an RRT algorithm.
The first energy-optimal node set determining module 205 is configured to perform energy cost evaluation on the expansion node by using the energy cost evaluation function to obtain a first energy-optimal node set.
A second energy-optimal node set determining module 206, configured to perform energy cost evaluation on nodes in the first energy-optimal node set by using the energy cost evaluation function through a graph search algorithm, so as to obtain a second energy-optimal node set.
And a B-spline curve fitting module 207, configured to fit the nodes in the second energy optimal node set by using a B-spline curve, so as to obtain a final planned path.
The embodiments in the present description are described in a progressive manner, each embodiment focuses on differences from other embodiments, and the same and similar parts among the embodiments are referred to each other. For the system disclosed by the embodiment, the description is relatively simple because the system corresponds to the method disclosed by the embodiment, and the relevant points can be referred to the method part for description.
The principles and embodiments of the present invention have been described herein using specific examples, which are provided only to help understand the method and the core concept of the present invention; meanwhile, for a person skilled in the art, according to the idea of the present invention, the specific embodiments and the application range may be changed. In view of the above, the present disclosure should not be construed as limiting the invention.
Claims (2)
1. A wave glider global path planning method is characterized by comprising the following steps:
establishing a flow field model of ocean flow velocity based on the initial position and the target position;
establishing a resultant velocity model according to the flow field model and the velocity of the wave glider;
establishing an energy cost evaluation function according to the combined speed model and the quality of the wave glider;
obtaining an extended node between the initial position and the target position by adopting an RRT algorithm;
performing energy cost evaluation on the expansion nodes by adopting the energy cost evaluation function to obtain a first energy optimal node set;
performing energy cost evaluation on the nodes in the first energy optimal node set by adopting the energy cost evaluation function through a graph search algorithm to obtain a second energy optimal node set;
fitting the nodes in the second energy optimal node set by adopting a B spline curve to obtain a final planned path;
the flow field model is represented as:
wherein the content of the first and second substances,to representtThe velocity component of the current velocity in the forward direction of the wave glider at the moment,representtA velocity component of the current velocity at the moment in a direction perpendicular to the direction of advance of the wave glider;
the resultant velocity model is represented as:
wherein, the first and the second end of the pipe are connected with each other,representing the velocity of the wave glider;
the energy cost evaluation function is expressed as:
wherein, the first and the second end of the pipe are connected with each other,mrepresenting the mass of the wave glider.
2. A wave glider global path planning system, characterized by at least a processor for performing the wave glider global path planning method of claim 1.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210995147.3A CN115061482B (en) | 2022-08-19 | 2022-08-19 | Wave glider global path planning method and system |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210995147.3A CN115061482B (en) | 2022-08-19 | 2022-08-19 | Wave glider global path planning method and system |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115061482A CN115061482A (en) | 2022-09-16 |
CN115061482B true CN115061482B (en) | 2022-11-25 |
Family
ID=83208139
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210995147.3A Active CN115061482B (en) | 2022-08-19 | 2022-08-19 | Wave glider global path planning method and system |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115061482B (en) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116027671B (en) * | 2023-03-28 | 2023-07-14 | 中国海洋大学 | Anchoring method and system of wave glider |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110006434A (en) * | 2019-04-23 | 2019-07-12 | 河海大学常州校区 | Based on the underwater glider paths planning method of ant group algorithm avoidance in thermocline sea area |
CN111189468A (en) * | 2020-01-13 | 2020-05-22 | 天津工业大学 | Wave glider global path planning method |
CN111290435A (en) * | 2020-03-12 | 2020-06-16 | 国家深海基地管理中心 | Path planning method and system for wave glider |
CN111522334A (en) * | 2019-12-02 | 2020-08-11 | 中国海洋大学 | Local path planning method for wave glider |
US10994821B1 (en) * | 2018-12-12 | 2021-05-04 | Thayermahan, Inc. | Autonomous long-endurance RF signal interception system |
CN113282094A (en) * | 2021-04-09 | 2021-08-20 | 武汉理工大学 | Intelligent underwater glider behavior system structure planning method based on deep Q learning |
CN114779791A (en) * | 2022-06-20 | 2022-07-22 | 青岛海舟科技有限公司 | Wave glider position keeping method and system |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108106623B (en) * | 2017-09-08 | 2021-06-04 | 同济大学 | Unmanned vehicle path planning method based on flow field |
-
2022
- 2022-08-19 CN CN202210995147.3A patent/CN115061482B/en active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US10994821B1 (en) * | 2018-12-12 | 2021-05-04 | Thayermahan, Inc. | Autonomous long-endurance RF signal interception system |
CN110006434A (en) * | 2019-04-23 | 2019-07-12 | 河海大学常州校区 | Based on the underwater glider paths planning method of ant group algorithm avoidance in thermocline sea area |
CN111522334A (en) * | 2019-12-02 | 2020-08-11 | 中国海洋大学 | Local path planning method for wave glider |
CN111189468A (en) * | 2020-01-13 | 2020-05-22 | 天津工业大学 | Wave glider global path planning method |
CN111290435A (en) * | 2020-03-12 | 2020-06-16 | 国家深海基地管理中心 | Path planning method and system for wave glider |
CN113282094A (en) * | 2021-04-09 | 2021-08-20 | 武汉理工大学 | Intelligent underwater glider behavior system structure planning method based on deep Q learning |
CN114779791A (en) * | 2022-06-20 | 2022-07-22 | 青岛海舟科技有限公司 | Wave glider position keeping method and system |
Non-Patent Citations (1)
Title |
---|
波浪滑翔器网络版岸基监控中心设计;桑洪强等;《水下无人系统学报》;20191031;第27卷(第5期);第521-528页 * |
Also Published As
Publication number | Publication date |
---|---|
CN115061482A (en) | 2022-09-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Song et al. | Smoothed A* algorithm for practical unmanned surface vehicle path planning | |
US10589829B2 (en) | Gliding robotic fish navigation and propulsion | |
CN107314768B (en) | Underwater terrain matching auxiliary inertial navigation positioning method and positioning system thereof | |
Niu et al. | Efficient path planning algorithms for unmanned surface vehicle | |
CN115061482B (en) | Wave glider global path planning method and system | |
Kang et al. | Development of multibody marine robots: A review | |
CN111189468A (en) | Wave glider global path planning method | |
JP6979666B1 (en) | Real-time optimization method and navigation method of the route of renewable energy driven unmanned boat considering propulsion by waves | |
Liao et al. | Heading control method and experiments for an unmanned wave glider | |
CN109319074B (en) | Multi-orthogonal signal emission unmanned submersible vehicle sound guiding and recycling system | |
Desa et al. | A small autonomous surface vehicle for ocean color remote sensing | |
Zhang et al. | Fast and accurate underwater acoustic horizontal ranging algorithm for an arbitrary sound-speed profile in the deep sea | |
CN114793129A (en) | Wireless communication relay method and system based on wave glider | |
Zhang et al. | Research on the maneuverability and path following control of the wave glider with a propeller-rudder system | |
Briere | Iboat: An autonomous robot for long-term offshore operation | |
Cai et al. | Long-range UWB Positioning based Automatic Docking Trajectory Design for Unmanned Surface Vehicle | |
CN111522334A (en) | Local path planning method for wave glider | |
CN112880678A (en) | Unmanned ship navigation planning method in complex water area environment | |
CN112254720B (en) | Natural energy driven robot route planning method considering wind energy capture | |
CN113984061A (en) | UUV multi-sea-area integrated navigation system design method based on factor graph optimization | |
Li et al. | Energy Efficient Space-Air-Ground-Ocean Integrated Network based on Intelligent Autonomous Underwater Glider | |
CN114610046A (en) | Unmanned ship dynamic safety trajectory planning method considering dynamic water depth | |
Asgharian et al. | Proposed efficient design for unmanned surface vehicles | |
Bandyopadhyay et al. | Turning of a short-length cable using flapping fin propulsion | |
Tan et al. | Segmented underwater terrain matching based on q-learning |
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 |