Get Started with ROS 2 in Simulink

This example uses:

This example shows how to use Simulink® blocks for ROS 2 to send and receive messages from a local ROS 2 network.

Introduction

Simulink support for Robot Operating System 2 (ROS 2) enables you to create Simulink models that work with a ROS 2 network. ROS 2 is a communication layer that allows different components of a robot system to exchange information in the form of messages. A component sends a message by publishing it to a particular topic, such as /odometry. Other components receive the message by subscribing to that topic.

Simulink support for ROS 2 includes a library of Simulink blocks for sending and receiving messages for a designated topic. When you simulate the model, Simulink connects to a ROS 2 network, which can be running on the same machine as Simulink or on a remote system. Once this connection is established, Simulink exchanges messages with the ROS 2 network until the simulation is terminated. If Simulink Coder™ is installed, you can also generate C++ code for a standalone ROS 2 node, from the Simulink model.

This example shows how to:

Create and run a Simulink model to send and receive ROS 2 messages
Work with data in ROS 2 messages

Prerequisites: Create a Simple Model, Get Started with ROS 2

Model

You will use Simulink to publish the X and Y location of a robot. You will also subscribe to the same location topic and display the received X,Y location.

Enter the following command to open the completed model created in example.

open_system('ros2GetStartedExample');

Create a Publisher

Configure a block to send a geometry_msgs/Point message to a topic named /location (the "/" is standard ROS syntax).

From the MATLAB Toolstrip, select Home > New > Simulink Model to open a new Simulink model.
From the Simulink Toolstrip, select Simulation > Library Browser to open the Simulink Library Browser. Click on the ROS Toolbox tab (you can also type roslib in MATLAB command window). Select the ROS 2 Library.
Drag a Publish block to the model. Double-click on the block to configure the topic and message type.
Select Specify your own for the Topic source, and enter /location in Topic.
Click Select next to Message type. A pop-up window will appear. Select geometry_msgs/Point and click OK to close the pop-up window.
You can also specify the ROS 2 Domain ID by clicking Configure ROS 2 Domain ID and ROS Middleware (RMW) option.

Create a ROS 2 Message

Create a blank ROS 2 message and populate it with the x and y location for the robot path. Then publish the updated ROS 2 message to the ROS 2 network.

A ROS 2 message is represented as a bus in Simulink. A bus is a bundle of Simulink signals, and can also include other buses (see the Simulink Bus Capabilities (Simulink) example for an overview). The ROS 2 Blank Message block outputs a Simulink bus corresponding to a ROS 2 message.

Click ROS Toolbox tab in the Library Browser, or type roslib at the MATLAB command line. Select the ROS 2 Library.
Drag a Blank Message block to the model. Double-click the block to open a dialog box.
Click Select next to the Message type box, and select geometry_msgs/Point from the resulting pop-up window. set Sample time to 0.01. Click OK to close the dialog box.
From the Simulink > Signal Routing tab in the Library Browser, drag a Bus Assignment block.
Connect the output port of the Blank Message block to the Bus input port of the Bus Assignment block. Connect the output port of the Bus Assignment block to the input port of Publish block.
Double-click the Bus Assignment block. If x, y, and z are not listed as elements of the input bus, close the dialog box. To ensure that the bus information is propagated, on the Modeling tab, click Update Model. Then, reopen the dialog box.
In the list of elements in the bus, select both X and Y. Then, click Select.
In the list of elements that are being assigned, select ??? signal1. Then, click Remove.
Click OK to apply the changes.

You can now populate the bus with the robot location.

From the Simulink > Sources tab in the Library Browser, drag two Sine Wave blocks into the model.
Connect the output ports of each Sine Wave block to the assignment input ports x and y of the Bus Assignment block.
Double-click on the Sine Wave block that is connected to input port X. Set the Phase parameter to -pi/2 and click OK. Leave the Sine Wave block connected to input port Y as default.

Your publisher should look like this:

At this point, the model is set up to publish messages to the ROS 2 network. You can verify this as follows:

Under the Simulation tab, set the simulation stop time to inf.
Click Run to start simulation. Simulink creates a dedicated ROS 2 node for the model and a ROS 2 publisher corresponding to the Publish block.
While the simulation is running, type ros2 node list in the MATLAB command window. This lists all the nodes available in the ROS network, and includes a node with a name like /untitled_90580 (the name of the model along with a random number to make it unique).
While the simulation is running, type ros2 topic list in the MATLAB command window. This lists all the topics available in the ROS 2 network, and it includes /location.
If you specified a ROS 2 domain ID in the Publish block, to list all the topics, type ros2 topic list domainID xx, where xx is the domain ID you specified.

To stop the simulation, click Stop. Simulink deletes the ROS 2 node and publisher. In general, the ROS 2 node for a model and any associated publishers and subscribers are automatically deleted at the end of a simulation; no additional clean-up steps are required.

Create a Subscriber

Use Simulink to receive messages sent to the /location topic. You will extract the x and y location from the message and plot it in the xy-plane.

From the ROS Toolbox tab in the Library Browser, drag a Subscribe block to the model. Double-click the block.
Select Specify your own in the Topic source box, and enter /location in the Topic box.
Click Select next to the Message type box, and select geometry_msgs/Point from the pop-up window. set Sample time to 0.01. Click OK to close the dialog box.

The Subscribe block outputs a Simulink bus. To extract the x and y signals from the bus, follow these steps.

From the Simulink > Signal Routing tab in the Library Browser, drag a Bus Selector block to the model.
Connect the Msg output of the Subscribe block to the input port of the Bus Selector block.
Double-click the Bus Selector block. If x and y are not listed as elements of the input bus, close the dialog box. To ensure that the bus information is propagated, on the Modeling tab, click Update Model. Then, reopen the dialog box.
In the list of elements in the bus, select x and y. To add these elements to the block output, click .
In the list of output elements, select signal1 and signal2. To remove these elements from the block output, click .

The Subscribe block will output the most-recently received message for the topic on every time step. The IsNew output indicates whether the message has been received during the prior time step. For the current task, the IsNew output is not needed, so do the following:

From the Simulink > Sinks tab in the Library Browser, drag a Terminator block to the model.
Connect the IsNew output of the Subscribe block to the input of the Terminator block.

The remaining steps configure the display of the extracted X and Y signals.

From the Simulink > Sinks tab in the Library Browser, drag an XY Graph block to the model. Connect the output ports of the Bus Selector block to the input ports of the XY Graph block.
From the Simulink > Sinks tab in the Library Browser, drag two Display blocks to the model. Connect each output of the Bus Selector block to each Display block.
Save your model.

Your entire model should look like this:

Configure and Run the Model

From the Modeling tab, select Model Settings. In the Solver pane, set Type to Fixed-step and Fixed-step size to 0.01.
Set simulation stop time to 10.0.
Click Run to start simulation. An XY plot will appear.

The first time you run the model in Simulink, the XY plot may look more jittery than the one above due to delays caused by loading ROS libraries. Once you rerun the simulation a few times, the plot should look smoother.

Note that the simulation does not work in actual or "real" time. The blocks in the model are evaluated in a loop that only simulates the progression of time, and is not intended to track actual clock time (for details, see Simulation Loop Phase (Simulink)).

Modify the Model to React Only to New Messages

In the above model, the Subscribe block outputs a message (bus) on every time step; if no messages have been received at all, it outputs a blank message (i.e., a message with zero values). Consequently, the XY coordinates are initially plotted at (0,0).

In this task, you will modify the model to use an enabled subsystem, so that it plots the location only when a new message is received. For more information, see Using Enabled Subsystems (Simulink). A pre-configured model is included for your convenience.

In the model, click and drag to select the Bus Selector block and XY Graph blocks. Right-click the selection and select Create Subsystem from Selection.
From the Simulink > Ports & Subsystems tab in the Library Browser, drag an Enable block into the newly-created subsystem.
Connect the IsNew output of the Subscribe block to the enabled input of the subsystem as shown in the picture below. Delete the Terminator block. Note that the IsNew output is true only if a new message was received during the previous time step.

Save your model.
Click Run to start simulation. You should see the following XY plot.

The blocks in the enabled subsystem are only executed when a new ROS 2 message is received by the Subscribe block. Hence, the initial (0,0) value will not be displayed in the XY plot.