Simulate Automated Parking Valet with ROS 2 in Simulink
This example shows how to distribute components of the Automated Parking Valet application into various Simulink® models and simulate them in a known parking lot environment.
Explore the Simulink ROS 2 nodes and connectivity
Observe the division of the components into four separate Simulink models. Each Simulink model represents a ROS 2 node.
1. Open the vehicle model.
Vehicle model subsystem contains a Bicycle Model (Automated Driving Toolbox) block,
Vehicle Body 3DOF, to simulate the vehicle controller effects and sends the vehicle information.
Behavioral Planner Node
1. Open the behavioral planner model.
2. This model reads the current vehicle information, sends the next goal and checks if the vehicle has reached the final pose of the segment using
Checker subsystem runs when a new message is available on either
4. The model sends the status if the vehicle has reached the final parking goal using the
/reachgoal topic, which uses a
std_msgs/Bool message type. All the models stop simulation when this message is
Path Planner Node
1. Open the path planner model.
2. This model plans a feasible path through the environment map using a
pathPlannerRRT (Automated Driving Toolbox) object, which implements the optimal rapidly exploring random tree (RRT*) algorithm and sends the plan to the controller.
Path Planner subsystem runs when a new message is available on
1. Open the vehicle controller model.
2. This model calculates and sends the steering and velocity commands.
3. The Controller subsystem runs when a new message is available on the
Simulate the ROS 2 nodes to verify partitioning
Model references in this example use Implement Variations in Separate Hierarchy Using Variant Subsystems (Simulink) to achieve easy switch between simulation and code generation. During simulation, messages pass from one node to other directly without ROS 2 blocks to showcase the data flow and execution order among these four ROS 2 nodes. During code generation, variant subsystem under each node will use publish and subscribe blocks to replace input and output ports. In this way, after we lock down the control algorithm during simulation, each node can be deployed as a standalone ROS 2 node without any changes to the model.
Verify that the behavior of the model remains the same after partitioning the system into four Simulink models.
1. Load the pre-recorded localization map data in MATLAB base workspace using the
exampleHelperROSValetLoadLocalizationData helper function.
2. Open the simulation model.
In the left parking selection area, you can also select a spot. The default parking spot is the sixth spot at the top row.
3. In the SIMULATION tab, click Run from SIMULATE section or run
sim('ROS2ValetSimulationExample.slx') in MATLAB Command Window. A figure opens and shows how the vehicle tracks the reference path. The blue line represents the reference path while the red line is the actual path traveled by the vehicle. Simulation for all the models stop when the vehicle reaches the final parking spot.
Visualization subsystem in vehicle model generates the results for this example.
isualizePath block is responsible for creating and updating the plot of the vehicle paths shown previously. The vehicle speed and steering commands are displayed in a scope.