MOTION CONTROL METHOD AND APPARATUS, CONTROLLER, MEDIUM, AND ROBOT

A method of controlling the motion of a two-legged robot includes: acquiring gait parameters of the two-legged robot; inputting the gait parameters to a preset gait planning model; determining gait trajectory parameters of the two-legged robot based on the gait parameters through the preset gait planning model, in which the gait trajectory parameters include a center-of-mass state corresponding to a double support phase and a center-of-mass state corresponding to a single support phase, and the center-of-mass state includes a center-of-mass position and a center-of-mass movement speed; and controlling the two-legged robot to move according to the gait trajectory parameters.

Skip to: Description  ·  Claims  · Patent History  ·  Patent History
Description
CROSS-REFERENCE TO RELATED APPLICATION

This application is based on and claims priority to Chinese Patent Application No. 202210945451.7, filed on Aug. 8, 2022, the entire contents of which are incorporated herein by reference.

BACKGROUND

In the related art, walking gaits of a two-legged robot are generally controlled based on a Linear Inverted Pendulum Model with Double Support Phase (D-LIP). However, when controlling the walking gaits of the two-legged robot, the D-LIP generally considers only a center-of-mass state of the two-legged robot in a Single Support Phase (SSP), and controls the two-legged robot to walk based on the center-of-mass state in the SSP. However, the two-legged robot is not subject only to the SSP when walking. Therefore, when the two-legged robot is controlled to walk only based on the center-of-mass state in the SSP, the two-legged robot may have poor walking stability.

SUMMARY

According to a first aspect of the present disclosure, a motion control method is provided. The motion control method includes: acquiring gait parameters of a two-legged robot; inputting the gait parameters to a preset gait planning model; determining gait trajectory parameters of the two-legged robot based on the gait parameters through the preset gait planning model, in which the gait trajectory parameters include a center-of-mass state corresponding to a double support phase and a center-of-mass state corresponding to a single support phase, and the center-of-mass state includes a center-of-mass position and a center-of-mass movement speed; and controlling the two-legged robot to move according to the gait trajectory parameters.

According to a second aspect of the present disclosure, a computer-readable storage medium is provided, in which instructions in the computer-readable storage medium, when executed by a processor of a controller, enable the controller to perform a motion control method. The motion control method includes: acquiring gait parameters of a two-legged robot; inputting the gait parameters to a preset gait planning model; determining gait trajectory parameters of the two-legged robot based on the gait parameters through the preset gait planning model, in which the gait trajectory parameters include a center-of-mass state corresponding to a double support phase and a center-of-mass state corresponding to a single support phase, and the center-of-mass state includes a center-of-mass position and a center-of-mass movement speed; and controlling the two-legged robot to move according to the gait trajectory parameters.

According to a third aspect of embodiments of the present disclosure, a two-legged robot is provided. The two-legged robot includes: a two-legged robot body, and a lower limb assembly and a controller, in which the lower limb assembly and the controller are arranged on the two-legged robot body. The controller is configured to: acquire gait parameters of the two-legged robot; input the gait parameters to a preset gait planning model; determine gait trajectory parameters of the two-legged robot based on the gait parameters through the preset gait planning model, in which the gait trajectory parameters include a center-of-mass state corresponding to a double support phase and a center-of-mass state corresponding to a single support phase, and the center-of-mass state includes a center-of-mass position and a center-of-mass movement speed; and control the lower limb assembly of the two-legged robot to move according to the gait trajectory parameters.

BRIEF DESCRIPTION OF DRAWINGS

The accompanying drawings, which are incorporated into and constitute a part of this specification, illustrate embodiments consistent with the present disclosure and, together with the specification, serve to explain the principles of the present disclosure rather than limit the present disclosure improperly.

FIG. 1 illustrates a flowchart of a motion control method according to an embodiment.

FIG. 2 illustrates a schematic diagram of a double support phase of a two-legged robot according to an embodiment.

FIG. 3 illustrates a schematic diagram of a single support phase of a two-legged robot according to an embodiment.

FIG. 4 illustrates a block diagram of a motion control apparatus according to an embodiment.

FIG. 5 illustrates a block diagram of a controller according to an embodiment.

DETAILED DESCRIPTION

The present disclosure relates to the field of electronic technologies, and more particularly, to a motion control method and apparatus, a controller, a medium, and a robot.

To enable those skilled in the art to better understand technical solutions of the present disclosure, the technical solutions in embodiments of the present disclosure will be described clearly and completely below with reference to the accompanying drawings.

It should be noted that terms such as “first” and “second” in the specification and claims of the present disclosure and in the foregoing drawings are used for distinguishing between similar objects and not necessarily for describing a particular sequential or chronological order. It should be understood that data thus used is interchangeable in proper circumstances, such that the embodiments of the present disclosure described herein can be implemented in orders except for the orders illustrated or described herein. The implementations described in the following embodiments do not represent all implementations consistent with the present disclosure. Instead, they are merely examples of an apparatus and a method consistent with some aspects of the present disclosure as recited in the appended claims.

A motion control method and apparatus, an electronic device, and a storage medium according to the embodiments of the present disclosure are described in detail below with reference to the accompanying drawings.

FIG. 1 is a flowchart of a motion control method according to an embodiment. The motion control method may be applied to a controller of a two-legged robot. As shown in FIG. 1, the motion control method may include the following steps.

In step S101, gait parameters of the two-legged robot are acquired.

In the embodiments of the present disclosure, when there is a need to control the two-legged robot to move, a user may operate an electronic device realizing communication connection with the two-legged robot to send the gait parameters to the two-legged robot. The electronic device may also automatically send the gait parameters to the two-legged robot, or the two-legged robot may also generate the gait parameters on its own. Then, the controller may acquire the gait parameters of the two-legged robot.

In a possible implementation, the gait parameters may include a center-of-mass height and a double support phase (DSP) duration. FIG. 2 is a schematic diagram of a DSP of a two-legged robot according to an embodiment. As shown in FIG. 2, foot1 and foot2 in FIG. 2 denote two legs of the two-legged robot respectively, g denotes gravitational acceleration, the center-of-mass height may be a height H of the center of mass of the two-legged robot in a direction perpendicular to the ground (i.e., a direction z), which is expressed as z=H in FIG. 2. The DSP is a phase in which the two legs of the two-legged robot are both in contact with the ground. The DSP duration may be a contact duration each time the two legs of the two-legged robot are both in contact with the ground. The two-legged robot realizes walking by switching the two legs between a single support phase (SSP) and the DSP.

In step S102, the gait parameters are input to a preset gait planning model.

In the embodiments of the present disclosure, after the gait parameters of the two-legged robot are acquired, the gait parameters may be input to the preset gait planning model. The preset gait planning model may be a liner inverted pendulum model with double support phase (D-LIP), which may be a preset model configured to perform processing based on the gait parameters of the two-legged robot to obtain gait trajectory parameters of the two-legged robot. In some embodiments, kinematics analysis may be performed based on the gait parameters of the two-legged robot to obtain the gait trajectory parameters. The gait trajectory parameters are a data basis for controlling the two-legged robot to walk.

In step S103, the gait trajectory parameters of the two-legged robot are determined based on the gait parameters through the preset gait planning model.

The gait trajectory parameters include a center-of-mass state corresponding to the DSP and a center-of-mass state corresponding to the SSP. The center-of-mass state includes a center-of-mass position and a center-of-mass movement speed. FIG. 3 is a schematic diagram of an SSP of a two-legged robot according to an embodiment. As shown in FIG. 3, the SSP is a phase in which one leg of the two-legged robot is in contact with the ground.

In the embodiments of the present disclosure, after the gait parameters are input to the preset gait planning model, the gait trajectory parameters of the two-legged robot may be determined based on the gait parameters of the two-legged robot through the preset gait planning model. In some embodiments, the preset gait planning model may be controlled to perform kinematics analysis on the gait parameters to output the gait trajectory parameters of the two-legged robot.

In a possible implementation, the center-of-mass state may include a forward center-of-mass position and a forward center-of-mass movement speed. That is, the gait trajectory parameters include a forward center-of-mass position and a forward center-of-mass movement speed corresponding to the DSP and a center-of-mass position and a center-of-mass movement speed corresponding to the SSP.

In step S104, the two-legged robot is controlled to move according to the gait trajectory parameters.

In the embodiments of the present disclosure, after the gait trajectory parameters of the two-legged robot are determined based on the gait parameters through the preset gait planning model, the two-legged robot may be controlled to move according to the gait trajectory parameters. In some embodiments, the two-legged robot may be controlled to move according to the gait trajectory parameters through a workspace control method. In some embodiments, the workspace control method may include, but is not limited to, a whole-body motion control method, inverse dynamics control, an inverse kinematics control method, and the like.

In the embodiments of the present disclosure, the gait parameters of the two-legged robot are acquired, and the gait parameters are input to the preset gait planning model; the gait trajectory parameters of the two-legged robot are then determined based on the gait parameters through the preset gait planning model, in which the gait trajectory parameters include the center-of-mass state corresponding to the DSP and the center-of-mass state corresponding to the SSP, and the center-of-mass state includes the center-of-mass position and the center-of-mass movement speed; and then the two-legged robot is controlled to move according to the gait trajectory parameters. In this way, the two-legged robot can be controlled to move by combining the center-of-mass state in the DSP based on the center-of-mass state corresponding to the SSP. Thus, since the two-legged robot is controlled to move by combining the center-of-mass state corresponding to the SSP with the center-of-mass state corresponding to the DSP, a motion process of the two-legged robot can be more stable, and the stability of the two-legged robot can be improved, compared with the related art in which the two-legged robot is controlled to walk based on the center-of-mass state in the SSP.

In a possible implementation, when the gait parameters include a center-of-mass height and a DSP duration and the center-of-mass state includes a forward center-of-mass position and a forward center-of-mass movement speed, a specific implementation of determining gait trajectory parameters of the two-legged robot based on the gait parameters through the preset gait planning model in step S103 may be as follows: inputting the center-of-mass height and the DSP duration to the preset gait planning model; determining, through a model corresponding to the SSP in the preset gait planning model, the forward center-of-mass position and the forward center-of-mass movement speed of the two-legged robot in the SSP based on the center-of-mass height and a first preset parameter; and determining, through a model corresponding to the DSP in the preset gait planning model, the forward center-of-mass position and the forward center-of-mass movement speed of the two-legged robot in the DSP based on the DSP duration and a second preset parameter.

In the embodiments of the present disclosure, when the gait trajectory parameters of the two-legged robot are determined based on the gait parameters through the preset gait planning model, the center-of-mass height and the DSP duration may be input to the preset gait planning model, and through the model corresponding to the SSP and the model corresponding to the DSP in the preset gait planning model, the forward center-of-mass position and the forward center-of-mass movement speed of the two-legged robot in the SSP and the forward center-of-mass position and the forward center-of-mass movement speed of the two-legged robot in the DSP are determined based on the center-of-mass height and the first preset parameter and based on the DSP duration and the second preset parameter respectively. It may be understood that the preset gait planning model may include the model corresponding to the SSP (as shown in FIG. 3) and the model corresponding to the DSP (as shown in FIG. 2). The model corresponding to the SSP may be configured to determine the forward center-of-mass position and the forward center-of-mass movement speed of the two-legged robot in the SSP based on the center-of-mass height and the first preset parameter. The model corresponding to the DSP may be configured to determine the forward center-of-mass position and the forward center-of-mass movement speed of the two-legged robot in the DSP based on the DSP duration and the second preset parameter.

In some embodiments, when the forward center-of-mass position and the forward center-of-mass movement speed of the two-legged robot in the SSP is determined based on the center-of-mass height and the first preset parameter through the preset gait planning model, force analysis may be performed based on the center-of-mass height through the model corresponding to the SSP. Specifically, as shown in FIG. 3, to keep the center-of-mass height of the two-legged robot constant, foot1 is subjected to ground force F1, which is applied to the center-of-mass position of the two-legged robot along a leg length direction. Z-component force of F1 is identically equal to gravity mg, in which m denotes mass of the two-legged robot, and force analysis is performed accordingly. Taking a support leg foot1 as a coordinate origin, an X-direction (i.e., forward) center-of-mass dynamics equation is:

x ¨ = λ 2 x , where λ = g H ( 1 )

in which {umlaut over (x)} denotes X-direction acceleration of the two-legged robot in the SSP, x denotes an X-direction position of the two-legged robot in the SSP, H denotes the center-of-mass height of the two-legged robot, and g denotes the gravitational acceleration.

An analytical solution to the above motion equation (1) is:

{ x ( t ) = c 1 e λ t + c 2 e - λ t x ˙ ( t ) = λ ( c 1 e λ t - c 2 e - λ t ) ( 2 )

in which x(t) denotes an X-direction center-of-mass position of the two-legged robot in the SSP, {dot over (x)}(t) denotes an X-direction movement speed of the two-legged robot in the SSP, and c1 and c2 denote preset parameters (i.e., the first preset parameter).

If [xs+, {dot over (x)}s+] denotes a center-of-mass state at SSP start time ts+, that is, an X-direction center-of-mass position and an X-direction center-of-mass movement speed, in which the subscript “s” denotes the SSP,

{ c 1 = 1 2 ( x s + + 1 λ x ˙ s + ) c 2 = 1 2 ( x s + - 1 λ x ˙ s + ) ( 3 )

in which xs+ denotes the X-direction center-of-mass position at the SSP start time ts+, and {dot over (x)}s+ denotes the X-direction center-of-mass movement speed at the SSP start time ts+. Moreover, [xs+, {dot over (x)}s+] satisfies the following relation:

{ x ˙ s + = - σ x s + x ˙ s - = σ x s - , where ( 4 ) σ = λ coth ( T s λ 2 )

In some embodiments, when the forward center-of-mass position and the forward center-of-mass movement speed of the two-legged robot in the DSP are determined based on the DSP duration and the second preset parameter through the preset gait planning model, force analysis may be performed based on the center-of-mass height through the model corresponding to the DSP. Specifically, referring to FIG. 2, a DSP stage may be regarded as an action transition stage between a swing leg and a support leg. Assuming that transition time (duration of the DSP) is Td, in which the subscript “d” denotes the DSP, since the center-of-mass height is generally expected to remain constant during the DSP, in consideration of physical realizability, a transition curve of support force between two legs of the two-legged robot may be designed to ensure smooth acceleration changes during the DSP, as shown by the following equation:

{ F z 1 = m g ( 1 - t T d ) F z 2 = m g t T d ( 5 )

in which Fz1 and Fz2 denote Z-direction components of force of an original support leg (foot1) and an original swing leg (foot2) of the two-legged robot on the center of mass of the two-legged robot respectively, Td denotes the DSP duration, g denotes the gravitational acceleration, and m denotes the mass of the two-legged robot.

Force analysis is performed with the original support leg foot1 as a coordinate origin and a constant center-of-mass height, and an X-direction center-of-mass dynamics equation of the two-legged robot in the DSP stage is:

x ¨ = λ 2 ( x - l T d t ) , where ( 6 ) λ = g H

in which {umlaut over (x)} denotes an X-direction acceleration of the two-legged robot in the DSP stage, Td denotes the DSP duration, x denotes an X-direction position of the two-legged robot in the DSP, l denotes a motion step length of the two-legged robot (the step length is a set step length, i.e., a first motion step length), that is, displacement of foot2 relative to foot1 in the direction X in FIG. 2.

Similarly, an analytical solution to the ordinary differential equation (6) may be obtained, i.e., a DSP kinematics equation:

{ x ( t ) = c 3 e λ t + c 4 e - λ t + l T d t x ˙ ( t ) = λ ( c 3 e λ t - c 4 e - λ t ) + l T d ( 7 )

in which x(t) denotes an X-direction center-of-mass position of the two-legged robot in the DSP, {dot over (x)}(t) denotes an X-direction movement speed of the two-legged robot in the DSP, and c3 and c4 denote preset parameters (i.e., the second preset parameter).

If [xd+, {dot over (x)}d+] denotes a center-of-mass state at DSP start time, that is, an X-direction center-of-mass position and an X-direction center-of-mass movement speed at the DSP start time,

{ c 3 = 1 2 ( x d + + 1 λ x ˙ d + - l λ T d ) c 4 = 1 2 ( x d + - 1 λ x ˙ d + + l λ T d ) ( 8 )

in which Td denotes the DSP duration, xd+ denotes the X-direction center-of-mass position at the DSP start time, and {dot over (x)}d+ denotes the X-direction center-of-mass movement speed at the DSP start time.

It may be understood that, during the motion of the two-legged robot, state transition may occur between the SSP and the DSP. A mapping relation of the center-of-mass states during the transition may be as follows: l denotes a motion step length of the two-legged robot.

Δ s d : { x ˙ d + = x ˙ s - x d + = x s - ( 9 a ) Δ d s : { x ˙ s + = x ˙ d - x s + = x d - - l ( 9 b )

in which Δs→d denotes switching from the SPP to the DSP, Δd→s denotes switching from the DSP to the SPP, l denotes the first motion step length of the two-legged robot, xd+ denotes a center-of-mass position at the DSP start time, {dot over (x)}d+ denotes a center-of-mass movement speed at the DSP start time, xs denotes a center-of-mass position at SSP end time, {dot over (x)}s denotes a movement speed at the SSP end time, {dot over (x)}s+ denotes a movement speed at the SSP start time, xs+ denotes a center-of-mass position at the SSP start time, {dot over (x)}d denotes a center-of-mass movement speed at DSP end time, and xd denotes a center-of-mass position at the DSP end time.

In this way, the forward center-of-mass positions and the forward center-of-mass movement speeds corresponding to the two-legged robot in different support phases can be determined based on the gait parameters through the models respectively corresponding to the SSP and the DSP. In this way, accuracy of the determined center-of-mass states can be improved by determining gait center-of-mass states in different situations based on different models. At the same time, since the above models are obtained based on actual force analysis, the gait trajectory parameters output by the models may also be more in line with the physical reality, and a smooth center-of mass-motion trajectory at an acceleration level can be generated.

In some possible implementations, the gait parameters may further include an SSP duration, a forward average speed, and a lateral average speed; and the gait trajectory parameters may further include a lateral center-of-mass movement speed of the two-legged robot in an SSP termination state, a first motion step length of the two-legged robot, and a center-of-mass height of the two-legged robot in a vertical direction.

Correspondingly, a specific implementation of determining gait trajectory parameters of the two-legged robot based on the gait parameters through the preset gait planning model in step S103 may be as follows: inputting the SSP duration, the DSP duration, the forward average speed, and the lateral average speed to the preset gait planning model; determining, through a model corresponding to the SSP in the preset gait planning model, a forward movement speed and a lateral movement speed of the two-legged robot in an SSP termination state based on the SSP duration, the DSP duration, the forward average speed, and a third preset parameter; determining, through a model corresponding to the DSP in the preset gait planning model, the first motion step length of the two-legged robot based on the SSP duration, the DSP duration, and the forward average speed; and determining the center-of-mass height as the center-of-mass height of the two-legged robot in the vertical direction.

In the embodiments of the present disclosure, the SSP duration, the DSP duration, the forward average speed, and the lateral average speed may be input to the preset gait planning model, and then the forward movement speed and the lateral movement speed of the two-legged robot in the SSP termination state is determined based on the SSP duration, the DSP duration, the forward average speed, and the third preset parameter through the model corresponding to the SSP in the preset gait planning model.

In some embodiments, when the center-of-mass height H, the SSP duration, and the DSP duration are given, each average speed has a unique limit cycle orbit (also known as a “gait”) corresponding thereto, and the forward movement speed in the SSP termination state is:

x ˙ s - * = T s + T d μ + 2 σ v x , where ( 10 ) μ = μ ( H , T s , T d ) = 2 λ T d e λ T d - e - λ T d ( 2 σ + 1 2 ( 1 σ + 1 λ - 2 σ λ T d ) ( e λ T d - 1 ) + 1 2 ( 1 σ - 1 λ + 2 σ λ T d ) ( e - λ T d - 1 ) ) ( 11 )

in which {dot over (x)}s−* denotes the forward (X-direction) movement speed in the SSP termination state, σ denotes the third preset parameter, Ts denotes the SSP duration, Td denotes the DSP duration, and νx denotes the forward average speed.

For Y-direction (lateral) motion, a Y-direction movement speed {dot over (y)}s−* in the SSP termination state is:

y . s - * = T s + T d μ + 2 σ v y ± W λ sinh ( λ T s ) 2 + 2 cosh ( λ T s ) ( 12 )

in which {dot over (y)}s−* denotes the Y-direction movement speed in the SSP termination state, Ts denotes the SSP duration, Td denotes the DSP duration, νy denotes the lateral average speed, W denotes a desired walking width when the Y-direction movement speed is 0 (the value may be a preset value), and a denotes the third preset parameter.

In some embodiments, when a desired motion step length, i.e., the first motion step length, of the two-legged robot in the DSP is determined based on the SSP duration, the DSP duration, and the forward average speed, the first motion step length of the two-legged robot may be determined by combining formulas (9a), (9b), and (11). A specific calculation manner thereof may be as follows:

l * = x s - + 1 σ x ˙ s - + μ x ˙ s - ( 13 )

in which l* denotes the first motion step length, xs denotes the center-of-mass position at the SSP end time, {dot over (x)}s denotes the center-of-mass movement speed at the SSP end time, and a denotes the third preset parameter.

In some embodiments, the center-of-mass height in the gait parameters may be determined to be the center-of-mass height of the two-legged robot in the vertical direction (direction z), and the center-of-mass height in the gait parameters may be determined to be a z-direction center-of-mass height in the gait trajectory parameters. That is, a motion trajectory of the center of mass of the two-legged robot in the direction Z is z(t)=H. It may be understood that, in the SSP stage, a trajectory of the swing leg of the two-legged robot is required to meet the following conditions. 1. During the swing in the direction Z, the swing leg leaves the ground at time t=0, rises to a specified height near t=0.5 Ts, and falls to the ground at time t=Ts. 2. During the swing in the direction X, the swing leg is located at the position of the DSP end time at the time t=0, and runs to the first motion step length l* determined by (13) at the time t=Ts.

In this way, more abundant gait trajectory parameters of the two-legged robot in lateral and vertical directions can be determined by combining different gait parameters, so as to improve comprehensiveness and accuracy of the gait trajectory parameters and further improve the stability of the two-legged robot.

In some possible implementations, the motion of the two-legged robot may also be adjusted according to an actual motion speed of the two-legged robot. Correspondingly, a specific implementation may be as follows: acquiring an actual forward movement speed and an actual lateral movement speed of the two-legged robot; determining whether the actual forward movement speed of the two-legged robot is consistent with the forward average speed, and determining whether the actual lateral movement speed is consistent with the lateral average speed; determining a second motion step length of the two-legged robot when the actual forward movement speed is inconsistent with the forward average speed and/or the actual lateral movement speed is inconsistent with the lateral average speed; and controlling the two-legged robot to move based on the second motion step length.

In the embodiments of the present disclosure, the two-legged robot may be subjected to external disturbances during the motion, resulting in changes in an actual desired motion speed of the two-legged robot (including at least one of the forward average speed and the lateral average speed in the above gait parameters). Therefore, in consideration of the above, after the two-legged robot is controlled to move based on the gait trajectory parameters, the actual forward movement speed and the actual lateral movement speed of the two-legged robot may also be monitored in real time or periodically. If at least one of the actual forward movement speed and the actual lateral movement speed is inconsistent with the corresponding average speed, for example, the actual forward movement speed is inconsistent with the forward average speed, or the actual lateral movement speed is inconsistent with the lateral average speed, or the actual forward movement speed is inconsistent with the forward average speed and the actual lateral movement speed is inconsistent with the lateral average speed, in this case, the walking length of the two-legged robot during the motion, that is, the second motion step length, can be re-determined, and the two-legged robot is controlled to move according to the second motion step length. In this way, the motion of the two-legged robot is adjusted according to actual motion of the two-legged robot, so that the motion of the two-legged robot is more in line with an actual requirement, thereby further improving the stability of the two-legged robot.

In a further possible implementation, a specific implementation of determining a second motion step length of the two-legged robot in the above step may be as follows: acquiring a forward center-of-mass position and a forward movement speed of the two-legged robot at current time; inputting the forward center-of-mass position and the forward movement speed of the two-legged robot at the current time, the SSP duration, the DSP duration, the forward average speed, and the first motion step length to the preset gait planning model; and determining, through the preset gait planning model, the second motion step length of the two-legged robot based on the forward center-of-mass position and the forward movement speed of the two-legged robot at the current time, the SSP duration, the DSP duration, the forward average speed, the first motion step length, and the third preset parameter.

In the embodiments of the present disclosure, when the second motion step length of the two-legged robot is determined, the forward center-of-mass position and the forward movement speed of the two-legged robot at the current time may be acquired, and then the forward center-of-mass position and the forward movement speed of the two-legged robot at the current time, the SSP duration, the DSP duration, the forward average speed, and the first motion step length are input to the preset gait planning model. Then, the preset gait planning model may be controlled to perform kinematics analysis on the forward center-of-mass position and the forward movement speed of the two-legged robot at the current time, the SSP duration, the DSP duration, the forward average speed, and the third preset parameter, so as to output a new desired motion step length of the two-legged robot, that is, the second motion step length.

In some embodiments, the preset gait planning model may calculate a new forward movement speed {dot over (x)}s−* in the SSP termination state at the current time through the above formula (10) based on the SSP duration, the DSP duration, and the forward average speed. Moreover, the forward center-of-mass position and the forward movement speed at the current time may be determined to be new [x(t), {dot over (x)}(t)] of the two-legged robot, that is, a forward center-of-mass position and a forward movement speed at the current time. Then, a forward movement speed {dot over (x)}s−# of the center of mass when the swing leg of the two-legged robot lands may be predicted in real time according to the forward center-of-mass position and the forward movement speed at the current time. A predictor formula of {dot over (x)}s−# may be Formula (14). Then, a new walking length of the two-legged robot in a current situation, i.e., the second motion step length, may be determined through Formula (15) by combining {dot over (x)}s−#, the first motion step length l*, and a preset parameter K (i.e., the third preset parameter).


{dot over (x)}s−#=λsinH(λ(Ts−t)x(t)+cosH(λ(Ts−t)){dot over (x)}(t)   (14)

in which {dot over (x)}s−# denotes the real-time predicted forward movement speed of the center of mass when the swing leg of the two-legged robot lands, Ts denotes the SSP duration, and H denotes the center-of-mass height.


ld=l*+K({dot over (x)}s−#−{dot over (x)}s−*)   (15)

in which ld denotes the second motion step length, l* denotes the first motion step length, {dot over (x)}s−# denotes the real-time predicted forward movement speed of the center of mass when the swing leg of the two-legged robot lands, {dot over (x)}s−* denotes the forward movement speed in the SSP termination state at the current time, and K denotes the third preset parameter. Moreover, K denotes a gain coefficient, and a specific value may be adjusted according to a desired speed tracking effect and an actual situation of the two-legged robot.

In this way, the motion step length of the two-legged robot may be adjusted according to actual motion of the two-legged robot, so that the motion of the two-legged robot is more in line with an actual requirement, and motion stability of the two-legged robot and robustness against external interference can be further improved. At the same time, by combining the above formulas, it can be seen that the gait trajectory parameters of this embodiment can be obtained by an analytical solution, and the calculation time is low, so online adjustment of the gait trajectory parameters can be realized, and a variable center-of-mass height and a variable walking speed of the two-legged robot can be realized.

Based on the same invention concept, an embodiment of the present disclosure further provides a motion control apparatus. As shown in FIG. 4, FIG. 4 is a block diagram of a motion control apparatus according to an embodiment. Referring to FIG. 4, the motion control apparatus 400 may include: a parameter acquisition module 410 configured to acquire gait parameters of a two-legged robot; an input module 420 configured to input the gait parameters to a preset gait planning model; a determination module 430 configured to determine gait trajectory parameters of the two-legged robot based on the gait parameters through the preset gait planning model, in which the gait trajectory parameters include a center-of-mass state corresponding to a DSP and a center-of-mass state corresponding to an SSP, and the center-of-mass state includes a center-of-mass position and a center-of-mass movement speed; and a first motion module 440 configured to control the two-legged robot to move according to the gait trajectory parameters.

In a possible implementation, the gait parameters include a center-of-mass height and a DSP duration; and the center-of-mass state includes a forward center-of-mass position and a forward center-of-mass movement speed.

In a possible implementation, the determination module 430 includes: a first input unit configured to input the center-of-mass height and the DSP duration to the preset gait planning model; a first determination unit configured to determine, through a model corresponding to the SSP in the preset gait planning model, the forward center-of-mass position and the forward center-of-mass movement speed of the two-legged robot in the SSP based on the center-of-mass height and a first preset parameter; and a second determination unit configured to determine, through a model corresponding to the DSP in the preset gait planning model, the forward center-of-mass position and the forward center-of-mass movement speed of the two-legged robot in the DSP based on the DSP duration and a second preset parameter.

In a possible implementation, the gait parameters further include an SSP duration, a forward average speed, and a lateral average speed; and the gait trajectory parameters further include a lateral center-of-mass movement speed of the two-legged robot in an SSP termination state, a first motion step length of the two-legged robot, and a center-of-mass height of the two-legged robot in a vertical direction.

In a possible implementation, the determination module 430 includes: a second input unit configured to input the SSP duration, the DSP duration, the forward average speed, and the lateral average speed to the preset gait planning model; a third determination unit configured to determine, through a model corresponding to the SSP in the preset gait planning model, a forward movement speed and a lateral movement speed of the two-legged robot in an SSP termination state based on the SSP duration, the DSP duration, the forward average speed, and a third preset parameter; a fourth determination unit configured to determine, through a model corresponding to the DSP in the preset gait planning model, the first motion step length of the two-legged robot based on the SSP duration, the DSP duration, and the forward average speed; and a fifth determination unit configured to determine the center-of-mass height as the center-of-mass height of the two-legged robot in the vertical direction.

In a possible implementation, the motion control apparatus 400 further includes: a speed acquisition module configured to acquire an actual forward movement speed and an actual lateral movement speed of the two-legged robot; a speed determination module configured to determine whether the actual forward movement speed of the two-legged robot is consistent with the forward average speed, and determine whether the actual lateral movement speed is consistent with the lateral average speed; a step length determination module configured to determine a second motion step length of the two-legged robot when the actual forward movement speed is inconsistent with the forward average speed and/or the actual lateral movement speed is inconsistent with the lateral average speed; and a second motion module configured to control the two-legged robot to move based on the second motion step length.

In a possible implementation, the step length determination module includes: a speed acquisition unit configured to acquire a forward center-of-mass position and a forward movement speed of the two-legged robot at current time; a third input unit configured to input the forward center-of-mass position and the forward movement speed of the two-legged robot at the current time, the SSP duration, the DSP duration, the forward average speed, and the first motion step length to the preset gait planning model; and a sixth determination unit configured to determine, through the preset gait planning model, the second motion step length of the two-legged robot based on the forward center-of-mass position and the forward movement speed of the two-legged robot at the current time, the SSP duration, the DSP duration, the forward average speed, the first motion step length, and the third preset parameter.

Regarding the motion control apparatus in the above embodiment, specific manners in which the modules perform operations have been described in the embodiment of the method, and will not be elaborated herein.

Based on the same invention concept, an embodiment of the present disclosure further provides a two-legged robot, including: a two-legged robot body, and a lower limb assembly and a controller, in which the lower limb assembly and the controller are arranged on the two-legged robot body. The controller is configured to: acquire gait parameters of the two-legged robot; input the gait parameters to a preset gait planning model; determine gait trajectory parameters of the two-legged robot based on the gait parameters through the preset gait planning model, in which the gait trajectory parameters include a center-of-mass state corresponding to a DSP and a center-of-mass state corresponding to an SSP, and the center-of-mass state includes a center-of-mass position and a center-of-mass movement speed; and control the lower limb assembly of the two-legged robot to move according to the gait trajectory parameters.

In a possible implementation, the gait parameters include a center-of-mass height and a DSP duration; and the center-of-mass state includes a forward center-of-mass position and a forward center-of-mass movement speed.

In a possible implementation, the controller is further configured to: input the center-of-mass height and the DSP duration to the preset gait planning model; determine, through a model corresponding to the SSP in the preset gait planning model, the forward center-of-mass position and the forward center-of-mass movement speed of the two-legged robot in the SSP based on the center-of-mass height and a first preset parameter; and determine, through a model corresponding to the DSP in the preset gait planning model, the forward center-of-mass position and the forward center-of-mass movement speed of the two-legged robot in the DSP based on the DSP duration and a second preset parameter.

In a possible implementation, the gait parameters further include an SSP duration, a forward average speed, and a lateral average speed; and the gait trajectory parameters further include a lateral center-of-mass movement speed of the two-legged robot in an SSP termination state, a first motion step length of the two-legged robot, and a center-of-mass height of the two-legged robot in a vertical direction.

In a possible implementation, the controller is further configured to: input the SSP duration, the DSP duration, the forward average speed, and the lateral average speed to the preset gait planning model; determine, through a model corresponding to the SSP in the preset gait planning model, a forward movement speed and a lateral movement speed of the two-legged robot in an SSP termination state based on the SSP duration, the DSP duration, the forward average speed, and a third preset parameter; determine, through a model corresponding to the DSP in the preset gait planning model, the first motion step length of the two-legged robot based on the SSP duration, the DSP duration, and the forward average speed; and determine the center-of-mass height as the center-of-mass height of the two-legged robot in the vertical direction.

In a possible implementation, the controller is further configured to: acquire an actual forward movement speed and an actual lateral movement speed of the two-legged robot; determine whether the actual forward movement speed of the two-legged robot is consistent with the forward average speed, and determining whether the actual lateral movement speed is consistent with the lateral average speed; determine a second motion step length of the two-legged robot when the actual forward movement speed is inconsistent with the forward average speed and/or the actual lateral movement speed is inconsistent with the lateral average speed; and control the lower limb assembly of the two-legged robot to move based on the second motion step length.

In a possible implementation, the controller is further configured to: acquire a forward center-of-mass position and a forward movement speed of the two-legged robot at current time; input the forward center-of-mass position and the forward movement speed of the two-legged robot at the current time, the SSP duration, the DSP duration, the forward average speed, and the first motion step length to the preset gait planning model; and determine, through the preset gait planning model, the second motion step length of the two-legged robot based on the forward center-of-mass position and the forward movement speed of the two-legged robot at the current time, the SSP duration, the DSP duration, the forward average speed, the first motion step length, and the third preset parameter.

Regarding the two-legged robot in the above embodiments, specific manners in which the structures perform operations have been described in the embodiments of the method, and will not be elaborated herein.

According to embodiments of the present disclosure, the present disclosure further provides a controller, a readable storage medium, and a computer program product.

FIG. 5 is a schematic block diagram of a controller 500 that may be configured to implement embodiments of the present disclosure. The controller 500 is intended to represent various forms of digital computers, such as laptops, desktops, workbenches, personal digital assistants, servers, blade servers, mainframe computers, and other suitable computers. The controller may further represent various forms of mobile devices, such as personal digital assistants, cellular phones, smart phones, wearable devices, and other similar computing devices. The components, their connections and relationships, and their functions shown herein are examples only, and are not intended to limit the implementation of the present disclosure as described and/or required herein.

As shown in FIG. 5, the controller 500 includes a computing unit 501, which may perform various suitable actions and processing according to a computer program stored in a read-only memory (ROM) 502 or a computer program loaded from a storage unit 508 into a random access memory (RAM) 503. The RAM 503 may also store various programs and data required to operate the controller 500. The computing unit 501, the ROM 502 and the RAM 503 are coupled to one another by a bus 504. An input/output (I/O) interface 505 may also be coupled to the bus 504.

A plurality of components in the controller 500 are coupled to the I/O interface 505, including an input unit 506, such as a keyboard and a mouse; an output unit 507, such as various types of displays and speakers; a storage unit 508, such as disks and discs; and a communication unit 509, such as a network card, a modem, and a wireless communication transceiver. The communication unit 509 allows the controller 500 to exchange information/data with other devices over computer networks such as the Internet and/or various telecommunications networks.

The computing unit 501 may be a variety of general-purpose and/or special-purpose processing components with processing and computing capabilities. Some examples of the computing unit 501 include, but are not limited to, a central processing unit (CPU), a graphics processing unit (GPU), various dedicated artificial intelligence (AI) computing chips, various computing units that run machine learning model algorithms, a digital signal processor (DSP), and any appropriate processor, controller or microcontroller, etc. The computing unit 501 performs the methods and processing described above, such as the motion control method. In some embodiments, the motion control method may be implemented as a computer software program that is tangibly embodied in a machine-readable medium, such as the storage unit 508. In some embodiments, part or all of a computer program may be loaded and/or installed on the controller 500 via the ROM 502 and/or the communication unit 509. One or more steps of the motion control method described above may be performed when the computer program is loaded into the RAM 503 and executed by the computing unit 501. Alternatively, in other embodiments, the computing unit 501 may be configured to perform the motion control method by any other appropriate means (for example, by means of firmware).

Various implementations of the systems and technologies disclosed herein can be realized in a digital electronic circuit system, an integrated circuit system, a field programmable gate array (FPGA), an application-specific integrated circuit (ASIC), an application-specific standard product (ASSP), a system on chip (SOC), a complex programmable logic device (CPLD), computer hardware, firmware, software, and/or combinations thereof. Such implementations may include implementation in one or more computer programs that are executable and/or interpretable on a programmable system including at least one programmable processor, which may be special or general purpose, configured to receive data and instructions from a storage system, at least one input apparatus, and at least one output apparatus, and to transmit data and instructions to the storage system, the at least one input apparatus, and the at least one output apparatus.

Program codes configured to implement the method in the present disclosure may be written in any combination of one or more programming languages. Such program codes may be supplied to a processor or controller of a general-purpose computer, a special-purpose computer, or another programmable data processing apparatus to enable the function/operation specified in the flowchart and/or block diagram to be implemented when the program codes are executed by the processor or controller. The program codes may be executed entirely on a machine, partially on a machine, partially on a machine and partially on a remote machine as a stand-alone package, or entirely on a remote machine or a server.

In the context of the present disclosure, the computer-readable storage medium may be a tangible medium which may include or store programs for use by or in conjunction with an instruction execution system, apparatus or device. The computer-readable storage medium may be a machine-readable signal medium or machine-readable storage medium. The computer-readable storage medium may include, but is not limited to, electronic, magnetic, optical, electromagnetic, infrared, or semiconductor systems, apparatuses or devices, or any suitable combinations thereof. More specific examples of the computer-readable storage medium may include electrical connections based on one or more wires, a portable computer disk, a hard disk, an RAM, an ROM, an erasable programmable read only memory (EPROM or flash memory), an optical fiber, a compact disk read only memory (CD-ROM), an optical storage device, a magnetic storage device, or any suitable combination thereof

To provide interaction with a user, the systems and technologies described here can be implemented on a computer. The computer has: a display apparatus (e.g., a cathode-ray tube (CRT) or a liquid crystal display (LCD) monitor) for displaying information to the user; and a keyboard and a pointing apparatus (e.g., a mouse or trackball) through which the user may provide input for the computer. Other kinds of apparatuses may also be configured to provide interaction with the user. For example, a feedback provided for the user may be any form of sensory feedback (e.g., visual, auditory, or tactile feedback); and input from the user may be received in any form (including sound input, voice input, or tactile input).

The systems and technologies described herein can be implemented in a computing system including background components (e.g., as a data server), or a computing system including middleware components (e.g., an application server), or a computing system including front-end components (e.g., a user computer with a graphical user interface or web browser through which the user can interact with the implementation schema of the systems and technologies described here), or a computing system including any combination of such background components, middleware components or front-end components. The components of the system can be coupled to each other through any form or medium of digital data communication (e.g., a communication network). Examples of the communication network include: a local area network (LAN), a wide area network (WAN), the Internet, and a blockchain network.

The computer system may include a client and a server. The client and the server are generally far away from each other and generally interact via the communication network. A relationship between the client and the server is generated through computer programs that run on a corresponding computer and have a client-server relationship with each other. The server may be a cloud server, also known as a cloud computing server or cloud host, which is a host product in the cloud computing service system to solve the problems of difficult management and weak business scalability in the traditional physical host and a Virtual Private Server (VPS). The server may also be a distributed system server, or a server combined with blockchain.

It should be understood that the steps can be reordered, added, or deleted using the various forms of processes shown above. For example, the steps described in the present disclosure may be executed in parallel or sequentially or in different sequences, provided that desired results of the technical solutions disclosed in the present disclosure are achieved, which is not limited herein.

The above specific implementations do not limit the protection scope of the present disclosure. Those skilled in the art should understand that various modifications, combinations, sub-combinations, and substitutions can be made according to design requirements and other factors. Any modifications, equivalent replacements, and improvements made within the principle of the present disclosure all should be included in the protection scope of the present disclosure.

Claims

1. A motion control method, comprising:

acquiring gait parameters of a two-legged robot;
inputting the gait parameters to a preset gait planning model;
determining gait trajectory parameters of the two-legged robot based on the gait parameters through the preset gait planning model, wherein the gait trajectory parameters comprise a center-of-mass state corresponding to a double support phase and a center-of-mass state corresponding to a single support phase, and the center-of-mass state comprises a center-of-mass position and a center-of-mass movement speed; and
controlling the two-legged robot to move according to the gait trajectory parameters.

2. The motion control method according to claim 1, wherein:

the gait parameters comprise a center-of-mass height and a double support phase duration; and
the center-of-mass state comprises a forward center-of-mass position and a forward center-of-mass movement speed.

3. The motion control method according to claim 2, wherein determining gait trajectory parameters of the two-legged robot based on the gait parameters through the preset gait planning model comprises:

inputting the center-of-mass height and the double support phase duration to the preset gait planning model;
determining, through a model corresponding to the single support phase in the preset gait planning model, the forward center-of-mass position and the forward center-of-mass movement speed of the two-legged robot in the single support phase based on the center-of-mass height and a first preset parameter; and
determining, through a model corresponding to the double support phase in the preset gait planning model, the forward center-of-mass position and the forward center-of-mass movement speed of the two-legged robot in the double support phase based on the double support phase duration and a second preset parameter.

4. The motion control method according to claim 2, wherein:

the gait parameters further comprise a single support phase duration, a forward average speed, and a lateral average speed; and
the gait trajectory parameters further comprise a lateral center-of-mass movement speed of the two-legged robot in a single support phase termination state, a first motion step length of the two-legged robot, and a center-of-mass height of the two-legged robot in a vertical direction.

5. The motion control method according to claim 4, wherein determining gait trajectory parameters of the two-legged robot based on the gait parameters through the preset gait planning model comprises:

inputting the single support phase duration, the double support phase duration, the forward average speed, and the lateral average speed to the preset gait planning model;
determining, through a model corresponding to the single support phase in the preset gait planning model, a forward movement speed and a lateral movement speed of the two-legged robot in the single support phase termination state based on the single support phase duration, the double support phase duration, the forward average speed, and a third preset parameter;
determining, through a model corresponding to the double support phase in the preset gait planning model, the first motion step length of the two-legged robot based on the single support phase duration, the double support phase duration, and the forward average speed; and
determining the center-of-mass height as the center-of-mass height of the two-legged robot in the vertical direction.

6. The motion control method according to claim 5, further comprising:

acquiring an actual forward movement speed and an actual lateral movement speed of the two-legged robot;
determining whether the actual forward movement speed of the two-legged robot is consistent with the forward average speed, and determining whether the actual lateral movement speed is consistent with the lateral average speed;
determining a second motion step length of the two-legged robot in response to determining at least one of that the actual forward movement speed is inconsistent with the forward average speed and that the actual lateral movement speed is inconsistent with the lateral average speed; and
controlling the two-legged robot to move based on the second motion step length.

7. The motion control method according to claim 6, wherein determining a second motion step length of the two-legged robot comprises:

acquiring a forward center-of-mass position and a forward movement speed of the two-legged robot at current time;
inputting the forward center-of-mass position and the forward movement speed of the two-legged robot at the current time, the single support phase duration, the double support phase duration, the forward average speed, and the first motion step length to the preset gait planning model; and
determining, through the preset gait planning model, the second motion step length of the two-legged robot based on the forward center-of-mass position and the forward movement speed of the two-legged robot at the current time, the single support phase duration, the double support phase duration, the forward average speed, the first motion step length, and the third preset parameter.

8. A computer-readable storage medium, wherein instructions in the computer-readable storage medium are executed by a processor of a controller and enable the controller to perform a motion control method,

wherein the motion control method comprises:
acquiring gait parameters of a two-legged robot;
inputting the gait parameters to a preset gait planning model;
determining gait trajectory parameters of the two-legged robot based on the gait parameters through the preset gait planning model, wherein the gait trajectory parameters comprise a center-of-mass state corresponding to a double support phase and a center-of-mass state corresponding to a single support phase, and the center-of-mass state comprises a center-of-mass position and a center-of-mass movement speed; and
controlling the two-legged robot to move according to the gait trajectory parameters.

9. The computer-readable storage medium according to claim 8, wherein:

the gait parameters comprise a center-of-mass height and a double support phase duration; and
the center-of-mass state comprises a forward center-of-mass position and a forward center-of-mass movement speed.

10. The computer-readable storage medium according to claim 9, wherein determining gait trajectory parameters of the two-legged robot based on the gait parameters through the preset gait planning model comprises:

inputting the center-of-mass height and the double support phase duration to the preset gait planning model;
determining, through a model corresponding to the single support phase in the preset gait planning model, the forward center-of-mass position and the forward center-of-mass movement speed of the two-legged robot in the single support phase based on the center-of-mass height and a first preset parameter; and
determining, through a model corresponding to the double support phase in the preset gait planning model, the forward center-of-mass position and the forward center-of-mass movement speed of the two-legged robot in the double support phase based on the double support phase duration and a second preset parameter.

11. The computer-readable storage medium according to claim 9, wherein:

the gait parameters further comprise a single support phase duration, a forward average speed, and a lateral average speed; and
the gait trajectory parameters further comprise a lateral center-of-mass movement speed of the two-legged robot in a single support phase termination state, a first motion step length of the two-legged robot, and a center-of-mass height of the two-legged robot in a vertical direction.

12. The computer-readable storage medium according to claim 11, wherein determining gait trajectory parameters of the two-legged robot based on the gait parameters through the preset gait planning model comprises:

inputting the single support phase duration, the double support phase duration, the forward average speed, and the lateral average speed to the preset gait planning model;
determining, through a model corresponding to the single support phase in the preset gait planning model, a forward movement speed and a lateral movement speed of the two-legged robot in the single support phase termination state based on the single support phase duration, the double support phase duration, the forward average speed, and a third preset parameter;
determining, through a model corresponding to the double support phase in the preset gait planning model, the first motion step length of the two-legged robot based on the single support phase duration, the double support phase duration, and the forward average speed; and
determining the center-of-mass height as the center-of-mass height of the two-legged robot in the vertical direction.

13. The computer-readable storage medium according to claim 12, wherein the motion control method further comprises:

acquiring an actual forward movement speed and an actual lateral movement speed of the two-legged robot;
determining whether the actual forward movement speed of the two-legged robot is consistent with the forward average speed, and determining whether the actual lateral movement speed is consistent with the lateral average speed;
determining a second motion step length of the two-legged robot in response to determining at least one of that the actual forward movement speed is inconsistent with the forward average speed and that the actual lateral movement speed is inconsistent with the lateral average speed; and
controlling the two-legged robot to move based on the second motion step length.

14. A two-legged robot, comprising:

a two-legged robot body, a lower limb assembly and a controller, the lower limb assembly and the controller being arranged on the two-legged robot body,
wherein the controller is configured to: acquire gait parameters of the two-legged robot; input the gait parameters to a preset gait planning model; determine gait trajectory parameters of the two-legged robot based on the gait parameters through the preset gait planning model, wherein the gait trajectory parameters comprise a center-of-mass state corresponding to a double support phase and a center-of-mass state corresponding to a single support phase, and the center-of-mass state comprises a center-of-mass position and a center-of-mass movement speed; and control the lower limb assembly of the two-legged robot to move according to the gait trajectory parameters.

15. The two-legged robot according to claim 14, wherein:

the gait parameters comprise a center-of-mass height and a double support phase duration; and
the center-of-mass state comprises a forward center-of-mass position and a forward center-of-mass movement speed.

16. The two-legged robot according to claim 15, wherein the controller is further configured to:

input the center-of-mass height and the double support phase duration to the preset gait planning model;
determine, through a model corresponding to the single support phase in the preset gait planning model, the forward center-of-mass position and the forward center-of-mass movement speed of the two-legged robot in the single support phase based on the center-of-mass height and a first preset parameter; and
determine, through a model corresponding to the double support phase in the preset gait planning model, the forward center-of-mass position and the forward center-of-mass movement speed of the two-legged robot in the double support phase based on the double support phase duration and a second preset parameter.

17. The two-legged robot according to claim 15, wherein:

the gait parameters further comprise a single support phase duration, a forward average speed, and a lateral average speed; and
the gait trajectory parameters further comprise a lateral center-of-mass movement speed of the two-legged robot in a single support phase termination state, a first motion step length of the two-legged robot, and a center-of-mass height of the two-legged robot in a vertical direction.

18. The two-legged robot according to claim 17, wherein the controller is further configured to:

input the single support phase duration, the double support phase duration, the forward average speed, and the lateral average speed to the preset gait planning model;
determine, through a model corresponding to the single support phase in the preset gait planning model, a forward movement speed and a lateral movement speed of the two-legged robot in the single support phase termination state based on the single support phase duration, the double support phase duration, the forward average speed, and a third preset parameter;
determine, through a model corresponding to the double support phase in the preset gait planning model, the first motion step length of the two-legged robot based on the single support phase duration, the double support phase duration, and the forward average speed; and
determine the center-of-mass height as the center-of-mass height of the two-legged robot in the vertical direction.

19. The two-legged robot according to claim 18, wherein the controller is further configured to:

acquire an actual forward movement speed and an actual lateral movement speed of the two-legged robot;
determine whether the actual forward movement speed of the two-legged robot is consistent with the forward average speed, and determining whether the actual lateral movement speed is consistent with the lateral average speed;
determine a second motion step length of the two-legged robot in response to determining at least one of that the actual forward movement speed is inconsistent with the forward average speed and that the actual lateral movement speed is inconsistent with the lateral average speed; and
control the two-legged robot to move based on the second motion step length.

20. The two-legged robot according to claim 19, wherein the controller is further configured to:

acquire a forward center-of-mass position and a forward movement speed of the two-legged robot at current time;
input the forward center-of-mass position and the forward movement speed of the two-legged robot at the current time, the single support phase duration, the double support phase duration, the forward average speed, and the first motion step length to the preset gait planning model; and
determine, through the preset gait planning model, the second motion step length of the two-legged robot based on the forward center-of-mass position and the forward movement speed of the two-legged robot at the current time, the single support phase duration, the double support phase duration, the forward average speed, the first motion step length, and the third preset parameter.
Patent History
Publication number: 20240042606
Type: Application
Filed: Dec 21, 2022
Publication Date: Feb 8, 2024
Inventor: Mingliang ZHOU (Beijing)
Application Number: 18/086,334
Classifications
International Classification: B25J 9/16 (20060101);