Mechanical arm high-precision vertical alignment method and device and electronic equipment

Through three-point multi-field measurement and quadratic algorithm, the problem of high-precision vertical alignment of the robotic arm in large workpiece assembly is solved, reducing the dependence on high-precision sensors and complex tooling fixtures, realizing high-precision automated assembly, and improving assembly efficiency and precision.

CN119077793APending Publication Date: 2024-12-06SHANGHAI ELECTRICAL AUTOMATION R&D INST
View PDF 0 Cites 1 Cited by

Patent Information

Application Number
CN202410925222.8
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-11
Publication Date
2024-12-06

AI Technical Summary

Technical Problem

In automated assembly of large components, in order to obtain high-precision vertical alignment effects, the robotic arms usually rely on high-precision sensors, resulting in high cost, complex assembly process, low efficiency and high difficulty.

Method used

By obtaining the three sets of reference points of the sensor carried on the robot arm on the workpiece plane, calculate the base vector of the coordinate axis, generate a new coordinate system, and perform inverse deconversion according to the rotation matrix, instructing the end of the robot arm to move to the workpiece plane and to communicate with each other with the workpiece plane. Vertical and concentric positions reduce dependence on high-precision sensors and the need for complex tooling fixtures.

Benefits of technology

It realizes high-precision automated assembly operations, simplifies assembly steps, improves assembly accuracy, reduces costs, and ensures automated production efficiency.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119077793A_ABST
    Figure CN119077793A_ABST
Patent Text Reader

Abstract

The invention relates to a mechanical arm high-precision vertical alignment method and device and electronic equipment. The method comprises the steps that three sets of reference points, on a workpiece plane, of a sensor carried on a mechanical arm are obtained; calculating three groups of base vectors of the coordinate axis based on the three groups of reference points, and generating a new coordinate system formed by the three groups of base vectors; the rotation matrix is refilled according to the definition of the rotation matrix and the projection conversion relation of all the row and column elements in the new coordinate system and the old coordinate system, and inverse solution conversion is conducted on the matrix to obtain the pose parameter of the mechanical arm angle; and the tail end of the mechanical arm is instructed to move to the position perpendicular to and concentric with the plane of the workpiece based on the pose parameters of the angle of the mechanical arm. According to the method, the dependence on a high-precision sensor is reduced through three-point multi-view measurement and a quadratic algorithm, and the cost is reduced, so that the high-precision automatic assembly operation is realized, the assembly steps are simplified, the assembly precision is improved, the assembly jamming is reduced, and the automatic production efficiency is ensured.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of vertical alignment of a robot arm, and in particular to a high-precision vertical alignment method, device and electronic equipment for a robot arm. Background Art

[0002] Regarding the automated assembly of large components, most domestic and foreign research focuses on the automated assembly of large aircraft, spacecraft, and launch vehicles. Large components have complex structures and huge sizes. Unlike the automated assembly of general industrial products, the assembly process is easily affected by uncertain factors such as actuator errors, large component assembly positioning errors, assembly parts processing errors, distributed cumulative errors, and environmental changes. As a result, large component assembly faces huge tolerance problems, which greatly increases the difficulty of assembly alignment. At present, in order to obtain high-precision vertical alignment effects in the assembly of large workpieces, robotic arms usually rely heavily on high-precision sensors, resulting in high costs. Complex and large tooling fixtures are required during the assembly process, and the assembly steps are complicated, the assembly efficiency is low, and the difficulty is high. Therefore, it needs to be improved. Summary of the invention

[0003] Based on this, it is necessary to provide a high-precision vertical alignment method, device and electronic equipment for a robotic arm in order to obtain high-precision vertical alignment effects in the assembly of large workpieces, which usually requires a high degree of reliance on high-precision sensors, resulting in high costs, the need for complex and large tooling and fixtures during the assembly process, complex assembly steps, low assembly efficiency and high difficulty.

[0004] The present invention provides a high-precision vertical alignment method for a robotic arm, comprising:

[0005] Acquire three sets of reference points of the sensor carried by the robot arm on the workpiece plane, wherein the reference points are three-dimensional coordinates based on the robot arm body coordinate system;

[0006] Based on the three sets of reference points, three sets of basis vectors of the coordinate axes are calculated, and a new coordinate system consisting of the three sets of basis vectors is generated;

[0007] Refill the rotation matrix according to the definition of the rotation matrix and the projection transformation relationship between each row and column element in the new and old coordinate systems, and perform inverse conversion on the matrix to obtain the position and posture parameters of the robot angle;

[0008] Based on the posture parameters of the robot arm angle, the end of the robot arm is instructed to move to a position that is perpendicular and concentric with the workpiece plane.

[0009] In one embodiment, the three groups of basis vectors of the coordinate axes are calculated based on the three groups of reference points, and a new coordinate system composed of the three groups of basis vectors is generated, including:

[0010] Take one of the reference points as the center point and radiate outward to build two sets of initial vectors A with the other two reference points. 1 and A 2 ;

[0011] Taking one set of vectors as the reference, orthogonalize the other set of vectors to determine two sets of mutually perpendicular vectors B. 1 and B 2 ;

[0012] Computation and Vector B 1 and B 2 Vector B perpendicular to the plane 3 ;

[0013] The vector B 1 , B 2 and B 3 Normalize to generate a coordinate system consisting of three standard unit vectors.

[0014] In one embodiment, one of the sets of vectors is used as a reference to orthogonalize another set of vectors, thereby determining two sets of mutually perpendicular vectors B 1 and B 2 ,include:

[0015] Take one of the vectors A 1 As a reference, vector A 2 Vector A 1 Project and get vector B 2 , the calculation formula is as follows:

[0016]

[0017] Or with one of the vectors A 2 As a reference, vector A 1 Vector A 2 Projection is performed to obtain vector B 1 , the calculation formula is as follows:

[0018]

[0019] In one embodiment, the calculation is related to the vector B 1 and B 2 Vector B perpendicular to the plane 3 ,include:

[0020] Calculate vector B 3 The modulus length is calculated as follows:

[0021] |B 3 |=|A 1 ×A 2 |;

[0022] Select vector B according to the set direction of the robot arm 3 direction.

[0023] In one embodiment, the vector B 1 , B 2 and B 3 Normalize and generate a coordinate system composed of three standard unit vectors. The calculation formula is as follows:

[0024]

[0025] In one embodiment, the rotation matrix is ​​refilled according to the rotation matrix definition and the projection transformation relationship between each row and column element in the new and old coordinate systems, and the calculation formula is as follows:

[0026]

[0027] Where n = E 1 , that is, n x =E 1.x , n y =E 1.y , n z =E 1.z ;

[0028] o=E 2 , that is o x =E 2.x , o y =E 2.y , o z =E 2.z ;

[0029] a=E 3 , that is, a x =E 3.x , a y =E 3.y , a z =E 3.z .

[0030] In one embodiment, the matrix is ​​inversely solved to obtain the posture parameters of the robot arm angle, and the calculation formula is as follows:

[0031]

[0032] Among them, (R, P, Y) are the posture parameters of the robot arm angle.

[0033] The present invention also provides a high-precision vertical alignment device for a mechanical arm, comprising:

[0034] An acquisition module is used to acquire three sets of reference points of the sensor carried by the robot arm on the workpiece plane, wherein the reference points are three-dimensional coordinates based on the coordinate system of the robot arm body;

[0035] A calculation module, used for calculating three groups of basis vectors of the coordinate axes based on the three groups of reference points, and generating a new coordinate system composed of the three groups of basis vectors;

[0036] The conversion module is used to refill the rotation matrix according to the definition of the rotation matrix and the projection transformation relationship between each row and column element in the new and old coordinate systems, and to perform inverse conversion on the matrix to obtain the position and posture parameters of the robot arm angle;

[0037] The command module is used to command the end of the robot arm to move to a position perpendicular to and concentric with the plane of the workpiece based on the posture parameters of the robot arm angle.

[0038] The present invention also provides an electronic device, comprising a memory and a processor, wherein the memory stores a computer program, and when the processor executes the computer program, the high-precision vertical alignment method of the robotic arm as described in any one of the above-mentioned methods is implemented.

[0039] The present invention also provides a computer-readable storage medium storing a computer program, wherein when the computer program is executed by a processor, the method for high-precision vertical alignment of a robotic arm as described in any one of the above is implemented.

[0040] The above-mentioned high-precision vertical alignment method, device and electronic equipment of the robotic arm reduce the dependence on high-precision sensors and reduce costs through three-point multi-field of view measurement and secondary algorithms, and reduce the need for complex and large tooling fixtures through the flexible form of the robotic arm carrying sensors. At the same time, the three-point multi-field of view measurement overcomes the problem of low measurement accuracy of a single field of view and inability to cover all workpieces. The data is finally restored to the angle posture parameters in the vertical alignment state of the robotic arm through measurement data and secondary conversion. This set of parameters can maximize the verticality and concentricity of the TCP at the end of the robotic arm and the plane of the workpiece, thereby realizing high-precision automated assembly operations, simplifying the assembly steps, improving assembly accuracy, reducing assembly jams, and ensuring automated production efficiency. BRIEF DESCRIPTION OF THE DRAWINGS

[0041] In order to more clearly illustrate the technical solutions in the present invention or the prior art, a brief introduction is given below to the drawings required for use in the embodiments or the description of the prior art. Obviously, the drawings described below are some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying any creative work.

[0042] Figure 1 A schematic diagram of a process flow of a high-precision vertical alignment method for a robotic arm in an embodiment;

[0043] Figure 2 is a schematic diagram of a calculation method flow of a coordinate system composed of three standard unit vectors in one embodiment;

[0044] Figure 3 A schematic diagram for selecting reference points in an embodiment;

[0045] Figure 4 is a vector B in one embodiment 3 Schematic diagram of the construction;

[0046] Figure 5 is a schematic diagram of vector normalization in one embodiment;

[0047] Figure 6 is a schematic diagram of a reconstructed rotation matrix in an embodiment;

[0048] Figure 7 A schematic diagram of an application of a high-precision vertical alignment method for a robotic arm in an embodiment;

[0049] Figure 8 It is a schematic diagram of the structure of a high-precision vertical alignment device for a robotic arm in one embodiment;

[0050] Fig. 9 The figure is a diagram showing the internal structure of an electronic device according to an embodiment. DETAILED DESCRIPTION

[0051] In order to make the purpose, technical solution and advantages of the embodiments of the present invention clearer, the technical solution in the embodiments of the present invention will be clearly and completely described below in conjunction with the drawings in the embodiments of the present invention. Obviously, the described embodiments are part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.

[0052] Regarding the automated assembly of large components, most domestic and foreign research has focused on the automated assembly of large aircraft, spacecraft, and launch vehicles. Large components have complex structures and huge sizes. Unlike the automated assembly of general industrial products, the assembly process is easily affected by uncertain factors such as actuator errors, large component assembly positioning errors, assembly part processing errors, distributed cumulative errors, and environmental changes. As a result, large component assembly faces huge tolerance problems, which greatly increases the difficulty of assembly alignment. And because of the huge size and complex structure of the assembly parts themselves, it is difficult to fully monitor the assembly status online during the assembly process. These problems are common problems faced in the automated assembly of large components. In order to obtain high-precision vertical alignment effects in the assembly of large workpieces, robotic arms usually have the following problems and shortcomings:

[0053] 1) Measure the target feature multiple times and average the measurement results. This method cannot eliminate the absolute error from the mechanism and also loses the working cycle.

[0054] 2) Improving the measurement accuracy of sensors has high technical costs and limited technical effects, and also creates additional constraints on features, reference objects, and light sources;

[0055] 3) The problem of insufficient electrical measurement accuracy is compensated by the end actuator of the robot arm with floating compensation, and tolerance compensation is performed by mechanical devices. However, the higher the assembly accuracy, the more limited the compensation range. In addition, increasing the difficulty of mechanical design and the complexity of mechanical structure will bring other derivative problems.

[0056] 4) Ensure the repeatable positioning accuracy of the workpiece through high-precision fixtures, which are applicable to small-sized workpieces, but generally difficult to apply to large-sized workpieces, with high mechanical difficulty and uncontrolled cumulative tolerances;

[0057] 5) The measurement accuracy under single field of view is inversely proportional to the FOV (Field of View) or field of view area and the size of the workpiece. The larger the workpiece, the worse the measurement positioning accuracy under single field of view.

[0058] 6) FANUC Robotics' iRVision has multiple field of view / multiple field of view functions, but in actual applications it cannot meet high-level process requirements, such as shaft hole pin assembly, bolt thread matching, etc.;

[0059] 7) Even if some robot manufacturers may have similar technologies, the source code is usually packaged, leaving only some debugging interfaces for engineers. It is impossible to port applications to other controller platforms, the usage environment is very limited, and the software and hardware are deeply bound.

[0060] In order to solve the above problems, the following Figure 1-Figure 9 The invention describes a high-precision vertical alignment method, device and electronic equipment for a robotic arm.

[0061] like Figure 1 As shown, in one embodiment, a high-precision vertical alignment method for a robot arm comprises the following steps:

[0062] Step S110, obtaining three groups of reference points of the sensor carried by the robot arm on the plane of the workpiece, wherein the reference points are three-dimensional coordinates based on the coordinate system of the robot arm body.

[0063] When selecting reference points, you need to ensure that the distance and angle between the three points are as large as possible, which will help improve the accuracy of vertical alignment. Figure 3 P 1 Point, P 2 Point and P 3Based on the idea of ​​three-point plane determination, by increasing the distance and angle between the detection points, the robot arm can be vertically aligned with high precision under the condition that the sensor measurement accuracy remains unchanged, so that the measurement accuracy is proportional to the workpiece size.

[0064] Step S120, based on the three groups of reference points, three groups of basis vectors of the coordinate axes are calculated, and a new coordinate system consisting of the three groups of basis vectors is generated.

[0065] Step S130, refilling the rotation matrix according to the definition of the rotation matrix and the projection transformation relationship between each row and column element in the new and old coordinate systems, and performing inverse conversion on the matrix to obtain the posture parameters of the robot arm angle.

[0066] The control accuracy is improved through three-point measurement and secondary algorithm. The technical cost is low, the effect is significantly improved, and the requirements for sensor performance indicators are reduced.

[0067] Step S140, based on the posture parameters of the robot arm angle, instruct the end of the robot arm to move to a position that is perpendicular and concentric with the workpiece plane.

[0068] The high-precision vertical alignment method of the robot arm reduces the design difficulty of the actuator at the end of the robot arm through algorithm improvement, improves mechanical stability and the success rate of automated implementation; there are no strict requirements for the placement and positioning of the workpiece, and there is no need to prepare high-precision tooling. By carrying sensors on the robot arm, the characteristics of the large moving range and high degree of freedom of the robot arm are fully utilized to achieve a high-freedom and high-flexibility production environment, and reduce the demand for complex and large tooling fixtures; in view of the difficulties of long tolerance chains and large tolerances during the assembly of large parts, by using sensors carried by the robot arm and utilizing the characteristics of the large moving range and high degree of freedom of the robot arm, the problem of low single-view measurement accuracy and inability to cover all workpieces is overcome through three-point multi-view measurement, and the angle posture parameters of the robot arm in the vertical alignment state are finally restored through measurement data and secondary conversion. This group of parameters can maximize the verticality and concentricity of the TCP at the end of the robot arm and the plane of the workpiece, thereby reducing the dependence on high-precision sensors, achieving high-precision automated assembly operations, and solving the problem of inaccurate vertical alignment of the robot arm in large workpieces; the algorithm of the present invention can be transplanted and applied in PLC, single-chip microcomputer or other host computer systems, and the application environment is more diverse, and is not subject to technical constraints of hardware brands.

[0069] like Figure 2 As shown, in one embodiment, based on three groups of reference points, three groups of basis vectors of the coordinate axes are calculated, and a new coordinate system composed of the three groups of basis vectors is generated, including:

[0070] Step S121, using one of the reference points as the center point, radiating outwards and coordinating with the other two reference points to construct two sets of initial vectors A 1 and A 2 , see Figure 3 c.

[0071] Step S122, taking one set of vectors as a reference, orthogonalize the other set of vectors, thereby determining two sets of mutually perpendicular vectors B 1 and B 2 .

[0072] Specific examples include:

[0073] Take one of the vectors A 1 As a reference, vector A 2 Vector A 1 Projection is performed to obtain vector B 2 , see Figure 3 d, calculated as follows:

[0074]

[0075] Or with one of the vectors A 2 As a reference, vector A 1 Vector A 2 Projection is performed to obtain vector B 1 , the calculation formula is as follows:

[0076]

[0077] Step S123, calculate and vector B 1 and B 2 Vector B perpendicular to the plane 3 , see Figure 4 .

[0078] Specific examples include:

[0079] Calculate vector B 3 The modulus length is calculated as follows:

[0080] |B 3 |=|A 1 ×A 2 |;

[0081] Select vector B according to the set direction of the robot arm 3 direction.

[0082] Step S124, vector B 1 , B 2 and B 3 Normalize to generate a coordinate system consisting of three standard unit vectors, see Figure 5 .

[0083] It should be noted that the calculation formula is as follows:

[0084]

[0085] Specifically, the rotation matrix is ​​refilled according to the definition of the rotation matrix and the projection transformation relationship between each row and column element in the new and old coordinate systems. The calculation formula is as follows:

[0086]

[0087] Where n = E 1 , that is, n x =E 1.x , n y =E 1.y , n z =E 1.z ;

[0088] o=E 2 , that is o x =E 2.x , o y =E 2.y , o z =E 2.z ;

[0089] a=E 3 , that is, a x =E 3.x , a y =E 3.y , a z =E 3.z .

[0090] See also Figure 6 , the rotation matrix is ​​a 3×3 matrix, which represents the rotation in three-dimensional space. Each column of the rotation matrix represents a unit vector on the rotation axis. Let X B , Y B , Z B They are the unit vectors of the three coordinate axes. There are three columns and nine numbers in the rotation matrix. The first column represents the vector component of the x-axis of the coordinate system {B} relative to the three axes of the coordinate system {A}, the second column represents the vector component of the y-axis of the coordinate system {B} relative to the three axes of the coordinate system {A}, and the third column represents the vector component of the z-axis of the coordinate system {B} relative to the three axes of the coordinate system {A}.

[0091] Specifically, the matrix is ​​inversely solved to obtain the position and posture parameters of the robot arm angle, see Figure 7 , the calculation formula is as follows:

[0092]

[0093] Among them, (R, P, Y) are the posture parameters of the robot arm angle.

[0094] The high-precision vertical alignment device for a robotic arm provided by the present invention is described below. The high-precision vertical alignment device for a robotic arm described below and the high-precision vertical alignment method for a robotic arm described above can be referenced to each other.

[0095] like Figure 8 As shown, in one embodiment, a high-precision vertical alignment device for a robotic arm includes an acquisition module 810 , a calculation module 820 , a conversion module 830 and an instruction module 840 .

[0096] The acquisition module 810 is used to acquire three groups of reference points of the sensor carried by the robot arm on the workpiece plane, and the reference points are three-dimensional coordinates based on the robot arm body coordinate system.

[0097] The calculation module 820 is used to calculate three groups of basis vectors of the coordinate axes based on the three groups of reference points, and generate a new coordinate system composed of the three groups of basis vectors.

[0098] The conversion module 830 is used to refill the rotation matrix according to the definition of the rotation matrix and the projection transformation relationship between each row and column element in the new and old coordinate systems, and to perform inverse conversion on the matrix to obtain the posture parameters of the robot arm angle.

[0099] The instruction module 840 is used to instruct the end of the robot arm to move to a position perpendicular to and concentric with the plane of the workpiece based on the posture parameters of the robot arm angle.

[0100] The calculation module 820 is specifically used for:

[0101] Take one of the reference points as the center point and radiate outward to build two sets of initial vectors A with the other two reference points. 1 and A 2 ;

[0102] Taking one set of vectors as the reference, orthogonalize the other set of vectors to determine two sets of mutually perpendicular vectors B. 1 and B 2 ;

[0103] Computation and Vector B 1 and B 2 Vector B perpendicular to the plane 3 ;

[0104] The vector B 1 , B 2 and B 3 Normalize to generate a coordinate system consisting of three standard unit vectors.

[0105] Fig. 9 An example of a physical structure diagram of an electronic device is shown. The electronic device may be a smart terminal, and its internal structure diagram may be as follows: Fig. 9As shown. The electronic device includes a processor, a memory and a network interface connected via a system bus. The processor of the electronic device is used to provide computing and control capabilities. The memory of the electronic device includes a non-volatile storage medium and an internal memory. The non-volatile storage medium stores an operating system and a computer program. The internal memory provides an environment for the operation of the operating system and the computer program in the non-volatile storage medium. The network interface of the electronic device is used to communicate with an external terminal via a network connection. When the computer program is executed by the processor, a high-precision vertical alignment method for a robotic arm is implemented, and the method includes:

[0106] Acquire three sets of reference points of the sensor carried by the robot arm on the workpiece plane, wherein the reference points are three-dimensional coordinates based on the robot arm body coordinate system;

[0107] Based on the three sets of reference points, three sets of basis vectors of the coordinate axes are calculated, and a new coordinate system consisting of the three sets of basis vectors is generated;

[0108] Refill the rotation matrix according to the definition of the rotation matrix and the projection transformation relationship between each row and column element in the new and old coordinate systems, and perform inverse conversion on the matrix to obtain the position and posture parameters of the robot angle;

[0109] Based on the posture parameters of the robot arm angle, the end of the robot arm is instructed to move to a position that is perpendicular and concentric with the workpiece plane.

[0110] Those skilled in the art will understand that Fig. 9 The structure shown in the figure is only a block diagram of a part of the structure related to the scheme of the present invention, and does not constitute a limitation on the electronic device to which the scheme of the present invention is applied. The specific electronic device may include more or fewer components than those shown in the figure, or combine certain components, or have a different arrangement of components.

[0111] On the other hand, the present invention further provides a computer storage medium storing a computer program, which, when executed by a processor, implements a high-precision vertical alignment method for a robotic arm, the method comprising:

[0112] Acquire three sets of reference points of the sensor carried by the robot arm on the workpiece plane, wherein the reference points are three-dimensional coordinates based on the robot arm body coordinate system;

[0113] Based on the three sets of reference points, three sets of basis vectors of the coordinate axes are calculated, and a new coordinate system consisting of the three sets of basis vectors is generated;

[0114] Refill the rotation matrix according to the definition of the rotation matrix and the projection transformation relationship between each row and column element in the new and old coordinate systems, and perform inverse conversion on the matrix to obtain the position and posture parameters of the robot angle;

[0115] Based on the posture parameters of the robot arm angle, the end of the robot arm is instructed to move to a position that is perpendicular and concentric with the workpiece plane.

[0116] In another aspect, a computer program product or a computer program is provided, the computer program product or the computer program comprising computer instructions, the computer instructions being stored in a computer-readable storage medium. A processor of an electronic device reads the computer instructions from the computer-readable storage medium, and when the processor executes the computer instructions, a method for high-precision vertical alignment of a robot arm is implemented, the method comprising:

[0117] Acquire three sets of reference points of the sensor carried by the robot arm on the workpiece plane, wherein the reference points are three-dimensional coordinates based on the robot arm body coordinate system;

[0118] Based on the three sets of reference points, three sets of basis vectors of the coordinate axes are calculated, and a new coordinate system consisting of the three sets of basis vectors is generated;

[0119] Refill the rotation matrix according to the definition of the rotation matrix and the projection transformation relationship between each row and column element in the new and old coordinate systems, and perform inverse conversion on the matrix to obtain the position and posture parameters of the robot angle;

[0120] Based on the posture parameters of the robot arm angle, the end of the robot arm is instructed to move to a position that is perpendicular and concentric with the workpiece plane.

[0121] Those of ordinary skill in the art can understand that all or part of the processes in the above-mentioned embodiment methods can be implemented by instructing related hardware through a computer program, and the computer program can be stored in a non-volatile computer-readable storage medium. When the computer program is executed, it can include the processes of the embodiments of the above-mentioned methods. Among them, any reference to memory, storage, database or other media used in the embodiments provided by the present invention may include non-volatile and / or volatile memory. Non-volatile memory may include read-only memory (ROM), programmable ROM (PROM), electrically programmable ROM (EPROM), electrically erasable programmable ROM (EEPROM) or flash memory. Volatile memory may include random access memory (RAM) or external cache memory.

[0122] By way of illustration and not limitation, RAM is available in many forms, such as static RAM (SRAM), dynamic RAM (DRAM), synchronous DRAM (SDRAM), double data rate SDRAM (DDRSDRAM), enhanced SDRAM (ESDRAM), synchronous link (Synchlink) DRAM (SLDRAM), memory bus (Rambus) direct RAM (RDRAM), direct memory bus dynamic RAM (DRDRAM), and memory bus dynamic RAM (RDRAM), etc.

[0123] The technical features of the above embodiments may be combined arbitrarily. To make the description concise, not all possible combinations of the technical features in the above embodiments are described. However, as long as there is no contradiction in the combination of these technical features, they should be considered to be within the scope of this specification.

[0124] The above-described embodiments only express several implementation methods of the present invention, and the description thereof is relatively specific and detailed, but it cannot be understood as limiting the scope of the present invention. It should be pointed out that, for a person of ordinary skill in the art, several modifications and improvements can be made without departing from the concept of the present invention, and these all belong to the protection scope of the present invention. Therefore, the protection scope of the present invention shall be subject to the attached claims.

Claims

1. A high-precision vertical alignment method for a robotic arm, characterized in that: The method comprises: Obtain three sets of reference points of the sensor carried by the robot arm on the workpiece plane, wherein the reference points are three-dimensional coordinates based on the robot arm body coordinate system; Based on the three sets of reference points, three sets of basis vectors of the coordinate axes are calculated, and a new coordinate system consisting of the three sets of basis vectors is generated; Refill the rotation matrix according to the definition of the rotation matrix and the projection transformation relationship between each row and column element in the new and old coordinate systems, and perform inverse conversion on the matrix to obtain the position and posture parameters of the robot angle; Based on the posture parameters of the robot arm angle, the end of the robot arm is instructed to move to a position that is perpendicular and concentric with the workpiece plane.

2. The high-precision vertical alignment method for a robotic arm according to claim 1, characterized in that: The method of calculating three groups of basis vectors of the coordinate axes based on the three groups of reference points and generating a new coordinate system composed of the three groups of basis vectors includes: Take one of the reference points as the center point and radiate outward to coordinate with the other two reference points to construct two sets of initial vectors A1 and A2; Taking one set of vectors as the reference, orthogonalize the other set of vectors to determine two sets of mutually perpendicular vectors B1 and B2; Calculate the vector B3 that is perpendicular to the plane where the vectors B1 and B2 are located; Normalize vectors B1, B2, and B3 to generate a coordinate system consisting of three standard unit vectors.

3. The high-precision vertical alignment method of a robot arm according to claim 2, characterized in that: The method uses one set of vectors as a reference to orthogonalize the other set of vectors, thereby determining two sets of mutually perpendicular vectors B1 and B2. include: Taking one of the vectors A1 as the reference, project vector A2 onto vector A1 to obtain vector B2. The calculation formula is as follows: Or take one of the vectors A2 as the reference, project vector A1 onto vector A2 to obtain vector B1. The calculation formula is as follows:

4. The high-precision vertical alignment method for a robot arm according to claim 3, characterized in that: The calculation of the vector B3 perpendicular to the plane where the vectors B1 and B2 are located includes: Calculate the modulus of vector B3 using the following formula: |B3|=|A1×A2|; The direction of vector B3 is selected according to the set direction of the robot arm.

5. The high-precision vertical alignment method for a robotic arm according to claim 2, characterized in that: The vectors B1, B2 and B3 are normalized to generate a coordinate system composed of three standard unit vectors. The calculation formula is as follows:

6. The high-precision vertical alignment method for a robot arm according to any one of claims 1 to 5, characterized in that: The rotation matrix is ​​refilled according to the definition of the rotation matrix and the projection transformation relationship between each row and column element in the new and old coordinate systems. The calculation formula is as follows: Among them, n = E1, that is, n x =E 1.x , n y =E 1.y , n z =E 1.z ; o = E2, that is, o x = E 2.x , o y = E 2.y , o z = E 2.z ; a = E3, that is, a x = E 3.x , a y = E 3.y , a z = E 3.z .

7. The high-precision vertical alignment method for a robot arm according to claim 6, characterized in that: The inverse solution of the matrix is ​​used to convert the position and posture parameters of the robot arm angle, and the calculation formula is as follows: Among them, (R, P, Y) are the posture parameters of the robot arm angle.

8. A high-precision vertical alignment device for a robotic arm, characterized in that: include: An acquisition module is used to acquire three sets of reference points of the sensor carried by the robot arm on the workpiece plane, wherein the reference points are three-dimensional coordinates based on the coordinate system of the robot arm body; A calculation module, used for calculating three groups of basis vectors of the coordinate axes based on the three groups of reference points, and generating a new coordinate system composed of the three groups of basis vectors; The conversion module is used to refill the rotation matrix according to the definition of the rotation matrix and the projection transformation relationship between each row and column element in the new and old coordinate systems, and to perform inverse conversion on the matrix to obtain the position and posture parameters of the robot arm angle; The command module is used to command the end of the robot arm to move to a position perpendicular to and concentric with the plane of the workpiece based on the posture parameters of the robot arm angle.

9. An electronic device comprising a memory and a processor, wherein the memory stores a computer program, wherein: When the processor executes the computer program, the steps of the high-precision vertical alignment method for a robotic arm as described in any one of claims 1 to 7 are implemented.

10. A computer-readable storage medium storing a computer program, characterized in that: When the computer program is executed by a processor, the steps of the high-precision vertical alignment method for a robot arm according to any one of claims 1 to 7 are implemented.

Citation Information

Cited By

  • Tail end vertical attitude automatic calibration method, device, equipment, medium and product

    CN121004607A