CN107381050B - Glass crawl position corrects system and method - Google Patents
Glass crawl position corrects system and method Download PDFInfo
- Publication number
- CN107381050B CN107381050B CN201710690238.5A CN201710690238A CN107381050B CN 107381050 B CN107381050 B CN 107381050B CN 201710690238 A CN201710690238 A CN 201710690238A CN 107381050 B CN107381050 B CN 107381050B
- Authority
- CN
- China
- Prior art keywords
- glass
- correction
- plc control
- photoelectric sensor
- straight line
- 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.)
- Active
Links
- 239000011521 glass Substances 0.000 title claims abstract description 190
- 238000000034 method Methods 0.000 title claims abstract description 34
- 238000012937 correction Methods 0.000 claims abstract description 104
- 238000003708 edge detection Methods 0.000 claims description 5
- 238000005516 engineering process Methods 0.000 description 6
- 238000004519 manufacturing process Methods 0.000 description 6
- 238000003780 insertion Methods 0.000 description 4
- 230000037431 insertion Effects 0.000 description 4
- 238000009532 heart rate measurement Methods 0.000 description 3
- 230000006378 damage Effects 0.000 description 2
- 230000036544 posture Effects 0.000 description 2
- 238000013519 translation Methods 0.000 description 2
- 208000027418 Wounds and injury Diseases 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 208000014674 injury Diseases 0.000 description 1
- 230000001788 irregular Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000001960 triggered effect Effects 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B65—CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
- B65G—TRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
- B65G49/00—Conveying systems characterised by their application for specified purposes not otherwise provided for
- B65G49/05—Conveying systems characterised by their application for specified purposes not otherwise provided for for fragile or damageable materials or articles
- B65G49/06—Conveying systems characterised by their application for specified purposes not otherwise provided for for fragile or damageable materials or articles for fragile sheets, e.g. glass
- B65G49/068—Stacking or destacking devices; Means for preventing damage to stacked sheets, e.g. spaces
Landscapes
- Manipulator (AREA)
- Measurement Of Length, Angles, Or The Like Using Electric Or Magnetic Means (AREA)
Abstract
本发明涉及一种玻璃抓取位置校正系统及其方法,用于实现玻璃堆垛系统中机械臂抓取的玻璃的位置校正,该玻璃堆垛系统包括PLC控制中心以及与该PLC控制中线相连接的机械手,该机械手包括法兰盘和与之相连接的抓取部,且所述的抓取部用于抓取玻璃,所述的法兰盘用于根据所述的PLC控制中心的控制,对所述的抓取部进行调整,且校正系统中还包括校正装置,所述的校正装置与所述的PLC控制中心相连接,且所述的校正系统通过所述的校正装置来获取被抓取的玻璃的校正参数,所述的PLC控制中心根据所述的校正装置获取的校正参数,对被抓取的玻璃进行位置校正。
The invention relates to a glass grabbing position correction system and a method thereof, which are used for realizing the position correction of glass grabbed by a mechanical arm in a glass stacking system. The glass stacking system includes a PLC control center and a center line connected with the PLC control. The manipulator, the manipulator includes a flange plate and a grasping part connected with it, and the grasping part is used for grasping glass, and the flange plate is used for the control according to the PLC control center, The grasping part is adjusted, and the calibration system also includes a calibration device, the calibration device is connected with the PLC control center, and the calibration system obtains the captured grasping parts through the calibration device. The calibration parameters of the glass are obtained, and the PLC control center performs position calibration on the grabbed glass according to the calibration parameters obtained by the calibration device.
Description
技术领域technical field
本发明涉及玻璃堆垛系统技术,尤其涉及玻璃堆垛系统中机械手抓取玻璃的校正方法,具体涉及一种玻璃抓取位置校正系统及其方法。The invention relates to a glass stacking system technology, in particular to a correction method for grasping glass by a manipulator in a glass stacking system, in particular to a glass grasping position correction system and a method thereof.
背景技术Background technique
随着科学技术的不断进步,玻璃生产企业对于提高生产产能要求越来越高,希望通过技术的不断改善,提高堆垛产线的性能,进而提高生产效率,降低玻璃堆垛时的插伤率。然而机械手取得从辊道上抓取的玻璃的姿态每次都不完全相同,因此需要PLC控制中心通过对堆垛玻璃进行位置校正。With the continuous progress of science and technology, glass production enterprises have higher and higher requirements for increasing production capacity. It is hoped that through the continuous improvement of technology, the performance of the stacking production line will be improved, thereby improving the production efficiency and reducing the insertion injury rate during glass stacking. . However, the posture of the glass grabbed from the roller table by the manipulator is not exactly the same every time, so the PLC control center is required to correct the position of the stacked glass.
发明内容SUMMARY OF THE INVENTION
本发明的目的是为了克服玻璃生产线机器人抓取玻璃的姿态不同,造成玻璃堆垛时出现不整齐、玻璃容易插伤等技术缺点,提供一种玻璃抓取位置校正系统及其方法。The purpose of the present invention is to provide a glass grasping position correction system and method for overcoming the technical shortcomings such as irregular glass stacking and easy insertion of glass due to different postures of robots grasping glass in glass production lines.
该玻璃抓取位置校正系统及其方法具体如下:The glass grabbing position correction system and its method are as follows:
该玻璃抓取位置校正系统,用于实现玻璃堆垛系统中机械臂抓取的玻璃的位置校正,该玻璃堆垛系统包括PLC控制中心以及与该PLC控制中线相连接的机械手,该机械手包括法兰盘和与之相连接的抓取部,且所述的抓取部用于抓取玻璃,所述的法兰盘用于根据所述的PLC控制中心的控制,对所述的抓取部进行调整,其主要特点是,校正系统中还包括校正装置,所述的校正装置与所述的PLC控制中心相连接,且所述的校正系统通过所述的校正装置来获取被抓取的玻璃的校正参数,所述的PLC控制中心根据所述的校正装置获取的校正参数,对被抓取的玻璃进行位置校正。The glass grabbing position correction system is used to realize the position correction of the glass grabbed by the mechanical arm in the glass stacking system. The glass stacking system includes a PLC control center and a manipulator connected with the PLC control center line. The manipulator includes a method The flange plate and the grasping part connected with it, and the grasping part is used to grasp the glass, and the flange plate is used to control the grasping part according to the control of the PLC control center. The main feature is that the calibration system also includes a calibration device, the calibration device is connected with the PLC control center, and the calibration system obtains the grabbed glass through the calibration device. According to the calibration parameters obtained by the calibration device, the PLC control center performs position calibration on the grabbed glass.
较佳地,所述的校正装置包括测边气缸、安装在所述的测边气缸上的磁栅尺以及安装在所述的磁栅尺上的光电传感器组,其中,Preferably, the calibration device includes an edge measuring cylinder, a magnetic scale installed on the edge measuring cylinder, and a photoelectric sensor group installed on the magnetic scale, wherein,
所述的光电传感器组用以探测玻璃边缘,并在探测到玻璃边缘时向所述的PLC控制中心上报触发信号;The photoelectric sensor group is used to detect the edge of the glass, and when the edge of the glass is detected, a trigger signal is reported to the PLC control center;
所述的测边气缸用以拖动所述的光电传感器组进行玻璃边缘探测,直至所述的光电传感器组中包含的所有光电传感器都探测到玻璃边缘;The edge measuring cylinder is used to drag the photoelectric sensor group to detect the glass edge until all the photoelectric sensors included in the photoelectric sensor group detect the glass edge;
所述的磁栅尺用于通过脉冲计数的方式计量所述的测边气缸的行程,且所述的磁栅尺通过一高速脉冲计数器连接至所述的PLC控制中心,在所述的PLC控制中心接收到所述的光电传感器组上报的触发信号时,由所述的高速脉冲计数器上报当前的计量的磁栅尺的脉冲数目,供所述的PLC控制中心获取当前所述的测边气缸的行程。The magnetic scale is used to measure the stroke of the edge measuring cylinder by means of pulse counting, and the magnetic scale is connected to the PLC control center through a high-speed pulse counter, and is controlled by the PLC. When the center receives the trigger signal reported by the photoelectric sensor group, the high-speed pulse counter reports the number of pulses of the current measured magnetic scale for the PLC control center to obtain the current value of the edge measuring cylinder. journey.
更佳地,所述的磁栅尺与测边气缸的数目一致,所述的光电传感器组中至少包括三个光电传感器。More preferably, the number of the magnetic grating ruler is the same as that of the edge measuring cylinder, and the photoelectric sensor group includes at least three photoelectric sensors.
更佳地,所述的测边气缸的数目为两个,包括相互垂直设置的第一测边气缸与第二测边气缸,且两个测边气缸都平行于水平面进行设置,且所述的第一测边气缸用于探测被抓取的玻璃的第一玻璃边缘,所述的第二测边气缸用于探测被抓取的玻璃的第二玻璃边缘,且所述的第一玻璃边缘垂直于所述的第二玻璃边缘;More preferably, the number of the edge-measuring cylinders is two, including a first edge-measuring cylinder and a second edge-measuring cylinder arranged perpendicular to each other, and the two edge-measuring cylinders are both arranged parallel to the horizontal plane, and the The first edge measuring cylinder is used to detect the first glass edge of the glass to be grasped, the second edge measuring cylinder is used to detect the second glass edge of the grasped glass, and the first glass edge is vertical on said second glass edge;
所述的磁栅尺的数目为两个,均平行于水平面进行设置,且第一磁栅尺垂直于第一测边气缸,安装在所述的第一测边气缸上,第二磁栅尺垂直于第二测边气缸,安装在所述的第二测边气缸上;The number of the magnetic scales is two, all of which are arranged parallel to the horizontal plane, and the first magnetic scale is perpendicular to the first edge-measuring cylinder and is installed on the first edge-measuring cylinder, and the second magnetic scale is perpendicular to the first edge-measuring cylinder. It is perpendicular to the second edge-measuring cylinder, and is installed on the second edge-measuring cylinder;
所述的光电传感器组包括三个光电传感器,其中第一光电传感器和第二光电传感器以一预设距离安装于第一磁栅尺上,第三光电传感器安装在第二磁栅尺上。The photoelectric sensor group includes three photoelectric sensors, wherein the first photoelectric sensor and the second photoelectric sensor are installed on the first magnetic scale with a preset distance, and the third photoelectric sensor is installed on the second magnetic scale.
尤佳地,所述的第一光电传感器和第二光电传感器之间的预设距离为0.5至0.7m。Particularly preferably, the preset distance between the first photoelectric sensor and the second photoelectric sensor is 0.5 to 0.7 m.
基于上述玻璃抓取位置校正系统中实现玻璃位置校正的方法,其主要特征是,所述的校正方法包括以下步骤:Based on the method for realizing glass position correction in the above-mentioned glass grasping position correction system, the main feature is that the correction method includes the following steps:
(1)所述的校正系统上电,所述的玻璃堆垛系统中的机械手抓取玻璃,所述的校正装置启动,所述的校正系统通过所述的校正装置获取校正当前被抓取的玻璃所需的校正参数;(1) The calibration system is powered on, the manipulator in the glass stacking system grabs the glass, the calibration device is activated, and the calibration system obtains and calibrates the currently grasped glass through the calibration device. Correction parameters required for the glass;
(2)所述的校正系统根据步骤(1)中获取的校正参数对被抓取的玻璃进行位置校正。(2) The correction system performs position correction on the grabbed glass according to the correction parameters obtained in step (1).
较佳地,所述的步骤(1)中通过校正装置获取校正参数的步骤为:Preferably, in the described step (1), the step of obtaining the correction parameters by the correction device is:
(1.1)所述的测边气缸拖动所述的光电传感器组探测玻璃边缘,直至该光电传感器组中的三个光电传感器都探测到玻璃边缘,向所述的PLC控制中心上报触发信号;(1.1) The edge measuring cylinder drags the photoelectric sensor group to detect the glass edge, until the three photoelectric sensors in the photoelectric sensor group detect the glass edge, and report the trigger signal to the PLC control center;
(1.2)所述的PLC控制中心根据所述的触发信号,实时向所述的磁栅尺发布消息,获取磁栅尺的当前脉冲计量数,从而获取测边气缸在第一光电传感器探测到玻璃边缘时所经过的第一行程S1、测边气缸在第二光电传感器探测到玻璃边缘时所经过的第二行程S2和测边气缸在第三光电传感器探测到玻璃边缘时所经过的第三行程S3;(1.2) According to the trigger signal, the PLC control center releases a message to the magnetic scale in real time, and obtains the current pulse measurement number of the magnetic scale, so as to obtain the detection of the glass by the edge measuring cylinder when the first photoelectric sensor detects the glass. The first stroke S1 of the edge detection cylinder, the second stroke S2 of the edge detection cylinder when the second photoelectric sensor detects the glass edge, and the third stroke of the edge detection cylinder when the third photoelectric sensor detects the glass edge S3;
(1.3)所述的PLC控制中心根据所述的第一行程S1和第二行程S2,获取第一测边气缸在第一光电传感器和第二光电传感器先后探测到玻璃边缘的时间段内所经过的行程间距D;(1.3) The PLC control center obtains, according to the first stroke S1 and the second stroke S2, the passage of the first edge measuring cylinder in the time period when the first photoelectric sensor and the second photoelectric sensor detect the glass edge successively The stroke distance D;
(1.4)所述的PLC控制中心以所述的法兰盘的中心为原点建立直角坐标系,并根据所述的第一行程S1、第二行程S2、第三行程S3和行程间距D,获取第一玻璃边缘在该直角坐标系中经过的第一直线L1,和第二玻璃边缘在该直角坐标系中经过的第二直线L2,所述的PLC控制中心还根据所述的第一直线L1所在方程和第二直线L2获取所述的第一直线L1和第二直线L2的第一交点H(xH,yH),其中第一交点H(xH,yH)的求取过程为:(1.4) The PLC control center establishes a Cartesian coordinate system with the center of the flange as the origin, and obtains the first stroke S1, the second stroke S2, the third stroke S3 and the stroke distance D according to the first stroke S1, the second stroke S2, the third stroke S3 and the stroke distance D. The first straight line L1 that the first glass edge passes through in the rectangular coordinate system, and the second straight line L2 that the second glass edge passes through in the rectangular coordinate system, the PLC control center is also based on the first straight line. The equation where the line L1 is located and the second straight line L2 obtain the first intersection H(x H , y H ) of the first straight line L1 and the second straight line L2, where the first intersection H(x H , y H ) is calculated The process of taking is:
其中,所述的(x1,y1)和(x2,y2)分别为所述的第一直线L1上任意两点的坐标值,所述的(x3,y3)为所述的第二直线L2上任意一点的坐标值;Wherein, the (x 1 , y 1 ) and (x 2 , y 2 ) are the coordinate values of any two points on the first straight line L1, respectively, and the (x 3 , y 3 ) is the the coordinate value of any point on the second straight line L2;
(1.5)所述的PLC控制中心获取所述的第一直线L1的第一斜率K1所对应的第一角度β以及交点H(xH,yH)与该直角坐标系的原点的连线的第二斜率K2所对应的第二角度θ,且第一角度β和第二角度θ的求取方法分别为:(1.5) The PLC control center obtains the first angle β corresponding to the first slope K1 of the first straight line L1 and the connection line between the intersection point H (x H , y H ) and the origin of the rectangular coordinate system The second angle θ corresponding to the second slope K2 of , and the methods for obtaining the first angle β and the second angle θ are:
(1.6)所述的PLC控制中心根据所述的第一角度β和第二角度θ获取最小旋转角度θ',其中θ'的求取方法为:(1.6) The PLC control center obtains the minimum rotation angle θ' according to the first angle β and the second angle θ, and the method for obtaining θ' is:
(1.7)所述的PLC控制中心由最小旋转角度θ'获取旋转后的第一玻璃边缘所在的第一直线L1和第二玻璃边缘所在的第二直线L2的第二交点J(xJ,yJ),(1.7) The PLC control center obtains the second intersection J(x J , where the first straight line L1 where the rotated first glass edge is located and the second straight line L2 where the second glass edge is located is located by the minimum rotation angle θ', y J ),
(1.8)所述的PLC控制中心根据第一交点H(xH,yH)和第二交点J(xJ,yJ)获取法兰盘应当在X轴方向上实施的校正距离和应当在Y轴方向上实施的校正距离,其中,法兰盘应当在X轴方向上实施的校正距离和应当在Y轴方向上实施的校正距离分别为:The PLC control center described in (1.8) obtains the correction distance that the flange should implement in the X-axis direction according to the first intersection H ( xH , yH) and the second intersection J (xJ, yJ ) and should be The correction distance implemented in the Y-axis direction, wherein the correction distance that the flange should implement in the X-axis direction and the correction distance that should be implemented in the Y-axis direction are:
X=xJ-xH;X=x J −x H ;
Y=yJ-yH;Y=y J -y H ;
其中X为法兰盘应当在X轴方向上实施的校正距离,Y为法兰盘应当在Y轴方向上实施的校正距离。Among them, X is the correction distance that the flange should implement in the X-axis direction, and Y is the correction distance that the flange should implement in the Y-axis direction.
尤佳地,所述的步骤(2)中校正系统根据步骤(1)中获取的校正参数对被抓取的玻璃进行位置校正具体为:Preferably, in the step (2), the correction system performs position correction on the grabbed glass according to the correction parameters obtained in the step (1), specifically:
所述的校正系统根据步骤(1)中获取的法兰盘应当在X轴方向上实施的校正距离和应当在Y轴方向上实施的校正距离,通过控制所述的法兰盘的转动,控制所述的抓取部上抓取的玻璃的转动,实现对被抓取的玻璃的位置校正。The calibration system controls the rotation of the flange according to the calibration distance that should be implemented in the X-axis direction and the calibration distance that should be implemented in the Y-axis direction of the flange obtained in step (1). The rotation of the glass grasped on the grasping part realizes the position correction of the grasped glass.
本发明的玻璃抓取位置校正系统及其方法,由于其利用机械手的法兰盘的中心构建直角坐标系,将光电传感器探测到的玻璃边缘数据转化成在该直角坐标系中的直角坐标,利用直角坐标进行更为方便的运算,能够轻松的获取玻璃堆垛系统中被抓取的玻璃的校正参数,使机械手可以稳定、准确、安全的校正不同位姿下抓取的玻璃;且本发明中的玻璃抓取位置校正系统安装方便、成本低廉、实用性强,能大大提高玻璃工业化中堆垛玻璃的整齐性,降低了玻璃堆垛时的玻璃插伤问题,应当大力推广该项技术。The glass grasping position correction system and method of the present invention utilizes the center of the flange of the manipulator to construct a rectangular coordinate system, converts the glass edge data detected by the photoelectric sensor into the rectangular coordinates in the rectangular coordinate system, and uses Cartesian coordinates are more convenient to calculate, and the correction parameters of the glass to be grasped in the glass stacking system can be easily obtained, so that the manipulator can stably, accurately and safely correct the glass grasped in different poses; and in the present invention The new glass grabbing position correction system is easy to install, low in cost and strong in practicability, which can greatly improve the neatness of stacking glass in glass industrialization and reduce the problem of glass insertion damage during glass stacking. This technology should be vigorously promoted.
附图说明Description of drawings
图1为本发明的玻璃抓取位置校正系统的结构示意图;Fig. 1 is the structural schematic diagram of the glass grasping position correction system of the present invention;
附图标记:Reference number:
1 法兰盘1 Flange
2 第一光电传感器2 The first photoelectric sensor
3 第二光电传感器;3 The second photoelectric sensor;
4 磁栅尺4 Magnetic scale
5 测边气缸5 Side measuring cylinder
6 第三光电传感器6 Third photoelectric sensor
具体实施方式Detailed ways
为了能够更清楚的描述本发明的技术方案,以下结合附图对本发明创造做进一步详细说明,这种制造技术对本专业的人士来说是清楚的。In order to be able to describe the technical solutions of the present invention more clearly, the invention will be described in further detail below with reference to the accompanying drawings, and this manufacturing technology will be clear to those skilled in the art.
该玻璃抓取位置校正系统,用于实现玻璃堆垛系统中机械臂抓取的玻璃的位置校正,该玻璃堆垛系统包括PLC控制中心以及与该PLC控制中线相连接的机械手,该机械手包括法兰盘1和与之相连接的抓取部,且所述的抓取部用于抓取玻璃,所述的法兰盘1用于根据所述的PLC控制中心的控制,对所述的抓取部进行调整,校正系统中还包括校正装置,所述的校正装置与所述的PLC控制中心相连接,且所述的校正系统通过所述的校正装置来获取被抓取的玻璃的校正参数,所述的PLC控制中心根据所述的校正装置获取的校正参数,对被抓取的玻璃进行位置校正。The glass grabbing position correction system is used to realize the position correction of the glass grabbed by the mechanical arm in the glass stacking system. The glass stacking system includes a PLC control center and a manipulator connected with the PLC control center line. The manipulator includes a method The flange plate 1 and the grasping part connected with it, and the grasping part is used for grasping the glass, and the flange plate 1 is used to control the grasping part according to the control of the PLC control center. The calibration system also includes a calibration device, the calibration device is connected with the PLC control center, and the calibration system obtains the calibration parameters of the grabbed glass through the calibration device , the PLC control center performs position correction on the grabbed glass according to the correction parameters obtained by the correction device.
在一种较佳的实施方式中,所述的校正装置包括测边气缸5、安装在所述的测边气缸5上的磁栅尺4以及安装在所述的磁栅尺4上的光电传感器组,其中,所述的光电传感器组用以探测玻璃边缘,并在探测到玻璃边缘时向所述的PLC控制中心上报触发信号;所述的测边气缸5用以拖动所述的光电传感器组进行玻璃边缘探测,直至所述的光电传感器组中包含的所有光电传感器都探测到玻璃边缘;所述的磁栅尺4用于通过脉冲计数的方式计量所述的测边气缸5的行程,且所述的磁栅尺4通过一高速脉冲计数器连接至所述的PLC控制中心,在所述的PLC控制中心接收到所述的光电传感器组上报的触发信号时,由所述的高速脉冲计数器上报当前的计量的磁栅尺4的脉冲数目,供所述的PLC控制中心获取当前所述的测边气缸5的行程。In a preferred embodiment, the calibration device includes an edge measuring cylinder 5 , a magnetic scale 4 installed on the edge measuring cylinder 5 and a photoelectric sensor installed on the magnetic scale 4 group, wherein the photoelectric sensor group is used to detect the edge of the glass, and report a trigger signal to the PLC control center when the edge of the glass is detected; the edge measuring cylinder 5 is used to drag the photoelectric sensor The glass edge detection is carried out in the group until all the photoelectric sensors included in the photoelectric sensor group detect the glass edge; the magnetic scale 4 is used to measure the stroke of the edge measuring cylinder 5 by means of pulse counting, And the magnetic scale 4 is connected to the PLC control center through a high-speed pulse counter, when the PLC control center receives the trigger signal reported by the photoelectric sensor group, the high-speed pulse counter Report the current measured pulse number of the magnetic scale 4 for the PLC control center to obtain the current stroke of the edge measuring cylinder 5 .
在一种更佳的实施方式中,所述的磁栅尺4与测边气缸5的数目一致,所述的光电传感器组中至少包括三个光电传感器。In a more preferred embodiment, the number of the magnetic scale 4 and the edge measuring cylinder 5 is the same, and the photoelectric sensor group includes at least three photoelectric sensors.
在一种更佳的实施方式中,所述的测边气缸5的数目为两个,包括相互垂直设置的第一测边气缸5与第二测边气缸5,且两个测边气缸5都平行于水平面进行设置,且所述的第一测边气缸5用于探测被抓取的玻璃的第一玻璃边缘,所述的第二测边气缸5用于探测被抓取的玻璃的第二玻璃边缘,且所述的第一玻璃边缘垂直于所述的第二玻璃边缘;所述的磁栅尺4的数目为两个,均平行于水平面进行设置,且第一磁栅尺4垂直于第一测边气缸5,安装在所述的第一测边气缸5上,第二磁栅尺4垂直于第二测边气缸5,安装在所述的第二测边气缸5上;所述的光电传感器组包括三个光电传感器,其中第一光电传感器2和第二光电传感器3以一预设距离安装于第一磁栅尺4上,第三光电传感器6安装在第二磁栅尺4上。In a better embodiment, the number of the edge-measuring cylinders 5 is two, including a first edge-measuring cylinder 5 and a second edge-measuring cylinder 5 arranged perpendicular to each other, and both edge-measuring cylinders 5 are Set parallel to the horizontal plane, and the first edge-measuring cylinder 5 is used to detect the first glass edge of the glass to be grasped, and the second edge-measuring cylinder 5 is used to detect the second edge of the grasped glass. The glass edge, and the first glass edge is perpendicular to the second glass edge; the number of the magnetic scale 4 is two, which are arranged parallel to the horizontal plane, and the first magnetic scale 4 is perpendicular to the The first edge-measuring cylinder 5 is installed on the first edge-measuring cylinder 5, the second magnetic scale 4 is perpendicular to the second edge-measuring cylinder 5, and is installed on the second edge-measuring cylinder 5; the The photoelectric sensor group includes three photoelectric sensors, wherein the first photoelectric sensor 2 and the second photoelectric sensor 3 are installed on the first magnetic scale 4 at a preset distance, and the third photoelectric sensor 6 is installed on the second magnetic scale 4 superior.
在一种尤佳的实施方式中,所述的第一光电传感器2和第二光电传感器3之间的预设距离为0.5至0.7m。In a particularly preferred embodiment, the preset distance between the first photoelectric sensor 2 and the second photoelectric sensor 3 is 0.5 to 0.7 m.
基于上述玻璃抓取位置校正系统中实现玻璃位置校正的方法,其主要特征是,所述的校正方法包括以下步骤:Based on the method for realizing glass position correction in the above-mentioned glass grasping position correction system, the main feature is that the correction method includes the following steps:
(1)所述的校正系统上电,所述的玻璃堆垛系统中的机械手抓取玻璃,所述的校正装置启动,所述的校正系统通过所述的校正装置获取校正当前被抓取的玻璃所需的校正参数;(1) The calibration system is powered on, the manipulator in the glass stacking system grabs the glass, the calibration device is activated, and the calibration system obtains and calibrates the currently grasped glass through the calibration device. Correction parameters required for the glass;
(2)所述的校正系统根据步骤(1)中获取的校正参数对被抓取的玻璃进行位置校正。(2) The correction system performs position correction on the grabbed glass according to the correction parameters obtained in step (1).
在一种较佳的实施方式中,所述的步骤(1)中通过校正装置获取校正参数的步骤为:In a preferred embodiment, in the step (1), the step of obtaining the correction parameters by the correction device is:
(1.1)所述的测边气缸5拖动所述的光电传感器组探测玻璃边缘,直至该光电传感器组中的三个光电传感器都探测到玻璃边缘,向所述的PLC控制中心上报触发信号;(1.1) The edge measuring cylinder 5 drags the photoelectric sensor group to detect the glass edge, until the three photoelectric sensors in the photoelectric sensor group detect the glass edge, and report the trigger signal to the PLC control center;
(1.2)所述的PLC控制中心根据所述的触发信号,实时向所述的磁栅尺4发布消息,获取磁栅尺4的当前脉冲计量数,从而获取测边气缸5在第一光电传感器2探测到玻璃边缘时所经过的第一行程S1、测边气缸5在第二光电传感器3探测到玻璃边缘时所经过的第二行程S2和测边气缸5在第三光电传感器6探测到玻璃边缘时所经过的第三行程S3;(1.2) According to the trigger signal, the PLC control center releases a message to the magnetic scale 4 in real time to obtain the current pulse measurement number of the magnetic scale 4, so as to obtain the position of the edge measuring cylinder 5 in the first photoelectric sensor 2. The first stroke S1 when the edge of the glass is detected, the second stroke S2 of the edge-measuring cylinder 5 when the second photoelectric sensor 3 detects the glass edge, and the edge-measuring cylinder 5 when the third photoelectric sensor 6 detects the glass The third stroke S3 passed by the edge;
(1.3)所述的PLC控制中心根据所述的第一行程S1和第二行程S2,获取第一测边气缸5在第一光电传感器2和第二光电传感器3先后探测到玻璃边缘的时间段内所经过的行程间距D;(1.3) According to the first stroke S1 and the second stroke S2, the PLC control center obtains the time period during which the first edge measuring cylinder 5 detects the glass edge successively by the first photoelectric sensor 2 and the second photoelectric sensor 3 The travel distance D passed in the
(1.4)所述的PLC控制中心以所述的法兰盘1的中心为原点建立直角坐标系,并根据所述的第一行程S1、第二行程S2、第三行程S3和行程间距D,获取第一玻璃边缘在该直角坐标系中经过的第一直线L1,和第二玻璃边缘在该直角坐标系中经过的第二直线L2,所述的PLC控制中心还根据所述的第一直线L1所在方程和第二直线L2获取所述的第一直线L1和第二直线L2的第一交点H(xH,yH),其中第一交点H(xH,yH)的求取过程为:(1.4) The PLC control center takes the center of the flange 1 as the origin to establish a Cartesian coordinate system, and according to the first stroke S1, the second stroke S2, the third stroke S3 and the stroke distance D, Obtain the first straight line L1 that the first glass edge passes through in the rectangular coordinate system, and the second straight line L2 that the second glass edge passes through in the rectangular coordinate system, and the PLC control center is also based on the first straight line L2. The equation where the straight line L1 is located and the second straight line L2 obtain the first intersection H(x H , y H ) of the first straight line L1 and the second straight line L2, wherein the first intersection H(x H , y H ) is The obtaining process is:
其中,所述的(x1,y1)和(x2,y2)分别为所述的第一直线L1上任意两点的坐标值,所述的(x3,y3)为所述的第二直线L2上任意一点的坐标值;Wherein, the (x 1 , y 1 ) and (x 2 , y 2 ) are the coordinate values of any two points on the first straight line L1, respectively, and the (x 3 , y 3 ) is the the coordinate value of any point on the second straight line L2;
(1.5)所述的PLC控制中心获取所述的第一直线L1的第一斜率K1所对应的第一角度β以及交点H(xH,yH)与该直角坐标系的原点的连线的第二斜率K2所对应的第二角度θ,且第一角度β和第二角度θ的求取方法分别为:(1.5) The PLC control center obtains the first angle β corresponding to the first slope K1 of the first straight line L1 and the connection line between the intersection point H (x H , y H ) and the origin of the rectangular coordinate system The second angle θ corresponding to the second slope K2 of , and the methods for obtaining the first angle β and the second angle θ are:
(1.6)所述的PLC控制中心根据所述的第一角度β和第二角度θ获取最小旋转角度θ',其中θ'的求取方法为:(1.6) The PLC control center obtains the minimum rotation angle θ' according to the first angle β and the second angle θ, and the method for obtaining θ' is:
(1.7)所述的PLC控制中心由最小旋转角度θ'获取旋转后的第一玻璃边缘所在的第一直线L1和第二玻璃边缘所在的第二直线L2的第二交点J(xJ,yJ),(1.7) The PLC control center obtains the second intersection J(x J , where the first straight line L1 where the rotated first glass edge is located and the second straight line L2 where the second glass edge is located is located by the minimum rotation angle θ', y J ),
(1.8)所述的PLC控制中心根据第一交点H(xH,yH)和第二交点J(xJ,yJ)获取法兰盘1应当在X轴方向上实施的校正距离和应当在Y轴方向上实施的校正距离,其中,法兰盘1应当在X轴方向上实施的校正距离和应当在Y轴方向上实施的校正距离分别为:(1.8) According to the first intersection point H(x H , y H ) and the second intersection point J (x J , y J ), the PLC control center obtains the correction distance that the flange plate 1 should implement in the X-axis direction and should The correction distance implemented in the Y-axis direction, wherein the correction distance that the flange 1 should implement in the X-axis direction and the correction distance that should be implemented in the Y-axis direction are respectively:
X=xJ-xH;X=x J −x H ;
Y=yJ-yH;Y=y J -y H ;
其中X为法兰盘1应当在X轴方向上实施的校正距离,Y为法兰盘1应当在Y轴方向上实施的校正距离。Wherein X is the correction distance that the flange 1 should implement in the X-axis direction, and Y is the correction distance that the flange 1 should implement in the Y-axis direction.
在一种尤佳的实施方式,所述的步骤(2)中校正系统根据步骤(1)中获取的校正参数对被抓取的玻璃进行位置校正具体为:In a particularly preferred embodiment, in the step (2), the correction system performs position correction on the grabbed glass according to the correction parameters obtained in the step (1), specifically:
所述的校正系统根据步骤(1)中获取的法兰盘1应当在X轴方向上实施的校正距离和应当在Y轴方向上实施的校正距离,通过控制所述的法兰盘1的转动,控制所述的抓取部上抓取的玻璃的转动,实现对被抓取的玻璃的位置校正。The calibration system controls the rotation of the flange 1 according to the calibration distance that the flange 1 should implement in the X-axis direction and the calibration distance that should be implemented in the Y-axis direction obtained in step (1). , controlling the rotation of the glass grasped on the grasping part, so as to realize the position correction of the grasped glass.
请参阅图1,在一种具体实施方式中,光电传感器组中各个光电传感器与法兰盘1中心的具体距离可根据实际情况调整,光电传感器接入机械手的控制柜(即PLC控制中心)。当光电传感器探测到玻璃边缘时,所述的光电传感器发出触发信号,交由所述的控制柜。Referring to FIG. 1 , in a specific embodiment, the specific distance between each photoelectric sensor in the photoelectric sensor group and the center of the flange 1 can be adjusted according to the actual situation, and the photoelectric sensor is connected to the control cabinet of the manipulator (ie, the PLC control center). When the photoelectric sensor detects the edge of the glass, the photoelectric sensor sends a trigger signal to the control cabinet.
在具体实施过程中,被抓取的玻璃的尺寸一般是已知的,当光电测得玻璃边缘、向所述的控制柜发送触发信号后,所述的控制柜通过高速计数器输入端口连接的磁栅尺4向所述的控制柜发送当前脉冲计量数。In the specific implementation process, the size of the glass to be grasped is generally known. When the edge of the glass is photoelectrically measured and a trigger signal is sent to the control cabinet, the control cabinet is connected to the magnetic sensor through the high-speed counter input port. The scale 4 sends the current pulse measurement number to the control cabinet.
第一光电传感器2、第二光电传感器3和第三光电传感器6均置于磁栅尺4上,且第一光电传感器2和第二光电传感器3为0.5至0.7m,光电传感器信号通过控制柜的I/O输入端与所述的控制柜相连接,所述的磁栅尺4通过高速脉冲计数器的输入端连接所述的控制柜,当两个测边气缸5开始动作时,磁栅尺4开始记气缸5行走的距离,当光电传感器检测的玻璃边缘后触发动作,PLC读取高速计数器计量的磁栅尺4发出的脉冲总数,可以测得第一测边气缸5在第一光电传感器2和第二光电传感器3先后探测到玻璃边缘的时间段内所经过的行程间距D,已知气缸5不动作时第一光电传感器2、第二光电传感器3和第三光电传感器6到法兰盘1中心的距离确定,以法兰盘1中心为原点建立直角坐标系OXY,并获取第一玻璃边缘所在直线上任意两点A(x1,y1),B(x2,y2),以及第二玻璃边缘所在直线上的任意一点C(x3,y3)的坐标值,且获取第一玻璃边缘和第二玻璃边缘的第一交点H(xH,yH)。The first photoelectric sensor 2, the second photoelectric sensor 3 and the third photoelectric sensor 6 are all placed on the magnetic scale 4, and the first photoelectric sensor 2 and the second photoelectric sensor 3 are 0.5 to 0.7 m, and the photoelectric sensor signal passes through the control cabinet The I/O input end is connected with the control cabinet, the magnetic scale 4 is connected to the control cabinet through the input end of the high-speed pulse counter, when the two edge measuring cylinders 5 start to move, the magnetic scale 4 4. Start to record the distance traveled by the cylinder 5. When the photoelectric sensor detects the glass edge, the action is triggered, and the PLC reads the total number of pulses issued by the magnetic scale 4 measured by the high-speed counter. It can be measured that the first edge measuring cylinder 5 is in the first photoelectric sensor 2 and the second photoelectric sensor 3 successively detect the travel distance D within the time period of the glass edge. It is known that the first photoelectric sensor 2, the second photoelectric sensor 3 and the third photoelectric sensor 6 reach the flange when the cylinder 5 does not move. The distance from the center of the disk 1 is determined, and the rectangular coordinate system OXY is established with the center of the flange 1 as the origin, and any two points A(x 1 , y 1 ), B(x 2 , y 2 ) on the straight line where the edge of the first glass is located are obtained. , and the coordinate value of any point C(x 3 , y 3 ) on the straight line where the second glass edge is located, and obtain the first intersection H(x H , y H ) of the first glass edge and the second glass edge.
所述的第一交点H(xH,yH)各个坐标值的的求取过程为:The process of obtaining each coordinate value of the first intersection point H(x H , y H ) is as follows:
以法兰盘O为中心旋转,让被抓取的玻璃以最小旋转角度旋转至第一玻璃边缘所在直线垂直于坐标系中的X轴,第一交点H(xH,yH)与法兰盘中线的连线的斜率对应的角度θ为:Rotate with the flange O as the center, and rotate the grabbed glass at the minimum rotation angle until the line where the edge of the first glass is located is perpendicular to the X axis in the coordinate system, and the first intersection H (x H , y H ) and the flange The angle θ corresponding to the slope of the connecting line of the disk midline is:
玻璃的第一玻璃边缘所在的直线的斜率所对应的角度β的求取方法为:The method for calculating the angle β corresponding to the slope of the straight line where the first glass edge of the glass is located is:
机械臂需要向第一光电传感器、第二光电传感器两个光电传感器中较后触发的方向旋转角度θ',实现该被抓取的玻璃的位置校正。其中θ'的求取方法为:The robotic arm needs to rotate by an angle θ' in the direction of the later triggering of the first photoelectric sensor and the second photoelectric sensor, so as to realize the position correction of the grabbed glass. The calculation method of θ' is as follows:
法兰盘1相对于X轴的机器人位置平移距离:(xJ-xH,yJ-yH)。控制柜通过modbus通讯协议控制机械臂旋转角度θ',在直角坐标系中产生平移距离(xJ-xH,yJ-yH)后,保证堆垛玻璃的整齐性。抓取角度及移动位置均经过控制柜计算处理提供。The robot position translation distance of flange 1 relative to the X axis: (x J -x H , y J -y H ). The control cabinet controls the rotation angle θ' of the manipulator through the modbus communication protocol, and after the translation distance (x J -x H , y J -y H ) is generated in the Cartesian coordinate system, the orderliness of the stacking glass is ensured. The grasping angle and moving position are all provided by the control cabinet.
本发明的玻璃抓取位置校正系统及其方法,由于其利用机械手的法兰盘1的中心构建直角坐标系,将光电传感器探测到的玻璃边缘数据转化成在该直角坐标系中的直角坐标,利用直角坐标进行更为方便的运算,能够轻松的获取玻璃堆垛系统中被抓取的玻璃的校正参数,使机械手可以稳定、准确、安全的校正不同位姿下抓取的玻璃;且本发明中的玻璃抓取位置校正系统安装方便、成本低廉、实用性强,能大大提高玻璃工业化中堆垛玻璃的整齐性,降低了玻璃堆垛时的玻璃插伤问题,应当大力推广该项技术。The glass grasping position correction system and method of the present invention, because it uses the center of the flange 1 of the manipulator to construct a rectangular coordinate system, and converts the glass edge data detected by the photoelectric sensor into the rectangular coordinates in the rectangular coordinate system, Using Cartesian coordinates to perform more convenient operations, the correction parameters of the glass to be grasped in the glass stacking system can be easily obtained, so that the manipulator can stably, accurately and safely correct the glass grasped in different poses; and the invention The glass grabbing position correction system in China is easy to install, low in cost and strong in practicability, which can greatly improve the neatness of stacking glass in glass industrialization and reduce the problem of glass insertion during glass stacking. This technology should be vigorously promoted.
在此说明书中,本发明已参照其特定的实施例作了描述。但是,很显然仍可以作出各种修改和变换而不背离本发明的精神和范围。因此,说明书和附图应被认为是说明性的而非限制性的。In this specification, the invention has been described with reference to specific embodiments thereof. However, it will be evident that various modifications and changes can still be made without departing from the spirit and scope of the invention. Accordingly, the specification and drawings are to be regarded in an illustrative rather than a restrictive sense.
Claims (4)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710690238.5A CN107381050B (en) | 2017-08-14 | 2017-08-14 | Glass crawl position corrects system and method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710690238.5A CN107381050B (en) | 2017-08-14 | 2017-08-14 | Glass crawl position corrects system and method |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107381050A CN107381050A (en) | 2017-11-24 |
CN107381050B true CN107381050B (en) | 2019-07-30 |
Family
ID=60355572
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710690238.5A Active CN107381050B (en) | 2017-08-14 | 2017-08-14 | Glass crawl position corrects system and method |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107381050B (en) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109865953B (en) * | 2019-04-23 | 2024-01-19 | 安徽速达数控设备有限责任公司 | Automatic correction device for position of material to be cut and use method thereof |
CN114030894B (en) * | 2021-12-21 | 2023-05-26 | 苏州迈为科技股份有限公司 | Method and device for adjusting angle and position of glass |
CN115285695A (en) * | 2022-09-15 | 2022-11-04 | 蚌埠凯盛工程技术有限公司 | A glass edge measuring system and method |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2009120311A (en) * | 2007-11-14 | 2009-06-04 | Shiraitekku:Kk | Supply device of glass substrate |
CN101829902B (en) * | 2009-06-18 | 2011-12-14 | 中汽成都配件有限公司 | Axial self-centering end face milling and center hole drilling numerical control machine tool |
CN102491091B (en) * | 2011-12-12 | 2014-04-16 | 中国建材国际工程集团有限公司 | Method of manipulator stacking system for glass |
CN106395383A (en) * | 2016-11-30 | 2017-02-15 | 中建材凯盛机器人(上海)有限公司 | Glass stacking device and control method thereof |
-
2017
- 2017-08-14 CN CN201710690238.5A patent/CN107381050B/en active Active
Also Published As
Publication number | Publication date |
---|---|
CN107381050A (en) | 2017-11-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110014426B (en) | Method for grabbing symmetrically-shaped workpieces at high precision by using low-precision depth camera | |
CN107381050B (en) | Glass crawl position corrects system and method | |
CN108177143B (en) | Robot positioning and grabbing method and system based on laser vision guidance | |
CN105222772B (en) | A kind of high-precision motion track detection system based on Multi-source Information Fusion | |
CN106097322B (en) | A kind of vision system calibration method based on neural network | |
CN203266633U (en) | Space coordinate positioning grabbing mechanical arm | |
CN111324121A (en) | An automatic charging method for mobile robots based on lidar | |
CN108748149A (en) | Based on deep learning without calibration mechanical arm grasping means under a kind of complex environment | |
CN103753585A (en) | Method for intelligently adjusting manipulator and grasping force on basis of visual image analysis | |
CN107981888B (en) | Computerized Breast Scanning Automatic Mechanical Positioning System | |
CN103895042A (en) | Industrial robot workpiece positioning grabbing method and system based on visual guidance | |
CN108080289A (en) | Robot sorting system, robot sorting control method and device | |
CN107009358A (en) | A kind of unordered grabbing device of robot based on one camera and method | |
CN110378325A (en) | A kind of object pose recognition methods during robot crawl | |
CN108214487A (en) | Based on the positioning of the robot target of binocular vision and laser radar and grasping means | |
CN108910701A (en) | Suspender attitude detection system and method | |
CN108818586B (en) | A method for detecting the center of gravity of objects suitable for automatic grasping by manipulators | |
CN103145038A (en) | Double-lifting-appliance travelling bridge tilt angle measuring equipment based on position sensor and measuring method of measuring equipment | |
CN109311604B (en) | Robot and method for adjusting posture of robot | |
CN103600353A (en) | Material edge detecting method of tooling | |
CN106646482A (en) | Transmission line distance detection method, device and system | |
CN114674311A (en) | A method and system for indoor positioning and mapping | |
CN113445709A (en) | Ceramic tile positioning and paving method and automatic ceramic tile paving equipment | |
CN109678057A (en) | The Different Deflection Angle Measurement of overhead crane based on stereoscopic vision | |
CN103862474B (en) | The discrimination method of joint of robot initial parameter |
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 | ||
PE01 | Entry into force of the registration of the contract for pledge of patent right | ||
PE01 | Entry into force of the registration of the contract for pledge of patent right |
Denomination of invention: Glass grabbing position correcting system and method thereof Effective date of registration: 20200416 Granted publication date: 20190730 Pledgee: Anxin Agricultural Insurance Co., Ltd. Shanghai Minhang Branch Co. Pledgor: CNBM TRIUMPH ROBOTICS (SHANGHAI) Co.,Ltd. Registration number: Y2020310000009 |
|
PC01 | Cancellation of the registration of the contract for pledge of patent right |
Date of cancellation: 20210603 Granted publication date: 20190730 Pledgee: Anxin Agricultural Insurance Co., Ltd. Shanghai Minhang Branch Co. Pledgor: CNBM TRIUMPH ROBOTICS (SHANGHAI) Co.,Ltd. Registration number: Y2020310000009 |
|
PC01 | Cancellation of the registration of the contract for pledge of patent right | ||
PE01 | Entry into force of the registration of the contract for pledge of patent right |
Denomination of invention: Glass grasping position correction system and its method Effective date of registration: 20210923 Granted publication date: 20190730 Pledgee: Pacific Anxin Agricultural Insurance Co.,Ltd. Shanghai Minhang branch Pledgor: CNBM TRIUMPH ROBOTICS (SHANGHAI) Co.,Ltd. Registration number: Y2021310000076 |
|
PE01 | Entry into force of the registration of the contract for pledge of patent right | ||
PC01 | Cancellation of the registration of the contract for pledge of patent right |
Granted publication date: 20190730 Pledgee: Pacific Anxin Agricultural Insurance Co.,Ltd. Shanghai Minhang branch Pledgor: CNBM TRIUMPH ROBOTICS (SHANGHAI) Co.,Ltd. Registration number: Y2021310000076 |
|
PC01 | Cancellation of the registration of the contract for pledge of patent right |