CN105511466B - AGV localization method and system based on two dimensional code band - Google Patents

AGV localization method and system based on two dimensional code band Download PDF

Info

Publication number
CN105511466B
CN105511466B CN201510876265.2A CN201510876265A CN105511466B CN 105511466 B CN105511466 B CN 105511466B CN 201510876265 A CN201510876265 A CN 201510876265A CN 105511466 B CN105511466 B CN 105511466B
Authority
CN
China
Prior art keywords
dimensional code
agv
speed
band
code band
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.)
Expired - Fee Related
Application number
CN201510876265.2A
Other languages
Chinese (zh)
Other versions
CN105511466A (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 Jiaotong University
Original Assignee
Shanghai Jiaotong University
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 Jiaotong University filed Critical Shanghai Jiaotong University
Priority to CN201510876265.2A priority Critical patent/CN105511466B/en
Publication of CN105511466A publication Critical patent/CN105511466A/en
Application granted granted Critical
Publication of CN105511466B publication Critical patent/CN105511466B/en
Expired - Fee Related 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/0246Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Multimedia (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

A kind of AGV localization method and system based on two dimensional code band, by being laid with continuous two dimensional code band in the track side of AGV, by the two dimensional code on the two dimensional code position sensor periodic reading two dimensional code band for the front-wheel side for being set to AGV, the position in orbit AGV is obtained accordingly, difference is carried out by the absolute position values to obtained two dimensional code, differential speed signal is obtained, digital signal filter then is carried out to differential speed signal, obtains accurate AGV real-time speed and location information.By the present invention in that with the Absolute position measurement method of two dimensional code band, absolute position of the AGV on any track can not only be calculated, the speed of AGV can be calculated in real time simultaneously, and it can be according to external demand for control, it is mobile with desired speed control AGV, or control AGV and stop surely to specified absolute position.

Description

AGV localization method and system based on two dimensional code band
Technical field
The present invention relates to a kind of technology of automation field, specifically a kind of AGV (homing guidance based on two dimensional code band Transport vehicle) positioning and speed control system.
Background technique
In existing rail mounted AGV application occasion, AGV is moved along fixed track, and track both sides are mutual with player Dynamic 3D game, in order to obtain preferable experience effect, 3D game needs to know the accurate real time position and in real time of AGV Speed is smaller with the position deviation in 3D game in order to control AGV movement, it is desirable that position accurate control AGV in orbit It sets and speed.
Existing AGV localization method mainly includes machine vision or method for ultrasonic locating.Chinese patent literature number CN104181920A, discloses a kind of AGV positioning system based on machine vision, passes through open (bulletin) day 2014.12.03 It is laid with the label of several fixations on the ground, is acquired and is marked with camera, carries out image procossing, calculates the position of AGV.It is Chinese special Sharp document number CN104155977A, open (bulletin) day 2014.11.09, it is open it is a kind of pass through method for ultrasonic locating, by Ultrasonic distance detector is placed in several corners of AGV vehicle, measures the position of AGV.These methods are mainly used for position measurement, but It is low measurement accuracy, and does not can be carried out precise speed measurement, accurate position can not be carried out during AGV dynamic mobile The position and speed control of AGV entirety is realized in measurement and tachometric survey.
Summary of the invention
The present invention In view of the above shortcomings of the prior art, propose a kind of AGV localization method based on two dimensional code band and System, by pasting two dimensional code band in orbit, the position of real-time measurement AGV can be obtained by Digital Signal Processing than calibrated The position and speed signal of true AGV, the present invention can the 3D game to track two sides provide itself accurate real time position and Real-time speed, and can stop in designated position, and can be with command speed even running in track according to game scripts On.
The present invention is achieved by the following technical solutions:
The present invention relates to a kind of AGV localization methods based on two dimensional code band, by being laid with continuous two in the track side of AGV Code band is tieed up, by the two dimensional code on the two dimensional code position sensor periodic reading two dimensional code band for the front-wheel side for being set to AGV, according to This obtains the position in orbit AGV, carries out difference by the absolute position values to obtained two dimensional code, obtains difference speed Then signal carries out digital signal filter to differential speed signal, obtains accurate AGV real-time speed and location information.
The front-wheel of the AGV is erected on guide rail, and front-wheel can only move in orbit, and two dimensional code position sensor is fixed In the side of front-wheel;
Position ring or speed by PID is arranged by the overall situation preferably after obtaining real-time speed and location information in the AGV Control realizes positioning or speed control to AGV on orbital position and can determine to stop to specified in AGV ramp to stop Target position.
Specific step is as follows by the present invention.
Step 1 is laid with whole process along orbital direction, when track road in the single-sided arrangement two dimensional code band band of I-shaped track Line is annular, and two dimensional code band sequestration site and two dimensional code are started position overlapping, and are recorded two dimensional code initial value and two dimensional code band and cut Only it is worth.
The sample frequency of the position data of two dimensional code position sensor, the absolute position of periodic reading AGV is arranged in step 2 It sets, difference is carried out according to eve position data and the position data at the latter moment, records the position signal of period AGV And differential speed signal.
Step 3 carries out digital signal filter to collected position signal and differential speed signal, obtains accurate position Set value and velocity amplitude.
Preferably, after step 3 obtains accurate positional value and velocity amplitude, according to default Script controlling AGV with specified Speed runs to specified position and stops, and the actual speed of itself and physical location are fed back to 3D game and missed on interface Difference amendment.
The error correction, i.e. the position and speed requirement according to 3D game scripts to AGV, controller is according to AGV's Operating status controls using speed by PID or stops surely position algorithm.
The present invention relates to a kind of systems for realizing the above method, comprising: is set to two dimensional code band on AGV track, setting In the two dimensional code position sensor on AGV idler wheel and it is attached thereto and obtains the control module of two-dimensional barcode information, in which:
The two dimensional code band is rearranged by several independent two dimensional codes, and each two dimensional code includes its absolute position Value.
The length and width of the two dimensional code are 1cm, adjacent two dimension code interval 5mm.
The two dimensional code band is preferably disposed on the height and position of the 8cm on close ground on AGV guide rail.
The two dimensional code position sensor is based on image-capable and to calculate the biography of two dimensional code absolute position Sensor, two dimensional code position sensor are set to the guide wheel side of AGV guide rail, and two dimensional code position sensor is with two dimensional code band spacing 5cm or so.
The control module brings line position into two dimensional code and sets identification according to built-in two dimensional code band position recognition algorithm, Then Difference Calculation difference speed is carried out to the position of taken at regular intervals, then to progress Kalman filtering.
Technical effect
Compared with prior art, the present invention can be improved the position and speed measurement accuracy of track AGV, and be capable of providing control The speed of system real-time control AGV processed and position.
Detailed description of the invention
Fig. 1 is two dimensional code band schematic diagram;
Fig. 2 is that position view is arranged in two dimensional code position sensor;
Fig. 3 is easy structure schematic diagram of the present invention;
Fig. 4 is embodiment flow chart;
In figure: A is two dimensional code upper left angle point position in the picture, and B is that position, C are two dimensional code upper right angle point in the picture Position, D are two dimensional code bottom right angle point position in the picture to two dimensional code lower-left angle point in the picture, and E is that two dimensional code upper left angle point exists Position in image vision, F are two dimensional code upper right angle point position in the picture, and G is two dimensional code lower-left angle point position in the picture, H For two dimensional code bottom right angle point position in the picture;1 is guide rail, and 2 be guide wheel, and 3 be the connecting bracket of sensor and front-wheel, and 4 be two Code sensor is tieed up, 5 be the two dimensional code band for being attached to guide rail side, and 6 be right rear drive sprocket, and 7 be left back driving wheel, and 8 be track AGV vehicle Body.
Specific embodiment
The parameters of system in the present embodiment are as follows: layout type on two dimensional code band is as shown in Figure 1, single two dimensional code length and width For 10mm, adjacent two dimensional code spacing is 5mm, and there is no limit for two-dimentional code length.Two dimensional code position sensor is fixed on front-wheel side, In AGV moving process, keep two dimensional code position sensor and two dimensional code band at a distance of 5cm or so.
It is the number with certain rule that two dimensional code, which includes information, on two dimensional code band, can be existed for the two dimensional code center Absolute position values on two dimensional code strip length direction.
The metrical information includes: real time position and real-time speed on AGV track.
Specific step is as follows for the present embodiment:
The first step, two dimensional code position sensor acquire a width include 2 to 3 two dimensional codes picture, identify wherein some Two dimensional code includes information, the information be the two dimensional code center in the absolute position of two dimensional code band, while identify this two 4 corner points of code and adjacent two dimensional code, i.e. A, B, C, D, E, F, G, H are tieed up, according in this 8 each point in the picture relative image The position of heart point can calculate the position of two two dimensional code central point relative image central points, be existed according to two dimensional code central point Absolute position on two dimensional code band can be obtained absolute position of the two dimensional code position sensor central point on two dimensional code band.
Second step, AGV control system interval 5ms periodically acquire the absolute position of an AGV, it is in-orbit to can be obtained AGV Road is taken up an official post the absolute position when carved.The difference of the AGV of the Difference Calculation period is carried out to the adjacent absolute position acquired twice Component velocity.
Step 3, the position signal and differential speed signal calculate control system carry out digital signal processing algorithm, meter Calculate accurate position and speed signal.
Step 4 carries out the closed loop speed of AGV by real-time AGV position and speed according to the demand with 3D game interaction Degree or position control guarantee the optimal game experiencing effect of player.
The calculating includes 1) two dimensional code position sensor to a width include 2 to 3 two dimensional codes image in identify Two dimensional code includes information, and the boundary point information of two dimensional code calculates edema with the heart involved in the relative image of two dimensional code central point in the picture Square to position be X1, relative image central horizontal direction position is set to X2 to adjacent two dimensional code central point in the picture, according to reality Adjacent two dimensional code central point spacing be 15mm, image center can be calculated with respect to some actual position in two dimensional code center X=X1/ (X1+X2) * 15mm.The track absolute position values P1 that message reflection is included according to two dimensional code, can calculate two-dimentional code bit Set physical location P=P1+X of the sensor on two dimensional code band.2) poor velocity component calculation, the absolute position acquired twice by front and back P2 and P3 are set, difference speed V1=(P3-P2)/T is calculated, wherein T is the sampling period.Position signal and difference speed are believed Number, using Kalman's digital filter, calculate accurate velocity amplitude.3) it is wanted according to status requirement and speed of the 3D game to AGV It asks, control system is carried out PID control AGV and run with desired speed according to current position and speed signal, and can be accurate Parking is in specified position.
This system can be not limited to determining for recreation ground track AGV with the mobile platform use occasion with various rail mounteds Position and speed control system, for the precision of position measurement in 1mm, the measurement accuracy of speed is related with sample frequency, and tachometric survey misses Difference is within 30mm/s;Either rear wheel drive mode, or front-wheel drive mode drives wheel speed control by control AGV movement speed in orbit processed, realizes the speed control and position control of AGV;This system, which can control AGV, determines off-position and sets mistake Difference is in ± 5mm range, and speed control error is within 5%.
Above-mentioned specific implementation can by those skilled in the art under the premise of without departing substantially from the principle of the invention and objective with difference Mode carry out local directed complete set to it, protection scope of the present invention is subject to claims and not by above-mentioned specific implementation institute Limit, each implementation within its scope is by the constraint of the present invention.

Claims (4)

1. a kind of localization method of the AGV positioning system based on two dimensional code band, which is characterized in that the system comprises: it is set to Length and width on AGV track side are 1cm, the two dimensional code band of adjacent spaces 5mm, the two-dimentional code position for being set to AGV front-wheel side Sensor and the control module for being attached thereto and obtaining two-dimensional barcode information, in which: two dimensional code band is by several independent two dimensions Code rearranges, and each two dimensional code includes its absolute position values;Control module according to built-in two dimensional code band position recognition algorithm, Line position is brought into two dimensional code and sets identification, Difference Calculation difference speed then is carried out to the position of taken at regular intervals and obtains position signal And differential speed signal, Kalman filtering, the two dimensional code band setting then are carried out to position signal and differential speed signal In the height and position of the 8cm on ground close on AGV guide rail;
The two dimensional code position sensor is based on image-capable and to calculate the sensor of two dimensional code absolute position, Two dimensional code position sensor is set to the front-wheel side of AGV, and two dimensional code position sensor and two dimensional code band spacing are 5cm;It is described Accurate location X=P1+X1/ (X1+X2) * 15 of the two dimensional code position sensor center on two dimensional code band, in which: P1 is track Absolute position values, X1 are the relative image central horizontal direction position of two dimensional code central point in the picture, and X2 is adjacent two dimensional code Central point relative image central horizontal direction position in the picture, unit mm;
It is in orbit accordingly to obtain AGV for two dimensional code on the two dimensional code position sensor periodic reading two dimensional code band Position carries out difference by the absolute position values to obtained two dimensional code, differential speed signal is obtained, then to difference speed Signal carries out digital signal filter, obtains accurate AGV real-time speed and location information, specifically includes the following steps:
Step 1 is laid with whole process along orbital direction, when track road in the single-sided arrangement two dimensional code band of the I shape track of AGV Line be annular, two dimensional code band sequestration site and two dimensional code start position overlapping, and record two dimensional code band initial value and two dimensional code band Cutoff value;
Step 2, the sample frequency of the position data of setting two dimensional code position sensor, the absolute position of periodic reading AGV, Difference is carried out according to eve position data and the position data at the latter moment, records period AGV between the forward and backward moment Position signal and differential speed signal;
Step 3 carries out digital signal filter to collected position signal and differential speed signal, obtains accurate positional value And velocity amplitude.
2. according to the method described in claim 1, it is characterized in that, the AGV, after obtaining real-time speed and location information, By the overall situation, position ring or speed by PID control are set, realize to positioning of the AGV on orbital position or speed control and It can determine to stop to specified target position in AGV ramp to stop.
3. according to the method described in claim 1, it is characterized in that, after step 3 obtains accurate positional value and velocity amplitude, root It runs to specified position according to default Script controlling AGV with specified speed to stop, and by itself actual speed and actual bit It sets and feeds back to 3D game and do error correction on interface.
4. according to the method described in claim 3, it is characterized in that, the error correction, i.e., according to 3D game scripts to AGV's Position and speed requirement, controller control using speed by PID or stop surely position algorithm according to the operating status of AGV.
CN201510876265.2A 2015-12-03 2015-12-03 AGV localization method and system based on two dimensional code band Expired - Fee Related CN105511466B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201510876265.2A CN105511466B (en) 2015-12-03 2015-12-03 AGV localization method and system based on two dimensional code band

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201510876265.2A CN105511466B (en) 2015-12-03 2015-12-03 AGV localization method and system based on two dimensional code band

Publications (2)

Publication Number Publication Date
CN105511466A CN105511466A (en) 2016-04-20
CN105511466B true CN105511466B (en) 2019-01-25

Family

ID=55719527

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201510876265.2A Expired - Fee Related CN105511466B (en) 2015-12-03 2015-12-03 AGV localization method and system based on two dimensional code band

Country Status (1)

Country Link
CN (1) CN105511466B (en)

Families Citing this family (20)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105807771B (en) * 2016-05-03 2018-07-27 上海交通大学 Station identifying system based on AGV and its control method
CN105823419B (en) * 2016-05-11 2019-07-12 上海振华重工电气有限公司 Reference band for the detection of machine vision pose
CN106444766A (en) * 2016-10-21 2017-02-22 北京京东尚科信息技术有限公司 AGV(automatic guided vehicle) and control method thereof
CN106347215A (en) * 2016-10-31 2017-01-25 长安大学 Special-section variable speed-limiting detection system and method based on dynamic two-dimensional codes
CN106989746A (en) * 2017-03-27 2017-07-28 远形时空科技(北京)有限公司 Air navigation aid and guider
CN107179091B (en) * 2017-06-27 2019-09-20 广东嘉腾机器人自动化有限公司 A kind of AGV walking vision positioning error correcting method
TWI628415B (en) * 2017-09-13 2018-07-01 國立清華大學 Positioning and measuring system based on image scale
CN109656130B (en) * 2017-10-10 2022-06-07 北京京东乾石科技有限公司 Method and device for controlling operation of transfer robot, and storage medium
CN107678432A (en) * 2017-10-16 2018-02-09 上海斐讯数据通信技术有限公司 Control method and automatic carriage, the system of a kind of automatic carriage
CN109800828B (en) * 2017-11-17 2020-10-20 比亚迪股份有限公司 Vehicle positioning system and positioning method based on two-dimensional code
CN108021113A (en) * 2017-12-14 2018-05-11 大连四达高技术发展有限公司 Cutter transport system
CN108189027B (en) * 2017-12-19 2020-08-11 朱宁波 Mobile robot control method
CN108345304A (en) * 2018-01-29 2018-07-31 星视创(长沙)智能装备有限公司 Intelligent transfer robot positioning system and localization method
CN108268044B (en) * 2018-01-31 2021-06-22 浙江国自机器人技术股份有限公司 Mobile robot in-place precision control method, system, medium and equipment
CN109407666A (en) * 2018-10-11 2019-03-01 智久(厦门)机器人科技有限公司上海分公司 A kind of control method of vehicle, device, equipment and storage medium
CN109669455A (en) * 2018-12-26 2019-04-23 深圳市招科智控科技有限公司 A kind of the AGV positioning system and method for view-based access control model two dimensional code
US10890918B2 (en) * 2019-04-24 2021-01-12 Innovation First, Inc. Performance arena for robots with position location system
CN112327818B (en) * 2019-07-19 2023-06-23 杭州海康机器人股份有限公司 Method for correcting pose deviation of guide graph and walking equipment
CN113845064B (en) * 2021-08-05 2023-05-09 乐仓信息科技有限公司 Positioning method and system for material bearing device with round support legs
CN114234939A (en) * 2021-12-13 2022-03-25 上海恒润数字科技集团股份有限公司 Track shape surveying and mapping method and system of amusement equipment and virtual reality equipment

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102735235A (en) * 2012-06-07 2012-10-17 无锡普智联科高新技术有限公司 Indoor mobile robot positioning system and method based on two-dimensional code
CN103064417A (en) * 2012-12-21 2013-04-24 上海交通大学 Global localization guiding system and method based on multiple sensors
CN104142683A (en) * 2013-11-15 2014-11-12 上海快仓智能科技有限公司 Automated guided vehicle navigation method based on two-dimension code positioning
CN104848858A (en) * 2015-06-01 2015-08-19 北京极智嘉科技有限公司 Two-dimensional code and vision-inert combined navigation system and method for robot

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6948662B2 (en) * 1991-07-25 2005-09-27 Symbol Technologies, Inc. Two-dimensional optical code scanner with scanning pattern having region of greater apparent brightness for assisting alignment of scanning pattern

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102735235A (en) * 2012-06-07 2012-10-17 无锡普智联科高新技术有限公司 Indoor mobile robot positioning system and method based on two-dimensional code
CN103064417A (en) * 2012-12-21 2013-04-24 上海交通大学 Global localization guiding system and method based on multiple sensors
CN104142683A (en) * 2013-11-15 2014-11-12 上海快仓智能科技有限公司 Automated guided vehicle navigation method based on two-dimension code positioning
CN104848858A (en) * 2015-06-01 2015-08-19 北京极智嘉科技有限公司 Two-dimensional code and vision-inert combined navigation system and method for robot

Also Published As

Publication number Publication date
CN105511466A (en) 2016-04-20

Similar Documents

Publication Publication Date Title
CN105511466B (en) AGV localization method and system based on two dimensional code band
US10266201B2 (en) K-turn path controller
CN106123908B (en) Automobile navigation method and system
CN107390691A (en) A kind of AGV path following methods
CN105620473B (en) One kind is parked track correcting method
CN107632602A (en) AGV trolley travelling tracks method for correcting error and system, terrestrial reference Quick Response Code acquisition device
CN105404842B (en) AGV positioning and directings and speed-measuring method based on terrestrial reference Quick Response Code
CN102721365B (en) Method and device for high-speed and accurate measurement of tunnel section
CN107463173A (en) AGV air navigation aids of storing in a warehouse and device, computer equipment and storage medium
WO2021128777A8 (en) Method, apparatus, device, and storage medium for detecting travelable region
CN106338991A (en) Robot based on inertial navigation and two-dimensional code and positioning and navigation method thereof
CN108955667A (en) A kind of complex navigation method, apparatus and system merging laser radar and two dimensional code
CN103659817B (en) A kind of rescuing robot system and realize the method for this rescue system
JP5396983B2 (en) Moving body and teaching method of moving body
CN103472434B (en) Robot sound positioning method
CN103680291A (en) Method for realizing simultaneous locating and mapping based on ceiling vision
KR20100071914A (en) Parking assist apparatus
KR102051046B1 (en) Following system for solar panel cleaning robot of mobile robot and method thereof
CN111077890A (en) Implementation method of agricultural robot based on GPS positioning and automatic obstacle avoidance
JP5561730B2 (en) Guidance control system and guidance control method for moving body
JP2009110250A (en) Map creation device and method for determining traveling path of autonomous traveling object
CN211734978U (en) Unmanned rapid comprehensive road detection vehicle system
JP2020181485A (en) Unmanned transportation robot system
CN112119188A (en) Method for controlling a set of one or more intervention tools mounted on a railway intervention vehicle
CN106989673A (en) Detection means and method for detecting track board size

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: 20190125

Termination date: 20211203