# US 2019/0317516 A1 · Autonomous automobile guidance and trajectory-tracking

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

- Number: US 2019/0317516 A1
- Document ID: US20190317516A1
- Status: Published application
- Kind: A1
- Application number: 16/348,280
- Filed: 2017-11-13
- Published: 2019-10-17
- Earliest claimed: 2016-11-10
- Assignees: Ohio University
- Applicants: Ohio University
- Inventors: Jianchao Zhu; Yuanyan Chen
- Web page: https://patentgrep.com/patent/US20190317516A1

## CPC

- B60W 60/001: {Planning or execution of driving tasks}
- G01C 21/26: specially adapted for navigation in a road network
- B60W 40/103: Side slip angle of vehicle body
- B60W 40/114: Yaw movement
- 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/0219: {ensuring the processing of the whole working surface}
- B60W 2050/0008: {Feedback, closed loop systems or details of feedback error signal}
- B60W 2050/0012: {Feedforward or open loop systems}
- 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
- G01C: MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY (measuring liquid level G01F; radio navigation, determining distance or velocity by use of propagation effects, e.g. Doppler effects, propagation time, of radio waves, analogous arrangements using other waves G01S)
- 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

## Abstract

Systems, methods, and computer program products for autonomous car-like ground vehicle guidance and trajectory tracking control. A multi-loop 3DOF trajectory linearization controller provides guidance to a vehicle having nonlinear rigid-body dynamics with nonlinear tire traction force, nonlinear drag forces and actuator dynamics. The controller may be based on a closed-loop PD-eigenvalue assignment and a singular perturbation (time-scale separation) theory for exponential stability, and controls the longitudinal velocity and steering angle simultaneously to follow a feasible guidance trajectory. A line-of-sight based pure-pursuit guidance controller may generate a 3DOF spatial trajectory that is provided to the 3DOF controller to enable target pursuit and path-following/trajectory-tracking. The resulting combination may provide a 3DOF motion control system with integrated simultaneous steering and speed control for automobile and car-like mobile robot target pursuit and trajectory-tracking.

## Claims

### Claim 1

A method of automatically guiding and controlling a car-like ground vehicle, the method comprising:
receiving a position command signal at a guidance controller including a first open-loop nominal controller and a first closed-loop tracking error controller;
receiving a position measurement signal at the guidance controller;
determining, by the first open-loop nominal controller, a nominal velocity signal based on the position command signal;
determining, by the first closed-loop tracking error controller, a velocity control signal based on the position command signal and the position measurement signal;
determining, by the guidance controller, a velocity command signal based on the nominal velocity signal and the velocity control signal;
determining, by the guidance controller, a drive command signal based on the velocity command signal; and
transmitting the drive command signal to a drive actuator of the car-like ground vehicle.

### Claim 2 (depends on 1)

The method of claim 1 wherein the velocity control signal includes a lateral velocity control signal, and further comprising:
determining a yaw control signal based on a longitudinal component of the nominal velocity signal and the lateral velocity control signal; and
transmitting the yaw control signal to a steering controller.

### Claim 3 (depends on 1)

The method of claim 1 wherein the velocity command signal includes a longitudinal velocity command signal, and determining the drive command signal comprises:
determining a difference between a longitudinal velocity measurement signal and the longitudinal velocity command signal to generate a longitudinal velocity error signal;
determining, by a second closed-loop tracking error controller of the guidance controller, a longitudinal force control signal based on the longitudinal velocity error signal; and
determining the drive command signal based on the longitudinal force control signal.

### Claim 4 (depends on 3)

The method of claim 3 wherein determining the drive command signal further comprises:
determining, by a second open-loop nominal controller, a nominal force signal; and
determining the drive command signal based on the nominal force signal and a tire traction force model.

### Claim 5 (depends on 4)

The method of claim 4 further comprising:
determining a nominal drive signal based on the nominal force signal;
determining a nominal yaw signal based on the nominal force signal;
receiving the nominal yaw signal at a steering controller including a third open-loop nominal controller;
determining, by the third open-loop nominal controller, a nominal yaw angular rate signal based on the nominal yaw signal; and
determining, by the steering controller, a steering angle command signal based on the nominal yaw angular rate signal.

### Claim 6 (depends on 5)

The method of claim 5 wherein the steering controller further includes a third closed loop tracking error controller, and further comprising:
receiving a yaw tracking error signal at the third closed loop tracking error controller;
determining, by the third closed loop tracking error controller, a yaw angular rate control signal based on the yaw tracking error signal; and
determining, by the steering controller, the steering angle command signal based on the yaw angular rate control signal.

### Claim 7 (depends on 6)

The method of claim 6 wherein the steering controller includes a fourth closed-loop tracking error controller and fourth open-loop nominal controller, and determining the steering angle command signal comprises:
receiving, at the steering controller, a yaw angular rate measurement signal;
determining a yaw angular rate command signal based on the difference between the nominal yaw angular rate signal and the yaw angular rate control signal;
determining a yaw angular rate error signal based on the difference between the yaw angular rate command signal and the yaw angular rate measurement signal;
determining, by the fourth closed-loop tracking error controller, a body torque control signal based on the yaw angular rate error signal;
determining, by the fourth open-loop nominal controller, a nominal body torque signal; and
determining the steering angle command signal as a sum of the body torque control signal and the nominal body torque signal.

### Claim 8 (depends on 1)

The method of claim 1 further comprising:
defining a guidance trajectory that leads from a current position of the car-like ground vehicle to a target on a mission trajectory within a domain of attraction of the guidance controller; and
determining the position command signal based on a position of the target relative to the current position of the car-like ground vehicle.

### Claim 9 (depends on 8)

The method of claim 8 wherein determining the position command signal includes:
receiving a target relative position signal;
determining, based on the target relative position signal, a range distance vector from the car-like ground vehicle to the target, the range distance vector defining a distance and a b-frame line-of-sight angle between the car-like ground vehicle and the target;
receiving a sensed yaw angle;
determining a longitudinal component of the range distance vector based on the b-frame line-of-sight angle;
determining a guidance angle based on the b-frame line-of-sight angle and the sensed yaw angle;
determining a guidance velocity in the b-frame based on the longitudinal component of the range distance vector; and
generating the position command signal in the n-frame based on the guidance angle and the guidance velocity.

### Claim 10

A controller for automatically guiding and controlling a car-like ground vehicle, the controller comprising:
one or more processors; and
a memory in communication with the one or more processors and storing program code that, when executed by at least one of the one or more processors, causes the controller to:
receive a position command signal;
receive a position measurement signal;
determine a nominal velocity signal based on the position command signal;
determine a velocity control signal based on the position command signal and the position measurement signal;
determine a velocity command signal based on the nominal velocity signal and the velocity control signal;
determine a drive command signal based on the velocity command signal; and
transmit the drive command signal to a drive actuator of the car-like ground vehicle.

### Claim 11 (depends on 10)

The controller of claim 10 wherein the velocity control signal includes a lateral velocity control signal and the program code further causes the controller to:
determine a yaw control signal based on a longitudinal component of the nominal velocity signal and the lateral velocity control signal; and
transmit the yaw control signal to a steering controller.

### Claim 12 (depends on 10)

The controller of claim 10 wherein the velocity command signal includes a longitudinal velocity command signal, and the program code causes the controller to determine the drive command signal by:
determining a difference between a longitudinal velocity measurement signal and the longitudinal velocity command signal to generate a longitudinal velocity error signal;
determining a longitudinal force control signal based on the longitudinal velocity error signal; and
determining the drive command signal based on the longitudinal force control signal.

### Claim 13 (depends on 12)

The controller of claim 12 wherein the program code causes the controller to determine the drive command signal by:
determining a nominal force signal; and
determining the drive command signal based on the nominal force signal and a tire traction force model.

### Claim 14 (depends on 13)

The controller of claim 13 wherein the program code further causes the controller to:
determine a nominal drive signal based on the nominal force signal;
determine a nominal yaw signal based on the nominal force signal;
determine a nominal yaw angular rate signal based on the nominal yaw signal; and
determine a steering angle command signal based on the nominal yaw angular rate signal.

### Claim 15 (depends on 14)

The controller of claim 14 wherein the program code further causes the controller to:
determine a yaw angular rate control signal based on a yaw tracking error signal; and
determine the steering angle command signal based on the yaw angular rate control signal.

### Claim 16 (depends on 15)

The controller of claim 15 wherein the program code causes the controller to determine the steering angle command signal by:
receiving a yaw angular rate measurement signal;
determining a yaw angular rate command signal based on the difference between the nominal yaw angular rate signal and the yaw angular rate control signal;
determining a yaw angular rate error signal based on the difference between the yaw angular rate command signal and the yaw angular rate measurement signal;
determining a body torque control signal based on the yaw angular rate error signal;
determining a nominal body torque signal; and
determining the steering angle command signal as a sum of the body torque control signal and the nominal body torque signal.

### Claim 17 (depends on 10)

The controller of claim 10 wherein the program code further causes the controller to:
define a guidance trajectory that leads from a current position of the car-like ground vehicle to a target on a mission trajectory within a domain of attraction of the controller; and
determine the position command signal based on a position of the target relative to the current position of the car-like ground vehicle.

### Claim 18 (depends on 17)

The controller of claim 17 wherein the program code causes the controller to determine the position command signal by:
receiving a target relative position signal;
determining, based on the target relative position signal, a range distance vector from the car-like ground vehicle to the target, the range distance vector defining a distance and a b-frame line-of-sight angle between the car-like ground vehicle and the target;
receiving a sensed yaw angle;
determining a longitudinal component of the range distance vector based on the b-frame line-of-sight angle;
determining a guidance angle based on the b-frame line-of-sight angle and the sensed yaw angle;
determining a guidance velocity in the b-frame based on the longitudinal component of the range distance vector; and
generating the position command signal in the n-frame based on the guidance angle and the guidance velocity.

### Claim 19

A computer program product for automatically guiding and controlling a car-like ground vehicle, the computer program product comprising:
a non-transitory computer readable storage medium containing program code that, when executed by one or more processors, causes the one or more processors to:
receive a position command signal;
receive a position measurement signal;
determine a nominal velocity signal based on the position command signal;
determine a velocity control signal based on the position command signal and the position measurement signal;
determine a velocity command signal based on the nominal velocity signal and the velocity control signal;
determine a drive command signal based on the velocity command signal; and
transmit the drive command signal to a drive actuator of the car-like ground vehicle.

### Claim at position 20

20-22. (canceled)
