CN110260875A - A kind of method in Global motion planning path, Global motion planning device and storage medium - Google Patents

A kind of method in Global motion planning path, Global motion planning device and storage medium Download PDF

Info

Publication number
CN110260875A
CN110260875A CN201910538396.8A CN201910538396A CN110260875A CN 110260875 A CN110260875 A CN 110260875A CN 201910538396 A CN201910538396 A CN 201910538396A CN 110260875 A CN110260875 A CN 110260875A
Authority
CN
China
Prior art keywords
path
mobile robot
planning
point
global motion
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
CN201910538396.8A
Other languages
Chinese (zh)
Inventor
阿迪·瓦蒂
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Guangzhou Blue Fat Robot Co Ltd
Original Assignee
Guangzhou Blue Fat Robot Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Guangzhou Blue Fat Robot Co Ltd filed Critical Guangzhou Blue Fat Robot Co Ltd
Priority to CN201910538396.8A priority Critical patent/CN110260875A/en
Publication of CN110260875A publication Critical patent/CN110260875A/en
Pending legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/34Route searching; Route guidance

Abstract

The invention discloses a kind of method in Global motion planning path, Global motion planning device and storage mediums, belong to robotic technology field.This method includes receiving multiple path points of First Series, according to the current posture of mobile robot, planning is sent to mobile robot with the path of first path point, when mobile robot reaches first path point of planning, according to the current posture of mobile robot, the step of planning is sent to mobile robot with the path of second path point, repeats above-mentioned planning path and transmitting path, until mobile robot reaches the last one path point of First Series.The method provided through the invention, when having received a series of path points, path planning is all re-started according to the current posture of robot when reaching each path point, can preferably cope with unpredictalbe barrier and environmental change, improves Global motion planning device to the real-time of path planning.

Description

A kind of method in Global motion planning path, Global motion planning device and storage medium
Technical field
The present invention relates to the mobile paths planning methods of the technical field of robot more particularly to a kind of robot, the overall situation Planner and storage medium.
Background technique
Path planning is the most basic link of Mobile Robotics Navigation, it refers to robot in the building ring for having barrier In border, one how is found from origin-to-destination motion path appropriate, makes robot during the motion can safety, collisionless Ground bypasses all barriers.
Global motion planning refers to that robot in the environment with barrier, according to one or more performance indicators, gives machine People plans that a paths, robot are moved to another point from a point according to the path of planning.In traditional Global motion planning device In, it is planning path to be carried out according to single-pathway point, and need to follow specific operational plan, therefore inflexible and real-time Property is not high.
Summary of the invention
In view of this, the purpose of the present invention is to provide a kind of method in Global motion planning path, it is complete to solve the prior art Office's planning path method lacks flexibility, and the problem that real-time is not high.
It is as follows that the present invention solves technical solution used by above-mentioned technical problem:
According to the first aspect of the invention, a kind of method in Global motion planning path is provided, Global motion planning device, institute are suitable for State method the following steps are included:
Receive multiple path points of First Series;
According to the current posture of mobile robot, planning is sent to mobile robot with the path of first path point;
When mobile robot reaches first path point of planning, according to the current posture of mobile robot, planning is had The path of second path point is sent to mobile robot;
The step of repeating above-mentioned planning path and transmitting path, until mobile robot reaches the last one of First Series Path point.
According to the second aspect of the invention, a kind of Global motion planning device is provided, the Global motion planning device include: receiver, Controller and transmitter, the receiver receive multiple path points of First Series, and the controller is worked as according to mobile robot Preceding posture, planning have the path of first path point, and the path with first path point is sent to shifting by transmitter Mobile robot, when mobile robot reaches first path point of planning, the controller is according to the current appearance of mobile robot Gesture, planning has the path of second path point, and the path with first path point is sent to movement by transmitter Robot, the controller and transmitter repeat the step of above-mentioned planning path and transmitting path, until mobile robot reaches The last one path point of First Series.
According to the third aspect of the present invention, a kind of computer readable storage medium is provided, which is characterized in that the calculating It is stored with computer program on machine readable storage medium storing program for executing, such as first aspect is realized when the computer program is executed by processor Or described in the second aspect the step of Global motion planning path.
A series of Global motion planning Path Method of the embodiment of the present invention, when having received path points, when each path of arrival Path planning is all re-started according to the current posture of robot when point, can preferably cope with unpredictalbe barrier and ring Border variation, improves Global motion planning device to the real-time of path planning.
Detailed description of the invention
Fig. 1 is a kind of flow chart for Global motion planning Path Method that the embodiment of the present invention one provides;
Fig. 2 is a kind of structural schematic diagram of Global motion planning device provided by Embodiment 2 of the present invention.
The embodiments will be further described with reference to the accompanying drawings for the realization, the function and the advantages of the object of the present invention.
Specific embodiment
It should be appreciated that the specific embodiments described herein are merely illustrative of the present invention, it is not intended to limit the present invention.
In subsequent description, if using the suffix for indicating such as " module ", " component " or " unit " of element Only for being conducive to explanation of the invention, itself there is no specific meaning.Therefore, " module ", " component " or " unit " can be with Mixedly use.
The embodiment of the present invention one provides a kind of method in Global motion planning path, is suitable for Global motion planning device.Please refer to figure 1, method flow includes:
Step S101, multiple path points of First Series are received;
Before receiving multiple path points of First Series, Global motion planning device is idle state.When receiving path point When, Global motion planning device opens planning state.
Step S102, according to the current posture of mobile robot, planning is sent to movement with the path of first path point Robot;
Mobile robot posture includes the location of robot, direction etc..
Optionally, according to the current posture of mobile robot, planning is sent to moving machine with the path of first path point Device people, concrete mode are as follows:
Position and direction are presently according to mobile robot, element, Quick Extended random number R RT or road are searched using figure At least one of line chart algorithmic rule is sent to mobile robot with the path of first path point.
Optionally, according to the current posture of mobile robot, planning is sent to mobile robot with the path of path point Later, Global motion planning device is wait state within the waiting time of setting.The waiting time of the setting can be robot from The estimated time of starting point arrival destination path point.
At the end of the waiting time of the setting, whether Global motion planning device detection mobile robot reaches the path of planning Point, when detection, which moves on to robot, does not reach the path point of planning, according to the current posture of mobile robot, planning, which has, again is somebody's turn to do The path of path point is sent to mobile robot.When detection, which moves on to robot, arrived the path point of planning, then execute subsequent Step S103.
Step S103, when mobile robot reaches first path point of planning, according to the current posture of mobile robot, Planning is sent to mobile robot with the path of second path point;
Step S104, the step of repeating above-mentioned planning path and transmitting path, until mobile robot reaches First Series The last one path point.
Optionally, after mobile robot reaches the last one path point of First Series, Global motion planning device restores idle State waits second series path point to be received.
Optionally, before mobile robot reaches the last one path point, if receiving second series path point, Abandon the First Series path point, and the step of planning path and transmitting path are carried out according to second series path point.
In practical application, when Global motion planning device is not received by any path point, Global motion planning device is in idle condition. When receiving a series of or either path point, Global motion planning device opens planning state, and planning one has the road of path point Diameter is sent to mobile robot.Robot is then moved according to the path of planning, when robot starts mobile, Global motion planning Device is waited within the set time, and at the end of wait state, whether detection robot reaches the first path of planning Point, if detecting the first path point for not reaching planning, according to robot, currently new posture is planned again, so as to Cope with unpredictalbe variation or obstacle.If detect the first path point that arrived planning, root if Global motion planning device According to the current posture of robot, continue path of the planning with the second path point to robot, robot reaches second path The process of point is identical with the aforementioned process for reaching first path point, and so on, repeat above-mentioned planning path and transmitting path The step of, until mobile robot reaches the last one path point of First Series, later, Global motion planning device is in idle shape State, until receiving new series or either path point.
Also, before mobile robot reaches a series of the last one path point, if received new a series of It when path point, then represents Global motion planning device and needs to change existing path planning, therefore, Global motion planning device is a series of before abandoning Path point, and series of paths point new based on the received re-starts planning path and transmitting path to robot.
A series of method in Global motion planning path provided in this embodiment, when having received path points, when each road of arrival Path planning is all re-started according to the current posture of robot when diameter point, can preferably cope with unpredictalbe barrier and Environmental change, further, in robot moving process, if Global motion planning device receives a series of new path points, Path planning will be re-started according to new range path point, and further improve Global motion planning device to the real-time of path planning.
Referring to Fig. 2, second embodiment of the present invention provides a kind of Global motion planning devices.The Global motion planning device includes receiver 201, controller 202 and transmitter 203.
The receiver 201 receives multiple path points of First Series.
The controller 202 is according to the current posture of mobile robot, and planning is with first path point in First Series Path, mobile robot will be sent to the path of first path point by transmitter 203.
When mobile robot reaches first path point of planning, the controller 202 is current according to mobile robot Posture, planning has the path of second path point, and is sent to the path with second path point by transmitter 203 Mobile robot.
The step of controller 202 and transmitter 203 repeat above-mentioned planning path and transmitting path, until mobile machine The last one path point of people's arrival First Series.
According to the current posture of mobile robot, planning is sent to mobile robot with the path of first path point, has Body mode are as follows:
Position and direction are presently according to mobile robot, element, Quick Extended random number R RT or road are searched using figure At least one of line chart algorithmic rule is sent to mobile robot with the path of first path point.
Optionally, the Global motion planning device further includes detector 204, and the transmitter 203 will have the path of path point It is sent to after mobile robot, Global motion planning device is wait state within the waiting time of setting, when the waiting of the setting At the end of time, the detector 204 detects the path point whether mobile robot reaches planning, when mobile robot does not reach When the path point of planning, according to the current posture of mobile robot, the controller 202 plans the road with the path point again Diameter, and mobile robot is sent to by transmitter 203.
Optionally, before mobile robot reaches the last one path point, if the receiver 201 receives second Series of paths point, then the controller 202 abandons First Series path point, and carries out planning road according to second series path point Diameter, and the path is sent to mobile robot by the transmitter 203.
During path planning, there are three states for Global motion planning device, are respectively: idle state, waits shape at planning state State.
When Global motion planning device does not receive any path point information, Global motion planning device is in idle condition;When receiving When a series of or either path point, Global motion planning device opens planning state, and one path with path point of planning is sent to Mobile robot;When the path that planning is had path point is sent to mobile robot, and robot starts mobile, Global motion planning Device is wait state within the waiting time of setting.
Following table is please referred to, is state table of the Global motion planning device in path planning.Wherein, destination, that is, path point.
Global motion planning device provided in this embodiment, when having received a series of path points, all when reaching each path point According to robot, current posture re-starts path planning, can preferably cope with unpredictalbe barrier and environment becomes Change, further, in robot moving process, if Global motion planning device receives a series of new path points, by basis New range path point re-starts path planning, further improves Global motion planning device to the real-time of path planning.
On the basis of previous embodiment, the embodiment of the present invention three provides a kind of computer readable storage medium, special Sign is, computer program is stored on the computer readable storage medium, when the computer program is executed by processor The step of realizing the path planning such as first embodiment or second embodiment.
The computer readable storage medium of the present embodiment, by when reaching each path point all according to robot it is current Posture re-starts path planning, unpredictalbe barrier and environmental change can be preferably coped with, further, in machine In people's moving process, if Global motion planning device receives a series of new path points, will according to new range path point again into Row path planning further improves Global motion planning device to the real-time of path planning.
It should be noted that, in this document, the terms "include", "comprise" or its any other variant are intended to non-row His property includes, so that the process, method, article or the device that include a series of elements not only include those elements, and And further include other elements that are not explicitly listed, or further include for this process, method, article or device institute it is intrinsic Element.In the absence of more restrictions, the element limited by sentence "including a ...", it is not excluded that including being somebody's turn to do There is also other identical elements in the process, method of element, article or device.
The serial number of the above embodiments of the invention is only for description, does not represent the advantages or disadvantages of the embodiments.
Through the above description of the embodiments, those skilled in the art can be understood that above-described embodiment side Method can be realized by means of software and necessary general hardware platform, naturally it is also possible to by hardware, but in many cases The former is more preferably embodiment.Based on this understanding, technical solution of the present invention substantially in other words does the prior art The part contributed out can be embodied in the form of software products, which is stored in a storage medium In (such as ROM/RAM, magnetic disk, CD), including some instructions are used so that a terminal (can be mobile phone, computer, service Device, air conditioner or network equipment etc.) execute method described in each embodiment of the present invention.
The embodiment of the present invention is described with above attached drawing, but the invention is not limited to above-mentioned specific Embodiment, the above mentioned embodiment is only schematical, rather than restrictive, those skilled in the art Under the inspiration of the present invention, without breaking away from the scope protected by the purposes and claims of the present invention, it can also make very much Form, all of these belong to the protection of the present invention.

Claims (10)

1. a kind of method in Global motion planning path is suitable for Global motion planning device, the described method comprises the following steps:
Receive multiple path points of First Series;
According to the current posture of mobile robot, planning is sent to mobile robot with the path of first path point;
When mobile robot reaches first path point of planning, according to the current posture of mobile robot, planning has second The path of a path point is sent to mobile robot;
The step of repeating above-mentioned planning path and transmitting path, until mobile robot reaches the last one path of First Series Point.
2. the method in Global motion planning path as described in claim 1, which is characterized in that described according to the current appearance of mobile robot Gesture, planning are sent to after mobile robot with the path of path point, and Global motion planning device is within the waiting time of setting etc. To state.
3. the method in Global motion planning path as claimed in claim 2, which is characterized in that terminate when the waiting time of the setting When, whether detection mobile robot reaches the path point of planning, when detection, which moves on to robot, does not reach the path point of planning, root According to the current posture of mobile robot, planning is sent to mobile robot with the path of the path point again.
4. the method in Global motion planning path as described in claim 1, which is characterized in that the mobile robot reaches the first system After the last one path point of column, Global motion planning device is idle state, waits second series path point to be received.
5. the method in Global motion planning path as described in claim 1, which is characterized in that reach the last one in mobile robot Before path point, if receiving second series path point, the First Series path point is abandoned, and according to second series road Diameter point carries out the step of planning path and transmitting path.
6. the method in Global motion planning path as described in claim 1, which is characterized in that according to the current posture of mobile robot, Planning is sent to mobile robot, concrete mode with the path of first path point are as follows:
Position and direction are presently according to mobile robot, element, Quick Extended random number R RT or route map are searched using figure At least one of algorithmic rule be sent to mobile robot with the path of first path point.
7. a kind of Global motion planning device, which is characterized in that the Global motion planning device includes: receiver, controller and transmitter, described Receiver receives multiple path points of First Series, and the controller has first according to the current posture of mobile robot, planning Path with first path point is sent to mobile robot by transmitter, when mobile machine by the path of a path point When people reaches first path point of planning, the controller has second road according to the current posture of mobile robot, planning The path of diameter point, and the path with second path point is sent to by mobile robot by transmitter, the controller and Transmitter repeats the step of above-mentioned planning path and transmitting path, until mobile robot reaches the last one road of First Series Diameter point.
8. Global motion planning device as claimed in claim 7, which is characterized in that the Global motion planning device further includes detector, described After path with path point is sent to mobile robot by transmitter, Global motion planning device is within the waiting time of setting etc. To state, at the end of the waiting time of the setting, whether the detector detection mobile robot reaches the path of planning Point, when mobile robot does not reach the path point of planning, according to the current posture of mobile robot, the controller is planned again Path with the path point, and mobile robot is sent to by transmitter.
9. Global motion planning device as claimed in claim 7, which is characterized in that mobile robot reach the last one path point it Before, if the receiver receives second series path point, the controller abandons First Series path point, and according to the 2 series of paths points carry out planning path, and send the path to mobile robot by the transmitter.
10. a kind of computer readable storage medium, which is characterized in that be stored with computer on the computer readable storage medium Program realizes such as step described in any one of claims 1 to 6 when the computer program is executed by processor.
CN201910538396.8A 2019-06-20 2019-06-20 A kind of method in Global motion planning path, Global motion planning device and storage medium Pending CN110260875A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910538396.8A CN110260875A (en) 2019-06-20 2019-06-20 A kind of method in Global motion planning path, Global motion planning device and storage medium

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910538396.8A CN110260875A (en) 2019-06-20 2019-06-20 A kind of method in Global motion planning path, Global motion planning device and storage medium

Publications (1)

Publication Number Publication Date
CN110260875A true CN110260875A (en) 2019-09-20

Family

ID=67919926

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910538396.8A Pending CN110260875A (en) 2019-06-20 2019-06-20 A kind of method in Global motion planning path, Global motion planning device and storage medium

Country Status (1)

Country Link
CN (1) CN110260875A (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2022037202A1 (en) * 2020-08-20 2022-02-24 深圳市海柔创新科技有限公司 Route reservation for navigation of warehouse robot
WO2022161045A1 (en) * 2021-01-26 2022-08-04 深圳市优必选科技股份有限公司 Estimated time of arrival calculation method, and system and mobile machine using same

Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103914068A (en) * 2013-01-07 2014-07-09 中国人民解放军第二炮兵工程大学 Service robot autonomous navigation method based on raster maps
CN106647769A (en) * 2017-01-19 2017-05-10 厦门大学 AGV path tracking and obstacle avoiding coordination method based on A* extraction guide point
CN107479570A (en) * 2017-07-05 2017-12-15 南宁学院 A kind of unmanned plane automatic flight control method of adjustable spiral wing posture
CN108401423A (en) * 2017-09-05 2018-08-14 深圳蓝胖子机器人有限公司 Method, system, robot and the storage device of automatic conveying package
CN108444482A (en) * 2018-06-15 2018-08-24 东北大学 A kind of autonomous pathfinding barrier-avoiding method of unmanned plane and system
CN108646730A (en) * 2018-04-13 2018-10-12 北京海风智能科技有限责任公司 A kind of service robot and its multiple target autonomous cruise method based on ROS
CN109000649A (en) * 2018-05-29 2018-12-14 重庆大学 A kind of all directionally movable robot pose calibration method based on right angle bend feature
CN109100744A (en) * 2018-07-27 2018-12-28 深圳蓝胖子机器人有限公司 Object localization method and system for AGV
CN109163724A (en) * 2018-09-07 2019-01-08 五邑大学 Multiple target point autonomous navigation method based on Turtlebot2 robot building map
CN109459031A (en) * 2018-12-05 2019-03-12 智灵飞(北京)科技有限公司 A kind of unmanned plane RRT method for optimizing route based on greedy algorithm

Patent Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103914068A (en) * 2013-01-07 2014-07-09 中国人民解放军第二炮兵工程大学 Service robot autonomous navigation method based on raster maps
CN106647769A (en) * 2017-01-19 2017-05-10 厦门大学 AGV path tracking and obstacle avoiding coordination method based on A* extraction guide point
CN107479570A (en) * 2017-07-05 2017-12-15 南宁学院 A kind of unmanned plane automatic flight control method of adjustable spiral wing posture
CN108401423A (en) * 2017-09-05 2018-08-14 深圳蓝胖子机器人有限公司 Method, system, robot and the storage device of automatic conveying package
CN108646730A (en) * 2018-04-13 2018-10-12 北京海风智能科技有限责任公司 A kind of service robot and its multiple target autonomous cruise method based on ROS
CN109000649A (en) * 2018-05-29 2018-12-14 重庆大学 A kind of all directionally movable robot pose calibration method based on right angle bend feature
CN108444482A (en) * 2018-06-15 2018-08-24 东北大学 A kind of autonomous pathfinding barrier-avoiding method of unmanned plane and system
CN109100744A (en) * 2018-07-27 2018-12-28 深圳蓝胖子机器人有限公司 Object localization method and system for AGV
CN109163724A (en) * 2018-09-07 2019-01-08 五邑大学 Multiple target point autonomous navigation method based on Turtlebot2 robot building map
CN109459031A (en) * 2018-12-05 2019-03-12 智灵飞(北京)科技有限公司 A kind of unmanned plane RRT method for optimizing route based on greedy algorithm

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
吴梦珂 等: "基于ROS的移动机器人多目标点导航的实现", 《电子技术研发》 *
吴正 等: "Turtlebot2 机器人环境地图构建与多目标点自主导航的研究", 《电脑与信息技术》 *

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2022037202A1 (en) * 2020-08-20 2022-02-24 深圳市海柔创新科技有限公司 Route reservation for navigation of warehouse robot
US11868142B2 (en) 2020-08-20 2024-01-09 Hai Robotics Co., Ltd. Navigation route reservation for warehouse robot
WO2022161045A1 (en) * 2021-01-26 2022-08-04 深圳市优必选科技股份有限公司 Estimated time of arrival calculation method, and system and mobile machine using same

Similar Documents

Publication Publication Date Title
US11709502B2 (en) Roadmap annotation for deadlock-free multi-agent navigation
US10994418B2 (en) Dynamically adjusting roadmaps for robots based on sensed environmental data
CN105513382B (en) A kind of vehicle early warning processing method, server and system
CN110260875A (en) A kind of method in Global motion planning path, Global motion planning device and storage medium
CN111216125B (en) Obstacle avoidance method and system of moving mechanical arm device facing narrow passage
CN204868886U (en) Multifunctional machine ware people who can fly in calamity scene
CN109059926A (en) Across floor paths planning method and system
CN109901578A (en) A kind of method, apparatus and terminal device controlling multirobot
US9964411B2 (en) Assisted roadmap generation
CN111308996A (en) Training device and cooperative operation control method thereof
CN105676848A (en) Robot autonomous navigation method based on ROS operating system
CN103063207B (en) A kind of method of rapid navigation, Apparatus and system
CN102457807A (en) Method and terminal for determining positional information
CN109048909A (en) Minor matters formula path dispatching method, device, background server and the first robot
CN116540656A (en) Digital twinning-based multi-AGV collision-free path scheduling method for manufacturing workshops
CN106323268A (en) Mobile terminal positioning and travelling navigation method and mobile terminal
US11460841B2 (en) Remote operation extending an existing route to a destination
CN105722030A (en) Node position prediction method in DTN (Delay Tolerant Network)
CN114485621A (en) Navigation method, navigation device and computer readable storage medium
CN107149322A (en) Intelligent mobile seat and its control system based on bluetooth 4.0
JP2009043241A (en) Method for tracking moving entities
CN110274600A (en) Obtain the method, apparatus and system of robot GPS information
KR101401311B1 (en) Apparatus and method of path planning for a plurality of moving bodies
KR100952469B1 (en) Delivery robot for printed matter of printer and thereof control method
JP6056585B2 (en) Control method of portable information terminal, control program, and portable information terminal

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
RJ01 Rejection of invention patent application after publication
RJ01 Rejection of invention patent application after publication

Application publication date: 20190920