Ackermann MPPI Controller

R2026b

Control motion planning of Ackermann vehicle model using Model Predictive Path Integral (MPPI)

Since R2025a

• 

Ackermann MPPI Controller block

To add a block to a model, double-click the canvas and start typing the block name. Then, select the block from the list.

Libraries:
Offroad Autonomy Library / Vehicle Controllers

Description

Add-On Required: This feature requires the Robotics System Toolbox Offroad Autonomy Library add-on.

The Ackermann MPPI Controller block enables you to plan a local path for an Ackermann Kinematic Model, following a reference path typically generated by a global path planner such as RRT* or Hybrid A*, using the model predictive path integral (MPPI) algorithm.

The Ackermann vehicle model represents a vehicle with two axles separated by the distance, specified in the Wheel Base parameter. The state of the vehicle is defined as a four-element vector, [x y θ ψ], with a global xy-position, vehicle heading, θ, and steering angle, ψ. The vehicle heading and xy-position are defined at the center of the rear axle.

At each state of the vehicle along the reference path, the MPPI controller samples potential trajectories for a short segment along the reference path, based on the current state and control of the vehicle. The controller evaluates these trajectories using a cost function to smooth the path and chooses an optimal trajectory and optimal control for the vehicle.

Examples

Plan Path Using Ackermann MPPI Controller in Simulink

Follow an obstacle-free path with an Ackermann vehicle model between two locations on a given map in Simulink^®.

• Open Live Script

Ports

Input

State — State of vehicle

four-element vector

Global xy-position, heading, and steering angle of the vehicle, specified as a four-element vector in the form [x y theta psi]. The global xy-position is specified in meters and vehicle heading, theta, and the steering angle, psi are specified in radians.

Data Types: double

Control — Current control commands of vehicle

two-element vector

Current control commands of the vehicle, specified as a two-element numeric vector.

For Ackermann vehicle model motion, the control commands are [v psiDot]. v is the vehicle velocity in the direction of motion in meters per second. psiDot is the steering angle rate in radians per second.

Data Types: double

Reference Path — Reference path to follow

N-by-3 matrix

Reference path to follow, specified as an N-by-3 matrix in which each row represents a pose on the path.

Data Types: double

Vehicle Speed Range — Minimum and maximum vehicle speeds

[-0.1 5] (default) | two-element vector

The vehicle speed range is a two-element vector that provides the minimum and maximum vehicle speeds, [MinSpeed MaxSpeed], specified in meters per second.

Dependencies

To enable this port, select the Specify Vehicle Speed (m/s) Range from input port parameter on the Vehicle tab.

Data Types: double

Steering Rate Range — Minimum and maximum vehicle steering rate

[-0.5, 1] (default) | two-element vector

The steering rate range is a two-element vector that provides the minimum and maximum rate that the vehicle can be steered to the right or left, specified in radians per second.

Dependencies

To enable this port, select the Specify Steering Rate Range (rad) from input port parameter on the Vehicle tab.

Data Types: double

Output

Control Commands — Optimal control commands of vehicle

two-element vector

Optimal control commands of the vehicle, specified as a two-element numeric vector.

For Ackermann vehicle model motion, the control commands are [v psi]. v is the vehicle velocity in the direction of motion in meters per second. psi is the steering angle rate in radians per second.

Data Types: double

Optimal Path — Optimal trajectory of vehicle

N-by-4 matrix

Optimal trajectory of the vehicle, returned as an N-by-4 matrix, where each row is in the form [x y θ ψ].

N is the number of states along the trajectory. x is the current x-coordinate in meters. y is the current y-coordinate in meters. θ is the current heading angle of the vehicle in radians. ψ is the steering angle of the vehicle in radians. Each row of the matrix represents vehicle state along optimal trajectory.

Data Types: double

Solution Info — Extra information

scalar (bus)

Extra information, returned as a scalar (bus) with these fields.

Field	Description
HasReachedGoal	Indicates whether the vehicle has successfully reached the last pose of the reference path within the goal tolerance, returned as true if successful. Otherwise, this value is false.
ExitFlag	Scalar value indicating the exit condition. 0 — The control sequences and trajectories of the output are feasible. 1 — The control sequences and trajectories of the output are not feasible due to constraint violations. 2 — The next reference path pose is farther than what the vehicle can cover in the specified lookahead time while traveling at the maximum forward velocity of the vehicle model.

Data Types: bus

Parameters

To edit block parameters interactively, use the Property Inspector. From the Simulink Toolstrip, on the Simulation tab, in the Prepare gallery, select Property Inspector.

General

Configure various path-following parameters that guide the controller to make the vehicle accurately follow the desired path.

Path Following Parameters

Goal Tolerance — Tolerance around goal pose

[1 1 0.1] (default) | three-element vector

Tolerance around the goal pose, specified as a three-element vector of the form [x y θ]. x and y denote the position of the robot in the x- and y-directions, respectively. Units are in meters. θ is the heading angle of the robot in radians. This value specifies the maximum distance from the goal pose at which the planner can consider the robot to have reached the goal pose.

Lookahead Time — Lookahead time for trajectory planning in seconds

4 (default) | positive numeric scalar

Lookahead time for trajectory planning in seconds, specified as a positive numeric scalar.

The vehicle model determines the maximum forward velocity of the vehicle. The lookahead time of the controller multiplied by the maximum forward velocity of the vehicle determines the lookahead distance of the controller.

The lookahead distance of the controller is the distance from the current pose of the vehicle for which the controller must optimize the local path. The lookahead distance determines the segment of the global reference path from the current pose that the controller considers for an iteration of local path planning. The reference path pose at a lookahead distance from the current pose is the lookahead point, and all reference path poses between the current pose and the lookahead point are lookahead poses.

Increasing the value of lookahead time causes the controller to generate controls further into the future, enabling the vehicle to react earlier to unseen obstacles at the cost of increased computation time. Conversely, a smaller lookahead time reduces the available time to react to new unknown obstacles, but enables the controller to run at a faster rate.

Block Parameters

Sample Time (s) — Time interval at which the block updates during simulation in seconds

0.1 (default) | numeric

Time interval at which the block updates during simulation in seconds, specified as a numeric value. Use a positive scalar for discrete execution, or -1 to inherit from upstream blocks. You must ensure consistency with other model components for optimal performance.

Simulate using — Type of simulation to run

Code generation (default) | Interpreted execution

Specify the type of simulation to run.

• Code generation –– Simulate model using generated C code. The first time you run a simulation, Simulink generates C code for the block. The C code is reused for subsequent simulations, as long as the model does not change.

• Interpreted execution –– Simulate model using the MATLAB^® interpreter. For more information, see Interpreted Execution vs. Code Generation (Simulink).

Tunable: No

Vehicle

Specify the vehicle specifications, limits, and other properties for an Ackermann Kinematic Model.

Vehicle Specifications

Wheel Base — Distance between front and rear axles

1 (default) | positive numeric scalar

The wheel base is the distance between the front and rear vehicle axles, specified in meters.

Vehicle Limits

Vehicle Speed Range (m/s) — Minimum and maximum vehicle speeds

[-0.1, 5] (default) | two-element vector

The vehicle speed range is a two-element vector that provides the minimum and maximum vehicle speeds, [MinSpeed MaxSpeed], specified in meters per second.

Steering Rate Range (rad/s) — Minimum and maximum vehicle steering rate

[-0.5, 1] (default) | two-element vector

The steering rate range is a two-element vector that provides the minimum and maximum rate at which the vehicle can be steered to the right or left, [MinSteerRate MaxSteerRate], specified in radians per second.

Specify Vehicle Properties from Input Ports

Specify Vehicle Speed (m/s) Range from input port — Minimum and maximum speeds of Ackermann vehicle model

off (default) | on

Select this parameter to specify the speed range of the Ackermann vehicle model at the Vehicle Speed Range input port. Enabling this option removes the Vehicle Speed Range (m/s) parameter from the block mask.

Specify Steering Rate Range (rad) from input port — Maximum and minimum steering rates of Ackermann vehicle model

off (default) | on

Select this parameter to specify the maximum and minimum steering rates of the Ackermann vehicle model at the Steering Rate Range input port. Enabling this option removes the Steering Rate Range (rad) parameter from the block mask.

Controller

Specify various parameters for the MPPI controller, which is used for motion planning of the Ackermann vehicle model in the Ackermann MPPI Controller block.

Cost Weights

Path Alignment Weight — Weight for aligning with lookahead poses

1 (default) | nonnegative scalar

Weight for aligning with the lookahead poses of the reference path, specified as a nonnegative scalar.

Path Following Weight — Weight for closely following lookahead point

1 (default) | nonnegative scalar

Weight for closely following lookahead point, specified as a nonnegative scalar.

Control Smoothness Weight — Weight for smoothing control actions

1 (default) | nonnegative scalar

Weight for smoothing control actions to achieve optimal trajectory, specified as a nonnegative scalar.

Trajectory Generation Parameters

Number of trajectories — Number of sampled trajectories

500 (default) | positive integer

Number of sampled trajectories, specified as a positive integer.

The controller calculates the optimal trajectory by averaging the controls of candidate trajectories, with weights determined by their associated costs.

A larger number of trajectories can lead to a more thorough search of the trajectory space and a potentially better solution, at the cost of increased computation time.

Time Step (s) — Time between consecutive states of trajectory in seconds

0.1 (default) | positive scalar

Time between consecutive states of the trajectory in seconds, specified as a positive scalar. Smaller values lead to more precise trajectory predictions, but increased computation time.

Standard Deviation — Standard deviation for vehicle inputs

[2 0.5] (default) | two-element numeric vector

Standard deviation for vehicle inputs, specified as a two-element numeric vector with nonnegative values. For the Ackermann vehicle model, the default value is [2 0.5].

Each element of the vector specifies the standard deviation for a control input of the vehicle model, such as steering or velocity. Each model has two control inputs. By introducing such variability into the control inputs during trajectory sampling, the controller can better explore different possible trajectories. Larger standard deviations enable the controller to account for uncertainties in the control input and achieve more realistic trajectory predictions.

Trajectory Selection Bias (λ) — Selectiveness of optimal trajectory

1000 (default) | positive scalar

Selectiveness of the optimal trajectory, specified as a positive scalar.

Specify a value close to 0 to favor the trajectory with the lowest cost as the optimal trajectory. Specify a larger value to favor the average of all sampled trajectories as the optimal trajectory.

This parameter adjusts the sensitivity of the MPPI algorithm to the cost differences, acting as a scaling factor that influences the weighting of candidate trajectories.

Programmatic Use: Add Block

To add the block programmatically, use the add_block function with one of these library block paths as the source.

"offroadcontrollerlib/Ackermann MPPI Controller"

Example: add_block("offroadcontrollerlib/Ackermann MPPI Controller","myModel/myBlock",MakeNameUnique="on")

Extended Capabilities

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

Version History

Introduced in R2025a