Longitudinal Controller Stanley

Control longitudinal velocity of vehicle by using Stanley method

• 

×

Libraries:
Automated Driving Toolbox / Vehicle Control

Description

The Longitudinal Controller Stanley block computes the acceleration and deceleration commands, in meters per second, that control the velocity of the vehicle. Specify the reference velocity, current velocity, and current driving direction. The controller computes these commands using the Stanley method [1], which the block implements as a discrete proportional-integral (PI) controller with integral anti-windup. For more details, see Algorithms.

You can also compute the steering angle command of a vehicle using the Stanley method. See the Lateral Controller Stanley block.

Examples

Control Vehicle Velocity

Control the velocity of a vehicle in forward motion using a longitudinal controller.

• Open Model

Automated Parking Valet in Simulink

Construct an automated parking valet system in Simulink^® with Automated Driving Toolbox™.

• Open Model

Ports

Input

RefVelocity — Reference velocity

real scalar

Reference velocity, in meters per second, specified as a real scalar.

CurrVelocity — Current velocity

real scalar

Current velocity of the vehicle, in meters per second, specified as a real scalar.

Direction — Driving direction

1 (forward motion) | -1 (reverse motion)

Driving direction of vehicle, specified as 1 for forward motion and -1 for reverse motion.

Reset — Trigger to reset integral of velocity error

0 (hold steady) | nonzero scalar (reset)

Trigger to reset the integral of velocity error, e(k), to zero. A value of 0 holds e(k) steady. A nonzero value resets e(k).

Output

AccelCmd — Acceleration command

real scalar in the range [0, M_A]

Acceleration command, returned as a real scalar in the range [0, M_A], where M_A is the value of the Maximum longitudinal acceleration (m/s^2) parameter.

DecelCmd — Deceleration command

real scalar in the range [0, M_D]

Deceleration command, returned as a real scalar in the range [0, M_D], where M_D is the value of the Maximum longitudinal deceleration (m/s^2) parameter.

Parameters

Proportional gain, Kp — Proportional gain

2.5 (default) | positive real scalar

Proportional gain of controller, K_p, specified as a positive real scalar.

Integral gain, Ki — Integral gain

1 (default) | positive real scalar

Integral gain of controller, K_i, specified as a positive real scalar.

Sample time (s) — Sample time

0.05 (default) | positive real scalar

Sample time of controller, in seconds, specified as a positive real scalar.

Maximum longitudinal acceleration (m/s^2) — Maximum longitudinal acceleration

3 (default) | positive real scalar

Maximum longitudinal acceleration, in meters per second squared, specified as a positive real scalar.

The block saturates the output from the AccelCmd to the range [0, M_A], where M_A is the value of this parameter. Values above M_A are set to M_A.

Maximum longitudinal deceleration (m/s^2) — Maximum longitudinal deceleration

6 (default) | positive real scalar

Maximum longitudinal deceleration, in meters per second squared, specified as a positive real scalar.

The block saturates the output from the DecelCmd port to the range [0, M_D], where M_D is the value of this parameter. Values above M_D are set to M_D.

Algorithms

The Longitudinal Controller Stanley block implements a discrete proportional-integral (PI) controller with integral anti-windup, as described by the Anti-windup method (Simulink) parameter of the PID Controller block. The block uses this equation:

$$u(k)=(K_{\text{p}}+K_{\text{i}}\frac{T_{\text{s}}z}{z-1})e(k)$$

• u(k) is the control signal at the kth time step.

• K_p is the proportional gain, as set by the Proportional gain, Kp parameter.

• K_i is the integral gain, as set by the Integral gain, Ki parameter.

• T_s is the sample time of the block in seconds, as set by the Sample time (s) parameter.

• e(k) is the velocity error (CurrVelocity – RefVelocity) at the kth time step. For each k, this error is equal to the difference between the current velocity and reference velocity inputs (CurrVelocity – RefVelocity).

The control signal, u, determines the value of acceleration command AccelCmd and deceleration command DecelCmd. The block saturates the acceleration and deceleration commands to respective ranges of [0, M_A] and [0, M_D], where:

• M_A is value of the Maximum longitudinal acceleration (m/s^2) parameter.

• M_D is the value of the Maximum longitudinal deceleration (m/s^2) parameter.

At each time step, only one of the AccelCmd and DecelCmd port values is positive, and the other port value is 0. In other words, the vehicle can either accelerate or decelerate in one time step, but it cannot do both at one time.

The direction of motion, as specified in the Direction input port, determines which command is positive at the given time step.

Direction Port Value	Control Signal Value u(k)	AccelCmd Port Value	DecelCmd Port Value	Description
1 (forward motion)	u(k) > 0	positive real scalar	0	Vehicle speeds up as it travels forward
	u(k) < 0	0	positive real scalar	Vehicle slows down as it travels forward
-1 (reverse motion)	u(k) > 0	0	positive real scalar	Vehicle slows down as it travels in reverse
	u(k) < 0	positive real scalar	0	Vehicle speeds up as it travels in reverse

References

[1] Hoffmann, Gabriel M., Claire J. Tomlin, Michael Montemerlo, and Sebastian Thrun. "Autonomous Automobile Trajectory Tracking for Off-Road Driving: Controller Design, Experimental Validation and Racing." American Control Conference. August 2007, pp. 2296–2301. doi:10.1109/ACC.2007.4282788.

Extended Capabilities

C/C++ Code Generation
Generate C and C++ code using Simulink® Coder™.

Version History

Introduced in R2019a