CN114434001A - Weld joint track autonomous tracking algorithm - Google Patents
Weld joint track autonomous tracking algorithm Download PDFInfo
- Publication number
- CN114434001A CN114434001A CN202110314543.0A CN202110314543A CN114434001A CN 114434001 A CN114434001 A CN 114434001A CN 202110314543 A CN202110314543 A CN 202110314543A CN 114434001 A CN114434001 A CN 114434001A
- Authority
- CN
- China
- Prior art keywords
- robot
- line laser
- calculating
- laser
- data
- 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.)
- Pending
Links
- 238000003466 welding Methods 0.000 claims abstract description 27
- 239000013598 vector Substances 0.000 claims abstract description 21
- 238000012937 correction Methods 0.000 claims abstract description 13
- 238000000034 method Methods 0.000 claims description 17
- 238000004364 calculation method Methods 0.000 claims description 12
- 238000013519 translation Methods 0.000 claims description 5
- FGUUSXIOTUKUDN-IBGZPJMESA-N C1(=CC=CC=C1)N1C2=C(NC([C@H](C1)NC=1OC(=NN=1)C1=CC=CC=C1)=O)C=CC=C2 Chemical compound C1(=CC=CC=C1)N1C2=C(NC([C@H](C1)NC=1OC(=NN=1)C1=CC=CC=C1)=O)C=CC=C2 FGUUSXIOTUKUDN-IBGZPJMESA-N 0.000 claims description 2
- 238000006243 chemical reaction Methods 0.000 description 4
- 238000010586 diagram Methods 0.000 description 3
- 238000013178 mathematical model Methods 0.000 description 2
- 230000001131 transforming effect Effects 0.000 description 2
- GNFTZDOKVXKIBK-UHFFFAOYSA-N 3-(2-methoxyethoxy)benzohydrazide Chemical compound COCCOC1=CC=CC(C(=O)NN)=C1 GNFTZDOKVXKIBK-UHFFFAOYSA-N 0.000 description 1
- 206010063385 Intellectualisation Diseases 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B23—MACHINE TOOLS; METAL-WORKING NOT OTHERWISE PROVIDED FOR
- B23K—SOLDERING OR UNSOLDERING; WELDING; CLADDING OR PLATING BY SOLDERING OR WELDING; CUTTING BY APPLYING HEAT LOCALLY, e.g. FLAME CUTTING; WORKING BY LASER BEAM
- B23K26/00—Working by laser beam, e.g. welding, cutting or boring
- B23K26/02—Positioning or observing the workpiece, e.g. with respect to the point of impact; Aligning, aiming or focusing the laser beam
- B23K26/04—Automatically aligning, aiming or focusing the laser beam, e.g. using the back-scattered light
- B23K26/044—Seam tracking
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B23—MACHINE TOOLS; METAL-WORKING NOT OTHERWISE PROVIDED FOR
- B23K—SOLDERING OR UNSOLDERING; WELDING; CLADDING OR PLATING BY SOLDERING OR WELDING; CUTTING BY APPLYING HEAT LOCALLY, e.g. FLAME CUTTING; WORKING BY LASER BEAM
- B23K26/00—Working by laser beam, e.g. welding, cutting or boring
- B23K26/20—Bonding
- B23K26/21—Bonding by welding
Landscapes
- Physics & Mathematics (AREA)
- Optics & Photonics (AREA)
- Engineering & Computer Science (AREA)
- Plasma & Fusion (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
- Numerical Control (AREA)
Abstract
The invention discloses an autonomous tracking algorithm for a welding seam track, which comprises the following steps: determining the initial position of the line laser; specifying a direction vector, and determining the initial position and the position direction of the robot through the movement of line laser; the robot retreats to the initial position; moving along the determined new direction again, determining the next position of the line laser and collecting data; adjusting and calculating the position of the line laser by using the acquired data to obtain the corrected position of the line laser; the robot moves to the correction position, the current position is used as a new initial position, and the search of the welding seam position is repeated; the invention can automatically track the welding seam track, improve the self-adaptability of the robot welding and obviously reduce the workload of on-site teaching and off-line programming of operators.
Description
Technical Field
The invention relates to the technical field of robot welding, in particular to an autonomous tracking algorithm for a welding seam track.
Background
In the welding technology, the welding process is extremely complex, the intelligent welding robot has the characteristics of nonlinearity, time variation, uncertainty and the like, an accurate mathematical model is difficult to establish due to the influence of nonlinearity and other interference factors, complex, fuzzy and uncertain system environments and tasks can be effectively processed by an intelligent system, and the accurate mathematical model is not needed, so that in the welding seam tracking process, the application of an intelligent control theory is more and more emphasized, the software core of intelligent control lies in the research of an algorithm, how to realize the identification and tracking of the welding seam by a robot is a key for further improving the welding automation, flexibility and intellectualization of the robot.
Disclosure of Invention
In order to solve the problems in the prior art, the invention aims to provide an autonomous tracking algorithm of a welding seam track, which can improve the adaptivity of a welding robot and obviously reduce the workload of workers on the welding seam track.
In order to achieve the purpose, the technical scheme provided by the invention is as follows: an autonomous tracking algorithm for a weld trajectory, comprising the steps of:
a. determining the initial position of the line laser;
b. determining the initial position and the movement direction of the robot;
c. the robot moves to an initial position;
d. determining the next position by linear laser and acquiring data;
e. adjusting and calculating the current position of the line laser;
f. the robot moves to the correction position;
g. the processes 3, 4 and 5 are repeated with the current position as the initial position.
As a preferred embodiment. In the step a, the line laser initial position determination means determining the line laser initial position and the attitude in the workpiece coordinate system.
As another preferred embodiment. In step b, the determining of the initial position and the movement direction of the robot specifically comprises:
b1, manually guiding the online laser of the robot to the initial point, and collecting data A0(Nxyz) (data as initial data coordinate system C)0Medium coordinates or coordinates converted into the workpiece coordinate system CW);
b2, initial Direction assignment
i. Method 1
Specifying a direction vector D0The direction vector may be specified using the workpiece coordinate direction as a base vector;
ii. Two-point method
1. Manually guiding the line laser to the next position, collecting dataAt this time, the data coordinate system C after the movement1The coordinate value of (1); need to be converted to the initial data coordinate system C0Centre-of-coordinates or conversion to the work coordinate system CWMiddle coordinate, marked as A1T(N x y z);
As another preferred embodiment, the movement of the robot to the initial position in the step c means that the robot is retracted to the memorized initial position.
As another preferred embodiment, in step d, the line laser next position determining and data acquiring specifically includes:
d1, line laser next position calculation
d2 calculating next position conversion and moving of robot
d3 scanning line laser data and calculating related pose
i. Line laser data scanning
5. According toDetermining the cutting direction of the welding seam and using the cutting direction as the next movement direction of the line laser;
ii. Line laser relative pose calculation (local coordinate system calculation)
As another preferred embodiment, in step e, the adjusting and calculating of the current position of the line laser specifically includes:
e1, correcting position translation (after correction, the center point of the laser stripe and the welding seam point are required to be at the same position)
ii. Correcting robot motion;
e2, correcting position rotation (requiring linear laser measuring plane and T after correction)1Vertical)
i. Calculation of current normal vector of line laser
ii. Rotation angle calculation
1. Around local coordinates
By S obtained in step d1Andtwo known vectors calculate the rotation of the laser stripe to the same as T1Vertical angle, where the data obtained is in a local coordinate system;
2. around the workpiece coordinate
And transforming the data in the local coordinate system to the workpiece coordinate system to obtain the data around the workpiece coordinate system.
As another preferred embodiment, the step f represents moving the robot to the corrected pose.
In another preferred embodiment, the current position is used as an initial position in the step g, and the processes c, d and e are repeated to enable the robot and the line laser to autonomously track the welding seam track.
Drawings
FIG. 1 is a flow chart of an embodiment of the present invention;
FIGS. 2 and 3 are schematic diagrams illustrating the movement process of the laser stripes in step b of the embodiment shown in FIG. 1;
FIG. 4 is a schematic diagram of the movement process of the laser stripe at step d of the embodiment shown in FIG. 1;
FIG. 5 is a schematic diagram of vector calculation in step d of the embodiment shown in FIG. 1;
FIG. 6 is a schematic view of the position translation correction in step e of the embodiment shown in FIG. 1;
FIG. 7 is a schematic view of the position rotation correction in step e of the embodiment shown in FIG. 1
Detailed Description
The present invention will now be described more fully hereinafter with reference to the accompanying drawings.
As shown in fig. 1, an autonomous tracking algorithm for a weld trace includes the following steps:
a. determining the initial position of the line laser;
b. determining the initial position and the movement direction of the robot;
c. the robot moves to an initial position;
d. determining the next position by linear laser and acquiring data;
e. adjusting and calculating the current position of the line laser;
f. the robot moves to the correction position;
g. and (5) taking the current position as an initial position, repeating the processes 3, 4 and 5, completing the autonomous tracking of the welding seam track and correcting the welding seam track.
The line laser initial position determination in the step a refers to determining the line laser initial position and the posture in a workpiece coordinate system, and the equipment can be manually threaded to the initial position.
Step b the initial position and the movement direction of the robot are determined, and the method specifically comprises the following steps:
b1, as shown in figure 2, manually guiding the online laser of the robot to the starting point, and collecting data A0(Nxyz) (data as coordinates in the initial data coordinate system C0 or transformed to the workpiece coordinate system CWMiddle coordinate);
b2, initial Direction assignment
i. Method 1
Specifying a direction vector D0The direction vector may be specified using the workpiece coordinate direction as a base vector;
ii. Two-point method
1. Manually guiding the line laser to the next position, and collecting dataAt this time, the data coordinate system C after the movement1The coordinate value of (1); need to be converted to the initial data coordinate system C0Centre-of-coordinates or conversion to the work coordinate system CWMiddle coordinate, marked as A1T(N x y z);
And c, moving the robot to the initial position, namely enabling the robot to retreat to the memorized initial point and pose after the step b.
As shown in fig. 4 and 5, the line laser next position determination and data acquisition in step d specifically includes:
d1, line laser next position calculation
i. The origin position C1 of the line laser coordinate system,delta is the scanning distance of the laser stripes;
d2, calculating next position conversion and moving of robot
d3 scanning line laser data and calculating related pose
i. Line laser data scanning
5. According toDetermining the cutting direction of the welding seam and using the cutting direction as the next movement direction of the line laser;
ii. Line laser correlation pose calculation
As shown in fig. 6 and 7, the adjusting and calculating of the current position of the line laser in step e specifically includes:
e1, correcting position translation (after correction, the center point of the laser stripe and the welding seam point are required to be at the same position)
ii. Correcting robot motion;
e2, correcting position rotation (requiring linear laser measuring plane and T after correction)1Vertical)
i. Line laser current normal vector calculation
ii. Rotation angle calculation
1. Around local coordinates
By S obtained in step d1Andtwo known vectors calculate the rotation of the laser stripe to the same as T1The angle of the vertical is such that,the data obtained at this time are performed in a local coordinate system;
2. around the workpiece coordinates.
And transforming the data in the local coordinate system to the workpiece coordinate system to obtain the data around the workpiece coordinate system.
And f, moving the robot to a corrected position, and moving the robot and the line laser to the corrected position through the corrected position obtained in the step e so as to obtain a more accurate welding seam track for welding.
And g, taking the current position as an initial position, repeating the steps c, d and e, and enabling the robot and the line laser to automatically track the welding seam track to perform related operations.
The above description of the embodiments of the present invention is specific and detailed, but should not be construed as limiting the scope of the present invention. It should be noted that, for a person skilled in the art, several variations and modifications can be made without departing from the inventive concept, which falls within the scope of the present invention.
Claims (6)
1. An autonomous tracking algorithm for a weld trajectory, comprising the steps of:
a. determining the initial position of the line laser;
b. determining the initial position and the movement direction of the robot;
c. the robot moves to an initial position;
d. determining the next position by linear laser and acquiring data;
e. adjusting and calculating the current position of the line laser;
f. the robot moves to the correction position;
g. and c, repeating the processes d and e by taking the current position as an initial position.
2. The weld joint trajectory autonomous tracking algorithm according to claim 1, wherein in the step b, the determining of the initial position and the movement direction of the robot specifically comprises:
b1, manually guiding the robot to be excitedLight arrives at the starting point, data is collected, and the data intermediate point is marked asCalculated weld joint location points
b2, determining the motion direction of the robot: the method comprises two methods, namely, a method I for specifying a direction vector; two-point method: manually guiding the robot to the next position, collecting data, and recalculating to the next weld feature pointAccording toDetermining the next direction of motion D of the line laser0。
3. The weld joint trajectory autonomous tracking algorithm according to claim 1, wherein in the step d, the line laser next position determination and data acquisition specifically comprise:
d1 calculating next position of linear laser, and calculating the origin of linear laser coordinate systemDelta is a line laser scanning distance, and a coordinate system of the current position of the line laser and the position of the origin thereof are obtained through calculation;
d2, converting, calculating and moving the next position of the robot;
d3, scanning line laser data and calculating related poses.
4. The weld joint track autonomous tracking algorithm according to claim 1, wherein in the step e, the adjustment calculation of the current position of the line laser comprises position translation correction and position rotation correction, a middle point of the line laser data is overlapped with a position point of the weld joint, and the line laser rotates by a certain angle to enable the laser stripe to be perpendicular to the next movement direction.
5. The weld joint track autonomous tracking algorithm according to claim 3, wherein in the step d3, line laser scanning data is utilizedFrom C0Under the coordinate system ComputingAccording toDetermination of T1The tangent direction of the welding seam is taken as the next movement direction; calculating outCalculating the normal vector N1Calculating a sub-tangential vector S1。
6. The weld joint trajectory autonomous tracking algorithm according to claim 4, wherein in the step f, the moving of the robot to the correction position specifically comprises:
e1, correcting position translation, moving line laser, satisfyingThe moving amount and direction are:moving the center point of the laser stripe to be superposed with the position of the welding line;
e2, correcting position rotation, and calculating the current normal vector of the linear laserByAnd S1And calculating the angle required by the rotation of the linear laser stripe from the current position to the position vertical to the moving direction vector, and rotating the robot and the linear laser to the position vertical to the next moving direction.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110314543.0A CN114434001A (en) | 2021-03-24 | 2021-03-24 | Weld joint track autonomous tracking algorithm |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110314543.0A CN114434001A (en) | 2021-03-24 | 2021-03-24 | Weld joint track autonomous tracking algorithm |
Publications (1)
Publication Number | Publication Date |
---|---|
CN114434001A true CN114434001A (en) | 2022-05-06 |
Family
ID=81362232
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110314543.0A Pending CN114434001A (en) | 2021-03-24 | 2021-03-24 | Weld joint track autonomous tracking algorithm |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114434001A (en) |
Citations (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0862963A1 (en) * | 1996-07-19 | 1998-09-09 | Fanuc Ltd. | Welding robot control system |
US20010013511A1 (en) * | 2000-02-11 | 2001-08-16 | Sung-Jin Hong | Method for correcting teaching points for welding robot and welding robot system employing the same |
CN101623867A (en) * | 2008-07-11 | 2010-01-13 | 中国科学院沈阳自动化研究所 | Equipment and method for enabling robot to track specified path with high precision |
CN106346129A (en) * | 2016-11-23 | 2017-01-25 | 中国计量大学 | Robot welding motion control method based on laser seam tracking sensor |
CN107999955A (en) * | 2017-12-29 | 2018-05-08 | 华南理工大学 | A kind of six-shaft industrial robot line laser automatic tracking system and an automatic tracking method |
CN108568624A (en) * | 2018-03-29 | 2018-09-25 | 东风贝洱热系统有限公司 | A kind of mechanical arm welding system and welding method based on image procossing |
CN109175608A (en) * | 2018-09-30 | 2019-01-11 | 华南理工大学 | Weld bead feature points position On-line Measuring Method and seam track automatic measurement system |
CN109719438A (en) * | 2017-10-31 | 2019-05-07 | 无锡威卓智能机器人有限公司 | A kind of industrial welding robot welding line automatic tracking method |
CN110227876A (en) * | 2019-07-15 | 2019-09-13 | 西华大学 | Robot welding autonomous path planning method based on 3D point cloud data |
CN110245599A (en) * | 2019-06-10 | 2019-09-17 | 深圳市超准视觉科技有限公司 | A kind of intelligent three-dimensional weld seam Auto-searching track method |
CN111344101A (en) * | 2017-11-15 | 2020-06-26 | 普雷茨特两合公司 | Laser processing system and method for laser processing |
CN109732589B (en) * | 2018-12-18 | 2020-09-25 | 中国船舶重工集团公司第七一六研究所 | Robot operation track acquisition method based on line laser sensor |
CN111745267A (en) * | 2020-08-14 | 2020-10-09 | 湘潭大学 | System and method for tracking groove weld in real time based on laser displacement sensor |
CN112122842A (en) * | 2020-10-13 | 2020-12-25 | 湘潭大学 | Delta welding robot system based on laser vision |
CN112223293A (en) * | 2020-10-21 | 2021-01-15 | 湖南科技大学 | Online grinding method of welding line grinding and polishing robot |
CN112427774A (en) * | 2020-11-16 | 2021-03-02 | 唐山松下产业机器有限公司 | Corrugated plate welding method and system based on weld seam tracking |
CN112518072A (en) * | 2020-11-23 | 2021-03-19 | 南京工程学院 | Spatial intersecting curve weld joint structure modeling method based on line structure light vision |
-
2021
- 2021-03-24 CN CN202110314543.0A patent/CN114434001A/en active Pending
Patent Citations (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0862963A1 (en) * | 1996-07-19 | 1998-09-09 | Fanuc Ltd. | Welding robot control system |
US20010013511A1 (en) * | 2000-02-11 | 2001-08-16 | Sung-Jin Hong | Method for correcting teaching points for welding robot and welding robot system employing the same |
CN101623867A (en) * | 2008-07-11 | 2010-01-13 | 中国科学院沈阳自动化研究所 | Equipment and method for enabling robot to track specified path with high precision |
CN106346129A (en) * | 2016-11-23 | 2017-01-25 | 中国计量大学 | Robot welding motion control method based on laser seam tracking sensor |
CN109719438A (en) * | 2017-10-31 | 2019-05-07 | 无锡威卓智能机器人有限公司 | A kind of industrial welding robot welding line automatic tracking method |
CN111344101A (en) * | 2017-11-15 | 2020-06-26 | 普雷茨特两合公司 | Laser processing system and method for laser processing |
CN107999955A (en) * | 2017-12-29 | 2018-05-08 | 华南理工大学 | A kind of six-shaft industrial robot line laser automatic tracking system and an automatic tracking method |
CN108568624A (en) * | 2018-03-29 | 2018-09-25 | 东风贝洱热系统有限公司 | A kind of mechanical arm welding system and welding method based on image procossing |
CN109175608A (en) * | 2018-09-30 | 2019-01-11 | 华南理工大学 | Weld bead feature points position On-line Measuring Method and seam track automatic measurement system |
CN109732589B (en) * | 2018-12-18 | 2020-09-25 | 中国船舶重工集团公司第七一六研究所 | Robot operation track acquisition method based on line laser sensor |
CN110245599A (en) * | 2019-06-10 | 2019-09-17 | 深圳市超准视觉科技有限公司 | A kind of intelligent three-dimensional weld seam Auto-searching track method |
CN110227876A (en) * | 2019-07-15 | 2019-09-13 | 西华大学 | Robot welding autonomous path planning method based on 3D point cloud data |
CN111745267A (en) * | 2020-08-14 | 2020-10-09 | 湘潭大学 | System and method for tracking groove weld in real time based on laser displacement sensor |
CN112122842A (en) * | 2020-10-13 | 2020-12-25 | 湘潭大学 | Delta welding robot system based on laser vision |
CN112223293A (en) * | 2020-10-21 | 2021-01-15 | 湖南科技大学 | Online grinding method of welding line grinding and polishing robot |
CN112427774A (en) * | 2020-11-16 | 2021-03-02 | 唐山松下产业机器有限公司 | Corrugated plate welding method and system based on weld seam tracking |
CN112518072A (en) * | 2020-11-23 | 2021-03-19 | 南京工程学院 | Spatial intersecting curve weld joint structure modeling method based on line structure light vision |
Non-Patent Citations (2)
Title |
---|
曹林攀;易际明;谢传禄;陈沼欣;: "激光传感的机器人多层多道焊路径规划" * |
程创;张均富;: "基于ADAMS的管道内检测器里程轮碰撞分析及模拟" * |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109514133B (en) | 3D curve welding seam autonomous teaching method of welding robot based on line structure light perception | |
CN108481323B (en) | Augmented reality-based robot motion trajectory automatic programming system and method | |
CN113001535B (en) | Automatic correction system and method for robot workpiece coordinate system | |
CN111152229B (en) | Manipulator guiding method and device for 3D mechanical vision | |
CN105045098B (en) | A kind of control method of Control During Paint Spraying by Robot track automatic creation system | |
US20110282492A1 (en) | Method of controlling a robotic tool | |
CN114161048B (en) | 3D vision-based parameterized welding method and device for tower legs of iron tower | |
CN109732589B (en) | Robot operation track acquisition method based on line laser sensor | |
CN105643062B (en) | Complex-curved shape recognition and welding gun posture control method based on rotating the arc | |
Ng et al. | Programming a robot for conformance grinding of complex shapes by capturing the tacit knowledge of a skilled operator | |
Efimov et al. | Improving the efficiency of automated precision robotics-enabled positioning and welding | |
CN114055255A (en) | Large-scale complex component surface polishing path planning method based on real-time point cloud | |
CN108107842A (en) | Robot polishing track evaluation method based on power control | |
CN105598975A (en) | Method for determining movement tracks of industrial robot | |
CN110802600A (en) | Singularity processing method of six-degree-of-freedom articulated robot | |
JP2006289580A (en) | Teaching point correcting method of program and teaching point correcting device of program | |
Mishani et al. | Real-time non-visual shape estimation and robotic dual-arm manipulation control of an elastic wire | |
CN112809167B (en) | Robot weld joint tracking method for all-position welding of large-curvature pipe fitting | |
CN116160174B (en) | Binocular vision-based weld joint identification and tracking control method | |
CN114434001A (en) | Weld joint track autonomous tracking algorithm | |
Wang et al. | Fuzzy-PI double-layer stability control of an online vision-based tracking system | |
CN115723133A (en) | Robot space welding seam automatic positioning and deviation rectifying system based on virtual-real combination | |
CN111300490A (en) | Robot track generation system and method based on depth vision sensor | |
Lembono et al. | Automatic robot taping: system integration | |
JPH07210230A (en) | Pipe surface copying control method using force control robot |
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 | ||
WD01 | Invention patent application deemed withdrawn after publication | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20220506 |