CN106441303B - It is a kind of based on the paths planning method that can search for continuous neighborhood A* algorithm - Google Patents

It is a kind of based on the paths planning method that can search for continuous neighborhood A* algorithm Download PDF

Info

Publication number
CN106441303B
CN106441303B CN201610867274.XA CN201610867274A CN106441303B CN 106441303 B CN106441303 B CN 106441303B CN 201610867274 A CN201610867274 A CN 201610867274A CN 106441303 B CN106441303 B CN 106441303B
Authority
CN
China
Prior art keywords
point
node
value
sideline
barrier
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
CN201610867274.XA
Other languages
Chinese (zh)
Other versions
CN106441303A (en
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.)
Harbin Engineering University
Original Assignee
Harbin Engineering University
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 Harbin Engineering University filed Critical Harbin Engineering University
Priority to CN201610867274.XA priority Critical patent/CN106441303B/en
Publication of CN106441303A publication Critical patent/CN106441303A/en
Application granted granted Critical
Publication of CN106441303B publication Critical patent/CN106441303B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20Instruments for performing navigational calculations
    • G01C21/203Specially adapted for sailing ships

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Management, Administration, Business Operations System, And Electronic Commerce (AREA)

Abstract

The present invention is to provide a kind of based on the paths planning method that can search for continuous neighborhood A* algorithm.The present invention is established the environmental model of environmental model acquisition using Grid Method, UUV is thought of as particle according to existing barrier geometric dimension, using the longest width of barrier as diameter, is handled by the round barrier of origin of the center of gravity of barrier;According to the information of barrier, grid size l is obtained;According to established grid map, the evaluation function f (x) of A* algorithm is determined;According to can neighborhood the characteristics of in conjunction with A* algorithm, determine the appraisal cost h (y) of arbitrary point y;The evaluation function minimum f of adjacent domains is found according to the evaluation function that can search for continuous neighborhood A* algorithmminNode UUV routeing is done step-by-step as next way point.The present invention solves the paths planning method of existing UUV in global context, there are problems that the smoothness difference in path and non-shortest path.

Description

It is a kind of based on the paths planning method that can search for continuous neighborhood A* algorithm
Technical field
The present invention relates to a kind of UUV global path planning methods.
Background technique
UAV navigation (Unmanned underwater vehicle, UUV) is used as a kind of high-tech means, In It is played a crucial role in the following valuable development space of this block of ocean, and path planning is autonomous underwater navigation One of key technology of device is that Autonomous Underwater Vehicle can safely, effectively travel in locating environment, smoothly complete to Determine the important guarantee of task.
UUV global path planning essence is under the conditions of given barrier and constraint, to find one in planning region Optimal or feasible path from starting point to target point.Traditional path planning algorithm, as Artificial Potential Field Method, graph search method, Particle swarm algorithm etc. has some shortcomings mostly, for example, be easily trapped into local minimum and it is computationally intensive the problems such as.With grid On the basis of method environmental modeling, UUV global path planning is carried out using the A* algorithm that can search for continuous field, can effectively be solved Certainly tradition UUV path planning algorithm be easily trapped into local best points, it is computationally intensive the problems such as.
Summary of the invention
The purpose of the present invention is to provide it is a kind of can be shortened the path UUV, save the time, improve efficiency based on the company of can search for The paths planning method of continuous neighborhood A* algorithm.
The object of the present invention is achieved like this:
Step 1: establishing the environmental model of environmental model acquisition using Grid Method according to existing barrier, it is to UUV Particle, barrier longest width be diameter, barrier center of gravity be the round barrier of origin, utilize formulaObtain the area S of each round barrieri, wherein liFor the maximum gauge of the i-th barrier;
Step 2: the area of each round barrier obtained according to step 1, determines grid size l;
Wherein: S is expressed as the gross area of environment, lmaxIt is barrier maximal side, lmin=min (lminobs,dr) it is obstacle The minimum side length of object, drIt is UUV diameter, l is finally determining grid side length;
Step 3: the evaluation function of A* algorithm are as follows:
F (x)=g (x)+h (x)
Wherein, f (x) is the evaluation function from initial point via x node to target point, and evaluation function f, g (x) are in shape From initial point to the actual cost of x node in state space, actual cost g, h (x) are from x node to target point optimal path Estimate cost, appraisal cost are h;
Step 4: the evaluation function of the A* algorithm obtained according to step 3, the sideline of each grid is defined as may have access to Node, the appraisal cost that can search for field A* algorithm is
H (y)=d × h (X2)+(l-d)×h(X1) d∈[0 l]
Wherein, h (X1) it is nodes X1Estimate cost, h (X2) it is nodes X2Estimate cost, y is point X2X1On line segment Any point, d are point y to X1Distance, X1,X2...X8It is the node of the adjacent eight sideline intersection point of present node X;
Step 5: being sequentially found excellent according to the g value, f value and h value that can search for continuous field A* algorithm that step 4 obtains The node of change, until target point, this paths is shortest path.
The present invention is that there are smoothness difference and path are non-most in path planning in the global context of ocean in order to solve UUV Short problem and propose.
Beneficial effects of the present invention:
By calculating area and entire environment area shared by barrier, determines the grid size of grid environment, both avoided The problem of Computer real-time processing and the data of storage increase, also improves the accuracy of UUV path planning.
By combining traditional A* algorithm with can search for continuous field, the path UUV is shortened, the time has been saved, is mentioned High efficiency.
Detailed description of the invention
Fig. 1 is grid environmental modeling schematic diagram in the present invention;
Fig. 2 is that can search for the schematic diagram that field node is sideline intersection point in the present invention;
Fig. 3 is that can search for field node in the present invention be the adjacent sideline schematic diagram vertical with current sideline;
Fig. 4 is that can search for field node in the present invention be the adjacent sideline schematic diagram parallel with current sideline;
Fig. 5 is UUV Path Planning Simulation figure in the present invention.
Specific embodiment
It illustrates below and the present invention is described in more detail.
In conjunction with Fig. 1, Fig. 2, Fig. 3, Fig. 4 and Fig. 5, one kind described in present embodiment is based on can search for continuous neighborhood A* algorithm Paths planning method, the specific steps of this method are as follows:
Step 1: the environmental model that environmental model obtains is established using Grid Method according to there are barriers, is selected on map Any one barrier is taken, and judges whether it is round;If it is not, then being selected in all vertex of i-th of barrier The maximum value of coordinate and minimum value x under environmental map coordinate systemmax,ymax,xmin,ymin, then compare | | xmax-xmin| | with | | ymax-ymin| | maximum gauge is obtained, finally forms round barrier by origin of center of gravity.Utilize formula:
Obtain the area S of each round barrieri, liFor the maximum gauge of the i-th barrier.
Step 2: the size of computation grid is
Wherein, S is expressed as the gross area of environment, lmaxIt is barrier maximal side, lmin=min (lminobs,dr) it is obstacle The minimum side length of object, drIt is the diameter of mobile robot, l is finally determining grid side length.
Working environment is indicated that wherein the east-west direction of working environment is by the elevation information for not considering UUV with two-dimensional surface X-axis, North and South direction are Y-axis, establish rectangular coordinate system XOY, are sat if the horizontal and vertical maximum value of two-dimensional surface is corresponding in plane It is X in mark systemmaxAnd Ymax, due to definition grid side length be l square.
Step 3: according to established grid map, the evaluation function of A* algorithm are as follows:
F (x)=g (x)+h (x) (4)
Wherein: x is node, and f (x) is the evaluation function from initial point via node to target point, and g (x) is in state sky Between in actual cost from initial point to node, h (x) is the estimate cost from node to target point optimal path.When h (x) estimates When counting actual distance value of the cost no more than node to target point, the points of search are more, low efficiency, but can obtain optimal solution; When h (x) is greater than actual distance value of the node to target point, the points of search are few, high-efficient, but cannot be guaranteed to obtain optimal Solution;For the Euclidean distance linear distance between two nodes in actual environment, can be chosen) be used as estimate cost, i.e.,
Wherein (xG,yG) be target point G coordinate, (xi,yi) it is arbitrary node XiCoordinate.
Step 4: according to the evaluation function for the A* algorithm that step 3 obtains, A* algorithm is mutually tied with can search for continuous neighborhood It closes, so that the sideline of each grid is defined as addressable node, the estimate cost value h (y) of the arbitrary point y on one section of sideline is it The linear combination of two-end-point assessment values, i.e.,
H (y)=d × h (X2)+(l-d)×h(X1) d∈[0 l] (6)
Wherein, h (X1) it is nodes X1Estimate cost, h (X2) it is nodes X2Estimate cost, y is point X2X1On line segment Any point, d are point y to X1Distance, X1,X2...X8It is the node of the adjacent eight sideline intersection point of present node X.For Sideline XXiOn cost be min (a, b).Its child node can be any one in these adjacent nodes, then move side It also just expands to angle for continuous any direction.It is different with h value for g value, the f value of different nodes of locations y.
When nodes X being sideline intersection point the case where, nodes X to sideline X2X1The cost of upper arbitrary node y can be expressed as
And
Wherein, g (X) be in state space from initial point to the actual cost of X node, g (y) be in state space from Actual cost of the initial point to y node, a, b are sideline XXiOn cost.
When nodes X is not sideline intersection point but vertical with this section of sideline situation, sideline nodes X to sideline X2X1Take up an official post The cost of meaning node y can be expressed as
Wherein, t ∈ [0, l] and
When nodes X is not sideline intersection point node but parallel with this section of sideline situation, sideline nodes X to sideline X2X3 The cost of upper arbitrary node y can be expressed as
Wherein [0, l] m ∈, and
By the calculating of the above different situations, can compare to obtain fminAnd g.
Step 5: two tables of creation: open table and closed table, open table be used to save it is all oneself generate and do not investigate Node, closed table accessed the node for being not required to investigate again for recording oneself.Then it is operated according to following step:
Starting point A is added in open table, and by the grid point X adjacent with A point1,X2...X8And appointing on sideline The point y that anticipates adds open into table.Starting point A is moved on in closed table from open table, and be defined as the grid of its adjacent extension Father node.G value, f value and the h value of grid point in open table are solved by formula (7,8,9,10,11,12).It is selected from open table The smallest grid point of f value is selected, is denoted as present node X, and it is moved on in closed table from open list.It investigates respectively and works as prosthomere Point X all adjacent nodes (be denoted as S, if fruit dot is neither in closed table nor in open table, added open into Table, solves its g value, f value and h value, and juxtaposition present node X is its father node;If oneself is present in open table S point, compare Compared with the size of g (X)+c (X, S) (wherein, c (X, S) is the cost from X point to S point) and g (S), as g (X)+c (X, S) < g (S) When, g (S)=g (X)+c (X, S) is enabled, and accordingly update the f value of point S, and setting point X is otherwise its father node does not do any place then Reason;If S is already present in closed table, also without any processing.It repeats above-mentioned until present node X is that target point G is Only.Since target point G, its father node is sequentially found, until starting point A, this paths is that the algorithm solves most Short path.
Specific example:
UUV arrives terminal (80,80) from starting point (10,10) navigation, 45 ° of original heading, devises multiple and barrier O1, O2... is obtained the area of barrier using formula (1), obtains the size of grid using formula (2), obtained using formula (3) In evaluation function.Then, being found using the evaluation function that can search for continuous neighborhood A* algorithm can search for continuous neighborhood evaluation function UUV routeing is done step-by-step as next way point in the smallest node.Simulation track is as shown in Figure 5.

Claims (5)

1. it is a kind of based on the paths planning method that can search for continuous neighborhood A* algorithm, it is characterized in that:
Step 1: establishing the environmental model of environmental model acquisition using Grid Method according to existing barrier, chosen on map Any one barrier, and judge whether it is round;If it is not, then being selected in all vertex of i-th of barrier The maximum value of coordinate and minimum value x under environmental map coordinate systemmax,ymax,xmin,ymin, then compare | | xmax-xmin| | with | | ymax-ymin| | maximum gauge is obtained, finally round barrier is formed by origin of center of gravity, utilizes formulaIt obtains Obtain the area S of each round barrieri, wherein liFor the maximum gauge of the i-th barrier;
Step 2: the area of each round barrier obtained according to step 1, determines grid size l;
Working environment is indicated that wherein the east-west direction of working environment is X-axis by the elevation information for not considering UUV with two-dimensional surface, North and South direction is Y-axis, establishes rectangular coordinate system XOY, if the horizontal and vertical maximum value of two-dimensional surface is corresponding in plane coordinate system In be XmaxAnd Ymax, the grid side length of definition is the square of l;
Wherein: S is expressed as the gross area of environment, lmaxIt is barrier maximal side, lmin=min (lminobs,dr) it is barrier Minimum side length, lminobsIt is the minimum side length of barrier itself, drIt is the diameter of UUV, l is finally determining grid side length;
Step 3: the evaluation function of A* algorithm are as follows:
F (x)=g (x)+h (x)
Wherein, f (x) is the evaluation function from initial point via x node to target point, and evaluation function f, g (x) are in state sky Between in from initial point to the actual cost of x node, actual cost g, h (x) are the estimations from x node to target point optimal path Cost, appraisal cost are h;
Step 4: the evaluation function of the A* algorithm obtained according to step 3, is defined as addressable section for the sideline of each grid Point, the appraisal cost that can search for field A* algorithm are
H (y)=d × h (X2)+(l-d)×h(X1) d∈[0 l]
Wherein, h (X1) it is nodes X1Estimate cost, h (X2) it is nodes X2Estimate cost, y is point X2X1It is any on line segment A bit, d is point y to X1Distance, X1,X2...X8It is the node of the adjacent eight sideline intersection point of present node X;
Step 5: sequentially finding optimization according to the g value, f value and h value that can search for continuous field A* algorithm that step 4 obtains Node, until target point, this paths is shortest path.
2. it is according to claim 1 based on the paths planning method that can search for continuous neighborhood A* algorithm, it is characterized in that estimation Cost h (x) are as follows:
(xG,yG) be target point G coordinate, (xi,yi) it is arbitrary node XiCoordinate.
3. it is according to claim 1 or 2 based on the paths planning method that can search for continuous neighborhood A* algorithm, it is characterized in that: When nodes X is sideline intersection point, nodes X to sideline X2X1The cost of upper arbitrary node y is expressed as
And
Wherein, g (X) is from initial point to the actual cost of X node in state space, and g (y) is in state space from initial Point arrives the actual cost of y node, and a, b are sideline XXiOn cost;
When nodes X is not sideline intersection point but is vertical with this section of sideline, sideline nodes X to sideline X2X1The generation of upper arbitrary node y Valence is expressed as
Wherein, t ∈ [0, l] and
When nodes X is not sideline intersection point node but is parallel with this section of sideline, sideline nodes X to sideline X2X3Upper arbitrary node y Cost be expressed as
Wherein [0, l] m ∈, and
4. it is according to claim 1 or 2 based on the paths planning method that can search for continuous neighborhood A* algorithm, it is characterized in that step Rapid five specifically include: two tables of creation: open table and closed table, and open table is used to save all own sections for generating and not investigating Point, closed table are used to record the node for having accessed and being not required to investigate again, then be operated according to following step:
Starting point A is added in open table, and by the grid point X adjacent with A point1,X2...X8And the arbitrary point y on sideline Open is added into table;Starting point A is moved on in closed table from open table, and is defined as father's section of the grid of its adjacent extension Point solves g value, f value and the h value of grid point in open table, and the smallest grid point of f value is selected from open table, is denoted as and works as prosthomere Point X, and it is moved on in closed table from open list, all adjacent nodes for investigating present node X respectively are denoted as S, if Point is added open into table, solves its g value, f value and h value, juxtaposition is current neither in closed table nor in open table Nodes X is its father node;If S point is already present in open table, compare the size of g (X)+c (X, S) and g (S), c (X, S g (S)=g (X)+c (X, S)) is enabled as g (X)+c (X, S) < g (S) for the cost from X point to S point, and accordingly updates point S F value, and set point X be its father node, it is otherwise, then without any processing;If S is already present in closed table, also do not do Any processing, repetition is above-mentioned until present node X is target point G, since target point G, sequentially finds its father node, directly Until starting point A, this paths is shortest path.
5. it is according to claim 3 based on the paths planning method that can search for continuous neighborhood A* algorithm, it is characterized in that step Five specifically include: two tables of creation: open table and closed table, and open table is used to save all own sections for generating and not investigating Point, closed table are used to record the node for having accessed and being not required to investigate again, then be operated according to following step:
Starting point A is added in open table, and by the grid point X adjacent with A point1,X2...X8And the arbitrary point y on sideline Open is added into table;Starting point A is moved on in closed table from open table, and is defined as father's section of the grid of its adjacent extension Point solves g value, f value and the h value of grid point in open table, and the smallest grid point of f value is selected from open table, is denoted as and works as prosthomere Point X, and it is moved on in closed table from open list, all adjacent nodes for investigating present node X respectively are denoted as S, if Point is added open into table, solves its g value, f value and h value, juxtaposition is current neither in closed table nor in open table Nodes X is its father node;If S point is already present in open table, compare the size of g (X)+c (X, S) and g (S), c (X, S g (S)=g (X)+c (X, S)) is enabled as g (X)+c (X, S) < g (S) for the cost from X point to S point, and accordingly updates point S F value, and set point X be its father node, it is otherwise, then without any processing;If S is already present in closed table, also do not do Any processing, repetition is above-mentioned until present node X is target point G, since target point G, sequentially finds its father node, directly Until starting point A, this paths is shortest path.
CN201610867274.XA 2016-09-30 2016-09-30 It is a kind of based on the paths planning method that can search for continuous neighborhood A* algorithm Active CN106441303B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201610867274.XA CN106441303B (en) 2016-09-30 2016-09-30 It is a kind of based on the paths planning method that can search for continuous neighborhood A* algorithm

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201610867274.XA CN106441303B (en) 2016-09-30 2016-09-30 It is a kind of based on the paths planning method that can search for continuous neighborhood A* algorithm

Publications (2)

Publication Number Publication Date
CN106441303A CN106441303A (en) 2017-02-22
CN106441303B true CN106441303B (en) 2019-11-01

Family

ID=58172531

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610867274.XA Active CN106441303B (en) 2016-09-30 2016-09-30 It is a kind of based on the paths planning method that can search for continuous neighborhood A* algorithm

Country Status (1)

Country Link
CN (1) CN106441303B (en)

Families Citing this family (34)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108510095B (en) * 2017-02-23 2020-12-22 北京京东乾石科技有限公司 Method and device for determining goods picking path
CN108731678A (en) * 2017-04-18 2018-11-02 深圳市丰巨泰科电子有限公司 robot global path planning method
CN107168697B (en) 2017-04-22 2020-11-24 华南理工大学 Connection automatic obstacle avoidance optimization method of graphical programming software
CN107168344B (en) * 2017-05-17 2020-01-17 哈尔滨工程大学 Method for generating air route in process of UUV (unmanned Underwater vehicle) approaching seabed operation
CN107506513A (en) * 2017-06-29 2017-12-22 南京理工大学 A kind of war game hexagonal grid map path planing method based on A* algorithms
CN107357295B (en) * 2017-08-16 2021-02-23 珠海市一微半导体有限公司 Path searching method and chip based on grid map and robot
CN107687859A (en) * 2017-09-06 2018-02-13 电子科技大学 Most short method for searching based on A star algorithms
CN107478232B (en) * 2017-09-18 2020-02-21 珠海市一微半导体有限公司 Searching method for robot navigation path
CN107860386B (en) * 2017-10-17 2020-09-04 洛阳中科龙网创新科技有限公司 Dijkstra algorithm-based agricultural machine shortest path planning method
CN108705532B (en) * 2018-04-25 2020-10-30 中国地质大学(武汉) Mechanical arm obstacle avoidance path planning method and device and storage device
CN108871364A (en) * 2018-06-28 2018-11-23 南京信息工程大学 A kind of underwater robot paths planning method based on Node Algorithm
CN109163722B (en) * 2018-06-29 2020-06-30 北京建筑大学 Humanoid robot path planning method and device
CN109255467A (en) * 2018-07-27 2019-01-22 四川大学 A kind of A* pathfinding optimization method of Virtual reality
CN109470249B (en) * 2018-11-07 2021-07-27 河海大学 Optimal path planning and obstacle avoidance design method for underwater vehicle
CN109540146A (en) * 2018-11-29 2019-03-29 珠海格力智能装备有限公司 Paths planning method and device
CN111308997B (en) * 2018-12-11 2024-04-16 北京京东尚科信息技术有限公司 Method and device for generating a travel path
CN109917794B (en) * 2019-04-18 2022-02-18 北京智行者科技有限公司 Global path planning method and device
CN110207708A (en) * 2019-06-25 2019-09-06 重庆邮电大学 A kind of unmanned aerial vehicle flight path device for planning and method
CN110456789A (en) * 2019-07-23 2019-11-15 中国矿业大学 A kind of complete coverage path planning method of clean robot
CN110595482B (en) * 2019-10-28 2020-11-13 深圳市银星智能科技股份有限公司 Path planning method and device with obstacle avoidance weight and electronic equipment
CN110836671B (en) * 2019-11-14 2021-09-14 北京京邦达贸易有限公司 Trajectory planning method, trajectory planning device, storage medium, and electronic apparatus
CN110806218B (en) * 2019-11-29 2021-09-07 北京京东乾石科技有限公司 Parking path planning method, device and system
CN111176286B (en) * 2020-01-06 2022-08-23 重庆邮电大学 Mobile robot path planning method and system based on improved D-lite algorithm
CN111412918B (en) * 2020-03-13 2022-01-07 天津大学 Unmanned ship global safety path planning method
CN111397622B (en) * 2020-03-26 2022-04-26 江苏大学 Intelligent automobile local path planning method based on improved A-algorithm and Morphin algorithm
CN111504325B (en) * 2020-04-29 2023-09-26 南京大学 Global path planning method based on weighted A-algorithm of enlarged search neighborhood
CN111586719A (en) * 2020-05-11 2020-08-25 桂林电子科技大学 Communication control method for path change
CN112034836B (en) * 2020-07-16 2023-06-16 北京信息科技大学 Mobile robot path planning method with improved A-algorithm
CN112957734B (en) * 2021-01-28 2023-05-02 北京邮电大学 Map route searching method and device based on secondary search
CN112985408B (en) * 2021-02-25 2022-02-11 南京航空航天大学 Path planning optimization method and system
CN113124873B (en) * 2021-04-09 2022-08-16 青岛哈船海智科技有限公司 UUV multi-index constraint three-dimensional route planning method based on marine environment information
CN113551682B (en) * 2021-07-19 2022-07-08 大连理工大学 Path planning method of amphibious unmanned war chariot considering influence of terrain and topography
CN113608531B (en) * 2021-07-26 2023-09-12 福州大学 Unmanned vehicle real-time global path planning method based on safety A-guidance points
CN114510056A (en) * 2022-02-21 2022-05-17 上海机器人产业技术研究院有限公司 Stable moving global path planning method for indoor mobile robot

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR101633889B1 (en) * 2009-02-18 2016-06-28 삼성전자주식회사 Apparatus and method for generating route using grid map
CN103777639B (en) * 2014-01-10 2015-06-24 哈尔滨工程大学 UUV three-dimension sea route planning method in moving obstacle environment
CN104599588B (en) * 2015-02-13 2017-06-23 中国北方车辆研究所 A kind of computational methods of the current cost of grating map

Also Published As

Publication number Publication date
CN106441303A (en) 2017-02-22

Similar Documents

Publication Publication Date Title
CN106441303B (en) It is a kind of based on the paths planning method that can search for continuous neighborhood A* algorithm
CN106371445B (en) A kind of unmanned vehicle planning control method based on topological map
CN106931961B (en) Automatic navigation method and device
Carsten et al. 3d field d: Improved path planning and replanning in three dimensions
CN105573318B (en) environment construction method based on probability analysis
CN108958282A (en) Three-dimensional path planing method based on dynamic spherical window
CN106931978B (en) Indoor map generation method for automatically constructing road network
CN108803659B (en) Multi-window heuristic three-dimensional space path planning method based on magic cube model
CN108731678A (en) robot global path planning method
CN116698043A (en) Visual navigation method for indoor mobile robot
Alam et al. An underactuated vehicle localization method in marine environments
CN112882058B (en) Shipborne laser radar obstacle detection method based on variable-size grid map
CN110763223B (en) Sliding window based indoor three-dimensional grid map feature point extraction method
CN114459483A (en) Landmark navigation map construction and application method and system based on robot navigation
CN110602635B (en) Indoor map matching enhanced positioning method, device and storage device
Kostavelis et al. Path tracing on polar depth maps for robot navigation
Su et al. Automatic multi-source data fusion technique of powerline corridor using UAV Lidar
CN108960738B (en) Laser radar data clustering method under warehouse channel environment
CN113776535A (en) Unmanned ship route planning method based on rasterized electronic chart
CN113313755A (en) Method, device and equipment for determining pose of target object and storage medium
Moratuwage et al. Collaborative multi-vehicle localization and mapping in marine environments
Yang et al. Vision and UWB-based anchor self-localisation system for UAV in GPS-denied environment
CN113885510B (en) Four-foot robot obstacle avoidance and pilot following method and system
Liu et al. 3D space path planning of complex environmental underwater vehicle
CN108981713A (en) A kind of hybrid wireless adaptive navigation method and device

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant