CN105751216A - Method for determining security and feasibility of instruction of mobile robot - Google Patents
Method for determining security and feasibility of instruction of mobile robot Download PDFInfo
- Publication number
- CN105751216A CN105751216A CN201610231601.2A CN201610231601A CN105751216A CN 105751216 A CN105751216 A CN 105751216A CN 201610231601 A CN201610231601 A CN 201610231601A CN 105751216 A CN105751216 A CN 105751216A
- Authority
- CN
- China
- Prior art keywords
- instruction
- donor
- people
- robot
- overbar
- 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/1674—Programme controls characterised by safety, monitoring, diagnostic
- B25J9/1676—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)
- Manipulator (AREA)
Abstract
The invention discloses a method for determining the security and feasibility of an instruction of a mobile robot. The method comprises the following steps: with the robot as an origin A of a coordinate system, acquiring coordinates of others in a direction of an instruction sent by an authorizer; selecting a person of others, who is closest to the authorizer, and calculating an included angle theta between a connecting line of coordinates C of the person who is closest to the authorizer and the origin and a connecting line of coordinates B of the authorizer and the origin; calculating a protecting angel alpha of the authorizer and a protecting angle beta of the person who is closest to the authorizer; when the angle phi of the direction of the instruction sent by the authorizer satisfies a preset safety condition, determining that the instruction provided by the authorizer is safe and feasible. According to the method disclosed by the invention, active avoidance of others in a path of robot instruction execution can be avoided, the possibility of touching pedestrians who carry bulky goods when the robot moves can be avoided, the safety performance of the robot is increased, and the intelligence level of the robot is improved.
Description
Technical field
The present invention relates to mobile apparatus people field, particularly relate to the determination methods of mobile apparatus people's instruction secure feasibility.
Background technology
In complex indoor environment, such as Modern Laboratory, transportation logistics factory etc., mobile apparatus people is commonly used to replacement personnel and performs simple, dangerous, repeated task, to save substantial amounts of cost of human resources.In the indoor environment that Row control is loaded down with trivial details especially, as, in chemical laboratory, the utilization of mobile apparatus people can reduce scientific research personnel and contact the chance of dangerous materials, the accuracy of experiment can not only be ensured, and accident occurrence probability can be effectively reduced.
Man-machine interaction is the intelligentized important component part of mobile apparatus people, nowadays, the mankind are from by touch, such as media such as mouse, keyboard, buttons, machine carries out instruction develop into and assign various assignment instructions by the utilization of various sensors (such as sound transducer, infrared sensor etc.) to machine.The appearance of Microsoft's Kinect sensor, makes man-machine interaction mode step again major step, and under the interactive interface based on Kinect sensor exploitation, the person inherently can become controller.But people control robot move time; due to the sight line of people or the change of environment make people not predict circuit that robot moves whether safety; thus in order to ensure in robot traveling process, it is to avoid the pedestrian of touching carrying large piece article, it is necessary to a kind of method that can carry out instruction secure judgement.
Summary of the invention
Present invention aim at providing the determination methods of a kind of mobile apparatus people's instruction secure feasibility, to solve the technical problem being likely to touch the pedestrian of carrying large piece article when robot moves.
For achieving the above object, the invention provides the determination methods of a kind of mobile apparatus people's instruction secure feasibility, comprise the following steps:
S1: with the initial point A of the artificial coordinate system of machine, obtains instruction that donor sends towards other people upper coordinate;
S2: select people nearest from donor in other people, calculates from the angle theta between coordinate C and coordinate B and the line of initial point of initial point line and donor of the nearest people of donor;
S3: calculate the degree of protection α of donor and from the degree of protection β of the nearest people of donor;
S4: the instruction sent as donor towards angleWhen meeting preset security condition, it is determined that the instruction secure that donor provides can perform.
Further improvements in methods as the present invention:
Preferably, angle is worked asWhen being not 0, preset security condition is
Preferably, after step S4 completes, method also includes:
S5: if the instruction that sends of donor towards angleMeetJudging that the instruction that donor provides can not perform, robot stops, and provides feedback information and informs that donor's instruction can not perform, and waits next step instruction;
S6: if the instruction that sends of donor towards angleMeetThe people obtained from close to mandate person-time finds in robot:
S601: if do not found from the people close to mandate person-time, then it represents that instruction can not perform, and robot stops, and provides feedback information and informs that donor's instruction can not perform;
S602: if had from the people close to mandate person-time, obtain the coordinate D from the people close to mandate person-time, it is judged that ∠ BAD and ∠ BAC relation;
S603: if ∠ BAD < ∠ BAC andThen continually look for obtaining from the people close to donor's distance the 3rd, judge by step S601 to step S603 method in like manner;
S604: until the instruction that sends of donor has traveled through towards upper everyone.
Preferably, in step S2, the computing formula of angle theta is as follows:
Preferably, the computing formula of the degree of protection α of donor is:
Computing formula from the degree of protection β of the nearest people of donor is:
Wherein, r is default guard space.
Preferably, the distance of r is not less than 1/2nd of robot width.
Preferably, in step S4, when the instruction that donor sends can not immediately arrive at towards angleTime, determine angle according to following conditionSize:
S401: when θ-alpha-beta ≠ 0, then
S402: when θ-alpha-beta=0, then it represents that instruction can not perform, robot stops, and provides feedback information and informs that donor's instruction can not perform;Continue to travel through from small to large instruction by distance towards upper everyone.
Preferably, the initial point of coordinate system is the body-sensing sensing station that robot obtains image, and the coordinate of people is the coordinate of human body central point.
The method have the advantages that
1, the determination methods of mobile apparatus people's instruction secure feasibility of the present invention, while improving safety, avoid robot instruction perform path on other people carry out actively dodging robot, avoid the pedestrian being likely to touch carrying large piece article when robot moves, add the security performance of robot, and improve the intelligence degree of robot.
2, in a preferred approach, the determination methods of mobile apparatus people's instruction secure feasibility of the present invention, the best course while robot can perform instruction results, in energy intelligent selection instruction redundancy.
Except purpose described above, feature and advantage, the present invention also has other purpose, feature and advantage.Below with reference to accompanying drawings, the present invention is further detailed explanation.
Accompanying drawing explanation
The accompanying drawing constituting the part of the application is used for providing a further understanding of the present invention, and the schematic description and description of the present invention is used for explaining the present invention, is not intended that inappropriate limitation of the present invention.In the accompanying drawings:
Fig. 1 is the schematic flow sheet of the determination methods of mobile apparatus people's instruction secure feasibility of the preferred embodiment of the present invention;
The instruction secure feasibility that Fig. 2 is the preferred embodiment of the present invention judges various point locations schematic diagram;
Another instruction secure feasibility that Fig. 3 is the preferred embodiment of the present invention judges various point locations schematic diagram.
Detailed description of the invention
Below in conjunction with accompanying drawing, embodiments of the invention are described in detail, but the multitude of different ways that the present invention can be defined by the claims and cover is implemented.
Referring to Fig. 1, the determination methods of mobile apparatus people's instruction secure feasibility of the present invention, comprise the following steps:
S1: with the initial point A of the artificial coordinate system of machine, obtains instruction that donor sends towards other people upper coordinate;
S2: select people nearest from donor in other people, calculates from the angle theta between coordinate C and coordinate B and the line of initial point of initial point line and donor of the nearest people of donor;
S3: calculate the degree of protection α of donor and from the degree of protection β of the nearest people of donor;
S4: the instruction sent as donor towards angleWhen meeting preset security condition, it is determined that the instruction secure that donor provides can perform.
Pass through above-mentioned steps, robot can actively dodge donor's instruction instruction towards the people being above likely to be encountered, while safety being improved, avoid robot instruction perform path on other people carry out actively dodging robot, avoid the pedestrian being likely to touch carrying large piece article when robot moves, add the security performance of robot, and improve the intelligence degree of robot.
In actual applications, on the basis of above-mentioned steps, the determination methods of mobile apparatus people's instruction secure feasibility of the present invention also can increase following steps and be optimized, and is exemplified below:
The determination methods of mobile apparatus people's instruction secure feasibility of the present embodiment, comprises the following steps:
S1: with the initial point A of machine artificial coordinate system the body-sensing sensing station of image (initial point of coordinate system obtain for robot), obtains instruction that donor sends towards upper other people coordinate the coordinate of human body central point (coordinate of people be).
S2: select people nearest from donor in other people:
Referring to Fig. 2, make coordinate B (x1,y1,z1), C point (x2,y2,z2) and D point (x3,y3,z3).Then, first determine which people is nearest from donor, namely calculate the length (space coordinates is in equatorial projection distance) of line segment BC and BD respectively:
And compare size, select the shortest line segment, in fig. 2 we assume that C from B closer to.
Then calculate from the angle theta between coordinate C and coordinate B and the line of initial point of initial point line and donor of the nearest people of donor.The computing formula of angle theta is as follows:
Wherein,
S3: calculate the degree of protection α of donor and from the degree of protection β of the nearest people of donor.The computing formula of the degree of protection α of donor is:
Computing formula from the degree of protection β of the nearest people of donor is:
Wherein, r is default guard space.Namely robot by people at one's side time leave the distance of r, minima is 1/2nd robot width, and user can pass through to regulate the size of r and set level of security.In order to ensure in robot traveling process, it is to avoid the pedestrian of touching carrying large piece article, each pedestrian being preset a safe distance, is similar to and pedestrian has overlapped a protective cover, robot at least must keep this distance size with pedestrian.
S4: the instruction sent as donor towards angleWhen meeting preset security condition, it is determined that the instruction secure that donor provides can perform, namely reach the level of security preset.When the instruction that donor sends can immediately arrive at towards angleTime (when the instruction of donor has directly given angle), preset security condition isRobot want safety avoid donor B point and the right C point, then the orientation angle of the right advance of robot should between α and (θ-β).
S5: if the instruction that sends of donor towards angleMeetJudging that the instruction that donor provides can not perform, robot stops, and provides feedback information and informs that donor's instruction can not perform, and waits next step instruction.
S6: if the instruction that sends of donor towards angleMeetThe people obtained from close to mandate person-time finds in robot:
S601: if do not found from the people close to mandate person-time, then it represents that instruction can not perform, and robot stops, and provides feedback information and informs that donor's instruction can not perform;
S602: if had from the people close to mandate person-time, obtain the coordinate D from the people close to mandate person-time, it is judged that ∠ BAD and ∠ BAC relation;
S603: if ∠ BAD < ∠ BAC and(in Fig. 3 D point), then continually look for obtaining from the people close to donor's distance the 3rd, judges by step S601 to step S603 method in like manner;
S604: until the instruction that sends of donor has traveled through towards upper everyone.
That is: if ∠ BAD > ∠ is BAC (in Fig. 2 D point), then similar steps when repeating the above about closest people, similar calculating θ again1, γ1And γ2。
Wherein,
If then judging θ+γ1> φ > θ-β, then represent that instruction performs dangerous, it is not possible to perform, and feed back to donor.
If θ is+θ1-γ2≥φ≥θ+γ1, then represent that donor's instruction can perform, perform instruction.
If φ > θ is+θ1-γ2, then continue above-mentioned similar steps, first find except C, D point from people nearest for B, then proceed to repeat to judge.Until all people on the right side of donor of traversal or it has been determined that instruction cannot perform.
When the instruction that donor sends can not immediately arrive at towards angleTime (only provide when donor provides instruction and keep out of the way direction, it does not have provide concrete angular dimension), determine angle according to following conditionSize:
S401: when θ-alpha-beta ≠ 0, then
S402: when θ-alpha-beta=0, then it represents that instruction can not perform, robot stops, and provides feedback information and informs that donor's instruction can not perform;Continue to travel through from small to large instruction by distance towards upper everyone.As, it is assumed that θ1-γ2-γ1≠ 0, thenIf same θ1-γ2-γ1=0, continue Ergodic judgement, until existingOr when having traveled through everyone also without satisfiedValue, then illustrate do not have executable safe avoidance, feeds back to donor and waits next step instruction (such as direction etc. is dodged in donor's change).
In summary, the present invention is by the instruction calculating towards angle, and pedestrian arranges a safe distance, while robot can perform instruction results, and can best course in intelligent selection instruction redundancy.
The foregoing is only the preferred embodiments of the present invention, be not limited to the present invention, for a person skilled in the art, the present invention can have various modifications and variations.All within the spirit and principles in the present invention, any amendment of making, equivalent replacement, improvement etc., should be included within protection scope of the present invention.
Claims (8)
1. the determination methods of mobile apparatus people's instruction secure feasibility, it is characterised in that comprise the following steps:
S1: with the initial point A of the artificial coordinate system of machine, obtains instruction that donor sends towards other people upper coordinate;
S2: select described in other people from the people that donor is nearest, calculate the angle theta between coordinate C and coordinate B and the line of initial point of initial point line and donor of the described people nearest from donor;
S3: calculate the degree of protection α of donor and the degree of protection β of the described people nearest from donor;
S4: the instruction sent as donor towards angleWhen meeting preset security condition, it is determined that the instruction secure that donor provides can perform.
2. determination methods according to claim 1, it is characterised in that when the instruction that donor sends can immediately arrive at towards angleTime, preset security condition is
3. determination methods according to claim 2, it is characterised in that after described step S4 completes, described method also includes:
S5: if the instruction that sends of donor towards angleMeetJudging that the instruction that donor provides can not perform, robot stops, and provides feedback information and informs that donor's instruction can not perform, and waits next step instruction;
S6: if the instruction that sends of donor towards angleMeetThe people obtained from close to mandate person-time finds in robot:
S601: if do not found from the people close to mandate person-time, then it represents that instruction can not perform, and robot stops, and provides feedback information and informs that donor's instruction can not perform;
S602: if had from the people close to mandate person-time, obtain the coordinate D of described people close to mandate person-time, it is judged that described ∠ BAD and ∠ BAC relation;
S603: if ∠ BAD < ∠ BAC andThen continually look for obtaining from the people close to donor's distance the 3rd, judge by step S601 to step S603 method in like manner;
S604: until the instruction that sends of donor has traveled through towards upper everyone.
4. determination methods according to any one of claim 1 to 3, it is characterised in that in described step S2, the computing formula of angle theta is as follows:
5. determination methods according to any one of claim 1 to 3, it is characterised in that the computing formula of the degree of protection α of described donor is:
The computing formula of the degree of protection β of the described people nearest from donor is:
Wherein, r is default guard space.
6. determination methods according to claim 5, it is characterised in that the distance of described r is not less than 1/2nd of robot width.
7. determination methods according to claim 3, it is characterised in that in described step S4, when the instruction that donor sends can not immediately arrive at towards angleTime, determine described angle according to following conditionSize:
S401: when θ-alpha-beta ≠ 0, then
S402: when θ-alpha-beta=0, then it represents that instruction can not perform, robot stops, and provides feedback information and informs that donor's instruction can not perform;Continue to travel through from small to large described instruction by distance towards upper everyone.
8. determination methods according to claim 3, it is characterised in that the initial point of described coordinate system is the body-sensing sensing station that described robot obtains image, and the coordinate of described people is the coordinate of human body central point.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610231601.2A CN105751216B (en) | 2016-04-14 | 2016-04-14 | The determination methods of mobile robot instruction secure feasibility |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610231601.2A CN105751216B (en) | 2016-04-14 | 2016-04-14 | The determination methods of mobile robot instruction secure feasibility |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105751216A true CN105751216A (en) | 2016-07-13 |
CN105751216B CN105751216B (en) | 2017-10-10 |
Family
ID=56334940
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610231601.2A Expired - Fee Related CN105751216B (en) | 2016-04-14 | 2016-04-14 | The determination methods of mobile robot instruction secure feasibility |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105751216B (en) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2020108293A1 (en) * | 2018-11-29 | 2020-06-04 | 深圳前海达闼云端智能科技有限公司 | Control method, related apparatus, and storage medium |
WO2021114223A1 (en) * | 2019-12-13 | 2021-06-17 | 原见精机股份有限公司 | Automatic device and safety apparatus thereof |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH05297937A (en) * | 1992-02-10 | 1993-11-12 | Honda Motor Co Ltd | Obstacle evading route searching method for mobile object |
US5502638A (en) * | 1992-02-10 | 1996-03-26 | Honda Giken Kogyo Kabushiki Kaisha | System for obstacle avoidance path planning for multiple-degree-of-freedom mechanism |
CN101738195A (en) * | 2009-12-24 | 2010-06-16 | 厦门大学 | Method for planning path for mobile robot based on environmental modeling and self-adapting window |
CN104375505A (en) * | 2014-10-08 | 2015-02-25 | 北京联合大学 | Robot automatic road finding method based on laser ranging |
CN105171752A (en) * | 2015-09-10 | 2015-12-23 | 刘玉伟 | Robot system and method thereof |
CN105486311A (en) * | 2015-12-24 | 2016-04-13 | 青岛海通机器人系统有限公司 | Indoor robot positioning navigation method and device |
-
2016
- 2016-04-14 CN CN201610231601.2A patent/CN105751216B/en not_active Expired - Fee Related
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH05297937A (en) * | 1992-02-10 | 1993-11-12 | Honda Motor Co Ltd | Obstacle evading route searching method for mobile object |
US5502638A (en) * | 1992-02-10 | 1996-03-26 | Honda Giken Kogyo Kabushiki Kaisha | System for obstacle avoidance path planning for multiple-degree-of-freedom mechanism |
CN101738195A (en) * | 2009-12-24 | 2010-06-16 | 厦门大学 | Method for planning path for mobile robot based on environmental modeling and self-adapting window |
CN104375505A (en) * | 2014-10-08 | 2015-02-25 | 北京联合大学 | Robot automatic road finding method based on laser ranging |
CN105171752A (en) * | 2015-09-10 | 2015-12-23 | 刘玉伟 | Robot system and method thereof |
CN105486311A (en) * | 2015-12-24 | 2016-04-13 | 青岛海通机器人系统有限公司 | Indoor robot positioning navigation method and device |
Non-Patent Citations (1)
Title |
---|
胡远航: "未知环境下自主移动机器人避障研究", 《中国优秀硕士学位论文全文数据库信息科技辑》 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2020108293A1 (en) * | 2018-11-29 | 2020-06-04 | 深圳前海达闼云端智能科技有限公司 | Control method, related apparatus, and storage medium |
WO2021114223A1 (en) * | 2019-12-13 | 2021-06-17 | 原见精机股份有限公司 | Automatic device and safety apparatus thereof |
Also Published As
Publication number | Publication date |
---|---|
CN105751216B (en) | 2017-10-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Wang et al. | Interactive and immersive process-level digital twin for collaborative human–robot construction work | |
CN106774380B (en) | Unmanned vehicle plane automatic obstacle avoiding method under a kind of dynamic uncertain environments | |
JP6682508B2 (en) | Positioning and mapping apparatus and method | |
JP2020046773A (en) | Robot, action planning device, and action planning program | |
Flacco et al. | Multiple depth/presence sensors: Integration and optimal placement for human/robot coexistence | |
CN105751216A (en) | Method for determining security and feasibility of instruction of mobile robot | |
CN105000476A (en) | Unmanned crane space collision avoidance strategy based on fuzzy decision inference | |
JP7125743B2 (en) | Robot, its action planning device and action planning program | |
Gil et al. | Installation of heavy duty glass using an intuitive manipulation device | |
KR20160010353A (en) | Method and device for controlling a robot | |
Zhang et al. | An efficient centralized planner for multiple automated guided vehicles at the crossroad of polynomial curves | |
KR20150092441A (en) | Method for user Authentication through touch dragging, device therefor | |
CN114859914A (en) | Obstacle detection method, apparatus, device and storage medium | |
Ohki et al. | Local path planner for mobile robot in dynamic environment based on distance time transform method | |
JP2020046779A (en) | Robot, action planning device, and action planning program | |
US10768606B2 (en) | Agent-based slicing | |
CN104978081A (en) | Method for determining touch position of touch control screen and touch control device | |
CN110825083B (en) | Control method, apparatus, and computer-readable storage medium for vehicle | |
WO2014045521A1 (en) | Placement score calculation system, method, and program | |
CN112306049A (en) | Autonomous robot, obstacle avoidance method and device thereof, and storage medium | |
Yoon et al. | Effects of spatial characteristics on the human–robot communication using deictic gesture in construction | |
JP2011060179A (en) | Steering control method | |
CN104007865A (en) | Recognition method and electronic device | |
Mayyas et al. | Fenceless obstacle avoidance method for efficient and safe human–robot collaboration in a shared work space | |
Ayedi et al. | A multiagent architecture for mobile robot navigation using hierarchical fuzzy and sliding mode controllers |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20171010 Termination date: 20190414 |