Follow-up welding device and control method thereof
By designing a follow-up welding device in industrial robots and adjusting the height of the material tray using the lifting mechanism and the sliding table, the problem of poor wire feeding is solved, and the smooth and uniform wire feeding and welding quality improvement of the welding wire is achieved.
Patent Information
- Application Number
- CN202411133099.2
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-19
- Publication Date
- 2024-11-01
AI Technical Summary
Existing industrial robots have poor wire feeding stability during welding, which is prone to failures such as wire jams, affecting the processing quality.
A follow-up welding device is designed, including an industrial robot and a wire feeding device. Through the cooperation of the lifting mechanism and the sliding table, the height of the material tray is adjusted in real time, so that the welding wire and the robot wire output direction are kept parallel, preventing the welding wire from bending, and adopting adaptive The control method adjusts the wire feeding device in real time according to the robot joint angle data to improve the wire feeding stability.
It realizes smooth and even wire feeding of welding wire, reduces wire feeding resistance, improves welding quality, reduces robot load, is suitable for the installation of large wire disks, and improves dynamic performance.
Smart Images

Figure CN118875583A_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the technical field of industrial robots, and in particular to a follow-up welding device and a control method thereof. Background Art
[0002] Robotic automated processing has the characteristics of high efficiency, stable product quality, and suitability for harmful environments. It is widely used in the fields of robotic welding and robotic spraying, such as arc welding robots and flame aluminum spraying robots. These devices require a matching six-axis industrial robot system and corresponding wire feeding devices. The robot system is used to drive the welding gun and spray gun along the specified weld or spraying trajectory, and the wire feeding device is used to transport welding materials and spraying raw materials, such as arc welding robot welding wire transportation and flame aluminum spraying robot aluminum wire transportation.
[0003] The wire feeding device needs to make the wire feeding speed and wire feeding angle as stable as possible during the operation of the robot to ensure the weld accuracy after welding and the surface quality after spraying. Currently, existing industrial robots are prone to uneven wire feeding and wire jamming during operation. They cannot be adaptively adjusted and have poor stability, which seriously affects the processing quality. Therefore, how to achieve wire feeding stability during robot operation is a common problem. Summary of the invention
[0004] The main purpose of the present application is to provide a follow-up welding device and a control method thereof, aiming to solve the technical problem of poor wire feeding stability of existing industrial robots.
[0005] To achieve the above-mentioned purpose, the present application provides a follow-up welding device, including an industrial robot and a wire feeding device, the industrial robot is used to pull the welding wire to perform welding operations, the wire feeding device includes a frame, a lifting mechanism is provided on the frame, the lifting mechanism is connected to a slide, a support is connected to one side of the slide, a material tray is provided on the support, the material tray is used to install the welding wire, and the lifting mechanism is used to adjust the upper and lower heights of the material tray.
[0006] Optionally, the industrial robot includes a rotating base, a rotatable first machine arm is provided on the rotating base, the first machine arm is connected to a rotatable second machine arm, a wire pusher is provided on the top of the second machine arm, a wire drawing machine is provided at the end of the second machine arm, and also includes a wire guide tube, the wire guide tube passes through the wire pusher and the wire drawing machine in sequence, and the wire guide tube is used to socket the welding wire on the material tray.
[0007] Optionally, the lifting mechanism includes a servo motor arranged at the top of the frame, a screw rod is connected to the bottom of the servo motor, the bottom of the screw rod is movably connected to the bottom of the frame, the screw rod thread passes through the slide, and guide rails are arranged on both inner walls of the frame, and the slide can be slidably connected between the two guide rails.
[0008] Optionally, limit switches are provided at the inner bottom and the inner top of the frame, and the limit switches are used to sense the position of the support or the slide.
[0009] A control method for controlling the above-mentioned follow-up welding device comprises the following steps:
[0010] Start the industrial robot and wire feeder;
[0011] Collecting joint angle data of the industrial robot to establish a DH parameter table between the first robot arm and the second robot arm;
[0012] According to the joint angle data and the DH parameter table, the transformation matrix of the first coordinate system relative to the reference coordinate system is obtained; wherein the first coordinate system is a coordinate system established with the joint axis center of the first robot arm, denoted as (X1, Y1), and the reference coordinate system is a coordinate system established with the bottom center of the frame, denoted as (X b , Y b );
[0013] According to the transformation matrix, the coordinate value of the second coordinate system relative to the reference coordinate system is obtained; wherein the second coordinate system is a coordinate system established with the joint axis center of the second robot arm, and is recorded as (X2, Y2);
[0014] According to the coordinate values of the second coordinate system, the distance H between the center of the slide and the bottom of the frame is obtained;
[0015] The distance H is adjusted in real time to keep the wire outlet direction of the wire guide tube parallel to the length direction of the second robot arm.
[0016] Optionally, collecting the joint angle data of the industrial robot to establish a DH parameter table between the first robot arm and the second robot arm includes:
[0017] Establish an origin coordinate system and a first coordinate system; wherein the origin coordinate system is a coordinate system established with the top center of the rotating base, denoted as (X0, Y0);
[0018] The rotation angle J1 of the rotating base, the rotation angle J2 of the first robot arm, and the rotation angle J3 of the second robot arm are respectively collected;
[0019] According to the origin coordinate system, the first coordinate system, the rotation angle J2 and the rotation angle J3, a DH parameter table between the first robot arm and the second robot arm is established as follows:
[0020]
[0021] In the table,
[0022] α0 represents the angle of rotation from Z0 to Z1 around the X0 axis;
[0023] a0 represents the distance from Z0 to Z1 along the X0 axis;
[0024] d1 represents the distance from X0 to X1 along the Z1 axis;
[0025] θ1 represents the angle of rotation from X0 to X1 around the Z1 axis;
[0026] Among them, according to the right-hand rule, Z0 represents the direction in which the thumb points when the four fingers of the right hand are grasped from X0 to Y0; Z1 represents the direction in which the thumb points when the four fingers of the right hand are grasped from X1 to Y0.
[0027] Optionally, obtaining a transformation matrix of the first coordinate system relative to the reference coordinate system according to the joint angle data and the DH parameter table includes:
[0028] According to the homogeneous coordinate transformation method, the transformation formula is established as follows:
[0029]
[0030] Where Z represents the transformation matrix of the origin coordinate system relative to the reference coordinate system;
[0031] Rot(Z, θ1) represents the rotation transformation matrix from X0 to X1 around the Z1 axis;
[0032] According to the DH parameter table, substituting into the transformation formula, we can get:
[0033]
[0034] Wherein, s and c represent the abbreviations of sin() and cos() respectively; E represents the distance between the center of the rotating base and the center of the bottom of the frame; L1 represents the height of the rotating base.
[0035] Optionally, obtaining the coordinate values of the second coordinate system relative to the reference coordinate system according to the transformation matrix includes:
[0036] Get the coordinate value of the second coordinate system in the first coordinate system as (L2, 0, 0);
[0037] According to the coordinate value (L2, 0, 0) and the transformation matrix, the following equation 1 is obtained:
[0038]
[0039] According to equation 1, the coordinate values of the second coordinate system relative to the reference coordinate system are obtained as follows:
[0040] x2=cJ1·sJ2·L2+E
[0041] y2=cJ2L2+L1
[0042] Wherein, L2 represents the length of the first robotic arm.
[0043] Optionally, obtaining the distance H between the center of the slide and the bottom of the frame according to the coordinate value of the second coordinate system includes:
[0044] According to the following equation 2, the distance H is obtained:
[0045] H=y2+t(J2+J3)x2-s(J2+J3)eSubstituting the coordinate values of the second coordinate system relative to the reference coordinate system into equation 2, the distance H is obtained as:
[0046] H=cJ2L2+L1+t(J2+J3)(cJ1·sJ2·L2+E)-s(J2+J3)e
[0047] Wherein, t is the abbreviation of tan(); e represents the distance between the rotation center of the material tray and the side of the frame.
[0048] Optionally, the real-time adjustment of the distance H includes:
[0049] Input an adjustment value, determine whether the distance H after the input adjustment value is within a limited range, if so, perform an adjustment action; if not, return to the step of collecting the joint angle data of the industrial robot to establish a DH parameter table between the first robot arm and the second robot arm.
[0050] The beneficial effects that this application can achieve are as follows:
[0051] The present application is adapted to the industrial robot to work together by configuring a wire feeding device. When the motion trajectory of the industrial robot changes, the lifting mechanism can be used to drive the slide, the support and the material tray on the support to move up and down as a whole, thereby adjusting the upper and lower heights of the material tray, so that the welding wire and the wire output direction of the industrial robot are kept as parallel as possible, thereby minimizing the curvature of the welding wire and eliminating the possibility of large bending of the welding wire. At the same time, the ability to correct deformation of the wire when it is slightly bent is retained, making the wire feeding smoother and more uniform, and improving the stability of wire feeding. The present application abandons the traditional wire feeding method of adding a wire tray to the robotic arm, and uses an external wire feeding device to greatly reduce the load of the industrial robot, improve the dynamic performance of the industrial robot, and can be conveniently used for the installation and use of large wire trays. BRIEF DESCRIPTION OF THE DRAWINGS
[0052] In order to more clearly illustrate the specific embodiments of the present application or the technical solutions in the prior art, the following is a brief introduction to the drawings required for the specific embodiments or the prior art description. In all drawings, similar elements or parts are generally identified by similar reference numerals. In the drawings, the elements or parts are not necessarily drawn according to the actual scale.
[0053] Figure 1It is a structural schematic diagram of a follow-up welding device in an embodiment of the present application;
[0054] Figure 2 Schematic diagram of each coordinate system established based on the follow-up welding device in the embodiment of the present application;
[0055] Figure 3 It is a schematic diagram of various parameters based on the follow-up welding device in the embodiment of the present application;
[0056] Figure 4 It is a schematic diagram of wire feeding of a follow-up welding device at different joint angles in an embodiment of the present application;
[0057] Figure 5 This is a hardware schematic diagram of the control system in the embodiment of this application;
[0058] Figure 6 Schematic diagram of the control method in the embodiment of the present application.
[0059] Reference numerals:
[0060] 100-industrial robot, 110-rotating base, 120-first machine arm, 130-second machine arm, 140-wire pusher, 150-wire drawing machine, 160-wire guide tube, 200-wire feeding device, 210-frame, 220-lifting mechanism, 221-servo motor, 222-screw rod, 230-slide table, 240-support, 250-material tray, 260-guide rail, 270-limit switch;
[0061] A-the direction of rotation of the tray relative to the support; Z-the direction of movement of the slide relative to the guide rail;
[0062] {B} - Reference coordinate system, Y b - Y direction of the center coordinate of the bottom of the frame, X b - X direction of the frame bottom center coordinate;
[0063] {0}-origin coordinate system, Y0-rotation base coordinate Y direction, X0-rotation base coordinate X direction;
[0064] {1}-first coordinate system, Y1-first robot arm joint axis coordinate Y direction, X1-first robot arm joint axis coordinate X direction;
[0065] {2}-second coordinate system, Y2-second robot arm joint axis coordinate Y direction, X2-second robot arm joint axis coordinate X direction.
[0066] The realization of the purpose, functional features and advantages of this application will be further explained in conjunction with embodiments and with reference to the accompanying drawings. DETAILED DESCRIPTION
[0067] The following will be combined with the drawings in the embodiments of the present application to clearly and completely describe the technical solutions in the embodiments of the present application. Obviously, the described embodiments are only part of the embodiments of the present application, not all of the embodiments. Based on the embodiments in the present application, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of this application.
[0068] It should be noted that all directional indications in the embodiments of the present application (such as up, down, left, right, front, back, etc.) are only used to explain the relative position relationship, movement status, etc. between the components in a certain specific posture. If the specific posture changes, the directional indication will also change accordingly.
[0069] In this application, unless otherwise clearly specified and limited, the terms "connection", "fixation", etc. should be understood in a broad sense. For example, "fixation" can be a fixed connection, a detachable connection, or an integral connection; it can be a mechanical connection or an electrical connection; it can be a direct connection or an indirect connection through an intermediate medium, it can be the internal connection of two elements or the interaction relationship between two elements, unless otherwise clearly defined. For ordinary technicians in this field, the specific meanings of the above terms in this application can be understood according to specific circumstances.
[0070] In addition, if there are descriptions involving "first", "second", etc. in the embodiments of the present application, the descriptions of "first", "second", etc. are only used for descriptive purposes and cannot be understood as indicating or implying their relative importance or implicitly indicating the number of technical features indicated. Therefore, the features defined as "first" and "second" may explicitly or implicitly include at least one of the features. In addition, the meaning of "and / or" appearing in the full text includes three parallel schemes. Taking "A and / or B" as an example, it includes scheme A, or scheme B, or a scheme that satisfies both A and B. In addition, the technical solutions between the various embodiments can be combined with each other, but it must be based on the ability of ordinary technicians in the field to implement. When the combination of technical solutions is contradictory or cannot be implemented, it should be considered that such a combination of technical solutions does not exist and is not within the scope of protection required by this application.
[0071] Example 1
[0072] Reference Figure 1The present embodiment provides a follow-up welding device, including an industrial robot 100 and a wire feeding device 200. The industrial robot 100 is used to pull the welding wire for welding operation. The wire feeding device 200 includes a frame 210. A lifting mechanism 220 is provided on the frame 210. The lifting mechanism 220 is connected to a slide 230. A support 240 is connected to one side of the slide 230. A material tray 250 is provided on the support 240. The material tray 250 is used to install the welding wire. The lifting mechanism 220 is used to adjust the upper and lower heights of the material tray 250.
[0073] Since the posture of the existing welding robot changes greatly during operation, the wire feeding angle changes greatly, and the wire feeding resistance under different postures varies greatly, it is easy to cause uneven wire feeding during operation, and it is easy to cause failure phenomena such as wire jamming. Although the prior art discloses some technical solutions using wire feeding devices to assist, general wire feeding devices usually have the following problems:
[0074] First, small wire reels are mostly installed on the 2nd and 3rd joint axes of the robot body, which adversely affects the robot's motion characteristics. Large wire reels are mostly fixed on the ground, close to the robot base. These two installation methods will cause the wire feeding tube to stretch and bend to varying degrees when the robot rotates the front joint, and the wire feeding resistance will change greatly, causing uneven wire feeding and wire jamming.
[0075] Second: At present, most wire feeding devices adopt mechanical passive adjustment mode, which is used to adapt to the posture changes of the robot during operation by adding bearings, universal joints, brackets and slings and other mechanical parts; however, this method will cause the wire feeding tube itself to be stressed, and the tube end will be fatigued and cracked during long-term use; and the mechanical adaptive adjustment is not accurate, and as the resistance of steering components such as bearings increases, the adjustment will fail; at the same time, the rapid posture change of the robot is likely to cause vibration of the wire feeding device, which seriously affects the wire feeding adjustment performance;
[0076] Third: The wire feeding device of the wire feeding unit and the straightening unit installed separately can only correct slight bending deformations, and has poor adjustment effect on large-scale wire feeding angle changes caused by changes in the robot's posture.
[0077] Therefore, in this embodiment, the wire feeding device 200 is configured to adapt the industrial robot 100 to work together. When the motion trajectory of the industrial robot 100 changes, the lifting mechanism 220 can drive the slide 230, the support 240 and the material tray 250 on the support 240 to move up and down as a whole, thereby adjusting the upper and lower heights of the material tray 250, so that the welding wire and the wire output direction of the industrial robot 100 are kept as parallel as possible, thereby minimizing the curvature of the welding wire and eliminating the possibility of large bending of the welding wire. At the same time, the deformation correction ability of the wire when it is slightly bent is retained, so that the wire feeding is smoother and more uniform, and the wire feeding stability is improved. The present application abandons the traditional wire feeding method of adding a wire reel to the robotic arm. Through the external wire feeding device 200, the load of the industrial robot 100 is greatly reduced, the dynamic performance of the industrial robot 100 is improved, and it can be conveniently used for the installation and use of large wire reels.
[0078] As an optional embodiment, the industrial robot 100 includes a rotating base 110, on which a rotatable first machine arm 120 is disposed, the first machine arm 120 is connected to a rotatable second machine arm 130, a wire pusher 140 is disposed on the top of the second machine arm 130, a wire drawing machine 150 is disposed at the end of the second machine arm 130, and also includes a wire guide tube 160, which passes through the wire pusher 140 and the wire drawing machine 150 in sequence, and the wire guide tube 160 is used to socket the welding wire on the material tray 250.
[0079] In this embodiment, the industrial robot 100 has a built-in robot controller. According to the welding process, the robot controller can control the rotating base 110, the first robot arm 120 and the second robot arm 130 to make corresponding actions to adapt to the welding work at different workstations. The wire pusher 140 and the wire drawing machine 150 are used for auxiliary work. Among them, the wire pusher 140 can be equipped with a correction gear train, which can be combined with the wire feeding device to further improve the deformation correction capability and make the wire feeding smoother and more uniform. The wire pusher 140 and the wire drawing machine 150 are both existing technologies and will not be described here.
[0080] As an optional embodiment, the lifting mechanism 220 includes a servo motor 221 arranged at the top of the frame 210, and a screw rod 222 is connected to the bottom of the servo motor 221. The bottom of the screw rod 222 is movably connected to the bottom of the frame 210. The screw rod 222 threads through the slide 230. Guide rails 260 are provided on both inner side walls of the frame 210, and the slide 230 is slidably connected between the two guide rails 260.
[0081] In this embodiment, when the lifting mechanism 220 is in operation, the servo motor 221 drives the screw rod 222 to rotate, thereby driving the slide 230 to slide up and down between the two guide rails 260 to automatically adjust the position of the material tray 250.
[0082] It should be noted that an external PLC controller can be used to communicate with the robot controller, read the joint angle data value stored in the robot controller, and calculate the distance between the slide 230 and the bottom of the frame 210 through the control algorithm to form a control system, which can achieve real-time matching of the posture of the wire feeding device 200 and the industrial robot 100, and effectively reduce the wire feeding resistance. The connection relationship of the control system hardware part is as follows: Figure 5 As shown, after the PLC controller is connected to the robot controller, it can read the joint angle data of the J2 motor that controls the rotation of the first robot arm 120 and the J3 motor that controls the rotation of the second robot arm 130. The robot is provided with an angle storage device to store and transmit the joint angle data. After receiving the joint angle data, the PLC controller combines the Z-axis limit (i.e. Figure 1 The servo controller drives the servo motor 221 in combination with the current position data of the slide 230, and drives the screw rod 222 to adjust the slide 230 to the set position, thereby realizing the adaptive follow-up effect.
[0083] As an optional embodiment, the inner bottom and the inner top of the frame 210 are both provided with limit switches 270, which are used to sense the position of the support 240 or the slide 230. The limit switches 270 can detect the extreme position of the support 240 or the slide 230 to prevent the slide 230 from sliding out of the limited range to ensure safety.
[0084] Example 2
[0085] Reference Figure 1-Figure 6 This embodiment provides a control method for controlling a follow-up welding device described in embodiment 1, comprising the following steps:
[0086] Start the industrial robot 100 and the wire feeding device 200;
[0087] Collecting joint angle data of the industrial robot 100 to establish a DH parameter table between the first robot arm 120 and the second robot arm 130;
[0088] According to the joint angle data and the DH parameter table, the transformation matrix of the first coordinate system relative to the reference coordinate system is obtained; wherein the first coordinate system is a coordinate system established with the joint axis center of the first robot arm 120, denoted as (X1, Y1), that is, the coordinate system {1} in the figure, and the reference coordinate system is a coordinate system established with the bottom center of the frame 210, denoted as (X b , Y b ), that is, the coordinate system {B} in the figure;
[0089] According to the transformation matrix, the coordinate values of the second coordinate system relative to the reference coordinate system are obtained; wherein the second coordinate system is a coordinate system established with the joint axis center of the second robot arm 130, denoted as (X2, Y2), that is, the coordinate system {2} in the figure;
[0090] According to the coordinate values of the second coordinate system, the distance H between the center of the slide 230 and the bottom of the frame 210 is obtained;
[0091] The distance H is adjusted in real time so that the wire outlet direction of the wire guide tube 160 is kept parallel to the length direction of the second robot arm 130 .
[0092] In this embodiment, the DH parameter table between the first robot arm 120 and the second robot arm 130 is obtained by collecting the joint angle data of the industrial robot 100. The DH parameter is a robot arm mathematical model and a coordinate system determination system that uses four parameters to express the position angle relationship between two pairs of joint links. Then, the coordinate system conversion matrix can be calculated according to the joint angle data and the DH parameter table, so as to calculate the coordinate value of the joint axis center of the second robot arm 130 relative to the reference coordinate system, and finally converted into the distance H between the center of the slide 230 and the bottom of the frame 210. In short, this embodiment realizes the dynamic association between the industrial robot 100 and the wire feeding device 200 by converting the motion trajectory data of the industrial robot 100 into the distance H parameter data of the wire feeding device 200, so that the distance H can be adjusted in real time through the motion trajectory of the industrial robot 100, so as to realize that the wire outlet direction of the wire guide tube 160 is always kept parallel to the length direction of the second robot arm 130, so as to achieve the purpose of wire feeding stability. This embodiment realizes active real-time matching of the wire feeding angle of the wire feeding device 200 and the joint posture of the industrial robot 100, so that the wire feeding angle is parallel to the direction of the second robot arm 130 in real time, which greatly reduces the wire feeding resistance. Compared with the traditional purely mechanical passive adjustment method, the wire feeding angle adjustment has higher accuracy, stronger anti-interference ability, and smaller vibration, and is suitable for working conditions that require the robot to change its posture quickly.
[0093] As an optional implementation, the collecting of the joint angle data of the industrial robot 100 to establish a DH parameter table between the first robot arm 120 and the second robot arm 130 includes:
[0094] Establish an origin coordinate system and a first coordinate system; wherein the origin coordinate system is a coordinate system established at the top center of the rotating base 110, denoted as (X0, Y0), that is, the coordinate system {0} in the figure;
[0095] The rotation angle J1 of the rotating base 110 , the rotation angle J2 of the first robot arm 120 , and the rotation angle J3 of the second robot arm 130 are respectively collected;
[0096] According to the origin coordinate system, the first coordinate system, the rotation angle J2 and the rotation angle J3, a DH parameter table between the first robotic arm 120 and the second robotic arm 130 is established as follows:
[0097]
[0098] In the table,
[0099] α0 represents the angle of rotation from Z0 to Z1 around the X0 axis;
[0100] a0 represents the distance from Z0 to Z1 along the X0 axis;
[0101] d1 represents the distance from X0 to X1 along the Z1 axis;
[0102] θ1 represents the angle of rotation from X0 to X1 around the Z1 axis;
[0103] Among them, according to the right-hand rule, Z0 represents the direction in which the thumb points when the four fingers of the right hand are grasped from X0 to Y0; Z1 represents the direction in which the thumb points when the four fingers of the right hand are grasped from X1 to Y0.
[0104] In this embodiment, by establishing a corresponding coordinate system and collecting the corresponding rotation angle J2 and rotation angle J 3, The DH parameter table can be established. In the table, α0 is 0 degrees, indicating that Z0 is parallel to Z1, the distances a0 and d1 are both zero, and θ1 is According to the DH parameter table, it is convenient to guide the calculation of the subsequent conversion matrix.
[0105] As an optional implementation manner, obtaining the transformation matrix of the first coordinate system relative to the reference coordinate system according to the joint angle data and the DH parameter table includes:
[0106] According to the homogeneous coordinate transformation method, the transformation formula is established as follows:
[0107]
[0108] Where Z represents the transformation matrix of the origin coordinate system relative to the reference coordinate system;
[0109] Rot(Z, θ1) represents the rotation transformation matrix from X0 to X1 around the Z1 axis;
[0110] According to the DH parameter table, substituting into the transformation formula, we can get:
[0111]
[0112] In the formula, s and c are respectively abbreviations of sin() and cos(), for example, cJ1 is represented by cosJ1; E represents the distance between the center of the rotating base 110 and the bottom center of the frame 210, and L1 represents the height of the rotating base 110.
[0113] In this embodiment, after the initial transformation formula is established according to the homogeneous coordinate transformation method, the final transformation matrix can be obtained by substituting the parameters according to the DH parameter table.
[0114] As an optional implementation manner, obtaining the coordinate values of the second coordinate system relative to the reference coordinate system according to the transformation matrix includes:
[0115] Get the coordinate value of the second coordinate system in the first coordinate system as (L2, 0, 0);
[0116] According to the coordinate value (L2, 0, 0) and the transformation matrix, the following equation 1 is obtained:
[0117]
[0118] According to equation 1, the coordinate values of the second coordinate system relative to the reference coordinate system are obtained as follows:
[0119] x2=cJ1·sJ2·L2+E
[0120] y2=cJ2L2+L1
[0121] Wherein, L2 represents the length of the first robotic arm 120 .
[0122] In this embodiment, according to the conversion matrix and the coordinate value of the second coordinate system in the first coordinate system is (L2, 0, 0), a matrix calculation formula such as Formula 1 can be established, so that the coordinate values X2 and Y2 can be calculated.
[0123] As an optional implementation manner, obtaining the distance H between the center of the slide 230 and the bottom of the frame 210 according to the coordinate value of the second coordinate system includes:
[0124] According to the following equation 2, the distance H is obtained:
[0125] H=y2+t(J2+J3)x2-s(J2+J3)eSubstituting the coordinate values of the second coordinate system relative to the reference coordinate system into equation 2, the distance H is obtained as:
[0126] H=cJ2L2+L1+t(J2+J3)(cJ1·sJ2·L2+E)-s(J2+J3)e
[0127] Wherein, t is the abbreviation of tan(); e represents the distance between the rotation center of the material tray 250 and the side of the frame 210.
[0128] In this embodiment, after the coordinate values of the second coordinate system are calculated, they can be substituted into the initial distance H calculation formula established according to the trigonometric function relationship in Formula 2 to obtain the final distance H calculation formula, wherein L1, L2, E and e are fixed parameters according to the robot model, and only the dynamically changing rotation angle J1, rotation angle J2 and rotation angle J3 need to be obtained to convert them into parameter values of the distance H in real time. According to the final distance H calculation formula, the real-time dynamic adjustment of the wire feeding device 200 can be effectively guided according to the motion trajectory of the industrial robot 100, which is more flexible.
[0129] As an optional implementation manner, the real-time adjustment of the distance H includes:
[0130] Input the adjustment value, determine whether the distance H after the input adjustment value is within the limited range, if so, perform the adjustment action; if not, return to the step of collecting the joint angle data of the industrial robot 100 to establish the DH parameter table between the first robot arm 120 and the second robot arm 130.
[0131] In this embodiment, a judgment step for the adjusted distance H is added, and a limited range is set to prevent the distance H from being greater than the effective moving range of the slide after the adjustment value is input, thereby reducing the risk of calculation errors. The motion trajectory of the industrial robot is then recalculated until the distance H meets the limited range to ensure safety.
[0132] Example 3
[0133] This embodiment is based on Embodiment 1 and Embodiment 2. It is assumed that the height L1 of the rotating base 110 of the selected industrial robot 100 is 0.4m, the length L2 of the first robot arm 120 is 1m, and a working condition is assumed in which the wire feeding device 200 is installed 0.5m behind the robot, the distance e between the rotation center of the material tray 250 and the frame 210 is 0.3m, the rotation angle J1 of the robot is 30°, the rotation angle J2 is 45°, and the rotation angle J3 is -15°. It is required that the wire feeding device 200 can realize automatic adjustment of the slide 23 0, ensuring that the wire feeding angle is parallel to the direction of the second robot arm 130, so that the wire feeding resistance is as small as possible, according to formula (4) and formula (5) in the steps of Example 2, the X-direction coordinate value of the joint rotation center of the second robot arm 130 in the center coordinate system {B} of the bottom of the wire feeding device 200 is 1.1124; the Y-direction coordinate value of the joint rotation center of the second robot arm 130 in the center coordinate system {B} of the bottom of the wire feeding device 200 is 1.1071; according to formula (7), the distance H can be obtained as 1.5993m.
[0134] like Figure 5As shown, the external PLC controller communicates with the industrial robot 100 controller, reads the joint angle data values J1, J2, and J3 stored inside the robot controller, and the PLC controller obtains the distance H data through the algorithm corresponding to the built-in embodiment 2 method, and rotates the servo motor 221 by a corresponding angle through the servo driver, driving the screw rod 222 to rotate. The rotation of the screw rod 222 drives the slide 230 to move along the Z direction of the follower guide rail 260, so that the actual distance between the center of the slide 230 and the top center of the wire feeding device 200 is consistent with the theoretical calculated value, thereby realizing the automatic adjustment function of the height direction of the material tray 250. At the same time, the material tray 250 can realize free rotation in the A direction relative to the support 240 through the traction force of the wire guide tube 160, and the material tray 250 increases the degree of freedom of movement, thereby realizing the adaptive adjustment of the horizontal angle of the material tray 250 during wire feeding.
[0135] The above are only preferred embodiments of the present application, and are not intended to limit the patent scope of the present application. Any equivalent structure or equivalent process transformation made using the contents of the present application specification and drawings, or directly or indirectly applied in other related technical fields, are also included in the patent protection scope of the present application.
Claims
1. A follow-up welding device, characterized in that: It includes an industrial robot and a wire feeding device. The industrial robot is used to pull the welding wire to perform welding operations. The wire feeding device includes a frame. The frame is provided with a lifting mechanism. The lifting mechanism is connected to a slide. A support is connected to one side of the slide. A material tray is provided on the support. The material tray is used to install the welding wire. The lifting mechanism is used to adjust the upper and lower heights of the material tray.
2. A follow-up welding device as claimed in claim 1, characterized in that: The industrial robot includes a rotating base, a rotatable first machine arm is arranged on the rotating base, the first machine arm is connected to a rotatable second machine arm, a wire pusher is arranged on the top of the second machine arm, a wire drawing machine is arranged at the end of the second machine arm, and also includes a wire guide tube, the wire guide tube passes through the wire pusher and the wire drawing machine in sequence, and the wire guide tube is used to sleeve the welding wire on the material tray.
3. A follow-up welding device as claimed in claim 1 or 2, characterized in that: The lifting mechanism includes a servo motor arranged at the top of the frame, a screw rod is connected to the bottom of the servo motor, the bottom of the screw rod is movably connected to the bottom of the frame, the screw rod thread passes through the slide, guide rails are arranged on both inner side walls of the frame, and the slide can be slidably connected between the two guide rails.
4. A follow-up welding device as claimed in claim 3, characterized in that: The inner bottom and the inner top of the frame are both provided with limit switches, and the limit switches are used to sense the position of the support or the slide.
5. A control method for controlling a follow-up welding device as claimed in claim 2, characterized in that: The following steps are involved: Starting the industrial robot and the wire feeding device; Collecting joint angle data of the industrial robot to establish a DH parameter table between the first robot arm and the second robot arm; According to the joint angle data and the DH parameter table, a transformation matrix of the first coordinate system relative to the reference coordinate system is obtained; wherein the first coordinate system is a coordinate system established with the center of the joint axis of the first robot arm, denoted as (X1, Y1), and the reference coordinate system is a coordinate system established with the center of the bottom of the frame, denoted as (X b , Y b ); According to the transformation matrix, the coordinate value of the second coordinate system relative to the reference coordinate system is obtained; wherein the second coordinate system is a coordinate system established with the center of the joint axis of the second robot arm, and is recorded as (X2, Y2); Obtaining a distance H between the center of the slide and the bottom of the frame according to the coordinate values of the second coordinate system; The distance H is adjusted in real time so that the wire outlet direction of the wire guide tube remains parallel to the length direction of the second robot arm.
6. A control method according to claim 5, characterized in that: The collecting the joint angle data of the industrial robot to establish a DH parameter table between the first robot arm and the second robot arm includes: Establishing an origin coordinate system and a first coordinate system; wherein the origin coordinate system is a coordinate system established with the top center of the rotating base, denoted as (X0, Y0); respectively collecting a rotation angle J1 of the rotating base, a rotation angle J2 of the first robotic arm, and a rotation angle J3 of the second robotic arm; A DH parameter table between the first robotic arm and the second robotic arm is established according to the origin coordinate system, the first coordinate system, the rotation angle J2, and the rotation angle J3.
7. A control method according to claim 6, characterized in that: The step of obtaining a transformation matrix of the first coordinate system relative to the reference coordinate system according to the joint angle data and the DH parameter table includes: According to the homogeneous coordinate transformation method, the transformation formula is established as follows: Where Z represents the transformation matrix of the origin coordinate system relative to the reference coordinate system; Rot(Z, θ1) represents the rotation transformation matrix from X0 to X1 around the Z1 axis; According to the DH parameter table, substitute into the transformation formula to obtain the conversion matrix: Wherein, s and c are abbreviations for sin() and cos() respectively; E represents the distance between the center of the rotating base and the center of the bottom of the frame, and L1 represents the height of the rotating base.
8. A control method according to claim 7, characterized in that: Obtaining the coordinate values of the second coordinate system relative to the reference coordinate system according to the conversion matrix includes: Obtaining the coordinate values of the second coordinate system in the first coordinate system as (L2, 0, 0); According to the coordinate values (L2, 0, 0) and the conversion matrix, the following equation 1 is obtained: According to equation 1, the coordinate values of the second coordinate system relative to the reference coordinate system are obtained as follows: x2 = cJ1·sJ2·L2 + E y2 = cJ2 L2 + L1 Wherein, L2 represents the length of the first robotic arm.
9. A control method according to claim 8, characterized in that: Obtaining the distance H between the center of the sliding table and the bottom of the frame according to the coordinate values of the second coordinate system includes: Obtaining the distance H according to the following equation 2: H = y2 + t(J2 + J3)x2 - s(J2 + J3)e Substituting the coordinate values of the second coordinate system relative to the reference coordinate system into equation 2, the distance H is obtained as: H = cJ2L2 + L1 + t(J2 + J3)(cJ1·sJ2·L2 + E) - s(J2 + J3)e Wherein, t is an abbreviation for tan(); e represents the distance between the rotation center of the tray and the side of the frame.
10. A control method according to any one of claims 5 to 9, characterized in that: The real-time adjustment of the distance H includes: Inputting an adjustment value, and judging whether the distance H after inputting the adjustment value is within the limited range. If so, perform an adjustment action; if not, return to the step of collecting the joint angle data of the industrial robot to establish the DH parameter table between the first robotic arm and the second robotic arm.
Citation Information
Patent Citations
Method for calibrating industry robot
CN101231749A
Over -and -under type submerged arc welding machine
CN206811291U
Robot calibration system
CN217833667U
Welding robot
JP2010036253A
