CN108445894A - A kind of secondary paths planning method considering unmanned boat movenent performance - Google Patents
A kind of secondary paths planning method considering unmanned boat movenent performance Download PDFInfo
- Publication number
- CN108445894A CN108445894A CN201810623244.3A CN201810623244A CN108445894A CN 108445894 A CN108445894 A CN 108445894A CN 201810623244 A CN201810623244 A CN 201810623244A CN 108445894 A CN108445894 A CN 108445894A
- Authority
- CN
- China
- Prior art keywords
- unmanned boat
- point
- path
- unmanned
- optimal path
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 31
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 claims abstract description 13
- 238000012360 testing method Methods 0.000 claims abstract description 12
- 238000004088 simulation Methods 0.000 claims abstract description 5
- 230000006872 improvement Effects 0.000 abstract description 4
- 238000005516 engineering process Methods 0.000 description 3
- 238000013528 artificial neural network Methods 0.000 description 2
- 230000004888 barrier function Effects 0.000 description 2
- 230000002068 genetic effect Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000002950 deficient Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000004387 environmental modeling Methods 0.000 description 1
- 238000011156 evaluation Methods 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 239000002245 particle Substances 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 238000007670 refining Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000012549 training Methods 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
The invention belongs to unmanned boat path planning fields, disclose a kind of secondary paths planning method considering unmanned boat movenent performance, comprise the following steps:Step (1):The revolution curvature of unmanned water surface ship is determined by the permanent turning test of unmanned boat or maneuverability l-G simulation test;Step (2):Path planning of unmanned boat is carried out, an optimal path point set p is obtained;Step (3):The turnability moved according to an optimal path point set p and unmanned surface vehicle obtains the optimal path p in unmanned boat motion range ability with secondary paths planning method2.The present invention is by analyzing unmanned boat gyroscopic characteristics, secondary path planning is carried out, under the premise of having optimal path, calculates an optimal path for meeting unmanned boat actual motion characteristic, efficiency and performance are taken into account simultaneously, there is marked improvement in terms of reducing detour walking along the street and optimizing hours underway.
Description
Technical field
The invention belongs to unmanned boat path planning field more particularly to a kind of secondary paths considering unmanned boat movenent performance
Planing method.
Background technology
Unmanned water surface ship is a kind of unattended surface ship.It is mainly used for executing danger and is unsuitable for someone's ship
Only carrying out for task.After being equipped with advanced control system, sensing system, communication system and weapon system, it can execute
A variety of wars and non-war operations task, for example, scouting, search, detecting and remove mines;It searches and rescues, navigation and hydro_geography are reconnoitred;Instead
Latent operation, anti-special operations and patrol, strike pirate, anti-terrorism attack etc..Field, the U.S. are researched and developed and use in unmanned water surface ship
It is constantly in leading position with Israel.Current each state all competitively develops unmanned boat, and the well-known unit of domestic contrast includes Hai Lan
Letter, Harbin Engineering University, 701 institute of middle ship heavy industry, 707 institute of middle ship heavy industry, Chinese Academy of Sciences's Shenyang Institute of Automation, Beijing orientation intelligence
Systems technology Co., Ltd etc., unmanned boat family are growing stronger day by day.And the key problem that path planning is studied as unmanned boat,
Represent the height of unmanned boat intelligent level to a certain extent.USV path planning exemplary process mainly has Artificial Potential Field
Method, genetic algorithm, artificial neural network, quick random search tree algorithm.Local space can only be solved using Artificial Potential Field Method
Avoidance problem, it lacks global information, it is easy to be absorbed in local minimum, cause to generate the path for vibrating or stagnating;It loses
Propagation algorithm is poor to the exploring ability in new space, it is more difficult to construct suitable fitness function, and be easier to converge to locally optimal solution;
Representative training sample is obtained using artificial neural network is more difficult, is not easy to realize in the working space of USV complexity;
The randomness of RRT algorithms cause result can only probability it is complete, in USV dynamic jobs space the algorithm deficient in stability and easily occur
Deviate optimal path.
But there are some defects in above-mentioned unmanned boat paths planning method, the optimal point set gone out with a path planning is
It is resolved based on the most short standard of distance, the result obtained mostly regards unmanned boat as particle, and ignores the mobility of unmanned boat
Energy turnability causes drive lacking unmanned boat that can not track the path node that curvature is larger than own body movenent performance limitation.
In practical engineering application, in tracking programme path detour or the unreachable phenomenon of path point can occur for unmanned boat, to increase nothing
People's ship task execution difficulty.
Jiangsu University of Science and Technology Liu builds, the paper delivered《The research of unmanned surface vehicle Path Planning Technique》Potential field method will be improved
It is combined with dynamic grids algorithm, devises a kind of potential field dynamic grids algorithm, environment is established by way of refining grid dynamic
Model searches for optimal path using potential field method is improved, and reduces extra path point by reducing broken line, is finally reached path
The purpose of optimization.Central China University of Science and Technology Wang Wei is red etc., the paper delivered《Mobile robot path rule based on smooth A* algorithms
It draws》It proposes in the path basis of A* algorithmic rules, all nodes in traverse path, before and after a certain node on node line
When accessible, this intermediate node of extension wire is rejected, smooth effect is finally reached.
Application No. is 201410022398.9 patent disclose a kind of water surface based on neighborhood intelligent water drop algorithm nobody
Ship paths planning method, including:(1) environmental modeling is carried out to unmanned surface vehicle path planning;(2) intelligent water drop algorithm root is utilized
According to known unmanned surface vehicle operating area static-obstacle thing, traveling target and path evaluation function in the grid battle array of operating area
Offline global path planning is carried out, global offline optimal path is obtained.
The above method has result randomness by reducing the broken line of planning path to reduce excess path, in practical ocean
Poor availability in environment, and it can not be included in the real navigation capacity adjusting of surface ship, it is larger by being limited.
Invention content
Meet ship movenent performance demand, a kind of strong consideration unmanned boat movement of availability it is an object of the invention to open
The secondary paths planning method of performance.
The object of the present invention is achieved like this:
A kind of secondary paths planning method considering unmanned boat movenent performance, comprises the following steps:
Step (1):Determine that the revolution of unmanned water surface ship is bent by the permanent turning test of unmanned boat or maneuverability l-G simulation test
Rate;
Step (2):Path planning of unmanned boat is carried out, an optimal path point set p is obtained:
With unmanned surface vehicle paths planning method, it is known that starting point ps=(xs,ys), target point pt=(xt,yt), n
Barrier coordinate set po={ po1,...,poi,...,pon, i-th of obstacle article coordinate poi=(xoi,yoi), i=1...n;
To an optimal path point set p={ p1,...,pj,...,pm, m is the number of an optimal path point centrostigma;p1=ps,pm
=pt, j=1...m.
Step (3):The secondary path planning of turnability moved according to an optimal path point set p and unmanned surface vehicle
Method obtains the optimal path p in unmanned boat motion range ability2:
The starting point for retaining an optimal path point set p, from second path point of an optimal path point set p backward according to
It is secondary to test, terminate to path termination:The path point examined is current trial point, if with current trial point, currently
The latter path point of previous path point and the current trial point of check point is the circumscribed circle curvature of the triangle of vertex composition
Less than the revolution curvature of unmanned water surface ship, retain current trial point;Otherwise current trial point is given up, examines the latter path
Point.Finally obtain the optimal path p in unmanned boat motion range ability2={ p21,...,p2k,...p2l, l moves for unmanned boat
The number at the optimal path midpoint in range capability;p21=ps,p2l=pt, l≤m, k=1...l.
Beneficial effects of the present invention are:
The present invention carries out secondary path planning, under the premise of having optimal path, solves by analyzing unmanned boat gyroscopic characteristics
It calculates one and meets the optimal path of unmanned boat actual motion characteristic, while taking into account efficiency and performance, reducing detour walking along the street simultaneously
There is marked improvement in terms of optimizing hours underway.
Description of the drawings
Fig. 1 is a kind of secondary paths planning method flow chart considering unmanned boat movenent performance;
Fig. 2 is a kind of secondary paths planning method path schematic diagram considering unmanned boat movenent performance.
Specific implementation mode
Further describe the present invention below in conjunction with the accompanying drawings:
Such as Fig. 1, a kind of secondary paths planning method considering unmanned boat movenent performance comprises the following steps:
Step (1):Determine that the revolution of unmanned water surface ship is bent by the permanent turning test of unmanned boat or maneuverability l-G simulation test
Rate;
When unmanned boat rotary motion, the track of ship center of gravity is known as turning circle, and the radius of turning circle is radius of gyration R.Revolution
Radius can be found out based on the permanent turning test of unmanned boat, and rudder is turned to certain rudder angle and is remained unchanged, at this moment ship will deviate from
Curvilinear motion is done in former air route, and the radius of permanent revolution curve is the radius of gyration.Or it is found out by maneuverability l-G simulation test.So
The revolution curvature of unmanned water surface ship can be found out afterwards.
Step (2):Path planning of unmanned boat is carried out, an optimal path point set p is obtained:
Paths planning method includes but not limited to Artificial Potential Field Method, genetic algorithm, A* algorithms, with unmanned surface vehicle
Paths planning method, it is known that starting point ps=(xs,ys, target point pt=(xt,yt, n barrier coordinate setI-th of obstacle article coordinate poi=(xoi,yoi), i=1...n;Obtain an optimal path point set
P={ p1,...,pj,...,pm, m is the number of an optimal path point centrostigma;p1=ps,pm=pt, j=1...m.
Step (3):The secondary path planning of turnability moved according to an optimal path point set p and unmanned surface vehicle
Method obtains the optimal path p in unmanned boat motion range ability2:
Such as Fig. 2, retain the starting point of an optimal path point set p, from second path point of an optimal path point set p
It tests, terminates to path termination successively backward:The path point examined is current trial point, if with current trial
Point, the previous path point of current trial point and the latter path point of current trial point are the external of the triangle of vertex composition
Circle curvature is less than the revolution curvature of unmanned water surface ship, retains current trial point;Otherwise current trial point is given up, examines the latter
Path point.Finally obtain the optimal path p in unmanned boat motion range ability2={ p21,...,p2k,...p2l, l is unmanned boat
The number at the optimal path midpoint in motion range ability;p21=ps,p2l=pt, l≤m, k=1...l.
The method for solving the triangle circumscribed circle curvature formed using three path points as vertex is as follows:
In above formula, A, B, C are respectively check point and the vertex of a triangle that its front and back node is vertex composition, and a, b, c divide
Not Wei triangle the length of side, r be triangle circumradius, K be triangle circumscribed circle curvature.
Compared with prior art, the present invention carries out secondary path planning, is having most by analyzing unmanned boat gyroscopic characteristics
Under the premise of shortest path, calculates one and meet the optimal path of unmanned boat actual motion characteristic, while taking into account efficiency and performance,
It reduces detour walking along the street and there is marked improvement in terms of optimizing hours underway so that the exploitativeness of original path planning increases.
The above is not intended to restrict the invention, and for those skilled in the art, the present invention can have various
Change and variation.All within the spirits and principles of the present invention, any modification, equivalent replacement, improvement and so on should all include
Within protection scope of the present invention.
Claims (3)
1. a kind of secondary paths planning method considering unmanned boat movenent performance, it is characterised in that:It comprises the following steps:
Step (1):The revolution curvature of unmanned water surface ship is determined by the permanent turning test of unmanned boat or maneuverability l-G simulation test;
Step (2):Path planning of unmanned boat is carried out, an optimal path point set p is obtained;
Step (3):The secondary paths planning method of turnability moved according to an optimal path point set p and unmanned surface vehicle
Obtain the optimal path p in unmanned boat motion range ability2。
2. a kind of secondary paths planning method considering unmanned boat movenent performance according to claim 1, it is characterised in that:
The step (2) is specially:
With unmanned surface vehicle paths planning method, it is known that starting point ps=(xs,ys), target point pt=(xt,yt), n obstacle
Article coordinate set po={ po1,...,poi,...,pon, i-th of obstacle article coordinate poi=(xoi,yoi), i=1...n;Obtain one
Suboptimum path point set p={ p1,...,pj,...,pm, m is the number of an optimal path point centrostigma;p1=ps,pm=
pt, j=1...m.
3. a kind of secondary paths planning method considering unmanned boat movenent performance according to claim 1, it is characterised in that:
The step (3) is specially:
The starting point for retaining an optimal path point set p, from second path point of an optimal path point set p backward successively into
Performing check terminates to path termination:The path point examined is current trial point, if with current trial point, current trial
The previous path point of point and the latter path point of current trial point are that the circumscribed circle curvature of the triangle of vertex composition is less than
The revolution curvature of unmanned water surface ship retains current trial point;Otherwise current trial point is given up, examines the latter path point;Most
The optimal path p in unmanned boat motion range ability is obtained afterwards2={ p21,...,p2k,...p2l, l is unmanned boat motion range
The number at the optimal path midpoint in ability;p21=ps,p2l=pt, l≤m, k=1...l.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810623244.3A CN108445894A (en) | 2018-06-15 | 2018-06-15 | A kind of secondary paths planning method considering unmanned boat movenent performance |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810623244.3A CN108445894A (en) | 2018-06-15 | 2018-06-15 | A kind of secondary paths planning method considering unmanned boat movenent performance |
Publications (1)
Publication Number | Publication Date |
---|---|
CN108445894A true CN108445894A (en) | 2018-08-24 |
Family
ID=63207118
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810623244.3A Pending CN108445894A (en) | 2018-06-15 | 2018-06-15 | A kind of secondary paths planning method considering unmanned boat movenent performance |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108445894A (en) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109116849A (en) * | 2018-09-01 | 2019-01-01 | 哈尔滨工程大学 | A kind of kernel action amalgamation method for on-line optimization considering unmanned boat movenent performance |
CN109240288A (en) * | 2018-08-31 | 2019-01-18 | 武汉理工大学 | Unmanned boat collision prevention paths planning method in the case of a kind of barrier based on trajectory unit |
CN110906935A (en) * | 2019-12-13 | 2020-03-24 | 河海大学常州校区 | Unmanned ship path planning method |
CN112113573A (en) * | 2020-09-18 | 2020-12-22 | 武汉理工大学 | Planning method for coverage path of single unmanned measurement boat |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103576685A (en) * | 2013-11-14 | 2014-02-12 | 哈尔滨工程大学 | Method for determining path of UUV in process of recycling mother ship |
CN105911990A (en) * | 2016-05-23 | 2016-08-31 | 吉林大学 | Track bias determination method for ship sailing turning phase |
-
2018
- 2018-06-15 CN CN201810623244.3A patent/CN108445894A/en active Pending
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103576685A (en) * | 2013-11-14 | 2014-02-12 | 哈尔滨工程大学 | Method for determining path of UUV in process of recycling mother ship |
CN105911990A (en) * | 2016-05-23 | 2016-08-31 | 吉林大学 | Track bias determination method for ship sailing turning phase |
Non-Patent Citations (1)
Title |
---|
庄佳园等: "应用改进随机树算法的无人艇局部路径规划", 《哈尔滨工业大学学报》 * |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109240288A (en) * | 2018-08-31 | 2019-01-18 | 武汉理工大学 | Unmanned boat collision prevention paths planning method in the case of a kind of barrier based on trajectory unit |
CN109116849A (en) * | 2018-09-01 | 2019-01-01 | 哈尔滨工程大学 | A kind of kernel action amalgamation method for on-line optimization considering unmanned boat movenent performance |
CN110906935A (en) * | 2019-12-13 | 2020-03-24 | 河海大学常州校区 | Unmanned ship path planning method |
CN110906935B (en) * | 2019-12-13 | 2023-06-13 | 河海大学常州校区 | Unmanned ship path planning method |
CN112113573A (en) * | 2020-09-18 | 2020-12-22 | 武汉理工大学 | Planning method for coverage path of single unmanned measurement boat |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109144102A (en) | A kind of Path Planning for UAV based on improvement bat algorithm | |
CN108445894A (en) | A kind of secondary paths planning method considering unmanned boat movenent performance | |
CN106767860B (en) | A method of shortening intelligent automobile path planning search time based on heuristic search algorithm | |
CN106989748A (en) | A kind of Agriculture Mobile Robot man-computer cooperation paths planning method based on cloud model | |
CN103336526B (en) | Based on the robot path planning method of coevolution population rolling optimization | |
CN103744428B (en) | A kind of unmanned surface vehicle paths planning method based on neighborhood intelligent water drop algorithm | |
CN109871032A (en) | A kind of multiple no-manned plane formation cooperative control method based on Model Predictive Control | |
CN101387888B (en) | Mobile robot path planning method based on binary quanta particle swarm optimization | |
CN105717923B (en) | The unmanned boat ocean dynamic obstacle avoidance control algolithm deduced based on oval cluster-collision cone | |
CN111694357B (en) | Robot walking path planning method based on genetic algorithm and artificial potential field method | |
CN108388250B (en) | Water surface unmanned ship path planning method based on self-adaptive cuckoo search algorithm | |
CN106444835A (en) | Underwater vehicle three-dimensional path planning method based on Lazy Theta satellite and particle swarm hybrid algorithm | |
Hao et al. | Dynamic path planning of a three-dimensional underwater AUV based on an adaptive genetic algorithm | |
CN113485371B (en) | Underwater multi-AUV path planning method based on improved sparrow search algorithm | |
CN110471426A (en) | Unmanned intelligent vehicle automatic Collision Avoidance method based on quantum wolf pack algorithm | |
Guo et al. | An improved a-star algorithm for complete coverage path planning of unmanned ships | |
CN114077256A (en) | Overwater unmanned ship path planning method | |
CN109116849A (en) | A kind of kernel action amalgamation method for on-line optimization considering unmanned boat movenent performance | |
CN113110464A (en) | Intelligent full-electric ship path planning method capable of reducing energy consumption | |
Zhang et al. | A-star algorithm for expanding the number of search directions in path planning | |
CN113190026B (en) | Energy-saving underwater path planning method based on re-excitation mechanism particle swarm algorithm | |
CN107229998A (en) | A kind of autonomous pathfinding strategy process of unmanned plane | |
Zhang et al. | Optimal search and rescue route design using an improved ant colony optimization | |
CN108227718A (en) | A kind of automatic transporting trolley path planning method adaptively switched | |
Liu et al. | The Path Planning Study of Autonomous Patrol Robot based on Modified Astar Algorithm and Genetic Algorithm |
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 | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20180824 |