CN114643290B - Device and method for correcting deviation of manipulator for hot-rolled steel strip - Google Patents
Device and method for correcting deviation of manipulator for hot-rolled steel strip Download PDFInfo
- Publication number
- CN114643290B CN114643290B CN202210348093.1A CN202210348093A CN114643290B CN 114643290 B CN114643290 B CN 114643290B CN 202210348093 A CN202210348093 A CN 202210348093A CN 114643290 B CN114643290 B CN 114643290B
- Authority
- CN
- China
- Prior art keywords
- hot
- steel strip
- rolled steel
- plate
- laser
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
- 229910000831 Steel Inorganic materials 0.000 title claims abstract description 176
- 239000010959 steel Substances 0.000 title claims abstract description 176
- 238000000034 method Methods 0.000 title claims abstract description 24
- 238000012545 processing Methods 0.000 claims abstract description 25
- 238000004364 calculation method Methods 0.000 claims abstract description 11
- 230000007246 mechanism Effects 0.000 claims abstract description 4
- 238000012937 correction Methods 0.000 claims description 31
- 238000005259 measurement Methods 0.000 claims description 20
- 238000004519 manufacturing process Methods 0.000 claims description 7
- 230000009471 action Effects 0.000 claims description 6
- 230000008569 process Effects 0.000 claims description 6
- 239000005329 float glass Substances 0.000 claims description 3
- 239000000463 material Substances 0.000 claims description 3
- TWNQGVIAIRXVLR-UHFFFAOYSA-N oxo(oxoalumanyloxy)alumane Chemical group O=[Al]O[Al]=O TWNQGVIAIRXVLR-UHFFFAOYSA-N 0.000 claims 1
- 230000009286 beneficial effect Effects 0.000 abstract 1
- 238000010586 diagram Methods 0.000 description 7
- PNEYBMLMFCGWSK-UHFFFAOYSA-N aluminium oxide Inorganic materials [O-2].[O-2].[O-2].[Al+3].[Al+3] PNEYBMLMFCGWSK-UHFFFAOYSA-N 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000036544 posture Effects 0.000 description 2
- 229910000838 Al alloy Inorganic materials 0.000 description 1
- 239000000956 alloy Substances 0.000 description 1
- WYTGDNHDOZPMIW-RCBQFDQVSA-N alstonine Natural products C1=CC2=C3C=CC=CC3=NC2=C2N1C[C@H]1[C@H](C)OC=C(C(=O)OC)[C@H]1C2 WYTGDNHDOZPMIW-RCBQFDQVSA-N 0.000 description 1
- 238000004458 analytical method Methods 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 238000005452 bending Methods 0.000 description 1
- 210000000078 claw Anatomy 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000003754 machining Methods 0.000 description 1
- 230000010355 oscillation Effects 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B21—MECHANICAL METAL-WORKING WITHOUT ESSENTIALLY REMOVING MATERIAL; PUNCHING METAL
- B21B—ROLLING OF METAL
- B21B39/00—Arrangements for moving, supporting, or positioning work, or controlling its movement, combined with or arranged in, or specially adapted for use in connection with, metal-rolling mills
- B21B39/14—Guiding, positioning or aligning work
- B21B39/16—Guiding, positioning or aligning work immediately before entering or after leaving the pass
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B21—MECHANICAL METAL-WORKING WITHOUT ESSENTIALLY REMOVING MATERIAL; PUNCHING METAL
- B21B—ROLLING OF METAL
- B21B37/00—Control devices or methods specially adapted for metal-rolling mills or the work produced thereby
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B21—MECHANICAL METAL-WORKING WITHOUT ESSENTIALLY REMOVING MATERIAL; PUNCHING METAL
- B21B—ROLLING OF METAL
- B21B38/00—Methods or devices for measuring, detecting or monitoring specially adapted for metal-rolling mills, e.g. position detection, inspection of the product
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P70/00—Climate change mitigation technologies in the production process for final industrial or consumer products
- Y02P70/10—Greenhouse gas [GHG] capture, material saving, heat recovery or other energy efficient measures, e.g. motor control, characterised by manufacturing processes, e.g. for rolling metal or metal working
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Length Measuring Devices By Optical Means (AREA)
Abstract
Description
技术领域technical field
本发明涉及热轧钢技术领域,尤其涉及一种用于热轧钢带的机械手纠偏装置及纠偏方法。The invention relates to the technical field of hot-rolled steel, in particular to a manipulator deviation correction device and a deviation correction method for hot-rolled steel strips.
背景技术Background technique
在热轧钢生产线上,热轧后钢带通过蛇形振荡器进入平板输送链,由于钢带经过振荡后左右摆动,整体呈S型在平板输送链上向前输送,在输送过程中自然冷却,然后通过辊道,再进行后续卷取。在输送过程中钢带头部受到摆动力的作用,导致钢带头部过度弯曲,可能出现头身贴合、头部回弯、头部贴合在平板输送链的侧壁上等不同姿态,使钢带无法自动进入辊道入口,影响到钢带自动卷取。In the hot-rolled steel production line, the hot-rolled steel strip enters the flat conveyor chain through the serpentine oscillator. Since the steel strip oscillates left and right after oscillation, it is conveyed forward on the flat conveyor chain in an S shape as a whole, and is naturally cooled during the conveying process. , and then pass through the roller table for subsequent coiling. During the conveying process, the head of the steel belt is affected by the swinging force, which causes the head of the steel belt to bend excessively, and there may be different postures such as head-to-body fit, head back bending, and head fit on the side wall of the flat conveyor chain, making the steel belt The belt cannot automatically enter the entrance of the roller table, which affects the automatic coiling of the steel strip.
目前主要依靠工人进入平板输送链,用夹子对钢带头部进行夹持操作,使得钢带头部矫正为向前的姿态,并进行拖拽以牵引钢带进入辊道口,作业环境恶劣,存在很大安全隐患,无法满足安全生产要求,需要用到钢带牵引机器人,现有技术中钢带牵引机器人的机械手上设置有热轧钢带抓取装置1,如图1所示,热轧钢带抓取装置1内平行开闭气爪14两侧活塞杆分别固定有支架10,支架10上设置有轴承座板11,轴承座板11通过轴承座12连接有滚轮抓手13,支架10、轴承座11和滚轮抓手13对称设置,对称平面为热轧钢带抓取装置1的中间面7,平行开闭气爪14两侧的活塞杆伸出或回缩带动两侧支架10移动,两个滚轮抓手13远离或靠近实现对热轧钢带的抓取操作,抓取后热轧钢带抓取装置1的中间面7与辊道中心线对齐,机器人移动将热轧钢带的头部送入辊道,由于中间面7位置并非已知,只是理论上的对称平面,因此在机器人抓取热轧钢带送入辊道时产生两个问题:一是中间面不易找正,因此与辊道中心线对齐存在困难;二是虽然理论上热轧钢带也位于辊道中心线上,但由于高温状态的钢带存在一定柔性,使得被抓取的热轧钢带头部与辊道中心线存在一定的偏移,无法顺利进行辊道,需要进行钢带纠偏。At present, workers mainly rely on workers to enter the flat conveyor chain, clamp the head of the steel belt with clips, correct the head of the steel belt to a forward posture, and drag the steel belt into the roller mouth. The working environment is harsh and there are many problems. Potential safety hazards, unable to meet the requirements of safe production, need to use the steel strip traction robot, the manipulator of the steel strip traction robot in the prior art is provided with a hot-rolled steel strip grasping device 1, as shown in Figure 1, the hot-rolled steel strip grasps The piston rods on both sides of the parallel opening and closing air claws 14 in the fetching device 1 are respectively fixed with brackets 10, the bracket 10 is provided with a bearing seat plate 11, the bearing seat plate 11 is connected with a roller gripper 13 through the bearing seat 12, the bracket 10, and the bearing seat 11 Set symmetrically with the roller gripper 13, the symmetrical plane is the middle surface 7 of the hot-rolled steel strip gripping device 1, the piston rods on both sides of the parallel opening and closing air gripper 14 stretch out or retract to drive the brackets 10 on both sides to move, and the two roller grippers The hand 13 moves away from or approaches to realize the grasping operation of the hot-rolled steel strip. After grasping, the middle surface 7 of the hot-rolled steel strip grasping device 1 is aligned with the center line of the roller table, and the robot moves to send the head of the hot-rolled steel strip into the For the roller table, since the position of the middle surface 7 is not known, it is only a theoretical symmetry plane, so there are two problems when the robot grabs the hot-rolled steel strip and sends it to the roller table: one is that the middle surface is not easy to align, so it is not consistent with the roller table. There are difficulties in aligning the center line. Second, although the hot-rolled steel strip is theoretically located on the center line of the roller table, due to the flexibility of the steel strip in a high-temperature state, there is a gap between the head of the hot-rolled steel strip and the center line of the roller table. If there is a certain deviation, the roller table cannot be smoothly carried out, and steel belt deviation correction is required.
发明内容Contents of the invention
有鉴于此,本发明旨在提出一种用于热轧钢带的机械手纠偏装置,能够解决现有技术中中间面不易找正以及机械手抓取后热轧钢带头部与辊道中心线发生偏移,不易进入辊道的技术问题。In view of this, the present invention aims to propose a manipulator deflection correction device for hot-rolled steel strip, which can solve the difficulty in aligning the middle surface in the prior art and the deviation between the head of the hot-rolled steel strip and the centerline of the roller table after the manipulator grabs it. Move, not easy to enter the technical problem of the roller table.
为达到上述目的,本发明的技术方案是这样实现的:In order to achieve the above object, technical solution of the present invention is achieved in that way:
一种用于热轧钢带的机械手纠偏装置,包括控制模块、数据处理模块、激光测距仪和标定模块:A manipulator deflection correction device for hot-rolled steel strips, including a control module, a data processing module, a laser rangefinder and a calibration module:
所述标定模块包括固定板、夹具组件和标定板,所述固定板设置有两块,分别固定在热轧钢带抓取装置的两个支架上,所述夹具组件两端设置在两个所述固定板的下方,所述标定板设置在所述夹具组件下方,能够沿所述夹具组件左右移动;The calibration module includes a fixed plate, a fixture assembly and a calibration plate. There are two fixed plates, which are respectively fixed on the two supports of the hot-rolled steel strip grabbing device. The two ends of the clamp assembly are arranged on two Below the fixed plate, the calibration plate is arranged below the clamp assembly and can move left and right along the clamp assembly;
所述激光测距仪固定在热轧钢带抓取装置的左侧上方,向标定板发射激光线以及接收激光线进行测距,并将测距信号发送给控制模块;The laser rangefinder is fixed on the upper left side of the hot-rolled steel strip grabbing device, emits laser lines to the calibration plate and receives laser lines for distance measurement, and sends the distance measurement signal to the control module;
所述控制模块分别与数据处理模块、激光测距模块和标定组件连接,控制激光测距模块发射激光线以及接收激光线进行测距,接收测距信号发送给数据处理模块进行计算,控制标定组件中驱动标定板移动的机构发生动作。The control module is respectively connected with the data processing module, the laser ranging module and the calibration component, controls the laser ranging module to emit the laser line and receives the laser line to measure the distance, receives the ranging signal and sends it to the data processing module for calculation, and controls the calibration component The mechanism that drives the calibration plate to move takes place.
进一步的,所述夹具组件包括电机、丝杠、导轨、移动块、气缸、气缸安装板、夹具和滑动板,所述丝杠和导轨平行设置,所述丝杠和导轨的两端分别与两个所述固定板下方可转动连接,所述电机与丝杠其中一端驱动连接,所述移动块同时套设在丝杠和导轨上,所述移动块与丝杠螺接,所述移动块与导轨可滑动连接,所述气缸安装板固定设置在移动块下部,所述气缸固定设置在气缸安装板下方,所述气缸的活塞杆与滑动板固定连接,所述滑动板与气缸安装板可滑动连接,所述滑动板下方固定设置有夹具,所述夹具与标定板固定连接。Further, the fixture assembly includes a motor, a lead screw, a guide rail, a moving block, a cylinder, a cylinder mounting plate, a clamp and a sliding plate, the lead screw and the guide rail are arranged in parallel, and the two ends of the lead screw and the guide rail are connected to the two ends respectively. The bottom of the two fixed plates can be rotatably connected, the motor is driven and connected to one end of the lead screw, the moving block is sleeved on the lead screw and the guide rail at the same time, the moving block is screwed to the lead screw, and the moving block is connected to the lead screw. The guide rail can be slidably connected, the cylinder mounting plate is fixedly arranged at the lower part of the moving block, the cylinder is fixedly arranged under the cylinder mounting plate, the piston rod of the cylinder is fixedly connected with the sliding plate, and the sliding plate and the cylinder mounting plate can slide connected, a fixture is fixedly arranged under the sliding plate, and the fixture is fixedly connected with the calibration plate.
进一步的,所述气缸固定板下部表面凸起设置有导向块,所述滑动板上部表面开设有导向槽,所述导向块插设在所述导向槽内,且与所述导向槽可滑动连接。Further, the lower surface of the cylinder fixing plate is protrudingly provided with a guide block, and the upper surface of the sliding plate is provided with a guide groove, the guide block is inserted in the guide groove, and is slidably connected with the guide groove .
进一步的,所述夹具下方开设有夹槽,所述标定板上端插设在所述夹槽内,所述夹具与所述标定板通过固定钉紧固连接,所述夹槽内设置有橡胶垫。Further, a clamping groove is opened under the clamp, the upper end of the calibration plate is inserted into the clamping groove, the clamp and the calibration plate are fastened and connected by fixing nails, and a rubber pad is arranged in the clamping groove .
进一步的,所述标定板材料为浮法玻璃,所述标定板其中一侧表面设置有刻度线,刻度线一侧朝向激光测距仪,所述刻度线为氧化铝喷涂。Further, the material of the calibration plate is float glass, one side surface of the calibration plate is provided with a scale line, and the side of the scale line faces the laser rangefinder, and the scale line is sprayed with alumina.
进一步的,所述固定板上端固定在支架的轴承座板上,两个所述固定板平行设置,所述丝杠和所述导轨与所述固定板垂直设置,所述标定板与所述固定板平行设置。Further, the upper end of the fixed plate is fixed on the bearing seat plate of the bracket, the two fixed plates are arranged in parallel, the screw and the guide rail are arranged perpendicular to the fixed plate, and the calibration plate is connected to the fixed plate The plates are arranged in parallel.
进一步的,一种用于热轧钢带的机械手纠偏方法,用于上述任一所述的用于热轧钢带的机械手纠偏装置,步骤如下:Further, a manipulator deviation correction method for hot-rolled steel strip is used for any one of the above-mentioned manipulator deviation correction devices for hot-rolled steel strip, the steps are as follows:
S1:将所述滚轮抓手从热轧钢带抓取装置拆卸下来,将两个所述固定板上端分别固定在两个支架的轴承座板上,依次安装所述夹具组件和所述标定板;标定板具有刻度线的一侧表面朝向所述激光测距仪;S1: Remove the roller gripper from the hot-rolled steel strip grabbing device, respectively fix the upper ends of the two fixing plates on the bearing seat plates of the two brackets, and install the clamp assembly and the calibration plate in sequence ; The side surface of the calibration plate with the scale marks faces the laser rangefinder;
S2:所述控制模块控制所述标定板分别移动到左侧轴承座板和右侧轴承座板位置处,所述激光测距仪分别在标定板两个位置处进行测距,所述控制模块控制数据处理模块对热轧钢带抓取装置的中间面以及激光测距仪发射激光线的偏转角进行标定;S2: The control module controls the calibration plate to move to the positions of the left bearing seat plate and the right bearing seat plate respectively, and the laser rangefinder performs distance measurement at the two positions of the calibration plate respectively, and the control module The control data processing module calibrates the middle surface of the hot-rolled steel strip grabbing device and the deflection angle of the laser line emitted by the laser rangefinder;
S3:依次拆卸所述夹具组件、所述标定板和所述固定板,将所述滚轮抓手安装到两个支架的轴承座板上;S3: Disassemble the fixture assembly, the calibration plate and the fixing plate in sequence, and install the roller gripper on the bearing seat plates of the two brackets;
S4:将热轧钢带的机械手移动到热轧钢带生产线上方,使两个滚轮抓手的中间面与辊道中心线对齐;S4: Move the manipulator of the hot-rolled steel strip to the top of the hot-rolled steel strip production line, so that the middle surface of the two roller grippers is aligned with the center line of the roller table;
S5:热轧钢带抓取装置动作,两个滚轮抓手抓取热轧钢带;S5: The hot-rolled steel strip grabbing device operates, and the two roller grippers grab the hot-rolled steel strip;
S6:所述控制模块控制所述激光测距仪在热轧钢带头部的左侧进行测距,并将测距信号传输给控制模块;S6: the control module controls the laser rangefinder to perform distance measurement on the left side of the head of the hot-rolled steel strip, and transmits the distance measurement signal to the control module;
S7:所述控制模块控制数据处理模块进行数据计算,根据激光测距仪发射激光线的偏转角计算热轧钢带头部偏移热轧钢带抓取装置的中间面的距离,并判断热轧钢带头部的偏移方向,热轧钢带的机械手针对偏移距离和偏移方向进行位置补偿。S7: The control module controls the data processing module to perform data calculation, and calculates the distance of the head of the hot-rolled steel strip from the middle surface of the hot-rolled steel strip grasping device according to the deflection angle of the laser line emitted by the laser range finder, and judges the hot-rolled strip The offset direction of the steel strip head, the manipulator of the hot-rolled steel strip performs position compensation for the offset distance and offset direction.
进一步的,所述步骤S2中,所述控制模块控制所述标定板分别移动到左侧轴承座板和右侧轴承座板位置处,所述激光测距仪分别在标定板两个位置处进行测距,所述控制模块控制数据处理模块对热轧钢带抓取装置的中间面以及激光测距仪发射激光线的偏转角进行标定,具体方法为:Further, in the step S2, the control module controls the calibration plate to move to the positions of the left bearing seat plate and the right bearing seat plate, respectively, and the laser rangefinder is respectively carried out at the two positions of the calibration plate. Ranging, the control module controls the data processing module to calibrate the middle surface of the hot-rolled steel strip grabbing device and the deflection angle of the laser line emitted by the laser range finder, the specific method is:
S21:所述控制模块控制电机动作,驱动所述丝杠转动,所述移动块带动标定板向左侧移动,同时气缸的活塞杆伸出推动滑动板向左侧移动,使标定板具有刻度线的一侧表面与左侧轴承座板表面所在平面对齐;S21: the control module controls the action of the motor to drive the screw to rotate, the moving block drives the calibration plate to move to the left, and the piston rod of the cylinder extends to push the sliding plate to move to the left, so that the calibration plate has a scale line One side of the surface is aligned with the plane of the surface of the left bearing seat plate;
S22:以激光测距仪上激光发射点为原点O,以垂直于支架的轴承座板的方向为Y方向,竖直方向为Z方向,建立空间直角坐标系;S22: taking the laser emission point on the laser rangefinder as the origin O, taking the direction perpendicular to the bearing seat plate of the bracket as the Y direction, and the vertical direction as the Z direction, establish a space Cartesian coordinate system;
S23:所述控制模块控制激光测距仪向标定板发射激光线,在标定板上打出光点A并标记下来,激光测距仪测量OA的距离为L1;S23: the control module controls the laser rangefinder to emit a laser line to the calibration plate, and marks the light point A on the calibration plate, and the distance of the laser rangefinder to measure OA is L 1 ;
S24:所述控制模块控制电机动作,驱动所述丝杠反向转动,所述移动块带动标定板向右侧移动,同时气缸的活塞杆回缩,拉动滑动板向右侧移动,使标定板具有刻度线的一侧表面与右侧轴承座板表面所在平面对齐;S24: The control module controls the action of the motor, drives the lead screw to rotate in reverse, the moving block drives the calibration plate to move to the right, and at the same time, the piston rod of the cylinder retracts, pulling the sliding plate to move to the right, so that the calibration plate The surface of one side with scale marks is aligned with the plane of the surface of the right bearing seat plate;
S25:所述控制模块控制激光测距仪向标定板发射激光线,在标定板上打出光点B并标记下来,激光测距仪测量OB的距离为L2;S25: the control module controls the laser rangefinder to emit laser lines to the calibration board, and marks the spot B on the calibration board, and the distance of the laser rangefinder to measure OB is L 2 ;
S26:所述控制模块控制数据处理模块对数据进行处理,建立热轧钢带纠偏的投影模型,求取热轧钢带抓取装置的中间面和激光测距仪发射激光线相对于ZY平面的偏转角α、激光测距仪发射激光线相对于XY平面的偏转角β。S26: The control module controls the data processing module to process the data, establishes a projection model for hot-rolled steel strip correction, and obtains the distance between the middle plane of the hot-rolled steel strip grabbing device and the laser line emitted by the laser rangefinder relative to the ZY plane Deflection angle α, deflection angle β of the laser line emitted by the laser rangefinder relative to the XY plane.
进一步的,所述S26中建立热轧钢带纠偏的投影模型,求取热轧钢带抓取装置的中间面和激光测距仪发射激光线相对于ZY平面的偏转角α、激光测距仪发射激光线相对于XY平面的偏转角β的具体算法为:Further, in said S26, a projection model for rectifying the hot-rolled steel strip is established, and the middle plane of the hot-rolled steel strip grasping device and the deflection angle α of the laser line emitted by the laser rangefinder relative to the ZY plane, and the deflection angle α of the laser rangefinder The specific algorithm for the deflection angle β of the emitted laser line relative to the XY plane is:
S261:将标定板分别位于左侧和右侧位置处看做在夹具组件上同时放置两个相同的标定板,两个标定板具有刻度线的一侧表面朝向激光测距仪,激光测距仪发出的激光线看做同时打在两个标定板上,与两个标定板交点为点A和点B;S261: The calibration plates located on the left and right sides are regarded as placing two identical calibration plates on the fixture assembly at the same time. The side surfaces of the two calibration plates with the scale lines face the laser rangefinder, and the laser rangefinder The emitted laser line is regarded as hitting two calibration boards at the same time, and the intersection with the two calibration boards is point A and point B;
S262:将点A沿Y轴方向在右侧标定板上的投影为点D,点B、点D分别在右侧标定板上沿Z轴方向和X轴方向做直线,点B沿Z轴方向的直线与点D沿X轴方向的直线交点为C,点B沿X轴方向的直线与点D沿Z轴方向的直线交点为E,线段AD与线段AC的夹角为激光测距仪发射激光线相对于ZY平面的偏转角α,线段AC与线段AB的夹角为激光测距仪发射激光线相对于XY平面的偏转角β;S262: The projection of point A along the Y-axis direction on the right calibration plate is point D, point B and point D are respectively drawn as a straight line along the Z-axis direction and the X-axis direction on the right calibration plate, and point B is along the Z-axis direction The intersection point of the straight line and point D along the X-axis direction is C, the intersection point of the straight line along the X-axis direction of point B and the straight line along the Z-axis direction of point D is E, and the angle between the line segment AD and the line segment AC is the laser rangefinder emission. The deflection angle α of the laser line relative to the ZY plane, the angle between the line segment AC and the line segment AB is the deflection angle β of the laser line emitted by the laser rangefinder relative to the XY plane;
S263:已知线段AD的长度为l,l为支架上两个轴承座板之间的距离,线段AB的长度为L,L=L2-L1,线段CD和线段CB长度可由标定板上刻度线得出,分别记为d和h;由于tanα=d/l,可求出α的大小;由于sinβ=h/L,可求出β的大小;S263: The length of line segment AD is known as l, l is the distance between the two bearing seat plates on the bracket, the length of line segment AB is L, L=L 2 -L 1 , the length of line segment CD and line segment CB can be obtained from the calibration board The scale line is obtained, which are recorded as d and h respectively; since tanα=d/l, the size of α can be obtained; since sinβ=h/L, the size of β can be obtained;
S264:分别取线段AB、AC、AD和AE的中点,记为点F、点I、点H和点G,点F、点I、点H和点G组成的平面HIGF为热轧钢带抓取装置的中间面,线段OF长度为L3,L3=(L1+L2)/2。S264: Take the midpoints of line segments AB, AC, AD and AE respectively, and record them as points F, point I, point H and point G, and the plane HIGF formed by point F, point I, point H and point G is a hot-rolled steel strip The length of the line segment OF on the middle surface of the grabbing device is L 3 , where L 3 =(L 1 +L 2 )/2.
进一步的,所述步骤S7中,所述控制模块控制数据处理模块进行数据计算,根据激光测距仪发射激光线的偏转角计算热轧钢带头部偏移热轧钢带抓取装置的中间面的距离,并判断热轧钢带头部的偏移方向,热轧钢带的机械手针对偏移距离和偏移方向进行位置补偿的具体方法为:Further, in the step S7, the control module controls the data processing module to perform data calculation, and calculates the offset of the head of the hot-rolled steel strip from the middle surface of the hot-rolled steel strip grasping device according to the deflection angle of the laser line emitted by the laser rangefinder distance, and judge the offset direction of the head of the hot-rolled steel strip. The specific method for the position compensation of the manipulator of the hot-rolled steel strip for the offset distance and offset direction is as follows:
S71:已知激光测距仪打到钢带头部左侧,记为点N,测得线段ON距离L4,计算XY平面上热轧钢带头部偏移距离Δl,Δl=(L4-L3)cosβ;S71: It is known that the laser rangefinder hits the left side of the steel strip head, which is recorded as point N, and the ON distance L 4 of the line segment is measured, and the offset distance Δl of the hot-rolled steel strip head on the XY plane is calculated, Δl=(L 4 -L 3 ) cosβ;
S72:计算ZY平面上热轧钢带头部偏移距离ΔL,ΔL=Δlcosα=(L4-L3)cosβcosα;S72: Calculate the head offset distance ΔL of the hot-rolled steel strip on the ZY plane, ΔL=Δlcosα=(L 4 -L 3 )cosβcosα;
S73:由于钢带厚度的影响,ZY平面上热轧钢带头部偏移距离ΔL会产生误差,计算ΔL时将钢带厚度t计入,最终ZY平面上钢带头部偏移距离ΔL’=(L4-L3)cosβcosα-t/2;S73: Due to the influence of the thickness of the steel strip, the offset distance ΔL of the head of the hot-rolled steel strip on the ZY plane will produce errors. When calculating ΔL, the thickness t of the steel strip will be included, and the final offset distance of the strip head on the ZY plane ΔL'=( L 4 -L 3 )cosβcosα-t/2;
S74:当ΔL’>0时,热轧钢带头部向中间面右侧偏移,热轧钢带的机械手带动热轧钢带抓取装置向辊道中心线左侧偏移ΔL’,当ΔL’<0时,热轧钢带头部向中间面左侧偏移,热轧钢带的机械手带动热轧钢带抓取装置向辊道中心线右侧偏移ΔL’。S74: When ΔL'>0, the head of the hot-rolled steel strip deviates to the right of the middle surface, and the manipulator of the hot-rolled steel strip drives the hot-rolled steel strip grabbing device to deviate ΔL' to the left of the center line of the roller table. When ΔL When '<0, the head of the hot-rolled steel strip deviates to the left of the middle surface, and the manipulator of the hot-rolled steel strip drives the hot-rolled steel strip grabbing device to shift to the right of the center line of the roller table by ΔL'.
本发明所述的一种用于热轧钢带的机械手纠偏装置及纠偏方法,与现有技术相比具有以下优势:A manipulator deviation correction device and deviation correction method for hot-rolled steel strip according to the present invention has the following advantages compared with the prior art:
(1)本发明所述的一种用于热轧钢带的机械手纠偏装置,采用一个标定板分别放置到支架的左右两侧,与支架左右两个轴承座板表面对齐,进行标定,标定时采用电机驱动丝杠移动,气缸驱动滑动板进行微调,避免了手动放置标定板导致定位效果不佳的缺点,位置精确,标定结果更加准确,无需另外设置采集组件,仅需要热轧钢带抓取装置自带的激光测距仪完成整个纠偏过程的测量即可,简单易行;(1) A manipulator correction device for hot-rolled steel strip according to the present invention adopts a calibration plate to be respectively placed on the left and right sides of the bracket, and is aligned with the surfaces of the left and right bearing seat plates of the bracket for calibration. The motor drives the screw to move, and the cylinder drives the sliding plate for fine adjustment, which avoids the disadvantage of poor positioning effect caused by manually placing the calibration plate. The position is accurate and the calibration result is more accurate. The laser rangefinder that comes with the device can complete the measurement of the entire correction process, which is simple and easy;
(2)本发明所述的一种用于热轧钢带的机械手纠偏方法,通过几何分析,建立热轧钢带纠偏的投影模型,对热轧钢带抓取装置的中间面进行找正定位,并计算出热轧钢带在ZY平面的偏移量,并对热轧钢带抓取装置进行位置补偿,使得牵引机器人将热轧钢带顺利送入辊道。(2) A kind of manipulator correction method for hot-rolled steel strip according to the present invention, through geometric analysis, set up the projection model of hot-rolled steel strip correction, carry out alignment and positioning to the middle plane of hot-rolled steel strip grasping device , and calculate the offset of the hot-rolled steel strip in the ZY plane, and perform position compensation on the hot-rolled steel strip grabbing device, so that the traction robot can smoothly send the hot-rolled steel strip into the roller table.
附图说明Description of drawings
构成本发明的一部分的附图用来提供对本发明的进一步理解,本发明的示意性实施例及其说明用于解释本发明,并不构成对本发明的不当限定。在附图中:The drawings constituting a part of the present invention are used to provide a further understanding of the present invention, and the schematic embodiments and descriptions of the present invention are used to explain the present invention, and do not constitute an improper limitation of the present invention. In the attached picture:
图1为本发明背景技术所述的钢带牵引机器人的机械手上设置的热轧钢带抓取装置结构示意图;Fig. 1 is the structural representation of the hot-rolled steel strip grasping device that is arranged on the manipulator of the strip traction robot described in the background technology of the present invention;
图2为本发明实施例所述用于热轧钢带的机械手纠偏装置中标定板位于右侧轴承座板位置结构示意图;Fig. 2 is a schematic diagram of the position of the calibration plate located on the right bearing seat plate in the manipulator deviation correction device for hot-rolled steel strip according to the embodiment of the present invention;
图3为本发明实施例图2中M处放大图;Fig. 3 is the enlarged view at M place in Fig. 2 of the embodiment of the present invention;
图4为本发明实施例标定组件局部分解示意图;Fig. 4 is a partial exploded schematic diagram of the calibration assembly of the embodiment of the present invention;
图5为本发明实施例所述标定板位于左侧轴承座板位置结构示意图;Fig. 5 is a schematic diagram of the position of the calibration plate in the embodiment of the present invention at the position of the bearing seat plate on the left side;
图6为本发明实施例热轧钢带纠偏的投影模型示意图;Fig. 6 is the schematic diagram of the projection model of the deviation correction of the hot-rolled steel strip according to the embodiment of the present invention;
图7为本发明实施例所述热轧钢带纠偏的投影模型以及中间面位置示意图;Fig. 7 is a schematic diagram of the projection model and the position of the middle plane of the hot-rolled steel strip deflection correction according to the embodiment of the present invention;
图8为本发明实施例热轧钢带抓取时从XY平面展示示意图;Fig. 8 is a schematic diagram showing from the XY plane when grabbing the hot-rolled steel strip according to the embodiment of the present invention;
图9为本发明实施例热轧钢带抓取时从与点A、B、C所在平面展示示意图;Fig. 9 is a schematic diagram showing the plane where points A, B, and C are located when grabbing the hot-rolled steel strip according to the embodiment of the present invention;
图10为发明实施例用于热轧钢带的机械手纠偏装置左视图。Fig. 10 is a left view of the manipulator deflection correction device for hot-rolled steel strip according to the embodiment of the invention.
附图标记说明:Explanation of reference signs:
1、热轧钢带抓取装置;10、支架;11、轴承座板;12、轴承座;13、滚轮抓手;2、激光测距仪;3、标定板;4、夹具组件;41、电机;42、丝杠;43、导轨;44、移动块;441、滚珠螺母;45、气缸安装板;451、导向块;471、导向槽;46、气缸;47、滑动板;48、夹具;481、固定钉;482、夹槽;5、固定板;6、热轧钢带;7、中间面。1. Hot-rolled steel strip grabbing device; 10. Bracket; 11. Bearing seat plate; 12. Bearing seat; 13. Roller gripper; 2. Laser range finder; 3. Calibration plate; 4. Fixture assembly; 41. Motor; 42, lead screw; 43, guide rail; 44, moving block; 441, ball nut; 45, cylinder mounting plate; 451, guide block; 471, guide groove; 46, cylinder; 47, sliding plate; 48, fixture; 481, fixed nail; 482, clip groove; 5, fixed plate; 6, hot-rolled steel strip; 7, middle surface.
具体实施方式Detailed ways
需要说明的是,在本发明中涉及“第一”、“第二”、“上”、“下”、“左”、“右”等的描述仅用于描述目的,而不能理解为指示或暗示其相对重要性或者隐含指明所指示的技术特征的数量。由此,限定有“第一”、“第二”特征可以明示或者隐含地包括至少一个该特征。“上”、“下”、“左”、“右”等以图中标注为准,另外,各个实施例之间的技术方案可以相互结合,但是必须是以本领域普通技术人员能够实现为基础,当实施例之间的技术方案能够实现结合的,均在本发明要求的保护范围之内。It should be noted that the descriptions in the present invention involving "first", "second", "upper", "lower", "left", "right" etc. Implying their relative importance or implying the number of technical features indicated. Thus, the definition of "first" and "second" features may explicitly or implicitly include at least one of these features. "Up", "Down", "Left", "Right", etc. are subject to the marks in the figure. In addition, the technical solutions of the various embodiments can be combined with each other, but it must be based on the realization of those skilled in the art. When the technical solutions among the embodiments can be combined, they all fall within the scope of protection required by the present invention.
下面将参考附图并结合实施例来详细说明本发明。The present invention will be described in detail below with reference to the accompanying drawings and examples.
具体实施例如图1-图9所示,一种用于热轧钢带的机械手纠偏装置,包括控制模块、数据处理模块、激光测距仪2和标定模块:As shown in Fig. 1-Fig. 9, a kind of manipulator deflection correction device for hot-rolled steel strip includes a control module, a data processing module, a laser range finder 2 and a calibration module:
标定模块包括固定板5、夹具组件4和标定板3,固定板5设置有两块,分别固定在热轧钢带抓取装置1的两个支架10上,夹具组件4两端设置在两个固定板5的下方,标定板3设置在夹具组件4下方,能够沿夹具组件4左右移动;The calibration module includes a fixed plate 5, a clamp assembly 4 and a calibration plate 3. There are two fixed plates 5, which are respectively fixed on the two supports 10 of the hot-rolled steel strip grabbing device 1. The two ends of the clamp assembly 4 are arranged on two Below the fixed plate 5, the calibration plate 3 is arranged below the fixture assembly 4, and can move left and right along the fixture assembly 4;
具体的,固定板5为L形,夹具组件4连接在固定板5远离轴承座板11的延伸端下方,这样能够保证激光测距仪2将光线打到标定板3表面上;固定板5长边的端头固定在支架10的轴承座板11上,两个固定板5平行设置,夹具组件4垂直于固定板5的方向设置,标定板3平行于固定板5设置,使得标定板3与中间面平行,便于根据后续计算找出中间面;Specifically, the fixed plate 5 is L-shaped, and the clamp assembly 4 is connected below the extension end of the fixed plate 5 away from the bearing seat plate 11, so that the laser rangefinder 2 can be guaranteed to hit the light on the surface of the calibration plate 3; the fixed plate 5 is long The end of the side is fixed on the bearing seat plate 11 of the bracket 10, the two fixed plates 5 are arranged in parallel, the clamp assembly 4 is arranged perpendicular to the direction of the fixed plate 5, and the calibration plate 3 is arranged parallel to the fixed plate 5, so that the calibration plate 3 and the fixed plate 5 are arranged. The middle plane is parallel, which is convenient to find out the middle plane according to the subsequent calculation;
进一步的,夹具组件4包括电机41、丝杠42、导轨43、移动块44、气缸46、气缸安装板45、夹具48和滑动板47,丝杠42和导轨43平行设置,导轨43设置有两根,丝杠42设置在两根导轨43之间,丝杠42和导轨43的两端分别与两个所述固定板5下方可转动连接,电机41与丝杠42其中一端驱动连接,移动块44同时套设在丝杠42和导轨43上,移动块44中部设置有滚珠螺母441,滚珠螺母441与丝杠42螺接,移动块44两侧套设在导轨43上,与导轨43可滑动连接,整个移动块44滑动更加平稳,移动精度高,气缸安装板45固定设置在移动块44下部,气缸46的缸体固定设置在气缸安装板45下方,气缸46的活塞杆与滑动板47固定连接,滑动板47与气缸安装板45可滑动连接,优选的,固定在气缸安装板45的端头处,滑动板47滑动时不易脱出,滑动板47下方固定设置有夹具48,夹具48与标定板3固定连接,气缸46、滑动板47的设置可对标定板3的位置进行微调,使得标定板3与轴承座板11表面能够平齐,便于后续激光测距仪2发射接收光线进行测距,并且根据测距信息计算中间面。Further, the fixture assembly 4 includes a motor 41, a leading screw 42, a guide rail 43, a moving block 44, a cylinder 46, a cylinder mounting plate 45, a clamp 48 and a slide plate 47, the leading screw 42 and the guide rail 43 are arranged in parallel, and the guide rail 43 is provided with two root, the lead screw 42 is arranged between the two guide rails 43, the two ends of the lead screw 42 and the guide rail 43 are respectively rotatably connected to the bottom of the two fixed plates 5, the motor 41 is connected to one end of the lead screw 42 by driving, and the moving block 44 is sleeved on the lead screw 42 and the guide rail 43 at the same time, the middle part of the moving block 44 is provided with a ball nut 441, the ball nut 441 is screwed with the lead screw 42, the two sides of the moving block 44 are sleeved on the guide rail 43, and the guide rail 43 can slide connected, the entire moving block 44 slides more smoothly, and the moving accuracy is high. The cylinder mounting plate 45 is fixedly arranged on the lower part of the moving block 44, the cylinder body of the cylinder 46 is fixedly arranged below the cylinder mounting plate 45, and the piston rod of the cylinder 46 is fixed to the sliding plate 47. Connection, the sliding plate 47 is slidably connected with the cylinder mounting plate 45, preferably, fixed on the end of the cylinder mounting plate 45, the sliding plate 47 is not easy to come out when sliding, and a clamp 48 is fixedly arranged below the sliding plate 47, and the clamp 48 is connected with the calibration The plate 3 is fixedly connected, and the setting of the cylinder 46 and the sliding plate 47 can fine-tune the position of the calibration plate 3, so that the surface of the calibration plate 3 and the bearing seat plate 11 can be flush, which is convenient for the subsequent laser rangefinder 2 to emit and receive light for distance measurement , and calculate the midplane based on the ranging information.
进一步的,气缸安装板45下部表面凸起设置有导向块451,滑动板47上部表面开设有导向槽471,导向块451插设在导向槽471内,且与导向槽471可滑动连接,导向块451和导向槽471截面为燕尾形,导向块451与导向槽471插接后不易脱落。Further, the lower surface of the cylinder mounting plate 45 protrudes and is provided with a guide block 451, the upper surface of the sliding plate 47 is provided with a guide groove 471, the guide block 451 is inserted in the guide groove 471, and is slidably connected with the guide groove 471, and the guide block 451 and the guide groove 471 have a dovetail-shaped section, and the guide block 451 is not easy to fall off after being plugged into the guide groove 471 .
进一步的,夹具48下方开设有夹槽482,标定板3上端插设在所述夹槽482内,在连接时起到定位作用,夹具48与标定板3通过固定钉481紧固连接,夹槽482内设置有橡胶垫,使标定板3与夹槽482连接更紧固,定位时不易脱落。Further, a clamping groove 482 is opened below the clamp 48, and the upper end of the calibration plate 3 is inserted in the clamping groove 482, which plays a positioning role during connection. The clamp 48 and the calibration plate 3 are fastened and connected by fixing nails 481, and the clamping groove 482 is provided with a rubber pad, so that the connection between the calibration plate 3 and the clamping groove 482 is tighter, and it is not easy to fall off during positioning.
标定板3材料为浮法玻璃,标定板3其中一侧的表面设置有刻度线,刻度线一侧3朝向激光测距仪2,刻度线为氧化铝喷涂,光源直射时,不会发生漫反射,夹具48、气缸安装板45、滑动板47、导轨43、丝杠42和固定板5均为铝合金材料进行加工,加工精度为±0.01mm,保证各表面的平行度良好。The material of the calibration plate 3 is float glass, and one side of the calibration plate 3 is provided with a scale line. The side 3 of the scale line faces the laser rangefinder 2. The scale line is sprayed with alumina. When the light source is directly irradiated, there will be no diffuse reflection. , The fixture 48, the cylinder mounting plate 45, the sliding plate 47, the guide rail 43, the screw 42 and the fixing plate 5 are all processed by aluminum alloy materials, and the machining accuracy is ± 0.01mm to ensure that the parallelism of each surface is good.
进一步的,激光测距仪2固定在热轧钢带抓取装置1的左侧上方,与中间面呈夹角设置,向标定板发射激光线以及接收激光线进行测距,并将测距信号发送给控制模块,激光线的方向倾斜向下;Further, the laser rangefinder 2 is fixed on the upper left side of the hot-rolled steel strip grabbing device 1, and is set at an angle with the middle surface, emits laser lines to the calibration plate and receives laser lines for distance measurement, and transmits the distance measurement signal Sent to the control module, the direction of the laser line is inclined downward;
控制模块分别与数据处理模块、激光测距模块和标定组件连接,控制激光测距模块发射激光线以及接收激光线进行测距,接收测距信号发送给数据处理模块进行计算,控制标定组件中驱动标定板3移动的机构发生动作,控制电机41以及气缸46进行动作。The control module is respectively connected with the data processing module, the laser ranging module and the calibration component, controls the laser ranging module to emit laser lines and receive laser lines for ranging, receives the ranging signal and sends it to the data processing module for calculation, and controls the drive in the calibration component The moving mechanism of the calibration plate 3 is activated, and the motor 41 and the cylinder 46 are controlled to operate.
进一步的,一种用于热轧钢带的机械手纠偏方法,用于上述任一所述的用于热轧钢带的机械手纠偏装置,步骤如下:Further, a manipulator deviation correction method for hot-rolled steel strip is used for any one of the above-mentioned manipulator deviation correction devices for hot-rolled steel strip, the steps are as follows:
S1:将滚轮抓手13从热轧钢带抓取装置1拆卸下来,将两个所述固定板5上端分别固定在两个支架10的轴承座板11上,依次安装夹具组件4和标定板3;标定板3具有刻度线的一侧表面朝向所述激光测距仪2;S1: Remove the roller gripper 13 from the hot-rolled steel strip grabbing device 1, fix the upper ends of the two fixing plates 5 on the bearing seat plates 11 of the two brackets 10 respectively, and install the clamp assembly 4 and the calibration plate in sequence 3. The side surface of the calibration plate 3 with the scale marks faces the laser rangefinder 2;
S2:控制模块控制标定板3分别移动到左侧轴承座板11和右侧轴承座板11位置处,使得标定板3具有刻度线的一侧表面与轴承座板11用于安装轴承座12的表面平齐,激光测距仪2分别在标定板3左右两个位置处进行测距,控制模块控制数据处理模块对热轧钢带抓取装置1的中间面7以及激光测距仪2发射的激光线的偏转角进行标定;S2: The control module controls the calibration plate 3 to move to the positions of the left bearing seat plate 11 and the right bearing seat plate 11 respectively, so that the side surface of the calibration plate 3 with the scale line and the bearing seat plate 11 are used to install the bearing seat 12 The surface is even, and the laser range finder 2 performs distance measurement at two positions on the left and right of the calibration plate 3 respectively. The deflection angle of the laser line is calibrated;
S3:依次拆卸夹具组件4、标定板3和固定板5,将滚轮抓手13安装到两个支架10的轴承座板11上;S3: Disassemble the fixture assembly 4, the calibration plate 3 and the fixed plate 5 in sequence, and install the roller handle 13 on the bearing seat plates 11 of the two brackets 10;
S4:将热轧钢带的机械手移动到热轧钢带生产线上方,使热轧钢带抓取装置1的中间面与辊道中心线对齐;S4: Move the manipulator of the hot-rolled steel strip to the top of the hot-rolled steel strip production line, so that the middle surface of the hot-rolled steel strip grasping device 1 is aligned with the center line of the roller table;
S5:热轧钢带抓取装置1动作,两个滚轮抓手13抓取热轧钢带;S5: The hot-rolled steel strip grasping device 1 operates, and the two roller grippers 13 grasp the hot-rolled steel strip;
S6:控制模块控制激光测距仪2在热轧钢带头部的左侧进行测距,并将测距信号传输给控制模块;S6: the control module controls the laser range finder 2 to perform distance measurement on the left side of the head of the hot-rolled steel strip, and transmits the distance measurement signal to the control module;
S7:控制模块控制数据处理模块进行数据计算,根据激光测距仪2偏转角计算热轧钢带头部偏移热轧钢带抓取装置1的中间面7的距离,并判断热轧钢带头部的偏移方向,热轧钢带的机械手针对偏移距离和偏移方向进行位置补偿。S7: the control module controls the data processing module to perform data calculation, and calculates the distance of the head of the hot-rolled steel strip offset from the middle surface 7 of the hot-rolled steel strip grasping device 1 according to the deflection angle of the laser rangefinder 2, and judges the head of the hot-rolled steel strip The manipulator of the hot-rolled steel strip performs position compensation for the offset distance and offset direction.
进一步的,如图2和图5、图6、图7所示,所述步骤S2中,控制模块控制所述标定板3分别移动到左侧轴承座板11和右侧轴承座板11位置处,所述激光测距仪2分别在标定板3两个位置处进行测距,所述控制模块控制数据处理模块对热轧钢带抓取装置1的中间面7以及激光测距仪2发射的激光线的偏转角进行标定,具体方法为:Further, as shown in Figure 2 and Figure 5, Figure 6, and Figure 7, in the step S2, the control module controls the calibration plate 3 to move to the positions of the left bearing seat plate 11 and the right bearing seat plate 11 respectively , the laser rangefinder 2 performs distance measurement at two positions of the calibration plate 3 respectively, and the control module controls the data processing module for the middle surface 7 of the hot-rolled steel strip grabbing device 1 and the laser rangefinder 2. The deflection angle of the laser line is calibrated, the specific method is:
S21:所述控制模块控制电机动作,驱动丝杠42转动,移动块44带动气缸安装板45、气缸46、滑动板47、夹具48以及标定板3向左侧移动,同时气缸46的活塞杆伸出推动滑动板47向左侧移动,使标定板3具有刻度线的一侧表面与左侧轴承座板11用于安装轴承座12的表面平齐;S21: The control module controls the action of the motor, drives the screw 42 to rotate, the moving block 44 drives the cylinder mounting plate 45, the cylinder 46, the sliding plate 47, the clamp 48 and the calibration plate 3 to move to the left, and at the same time the piston rod of the cylinder 46 extends Push the sliding plate 47 to move to the left, so that the side surface of the calibration plate 3 with the scale line is flush with the surface of the left bearing seat plate 11 for installing the bearing seat 12;
S22:所示,以激光测距仪2上激光发射点为原点O,以垂直于支架10的轴承座板11用于安装轴承座12的表面的方向为Y方向,竖直方向为Z方向,建立空间直角坐标系;S22: As shown, take the laser emission point on the laser rangefinder 2 as the origin O, take the direction perpendicular to the surface of the bearing seat plate 11 of the bracket 10 for mounting the bearing seat 12 as the Y direction, and the vertical direction as the Z direction, Establish a space Cartesian coordinate system;
S23:控制模块控制激光测距仪2向标定板3发射激光线,在标定板3上打出光点A并标记下来,激光测距仪2测量OA的距离为L1;S23: the control module controls the laser rangefinder 2 to emit a laser line to the calibration plate 3, and marks the light point A on the calibration plate 3, and the distance of the laser rangefinder 2 to measure OA is L 1 ;
S24:所述控制模块控制电机41动作,驱动所述丝杠42反向转动,所述移动块44带动气缸安装板45、气缸46、滑动板47、夹具48以及标定板3向右侧移动,同时气缸46的活塞杆回缩,拉动滑动板47向右侧移动,使标定板3具有刻度线的一侧表面与右侧轴承座板11用于安装轴承座12表面所在平面对齐;S24: the control module controls the action of the motor 41 to drive the screw 42 to rotate in reverse, and the moving block 44 drives the cylinder mounting plate 45, the cylinder 46, the sliding plate 47, the clamp 48 and the calibration plate 3 to move to the right, Simultaneously, the piston rod of the cylinder 46 is retracted, and the sliding plate 47 is pulled to move to the right, so that the side surface of the calibration plate 3 with the scale line is aligned with the plane where the bearing seat plate 11 on the right side is used to install the surface of the bearing seat 12;
S25:所述控制模块控制激光测距仪2向标定板3发射激光线,在标定板3上打出光点B并标记下来,激光测距仪2测量OB的距离为L2;S25: the control module controls the laser rangefinder 2 to emit a laser line to the calibration plate 3, and marks the light point B on the calibration plate 3, and the distance of the laser rangefinder 2 to measure OB is L 2 ;
S26:所述控制模块控制数据处理模块对数据进行处理,建立热轧钢带纠偏的投影模型,该投影模型为激光测距仪2在标定板3分别位于左侧轴承座板11和右侧轴承座板11位置处发射激光线的投影模型,求取热轧钢带抓取装置1的中间面7和激光测距仪2发射的激光线相对于ZY平面的偏转角α、激光测距仪2发射的激光线相对于XY平面的偏转角β。S26: The control module controls the data processing module to process the data, and establishes a projection model for correcting the hot-rolled steel strip. The projection model is that the laser rangefinder 2 is respectively located on the left bearing seat plate 11 and the right bearing on the calibration plate 3 The projection model of the laser line emitted at the position of the seat plate 11 is to obtain the deflection angle α of the laser line emitted by the middle plane 7 of the hot-rolled steel strip grabbing device 1 and the laser rangefinder 2 relative to the ZY plane, and the laser rangefinder 2 The deflection angle β of the emitted laser line relative to the XY plane.
进一步的,所述S26中建立热轧钢带纠偏的投影模型,求取热轧钢带抓取装置1的中间面7和激光测距仪2发射的激光线相对于ZY平面的偏转角α、激光测距仪2发射的激光线相对于XY平面的偏转角β的具体算法为:Further, in said S26, a projection model for rectifying the hot-rolled steel strip is established, and the deflection angle α, The specific algorithm of the deflection angle β of the laser line emitted by the laser rangefinder 2 relative to the XY plane is:
S261:将标定板3分别位于左侧轴承座板11和右侧轴承座板11位置处看做在夹具组件4上同时放置两个相同的标定板3,两个标定板3具有刻度线的一侧表面朝向激光测距仪2,激光测距仪2发出的激光线看做同时打在两个标定板3上,与两个标定板交点为点A和点B;S261: The calibration plates 3 are respectively located at the positions of the left bearing seat plate 11 and the right bearing seat plate 11 as placing two identical calibration plates 3 on the fixture assembly 4 at the same time, and the two calibration plates 3 have a scale line The side surface is facing the laser range finder 2, and the laser line emitted by the laser range finder 2 is regarded as hitting two calibration plates 3 at the same time, and the intersection with the two calibration plates is point A and point B;
S262:将点A沿Y轴方向在右侧标定板上的投影为点D,点B、点D分别在右侧标定板上沿Z轴方向和X轴方向做直线,点B沿Z轴方向的直线与点D沿X轴方向的直线交点为C,点B沿X轴方向的直线与点D沿Z轴方向的直线交点为E,线段AD与线段AC的夹角为激光测距仪2发射的激光线相对于ZY平面的偏转角α,线段AC与线段AB的夹角为激光测距仪2发射的激光线相对于XY平面的偏转角β;S262: The projection of point A along the Y-axis direction on the right calibration plate is point D, point B and point D are respectively drawn as a straight line along the Z-axis direction and the X-axis direction on the right calibration plate, and point B is along the Z-axis direction The intersection point of the straight line and the point D along the X-axis direction is C, the intersection point of the straight line along the X-axis direction of point B and the point D along the Z-axis direction is E, and the angle between the line segment AD and the line segment AC is the laser rangefinder 2 The deflection angle α of the emitted laser line relative to the ZY plane, the angle between the line segment AC and the line segment AB is the deflection angle β of the laser line emitted by the laser rangefinder 2 relative to the XY plane;
由于点A、D、C所在平面与XY平面平行,点A、D、E所在平面与ZY平面平行,所以线段AB与线段AC的夹角β记为激光测距仪2发射的激光线相对于XY平面的偏转角,线段AC与线段AD夹角记为激光测距仪2发射的激光线相对于ZY平面的偏转角;Since the planes where points A, D, and C are located are parallel to the XY plane, and the planes where points A, D, and E are located are parallel to the ZY plane, the angle β between line segment AB and line segment AC is recorded as the laser line emitted by the laser rangefinder 2 relative to The deflection angle of the XY plane, the angle between the line segment AC and the line segment AD is recorded as the deflection angle of the laser line emitted by the laser range finder 2 relative to the ZY plane;
S263:已知线段AD的长度为l,l为支架10上两个轴承座板11之间的距离,线段AB的长度为L,L=L2-L1,线段CD和线段CB长度可由标定板上刻度线得出,分别记为d和h;由于tanα=d/l,可求出α的大小;由于sinβ=h/L,可求出β的大小;S263: The length of the known line segment AD is l, l is the distance between the two bearing seat plates 11 on the bracket 10, the length of the line segment AB is L, L=L 2 -L 1 , the length of the line segment CD and the line segment CB can be calibrated The scale marks on the board are obtained, which are recorded as d and h respectively; since tanα=d/l, the size of α can be obtained; since sinβ=h/L, the size of β can be obtained;
S264:分别取线段AB、AC、AD和AE的中点,记为点F、点I、点H和点G,点F、点I、点H和点G组成的平面HIGF为热轧钢带抓取装置1的中间面7,线段OF长度为L3,L3=(L1+L2)/2。S264: Take the midpoints of line segments AB, AC, AD and AE respectively, and record them as points F, point I, point H and point G, and the plane HIGF formed by point F, point I, point H and point G is a hot-rolled steel strip The length of the line segment OF on the middle surface 7 of the gripping device 1 is L 3 , where L 3 =(L 1 +L 2 )/2.
进一步的,如图8和图9所示,所述步骤S7中,控制模块控制数据处理模块进行数据计算,根据激光测距仪2偏转角计算热轧钢带头部偏移热轧钢带抓取装置1的中间面7的距离,并判断热轧钢带头部的偏移方向,热轧钢带的机械手针对偏移距离和偏移方向进行位置补偿的具体方法为:Further, as shown in Figures 8 and 9, in the step S7, the control module controls the data processing module to perform data calculation, and calculates the head offset of the hot-rolled steel strip according to the deflection angle of the laser rangefinder 2 to grab the hot-rolled steel strip The distance between the middle surface 7 of the device 1 and the offset direction of the head of the hot-rolled steel strip are judged. The specific method for the position compensation of the manipulator of the hot-rolled steel strip for the offset distance and the offset direction is as follows:
S71:已知激光测距仪2打到钢带头部左侧,记为点N,测得线段ON距离L4,计算XY平面上热轧钢带6头部偏移距离Δl,Δl=(L4-L3)cosβ;由于激光测距仪2的位置一定,根据上述建立的热轧钢带6纠偏的投影模型,线段ON经过F点,将点N向XY平面进行投影,得到点Q,线段OQ与中间面7的交点为点P,而线段OQ与线段AC平行,所以线段OQ与线段ON夹角也为β,线段OP与线段FP垂直,Δl为线段PQ的长度,记为XY平面上热轧钢带6头部偏移距离Δl;S71: It is known that the laser range finder 2 hits the left side of the head of the steel strip, which is recorded as point N, and the ON distance L4 of the line segment is measured, and the offset distance Δl of the head of the hot-rolled steel strip 6 on the XY plane is calculated, Δl=(L 4 -L 3 ) cosβ; because the position of the laser rangefinder 2 is fixed, according to the above-mentioned projection model for correcting the deviation of the hot-rolled steel strip 6, the line segment ON passes through the point F, and the point N is projected to the XY plane to obtain the point Q, The intersection of the line segment OQ and the middle plane 7 is point P, and the line segment OQ is parallel to the line segment AC, so the angle between the line segment OQ and the line segment ON is also β, the line segment OP is perpendicular to the line segment FP, and Δl is the length of the line segment PQ, recorded as the XY plane The head offset distance Δl of the upper hot-rolled steel strip 6;
S72:计算ZY平面上热轧钢带6头部偏移距离ΔL,ΔL=Δlcosα=(L4-L3)cosβcosα;点P向在ZY平面上的投影为点W,点Q向ZY面投影为点U,线段OU与线段AD平行,所以线段OQ与线段AD的夹角也为α,线段WU的长度为ΔL,也为点Q到中间面7的距离,记为ZY平面上热轧钢带6头部偏移距离,又由于ZY平面为垂直于辊道中心线,热轧钢带6头部偏移辊道中心线的距离以ZY平面上热轧钢带6头部偏移距离ΔL为准;S72: Calculate the head offset distance ΔL of the hot-rolled steel strip 6 on the ZY plane, ΔL=Δlcosα=(L 4 -L 3 )cosβcosα; the projection of point P on the ZY plane is point W, and the projection of point Q to the ZY plane is the point U, the line segment OU is parallel to the line segment AD, so the angle between the line segment OQ and the line segment AD is also α, the length of the line segment WU is ΔL, which is also the distance from the point Q to the middle plane 7, recorded as the hot rolled steel on the ZY plane The offset distance of the head of the strip 6, and since the ZY plane is perpendicular to the centerline of the roller table, the distance of the offset distance of the head of the hot-rolled steel strip 6 from the centerline of the roller table is equal to the offset distance of the head of the hot-rolled steel strip 6 on the ZY plane ΔL prevail;
S73:由于热轧钢带6厚度的影响,ZY平面上热轧钢带6头部偏移距离△L会产生误差,计算ΔL时将钢带厚度t计入,最终ZY平面上钢带头部偏移距离ΔL’=(L4-L3)cosβcosα-t/2;在实际生产中,热轧钢带生产线的钢带厚度范围是1.2mm-6.5mm,则取中间值t=3.85mm作为补偿基数;S73: Due to the influence of the thickness of the hot-rolled steel strip 6, the offset distance △L of the head of the hot-rolled steel strip 6 on the ZY plane will produce an error. Moving distance ΔL'=(L 4 -L 3 )cosβcosα-t/2; in actual production, the steel strip thickness range of the hot-rolled steel strip production line is 1.2mm-6.5mm, then take the middle value t=3.85mm as compensation base;
S74:当ΔL’>0时,热轧钢带6头部向中间面7右侧偏移,热轧钢带6的机械手带动热轧钢带抓取装置1向辊道中心线左侧偏移ΔL’,当ΔL’<0时,热轧钢带6头部向中间面7左侧偏移,热轧钢带6的机械手带动热轧钢带抓取装置1向辊道中心线右侧偏移ΔL’。S74: When ΔL'>0, the head of the hot-rolled steel strip 6 deviates to the right of the middle surface 7, and the manipulator of the hot-rolled steel strip 6 drives the hot-rolled steel strip grasping device 1 to deviate to the left of the center line of the roller table ΔL', when ΔL'<0, the head of the hot-rolled steel strip 6 deviates to the left of the middle surface 7, and the manipulator of the hot-rolled steel strip 6 drives the hot-rolled steel strip grasping device 1 to the right of the center line of the roller table Shift ΔL'.
值得说明的是,结合图1和图10所示,由于滚轮抓手13下端到轴承座板11下端的长度为n,n为已知的,直接测量即可得出,而激光测距仪2在对热轧钢带6进行测距时,激光线打在热轧钢带6头部的点距离滚轮抓手13轴线大致20cm,滚轮抓手13轴线位于轴承座板11的中部,因此为了在标定时,激光测距仪2的激光线能够打在标定板3具有刻度线的范围内,固定板5的下端距离轴承座板11下端的长度也为n,滚轮抓手13的轴线位置到固定板5远离轴承座板11的延伸端距离为m,m的取值大致为20cm,夹具组件4连接在固定板5远离轴承座板11的延伸端下方。It is worth noting that, as shown in Figure 1 and Figure 10, since the length from the lower end of the roller gripper 13 to the lower end of the bearing seat plate 11 is n, n is known and can be obtained by direct measurement, while the laser rangefinder 2 When measuring the distance of the hot-rolled steel strip 6, the point where the laser line hits the head of the hot-rolled steel strip 6 is roughly 20 cm away from the axis of the roller grip 13, and the axis of the roller grip 13 is located in the middle of the bearing seat plate 11, so in order to During calibration, the laser line of the laser range finder 2 can be marked within the range of the calibration plate 3 with the scale line, the length of the lower end of the fixed plate 5 from the lower end of the bearing seat plate 11 is also n, and the axis position of the roller gripper 13 reaches the fixed position. The distance from the extension end of the plate 5 away from the bearing seat plate 11 is m, and the value of m is approximately 20 cm. The clamp assembly 4 is connected below the extension end of the fixing plate 5 away from the bearing seat plate 11 .
以上所述实施例仅表达了本发明的几种实施装置,其描述较为具体和详细,但并不能因此而理解为对发明专利范围的限制。The above-mentioned embodiments only express several implementing devices of the present invention, and the description thereof is relatively specific and detailed, but it should not be construed as limiting the patent scope of the invention.
虽然,上文中已经用一般性说明及具体实施例对本发明作了详尽的描述,但在本发明基础上,可以对之作一些修改或改进,这对本领域技术人员而言是显而易见的。因此,在不偏离本发明精神的基础上所做的这些修改或改进,均属于本发明要求保护的范围。Although the present invention has been described in detail with general descriptions and specific examples above, it is obvious to those skilled in the art that some modifications or improvements can be made on the basis of the present invention. Therefore, the modifications or improvements made on the basis of not departing from the spirit of the present invention all belong to the protection scope of the present invention.
Claims (8)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210348093.1A CN114643290B (en) | 2022-03-29 | 2022-03-29 | Device and method for correcting deviation of manipulator for hot-rolled steel strip |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210348093.1A CN114643290B (en) | 2022-03-29 | 2022-03-29 | Device and method for correcting deviation of manipulator for hot-rolled steel strip |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114643290A CN114643290A (en) | 2022-06-21 |
CN114643290B true CN114643290B (en) | 2023-08-01 |
Family
ID=81996289
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210348093.1A Expired - Fee Related CN114643290B (en) | 2022-03-29 | 2022-03-29 | Device and method for correcting deviation of manipulator for hot-rolled steel strip |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114643290B (en) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115055958B (en) * | 2022-08-19 | 2022-12-02 | 上海泽丰半导体科技有限公司 | Automatic deviation rectifying system for needle implantation |
CN116099885A (en) * | 2022-09-09 | 2023-05-12 | 马鞍山钢铁股份有限公司 | An automatic calibration device and calibration method for the front guide of a hot rolling coiler |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO1998058871A1 (en) * | 1997-06-24 | 1998-12-30 | Autefa Maschinenfabrik Gmbh | Bale gripper loader for strapped compressed bales |
CN102658294A (en) * | 2012-05-09 | 2012-09-12 | 永鑫精密材料(无锡)有限公司 | Low-carbon cold-rolled precision ultrathin steel strip for toy industry, and process method and application thereof |
CN204278014U (en) * | 2014-10-31 | 2015-04-22 | 亿和精密工业(苏州)有限公司 | Punching press conveying robot |
CN107127929A (en) * | 2017-06-20 | 2017-09-05 | 东莞市贝禹电子科技有限公司 | A kind of one-to-many injection machine arm device |
-
2022
- 2022-03-29 CN CN202210348093.1A patent/CN114643290B/en not_active Expired - Fee Related
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO1998058871A1 (en) * | 1997-06-24 | 1998-12-30 | Autefa Maschinenfabrik Gmbh | Bale gripper loader for strapped compressed bales |
CN102658294A (en) * | 2012-05-09 | 2012-09-12 | 永鑫精密材料(无锡)有限公司 | Low-carbon cold-rolled precision ultrathin steel strip for toy industry, and process method and application thereof |
CN204278014U (en) * | 2014-10-31 | 2015-04-22 | 亿和精密工业(苏州)有限公司 | Punching press conveying robot |
CN107127929A (en) * | 2017-06-20 | 2017-09-05 | 东莞市贝禹电子科技有限公司 | A kind of one-to-many injection machine arm device |
Also Published As
Publication number | Publication date |
---|---|
CN114643290A (en) | 2022-06-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN114643290B (en) | Device and method for correcting deviation of manipulator for hot-rolled steel strip | |
CN110045465A (en) | A kind of Lens Coupling system and method | |
US9054145B2 (en) | Substrate transfer apparatus | |
CN207404466U (en) | A kind of three axis truss manipulators applied to automobile door plate assembling | |
WO2019136998A1 (en) | Mechanical ceramic tile truss device having visual system | |
CN209961199U (en) | Automatic cutter detection equipment | |
WO2022257681A1 (en) | Interaction system, bricklaying apparatus, bricklaying robot arm and bricklaying positioning method | |
CN112601710A (en) | Mark positioning device of elevator | |
CN114770505B (en) | Grabbing device, assembling equipment and control method of grabbing device | |
CN209485698U (en) | Dummy positioning device for automobile crash test | |
CN115436166A (en) | Method for measuring elongation of tensile deformation material by using video extensometer | |
CN115443363A (en) | Block transfer device and improved clamping assembly for use therewith | |
CN209911606U (en) | Lens coupling system | |
CN221077506U (en) | Beam bottom width measuring device | |
CN204128499U (en) | Multi-functional three coordinate measuring machine | |
CN209966322U (en) | Endoscope image debugging tool | |
CN209888257U (en) | Positioning and feeding equipment | |
JPH0755669A (en) | Automatic tension testing unit | |
CN106325302B (en) | Moving object position tracking platform, tracking device and tracking method | |
CN108994464B (en) | A welding machine including an automatically adjustable walking track type mobile module | |
CN117438366A (en) | Wafer box conveying mechanism and conveying method thereof | |
JP2011102767A (en) | Non-contact type position/attitude measuring method, non-contact type position/attitude measuring device, and semiconductor mounting device equipped with the non-contact type position/attitude measuring device | |
CN116605646A (en) | Battery cell transfer control system | |
CN115230198A (en) | An automatic docking device and method for T-shaped truss skins of large-sized composite wall panels | |
JPH0755670A (en) | Automatic tension testing unit |
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20230801 |
|
CF01 | Termination of patent right due to non-payment of annual fee |