A method, device and storage medium for determining the joint angles of a target robot.

By constructing a linkage coordinate system and inverse kinematics on the welding robot, the problem of insufficient real-time performance and accuracy of traditional welding robots in complex environments is solved, and efficient positioning and precise operation are achieved in the welding of large-diameter pipes.

CN123103266APending Publication Date: 2026-11-17PIPECHINA SOUTH CHINA CO +1
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202510636075.7
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2025-05-16
Publication Date
2026-11-17

AI Technical Summary

Technical Problem

Existing welding robots struggle to meet real-time and precision requirements in complex external environments, especially when welding large-diameter pipes. The fixed base of traditional six-degree-of-freedom robots limits their working area, and there is a lack of effective joint angle optimization design methods.

Method used

By assembling a six-DOF robot onto a mobile connection platform, a link coordinate system is constructed, the coordinate transformation of the mobile connection platform and each joint is determined, and the target joint angle is calculated using inverse kinematics, thus achieving the real-time and accuracy requirements of the robot in complex environments.

Benefits of technology

It improves the working accuracy and real-time performance of welding robots in complex environments, adapts to the needs of welding large-diameter pipes, and ensures that the welding torch can pass through completely and achieve precise positioning.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN123103266A_ABST
    Figure CN123103266A_ABST
Patent Text Reader

Abstract

This application discloses a method, device, and storage medium for determining joint angles of a target robot, relating to the field of robotics. It aims to provide a method for determining joint angles in a structurally improved robot to meet the real-time and accuracy requirements during robot operation. The method is applied to a target robot comprising a six-degree-of-freedom (6DOF) robot and a mobile connection platform, with the 6DOF robot mounted on the mobile connection platform. The method includes: constructing a link coordinate system based on the target robot; determining the transformation matrix of the mobile connection platform and the transformation matrices of each joint of the six-DOF robot based on the link coordinate system; determining the transformation matrix of the target robot's working mechanism based on the transformation matrix of the mobile connection platform and the transformation matrices of each joint of the six-DOF robot; and performing inverse kinematics based on the transformation matrix of the working mechanism to obtain the target joint angles of each joint.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] This application relates to the field of robotics technology, and in particular to a method, device and storage medium for determining the joint angles of a target robot. Background Technology

[0002] Welding robots are widely used in automated welding operations due to their advantages such as high flexibility, fast welding speed, parameterization of the welding process, and ease of control. However, pipeline welding operations are usually carried out in complex external environments with varied terrain and topography. The installation method of welding robots is also affected by the terrain and geology, resulting in a large footprint. Furthermore, welding large-diameter pipelines requires a large area; when welding at the bottom of the pipeline, ample space must be reserved to ensure the welding torch can pass through completely.

[0003] Currently, in response to complex external environments, welding robots need structural modifications to meet the requirements. However, it is necessary to consider how to configure the modified robots to meet the real-time and precision requirements of welding scenarios. Summary of the Invention

[0004] The purpose of this application is to provide a method, device and storage medium for determining the joint angles of a target robot, aiming to provide a method for determining the joint angles of a robot with improved structure, so as to meet the real-time and accuracy requirements of the robot during operation.

[0005] To achieve the above objectives, this application adopts the following technical solution:

[0006] In a first aspect, this application provides a method for determining the joint angles of a target robot, the target robot comprising a six-degree-of-freedom robot and a mobile connection platform, the six-degree-of-freedom robot being mounted on the mobile connection platform, the method comprising:

[0007] A link coordinate system is constructed based on the target robot; the link coordinate system is used to describe the geometric relationships between the joints of the target robot.

[0008] Based on the linkage coordinate system, the coordinate transformation of the mobile connection platform and the coordinate transformation of each joint of the six-degree-of-freedom robot are determined.

[0009] Based on the coordinate transformation of the mobile connection platform and the coordinate transformation of each joint of the six-degree-of-freedom robot, the transformation matrix of the working mechanism of the target robot is determined.

[0010] Inverse kinematics is performed based on the transformation matrix of the working mechanism to obtain the target joint angles of each joint.

[0011] This application provides a method for determining the joint angles of a target robot. This method addresses complex external environments by assembling a six-DOF robot onto a mobile connection platform to create a seven-DOF target robot. A link coordinate system is constructed based on the structural characteristics of the target robot. The coordinate transformations of the mobile connection platform and each joint of the six-DOF robot are determined based on this link coordinate system, thereby determining the coordinate transformation of the end effector of the target robot. Inverse kinematics is performed based on the coordinate transformation of the end effector to obtain the target joint angles (optimal joint angles) of each joint of the target robot. The target robot can then be quickly adjusted using these target joint angles to determine its accurate working position, meeting the real-time and accuracy requirements during operation.

[0012] In some embodiments, inverse kinematics is performed based on the transformation matrix of the working mechanism to obtain the target joint angles of each joint, including: in the j-th iteration, determining a new solution in the neighborhood of the current solution; wherein j is greater than or equal to 1; determining the error value of the new solution based on the transformation matrix of the working mechanism; if the error value satisfies the condition for accepting the new solution, taking the new solution as the current solution in the (j+1)-th iteration; and if the iteration termination condition is satisfied, determining the current solution in the current iteration as the target joint angles of each joint.

[0013] In some embodiments, the method further includes: redetermining a new solution in the neighborhood of the new solution if the conditions for accepting the new solution are not met.

[0014] In some embodiments, the method further includes: if the iteration termination condition is not met, performing temperature decay based on the cooling coefficient and executing the next iteration process.

[0015] In some embodiments, the conditions for accepting a new solution include at least one of the following: the error value of the new solution is less than the minimum error value; the transition probability of the new solution at the current temperature is less than the preset transition probability; and a new solution is fully searched at the current temperature.

[0016] In some embodiments, the iteration termination condition includes at least one of the following: reaching the required number of iterations; or the temperature decaying to below a temperature threshold.

[0017] In some embodiments, determining the error value of a new solution based on the transformation matrix of the working mechanism includes: inputting the new solution into the transformation matrix of the working mechanism to obtain the actual working position of the working mechanism; obtaining the target working position of the working mechanism; and determining the Euclidean distance between the actual working position and the target working position as the error value of the new solution.

[0018] In some embodiments, the coordinate transformation of the mobile connection platform is determined based on the DH parameters of the mobile connection platform; in the DH parameters of the mobile connection platform, the joint angle or connection offset is a variable.

[0019] Secondly, this application provides a joint angle determination device, including a construction module, a determination module, and a processing module.

[0020] The building module is used to construct a link coordinate system based on the target robot; the link coordinate system is used to describe the geometric relationships between the joints of the target robot.

[0021] The determination module is used to determine the coordinate transformation of the mobile connection platform and the coordinate transformation of each joint of the six-degree-of-freedom robot, based on the link coordinate system.

[0022] The determination module is also used to determine the transformation matrix of the target robot's working mechanism based on the coordinate transformation of the mobile connection platform and the coordinate transformation of each joint of the six-degree-of-freedom robot.

[0023] The processing module is also used to perform inverse kinematics based on the transformation matrix of the working mechanism to obtain the target joint angles of each joint.

[0024] In some embodiments, the processing module is specifically configured to: determine a new solution in the neighborhood of the current solution during the j-th iteration; wherein j is greater than or equal to 1; determine the error value of the new solution based on the transformation matrix of the working mechanism; if the error value satisfies the condition for accepting the new solution, use the new solution as the current solution in the (j+1)-th iteration; and if the iteration termination condition is satisfied, determine the current solution in the current iteration as the target joint angle of each joint.

[0025] In some embodiments, the determining module is further configured to redetermine a new solution in the neighborhood of the new solution if the conditions for accepting a new solution are not met.

[0026] In some embodiments, the processing module is further configured to, if the iteration termination condition is not met, perform temperature decay based on the cooling coefficient and execute the next iteration process.

[0027] In some embodiments, the conditions for accepting a new solution include at least one of the following: the error value of the new solution is less than the minimum error value; the transition probability of the new solution at the current temperature is less than the preset transition probability; and a new solution is fully searched at the current temperature.

[0028] In some embodiments, the iteration termination condition includes at least one of the following: reaching the required number of iterations; or the temperature decaying to below a temperature threshold.

[0029] In some embodiments, the determining module is specifically used to: input the new solution into the transformation matrix of the working mechanism to obtain the actual working position of the working mechanism; obtain the target working position of the working mechanism; and determine the Euclidean distance between the actual working position and the target working position as the error value of the new solution.

[0030] In some embodiments, the coordinate transformation of the mobile connection platform is determined based on the DH parameters of the mobile connection platform; in the DH parameters of the mobile connection platform, the joint angle or connection offset is a variable.

[0031] Thirdly, this application provides an electronic device comprising: a processor and a memory; the memory storing processor-executable instructions; when the processor is configured to execute the instructions, causing the electronic device to implement the method of the first aspect described above.

[0032] Fourthly, this application provides a computer-readable storage medium comprising: computer software instructions; which, when executed in an electronic device, cause the electronic device to implement the method described in the first aspect.

[0033] Fifthly, this application provides a computer program product that, when run on a computer, causes the computer to perform the steps of the relevant method described in the first aspect above, so as to implement the method of the first aspect above.

[0034] The beneficial effects of the second to fifth aspects mentioned above are described in the corresponding description of the first aspect and will not be repeated here. Attached Figure Description

[0035] To more clearly illustrate the technical solutions of the embodiments of this application, the drawings used in the description of the embodiments will be briefly introduced below. Obviously, the drawings described below are only some embodiments of this application. For those skilled in the art, other drawings can be obtained based on these drawings without creative effort.

[0036] Figure 1 A flowchart illustrating a method for determining the joint angles of a target robot, provided in an embodiment of this application;

[0037] Figure 2 A flowchart illustrating another method for determining the joint angles of a target robot provided in an embodiment of this application;

[0038] Figure 3 A schematic diagram of an iterative process provided for an embodiment of this application;

[0039] Figure 4 A schematic diagram of an error transformation curve provided in an embodiment of this application;

[0040] Figure 5 A schematic diagram of another error transformation curve provided in an embodiment of this application;

[0041] Figure 6 This is a schematic diagram of the composition of a joint angle determining device provided in an embodiment of this application;

[0042] Figure 7 This is a schematic diagram of the composition of an electronic device provided in an embodiment of this application. Detailed Implementation

[0043] The technical solutions of the embodiments of this application will be clearly and completely described below with reference to the accompanying drawings. Obviously, the described embodiments are only some embodiments of this application, and not all embodiments. Based on the embodiments of this application, all other embodiments obtained by those skilled in the art without creative effort are within the scope of protection of this application.

[0044] In the description of this application, it should be understood that the terms "upper," "lower," "left," "right," "front," "rear," "inner," and "outer," etc., indicate the orientation or positional relationship based on the orientation or relative positional relationship shown in the accompanying drawings. They are used only for the convenience of describing this application and for simplification, and do not indicate or imply that the device or element referred to must have a specific orientation, or be constructed and operated in a specific orientation. Therefore, they should not be construed as limitations on this application. Unless otherwise specified, the above-mentioned orientational descriptions can be flexibly set in practical applications, provided that the relative positional relationships shown in the accompanying drawings are satisfied.

[0045] The terms "first" and "second" are used for descriptive purposes only and should not be construed as indicating or implying relative importance or implicitly specifying the number of technical features indicated. Therefore, a feature defined as "first" or "second" may explicitly or implicitly include one or more of that feature. In the description of this application, unless otherwise stated, "a plurality of" means two or more.

[0046] In the description of this application, it should be noted that, unless otherwise expressly specified and limited, the terms "installation," "connection," "linking," and "communication" should be interpreted broadly. For example, they can refer to a fixed connection, a detachable connection, or an integral connection. They can refer to a direct connection or an indirect connection through an intermediate medium, or a connection within two components. Those skilled in the art can understand the specific meaning of the above terms in this application according to the specific circumstances.

[0047] In embodiments of this application, the terms "comprising," "including," or any other variations thereof are intended to cover non-exclusive inclusion, such that a process, article, or apparatus that comprises a list of elements includes not only those elements but also other elements not expressly listed, or elements inherent to such a process, article, or apparatus. Without further limitation, an element defined by the phrase "comprising one..." does not exclude the presence of other identical elements in the process, article, or apparatus that includes that element.

[0048] In the embodiments of this application, the terms "exemplary" or "for example" are used to indicate that something is an example, illustration, or description. Any embodiment or design that is described as "exemplary" or "for example" in the embodiments of this application should not be construed as being more preferred or advantageous than other embodiments or design. Specifically, the use of the terms "exemplary" or "for example" is intended to present the relevant concepts in a specific manner.

[0049] In the description of this specification, specific features, structures, materials, or characteristics may be combined in any suitable manner in one or more embodiments or examples.

[0050] Degrees of freedom: refers to the number of independent movements of a robot. Each degree of freedom corresponds to the movement of one joint (rotation or translation).

[0051] In welding scenarios, traditional welding robots are six-degree-of-freedom (DOF) robots, meaning they can move freely in three-dimensional space, and their welding torch can rotate around the X, Y, and Z axes, thus meeting welding requirements at any position in 3D space. However, actual working environments are often complex, and the base of a six-DOF robot is typically fixed in a fixed position, limiting the robot's working area due to the length of the robotic arm and restricting its application scenarios.

[0052] The current solution is to improve the structure of the welding robot to increase its degrees of freedom. However, after the robot's structure is improved, the angle of each joint needs to be reconfigured to ensure the robot's real-time performance and accuracy. However, there is currently a lack of effective design methods for optimizing joint angles.

[0053] Based on this, this application provides a method for determining the joint angles of a target robot. This method addresses complex external environments by assembling a six-DOF robot onto a mobile connection platform to create a seven-DOF target robot. Considering the structural characteristics of the target robot, a link coordinate system is constructed. Based on the link coordinate system, the coordinate transformations of the mobile connection platform and each joint of the six-DOF robot are determined, thereby determining the coordinate transformation of the end effector of the target robot. Inverse kinematics is performed based on the coordinate transformation of the end effector to obtain the target joint angles (optimal joint angles) of each joint of the target robot. The target robot can then be quickly adjusted using these target joint angles to determine an accurate working position, meeting the real-time and accuracy requirements during the robot's operation.

[0054] The joint angle determination method of this application can be applied to electronic devices, such as servers, personal computers, and mobile terminals. The server mentioned here can be a server cluster consisting of multiple servers, a single server, or a computer. This application does not limit the specific device form of the server described above.

[0055] In addition, electronic devices communicate with the target robot to control the target robot to perform its tasks.

[0056] It should be noted that the electronic device controlling the target robot and the electronic device performing the joint angle determination method described above can be the same device or different devices. If they are different devices, electronic device 1 can be used to determine the joint angles, while electronic device 2 is used to directly control the target robot, obtain the joint angles from electronic device 1, and configure the target robot.

[0057] The target robot includes a mobile connection platform and a six-degree-of-freedom robot (robotic arm). The target robot is mounted on the mobile connection platform.

[0058] Specifically, the base of the six-DOF robot can be welded to a mobile connection platform. The mobile connection platform is connected to the track via gears. The mobile connection platform includes a reducer and external axis motors, and the coordination between the external track and the robotic arm is achieved through the control of the reducer and external axis motors.

[0059] In this embodiment, the six-degree-of-freedom robot can be a FANUC LR Mate200iD / 7L, whose specifications are shown in Table 1:

[0060] Table 1

[0061]

[0062]

[0063] The target robot in the embodiments of this application can be applied in pipe welding scenarios. For example, a mobile connection platform carries a robotic arm into a confined area (such as inside a pipe), where the robotic arm is responsible for local precision operations.

[0064] Figure 1 This is a flowchart illustrating a method for determining the joint angles of a target robot, provided in an embodiment of this application. Figure 1 As shown, the method for determining the joint angle of the target robot provided in this application can be implemented using the aforementioned electronic device, and specifically includes the following steps:

[0065] S101. Construct a link coordinate system based on the target robot.

[0066] The link coordinate system is used to describe the geometric relationships between the joints of the target robot.

[0067] The target robot consists of a series of links and joints. Each link's coordinate system describes its position and orientation relative to its adjacent links. A link is the rigid part of the robotic arm that connects two adjacent joints. A joint is a kinematic pair (rotational or translational) that connects two links.

[0068] S102. Based on the link coordinate system, determine the coordinate transformation of the mobile connection platform and the coordinate transformation of each joint of the six-degree-of-freedom robot.

[0069] The coordinate transformation of each part of the target robot is used to describe the transformation relationship of that part relative to the fixed coordinate system.

[0070] In some embodiments, the electronic device can obtain the DH parameters of the mobile connection platform in the target robot, as well as the DH parameters of each joint of the six-DOF robot, based on the connected coordinate system. Further, based on the DH parameters, a mathematical model is constructed to determine the coordinate transformations of the mobile connection platform and each joint of the six-DOF robot, respectively.

[0071] The DH parameters are a commonly used method to describe the inter-joint transformations of a robot, and include four parameters: joint angle (θ). i ), connecting rod torsion angle (α) i-1 ), Linkage offset (d) i ), Link length (a i-1 ).

[0072] In some embodiments, the coordinate transformation of the mobile connection platform is determined based on the DH parameters of the mobile connection platform; in the DH parameters of the mobile connection platform, the joint angle or link offset is a variable.

[0073] It should be noted that the DH parameter settings vary depending on the mode of motion being set on the mobile connection platform.

[0074] If the track on which the mobile connection platform runs is an arc, then the motion trajectory of the mobile connection platform can be regarded as rotating around the center of the track (similar to a large disk). In this case, the joint rotation angle is a variable, while other DH parameters are constants.

[0075] If the track on which the mobile connection platform runs is straight, then the mobile connection platform can be regarded as a translational joint, and its link offset is a variable.

[0076] This application uses an example where the track of the mobile connection platform is arc-shaped. A specific application scenario could be pipe welding.

[0077] As an example, the DH parameters of the target robot are shown in Table 2 below.

[0078] Table 2

[0079] joint <![CDATA[θ i ]]> <![CDATA[d i / mm]]> <![CDATA[a i-1 / mm]]> <![CDATA[α i-1 / (rad)]]> Range of motion (rad) 1 <![CDATA[θ1]]> 0 802.5 0 [-2π,2π] 2 <![CDATA[θ2]]> 0 50 π / 2 [-π / 2,π / 2] 3 <![CDATA[θ3]]> 0 440 0 [-π,π / 8] 4 <![CDATA[θ4]]> 0 35 -π / 2 [-π,π / 4] 5 <![CDATA[θ5]]> -420 0 π / 2 [-2π,2π] 6 <![CDATA[θ6]]> 0 0 π / 2 [-2π,2π] 7 <![CDATA[θ7]]> -80 0 -π [-2π,2π]

[0080] In some embodiments, the coordinate transformation of each joint in the target robot is represented by a homogeneous coordinate transformation:

[0081]

[0082] For example, by substituting the DH parameters of each joint in Table 2 above into the expression above, the coordinate transformation corresponding to each joint can be obtained.

[0083] S103. Based on the coordinate transformation of the mobile connection platform and the coordinate transformation of each joint of the six-degree-of-freedom robot, determine the transformation matrix of the working mechanism of the target robot.

[0084] Here, the working mechanism refers to the end effector of the target robot. Taking a welding robot as an example, the working mechanism refers to the welding torch at the end effector.

[0085] The electronic device can sequentially multiply the coordinate transformations of each component according to the connection order of the mobile connection platform and the joints of the six-degree-of-freedom robot to obtain the transformation matrix of the working mechanism.

[0086] For example, the transformation matrix of the working mechanism is determined by the following expression:

[0087]

[0088] in, The transformation matrix represents the working mechanism. The first parameter represents the coordinate transformation of the mobile connectivity platform, while the other parameters represent the coordinate transformation of the six-DOF robot described above. The expressions for each element in the coordinate transformation are as follows:

[0089] n x =S7(C6(C4S1-S4(C1S2S3-C1C2C3))-S6(C5(S1S4+C4(C1S2S3-C1C2C3))+S5(C1C2S3+C1C3S2))) -C7(S6(C4S1-S4(C1S2S3-C1C2C3))+C6(C5(S1S4+C4(C1S2S3-C1C2C3))+S5(C1C2S3+C1C3S2)));

[0090] n y=C7(S6(C1C4+S4(S1S2S3-C2C3S1))+C6(C5(C1S4-C4(S1S2S3-C2C3S1))-S5(C2S1S3+C3S1S2)))-S7(C6(C1C4+S4(S1S2S3-C2C3S1))-S6(C5(C1S4-C4(S1S2S3-C2C3S1)-S5(C2S1S3+C3S1S2)));

[0091] n z =C7(C6(S5(C2C3-S2S3)+C4C5(C2S3+C3S2))-S4S6(C2S3+C3S2))+S7(S6(S5(C2C3-S2S3)+C4C5(C2S3+C3S2))+C6S4(C2S3+C3S2));

[0092] about x =C7(C6(C4S1-S4(C1S2S3-C1C2C3))-S6(C5(S1S4+C4(C1S2S3-C1C2C3))+

[0093] S5(C1C2S3+C1C3S2)))+S7(S6(C4S1-S4(C1S2S3-C1C2C3))+C6(C5(S1S4+C4(C1S2S3-C1C2C3))+S5(C1C2S3+C1C3S2)));

[0094] about y =-C7(C6(C1C4+S4(S1S2S3-C2C3S1))-S6(C5(C1S4-C4(S1S2S3-C2C3S1))-S5(C2S1S3+C3S1S2)))-S7(S6(C1C4+S4(S1S2S3-C2C3S1))+C6(C5(C1S4-C4(S1S2S3-C2C3S1))-S5(C2S1S3+C3S1S2)));

[0095] about z =C7(S6(S5(C2C3-S2S3)+C4C5(C2S3+C3S2))+C6S4(C2S3+C3S2))-S7(C6(S5(C2C3-S2S3)+C4C5(C2S3+C3S2))-S4S6(C2S3+C3S2));

[0096] a x =C5(C1C2S3+C1C3S2)-S5(S1S4+C4(C1S2S3-C1C2C3));

[0097] ay =S5(C1S4-C4(S1S2S3-C2C3S1))+C5(C2S1S3+C3S1S2);

[0098] a z =C4S5(C2S3+C3S2)-C5(C2C3-S2S3);

[0099] p x =50C1+440C1C2-420C4S1+80S5(S1S4+C4(C1S2S3-C1C2C3))-80C5(C1C2S3+C1C3S2)+420S4(C1S2S3-C1C2C3)-35C1S2S3+35C1C2C3+802.5;

[0100] p y =50S1+400C1C4+440C2S1-80S5(C1S4-C4(S1S2S3-C2C3S1))-80C5(C2S1S3+C3S1S2)+420S4(S1S2S3-C2C3S1)-35S1S2S3+35C2C3S1;

[0101] p z =440S2+35C2S3+35C3S2+80C5(C2C3-S2S3)-420S4(C2S3+C3S2)-80C4S5(C2S3+C3S2);

[0102] Among them, C i S i They represent cosθ respectively i and sinθ i , i = 1, 2…7.

[0103] S104. Perform inverse kinematics based on the transformation matrix of the working mechanism to obtain the target joint angles of each joint.

[0104] Inverse kinematics (IK) is a core problem in robot control, which involves calculating the angles or displacements of all joints based on the target pose (position + orientation) of the robot's end effector.

[0105] The target joint angle is the optimal joint angle. Electronic devices can use the target joint angle to sequentially configure each joint of the target robot to achieve precise positioning.

[0106] In one possible implementation, such as Figure 2 As shown, the above S104 can be specifically implemented as follows:

[0107] S1041. During the j-th iteration, determine a new solution in the neighborhood of the current solution.

[0108] Where j is greater than or equal to 1.

[0109] For example, it can be done in the current solution (q) i A new solution (q) is randomly selected from the neighborhood of ) j During the selection process, motion limits for each joint can be set (which can be found in the robot's configuration parameter table) to constrain the randomly generated new solutions.

[0110] It should be noted that in the first iteration, the current solution can be the initial solution configured by the user. The solution here refers to the angles of each joint of the target robot (including the mobile connection platform). For example, the initial solution is [0,0,0,0,0,0,0].

[0111] S1042. Based on the transformation matrix of the working mechanism, determine the error value of the new solution.

[0112] Specifically, S1042 above can be implemented as follows: steps a-c:

[0113] Step a: Input the new solution into the transformation matrix of the working mechanism to obtain the actual working position of the working mechanism.

[0114] It should be noted that the coordinate transformation of each joint is obtained using the definition of the secondary coordinate transformation. The first three rows and first three columns of the matrix form a rotational coordinate transformation, representing the actual posture transformation of the working mechanism; the first three rows of the last column of the matrix form a column vector, representing the working position of the working mechanism. Therefore, after the electronic device incorporates the new solution into the coordinate transformation, it can extract the actual working position corresponding to the new solution from the coordinate transformation.

[0115] Step b: Obtain the target working location of the work unit.

[0116] The target working position refers to the position where the target robot is expected to perform its work.

[0117] In some implementations, the actual working position can be obtained by simulating the target robot or by measuring the location of the object to be worked on in the physical environment.

[0118] Step c: Determine the Euclidean distance between the theoretical working position and the actual working position, as the error value of the new solution.

[0119] In some implementations, the error value of the new solution can be determined using an objective function:

[0120] The expression for the objective function is as follows:

[0121]

[0122] Where E(i) represents the error. The first to third terms under the square root represent the position errors of the working mechanism along the x, y, and z axes, respectively. T a T represents the coordinate transformation of the actual working position. b Represents the coordinate transformation of the target working position.

[0123] S1043. If the error value meets the condition for accepting the new solution, the new solution shall be used as the current solution in the (j+1)th iteration process.

[0124] If the condition for accepting a new solution is met, then the new solution is accepted, and that is, the new solution is used as the current solution in the (j+1)th iteration process.

[0125] In some implementations, if the conditions for accepting a new solution are not met, a new candidate solution is determined in the neighborhood of the new solution, i.e., the above S1041 is re-executed.

[0126] In some implementations, the above-mentioned conditions for accepting a new solution include at least one of the following: the error value of the new solution is less than the minimum error value; the transition probability of the new solution at the current temperature is less than a preset transition probability. Search for new solutions fully at the current temperature.

[0127] Wherein, the minimum error value mentioned above is the current solution (q) during the current iteration. i The error value corresponding to the current solution (q). Specifically, the error value can be calculated using the current solution (q). i Substitute these values ​​into the objective function to obtain the corresponding error values.

[0128] The transition probability P is determined by the following expression:

[0129]

[0130] Among them, t k This represents the control parameter, which is the set temperature for the current iteration process.

[0131] A solution is considered to have been adequately searched at the current temperature if at least one of the following conditions is met: a fixed number of new solutions have been generated at each temperature; and no new solutions have been accepted after M connections.

[0132] It should be noted that by conducting a thorough search at the current temperature, the probability of finding the global optimum can be increased, and the random bias caused by random disturbances can be reduced.

[0133] In some implementations, the above conditions can be used in combination. For example, if the error of the new solution is less than the minimum error value, the new solution is accepted. If it is greater than or equal to the error value, the transition probability of the new solution is calculated. If the transition probability of the new solution is less than a preset transition probability, the new solution is accepted. If not, it is determined whether a new solution has been sufficiently searched at the current temperature. If a new solution has been sufficiently searched, S1044 is executed. If a new solution has not been sufficiently searched, the next step is executed to redetermine the new solution.

[0134] S1044. If the iteration termination condition is met, determine the current solution in the current iteration process as the target joint angle of each joint.

[0135] In some implementations, if the iteration termination condition is not met, the temperature is decayed according to the cooling coefficient, and the next iteration process is executed.

[0136] Users can configure the initial temperature (e.g., 1000 degrees) and the cooling coefficient (e.g., 0.95). If temperature decay is required, 1000 * 0.95 = 950 will be used as the set temperature for the next iteration.

[0137] In some implementations, the iteration termination condition includes at least one of the following: reaching the required number of iterations; or the temperature decaying to below a temperature threshold. For example, if the user sets a maximum number of iterations of 10,000, the iteration ends when 10,000 iterations have been performed. Alternatively, if the user sets a temperature threshold of 100, the iteration ends when the temperature decays to below 100.

[0138] Figure 3 This is a schematic diagram of an iterative process provided in an embodiment of this application. For example... Figure 3 As shown, the process begins with: 1. Setting initialization parameters, including initial temperature (T0), cooling coefficient (α), initial solution (q0), initial error value (also known as evaluation score), and maximum number of iterations. 2. [The text then abruptly shifts to a different topic:] ...in the current solution (q... i A new solution (q) is randomly selected from the neighborhood of ) j 3. Calculate the new solution (q) j The error of f(q) j 4. Determine f(q) j Is ) less than f(q)? i (That is, determine whether the error of the new solution is less than the error of the current solution). If yes, then 5. Accept the new solution. If no, 6. Determine whether the transition probability of the new solution is less than the preset transition probability. If yes, then 5. Accept the new solution. If no, 7. Determine whether the search is sufficient at the current temperature. If no, then reject the new solution (q). jAs the current solution, execute step 2 above. If the search has been sufficient, step 8: determine if the iteration termination condition is met. If not, perform temperature decay and execute the next iteration, i.e., execute step 2 above. If yes, step 9: output the target joint angle and error value, and end.

[0139] The method for determining joint angles provided in this application will be described below with specific examples.

[0140] In this embodiment, the initial parameters are set as follows: initial temperature T0 = 1000℃, temperature decay coefficient is 0.99, initial joint angle of the target (initial solution) [0, 0, 0, 0, 0, 0, 0], and maximum number of iterations is 28500.

[0141] Four sets of experiments were conducted to verify the accuracy of the joint angle determination method provided in the embodiments of this application. Specifically, using the known target position (target working position), the optimal joint angle was calculated using the aforementioned joint angle determination method for the target robot, and the error between the optimal joint angle and the target position was verified.

[0142] The four sets of data are shown in Table 3 below, including:

[0143] Table 3

[0144]

[0145]

[0146] For each set of data, the above joint angle determination method was applied to obtain the target joint angles (optimal joint angles) as shown in Table 4 below:

[0147] Table 4

[0148]

[0149] Taking the first set of experimental data as an example, this demonstrates the error value generated by the evaluation function during the iteration process, such as... Figure 4 and Figure 5 As shown, the error value decreases continuously with the number of iterations until it stops decreasing after 480 iterations. This yields the optimal joint angles [-2.08 rad, 0.06 rad, 3.04 rad, -4.73 rad, 0.73 rad, -1.38 rad, 2.35 rad] and the minimum error of 0.3158 mm, with a total time of 0.937 s. Figure 4 It shows the change in error within the range of 0-600℃. Figure 5 This shows the change in error within the range of 360-480℃, compared to... Figure 4 It offers higher display precision.

[0150] This application provides a method for determining the joint angles of a target robot. This method addresses complex external environments by assembling a six-DOF robot onto a mobile connection platform to create a seven-DOF target robot. A link coordinate system is constructed based on the structural characteristics of the target robot. The coordinate transformations of the mobile connection platform and each joint of the six-DOF robot are determined based on this link coordinate system, thereby determining the coordinate transformation of the end effector of the target robot. Inverse kinematics is performed based on the coordinate transformation of the end effector to obtain the target joint angles (optimal joint angles) of each joint of the target robot. The target robot can then be quickly adjusted using these target joint angles to determine its accurate working position, meeting the real-time and accuracy requirements during operation.

[0151] In addition, this application provides a method for determining joint angles, which can coordinate the posture adjustment of the mobile connection platform and the robotic arm. The mobile connection platform can move the robotic arm to complete the task, avoiding extreme movements of the robotic arm joints.

[0152] The target robot in the embodiments of this application can be applied in pipe welding scenarios. For example, a mobile connection platform carries a robotic arm into a confined area (such as inside a pipe), where the robotic arm is responsible for local precision operations.

[0153] It is understood that the electronic device provided in this application embodiment includes hardware structures and / or software modules corresponding to perform each function in order to achieve the above-mentioned functions. Those skilled in the art should readily recognize that, in conjunction with the units and algorithm steps of the various examples described in the embodiments disclosed herein, the embodiments of this application can be implemented in hardware or a combination of hardware and computer software. Whether a function is executed by hardware or by computer software driving hardware depends on the specific application and design constraints of the technical solution. Those skilled in the art can use different methods to implement the described functions for each specific application, but such implementation should not be considered beyond the scope of the embodiments of this application.

[0154] This application embodiment can divide the above-described electronic device into functional modules based on the method example described above. For example, each function can be divided into its own functional modules, or two or more functions can be integrated into one processing module. The integrated modules can be implemented in hardware or as software functional modules. It should be noted that the module division in this application embodiment is illustrative and only represents one logical functional division; other division methods may be used in actual implementation.

[0155] In an exemplary embodiment, this application also provides a joint angle determination device. This joint angle determination device may include one or more functional modules for implementing the joint angle determination method for the target robot described in the above method embodiments.

[0156] For example, Figure 6 This is a schematic diagram illustrating the composition of a joint angle determining device provided in this application. Figure 6 As shown, the joint angle determination device includes: a construction module 601, a determination module 602, and a processing module 603.

[0157] Module 601 is used to construct a link coordinate system based on the target robot; the link coordinate system is used to describe the geometric relationships between the joints of the target robot.

[0158] The determination module 602 is used to determine the coordinate transformation of the mobile connection platform and the coordinate transformation of each joint of the six-degree-of-freedom robot based on the link coordinate system.

[0159] The determining module 602 is also used to determine the transformation matrix of the working mechanism of the target robot based on the coordinate transformation of the mobile connection platform and the coordinate transformation of each joint of the six-degree-of-freedom robot.

[0160] The processing module 603 is also used to perform inverse kinematics based on the transformation matrix of the working mechanism to obtain the target joint angles of each joint.

[0161] In some embodiments, the processing module 603 is specifically configured to: determine a new solution in the neighborhood of the current solution during the j-th iteration; wherein j is greater than or equal to 1; determine the error value of the new solution based on the transformation matrix of the working mechanism; if the error value satisfies the condition for accepting the new solution, use the new solution as the current solution in the (j+1)-th iteration; and if the iteration termination condition is satisfied, determine the current solution in the current iteration as the target joint angle of each joint.

[0162] In some embodiments, the determining module 602 is further configured to redetermine a new solution in the neighborhood of the new solution if the conditions for accepting a new solution are not met.

[0163] In some embodiments, the processing module 603 is further configured to perform temperature decay based on the cooling coefficient and execute the next iteration process if the iteration termination condition is not met.

[0164] In some embodiments, the conditions for accepting a new solution include at least one of the following: the error value of the new solution is less than the minimum error value; the transition probability of the new solution at the current temperature is less than the preset transition probability; and a new solution is fully searched at the current temperature.

[0165] In some embodiments, the iteration termination condition includes at least one of the following: reaching the required number of iterations; or the temperature decaying to below a temperature threshold.

[0166] In some embodiments, the determining module 602 is specifically used to: input the new solution into the transformation matrix of the working mechanism to obtain the actual working position of the working mechanism; obtain the target working position of the working mechanism; and determine the Euclidean distance between the actual working position and the target working position as the error value of the new solution.

[0167] In some embodiments, the coordinate transformation of the mobile connection platform is determined based on the DH parameters of the mobile connection platform; in the DH parameters of the mobile connection platform, the joint angle or connection offset is a variable.

[0168] In an exemplary embodiment, this application also provides a target robot. The target robot includes a mobile connection platform and a six-degree-of-freedom robot. The six-degree-of-freedom robot is mounted on the mobile connection platform, which can move on a track.

[0169] In an exemplary embodiment, this application also provides an electronic device. Figure 7 This is a schematic diagram illustrating the composition of an electronic device provided in an embodiment of this application. For example... Figure 7 As shown, the electronic device includes: a processor 10, a memory 20, a communication line 30, a communication interface 40, and an input / output interface 50.

[0170] The processor 10, memory 20, communication interface 40, and input / output interface 50 can be connected via communication line 30.

[0171] Processor 10 is used to execute instructions stored in memory 20 to run the reader described in the above embodiments. Processor 10 can be a CPU, a network processor (NP), a digital signal processor (DSP), a microprocessor, a microcontroller (MCU) / single-chip microcomputer / microcontroller, a programmable logic device (PLD), or any combination thereof. Processor 10 can also be any other device with processing capabilities, such as a circuit, device, or software module; this application embodiment does not limit this. In one example, processor 10 may include one or more CPUs, for example... Figure 7 CPU0 and CPU1 in the example. As an optional implementation, the electronic device may include multiple processors; for example, in addition to processor 10, it may also include processor 60. Figure 7 (The example shown is a dashed line).

[0172] The memory 20 is used to store instructions. For example, the instructions may be computer programs. Optionally, the memory 20 may be a read-only memory (ROM) or other types of static storage devices that can store static information and / or instructions; it may also be a random access memory (RAM) or other types of dynamic storage devices that can store information and / or instructions; it may also be an electrically erasable programmable read-only memory (EEPROM), a compact disc read-only memory (CD-ROM) or other optical disc storage, optical disc storage (including compressed optical discs, laser discs, optical discs, digital universal optical discs, Blu-ray discs, etc.), magnetic disk storage media, or other magnetic storage devices, etc. The embodiments of this application do not limit this.

[0173] It should be noted that the memory 20 can exist independently of the processor 10 or it can be integrated with the processor 10. The memory 20 can be located inside or outside the electronic device, and this application embodiment does not impose any restrictions on this.

[0174] Communication line 30 is used to transmit information between the components included in the electronic device.

[0175] Communication interface 40 is used to communicate with other devices or other communication networks. These other communication networks can be Ethernet, radio access network (RAN), wireless local area networks (WLAN), etc. Communication interface 40 can be a module, circuit, transceiver, or any device capable of enabling communication.

[0176] Input / output interface 50 is used to enable human-computer interaction between users and electronic devices. For example, it enables action interaction or information exchange between users and electronic devices.

[0177] For example, the input / output interface 50 can be a mouse, keyboard, display screen, or touch screen. Action or information interaction between the user and the electronic device can be achieved through a mouse, keyboard, display screen, or touch screen.

[0178] It should be noted that, Figure 7 The structures shown do not constitute a limitation on electronic devices, except... Figure 7 In addition to the components shown, electronic devices may include more or fewer components than illustrated, or combinations of certain components, or different component arrangements.

[0179] This application also provides a computer-readable storage medium including computer instructions that, when executed on the electronic device, cause the electronic device to perform the various functions or steps described in the method embodiments.

[0180] This application also provides a computer program product that, when run on a computer, causes the computer to perform the functions or steps described in the above method embodiments.

[0181] Through the above description of the embodiments, those skilled in the art can clearly understand that, for the sake of convenience and brevity, only the division of the above functional modules is used as an example. In actual applications, the above functions can be assigned to different functional modules as needed, that is, the internal structure of the device can be divided into different functional modules to complete all or part of the functions described above.

[0182] In the several embodiments provided in this application, it should be understood that the disclosed apparatus and methods can be implemented in other ways. For example, the apparatus embodiments described above are merely illustrative. For instance, the division of modules or units is only a logical functional division, and in actual implementation, there may be other division methods. For example, multiple units or components may be combined or integrated into another device, or some features may be ignored or not executed. Furthermore, the coupling or direct coupling or communication connection shown or discussed may be through some interfaces; the indirect coupling or communication connection between devices or units may be electrical, mechanical, or other forms.

[0183] The units described as separate components may or may not be physically separate. A component shown as a unit can be one or more physical units; that is, it can be located in one place or distributed in multiple different locations. Some or all of the units can be selected to achieve the purpose of this embodiment according to actual needs.

[0184] Furthermore, the functional units in the various embodiments of this application can be integrated into one processing unit, or each unit can exist physically separately, or two or more units can be integrated into one unit. The integrated unit can be implemented in hardware or as a software functional unit.

[0185] If the integrated unit is implemented as a software functional unit and sold or used as an independent product, it can be stored in a readable storage medium. Based on this understanding, the technical solutions of the embodiments of this application, essentially or in other words, the parts that contribute to the prior art, or all or part of the technical solutions, can be embodied in the form of a software product. This software product is stored in a storage medium and includes several instructions to cause a device (which may be a microcontroller, chip, etc.) or processor to execute all or part of the steps of the methods described in the various embodiments of this application. The aforementioned storage medium includes various media capable of storing program code, such as USB flash drives, portable hard drives, read-only memory (ROM), random access memory (RAM), magnetic disks, or optical disks.

[0186] The above are merely specific embodiments of this application, but the scope of protection of this application is not limited thereto. Any variations or substitutions that can be easily conceived by those skilled in the art within the scope of the technology disclosed in this application should be included within the scope of protection of this application. Therefore, the scope of protection of this application should be determined by the scope of the claims.

Claims

1. A method for determining the joint angles of a target robot, characterized in that, The target robot includes a six-degree-of-freedom robot and a mobile connection platform, wherein the six-degree-of-freedom robot is mounted on the mobile connection platform, and the method includes: A link coordinate system is constructed based on the target robot; the link coordinate system is used to describe the geometric relationships between the joints of the target robot. Based on the link coordinate system, the coordinate transformation of the mobile connection platform and the coordinate transformation of each joint of the six-degree-of-freedom robot are determined; Based on the coordinate transformation of the mobile connection platform and the coordinate transformation of each joint of the six-degree-of-freedom robot, the transformation matrix of the working mechanism of the target robot is determined. Inverse kinematics is performed based on the transformation matrix of the working mechanism to obtain the target joint angles of each joint.

2. The method according to claim 1, characterized in that, The inverse kinematics solution based on the transformation matrix of the working mechanism is used to obtain the target joint angles of each joint, including: In the j-th iteration, a new solution is determined in the neighborhood of the current solution; where j is greater than or equal to 1. Based on the transformation matrix of the working mechanism, the error value of the new solution is determined; If the error value satisfies the condition for accepting a new solution, the new solution is taken as the current solution in the (j+1)th iteration process; If the iteration termination condition is met, the current solution in the current iteration process is determined as the target joint angle of each joint.

3. The method according to claim 2, characterized in that, The method further includes: If the conditions for accepting a new solution are not met, a new solution is redetermined in the neighborhood of the new solution.

4. The method according to claim 2, characterized in that, The method further includes: if the iteration termination condition is not met, performing temperature decay based on the cooling coefficient and executing the next iteration process.

5. The method according to claim 2 or 3, characterized in that, The condition for accepting a new solution includes at least one of the following: The error value of the new solution is less than the minimum error value; The transition probability of the new solution at the current temperature is less than the preset transition probability; Search for new solutions fully at the current temperature.

6. The method according to claim 2 or 4, characterized in that, The iteration termination condition includes at least one of the following: Reached the required number of iterations; After the temperature decays, it is less than the temperature threshold.

7. The method according to claim 2, characterized in that, Determining the error value of the new solution based on the transformation matrix of the working mechanism includes: The new solution is input into the transformation matrix of the working mechanism to obtain the actual working position of the working mechanism; Obtain the target working position of the working mechanism; The Euclidean distance between the actual working position and the target working position is determined as the error value of the new solution.

8. The method according to claim 1, characterized in that, The coordinate transformation of the mobile connection platform is determined according to the DH parameters of the mobile connection platform; In the DH parameters of the mobile connection platform, the joint angle or connection offset is a variable.

9. An electronic device, characterized in that, The electronic device includes: a processor and a memory; The memory stores instructions that the processor can execute; When the processor is configured to execute the instructions, the electronic device performs the method as described in any one of claims 1-8.

10. A computer-readable storage medium, characterized in that, The computer-readable storage medium includes: computer software instructions; When the computer software instructions are executed in an electronic device, the electronic device causes the electronic device to perform the method as described in any one of claims 1-8.