# US 2021/0341936 A1 · Method and Apparatus for Controlling Movement of Autonomous Mobile Machine, Machine, and Storage Medium

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

- Number: US 2021/0341936 A1
- Document ID: US20210341936A1
- Status: Published application
- Kind: A1
- Application number: 16/336,899
- Filed: 2018-08-03
- Published: 2021-11-04
- Earliest claimed: 2018-03-27
- Assignees: Guangzhou Automobile Group Co., Ltd.
- Applicants: Guangzhou Automobile Group Co., Ltd.
- Inventors: Shijing WENG; Xiaobo WANG; Hongshan ZHA; Mingzhe QIU; Xiaomin LIN
- Web page: https://patentgrep.com/patent/US20210341936A1

## CPC

- G05D 1/0212: {with means for defining a desired trajectory (involving a plurality of land vehicles G05D1/0287)}
- G05D 1/0223: {involving speed control of the vehicle (vehicle fittings for automatically controlling, i.e. preventing speed from exceeding an arbitrarily established velocity or maintaining speed at a particular velocity, as selected by the vehicle operator B60K31/00)}
- B60W 50/00: Details of control systems for road vehicle drive control not related to the control of a particular sub-unit {, e.g. process diagnostic or vehicle driver interfaces}
- B60W 60/001: {Planning or execution of driving tasks}
- B60W 2050/0026: {Lookup tables or parameter maps}
- B60W 2050/006: {Interpolation; Extrapolation}
- B60W 2520/10: Longitudinal speed
- B60W 2556/50: of positioning data, e.g. GPS [Global Positioning System] data
- G05D: SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- B60W: CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT

## Abstract

Provided is a method for controlling movement of an autonomous mobile machine. The method includes that: a target path and a current state of the autonomous mobile machine are acquired; at least one preview distance is calculated according to a current speed; at least one preview point each corresponding to a respective one of the at least one preview distance is acquired according to the target path and the at least one preview distance; a lateral deviation from each preview point to a current position is calculated; a direction control angle parameter of a current control period is acquired according to the lateral deviation, the current speed and a preset parameter matching table; and the autonomous mobile machine is controlled to move according to the direction control angle parameter. Also provided are an apparatus for controlling movement of an autonomous mobile machine, a machine and a storage medium.

## Claims

### Claim 1

A method for controlling movement of an autonomous mobile machine, comprising:
acquiring a target path and a current state of the autonomous mobile machine, wherein the current state comprises a current speed and a current position;
calculating at least one preview distance according to the current speed;
acquiring at least one preview point each corresponding to a respective one of the at least one preview distance according to the target path and the at least one preview distance;
calculating a lateral deviation from each preview point to the current position, wherein the lateral deviation is a vertical distance from the preview point to a current moving heading of the autonomous mobile machine;
acquiring a direction control angle parameter of a current control period according to the lateral deviation, the current speed and a preset parameter matching table, wherein the preset parameter matching table defines a direction control angle parameter of the autonomous mobile machine under a specific lateral deviation at a specific speed; and
controlling the autonomous mobile machine to move according to the direction control angle parameter.

### Claim 2 (depends on 1)

The method for controlling movement of an autonomous mobile machine as claimed in claim 1, wherein before acquiring the target path and the current state of the autonomous mobile machine, the method further comprises:
acquiring all first direction control angle parameters of the autonomous mobile machine under different lateral deviations at a specific speed;
acquiring all second direction control angle parameters of the autonomous mobile machine under a specific lateral deviation at different speeds; and
generating the parameter matching table according to all the first direction control angle parameters and all the second direction control angle parameters.

### Claim 3 (depends on 1)

The method for controlling movement of an autonomous mobile machine as claimed in claim 1, wherein before calculating the at least one preview distance according to the current speed, the method further comprises:
establishing a tracking coordinate system according to the target path and the current state; and
acquiring a current coordinate of the autonomous mobile machine according to the current position and the tracking coordinate system;
calculating the lateral deviation from each preview point to the current position comprises:
calculating a preview coordinate of each preview point according to the tracking coordinate system; and
calculating the lateral deviation from each preview point to the current position according to the current coordinate and the preview coordinate.

### Claim 4 (depends on 1)

The method for controlling movement of an autonomous mobile machine as claimed in claim 1, wherein there are a plurality of path points on the target path, and acquiring the at least one preview point each corresponding to the respective one of the at least one preview distance according to the target path and the at least one preview distance comprises:
for each preview distance,
calculating a distance between each path point and the current position, and taking a path point having a smallest distance as a closest point;
acquiring, starting from the closest point, a distance from each path point to the current position according to a sequence of the plurality of path points in the target path, until a first path point which is spaced apart from the current position by a distance greater than or equal to the preview distance is acquired for the first time;
selecting a previous path point of the first path point as a second path point according to the target path;
performing interpolation processing at a preset interval between the first path point and the second path point to acquire an interpolation point set; and
acquiring the preview point corresponding to the preview distance according to the preview distance and the interpolation point set.

### Claim 5 (depends on 4)

The method for controlling movement of an autonomous mobile machine as claimed in claim 4, wherein the preview distance comprises a remote preview distance and a near preview distance, the remote preview distance being a distance calculated based on the current speed and a preset remote preview time.

### Claim 6 (depends on 1)

The method for controlling movement of an autonomous mobile machine as claimed in claim 1, wherein acquiring the direction control angle parameter of the current control period according to the lateral deviation, the current speed and the preset parameter matching table comprises:
judging whether there is an item, which contains a lateral deviation and a speed simultaneously matching the lateral deviation and the current speed, in the preset parameter matching table;
in a case where there is such an item, extracting a direction control angle parameter corresponding to the item from the parameter matching table; and
in a case where there is no such item, calculating the lateral deviation and the speed by linear interpolation according to the preset parameter matching table to acquire the direction control angle parameter for the current control period.

### Claim 7 (depends on 1)

The method for controlling movement of an autonomous mobile machine as claimed in claim 1, wherein controlling the autonomous mobile machine to move according to the direction control angle parameter comprises:
calculating a control parameter corresponding to each preview point for the current control period according to the direction control angle parameter, the lateral deviation and the current speed;
calculating a target direction control angle control amount for the current control period according to the lateral deviation and the control parameter of each preview point; and
controlling the autonomous mobile machine to move according to the target direction control angle control amount.

### Claim 8 (depends on 7)

The method for controlling movement of an autonomous mobile machine as claimed in claim 7, wherein calculating the control parameter corresponding to each preview point for the current control period according to the direction control angle parameter, the lateral deviation and the current speed comprises:
calculating a proportional parameter corresponding to each preview point for the current control period according to the direction control angle parameter and the lateral deviation; and
acquiring an integral parameter and a differential parameter corresponding to each preview point for the current control period according to the current speed.

### Claim 9 (depends on 7)

The method for controlling movement of an autonomous mobile machine as claimed in claim 7, wherein there are at least two preview points, and calculating the target direction control angle control amount according to the lateral deviation and the control parameter of each preview point comprises:
calculating a control output of each preview point according to the lateral deviation and the control parameter of each preview point;
weighting each control output to acquire a direction control angle control amount; and
performing amplitude limiting on the direction control angle control amount to acquire the target direction control angle control amount for the current control period.

### Claim 10 (depends on 9)

The method for controlling movement of an autonomous mobile machine as claimed in claim 9, further comprising: in a case where the current control period is not the first control period, acquiring a historical lateral deviation, which corresponds to each preview point in the current control period, in previous N control periods, wherein
calculating the control output of each preview point according to the lateral deviation and the control parameter of each preview point comprises:
calculating the control output of each preview point according to the control parameter of each preview point, the lateral deviation and the historical lateral deviation.

### Claim 11

An apparatus for controlling movement of an autonomous mobile machine, comprising:
a data acquisition module, configured to acquire a target path and a current state of the autonomous mobile machine, wherein the current state comprises a current speed and a current position;
a preview distance calculation module, configured to calculate at least one preview distance according to the current speed;
a preview point acquisition module, configured to acquire at least one preview point each corresponding to a respective one of the at least one preview distance according to the target path and the at least one preview distance;
a lateral deviation calculation module, configured to calculate a lateral deviation from each preview point to the current position, wherein the lateral deviation is a vertical distance from the preview point to a current moving heading of the autonomous mobile machine;
a direction control angle parameter acquisition module, configured to acquire a direction control angle parameter of a current control period according to the lateral deviation, the current speed and a preset parameter matching table, wherein the preset parameter matching table defines a direction control angle parameter of the autonomous mobile machine under a specific lateral deviation at a specific speed; and
a movement control module, configured to control the autonomous mobile machine to move according to the direction control angle parameter.

### Claim 12 (depends on 1)

An autonomous mobile machine, comprising a machine body and a controller, wherein the controller comprises a processor, a memory and a computer program that is stored in the memory and configured to be executed by the processor, and when the processor executes the computer program, the method for controlling movement of an autonomous mobile machine as claimed in claim 1 is implemented.

### Claim 13 (depends on 1)

A computer readable storage medium, comprising a stored computer program, wherein when the computer program is run, a device where the computer readable storage medium is located is controlled to execute the method for controlling movement of an autonomous mobile machine as claimed in claim 1.

### Claim 14 (depends on 11)

The apparatus for controlling movement of an autonomous mobile machine as claimed in claim 11, wherein the apparatus is further configured to:
acquire all first direction control angle parameters of the autonomous mobile machine under different lateral deviations at a specific speed;
acquire all second direction control angle parameters of the autonomous mobile machine under a specific lateral deviation at different speeds; and
generate the parameter matching table according to all the first direction control angle parameters and all the second direction control angle parameters.

### Claim 15 (depends on 11)

The apparatus for controlling movement of an autonomous mobile machine as claimed in claim 11, wherein the apparatus is further configured to:
establish a tracking coordinate system according to the target path and the current state; and
acquire a current coordinate of the autonomous mobile machine according to the current position and the tracking coordinate system;
the lateral deviation calculation module is configured to:
calculate a preview coordinate of each preview point according to the tracking coordinate system; and
calculate the lateral deviation from each preview point to the current position according to the current coordinate and the preview coordinate.

### Claim 16 (depends on 11)

The apparatus for controlling movement of an autonomous mobile machine as claimed in claim 11, wherein there are a plurality of path points on the target path, and the preview point acquisition module is configured to:
for each preview distance,
calculate a distance between each path point and the current position, and take a path point having a smallest distance as a closest point;
acquire, starting from the closest point, a distance from each path point to the current position according to a sequence of the plurality of path points in the target path, until a first path point which is spaced apart from the current position by a distance greater than or equal to the preview distance is acquired for the first time;
select a previous path point of the first path point as a second path point according to the target path;
perform interpolation processing at a preset interval between the first path point and the second path point to acquire an interpolation point set; and
acquire the preview point corresponding to the preview distance according to the preview distance and the interpolation point set.

### Claim 17 (depends on 16)

The apparatus for controlling movement of an autonomous mobile machine as claimed in claim 16, wherein the preview distance comprises a remote preview distance and a near preview distance, the remote preview distance being a distance calculated based on the current speed and a preset remote preview time.

### Claim 18 (depends on 11)

The apparatus for controlling movement of an autonomous mobile machine as claimed in claim 11, wherein the direction control angle parameter acquisition module is configured to:
judge whether there is an item, which contains a lateral deviation and a speed simultaneously matching the lateral deviation and the current speed, in the preset parameter matching table;
in a case where there is such an item, extract a direction control angle parameter corresponding to the item from the parameter matching table; and
in a case where there is no such item, calculate the lateral deviation and the speed by linear interpolation according to the preset parameter matching table to acquire the direction control angle parameter for the current control period.

### Claim 19 (depends on 11)

The apparatus for controlling movement of an autonomous mobile machine as claimed in claim 11, wherein the movement control module is configured to:
calculate a control parameter corresponding to each preview point for the current control period according to the direction control angle parameter, the lateral deviation and the current speed;
calculate a target direction control angle control amount for the current control period according to the lateral deviation and the control parameter of each preview point; and
control the autonomous mobile machine to move according to the target direction control angle control amount.

### Claim 20 (depends on 19)

The apparatus for controlling movement of an autonomous mobile machine as claimed in claim 19, wherein the movement control module is configured to calculate the control parameter corresponding to each preview point for the current control period according to the direction control angle parameter, the lateral deviation and the current speed in a following manner:
calculating a proportional parameter corresponding to each preview point for the current control period according to the direction control angle parameter and the lateral deviation; and
acquiring an integral parameter and a differential parameter corresponding to each preview point for the current control period according to the current speed.
