A large-scale component automatic docking parallel mechanism device and guiding method
By adopting an automated docking device combined with dual parallel robots and laser trackers in the aerospace industry, the problems of low docking efficiency and poor accuracy of large components are solved, and an efficient and accurate docking process is achieved to meet the high-precision docking requirements of large components. .
Patent Information
- Application Number
- CN202211578787.0
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-12-07
- Publication Date
- 2024-11-26
- Estimated Expiration
- 2042-12-07
AI Technical Summary
The existing technology has low automation docking efficiency, poor quality consistency of large components in the aerospace industry, and the control system of parallel robots cannot guarantee high-precision docking.
Design a large-scale component automated docking and parallel mechanism device, adopting a guide control method combined with two six-degree of freedom parallel robots and laser trackers, and accurately measure and convert the coordinate system of the butt surface through the coordinate system positioning plate and the annular clamping table. Dynamic adjustment is performed using target ball positioning and laser tracker to achieve segmented error correction in the docking process.
It improves the efficiency and accuracy of the docking system, reduces the long-distance operation error of the six-degree of freedom parallel robot, and meets the high-precision docking requirements of large components.
Smart Images

Figure CN115771017B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of robot automation, and in particular to a parallel mechanism device and a guiding method capable of realizing automatic docking of large workpieces. Technical Background
[0002] With the rapid development of robotics technology, industrial robots have been widely used in various industries. According to the structure of industrial robots, they are mainly divided into three main types: series, parallel and hybrid. Among them, parallel robots have advantages over series robots such as high rigidity and high load, and are gradually widely used in high-end manufacturing and other fields. With the continuous and rapid development of industries such as aerospace, the original manual production method no longer meets the current production efficiency requirements. In the aerospace industry, the automated docking of large components is one of the key issues that need to be solved urgently.
[0003] At present, the automated docking of large components mainly relies on manual guidance. This method has problems such as low docking efficiency, poor docking accuracy and quality consistency. Using robots to build a flexible assembly system is the main way to solve this problem. The current flexible assembly system mainly uses serial industrial robots. The accuracy of this type of robot cannot meet the needs of high-precision assembly, especially for the "silk" level accuracy requirements. Secondly, the end of the serial industrial robot is only about 500kg, which cannot meet the requirements for the assembly of some large components. The parallel robot can meet the requirements of large load and high precision, but because the control system of the current industrial robot is a semi-closed loop control structure, the accuracy of the system during the docking process cannot be guaranteed. At present, there is a flexible assembly system based on visual guidance, but the measurement accuracy of the visual measurement system cannot meet the high-precision requirements. Moreover, if the visual measurement system is to achieve high-precision measurement, it is often installed on large components, which will affect the docking process. In addition, the current robot docking platform mainly uses one robot device to carry large components, and the other large component is fixed. Since only one robot realizes the docking movement, the working efficiency of this docking method is relatively low. In summary, there is an urgent need to invent and design a high-efficiency large-scale automated docking device system and a high-precision docking guidance method. Summary of the invention
[0004] The technical problem to be solved by the present invention is to overcome the problems of low efficiency, poor docking accuracy and quality consistency in the manual docking technology of the prior art in aviation cabins, and to provide a parallel mechanism device that can realize the automatic docking of large components. The device meets the requirements of large load and high-precision docking accuracy, and at the same time combines with the laser tracker, a high-precision measuring device, to realize the guidance and control of the dual parallel mechanism device.
[0005] The large-scale component automated docking parallel mechanism device of the present invention comprises a left six-degree-of-freedom parallel robot, a right six-degree-of-freedom parallel robot, a laser tracker, and a plurality of coordinate system positioning plates, wherein the laser tracker is installed between the two parallel robots, and each six-degree-of-freedom parallel robot is installed with a coordinate system positioning plate;
[0006] The two six-degree-of-freedom parallel robots clamp large components through a ring-shaped clamping table, and the two large components are components to be docked;
[0007] Each coordinate system positioning plate is located within the field of view of the laser tracker.
[0008] Furthermore, the device includes a first coordinate system positioning plate, a second coordinate system positioning plate, a third coordinate system positioning plate and a fourth coordinate system positioning plate, and two coordinate system positioning plates are installed on each six-degree-of-freedom parallel robot; it also includes a left-side annular clamping table and a right-side annular clamping table; a first large component with a positioning hole is placed on the left-side six-degree-of-freedom parallel robot, and a second large component with a positioning pin is placed on the right-side six-degree-of-freedom parallel robot.
[0009] Furthermore, the lower planes of the left six-degree-of-freedom parallel robot and the right six-degree-of-freedom parallel robot are respectively fixed with a first coordinate system positioning plate and a second coordinate system positioning plate for realizing the measurement of the base coordinate system of the six-degree-of-freedom parallel robot; the left six-degree-of-freedom parallel robot and the right six-degree-of-freedom parallel robot are respectively installed with a left annular clamping table and a right annular clamping table, and the left annular clamping table and the right annular clamping table are respectively installed with a third coordinate system positioning plate and a fourth coordinate system positioning plate for realizing the posture measurement of large components.
[0010] Furthermore, each coordinate system positioning plate has the same structure, including a positioning adapter plate, three magnetic target ball bases, and a target ball is provided on each target ball base; wherein the positioning adapter plate is fixedly installed at each position to be detected, and the three magnetic target ball bases are distributed on the positioning adapter plate at an angle of 120 degrees, the orientation of each target ball can be adjusted, and each target ball is numbered in sequence.
[0011] The present application also provides an automated docking guidance method for the above-mentioned large-scale component, the guidance method comprising:
[0012] S1, determining the position of the coordinate system of each positioning plate in the field of view of the laser tracker;
[0013] S2, docking large components, first determine the conversion relationship between the two six-degree-of-freedom parallel robots, and then determine the conversion relationship between the two docking surface coordinate systems by using target ball positioning according to the position of the coordinate system of each positioning plate in the field of view of the laser tracker;
[0014] S3, during the docking process, the motion trajectories of the left six-degree-of-freedom parallel robot and the right six-degree-of-freedom parallel robot are continuously corrected.
[0015] Furthermore, the S1 is:
[0016] S11, measure the first, second, and third target balls in sequence in the laser tracker measurement coordinate system {L}O L -xyz spatial positions are denoted as p1, p2, and p3 respectively;
[0017] S12, taking point p1 as the origin of the coordinate system of the first coordinate system positioning plate, taking the unit vector n of the line direction between points p1 and p2 as the X-axis direction, and taking the unit vector a of the plane normal vector formed by points p1, p2, and p3 as the Z-axis direction;
[0018] S13, based on the above information, the coordinate system of the first coordinate system positioning plate {F1} is obtained in the laser tracker measurement coordinate system {L} L The pose matrix H under -xyz is as follows:
[0019]
[0020] S14, repeat steps S11 to S13 to obtain the pose matrices {F2}, {F3}, {F4} of the coordinate systems of the second, third, and fourth coordinate system positioning plates in the laser tracker measurement coordinate system {L}OL-xyz.
[0021] Further, the S2 is:
[0022] S21, installing the laser tracker, the left six-degree-of-freedom parallel robot, the right six-degree-of-freedom parallel robot, the first large component with positioning holes, the second large component with positioning pins, the first annular clamping table, and the second annular clamping table according to the positional relationship described in claim 1;
[0023] S22, fixing the first to fourth coordinate system positioning plates on the lower platforms of the left six-degree-of-freedom parallel robot and the right six-degree-of-freedom parallel robot and two annular clamping tables respectively, to ensure that the target ball is within the tracking and positioning range of the laser tracker;
[0024] S23, with the laser tracker measuring coordinate system {L}O L –xyz is used as a reference, and the base coordinate system of the left six-DOF parallel robot is defined as {M}O M –xyz, the base coordinate system of the six-DOF parallel robot on the right is {N}O M –xyz, the two coordinate systems measured by the first coordinate system positioning plate and the second coordinate system positioning plate are {F1} and {F2} respectively, and the coordinate system {M}O M–xyz and {F1}, coordinate system {N}O M – The conversion relationship between xyz and {F2} is known. After the positions of {F1} and {F2} are measured, the base coordinate system conversion relationship between the left six-degree-of-freedom parallel robot and the right six-degree-of-freedom parallel robot is obtained;
[0025] S24, with the laser tracker measuring coordinate system {L}O L –xyz is used as a reference, and the coordinate system of the ring clamping table on the left six-DOF parallel robot is defined as {D}O D -xyz, the coordinate system of the ring clamping table of the six-degree-of-freedom parallel robot on the right is {E}O E –xyz; the two coordinate systems measured by the third coordinate system positioning plate and the third coordinate system positioning plate are {F3} and {F4} respectively;
[0026] S25, the coordinate system of the joint surface of the first large component with positioning holes {D1}O D1 –xyz, coordinate system of the second large component with locating pins {E1}O E1 –xyz coordinate directions in the reference coordinate system are consistent with the reference coordinate system. The target ball is placed in a fixed position on the docking surface to determine the docking surface coordinate system {D1}O of the first large component with the positioning hole. D1 –xyz and {D}O D –xyz, coordinate system of the second large component with locating pins {E1}O E1 –xyz and {E}O E –Conversion relationship between xyz;
[0027] S26, and the coordinate system {D}O D –xyz and {F3}, coordinate system {E}O E – The conversion relationship between xyz and {F4} is known, and the conversion relationship between the first large component with the positioning hole and the second large component with the positioning pin is obtained according to the positions of {F3} and {F4};
[0028] S27, obtaining the docking surface coordinate system {D1} of the first large-scale component with the positioning hole through steps S21 to S26. D1 –xyz and the base coordinate system {M}O of the left six-DOF parallel robot M –xyz conversion relationship, the second large component with locating pins docking surface coordinate system {E1}O E1 –xyz and the base coordinate system of the right six-DOF parallel robot {N}O M –The conversion relationship between xyz.
[0029] Further, the S3 is:
[0030] S31, expressing the end positions of the left six-degree-of-freedom parallel robot and the right six-degree-of-freedom parallel robot and the joint surface positions of the first large component with the locating hole and the second large component with the locating pin in the coordinate system {L}O L –xyz;
[0031] S32, selecting the midpoint of the line connecting the origins of the coordinate systems of the two docking surfaces as the final docking position, the posture matrices are all unit matrices, the left six-degree-of-freedom parallel robot and the right six-degree-of-freedom parallel robot move simultaneously, and the docking process is measured in sections;
[0032] S33, controlling the left six-degree-of-freedom parallel robot and the right six-degree-of-freedom parallel robot to move according to the above data, so as to change the relative posture of the first large component with the positioning hole and the second large component with the positioning pin;
[0033] S34, after the left six-degree-of-freedom parallel robot and the right six-degree-of-freedom parallel robot complete each stage of movement, re-measure the relative position and posture of the {F3} and {F4} coordinate systems, and convert the relative position and posture into the docking surface coordinate system of the first large component with the positioning hole {D1}O D1 –xyz, coordinate system of the second large component with locating pins {E1}O E1 –xyz relative pose.
[0034] The present invention has the following beneficial effects: 1. Utilizing two six-degree-of-freedom parallel robots for automated docking, the docking efficiency of the docking system is improved; 2. The segmented docking process not only realizes process error correction, but also reduces the long-distance operation accuracy of the six-degree-of-freedom parallel robot. BRIEF DESCRIPTION OF THE DRAWINGS
[0035] Figure 1 It is a schematic diagram of the docking device system structure of the present invention;
[0036] Figure 2 It is a schematic structural diagram of a six-degree-of-freedom parallel robot of the present invention;
[0037] Figure 3 It is a schematic diagram of the structure of the coordinate system positioning plate of the present invention;
[0038] Figure 4 It is a schematic diagram of the coordinate system definition of the coordinate system positioning plate of the present invention;
[0039] Figure 5 It is a schematic diagram of the structure of the annular clamping table of the present invention;
[0040] Figure 6 It is a schematic diagram of the coordinate system of the docking surfaces of the large-scale components to be docked according to the present invention. DETAILED DESCRIPTION
[0041] The present invention will be further described in detail below in conjunction with the accompanying drawings and embodiments.
[0042] Example 1
[0043] See also Figure 1 As shown, the parallel mechanism device and system for realizing automatic docking of large components of the present invention mainly comprises a left six-degree-of-freedom parallel robot 2, a right six-degree-of-freedom parallel robot 3, a laser tracker 1, and a plurality of coordinate system positioning plates. In this embodiment, the positioning plates are a first positioning plate 9, a second positioning plate 10, a third positioning plate 11, a fourth positioning plate 12, and a left annular clamping table 6 and a right annular clamping table 7. A first large component 4 with a positioning hole is placed on the left six-degree-of-freedom parallel robot 2, and a second large component 5 with a positioning pin is placed on the right six-degree-of-freedom parallel robot 3.
[0044] The laser tracker 1 is placed on the side of the left six-degree-of-freedom parallel robot 2 and the right six-degree-of-freedom parallel robot 3, and the left six-degree-of-freedom parallel robot 2 and the right six-degree-of-freedom parallel robot 3 are placed on the left and right sides of the laser tracker 1, respectively. A coordinate system positioning plate is fixed to the lower plane of the left six-degree-of-freedom parallel robot 2 and the right six-degree-of-freedom parallel robot 3, respectively, which are the second coordinate system positioning plate 10 and the first coordinate system positioning plate 9, which are mainly used to realize the measurement of the base coordinate system of the six-degree-of-freedom parallel robot:
[0045] There are three target balls on the calibration board. The laser tracker measures the positions of the three target balls. The plane can be determined through three points. At the same time, the origin and coordinate system are determined according to the order of the target balls, and the coordinate system of the coordinate system positioning plate can be calculated. The installation position of the coordinate system positioning plate and the conversion relationship between the base coordinate system of the robot can be obtained according to the design drawings. Therefore, the measurement of the base coordinate system of the six-degree-of-freedom parallel robot, that is, the pose matrix of the base coordinate system, can be realized.
[0046] The fourth coordinate system positioning plate 12 is fixedly installed on the side of the left annular clamping table 6, which is mainly used to realize the posture measurement of the first large component 4 with positioning holes, so as to ensure the trajectory guidance and docking accuracy of the automated docking process. The first large component 4 with positioning holes is fixed on the left six-degree-of-freedom parallel robot 2 through the left annular clamping table 6. Since the first large component 4 with positioning holes and the second large component 5 with positioning pins are rigidly connected to the left annular clamping table 6 and the right annular clamping table 7, as long as the posture conversion relationship between the two is determined, the coordinate system positioning plates 12 and 11 on the two annular clamping tables can be used to measure the posture of the large components. According to the relative posture error of the large components, the movement of the left six-degree-of-freedom parallel robot 2 and the right six-degree-of-freedom parallel robot 3 is controlled.
[0047] During the docking process, since the laser tracker 1 cannot track the change status of each coordinate system in real time, the segmented guidance of the docking process is realized by writing a control program for the laser tracker 1. In addition, in this system, since the left six-degree-of-freedom parallel robot 2 and the right six-degree-of-freedom parallel robot 3 are guided to move at the same time, the docking efficiency of large components will be effectively improved.
[0048] See also Figure 2 As shown, the structures of the left six-degree-of-freedom parallel robot 2 and the right six-degree-of-freedom parallel robot 3 are the same. Taking the left six-degree-of-freedom parallel robot 2 as an example, it mainly includes an upper platform 201, a lower platform 202 and six support rods, namely a first support rod 203, a second support rod 204, a third support rod 205, a fourth support rod 206, a fifth support rod 207, and a sixth support rod 208.
[0049] See also Figure 3 As shown, taking the first coordinate system calibration plate 9 as an example, the first coordinate system positioning plate 9 mainly includes a positioning adapter plate 301, three magnetic target ball bases: a first magnetic target ball base 305, a second magnetic target ball base 306, a third magnetic target ball base 307, and three target balls: a first target ball 302, a second target ball 303, and a third target ball 304. The positioning adapter plate 301 can be fixedly installed at each position to be detected by screws. The three magnetic target ball bases are distributed on the positioning adapter plate 301 at an angle interval of 120 degrees, and the three target balls are respectively fixed in the three magnetic target ball bases by magnetic adsorption. In this embodiment, the orientation of each target ball can be freely adjusted, so as to ensure that the coordinate system positioning plate can be measured by the laser tracker 1 no matter how it is placed, and the first target ball 302, the second target ball 303, and the third target ball 304 are distinguished by red, green and blue colors.
[0050] like Figure 5 As shown in the figure, it is a schematic diagram of the structure of the annular clamping platform of the present invention, the annular clamping platform comprises two annular clamping hoops and a mounting table 703, each annular clamping hoop comprises two half hoops, namely the first half hoop 701, the second half hoop 702, the third half hoop 704, and the fourth half hoop 705 in the figure, wherein the two half hoops are mounted on the mounting table, and a coordinate system positioning plate is mounted on one of the annular clamping hoops; as shown in the figure, Figure 6 As shown, it is a schematic diagram of the coordinate system of the docking surface of the large components to be docked; at least three positioning holes are provided on the side wall of the first large component 4, namely the first to third positioning holes 401, 402, and 403, and the docking of large components is achieved based on the above structure.
[0051] Example 2
[0052] See also Figure 4As shown, the method for measuring the position and posture of the coordinate system positioning plate 9 during the docking process is as follows:
[0053] (1) Measure the coordinates of the first, second, and third target balls in a fixed order, for example, red, green, and blue, using the laser tracker 1 to measure the coordinates of the three target balls in the laser tracker 1 measurement coordinate system {L}O L -xyz spatial positions are denoted as p1, p2, and p3 respectively;
[0054] (2) Point p1 is used as the origin of the coordinate system of the coordinate system positioning plate 9, and the unit vector n in the direction of the line connecting points p1 and p2 is used as the X-axis direction. The unit vector a of the plane normal vector formed by p1, p2, and p3 is used as the Z-axis direction, and the unit direction vector o of the Y-axis is calculated by the cross product of the vectors of the X-axis and the Y-axis.
[0055] (3) Based on the above information, the coordinate system {F} of the first coordinate system positioning plate 9 can be obtained in the measurement coordinate system {L} of the laser tracker 1. L The pose matrix H under -xyz is as follows:
[0056]
[0057] See also Figure 1 As shown in the figure, the coordinate system conversion method during the docking process is as follows:
[0058] (1) Place the laser tracker 1 on the sides of the left six-degree-of-freedom parallel robot 2 and the right six-degree-of-freedom parallel robot 3, and fix the first large component 4 with positioning holes and the second large component 5 with positioning pins on the upper platforms of the left six-degree-of-freedom parallel robot 2 and the right six-degree-of-freedom parallel robot 3 through the first annular clamping table 6 and the second annular clamping table 7.
[0059] (2) The first to fourth coordinate system positioning plates are fixedly mounted on the lower platforms and two annular clamping tables of the left six-degree-of-freedom parallel robot 2 and the right six-degree-of-freedom parallel robot 3, respectively, to ensure that the target ball is within the tracking and positioning range of the laser tracker 1;
[0060] (3) Using the measurement coordinate system {L}O of the laser tracker 1 L –xyz as a reference, define the base coordinate system of the left six-DOF parallel robot 2 as {M}O M –xyz, the base coordinate system of the six-DOF parallel robot 3 on the right is {N}O M –xyz, and the two coordinate systems measured by the second coordinate system positioning plate 10 and the first coordinate system positioning plate 9 are {F1} and {F2}, respectively. F1 and F2 refer to the Cartesian coordinate system, which is defined by the positions of the three target balls. The pose expression of the coordinate system is expressed by the pose matrix H. Coordinate system {M}O M–xyz and {F1}, coordinate system {N}O M –The conversion relationship between xyz and {F2} is known. Therefore, after measuring the poses of {F1} and {F2}, the base coordinate system conversion relationship between the left six-degree-of-freedom parallel robot 2 and the right six-degree-of-freedom parallel robot 3 can be obtained. There are three target balls on the calibration plate. The laser tracker measures the positions of the three target balls. The plane can be determined by three points. At the same time, the origin and coordinate system are determined according to the sequence of the target balls, and the coordinate system of the coordinate system positioning plate can be calculated. The installation position of the coordinate system positioning plate and the conversion relationship between the base coordinate system of the robot can be obtained according to the design drawings. After measuring the poses of {F1} and {F2}, the base coordinate system pose of the robot can be calculated through the above conversion relationship. Since the base coordinate system pose matrices of the two robots are expressed in the measurement coordinate system of the laser tracker, the base coordinate system conversion of the six-degree-of-freedom parallel robot can be realized;
[0061] (4) Using the measurement coordinate system {L}O of the laser tracker 1 L –xyz is used as a reference, and the coordinate system of the ring clamping table 6 on the left six-DOF parallel robot 2 is defined as {D}O D -xyz, the coordinate system of the annular clamping table 7 of the right six-degree-of-freedom parallel robot 3 is {E}O E -xyz, and the two coordinate systems measured by the fourth coordinate system positioning plate 12 and the third coordinate system positioning plate 11 are {F3} and {F4} respectively. Since the first large component 4 with positioning holes and the second large component 5 with positioning pins are manually clamped, accurate positioning cannot be achieved. Therefore, it is necessary to determine the coordinate system {D1} of the docking surface of the first large component 4 with positioning holes. D1 –xyz and {D}O D –xyz, coordinate system of the joint surface of the second large component 5 with locating pins {E1}O E1 –xyz and {E}O E –xyz conversion relationship. The docking surface coordinate system {D1}O of the first large component 4 with positioning holes D1 –xyz, coordinate system of the joint surface of the second large component 5 with locating pins {E1}O E1 –xyz coordinate directions in the reference coordinate system are consistent with the reference coordinate system. By placing the target ball in a fixed position on the docking surface, the above conversion relationship can be calculated. D –xyz and {F3}, coordinate system {E}O E – The conversion relationship between xyz and {F4} is known. According to the position measurement method of the coordinate system positioning plate, the position of {F3} and {F4} can be calculated, and the conversion relationship between the first large component 4 with the positioning hole and the second large component 5 with the positioning pin can be obtained;
[0062] (5) Through the above steps, the docking surface coordinate system {D1} of the first large-scale component 4 with the positioning hole can also be obtained. D1 –xyz, coordinate system of the joint surface of the second large component 5 with locating pins {E1}O E1 –xyz and the base coordinate system of the left six-DOF parallel robot 2 are {M}O M –xyz, the base coordinate system of the six-DOF parallel robot 3 on the right is {N}O M –The conversion relationship between xyz.
[0063] The above steps determine the relative position relationship between each coordinate system in the docking system.
[0064] The above calculations are all based on the measurement coordinate system {L}O of the laser tracker 1 L –xyz is used as the reference coordinate system, and the end positions of the left six-degree-of-freedom parallel robot 2 and the right six-degree-of-freedom parallel robot 3, as well as the joint surface positions of the large component 4 with locating holes and the large component 5 with locating pins are expressed in the coordinate system {L}O L –xyz. Through the above coordinate system conversion, all defined coordinate systems can be converted into a unified coordinate system for expression, so that the position control of the two six-degree-of-freedom parallel robots can be expressed in a unified coordinate system, and the target posture of the six-degree-of-freedom parallel robot is defined at the same time. The control of the robot is to input the controller after the target posture is given to achieve motion control.
[0065] If the motion trajectory accuracy of the left six-degree-of-freedom parallel robot 2 and the right six-degree-of-freedom parallel robot 3 is not high, it is necessary to continuously correct the motion trajectory of the left six-degree-of-freedom parallel robot 2 and the right six-degree-of-freedom parallel robot 3 during the docking process. The correction method of the docking process is as follows:
[0066] (1) The midpoint of the line connecting the origins of the coordinate systems of the two docking surfaces is selected as the final docking position. The posture matrices are all unit matrices. The six-degree-of-freedom parallel robot 2 on the left and the six-degree-of-freedom parallel robot 3 on the right move simultaneously to improve the efficiency of the docking process. At the same time, in order to avoid docking errors, the docking process is measured in sections;
[0067] (2) According to step (5) of the coordinate system conversion method, the initial docking surface coordinate system {D1} of the large component 4 with positioning holes can be obtained. D1 –xyz, coordinate system of the joint surface of large component 5 with locating pins {E1}O E1 –xyz position in the reference coordinate system;
[0068] (3) According to the above data, the left six-degree-of-freedom parallel robot 2 and the right six-degree-of-freedom parallel robot 3 are controlled to move respectively, so as to change the relative posture of the large component 4 with the positioning hole and the large component 5 with the positioning pin;
[0069] (4) After the left six-degree-of-freedom parallel robot 2 and the right six-degree-of-freedom parallel robot 3 complete each stage of movement, the relative position errors of the {F3} and {F4} coordinate systems are remeasured and converted into the docking surface coordinate system {D1} of the large component 4 with positioning holes. D1 –xyz, coordinate system of the joint surface of large component 5 with locating pins {E1}O E1 –xyz relative pose.
[0070] (5) Finally, ensure the successful docking of the large component 4 with the positioning hole and the large component 5 with the positioning pin.
[0071] The present invention has the following beneficial effects: 1. Utilizing two six-degree-of-freedom parallel robots for automated docking, the docking efficiency of the docking system is improved; 2. The segmented docking process not only realizes process error correction, but also reduces the long-distance operation accuracy of the six-degree-of-freedom parallel robot.
[0072] The above is only a specific embodiment of the present invention, but the protection scope of the present invention is not limited thereto. A person skilled in the art can make several changes and adjustments within the technical scope disclosed by the present invention. Therefore, the protection scope of the present invention should be based on the protection scope of the claims.
Claims
1. A large-scale component automatic docking parallel mechanism device, characterized in that: The device comprises a left six-degree-of-freedom parallel robot, a right six-degree-of-freedom parallel robot, a laser tracker, and a plurality of coordinate system positioning plates, wherein the laser tracker is installed between the two parallel robots, and a coordinate system positioning plate is installed on each six-degree-of-freedom parallel robot; The two six-degree-of-freedom parallel robots clamp large components through a ring-shaped clamping table, and the two large components are components to be docked; Each coordinate system positioning plate is located within the field of view of the laser tracker; The device comprises a first coordinate system positioning plate, a second coordinate system positioning plate, a third coordinate system positioning plate and a fourth coordinate system positioning plate, and each six-degree-of-freedom parallel robot is equipped with two coordinate system positioning plates; it also comprises a left annular clamping table and a right annular clamping table; a first large component with a positioning hole is placed on the left six-degree-of-freedom parallel robot, and a second large component with a positioning pin is placed on the right six-degree-of-freedom parallel robot; The lower planes of the left six-degree-of-freedom parallel robot and the right six-degree-of-freedom parallel robot are respectively fixed with a first coordinate system positioning plate and a second coordinate system positioning plate, which are used to realize the measurement of the base coordinate system of the six-degree-of-freedom parallel robot; the left six-degree-of-freedom parallel robot and the right six-degree-of-freedom parallel robot are respectively installed with a left annular clamping table and a right annular clamping table, and the left annular clamping table and the right annular clamping table are respectively installed with a third coordinate system positioning plate and a fourth coordinate system positioning plate, which are used to realize the position and posture measurement of large components.
2. The large-scale component automatic docking parallel mechanism device according to claim 1 is characterized in that: Each coordinate system positioning plate has the same structure, including a positioning adapter plate, three magnetic target ball bases and a target ball on each target ball base; the positioning adapter plate is fixedly installed at each position to be detected, and the three magnetic target ball bases are distributed on the positioning adapter plate at an angle of 120 degrees. The direction of each target ball can be adjusted, and each target ball is numbered in sequence.
3. A large-scale component automated docking guidance method, characterized in that: The boot method comprises: S1, determining the position of the coordinate system of each positioning plate in the field of view of the laser tracker; S2, docking large components, first determine the conversion relationship between the two six-degree-of-freedom parallel robots, and then determine the conversion relationship between the two docking surface coordinate systems by using target ball positioning according to the position of the coordinate system of each positioning plate in the field of view of the laser tracker; S3, continuously correcting the motion trajectories of the left six-degree-of-freedom parallel robot and the right six-degree-of-freedom parallel robot during the docking process; The S1 is: S11, measure the first, second, and third target balls in sequence in the laser tracker measurement coordinate system {L}O L -xyz spatial positions are denoted as p1, p2, and p3 respectively; S12, taking point p1 as the origin of the coordinate system of the first coordinate system positioning plate, taking the unit vector n of the line direction between points p1 and p2 as the X-axis direction, and taking the unit vector a of the plane normal vector formed by points p1, p2, and p3 as the Z-axis direction; S13, based on the above information, the coordinate system of the first coordinate system positioning plate {F1} is obtained in the laser tracker measurement coordinate system {L} L The pose matrix H under -xyz is as follows: S14, repeating steps S11 to S13 to obtain the pose matrices {F2}, {F3}, {F4} of the coordinate systems of the second, third, and fourth coordinate system positioning plates in the laser tracker measurement coordinate system {L}OL-xyz; The S2 is: S21, installing the laser tracker, the left six-degree-of-freedom parallel robot, the right six-degree-of-freedom parallel robot, the first large component with positioning holes, the second large component with positioning pins, the first annular clamping table, and the second annular clamping table according to the positional relationship described in claim 1; S22, fixing the first to fourth coordinate system positioning plates on the lower platforms of the left six-degree-of-freedom parallel robot and the right six-degree-of-freedom parallel robot and two annular clamping tables respectively, to ensure that the target ball is within the tracking and positioning range of the laser tracker; S23, with the laser tracker measuring coordinate system {L}O L –xyz is used as a reference, and the base coordinate system of the left six-DOF parallel robot is defined as {M}O M –xyz, the base coordinate system of the six-DOF parallel robot on the right is {N}O M –xyz, the two coordinate systems measured by the first coordinate system positioning plate and the second coordinate system positioning plate are {F1} and {F2} respectively, and the coordinate system {M}O M –xyz and {F1}, coordinate system {N}O M – The conversion relationship between xyz and {F2} is known. After the positions of {F1} and {F2} are measured, the base coordinate system conversion relationship between the left six-degree-of-freedom parallel robot and the right six-degree-of-freedom parallel robot is obtained; S24, with the laser tracker measuring coordinate system {L}O L –xyz is used as a reference, and the coordinate system of the ring clamping table on the left six-DOF parallel robot is defined as {D}O D -xyz, the coordinate system of the ring clamping table of the six-degree-of-freedom parallel robot on the right is {E}O E –xyz; the two coordinate systems measured by the third coordinate system positioning plate and the third coordinate system positioning plate are {F3} and {F4} respectively; S25, the coordinate system of the joint surface of the first large component with positioning holes {D1}O D1 –xyz, coordinate system of the second large component with locating pins {E1}O E1 –xyz coordinate directions in the reference coordinate system are consistent with the reference coordinate system. The target ball is placed in a fixed position on the docking surface to determine the docking surface coordinate system {D1}O of the first large component with the positioning hole. D1 –xyz and {D}O D –xyz, coordinate system of the second large component with locating pins {E1}O E1 –xyz and {E}O E –Conversion relationship between xyz; S26, and the coordinate system {D}O D –xyz and {F3}, coordinate system {E}O E – The conversion relationship between xyz and {F4} is known, and the conversion relationship between the first large component with the positioning hole and the second large component with the positioning pin is obtained according to the positions of {F3} and {F4}; S27, obtaining the docking surface coordinate system {D1} of the first large-scale component with the positioning hole through steps S21 to S26. D1 –xyz and the base coordinate system {M}O of the left six-DOF parallel robot M –xyz conversion relationship, the second large component with locating pins docking surface coordinate system {E1}O E1 –xyz and the base coordinate system of the right six-DOF parallel robot {N}O M –The conversion relationship between xyz.
4. The large-scale component automated docking guidance method according to claim 3, characterized in that: The S3 is: S31, expressing the end positions of the left six-degree-of-freedom parallel robot and the right six-degree-of-freedom parallel robot and the joint surface positions of the first large component with the locating hole and the second large component with the locating pin in the coordinate system {L}O L –xyz; S32, selecting the midpoint of the line connecting the origins of the coordinate systems of the two docking surfaces as the final docking position, the posture matrices are all unit matrices, the left six-degree-of-freedom parallel robot and the right six-degree-of-freedom parallel robot move simultaneously, and the docking process is measured in sections; S33, controlling the left six-degree-of-freedom parallel robot and the right six-degree-of-freedom parallel robot to move according to the above data, so as to change the relative posture of the first large component with the positioning hole and the second large component with the positioning pin; S34, after the left six-degree-of-freedom parallel robot and the right six-degree-of-freedom parallel robot complete each stage of movement, re-measure the relative position and posture of the {F3} and {F4} coordinate systems, and convert the relative position and posture into the docking surface coordinate system of the first large component with the positioning hole {D1}O D1 –xyz, coordinate system of the second large component with locating pins {E1}O E1 –xyz relative pose.
