CN112099493A - Autonomous mobile robot trajectory planning method, system and equipment - Google Patents
Autonomous mobile robot trajectory planning method, system and equipment Download PDFInfo
- Publication number
- CN112099493A CN112099493A CN202010898857.5A CN202010898857A CN112099493A CN 112099493 A CN112099493 A CN 112099493A CN 202010898857 A CN202010898857 A CN 202010898857A CN 112099493 A CN112099493 A CN 112099493A
- Authority
- CN
- China
- Prior art keywords
- path
- obstacle
- robot
- point
- distance
- 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
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- 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 or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- 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 or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0221—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- 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/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
Abstract
The invention discloses a method, a system and equipment for planning a track of an autonomous mobile robot, wherein the method comprises the following steps: acquiring a path planning signal, generating a path group to be selected, generating the path group to be selected by adopting a state grid sampling method and a quintic spline interpolation algorithm, and simultaneously generating an extended path corresponding to each path to be selected; selecting an optimal path based on the path group to be selected; obtaining an optimal path based on the non-obstacle influence loss and the obstacle influence loss, wherein the path with the minimum loss is the optimal path; generating a speed curve corresponding to the optimal path to obtain a moving track; judging whether the current track is suitable for the robot to continue following or not according to the moving track, the motion state of the robot and the influence of the obstacle on the track, and advancing or replanning the path along the moving track; the flexibility of the autonomous mobile robot is effectively improved, and the collision risk is reduced; the speed curve generation method based on sliding window key point extraction can generate a smooth speed curve.
Description
Technical Field
The invention belongs to the technical field of autonomous mobile robots, and particularly relates to a method, a system and equipment for planning a track of an autonomous mobile robot.
Background
Trajectory planning is an important component in autonomous mobile robotic systems. It includes two aspects. The first is the planning of the path of travel of the autonomous mobile robot, and the second is the generation of the speed profile of the robot. The purpose of trajectory planning is to achieve interaction of the autonomous mobile robot with the obstacle under the guidance of global navigation.
An excellent planning algorithm should exhibit the intelligence of the robot in the interaction with obstacles. It can be considered that the intelligence of the robot in interacting with the obstacle should be embodied in two aspects. Firstly, during the course of traveling along the planned path, the robot keeps a suitable distance from the obstacle as far as possible while ensuring that the robot passes the obstacle. Second, the robot should carefully pass over the obstacle when it cannot keep a sufficient distance from the obstacle, i.e. the closer the robot is to the obstacle when passing over the obstacle, the lower the speed should be.
The current track planning technology has the defect when considering the influence of the barrier on the path, and can cause the robot to be too close to the barrier in the process of avoiding the barrier, so that the flexibility is reduced, and the risk is improved. On the other hand, current techniques often only give speed steps and cannot generate smooth speed curves.
Disclosure of Invention
In order to solve the problems in the prior art, the invention provides an autonomous mobile robot trajectory planning method, system and device.
In order to achieve the above object, the invention adopts a technical scheme that an autonomous mobile robot trajectory planning method comprises the following steps:
acquiring a path planning signal, generating a path group to be selected, generating the path group to be selected by adopting a state grid sampling method and a quintic spline interpolation algorithm, and simultaneously generating an extended path corresponding to each path to be selected;
selecting an optimal path based on the path group to be selected; obtaining an optimal path based on the non-obstacle influence loss and the obstacle influence loss, wherein the path loss is the non-obstacle influence loss plus the obstacle influence loss, and the path with the minimum loss is the optimal path;
generating a speed curve corresponding to the optimal path to obtain a moving track;
judging whether the current track is suitable for the robot to follow continuously or not according to the moving track, the motion state of the robot and the influence of the obstacle on the track; judging whether the distance between the non-driving path and the obstacle is smaller than a threshold value or not, if so, not being suitable for continuing to follow, and simultaneously generating a replanning signal; and judging whether the robot reaches the end point of the driving path in real time, if so, generating a replanning signal, and if not, continuing to move along the moving track.
Taking the global navigation path as a reference line, and sampling at set intervals along the longitudinal direction and the transverse direction of the reference line respectively, namely setting a plurality of sampling target points;
acquiring longitudinal offset and transverse offset of the sampling target point corresponding to a reference point; simultaneously obtaining a reference point in the reference line, which has the same longitudinal offset as the sampling target point, and the coordinates, the orientation and the curvature of the reference point;
acquiring the pose of a sampling target point in a Cartesian coordinate system;
generating a curve from the robot to the current pose to the sampling target point;
and generating diversified path groups to be selected based on all the sampling target points.
Acquiring a path from an initial point of the robot to a sampling target point;
taking the sampling target point as a new starting point to obtain the transverse offset of the next sampling target point, wherein the transverse offset of the next sampling target point is the same as the transverse offset of the sampling target point, and the pose of the next sampling target point under a Cartesian coordinate system is obtained;
generating a curve from the robot to the current pose to the next sampled target point;
and generating expansion paths corresponding to all paths to be selected based on all the sampling target points.
Non-obstacle affecting loss includes maximum curvature of path
And the lateral offset d of the sampling target point of the path on the reference linei,jThe Path can be calculated by the following expressioni,jIs not an obstacle affecting the loss
Wherein, κthresFor maximum curvature threshold, paths with curvature greater than the maximum curvature threshold are not added to the candidate path group, dmaxFor maximum lateral offset with respect to a reference line, wcurWeight lost for curvature, weffWeight is lost for the lateral offset.
The method comprises the following steps of converting the influence loss of the obstacle into a distance from the robot to the obstacle, setting the robot and the obstacle as rectangular bounding boxes, and calculating the distance between the two rectangles, wherein the specific steps are as follows:
firstly, judging the distance between two circumscribed circles of the rectangles, and if the distance is greater than a given threshold value, considering the distance between the two rectangles as a maximum value; if the distance between the rectangles does not meet the preset distance threshold, calculating the distance between the rectangles, wherein the first process is to judge whether the two rectangles are overlapped or not, and judging by a separation axis theorem; if the two rectangles are overlapped, the distance between the two rectangles is 0, and if the two rectangles are not overlapped, the minimum distance between the two rectangles is inevitably from one corner point of one rectangle to one side of the other rectangle; and calculating all distances from each corner point of the two rectangles to each side of the other rectangle, wherein the minimum value of the distances is the distance between the two rectangles.
Distance attenuation loss calculation model introduced when calculating influence of obstacle on path
Wherein the content of the first and second substances,
the barrier impact loss is finally calculated; w is aobsIs a risk weight; n is a Path Pathi,jThe number of sampling points of (a); lsafeA safe distance threshold from the obstacle mentioned in the first subsection; w is acolIs the collision weight;
as a Path Pathi,jThe arc length between the first point of collision with an obstacle and the starting point, if the path has no point of collision with an obstacle, then
Equal to the length s of the pathi,j,n。
The speed curve is generated by taking the initial motion state, the path curvature, the collision risk and the destination of the robot into consideration, and the speed curve is generated by using a sliding window key point difference method.
An autonomous mobile robot trajectory planning system comprises a path planning module, a path selection module, a speed generation module and a driving monitoring module, wherein the path planning module is used for generating a path group to be selected; the method comprises the steps that a path selection module obtains a path group to be selected, and the path selection module selects an optimal path based on the attribute of the path and the influence of an obstacle on the path; the speed generation module also generates a speed curve corresponding to the optimal path according to the same information; the driving monitoring module monitors the planned moving track, the control module obtains the moving track to autonomously move the robot and starts to move along the moving track, in the moving process of the robot, the driving monitoring module can judge whether the current track is suitable for the robot to continue to follow according to the generated track, the motion state of the robot and the influence of an obstacle on the track, and the judging condition is that whether the distance between the non-driving path and the obstacle is smaller than a threshold value, and if the distance is smaller than the threshold value, the current track is not suitable for the robot to continue to follow; at the moment, the driving monitoring module generates a re-planning signal, the path planning module acquires the re-planning signal, the driving monitoring module also judges whether the robot reaches the driving path end point in the next planning period, if so, the driving monitoring module generates the re-planning signal, and the path planning module acquires the re-planning signal.
An apparatus, comprising: one or more processors and storage for storing one or more computer programs;
the one or more computer programs are executed by the one or more processors such that the one or more processors implement the method of trajectory planning for an autonomous mobile robot of the present invention.
A computer-readable storage medium, on which a computer program is stored which, when being executed by a processor, carries out the method of trajectory planning for an autonomous mobile robot according to the invention.
Compared with the prior art, the invention has at least the following beneficial effects:
the system comprises a candidate path group generation part, an optimal path selection part, a speed curve generation part and a distance attenuation loss calculation part, wherein the candidate path group generation part adopts a state sampling method, a new distance attenuation loss calculation model is introduced into the optimal path selection part and is used for calculating the influence of obstacles on a path, a driving path which best accords with the current situation can be selected, a speed curve generation method based on sliding window key point extraction is used during speed curve generation, a continuous and smooth speed curve can be generated according to the obstacle distance and the path curve limitation, the driving monitoring part is used for judging whether the planned path needs to be updated or not, the four parts cooperate to realize the intelligence of the autonomous mobile robot and the obstacles in the interaction process, the influence of the obstacles on the planned path is measured by using the distance attenuation loss calculation model, the flexibility of the autonomous mobile robot can be effectively improved, and the collision; the speed curve generation method based on the sliding window key point extraction can generate a smooth speed curve, and when the robot moves along the speed curve, the robot can respond to an obstacle at a close distance, and the cautious property is shown.
Drawings
Fig. 1 is a frame diagram of a trajectory planning method.
Fig. 2 is a schematic diagram of candidate path generation.
Fig. 3 is a schematic diagram of an autonomous mobile robot interacting with an obstacle.
Fig. 4 is a schematic diagram of a sliding window-based keypoint extraction method.
Detailed Description
The trajectory planning system provided by the invention is shown in fig. 1 and comprises a path planning module, a path selection module, a speed generation module and a driving monitoring module.
After receiving a starting planning signal, a path planning module generates a path group to be selected by utilizing a quintic spline interpolation algorithm and a state grid sampling algorithm; and then, the path selection module acquires a path group to be selected, and selects an optimal path based on the attribute of the path and the influence of the obstacle on the path. The speed generation module also generates a speed curve corresponding to the optimal path by using the same sensing input information as the path planning module. And finishing the planning of the movement track. And the driving monitoring module monitors the planned movement track, and the control module acquires the movement track and starts to move along the movement track.
In the moving process of the robot, the driving monitoring module judges whether the current track is suitable for the robot to continue to follow or not according to the generated track, the motion state of the robot and the influence of the obstacle on the track. The judgment condition is whether the distance between the non-driving path and the obstacle is less than a threshold value lsafeIf the value is less than the preset value, the following is not suitable to continue; at this time, the driving monitoring module is generatedAnd replanning the signal, wherein the path planning module acquires the replanning signal and starts the next planning period. In addition, the driving monitoring module also judges whether the robot reaches the end point of the driving path. If yes, the driving monitoring module generates a re-planning signal, and the path planning module acquires the re-planning signal.
The following is a detailed description of each module in the planning method.
Firstly, a path generating module is used for generating a candidate path group, and the candidate path group is generated by using a state grid sampling method, as shown in fig. 2.
Taking the global navigation path as a reference line, wherein the pose of each point on the reference line is known, and sampling is carried out at set intervals along the longitudinal direction and the transverse direction of the reference line respectively; the ith longitudinal sample and the jth transverse sample are the sample target points Gi,jThe longitudinal offset and the transverse offset corresponding to the reference line are respectively liAnd di,j. At the same time, the sum G in the reference line can be obtainedi,jReference points R having the same longitudinal offseti，RiThe pose in a Cartesian coordinate system is known as
Each represents RiAnd orientation and curvature, according to which condition G is obtained by the following expressioni,jPose in Cartesian coordinate System
In obtaining Gi,jAfter pose in cartesian coordinate system, next step is to generate a bar from the current pose of the robot to G as shown in fig. 2i,jIn order to ensure that the path generated between adjacent planning cycles is continuous in curvature, the parameter curve of the planned path is expressed by a quintic polynomialLine, shown in the following equation:
wherein s isfThe arc length from the start point to the end point of the curve can be approximated by the chord length. Then, the unknown parameters in expression 2 are solved through boundary limiting conditions, and the boundary limiting conditions are determined by the current pose (x) of the robotAMR,yAMR,θAMR,κAMR) And Gi,jPosition and posture of
The calculation is as follows:
substituting the expression 3 into the expression 2 can calculate unknown parameters in the expression 2, and finally obtaining the position from the current pose of the robot to Gi,jParametric curves of the paths. Different Gi,jDifferent parameter curves can be calculated to generate diversified driving paths. In addition, if the curvature of the generated path is larger than the set maximum curvature, the path will not be added to the candidate path group.
The vertical offset of the end point of the state sample generation path on the reference line is not uniform, which may adversely affect the path selection. As shown in fig. 2, due to G1,1Is much smaller than the other sampling end points in the graph, the effect of the obstacle on it is minimal, but the path generated with it as the target point should not be optimal. To solve this problem, the present invention introduces an expansion path.
The extended path is generated on the basis of the planned driving path and is used for assisting subsequent calculation related to the path, and the control module cannot acquire the extended path.
The method for generating the expansion path comprises the following steps: when obtaining the target from the initial point IPoint Gi,jAfter route (1), in Gi,jContinuing to find the next endpoint G 'for the new starting point'i,j。G′i,j,
j all have the same longitudinal offset from the reference line. And, G'i,jTransverse offset and Gi,jThe same is true. To this end, G 'can be calculated by expression 1'i,jThe pose in a Cartesian coordinate system, so that the pose G can be further calculated and obtained by using an expression 2 and an expression 3i,jTo G'i,jI.e. an expansion path.
And finishing the generation of the candidate route group, wherein the longitudinal offset of the end point of each route in the finally obtained candidate route group on the reference line is the same. And each path has two parts, one is a driving path tracked by the robot, and the other is an expansion path not tracked.
And after the candidate path group is obtained, obtaining an optimal path from the candidate path group, wherein the measurement of the optimal path is obtained by calculating a loss function. The loss function includes two parts, non-obstacle affecting loss and obstacle affecting loss, respectively. Before loss calculation, firstly defining paths, and selecting one path to be selected by Gi,jFor sampling the path of the target point
n is Pathi,jTotal number of sampling points, Pathi,j(k) Is a tuple of cartesian coordinates, orientation, curvature and arc length from the start of the path for the kth sample point on the path.
Pathi,jThe non-obstacle impact loss of (2) is derived from the properties of the path itself, including the maximum curvature of the path
And the lateral offset d of the sampling target point of the path on the reference linei,jThe Path can be calculated by the following expressioni,jIs not an obstacle affecting the loss
Wherein, κthresFor maximum curvature threshold, paths with curvature greater than the maximum curvature threshold are not added to the candidate path group, dmaxFor maximum lateral offset with respect to a reference line, wcurWeight lost for curvature, weffWeight is lost for the lateral offset.
Before calculating the obstacle impact loss, a key issue is how to quantify the impact of obstacles on the movement of the robot along the path. And calculating the minimum value of the distances from the robot to all the obstacles at each point on the path. The key to the problem becomes how to calculate the distance of the robot to an obstacle.
When the robot is at a certain point on the path, the robot can be represented by a rectangular bounding box. And the obstacle may also be represented by a rectangular bounding box. In summary, the problem of calculating the distance of the robot to an obstacle translates to calculating the distance between two rectangles.
First, the distance between the two rectangles circumscribing the circle can be determined, and if the distance is greater than a given threshold, the distance between the two rectangles is considered to be the maximum value. If the distance between the rectangles does not meet the preset distance threshold, the distance between the rectangles is calculated and divided into two processes, the first process is to judge whether the two rectangles are overlapped, and the separation axis theorem judges. If overlapping, the distance between the two rectangles is 0. If the two rectangles are not overlapped, the minimum distance between the two rectangles is inevitably from one corner point of one rectangle to one side of the other rectangle; and calculating all distances from each corner point of the two rectangles to each side of the other rectangle, wherein the minimum value of the distances is the distance between the two rectangles.
After the calculation method of the distance between the two rectangles is obtained, the minimum distance between the robot and all obstacles at each point on the path can be calculated. Hypothetical Pathi,jEach point in Pathi,j(k) Minimum distance from all obstacles is li,j,kThen, then
Can be used to measure Pathi,jAnd calculating loss according to the collision risk.
Before calculating the loss, as an example, as in scenario one in fig. 3, in this case, a minimization of min (L) is utilizedi,j) Can easily determine P3For the optimal path, however, when one obstacle is moved horizontally backwards, it becomes scene two. Min (L) minimizationi,j) The loss calculation method of (2) still considers P3Is the optimal path because it has the smallest min (L) compared to other pathsi,j). However, in practice it can be seen that the robot can follow P2Move and are in O1The point is re-planned and finally the edge P6Passing through the obstacle. This is the ratio edge P3Move the more optimal policy.
Thereby, it is possible to obtain: path of obstacle pairi,jNot only with its sampling point Pathi,j(k) Risk of collision Li,j(k) And also the arc length s to the starting pointi,j,kThere is a correlation, on the basis of which, a distance attenuation loss calculation model is introduced, as follows:
wherein the content of the first and second substances,
the barrier impact loss is finally calculated; w is aobsIs a risk weight; n is a Path Pathi,jThe number of sampling points of (a); lsafeIs mentioned in the first subsectionA safe distance to the obstacle threshold; w is acolIs the collision weight;
as a Path Pathi,jThe arc length between the first point of collision with an obstacle and the starting point, if the path has no point of collision with an obstacle, then
Equal to the length s of the pathi ,j,n。
The Path Path can then be obtained by the following formulai,jLoss of (2):
and calculating the loss of each path in the candidate path group to obtain the path with the minimum loss, namely the optimal path.
In addition, the process can be further optimized on the basis of considering both accuracy and efficiency. On one hand, the proper number n of path sampling points is selected, the proper n can greatly reduce the calculation amount, and only slightly influences the precision. On the other hand, the obstacle is described by using the outer contour instead of the rectangular bounding box, the outer contour has higher precision, and each edge of the outer contour can be regarded as a rectangle with a small width in the calculation process, so that the applicability of the method is not changed.
After the optimal path is obtained, a corresponding smooth speed-arc length curve is generated finally, and the speed curve is generated by considering the initial motion state of the robot, the curvature of the path, the collision risk and the destination. In contrast, a sliding window key point interpolation method is used for generating a speed curve, and the idea is as follows: determining a series of key points through a sliding window, then smoothing the key points, and finally obtaining a smooth speed curve by utilizing an interpolation method.
The key point selection of the sliding window key point interpolation method is characterized in that a set with a plurality of key points is generated corresponding to a selected path, and each element in the set comprises two-dimensional information of the arc length of a path starting point and the expected speed of a current point;
as an example, a set of o keypoints needs to be generated for the chosen Path Path
Each element KP in a KPmBoth contain two-dimensional information, respectively the arc length s to the start of the pathmAnd the desired velocity v of the current pointm。
And acquiring the expected speed of the current position of the robot, and taking the speed corresponding to the current key point in the historical track as the expected speed or taking the current speed of the robot as the expected speed.
As an example, the current position of the robot is the first key point kp1If the historical track exists, finding the corresponding speed of the current position of the robot in the historical track as the expected speed v of the first key point1If no historical track exists, taking the current speed of the robot as the expected speed v1。
The remaining key points can be searched through a sliding window, as shown in FIG. 4, which shows the mth key point kpmThe calculation process of (2).
First, one key point kpm-1Arc length s ofm-1Starting from l(w)Two successive windows are constructed for length, the height of the window being the velocity amplitude vmaxJudgment of stopping Point s(s)Whether the stopping point exists in the two continuous windows or not is divided into two situations, wherein the first situation is that a point with the distance of 0 to the obstacle exists on the Path, and the second situation is that the destination of the global navigation is reached; using two windows avoids the stopping point s(s)With the last key point kpm-1Too close a distance results in excessive acceleration. If s is(s)In any window, then s(s)As the last key point, the desired speed is 0, which is added to KP, and the selection of key points is ended. If not, performing the second step; stopping point is alsoIt may not exist, in which case it is determined whether the last point of the path is within the window. If so, directly ending the key point selection.
Secondly, acquiring key points to be selected, wherein the most important point is to calculate the expected speed v of the key points to be selectedcon，vconLimited by two conditions, the first being the curvature of the path and the second being the risk of collision. Firstly, whether each sampling point Path (k) of the Path Path is in a window can be judged; if the arc length s of Path (k)kGreater than sm-1Is less than sm-1+l(w)Then Path (k) is within the window; for the sampling point in the Path within the window, the maximum value of the curvature of the sampling point can be obtained
And maximum risk of collision
The smaller the distance from the obstacle, the greater the risk of collision; finally, v can be obtained by the following expressioncon：
Wherein v ismaxTo set a maximum speed; v. ofminIs a set minimum speed; lsafeA barrier safe distance threshold for the preamble; kappathresThe maximum curvature threshold in the foregoing. To obtain vconThen, the arc length of the key point to be selected can be set as the center point of the window, namely
Meanwhile, according to the key point to be selected and the previous key point kpm-1The average acceleration a can be calculatedavg。
Thirdly, obtaining a key point kpmJudgment of aavgWhether the acceleration is larger than the set maximum average acceleration or not, if not, the key point to be selected is kpm(ii) a If so, then v is heldconIs not changedConstantly changing smUntil a is satisfiedavgThe key point kp is obtained when the maximum average acceleration is less than the set maximum average accelerationmLet the key point kpmAnd adding the set KP, continuously repeating the process until a termination condition is met, and finishing the selection of the key points.
In the key point selection process, it is most important for the window width l(w)Selection of (1)(w)If the speed is too large, the obtained speed change of the robot is slow; l(w)If too small, the resulting velocity profile is prone to oscillations, but even if the appropriate l is selected(w)In order to further optimize the key point, the invention uses a bilateral filter to smooth the expected speed of the key point, and the mth key point kpmSmoothed desired velocity
The calculation process of (a) is as follows:
wherein o is the number of key points; l(b)Is the filter window length; sigma(s)And σ(v)Are the filter correlation coefficients. The bilateral filter can smooth the small-amplitude speed jitter under the condition of not influencing the large-amplitude speed change, and a better speed curve is obtained.
And fourthly, interpolating the smoothed key points through a cubic spline to obtain a smoothed speed curve, wherein the cubic spline interpolation uses a fixed boundary condition, the speeds of the two endpoints are known, and the first derivative can be calculated as long as the accelerations of the two endpoints are given. The method for acquiring the acceleration of the starting point is to search the corresponding acceleration in the historical track, and if the corresponding acceleration does not exist, the value is assigned to be 0. The acceleration of the end point is directly assigned 0. So far, the speed curve before the last key point has been obtained and the speed curve after the last key point is uniformly assigned as its speed.
The computer device in one example of the invention comprises a memory, a display screen with touch function, an input device, an output device and a communication device, wherein the number of the processors can be one or more, and one processor is taken as an example in the figure. The amount of memory in the device may be one or more. The processor, the memory, the display, the input device, the output device and the communication device of the apparatus according to the present embodiment may be connected by a bus or other means, preferably by a bus.
The memory is used for storing software programs, computer executable programs and modules, such as program instructions/modules corresponding to the trajectory planning method according to any embodiment of the present invention, and the memory may mainly include a program storage area and a data storage area, wherein the program storage area may store an operating device and an application program required by at least one function; the storage data area may store data created according to use of the device, and the like. The memory may include high speed random access memory and may also include non-volatile memory, such as at least one magnetic disk storage device, flash memory device, or other non-volatile solid state storage device. In some examples, the memory may further include memory located remotely from the processor, and these remote memories may be connected to the device over a network. Examples of such networks include, but are not limited to, the internet, intranets, local area networks, mobile communication networks, and combinations thereof.
The display screen is a display screen with a touch function, and the display screen is used for displaying data according to the indication of the processor, receiving touch operation acting on the display screen and sending corresponding signals to the processor or other devices.
The communication device is used for establishing communication connection with other equipment, and can be a wired communication device and/or a wireless communication device.
The input device may be used to receive input numeric or character information and to generate key signal inputs relating to user settings and function controls of the apparatus. The output device may include an audio device such as a speaker. It should be noted that the specific composition of the input device and the output device can be set according to actual conditions.
The processor executes various functional applications and data processing of the device by running software programs, instructions and modules stored in the memory, that is, the trajectory planning method is realized.
Specifically, in the embodiment, when the processor executes one or more programs stored in the memory, the steps of the trajectory planning method provided in the embodiment of the present invention are specifically implemented.
The invention also provides a computer-readable storage medium having stored thereon a computer program which, when executed by a processor, is operable to implement a trajectory planning method according to any of the embodiments of the invention.
From the above description of the embodiments, it is obvious for those skilled in the art that the present invention can be implemented by software and necessary general hardware, and certainly, can also be implemented by hardware, but the former is a better embodiment in many cases. Based on such understanding, the technical solutions of the present invention may be embodied in the form of a software product, which may be stored in a computer-readable storage medium, such as a floppy disk, a Read-Only Memory (ROM), a Random Access Memory (RAM), a FLASH Memory (FLASH), a hard disk, or an optical disk of a computer, and includes several instructions to enable a computer device, which may be a personal computer, a server, or a network device, to execute the autonomous mobile robot trajectory planning method of the present invention.
Claims (10)
1. An autonomous mobile robot trajectory planning method is characterized by comprising the following steps:
acquiring a path planning signal, generating a path group to be selected, generating the path group to be selected by adopting a state grid sampling method and a quintic spline interpolation algorithm, and simultaneously generating an extended path corresponding to each path to be selected;
selecting an optimal path based on the path group to be selected; obtaining an optimal path based on the non-obstacle influence loss and the obstacle influence loss, wherein the path loss is the non-obstacle influence loss plus the obstacle influence loss, and the path with the minimum loss is the optimal path;
generating a speed curve corresponding to the optimal path to obtain a moving track;
judging whether the current track is suitable for the robot to follow continuously or not according to the moving track, the motion state of the robot and the influence of the obstacle on the track; judging whether the distance between the non-driving path and the obstacle is smaller than a threshold value or not, if so, not being suitable for continuing to follow, and simultaneously generating a replanning signal; and judging whether the robot reaches the end point of the driving path in real time, if so, generating a replanning signal, and if not, continuing to move along the moving track.
2. The autonomous mobile robot trajectory planning method according to claim 1,
taking the global navigation path as a reference line, and sampling at set intervals along the longitudinal direction and the transverse direction of the reference line respectively, namely setting a plurality of sampling target points;
acquiring longitudinal offset and transverse offset of the sampling target point corresponding to a reference point; simultaneously obtaining a reference point in the reference line, which has the same longitudinal offset as the sampling target point, and the coordinates, the orientation and the curvature of the reference point;
acquiring the pose of a sampling target point in a Cartesian coordinate system;
generating a curve from the robot to the current pose to the sampling target point;
and generating diversified path groups to be selected based on all the sampling target points.
3. The autonomous mobile robot trajectory planning method according to claim 1, characterized by obtaining a path from an initial point of the robot to a sampling target point;
taking the sampling target point as a new starting point to obtain the transverse offset of the next sampling target point, wherein the transverse offset of the next sampling target point is the same as the transverse offset of the sampling target point, and the pose of the next sampling target point under a Cartesian coordinate system is obtained;
generating a curve from the robot to the current pose to the next sampled target point;
and generating expansion paths corresponding to all paths to be selected based on all the sampling target points.
4. The autonomous mobile robot trajectory planning method of claim 1, wherein the non-obstacle affecting penalty comprises a maximum curvature of the path
And the lateral offset d of the sampling target point of the path on the reference linei,jThe Path can be calculated by the following expressioni,jIs not an obstacle affecting the loss
Wherein, κthresFor maximum curvature threshold, paths with curvature greater than the maximum curvature threshold are not added to the candidate path group, dmaxFor maximum lateral offset with respect to a reference line, wcurWeight lost for curvature, weffWeight is lost for the lateral offset.
5. The method for planning the trajectory of the autonomous mobile robot according to claim 1, wherein the obstacle impact loss is converted into a distance between the robot and an obstacle, the robot and the obstacle are set as rectangular bounding boxes, and the distance between the two rectangles is calculated as follows:
firstly, judging the distance between two circumscribed circles of the rectangles, and if the distance is greater than a given threshold value, considering the distance between the two rectangles as a maximum value; if the distance between the rectangles does not meet the preset distance threshold, calculating the distance between the rectangles, wherein the first process is to judge whether the two rectangles are overlapped or not, and judging by a separation axis theorem; if the two rectangles are overlapped, the distance between the two rectangles is 0, and if the two rectangles are not overlapped, the minimum distance between the two rectangles is inevitably from one corner point of one rectangle to one side of the other rectangle; and calculating all distances from each corner point of the two rectangles to each side of the other rectangle, wherein the minimum value of the distances is the distance between the two rectangles.
6. The autonomous mobile robot trajectory planning method according to claim 1, characterized by introducing a distance attenuation loss calculation model when calculating the influence of an obstacle on the path
Wherein the content of the first and second substances,
the barrier impact loss is finally calculated; w is aobsIs a risk weight; n is a Path Pathi,jThe number of sampling points of (a); lsafeA safe distance threshold from the obstacle mentioned in the first subsection; w is acolIs the collision weight;
as a Path Pathi,jThe arc length between the first point of collision with an obstacle and the starting point, if the path has no point of collision with an obstacle, then
Equal to the length s of the pathi,j,n。
7. The method for planning the trajectory of the autonomous mobile robot according to claim 1, wherein the velocity curve is generated by using a sliding window key point difference method in consideration of the initial motion state, the path curvature, the collision risk and the destination of the robot, specifically, a plurality of key points are determined through a sliding window, all the key points are smoothed, and then a smoothed velocity curve is obtained by using an interpolation method.
8. The trajectory planning system of the autonomous mobile robot is characterized by comprising a path planning module, a path selection module, a speed generation module and a driving monitoring module, wherein the path planning module is used for generating a path group to be selected; the method comprises the steps that a path selection module obtains a path group to be selected, and the path selection module selects an optimal path based on the attribute of the path and the influence of an obstacle on the path; the speed generation module also generates a speed curve corresponding to the optimal path according to the same information; the driving monitoring module monitors the planned moving track, the control module obtains the moving track to autonomously move the robot and starts to move along the moving track, in the moving process of the robot, the driving monitoring module can judge whether the current track is suitable for the robot to continue to follow according to the generated track, the motion state of the robot and the influence of an obstacle on the track, and the judging condition is that whether the distance between the non-driving path and the obstacle is smaller than a threshold value, and if the distance is smaller than the threshold value, the current track is not suitable for the robot to continue to follow; at the moment, the driving monitoring module generates a re-planning signal, the path planning module acquires the re-planning signal, the driving monitoring module also judges whether the robot reaches the driving path end point in the next planning period, if so, the driving monitoring module generates the re-planning signal, and the path planning module acquires the re-planning signal.
9. An apparatus, comprising: one or more processors and storage for storing one or more computer programs;
the one or more computer programs, for execution by the one or more processors, cause the one or more processors to implement the autonomous mobile robot trajectory planning method of any of claims 1-7.
10. A computer-readable storage medium, on which a computer program is stored, which, when being executed by a processor, carries out the method for trajectory planning of an autonomous mobile robot according to any of claims 1 to 7.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202010898857.5A CN112099493B (en) | 2020-08-31 | 2020-08-31 | Autonomous mobile robot trajectory planning method, system and equipment |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202010898857.5A CN112099493B (en) | 2020-08-31 | 2020-08-31 | Autonomous mobile robot trajectory planning method, system and equipment |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN112099493A true CN112099493A (en) | 2020-12-18 |
| CN112099493B CN112099493B (en) | 2021-11-19 |
Family
ID=73756663
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202010898857.5A Active CN112099493B (en) | 2020-08-31 | 2020-08-31 | Autonomous mobile robot trajectory planning method, system and equipment |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN112099493B (en) |
Cited By (17)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN112703144A (en) * | 2020-12-21 | 2021-04-23 | 华为技术有限公司 | Control method, related device and computer-readable storage medium |
| CN112783161A (en) * | 2020-12-29 | 2021-05-11 | 广东嘉腾机器人自动化有限公司 | AGV obstacle avoidance method based on Bezier curve |
| CN112904858A (en) * | 2021-01-20 | 2021-06-04 | 西安交通大学 | Path planning method, system and equipment with continuous curvature |
| CN113103241A (en) * | 2021-04-29 | 2021-07-13 | 哈尔滨工业大学 | Method, device and system for realizing G2 continuous robot double-NURBS track interpolation |
| CN113103240A (en) * | 2021-04-29 | 2021-07-13 | 哈尔滨工业大学 | Method, device and system for realizing C2 continuous robot trajectory planning |
| CN113119123A (en) * | 2021-04-12 | 2021-07-16 | 厦门大学 | Movement control method for office swivel chair production |
| CN113280819A (en) * | 2021-05-21 | 2021-08-20 | 广东美房智高机器人有限公司 | Compression method for operation path data of mobile robot |
| CN113534789A (en) * | 2021-05-18 | 2021-10-22 | 杭州壹悟科技有限公司 | Real-time planning method and device for cubic polynomial speed curve of mobile robot |
| CN113721608A (en) * | 2021-08-16 | 2021-11-30 | 河南牧原智能科技有限公司 | Robot local path planning method and system and readable storage medium |
| CN114442637A (en) * | 2022-02-10 | 2022-05-06 | 北京理工大学 | Unmanned vehicle local dynamic obstacle avoidance path planning method |
| WO2022183790A1 (en) * | 2021-03-02 | 2022-09-09 | 北京旷视机器人技术有限公司 | Path planning method and apparatus, mobile robot, storage medium, and program |
| CN115079702A (en) * | 2022-07-18 | 2022-09-20 | 江苏集萃清联智控科技有限公司 | Intelligent vehicle planning method and system under mixed road scene |
| CN116155965A (en) * | 2023-04-21 | 2023-05-23 | 天津洪荒科技有限公司 | Multi-stage control method of omnidirectional AMR |
| CN116520822A (en) * | 2023-03-13 | 2023-08-01 | 中国人民解放军国防科技大学 | Smooth curvature parameterized representation path generation method |
| CN116552261A (en) * | 2023-06-02 | 2023-08-08 | 陕西长瑞安驰信息技术集团有限公司 | Cone barrel mobile robot and application thereof |
| CN117308965A (en) * | 2023-11-28 | 2023-12-29 | 华南农业大学 | Harvester robot autonomous grain unloading path planning method based on sliding window algorithm |
| CN117405124A (en) * | 2023-12-13 | 2024-01-16 | 融科联创(天津)信息技术有限公司 | Path planning method and system based on big data |
Citations (31)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20080059015A1 (en) * | 2006-06-09 | 2008-03-06 | Whittaker William L | Software architecture for high-speed traversal of prescribed routes |
| US20090150010A1 (en) * | 2007-12-11 | 2009-06-11 | Airbus France | Method and device for generating a yaw speed order for an aircraft during a taxiing |
| US20100299013A1 (en) * | 2009-05-22 | 2010-11-25 | Toyota Motor Engin. & Manufact. | Using topological structure for path planning in semi-structured environments |
| US20110029235A1 (en) * | 2009-07-30 | 2011-02-03 | Qinetiq Limited | Vehicle Control |
| CN102819264A (en) * | 2012-07-30 | 2012-12-12 | 山东大学 | Path planning Q-learning initial method of mobile robot |
| CN103076619A (en) * | 2012-12-27 | 2013-05-01 | 山东大学 | System and method for performing indoor and outdoor 3D (Three-Dimensional) seamless positioning and gesture measuring on fire man |
| CN104215249A (en) * | 2014-08-26 | 2014-12-17 | 厦门市润铭电子科技有限公司 | Smoothening method of driving track |
| CN104238560A (en) * | 2014-09-26 | 2014-12-24 | 深圳市科松电子有限公司 | Method and system for planning nonlinear paths |
| CN105539586A (en) * | 2014-08-29 | 2016-05-04 | 通用汽车环球科技运作有限责任公司 | Unified motion planner for autonomous driving vehicle in avoiding the moving obstacle |
| CN105539434A (en) * | 2014-08-29 | 2016-05-04 | 通用汽车环球科技运作有限责任公司 | Method of path planning for evasive steering maneuver |
| US20170010115A1 (en) * | 2015-02-10 | 2017-01-12 | Mobileye Vision Technologies Ltd. | Autonomous navigation based on road signatures |
| CN106773739A (en) * | 2017-02-28 | 2017-05-31 | 山东大学 | Method for planning track of robot based on hereditary chaotic optimization algorithm |
| JP2017097535A (en) * | 2015-11-20 | 2017-06-01 | トヨタ自動車株式会社 | Autonomous mobile entity |
| CN106909144A (en) * | 2017-01-22 | 2017-06-30 | 无锡卡尔曼导航技术有限公司 | For the unpiloted field obstacle-avoiding route planning of agricultural machinery and its control method |
| CN107168305A (en) * | 2017-04-01 | 2017-09-15 | 西安交通大学 | Unmanned vehicle method for planning track based on Bezier and VFH under the scene of crossing |
| CN107883961A (en) * | 2017-11-06 | 2018-04-06 | 哈尔滨工程大学 | A kind of underwater robot method for optimizing route based on Smooth RRT algorithms |
| US20180164827A1 (en) * | 2018-02-09 | 2018-06-14 | GM Global Technology Operations LLC | Systems and methods for autonomous vehicle path follower correction |
| CN108981717A (en) * | 2018-08-23 | 2018-12-11 | 王红军 | A kind of paths planning method based on hyperbolic metric |
| CN109159113A (en) * | 2018-08-14 | 2019-01-08 | 西安交通大学 | A kind of robot manipulating task method of view-based access control model reasoning |
| CN109375632A (en) * | 2018-12-17 | 2019-02-22 | 清华大学 | Automatic driving vehicle real-time track planing method |
| CN109606352A (en) * | 2018-11-22 | 2019-04-12 | 江苏大学 | A kind of tracking of vehicle route and stability control method for coordinating |
| US20190129433A1 (en) * | 2016-12-29 | 2019-05-02 | Amicro Semiconductor Corporation | A path planning method of intelligent robot |
| CN109839953A (en) * | 2019-02-19 | 2019-06-04 | 上海交通大学 | The trajectory planning and speed planning method for transferring smooth based on Bezier |
| US20190243370A1 (en) * | 2018-02-07 | 2019-08-08 | Baidu Usa Llc | Systems and methods for accelerated curve projection |
| CN110109451A (en) * | 2019-04-10 | 2019-08-09 | 东南大学 | A kind of novel geometry path tracking algorithm considering path curvatures |
| CN110442128A (en) * | 2019-07-20 | 2019-11-12 | 河北科技大学 | AGV paths planning method based on feature point extraction ant group algorithm |
| CN110861650A (en) * | 2019-11-21 | 2020-03-06 | 驭势科技（北京）有限公司 | Vehicle path planning method and device, vehicle-mounted equipment and storage medium |
| CN110865642A (en) * | 2019-11-06 | 2020-03-06 | 天津大学 | Path planning method based on mobile robot |
| CN110887484A (en) * | 2019-10-14 | 2020-03-17 | 重庆邮电大学 | Mobile robot path planning method based on improved genetic algorithm and storage medium |
| CN111368607A (en) * | 2018-12-26 | 2020-07-03 | 北京欣奕华科技有限公司 | Robot, obstacle detection method and detection device |
| CN111487960A (en) * | 2020-03-26 | 2020-08-04 | 北京控制工程研究所 | Mobile robot path planning method based on positioning capability estimation |
-
2020
- 2020-08-31 CN CN202010898857.5A patent/CN112099493B/en active Active
Patent Citations (31)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20080059015A1 (en) * | 2006-06-09 | 2008-03-06 | Whittaker William L | Software architecture for high-speed traversal of prescribed routes |
| US20090150010A1 (en) * | 2007-12-11 | 2009-06-11 | Airbus France | Method and device for generating a yaw speed order for an aircraft during a taxiing |
| US20100299013A1 (en) * | 2009-05-22 | 2010-11-25 | Toyota Motor Engin. & Manufact. | Using topological structure for path planning in semi-structured environments |
| US20110029235A1 (en) * | 2009-07-30 | 2011-02-03 | Qinetiq Limited | Vehicle Control |
| CN102819264A (en) * | 2012-07-30 | 2012-12-12 | 山东大学 | Path planning Q-learning initial method of mobile robot |
| CN103076619A (en) * | 2012-12-27 | 2013-05-01 | 山东大学 | System and method for performing indoor and outdoor 3D (Three-Dimensional) seamless positioning and gesture measuring on fire man |
| CN104215249A (en) * | 2014-08-26 | 2014-12-17 | 厦门市润铭电子科技有限公司 | Smoothening method of driving track |
| CN105539586A (en) * | 2014-08-29 | 2016-05-04 | 通用汽车环球科技运作有限责任公司 | Unified motion planner for autonomous driving vehicle in avoiding the moving obstacle |
| CN105539434A (en) * | 2014-08-29 | 2016-05-04 | 通用汽车环球科技运作有限责任公司 | Method of path planning for evasive steering maneuver |
| CN104238560A (en) * | 2014-09-26 | 2014-12-24 | 深圳市科松电子有限公司 | Method and system for planning nonlinear paths |
| US20170010115A1 (en) * | 2015-02-10 | 2017-01-12 | Mobileye Vision Technologies Ltd. | Autonomous navigation based on road signatures |
| JP2017097535A (en) * | 2015-11-20 | 2017-06-01 | トヨタ自動車株式会社 | Autonomous mobile entity |
| US20190129433A1 (en) * | 2016-12-29 | 2019-05-02 | Amicro Semiconductor Corporation | A path planning method of intelligent robot |
| CN106909144A (en) * | 2017-01-22 | 2017-06-30 | 无锡卡尔曼导航技术有限公司 | For the unpiloted field obstacle-avoiding route planning of agricultural machinery and its control method |
| CN106773739A (en) * | 2017-02-28 | 2017-05-31 | 山东大学 | Method for planning track of robot based on hereditary chaotic optimization algorithm |
| CN107168305A (en) * | 2017-04-01 | 2017-09-15 | 西安交通大学 | Unmanned vehicle method for planning track based on Bezier and VFH under the scene of crossing |
| CN107883961A (en) * | 2017-11-06 | 2018-04-06 | 哈尔滨工程大学 | A kind of underwater robot method for optimizing route based on Smooth RRT algorithms |
| US20190243370A1 (en) * | 2018-02-07 | 2019-08-08 | Baidu Usa Llc | Systems and methods for accelerated curve projection |
| US20180164827A1 (en) * | 2018-02-09 | 2018-06-14 | GM Global Technology Operations LLC | Systems and methods for autonomous vehicle path follower correction |
| CN109159113A (en) * | 2018-08-14 | 2019-01-08 | 西安交通大学 | A kind of robot manipulating task method of view-based access control model reasoning |
| CN108981717A (en) * | 2018-08-23 | 2018-12-11 | 王红军 | A kind of paths planning method based on hyperbolic metric |
| CN109606352A (en) * | 2018-11-22 | 2019-04-12 | 江苏大学 | A kind of tracking of vehicle route and stability control method for coordinating |
| CN109375632A (en) * | 2018-12-17 | 2019-02-22 | 清华大学 | Automatic driving vehicle real-time track planing method |
| CN111368607A (en) * | 2018-12-26 | 2020-07-03 | 北京欣奕华科技有限公司 | Robot, obstacle detection method and detection device |
| CN109839953A (en) * | 2019-02-19 | 2019-06-04 | 上海交通大学 | The trajectory planning and speed planning method for transferring smooth based on Bezier |
| CN110109451A (en) * | 2019-04-10 | 2019-08-09 | 东南大学 | A kind of novel geometry path tracking algorithm considering path curvatures |
| CN110442128A (en) * | 2019-07-20 | 2019-11-12 | 河北科技大学 | AGV paths planning method based on feature point extraction ant group algorithm |
| CN110887484A (en) * | 2019-10-14 | 2020-03-17 | 重庆邮电大学 | Mobile robot path planning method based on improved genetic algorithm and storage medium |
| CN110865642A (en) * | 2019-11-06 | 2020-03-06 | 天津大学 | Path planning method based on mobile robot |
| CN110861650A (en) * | 2019-11-21 | 2020-03-06 | 驭势科技（北京）有限公司 | Vehicle path planning method and device, vehicle-mounted equipment and storage medium |
| CN111487960A (en) * | 2020-03-26 | 2020-08-04 | 北京控制工程研究所 | Mobile robot path planning method based on positioning capability estimation |
Non-Patent Citations (7)
| Title |
|---|
| REKHA RAJA等: "Path planning in dynamic environment for a rover using A∗ and potential field method", 《2017 18TH INTERNATIONAL CONFERENCE ON ADVANCED ROBOTICS (ICAR)》 * |
| TOMAS BERGLUND: "Path-Planning with Obstacle-Avoiding Minimum Curvature Variation B-splines", 《DEPARTMENT OF COMPUTER SCIENCE AND ELECTRICAL ENGINEERING LULE˚A UNIVERSITY OF TECHNOLOGY学位论文》 * |
| ZHIQIANG JIAN等: "High-Definition Map Combined Local Motion Planning and Obstacle Avoidance for Autonomous Driving", 《2019 IEEE INTELLIGENT VEHICLES SYMPOSIUM (IV)》 * |
| 修彩靖等: "基于改进人工势场法的无人驾驶车辆局部路径规划的研究", 《汽车工程》 * |
| 傅卫平等: "利用机器人行为动力学与滚动窗口路径规划", 《计算机工程与应用》 * |
| 刘子熠，等: "一种基于共点映射的无人车可行驶区域检测方法", 《ENGINEERING》 * |
| 彭晓燕，等: "无人驾驶汽车局部路径规划算法研究", 《汽车工程》 * |
Cited By (26)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN112703144A (en) * | 2020-12-21 | 2021-04-23 | 华为技术有限公司 | Control method, related device and computer-readable storage medium |
| CN112783161A (en) * | 2020-12-29 | 2021-05-11 | 广东嘉腾机器人自动化有限公司 | AGV obstacle avoidance method based on Bezier curve |
| CN112904858A (en) * | 2021-01-20 | 2021-06-04 | 西安交通大学 | Path planning method, system and equipment with continuous curvature |
| WO2022183790A1 (en) * | 2021-03-02 | 2022-09-09 | 北京旷视机器人技术有限公司 | Path planning method and apparatus, mobile robot, storage medium, and program |
| CN113119123B (en) * | 2021-04-12 | 2022-05-17 | 厦门大学 | Motion control method for office swivel chair production |
| CN113119123A (en) * | 2021-04-12 | 2021-07-16 | 厦门大学 | Movement control method for office swivel chair production |
| CN113103241A (en) * | 2021-04-29 | 2021-07-13 | 哈尔滨工业大学 | Method, device and system for realizing G2 continuous robot double-NURBS track interpolation |
| CN113103240A (en) * | 2021-04-29 | 2021-07-13 | 哈尔滨工业大学 | Method, device and system for realizing C2 continuous robot trajectory planning |
| CN113534789B (en) * | 2021-05-18 | 2024-04-05 | 杭州壹悟科技有限公司 | Method and device for real-time planning of three-time polynomial speed curve of mobile robot |
| CN113534789A (en) * | 2021-05-18 | 2021-10-22 | 杭州壹悟科技有限公司 | Real-time planning method and device for cubic polynomial speed curve of mobile robot |
| CN113280819A (en) * | 2021-05-21 | 2021-08-20 | 广东美房智高机器人有限公司 | Compression method for operation path data of mobile robot |
| CN113280819B (en) * | 2021-05-21 | 2024-03-08 | 广东美房智高机器人有限公司 | Method for compressing operation path data of mobile robot |
| CN113721608A (en) * | 2021-08-16 | 2021-11-30 | 河南牧原智能科技有限公司 | Robot local path planning method and system and readable storage medium |
| CN114442637A (en) * | 2022-02-10 | 2022-05-06 | 北京理工大学 | Unmanned vehicle local dynamic obstacle avoidance path planning method |
| CN114442637B (en) * | 2022-02-10 | 2023-11-10 | 北京理工大学 | Unmanned vehicle local dynamic obstacle avoidance path planning method |
| CN115079702A (en) * | 2022-07-18 | 2022-09-20 | 江苏集萃清联智控科技有限公司 | Intelligent vehicle planning method and system under mixed road scene |
| CN116520822B (en) * | 2023-03-13 | 2023-09-19 | 中国人民解放军国防科技大学 | Smooth curvature parameterized representation path generation method |
| CN116520822A (en) * | 2023-03-13 | 2023-08-01 | 中国人民解放军国防科技大学 | Smooth curvature parameterized representation path generation method |
| CN116155965B (en) * | 2023-04-21 | 2023-06-30 | 天津洪荒科技有限公司 | Multi-stage control method of omnidirectional AMR |
| CN116155965A (en) * | 2023-04-21 | 2023-05-23 | 天津洪荒科技有限公司 | Multi-stage control method of omnidirectional AMR |
| CN116552261A (en) * | 2023-06-02 | 2023-08-08 | 陕西长瑞安驰信息技术集团有限公司 | Cone barrel mobile robot and application thereof |
| CN116552261B (en) * | 2023-06-02 | 2023-10-10 | 陕西长瑞安驰信息技术集团有限公司 | Cone barrel mobile robot and application thereof |
| CN117308965A (en) * | 2023-11-28 | 2023-12-29 | 华南农业大学 | Harvester robot autonomous grain unloading path planning method based on sliding window algorithm |
| CN117308965B (en) * | 2023-11-28 | 2024-03-12 | 华南农业大学 | Harvester robot autonomous grain unloading path planning method based on sliding window algorithm |
| CN117405124A (en) * | 2023-12-13 | 2024-01-16 | 融科联创(天津)信息技术有限公司 | Path planning method and system based on big data |
| CN117405124B (en) * | 2023-12-13 | 2024-02-27 | 融科联创(天津)信息技术有限公司 | Path planning method and system based on big data |
Also Published As
| Publication number | Publication date |
|---|---|
| CN112099493B (en) | 2021-11-19 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN112099493B (en) | Autonomous mobile robot trajectory planning method, system and equipment | |
| CN108692734B (en) | Path planning method and device | |
| CN109885891B (en) | Intelligent vehicle GPU parallel acceleration trajectory planning method | |
| US5570285A (en) | Method and apparatus for avoiding obstacles by a robot | |
| US8515612B2 (en) | Route planning method, route planning device and autonomous mobile device | |
| Magid et al. | Spline-based robot navigation | |
| CN111830979A (en) | Trajectory optimization method and device | |
| CN110162029A (en) | A kind of motion control method and device, robot based on planning path | |
| CN112859866A (en) | Robot rolling path planning method, system, storage medium, equipment and application | |
| Özdemir et al. | A hybrid obstacle avoidance method: follow the gap with dynamic window approach | |
| CN112254727B (en) | TEB-based path planning method and device | |
| CN112526999A (en) | Speed planning method, device, electronic equipment and storage medium | |
| CN115609594B (en) | Planning method and device for mechanical arm path, upper control end and storage medium | |
| CN113433936A (en) | Mobile equipment obstacle-avoiding method and device, mobile equipment and storage medium | |
| CN111578926A (en) | Map generation and navigation obstacle avoidance method based on automatic driving platform | |
| CN113359714B (en) | Routing inspection robot dynamic path planning method and device based on particle filter algorithm | |
| CN111707258A (en) | External vehicle monitoring method, device, equipment and storage medium | |
| CN113867336A (en) | Mobile robot path navigation and planning method suitable for complex scene | |
| WO2023236476A1 (en) | Lane line-free method and apparatus for determining tracking trajectory | |
| CN110488815B (en) | Vehicle path tracking method and system | |
| CN113296099B (en) | Method and terminal for automatically generating avoidance path according to obstacle | |
| CN115657664A (en) | Path planning method, system, equipment and medium based on human teaching learning | |
| CN117416342B (en) | Intelligent parking method for unmanned vehicle | |
| CN115826590B (en) | Mobile robot local path planning method and system with self-adaptive parameters | |
| CN116736866B (en) | Property indoor robot path planning and trajectory control method and system |
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 |