A multi-body system dynamics analysis method, device, electronic device and storage medium

By applying the external action of the subsystem to the equivalent centroid, the overall dynamic equilibrium equation system is constructed, and the problems of inconsistent assembly complexity and interface in multi-body dynamics software are solved, and fast and accurate dynamic analysis is achieved .

CN118690591BActive Publication Date: 2024-11-08深圳十沣科技有限公司
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411195037.4
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2024-08-29
Publication Date
2024-11-08
Estimated Expiration
2044-08-29

AI Technical Summary

Technical Problem

During the subsystem assembly process of existing multi-body dynamics software, the degree of freedom of the internal rigid body needs to be open, and the external interface parameters are not unified, resulting in complex assembly and error-prone, and it is impossible to realize unified characterization and rapid dynamic analysis of interfaces between subsystems.

Method used

By applying all external effects of the subsystem to the degrees of freedom of the equivalent centroid, an overall dynamic equilibrium equation system is constructed, and the degrees of freedom and binding force of the equivalent centroid are solved, and the position and posture information of the internal rigid body unit of the subsystem are determined by applying all external effects of the subsystem to the degrees of freedom of the equivalent centroid. .

Benefits of technology

It realizes unified characterization of interfaces between subsystems, simplifies the assembly process, and quickly determines the position and attitude information of the internal rigid body unit of the multi-body system, improving analysis efficiency and accuracy.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118690591B_ABST
    Figure CN118690591B_ABST
Patent Text Reader

Abstract

The present application provides a multi-body system dynamics analysis method, device, electronic device and storage medium, including: constructing the internal constraint relationship of each subsystem of the multi-body system; determining the equivalent center of mass of the subsystem based on the distribution state of each internal rigid unit of the subsystem at the current moment; for the subsystem, the external connection relationship between the subsystem and other subsystems is applied to the subsystem in the form of constraint force or constraint torque to determine the equivalent constraint force of the equivalent center of mass of the subsystem; constructing the overall dynamic equilibrium equations based on the internal constraint relationship, equivalent constraint force and equivalent center of mass of each subsystem, solving the overall dynamic equilibrium equations, and determining the position information and posture information of the internal rigid units of each subsystem at the current moment. Thus, the position information and posture information of the internal rigid units of each subsystem of the multi-body system can be quickly determined.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present application relates to the technical field of multi-body mechanical systems, and in particular to a multi-body system dynamics analysis method, device, electronic device and storage medium. Background Art

[0002] In multi-body dynamics simulation and analysis software, using the subsystem method to build the overall system is an effective way to achieve complex multi-body system modeling. In this type of method, when a subsystem is assembled into the overall system, all the connection relationships between the subsystem and the overall system need to be assembled into the overall equation. The current multi-body dynamics software handles these constraints by directly constructing constraint equations between the two rigid bodies associated with the constraint, and directly constraining the constraint through the relationship between the degrees of freedom of rigid body C1 and rigid body A1. Introduce and use the constraint relationship between rigid body C2 and rigid body B3 . This processing method will lead to the following problems: the assembly process needs to establish constraint relationships between the degrees of freedom of the internal rigid bodies of different subsystems, which means that the degrees of freedom of these internal rigid bodies connected to the outside need to be open to the outside. At the same time, the number of degrees of freedom of different subsystems connected to the outside and the sequence number of the degrees of freedom in the subsystem are different, which makes the external interface parameters of each subsystem different. When connecting between subsystems, the number of external connections of different subsystems cannot be forced to be unified, and the establishment of a single connection relationship must also act directly on the internal rigid body. On the other hand, similar technologies currently use the internal rigid body degrees of freedom as an external interface, which cannot achieve unified interface representation, resulting in complex assembly process relationships, cumbersome processing, and prone to errors. Therefore, how to achieve the same representation of the interface between subsystems and quickly perform dynamic analysis on the assembled system has become a technical issue that cannot be underestimated. Summary of the invention

[0003] In view of this, the purpose of the present application is to provide a multi-body system dynamics analysis method, device, electronic device and storage medium, in which all external forces of the subsystem are applied to the degrees of freedom of the equivalent center of mass. The degrees of freedom of the equivalent center of mass become the external interface of the subsystem, and the overall dynamic equilibrium equations are constructed according to the internal constraint relationship, equivalent constraint force and equivalent center of mass of each subsystem. The overall dynamic equilibrium equations are solved to quickly determine the position information and posture information of the internal rigid body units of each subsystem of the multi-body system.

[0004] The present application provides a multi-body system dynamics analysis method, the multi-body system dynamics analysis method comprising:

[0005] Constructing the internal constraint relationship of each subsystem of the multi-body system; wherein, if the multi-body system is a humanoid robot, the subsystem is any one of the torso, left lower limb, right lower limb, left upper limb and right upper limb of the humanoid robot;

[0006] Based on the distribution state of each internal rigid body unit of each subsystem at the current moment, determining the equivalent center of mass of each subsystem;

[0007] For each of the subsystems, the external connection relationship between the subsystem and other subsystems is applied to the subsystem in the form of a constraint force or a constraint moment, and the constraint force or the constraint moment is equivalently applied to the equivalent center of mass of the subsystem to determine the equivalent constraint force of the equivalent center of mass of the subsystem;

[0008] Based on the internal constraint relationship of each subsystem, the equivalent constraint force and the equivalent center of mass, an overall dynamic equilibrium equation group is constructed, and the Lagrange multipliers corresponding to the degrees of freedom of the equivalent center of mass of each subsystem of the overall dynamic equilibrium equation group and the equivalent constraint force between subsystems are solved to determine the position information and posture information of the internal rigid body units of each subsystem at the current moment.

[0009] In a possible implementation manner, the constructing of internal constraint relationships of each subsystem of the multi-body system includes:

[0010] Based on the rotation relationship of the internal rigid body units of the subsystem of the multi-body system in the simulation model, determining the constraint relationship of the relative degrees of freedom between two of the internal rigid body units in the three-dimensional space;

[0011] Based on the constraint relationship of the relative degrees of freedom between every two of the internal rigid body units, the internal constraint relationship of the subsystem is constructed.

[0012] In a possible implementation manner, for any of the subsystems, determining the equivalent center of mass of each of the subsystems based on the distribution state of each internal rigid unit of each of the subsystems at the current moment includes:

[0013] Determine the mass information and center of mass coordinate information of each internal rigid body unit of the subsystem at the current moment;

[0014] Determining the mass of the equivalent center of mass based on the sum of mass information of each internal rigid body unit;

[0015] Determining the position of the equivalent center of mass based on the mass information of each internal rigid body unit and the mass of the equivalent center of mass;

[0016] The moment of inertia is determined based on the calculation function of the equivalent moment of inertia and the mass information of each internal rigid body unit and the mass of the equivalent center of mass.

[0017] In a possible implementation manner, for each of the subsystems, the external connection relationship between the subsystem and the other subsystems is applied to the subsystem in the form of a constraint force or a constraint moment, and the constraint force or the constraint moment is applied equivalently to the equivalent center of mass of the subsystem to determine the equivalent constraint force of the equivalent center of mass of the subsystem, including:

[0018] Based on the external connection relationship between the subsystem and other subsystems, determining the constrained degrees of freedom between the internal rigid body units of the subsystem and the internal rigid body units of other subsystems;

[0019] Apply the constraint force or constraint torque of the displacement constraint equation corresponding to the constrained degree of freedom to the internal rigid body unit of the subsystem, and use the constraint force or constraint torque corresponding to the displacement constraint equation as the external load of the subsystem to be equivalent to the equivalent center of mass of the subsystem, and determine the equivalent constraint force of the equivalent center of mass of the subsystem; wherein, if the constrained degree of freedom is a degree of freedom of translational constraint, the displacement constraint equation corresponds to the constraint force, and if the constrained degree of freedom is a degree of freedom of rotational constraint, the displacement constraint equation corresponds to the constraint torque;

[0020] Apply the constraint reaction force corresponding to the constraint force or constraint moment to the internal rigid body unit of the other subsystem, the constraint reaction force acts on the connecting parts between the internal rigid body unit of the subsystem and the internal rigid body unit of the other subsystem, and use the constraint reaction force as the external load of the other subsystem to be equivalent to the equivalent center of mass of the other subsystem, and determine the equivalent constraint force of the equivalent center of mass of the other subsystem;

[0021] The constraint reaction force is the Jacobian matrix of the displacement constraint equation multiplied by a variable Lagrange multiplier, and the size of the Lagrange multiplier depends on the motion state.

[0022] In a possible implementation manner, the step of using the constraint force or constraint moment corresponding to the shift constraint equation as an external load of the subsystem to be equivalent to the equivalent center of mass of the subsystem to determine the equivalent constraint force of the equivalent center of mass of the subsystem includes:

[0023] Based on the equivalent processing formula, the constraint force or constraint moment corresponding to the shift constraint equation is equivalently processed to obtain the equivalent constraint force of the equivalent center of mass of the subsystem.

[0024] In a possible implementation manner, solving the Lagrange multipliers corresponding to the degrees of freedom of the equivalent center of mass of each subsystem of the overall dynamic equilibrium equation group and the equivalent constraint forces between subsystems to determine the position information and posture information of the internal rigid body units of each subsystem at the current moment includes:

[0025] Solving the degrees of freedom of the equivalent center of mass of each subsystem of the overall dynamic equilibrium equations and the Lagrange multipliers corresponding to each of the equivalent constraint forces between the subsystems, and determining the degrees of freedom of the equivalent center of mass of each subsystem and the Lagrange multipliers corresponding to the equivalent constraint forces between the subsystems;

[0026] Determine the constraint reaction force between the subsystems based on the Lagrange multipliers corresponding to the equivalent constraint forces between the subsystems and the Jacobian matrix of the displacement constraint equations between the subsystems;

[0027] Based on the constraint reaction forces between the subsystems and the degrees of freedom of the equivalent center of mass of the subsystems, the state information of the internal rigid body units of each subsystem is solved to determine the position information and posture information of the internal rigid body units of each subsystem at the current moment.

[0028] The embodiment of the present application further provides a multi-body system dynamics analysis device, the multi-body system dynamics analysis device comprising:

[0029] A construction module, used to construct the internal constraint relationship of each subsystem of the multi-body system; wherein, if the multi-body system is a humanoid robot, the subsystem is any one of the torso, left lower limb, right lower limb, left upper limb and right upper limb of the humanoid robot;

[0030] A multi-body system equivalent center of mass determination module, used to determine the equivalent center of mass of each subsystem based on the distribution state of each internal rigid body unit of each subsystem at the current moment;

[0031] An equivalent constraint force determination module is used to, for each of the subsystems, apply the external connection relationship between the subsystem and other subsystems to the subsystem in the form of a constraint force or a constraint moment, and apply the constraint force or the constraint moment equivalently to the equivalent center of mass of the subsystem to determine the equivalent constraint force of the equivalent center of mass of the subsystem;

[0032] The state information determination module is used to construct an overall dynamic equilibrium equation group based on the internal constraint relationship of each subsystem, the equivalent constraint force and the equivalent center of mass, solve the Lagrange multipliers corresponding to the degrees of freedom of the equivalent center of mass of each subsystem of the overall dynamic equilibrium equation group and the equivalent constraint force between subsystems, and determine the position information and posture information of the internal rigid body units of each subsystem at the current moment.

[0033] In a possible implementation manner, when the construction module is used to construct the internal constraint relationship of each subsystem of the multi-body system, the construction module is specifically used to:

[0034] Based on the rotation relationship of the internal rigid body units of the subsystem of the multi-body system in the simulation model, determining the constraint relationship of the relative degrees of freedom between two of the internal rigid body units in the three-dimensional space;

[0035] Based on the constraint relationship of the relative degrees of freedom between every two of the internal rigid body units, the internal constraint relationship of the subsystem is constructed.

[0036] An embodiment of the present application also provides an electronic device, including: a processor, a memory and a bus, wherein the memory stores machine-readable instructions executable by the processor, and when the electronic device is running, the processor and the memory communicate through the bus, and when the machine-readable instructions are executed by the processor, the steps of the multi-body system dynamics analysis method as described above are performed.

[0037] An embodiment of the present application further provides a computer-readable storage medium having a computer program stored thereon. When the computer program is executed by a processor, the steps of the multi-body system dynamics analysis method as described above are executed.

[0038] The embodiment of the present application provides a multi-body system dynamics analysis method, device, electronic device and storage medium, the multi-body system dynamics analysis method comprising: constructing the internal constraint relationship of each subsystem of the multi-body system; wherein, if the multi-body system is a humanoid robot, the subsystem is any one of the torso, left lower limb, right lower limb, left upper limb and right upper limb of the humanoid robot; based on the distribution state of each internal rigid body unit of each subsystem at the current moment, determining the equivalent center of mass of each subsystem; for each subsystem, external connections between the subsystem and other subsystems are connected; The relationship acts on the subsystem in the form of a constraint force or a constraint torque, and the constraint force or the constraint torque is equivalently applied to the equivalent center of mass of the subsystem to determine the equivalent constraint force of the equivalent center of mass of the subsystem; based on the internal constraint relationship of each subsystem, the equivalent constraint force and the equivalent center of mass, the overall dynamic equilibrium equation group is constructed, and the Lagrange multipliers corresponding to the degrees of freedom of the equivalent center of mass of each subsystem of the overall dynamic equilibrium equation group and the equivalent constraint force between subsystems are solved to determine the position information and posture information of the internal rigid body units of each subsystem at the current moment. All external actions of the subsystem are applied to the degrees of freedom of the equivalent center of mass, and the equivalent center of mass degrees of freedom become the external interface of the subsystem. According to the internal constraint relationship, equivalent constraint force and equivalent center of mass of each subsystem, the overall dynamic equilibrium equation group is constructed, and the overall dynamic equilibrium equation group is solved so that the position information and posture information of the internal rigid body units of each subsystem of the multi-body system can be quickly determined.

[0039] In order to make the above-mentioned objects, features and advantages of the present application more obvious and easy to understand, preferred embodiments are specifically cited below and described in detail with reference to the attached drawings. BRIEF DESCRIPTION OF THE DRAWINGS

[0040] In order to more clearly illustrate the technical solutions of the embodiments of the present application, the drawings required for use in the embodiments will be briefly introduced below. It should be understood that the following drawings only show certain embodiments of the present application and therefore should not be regarded as limiting the scope. For ordinary technicians in this field, other related drawings can be obtained based on these drawings without paying creative work.

[0041] Figure 1 One of the flow charts of a multi-body system dynamics analysis method provided in an embodiment of the present application;

[0042] Figure 2 The second flowchart of a multi-body system dynamics analysis method provided in an embodiment of the present application;

[0043] Figure 3A schematic diagram of the structure of a multi-body system dynamics analysis device provided in an embodiment of the present application;

[0044] Figure 4 A schematic diagram of the structure of an electronic device provided in an embodiment of the present application. DETAILED DESCRIPTION

[0045] To make the purpose, technical scheme and advantages of the embodiments of the present application clearer, the technical scheme in the embodiments of the present application will be clearly and completely described below in conjunction with the drawings in the embodiments of the present application. Obviously, the described embodiments are only a part of the embodiments of the present application, rather than all of the embodiments. The components of the embodiments of the present application usually described and shown in the drawings here can be arranged and designed in various different configurations. Therefore, the following detailed description of the embodiments of the present application provided in the drawings is not intended to limit the scope of the application claimed for protection, but merely represents the selected embodiments of the present application. Based on the embodiments of the present application, each other embodiment obtained by those skilled in the art without making creative work belongs to the scope of protection of the present application.

[0046] First, the application scenarios to which the present application is applicable are introduced. The present application can be applied to the technical field of multi-body mechanical systems.

[0047] Research has found that in multi-body dynamics simulation and analysis software, using the subsystem method to build the overall system is an effective way to achieve complex multi-body system modeling. In this type of method, when a subsystem is assembled into the overall system, all the connection relationships between the subsystem and the overall system need to be assembled into the overall equation. The current multi-body dynamics software handles these constraints by directly constructing constraint equations between the two rigid bodies associated with the constraint, and directly using the relationship between the degrees of freedom of rigid body C1 and rigid body A1 to directly constrain the constraint. Introduce and use the constraint relationship between rigid body C2 and rigid body B3 . This processing method will lead to the following problems: the assembly process needs to establish constraint relationships between the degrees of freedom of the internal rigid bodies of different subsystems, which means that the degrees of freedom of these internal rigid bodies connected to the outside need to be open to the outside. At the same time, the number of degrees of freedom of different subsystems connected to the outside and the sequence number of the degrees of freedom in the subsystem are different, which makes the external interface parameters of each subsystem different. When connecting between subsystems, the number of external connections of different subsystems cannot be forced to be unified, and the establishment of a single connection relationship must also act directly on the internal rigid body. On the other hand, similar technologies currently use the internal rigid body degrees of freedom as an external interface, which cannot achieve unified interface representation, resulting in complex assembly process relationships, cumbersome processing, and prone to errors. Therefore, how to achieve the same representation of the interface between subsystems and quickly perform dynamic analysis on the assembled system has become a technical issue that cannot be underestimated.

[0048] Based on this, an embodiment of the present application provides a multi-body system dynamics analysis method, in which all external forces of the subsystem are applied to the degrees of freedom of the equivalent center of mass. The equivalent center of mass degrees of freedom become the external interface of the subsystem, and the overall dynamic equilibrium equations are constructed according to the internal constraint relationships, equivalent constraint forces and equivalent center of mass of each subsystem. The overall dynamic equilibrium equations are solved to quickly determine the position information and posture information of the internal rigid body units of each subsystem of the multi-body system.

[0049] See also Figure 1 , Figure 1 This is one of the flow charts of a multi-body system dynamics analysis method provided in the embodiment of the present application. Figure 1 As shown in , the multi-body system dynamics analysis method provided by the embodiment of the present application includes:

[0050] S101: Constructing internal constraint relationships of each subsystem of a multi-body system; wherein, if the multi-body system is a humanoid robot, the subsystem is any one of the torso, left lower limb, right lower limb, left upper limb and right upper limb of the humanoid robot.

[0051] In this step, the internal constraint relationships of each subsystem of the multi-body system are constructed.

[0052] In a possible implementation manner, the constructing of internal constraint relationships of each subsystem of the multi-body system includes:

[0053] A: Based on the rotation relationship of the internal rigid body units of the subsystems of the multi-body system in the simulation model, the constraint relationship of the relative degrees of freedom between two of the internal rigid body units in the three-dimensional space is determined.

[0054] Here, the constraint relationship of the relative degrees of freedom between two internal rigid body units in three-dimensional space is determined according to the rotation relationship between the internal rigid body units of the subsystems of the multi-body system pre-set in the simulation model.

[0055] Among them, the subsystem for the torso includes internal rigid body units such as the torso, waist, hips, head and the connecting joints between them; the subsystem for the left lower limb includes internal rigid body units such as the left thigh, left calf, left foot and the connecting joints between them; the subsystem for the right lower limb includes internal rigid body units such as the right thigh, right calf, right foot and the connecting joints between them.

[0056] Here, in three-dimensional space, two relatively independent rigid bodies A and B The relative degrees of freedom between A Rigid body as the reference, when the rigid body A, B When there is no constraint relationship between B Rigid bodies can be relatively A The rigid body can move arbitrarily in three mutually perpendicular directions, and can also rotate arbitrarily in three mutually perpendicular directions. Constructing a constraint relationship means limiting part or all of these six relative degrees of freedom.

[0057] B: Based on the constraint relationship of the relative degrees of freedom between every two of the internal rigid body units, the internal constraint relationship of the subsystem is constructed.

[0058] Here, the internal constraint relationship of the subsystem is constructed according to the constraint relationship of the relative degrees of freedom between every two internal rigid body units.

[0059] For example, when three mutually perpendicular rotation pairs are used to connect the torso and head of a multi-body system, the multi-body system is kept upright and the torso is kept stationary. The head can be twisted left and right along the axis of gravity, or rotated along the second vertical direction to tilt the head left and right, or rotated along the third vertical direction to nod forward and tilt the head backward, but the head cannot translate away from the torso. In this case, the constraint relationship between the torso and the head is to constrain the three relative translational degrees of freedom and the three relative rotational degrees of freedom between the two. Similarly, the constraint relationship between each rigid body is constructed within each subsystem. Taking the torso as an example, in addition to constructing the constraint relationship between the torso and the head to constrain the three translational constraints, the torso also needs to construct the constraint relationship between the torso and the waist, and the waist and the hip in turn, and then complete the construction of all the constraint relationships within the torso. Similarly, the construction of the internal constraint relationships of the other subsystems is further completed.

[0060] S102: Determine the equivalent center of mass of each subsystem based on the distribution state of each internal rigid body unit of each subsystem at the current moment.

[0061] In this step, the equivalent center of mass of each subsystem is determined according to the distribution state of each internal rigid unit of each subsystem at the current moment.

[0062] In a possible implementation manner, for any of the subsystems, determining the equivalent center of mass of each of the subsystems based on the distribution state of each internal rigid unit of each of the subsystems at the current moment includes:

[0063] a: Determine the mass information and center of mass coordinate information of each internal rigid body unit of the subsystem at the current moment.

[0064] Here, the mass information and center of mass coordinate information of each internal rigid body unit of the subsystem at the current moment are determined.

[0065] b: Based on the sum of the mass information of each internal rigid body unit, the mass of the equivalent center of mass is determined.

[0066] Here, the mass of the equivalent center of mass is determined based on the sum of the mass information of each internal rigid body unit.

[0067] c: Based on the mass information of each internal rigid body unit and the mass of the equivalent center of mass, determine the position of the equivalent center of mass.

[0068] Here, the position of the equivalent center of mass is determined based on the mass information of each internal rigid body unit and the mass of the equivalent center of mass.

[0069] For example, calculate the equivalent center of mass position, mass and moment of inertia at a certain moment in the walking process. The masses of the left thigh, left calf and left foot are recorded as m1, m2 and m3. The center of mass coordinates of these three parts at the current moment are (x1, y1, z1), (x2, y2, z2) and (x3, y3, z3). The equivalent mass Mc of the left lower limb is: Mc = m1+ m2+ m3. The position of the equivalent center of mass of the left lower limb (Xc, Yc, Zc) is: Xc = (m1 x1+ m2 x2+ m3 x3) / Mc,Yc = (m1 y1+ m2 y2+ m3 y3) / Mc,Zc = (m1 z1+ m2 z2+ m3 z3) / Mc.

[0070] d: Determine the moment of inertia based on the calculation function of the equivalent moment of inertia and the mass information of each internal rigid body unit and the mass of the equivalent center of mass.

[0071] Here, the moment of inertia is determined based on the calculation function of the equivalent moment of inertia and the mass information of each internal rigid body unit and the mass of the equivalent center of mass.

[0072] The equivalent moment of inertia Jc of the left lower limb can also be expressed as a function of the mass and position of each component: Jc=f(m1,m2,m3,(x1,y1,z1),(x2,y2,z2),(x3,y3,z3)). The function for constructing Jc can be constructed in different forms according to different system characteristics. One of the commonly used forms is as follows: Jc is a symmetric tensor containing 6 components), Jcxx= m1 (y1- Yc) 2 +(z1- Zc) 2 )+m2 ((y2− yc) 2 +(z2− Zc) 2 )+ m3 ((y3- yc) 2 +(z3- Zc) 2 ),Jcyy=m1 (x1 – Xc) 2 +(z1− Zc) 2 )+m2 ((x2− Xc) 2 +(x2-Xc) 2 )+m3 ((x3-Xc) 2 +(z3- Zc) 2 ),Jcz= m1 ((x1−Xc) 2 +(y1 − Yc) 2 )+m2 ((x2− Xc) 2 +(y2 − Yc) 2 )+m3 ((x3− Xc) 2 +(y3- Yc) 2 ),Jcxy = −m1 ((x1− Xc) (y1− Yc)−m2 ((x2- Is) (y2− O))−m3 ((x3- Is) (y3-Yc), Jcyz= -m1 (y1 – yc) (z1− Zc))−m2 ((y2- Yes) (z2- Zc)))-m3 ((y3- Yes) (z3- Zc))),Jcxz= -m1 ((x1−Xc) (z1− Zc)))−m2 ((x2− Xc) (z2− Zc))−m3 ((x3-Xc) (z3- Zc)))。

[0073] In this way, the equivalent center of mass of the subsystem is calculated by the mass of each component inside it and its current position, describing the instantaneous equivalent center of gravity of the subsystem. Therefore, different distribution states of internal components will change the position of the equivalent center of mass. Similarly, the equivalent moment of inertia also changes with different internal distribution states. Take the humanoid multi-body system described in the previous step as an example. When the multi-body system is in the process of walking, the various components of the multi-body system are constantly moving, and their positions and postures are constantly changing. Different components have different effects on the overall gait. At the same time, even if it is the same component, its effect on the overall balance will be quite different in different postures.

[0074] S103: For each of the subsystems, the external connection relationship between the subsystem and the other subsystems is applied to the subsystem in the form of a constraint force or a constraint torque, and the constraint force or the constraint torque is equivalently applied to the equivalent center of mass of the subsystem to determine the equivalent constraint force of the equivalent center of mass of the subsystem.

[0075] In this step, for each subsystem, the external connection relationship between the subsystem and other subsystems is applied to the subsystem in the form of a constraint force or a constraint torque, and the constraint force or the constraint torque is equivalently applied to the equivalent center of mass of the subsystem to determine the equivalent constraint force of the equivalent center of mass of the subsystem.

[0076] For further information, see Figure 2 , Figure 2 This is a second flow chart of a multi-body system dynamics analysis method provided in an embodiment of the present application. Figure 2 As shown, for each of the subsystems, the external connection relationship between the subsystem and other subsystems is applied to the subsystem in the form of a constraint force or a constraint moment, and the constraint force or the constraint moment is equivalently applied to the equivalent center of mass of the subsystem to determine the equivalent constraint force of the equivalent center of mass of the subsystem, including:

[0077] S201: Based on the external connection relationship between the subsystem and other subsystems, determine the constrained degrees of freedom between the internal rigid body units of the subsystem and the internal rigid body units of other subsystems.

[0078] In this step, the constrained degrees of freedom between the internal rigid body units of the subsystem and the internal rigid body units of other subsystems are determined according to the external connection relationship between the subsystem and other external systems.

[0079] Among them, the external connection relationships are all pre-set. Taking the humanoid multi-body system as an example, the torso and the left lower limb are connected by the revolute joint between the hip and the left thigh. There is one relative rotational degree of freedom between these two components, and the other five relative degrees of freedom are constrained. These five constraints are translational constraints in three directions and rotational constraints in two directions.

[0080] S202: Apply the constraint force or constraint torque of the displacement constraint equation corresponding to the constrained degree of freedom to the internal rigid body unit of the subsystem, and use the constraint force or constraint torque corresponding to the displacement constraint equation as the external load of the subsystem to be equivalent to the equivalent center of mass of the subsystem, and determine the equivalent constraint force of the equivalent center of mass of the subsystem.

[0081] In this step, the constraint force or constraint torque of the displacement constraint equation corresponding to the constrained degree of freedom acts on the internal rigid body unit of the subsystem, and the constraint force or constraint torque corresponding to the displacement constraint equation is used as the external load of the subsystem to be equivalent to the equivalent center of mass of the subsystem, and the equivalent constraint force of the equivalent center of mass of the subsystem is determined.

[0082] Here, for the connection relationship between subsystems, the displacement constraint equation is no longer used to describe the constraint relationship. Instead, the corresponding constraint reaction force is used to act on the two connected components. The constraint reaction force can be expressed as the Jacobian matrix of the constraint equation multiplied by a variable Lagrange multiplier. The size of the Lagrange multiplier depends on the state of motion.

[0083] Among them, if the constrained degree of freedom is a degree of freedom of translational constraint, the displacement constraint equation corresponds to the constraint force, and if the constrained degree of freedom is a degree of freedom of rotational constraint, the displacement constraint equation corresponds to the constraint torque.

[0084] In a possible implementation manner, the step of using the constraint force or constraint moment corresponding to the shift constraint equation as an external load of the subsystem to be equivalent to the equivalent center of mass of the subsystem to determine the equivalent constraint force of the equivalent center of mass of the subsystem includes:

[0085] Based on the equivalent processing formula, the constraint force or constraint moment corresponding to the shift constraint equation is equivalently processed to obtain the equivalent constraint force of the equivalent center of mass of the subsystem.

[0086] Here, the constraint force or constraint moment corresponding to the shift constraint equation is processed equivalently based on the equivalent processing formula to obtain the equivalent constraint force of the equivalent center of mass of the subsystem.

[0087] S203: Apply the constraint reaction force corresponding to the constraint force or constraint torque to the internal rigid body units of the other subsystems, the constraint reaction force acts on the connecting parts between the internal rigid body units of the subsystem and the internal rigid body units of the other subsystems, and use the constraint reaction force as the external load of the other subsystem to be equivalent to the equivalent center of mass of the other subsystem, and determine the equivalent constraint force of the equivalent center of mass of the other subsystem.

[0088] In this step, the constraint reaction force corresponding to the constraint force or constraint torque is applied to the internal rigid body unit of other subsystems, the constraint reaction force acts on the connecting parts between the internal rigid body unit of the subsystem and the internal rigid body unit of other subsystems, and the constraint reaction force is used as the external load of other subsystems to be equivalent to the equivalent center of mass of other subsystems, and the equivalent constraint force of the equivalent center of mass of other subsystems is determined.

[0089] The constraint reaction force is the Jacobian matrix of the displacement constraint equation multiplied by a variable Lagrange multiplier, and the size of the Lagrange multiplier depends on the motion state.

[0090] In the example, the trunk and the left lower limb are connected by the revolute joint between the hip and the left thigh. There is one relative rotational degree of freedom between the two components, and the other five relative degrees of freedom are all constrained. These five constraints are translational constraints in three directions and rotational constraints in two directions. That is, three constraint forces F1, F2, F3 and two constraint moments T1 and T2 corresponding to the five displacement constraint equations act on the hip, and at the same time, three reaction forces F1', F2', F3' and two reaction moments T1' and T2' are applied to the thigh, and the action position is the connection between the hip and the thigh. Then, F1, F2, F3, T1, and T2 are used as external loads of the trunk and are equivalent to the equivalent center of mass of the trunk. Similarly, F1', F2', F3', T1', and T2' are used as external loads of the left lower limb and are equivalent to the equivalent center of mass of the left lower limb. In this example, in addition to the connection between the torso and the left lower limb, the torso and the right lower limb are connected through the joint between the hip and the right thigh, so it is necessary to follow the above steps to apply the constraint force or constraint torque between the torso and each other subsystem to the equivalent center of mass of the torso.

[0091] S104: Construct an overall dynamic equilibrium equation group based on the internal constraint relationship of each subsystem, the equivalent constraint force and the equivalent center of mass, solve the Lagrange multipliers corresponding to the degrees of freedom of the equivalent center of mass of each subsystem of the overall dynamic equilibrium equation group and the equivalent constraint force between subsystems, and determine the position information and posture information of the internal rigid body units of each subsystem at the current moment.

[0092] In this step, the overall dynamic equilibrium equations are constructed according to the internal constraint relationships, equivalent constraint forces and equivalent center of mass of each subsystem. The Lagrange multipliers corresponding to the degrees of freedom of the equivalent center of mass of each subsystem of the overall dynamic equilibrium equations and the equivalent constraint forces between subsystems are solved to determine the position information and posture information of the internal rigid body units of each subsystem at the current moment.

[0093] Among them, the equivalent constraint force between a subsystem and each other subsystem corresponds to a Lagrange multiplier.

[0094] Among them, the kinetic equilibrium equation is an existing calculation formula, which will not be described in detail in this section.

[0095] Specifically, each subsystem is assembled into the overall system to form the overall dynamic equilibrium equation of the system. The unknown vector of this equation only contains the degrees of freedom of the equivalent center of mass of each subsystem and the Lagrange multipliers corresponding to the constraints between subsystems. Taking the humanoid multibody system as an example, in the previous steps, the internal constraint relationships of the five subsystems of the humanoid multibody system and the connection relationships between the five subsystems have been built respectively. When assembling, the coefficient matrices corresponding to the internal constraint equations of subsystems 1, 2, 3, 4, and 5 are first assembled to the corresponding positions in the overall dynamic equilibrium equation in sequence, and then the coefficient matrices corresponding to the equivalent constraints between subsystems 1 and 2 are added to the equations corresponding to subsystems 1 and 2 respectively, and then the coefficient matrices corresponding to the equivalent constraints of subsystems 1 and 3, 1 and 4, and 1 and 5 are added in sequence. At the same time, the right-hand side of the overall dynamic equilibrium equation is assembled. The current unknowns of the overall equation are composed of the degrees of freedom of the equivalent center of mass of each of the five subsystems and the Lagrange multipliers corresponding to the constraints corresponding to the connection relationship between each group of subsystems. Among them, each equivalent center of mass contains 6 degrees of freedom, and the number of Lagrange multipliers depends on the number of constraints between subsystems. For example, there are 5 independent equivalent constraints between subsystem 1 and subsystem 2, which corresponds to 5 unknown Lagrange multipliers.

[0096] In a possible implementation manner, solving the Lagrange multipliers corresponding to the degrees of freedom of the equivalent center of mass of each subsystem of the overall dynamic equilibrium equation group and the equivalent constraint forces between subsystems to determine the position information and posture information of the internal rigid body units of each subsystem at the current moment includes:

[0097] (1): Solving the degrees of freedom of the equivalent center of mass of each subsystem of the overall dynamic equilibrium equation group and the Lagrange multiplier corresponding to each equivalent constraint force between the subsystems, and determining the degrees of freedom of the equivalent center of mass of each subsystem and the Lagrange multiplier corresponding to the equivalent constraint force between the subsystems.

[0098] Here, the degrees of freedom of the equivalent center of mass of each subsystem of the overall dynamic equilibrium equations and the Lagrange multipliers corresponding to each equivalent constraint force between the subsystems are solved to determine the degrees of freedom of the equivalent center of mass of each subsystem and the Lagrange multipliers corresponding to the equivalent constraint forces between the subsystems.

[0099] (2): Based on the Lagrange multipliers corresponding to the equivalent constraint forces between the subsystems and the Jacobian matrix of the displacement constraint equations between the subsystems, the constraint reaction forces between the subsystems are determined.

[0100] Here, the constraint reaction force between the subsystems is determined based on the Lagrange multipliers corresponding to the equivalent constraint forces between the subsystems and the Jacobian matrix of the displacement constraint equations between the subsystems.

[0101] (3): Based on the constraint reaction force between the subsystems and the degree of freedom of the equivalent center of mass of the subsystem, the state information of the internal rigid body unit of each subsystem is solved to determine the position information and posture information of the internal rigid body unit of each subsystem at the current moment.

[0102] Here, the state information of the internal rigid body units of each subsystem is solved according to the constraint reaction force between the subsystems and the degree of freedom of the equivalent center of mass of the subsystem, and the position information and posture information of the internal rigid body units of each subsystem at the current moment are determined.

[0103] Specifically, taking the humanoid robot system as an example, the overall dynamic equilibrium equations constructed in the previous step are solved to calculate the unknown vector, which includes the 6 degrees of freedom of the equivalent center of mass of each of the 5 subsystems, and the Lagrange multipliers corresponding to the constraint forces between the subsystems. Furthermore, the calculated Lagrange multipliers are multiplied by the Jacobian matrix of the constraint equations between the subsystems to obtain the constraint reaction forces between the subsystems. The constraint forces calculated in the previous step are used as the external loads of the corresponding subsystems, and the internal parts of each subsystem are solved to update the states of each rigid body in the subsystem. Taking the humanoid robot system as an example, the six degrees of freedom of the equivalent center of mass of the torso calculated in the previous step and the constraint reaction force of other subsystems acting on the torso are further converted to obtain the state of each rigid body inside the torso at the current moment, that is, the position and posture of the torso, head, waist and hip; similarly, the position and posture of the left thigh, left calf and left foot are converted according to the value of the six degrees of freedom of the equivalent center of mass of the left lower limb and the constraint reaction force of the torso acting on the left lower limb; in turn, the state of the internal rigid bodies of other subsystems can be updated. In this way, the state update of each rigid body in the entire humanoid multi-body system at the current moment is completed.

[0104] In this application, the degree of freedom of the equivalent center of mass is used as the external interface of the multi-body subsystem, thereby achieving a unified representation of the external interface of the multi-body subsystem.

[0105] An embodiment of the present application provides a multi-body system dynamics analysis method, which includes: constructing internal constraint relationships of each subsystem of the multi-body system; wherein the subsystem is any one of the trunk, left lower limb, right lower limb, left upper limb and right upper limb of the multi-body system; determining the equivalent center of mass of each subsystem based on the distribution state of each internal rigid body unit of each subsystem at the current moment; for each subsystem, acting on the subsystem with the external connection relationship between the subsystem and other subsystems in the form of constraint force or constraint torque, and applying the constraint force or constraint torque equivalently to the equivalent center of mass of the subsystem to determine the equivalent constraint force of the equivalent center of mass of the subsystem; constructing an overall dynamic equilibrium equation group based on the internal constraint relationship of each subsystem, the equivalent constraint force and the equivalent center of mass, solving the Lagrange multipliers corresponding to the degrees of freedom of the equivalent center of mass of each subsystem of the overall dynamic equilibrium equation group and the equivalent constraint force between subsystems, and determining the position information and posture information of the internal rigid body units of each subsystem at the current moment. All external forces of the subsystem are applied to the degrees of freedom of the equivalent center of mass. The degrees of freedom of the equivalent center of mass become the external interface of the subsystem. The overall dynamic equilibrium equations are constructed according to the internal constraint relationship, equivalent constraint force and equivalent center of mass of each subsystem. By solving the overall dynamic equilibrium equations, the position information and posture information of the internal rigid body units of each subsystem of the multi-body system can be quickly determined.

[0106] See also Figure 3 , Figure 3 This is a schematic diagram of the structure of a multi-body system dynamics analysis device provided in an embodiment of the present application. Figure 3 As shown in , the multi-body system dynamics analysis device 300 includes:

[0107] A construction module 310 is used to construct internal constraint relationships of each subsystem of the multi-body system; wherein, if the multi-body system is a humanoid robot, the subsystem is any one of the torso, left lower limb, right lower limb, left upper limb and right upper limb of the humanoid robot;

[0108] An equivalent center of mass determination module 320, configured to determine the equivalent center of mass of each subsystem based on the distribution state of each internal rigid unit of each subsystem at the current moment;

[0109] An equivalent constraint force determination module 330 is used to, for each of the subsystems, apply the external connection relationship between the subsystem and other subsystems to the subsystem in the form of a constraint force or a constraint moment, and apply the constraint force or the constraint moment equivalently to the equivalent center of mass of the subsystem to determine the equivalent constraint force of the equivalent center of mass of the subsystem;

[0110] The state information determination module 340 is used to construct an overall dynamic equilibrium equation group based on the internal constraint relationship of each subsystem, the equivalent constraint force and the equivalent center of mass, solve the Lagrange multipliers corresponding to the degrees of freedom of the equivalent center of mass of each subsystem of the overall dynamic equilibrium equation group and the equivalent constraint force between subsystems, and determine the position information and posture information of the internal rigid body units of each subsystem at the current moment.

[0111] Furthermore, when the construction module 310 is used to construct the internal constraint relationship of each subsystem of the multi-body system, the construction module 310 is specifically used to:

[0112] Based on the rotation relationship of the internal rigid body units of the subsystem of the multi-body system in the simulation model, determining the constraint relationship of the relative degrees of freedom between two of the internal rigid body units in the three-dimensional space;

[0113] Based on the constraint relationship of the relative degrees of freedom between every two of the internal rigid body units, the internal constraint relationship of the subsystem is constructed.

[0114] Further, when the equivalent center of mass determination module 320 is used for determining the equivalent center of mass of each subsystem based on the distribution state of each internal rigid unit of each subsystem at the current moment for any of the subsystems, the equivalent center of mass determination module 320 is specifically used for:

[0115] Determine the mass information and center of mass coordinate information of each internal rigid body unit of the subsystem at the current moment;

[0116] Determining the mass of the equivalent center of mass based on the sum of mass information of each internal rigid body unit;

[0117] Determining the position of the equivalent center of mass based on the mass information of each internal rigid body unit and the mass of the equivalent center of mass;

[0118] The moment of inertia is determined based on the calculation function of the equivalent moment of inertia and the mass information of each internal rigid body unit and the mass of the equivalent center of mass.

[0119] Further, when the equivalent constraint force determination module 330 is used to apply the external connection relationship between the subsystem and other subsystems to the subsystem in the form of a constraint force or a constraint moment, and apply the constraint force or the constraint moment equivalently to the equivalent center of mass of the subsystem to determine the equivalent constraint force of the equivalent center of mass of the subsystem, the equivalent constraint force determination module 330 is specifically used to:

[0120] Based on the external connection relationship between the subsystem and other subsystems, determining the constrained degrees of freedom between the internal rigid body units of the subsystem and the internal rigid body units of other subsystems;

[0121] Apply the constraint force or constraint torque of the displacement constraint equation corresponding to the constrained degree of freedom to the internal rigid body unit of the subsystem, and use the constraint force or constraint torque corresponding to the displacement constraint equation as the external load of the subsystem to be equivalent to the equivalent center of mass of the subsystem, and determine the equivalent constraint force of the equivalent center of mass of the subsystem; wherein, if the constrained degree of freedom is a degree of freedom of translational constraint, the displacement constraint equation corresponds to the constraint force, and if the constrained degree of freedom is a degree of freedom of rotational constraint, the displacement constraint equation corresponds to the constraint torque;

[0122] Apply the constraint reaction force corresponding to the constraint force or constraint moment to the internal rigid body unit of the other subsystem, the constraint reaction force acts on the connecting parts between the internal rigid body unit of the subsystem and the internal rigid body unit of the other subsystem, and use the constraint reaction force as the external load of the other subsystem to be equivalent to the equivalent center of mass of the other subsystem, and determine the equivalent constraint force of the equivalent center of mass of the other subsystem;

[0123] The constraint reaction force is the Jacobian matrix of the displacement constraint equation multiplied by a variable Lagrange multiplier, and the size of the Lagrange multiplier depends on the motion state.

[0124] Further, when the equivalent constraint force determination module 330 is used to use the constraint force or constraint moment corresponding to the shift constraint equation as the external load of the subsystem to be equivalent to the equivalent center of mass of the subsystem to determine the equivalent constraint force of the equivalent center of mass of the subsystem, the equivalent constraint force determination module 330 is specifically used to:

[0125] Based on the equivalent processing formula, the constraint force or constraint moment corresponding to the shift constraint equation is equivalently processed to obtain the equivalent constraint force of the equivalent center of mass of the subsystem.

[0126] Further, when the state information determination module 340 is used to solve the Lagrange multipliers corresponding to the degrees of freedom of the equivalent center of mass of each subsystem of the overall dynamic equilibrium equation group and the equivalent constraint forces between subsystems to determine the position information and posture information of the internal rigid body units of each subsystem at the current moment, the state information determination module 340 is specifically used to:

[0127] Solving the degrees of freedom of the equivalent center of mass of each subsystem of the overall dynamic equilibrium equations and the Lagrange multipliers corresponding to each of the equivalent constraint forces between the subsystems, and determining the degrees of freedom of the equivalent center of mass of each subsystem and the Lagrange multipliers corresponding to the equivalent constraint forces between the subsystems;

[0128] Determine the constraint reaction force between the subsystems based on the Lagrange multipliers corresponding to the equivalent constraint forces between the subsystems and the Jacobian matrix of the displacement constraint equations between the subsystems;

[0129] Based on the constraint reaction forces between the subsystems and the degrees of freedom of the equivalent center of mass of the subsystems, the state information of the internal rigid body units of each subsystem is solved to determine the position information and posture information of the internal rigid body units of each subsystem at the current moment.

[0130] The embodiment of the present application provides a multi-body system dynamics analysis device, which includes: a construction module, which is used to construct the internal constraint relationship of each subsystem of the multi-body system; wherein, if the multi-body system is a humanoid robot, the subsystem is any one of the torso, left lower limb, right lower limb, left upper limb and right upper limb of the humanoid robot; an equivalent center of mass determination module, which is used to determine the equivalent center of mass of each subsystem based on the distribution state of each internal rigid body unit of each subsystem at the current moment; an equivalent constraint force determination module, which is used to determine the external constraint relationship between each subsystem and other subsystems for each subsystem. The internal connection relationship acts on the subsystem in the form of a constraint force or a constraint torque, and the constraint force or the constraint torque is equivalently applied to the equivalent center of mass of the subsystem to determine the equivalent constraint force of the equivalent center of mass of the subsystem; a state information determination module is used to construct an overall dynamic equilibrium equation group based on the internal constraint relationship of each subsystem, the equivalent constraint force and the equivalent center of mass, solve the Lagrange multipliers corresponding to the degrees of freedom of the equivalent center of mass of each subsystem of the overall dynamic equilibrium equation group and the equivalent constraint force between subsystems, and determine the position information and posture information of the internal rigid body units of each subsystem at the current moment.

[0131] See also Figure 4 , Figure 4 This is a schematic diagram of the structure of an electronic device provided in an embodiment of the present application. Figure 4 As shown in , the electronic device 400 includes a processor 410 , a memory 420 and a bus 430 .

[0132] The memory 420 stores machine-readable instructions executable by the processor 410. When the electronic device 400 is running, the processor 410 communicates with the memory 420 via the bus 430. When the machine-readable instructions are executed by the processor 410, the above-mentioned Figure 1 as well as Figure 2 The steps of the multi-body system dynamics analysis method in the method embodiment shown, the specific implementation method can be found in the method embodiment, and will not be repeated here.

[0133] The present application also provides a computer-readable storage medium on which a computer program is stored. When the computer program is executed by a processor, the computer program can execute the above-mentioned Figure 1 as well as Figure 2 The steps of the multi-body system dynamics analysis method in the method embodiment shown, the specific implementation method can be found in the method embodiment, and will not be repeated here.

[0134] Those skilled in the art can clearly understand that, for the convenience and brevity of description, the specific working processes of the systems, devices and units described above can refer to the corresponding processes in the aforementioned method embodiments and will not be repeated here.

[0135] In the several embodiments provided in the present application, it should be understood that the disclosed systems, devices and methods can be implemented in other ways. The device embodiments described above are merely schematic. For example, the division of the units is only a logical function division. There may be other division methods in actual implementation. For example, multiple units or components can be combined or integrated into another system, or some features can be ignored or not executed. Another point is that the mutual coupling or direct coupling or communication connection shown or discussed can be through some communication interfaces, and the indirect coupling or communication connection of devices or units can be electrical, mechanical or other forms.

[0136] The units described as separate components may or may not be physically separated, and the components shown as units may or may not be physical units, that is, they may be located in one place or distributed on multiple network units. Some or all of the units may be selected according to actual needs to achieve the purpose of the solution of this embodiment.

[0137] In addition, each functional unit in each embodiment of the present application may be integrated into one processing unit, or each unit may exist physically separately, or two or more units may be integrated into one unit.

[0138] If the functions are implemented in the form of software functional units and sold or used as independent products, they can be stored in a non-volatile computer-readable storage medium that is executable by a processor. Based on this understanding, the technical solution of the present application, or the part that contributes to the prior art or the part of the technical solution, can be embodied in the form of a software product. The computer software product is stored in a storage medium, including several instructions for a computer device (which can be a personal computer, server, or network device, etc.) to execute all or part of the steps of the method described in each embodiment of the present application. The aforementioned storage medium includes: U disk, mobile hard disk, read-only memory (ROM), random access memory (RAM), disk or optical disk, and other media that can store program codes.

[0139] Finally, it should be noted that the above-described embodiments are only specific implementation methods of the present application, which are used to illustrate the technical solutions of the present application, rather than to limit them. The protection scope of the present application is not limited thereto. Although the present application is described in detail with reference to the above-mentioned embodiments, ordinary technicians in the field should understand that any technician familiar with the technical field can still modify the technical solutions recorded in the above-mentioned embodiments within the technical scope disclosed in the present application, or can easily think of changes, or make equivalent replacements for some of the technical features therein; and these modifications, changes or replacements do not make the essence of the corresponding technical solutions deviate from the spirit and scope of the technical solutions of the embodiments of the present application, and should be included in the protection scope of the present application. Therefore, the protection scope of the present application shall be based on the protection scope of the claims.

Claims

1. A multi-body system dynamics analysis method, characterized in that: The multi-body system dynamics analysis method comprises: Constructing the internal constraint relationship of each subsystem of the multi-body system; wherein, if the multi-body system is a humanoid robot, the subsystem is any one of the torso, left lower limb, right lower limb, left upper limb and right upper limb of the humanoid robot; Based on the distribution state of each internal rigid body unit of each subsystem at the current moment, determining the equivalent center of mass of each subsystem; For each of the subsystems, the external connection relationship between the subsystem and other subsystems is applied to the subsystem in the form of a constraint force or a constraint moment, and the constraint force or the constraint moment is equivalently applied to the equivalent center of mass of the subsystem to determine the equivalent constraint force of the equivalent center of mass of the subsystem; Based on the internal constraint relationship of each subsystem, the equivalent constraint force and the equivalent center of mass, an overall dynamic equilibrium equation group is constructed, and the Lagrange multipliers corresponding to the degrees of freedom of the equivalent center of mass of each subsystem of the overall dynamic equilibrium equation group and the equivalent constraint force between subsystems are solved to determine the position information and posture information of the internal rigid body unit of each subsystem at the current moment; The construction of internal constraint relationships of each subsystem of the multi-body system includes: Based on the rotation relationship of the internal rigid body units of the subsystem of the multi-body system in the simulation model, determining the constraint relationship of the relative degrees of freedom between two of the internal rigid body units in the three-dimensional space; Constructing the internal constraint relationship of the subsystem based on the constraint relationship of the relative degrees of freedom between every two of the internal rigid body units; For each of the subsystems, the external connection relationship between the subsystem and other subsystems is applied to the subsystem in the form of a constraint force or a constraint moment, and the constraint force or the constraint moment is applied equivalently to the equivalent center of mass of the subsystem to determine the equivalent constraint force of the equivalent center of mass of the subsystem, including: Based on the external connection relationship between the subsystem and other subsystems, determining the constrained degrees of freedom between the internal rigid body units of the subsystem and the internal rigid body units of other subsystems; Apply the constraint force or constraint torque of the displacement constraint equation corresponding to the constrained degree of freedom to the internal rigid body unit of the subsystem, and use the constraint force or constraint torque corresponding to the displacement constraint equation as the external load of the subsystem to be equivalent to the equivalent center of mass of the subsystem, and determine the equivalent constraint force of the equivalent center of mass of the subsystem; wherein, if the constrained degree of freedom is a degree of freedom of translational constraint, the displacement constraint equation corresponds to the constraint force, and if the constrained degree of freedom is a degree of freedom of rotational constraint, the displacement constraint equation corresponds to the constraint torque; Apply the constraint reaction force corresponding to the constraint force or constraint moment to the internal rigid body unit of the other subsystem, the constraint reaction force acts on the connecting parts between the internal rigid body unit of the subsystem and the internal rigid body unit of the other subsystem, and use the constraint reaction force as the external load of the other subsystem to be equivalent to the equivalent center of mass of the other subsystem, and determine the equivalent constraint force of the equivalent center of mass of the other subsystem; Wherein, the constraint reaction force is the Jacobian matrix of the displacement constraint equation multiplied by a variable Lagrange multiplier, and the size of the Lagrange multiplier depends on the motion state; Solving the Lagrange multipliers corresponding to the degrees of freedom of the equivalent center of mass of each subsystem of the overall dynamic equilibrium equation group and the equivalent constraint forces between subsystems to determine the position information and posture information of the internal rigid body units of each subsystem at the current moment includes: Solving the degrees of freedom of the equivalent center of mass of each subsystem of the overall dynamic equilibrium equations and the Lagrange multipliers corresponding to each of the equivalent constraint forces between the subsystems, and determining the degrees of freedom of the equivalent center of mass of each subsystem and the Lagrange multipliers corresponding to the equivalent constraint forces between the subsystems; Determine the constraint reaction force between the subsystems based on the Lagrange multipliers corresponding to the equivalent constraint forces between the subsystems and the Jacobian matrix of the displacement constraint equations between the subsystems; Based on the constraint reaction forces between the subsystems and the degrees of freedom of the equivalent center of mass of the subsystems, the state information of the internal rigid body units of each subsystem is solved to determine the position information and posture information of the internal rigid body units of each subsystem at the current moment.

2. The multi-body system dynamics analysis method according to claim 1, characterized in that: For any of the subsystems, determining the equivalent center of mass of each subsystem based on the distribution state of each internal rigid unit of each subsystem at the current moment includes: Determine the mass information and center of mass coordinate information of each internal rigid body unit of the subsystem at the current moment; Determining the mass of the equivalent center of mass based on the sum of mass information of each internal rigid body unit; Determining the position of the equivalent center of mass based on the mass information of each internal rigid body unit and the mass of the equivalent center of mass; The moment of inertia is determined based on the calculation function of the equivalent moment of inertia and the mass information of each internal rigid body unit and the mass of the equivalent center of mass.

3. The multi-body system dynamics analysis method according to claim 1, characterized in that: The step of using the constraint force or constraint moment corresponding to the shift constraint equation as the external load of the subsystem to be equivalent to the equivalent center of mass of the subsystem, and determining the equivalent constraint force of the equivalent center of mass of the subsystem, comprises: Based on the equivalent processing formula, the constraint force or constraint moment corresponding to the shift constraint equation is equivalently processed to obtain the equivalent constraint force of the equivalent center of mass of the subsystem.

4. A multi-body system dynamics analysis device, characterized in that: The multi-body system dynamics analysis device comprises: A construction module, used to construct the internal constraint relationship of each subsystem of the multi-body system; wherein, if the multi-body system is a humanoid robot, the subsystem is any one of the torso, left lower limb, right lower limb, left upper limb and right upper limb of the humanoid robot; An equivalent center of mass determination module, used to determine the equivalent center of mass of each subsystem based on the distribution state of each internal rigid unit of each subsystem at the current moment; An equivalent constraint force determination module is used to, for each of the subsystems, apply the external connection relationship between the subsystem and other subsystems to the subsystem in the form of a constraint force or a constraint moment, and apply the constraint force or the constraint moment equivalently to the equivalent center of mass of the subsystem to determine the equivalent constraint force of the equivalent center of mass of the subsystem; A state information determination module, for constructing an overall dynamic equilibrium equation group based on the internal constraint relationship of each subsystem, the equivalent constraint force and the equivalent center of mass, solving the Lagrange multipliers corresponding to the degrees of freedom of the equivalent center of mass of each subsystem of the overall dynamic equilibrium equation group and the equivalent constraint force between subsystems, and determining the position information and posture information of the internal rigid body unit of each subsystem at the current moment; When the construction module is used to construct the internal constraint relationship of each subsystem of the multi-body system, the construction module is specifically used to: Based on the rotation relationship of the internal rigid body units of the subsystem of the multi-body system in the simulation model, determining the constraint relationship of the relative degrees of freedom between two of the internal rigid body units in the three-dimensional space; Constructing the internal constraint relationship of the subsystem based on the constraint relationship of the relative degrees of freedom between every two of the internal rigid body units; When the equivalent constraint force determination module is used for each of the subsystems, the external connection relationship between the subsystem and other subsystems is applied to the subsystem in the form of a constraint force or a constraint moment, and the constraint force or the constraint moment is equivalently applied to the equivalent center of mass of the subsystem to determine the equivalent constraint force of the equivalent center of mass of the subsystem, the equivalent constraint force determination module is specifically used to: Based on the external connection relationship between the subsystem and other subsystems, determining the constrained degrees of freedom between the internal rigid body units of the subsystem and the internal rigid body units of other subsystems; Apply the constraint force or constraint torque of the displacement constraint equation corresponding to the constrained degree of freedom to the internal rigid body unit of the subsystem, and use the constraint force or constraint torque corresponding to the displacement constraint equation as the external load of the subsystem to be equivalent to the equivalent center of mass of the subsystem, and determine the equivalent constraint force of the equivalent center of mass of the subsystem; wherein, if the constrained degree of freedom is a degree of freedom of translational constraint, the displacement constraint equation corresponds to the constraint force, and if the constrained degree of freedom is a degree of freedom of rotational constraint, the displacement constraint equation corresponds to the constraint torque; Apply the constraint reaction force corresponding to the constraint force or constraint moment to the internal rigid body unit of the other subsystem, the constraint reaction force acts on the connecting parts between the internal rigid body unit of the subsystem and the internal rigid body unit of the other subsystem, and use the constraint reaction force as the external load of the other subsystem to be equivalent to the equivalent center of mass of the other subsystem, and determine the equivalent constraint force of the equivalent center of mass of the other subsystem; Wherein, the constraint reaction force is the Jacobian matrix of the displacement constraint equation multiplied by a variable Lagrange multiplier, and the size of the Lagrange multiplier depends on the motion state; When the state information determination module is used to solve the Lagrange multipliers corresponding to the degrees of freedom of the equivalent center of mass of each subsystem of the overall dynamic equilibrium equation group and the equivalent constraint forces between subsystems to determine the position information and posture information of the internal rigid body units of each subsystem at the current moment, the state information determination module is specifically used to: Solving the degrees of freedom of the equivalent center of mass of each subsystem of the overall dynamic equilibrium equations and the Lagrange multipliers corresponding to each of the equivalent constraint forces between the subsystems, and determining the degrees of freedom of the equivalent center of mass of each subsystem and the Lagrange multipliers corresponding to the equivalent constraint forces between the subsystems; Determine the constraint reaction force between the subsystems based on the Lagrange multipliers corresponding to the equivalent constraint forces between the subsystems and the Jacobian matrix of the displacement constraint equations between the subsystems; Based on the constraint reaction forces between the subsystems and the degrees of freedom of the equivalent center of mass of the subsystems, the state information of the internal rigid body units of each subsystem is solved to determine the position information and posture information of the internal rigid body units of each subsystem at the current moment.

5. An electronic device, characterized in that: include: A processor, a memory and a bus, wherein the memory stores machine-readable instructions executable by the processor, and when the electronic device is running, the processor and the memory communicate through the bus, and the machine-readable instructions are executed by the processor to execute the steps of the multi-body system dynamics analysis method as described in any one of claims 1 to 3.

6. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores a computer program, and when the computer program is executed by a processor, the steps of the multi-body system dynamics analysis method according to any one of claims 1 to 3 are executed.