A control method for on-orbit assembly of large space structures by a mobile dual-arm robot

By using dynamic coupling modeling and motion controller design, the problem of precise pose control for mobile dual-arm robots during on-orbit assembly of large space structures was solved. This achieved dynamic coupling between the robot and the structural modules, improved the control accuracy and system stability of the assembly task, and promoted the automation development of space construction.

CN120962643BActive Publication Date: 2026-11-10NANJING UNIV OF AERONAUTICS & ASTRONAUTICS
View PDF 2 Cites 0 Cited by

Patent Information

Application Number
CN202511054661.7
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2025-07-30
Publication Date
2026-11-10
Estimated Expiration
2045-07-30

AI Technical Summary

Technical Problem

When existing mobile dual-arm robots assemble large spatial structures in orbit, it is difficult to accurately drive the structural modules to be assembled to the pre-assembly pose. Furthermore, the safe and stable operation of the robot's multi-arm chain system is challenging, and existing modeling methods fail to achieve dynamic coupling with the structural modules, thus limiting their application effectiveness.

Method used

A method for on-orbit assembly of a mobile dual-arm robot is designed, including dynamic coupling modeling and motion controller design. By establishing a coordinate system, forward kinematics model, differential kinematics analysis, coupled kinematics and dynamics model, the dynamic coupling between the robot and the structural module is realized, and the motion controller is designed to achieve rapid tracking control.

Benefits of technology

It improves the control precision and system stability of mobile space robots in on-orbit assembly tasks, provides technical support for the autonomous construction of large space structures, significantly improves the response speed and trajectory tracking accuracy of the assembly process, and enhances the stability of the system.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN120962643B_ABST
    Figure CN120962643B_ABST
Patent Text Reader

Abstract

This invention provides a control method for on-orbit assembly of large spatial structures using a mobile dual-arm robot. Based on the Lagrangian method in analytical mechanics, this invention establishes a dynamic coupling model between the robot and the structural module, and proposes a specific motion tracking controller accordingly. This enables rapid tracking control of the structural module to be assembled to the target pose under the drive of the mobile dual-arm robot. The mechanical model involved in this method accurately describes the coupled dynamic behavior of the mobile dual-arm robot and the structural module to be assembled, and the control method involved has a simple structure and enables the system to reach the desired position.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] This invention belongs to the field of space robot technology, and in particular relates to a control method for on-orbit assembly of large space structures by a mobile dual-arm robot. Background Technology

[0002] With the increasing demand for the construction of large space structures such as space stations, space telescopes, large communication antennas, and solar power plants, the complexity and precision of on-orbit assembly tasks are constantly increasing. How to achieve efficient, intelligent, and autonomous construction of large space structures has become a major technical challenge.

[0003] Against this backdrop, the emergence and development of mobile space robot technology has provided new ideas and technical paths for solving this problem. However, despite the significant application potential of space robots in space construction, many key issues remain to be addressed in their practical application for on-orbit assembly tasks. In particular, ensuring that the mobile dual-arm robot accurately drives the structural module to be assembled to the pre-assembly pose while guaranteeing the safe and stable operation of the robot's multi-arm chain system is one of the key challenges in current research. Furthermore, existing robot modeling methods are mostly limited to joint space analysis and fail to achieve dynamic coupling with the structural module, further limiting their application effectiveness in practical tasks. Summary of the Invention

[0004] Purpose of the invention: The technical problem to be solved by the present invention is to address the shortcomings of the existing technology by providing a control method for on-orbit assembly of large spatial structures by a mobile dual-arm robot, comprising the following steps:

[0005] Step 1, Design the on-orbit assembly mechanism: The large space structure based on the mobile dual-arm robot includes the base spacecraft, support rods, mobile dual-arm robot, polygonal structural modules to be assembled, and modular large space structure.

[0006] Step 2, dynamic coupling modeling; includes the following steps:

[0007] Step 2-1: Establish a coordinate system and define the symbols for the physical quantities of the system.

[0008] Step 2-2: Establish the forward kinematics model of the space robot system;

[0009] Steps 2-3 involve performing differential kinematics analysis on the space dual-arm robot to obtain the mapping relationship between the generalized and end effector velocities;

[0010] Steps 2-4: Establish a coupled kinematic model of the space dual-arm robot and the polygonal structure module, that is, a coupled kinematic model of N robotic arms cooperating to grasp a polygonal structure module. It is set that the space robot and the polygonal structure module are rigidly grasped and there will be no relative motion between the space robot and the polygonal structure module.

[0011] Steps 2-5: Establish the dynamic model of the polygonal structure module;

[0012] Steps 2-6: Establish the dynamic model of the mobile dual-arm robot;

[0013] Steps 2-7: Establish the dynamic model of the coupled structural module of the movable dual-arm robot;

[0014] Step 3: Design the motion controller.

[0015] Step 1 includes: the base spacecraft is equipped with square solar panels that provide energy;

[0016] The starting end of the support rod is located at the center of mass of the base spacecraft, and the end is located at the center of mass of the modular large space structure being assembled.

[0017] The movable dual-arm robot includes a movable base and two multi-degree-of-freedom robotic arms. The movable base can move linearly along the rod and can also rotate freely around the rod. It can transport the structural module to be assembled and complete the assembly by moving back and forth on the support rod.

[0018] The completed modular large-scale space structure is a movable ring structure with a diameter of 100m that can operate in orbit. The movable ring structure can be divided into two or more polygonal structural modules.

[0019] The following on-orbit assembly scheme is formulated: The support rod and the movable dual-arm robot are pre-placed in the storage compartment of the base spacecraft. Upon receiving the assembly start command, the support rod exits the compartment, and the rotary joints on the support rod rotate to cooperate with the expansion of the support rod. After the support rod is fully expanded, the rotary joints lock, and the support rod becomes an inextensible rigid rod. Subsequently, the movable dual-arm robot exits the compartment, and the end effectors on the robotic arms jointly grasp a polygonal structural module. While the movable base moves along the rod and rotates around the rod, the movable dual-arm robot drives the joints to rotate. The movable base and the dual-arm joints jointly manipulate the polygonal structural module, accurately transporting the polygonal structural module to be assembled to the pre-assembly position according to the target pose.

[0020] After the 100m diameter movable ring structure is assembled, the movable dual-arm robot moves back to the storage compartment of the base spacecraft. The rotary joints on the support rod are unlocked. At this time, the support rod is regarded as a space robotic arm. The position and posture of the large space target structure are adjusted in real time by changing the joint angles on the space robotic arm.

[0021] Step 2-1 includes: I (·) indicates that · represents the coordinate system {I} in the inertial coordinate system. x ,I y ,I z These are the three orthogonal coordinate axes of the inertial coordinate system, and their directions are consistent with the components corresponding to the Earth coordinate system. o (·) indicates that · is represented in the base centroid coordinate system {o}; The symbol · represents the coordinate system of the centroid of the end effector {e}. k In the diagram, k takes the value l to represent the left arm and k takes the value r to represent the right arm; A (·) indicates that · represents the coordinate system {A} of the link's center of mass. M (·) indicates that · is represented in the centroid coordinate system of the spatial module {M}; The antisymmetric matrix is ​​represented as ·. Represents the space of m×n dimensional real matrices. Let m×1 represent the real vector space;

[0022] This represents the position vector of the centroid of the coupled system. This represents the position vector of the end effector of arm k. This represents the position vector of the movable base's center of mass pointing towards the connection point of the left arm (l) or right arm (r). Let represent the vector coordinates of the center of mass of the i-th link in the left arm and the j-th link in the right arm, respectively. This represents the position vector of the centroid of the polygonal structure module. This represents the position vector from the current link's center of mass to the current link's end point; Let represent the inertia matrix of the movable base, the inertia matrix of the structural module, and the inertia matrix of the i(j)th link of the left (right) arm. and Let the velocity and angular velocity of the center of mass of the i-th link in the robot's left arm be represented, respectively. and Let their respective values ​​represent the velocity and angular velocity of the center of mass of the j-th link in the robot's right arm. This represents the vector coordinates of the end of the i-th link of the robot's left arm. Let n represent the vector coordinates of the end of the j-th link of the robot's right arm, and let n1 and n2 be the degrees of freedom of the left arm and the right arm, respectively.

[0023] The joint angles of the robot's left arm and right arm are respectively... and T represents the transpose of a vector matrix; q 11 ,…, q represents the rotation angle of each joint of the robot's left arm. 21 ,…, These represent the rotation angles of each joint of the robot's right arm;

[0024] The generalized coordinate q is: in These are the coordinates of the base in the inertial coordinate system, with the support rod set along I. x If placed along the axis, then x is along I. x The coordinates along the axis, the base along I y ,I z The coordinates along the axis remain constant at 2m. This is the attitude vector matrix of the base, where α, β, and γ are the Euler angles of the base's attitude. Because the base rotates around the support rod, the base only has angles around I. x The Euler angles of the axis rotation are changing, that is...

[0025] Generalized speed for: It is the velocity vector of the base, only in I x The velocity changes along the axial direction, along I y ,I z The velocity in the axial direction is always 0. It is the angular velocity of the base. These represent the joint angular velocities of the robot's left arm and right arm, respectively. These represent the angular velocities of each joint in the robot's left arm. These represent the angular velocities of each joint in the robot's right arm;

[0026] The following settings are made: the base is a 2m × 2m × 2m cube, and the base is along the direction of the rod (i.e., I). x The motion is along the axis, with the base's center of mass at [x, 2, 2]. T The coordinates of the connection point between the left arm and the base are [x, 1, 2]. T The coordinates of the connection point between the right arm and the base are [x, 3, 2]. T .

[0027] Step 2-2 includes: the movable base can move along the rod and rotate around the rod simultaneously, having 2 degrees of freedom; the homogeneous coordinate matrix of the movable base's pose. for:

[0028]

[0029] Where γ is the base winding I x The attitude angle of the axis rotation;

[0030] Homogeneous coordinate matrix of the first joint of the left arm (i.e., the connection point between the movable base and the left arm) In the inertial coordinate system, {I} is represented as:

[0031]

[0032] in This is the representation of the transformation relationship between the homogeneous coordinate matrix of the base and the homogeneous coordinate matrix of the left arm at the connection point of the base in the inertial coordinate system;

[0033] Homogeneous coordinate matrix of the first joint of the right arm (i.e., the connection point between the base and the right arm) In the inertial coordinate system, {I} is represented as:

[0034]

[0035] in This is the representation of the transformation relationship between the homogeneous coordinate matrix of the base and the homogeneous coordinate matrix of the right arm located at the connection point of the base in the inertial coordinate system.

[0036] For a spatial dual-arm robot with n degrees of freedom, each joint is a rotary joint, and the robot's forward kinematics model is obtained by multiplying the homogeneous matrices of each joint.

[0037] Homogeneous matrix of a joint in the left arm for:

[0038]

[0039] in, Let be the homogeneous transformation matrix from the first joint to the second joint of the left arm. Let be the homogeneous transformation matrix from the (n-1)th joint to the nth joint of the left arm. Let {i} be the coordinate system of the nth joint of the left arm of the space dual-arm robot. n The rotation matrix relative to the inertial coordinate system {I}. Let {i} be the coordinate system of the nth joint of the robot's left arm, pointing from the origin of the inertial coordinate system {I}. n The position vector of the origin;

[0040] Homogeneous matrix of a joint in the right arm for:

[0041]

[0042] in, Let be the homogeneous transformation matrix from the first joint to the second joint of the left arm. Let be the homogeneous transformation matrix from the (j-1)th joint to the jth joint of the left arm. Let {i} be the coordinate system of the j-th joint of the right arm of the space dual-arm robot. j The rotation matrix relative to the inertial coordinate system {I}. Let {i} be the coordinate system pointing from the origin of the inertial coordinate system {I} to the coordinate system {i} of the j-th joint of the robot's right arm. j The position vector of the origin.

[0043] Steps 2-3 include: obtaining the linear and angular velocities of each link in the two arms from the geometric topology of the mobile spatial dual-arm robot.

[0044]

[0045] in, Let be the velocity vector of the center of mass of the i-th link in the left (right) arm in the inertial coordinate system. E is the angular velocity vector of the center of mass of the i-th link in the left or right arm in the inertial coordinate system. 3×3 It is a 3×3 identity matrix. Let be the position vector of the center of mass of the i-th link in the left or right arm in the inertial coordinate system. Let be the position vector of the center of mass of the i-th link in either the left or right arm relative to the movable base. Let be the translational Jacobian matrix of the center of mass of the i-th link in the left or right arm in the inertial coordinate system. Let be the rotational Jacobian matrix of the i-th link's center of mass in the left or right arm in the inertial coordinate system, 0. 3×(n-i) Given a 3-row, ni-column matrix with all elements equal to 0, Let be the angular velocity of the i-th joint of the left or right arm in the inertial coordinate system. It is the normal vector of the i-th joint of the left or right arm.

[0046] The linear velocity and angular velocity of the left arm end effector in the dual-arm system are obtained from geometric relationships:

[0047]

[0048] in These represent the velocity and angular velocity vectors of the left arm end effector in the inertial coordinate system, respectively. Let be the position vector of the end effector of the left arm in the inertial coordinate system. The position vector of the center of mass of the i-th link of the left arm in the inertial coordinate system; the linear velocity and angular velocity expressions of the end effector of the right arm in the dual-arm system are similar to those in equation (8), and will not be repeated here. Definition:

[0049]

[0050]

[0051] in, The linear and angular velocities of the end effectors of the left and right arms. These are the linear velocity and angular velocity of the right arm end effector, respectively; the generalized velocity is combined into... These are the position vectors of the end effectors of the left and right arms, respectively. These are the position vectors of the left and right end effectors relative to the movable base, respectively. It is the position vector of the first to nth joints of the left arm in the inertial coordinate system. It is the position vector of the first to nth joints of the right arm in the inertial coordinate system. It is the Jacobian matrix between the movable base and the space dual-arm robot. It is the Jacobian matrix between the movable base and the joint space of the spatial dual-arm robot. It is the generalized Jacobian matrix of the operation space;

[0052] From equation (9), we get:

[0053]

[0054] in, It is the pseudo-inverse of J.

[0055] Steps 2-4 include: constructing the velocity relationship between the polygonal structure module and the end effector as follows:

[0056]

[0057] in, It is the speed of the space module. It is the speed of the end effector of the left or right arm. For the coordinate system of the left or right arm end effector {e k The Jacobian matrix of the origin relative to the origin of the coordinate system {M} is expressed as:

[0058]

[0059] in, The center of mass of the space module points to the end effector e of the robotic arm. k The position vector.

[0060] Incorporating the positive kinematics of a single robot end effector into a multi-robot coupled model, we obtain:

[0061]

[0062] in, The velocity vector of the dual-arm end effector. This is the Jacobian matrix between the polygonal structure module and the end effector.

[0063] Inverting equation (13) yields the kinematic model of the coupled system of the spatial dual-arm robot and the polygonal structure module:

[0064]

[0065] in, It is the velocity vector of the space module. It is J te The false rebellion, It is the Jacobian matrix between the space module and the joints of the space robot's two arms.

[0066] Steps 2-5 include: The dynamic expression of the rigid space module is:

[0067]

[0068] in, It is the acceleration of the space module, matrix The inertial mass matrix of the structural module is expressed as: m M For the quality of the polygonal structure module, Let be the inertia matrix of the structural module relative to its own coordinate system {M}. F represents the resultant force (moment) exerted by the end effector on the polygonal structural module; tx ,F ty ,F tz These are the effects applied along the I-axis by the dual-arm end effector to the polygonal structure module. x ,I y ,I z The resultant force in the axial direction, τ tx ,τ ty ,τ tz These are the dual-arm end effectors applying pressure along the I-axis to the polygonal structure module. x ,I y ,I z Resultant moment in the axial direction;

[0069] Steps 2-6 include: Considering a space robot with N degrees of freedom and only rotational joints in a coupled system, the robot's energy is expressed using the Lagrangian function as follows:

[0070]

[0071] in, These represent the total kinetic energy and total potential energy of a single robot system, respectively. yes and The difference; let

[0072] The total kinetic energy is the sum of the kinetic energies of the movable base and each link. The kinetic energy function is constructed as follows:

[0073]

[0074] Where ω is the angular velocity of each link, I is the inertia matrix of each link, m represents the mass of the link, and v represents the angular velocity of the link.

[0075] Equation (7) yields the linear velocity and angular velocity at the center of mass of the links in the space dual-arm robot. For the first link of the left arm, its linear velocity and angular velocity are expressed as:

[0076]

[0077] in, The position vector of the center of mass of the first link in the left arm. These are the coordinates of the center of mass of the first link of the left arm relative to the movable base. It is the translational Jacobian matrix of the first link in the left arm. It is the rotation Jacobian matrix of the first link in the left arm. It is the angular velocity of the first joint of the left arm;

[0078] The total kinetic energy of the left arm link 1 is:

[0079]

[0080] in, It is the mass of the first link of the left arm. This is the inertia matrix of the first link in the left arm; the kinetic energies of the other links can be expressed similarly.

[0081] Adding the kinetic energies of each link in both arms, and considering the movable base, we combine the joint variables of the movable base and the dual-arm robot into a generalized variable, obtaining the total kinetic energy of the movable dual-arm robot system as follows:

[0082]

[0083]

[0084] Where M1 is the mass matrix of the mobile dual-arm robot system, M 11 M 12 M 13 M 14 M 22 M 23 M 24 M 33 M 34 M44 It is a submatrix of M1, and M1 is a symmetric matrix; These are the translational and rotational parts of the Jacobian matrix of the i-th link in the left arm, respectively. These are the translational and rotational components of the Jacobian matrix for the j-th link of the right arm, respectively. I r g r is the position vector of the centroid of the mobile dual-arm robot system. o-g = I r g - I r o It is the position vector of the system's center of mass relative to the center of mass of the movable base. I r i , I r j These are the position vectors of the center of mass of each link in the left and right arms, respectively. I r i-o = I r i - I r o It is the position vector of the center of mass of each link in the left arm relative to the center of mass of the movable base. I r j-o = I r j - I r o It is the position vector of the center of mass of each link in the right arm relative to the center of mass of the movable base, I o It is the inertia matrix of the base, I i I is the inertia matrix of the i-th link in the left arm. j It is the inertia matrix of the j-th link in the right arm. It is an n1-row, n2-column matrix of zeros;

[0085] The terms in the Coriolis force matrix are obtained from the Lagrange equations:

[0086]

[0087] Among them, c ij M is the element in the i-th row and j-th column of the Coriolis matrix. ij It is the element in the i-th row and j-th column of M1, M jk It is the element in row j and column k of M1, q k It represents the position (rotation angle or position) of the k-th variable in the generalized coordinate system, q. i It represents the position (rotation angle or position) of the i-th variable in the generalized coordinate system. The elements of the mass inertia matrix M1 are the pairs of q in the generalized coordinate system. k The partial derivatives, The elements of the mass matrix M1 are the pairs of q in the generalized coordinates. i The partial derivatives;

[0088] The dynamic model of a mobile dual-arm robot can be written in the following form:

[0089]

[0090] in, This represents the resultant force exerted by each joint of the space robot on the end effector. This indicates that the end effector of the two arms is subjected to the resultant force exerted by the external environment, F. e1 T H e1 T These are the resultant force and resultant torque exerted on the left arm end effector by the external environment, F. e2 T H e2 T These are the resultant force and resultant torque exerted on the right arm end effector by the external environment. The inertial matrix represents the inertial matrix of a space robot. The Coriolis matrix represents the space robot.

[0091] Steps 2-7 include: The relationship between the resultant force applied to the structural module and the resultant force exerted on the end effector by the external environment is as follows:

[0092] F t =J te T F e (33)

[0093] in,

[0094] get: It is J te T The false reversal;

[0095] Substituting equation (33) into equation (32) and combining it with equation (15), we get:

[0096]

[0097] Differentiating equation (14) yields:

[0098]

[0099] Substituting into equation (34), we obtain the final dynamic equation of the coupled system:

[0100]

[0101] in, It is the mass matrix of a mobile dual-arm robot system. It is the Coriolis matrix of a mobile dual-arm robot system.

[0102] Step 3 includes: designing the following motion controller:

[0103]

[0104] Among them, K P ,K D These are the proportional gain coefficient and the differential gain coefficient, It is the expected position of the generalized coordinates. I q(t) is the real-time position of the mobile dual-arm robot. It is the derivative of the difference between the two with respect to time t.

[0105] This invention establishes a dynamic coupling model between the robot and the structural modules, achieving a precise description of the system's coupled dynamics. Based on this, the invention further designs a motion controller for rapid tracking and control of the desired pose of the structural modules to be assembled. Through theoretical analysis and simulation verification, the proposed method effectively improves the control accuracy and system stability of mobile space robots in on-orbit assembly tasks, providing reliable technical support for the autonomous construction of large space structures.

[0106] Beneficial effects: This invention proposes an on-orbit assembly strategy for large space structures, providing reliable technical support for the autonomous on-orbit assembly of large space structures and promoting the automation of space construction; by establishing a dynamic coupling model between the mobile dual-arm robot and the space structure module, a precise description of the interaction of complex systems is achieved, laying a theoretical foundation for high-precision control; the designed motion controller can quickly track the desired pose of the mobile dual-arm robot and the structural module to be assembled, significantly improving the response speed and trajectory tracking accuracy during the assembly process and enhancing the stability of the system. Attached Figure Description

[0107] The present invention will be further described in detail below with reference to the accompanying drawings and specific embodiments, and the advantages of the present invention in the above and / or other aspects will become clearer.

[0108] Figure 1 This is a schematic diagram of an on-orbit assembly scheme for a large space structure based on a mobile dual-arm robot.

[0109] Figure 2 The base is along coordinate axis I x Directional displacement and velocity curves.

[0110] Figure 3 It is a graph showing the base rotation angle and angular velocity.

[0111] Figure 4 It is applied to the base along coordinate axis Ix A diagram illustrating the force that causes directional movement.

[0112] Figure 5 It is applied to the base around coordinate axis I x A schematic diagram of the rotational torque.

[0113] Figure 6 It is a curve showing the changes in the position of the three joints of the left arm over time.

[0114] Figure 7 It is a curve showing the change of angular velocity of the three joints of the left arm over time.

[0115] Figure 8 It is a curve showing how the torque required to reach the target position of the three joints of the left arm changes over time.

[0116] Figure 9 It is a curve showing the changes in the position of the three joints of the right arm over time.

[0117] Figure 10 It is a curve showing the change in velocity of the three joints of the right arm over time.

[0118] Figure 11 It is a curve showing how the torque required to reach the target position of the three joints of the right arm changes over time.

[0119] Figure 12 This is a three-dimensional path diagram of the space module.

[0120] Figure 13 The spatial module is on coordinate axis I x The curve showing the displacement in the axial direction as a function of time.

[0121] Figure 14 The spatial module is on coordinate axis I y The curve showing the displacement in the axial direction as a function of time.

[0122] Figure 15 The spatial module is on coordinate axis I z The curve showing the displacement in the axial direction as a function of time. Detailed Implementation

[0123] This invention provides a control method for on-orbit assembly of large space structures using a mobile dual-arm robot, comprising the following steps:

[0124] Step 1: Design the on-orbit assembly mechanism;

[0125] The large-scale space structure based on a mobile dual-arm robot mainly consists of a base spacecraft, support rods, the mobile dual-arm robot, polygonal structural modules to be assembled, and a modular large-scale space structure. The base spacecraft is equipped with square solar panels to provide power; the support rods start at the center of mass of the base spacecraft and end at the center of mass of the modular large-scale space structure being assembled; the mobile dual-arm robot consists of a mobile base and two multi-degree-of-freedom robotic arms. The mobile base can move linearly along the rods and also rotate freely around them, transporting the structural modules to be assembled and completing the assembly by reciprocating along the support rods. The assembled modular large-scale space structure is a movable ring-shaped structure with a diameter of 100m in orbit, which can be divided into multiple polygonal structural modules.

[0126] Considering the mobile dual-arm robot, the following on-orbit assembly scheme was customized: The support rod and the mobile dual-arm robot are pre-placed in the storage compartment of the base spacecraft. Upon receiving the assembly start command, the support rod exits the compartment, and the rotary joints on the support rod rotate to unfold the rod. Once fully unfolded, the rotary joints lock, and the support rod becomes an inextensible rigid rod. Subsequently, the mobile dual-arm robot exits the compartment, and the end effectors on its robotic arms jointly grasp a polygonal structural module. While the mobile base moves along and rotates around the rod, the robot drives the joints to rotate. Both work together to manipulate the polygonal structural module, precisely transporting it to the pre-assembly position according to the target pose.

[0127] 100 m After the large-caliber space target structure is assembled, the movable dual-arm robot moves back to the storage compartment of the base spacecraft. The rotary joints on the support rods unlock, and the support rods can then be regarded as space robotic arms, adjusting the pose of the large-caliber space target structure in real time by changing the joint angles on them. A schematic diagram of the on-orbit assembly is shown below. Figure 1 As shown.

[0128] Step 2, dynamic coupling modeling;

[0129] To achieve precise on-orbit assembly of the modular large-scale space structure according to the assembly plan, the dynamic coupling between the module to be assembled and the mobile dual-arm robot is a key issue that needs to be addressed during the assembly task. Therefore, it is necessary to establish a dynamic coupling model between the robot and the structural module to provide a theoretical basis for subsequent controller design. The steps are described below based on the assembly plan:

[0130] Step 2-1: Establish a coordinate system and define the symbols for the physical quantities of the system.

[0131] I (·) indicates that · represents the coordinate system {I} in the inertial coordinate system. i(·) indicates that · represents the coordinate system {i} of the link. The symbol · represents the coordinate system of the end effector {e}. k}, k represents the left (right) arm; B (·) indicates that · represents the coordinate system of the spatial module {B}. The antisymmetric matrix is ​​represented by ·. Let represent the space of m×n-dimensional real matrices, and Let m represent the real vector space of size m×1.

[0132] The position vector representing the centroid (CM) of the coupled system; These represent the position vector and Euler angle of the center of mass of the movable base, respectively; This represents the position vector of the end effector of arm k (l or r); This represents the position vector of the movable base's centroid pointing towards the left (right) connection point; The vector coordinates represent the centroids of the i-th link in the left arm and the j-th link in the right arm of the robot. The position vector representing the centroid of the polygonal structure module; This represents the position vector from the current link's center of mass to the current link's end point; The inertia matrix represents the movable base, structural module, and the i-th (j-th) link of the left (right) arm; and Indicate the velocity and angular velocity of the center of mass of the i-th link in the robot's left arm; and Indicate the velocity and angular velocity of the center of mass of the j-th link in the robot's right arm; and Let represent the vector coordinates of the end of the i(j)th link in the left and right arms of the robot. The degrees of freedom of the left and right arms are n1 and n2, respectively.

[0133] The joint angles of the robot's left and right arms are and express; These represent the joint angular velocities of the robot's left and right arms, respectively.

[0134] Generalized coordinates: q = [r0θ0q1 q2] T Generalized speed:

[0135] The following settings are made: the base is a 2m × 2m × 2m cube, the base moves along the x-direction of the rod, and the center of mass of the base is [x22]. T Then the coordinates of the connection point between the left arm and the base are [x 1 2]. T The coordinates of the connection point between the right arm and the base are [x 3 2].T .

[0136] Step 2-2: Establish the forward kinematics model of the space robot system.

[0137] The movable base can move along the rod and rotate around the rod simultaneously, having two degrees of freedom. The homogeneous coordinate matrix of the movable base's pose is represented by the Euler angles in the horizontal x-direction and the x-axis normal:

[0138]

[0139] The homogeneous coordinate matrix from the base to the left connecting point (the connection point between the base and the left arm) is:

[0140]

[0141] Similarly, the homogeneous coordinate matrix of the right connect point in the inertial coordinate system can be represented as:

[0142]

[0143] The homogeneous coordinate matrix of each link coordinate system {A} of the space robot relative to the previous link coordinate system {A-1} is obtained from the DH parameters:

[0144]

[0145] Consider a spatial dual-arm robot with n degrees of freedom, where each joint is a rotary joint. The forward kinematics model of this robot can be obtained by multiplying the homogeneous matrices of each link.

[0146] Homogeneous matrix of the left arm:

[0147]

[0148] in, Coordinate system of the left arm of the space dual-arm robot The rotation matrix relative to the inertial coordinate system {I} The origin of the inertial coordinate system {I} points to the coordinate system of the robot's left arm. The position vector of the origin.

[0149] Homogeneous matrix of the right arm:

[0150]

[0151] in, Coordinate system of the right arm of the space dual-arm robot The rotation matrix relative to the inertial coordinate system {I} The origin of the inertial coordinate system {I} points to the robot's right arm coordinate system. The position vector of the origin.

[0152] Steps 2-3 involve performing differential kinematics analysis on the space dual-arm robot to obtain the mapping relationship between the system velocity and the end effector velocity.

[0153] from Figure 1 The geometric topology of the mid-space robot allows us to obtain the linear and angular velocities of each link in both arms:

[0154]

[0155] in,

[0156] Let be the normal vector of the i-th joint of the left (right) arm.

[0157] The linear velocity and angular velocity of the end effector of the dual-arm system can be obtained from geometric relationships:

[0158]

[0159] definition Let the coordinate system of the left (right) arm end effector be {e k The generalized velocity vector relative to the inertial frame {I}. Expressing the above equation using matrices:

[0160]

[0161] Among them, E 3×3 It is a 3×3 identity matrix.

[0162] It is the Jacobian matrix between the movable base and the space dual-arm robot. It is the Jacobian matrix between the movable base and the joint space of the spatial dual-arm robot. It is the generalized Jacobian matrix of the operation space, which includes not only the kinematic parameters of the system but also the dynamic parameters of the system, reflecting the kinematic coupling of the mobile space assembly robot system. From the above equation (9), we get:

[0163]

[0164] in, It is the pseudo-inverse of J.

[0165] Steps 2-4 establish a coupled kinematic model of the space dual-arm robot and the polygonal structural module, that is, a coupled kinematic model of N robotic arms cooperating to grasp a polygonal structural module. It is assumed at this point that the space robot and the structural module are rigidly grasped, and no relative motion occurs between them.

[0166] It is known that the velocity relationship between the polygonal structure module and the end effector can be constructed as follows:

[0167]

[0168] in, For coordinate system {e k The Jacobian matrix of the origin relative to the origin of coordinate system {B} is expressed as:

[0169]

[0170] in, The centroid of the polygonal structure module points towards the end effector e of the robotic arm. k The position vector.

[0171] Incorporating the positive kinematics of a single robot end effector into the multi-robot coupling model discussed in this method, we obtain:

[0172]

[0173] in, This is the Jacobian matrix between the polygonal structure module and the end effector.

[0174] Inverting equation (13) yields the kinematic model of the spatial dual-arm robot coupled with the polygonal structural module system:

[0175]

[0176] in, It is J te The false rebellion,

[0177] Steps 2-5: Establish the dynamic model of the polygonal structure module.

[0178] According to Newton's second law, the dynamic expression of a rigid space module is:

[0179]

[0180] in,

[0181] matrix The inertial mass matrix of the structural module is expressed as: For the quality of the structural modules, Let {B} be the inertia matrix of the structural module relative to the coordinate system {B}. This represents the resultant force and resultant torque exerted by the end effector on the polygonal structural module.

[0182] Steps 2-6: Establish the dynamic model of the mobile dual-arm robot.

[0183] Consider a space robot with N degrees of freedom and only rotational joints in a coupled system. The robot's energy can be expressed using the Lagrangian function as follows:

[0184]

[0185] in, Let represent the total kinetic energy and total potential energy of the single robot system, respectively. Since the robot system operates in a space environment, it is free from gravity, which allows for... The total kinetic energy is the sum of the kinetic energies of the movable base and each link. The kinetic energy function is constructed as follows:

[0186]

[0187] The linear velocity and angular velocity at the center of mass of the space robot link are obtained from equation (7). Here, we take the left arm link 1 as an example for calculation:

[0188]

[0189] The total kinetic energy of the left arm link 1 is:

[0190]

[0191] Adding the kinetic energies of each link in both arms, and considering the movable base, the total kinetic energy of the movable dual-arm robot system is:

[0192]

[0193] Where, r o-g =r g -r o ,r i-o =r i -r o r j-o =r j -r o I o It is the inertia matrix of the base, I i I is the inertia matrix of the i-th link in the left arm. j It is the inertia matrix of the j-th link of the right arm.

[0194]

[0195]

[0196] The terms in the Coriolis force matrix can be obtained from the Lagrange equations:

[0197]

[0198] The dynamic model of the mobile dual-arm robot can be written in the following concise form:

[0199]

[0200] in, This represents the resultant force exerted by each joint of the space robot on the end effector. This indicates that the end effector is subjected to the resultant force exerted by the external environment. The inertial matrix represents the inertial matrix of a space robot. The Coriolis matrix represents the space robot.

[0201] Steps 2-7: Establish the dynamic model of the coupled structural module of the movable dual-arm robot.

[0202] The relationship between the resultant force applied to the structural module and the resultant force exerted on the end effector by the external environment is as follows:

[0203] F t =J te T F e (33)

[0204] in,

[0205] From the above formula, we can obtain: It is J te T The false rebellion.

[0206] Substituting equation (33) into equation (32) and combining it with equation (15), we get:

[0207]

[0208] Differentiating equation (14) yields:

[0209]

[0210] Substituting into equation (34), we obtain the final dynamic equation of the coupled system:

[0211]

[0212] in,

[0213] Step 3, design the motion controller;

[0214] To achieve precise and efficient control of complex coupled structures, the following motion controller is designed:

[0215]

[0216] in, q(t) is the expected position of the generalized coordinates, and q(t) is the real-time position of the movable dual-arm robot.

[0217] Step 4, simulation verification;

[0218] The accuracy of the proposed modeling method is verified using a 3-DOF mobile dual-arm robot.

[0219] The parameters for setting the spatial structure are shown in Tables 1, 2, and 3.

[0220] Table 1

[0221]

[0222] Table 2

[0223]

[0224]

[0225] Table 3

[0226]

[0227] Set the controller parameters to 5 and 20 respectively, and design the controller based on the aforementioned design parameters. Input these parameters... Figure 1 The simulation system shown can be used for numerical simulation to obtain results such as... Figure 2 , Figure 3 , Figure 4 , Figure 5 , Figure 6 , Figure 7 , Figure 8 , Figure 9 , Figure 10 , Figure 11 , Figure 12 , Figure 13 , Figure 14 , Figure 15 The dynamic response curves are shown. Simulation results show that, under the control strategy designed in this method, the movable base of the space robot system can quickly converge to the desired position and desired attitude angle within a finite time; simultaneously, the structural modules can accurately reach the target pose. Notably, throughout the entire attitude maneuver, the left and right robotic arms of the coupled system maintain a stable pose state, a phenomenon that fully verifies the accuracy of the established dynamic model and the effectiveness of the control strategy.

[0228] This invention provides a control method for on-orbit assembly of large spatial structures using a mobile dual-arm robot. Many methods and approaches exist for implementing this technical solution; the above description is merely a preferred embodiment of the invention. It should be noted that those skilled in the art can make various improvements and modifications without departing from the principles of this invention, and these improvements and modifications should also be considered within the scope of protection of this invention. All components not explicitly stated in this embodiment can be implemented using existing technologies.

Claims

1. A control method for on-orbit assembly of large space structures by a mobile dual-arm robot, characterized in that, Includes the following steps: Step 1, Design the on-orbit assembly mechanism: The large space structure based on the mobile dual-arm robot includes the base spacecraft, support rods, mobile dual-arm robot, polygonal structural modules to be assembled, and modular large space structure. Step 2, dynamic coupling modeling; includes the following steps: Step 2-1: Establish a coordinate system and define the symbols for the physical quantities of the system. Step 2-2: Establish the forward kinematics model of the space robot system; Steps 2-3 involve performing differential kinematics analysis on the space dual-arm robot to obtain the mapping relationship between the generalized and end effector velocities; Steps 2-4: Establish a coupled kinematic model of the space dual-arm robot and the polygonal structure module, that is, a coupled kinematic model of N robotic arms cooperating to grasp a polygonal structure module. It is set that the space robot and the polygonal structure module are rigidly grasped and there will be no relative motion between the space robot and the polygonal structure module. Steps 2-5: Establish the dynamic model of the polygonal structure module; Steps 2-6: Establish the dynamic model of the mobile dual-arm robot; Steps 2-7: Establish the dynamic model of the coupled structural module of the movable dual-arm robot; Step 3, design the motion controller; Step 1 includes: the base spacecraft is equipped with square solar panels that provide energy; The starting end of the support rod is located at the center of mass of the base spacecraft, and the ending end is located at the center of mass of the modular large space structure being assembled. The movable dual-arm robot includes a movable base and two multi-degree-of-freedom robotic arms. The movable base can move linearly along the rod and can also rotate freely around the rod. It can transport the structural module to be assembled and complete the assembly by moving back and forth on the support rod. The completed modular large-scale space structure is a movable ring structure with a diameter of 100m that can operate in orbit. The movable ring structure can be divided into two or more polygonal structural modules. The following on-orbit assembly scheme is formulated: The support rod and the movable dual-arm robot are pre-placed in the storage compartment of the base spacecraft. Upon receiving the assembly start command, the support rod exits the compartment, and the rotary joints on the support rod rotate to cooperate with the expansion of the support rod. After the support rod is fully expanded, the rotary joints lock, and the support rod becomes an inextensible rigid rod. Subsequently, the movable dual-arm robot exits the compartment, and the end effectors on the robotic arms jointly grasp a polygonal structural module. While the movable base moves along the rod and rotates around the rod, the movable dual-arm robot drives the joints to rotate. The movable base and the dual-arm joints jointly manipulate the polygonal structural module, accurately transporting the polygonal structural module to be assembled to the pre-assembly position according to the target pose. After the 100m diameter movable ring structure is assembled, the movable dual-arm robot moves back to the storage compartment of the base spacecraft. The rotary joints on the support rod are unlocked. At this time, the support rod is regarded as a space robotic arm. The position and posture of the large space target structure are adjusted in real time by changing the joint angles on the space robotic arm.

2. The method according to claim 1, characterized in that, Step 2-1 includes: Indicates will This indicates that in the inertial coordinate system {I}, These are the three orthogonal coordinate axes of the inertial coordinate system, and their directions are consistent with the components corresponding to the Earth coordinate system. Indicates will This is indicated in the coordinate system {o} of the base centroid. Indicates will Represents the coordinate system of the centroid of the end effector. In the diagram, k takes the value l to represent the left arm and k takes the value r to represent the right arm; Indicates will In the coordinate system {A} of the link's center of mass, Indicates will This is represented in the centroid coordinate system of the spatial module {M}; Represented as antisymmetric matrix, represent A dimensional real matrix space, express The real vector space; This represents the position vector of the centroid of the coupled system. This represents the position vector of the end effector of arm k. This represents the position vector of the movable base's center of mass pointing towards the connection point of the left or right arm. Let represent the vector coordinates of the center of mass of the i-th link in the left arm and the j-th link in the right arm, respectively. This represents the position vector of the centroid of the polygonal structure module. This represents the position vector from the current link's center of mass to the current link's end point; Let represent the inertia matrix of the movable base, the inertia matrix of the structural module, and the inertia matrix of the i-th link of the left arm. and Let the velocity and angular velocity of the center of mass of the i-th link in the robot's left arm be represented, respectively. and Let their respective values ​​represent the velocity and angular velocity of the center of mass of the j-th link in the robot's right arm. This represents the vector coordinates of the end of the i-th link of the robot's left arm. Let represent the vector coordinates of the end of the j-th link of the robot's right arm, and let represent the degrees of freedom of the left arm and the right arm respectively. ; The joint angles of the robot's left arm and right arm are respectively... and T represents the transpose of the vector matrix; These represent the rotation angles of each joint in the robot's left arm. These represent the rotation angles of each joint of the robot's right arm; The generalized coordinate q is: ,in These are the coordinates of the base in the inertial coordinate system, setting the support rod along... If placed along the axis, then It is along Coordinates along the axial direction, base along The coordinates in the axial direction are all remain unchanged. It is the attitude vector matrix of the base. These are the Euler angles of the base's orientation, because the base rotates around the support rod, so the base can only rotate around... The Euler angles of the axis rotation are changing, that is... ; Generalized speed for: , It is the velocity vector of the base, only in The velocity changes along the axial direction. The velocity in the axial direction is always 0. It is the angular velocity of the base. , These represent the joint angular velocities of the robot's left arm and right arm, respectively. These represent the angular velocities of each joint in the robot's left arm. These represent the angular velocities of each joint in the robot's right arm; The following settings are made: The base is A cube, the base moves along the direction of the rod, the center of mass of the base is... Then the coordinates of the connection point between the left arm and the base are The coordinates of the connection point between the right arm and the base are: .

3. The method according to claim 2, characterized in that, Step 2-2 includes: the movable base can move along the rod and rotate around the rod simultaneously, having 2 degrees of freedom; the homogeneous coordinate matrix of the movable base's pose. for: (1), in It is the base around The attitude angle of the axis rotation; Homogeneous coordinate matrix of the first joint of the left arm In the inertial coordinate system, {I} is represented as: (2), in This is the representation of the transformation relationship between the homogeneous coordinate matrix of the base and the homogeneous coordinate matrix of the left arm at the connection point of the base in the inertial coordinate system; Homogeneous coordinate matrix of the first joint of the right arm In the inertial coordinate system, {I} is represented as: (3), in This is the representation of the transformation relationship between the homogeneous coordinate matrix of the base and the homogeneous coordinate matrix of the right arm located at the connection point of the base in the inertial coordinate system; For a spatial dual-arm robot with n degrees of freedom, each joint is a rotary joint, and the robot's forward kinematics model is obtained by multiplying the homogeneous matrices of each joint. Homogeneous matrix of a joint in the left arm for: (5), in, Let be the homogeneous transformation matrix from the first joint to the second joint of the left arm. Let be the homogeneous transformation matrix from the (n-1)th joint to the nth joint of the left arm. Let { be the coordinate system of the nth joint of the left arm of the space dual-arm robot} The rotation matrix relative to the inertial coordinate system {I}. Let {I} be the coordinate system pointing from the origin of the inertial coordinate system {I} to the coordinate system of the nth joint of the robot's left arm {I}. The position vector of the origin; Homogeneous matrix of a joint in the right arm for: (6), in, Let be the homogeneous transformation matrix from the first joint to the second joint of the left arm. Let be the homogeneous transformation matrix from the (j-1)th joint to the jth joint of the left arm. Let { be the coordinate system of the j-th joint of the right arm of the space dual-arm robot} The rotation matrix relative to the inertial coordinate system {I}. Let {I} be the coordinate system pointing from the origin of the inertial coordinate system {I} to the j-th joint coordinate system of the robot's right arm {j}. The position vector of the origin.

4. The method according to claim 3, characterized in that, Steps 2-3 include: obtaining the linear and angular velocities of each link in the two arms from the geometric topology of the mobile spatial dual-arm robot. (7), in, Let be the velocity vector of the center of mass of the i-th link in the left (right) arm in the inertial coordinate system. Let be the angular velocity vector of the center of mass of the i-th link in the left or right arm in the inertial coordinate system. yes The identity matrix, Let be the position vector of the center of mass of the i-th link in the left or right arm in the inertial coordinate system. Let be the position vector of the center of mass of the i-th link in the left or right arm relative to the movable base. Let be the translational Jacobian matrix of the center of mass of the i-th link in the left or right arm in the inertial coordinate system. Let be the rotational Jacobian matrix of the i-th link's center of mass in the inertial coordinate system in either the left or right arm. 3 lines A matrix whose columns are all zero. Let be the angular velocity of the i-th joint of the left or right arm in the inertial coordinate system. It is the normal vector of the i-th joint of the left or right arm; The linear velocity and angular velocity of the left arm end effector in the dual-arm system are obtained from geometric relationships: (8), in , These represent the velocity and angular velocity vectors of the left arm end effector in the inertial coordinate system, respectively. Let be the position vector of the end effector of the left arm in the inertial coordinate system. The position vector of the center of mass of the i-th link in the left arm in the inertial coordinate system; definition: , (9), in, The linear and angular velocities of the end effectors of the left and right arms. , These are the linear velocity and angular velocity of the right arm end effector, respectively; the generalized velocity is combined into... , , These are the position vectors of the end effectors of the left and right arms, respectively. , These are the position vectors of the left and right end effectors relative to the movable base, respectively. … It is the position vector of the first to nth joints of the left arm in the inertial coordinate system. … It is the position vector of the first to nth joints of the right arm in the inertial coordinate system. It is the Jacobian matrix between the movable base and the space dual-arm robot. It is the Jacobian matrix between the movable base and the joint space of the spatial dual-arm robot. It is the generalized Jacobian matrix of the operation space; From equation (9), we get: (10) , in, yes The false rebellion, , .

5. The method according to claim 4, characterized in that, Steps 2-4 include: constructing the velocity relationship between the polygonal structure module and the end effector as follows: (11), in, It is the speed of the space module. It is the speed of the end effector of the left or right arm. For the coordinate system of the left or right arm end effector The Jacobian matrix of the origin relative to the origin of the coordinate system {M} is expressed as: (12), in, , The center of mass of the space module points to the end effector of the robotic arm. Position vector; Incorporating the positive kinematics of a single robot end effector into a multi-robot coupled model, we obtain: (13), in, The velocity vector of the dual-arm end effector. This is the Jacobian matrix between the polygonal structure module and the end effector; Inverting equation (13) yields the kinematic model of the coupled system of the spatial dual-arm robot and the polygonal structure module: (14), in, It is the velocity vector of the space module. , yes The false rebellion, It is the Jacobian matrix between the space module and the joints of the space robot's two arms.

6. The method according to claim 5, characterized in that, Steps 2-5 include: The dynamic expression of the rigid space module is: (15), in, It is the acceleration of the space module, matrix The inertial mass matrix of the structural module is expressed as: , For the quality of the polygonal structure module, Let be the inertia matrix of the structural module relative to its own coordinate system {M}. This represents the resultant force exerted by the end effector on the polygonal structural module; These are the along-axis forces applied by the dual-arm end effectors to the polygonal structural module. The resultant force in the axial direction, These are the dual-arm end effectors applying pressure along the polygonal structure module. The resultant moment in the axial direction.

7. The method according to claim 6, characterized in that, Steps 2-6 include: Considering a space robot with N degrees of freedom and only rotational joints in a coupled system, the robot's energy is expressed using the Lagrangian function as follows: (16), in, These represent the total kinetic energy and total potential energy of a single robot system, respectively. yes and The difference; let ; The total kinetic energy is the sum of the kinetic energies of the movable base and each link. The kinetic energy function is constructed as follows: (17), in, It is the angular velocity of each link. It is the inertia matrix of each link. Represents the mass of the connecting rod. Represents the angular velocity of the connecting rod; Equation (7) yields the linear velocity and angular velocity at the center of mass of the links in the space dual-arm robot. For the first link of the left arm, its linear velocity and angular velocity are expressed as: (18), in, The position vector of the center of mass of the first link in the left arm. These are the coordinates of the center of mass of the first link of the left arm relative to the movable base. It is the translational Jacobian matrix of the first link in the left arm. It is the rotation Jacobian matrix of the first link in the left arm. It is the angular velocity of the first joint of the left arm; The total kinetic energy of the left arm link 1 is: (19), in, It is the mass of the first link of the left arm. It is the inertia matrix of the first link in the left arm; Adding the kinetic energies of each link in both arms, and considering the movable base, we combine the joint variables of the movable base and the dual-arm robot into a generalized variable, obtaining the total kinetic energy of the movable dual-arm robot system as follows: (20), (21), (22), (23), (24), (25), (26), (27), (28), (29), (30), in, It is the mass matrix of a mobile dual-arm robot system. , , yes The submatrix, and It is a symmetric matrix; , These are the translational and rotational parts of the Jacobian matrix of the i-th link in the left arm, respectively. , These are the translational and rotational components of the Jacobian matrix for the j-th link of the right arm, respectively. It is the position vector of the centroid of the mobile dual-arm robot system. It is the position vector of the system's center of mass relative to the center of mass of the movable base. , These are the position vectors of the center of mass of each link in the left and right arms, respectively. It is the position vector of the center of mass of each link in the left arm relative to the center of mass of the movable base. It is the position vector of the center of mass of each link in the right arm relative to the center of mass of the movable base. It is the inertia matrix of the base. It is the inertia matrix of the i-th link in the left arm. It is the inertia matrix of the j-th link in the right arm. yes OK A zero matrix of columns; The terms in the Coriolis force matrix are obtained from the Lagrange equations: (31), in, It is the element in the i-th row and j-th column of the Coriolis matrix. yes The element in the i-th row and j-th column, yes The element in the j-th row and k-th column, It is the position of the k-th variable in the generalized coordinate system. It is the position of the i-th variable in the generalized coordinate system. It is the mass inertia matrix In generalized coordinates of element pairs The partial derivatives, It is a mass matrix In generalized coordinates of element pairs The partial derivatives; The dynamic model of a mobile dual-arm robot can be written in the following form: (32), in, This represents the resultant force exerted by each joint of the space robot on the end effector. This indicates that the end effectors of the two arms are subjected to the resultant force exerted by the external environment. These are the resultant force and resultant torque exerted on the left arm end effector by the external environment. These are the resultant force and resultant torque exerted on the right arm end effector by the external environment. The inertia matrix represents the inertia matrix of a space robot. The Coriolis matrix represents the space robot.

8. The method according to claim 7, characterized in that, Steps 2-7 include: The relationship between the resultant force applied to the structural module and the resultant force exerted on the end effector by the external environment is as follows: (33), in, ; get: , yes The false reversal; Substituting equation (33) into equation (32) and combining it with equation (15), we get: (34), Differentiating equation (14) yields: (35), Substituting into equation (34), we obtain the final dynamic equation of the coupled system: (36), in, It is the mass matrix of a mobile dual-arm robot system. It is the Coriolis matrix of a mobile dual-arm robot system.

9. The method according to claim 8, characterized in that, Step 3 includes: designing the following motion controller: (37), in, These are the proportional gain coefficient and the differential gain coefficient, It is the expected position of the generalized coordinates. It shows the real-time position of the mobile dual-arm robot. It is the difference between the two in terms of time. Find the derivative.

Citation Information

Patent Citations

  • Motion coordination control method for space dual-manipulator system

    CN106945020A

  • Compliant control method and device for on-orbit assembly of double-arm robot

    CN117182929A