# US 2024/0004386 A1 · Systems and methods for dynamic predictive control of autonomous vehicles

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

- Number: US 2024/0004386 A1
- Document ID: US20240004386A1
- Status: Published application
- Kind: A1
- Application number: 18/469,466
- Filed: 2023-09-18
- Published: 2024-01-04
- Earliest claimed: 2018-11-05
- Assignees: Tusimple, Inc.
- Applicants: TuSimple, Inc.
- Inventors: Aaron Havens; Jun Chen; Yujia Wu; Haoming Sun; Zijie Xuan; Arda Kurt
- Web page: https://patentgrep.com/patent/US20240004386A1

## CPC

- B62D 15/025: {Active steering aids, e.g. helping the driver by actively influencing the steering system after environment evaluation (B62D1/28 takes precedence)}
- G05D 1/0088: {characterized by the autonomous decision making process, e.g. artificial intelligence, predefined behaviours (using knowledge based models G06N5/00)}
- B60W 10/04: including control of propulsion units
- G05B 19/4155: characterised by program execution, i.e. part program or machine function execution, e.g. selection of a program
- G05D 1/0212: {with means for defining a desired trajectory (involving a plurality of land vehicles G05D1/0287)}
- G05D 1/646: Following a predefined trajectory, e.g. a line marked on the floor or a flight path
- G05D 1/81: Handing over between on-board automatic and on-board manual control
- G06F 17/11: for solving equations {, e.g. nonlinear equations, general mathematical optimization problems (optimization specially adapted for a specific administrative, business or logistic context G06Q10/04)}
- B60W 10/18: including control of braking systems
- B60W 10/20: including control of steering systems
- 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 2050/0011: {Proportional Integral Differential [PID] controller}
- B60W 2050/0028: {Mathematical models, e.g. for simulation}
- B60W 2050/0083: {Setting, resetting, calibration}
- B60W 2300/145: Semi-trailers
- B60W 2400/00: Indexing codes relating to detected, measured or calculated conditions or factors
- B60W 2520/22: Articulation angle, e.g. between tractor and trailer
- B60W 2530/10: Weight
- B60W 2710/18: Braking system
- B60W 2710/20: Steering systems
- G05B 2219/42033: Kind of servo controller
- 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)
- 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
- G05B: CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS (systems for controlling or regulating non-electric variables G05D; systems for regulating electric or magnetic variables G05F; control devices or systems insofar as characterised by mechanical features only G05G)
- G06F: ELECTRIC DIGITAL DATA PROCESSING (computer systems based on specific computational models G06N)

## Abstract

Systems and methods for dynamic predictive control of autonomous vehicles are disclosed. In one aspect, an in-vehicle control system for a semi-truck includes one or more control mechanisms configured to control movement of the semi-truck and a processor. The system further includes computer-readable memory in communication with the processor and having stored thereon computer-executable instructions to cause the processor to receive a desired trajectory and a vehicle status of the semi-truck, determine a dynamic model of the semi-truck based on the desired trajectory and the vehicle status, determine at least one quadratic program (QP) problem based on the dynamic model, generate at least one control command for controlling the semi-truck by solving the at least one QP problem, and provide the at least one control command to the one or more control mechanisms.

## Claims

### Claim 1

An in-vehicle control system for a semi-truck, comprising:
a processor; and
a computer-readable memory in communication with the processor and having stored thereon computer-executable instructions to cause the processor to at least:
receive a desired trajectory for autonomously driving the semi-truck and a vehicle status of the semi-truck,
determine a lateral dynamic model and a longitudinal kinematic model of the semi-truck based on the desired trajectory and the vehicle status,
model movement of the semi-truck over a prediction time horizon using the lateral dynamic model and the longitudinal kinematic model,
generate at least one control command for controlling a movement of the semi-truck based on the modelled movement, and
output the at least one control command for the autonomous driving of the semi-truck along the desired trajectory.

### Claim 2 (depends on 1)

The system of claim 1, wherein the memory further has stored thereon computer-executable instructions to cause the processor to:
update a dynamic non-linear model of the semi-truck based on the desired trajectory and the vehicle status,
wherein determining the lateral dynamic model and the longitudinal kinematic model is further based on an approximation of the dynamic non-linear model.

### Claim 3 (depends on 2)

The system of claim 2, wherein updating the dynamic non-linear model is based on small angle error assumptions.

### Claim 4 (depends on 2)

The system of claim 2, wherein the dynamic non-linear model is configured to predict the movement of the semi-truck in response to a potential control command during autonomous driving of the semi-truck.

### Claim 5 (depends on 2)

The system of claim 2, wherein determining the lateral dynamic model and the longitudinal kinematic model includes transforming a reference frame for the dynamic non-linear model from a global inertial coordinate frame to a reference frame coordinate centered on a current position of the semi-truck on a road.

### Claim 6 (depends on 1)

The system of claim 1, wherein modelling movement of the semi-truck comprises:
determining a first quadratic program problem based on the lateral dynamic model, and
determining a second quadratic program problem based on the longitudinal kinematic model.

### Claim 7 (depends on 6)

The system of claim 6, wherein the memory further has stored thereon computer-executable instructions to cause the processor to:
solving the first quadratic program problem to generate a first solution, and
solving the second quadratic program problem to generate a second solution,
wherein generating at least one control command is further based on the first solution and the second solution.

### Claim 8 (depends on 5)

The system of claim 5, wherein the memory further has stored thereon computer-executable instructions to cause the processor to:
determine a road referenced error model based at least in part on a comparison between the transformed dynamic non-linear model and the desired trajectory.

### Claim 9 (depends on 8)

The system of claim 8, wherein the road referenced error model comprises a heading error and a relative lateral position error.

### Claim 10 (depends on 1)

The system of claim 1, wherein the modelling of the movement of the semi-truck comprises:
predicting the movement of the semi-truck using the lateral dynamic model and the longitudinal kinematic model, an average reference trajectory velocity of the semi-truck, and a curvature at a waypoint of the desired trajectory.

### Claim 11 (depends on 1)

The system of claim 1, wherein:
determining the lateral dynamics model is further based at least in part on one or more internal dynamic parameters of the semi-truck.

### Claim 12 (depends on 11)

The system of claim 11, wherein the one or more internal dynamic parameters include one or more of the following: a mass of the semi-truck, a moment of inertia of the semi-truck, a trailer angle, a cornering stiffness, and an articulation between a tractor and a trailer of the semi-truck.

### Claim 13

A non-transitory computer readable storage medium having stored thereon instructions that, when executed, cause at least one computing device to at least:
receive a desired trajectory for autonomously driving a semi-truck and a vehicle status of the semi-truck;
determine a lateral dynamic model and a longitudinal kinematic model of the semi-truck based on the desired trajectory and the vehicle status;
model movement of the semi-truck over a prediction time horizon using the lateral dynamic model and the longitudinal kinematic model;
generate at least one control command for controlling a movement of the semi-truck based on the modelled movement; and
output the at least one control command for the autonomous driving of the semi-truck along the desired trajectory.

### Claim 14 (depends on 13)

The non-transitory computer readable storage medium of claim 13, wherein:
the modelling of the movement of the semi-truck comprises determining a first quadratic program problem based on the lateral dynamic model and a second quadratic program problem based on the longitudinal kinematic model, and
the generating of the at least one control command comprises solving the first and second quadratic program problems.

### Claim 15 (depends on 14)

The non-transitory computer readable storage medium of claim 14, wherein the first and second quadratic program problems decouple lateral and longitudinal control objectives of a dynamic linear time-invariant model.

### Claim 16 (depends on 14)

The non-transitory computer readable storage medium of claim 14, wherein determining the first quadratic program problem and the second quadratic program problem is based on minimizing an error state at every reference point.

### Claim 17 (depends on 14)

The non-transitory computer readable storage medium of claim 14, wherein determining the first quadratic program problem and the second quadratic program problem is based on penalizing using command inputs and change in the command inputs over time.

### Claim 18

A method for controlling movement of a semi-truck, comprising:
receiving a desired trajectory for autonomously driving a semi-truck and a vehicle status of the semi-truck;
determining a lateral dynamic model and a longitudinal kinematic model of the semi-truck based on the desired trajectory and the vehicle status;
modelling movement of the semi-truck over a prediction time horizon using the lateral dynamic model and the longitudinal kinematic model;
generating at least one control command for controlling a movement of the semi-truck based on the modelled movement; and
outputting the at least one control command for the autonomous driving of the semi-truck along the desired trajectory.

### Claim 19 (depends on 18)

The method of claim 18, wherein the desired trajectory defines at least one of a position, heading, speed, and time in a local coordinate frame of the semi-truck.

### Claim 20 (depends on 18)

The method of claim 18, wherein the desired trajectory is discretized at a time interval to define a plurality of waypoints and a speed profile for the semi-truck.
