CN112596513A - AGV navigation system and AGV dolly - Google Patents

AGV navigation system and AGV dolly Download PDF

Info

Publication number
CN112596513A
CN112596513A CN202011194530.6A CN202011194530A CN112596513A CN 112596513 A CN112596513 A CN 112596513A CN 202011194530 A CN202011194530 A CN 202011194530A CN 112596513 A CN112596513 A CN 112596513A
Authority
CN
China
Prior art keywords
constraint
path
sampling
module
local
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN202011194530.6A
Other languages
Chinese (zh)
Other versions
CN112596513B (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.)
Wuhu Hit Robot Technology Research Institute Co Ltd
Original Assignee
Wuhu Hit Robot Technology Research Institute 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 Wuhu Hit Robot Technology Research Institute Co Ltd filed Critical Wuhu Hit Robot Technology Research Institute Co Ltd
Priority to CN202011194530.6A priority Critical patent/CN112596513B/en
Publication of CN112596513A publication Critical patent/CN112596513A/en
Application granted granted Critical
Publication of CN112596513B publication Critical patent/CN112596513B/en
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/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
    • 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/0214—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
    • 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

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 discloses an AGV navigation system, comprising: the system comprises a global path planning unit, a local path planning unit connected with the global path planning unit and a path optimization unit connected with the global path planning unit and the local path planning unit, wherein the global path planning unit plans a shortest path from a task starting point to a task ending point, namely a global path; in the driving process, if the obstacle is detected to exist on the global path, planning and avoiding the obstacle to return to the shortest path on the global path through the local path planning unit, namely obtaining the local path; and the path optimization unit is used for smoothing the formed global path and the local path. When local navigation is carried out, the sampling group adopts equal resolution sampling, more comprehensive linear velocity constraint and angular velocity constraint for processing, the calculated amount of the local navigation is greatly reduced, and meanwhile, the navigation accuracy can be ensured.

Description

AGV navigation system and AGV dolly
Technical Field
The invention belongs to the technical field of AGV navigation, and particularly relates to an AGV navigation system and an AGV.
Background
When an AGV navigation system generates a global path, the best driving path is mostly generated based on an existing obstacle of a field, in the driving process, when a newly-added obstacle appears on the global path, obstacle avoidance can be carried out only by local path planning, most of the current AGV adopts local path planning methods such as D and the like under ROS, the D-local path planning method searches the optimal path from a task starting point to a task terminal point on a grid map in a traversal mode, the task terminal point is taken as a starting point, 8 grids around the grid where the task terminal point is located are traversed, the grid which is nearest to the task starting point and has no obstacle is obtained, then the 8 grids around the grid are traversed by taking the grid as the starting point, and the grid where the task starting point is located is traversed by analogy in sequence, and the local path planning methods have the problems of complex calculation and large calculation amount.
Disclosure of Invention
The present invention provides an AGV navigation system that aims to improve the above-mentioned problems.
The present invention is achieved as described above, and an AGV navigation system includes:
a global path planning unit, a local path planning unit connected with the global path planning unit, and a path optimizing unit connected with the global path planning unit and the local path planning unit, wherein,
the global path planning unit is used for planning a shortest path from a task starting point to a task ending point, namely a global path;
in the driving process, if the obstacle is detected to exist on the global path, planning and avoiding the obstacle to return to the shortest path on the global path through the local path planning unit, namely obtaining the local path;
and the path optimization unit is used for smoothing the formed global path and the local path.
Further, the local planning unit includes: a sampling group generation module, a linear velocity constraint module, an angular velocity constraint module, a track evaluation module and a smooth processing module which are connected in sequence, wherein,
a sample group generation module: periodically forming a plurality of initial sampling groups, and generating a track corresponding to each initial sampling group based on an initial position;
a linear velocity constraint module; outputting a sampling group with the linear velocity meeting the motor performance constraint, the obstacle distance constraint and the local path constraint to an angular velocity constraint module;
an angular velocity constraint module; outputting the sampling group of which the angular speed meets the local course constraint and the global course constraint and the smooth constraint to a track evaluation module;
a trajectory evaluation module: evaluating the tracks formed by each adopted group, and outputting the tracks with the best evaluation to a smoothing processing unit;
a smoothing module: performing angular speed smoothing on the track with the best evaluation to form an optimal track;
further, the linear velocity constraint conditions of the linear velocity constraint module are as follows:
and (3) motor performance constraint: v. ofm∈{v0-va·Δt,v0+vaΔ t }, wherein vaRepresents the maximum linear acceleration, v, that the AGV car can achieve0Representing the current speed of the AGV trolley, wherein delta t is the time interval of two times of sampling;
obstacle distance constraint:
Figure BDA0002753629860000021
wherein diast (v)m,wm) Is a sample group (v)m,wm) Corresponding to the distance of the trajectory from the nearest obstacle, vaRepresents the maximum linear acceleration, w, that the AGV car can achieveaRepresenting the maximum angular acceleration that the AGV car can achieve;
local path constraint: v (w) delta t-S | < delta |1And | v (w). DELTA.t-S does not countx≤δ2Wherein v ist(w) represents the AGV traveling angular velocity wmLinear velocity v ofmS is v (w) corresponding to the local end point of the track on the global path, | v (w) × Δ t-S non-woven phosphorxRepresents the projected distance of the line | v (w) × Δ t-S | on the transverse axis x.
Further, the angular velocity constraint conditions of the angular velocity constraint module are as follows:
the local course constraint is as follows:
Figure BDA0002753629860000031
wherein, thetacIs the course angle, theta, corresponding to the sample groupgLocal end course angle, w, of the corresponding track on the global path for the sampling group0Is a local course deviation threshold;
and (3) global course constraint:
Figure BDA0002753629860000032
wherein, thetacIs the course angle, theta, corresponding to the sample groupwIs the global end course angle, w, on the current global path1Is a global course deviation threshold;
and (4) smooth constraint:
Figure BDA0002753629860000033
wherein the content of the first and second substances,
Figure BDA0002753629860000034
θpis a heading deviation threshold.
Further, the smoothing module performs smoothing based on the optimal trajectory estimated by formula (1), where formula (1) is expressed as follows:
Figure BDA0002753629860000035
wherein the content of the first and second substances,
Figure BDA0002753629860000036
θcindicating the heading angle, θ, corresponding to the sample groupgAnd (4) regarding the local end point course angle of the corresponding track of the sampling group on the global path, wherein theta represents the course angle corresponding to the sampling group after smoothing.
Further, the trajectory evaluation module performs estimation evaluation based on the following method:
obtaining the number of corners n of the trackrAnd amplitude of rotation thetarThe evaluation formula is mu (n)r) And ρ (θ)r)；
Evaluating the distance between the AGV and the global terminal, wherein the distance evaluation formula is beta (dist);
optimal path TpIs Tp＝max{σ1·μ(nr)+σ2·ρ(θr)+σ3·β(dist)}，σ1、σ2And sigma3Is a specific gravity coefficient.
Further, the AGV navigation system further includes:
the linear velocity sampling module, linear velocity restraint module pass through the linear velocity sampling module and are connected with angular velocity restraint module, and wherein, the linear velocity sampling module samples the sampling group of linear velocity restraint module output, exports the adoption group of sampling to the angular velocity restraint module, and the sampling method of linear velocity sampling module specifically is as follows:
calculating a speed difference value v' between the maximum speed and the minimum speed in the output sampling group of the linear speed constraint unit;
determining the sampling number N based on the speed difference v', and sampling the sampling group output by the linear speed constraint unit based on an equal resolution method;
Figure BDA0002753629860000041
Figure BDA0002753629860000042
where ε is the velocity difference threshold, nsAnd f (×) is a set value of the number of sampling groups, a is a scaling factor, and n is the number of output sampling groups of the linear velocity constraint unit.
The AGV comprises an AGV body, a front wheel, a rear wheel.
The AGV navigation method provided by the invention has the following beneficial technical effects: when local navigation is carried out, the sampling group adopts equal resolution sampling, more comprehensive linear velocity constraint and angular velocity constraint to carry out processing, the calculated amount of the local navigation is greatly reduced, and meanwhile, the navigation accuracy can be ensured, so that the algorithm does not depend on the calculation force of the processor seriously, the method is suitable for adopting an embedded processor, and the method is more suitable for the operation scene of the industrial AGV.
Drawings
FIG. 1 is a schematic diagram of an AGV navigation system according to an embodiment of the present invention.
Detailed Description
The following detailed description of the embodiments of the present invention will be given in order to provide those skilled in the art with a more complete, accurate and thorough understanding of the inventive concept and technical solutions of the present invention.
FIG. 1 is a schematic diagram of an AGV navigation system according to an embodiment of the present invention, and for convenience of illustration, only the portions related to the embodiment of the present invention are shown.
This AGV navigation mainly is applicable to the AGV navigation in the grid map, and this AGV navigation includes: a global path planning unit, a local path planning unit connected with the global path planning unit, and a path optimizing unit connected with the global path planning unit and the local path planning unit, wherein,
the global path planning unit is used for planning a shortest path from a task starting point to a task ending point, namely a global path; in the driving process, if the obstacle is detected to exist on the global path, planning and avoiding the obstacle to return to the shortest path on the global path through the local path planning unit, namely obtaining the local path; a path optimization unit for smoothing the global path and the local path,
the global path planning unit adopts a shortest path algorithm to plan a shortest path from a task starting point to a task ending point, such as a Floyd algorithm; the path optimization unit adopts a Bezier curve to smoothly process the global path and the local path, so that the driving is stable and smooth.
In an embodiment of the present invention, the local planning unit includes: a sampling group generation module, a linear velocity constraint module, an angular velocity constraint module, a track evaluation module and a smooth processing module which are connected in sequence, wherein,
a sample group generation module: periodically forming a plurality of initial sampling groups, and generating a track corresponding to each initial sampling group based on an initial position; a linear velocity constraint module; outputting a sampling group with the linear velocity meeting the motor performance constraint, the obstacle distance constraint and the local path constraint to an angular velocity constraint module; an angular velocity constraint module; outputting the sampling group of which the angular speed meets the local course constraint and the global course constraint and the smooth constraint to a track evaluation module; a trajectory evaluation module: evaluating the tracks formed by each adopted group, and outputting the tracks with the best evaluation to a smoothing processing unit; a smoothing module: performing angular speed smoothing on the track with the best evaluation to form an optimal track;
a sample group generation module: periodically forming a plurality of initial sampling groups, and generating a track corresponding to each initial sampling group based on an initial position;
before local path planning, a kinematic model of the AGV is first determined as:
Figure BDA0002753629860000051
namely, the motion track of the AGV in the adjacent time is regarded as a section of circular arc, the motion characteristic of the industrial wheeled AGV is better met, R is the instant center radius, v is the linear velocity, and w is the angular velocity. Therefore, by the model, it can be known that: the centrode radius R determines the trajectory of the motion, and v and w are related to R.
Obtaining the current position (x) of AGV0，y0) Defined as the starting position, periodically generating several groups of samples (v) based on a fixed resolutionm，wm) Called initial sampling group, and synchronously generating the track corresponding to each sampling group. Based on the linear velocity v in each sampling groupmAnd angular velocity wmThe running track of each sampling group in the current period can be obtained through a speed displacement formula, and the terminal point coordinate of the track is (x)mf，ymf) The expression is specifically as follows:
Figure BDA0002753629860000061
wherein, thetat0Is the starting course angle, θ, of the AGVt1＝θt0+ w.DELTA.t, DELTA.t is the time interval between two samplings, i.e. the sampling period, vm,wmLinear velocity and angular velocity of the mth sampling group are shown;
the linear velocity constraint module: outputting a sampling group with the linear velocity meeting the motor performance constraint, the obstacle distance constraint and the local path constraint to an angular velocity constraint module;
in the embodiment of the present invention, the linear velocity constraint condition of the linear velocity constraint module is expressed as follows:
1) and (3) motor performance constraint: v. ofm∈{v0-va·Δt,v0+vaΔ t }, wherein vaRepresents the maximum linear acceleration, v, that the AGV car can achieve0Representing the current speed of the AGV trolley, wherein delta t is the time interval of two times of sampling;
2) obstacle distance constraint: considering not only the straight-line distance from the obstacle but also the transverse distance from the obstacle, the straight-line distance and the transverse distance from the obstacle need to be kept within a safe distance, and if the vehicle runs at a certain course w, the speed v is coupled with the angular speed w in a relation mode. For straight-line distance of obstacle, vmShould satisfy the following:
Figure BDA0002753629860000062
wherein diast (v)m,wm) Is velocity (v)m,wm) Corresponding to the distance of the trajectory from the nearest obstacle, vaRepresents the maximum linear acceleration, w, that the AGV car can achieveaThe maximum angular acceleration that the AGV dolly can reach is shown, the lateral distance from the barrier is then very easy to acquire, and the limit based on barrier straight line distance satisfies the contained angle relation with the limit of barrier lateral distance. I.e. whether to travel at the current speed, stop before an obstacle;
3) local path constraint: the AGV runs at a certain course at the current speed, the distance between a position point reached within a sampling period delta t and a corresponding local terminal point on the global path is within a certain range, the distance comprises a linear distance and a transverse distance, and the linear distance between the position point and the corresponding local terminal point on the global path is smaller than a distance threshold value delta1I.e. | v (w) × Δ t-S | ≦ δ1And | v (w). DELTA.t-S does not countx≤δ2Wherein v ist(w) represents the AGV traveling angular velocity wmLinear velocity v ofmS is v (w) corresponding to the local end point of the track on the global path, | v (w) × Δ t-S non-woven phosphorxRepresents the projected distance of the line | v (w) × Δ t-S | on the transverse axis x.
The global path refers to the shortest path planned from the task starting position to the task ending position, the local ending point is a point on the global path, and v (w) is a point on the corresponding track returning to the global path,
the track formed by the sampling group meeting the constraint conditions meets the hardware performance of the motor, can not collide with an obstacle (has good safety), has short distance with a local path terminal point and has small lateral deviation of the local path (can not deviate).
In an embodiment of the present invention, the AGV system further includes:
the linear velocity sampling module, linear velocity restraint module pass through the linear velocity sampling module and are connected with angular velocity restraint module, and wherein, the linear velocity sampling module samples the sampling group of linear velocity restraint module output, exports the adoption group of sampling to the angular velocity restraint module, and the sampling method of linear velocity sampling module specifically is as follows:
and calculating the speed difference value v ', v' ═ v of the maximum speed and the minimum speed in the output of the wire harness speed constraint modulemax|-vminL, wherein l vmax| is the maximum velocity value in the sampling group I, | vminI is the minimum speed value in the sampling group I;
determining the sampling number N of the sampling group I based on the speed difference, and sampling the sampling group I based on an equal resolution method to generate a sampling group II;
Figure BDA0002753629860000071
Figure BDA0002753629860000072
where ε is the velocity difference threshold, nsFor the set value of the number of sampling groups, f (. +) is an integer function, n is, a is a proportionality factorAnd N is the number of the sampling groups in the sampling group I, when the numerical value of N is 12 and the numerical value of N is 6, sampling is performed in every other sampling group in the sampling group I, and when the numerical value of N is 3, sampling is performed in every other 4 sampling groups in the sampling group I.
An angular velocity constraint module: screening the angular speed by adopting groups output by the linear speed constraint module or the linear speed sampling module, and outputting sampling groups with angular speed meeting the local course constraint and the global course constraint and smooth constraint to the track evaluation module;
estimating the angular velocity based on the course angle, wherein the global path constraint, the local path constraint and the smooth constraint are as follows:
1) local course constraint:
Figure BDA0002753629860000081
wherein, thetacIs the course angle, theta, corresponding to the sample groupgThe local terminal course angle of the corresponding track of the sampling group on the global path (or the local terminal course angle of the corresponding track of the sampling group for short), the course angle in the invention refers to the included angle between the mass center speed (vector) of the AGV and the x axis, and w0Is a local course deviation threshold;
2) and (3) global course constraint:
Figure BDA0002753629860000082
wherein, thetacIs the course angle, theta, corresponding to the sample groupwIs a global end course angle, w, on a global path1Is a global course deviation threshold;
3) and (4) smooth constraint:
Figure BDA0002753629860000083
wherein the content of the first and second substances,
Figure BDA0002753629860000084
θpis a heading deviation threshold.
In the local course constraint, the global course constraint and the smoothing constraint, if f is 1, the angular velocity in the corresponding sampling group is reserved, and if f is 0, the angular velocity in the corresponding sampling group is not reserved.
The corresponding track of the sampling group which can meet the constraint condition does not rotate in a large angle (the smoothness is ensured); ensuring small deviation (ensuring no deviation) from the local path terminal point orientation; and ensuring that the deviation from the global path orientation is small (ensuring that the deviation is not generated).
A trajectory evaluation module: and receiving a sampling group output by the angular velocity constraint module, and evaluating a track formed by the sampling group to obtain an optimal track for evaluation. The track evaluation method specifically comprises the following steps:
1) the method has the advantages that as the paths under the grid map still have broken line corners and are likely to have more broken corner numbers, the paths cause the problem that the AGV has low operation efficiency, the operation problem of the paths is comprehensively considered, the tracks are evaluated, two factors are considered, and the corner number n of the tracks T is consideredrAnd amplitude of rotation thetarHas an evaluation formula of μ (n)r) And ρ (θ)r) The larger the number of corners, μ (n)r) The smaller the value, the larger the amplitude of the rotation angle, ρ (θ)r) The smaller the value;
2) the method is used for evaluating the distance between the AGV and the global end point in real time, dist represents the distance between two points of the robot on the current track, the distance evaluation formula is beta (dist), and the longer the distance is, the smaller the value of beta (dist) is.
3) Evaluating the optimal trajectory TpIs Tp＝max{σ1·μ(nr)+σ2·ρ(θr)+σ3·β(dist)}，σ1、σ2And sigma3For the proportion coefficient, the obtained path can better meet the application scene of the industrial AGV, and the AGV runs more stably.
A smoothing module: and performing angular velocity smoothing processing on the track with the best evaluation to form an optimal track.
Smoothing treatment:
Figure BDA0002753629860000091
wherein the content of the first and second substances,
Figure BDA0002753629860000092
θcindicating the heading angle, θ, corresponding to the sample groupgAnd theta represents the course angle corresponding to the smoothed sampling group.
Correspondingly, the invention also provides an AGV, wherein the AGV is provided with an AGV navigation system, and the AGV navigation system is provided with the system.
The AGV navigation method provided by the invention has the following beneficial technical effects: when local navigation is carried out, the sampling group adopts equal resolution sampling, more comprehensive linear velocity constraint and angular velocity constraint to carry out processing, the calculated amount of the local navigation is greatly reduced, and meanwhile, the navigation accuracy can be ensured, so that the algorithm does not depend on the calculation force of the processor seriously, the method is suitable for adopting an embedded processor, and the method is more suitable for the operation scene of the industrial AGV.
The invention has been described above with reference to the accompanying drawings, it is obvious that the invention is not limited to the specific implementation in the above-described manner, and it is within the scope of the invention to apply the inventive concept and solution to other applications without substantial modification.

Claims (8)

1. An AGV navigation system, comprising:
a global path planning unit, a local path planning unit connected with the global path planning unit, and a path optimizing unit connected with the global path planning unit and the local path planning unit, wherein,
the global path planning unit is used for planning a shortest path from a task starting point to a task ending point, namely a global path;
in the driving process, if the obstacle is detected to exist on the global path, planning and avoiding the obstacle to return to the shortest path on the global path through the local path planning unit, namely obtaining the local path;
and the path optimization unit is used for smoothing the formed global path and the local path.
2. The AGV navigation system of claim 1, wherein the local planning unit includes: a sampling group generation module, a linear velocity constraint module, an angular velocity constraint module, a track evaluation module and a smooth processing module which are connected in sequence, wherein,
a sample group generation module: periodically forming a plurality of initial sampling groups, and generating a track corresponding to each initial sampling group based on an initial position;
a linear velocity constraint module; outputting a sampling group with the linear velocity meeting the motor performance constraint, the obstacle distance constraint and the local path constraint to an angular velocity constraint module;
an angular velocity constraint module; outputting the sampling group of which the angular speed meets the local course constraint and the global course constraint and the smooth constraint to a track evaluation module;
a trajectory evaluation module: evaluating the tracks formed by each adopted group, and outputting the tracks with the best evaluation to a smoothing processing unit;
a smoothing module: performing angular speed smoothing on the track with the best evaluation to form an optimal track;
3. the AGV navigation system of claim 2, wherein the linear velocity constraint of the linear velocity constraint module is specified as follows:
and (3) motor performance constraint: v. ofm∈{v0-va·Δt,v0+vaΔ t }, wherein vaRepresents the maximum linear acceleration, v, that the AGV car can achieve0Representing the current speed of the AGV trolley, wherein delta t is the time interval of two times of sampling;
obstacle distance constraint:
Figure RE-FDA0002959713670000021
wherein diast (v)m,wm) Is a sample group (v)m,wm) Corresponding to the distance of the trajectory from the nearest obstacle, vaRepresents the maximum linear acceleration, w, that the AGV car can achieveaRepresenting the maximum angular acceleration that the AGV car can achieve;
local path constraint: v (w) delta t-S | < delta |1And | v (w). DELTA.t-S does not countx≤δ2Wherein v ist(w) represents the AGV traveling angular velocity wmLinear velocity v ofmS is v (w) corresponding to the local end point of the track on the global path, | v (w) × Δ t-S non-woven phosphorxRepresents the projected distance of the line | v (w) × Δ t-S | on the transverse axis x.
4. The AGV navigation system of claim 2, wherein the angular velocity constraints of the angular velocity constraint module are specified as follows:
the local course constraint is as follows:
Figure RE-FDA0002959713670000022
wherein, thetacIs the course angle, theta, corresponding to the sample groupgLocal end course angle, w, of the corresponding track on the global path for the sampling group0Is a local course deviation threshold;
and (3) global course constraint:
Figure RE-FDA0002959713670000023
wherein, thetacIs the course angle, theta, corresponding to the sample groupwIs the global end course angle, w, on the current global path1Is a global course deviation threshold;
and (4) smooth constraint:
Figure RE-FDA0002959713670000024
wherein the content of the first and second substances,
Figure RE-FDA0002959713670000025
θpis a heading deviation threshold.
5. The AGV navigation system of claim 2, wherein the smoothing module performs smoothing based on an optimal trajectory estimated by equation (1), where equation (1) is expressed as follows:
Figure RE-FDA0002959713670000026
wherein the content of the first and second substances,
Figure RE-FDA0002959713670000027
θcindicating the heading angle, θ, corresponding to the sample groupgAnd (4) regarding the local end point course angle of the corresponding track of the sampling group on the global path, wherein theta represents the course angle corresponding to the sampling group after smoothing.
6. The AGV navigation system of claim 2, wherein the trajectory evaluation module evaluates the estimate based on:
obtaining the number of corners n of the trackrAnd amplitude of rotation thetarThe evaluation formula is mu (n)r) And ρ (θ)r)；
Evaluating the distance between the AGV and the global terminal, wherein the distance evaluation formula is beta (dist);
optimal path TpIs Tp＝max{σ1·μ(nr)+σ2·ρ(θr)+σ3·β(dist)}，σ1、σ2And sigma3Is a specific gravity coefficient.
7. The AGV navigation system of claim 2, further comprising:
the linear velocity sampling module, linear velocity restraint module pass through the linear velocity sampling module and are connected with angular velocity restraint module, and wherein, the linear velocity sampling module samples the sampling group of linear velocity restraint module output, exports the adoption group of sampling to the angular velocity restraint module, and the sampling method of linear velocity sampling module specifically is as follows:
calculating a speed difference value v' between the maximum speed and the minimum speed in the output sampling group of the linear speed constraint unit;
determining the sampling number N based on the speed difference v', and sampling the sampling group output by the linear speed constraint unit based on an equal resolution method;
Figure RE-FDA0002959713670000031
Figure RE-FDA0002959713670000032
where ε is the velocity difference threshold, nsAnd f (×) is a set value of the number of sampling groups, a is a scaling factor, and n is the number of output sampling groups of the linear velocity constraint unit.
8. AGV trolley, characterized in that an AGV navigation system is arranged on the AGV trolley, which AGV navigation system is provided with a system according to claims 1 to 7.
CN202011194530.6A 2020-10-30 2020-10-30 AGV navigation system and AGV dolly Active CN112596513B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202011194530.6A CN112596513B (en) 2020-10-30 2020-10-30 AGV navigation system and AGV dolly

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202011194530.6A CN112596513B (en) 2020-10-30 2020-10-30 AGV navigation system and AGV dolly

Publications (2)

Publication Number Publication Date
CN112596513A true CN112596513A (en) 2021-04-02
CN112596513B CN112596513B (en) 2022-12-23

Family

ID=75180727

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202011194530.6A Active CN112596513B (en) 2020-10-30 2020-10-30 AGV navigation system and AGV dolly

Country Status (1)

Country Link
CN (1) CN112596513B (en)

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20160036287A (en) * 2014-09-25 2016-04-04 국방과학연구소 Auto Pilot Vehicle based on Drive Information Map and Local Route Management Method thereof
CN107703948A (en) * 2017-11-14 2018-02-16 上海理工大学 Mobile robot local dynamic station paths planning method based on adaptive dynamic window
CN108334086A (en) * 2018-01-25 2018-07-27 江苏大学 A kind of automatic driving vehicle path tracking control method based on soft-constraint quadratic programming MPC
CN110703762A (en) * 2019-11-04 2020-01-17 东南大学 Hybrid path planning method for unmanned surface vehicle in complex environment
CN111289008A (en) * 2020-04-28 2020-06-16 南京维思科汽车科技有限公司 Local path planning algorithm for unmanned vehicle
CN111352416A (en) * 2019-12-29 2020-06-30 的卢技术有限公司 Dynamic window local trajectory planning method and system based on motion model
CN111399506A (en) * 2020-03-13 2020-07-10 大连海事大学 Global-local hybrid unmanned ship path planning method based on dynamic constraints
CN111457929A (en) * 2019-12-31 2020-07-28 南京工大数控科技有限公司 Logistics vehicle autonomous path planning and navigation method based on geographic information system

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20160036287A (en) * 2014-09-25 2016-04-04 국방과학연구소 Auto Pilot Vehicle based on Drive Information Map and Local Route Management Method thereof
CN107703948A (en) * 2017-11-14 2018-02-16 上海理工大学 Mobile robot local dynamic station paths planning method based on adaptive dynamic window
CN108334086A (en) * 2018-01-25 2018-07-27 江苏大学 A kind of automatic driving vehicle path tracking control method based on soft-constraint quadratic programming MPC
CN110703762A (en) * 2019-11-04 2020-01-17 东南大学 Hybrid path planning method for unmanned surface vehicle in complex environment
CN111352416A (en) * 2019-12-29 2020-06-30 的卢技术有限公司 Dynamic window local trajectory planning method and system based on motion model
CN111457929A (en) * 2019-12-31 2020-07-28 南京工大数控科技有限公司 Logistics vehicle autonomous path planning and navigation method based on geographic information system
CN111399506A (en) * 2020-03-13 2020-07-10 大连海事大学 Global-local hybrid unmanned ship path planning method based on dynamic constraints
CN111289008A (en) * 2020-04-28 2020-06-16 南京维思科汽车科技有限公司 Local path planning algorithm for unmanned vehicle

Also Published As

Publication number Publication date
CN112596513B (en) 2022-12-23

Similar Documents

Publication Publication Date Title
CN112578790B (en) Local path planning method and AGV
CN112810630B (en) Method and system for planning track of automatic driving vehicle
Pérez et al. Trajectory generator for autonomous vehicles in urban environments
CN114234998A (en) Unmanned multi-target-point track parallel planning method based on semantic road map
EP3887759B1 (en) Method and apparatus for determining a position of a vehicle
WO2019042295A1 (en) Path planning method, system, and device for autonomous driving
CN110155081B (en) Self-adaptive obstacle avoidance control system for intelligent driving automobile
CN112606830B (en) Two-section type autonomous parking path planning method based on mixed A-algorithm
CN113608531B (en) Unmanned vehicle real-time global path planning method based on safety A-guidance points
Heirich et al. Bayesian train localization method extended by 3D geometric railway track observations from inertial sensors
CN110296709B (en) Vehicle-mounted positioning navigation method based on self-adaptive odometer model
CN112947469A (en) Automobile track-changing track planning and dynamic track tracking control method
CN110703757A (en) Energy consumption optimization-oriented high-speed train speed planning method
CN111578926A (en) Map generation and navigation obstacle avoidance method based on automatic driving platform
CN113886764A (en) Intelligent vehicle multi-scene track planning method based on Frenet coordinate system
CN113165678B (en) Method and device for determining the position of a vehicle
Ritter et al. Real-time graph construction algorithm for probabilistic predictions in vehicular applications
CN112596513B (en) AGV navigation system and AGV dolly
Song et al. Research on target tracking algorithm using millimeter-wave radar on curved road
CN117141489A (en) Intelligent vehicle track layered planning method based on minimum action quantity principle
Alrifaee et al. Satellite-and map-based long range cooperative adaptive cruise control system for road vehicles
CN115826583A (en) Automatic driving vehicle formation method based on point cloud map
CN111857112B (en) Automobile local path planning method and electronic equipment
Daniel et al. Energy constrained trajectory generation for ADAS
CN116945913B (en) Synchronous differential drive control algorithm for hub motor of railway vehicle

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