# US 2023/0055206 A1 · Legged robot motion control method, apparatus, and device, and medium

> Agents: this data is available as JSON from the patentgrep API and MCP server — see https://patentgrep.com/llms.txt

- Number: US 2023/0055206 A1
- Document ID: US20230055206A1
- Status: Published application
- Kind: A1
- Application number: 17/969,999
- Filed: 2022-10-20
- Published: 2023-02-23
- Earliest claimed: 2020-09-07
- Assignees: Tencent Technology (Shenzhen) Company Limited
- Applicants: Tencent Technology (Shenzhen) Company Limited
- Inventors: Yu ZHENG; Xinyang JIANG; Wanchao CHI; Zhengyou ZHANG
- Web page: https://patentgrep.com/patent/US20230055206A1

## CPC

- B25J 9/1664: {characterised by motion, path, trajectory planning}
- G05D 1/0231: {using optical position detecting means (position-fixing by using electromagnetic waves other than radio waves, e.g. optical position detecting means G01S5/16)}
- B62D 57/032: with alternately or sequentially lifted supporting base and legs; with alternately or sequentially lifted feet or skid (B62D57/024 takes precedence)
- B25J: MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES ({manipulators specially adapted for use in surgery A61B34/70; manipulators used in cleaning hollow articles B08B9/04}; manipulators associated with rolling mills B21B39/20; manipulators associated with forging machines B21J13/10; {manipulators associated with picking-up and placing mechanisms B23P19/007}; means for holding wheels or parts thereof B60B30/00; {vehicles with ground-engaging propulsion means, e.g. walking members B62D57/02, B62D57/032; devices for picking-up and depositing articles or materials between conveyors B65G47/90, B65G47/91; manipulators with gripping or holding means for transferring packages B65H67/065}; cranes B66C; {manipulators used in the protection or supervision of pipe-line installations F17D5/00; walking equipment adapted for nuclear steam-generators F22B37/006}; manipulators specially adapted for, or associated with, nuclear reactors G21C; {apparatus used for handling wafers during manufacture or treatment of semiconductor H10P72/50})
- G05D: SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- B62D: MOTOR VEHICLES; TRAILERS (steering, or guiding on a desired track, of agricultural machines or implements A01B69/00; wheels, castors, axles, increasing wheel adhesion B60B; vehicle tyres, tyre inflation or tyre changing B60C; connections between vehicles of a train or the like B60D; vehicles for use on rail and road, amphibious or convertible vehicles B60F; suspension arrangements B60G; heating, cooling, ventilating or other air treating devices B60H; windows, windscreens, non-fixed roofs, doors or similar devices, protective coverings for vehicles not in use B60J; propulsion plant arrangements, auxiliary drives, transmissions, controls, instrumentation or dashboards B60K; electric equipment or propulsion of electrically-propelled vehicles B60L; power supply for electrically-propelled vehicles B60M; passenger accommodation not otherwise provided for B60N; adaptations for load transportation or to carry special loads or objects B60P; arrangement of signalling or lighting devices, the mounting or supporting thereof or circuits therefor, for vehicles in general B60Q; vehicles, vehicle fittings or vehicle parts not otherwise provided for B60R; servicing, cleaning, repairing, supporting, lifting, or manoeuvring, not otherwise provided for, B60S; brake arrangements, brake control systems or parts thereof B60T; air-cushion vehicles B60V; motor-cycles, accessories therefor B62J, B62K; testing of vehicles G01M)

## Abstract

A legged robot motion control method includes: acquiring centroid state data of a spatial path start point and a spatial path end point of a motion path; determining a target landing point of afoot of the legged robot in the motion path based on the spatial path start point and the spatial path end point; determining a change relationship between a centroid position change coefficient and a foot contact force based on the centroid state data; selecting, under constraint of a constraint condition set, a target centroid position change coefficient that meets the change relationship; the constraint condition set including a spatial landing point constraint condition; determining a target motion control parameter according to the target centroid position change coefficient and the target landing point of the foot; and controlling, based on the target motion control parameter, the legged robot to perform motion according to the motion path.

## Claims

### Claim 1

A legged robot motion control method, performed by a control device and comprising:
acquiring centroid state data respectively corresponding to a spatial path start point and a spatial path end point of a motion path of a legged robot;
determining a target landing point of a foot of the legged robot in the motion path based on the spatial path start point and the spatial path end point;
determining a change relationship between a centroid position change coefficient and a foot contact force based on the centroid state data respectively corresponding to the spatial path start point and the spatial path end point;
selecting, under constraint of a constraint condition set, a target centroid position change coefficient that meets the change relationship, wherein the constraint condition set comprises at least a spatial landing point constraint condition, and the spatial landing point constraint condition constrains a value of the centroid position change coefficient for the legged robot to reach the target landing point;
determining a target motion control parameter according to the target centroid position change coefficient and the target landing point of the foot; and
controlling, based on the target motion control parameter, the legged robot to perform motion according to the motion path.

### Claim 2 (depends on 1)

The method according to claim 1, wherein the centroid state data corresponding to the spatial path start point comprises a start centroid position of the spatial path start point, and the determining a change relationship between a centroid position change coefficient and a foot contact force based on the centroid state data respectively corresponding to the spatial path start point and the spatial path end point comprises:
obtaining moving duration required by the legged robot to complete the motion path;
determining a plurality of sampling moments from the moving duration, and determining a time interval between each sampling moment and a moment corresponding to the spatial path start point as a time interval corresponding to the sampling moment; and
obtaining a change relationship between the centroid position change coefficient and a foot contact force at each sampling moment according to a time interval corresponding to each sampling moment, the start centroid position, and a relational expression between a centroid position and the foot contact force at each sampling moment.

### Claim 3 (depends on 2)

The method according to claim 2, wherein the obtaining a change relationship between the centroid position change coefficient and a foot contact force at each sampling moment according to a time interval corresponding to each sampling moment, the start centroid position, and a relational expression between a centroid position and the foot contact force at each sampling moment comprises:
determining a centroid angular momentum at each sampling moment according to a body posture of the legged robot at each sampling moment; and
obtaining the change relationship between the centroid position change coefficient and the foot contact force at each sampling moment according to the centroid angular momentum at each sampling moment, the time interval corresponding to each sampling moment, the start centroid position, and the relational expression between the centroid position and the foot contact force at each sampling moment.

### Claim 4 (depends on 2)

The method according to claim 2, wherein the selecting, under constraint of a constraint condition set, a target centroid position change coefficient that meets the change relationship comprises:
determining a target constraint relationship of a centroid position change coefficient at each sampling moment as a target constraint relationship corresponding to each sampling moment according to a foot in contact with a contact surface at each sampling moment, a body posture of the legged robot at each sampling moment, a target landing point of each foot, and the spatial landing point constraint condition; and
selecting the target centroid position change coefficient that meets the target constraint relationship corresponding to each sampling moment and the change relationship between the centroid position change coefficient and the foot contact force at each sampling moment.

### Claim 5 (depends on 4)

The method according to claim 4, wherein the method further comprises:
determining, for each sampling moment according to a rotation range and a length of a joint associated with a foot in contact with the contact surface at the sampling moment, a plurality of positions accessible to the foot in contact with the contact surface; and
fitting the plurality of positions to obtain the spatial landing point constraint condition of the legged robot.

### Claim 6 (depends on 1)

The method according to claim 1, wherein the selecting, under constraint of a constraint condition set, a target centroid position change coefficient that meets the change relationship comprises:
obtaining, under constraint of the constraint condition set, a plurality of groups of candidate results that meet the change relationship; each group of candidate results comprising a centroid position change coefficient; and
minimizing an objective function according to the plurality of groups of candidate results, and determining a target result from the plurality of groups of candidate results; the objective function being a quadratic term constructed according to a correlation quantity of the candidate result.

### Claim 7 (depends on 6)

The method according to claim 6, wherein the objective function comprises at least one of:
a quadratic term related to a change amount of a foot contact force in the motion path;
a quadratic term of a change amount of a centroid position in the motion path;
a quadratic term of a difference between an end centroid position of the spatial path end point in the centroid state data corresponding to the spatial path end point and a centroid position of the spatial path end point in the candidate result;
a quadratic term of a difference between an end centroid speed of the spatial path end point in the centroid state data corresponding to the spatial path end point and a centroid speed of the spatial path end point in the candidate result; or
a quadratic term of a difference between an end centroid acceleration of the spatial path end point in the centroid state data corresponding to the spatial path end point and a centroid acceleration of the spatial path end point in the candidate result.

### Claim 8 (depends on 1)

The method according to claim 1, wherein the constraint condition set further comprises:
a friction constraint condition used for constraining a friction between a foot of a landing point and the contact surface; and the friction between the foot of the landing point and the contact surface is determined according to the foot contact force and a friction coefficient.

### Claim 9 (depends on 1)

The method according to claim 1, wherein the determining a target landing point of the foot in the motion path based on the spatial path start point and the spatial path end point comprises:
collecting a three-dimensional point cloud map of an environment in which the legged robot is currently located; and
determining, from the three-dimensional point cloud map according to a foot of the legged robot in contact with the contact surface in the motion path, a target landing point corresponding to the foot in contact with the contact surface.

### Claim 10 (depends on 1)

The method according to claim 1, wherein the determining a target motion control parameter according to the target centroid position change coefficient and the target landing point of each foot comprises:
determining a centroid position of the legged robot at a moment according to the target centroid position change coefficient; and
determining a joint torque of the legged robot at the moment according to the centroid position of the legged robot at the moment and the target landing point of each foot.

### Claim 11

A legged robot motion control apparatus, comprising:
a memory; and
at least one processor connected to the memory;
the memory storing instructions executable by the at least one processor, and the at least one processor, when executing the instructions stored in the memory, are configured to implement:
acquiring centroid state data respectively corresponding to a spatial path start point and a spatial path end point of a motion path of a legged robot;
determining a target landing point of a foot of the legged robot in the motion path based on the spatial path start point and the spatial path end point;
determining a change relationship between a centroid position change coefficient and a foot contact force based on the centroid state data respectively corresponding to the spatial path start point and the spatial path end point;
selecting, under constraint of a constraint condition set, a target centroid position change coefficient that meets the change relationship, wherein the constraint condition set comprises at least a spatial landing point constraint condition, and the spatial landing point constraint condition constrains a value of the centroid position change coefficient for the legged robot to reach the target landing point;
determining a target motion control parameter according to the target centroid position change coefficient and the target landing point of the foot; and
controlling, based on the target motion control parameter, the legged robot to perform motion according to the motion path.

### Claim 12 (depends on 11)

The apparatus according to claim 11, wherein the centroid state data corresponding to the spatial path start point comprises a start centroid position of the spatial path start point, and the determining a change relationship between a centroid position change coefficient and a foot contact force based on the centroid state data respectively corresponding to the spatial path start point and the spatial path end point comprises:
obtaining moving duration required by the legged robot to complete the motion path;
determining a plurality of sampling moments from the moving duration, and determining a time interval between each sampling moment and a moment corresponding to the spatial path start point as a time interval corresponding to the sampling moment; and
obtaining a change relationship between the centroid position change coefficient and a foot contact force at each sampling moment according to a time interval corresponding to each sampling moment, the start centroid position, and a relational expression between a centroid position and the foot contact force at each sampling moment.

### Claim 13 (depends on 12)

The apparatus according to claim 12, wherein the obtaining a change relationship between the centroid position change coefficient and a foot contact force at each sampling moment according to a time interval corresponding to each sampling moment, the start centroid position, and a relational expression between a centroid position and the foot contact force at each sampling moment comprises:
determining a centroid angular momentum at each sampling moment according to a body posture of the legged robot at each sampling moment; and
obtaining the change relationship between the centroid position change coefficient and the foot contact force at each sampling moment according to the centroid angular momentum at each sampling moment, the time interval corresponding to each sampling moment, the start centroid position, and the relational expression between the centroid position and the foot contact force at each sampling moment.

### Claim 14 (depends on 12)

The apparatus according to claim 12, wherein the selecting, under constraint of a constraint condition set, a target centroid position change coefficient that meets the change relationship comprises:
determining a target constraint relationship of a centroid position change coefficient at each sampling moment as a target constraint relationship corresponding to each sampling moment according to a foot in contact with a contact surface at each sampling moment, a body posture of the legged robot at each sampling moment, a target landing point of each foot, and the spatial landing point constraint condition; and
selecting the target centroid position change coefficient that meets the target constraint relationship corresponding to each sampling moment and the change relationship between the centroid position change coefficient and the foot contact force at each sampling moment.

### Claim 15 (depends on 14)

The apparatus according to claim 14, wherein the processor is further configured to perform:
determining, for each sampling moment according to a rotation range and a length of a joint associated with a foot in contact with the contact surface at the sampling moment, a plurality of positions accessible to the foot in contact with the contact surface; and
fitting the plurality of positions to obtain the spatial landing point constraint condition of the legged robot.

### Claim 16 (depends on 11)

The apparatus according to claim 11, wherein the selecting, under constraint of a constraint condition set, a target centroid position change coefficient that meets the change relationship comprises:
obtaining, under constraint of the constraint condition set, a plurality of groups of candidate results that meet the change relationship; each group of candidate results comprising a centroid position change coefficient; and
minimizing an objective function according to the plurality of groups of candidate results, and determining a target result from the plurality of groups of candidate results; the objective function being a quadratic term constructed according to a correlation quantity of the candidate result.

### Claim 17 (depends on 16)

The apparatus according to claim 16, wherein the objective function comprises at least one of:
a quadratic term related to a change amount of a foot contact force in the motion path;
a quadratic term of a change amount of a centroid position in the motion path;
a quadratic term of a difference between an end centroid position of the spatial path end point in the centroid state data corresponding to the spatial path end point and a centroid position of the spatial path end point in the candidate result;
a quadratic term of a difference between an end centroid speed of the spatial path end point in the centroid state data corresponding to the spatial path end point and a centroid speed of the spatial path end point in the candidate result; or
a quadratic term of a difference between an end centroid acceleration of the spatial path end point in the centroid state data corresponding to the spatial path end point and a centroid acceleration of the spatial path end point in the candidate result.

### Claim 18 (depends on 11)

The apparatus according to claim 11, wherein the constraint condition set further comprises:
a friction constraint condition used for constraining a friction between a foot of a landing point and the contact surface; and the friction between the foot of the landing point and the contact surface is determined according to the foot contact force and a friction coefficient.

### Claim 19 (depends on 11)

The apparatus according to claim 11, wherein the determining a target landing point of the foot in the motion path based on the spatial path start point and the spatial path end point comprises:
collecting a three-dimensional point cloud map of an environment in which the legged robot is currently located; and
determining, from the three-dimensional point cloud map according to a foot of the legged robot in contact with the contact surface in the motion path, a target landing point corresponding to the foot in contact with the contact surface.

### Claim 20

A non-transitory storage medium, storing computer instructions, when run on a computer, causing the computer to perform:
acquiring centroid state data respectively corresponding to a spatial path start point and a spatial path end point of a motion path of a legged robot;
determining a target landing point of a foot of the legged robot in the motion path based on the spatial path start point and the spatial path end point;
determining a change relationship between a centroid position change coefficient and a foot contact force based on the centroid state data respectively corresponding to the spatial path start point and the spatial path end point;
selecting, under constraint of a constraint condition set, a target centroid position change coefficient that meets the change relationship, wherein the constraint condition set comprises at least a spatial landing point constraint condition, and the spatial landing point constraint condition constrains a value of the centroid position change coefficient for the legged robot to reach the target landing point;
determining a target motion control parameter according to the target centroid position change coefficient and the target landing point of the foot; and
controlling, based on the target motion control parameter, the legged robot to perform motion according to the motion path.
