CN107381050B - Glass crawl position corrects system and method - Google Patents

Glass crawl position corrects system and method Download PDF

Info

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
Application number
CN201710690238.5A
Other languages
Chinese (zh)
Other versions
CN107381050A (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.)
Kasen Robot (shanghai) Co Ltd
Original Assignee
Kasen Robot (shanghai) Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Kasen Robot (shanghai) Co Ltd filed Critical Kasen Robot (shanghai) Co Ltd
Priority to CN201710690238.5A priority Critical patent/CN107381050B/en
Publication of CN107381050A publication Critical patent/CN107381050A/en
Application granted granted Critical
Publication of CN107381050B publication Critical patent/CN107381050B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B65CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
    • B65GTRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
    • B65G49/00Conveying systems characterised by their application for specified purposes not otherwise provided for
    • B65G49/05Conveying systems characterised by their application for specified purposes not otherwise provided for for fragile or damageable materials or articles
    • B65G49/06Conveying 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/068Stacking 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

玻璃抓取位置校正系统及其方法Glass grabbing position correction system and method

技术领域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-xHX=x J −x H ;

Y=yJ-yHY=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-xHX=x J −x H ;

Y=yJ-yHY=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)

1. a kind of glass crawl position corrects system, for realizing the position school for the glass that mechanical arm in glass stacking system grabs Just, which includes PLC control centre and the manipulator that is connected with the PLC control centre, the machinery handbag Ring flange and connected crawl section are included, and the crawl section is used for basis for grabbing glass, the ring flange The control of the PLC control centre, is adjusted the crawl section, which is characterized in that further includes school in correction system Equipment, the means for correcting are connected with the PLC control centre, and the correction system passes through the correction Device obtains the correction parameter of the glass being crawled, the school that the PLC control centre obtains according to the means for correcting Positive parameter carries out position correction to the glass being crawled;
The means for correcting includes the magnetic railings ruler surveyed when cylinder, being mounted on the survey on cylinder and is mounted on described Photoelectric sensor group on magnetic railings ruler, wherein
The photoelectric sensor group is to detect glass edge, and when detecting glass edge into the described PLC control Trigger signal is reported in the heart;
The survey side cylinder carries out glass edge detection to drag the photoelectric sensor group, until the photoelectric transfer All photoelectric sensors for including in sensor group all detect glass edge;
The magnetic railings ruler is used to measure the stroke of the survey side cylinder, and the magnetic railings ruler by way of step-by-step counting It is connected to the PLC control centre by a high-speed counter, the light is received in the PLC control centre When the trigger signal that electric transducer group reports, the pulse of the magnetic railings ruler of current metering is reported by the high-speed counter Number obtains the stroke of presently described survey side cylinder for the PLC control centre;
The magnetic railings ruler is consistent with the number of side cylinder is surveyed, and three photoelectric sensings are included at least in the photoelectric sensor group Device;
The number of the survey side cylinder is two, and first including being arranged in a mutually vertical manner surveys the cylinder when cylinder and second are surveyed, And two survey side cylinders are parallel to horizontal plane and are configured, and the first survey side cylinder is for detecting the glass being crawled The first glass edge, the described second survey side cylinder is used to detect the second glass edge of the glass being crawled, and described First glass edge is perpendicular to second glass edge;
The number of the magnetic railings ruler is two, is configured each parallel to horizontal plane, and the first magnetic railings ruler is surveyed perpendicular to first Side cylinder is mounted on described first and surveys on the cylinder of side, and the second magnetic railings ruler surveys side cylinder perpendicular to second, is mounted on described the Two survey on the cylinder of side;
The photoelectric sensor group includes three photoelectric sensors, wherein the first photoelectric sensor and the second photoelectric sensor with One pre-determined distance is installed on the first magnetic railings ruler, and third photoelectric sensor is mounted on the second magnetic railings ruler;
The glass crawl position correction system carries out realizing glass position correct operation, wherein the realization glass position Correct operation is set to carry out the following processing:
(1) the correction system electrification described in, the manipulator in the glass stacking system grab glass, the means for correcting Starting, correction parameter needed for the correction system obtains the glass that correction is currently crawled by the means for correcting;
Wherein, it is described the glass that correction is currently crawled is obtained by the means for correcting needed for correction parameter include with Lower operation:
(1.1) the side cylinder dragging photoelectric sensor group of surveying described in detects glass edge, until the photoelectric sensor group In three photoelectric sensors all detect glass edge, the PLC control centre of Xiang Suoshu reports trigger signal;
(1.2) the PLC control centre described in gives out information to the magnetic railings ruler in real time according to the trigger signal, obtains The current PRF stoichiometric number of magnetic railings ruler is passed through to obtain and survey side cylinder when the first photoelectric sensor detects glass edge First stroke S1, survey in second stroke S2 that cylinder is passed through when the second photoelectric sensor detects glass edge and when surveying The third trip S3 that cylinder is passed through when third photoelectric sensor detects glass edge;
(1.3) the PLC control centre described in obtains the first survey side cylinder and exists according to the first stroke S1 and second stroke S2 First photoelectric sensor and the second photoelectric sensor successively detect the period interior stroke space D passed through of glass edge;
(1.4) the PLC control centre described in establishes rectangular coordinate system by origin of the center of the ring flange, and according to described First stroke S1, second stroke S2, third trip S3 and stroke space D, obtain the first glass edge in the rectangular coordinate system The second straight line L2 that the first straight line L1 and the second glass edge of middle process pass through in the rectangular coordinate system, the PLC control Center processed obtains the first straight line L1 and second directly also according to equation and second straight line L2 where the first straight line L1 The first intersection point H (x of line L2H,yH), wherein the first intersection point H (xH,yH) finding process are as follows:
Wherein, (the x1,y1) and (x2,y2) be respectively any two points on the first straight line L1 coordinate value, it is described (x3,y3) be the second straight line L2 on any point coordinate value;
(1.5) PLC control centre described in obtain first angle β corresponding to the first slope K1 of the first straight line L1 with And intersection point H (xH,yH) second angle θ corresponding to the second slope K 2 with the line of the origin of the rectangular coordinate system, and first jiao The acquiring method of degree β and second angle θ is respectively as follows:
(1.6) PLC control centre described according to the first angle β and second angle θ obtain minimum rotation angle, θ ', The acquiring method of middle θ ' are as follows:
(1.7) the PLC control centre described in is as first where minimum rotation angle, θ ' postrotational first glass edge of acquisition The second intersection point J (x of straight line L1 and the second straight line L2 where the second glass edgeJ, yJ),
(1.8) the PLC control centre described in is according to the first intersection point H (xH,yH) and the second intersection point J (xJ, yJ) obtain ring flange should The correction distance implemented in the X-axis direction and the correction distance that should implement in the Y-axis direction, wherein ring flange should be in X-axis The correction distance implemented on direction and the correction distance that should implement in the Y-axis direction are respectively as follows:
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 what ring flange should be implemented in the Y-axis direction Correction distance;
(2) the correction system described in carries out position correction to the glass being crawled according to the correction parameter obtained in step (1).
2. glass crawl position according to claim 1 corrects system, which is characterized in that first photoelectric sensor And the second pre-determined distance between photoelectric sensor is 0.5 to 0.7m.
3. a kind of based on realization glass position school in correction system in glass crawl position described in any one of claims 1 or 2 Positive method, which is characterized in that the bearing calibration the following steps are included:
(1) the correction system electrification described in, the manipulator in the glass stacking system grab glass, the means for correcting Starting, correction parameter needed for the correction system obtains the glass that correction is currently crawled by the means for correcting, Wherein, correction parameter needed for the glass being currently crawled by the means for correcting acquisition correction includes following step It is rapid:
(1.1) the side cylinder dragging photoelectric sensor group of surveying described in detects glass edge, until the photoelectric sensor group In three photoelectric sensors all detect glass edge, the PLC control centre of Xiang Suoshu reports trigger signal;
(1.2) the PLC control centre described in gives out information to the magnetic railings ruler in real time according to the trigger signal, obtains The current PRF stoichiometric number of magnetic railings ruler is passed through to obtain and survey side cylinder when the first photoelectric sensor detects glass edge First stroke S1, survey in second stroke S2 that cylinder is passed through when the second photoelectric sensor detects glass edge and when surveying The third trip S3 that cylinder is passed through when third photoelectric sensor detects glass edge;
(1.3) the PLC control centre described in obtains the first survey side cylinder and exists according to the first stroke S1 and second stroke S2 First photoelectric sensor and the second photoelectric sensor successively detect the period interior stroke space D passed through of glass edge;
(1.4) the PLC control centre described in establishes rectangular coordinate system by origin of the center of the ring flange, and according to described First stroke S1, second stroke S2, third trip S3 and stroke space D, obtain the first glass edge in the rectangular coordinate system The second straight line L2 that the first straight line L1 and the second glass edge of middle process pass through in the rectangular coordinate system, the PLC control Center processed obtains the first straight line L1 and second directly also according to equation and second straight line L2 where the first straight line L1 The first intersection point H (x of line L2H,yH), wherein the first intersection point H (xH,yH) finding process are as follows:
Wherein, (the x1,y1) and (x2,y2) be respectively any two points on the first straight line L1 coordinate value, it is described (x3,y3) be the second straight line L2 on any point coordinate value;
(1.5) PLC control centre described in obtain first angle β corresponding to the first slope K1 of the first straight line L1 with And intersection point H (xH,yH) second angle θ corresponding to the second slope K 2 with the line of the origin of the rectangular coordinate system, and first jiao The acquiring method of degree β and second angle θ is respectively as follows:
(1.6) PLC control centre described according to the first angle β and second angle θ obtain minimum rotation angle, θ ', The acquiring method of middle θ ' are as follows:
(1.7) the PLC control centre described in is as first where minimum rotation angle, θ ' postrotational first glass edge of acquisition The second intersection point J (x of straight line L1 and the second straight line L2 where the second glass edgeJ, yJ),
(1.8) the PLC control centre described in is according to the first intersection point H (xH,yH) and the second intersection point J (xJ, yJ) obtain ring flange should The correction distance implemented in the X-axis direction and the correction distance that should implement in the Y-axis direction, wherein ring flange should be in X-axis The correction distance implemented on direction and the correction distance that should implement in the Y-axis direction are respectively as follows:
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 what ring flange should be implemented in the Y-axis direction Correction distance;
(2) the correction system described in carries out position correction to the glass being crawled according to the correction parameter obtained in step (1).
4. the method according to claim 3 based on realization glass position correction in glass crawl position correction system, It is characterized in that, the step (2) lieutenant colonel's positive system carries out the glass being crawled according to the correction parameter obtained in step (1) Position correction specifically:
The correction distance and answer that the correction system should be implemented in the X-axis direction according to the ring flange obtained in step (1) When the correction distance implemented in the Y-axis direction is controlled and grabbed on the crawl section by controlling the rotation of the ring flange Glass rotation, realize position correction to the glass being crawled.
CN201710690238.5A 2017-08-14 2017-08-14 Glass crawl position corrects system and method Active CN107381050B (en)

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)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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

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