Automatic welding device for signal transmission line and method for using the device
By designing automatic welding equipment, using AGV and robotic arms to realize automatic wire picking and welding of signal transmission lines, the problems of cumbersome and instability of traditional welding operations are solved, and the welding efficiency and accuracy are improved.
Patent Information
- Application Number
- CN202210096128.7
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-01-26
- Publication Date
- 2024-12-03
- Estimated Expiration
- 2042-01-26
AI Technical Summary
In the signal room, traditional signal transmission line welding operations rely on manual labor, resulting in cumbersome operation and error-prone, and lack of unified standards, which affects the stability of the connection and leads to frequent failures.
Design an automatic welding equipment, including base, welding device, line picking device, line pretreatment device and control system, realize automatic line picking and welding through AGV drive base and robotic arm, and use positioning system to accurately locate line picking points and Welding points ensure automation and accuracy of operations.
Automatic wire picking and welding of signal transmission lines is realized, efficiency and stability are improved, manual errors are reduced, and unified standards and high precision are ensured.
Smart Images

Figure CN114406540B_ABST
Abstract
Description
Technical Field
[0001] The invention belongs to the field of automation and relates to an automatic welding device for a signal transmission line and a method for using the device. Background Art
[0002] As the heart of the signal system, the signal room is extremely important in the entire signal network. In the signal network, signals are usually connected through signal transmission lines. Therefore, there are a large number of wiring cabinets and wiring in the signal room. In the construction process of the traditional signal room, the wire cutting, stripping and welding of the signal transmission line ends are mostly done manually. Although there are tools such as wire strippers to assist, a large number of repeated actions are very boring and prone to errors. On the other hand, it is difficult to set a unified standard for the welding of signal transmission lines, resulting in different connection stability of different wirings, which is prone to failure. The present invention effectively solves this problem. Summary of the invention
[0003] In order to overcome the deficiencies of the prior art, the present invention provides an automatic welding device for a signal transmission line and a method for using the device.
[0004] In order to achieve the above-mentioned purpose, the present invention adopts the following technical scheme: an automatic welding equipment for signal transmission line, characterized in that it includes a base, a welding device, a wire taking device, a wire preprocessing device and a control system, the control system controls the operation of the base, the welding device, the wire taking device and the wire preprocessing device, the wire taking device includes a wire taking arm, the welding device includes a welding arm, the wire taking device takes the signal transmission line to be processed from the wiring cabinet to the wire preprocessing device through the wire taking arm for preprocessing, the wire taking device moves the preprocessed signal transmission line to the welding device through the wire taking arm, and the welding device moves the preprocessed signal transmission line to the welding terminal of the wiring cabinet through the welding arm for welding.
[0005] Furthermore; the base is driven by AGV, and the base is moved to the standby position by AGV. The wiring cabinet is provided with a plurality of wire boards, and any wire board is provided with a plurality of wire board inner holes, and the plurality of wire board inner holes are distributed horizontally or vertically. Signal transmission lines to be processed are hung in the wire board inner holes, and a welding plate for welding wires is provided on the other side of the wiring cabinet, and the welding terminals are located on the welding plate.
[0006] Furthermore, the wire taking device includes a wire taking assembly, a wire taking transverse movement assembly and a wire taking longitudinal movement assembly. The wire taking longitudinal movement assembly is fixed on the base in the vertical direction. The wire taking longitudinal movement assembly includes a wire taking longitudinal movement drag chain. One end of the wire taking longitudinal movement drag chain is fixed, and the other end is connected to the wire taking longitudinal movement slider on the wire taking longitudinal movement assembly. The wire taking longitudinal movement assembly drives the wire taking longitudinal movement slider to move and then drives the wire taking longitudinal movement drag chain to move in the vertical direction. The wire taking longitudinal movement drag chain can not only protect the pipeline, but also limit the movement range of the wire taking device. The wire taking transverse movement assembly includes a wire taking transverse movement drag chain. One end of the wire taking transverse movement drag chain is fixed to the wire taking transverse movement assembly, and the other end is connected to the wire taking transverse movement assembly on the wire taking transverse movement assembly. The wire taking transverse moving block is connected, and the wire taking transverse moving assembly drives the wire taking transverse moving block to move and then drives the wire taking transverse moving drag chain to move in the horizontal direction. The wire taking transverse moving drag chain can not only protect the pipeline, but also limit the moving range of the wire taking device. The wire taking transverse moving block is fixedly connected to the wire taking arm. The joint action of the wire taking transverse moving assembly and the wire taking longitudinal moving assembly controls the position movement of the wire taking arm in space. The wire taking arm is composed of multiple arms connected to each other, with a built-in cylinder group, which moves within the space range. One end of the wire taking arm is fixedly connected to the wire taking transverse moving block, and the other end is fixedly connected to the wire taking assembly. The wire taking arm drives the position movement of the wire taking assembly within the space range to control the small range of position adjustment.
[0007] Further; the line taking assembly includes a line taking fixing plate, on which a line taking fixing plate is fixedly provided with a line taking connecting plate for connecting to the line taking arm fixedly provided, The first wire taking mechanism and the second wire taking mechanism, the first wire taking mechanism includes a first wire taking cylinder, a wire taking plate 1 and a wire taking plate 2, the first wire taking cylinder is respectively connected to the wire taking plate 1 and the wire taking plate 2, and controls the wire taking plate 1 and the wire taking plate 2 to move synchronously relative to or opposite to each other to perform wire taking and wire releasing operations, the wire taking plate 1 and the wire taking plate 2 have the same structure and are symmetrically distributed, the wire taking plate 1 includes a first plate, a second plate and a third plate, the first plate, the second plate and the third plate are fixedly connected in sequence to form a Z-shaped structure, the first plate is connected to the first wire taking cylinder, the opposing surfaces of the third plate of the wire taking plate 1 and the wire taking plate 2 are respectively fixedly provided with a wire taking groove 1 and a wire taking groove 2, the wire taking groove 1 and the wire taking groove 2 are preferably semicircular structures, the first wire taking cylinder controls the wire taking plate 1 and the wire taking plate 2 to move synchronously relative to each other, so that the wire taking plate 1 and the wire taking plate 2 touch each other, and the signal transmission line is confined in the wire taking groove formed by the wire taking groove 1 and the wire taking groove 2.
[0008] Furthermore; the second wire taking mechanism includes a second wire taking cylinder, a wire taking plate three and a wire taking plate four, the second wire taking cylinder is connected to the wire taking plate three and the wire taking plate four respectively, and controls the wire taking plate three and the wire taking plate four to move synchronously relative to or opposite to each other to perform wire taking and wire releasing operations, the wire taking plate three and the wire taking plate four have the same structure and are symmetrically distributed, the wire taking plate three includes a fourth plate, a fifth plate and a sixth plate, the fourth plate, the fifth plate and the sixth plate are fixedly connected in sequence to form a Z-shaped structure, the fourth plate is connected to the second wire taking cylinder, the opposite surfaces of the sixth plate of the wire taking plate three and the wire taking plate four are respectively fixed with a wire taking groove three and a wire taking groove four, the wire taking groove three and the wire taking groove four are preferably semicircular structures, the second wire taking cylinder controls the wire taking plate three and the wire taking plate four to move synchronously relative to each other, so that the wire taking plate three and the wire taking plate four touch each other, and the signal transmission line is confined to the wire taking groove formed by the wire taking groove three and the wire taking groove four to perform wire taking operations.
[0009] Furthermore, the wire pretreatment device includes a wire pretreatment mechanism, a wire pretreatment transverse movement component and a wire pretreatment longitudinal movement component. The wire pretreatment longitudinal movement component is fixed on the base in the vertical direction. The wire pretreatment longitudinal movement component includes a wire pretreatment longitudinal movement chain. One end of the wire pretreatment longitudinal movement chain is fixed, and the other end is connected to the wire pretreatment longitudinal movement slider on the wire pretreatment longitudinal movement component. The wire pretreatment longitudinal movement component drives the wire pretreatment longitudinal movement chain to move in the vertical direction by driving the wire pretreatment longitudinal movement slider. The wire pretreatment longitudinal movement chain can not only protect the pipeline, but also limit the movement range of the wire pretreatment device. The wire pretreatment mechanism to At least it includes a wire twisting assembly, a wire cutting assembly, a wire stripping assembly, a wire transmission assembly, a wire tight detection assembly and a wire preprocessing platform. The wire twisting assembly, wire cutting assembly, wire stripping assembly, wire transmission assembly and wire tight detection assembly are installed on the online preprocessing platform. The wire preprocessing platform is connected to the wire preprocessing transverse movement assembly. The wire transmission assembly moves relative to the wire twisting assembly, wire cutting assembly and wire stripping assembly. The wire transmission assembly is docked with the wire twisting assembly, and the wire transmission assembly is docked with the wire cutting assembly and wire stripping assembly. The wire preprocessing device performs wire cutting, wire stripping, wire twisting and detection operations on the signal transmission line through the wire twisting assembly, wire cutting assembly, wire stripping assembly, wire transmission assembly and wire tight detection assembly.
[0010] Furthermore; the welding device includes a welding assembly, a welding transverse movement assembly and a welding longitudinal movement assembly. The welding longitudinal movement assembly is fixed on the base in the vertical direction. The welding longitudinal movement assembly adopts a screw drive. The welding longitudinal movement assembly includes a welding longitudinal movement drag chain. One end of the welding longitudinal movement drag chain is fixed, and the other end is connected to the welding longitudinal movement slider on the welding longitudinal movement assembly. The welding longitudinal movement assembly drives the welding longitudinal movement slider to move and then drives the welding longitudinal movement drag chain to move in the vertical direction. The welding longitudinal movement drag chain can not only protect the pipeline, but also limit the moving range of the welding device. The welding transverse movement assembly includes a welding transverse movement drag chain. One end of the welding transverse movement drag chain is fixed to the welding transverse movement assembly, and the other end is connected to the welding transverse movement slider on the welding transverse movement assembly. The welding transverse movement assembly drives the welding transverse movement slider to move and then drives the welding transverse movement drag chain to move in the horizontal direction. The welding transverse movement drag chain can not only protect the pipeline, but also limit the moving range of the welding device. The welding transverse movement slider is fixedly connected to the welding arm.
[0011] Furthermore, the welding arm is composed of multiple arms connected to each other, with a built-in cylinder group, which can move within a spatial range. One end of the welding arm is fixedly connected to the welding transverse sliding slider, and the other end is fixedly connected to the welding assembly. The welding arm drives the welding assembly to move within a spatial range and controls the position adjustment in a small range. The welding assembly includes a welding fixing mechanism, a welding mechanism, a welding conveying mechanism and a welding clamping mechanism. The welding mechanism and the welding conveying mechanism are respectively fixed on the welding fixing mechanism. The welding conveying mechanism receives the finished wire conveyed by the wire taking device and moves the finished wire to the welding position. The welding mechanism welds the signal transmission line. The welding fixing mechanism includes a welding The fixing plate one and the welding fixing plate two are vertically connected. The welding fixing plate two is fixedly provided with a welding connecting plate for being fixedly connected to the welding arm. The welding mechanism is fixedly provided on the welding fixing plate one through the welding plate. The welding mechanism includes a welding part, a welding part fixing plate, a pressure welding motor and a welding part connecting plate. The pressure welding motor is fixed on the welding plate and connected to the welding part connecting plate. The pressure welding motor can drive the welding part connecting plate to move. The welding part fixing plate is fixed on the welding part connecting plate. The welding part is installed on the welding part connecting plate. The pressure welding motor can control the movement of the welding part fixing plate through the welding part connecting plate, adjust the position of the welding part, and flatten the penetrated wire.
[0012] A method for using a signal transmission line automatic welding device, characterized in that the method is used for the above-mentioned automatic welding device, and specifically comprises the following steps:
[0013] Step B1: automatic welding equipment pretreatment;
[0014] Step B2: Automatic welding equipment startup preparation;
[0015] Step B3: Welding wire number series judgment;
[0016] Step B4: the control system controls the AGV to run to the destination station corresponding to the current welding line sequence;
[0017] Step B5: Start the automatic welding equipment, initialize the control system, confirm that the equipment communication is normal, start the welding arm, and start the wire taking arm.
[0018] Step B6: judging the line board number series;
[0019] Step B7: The welding device, the wire taking device and the wire pre-processing device move to a position where the welding wire is to be taken from a certain wire board in the wire board array;
[0020] Step B8: judging the number of holes in the wire board;
[0021] Step B9: the control system sends the coordinates of the current wire taking point to the wire taking arm; the wire taking arm controls the wire taking component to take the wire from the wire taking point, completing the wire taking and wire pulling operations;
[0022] Step B10: the wire taking arm controls the wire taking assembly to cut, strip and twist the signal transmission line through the wire preprocessing mechanism;
[0023] Step B11: the wire taking arm controls the wire taking assembly to transfer the wire to the welding assembly; the welding assembly moves the wire to the welding point coordinates to complete the wire welding operation;
[0024] Step B12: Accumulate the number of holes in the wire board and determine whether the number of holes in the wire board has been completed. If so, execute step B13; if not, execute step B8;
[0025] Step B13: Accumulate the line board sequence to determine whether the line board sequence has been completed. If so, execute step B14; if not, execute step B6;
[0026] Step B14: The line board sequence of the destination station is completed, the line taking arm and the wire welding arm are shut down, and the system is powered off;
[0027] Step B15: Determine whether the welding sequence is completed, if yes, execute step B16, if no, execute step B3;
[0028] Step B16: The control system controls the AGV to run to the standby station, and the multi-cabinet welding program is completed.
[0029] Further, the automatic welding equipment startup preparation in step B2 includes the following steps:
[0030] Step B2.1: PC sends welding sequence execution list to the control system;
[0031] Step B2.2: Start the AGV and confirm that the AGV communication is normal;
[0032] Step B2.3: The control system controls AGV7 to run to the standby station;
[0033] Step B2.4: The control system reads the incoming sequence execution list.
[0034] In summary, the present invention is beneficial in that:
[0035] 1) The present invention locates the positions of the wire taking point and the welding point through a positioning system, which facilitates the wire taking operation of the wire taking device and the welding operation of the welding device, realizes the functions of automatic wire taking and automatic welding, avoids a lot of manual and repetitive work, and improves the efficiency of wire taking and welding as well as the stability of wire taking and welding.
[0036] 2) The present invention realizes the wire taking operation through the wire taking device. The wire taking transverse movement component and the wire taking longitudinal movement component work together to realize the position movement of the wire taking device in space. The wire taking arm drives the position movement of the wire taking component within the spatial range, controls the adjustment of the position in a small range, and realizes precise control of each position of the wire taking device.
[0037] 3) The present invention realizes welding operation through a welding device. The joint action of the welding lateral movement assembly and the welding longitudinal movement assembly realizes the position movement of the welding device in space. The welding arm drives the position movement of the welding assembly within the spatial range, controls the adjustment of the position in a small range, and realizes precise control of the welding position of the welding device.
[0038] 4) The present invention controls the position of the base, the wire taking device, the welding device and the positioning system through a control system. The present invention inputs the welding sequence execution list into the control system through a PC, and the control system reads the welding sequence to realize automatic and uninterrupted wire taking and welding operations.
[0039] 5) The present invention controls the automatic return to zero of the robot arm through the robot arm return to zero module. The reset control system stores the moving path information between each waypoint and the avoidance point. The path information for moving to the avoidance point is different according to the different stop positions before emergency or emergency stop. Under normal conditions, the operation path of the robot arm is set to unidirectionally run from the avoidance point along each waypoint back to the avoidance point. If the stop position of the robot arm before emergency or emergency stop is each waypoint, the reset control system controls the robot arm to move from the waypoint to the avoidance point; if the stop position of the robot arm before emergency or emergency stop is a midway point between different waypoints, the robot arm moves from the last waypoint or avoidance point passed by the robot to the avoidance point, thereby reducing intermediate links and time and improving the return to zero efficiency of the robot arm. BRIEF DESCRIPTION OF THE DRAWINGS
[0040] Figure 1 It is a schematic diagram of the assembly of the wiring cabinet and the base of the present invention.
[0041] Figure 2 It is a schematic diagram of the base device of the present invention.
[0042] Figure 3 It is an axonometric view of the wire taking device of the present invention.
[0043] Figure 4 It is a front view of the wire taking device of the present invention.
[0044] Figure 5 It is a schematic diagram of the wire pretreatment device of the present invention.
[0045] Figure 6 The welding device of the present invention is schematically shown in FIG. Figure 1 .
[0046] Figure 7 The welding device of the present invention is schematically shown in FIG. Figure 2 .
[0047] Figure 8 It is a top view of the welding device and positioning system of the present invention.
[0048] Fig. 9 for Figure 8 Schematic diagram of the cross-section of AA.
[0049] Fig.10 The robot arm zero return process of the present invention Figure 1 .
[0050] Fig.11 The robot arm zero return process of the present invention Figure 2 .
[0051] Fig.12 It is a schematic diagram of the reference line plate and the line plate of the present invention.
[0052] Fig.13 This is a flow chart of AGV movement in step B1.0 of the present invention.
[0053] Fig.14 The process of establishing the welding arm's own coordinate system in step B1.0 of the present invention Figure 1 .
[0054] Fig.15 The process of establishing the welding arm's own coordinate system in step B1.0 of the present invention Figure 2 .
[0055] Fig.16 It is the automatic welding flow chart of the present invention.
[0056] Fig.17 This is a flow chart of AGV communication determination of the present invention.
[0057] Fig.18 This is a flow chart for initializing the control system of the present invention.
[0058] Fig.19 The flowchart of establishing the coordinates of the wire plate and the welding arm of the present invention.
[0059] Fig. 20 The present invention is a flow chart for establishing a line plate visual positioning template.
[0060] Fig.21 The flowchart of establishing the coordinates of the welding plate and the welding arm of the present invention.
[0061] Fig. 22 The present invention is a flow chart for establishing a welding plate visual positioning template.
[0062] Fig.23 It is a pre-edited flow chart of the robot arm action of the present invention.
[0063] Fig.24 The figure is a flow chart of wire taking and welding of the present invention. DETAILED DESCRIPTION
[0064] The following describes the embodiments of the present invention by specific examples, and those skilled in the art can easily understand other advantages and effects of the present invention from the contents disclosed in this specification. The present invention can also be implemented or applied through other different specific embodiments, and the details in this specification can also be modified or changed in various ways based on different viewpoints and applications without departing from the spirit of the present invention. It should be noted that the following embodiments and features in the embodiments can be combined with each other without conflict.
[0065] It should be noted that the illustrations provided in the following embodiments are only schematic illustrations of the basic concept of the present invention, and thus the drawings only show components related to the present invention rather than being drawn according to the number, shape and size of components in actual implementation. In actual implementation, the type, quantity and proportion of each component may be changed arbitrarily, and the component layout may also be more complicated.
[0066] All directional indications in the embodiments of the present invention (such as up, down, left, right, front, back, horizontal, vertical...) 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.
[0067] Embodiment 1:
[0068] like Figure 1-9As shown, an automatic welding device for a signal transmission line includes a base 1, a welding device 2, a wire taking device 3, a wire preprocessing device 4, a positioning system 6 and a control system. The control system is connected to the base 1, the welding device 2, the wire taking device 3, the wire preprocessing device 4 and the positioning system 6 respectively. The control system controls the operation of the base 1, the welding device 2, the wire taking device 3, the wire preprocessing device 4 and the positioning system 6. The welding device 2 includes a welding transverse movement component 23 and a welding longitudinal movement component 24. The wire taking device 3 includes a wire taking transverse movement component 33 and a wire taking longitudinal movement component 34. The wire preprocessing device 4 includes a wire preprocessing transverse movement component 43 and a wire preprocessing longitudinal movement component 44. The welding longitudinal movement component 24 and the wire taking longitudinal movement component 34 The wire pretreatment longitudinal movement assembly 44 is fixedly arranged on the base 1, the welding transverse movement assembly 23, the wire taking transverse movement assembly 33 and the wire pretreatment transverse movement assembly 43 are respectively installed on the welding longitudinal movement assembly 24, the wire taking longitudinal movement assembly 34 and the wire pretreatment longitudinal movement assembly 44, the welding transverse movement assembly 23 and the welding longitudinal movement assembly 24 control the position of the welding device 2, the wire taking transverse movement assembly 33 and the wire taking longitudinal movement assembly 34 control the position of the wire taking device 3, and the wire pretreatment transverse movement assembly 43 and the wire pretreatment longitudinal movement assembly 44 control the position of the wire pretreatment device 4.
[0069] The automatic welding equipment also includes a power supply device (not shown in the figure), which includes power electricity and control electricity. The power electricity is used to power the execution equipment, and the control electricity is used to power the control system. The power electricity supplements the power supply through the electric cylinder, such as Figure 1 As shown, the wiring cabinet 5 is provided with a charging interface 81, and the base 1 is provided with a charging device. The control power is supplemented by a backup battery. When the power is sufficient, the power supply is supplemented to the control power by the backup battery. When the power supply is disconnected, the execution equipment is powered off, and the control power is supplemented by the backup battery to ensure the power of the control system.
[0070] The base 1 is driven by AGV7, and the base 1 runs to the standby position through AGV7. Generally speaking, the base 1 is opposite to the wiring cabinet 5. The wiring cabinet 5 is provided with a plurality of wire boards, and any wire board is fixed with a plurality of wire board inner holes, and the plurality of wire board inner holes are distributed horizontally or vertically. Signal transmission lines to be processed are hung in the wire board inner holes. A welding plate for wiring is provided on the other side of the wiring cabinet 5, and a plurality of welding terminals are provided on the welding plate. The wire taking device 3 takes the signal transmission line to be processed to the wire preprocessing device 4 for preprocessing, and the wire taking device 3 takes the preprocessed signal transmission line to the welding device 2, and the welding device 2 moves the preprocessed signal transmission line to the welding terminal and welds it.
[0071] The wire taking device 3 includes a wire taking arm 31, a wire taking assembly 32, a wire taking transverse movement assembly 33 and a wire taking longitudinal movement assembly 34. The wire taking longitudinal movement assembly 34 is fixed on the base 1 in the vertical direction. The wire taking longitudinal movement assembly 34 adopts a screw drive. The wire taking longitudinal movement assembly 34 includes a wire taking longitudinal movement drag chain (not shown in the figure). One end of the wire taking longitudinal movement drag chain is fixed, and the other end is connected to the wire taking longitudinal movement slider on the wire taking longitudinal movement assembly 34. The wire taking longitudinal movement assembly 34 drives the wire taking longitudinal movement slider to move and then drives the wire taking longitudinal movement drag chain to move in the vertical direction. The wire taking longitudinal movement drag chain can not only protect the pipeline, but also limit the moving range of the wire taking device 3.
[0072] The wire taking transverse movement assembly 33 adopts a screw transmission, and the wire taking transverse movement assembly 33 includes a wire taking transverse movement chain (not shown in the figure). One end of the wire taking transverse movement chain is fixed to the wire taking transverse movement assembly 33, and the other end is connected to the wire taking transverse movement slider on the wire taking transverse movement assembly 33. The wire taking transverse movement assembly 33 drives the wire taking transverse movement slider to move and then drives the wire taking transverse movement chain to move in the horizontal direction. The wire taking transverse movement chain can not only protect the pipeline, but also limit the moving range of the wire taking device 3. The wire taking transverse movement slider is fixedly connected to the wire taking arm 31. In this embodiment, the position movement of the wire taking device 3 in space is achieved through the joint action of the wire taking transverse movement assembly 33 and the wire taking longitudinal movement assembly 34.
[0073] The wire taking arm 31 is composed of multiple arms connected to each other, and has a built-in cylinder group, which can realize movement within a spatial range. One end of the wire taking arm 31 is fixedly connected to the wire taking transverse sliding slider, and the other end is fixedly connected to the wire taking assembly 32. The wire taking arm 31 drives the wire taking assembly 32 to move within a spatial range, controls the position adjustment in a small range, and realizes precise control of each position of the wire taking device.
[0074] The wire taking assembly 32 includes a wire taking fixing plate 322, on which a wire taking connecting plate 321, a first wire taking mechanism and a second wire taking mechanism for being fixedly connected to the wire taking arm 31 are fixedly provided. The first wire taking mechanism includes a first wire taking cylinder 3231, a wire taking plate 1 3232 and a wire taking plate 2 3233. The first wire taking cylinder 3231 is respectively connected to the wire taking plate 1 3232 and the wire taking plate 2 3233, and controls the wire taking plate 1 3232 and the wire taking plate 2 3233 to move synchronously relative to or opposite to each other, so as to realize wire taking and wire releasing operations.
[0075] The wire taking plate 1 3232 and the wire taking plate 2 3233 have the same structure and are symmetrically distributed. Taking the wire taking plate 1 3232 as an example for explanation, the wire taking plate 1 3232 includes a first plate, a second plate and a third plate. The first plate, the second plate and the third plate are fixedly connected in sequence to form a Z-shaped structure. The first plate is connected to the first wire taking cylinder 3231. The opposite surfaces of the third plate of the wire taking plate 1 3232 and the wire taking plate 2 3233 are respectively fixed with a wire taking groove 1 3234 and a wire taking groove 2 3235. The wire taking groove 1 3234 and the wire taking groove 2 3235 are preferably semicircular structures. The first wire taking cylinder 3231 controls the synchronous relative movement of the wire taking plate 1 3232 and the wire taking plate 2 3233, so that the wire taking plate 1 3232 and the wire taking plate 2 3233 touch each other, and the signal transmission line is confined in the wire taking groove formed by the wire taking groove 1 3234 and the wire taking groove 2 3235 to realize the wire taking operation.
[0076] The second wire taking mechanism includes a second wire taking cylinder 3241, a wire taking plate three 3242 and a wire taking plate four 3243. The second wire taking cylinder 3241 is connected to the wire taking plate three 3242 and the wire taking plate four 3243 respectively, and controls the wire taking plate three 3242 and the wire taking plate four 3243 to move synchronously relative to or opposite to each other, thereby realizing wire taking and wire releasing operations.
[0077] The wire taking plate three 3242 and the wire taking plate four 3243 have the same structure and are symmetrically distributed. Taking the wire taking plate three 3242 as an example for explanation, the wire taking plate three 3242 includes a fourth plate, a fifth plate and a sixth plate. The fourth plate, the fifth plate and the sixth plate are fixedly connected in sequence to form a Z-shaped structure. The fourth plate is connected to the second wire taking cylinder 3241. The wire taking groove three 3244 and the wire taking groove four 3245 are fixedly provided on the opposite surfaces of the sixth plate of the wire taking plate three 3242 and the wire taking plate four 3243, respectively. The wire taking groove three 3244 and the wire taking groove four 3245 are preferably semicircular structures. The second wire taking cylinder 3241 controls the synchronous relative movement of the wire taking plate three 3242 and the wire taking plate four 3243, so that the wire taking plate three 3242 and the wire taking plate four 3243 touch each other, and the signal transmission line is confined in the wire taking groove formed by the wire taking groove three 3244 and the wire taking groove four 3245 to realize the wire taking operation.
[0078] like Figure 3As shown, the first wire taking mechanism and the second wire taking mechanism are distributed in the horizontal direction, and the second wire taking mechanism also includes a wire taking drive mechanism 3246. The wire taking drive mechanism 3246 adopts a cylinder structure. The wire taking drive mechanism 3246 is connected to the second wire taking mechanism to control the horizontal movement of the second wire taking mechanism, and then control the horizontal distance between the first wire taking mechanism and the second wire taking mechanism to realize the wire pulling operation. In this embodiment, the operation process of the wire taking device 3 is specifically as follows: the wire taking transverse movement component 33 and the wire taking longitudinal movement component 34 control the wire taking component 32 to move to the wiring cabinet 5, the wire taking arm 31 controls the wire taking component 32 to move to the wire taking point, the first wire taking mechanism takes the signal transmission line head, and the second wire taking mechanism fixes the line head to the rear position, so that the signal transmission line between the first wire taking mechanism and the second wire taking mechanism remains straight or quasi-straight, which ensures the stability of the wire taking on the one hand, and facilitates the transmission of the signal transmission line between the wire taking device 3 and the welding device 2 and the wire pretreatment device 4 on the other hand.
[0079] The wire pretreatment device 4 of this embodiment adopts existing equipment. The wire pretreatment device 4 includes a wire pretreatment mechanism 42, a wire pretreatment transverse movement component 43 and a wire pretreatment longitudinal movement component 44. The wire pretreatment longitudinal movement component 44 is fixed on the base 1 in the vertical direction. The wire pretreatment longitudinal movement component 44 adopts a screw drive. The wire pretreatment longitudinal movement component 44 includes a wire pretreatment longitudinal movement chain (not shown in the figure). One end of the wire pretreatment longitudinal movement chain is fixed, and the other end is connected to the wire pretreatment longitudinal movement slider on the wire pretreatment longitudinal movement component 44. The wire pretreatment longitudinal movement component 44 drives the wire pretreatment longitudinal movement chain to move in the vertical direction by driving the wire pretreatment longitudinal movement slider. The wire pretreatment longitudinal movement chain can not only protect the pipeline, but also limit the moving range of the wire pretreatment device 4.
[0080] The wire preprocessing mechanism 42 at least includes a wire twisting component 421, a wire cutting component 422, a wire stripping component 423, a wire transmission component 424, a wire tightening detection component and a wire preprocessing platform. The wire twisting component 421, the wire cutting component 422, the wire stripping component 423, the wire transmission component 424 and the wire tightening detection component are installed on the online preprocessing platform. The wire preprocessing platform is connected to the wire preprocessing transverse movement component 43. The wire transmission component 424 can move relative to the wire twisting component 421, the wire cutting component 422 and the wire stripping component 423 to achieve the connection between the wire transmission component 424 and the wire twisting component 421, and the wire transmission component 424 and the wire cutting component 422 and the wire stripping component 423. The wire preprocessing device 4 realizes the wire cutting, stripping, twisting and detection operations on the signal transmission line through the wire twisting component 421, the wire cutting component 422, the wire stripping component 423, the wire transmission component 424 and the wire tightening detection component.
[0081] In this embodiment, the wire preprocessing device 4 is connected to the wire taking device 3, and the wire taking device 3 moves the signal transmission line from the wiring cabinet 5 to the wire transmission component 424 of the wire preprocessing device 4, and the signal transmission line is preprocessed by the wire preprocessing device 4, including wire cutting, wire stripping and wire twisting. The processed signal transmission line is moved to the welding device 2 through the wire preprocessing device 4, and the signal transmission line is welded by the welding device 2.
[0082] The welding device 2 includes a welding arm 21, a welding assembly 22, a welding lateral movement assembly 23 and a welding longitudinal movement assembly 24. The welding longitudinal movement assembly 24 is fixed on the base 1 in the vertical direction. The welding longitudinal movement assembly 24 adopts a screw drive. The welding longitudinal movement assembly 24 includes a welding longitudinal movement drag chain (not shown in the figure). One end of the welding longitudinal movement drag chain is fixed, and the other end is connected to the welding longitudinal movement slider on the welding longitudinal movement assembly 24. The welding longitudinal movement assembly 24 drives the welding longitudinal movement slider to move and then drives the welding longitudinal movement drag chain to move in the vertical direction. The welding longitudinal movement drag chain can not only protect the pipeline, but also limit the moving range of the welding device 2.
[0083] The welding transverse movement assembly 23 adopts a screw drive, and the welding transverse movement assembly 23 includes a welding transverse movement chain (not shown in the figure). One end of the welding transverse movement chain is fixed to the welding transverse movement assembly 23, and the other end is connected to the welding transverse movement slider on the welding transverse movement assembly 23. The welding transverse movement assembly 23 drives the welding transverse movement slider to move and then drives the welding transverse movement chain to move in the horizontal direction. The welding transverse movement chain can not only protect the pipeline, but also limit the moving range of the welding device 2. The welding transverse movement slider is fixedly connected to the welding arm 21. In this embodiment, the position movement of the welding device 2 in space is achieved through the joint action of the welding transverse movement assembly 23 and the welding longitudinal movement assembly 24.
[0084] The welding arm 21 is composed of multiple arms connected to each other, and has a built-in cylinder group, which can realize movement within a spatial range. One end of the welding arm 21 is fixedly connected to the welding transverse sliding slider, and the other end is fixedly connected to the welding assembly 22. The welding arm 21 drives the welding assembly 22 to move within a spatial range, controls the position adjustment in a small range, and realizes precise control of the welding position of the welding device 2.
[0085] The welding assembly 22 includes a welding fixing mechanism, a welding mechanism, a welding conveying mechanism and a welding clamping mechanism. The welding mechanism and the welding conveying mechanism are respectively fixed on the welding fixing mechanism. The welding conveying mechanism receives the finished wire delivered by the wire taking device 3 and moves the finished wire to the welding position. The welding mechanism welds the signal transmission line.
[0086] The welding fixing mechanism includes a welding fixing plate 1 2201 and a welding fixing plate 2203. The welding fixing plate 1 2201 and the welding fixing plate 2203 are vertically connected. The welding fixing plate 2203 is fixed with a welding connecting plate 2202 for being fixedly connected to the welding arm 21. The welding mechanism is fixed to the welding fixing plate 1 2201 through a welding plate 2213.
[0087] The welding mechanism includes a welding part 2210, a welding part fixing plate 2211, a pressure welding motor 2212 and a welding part connecting plate 2214. The pressure welding motor 2212 is fixed on the welding plate 2213 and connected to the welding part connecting plate 2214. The pressure welding motor 2212 can drive the welding part connecting plate 2214 to move. The welding part fixing plate 2211 is fixed on the welding part connecting plate 2214. The welding part 2210 is installed on the welding part connecting plate 2214. The pressure welding motor 2212 can control the movement of the welding part fixing plate 2211 through the welding part connecting plate 2214, thereby adjusting the position of the welding part 2210 to ensure the accuracy of welding. At the same time, the passing line can be flattened to facilitate welding.
[0088] The welding clamping mechanism includes a clamping cylinder 2221 and a clamping plate 2222. There are two groups of clamping plates 2222, which are horizontally symmetrically installed on the clamping cylinder 2221. The clamping cylinder 2221 controls the two groups of clamping plates 2222 to move synchronously relative to or opposite to each other, thereby achieving the clamping or loosening of the line and the clamping or loosening of the welding terminal, which facilitates welding. A through hole for the signal transmission line is provided between the two groups of clamping plates 2222.
[0089] The welding conveying mechanism includes an upper member and a lower member, and the wire is placed between the upper member and the lower member through the wire taking device 3. Specifically, the upper member includes two groups of upper plates 2232, and the two groups of upper plates 2232 are horizontally symmetrically fixed on the lower end surface of the clamping cylinder 2221. The upper side plates 2233 are fixed on the sides of the two groups of upper plates 2232. The upper side plates 2233, the two groups of upper plates 2232 and the lower end surface of the clamping cylinder 2221 constitute an upper installation cavity with an opening facing downward, such as Figure 8 As shown, an upper traction wheel 2234 and an upper guide wheel 2235 are rotatably arranged in the upper mounting cavity.
[0090] The lower component includes a lower cylinder 2245, which is fixed on the second welding fixing plate 2203. The lower cylinder 2245 is fixed with a lower push block 2244. The lower cylinder 2245 controls the movement of the lower push block 2244 in the vertical direction. Two groups of horizontally symmetrical lower plates 2242 are fixed on the lower push block 2244. The sides and bottom surfaces of the two groups of horizontally symmetrical lower plates 2242 are fixed with lower side plates 2243. The two groups of lower plates 2242 and the lower side plates 2243 constitute a lower installation cavity with an opening facing upward. The lower installation cavity is opposite to the upper installation cavity. A transmission wheel 2246 and a lower guide wheel 2247 are rotatably arranged in the lower installation cavity. The lower guide wheel 2247 is opposite to the upper guide wheel 2235. The lower guide wheel 2247 and the upper guide wheel 2235 are respectively provided with grooves. The line is located in the groove between the lower guide wheel 2247 and the upper guide wheel 2235 to guide the transmission of the signal transmission line. A plurality of transmission wheels 2246 are provided. One group of transmission wheels 2246 is controlled to rotate by the threading motor 2240. The transmission wheels 2246 are provided with teeth. The upper traction wheel 2234 is opposite to a group of transmission wheels 2246.
[0091] The welding conveying mechanism also includes a clamp, which includes an upper clamp 2231 and a lower clamp 2241. The upper clamp 2231 is fixedly mounted on the upper side plate 2233, and the lower clamp 2241 is fixedly mounted on the lower side plate 2243. The lower end surface of the upper clamp 2231 and the upper end surface of the lower clamp 2241 are provided with an arc surface, and the lower end surface of the upper clamp 2231 and the upper end surface of the lower clamp 2241 are fixedly provided with an inner groove. The upper clamp 2231 and the lower clamp 2241 are abutted against each other to form a conveying chamber 225 for conveying a signal transmission line. The signal transmission line guided and conveyed by the lower guide wheel 2247 and the upper guide wheel 2235 is transmitted to between the upper traction wheel 2234 and the transmission wheel 2246, and the signal transmission line is conveyed to the conveying chamber 225 by the toothed action of the transmission wheel 2246, and the line head of the signal transmission line along the conveying chamber 225 passes through the through hole.
[0092] In this embodiment, the operation process of the welding device 2 is as follows: the lower cylinder 2245 controls the lower component to move downward relative to the upper component, so that the upper component and the lower component are out of the connected state; the wire taking device 3 moves a pre-processed signal transmission line between the upper component and the lower component; the lower cylinder 2245 starts to control the lower component to move upward relative to the upper component, so that the upper component and the lower component are connected; the signal transmission line is located between the lower guide wheel 2247 and the upper guide wheel 2235 and the upper traction wheel 2234 and the transmission wheel 2246; the threading motor 2240 starts to convey the signal transmission line along the conveying cavity 225 and pass through the through hole; the welding clamping mechanism clamps the welding terminal, which is convenient for positioning and clamping the threading signal transmission line, and ensures the stability of the signal transmission line during movement and welding; the welding piece 2210 starts to weld the signal transmission line to the wiring cabinet 5.
[0093] The automatic welding equipment of the signal transmission line also includes a robot arm zero return module. The robot arm zero return module includes a reset button and a reset control system. The reset control system is connected to the control system respectively. The control system controls the robot arm to return to zero after an emergency or emergency stop through the robot arm zero return module. The reset control system stores the movement path information between each waypoint and the avoidance point. The robot arm includes a welding arm 21 and a wire taking arm 31. The power supply device of the automatic welding equipment is connected to the power equipment to power the robot arm zero return module.
[0094] like Figure 10-11 As shown, the method for returning the robot arm to zero of the automatic welding equipment of the signal transmission line adopts the above device for returning the wire taking arm and the welding arm to zero, and comprises the following steps:
[0095] Step 1: Connect the power equipment;
[0096] Step 2: Click the reset button to start, unlock, and enable the robot arm in sequence;
[0097] Step 3: The robot arm returns to zero manually or automatically.
[0098] In step 3, the robot arm returns to zero manually, including the following steps:
[0099] Step 3.1.1 Manually trigger the free drive of the robotic arm;
[0100] Step 3.1.2 Manually calibrate the robot arm to the vicinity of the avoidance point;
[0101] Step 3.1.3 The control system issues a command for the robot arm to move to the avoidance point;
[0102] Step 3.1.4: The reset control system receives the command and the robot moves to the avoidance point;
[0103] Step 3.1.5 determines whether the robot arm is at the avoidance point. If not, wait for the robot arm to return to the avoidance point. If so, proceed to step 3.1.6.
[0104] Step 3.1.6 The robot arm is reset.
[0105] In step 3, the robot arm automatically returns to zero, including the following steps:
[0106] Step 3.2.1 The control system sends an automatic reset command to the reset control system, and the robotic arm receives the command and prepares to reset;
[0107] Step 3.2.2 The control system sends the last waypoint information before the emergency or emergency stop to the reset control system;
[0108] Step 3.2.3 The robot arm receives the last waypoint information and moves to the last waypoint;
[0109] Step 3.2.4 resets the control system to control the robot arm to move to the avoidance point through the set path information;
[0110] Step 3.2.5 determines whether the robot arm is at the avoidance point. If not, wait for the robot arm to return to the avoidance point. If so, proceed to step 3.2.6.
[0111] Step 3.2.6 The robot arm is reset.
[0112] The reset control system stores the moving path information between each waypoint and the avoidance point, and the moving path information to the avoidance point is set differently according to the different stop positions before the emergency or emergency stop. Specifically, Fig.11 As shown, the route marked by the thick solid line is the operation path of the robot arm under normal conditions. It runs in a one-way loop from the avoidance point along each waypoint back to the avoidance point. If the stopping position of the robot arm before an emergency or emergency stop is a waypoint, the last waypoint described in step 3.2.3 is the waypoint, and the reset control system controls the robot arm to move from the waypoint to the avoidance point; if the stopping position of the robot arm before an emergency or emergency stop is a midway point between different waypoints, the last waypoint described in step 3.2.2 is the last waypoint or avoidance point passed by the midway point, and the robot arm moves to the avoidance point according to steps 3.2.3-step 3.2.4.
[0113] In this embodiment, the avoidance point of the robot arm is the reference position of the welding arm for shooting the welding plate and the position of the wire-taking arm corresponding to the reference position of the welding arm for shooting the wire plate. Figure 18-21 as well as Figure 14-15 As shown, the coordinate systems of the welding arm and the wire-taking arm are established, the coordinate system between the wire plate and the welding arm is established, and the coordinate system between the welding plate and the welding arm is established, and then the avoidance point of the robot arm is obtained. The establishment of each coordinate system is shown in the figures and will not be repeated here.
[0114] The present invention provides a high-precision positioning method for positioning the line taking and welding of the signal transmission line between the welding equipment and the wiring cabinet 5, including a positioning system 6, the welding equipment including a base 1, a welding device 2, a line taking device 3, a line preprocessing device 4 and a control system, the positioning system 6 is connected to the control system, the positioning system 6 includes a positioning ranging sensor 60, a positioning camera 61, a reference line plate and a reference welding plate, the method uses the positioning system 6 to locate the line taking point on the line plate and the welding point on the welding plate, so as to facilitate the line taking device 3 to take the line and the welding device 2 to weld.
[0115] The positioning camera 61 is installed on the welding assembly 22 of the welding device 2, and the welding arm 21 of the welding device 2 controls the moving position of the positioning camera 61. The positioning system 6 can locate the line taking point of the line plate and the welding point of the welding plate respectively through the reference line plate and the reference welding plate. The positioning and ranging sensor 60 is installed on the line preprocessing platform of the online preprocessing device 4, and the control system controls the positioning and ranging sensor 60 to move in plane along with the line preprocessing platform.
[0116] The method of locating the wire taking point of the wire board and the welding point of the welding board using the positioning system 6 in this embodiment includes the following steps:
[0117] Step A1: calibrating the wire board and welding board;
[0118] Step A1.1: Establishing a coordinate system α between the wire plate and the welding arm 21;
[0119] Step A1.1.1 The welding arm 21 makes a tool coordinate system for the wire plate;
[0120] Step A1.1.2 The welding arm 21 controls the positioning camera 61 to move to the line board shooting position;
[0121] Step A1.1.3: Position the camera 61 to take pictures and select feature points;
[0122] Step A1.1.4 records the translation position information of the welding arm 21 and the position information of the characteristic points;
[0123] Step A1.1.5 determines whether there are nine groups of feature points. If not, proceed to step A1.1.4. If not, proceed to step A1.1.6.
[0124] Step A1.1.6: establishing a coordinate system α of the wire plate and the welding arm 21 according to the nine sets of feature point information;
[0125] Step A1.2: Establishing the coordinate system β of the welding plate and the welding arm 21; the establishment method of the coordinate system β is the same as the establishment method of the coordinate system α in step A1.1, which will not be described in detail here;
[0126] Step A2: Establish visual positioning templates for line plates and welding plates;
[0127] Step A2.1: Establish a visual positioning template for the wire board;
[0128] Step A2.1.1 The welding arm 21 controls the positioning camera 61 to move to the wire board to take a picture;
[0129] Step A2.1.2 Select the feature point Q of the image in step A2.1.1, and output the offset X through the coordinate system α 1 , Y 1 , the offset X 1 , Y1 As the first position coordinate of the welding arm 21;
[0130] Step A2.1.3 Set the first position coordinate (X 1 , Y 1 )Offset(-X 1 , -Y 1 ), and the offset position of the welding arm 21 is used as the second position of the welding arm 21, the positioning camera 61 moves with the welding arm 21, and takes pictures;
[0131] Step A2.1.4 Select the feature point Q of the image in step A2.1.3, and output the offset X of the feature point Q information through the coordinate system 2 , Y 2 , determine the offset X 2 , Y 2 Is it zero or close to zero? If so, execute step A2.1.5; if not, determine whether the characteristic point Q is correct. If the characteristic point Q is incorrect, execute step A2.1.2. If the characteristic point Q is correct, re-calibrate the coordinate system α of the welding arm and the line plate with nine points;
[0132] Step A2.1.5 sets the second position of the welding arm 21 as the shooting line plate reference position of the welding arm 21;
[0133] Step A2.1.6 sets the first wire picking point on the wire board as the wire picking template point;
[0134] Step A2.1.7 Complete the visual positioning template of the wire board;
[0135] Step A2.2: Establishing the visual positioning template of the welding plate; the steps for establishing the visual positioning template of the welding plate are the same as those for establishing the visual positioning template of the line plate in step A2.1, and will not be repeated here;
[0136] Step A3: rough positioning of the line board;
[0137] Step A3.1: Setting the reference line board;
[0138] In this embodiment, Figure 1 As shown, the left-right direction of the reference line plate is set as the X direction, and the X left direction is set as the positive direction, the up-down direction of the reference line plate is set as the Y direction, and the Y upward direction is set as the positive direction, the inside-outside direction of the reference line plate is set as the Z direction, and the Z inside direction is set as the positive direction, and the clockwise rotation direction, that is, the arrow direction, is set as the positive rotation direction. The wire taking device 3 takes wires row by row along the positive direction of Y, and after taking wires from any column, it moves along the positive direction of X to the adjacent column to take wires.
[0139] In other embodiments, the wire taking device 3 can also take wires row by row along the negative direction of Y, and after taking wires from any column, it moves along the negative direction of X to an adjacent column to take wires. The wire taking direction of the wire taking device 3 is not limited.
[0140] The reference line point on the reference line plate is set to A 0PMN , 0P refers to the base line board, M refers to the number of columns, N refers to the number of rows, A 0PMN Refers to the reference line point in the Mth column and Nth row on the reference line board (1≤M≤3, 1≤N≤18), the adjacent reference line point A 0PMN The vertical spacing is set to L YAA , the horizontal spacing is set to L XAA In this embodiment, each column of the reference line plate is provided with 18 groups of reference line points in the longitudinal direction, that is, there are 18 rows and 3 columns in total;
[0141] The welding arm 21 sets the positioning mark point on the reference line plate obtained by photographing the reference position of the line plate as the reference positioning point B. Op , 0P refers to the reference line plate, positioning distance sensor 60 detects B Op The Z direction coordinate is set to 0, and the reference line point A 0P11 The coordinates of B are set to [0, 0, 0], Op As the coordinates of the reference positioning point are known, we can get L AB , L XAB , L YAB and θ AB , L AB Pointer B Op With A 0P11 The straight-line distance, L XAB Pointer B Op Relative to A 0P11 Distance in the X direction, L YAB Pointer B 0p Relative to A 0P11 Distance in the Y direction, θ AB Pointer B 0p Relative to A 0P11 Angle offset value in the X direction;
[0142] The reference rough positioning distance measurement point on the reference line plate is set as D 0P ;D 0P The position can be set at the center or non-center of the reference line plate. 0P With B 0p The distance is known, and L XDB , L YDB , L DB and θ DB , L XDB Finger D 0P Relative to B 0p Distance in the X direction, LYDB Finger D 0P Relative to B 0p Distance in the Y direction, L DB Finger D 0P Relative to B 0p The straight-line distance, θ DB Finger D 0P Relative to B 0p Angle offset value in the X direction;
[0143] Step A3.2 Line board setting;
[0144] The line point on the line board is set to A 1PMN , 1P refers to the line board, M refers to the number of columns, N refers to the number of rows, A 1PMN Refers to the line-taking points in the Mth row and Nth row on the line board (1≤M≤3, 1≤N≤18). In this embodiment, each column of the line board is provided with 18 groups of line-taking points in the longitudinal direction, that is, there are 18 rows and 3 columns in total; the positioning point on the line board is set as B 1P , the coarse positioning and ranging point is set to D 1P , A 0HMN With A 1HMN , D 0P and D 1P , B 0P and B 1P The quantity and position correspond one to one;
[0145] The longitudinal and transverse spacing between adjacent line-taking points and L YAA and L XAA same;
[0146] Step A3.3: Positioning camera 61 feedbacks the offset of the line board;
[0147] The control system controls the wire bonding arm 21 to move to the reference position of the shooting wire board, and the positioning camera 61 moves the positioning point B 1P Relative to the reference point B 0p The offset of the line plate is the offset X of the line plate relative to the reference line plate 1P0 , Y 1P0 and θ 1P0 Feedback to the control system; offset X 1P0 Pointer B 1P Relative to B 0P The X-direction offset, Y 1P0 Pointer B 1P Relative to B 0P The Y-direction offset, θ 1P0 The clockwise rotation offset of the finger plate relative to the base plate.
[0148] Step A4: Line board distance measurement;
[0149] Step A4.1 sets the rough positioning and ranging position of the line plate;
[0150] Step A3.1 Feedback line board offset [X 1P0 , Y 1P0 ,θ 1P0 ]Get the line board D 1P Relative to the reference line plate D 0P The offset X 1′P0 , Y 1′P0 ,
[0151] X 1′P0 =X 1P0 +L DB ×cos(θ DB +θ 1P0 )-L XDB ;
[0152] Y 1′P0 =Y 1P0 +L DB ×sin(θ DB +θ 1P0 )-L YDB ;
[0153] The control system controls the positioning and ranging sensor 60 to follow the line preprocessing platform according to the offset [X 1′P0 , Y 1′P0 ] Move to obtain the rough positioning and ranging position of the line plate;
[0154] Step A4.2: Positioning and measuring distance sensor 60 to measure distance;
[0155] The positioning and ranging sensor 60 is located at the rough positioning and ranging position of the line plate. 1P Perform distance measurement and obtain D 1P Relative D 0P The offset in the Z direction is Z 1P0 And feedback to the control system;
[0156] Step A4.3 sets the positioning camera to actually shoot the line board position;
[0157] The positioning distance sensor 60 is reset, and the control system controls the welding arm 21 of the welding device 2 to drive the positioning camera 61 according to the offset Z 1P0 By moving along the Z direction, the actual shooting line plate position of the positioning camera 61 is obtained, which can avoid the influence of depth deviation on vision.
[0158] Step A5: Precise positioning of the line board line taking point;
[0159] Step A5.1 obtains the offset of the line board;
[0160] The control system controls the welding arm 21 of the welding device 2 to drive the positioning camera 61 to the actual shooting line plate position. The positioning camera 61 measures the offset X of the line plate relative to the reference line plate at the actual shooting line plate position. 1P , Y 1P and θ 1P Feedback to control system;
[0161] Step A5.2 obtains the Z-direction offset of the line board;
[0162] Step A5.2.1 Setting the reference distance measurement point of the reference line plate;
[0163] The reference distance measurement point on the reference line board is set as C 0Pa , 0P refers to the reference line plate, a refers to the number of reference distance measurement points, a: 1, 2, 3...n; In this embodiment, the reference line plate is provided with three groups of reference distance measurement points, which are set as C 0Pa , respectively C 0P1 , C 0P2 and C 0P3 , C 0P1 Located in A 0P11 Directly below, C 0P2 Located in A 0P18 Directly above, C 0P3 Located in A 0P31 Directly below, the reference distance measurement point C 0Pa With adjacent benchmark line point A 0PMN The spacing between them is set to L AC ;
[0164] Step A5.2.2 Setting the distance measurement point of the line board;
[0165] The distance measurement point on the line board is set as C 1Pa , 1P refers to the line board, a refers to the number of ranging fixed points, a: 1, 2, 3...n; in this embodiment, the line board is provided with three groups of ranging fixed points set as C 1Pa , respectively C 1P1 , C 1P2 and C 1P3 , C 1P1 Located in A 1P11 Directly below, C 1P2 Located in A 1P18 Directly above, C 1P3 Located in A 1P31 Directly below, the distance measurement point C 1Pa With adjacent line point A 1PMN The spacing between AC , C 0Pa With C 1Pa The quantity and position correspond one to one;
[0166] Step A5.2.3: Positioning the distance measuring sensor 60 to detect the offset of the line board in the Z direction;
[0167] The positioning distance measuring sensor 60 detects the reference distance measuring point C on the reference line plate. 0Pa And the distance measurement point C on the line board 1Pa The Z offset value Z Pa , Z P1 C 1P1 Relative C 0P1 The offset value in the Z direction, Z P2 C 1P2 Relative C 0P2 The offset value in the Z direction, Z P3 C 1P3 Relative C 0P3 Offset value in the Z direction;
[0168] Step A5.2.4: Get the line board take-off point A 1P11 The coordinates [X 1P11 , Y 1P11 , Z 1P11 ];
[0169] X 1P11 =X 1P -L XAB +L AB ×cos(θ AB +θ 1P );
[0170] Y 1P11 =Y 1P -L YAB +L AB ×sin(θ AB +θ 1P );
[0171] Z 1P11 =(Z P2 -Z P1 ) / (17×L YAA +2×L AC )×L AC +Z P1 ;
[0172] Step A5.2.5: Get the first arbitrary line point A of the line board 1P1N The coordinates [X 1P1N , Y 1P1N , Z 1P1N ];
[0173] X 1P1N =X 1P11 -(N-1)×L YAB ×sinθ 1P ;
[0174] Y 1P1N =Y 1P11 +(N-1)×L YAB ×cos θ 1P ;
[0175] Z 1P1N =(Z P2 -Z P1 ) / (17×L YAA +2×L AC )×(L AC +(N-1)×L YAA )+Z P1 ;
[0176] Step A5.2.6: Get any line-taking point A on the line board 1PMN The coordinates [X 1PMN , Y1 PMN , Z 1PMN ];
[0177] X 1PMN =X 1P11 +(M-1)×L XAA ×cos θ 1P -(N-1)×L YAA ×sinθ 1P ;
[0178] Y 1PMN =Y 1P11 +(M-1)×L XAA ×sinθ 1P +(N-1)×L YAA ×cosθ 1P ;
[0179] Z 1PMN =(Z P2 -Z P1 ) / (17×L YAA +2×L AC )×(L AC +(N-1)×L YAA )+(Z P3 -Z P1 )× (M-1) / 2+Z P1
[0180] Step A6: Rough positioning of welding plate;
[0181] In this embodiment, the left-right direction of the reference welding plate is set as the X direction, and the X left direction is set as the positive direction, the up-down direction of the reference welding plate is set as the Y direction, the Y upward direction is set as the positive direction, the inside-outside direction of the reference welding plate is set as the Z direction, and the Z inside direction is set as the positive direction; the welding device 2 welds row by row along the positive direction of Y, and after welding any column, it moves along the positive direction of X to the adjacent column for welding, but is not limited to this.
[0182] The reference welding point on the reference welding plate is set as A 0HMN OH refers to the reference welding plate, M refers to the number of columns, N refers to the number of rows, A 0HMN Refers to the reference welding point in the Mth row and Nth row on the reference welding plate (1≤M≤3, 1≤N≤18). The reference distance measurement point on the reference welding plate is set to C 0Ha , a refers to the number of reference distance measurement points, a: 1, 2, 3...n; the welding point on the welding plate is set to A 1HMN , 1H refers to the welding plate, M refers to the number of columns, N refers to the number of rows, A 1HMN Refers to the welding point in the Mth row and Nth row on the welding plate (1≤M≤3, 1≤N≤18), and the distance measurement point on the welding plate is set to C 1Ha , a refers to the number of ranging points, a: 1, 2, 3...n; A 0HMN With A 1HMN , C 0Ha With C 1Ha The quantity and position correspond one to one;
[0183] The reference rough positioning distance measurement point on the reference welding plate is set as D 0H ;D 0H The position can be set at the center or non-center of the reference welding plate. 0H With B 0H The distance is known, and L X′DB , L Y′DB , L ′DB and θ ′DB , L′ XDB Finger D 0H Relative to B 0H Distance in the X direction, L Y′DB Finger D 0H Relative to B 0H Distance in the Y direction, L ′DB Finger D 0H Relative to B 0H The straight-line distance, θ′ DB Finger D 0H Relative to B 0H The angle offset value in the X direction; the coarse positioning distance measurement point on the welding plate is set to D 1H , set B on the welding plate 1H B is the positioning point; 0H and B1H , D 0H and D 1H The quantity and position correspond one to one;
[0184] The control system controls the wire welding arm 21 to move to the reference position for photographing the welding plate, and the positioning camera 61 adjusts the offset X of the welding plate relative to the reference welding plate. 1H0 , Y 1H0 and θ 1H0 Feedback to the control system; the offset of the welding plate relative to the reference welding plate X 1H0 Pointer B 1H Relative to B 0H The X-direction offset, Y 1H0 Pointer B 1H Relative to B 0H The Y-direction offset, θ 1H0 Refers to the rotational offset of the welding plate relative to the reference welding plate.
[0185] Step A7: welding plate distance measurement;
[0186] The control system controls the positioning and ranging sensor 60 to follow the line preprocessing platform according to the offset [X 1′H0 , Y 1′H0 ]Move, X 1′H0 , Y 1′H0 The calculation method is the same as X 1′P0 , Y 1′P0 The calculation method is the same as that of the welding plate rough positioning distance measurement position, and the positioning distance measurement sensor 60 is located at the welding plate rough positioning distance measurement position D 1H Perform distance measurement and obtain D 1H Relative D 0H The offset in the Z direction is Z 1H0 And feedback to the control system, the control system controls the welding arm 21 of the welding device 2 to drive the positioning camera 61 according to the offset Z 1H0 Move along the Z direction to obtain the actual photographing welding plate position of the positioning camera 61;
[0187] Step A8: Precise positioning of welding points of welding plates;
[0188] The positioning camera 61 measures the offset X of the welding plate relative to the reference welding plate at the actual shooting welding plate position. 1H 、Y1 H and θ 1H Feedback to the control system, positioning distance sensor 60 detects the reference distance fixed point C on the reference welding plate 0Ha And the distance measurement point C on the welding board 1Ha The Z offset value Z Ha , Z H1 C 1H1 Relative C 0H1 The offset value in the Z direction, ZH2 C 1H2 Relative C 0H2 The offset value in the Z direction, Z H3 C 1H3 Relative C 0H3 The offset value in the Z direction is based on the offset value X 1H , Y 1H ,θ 1H And the offset value Z in the Z direction Ha , get welding point A 1HMN The coordinates [X 1HMN , Y 1HMN , Z 1HMN ]; welding point A 1HMN Coordinate calculation method and line point A 1PMN The calculation method of coordinates is similar and will not be elaborated here.
[0189] Step A9: Reset the robot arm;
[0190] The robot arm includes a welding arm and a wire taking arm, and the resetting of the welding arm and the wire taking arm is achieved through the above-mentioned robot arm zero return module.
[0191] In this embodiment, before the line board and welding plate calibration step in step A1, the base 1 may also be repositioned. AGV7 drives the base 1 to move to the destination station and then repositions it. The purpose is to keep the base 1 parallel to the wiring cabinet 5. This is the same as the step of AGV7 repositioning the base 1 in step B2.5, and will not be repeated here.
[0192] In this embodiment, the control system controls the wire taking arm 31 of the wire taking device 3 to move to the wire taking point position to take the wire through the wire taking point position on the wire board and the coordinate system α.
[0193] In other embodiments, the step of fine positioning of the line board line point in step A5 can be omitted, and the rough positioning offset value of the line board [X 1P0 , Y 1P0 ,θ 1P0 ] Feedback to the control system to obtain the line point A 1PMN The coordinates of each line point A 1PMN The coordinate in the Z direction can be approximately equal to the offset value Z 1P0 ;
[0194] In other embodiments, the number of reference distance measurement points of the reference line plate in step A5.2.1 and the number of distance measurement points of the line plate in step A5.2.2 can be set as a group, and each line point A 1PMN The offset in the Z direction can be approximately the same.
[0195] In this embodiment, several wire plates located in the same column are regarded as a group of wire plate number series, which can be set to 10000001 1111 1111, and the station number 0x0010 is the destination station. AGV7 drives the base 1 to the destination station so that the base 1 is opposite to a group of wire plate number series. After the welding operation is completed, AGV7 with the station number 0xZZZZ continues to drive the base 1 to the destination station opposite to another group of wire plate number series. Preferably, one group of wire plate number series corresponds to 9 groups of wire plates, and any wire plate is provided with three columns of wire plate inner hole number series, such as recorded as column A, column B, and column C respectively. The column A number series can be set to 0000 0000 0000 0011 1111 1111 1111 1111; the column B number series can be set to 0000 0000 0000 0011 1111 1111 1111 1111; the C column number sequence can be set to 0000 00000000 0011 1111 1111 1111 1111; a number of groups of wire plate number sequences constitute a welding number sequence execution list, see Table 1; the welding number sequence execution list is input into the control system through the PC, and the control system reads the welding number sequence to realize uninterrupted wire taking and welding operation.
[0196] Table 1
[0197]
[0198]
[0199] In the nth line board number series YEEE EEEX XXXX XXXX in Table 1, Y refers to welding on the left side or welding on the right side, such as 1 represents the right side of the junction cabinet 5, X XXXX XXXX refers to the line board number series, and E has no reference;
[0200] like Figure 1-23 As shown, the present embodiment also provides a method for using an automatic welding device for a signal transmission line. The method uses the automatic welding device to weld the signal transmission line to a wiring cabinet 5. The automatic welding device includes the above-mentioned base 1, welding device 2, wire taking device 3, wire preprocessing device 4, positioning system 6 and control system. The wire taking device 3 includes a wire taking arm 31, a wire taking assembly 32, a wire taking transverse movement assembly 33 and a wire taking longitudinal movement assembly 34. The wire preprocessing device 4 includes a wire preprocessing mechanism 42, a wire preprocessing transverse movement assembly 43 and a wire preprocessing longitudinal movement assembly 44. The welding device 2 includes a welding arm 21, a welding assembly 22, a welding transverse movement assembly 23 and a welding longitudinal movement assembly 24. The base 1 is driven by AGV7, and the control system controls the operation of the welding device 2, the wire taking device 3, the wire preprocessing device 4, the positioning system 6 and the AGV7, and specifically includes the following steps:
[0201] Step B1: automatic welding equipment pretreatment;
[0202] Step B1.0: AGV7 drives base 1 to move to the destination station, so that base 1 and wiring cabinet 5 remain parallel or approximately parallel and establish the robot arm's own coordinate system;
[0203] Step B1.1: Calibration of wire board and welding board;
[0204] Step B1.2: Create visual positioning templates for line plates and welding plates;
[0205] Step B1.3: Pre-editing of robot arm motion;
[0206] Step B2: Automatic welding equipment startup preparation;
[0207] Step B2.1: PC sends welding sequence execution list to the control system;
[0208] Step B2.2: Start the AGV and confirm that the AGV communication is normal;
[0209] Step B2.3: The control system controls AGV7 to run to the standby station;
[0210] Step B2.4: The control system reads the incoming sequence execution list;
[0211] Step B3: Welding wire number series judgment;
[0212] Step B4: the control system controls the AGV to run to the destination station corresponding to the current welding line sequence;
[0213] Step B5: Start the automatic welding equipment, initialize the control system, confirm that the equipment communication is normal, start the welding arm, and start the wire taking arm.
[0214] Step B6: judging the line board number series;
[0215] Step B7: the welding device 2, the wire taking device 3 and the wire pre-processing device 4 move to a position where the welding wire is to be taken from a certain wire board in the wire board array;
[0216] Step B8: judging the number of holes in the wire board;
[0217] Step B9: The control system sends the current line point coordinates [X 1PMN , Y 1PMN , Z 1PMN ] to the wire taking arm 31; the wire taking arm 31 controls the wire taking assembly 32 to take the wire from the wire taking point to complete the wire taking and wire pulling operations;
[0218] Step B10: the wire taking arm 31 controls the wire taking assembly 32 to run the signal transmission wire to the wire preprocessing mechanism 42 of the wire preprocessing device 4 for wire cutting, wire stripping and wire twisting operations;
[0219] Step B11: The wire taking arm 31 controls the wire taking assembly 32 to transfer the wire to the welding assembly 22; the welding assembly 22 moves the wire to the welding point coordinate [X 1HMN , Y 1HMN , Z 1HMN ], completing the line welding operation;
[0220] Step B12: Accumulate the number of holes in the wire board and determine whether the number of holes in the wire board has been completed. If so, execute step B13; if not, execute step B8;
[0221] Step B13: Accumulate the line board sequence to determine whether the line board sequence has been completed. If so, execute step B14; if not, execute step B6;
[0222] Step B14: the line board sequence of the destination station is completed, the line taking arm 31 and the wire welding arm 21 are shut down, and the system is powered off;
[0223] Step B15: Determine whether the welding sequence is completed, if yes, execute step B16, if no, execute step B3;
[0224] Step B16: The control system controls AGV7 to run to the standby station, and the multi-cabinet welding program is completed.
[0225] In step B1.0, the robot arm includes a welding arm and a wire taking arm, and the steps for establishing the welding arm's own coordinate system are as follows;
[0226] Step B1.0.1 sets a top point with a constant position;
[0227] Step B1.0.2 Move the welding arm so that the chuck vertex of the welding arm touches the top vertex, and record position 1;
[0228] Step B1.0.3 Change the welding arm posture to make the chuck vertex contact the top vertex, and record position 2;
[0229] Step B1.0.4 Change the welding arm posture to make the chuck vertex contact the top vertex, and record position 3;
[0230] Step B1.0.5 confirms the position of the chuck and generates tool points;
[0231] Step B1.0.6 Place the chuck of the welding arm at a certain position on the welding plate, such as the upper right corner as the origin;
[0232] Step B1.0.7 Place the chuck of the welding arm at another position of the welding plate, such as the upper left corner to determine the x-axis direction;
[0233] Step B1.0.8 Place the chuck of the welding arm at another position of the welding plate, such as the lower right corner to determine the y-axis direction;
[0234] Step B1.0.9 generates the welding arm's own coordinate system;
[0235] The steps of establishing the line-taking arm's own coordinate system in step B1.0 are similar to the steps of establishing the welding arm's own coordinate system, and will not be described in detail here;
[0236] Steps for calibrating the centerline plate and welding plate in step B1.1 are as follows;
[0237] Step B1.1.1: Establishing a coordinate system α between the wire plate and the welding arm 21;
[0238] Step B1.1.1.1 The welding arm 21 makes a tool coordinate system for the wire plate;
[0239] Step B1.1.1.2 The welding arm 21 controls the positioning camera 61 to move to the line board shooting position;
[0240] Step B1.1.1.3 Position the camera 61 to shoot and select feature points. The feature point is preferably the center of the hole at the upper right corner of the wire board;
[0241] Step B1.1.1.4 records the translation position information of the welding arm 21 and the feature point position information;
[0242] Step B1.1.1.5 determines whether there are nine groups of image feature points and welding arm position information. If not, proceed to step B1.1.1.4. If not, proceed to step B1.1.1.6.
[0243] Step B1.1.1.6: Establishing the coordinate system α of the wire plate and the welding arm 21 according to the nine sets of feature point information;
[0244] Step B1.1.2: Establishing the coordinate system β of the welding plate and the welding arm 21; the method and steps for establishing the coordinate system β are the same as those for establishing the coordinate system α in step B1.1.1, and will not be described in detail here;
[0245] The steps for establishing the visual positioning template of the line plate and the welding plate in step B1.2 are as follows;
[0246] Step B1.2.1 Establish a visual positioning template for the wire board;
[0247] Step B1.2.1.1 The welding arm 21 controls the positioning camera 61 to move to the wire board to take a picture;
[0248] Step B1.2.1.2 Select the feature point Q of the image in step B1.2.1.1, and output the offset X through the coordinate system α 1 , Y 1 , the offset X 1 , Y 1 As the first position coordinate of the welding arm 21;
[0249] Step B1.2.1.3 Set the first position coordinates (X 1 , Y 1 )Offset(-X 1 , -Y 1 ), and the offset position of the welding arm 21 is used as the second position of the welding arm 21, the positioning camera 61 moves with the welding arm 21, and takes pictures;
[0250] Step B1.2.1.4 Select the feature point Q of the image in step B1.2.1.3, and output the offset X of the feature point Q information through the coordinate system 2 , Y 2 , determine the offset X 2 , Y 2 Is it zero or close to zero? If so, execute step B1.2.1.5; if not, determine whether the characteristic point Q is correct. If the characteristic point Q is incorrect, execute step B1.2.1.2. If the characteristic point Q is correct, re-calibrate the coordinate system α of the welding arm and the line plate with nine points;
[0251] Step B1.2.1.5 sets the second position of the welding arm 21 as the shooting line plate reference position of the welding arm 21;
[0252] Step B1.2.1.6 Set the first line-taking point A on the line board 1P11 To take the line template point;
[0253] Step B1.2.1.7 Complete the visual positioning template of the wire board;
[0254] Step B1.2.2: Establish the visual positioning template of the welding plate; the steps for establishing the visual positioning template of the welding plate are the same as those for establishing the visual positioning template of the line plate in step B1.2.1, and will not be repeated here;
[0255] The pre-editing of the robot arm motion in step B1.3 includes the following steps;
[0256] Step B1.3.1 sets the avoidance point and avoidance path of the welding arm 21 and the wire taking arm 31; at the avoidance point, the welding arm 21 and the wire taking arm 31 will not collide with related equipment, and the above-mentioned robot arm zero return module is used to realize the automatic zero return function of the robot arm;
[0257] Step B1.3.2 The wire taking arm 31 moves from the avoidance point to the wire taking point according to the wire taking point coordinates on the wire board to take the wire;
[0258] Step B1.3.3 The wire taking device 3 straightens the signal transmission wire through the wire taking driving mechanism 3246 of the wire preprocessing mechanism 42;
[0259] Step B1.3.4: the wire taking arm 31 moves the signal transmission wire to the wire preprocessing platform of the wire preprocessing mechanism 42;
[0260] Step B1.3.5 The wire taking arm 31 releases the signal transmission wire and leaves the wire preprocessing platform of the wire preprocessing mechanism 42;
[0261] Step B1.3.6 The wire taking arm 31 enters the wire pre-processing platform to clamp the processed wire;
[0262] Step B1.3.7 The wire taking arm 31 takes the wire away from the wire pre-processing platform;
[0263] Step B1.3.8: the thread taking arm 31 moves the thread to the arm changing preparation position;
[0264] Step B1.3.9: the welding arm 21 moves from the avoidance point to the arm change preparation position;
[0265] Step B1.3.10 The wire taking arm 31 feeds the wire into the welding conveying mechanism of the welding assembly 22;
[0266] Step B1.3.11: the wire taking arm 31 is reset to the avoidance point;
[0267] Step B1.3.12 The welding arm 21 moves to the welding point according to the welding point coordinate line;
[0268] Step B1.3.13 The welding wire arm moves horizontally in the z direction (i.e., the direction of the wiring cabinet) to wait for the welding clamping mechanism of the welding assembly 22 to clamp the welding terminal;
[0269] Step B1.3.14 The wire welding arm moves horizontally in the z direction to wait for wire threading and welding;
[0270] Step B1.3.15 The wire welding arm is reset to the avoidance point.
[0271] In step B2.2, start the AGV and confirm that the AGV communication is normal: when the control system is initialized, the control system sends an AGV7 communication command. If an AGV7 communication return is received, it is determined that the AGV7 communication is normal and step B2.3 is executed. If not, the control system receives a prompt to check the AGV7 communication connection. Once the control system is initialized, adjust the AGV7 communication connection and re-execute step B2.2 until the AGV7 communication connection is normal.
[0272] Step B4 may also include the AGV 7 relocating the base 1, and the two sides of the bottom of the base 1 are respectively fixed with a relocation distance measuring sensor 70, which specifically includes the following steps:
[0273] Step B4.1: repositioning the distance measuring sensor 70 to detect the distance between the base 1 and the wiring cabinet 5;
[0274] Two sets of relocation distance measuring sensors 70 respectively measure the distance between the base 1 and the wiring cabinet 5, and obtain the average distance H between the base 1 and the wiring cabinet 5. a , H a Compare the distance H between the set wiring cabinet 5 and the corresponding destination station stored in the control system, H h =|H a -H|,H h If Hh is equal to zero or close to zero or within the allowable error range, proceed to step B4.3. If Hh is not within the allowable error range, proceed to step B4.2.
[0275] Step B4.2: relocating the distance between the base 1 and the wiring cabinet 5;
[0276] The AGV controls the movement of the base 1 again until the average distance between the base 1 and the wiring cabinet 5 is maintained at H or approximately H, ensuring that the base 1 is located at the destination station corresponding to the wiring cabinet 5;
[0277] Step B4.3: Detecting the angle offset value of the base 1 relative to the wiring cabinet 5;
[0278] Two sets of repositioning distance measuring sensors 70 measure the distance between the base 1 and the wiring cabinet 5, and the angle offset value θ between the base 1 and the wiring cabinet 5 is obtained according to the distance difference measured by the two sets of repositioning distance measuring sensors 70. a ,θ a Compare with the allowable angle offset value θ between the base 1 and the wiring cabinet 5 stored in the control system, θ h =|θ a -θ|, if θ a is equal to zero or close to zero or within the allowable error range, it can be determined that the current base 1 is parallel or close to the wiring cabinet 5. a If it is not within the allowable error range, proceed to step B4.4;
[0279] Step B4.4: repositioning the angle offset value of the base 1 relative to the wiring cabinet 5;
[0280] The control system controls the AGV to drive the base 1 to rotate θ h , so that the angle offset value between the base 1 and the wiring cabinet 5 is maintained at θ or approximately θ, ensuring that the base 1 and the wiring cabinet 5 are parallel or approximately parallel.
[0281] In actual use, when the AGV 7 operates normally, it drives the base 1 to move directly to the corresponding destination station. Therefore, in other embodiments, the repositioning step of the base 1 can also be eliminated.
[0282] The control system initialization 2 in step B5 includes the following steps:
[0283] Step B5.1 Control system initialization 2 starts;
[0284] Step B5.2 Equipment communication check;
[0285] The control system sends a device communication command. If a device communication response is received, step B5.3 is executed. If not, the control system receives a prompt to check the device communication connection. The control system initialization 2 ends, the device communication connection is adjusted, and step B5.1 is executed again until the device communication connection is normal.
[0286] Step B5.3 Positioning system communication check;
[0287] The control system sends a positioning system communication command. If a positioning system communication response is received, step B5.4 is executed. If not, the control system receives a prompt to check the positioning system communication connection. The control system initialization 2 ends, the positioning system communication connection is adjusted, and step B5.1 is executed again until the positioning system communication connection is normal.
[0288] Step B5.4 determines whether the system is at zero position, if so, executes step B5.5, if not, each device is reset to zero according to the path;
[0289] Step B5.5 Control system power-off storage variable reading;
[0290] Step B5.6 Control system initialization 2 ends.
[0291] Steps B6 to B7 may also include a method for locating the coordinates of the line-taking point and the welding point, which specifically includes the following steps:
[0292] Step C1: taking the line point coordinates for positioning;
[0293] The coordinates of the line taking point are positioned using the high-precision positioning line taking device 3.
[0294] Step C2: welding point coordinate positioning;
[0295] The welding point coordinates are located using a high-precision positioning welding device 2.
[0296] Step C3: the robot arm is reset;
[0297] The robot arm comprises a welding arm and a wire taking arm, and the resetting of the welding arm and the wire taking arm is achieved through the above-mentioned robot arm zero return module.
[0298] Step C1: The steps for locating the coordinates of the line-taking point are as follows:
[0299] Step C1.1: rough positioning of the wire board;
[0300] Step C1.1.1: Setting the datum line plate;
[0301] In this embodiment, Figure 1As shown, the left-right direction of the reference line plate is set as the X direction, and the X left direction is set as the positive direction, the up-down direction of the reference line plate is set as the Y direction, and the Y upward direction is set as the positive direction, the inside-outside direction of the reference line plate is set as the Z direction, and the Z inside direction is set as the positive direction, the wire taking device 3 takes wires row by row along the positive direction of Y, and after taking wires from any column, it moves along the positive direction of X to the adjacent column to take wires.
[0302] In other embodiments, the wire taking device 3 can also take wires row by row along the negative direction of Y, and after taking wires from any column, it moves along the negative direction of X to an adjacent column to take wires. The wire taking direction of the wire taking device 3 is not limited.
[0303] The reference line point on the reference line plate is set to A 0PMN , 0P refers to the base line board, M refers to the number of columns, N refers to the number of rows, A 0PMN Refers to the reference line point in the Mth column and Nth row on the reference line board (1≤M≤3, 1≤N≤18), the adjacent reference line point A 0PMN The vertical spacing is set to L YAA , the horizontal spacing is set to L XAA In this embodiment, each column of the reference line plate is provided with 18 groups of reference line points in the longitudinal direction, that is, there are 18 rows and 3 columns in total;
[0304] The welding arm 21 sets the positioning mark point on the reference line plate obtained by photographing the reference position of the line plate as the reference positioning point B. 0p , 0P refers to the reference line plate, positioning distance sensor 60 detects B 0p The Z direction coordinate is set to 0, and the reference line point A 0P11 The coordinates of B are set to [0, 0, 0], 0p As the coordinates of the reference positioning point are known, we can get L AB , L XAB , L YAB and θ AB , L AB Pointer B 0p With A 0P11 The straight-line distance, L XAB Pointer B 0p Relative to A 0P11 Distance in the X direction, L YAB Pointer B 0p Relative to A 0P11 Distance in the Y direction, θ AB Refers to B0 p Relative to A 0P11 Angle offset value in the X direction;
[0305] The reference rough positioning distance measurement point on the reference line plate is set as D 0P ;D 0PThe position can be set at the center or non-center of the reference line plate. 0P With B 0p The distance is known, and L XDB , L YDB , L DB and θ DB , L XDB Finger D 0P Relative to B 0p Distance in the X direction, L YDB Finger D 0P Relative to B 0p Distance in the Y direction, L DB Finger D 0P Relative to B 0p The straight-line distance, θ DB Finger D 0P Relative to B 0p Angle offset value in the X direction;
[0306] Step C1.1.2 Line board setting;
[0307] The line point on the line board is set to A 1PMN , 1P refers to the line board, M refers to the number of columns, N refers to the number of rows, A 1PMN Refers to the line-taking points in the Mth row and Nth row on the line board (1≤M≤3, 1≤N≤18). In this embodiment, each column of the line board is provided with 18 groups of line-taking points in the longitudinal direction, that is, there are 18 rows and 3 columns in total; the positioning point on the line board is set as B 1P , the coarse positioning and ranging point is set to D 1P , A 0HMN With A 1HMN , D 0P and D 1P , B 0P and B 1P The quantity and position correspond one to one;
[0308] The longitudinal and transverse spacing between adjacent line-taking points and L YAA and L XAA same;
[0309] Step C1.1.3: Positioning camera 61 feedbacks the offset of the line board;
[0310] The control system controls the wire bonding arm 21 to move to the reference position of the shooting wire board, and the positioning camera 61 moves the positioning point B 1P Relative to the reference point B 0p The offset of the line plate is the offset X of the line plate relative to the reference line plate 1P0 , Y 1P0 and θ 1P0 Feedback to the control system; offset X 1P0 Pointer B 1P Relative to B0P X-direction offset, Y1 P0 Pointer B 1P Relative to B 0P The Y-direction offset, θ 1P0 The rotation offset of the finger plate relative to the base plate.
[0311] Step C1.2 Line board distance measurement;
[0312] Step C1.2.1 sets the line plate coarse positioning and ranging position;
[0313] The line board offset [X 1P0 , Y 1P0 ,θ 1P0 ]Get the line board D 1P Relative to the reference line plate D 0P The offset X 1′P0 , Y 1′P0 ,
[0314] X 1′P0 =X 1P0 +L DB ×cos(θ DB +θ 1P0 )-L XDB ;
[0315] Y 1′P0 =Y 1P0 +L DB ×sin(θ DB +θ 1P0 )-L YDB ;
[0316] The control system controls the positioning and ranging sensor 60 to follow the line preprocessing platform according to the offset [X 1′P0 , Y 1′P0 ] Move to obtain the rough positioning and ranging position of the line plate;
[0317] Step C1.2.2: Positioning and measuring distance sensor 60 to measure distance;
[0318] The positioning and ranging sensor 60 is located at the rough positioning and ranging position of the line plate. 1P Perform distance measurement and obtain D 1P Relative D 0P The offset in the Z direction is Z 1P0 And feedback to the control system;
[0319] Step C1.2.3 sets the positioning camera to actually shoot the line board position;
[0320] The positioning distance sensor 60 is reset, and the control system controls the welding arm 21 of the welding device 2 to drive the positioning camera 61 according to the offset Z 1P0By moving along the Z direction, the actual shooting line plate position of the positioning camera 61 is obtained, which can avoid the influence of depth deviation on vision.
[0321] Step C1.3 Precise positioning of the line board line taking point;
[0322] Step C1.3.1 obtains the offset of the line board;
[0323] The control system controls the welding arm 21 of the welding device 2 to drive the positioning camera 61 to the actual shooting line plate position. The positioning camera 61 measures the offset X of the line plate relative to the reference line plate at the actual shooting line plate position. 1P , Y 1P and θ 1P Feedback to control system;
[0324] Step C1.3.2 obtains the Z-direction offset of the line board;
[0325] Step C1.3.2.1 Setting the reference distance measurement point of the reference line plate;
[0326] The reference distance measurement point on the reference line board is set as C 0Pa , 0P refers to the reference line plate, a refers to the number of reference distance measurement points, a: 1, 2, 3...n; In this embodiment, the reference line plate is provided with three groups of reference distance measurement points set as C 0Pa , respectively C 0P1 , C 0P2 and C 0P3 , C 0P1 Located in A 0P11 Directly below, C 0P2 Located in A 0P18 Directly above, C 0P3 Located in A 0P31 Directly below, the reference distance measurement point C 0Pa With adjacent benchmark line point A 0PMN The spacing between them is set to L AC ;
[0327] Step C1.3.2.2 Setting the distance measurement point of the line board;
[0328] The distance measurement point on the line board is set as C 1Pa , 1P refers to the line board, a refers to the number of ranging fixed points, a: 1, 2, 3...n; in this embodiment, the line board is provided with three groups of ranging fixed points set as C 1Pa , respectively C 1P1 , C 1P2 and C 1P3 , C 1P1 Located in A 1P11 Directly below, C 1P2 Located in A 1P18 Directly above, C 1P3Located in A 1P31 Directly below, the distance measurement point C 1Pa With adjacent line point A 1PMN The spacing between AC , C 0Pa With C 1Pa The quantity and position correspond one to one;
[0329] Step C1.3.2.3: Positioning and ranging sensor 60 to detect the offset of the line board in the Z direction;
[0330] The positioning distance measuring sensor 60 detects the reference distance measuring point C on the reference line plate. 0Pa And the distance measurement point C on the line board 1Pa The Z offset value Z Pa , Z P1 C 1P1 Relative C 0P1 The offset value in the Z direction, Z P2 C 1P2 Relative C 0P2 The offset value in the Z direction, Z P3 C 1P3 Relative C 0P3 Offset value in the Z direction;
[0331] Step C1.3.2.4: Get the line board take-off point A 1P11 The coordinates [X 1P11 , Y 1P11 , Z 1P11 ];
[0332] X 1P11 =X 1P -L XAB +L AB ×cos(θ AB +θ 1P );
[0333] Y 1P11 =Y 1P -L YAB +L AB ×sin(θ AB +θ 1P );
[0334] Z 1P11 =(Z P2 -Z P1 ) / (17×L YAA +2×L AC )×L AC +Z P1 ;
[0335] Step C1.3.2.5: Get the arbitrary line-taking point A in the first column of the line board 1P1NThe coordinates [X 1P1N , Y 1P1N , Z 1P1N ];
[0336] X 1P1N =X 1P11 -(N-1)×L YAB ×sinθ 1P ;
[0337] Y 1P1N =Y 1P11 +(N-1)×L YAB ×cosθ 1P ;
[0338] Z 1P1N =(Z P2 -Z P1 ) / (17×L YAA +2×L AC )×(L AC +(N-1)×L YAA )+Z P1 ;
[0339] Step C1.3.2.6: Get any line-taking point A on the line board 1PMN The coordinates [X 1PMN , Y 1PMN , Z 1PMN ];
[0340] X 1PMN =X 1P11 +(M-1)×L XAA ×cosθ 1P -(N-1)×L YAA ×sinθ 1P ;
[0341] Y 1PMN =Y 1P11 +(M-1)×L xAA ×sinθ 1P +(N-1)×L YAA ×cosθ 1P ;
[0342] Z 1PMN =(Z P2 -Z P1 ) / (17×L YAA +2×L AC )×(L AC +(N-1)×L YAA )+(Z P3 -Z P1 )× (M-1) / 2+Z P1 ;
[0343] Step C2: The steps for locating the welding point coordinates are as follows:
[0344] Step C2.1 Rough positioning of welding plate;
[0345] In this embodiment, the left-right direction of the reference welding plate is set as the X direction, and the X left direction is set as the positive direction, the up-down direction of the reference welding plate is set as the Y direction, the Y upward direction is set as the positive direction, the inside-outside direction of the reference welding plate is set as the Z direction, and the Z inside direction is set as the positive direction; the welding device 2 welds row by row along the positive direction of Y, and after welding any column, it moves along the positive direction of X to the adjacent column for welding, but is not limited to this.
[0346] The reference welding point on the reference welding plate is set as A 0HMN , 0H refers to the reference welding plate, M refers to the number of columns, N refers to the number of rows, A 0HMN Refers to the reference welding point in the Mth row and Nth row on the reference welding plate (1≤M≤3, 1≤N≤18). The reference distance measurement point on the reference welding plate is set to C 0Ha , a refers to the number of reference distance measurement points, a: 1, 2, 3...n; the welding point on the welding plate is set to A 1HMN , 1H refers to the welding plate, M refers to the number of columns, N refers to the number of rows, A 1HMN Refers to the welding point in the Mth row and Nth row on the welding plate (1≤M≤3, 1≤N≤18), and the distance measurement point on the welding plate is set to C 1Ha , a refers to the number of ranging points, a: 1, 2, 3...n; A 0HMN With A 1HMN , C 0Ha With C 1Ha The quantity and position correspond one to one;
[0347] The reference rough positioning distance measurement point on the reference welding plate is set as D 0H ;D 0H The position can be set at the center or non-center of the reference welding plate. 0H With B 0H The distance is known, and L X′DB , L Y′DB , L ′DB and θ ′DB , L′ XDB Finger D 0H Relative to B 0H Distance in the X direction, L Y′DB Finger D 0H Relative to B 0H Distance in the Y direction, L ′DB Finger D 0H Relative to B 0H The straight-line distance, θ′ DB Finger D 0H Relative to B0H The angle offset value in the X direction; the coarse positioning distance measurement point on the welding plate is set to D 1H , set B on the welding plate 1H B is the positioning point; 0H and B 1H , D 0H and D 1H The quantity and position correspond one to one;
[0348] The control system controls the wire welding arm 21 to move to the reference position for photographing the welding plate, and the positioning camera 61 adjusts the offset X of the welding plate relative to the reference welding plate. 1H0 , Y 1H0 and θ 1H0 Feedback to the control system; the offset of the welding plate relative to the reference welding plate X 1H0 Pointer B 1H Relative to B 0H The X-direction offset, Y 1H0 Pointer B 1H Relative to B 0H The Y-direction offset, θ 1H0 Refers to the rotational offset of the welding plate relative to the reference welding plate.
[0349] Step C2.2 welding plate distance measurement;
[0350] The control system controls the positioning and ranging sensor 60 to follow the line preprocessing platform according to the offset [X 1′H0 , Y 1′H0 ]Move, X 1′H0 , Y 1′H0 The calculation method is the same as X 1′P0 , Y 1′P0 The calculation method is the same as that of the welding plate rough positioning distance measurement position, and the positioning distance measurement sensor 60 is located at the welding plate rough positioning distance measurement position D 1H Perform distance measurement and obtain D 1H Relative D 0H The offset in the Z direction is Z 1H0 And feedback to the control system, the control system controls the welding arm 21 of the welding device 2 to drive the positioning camera 61 according to the offset Z 1H0 Move along the Z direction to obtain the actual photographing welding plate position of the positioning camera 61;
[0351] Step C2.3 Precise positioning of welding points of welding plate;
[0352] The positioning camera 61 measures the offset X of the welding plate relative to the reference welding plate at the actual shooting welding plate position. 1H , Y 1H and θ 1H Feedback to the control system, positioning distance sensor 60 detects the reference distance fixed point C on the reference welding plate 0Ha And the distance measurement point C on the welding board1Ha The Z offset value Z Ha , Z H1 C 1H1 Relative C 0H1 The offset value in the Z direction, Z H2 C 1H2 Relative C 0H2 The offset value in the Z direction, Z H3 C 1H3 Relative C 0H3 The offset value in the Z direction is based on the offset value X 1H , Y 1H ,θ 1H And the offset value Z in the Z direction Ha , get welding point A 1HMN The coordinates [X 1HMN , Y 1HMN , Z 1HMN ]; welding point A 1HMN Coordinate calculation method and line point A 1PMN The calculation method of coordinates is similar and will not be elaborated here.
[0353] In step B9, the wire taking assembly 32 is used to take the wire and pull the wire. The wire taking assembly 32 includes a first wire taking mechanism and a second wire taking mechanism. The first wire taking mechanism includes a first wire taking cylinder 3231, a wire taking plate 1 3232 and a wire taking plate 2 3233. The second wire taking mechanism includes a second wire taking cylinder 3241, a wire taking plate 3 3242, a wire taking plate 4 3243 and a wire taking drive mechanism 3246. Specifically, the following steps are included:
[0354] Step B9.1: The wire taking arm 31 controls the wire taking assembly 32 to move to the current wire taking point A. 1PMN The coordinates [X 1PMN , Y 1PMN , Z 1PMN ];
[0355] Step B9.2: The first wire taking cylinder 3231 controls the wire taking plate 1 3232 and the wire taking plate 2 3233 to move synchronously relative to each other to clamp the signal transmission line, and the wire taking arm 31 controls the wire taking assembly 32 to move away from the wire taking point to complete the wire taking operation;
[0356] Step B9.3: The wire taking drive mechanism 3246 drives the second wire taking mechanism to approach the first wire taking mechanism, the second wire taking cylinder 3241 controls the wire taking plate three 3242 and the wire taking plate four 3243 to move synchronously relative to each other to clamp the signal transmission line, and the wire taking drive mechanism 3246 drives the second wire taking mechanism away from the first wire taking mechanism to complete the wire pulling operation.
[0357] In step B11, the welding operation is performed using the welding assembly 22, the welding assembly 22 includes a welding mechanism, a welding conveying mechanism and a welding clamping mechanism, the welding mechanism includes a welding piece 2210 and a pressure welding motor 2212, the welding clamping mechanism includes a clamping cylinder 2221 and a clamping plate 2222, the welding conveying mechanism includes a clamping claw, an upper member, a lower member and a threading motor 2240, and the lower member includes a lower cylinder 2245, specifically including the following steps:
[0358] Step B11.1: The wire taking assembly 32 conveys the finished wire to between the upper member and the lower member, and the lower cylinder 2245 controls the lower member to move toward the upper member, fixes the finished wire between the upper member and the lower member, and the wire taking arm 31 is reset;
[0359] Step B11.2: The control system sends the current welding point coordinates [X 1HMN , Y 1HMN , Z 1HMN ] to the welding arm 21, the welding arm 21 controls the welding assembly 22 to move to the welding point, and the clamping cylinder 2221 controls the clamping plate 2222 to clamp the welding terminal;
[0360] Step B11.3: The control system controls the threading motor 2240 to run, and the thread is passed through the conveying cavity 225 of the clamping jaw and the clamping plate 2222 in sequence, and then passed to the welding terminal;
[0361] Step B11.4: The control system controls the welding motor 2212 to run, flatten the wire, and after flattening, retreats a certain distance while controlling the welding piece 2210 to perform welding operation;
[0362] Step B11.5: The components of the welding assembly 22 are reset, and the welding arm 21 returns to the origin and waits.
[0363] Obviously, the described embodiments are only some embodiments of the present invention, not all embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work should fall within the scope of protection of the present invention.
Claims
1. A method for using a signal transmission line automatic welding device, characterized in that: The method is based on automatic welding equipment, which includes a base, a welding device, a wire taking device, a wire preprocessing device and a control system. The control system controls the operation of the base, the welding device, the wire taking device and the wire preprocessing device. The wire taking device includes a wire taking arm, and the welding device includes a welding arm. The wire taking device takes the signal transmission line to be processed from the wiring cabinet to the wire preprocessing device through the wire taking arm for preprocessing. The wire taking device takes the preprocessed signal transmission line to the welding device through the wire taking arm. The welding device moves the preprocessed signal transmission line to the welding terminal of the wiring cabinet through the welding arm and welds it. The base is driven by an AGV, and the base is operated to a standby position by the AGV. Any wire plate is fixed with a plurality of wire plate inner holes, and the plurality of wire plate inner holes are distributed horizontally or vertically. The signal transmission line to be processed is hung in the wire plate inner holes. The welding terminal is located on the welding plate. The method also includes a positioning system, and the positioning system includes a positioning distance measuring sensor, a positioning camera, a reference wire plate and a reference welding plate. Specifically, the following steps are included: Step B1: automatic welding equipment pretreatment; Step B2: Automatic welding equipment startup preparation; Step B3: Welding wire number series judgment; Step B4: the control system controls the AGV to run to the destination station corresponding to the current welding line sequence; Step B5: Start the automatic welding equipment, confirm that the equipment communication is normal after the control system is initialized, start the welding arm, and start the wire taking arm; Step B6: judging the line board number series; Step B7: The welding device, the wire taking device and the wire pre-processing device move to a position where the welding wire is to be taken from a certain wire board in the wire board array; Steps B6 to B7 also include a method for locating the coordinates of the line-taking points and welding points, which specifically includes the following steps: Step C1: taking the line point coordinates for positioning; Step C2: welding point coordinate positioning; Step C3: the robot arm is reset; The robot arm includes a welding arm and a wire taking arm, and the welding arm and the wire taking arm are reset through the robot arm zero return module; Step C1: The steps for locating the coordinates of the line-taking point are as follows: Step C1.1: rough positioning of the wire board; Step C1.1.1: Setting the datum line plate; The left-right direction of the reference line plate is set as the X direction, and the X left direction is set as the positive direction, the up-down direction of the reference line plate is set as the Y direction, and the Y upward direction is set as the positive direction, the inside-outside direction of the reference line plate is set as the Z direction, and the Z inside direction is set as the positive direction, the wire taking device takes wires row by row along the positive direction of Y, and after taking wires from any column, it moves along the positive direction of X to an adjacent column to take wires; The reference line point on the reference line plate is set to A 0PMN , 0P refers to the base line board, M refers to the number of columns, N refers to the number of rows, A 0PMN Refers to the reference line point in the Mth column and Nth row on the reference line board, where 1≤M≤3, 1≤N≤18, and the adjacent reference line point A 0PMN The vertical spacing is set to L YAA , the horizontal spacing is set to L XAA , each column of the reference line plate is provided with 18 groups of reference line points in the longitudinal direction, that is, there are 18 rows and 3 columns in total; The welding arm sets the positioning mark point on the reference line plate obtained by shooting the reference position of the line plate as the reference positioning point B 0p , 0P refers to the reference line plate, and B is detected by the positioning distance sensor 0p The Z coordinate is set to 0, and the reference line point A 0P11 The coordinates of B are set to [0, 0, 0], 0p As the coordinates of the reference positioning point are known, we can get L AB , L XAB , L YAB and θ AB , L AB Pointer B 0p With A 0P11 The straight-line distance, L XAB Pointer B 0p Relative to A 0P11 Distance in the X direction, L YAB Pointer B 0p Relative to A 0P11 Distance in the Y direction, θ AB Pointer B 0p Relative to A 0P11 Angle offset value in the X direction; The reference rough positioning distance measurement point on the reference line plate is set as D 0P ;D 0P The position is set at the center or non-center of the reference line plate, D 0P With B 0p The distance is known, and L XDB , L YDB , L DB and θ DB , L XDB Finger D 0P Relative to B 0p Distance in the X direction, L YDB Finger D 0P Relative to B 0p Distance in the Y direction, L DB Finger D 0P Relative to B 0p The straight-line distance, θ DB Finger D 0P Relative to B 0p Angle offset value in the X direction; Step C1.1.2 Line board setting; The line point on the line board is set to A 1PMN , 1P refers to the line board, M refers to the number of columns, N refers to the number of rows, A 1PMN Refers to the line-taking point in the Mth row and Nth row of the line board, where 1≤M≤3, 1≤N≤18. There are 18 groups of line-taking points in each column of the line board, that is, there are 18 rows and 3 columns in total. The positioning point on the line board is set to B 1P , the coarse positioning and ranging point is set to D 1P , A 0PMN With A 1PMN , D 0P and D 1P , B 0P and B 1P The quantity and position correspond one to one; The longitudinal and transverse spacing between adjacent line-taking points and L YAA and L XAA same; Step C1.1.3 locates the offset of the camera feedback line plate; The control system controls the wire welding arm to move to the reference position of the shooting wire board, and the positioning camera will locate point B 1P Relative to the reference point B 0p The offset of the line plate is the offset X of the line plate relative to the reference line plate 1P0 , Y 1P0 and θ 1P0 Feedback to the control system; offset X 1P0 Pointer B 1P Relative to B 0P The X-direction offset, Y 1P0 Pointer B 1P Relative to B 0P The Y-direction offset, θ 1P0 The rotation offset of the finger line plate relative to the reference line plate; Step C1.2 Line board distance measurement; Step C1.2.1 sets the line plate coarse positioning and ranging position; The line board offset [X 1P0 , Y 1P0 ,θ 1P0 ]Get the line board D 1P Relative to the reference line plate D 0P The offset X 1'P0 , Y 1'P0 , X 1'P0 =X 1P0 +L DB ×cos(θ DB +θ 1P0 )-L XDB ; Y 1'P0 =Y 1P0 +L DB ×sin(θ DB +θ 1P0 )-L YDB ; The control system controls the positioning and ranging sensor to follow the line preprocessing platform according to the offset [X 1'P0 , Y 1'P0 ] Move to obtain the rough positioning and ranging position of the line plate; Step C1.2.2: Positioning and ranging sensor distance measurement; The positioning and ranging sensor is located at the rough positioning and ranging position of the line board. 1P Perform distance measurement and obtain D 1P Relative D 0P The offset in the Z direction is Z 1P0 And feedback to the control system; Step C1.2.3 sets the positioning camera to actually shoot the line board position; The positioning distance sensor is reset, and the control system controls the welding arm of the welding device to drive the positioning camera according to the offset Z 1P0 Move along the Z direction to obtain the actual shooting line plate position of the positioning camera; Step C1.3 Precise positioning of the line board line taking point; Step C1.3.1 obtains the offset of the line board; The control system controls the welding arm of the welding device to drive the positioning camera to the actual shooting line plate position. The positioning camera adjusts the offset X of the line plate relative to the reference line plate at the actual shooting line plate position. 1P , Y 1P and θ 1P Feedback to control system; Step C1.3.2 obtains the Z-direction offset of the line board; Step C1.3.2.1 Setting the reference distance measurement point of the reference line plate; The reference distance measurement point on the reference line board is set as C 0Pa , 0P refers to the reference line plate, a refers to the number of reference distance measurement points, a: 1, 2, 3...n; the reference line plate is set with three groups of reference distance measurement points set as C 0Pa , respectively C 0P1 , C 0P2 and C 0P3 , C 0P1 Located in A 0P11 Directly below, C 0P2 Located in A 0P18 Directly above, C 0P3 Located in A 0P31 Directly below, the reference distance measurement point C 0Pa With adjacent benchmark line point A 0PMN The spacing between them is set to L AC ; Step C1.3.2.2 Setting the distance measurement point of the line board; The distance measurement point on the line board is set as C 1Pa , 1P refers to the line board, a refers to the number of ranging points, a: 1, 2, 3...n; the line board is set with three groups of ranging points set as C 1Pa , respectively C 1P1 , C 1P2 and C 1P3 , C 1P1 Located in A 1P11 Directly below, C 1P2 Located in A 1P18 Directly above, C 1P3 Located in A 1P31 Directly below, the distance measurement point C 1Pa With the adjacent line point A 1PMN The spacing between AC , C 0Pa With C 1Pa The quantity and position correspond one to one; Step C1.3.2.3: Position the distance measuring sensor to detect the offset of the line board in the Z direction; The positioning distance sensor detects the reference distance fixed point C on the reference line plate 0Pa And the distance measurement point C on the line board 1Pa The Z offset value Z Pa , Z P1 C 1P1 Relative C 0P1 The offset value in the Z direction, Z P2 C 1P2 Relative C 0P2 The offset value in the Z direction, Z P3 C 1P3 Relative C 0P3 Offset value in the Z direction; Step C1.3.2.4: Get the line board take-off point A 1P11 The coordinates [X 1P11 , Y 1P11 , Z 1P11 ]; X 1P11 =X 1P -L XAB +L AB ×cos(θ AB +θ 1P ); Y 1P11 =Y 1P -L YAB +L AB ×sin(θ AB +θ 1P ); WITH 1P11 =(From P2 -WITH P1 ) / (17×L YAA +2×L AC )×L AC +Z P1 ; Step C1.3.2.5: Get the arbitrary line-taking point A in the first column of the line board 1P1N The coordinates [X 1P1N , Y 1P1N , Z 1P1N ]; X 1P1N =X 1P11 -(N-1)×L YAB ×sinθ 1P ; AND 1P1N =And 1P11 +(N-1)×L YAB ×cosθ 1P ; Z 1P1N =(Z P2 -Z P1 ) / (17×L YAA +2×L AC )×(L AC +(N-1)×L YAA )+ Z P1 ; Step C1.3.2.6: Get any line-taking point A on the line board 1PMN The coordinates [X 1PMN , Y 1PMN , Z 1PMN ]; X 1PMN =X 1P11 +(M-1)×L XAA ×cosθ 1P -(N-1)×L YAA ×sinθ 1P ; AND 1PMN =And 1P11 +(M-1)×L XAA ×sinθ 1P +(N-1)×L YAA ×cosθ 1P ; Z 1PMN =(Z P2 -Z P1 ) / (17×L YAA +2×L AC )×(L AC +(N-1)×L YAA )+ From P3 -Z P1 )×(M-1) / 2+Z P1 ; Step B8: judging the number of holes in the wire board; Step B9: The control system sends the coordinates of the current wire taking point to the wire taking arm; the wire taking arm controls the wire taking component to take the wire from the wire taking point to complete the wire taking and pulling operations; Step B10: the wire taking arm controls the wire taking assembly to cut, strip and twist the signal transmission line through the wire preprocessing mechanism; Step B11: the wire taking arm controls the wire taking assembly to transfer the wire to the welding assembly; the welding assembly moves the wire to the welding point coordinates to complete the wire welding operation; Step B12: Accumulate the number of holes in the wire board and determine whether the number of holes in the wire board has been completed. If so, execute step B13; if not, execute step B8; Step B13: Accumulate the line board sequence to determine whether the line board sequence has been completed. If so, execute step B14; if not, execute step B6; Step B14: The line board sequence of the destination station is completed, the line taking arm and the wire welding arm are shut down, and the system is powered off; Step B15: Determine whether the welding sequence is completed, if yes, execute step B16, if no, execute step B3; Step B16: The control system controls the AGV to run to the standby station, and the multi-cabinet welding program is completed.
2. The method for using the automatic welding equipment for signal transmission lines according to claim 1, characterized in that: The automatic welding equipment startup preparation in step B2 includes the following steps: Step B2.1: PC sends welding sequence execution list to the control system; Step B2.2: Start the AGV and confirm that the AGV communication is normal; Step B2.3: The control system controls the AGV to run to the standby station; Step B2.4: The control system reads the incoming sequence execution list.
3. The method for using the automatic welding equipment for signal transmission lines according to claim 1, characterized in that: The wire taking device comprises a wire taking assembly, a wire taking transverse movement assembly and a wire taking longitudinal movement assembly. The wire taking longitudinal movement assembly is fixed on the base in the vertical direction. The wire taking longitudinal movement assembly comprises a wire taking longitudinal movement drag chain. One end of the wire taking longitudinal movement drag chain is fixed, and the other end is connected to the wire taking longitudinal movement slider on the wire taking longitudinal movement assembly. The wire taking longitudinal movement assembly drives the wire taking longitudinal movement slider to move and then drives the wire taking longitudinal movement drag chain to move in the vertical direction. The wire taking longitudinal movement drag chain can not only protect the pipeline, but also limit the moving range of the wire taking device. The wire taking transverse movement assembly comprises a wire taking transverse movement drag chain. One end of the wire taking transverse movement drag chain is fixed to the wire taking transverse movement assembly, and the other end is connected to the wire taking transverse movement slider on the wire taking transverse movement assembly. The wire taking transverse movement assembly drives the wire taking transverse movement slider to move, thereby driving the wire taking transverse movement chain to move in the horizontal direction. The wire taking transverse movement chain can not only protect the pipeline, but also limit the moving range of the wire taking device. The wire taking transverse movement slider is fixedly connected to the wire taking arm. The joint action of the wire taking transverse movement assembly and the wire taking longitudinal movement assembly controls the position movement of the wire taking arm in space. The wire taking arm is composed of multiple arms connected to each other, with a built-in cylinder group, which moves within the space range. One end of the wire taking arm is fixedly connected to the wire taking transverse movement slider, and the other end is fixedly connected to the wire taking assembly. The wire taking arm drives the wire taking assembly to move within the space range, and controls the position adjustment in a small range.
4. The method for using the automatic welding equipment for signal transmission lines according to claim 3 is characterized in that: The wire taking assembly comprises a wire taking fixing plate, on which a wire taking connecting plate for being fixedly connected to a wire taking arm, a first wire taking mechanism and a second wire taking mechanism are fixedly arranged, the first wire taking mechanism comprises a first wire taking cylinder, a wire taking plate 1 and a wire taking plate 2, the first wire taking cylinder is respectively connected to the wire taking plate 1 and the wire taking plate 2, and controls the wire taking plate 1 and the wire taking plate 2 to move synchronously relative to or opposite to each other to perform wire taking and wire releasing operations, the wire taking plate 1 and the wire taking plate 2 have the same structure and are symmetrically distributed, the wire taking plate 1 comprises a first wire taking cylinder, a wire taking plate 1 and a wire taking plate 2 A first plate, a second plate and a third plate, the first plate, the second plate and the third plate are fixedly connected in sequence to form a Z-shaped structure, the first plate is connected to the first wire taking cylinder, the opposite surfaces of the third plate of the wire taking plate one and the wire taking plate two are respectively fixed with a wire taking groove one and a wire taking groove two, the wire taking groove one and the wire taking groove two are semicircular structures, the first wire taking cylinder controls the synchronous relative movement of the wire taking plate one and the wire taking plate two, so that the wire taking plate one and the wire taking plate two touch each other, and the signal transmission line is confined in the wire taking groove formed by the wire taking groove one and the wire taking groove two.
5. The method for using the automatic welding equipment for signal transmission lines according to claim 4 is characterized in that: The second wire taking mechanism includes a second wire taking cylinder, a wire taking plate three and a wire taking plate four. The second wire taking cylinder is connected to the wire taking plate three and the wire taking plate four, respectively, and controls the wire taking plate three and the wire taking plate four to move synchronously relative to or opposite to each other to perform wire taking and wire releasing operations. The wire taking plate three and the wire taking plate four have the same structure and are symmetrically distributed. The wire taking plate three includes a fourth plate, a fifth plate and a sixth plate. The fourth plate, the fifth plate and the sixth plate are fixedly connected in sequence to form a Z-shaped structure. The fourth plate is connected to the second wire taking cylinder. The opposite surfaces of the sixth plate of the wire taking plate three and the wire taking plate four are fixedly provided with a wire taking groove three and a wire taking groove four, respectively. The wire taking groove three and the wire taking groove four are semicircular structures. The second wire taking cylinder controls the wire taking plate three and the wire taking plate four to move synchronously relative to each other, so that the wire taking plate three and the wire taking plate four touch each other, and the signal transmission line is confined in the wire taking groove formed by the wire taking groove three and the wire taking groove four to perform wire taking operations.
6. The method for using the automatic welding equipment for signal transmission lines according to claim 1, characterized in that: The wire pretreatment device comprises a wire pretreatment mechanism, a wire pretreatment transverse movement component and a wire pretreatment longitudinal movement component. The wire pretreatment longitudinal movement component is fixed on the base in the vertical direction. The wire pretreatment longitudinal movement component comprises a wire pretreatment longitudinal movement chain. One end of the wire pretreatment longitudinal movement chain is fixed, and the other end is connected to the wire pretreatment longitudinal movement slider on the wire pretreatment longitudinal movement component. The wire pretreatment longitudinal movement component drives the wire pretreatment longitudinal movement chain to move in the vertical direction by driving the wire pretreatment longitudinal movement slider. The wire pretreatment longitudinal movement chain can not only protect the pipeline, but also limit the movement range of the wire pretreatment device. The wire pretreatment mechanism at least comprises The wire twisting assembly, wire cutting assembly, wire stripping assembly, wire transmission assembly, wire tightening detection assembly and wire preprocessing platform are installed on the online preprocessing platform. The wire preprocessing platform is connected to the wire preprocessing transverse movement assembly. The wire transmission assembly moves relative to the wire twisting assembly, wire cutting assembly and wire stripping assembly. The wire transmission assembly is docked with the wire twisting assembly, and the wire transmission assembly is docked with the wire cutting assembly and wire stripping assembly. The wire preprocessing device performs wire cutting, wire stripping, wire twisting and detection operations on the signal transmission line through the wire twisting assembly, wire cutting assembly, wire stripping assembly, wire transmission assembly and wire tightening detection assembly.
7. The method for using the automatic welding equipment for signal transmission lines according to claim 1, characterized in that: The welding device includes a welding assembly, a welding transverse movement assembly and a welding longitudinal movement assembly. The welding longitudinal movement assembly is fixed on the base in the vertical direction. The welding longitudinal movement assembly adopts a screw drive. The welding longitudinal movement assembly includes a welding longitudinal movement drag chain. One end of the welding longitudinal movement drag chain is fixed, and the other end is connected to the welding longitudinal movement slider on the welding longitudinal movement assembly. The welding longitudinal movement assembly drives the welding longitudinal movement slider to move and then drives the welding longitudinal movement drag chain to move in the vertical direction. The welding longitudinal movement drag chain can not only protect the pipeline, but also limit the moving range of the welding device. The welding transverse movement assembly includes a welding transverse movement drag chain. One end of the welding transverse movement drag chain is fixed to the welding transverse movement assembly, and the other end is connected to the welding transverse movement slider on the welding transverse movement assembly. The welding transverse movement assembly drives the welding transverse movement slider to move and then drives the welding transverse movement drag chain to move in the horizontal direction. The welding transverse movement drag chain can not only protect the pipeline, but also limit the moving range of the welding device. The welding transverse movement slider is fixedly connected to the welding arm.
8. The method for using the automatic welding equipment for signal transmission lines according to claim 7, characterized in that: The welding arm is composed of multiple arms connected to each other, with a built-in cylinder group, which moves within a spatial range. One end of the welding arm is fixedly connected to the welding transverse sliding slider, and the other end is fixedly connected to the welding assembly. The welding arm drives the welding assembly to move within the spatial range and controls the position adjustment in a small range. The welding assembly includes a welding fixing mechanism, a welding mechanism, a welding conveying mechanism and a welding clamping mechanism. The welding mechanism and the welding conveying mechanism are respectively fixed on the welding fixing mechanism. The welding conveying mechanism receives the finished wire conveyed by the wire taking device and moves the finished wire to the welding position. The welding mechanism welds the signal transmission line. The welding fixing mechanism includes a welding fixing plate One and welding fixing plate two, welding fixing plate one and welding fixing plate two are vertically connected, welding fixing plate two is fixedly provided with a welding connecting plate for being fixedly connected to the welding arm, the welding mechanism is fixedly provided on welding fixing plate one through the welding plate, the welding mechanism comprises a welding part, a welding part fixing plate, a pressure welding motor and a welding part connecting plate, the pressure welding motor is fixed on the welding plate and connected to the welding part connecting plate, the pressure welding motor can drive the welding part connecting plate to move, the welding part fixing plate is fixed on the welding part connecting plate, the welding part is installed on the welding part connecting plate, the pressure welding motor can control the movement of the welding part fixing plate through the welding part connecting plate, adjust the position of the welding part, and flatten the penetrated line.
