The content of the invention
The invention aims to overcome the posture of glass production line robot crawl glass different, glass stacking is caused
When there is irregular, glass and easily insert the technical disadvantages such as wound, there is provided a kind of glass crawl position corrects system and method.
Glass crawl position correction system and method are specific as follows:
The glass crawl position corrects system, for realizing the position school of the glass that mechanical arm captures in glass stacking system
Just, the glass stacking system includes PLC control centres and the manipulator being connected with PLC control center lines, the mechanical handbag
Ring flange and connected crawl section are included, and described crawl section is used to capture glass, described ring flange is used for basis
The control of described PLC control centres, is adjusted to described crawl section, and it is mainly characterized by, and also includes in correction system
Means for correcting, described means for correcting are connected with described PLC control centres, and described correction system passes through described school
Equipment obtains the correction parameter for the glass being crawled, and described PLC control centres obtain according to described means for correcting
Correction parameter, position correction is carried out to the glass being crawled.
It is preferred that described means for correcting include surveying while cylinder, installed in described survey while cylinder on magnetic railings ruler and
Photoelectric sensor group on described magnetic railings ruler, wherein,
Described photoelectric sensor group is controlled to detect glass edge when detecting glass edge to described PLC
Center processed reports trigger signal;
Described survey side cylinder carries out glass edge detection to drag described photoelectric sensor group, until described light
All photoelectric sensors included in electric transducer group all detect glass edge;
Described magnetic railings ruler is used for the stroke that described survey side cylinder is measured by way of step-by-step counting, and described magnetic
Grid chi is connected to described PLC control centres by a high-speed counter, is received in described PLC control centres described
Photoelectric sensor group report trigger signal when, the magnetic railings ruler of current metering is reported by described high-speed counter
Pulse number, the stroke of presently described survey side cylinder is obtained for described PLC control centres.
More preferably, described magnetic railings ruler is consistent with the number for surveying side cylinder, is comprised at least in described photoelectric sensor group
Three photoelectric sensors.
More preferably, the number of described survey side cylinder is two, including first be arranged in a mutually vertical manner surveys side cylinder and the
Two survey side cylinder, and two survey side cylinders are parallel to horizontal plane and are configured, and the described first survey side cylinder is used to detect
First glass edge of the glass being crawled, the described second survey side cylinder are used for the second glass edge for detecting the glass being crawled
Edge, and the first described glass edge is perpendicular to the second described glass edge;
The number of described magnetic railings ruler is two, is configured each parallel to horizontal plane, and the first magnetic railings ruler is perpendicular to the
One surveys side cylinder, is surveyed installed in described first on the cylinder of side, and the second magnetic railings ruler surveys side cylinder perpendicular to second, installed in described
Second survey side cylinder on;
Described photoelectric sensor group includes three photoelectric sensors, wherein the first photoelectric sensor and the second photoelectric sensing
Device is installed on the first magnetic railings ruler with a pre-determined distance, and the 3rd photoelectric sensor is arranged on the second magnetic railings ruler.
It is particularly preferred that the pre-determined distance between described the first photoelectric sensor and the second photoelectric sensor is 0.5 to 0.7m.
Based on the method that glass position correction is realized in above-mentioned glass crawl position correction system, it is mainly characterized by, institute
The bearing calibration stated comprises the following steps:
(1) the correction system electrification described in, the manipulator crawl glass in described glass stacking system, described correction
Device starts, and described correction system is obtained the correction corrected needed for the glass being currently crawled by described means for correcting and joined
Number;
(2) the correction system described in carries out position school according to the correction parameter obtained in step (1) to the glass being crawled
Just.
It is preferred that the step of obtaining correction parameter by means for correcting in described step (1) is:
(1.1) the described photoelectric sensor group detection glass edge of side cylinder dragging is surveyed described in, until the photoelectric sensing
Three photoelectric sensors in device group all detect glass edge, and trigger signal is reported to described PLC control centres;
(1.2) PLC control centres described in give out information to described magnetic railings ruler according to described trigger signal in real time,
The current PRF stoichiometric number of magnetic railings ruler is obtained, side cylinder is surveyed in the first photoelectric sensor when of detecting glass edge institute so as to obtain
The first stroke S1 for passing through, survey the second stroke S2 for being passed through when the second photoelectric sensor detects glass edge of side cylinder and
Survey the third trip S3 that side cylinder is passed through when the 3rd photoelectric sensor detects glass edge;
(1.3) the PLC control centres described in obtain first and survey side gas according to described the first stroke S1 and the second stroke S2
Cylinder is successively detected in the first photoelectric sensor and the second photoelectric sensor between the stroke passed through in the period of glass edge
Away from D;
(1.4) PLC control centres described in establish rectangular coordinate system using the center of described ring flange as origin, and according to
Described the first stroke S1, the second stroke S2, third trip S3 and stroke space D, obtain the first glass edge and sat at the right angle
The first straight line L1 that passes through in mark system, and the second straight line L2 that the second glass edge passes through in the rectangular coordinate system, it is described
PLC control centres obtain described first straight line L1 and the always according to equation where described first straight line L1 and second straight line L2
Two straight line L2 the first intersection point H (xH,yH), wherein the first intersection point H (xH,yH) process of asking for be:
Wherein, described (x1,y1) and (x2,y2) be respectively any two points on described first straight line L1 coordinate value, institute
(the x stated3,y3) for the coordinate value at any point on described second straight line L2;
(1.5) the PLC control centres described in obtain first jiao corresponding to described first straight line L1 first slope K1
Spend β and intersection point H (xH,yH) second angle θ corresponding to the second slope K 2 of the line of the origin of the rectangular coordinate system, and
First angle β and second angle θ acquiring method is respectively:
(1.6) the PLC control centres described in obtain the minimum anglec of rotation according to described first angle β and second angle θ
θ ', wherein θ ' acquiring method is:
(1.7) the PLC control centres described in are as where minimum anglec of rotation θ ' obtains postrotational first glass edge
First straight line L1 and the second straight line L2 where the second glass edge the second intersection point J (xJ, yJ),
(1.8) the PLC control centres described in are according to the first intersection point H (xH,yH) and the second intersection point J (xJ, yJ) obtain ring flange
The correction distance that should implement in the X-axis direction and the correction distance that should implement in the Y-axis direction, wherein, ring flange should
The correction distance implemented in the X-axis direction and the correction distance that should implement in the Y-axis direction are respectively:
X=xJ-xH;
Y=yJ-yH;
Wherein X is the correction distance that ring flange should be implemented in the X-axis direction, and Y is that ring flange should be real in the Y-axis direction
The correction distance applied.
It is particularly preferred that described step (2) lieutenant colonel's positive system according to the correction parameter obtained in step (1) to the glass that is crawled
Glass carries out position correction:
The correction distance that described correction system should be implemented in the X-axis direction according to the ring flange obtained in step (1)
With the correction distance that should implement in the Y-axis direction, by controlling the rotation of described ring flange, control on described crawl section
The rotation of the glass of crawl, realize the position correction of the glass to being crawled.
The glass crawl position correction system and method for the present invention, because it utilizes the center structure of the ring flange of manipulator
Rectangular coordinate system is built, the right angle that the glass edge data that photoelectric sensor detects are changed into the rectangular coordinate system is sat
Mark, more convenient computing is carried out using rectangular co-ordinate, can easily obtain the glass that is crawled in glass stacking system
Correction parameter, the glass stablize manipulator, be accurate, being captured under safety correction different positions and pose;And the glass in the present invention
Glass crawl position correction system is easy for installation, cost is cheap, practical, can greatly improve stacking glass in glass industry
Regularity, glass when reducing glass stacking, which is inserted, hinders problem, should widely popularize this technology.
Embodiment
In order to clearer description technical scheme, the invention is done further below in conjunction with accompanying drawing
Describe in detail, be clear for this manufacturing technology personage professional to this.
The glass crawl position corrects system, for realizing the position school of the glass that mechanical arm captures in glass stacking system
Just, the glass stacking system includes PLC control centres and the manipulator being connected with PLC control center lines, the mechanical handbag
Ring flange 1 and connected crawl section are included, and described crawl section is used to capture glass, described ring flange 1 is used for root
According to the control of described PLC control centres, described crawl section is adjusted, means for correcting, institute are also included in correction system
The means for correcting stated is connected with described PLC control centres, and described correction system is obtained by described means for correcting
Take the correction parameter for the glass being crawled, the correction parameter that described PLC control centres obtain according to described means for correcting is right
The glass being crawled carries out position correction.
A kind of preferably in embodiment, described means for correcting include surveying while cylinder 5, installed in described survey while gas
Magnetic railings ruler 4 on cylinder 5 and the photoelectric sensor group on described magnetic railings ruler 4, wherein, described photoelectric sensor group
To detect glass edge, and trigger signal is reported to described PLC control centres when detecting glass edge;Described survey
Side cylinder 5 carries out glass edge detection to drag described photoelectric sensor group, until being wrapped in described photoelectric sensor group
All photoelectric sensors contained all detect glass edge;Described magnetic railings ruler 4 is used for the First Astronautic Research Institute for Measurement and Test by way of step-by-step counting
The stroke for the survey side cylinder 5 stated, and described magnetic railings ruler 4 is connected to by a high-speed counter in described PLC controls
The heart, when described PLC control centres receive the trigger signal that described photoelectric sensor group reports, by described high rapid pulse
The pulse number that counter reports the magnetic railings ruler 4 of current metering is rushed, presently described survey is obtained for described PLC control centres
The stroke of side cylinder 5.
In a kind of more preferably embodiment, described magnetic railings ruler 4 photoelectricity consistent, described with the number for surveying side cylinder 5
Three photoelectric sensors are comprised at least in sensor group.
In a kind of more preferably embodiment, the number of described survey side cylinder 5 is two, including be arranged in a mutually vertical manner
First surveys the cylinder 5 when cylinder 5 and second is surveyed, and two survey side cylinders 5 are parallel to horizontal plane and are configured, and described the
One survey side cylinder 5 is used for the first glass edge for detecting the glass being crawled, and the described second survey side cylinder 5, which is used to detect, is grabbed
Second glass edge of the glass taken, and the first described glass edge is perpendicular to the second described glass edge;Described magnetic
The number of grid chi 4 is two, is configured each parallel to horizontal plane, and the first magnetic railings ruler 4 surveys side cylinder 5, peace perpendicular to first
Surveyed mounted in described first on side cylinder 5, the second magnetic railings ruler 4 surveys side cylinder 5 perpendicular to second, and side is surveyed installed in described second
On cylinder 5;Described photoelectric sensor group includes three photoelectric sensors, wherein the first photoelectric sensor 2 and the second photoelectric transfer
Sensor 3 is installed on the first magnetic railings ruler 4 with a pre-determined distance, and the 3rd photoelectric sensor 6 is arranged on the second magnetic railings ruler 4.
It is pre- between described the first photoelectric sensor 2 and the second photoelectric sensor 3 in a kind of preferred embodiment
If distance is 0.5 to 0.7m.
Based on the method that glass position correction is realized in above-mentioned glass crawl position correction system, it is mainly characterized by, institute
The bearing calibration stated comprises the following steps:
(1) the correction system electrification described in, the manipulator crawl glass in described glass stacking system, described correction
Device starts, and described correction system is obtained the correction corrected needed for the glass being currently crawled by described means for correcting and joined
Number;
(2) the correction system described in carries out position school according to the correction parameter obtained in step (1) to the glass being crawled
Just.
A kind of preferably in embodiment, the step of correction parameter is obtained by means for correcting in described step (1)
For:
(1.1) the survey side cylinder 5 described in drags described photoelectric sensor group detection glass edge, until the photoelectric sensing
Three photoelectric sensors in device group all detect glass edge, and trigger signal is reported to described PLC control centres;
(1.2) PLC control centres described in give out information to described magnetic railings ruler 4 according to described trigger signal in real time,
The current PRF stoichiometric number of magnetic railings ruler 4 is obtained, glass edge is detected in the first photoelectric sensor 2 so as to obtain survey side cylinder 5
When passed through the first stroke S1, survey the second row that is passed through when the second photoelectric sensor 3 detects glass edge of side cylinder 5
The third trip S3 that journey S2 and survey side cylinder 5 are passed through when the 3rd photoelectric sensor 6 detects glass edge;
(1.3) the PLC control centres described in obtain first and survey side gas according to described the first stroke S1 and the second stroke S2
Cylinder 5 detects the stroke passed through in the period of glass edge in the first photoelectric sensor 2 and the priority of the second photoelectric sensor 3
Space D;
(1.4) the PLC control centres described in establish rectangular coordinate system, and root using the center of described ring flange 1 as origin
According to the first described stroke S1, the second stroke S2, third trip S3 and stroke space D, the first glass edge is obtained at the right angle
The first straight line L1 passed through in coordinate system, and the second straight line L2 that the second glass edge passes through in the rectangular coordinate system, it is described
PLC control centres always according to equation where described first straight line L1 and second straight line L2 obtain described first straight line L1 and
Second straight line L2 the first intersection point H (xH,yH), wherein the first intersection point H (xH,yH) process of asking for be:
Wherein, described (x1,y1) and (x2,y2) be respectively any two points on described first straight line L1 coordinate value, institute
(the x stated3,y3) for the coordinate value at any point on described second straight line L2;
(1.5) the PLC control centres described in obtain first jiao corresponding to described first straight line L1 first slope K1
Spend β and intersection point H (xH,yH) second angle θ corresponding to the second slope K 2 of the line of the origin of the rectangular coordinate system, and
First angle β and second angle θ acquiring method is respectively:
(1.6) the PLC control centres described in obtain the minimum anglec of rotation according to described first angle β and second angle θ
θ ', wherein θ ' acquiring method is:
(1.7) the PLC control centres described in are as where minimum anglec of rotation θ ' obtains postrotational first glass edge
First straight line L1 and the second straight line L2 where the second glass edge the second intersection point J (xJ, yJ),
(1.8) the PLC control centres described in are according to the first intersection point H (xH,yH) and the second intersection point J (xJ, yJ) obtain ring flange
1 correction distance that should implement in the X-axis direction and the correction distance that should implement in the Y-axis direction, wherein, ring flange 1 should
When the correction distance implemented in the X-axis direction and the correction distance that should implement in the Y-axis direction are respectively:
X=xJ-xH;
Y=yJ-yH;
Wherein X is the correction distance that ring flange 1 should be implemented in the X-axis direction, and Y is that ring flange 1 should be in the Y-axis direction
The correction distance of implementation.
In a kind of preferred embodiment, described step (2) lieutenant colonel's positive system is joined according to the correction obtained in step (1)
It is several position correction is carried out to the glass that is crawled to be specially:
The correction distance that described correction system should be implemented in the X-axis direction according to the ring flange 1 obtained in step (1)
With the correction distance that should implement in the Y-axis direction, by controlling the rotation of described ring flange 1, described crawl section is controlled
The rotation of the glass of upper crawl, realize the position correction of the glass to being crawled.
Referring to Fig. 1, in a kind of embodiment, each photoelectric sensor and ring flange 1 in photoelectric sensor group
The specific distance at center can adjust according to actual conditions, and photoelectric sensor accesses the switch board (i.e. PLC control centres) of manipulator.
When photoelectric sensor detects glass edge, described photoelectric sensor sends trigger signal, transfers to described switch board.
In specific implementation process, the size of the glass being crawled be usually it is known, when photoelectric measuring obtain glass edge, to
After described switch board sends trigger signal, described switch board by the magnetic railings ruler 4 that high-speed counter input port connects to
Described switch board sends current PRF stoichiometric number.
First photoelectric sensor 2, the second photoelectric sensor 3 and the 3rd photoelectric sensor 6 are placed on magnetic railings ruler 4, and the
One photoelectric sensor 2 and the second photoelectric sensor 3 are 0.5 to 0.7m, the I/O inputs that photo-sensor signal passes through switch board
It is connected with described switch board, described magnetic railings ruler 4 connects described switch board by the input of high-speed counter,
When two, which are surveyed side cylinder 5, starts action, magnetic railings ruler 4 starts to remember the distance that cylinder 5 is walked, when the glass of photoelectric sensor detection
Trigger action behind edge, the pulse sum that the magnetic railings ruler 4 that PLC reads high-speed counter metering is sent, can measure the first survey side
Cylinder 5 detects the row passed through in the period of glass edge in the first photoelectric sensor 2 and the priority of the second photoelectric sensor 3
Journey space D, it is known that the first photoelectric sensor 2, the second photoelectric sensor 3 and the 3rd photoelectric sensor 6 arrive method when cylinder 5 is failure to actuate
The distance at the blue center of disk 1 determines, establishes rectangular coordinate system OXY by origin of the center of ring flange 1, and obtain the first glass edge institute
Any two points A (the x on straight line1,y1),B(x2,y2), and any point C (x where the second glass edge on straight line3,y3)
Coordinate value, and obtain the first intersection point H (x of the first glass edge and the second glass edgeH,yH)。
The first described intersection point H (xH,yH) process of asking for of each coordinate value is:
Rotated centered on ring flange O, allow the glass being crawled to be rotated with the minimum anglec of rotation to the first glass edge institute
In X-axis of the straight line in coordinate system, the first intersection point H (xH,yH) corresponding with the slope of the line of ring flange center line angle, θ
For:
The acquiring method of angle beta corresponding to the slope of straight line where first glass edge of glass is:
Mechanical arm needs the side triggered more afterwards into two the first photoelectric sensor, the second photoelectric sensor photoelectric sensors
To anglec of rotation θ ', the position correction of the glass being crawled is realized.Wherein θ ' acquiring method is:
Ring flange 1 relative to X-axis robot location's translation distance:(xJ-xH,yJ-yH).Switch board is led to by modbus
Protocol integrated test system mechanical arm anglec of rotation θ ' is interrogated, translation distance (x is produced in rectangular coordinate systemJ-xH,yJ-yH) after, ensure stacking
The regularity of glass.Capture angle and shift position and calculate processing offer by switch board.
The glass crawl position correction system and method for the present invention, because it utilizes the center of the ring flange 1 of manipulator
Rectangular coordinate system is built, the right angle that the glass edge data that photoelectric sensor detects are changed into the rectangular coordinate system is sat
Mark, more convenient computing is carried out using rectangular co-ordinate, can easily obtain the glass that is crawled in glass stacking system
Correction parameter, the glass stablize manipulator, be accurate, being captured under safety correction different positions and pose;And the glass in the present invention
Glass crawl position correction system is easy for installation, cost is cheap, practical, can greatly improve stacking glass in glass industry
Regularity, glass when reducing glass stacking, which is inserted, hinders problem, should widely popularize this technology.
In this description, the present invention is described with reference to its specific embodiment.But it is clear that it can still make
Various modifications and alterations are without departing from the spirit and scope of the present invention.Therefore, specification and drawings are considered as illustrative
It is and nonrestrictive.