CN108544491A - A kind of moving robot obstacle avoiding method considering distance and two factor of direction - Google Patents
A kind of moving robot obstacle avoiding method considering distance and two factor of direction Download PDFInfo
- Publication number
- CN108544491A CN108544491A CN201810289260.3A CN201810289260A CN108544491A CN 108544491 A CN108544491 A CN 108544491A CN 201810289260 A CN201810289260 A CN 201810289260A CN 108544491 A CN108544491 A CN 108544491A
- Authority
- CN
- China
- Prior art keywords
- robot
- barrier
- distance
- max
- danger
- 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
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
- B25J9/1666—Avoiding collision or forbidden zones
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
The present invention discloses a kind of moving robot obstacle avoiding method considering two factors of distance and direction.This method quantizes the fusion problem between the distance and direction of barrier, obtains a unified measurement standard, referred to as barrier danger angle value.The barrier of the greatest danger angle value obtains preferential avoidance, this method can make mobile robot be infinitely variable the angular speed and linear velocity of movement naturally according to real-time environmental information, safety guarantee of both distance and direction is provided for robot, there is Practical significance for the safety navigation of robot.
Description
Technical field
The invention belongs to mobile robot barrier evacuation control system fields, particularly, are related to a kind of based on Laser Measuring
Moving robot obstacle avoiding method away from sensor.
Background technology
In recent years, robot and intelligent vehicle cannot reach or high in mankind such as battlefield attacking and defending, rescue and relief work, Science Explorations
It spends in dangerous environment and embodies more and more important application.With the development of robot technology, robot application is promoted
The working environment of the continuous extension in field, robot also becomes increasingly complex therewith.Robot can encounter various during the motion
The barrier of various kinds, this results in robot, and there is great dangers during its Navigational Movements.Therefore whether have
Standby quickly and effectively avoiding barrier ability is the key that robot realizes safety navigation.At present in most of barrier-avoiding method,
It is usually main to consider the distance between barrier and robot to carry out avoidance operation.This method reduces the orientation of barrier
Influence of the information to robot obstacle-avoiding.Distance and direction are that robot refers to two primary evaluations of barrier progress avoidance judge
Mark answers preferential avoidance apart from close, and the barrier in front also should preferential avoidance.It is proposed to this end that it is a kind of merged distance and
The moving robot obstacle avoiding method based on laser radar sensor in direction, provides more the safety navigation of robot
Safety guarantee has Practical significance for the safety navigation of robot.
Invention content
The present invention be directed to existing method deficiency, propose it is a kind of consider two factor of distance and bearing based on Laser Measuring
Moving robot obstacle avoiding method away from sensor.
In order to achieve the above object, the present invention is divided into three parts:First part is part around mobile robot itself
The fetching portion of environmental information;Second part is the dangerous obstacles extraction for considering two factors of distance and bearing, third
Part is the Mobile Robot Obstacle Avoidance based on barrier danger level.
The operating procedure of barrier-avoiding method is as follows:
One:The acquisition of local environmental information
Step 1:By installing two laser range finders back-to-back come the ambient enviroment of scanning machine people, one 360 ° are formed
Circular scan face.It scans each time and can get a frame scan data, be expressed as array Ak
Wherein k indicates kth time scanning ambient enviroment;For laser scanning angular resolution;N is that scanning can get each time
Laser ranging data number, namely share N number of distance measurement value;diIndicate ith measurement value, 1≤i≤N.So AkAs one
The local environmental information that secondary scanning circumstance is obtained.
Two:Calculate the barrier danger level for considering two factors of distance and bearing
Step 2:It enables i since 1, i-th of distance measurement value is calculated separately in robot local Coordinate System by formula (2) (3)
Coordinate (xi,yi), whereinFor the deviation angle of i-th of distance measurement value.
Step 3:Calculate temporary variable S
S=max (0.56yi+2.56,0) (4)
Step 4:Calculate temporary variable K
K=max (yi+ 0.56, eps), wherein eps=0.00001 (5)
Step 5:Calculate ri
ri=max (1- (yi 2+Sxi 2)/K,0) 1≤i≤N (6)
riBarrier danger angle value of the distance with direction, and 0≤r have been merged corresponding to as i-th of distance measurei
≤1.If ri=1, indicate the barrier danger level highest corresponding to i-th of distance measure, ri=0 indicates that i-th of distance is surveyed
Barrier corresponding to magnitude is safe from danger.
Step 6:If i≤N, step 2 is returned to until obtaining the dangerous angle value array containing N number of element
R={ r1,r2,…,rN} (7)
Three:Mobile Robot Obstacle Avoidance based on barrier danger level
Step 7:Find out highest danger angle valueIts corresponding i-thmaxA laser ranging value
Step 8:IfIt indicates that dangerous barrier exists, then calculates between dangerous obstacles and robot
Angle
IfIt then indicates the barrier presence that is safe from danger, jumps to step 1.
Step 9:The angular velocity omega of avoidance movement is carried out by formula (10), (11) calculating robot and linear velocity v is indicated
It is as follows:
Wherein ωpreWith vpreThe angular speed and linear velocity of robot when to be switched to avoid-obstacle behavior;ωmaxWith vmaxFor machine
People's maximum angular rate and linear velocity;α and β is intensity factor.
Step 10:It jumps to step 1 and continues to run until that robot completes motor task.
Advantageous effect:The present invention is by distance and the information in direction are carried out data fusion, forming a single weighing apparatus
Amount standard, as barrier danger angle value.Have the characteristics that computation complexity is low and real-time is good.The design can make mobile machine
People is infinitely variable the angular speed and linear velocity of movement according to real-time environmental information naturally, so as to ensure that robot realizes
Safer Navigation Control.
Description of the drawings
Fig. 1 is the flow diagram of moving robot obstacle avoiding method;
Fig. 2 is the movement sectional drawing in the implementation process of moving robot obstacle avoiding method.
Specific implementation mode:
The present invention moves in the environment with robot, while with the part around the acquisition robot of laser range finder
Environmental information, the distance and bearing for considering environmental information obtain a single measurement standard, i.e. barrier danger angle value,
Robot generates suitable avoidance linear velocity and angular speed according to dangerous angle value, completes avoid-obstacle behavior.Fig. 2 keeps away for mobile robot
Movement sectional drawing in barrier method implementation process.From movement locus as it can be seen that the successful avoiding obstacles of robot reach eventually from starting point
Point.
As shown in Figure 1, the specific implementation mode of whole process of the present invention illustrated below:
First part:The acquisition of local environmental information
Step 1:By installing two laser range finders back-to-back come the ambient enviroment of scanning machine people, one 360 ° are formed
Circular scan face.It scans each time and can get a frame scan data, the array A that kth time scanning ambient enviroment obtainsk
For laser scanning angular resolution, settingTherefore it scans can get 360 range data each time.
Second part:Calculate the barrier danger level for considering two factors of distance and bearing
Step 2:I calculates separately i-th of distance measure in robot local Coordinate System since 1, by formula (2) (3)
In coordinate (xi,yi), whereinFor the deviation angle of i-th of distance measurement value.
xi=dicos(i·1) (2)
yi=disin(i·1) (3)
Step 3:Calculate temporary variable S
S=max (0.56yi+2.56,0) (4)
Step 4:Calculate temporary variable K
K=max (yi+ 0.56, eps), wherein eps=0.00001 (5)
Step 5:Calculate ri
ri=max (1- (yi 2+Sxi 2)/K,0)(1≤i≤N) (6)
riThe danger level of barrier corresponding to as i-th of distance measure, and 0≤ri≤1.If ri=1, it indicates
Barrier danger level highest corresponding to i-th of distance measure, ri=0 indicates the obstacle corresponding to i-th of distance measure
Object is safe from danger.
Step 6:If i≤N, step 2 is returned to until obtaining the dangerous angle value array containing N=360 element
R={ r1,r2,…,rN} (7)
Part III:Mobile Robot Obstacle Avoidance based on barrier danger level
Step 7:Find out highest danger angle valueIts corresponding i-thmaxA laser ranging value
Step 8:IfIt indicates that dangerous barrier exists, then calculates between dangerous obstacles and robot
Angle
IfIt then indicates the barrier presence that is safe from danger, jumps to step 1.
Step 9:The angular velocity omega of avoidance movement is carried out by formula (10) (11) calculating robot and linear velocity v is indicated such as
Under:
Wherein ωpreWith vpreThe angular speed and linear velocity of robot when to be switched to avoid-obstacle behavior;ωmaxWith vmaxFor machine
People's maximum angular rate and linear velocity;α and β is intensity factor, and α=2, β=4 are arranged.
Step 10:It jumps to step 1 and continues to run until that robot completes motor task.
Claims (1)
1. a kind of moving robot obstacle avoiding method considering distance and two factor of direction, which is characterized in that this method is specific
Include the following steps:
One:The acquisition of local environmental information
Step 1:By installing two laser range finders back-to-back come the ambient enviroment of scanning machine people, one 360 ° of circle is formed
Shape scanning plane;It scans each time and can get a frame scan data, be expressed as array Ak
Wherein k indicates kth time scanning ambient enviroment;For laser scanning angular resolution;N, which is that scanning each time is obtainable, to be swashed
The number of ligh-ranging data, namely share N number of distance measurement value;diIndicate ith measurement value, 1≤i≤N;So AkAs once sweep
Retouch the local environmental information that environment is obtained;
Two:Calculate the barrier danger level for considering two factors of distance and bearing
Step 2:It enables i since 1, seat of i-th of distance measurement value in robot local Coordinate System is calculated separately by formula (2) (3)
Mark (xi,yi), whereinFor the deviation angle of i-th of distance measurement value;
Step 3:Calculate temporary variable S
S=max (0.56yi+2.56,0) (4)
Step 4:Calculate temporary variable K
K=max (yi+ 0.56, eps), wherein eps=0.00001 (5)
Step 5:Calculate ri
ri=max (1- (yi 2+Sxi 2)/K,0) 1≤i≤N (6)
riBarrier danger angle value of the distance with direction, and 0≤r have been merged corresponding to as i-th of distance measurei≤1;
If ri=1, indicate the barrier danger level highest corresponding to i-th of distance measure, ri=0 indicates i-th of distance measure
Corresponding barrier is safe from danger;
Step 6:If i≤N, step 2 is returned to until obtaining the dangerous angle value array containing N number of element
R={ r1,r2,…,rN} (7)
Three:Mobile Robot Obstacle Avoidance based on barrier danger level
Step 7:Find out highest danger angle valueIts corresponding i-thmaxA laser ranging value
Step 8:IfIt indicates that dangerous barrier exists, then calculates the angle between dangerous obstacles and robot
IfIt then indicates the barrier presence that is safe from danger, jumps to step 1;
Step 9:The angular velocity omega of avoidance movement is carried out by formula (10), (11) calculating robot and linear velocity v indicates as follows:
Wherein ωpreWith vpreThe angular speed and linear velocity of robot when to be switched to avoid-obstacle behavior;ωmaxWith vmaxMost for robot
Big angular speed and linear velocity;α and β is intensity factor;
Step 10:It jumps to step 1 and continues to run until that robot completes motor task.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810289260.3A CN108544491B (en) | 2018-03-30 | 2018-03-30 | Mobile robot obstacle avoidance method comprehensively considering two factors of distance and direction |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810289260.3A CN108544491B (en) | 2018-03-30 | 2018-03-30 | Mobile robot obstacle avoidance method comprehensively considering two factors of distance and direction |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108544491A true CN108544491A (en) | 2018-09-18 |
CN108544491B CN108544491B (en) | 2020-04-28 |
Family
ID=63513931
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810289260.3A Active CN108544491B (en) | 2018-03-30 | 2018-03-30 | Mobile robot obstacle avoidance method comprehensively considering two factors of distance and direction |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108544491B (en) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110147108A (en) * | 2019-06-04 | 2019-08-20 | 西南交通大学 | A kind of Mobile Robot Obstacle Avoidance control method calculated based on film |
CN113069094A (en) * | 2021-03-22 | 2021-07-06 | 浙江华彩光电科技有限公司 | Wearable appliance with explosion-proof abnormality detection and physiological early warning functions |
CN113110413A (en) * | 2021-03-10 | 2021-07-13 | 成都永奉科技有限公司 | Following robot, following control method and following control system |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20080243387A1 (en) * | 2004-09-15 | 2008-10-02 | Christoph Schinerl | Method for Preventing a Collision |
CN102541057A (en) * | 2010-12-29 | 2012-07-04 | 沈阳新松机器人自动化股份有限公司 | Moving robot obstacle avoiding method based on laser range finder |
CN102773858A (en) * | 2012-07-17 | 2012-11-14 | 北京航空航天大学 | Obstacle avoidance method of robot palletizer |
CN105159291A (en) * | 2015-07-10 | 2015-12-16 | 北京印刷学院 | Intelligent fleet obstacle avoiding device based on physical information network and obstacle avoiding method |
CN105437232A (en) * | 2016-01-11 | 2016-03-30 | 湖南拓视觉信息技术有限公司 | Method and device for controlling multi-joint moving robot to avoid obstacle |
CN106166750A (en) * | 2016-09-27 | 2016-11-30 | 北京邮电大学 | A kind of modified model D* mechanical arm dynamic obstacle avoidance paths planning method |
CN107844116A (en) * | 2017-10-12 | 2018-03-27 | 杭州电子科技大学 | A kind of online generation method of mobile robot path map |
-
2018
- 2018-03-30 CN CN201810289260.3A patent/CN108544491B/en active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20080243387A1 (en) * | 2004-09-15 | 2008-10-02 | Christoph Schinerl | Method for Preventing a Collision |
CN102541057A (en) * | 2010-12-29 | 2012-07-04 | 沈阳新松机器人自动化股份有限公司 | Moving robot obstacle avoiding method based on laser range finder |
CN102773858A (en) * | 2012-07-17 | 2012-11-14 | 北京航空航天大学 | Obstacle avoidance method of robot palletizer |
CN105159291A (en) * | 2015-07-10 | 2015-12-16 | 北京印刷学院 | Intelligent fleet obstacle avoiding device based on physical information network and obstacle avoiding method |
CN105437232A (en) * | 2016-01-11 | 2016-03-30 | 湖南拓视觉信息技术有限公司 | Method and device for controlling multi-joint moving robot to avoid obstacle |
CN106166750A (en) * | 2016-09-27 | 2016-11-30 | 北京邮电大学 | A kind of modified model D* mechanical arm dynamic obstacle avoidance paths planning method |
CN107844116A (en) * | 2017-10-12 | 2018-03-27 | 杭州电子科技大学 | A kind of online generation method of mobile robot path map |
Non-Patent Citations (2)
Title |
---|
ZHONG CL: "Continuous learning route map for robot navigation using a growing-on-demand self-organizing neural network", 《INTERNATIONAL JOURNAL OF ADVANCED ROBOTIC SYSTEMS》 * |
仲朝亮: "未知环境下的移动机器人主动寻径导航策略", 《杭州电子科技大学学报》 * |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110147108A (en) * | 2019-06-04 | 2019-08-20 | 西南交通大学 | A kind of Mobile Robot Obstacle Avoidance control method calculated based on film |
CN110147108B (en) * | 2019-06-04 | 2021-08-03 | 西南交通大学 | Mobile robot obstacle avoidance control method based on membrane calculation |
CN113110413A (en) * | 2021-03-10 | 2021-07-13 | 成都永奉科技有限公司 | Following robot, following control method and following control system |
CN113069094A (en) * | 2021-03-22 | 2021-07-06 | 浙江华彩光电科技有限公司 | Wearable appliance with explosion-proof abnormality detection and physiological early warning functions |
Also Published As
Publication number | Publication date |
---|---|
CN108544491B (en) | 2020-04-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Cheng et al. | Are we ready for unmanned surface vehicles in inland waterways? The usvinland multisensor dataset and benchmark | |
CN110673115B (en) | Combined calibration method, device, equipment and medium for radar and integrated navigation system | |
US6442476B1 (en) | Method of tracking and sensing position of objects | |
KR102159376B1 (en) | Laser scanning system, laser scanning method, mobile laser scanning system and program | |
CN107883932B (en) | Measurement system and method applicable to island and beach | |
CN108663681A (en) | Mobile Robotics Navigation method based on binocular camera Yu two-dimensional laser radar | |
CN103424112B (en) | A kind of motion carrier vision navigation method auxiliary based on laser plane | |
CN110889808B (en) | Positioning method, device, equipment and storage medium | |
EP4033324B1 (en) | Obstacle information sensing method and device for mobile robot | |
CN108544491A (en) | A kind of moving robot obstacle avoiding method considering distance and two factor of direction | |
CN113587930B (en) | Indoor and outdoor navigation method and device of autonomous mobile robot based on multi-sensor fusion | |
CN110427042A (en) | Unmanned plane low latitude barrier-avoiding method based on ultrasonic wave and binocular vision | |
CN112068152A (en) | Method and system for simultaneous 2D localization and 2D map creation using a 3D scanner | |
Kim et al. | Autonomous mobile robot localization and mapping for unknown construction environments | |
CN110645960A (en) | Distance measurement method, terrain following distance measurement method, obstacle avoidance distance measurement method and device | |
CN110864692A (en) | Pose determination method of heading machine | |
Csaba et al. | Differences between Kinect and structured lighting sensor in robot navigation | |
CN113607166B (en) | Indoor and outdoor positioning method and device for autonomous mobile robot based on multi-sensor fusion | |
CN114266821A (en) | Online positioning method and device, terminal equipment and storage medium | |
CN112731337B (en) | Map construction method, device and equipment | |
CN117308982A (en) | Positioning method and device for underwater cleaning robot of nuclear power station | |
Kim et al. | Development of an Autonomous Mobile Robot in the Outdoor Environments with a Comparative Survey of LiDAR SLAM | |
CN108663537B (en) | Offshore wind measuring method and system | |
US20220089166A1 (en) | Motion state estimation method and apparatus | |
CN105425246A (en) | Method for ship-borne integrated measurement system precision calibration in water pool |
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 |