CN110456802A - A kind of method that mobile robot safely and fast crosses gate - Google Patents

A kind of method that mobile robot safely and fast crosses gate Download PDF

Info

Publication number
CN110456802A
CN110456802A CN201910816969.9A CN201910816969A CN110456802A CN 110456802 A CN110456802 A CN 110456802A CN 201910816969 A CN201910816969 A CN 201910816969A CN 110456802 A CN110456802 A CN 110456802A
Authority
CN
China
Prior art keywords
mobile robot
gate
mobile
safely
lead
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
Application number
CN201910816969.9A
Other languages
Chinese (zh)
Other versions
CN110456802B (en
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.)
Shanghai Has A Robot Co Ltd
Shanghai Yogo Robot Co Ltd
Original Assignee
Shanghai Has A 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 Shanghai Has A Robot Co Ltd filed Critical Shanghai Has A Robot Co Ltd
Priority to CN201910816969.9A priority Critical patent/CN110456802B/en
Publication of CN110456802A publication Critical patent/CN110456802A/en
Application granted granted Critical
Publication of CN110456802B publication Critical patent/CN110456802B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0242Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using non-visible light signals, e.g. IR or UV signals

Landscapes

  • Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • Electromagnetism (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

The present invention relates to internet of things field, the method that specifically a kind of mobile robot safely and fast crosses gate, includes following steps: step S1: passing through the distance of distance measuring sensor acquisition mobile robot to gate two sides;Step S2: by gate entrance, the initial yaw angle Ψ of gyroscope0As lead, current yaw angle Ψ is calculated in real time1With the misalignment angle Ψ of lead2;Step S3: moveable robot movement angular speed is adjusted by the deviation in two sides range difference and lead;Step S4: judging whether have pedestrian or gate gate resistance to keep off on gate direction using distance measuring sensor detection and lead, be, return step S3, no, progress step S5;Step S5: mobile robot is judged at present whether by gate using encoder information, is then to accelerate to defined operation linear velocity V0 traveling, otherwise return step S3.The present invention can guarantee mobile robot can safely and fast by gate, can be improved Internet of Things conevying efficiency.

Description

A kind of method that mobile robot safely and fast crosses gate
Technical field
The present invention relates to internet of things field, specifically a kind of mobile robot safely and fast cross gate method.
Background technique
The every field of present production, processing, transport, Internet of Things transport proportion is increasing, under Internet of Things The mobile robot that mobile robot has needs to realize transport of each workshop perhaps between warehouse and factory or the storehouse at place Many positions in library in order to increase many gates safely, since guarantee warehouse safe coefficient, since gate width is general It is relatively narrow, robot width itself is added, enough accuracy is unable to reach by the motion algorithm of general positioning and path and guarantees Robot safely and fast can pass through gate.
Summary of the invention
The purpose of the present invention is to provide a kind of methods that mobile robot safely and fast crosses gate, to solve above-mentioned background The problem of being proposed in technology.
The technical scheme is that
A kind of method that mobile mobile robot safely and fast crosses gate, includes following steps:
Step S1: pass through the distance of distance measuring sensor acquisition mobile robot to gate two sides;
Step S2: by gate entrance, the initial yaw angle Ψ of gyroscope0As lead, calculates work as in real time Preceding yaw angle Ψ1With the misalignment angle Ψ of lead2
Step S3: moveable robot movement angular speed is adjusted by the deviation in two sides range difference and lead;
Step S4: judge whether there is pedestrian or gate door on gate direction using distance measuring sensor detection and lead Stop, is, return step S3, no, progress step S5;
Step S5: judge mobile robot at present whether by gate using encoder information, be then accelerate to it is defined Linear velocity V0 traveling is run, otherwise return step S3.
Further, mobile robot operation linear velocity V respectively with barrier in mobile robot to lead Distance and mobile robot angular speed it is directly proportional.
Further, in the step S3, detection mobile robot is to the distance L1 and L2 of gate two sides, wherein L1 and L2 The sum of whether be greater than mobile robot width K, be then to carry out step S3, it is no, then mobile robot stop.
Further, in the step S2, the misalignment angle Ψ of lead201, gyroscope rotates clockwise Direction is positive direction, and gyroscope is counterclockwise, and direction of rotation is negative direction.
Further, in the step S3, as misalignment angle Ψ2For timing, mobile robot rotates counterclockwise and deviation The identical angle of angle value, as misalignment angle Ψ2When being negative, mobile robot is rotated clockwise.
Further, in the step S4, when judging to have on gate direction pedestrian or gate gate resistance gear, mobile robot Stop mobile and be delayed after 1S, carries out step S3 again.
Further, the encoder detects whether mobile robot operation linear velocity V accelerates and reach defined fortune 0.7 times of line speed V0 is that then mobile robot passes through gate completely, no, then return step S3.
Further, the distance measuring sensor is infrared distance sensor.
The present invention provides a kind of method that mobile robot safely and fast crosses gate by improving herein, with prior art phase Than, have the advantages that as follows improve and:
First, when the present invention enables to mobile robot close to gate, adjust automatically displacement direction guarantees Mobile robot safely and fast can pass through gate.
Second, the present invention can be improved Internet of Things conevying efficiency, mobile robot is reduced in the fault of the process of transport.
Detailed description of the invention
The present invention is further explained with reference to the accompanying drawings and examples:
Fig. 1 is logic judgment block diagram of the invention;
Fig. 2 is the logic judgment block diagram of step S3 of the present invention;
Fig. 3 is schematic diagram of the mobile robot of the present invention by gate;
Detailed description of the invention label: gate 1, mobile robot 2, gyroscope rotate clockwise direction 3.
Specific embodiment
The present invention is described in detail below, and technical solution in the embodiment of the present invention is clearly and completely retouched It states, it is clear that described embodiments are only a part of the embodiments of the present invention, instead of all the embodiments.Based on the present invention In embodiment, every other implementation obtained by those of ordinary skill in the art without making creative efforts Example, shall fall within the protection scope of the present invention.
(direction that the +X direction in text is the gate lateral distance L1 that mobile robot is directed toward, +Y direction are mobile machine People is by the direction of gate, as shown in the coordinate system of Fig. 3)
The present invention provides a kind of method that mobile robot safely and fast crosses gate by improving herein:
As shown in Figure 1 to Figure 3, a kind of method that mobile mobile robot safely and fast crosses gate, includes following steps:
Step S1: the distance that mobile robot 2 arrives 1 two sides of gate, the distance measuring sensor are obtained by distance measuring sensor Model can use optical ranging sensor and acoustics distance measuring sensor;
Step S2: by 1 entrance of gate, the initial yaw angle Ψ of gyroscope0As lead, calculates work as in real time Preceding yaw angle Ψ1With the misalignment angle Ψ of lead2, according to misalignment angle Ψ2, can calculate current kinetic direction with can By the angle of the direction of motion of gate 1, so that judgement needs that mobile robot 2 is driven to rotate that how many angle enable to move The direction of motion of robot 2 is correct;
Step S3: 2 angular velocity of satellite motion of mobile robot, root are adjusted by the deviation in two sides range difference and lead According to two sides range difference and misalignment angle Ψ2, it calculates and moves out forward under the premise of portion deviates itself track route, it can It is moved along distance L, L=| L1-L2 | tan (90 ° of-ψ2), the motion morphology of mobile robot 2 can be adjusted, so Accurately adjustment 2 angular velocity of satellite motion of mobile robot and movement linear velocity, guarantee mobile robot 2 safely and fast can pass through lock afterwards Machine 1 moves if adjusted without lead, will lead to robot and oscillates in the channel concussion.
When L1-L2 > 0 and misalignment angle Ψ 2 > 0,2 counter-rotating of mobile robot, so that mobile robot 2 is inclined Boat is contended and gradually resets to initial Ψ0, mobile robot 2 is along+X and the shifting of arctan [L/L2-L1] direction vector of +Y direction It is dynamic.
When L1-L2>0 and misalignment angle Ψ 2<0, mobile robot 2 is rotated in the forward direction, so that mobile robot 2 is inclined Boat is contended and gradually resets to initial Ψ0, mobile robot 2 is along+X and the shifting of arctan [L/L2-L1] direction vector of +Y direction It is dynamic.
As L1-L2<0 and misalignment angle Ψ 2>0,2 counter-rotating of mobile robot, so that mobile robot 2 is inclined Boat is contended and gradually resets to initial Ψ0, mobile robot 2 is along+X and the shifting of arctan [L/L1-L2] direction vector of +Y direction It is dynamic.
When L1-L2 < 0 and misalignment angle Ψ 2 < 0, mobile robot 2 is rotated in the forward direction, so that mobile robot 2 is inclined Boat is contended and gradually resets to initial Ψ0, mobile robot 2 is along+X and the shifting of arctan [L/L1-L2] direction vector of +Y direction It is dynamic.
Step S4: judge whether there is pedestrian or gate 1 on 1 direction of gate using distance measuring sensor detection and lead Gate resistance gear is that return step S3, no, progress step S5, step S4, which can be avoided, safety accident occurs.
Whether step S5: judging mobile robot 2 at present using encoder information, by gate 1, is then to accelerate to regulation Operation linear velocity V0 traveling, otherwise return step S3, the encoder is rotating detector, being capable of real-time detection moving machine The angular speed of 2 drive shaft of device people, when mobile robot 2 is when by gate 1, speed is the smallest, the drive of mobile robot 2 The angular speed of moving axis starts to accelerate and reache a certain level, then it represents that mobile robot 2 passes through gate 1 completely.
The mobile robot 2 run linear velocity V respectively at a distance from barrier in mobile robot 2 to lead and The angular speed of mobile robot 2 is directly proportional, closer from barrier, and speed is smaller, and the bigger linear velocity of Schemes of Angular Velocity Estimation for Robots is smaller.
In the step S3, detection mobile robot 2 arrives the distance L1 and L2 of 1 two sides of gate, and wherein the sum of L1 and L2 are The no width K greater than mobile robot 2 is then to carry out step S3, no, then mobile robot stops.
In the step S2, the misalignment angle Ψ of lead201, gyroscope rotates clockwise direction 3 and is positive Direction, gyroscope is counterclockwise, and direction of rotation is negative direction.
In the step S3, as misalignment angle Ψ2For timing, mobile robot 2 rotates counterclockwise and angle of deviation angle value phase Same angle, as misalignment angle Ψ2When being negative, mobile robot 2 is rotated clockwise, according to misalignment angle Ψ2Positive and negative values, come Judge mobile robot 2 is biased to which side of gate 1.
In the step S4, when judging there is pedestrian or 1 gate resistance of gate gear on 1 direction of gate, mobile robot 2 stops moving It moves and is delayed after 1S, carry out step S3 again, step S4, which can be avoided, safety accident occurs.
The encoder detects that mobile robot 2 runs whether linear velocity V accelerates and reach defined operation linear velocity 0.7 times of V0 is that then mobile robot 2 is no completely by gate 1, then return step S3, and encoder information is in a small range Error is smaller, can use to determine whether passing through gate 1 completely.
The distance measuring sensor is infrared distance sensor, and measurement range is wide, and the response time is short, is mainly used in modern section Skill, infrared distance sensor have a pair of of infrared signal transmitting and reception diode, the infrared distance sensor LDM301 utilized Launch a branch of infrared light, form the process of a reflection after being irradiated to object, is reflected into sensor and is followed by the collection of letters number, then The data for receiving transmitting with received time difference are handled using ccd image.Calculated after signal processor processes object away from From.
The foregoing description of the disclosed embodiments enables those skilled in the art to implement or use the present invention. Various modifications to these embodiments will be readily apparent to those skilled in the art, as defined herein General Principle can be realized in other embodiments without departing from the spirit or scope of the present invention.Therefore, of the invention It is not intended to be limited to the embodiments shown herein, and is to fit to and the principles and novel features disclosed herein phase one The widest scope of cause.

Claims (8)

1. a kind of method that mobile mobile robot safely and fast crosses gate, it is characterised in that: include following steps:
Step S1: mobile robot (2) is attached with intelligent mobile terminal, obtains mobile robot by distance measuring sensor (2) distance of gate (1) two sides is arrived;
Step S2: by gate (1) entrance, with the initial yaw angle Ψ of gyroscope0As lead, calculates work as in real time Preceding yaw angle Ψ1With the misalignment angle Ψ of lead2
Step S3: mobile robot (2) angular velocity of satellite motion is adjusted by the deviation in two sides range difference and lead;
Step S4: judge whether there is pedestrian or gate (1) on gate (1) direction using distance measuring sensor detection and lead Gate resistance gear is return step S3, no, progress step S5;
Whether step S5: judging mobile robot (2) at present using encoder information, by gate (1), is then to accelerate to regulation Operation linear velocity V0It travels, otherwise return step S3.
2. the method that a kind of mobile mobile robot according to claim 1 safely and fast crosses gate, it is characterised in that: institute Mobile robot (2) operation linear velocity V is stated respectively at a distance from mobile robot (2) to barrier in lead and moving machine The angular speed of device people (2) is directly proportional.
3. the method that a kind of mobile mobile robot according to claim 1 safely and fast crosses gate, it is characterised in that: institute It states in step S3, the distance L1 and L2 of gate (1) two sides are arrived in detection mobile robot (2), and wherein whether the sum of L1 and L2 are greater than The width K of mobile robot (2) is then to carry out step S3, no, then mobile robot stops.
4. the method that a kind of mobile mobile robot according to claim 1 safely and fast crosses gate, it is characterised in that: institute It states in step S2, the misalignment angle Ψ of lead201, it is positive direction, gyro that gyroscope, which rotates clockwise direction (3), Instrument is counterclockwise, and direction of rotation is negative direction.
5. the method that a kind of mobile mobile robot according to claim 4 safely and fast crosses gate, it is characterised in that: institute It states in step S3, as misalignment angle Ψ2For timing, mobile robot (2) rotates angle identical with angle of deviation angle value counterclockwise, As misalignment angle Ψ2When being negative, mobile robot (2) is rotated clockwise.
6. the method that a kind of mobile mobile robot according to claim 1 safely and fast crosses gate, it is characterised in that: institute It states in step S4, when judging there is pedestrian or gate (1) gate resistance gear on gate (1) direction, mobile robot (2) stopping is mobile simultaneously It is delayed after 1S, carries out step S3 again.
7. the method that a kind of mobile mobile robot according to claim 1 safely and fast crosses gate, it is characterised in that: institute It states encoder and detects whether mobile robot (2) operation linear velocity V accelerates and reach defined to run linear velocity V00.7 Times, it is that then mobile robot (2) is no completely by gate (1), then return step S3.
8. the method that a kind of mobile mobile robot according to claim 1 safely and fast crosses gate, it is characterised in that: institute Stating distance measuring sensor is infrared distance sensor.
CN201910816969.9A 2019-08-30 2019-08-30 Method for safely and quickly passing gate by mobile robot Active CN110456802B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910816969.9A CN110456802B (en) 2019-08-30 2019-08-30 Method for safely and quickly passing gate by mobile robot

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910816969.9A CN110456802B (en) 2019-08-30 2019-08-30 Method for safely and quickly passing gate by mobile robot

Publications (2)

Publication Number Publication Date
CN110456802A true CN110456802A (en) 2019-11-15
CN110456802B CN110456802B (en) 2020-08-25

Family

ID=68490166

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910816969.9A Active CN110456802B (en) 2019-08-30 2019-08-30 Method for safely and quickly passing gate by mobile robot

Country Status (1)

Country Link
CN (1) CN110456802B (en)

Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20110167589A1 (en) * 2010-01-14 2011-07-14 International Business Machines Corporation Robotic safety stop for automated storage library
CN103076804A (en) * 2012-12-27 2013-05-01 深圳先进技术研究院 Automatic guide vehicle, automatic guide system and navigation method based on ultrasonic range finder
JP5449952B2 (en) * 2009-09-29 2014-03-19 Cyberdyne株式会社 Autonomous traveling robot and control system for autonomous traveling robot
CN105487510A (en) * 2015-12-18 2016-04-13 中国印钞造币总公司 Locus guiding method and apparatus of mobile scanning vehicle in stack zone environment
CN105717928A (en) * 2016-04-26 2016-06-29 北京进化者机器人科技有限公司 Vision-based robot navigation door-passing method
CN105867372A (en) * 2016-04-07 2016-08-17 重庆大学 Turning motion planning method and system of omni-directional mobile robot under narrow right-angled bend condition
CN106200645A (en) * 2016-08-24 2016-12-07 北京小米移动软件有限公司 Autonomous robot, control device and control method
CN106313114A (en) * 2016-08-30 2017-01-11 四川超影科技有限公司 Door-passing system and method for indoor inspection robot
CN107065870A (en) * 2017-03-31 2017-08-18 深圳诺欧博智能科技有限公司 Mobile robot autonomous navigation system and method
CN107742304A (en) * 2017-10-10 2018-02-27 广州视源电子科技股份有限公司 Method and device for determining movement track, mobile robot and storage medium
CN108607174A (en) * 2018-08-21 2018-10-02 四川中科领格科技有限公司 Rope rescue robot
CN110083150A (en) * 2019-01-21 2019-08-02 苏州乐轩科技有限公司 Robot and robot control method

Patent Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP5449952B2 (en) * 2009-09-29 2014-03-19 Cyberdyne株式会社 Autonomous traveling robot and control system for autonomous traveling robot
US20110167589A1 (en) * 2010-01-14 2011-07-14 International Business Machines Corporation Robotic safety stop for automated storage library
CN103076804A (en) * 2012-12-27 2013-05-01 深圳先进技术研究院 Automatic guide vehicle, automatic guide system and navigation method based on ultrasonic range finder
CN105487510A (en) * 2015-12-18 2016-04-13 中国印钞造币总公司 Locus guiding method and apparatus of mobile scanning vehicle in stack zone environment
CN105867372A (en) * 2016-04-07 2016-08-17 重庆大学 Turning motion planning method and system of omni-directional mobile robot under narrow right-angled bend condition
CN105717928A (en) * 2016-04-26 2016-06-29 北京进化者机器人科技有限公司 Vision-based robot navigation door-passing method
CN106200645A (en) * 2016-08-24 2016-12-07 北京小米移动软件有限公司 Autonomous robot, control device and control method
CN106313114A (en) * 2016-08-30 2017-01-11 四川超影科技有限公司 Door-passing system and method for indoor inspection robot
CN107065870A (en) * 2017-03-31 2017-08-18 深圳诺欧博智能科技有限公司 Mobile robot autonomous navigation system and method
CN107742304A (en) * 2017-10-10 2018-02-27 广州视源电子科技股份有限公司 Method and device for determining movement track, mobile robot and storage medium
CN108607174A (en) * 2018-08-21 2018-10-02 四川中科领格科技有限公司 Rope rescue robot
CN110083150A (en) * 2019-01-21 2019-08-02 苏州乐轩科技有限公司 Robot and robot control method

Non-Patent Citations (4)

* Cited by examiner, † Cited by third party
Title
IÑAKI MONASTERIO等: "Learning to traverse doors using visual information", 《MATHEMATICS AND COMPUTERS IN SIMULATION》 *
MAURICE R. MASLIAH等: "The Mobile Robot Surrogate Method for Developing Autonomy", 《IEEE TRANSACTIONS ON ROBOTICS AND AUTOMATION》 *
李新征等: "基于视觉的机器人定位精度提高方法", 《计算机测量与控制》 *
李新征等: "基于视觉的移动机器人的过门研究", 《中国自动化与信息技术研讨会暨2004年学术年会论文集》 *

Also Published As

Publication number Publication date
CN110456802B (en) 2020-08-25

Similar Documents

Publication Publication Date Title
CN106527432B (en) The indoor mobile robot cooperative system corrected certainly based on fuzzy algorithmic approach and two dimensional code
TWI676875B (en) AGV control system and control method, AGV system
US4939651A (en) Control method for an unmanned vehicle (robot car)
US9164512B2 (en) Autonomous moving body and control method thereof
CN112068570B (en) Robot movement control method and device and robot
CN108759829B (en) Local obstacle avoidance path planning method for intelligent forklift
CN106843212A (en) Automatic Pilot is based on the emergency vehicle auxiliary directional system and method for yaw angle amendment
CN106203341B (en) A kind of Lane detection method and device of unmanned vehicle
CN104773430B (en) Automatic stereoscopic warehouse positioning control system and control method thereof
CN112540602B (en) Robot local path optimization method and robot
CN113064430A (en) Quality inspection trolley obstacle avoidance and path planning algorithm based on Android mobile phone
US11762390B1 (en) Autonomous machine safety management in a dynamic environment
CN110456802A (en) A kind of method that mobile robot safely and fast crosses gate
CN105356060B (en) The scan control method of azimuth axis of antenna when a kind of communication in moving seeks star
CN111538334B (en) Path tracking system of AGV dolly
CN115314996B (en) Method for rapidly acquiring WIFI wireless signal coverage based on track inspection robot
CN112849895B (en) Shuttle rail changing-based scheduling method and device
US20210114212A1 (en) Robot control method and robot control device
CN110370278B (en) Route adjusting system and method based on industrial robot jitter analysis
CN203759542U (en) Wheel running gear capable of realizing free path running
Jochem et al. Vision based intersection navigation
JP6866781B2 (en) Mobile vehicle
CN103899881B (en) For the automatic deviation correction controlling method of tube cleaning arrangement
TWI721428B (en) Method of detecting obstacles by transportation vehicle having pitching angle-adjustable laser detection device
CN207339713U (en) A kind of intelligent machine garage bar code scan and the vector control system of encoder positioning

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