CN114089742A - AGV traveling speed control method and device based on path curvature and medium - Google Patents
AGV traveling speed control method and device based on path curvature and medium Download PDFInfo
- Publication number
- CN114089742A CN114089742A CN202111238394.0A CN202111238394A CN114089742A CN 114089742 A CN114089742 A CN 114089742A CN 202111238394 A CN202111238394 A CN 202111238394A CN 114089742 A CN114089742 A CN 114089742A
- Authority
- CN
- China
- Prior art keywords
- speed
- agv
- point
- curvature
- maximum
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 30
- 239000011159 matrix material Substances 0.000 claims abstract description 24
- 230000001133 acceleration Effects 0.000 claims description 12
- 238000004364 calculation method Methods 0.000 claims description 5
- 238000004590 computer program Methods 0.000 claims description 5
- 238000001914 filtration Methods 0.000 claims description 5
- 238000006073 displacement reaction Methods 0.000 claims description 4
- 238000009499 grossing Methods 0.000 claims description 4
- 238000006243 chemical reaction Methods 0.000 claims description 3
- 238000010586 diagram Methods 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 3
- 238000004891 communication Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 238000004088 simulation Methods 0.000 description 2
- 230000006399 behavior Effects 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000000638 solvent extraction Methods 0.000 description 1
- 230000007723 transport mechanism Effects 0.000 description 1
- 230000007306 turnover Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0223—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
The invention provides an AGV running speed control method, device and medium based on path curvature, relating to the technical field of AGV control, wherein the method comprises the steps of obtaining a curvature matrix, a minimum curvature threshold value and a speed threshold value of all points in a planned path; determining the maximum curvature in the planned path according to the curvature matrix; determining the maximum speed of each point in the planned path according to the maximum curvature, the minimum curvature threshold and the speed threshold; wherein the speed threshold comprises a maximum speed threshold and a minimum speed threshold; wherein the theoretical speed comprises a maximum theoretical speed and a minimum theoretical speed; determining the planning speed of the AGV at each point according to the maximum speed of each point in the planned path and the theoretical speed of the AGV at the point; controlling the AGV to run along the planned path according to the planned speed; this disclosure can guarantee the steady transportation to the goods.
Description
Technical Field
The present disclosure relates to, but not limited to, the field of AGV control technologies, and in particular, to a method, an apparatus, and a medium for controlling an AGV traveling speed based on a path curvature.
Background
And the trajectory planning is that the system plans the driving trajectory of the vehicle according to the result of the behavior decision and the driving state and the environmental information of the vehicle. The trajectory planning can be mainly divided into two parts of path planning and speed planning, wherein the speed planning is to endow each point of a path with corresponding speed according to the characteristics of the path and a set speed interval on the basis of the generated path. The path planning and the speed planning are combined with each other to obtain a track with characteristics meeting requirements, and the track is output to a motion control system.
In general case, AGV gets goods position and all fixes and has markd corresponding world coordinate, so AGV only needs to arrive according to preset's place map and gets the goods point and can get smoothly and put goods, but under some special circumstances, if the artifical goods or the not high circumstances of precision that the assembly line targets in place, if do not fix a position goods and revise, hardly guarantee the accurate of goods target in place, fork arm can not normally advance the pallet hole when leading to AGV to get goods, collide with the pallet even, push over the goods, just calculate and do not have the problem when getting goods, the goods of getting are because the fork is enough balanced, lead to AGV travel in-process goods turnover easily.
In view of this, it is necessary to provide a speed planning scheme for reasonably planning the speed of the AGV traveling on the planned path to ensure smooth transportation of the goods.
Disclosure of Invention
The following is a summary of the subject matter described in detail herein. This summary is not intended to limit the scope of the claims.
The embodiment of the disclosure provides an AGV traveling speed control method, an AGV traveling speed control device and an AGV traveling speed control medium based on path curvature.
In a first aspect, an embodiment of the present disclosure provides an AGV running vehicle speed control method based on a path curvature, including:
obtaining a curvature matrix, a minimum curvature threshold and a speed threshold of all points in a planned path;
determining the maximum curvature in the planned path according to the curvature matrix;
determining the maximum speed of each point in the planned path according to the maximum curvature, the minimum curvature threshold and the speed threshold; wherein the speed threshold comprises a maximum speed threshold and a minimum speed threshold;
determining the theoretical speed of the AGV at each point in the planned path according to the speed threshold; wherein the theoretical speed comprises a maximum theoretical speed and a minimum theoretical speed;
determining the planning speed of the AGV at each point according to the maximum speed of each point in the planned path and the theoretical speed of the AGV at the point;
and controlling the AGV to run along the planned path according to the planned speed.
In some embodiments, said determining a maximum velocity for each point in a planned path from said maximum curvature, minimum curvature threshold and velocity threshold comprises:
performing threshold processing on the curvature matrix to obtain the effective curvature of each point in the planned path;
and carrying out proportional conversion on the speed threshold according to the maximum curvature, the minimum curvature threshold and the effective curvature of each point in the planned path to obtain the maximum speed of each point in the planned path.
In some embodiments, the formula for thresholding the curvature matrix is: ks(i)＝max(k(i)，Kvalue) Where K (i) represents the curvature of the ith point in the planned path, KvalueMinimum curvature threshold, K, representing the planned paths(i) Representing the effective curvature of the ith point in the planned path;
the calculation formula of the maximum speed of each point in the planned path is as follows:
wherein v ismax(i) For maximum speed, v, at point i in the planned pathvalue_maxIndicating a maximum speed threshold, vvalue_minRepresenting a minimum speed threshold.
In some embodiments, said determining the theoretical speed of the AGV at each point in the planned path based on said speed threshold comprises:
acquiring rated uniform acceleration of the AGV;
determining a displacement and speed relation formula when the AGV performs uniform acceleration linear motion;
determining the speed of the AGV at each point according to the relational expression;
and determining the theoretical speed of the AGV at each point according to the speed threshold and the speed of the AGV at each point.
In some embodiments, said determining the theoretical speed of the AGV at each point based on the speed threshold and the speed of the AGV at each point comprises:
the maximum theoretical speed of the AGV at point i is determined according to the following equation:
vH(i)＝min(vi，vvalue_max)；
the minimum theoretical speed of the AGV at point i is determined according to the following equation:
vL(i)＝max(vivvalue_min)；
wherein v isvalue_maxIndicating a maximum speed threshold, vvalue_minRepresents a minimum speed threshold, a is the rated uniform acceleration of the AGV, ds is the travel distance of the AGV per unit time, viVelocity, v, of the AGV at point ii-1The speed of the AGV at the (i-1) point;
the velocity of the AGV at the ith point is calculated by the formula
In some embodiments, determining the planned speed of the AGV at each point in the planned path based on the maximum speed of the AGV at the point and the theoretical speed of the AGV at the point comprises:
comparing the maximum speed of each point in the planned path with the theoretical speed of the AGV at the point;
when the maximum speed of any point in the planned path is greater than the maximum theoretical speed of the AGV at the point, setting the planned speed of the AGV at the point as the maximum theoretical speed of the AGV at the point;
when the maximum speed of any point in the planned path is smaller than the minimum theoretical speed of the AGV at the point, setting the planned speed of the AGV at the point as the minimum theoretical speed of the AGV at the point;
and when the maximum speed of any point in the planned path is greater than or equal to the minimum theoretical speed of the AGV at the point and is less than or equal to the maximum theoretical speed of the AGV at the point, setting the planned speed of the AGV at the point as the maximum speed of the point.
In some embodiments, said controlling the AGV to travel along the planned path according to the planned speed comprises:
performing convolution smoothing filtering on the planned speed of the AGV at each point to obtain the running speed of the AGV;
and controlling the AGV to run along the planned path according to the running speed.
In a second aspect, an embodiment of the present disclosure further provides an AGV running vehicle speed control device based on a path curvature, including:
the system comprises an acquisition module, a calculation module and a processing module, wherein the acquisition module is used for acquiring a curvature matrix, a minimum curvature threshold and a speed threshold of all points in a planned path;
a maximum curvature determination module for determining a maximum curvature in the planned path according to the curvature matrix;
the maximum speed determining module is used for determining the maximum speed of each point in the planned path according to the maximum curvature, the minimum curvature threshold and the speed threshold; wherein the speed threshold comprises a maximum speed threshold and a minimum speed threshold;
the theoretical speed determining module is used for determining the theoretical speed of each point of the AGV in the planned path according to the speed threshold; wherein the theoretical speed comprises a maximum theoretical speed and a minimum theoretical speed;
the planning speed determining module is used for determining the planning speed of the AGV at each point according to the maximum speed of each point in the planned path and the theoretical speed of the AGV at the point;
and the running control module is used for controlling the AGV to run along the planned path according to the planned speed.
In a third aspect, an embodiment of the present disclosure further provides an AGV, including: the AGV comprises a memory, a processor and a computer program stored on the memory and capable of running on the processor, wherein the processor executes the computer program to realize the AGV running vehicle speed control method based on the path curvature.
In a fourth aspect, the disclosed embodiments also provide a computer-readable storage medium storing computer-executable instructions for executing the AGV travel speed control method based on path curvature according to the first aspect.
The embodiment of the disclosure comprises: obtaining a curvature matrix, a minimum curvature threshold and a speed threshold of all points in a planned path; determining the maximum curvature in the planned path according to the curvature matrix; determining the maximum speed of each point in the planned path according to the maximum curvature, the minimum curvature threshold and the speed threshold; wherein the speed threshold comprises a maximum speed threshold and a minimum speed threshold; wherein the theoretical speed comprises a maximum theoretical speed and a minimum theoretical speed; determining the planning speed of the AGV at each point according to the maximum speed of each point in the planned path and the theoretical speed of the AGV at the point; and controlling the AGV to run along the planned path according to the planned speed.
Additional features and advantages of the disclosure will be set forth in the description which follows, and in part will be obvious from the description, or may be learned by the practice of the disclosure. The objectives and other advantages of the disclosure may be realized and attained by the structure particularly pointed out in the written description and claims hereof as well as the appended drawings.
Drawings
The accompanying drawings are included to provide a further understanding of the disclosed embodiments and are incorporated in and constitute a part of this specification, illustrate embodiments of the disclosure and together with the example serve to explain the principles of the disclosure and not to limit the disclosure.
FIG. 1 is a flowchart illustrating an AGV travel speed control method based on path curvature according to an embodiment of the present disclosure;
FIG. 2 is a graph of the simulation effect of the programming speed of FIG. 1;
FIG. 3 is a graph showing the effect of simulation on the travel speed of FIG. 1;
FIG. 4 is a schematic diagram illustrating an exemplary configuration of an AGV traveling speed control apparatus according to an embodiment of the present disclosure;
FIG. 5 is a block diagram of an AGV according to one embodiment of the present disclosure.
Detailed Description
In order to make the objects, technical solutions and advantages of the present disclosure more clearly understood, the present disclosure is further described in detail below with reference to the accompanying drawings and embodiments. It should be understood that the specific embodiments described herein are merely illustrative of the disclosure and are not intended to limit the disclosure.
It should be noted that although functional blocks are partitioned in a schematic diagram of an apparatus and a logical order is shown in a flowchart, in some cases, the steps shown or described may be performed in a different order than the partitioning of blocks in the apparatus or the order in the flowchart. The terms "first," "second," and the like in the description, in the claims, or in the drawings described above, are used for distinguishing between similar elements and not necessarily for describing a particular sequential or chronological order.
The disclosure provides an AGV traveling speed control method, an AGV traveling speed control device and a medium based on path curvature, wherein the method comprises the following steps: obtaining a curvature matrix, a minimum curvature threshold and a speed threshold of all points in a planned path; determining the maximum curvature in the planned path according to the curvature matrix; determining the maximum speed of each point in the planned path according to the maximum curvature, the minimum curvature threshold and the speed threshold; wherein the speed threshold comprises a maximum speed threshold and a minimum speed threshold; wherein the theoretical speed comprises a maximum theoretical speed and a minimum theoretical speed; determining the planning speed of the AGV at each point according to the maximum speed of each point in the planned path and the theoretical speed of the AGV at the point; and controlling the AGV to run along the planned path according to the planned speed.
The invention provides an AGV running speed control method, device and medium based on path curvature, wherein the speed of each point in a planned path is planned based on the path curvature characteristics, and the obtained planned speed can ensure that goods are stably transported when the AGV runs.
As shown in fig. 1, fig. 1 is a flowchart of an AGV travel speed control method based on a path curvature according to an embodiment of the present disclosure, in which the method includes, but is not limited to, the following steps:
step S100, obtaining curvature matrixes of all points in a planned path, a minimum curvature threshold value and a speed threshold value;
step S200, determining the maximum curvature in the planned path according to the curvature matrix;
step S300, determining the maximum speed of each point in the planned path according to the maximum curvature, the minimum curvature threshold and the speed threshold; wherein the speed threshold comprises a maximum speed threshold and a minimum speed threshold;
step S400, determining the theoretical speed of the AGV at each point in the planned path according to the speed threshold; wherein the theoretical speed comprises a maximum theoretical speed and a minimum theoretical speed;
step S500, determining the planning speed of the AGV at each point according to the maximum speed of each point in the planned path and the theoretical speed of the AGV at the point;
and step S600, controlling the AGV to run along the planned path according to the planned speed.
It should be noted that the curvature matrix in this embodiment includes curvatures of all points in the planned path, and the minimum curvature threshold and the speed threshold are calibrated in advance, and the basis of the calibration lies in a value range for ensuring that the AGV runs stably, and can be determined according to multiple tests.
In a modified embodiment, in step S300, the determining the maximum speed of each point in the planned path according to the maximum curvature, the minimum curvature threshold and the speed threshold includes:
performing threshold processing on the curvature matrix to obtain the effective curvature of each point in the planned path;
wherein the formula for thresholding the curvature matrix is: ks(i)＝max(k(i)，Kvalue) Where K (i) represents the curvature of the ith point in the planned path, KvalueMinimum curvature threshold, K, representing the planned paths(i) Indicating the validity of the ith point in the planned pathA curvature;
and carrying out proportional conversion on the speed threshold according to the maximum curvature, the minimum curvature threshold and the effective curvature of each point in the planned path to obtain the maximum speed of each point in the planned path:
the calculation formula of the maximum speed of each point in the planned path is as follows:
wherein v ismax(i) For maximum speed, v, at point i in the planned pathvalue_maxIndicating a maximum speed threshold, vvalue_minRepresenting a minimum speed threshold.
In an improved embodiment, said determining the theoretical speed of the AGV at each point in the planned path based on said speed threshold comprises:
acquiring rated uniform acceleration of the AGV;
determining a displacement and speed relation formula when the AGV performs uniform acceleration linear motion;
determining the speed of the AGV at each point according to the relational expression;
and determining the theoretical speed of the AGV at each point according to the speed threshold and the speed of the AGV at each point.
The relationship between the displacement and the speed when the AGV performs uniform acceleration linear motion is as follows:
where a is the rated uniform acceleration of the AGV, ds is the travel distance of the AGV per unit time, viVelocity, v, of the AGV at point ii-1The speed of the AGV at the (i-1) point; the speed of the AGV at point i may be expressed as
The maximum theoretical velocity of the AGV at point i is then
The minimum theoretical velocity of the AGV at point i is
It should be noted that the rated uniform acceleration a of the AGV is obtained from the characteristics of the motor driver if
Namely, the direction of the uniform acceleration a is reversed.
In an improved embodiment, the determining the planned speed of the AGV at each point in the planned path according to the maximum speed of the AGV at the point and the theoretical speed of the AGV at the point includes:
comparing the maximum speed of each point in the planned path with the theoretical speed of the AGV at the point;
when the maximum speed of any point in the planned path is greater than the maximum theoretical speed of the AGV at the point, setting the planned speed of the AGV at the point as the maximum theoretical speed of the AGV at the point;
when the maximum speed of any point in the planned path is smaller than the minimum theoretical speed of the AGV at the point, setting the planned speed of the AGV at the point as the minimum theoretical speed of the AGV at the point;
and when the maximum speed of any point in the planned path is greater than or equal to the minimum theoretical speed of the AGV at the point and is less than or equal to the maximum theoretical speed of the AGV at the point, setting the planned speed of the AGV at the point as the maximum speed of the point.
In some embodiments, the projected velocity v of the AGV at this point is outputplan(i) The pseudo code of (1) is:
step 1: if vmax(i)＞vH(i) Then output vplan(i)＝vH(i)；
And 2, step 2: elseif vmax(i) < L (i), then output vplan(i)＝vL(i)；
And 3, step 3: else vplan(i)＝vmax(i)。
In some casesIn an embodiment, a maximum speed threshold v is setvalue_max＝1m/s，vvalue_minThe planned speed is shown in fig. 2 at 0.7m/s, and the abscissa in fig. 2 represents the number of the middle point of the planned path.
In addition, in an embodiment, the step S600 further includes, but is not limited to, the following steps:
the planned speed v of the AGV at the point iplan(i) Carrying out convolution smoothing filtering to obtain the driving speed of the AGV;
and controlling the AGV to run along the planned path according to the running speed.
In this embodiment, in order to make the speed change smoother and to improve the smoothness during driving, the planned speed is subjected to convolution smoothing filtering, the result after filtering is shown in fig. 3, and the abscissa in fig. 3 represents the number of the midpoint of the planned path:
in addition, referring to fig. 4, in an embodiment, there is also provided an AGV running vehicle speed control apparatus based on a curvature of a path, the AGV running vehicle speed control apparatus based on a curvature of a path including;
an obtaining module 100, configured to obtain a curvature matrix, a minimum curvature threshold, and a speed threshold of all points in a planned path;
a maximum curvature determining module 200, configured to determine a maximum curvature in the planned path according to the curvature matrix;
a maximum speed determination module 300, configured to determine a maximum speed of each point in the planned path according to the maximum curvature, the minimum curvature threshold, and the speed threshold; wherein the speed threshold comprises a maximum speed threshold and a minimum speed threshold;
a theoretical speed determining module 400, configured to determine a theoretical speed of the AGV at each point in the planned path according to the speed threshold; wherein the theoretical speed comprises a maximum theoretical speed and a minimum theoretical speed;
the planning speed determining module 500 is configured to determine a planning speed of the AGV at each point in the planned path according to the maximum speed of each point and the theoretical speed of the AGV at the point;
and a running control module 600, configured to control the AGV to run along the planned path according to the planned speed.
The above-described embodiments of the apparatus are merely illustrative, wherein the units illustrated as separate components may or may not be physically separate, i.e. may be located in one place, or may also be distributed over a plurality of network elements. Some or all of the modules may be selected according to actual needs to achieve the purpose of the solution of the present embodiment.
Additionally, referring to FIG. 5, an embodiment of the present disclosure also provides an AGV10, the AGV10 including: a memory 11, a processor 12 and a computer program stored on the memory 11 and executable on the processor 12.
The processor 12 and the memory 11 may be connected by a bus or other means.
The non-transitory software program and instructions necessary to implement the AGV running vehicle speed control method based on the path curvature of the above embodiment are stored in the memory 11, and when executed by the processor 12, the AGV running vehicle speed control method based on the path curvature of the above embodiment is executed.
Furthermore, an embodiment of the present disclosure also provides a computer-readable storage medium storing computer-executable instructions, which are executed by a processor or a controller, for example, by a processor in the above-mentioned electronic device embodiment, and can make the processor execute the AGV running vehicle speed control method based on the path curvature in the above-mentioned embodiment.
One of ordinary skill in the art will appreciate that all or some of the steps, systems, and methods disclosed above may be implemented as software, firmware, hardware, and suitable combinations thereof. Some or all of the physical components may be implemented as software executed by a processor, such as a central processing unit, digital signal processor, or microprocessor, or as hardware, or as an integrated circuit, such as an application specific integrated circuit. Such software may be distributed on computer readable media, which may include computer storage media (or non-transitory media) and communication media (or transitory media). The term computer storage media includes volatile and nonvolatile, removable and non-removable media implemented in any method or technology for storage of information such as computer readable instructions, data structures, program modules or other data, as is well known to those of ordinary skill in the art. Computer storage media includes, but is not limited to, RAM, ROM, EEPROM, flash memory or other memory technology, CD-ROM, Digital Versatile Disks (DVD) or other optical disk storage, magnetic cassettes, magnetic tape, magnetic disk storage or other magnetic storage devices, or any other medium which can be used to store the desired information and which can accessed by a computer. In addition, communication media typically embodies computer readable instructions, data structures, program modules or other data in a modulated data signal such as a carrier wave or other transport mechanism and includes any information delivery media as known to those skilled in the art.
While the present disclosure has been described with reference to the preferred embodiments, it will be understood by those skilled in the art that various changes in form and details may be made therein without departing from the spirit and scope of the disclosure as defined by the appended claims.
Claims (10)
1. An AGV traveling speed control method based on a path curvature is characterized by comprising the following steps:
obtaining a curvature matrix, a minimum curvature threshold and a speed threshold of all points in a planned path;
determining the maximum curvature in the planned path according to the curvature matrix;
determining the maximum speed of each point in the planned path according to the maximum curvature, the minimum curvature threshold and the speed threshold; wherein the speed threshold comprises a maximum speed threshold and a minimum speed threshold;
determining the theoretical speed of the AGV at each point in the planned path according to the speed threshold; wherein the theoretical speed comprises a maximum theoretical speed and a minimum theoretical speed;
determining the planning speed of the AGV at each point according to the maximum speed of each point in the planned path and the theoretical speed of the AGV at the point;
and controlling the AGV to run along the planned path according to the planned speed.
2. The AGV travel vehicle speed control method according to claim 1, wherein determining the maximum speed of each point in the planned path according to the maximum curvature, the minimum curvature threshold and the speed threshold comprises:
performing threshold processing on the curvature matrix to obtain the effective curvature of each point in the planned path;
and carrying out proportional conversion on the speed threshold according to the maximum curvature, the minimum curvature threshold and the effective curvature of each point in the planned path to obtain the maximum speed of each point in the planned path.
3. The AGV travel vehicle speed control method according to claim 2, wherein the formula for thresholding the curvature matrix is: ks(i)＝max(k(i)，Kvalue) Where K (i) represents the curvature of the ith point in the planned path, KvalueMinimum curvature threshold, K, representing the planned paths(i) Representing the effective curvature of the ith point in the planned path;
the calculation formula of the maximum speed of each point in the planned path is as follows:
wherein v ismax(i) For maximum speed, v, at point i in the planned pathvalue_maxIndicating a maximum speed threshold, vvalue_minRepresenting a minimum speed threshold.
4. The method of claim 1, wherein determining the theoretical speed of the AGV at each point in the planned path based on the speed threshold comprises:
acquiring rated uniform acceleration of the AGV;
determining a displacement and speed relation formula when the AGV performs uniform acceleration linear motion;
determining the speed of the AGV at each point according to the relational expression;
and determining the theoretical speed of the AGV at each point according to the speed threshold and the speed of the AGV at each point.
5. The AGV travel vehicle speed control method based on path curvature of claim 4, wherein the determining the theoretical speed of the AGV at each point according to the speed threshold and the speed of the AGV at each point comprises:
the maximum theoretical speed of the AGV at point i is determined according to the following equation:
vH(i)＝min(vi，vvalue_max)；
the minimum theoretical speed of the AGV at point i is determined according to the following equation:
vL(i)＝max(vivvalue_min)；
wherein v isvalue_maxIndicating a maximum speed threshold, vvalue_minRepresents a minimum speed threshold, a is the rated uniform acceleration of the AGV, ds is the travel distance of the AGV per unit time, viVelocity, v, of the AGV at point ii-1The speed of the AGV at the (i-1) point;
the velocity of the AGV at the ith point is calculated by the formula
6. The AGV traveling vehicle speed control method based on the path curvature of claim 1, wherein the step of determining the planned speed of the AGV at each point in the planned path according to the maximum speed of the AGV at the point and the theoretical speed of the AGV at the point comprises the following steps:
comparing the maximum speed of each point in the planned path with the theoretical speed of the AGV at the point;
when the maximum speed of any point in the planned path is greater than the maximum theoretical speed of the AGV at the point, setting the planned speed of the AGV at the point as the maximum theoretical speed of the AGV at the point;
when the maximum speed of any point in the planned path is smaller than the minimum theoretical speed of the AGV at the point, setting the planned speed of the AGV at the point as the minimum theoretical speed of the AGV at the point;
and when the maximum speed of any point in the planned path is greater than or equal to the minimum theoretical speed of the AGV at the point and is less than or equal to the maximum theoretical speed of the AGV at the point, setting the planned speed of the AGV at the point as the maximum speed of the point.
7. The AGV traveling vehicle speed control method according to claim 1, wherein the controlling the AGV to travel along the planned path according to the planned speed includes:
performing convolution smoothing filtering on the planned speed of the AGV at each point to obtain the running speed of the AGV;
and controlling the AGV to run along the planned path according to the running speed.
8. An AGV traveling vehicle speed control device based on a path curvature, comprising:
the system comprises an acquisition module, a calculation module and a processing module, wherein the acquisition module is used for acquiring a curvature matrix, a minimum curvature threshold and a speed threshold of all points in a planned path;
a maximum curvature determination module for determining a maximum curvature in the planned path according to the curvature matrix;
the maximum speed determining module is used for determining the maximum speed of each point in the planned path according to the maximum curvature, the minimum curvature threshold and the speed threshold; wherein the speed threshold comprises a maximum speed threshold and a minimum speed threshold;
the theoretical speed determining module is used for determining the theoretical speed of each point of the AGV in the planned path according to the speed threshold; wherein the theoretical speed comprises a maximum theoretical speed and a minimum theoretical speed;
the planning speed determining module is used for determining the planning speed of the AGV at each point according to the maximum speed of each point in the planned path and the theoretical speed of the AGV at the point;
and the running control module is used for controlling the AGV to run along the planned path according to the planned speed.
9. An AGV, comprising: memory, processor and computer program stored on the memory and operable on the processor, wherein the processor when executing the computer program implements a method for controlling an AGV travel speed based on a path curvature according to any one of claims 1 to 7.
10. A computer-readable storage medium storing computer-executable instructions for performing the AGV travel vehicle speed control method based on path curvature according to any one of claims 1 to 7.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202111238394.0A CN114089742B (en) | 2021-10-25 | 2021-10-25 | AGV running speed control method, device and medium based on path curvature |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202111238394.0A CN114089742B (en) | 2021-10-25 | 2021-10-25 | AGV running speed control method, device and medium based on path curvature |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN114089742A true CN114089742A (en) | 2022-02-25 |
| CN114089742B CN114089742B (en) | 2023-09-26 |
Family
ID=80297463
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202111238394.0A Active CN114089742B (en) | 2021-10-25 | 2021-10-25 | AGV running speed control method, device and medium based on path curvature |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN114089742B (en) |
Citations (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101318509A (en) * | 2007-05-22 | 2008-12-10 | 株式会社日立制作所 | Vehicle speed control apparatus in accordance with curvature of vehicle trajectory |
| CN103376118A (en) * | 2012-04-27 | 2013-10-30 | 北京四维图新科技股份有限公司 | Curvature-based aided driving method and curvature-based aided driving device |
| CN109540159A (en) * | 2018-10-11 | 2019-03-29 | 同济大学 | A kind of quick complete automatic Pilot method for planning track |
| CN109976337A (en) * | 2019-03-11 | 2019-07-05 | 智久(厦门)机器人科技有限公司上海分公司 | A kind of bend speed planning method, apparatus of homing guidance device |
| CN110531771A (en) * | 2019-09-02 | 2019-12-03 | 广州小鹏汽车科技有限公司 | A kind of speed planning method and device, vehicle |
| CN110989569A (en) * | 2019-11-20 | 2020-04-10 | 华为技术有限公司 | Vehicle running control method and related equipment |
| CN111897216A (en) * | 2020-07-16 | 2020-11-06 | 华中科技大学 | Multi-motion-segment speed planning and interpolation method |
| US20210114620A1 (en) * | 2019-10-18 | 2021-04-22 | Beijing Baidu Netcom Science And Technology Co., Ltd. | Method for controlling autonomous vehicle to pass through curve, electronic device and medium |
| CN113419571A (en) * | 2021-07-08 | 2021-09-21 | 广州小鹏自动驾驶科技有限公司 | Speed adjusting method and device and automobile |
-
2021
- 2021-10-25 CN CN202111238394.0A patent/CN114089742B/en active Active
Patent Citations (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101318509A (en) * | 2007-05-22 | 2008-12-10 | 株式会社日立制作所 | Vehicle speed control apparatus in accordance with curvature of vehicle trajectory |
| CN103376118A (en) * | 2012-04-27 | 2013-10-30 | 北京四维图新科技股份有限公司 | Curvature-based aided driving method and curvature-based aided driving device |
| CN109540159A (en) * | 2018-10-11 | 2019-03-29 | 同济大学 | A kind of quick complete automatic Pilot method for planning track |
| CN109976337A (en) * | 2019-03-11 | 2019-07-05 | 智久(厦门)机器人科技有限公司上海分公司 | A kind of bend speed planning method, apparatus of homing guidance device |
| CN110531771A (en) * | 2019-09-02 | 2019-12-03 | 广州小鹏汽车科技有限公司 | A kind of speed planning method and device, vehicle |
| US20210114620A1 (en) * | 2019-10-18 | 2021-04-22 | Beijing Baidu Netcom Science And Technology Co., Ltd. | Method for controlling autonomous vehicle to pass through curve, electronic device and medium |
| CN110989569A (en) * | 2019-11-20 | 2020-04-10 | 华为技术有限公司 | Vehicle running control method and related equipment |
| CN111897216A (en) * | 2020-07-16 | 2020-11-06 | 华中科技大学 | Multi-motion-segment speed planning and interpolation method |
| CN113419571A (en) * | 2021-07-08 | 2021-09-21 | 广州小鹏自动驾驶科技有限公司 | Speed adjusting method and device and automobile |
Non-Patent Citations (2)
| Title |
|---|
| 杨杰;王瑞;: "基于加速度输入的无人机航迹PID控制", 自动化技术与应用, no. 12, pages 15 - 25 * |
| 陈松;宋晓琳;: "基于DSP的智能小车路径跟随***设计", 工程设计学报, no. 04, pages 312 - 317 * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN114089742B (en) | 2023-09-26 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US10012984B2 (en) | System and method for controlling autonomous vehicles | |
| CN110316193B (en) | Preview distance setting method, device, equipment and computer readable storage medium | |
| KR101504252B1 (en) | System for controlling speed of vehicle on curved road and method thereof | |
| CN111121777A (en) | Unmanned equipment trajectory planning method and device, electronic equipment and storage medium | |
| CN113433936B (en) | Mobile equipment obstacle detouring method and device, mobile equipment and storage medium | |
| EP3828587A1 (en) | Method for determining the position of a vehicle | |
| CN110341688A (en) | A kind of front wheel angle compensation method, device, mobile unit and storage medium | |
| CN115127576B (en) | Path planning method, device, chip, terminal, electronic equipment and storage medium | |
| CN112859863B (en) | Prediction-based path tracking control key reference point selection method and system | |
| CN111813112A (en) | Vehicle track point determination method and device, vehicle and storage medium | |
| CN113074748B (en) | Path planning method and device for unmanned equipment | |
| CN115808918A (en) | Global path planning method, motion control method and computer program product | |
| CN114089742A (en) | AGV traveling speed control method and device based on path curvature and medium | |
| CN116576874A (en) | Vehicle driving path optimization method and device, electronic equipment and storage medium | |
| CN113340311B (en) | Path planning method and device for unmanned equipment | |
| CN111402148B (en) | Information processing method and apparatus for automatically driving vehicle | |
| CN114646328A (en) | Method, device, equipment and medium for determining path information | |
| CN112612289A (en) | Trajectory tracking control method, mobile robot, control device, and storage medium | |
| CN113568403A (en) | Processing method, processing device, vehicle, and storage medium | |
| CN112518744A (en) | Robot trajectory planning method and device and robot | |
| CN115782926B (en) | Vehicle motion prediction method and device based on road information | |
| CN117382639B (en) | Vehicle control method, device, computer equipment and storage medium | |
| US11874136B2 (en) | System for storing and updating bump information | |
| US12044772B2 (en) | Apparatus and method for generating sensor fusion track | |
| CN116107320B (en) | Vision-based automatic driving method, system, electronic equipment and storage medium |
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 |