Skip to content

Latest commit

 

History

History
556 lines (405 loc) · 30.6 KB

README.md

File metadata and controls

556 lines (405 loc) · 30.6 KB
Raw

mqtt_client

The mqtt_client package provides a ROS nodelet or ROS 2 component node that enables connected ROS-based and non-ROS-based devices or robots to exchange ROS messages via an MQTT broker using the MQTT protocol. This works generically for arbitrary ROS message types. The mqtt_client can also exchange primitive messages with MQTT clients running on devices not based on ROS.

Important

This repository is open-sourced and maintained by the Institute for Automotive Engineering (ika) at RWTH Aachen University.
V2X Communication is one of many research topics within our Vehicle Intelligence & Automated Driving domain.
If you would like to learn more about how we can support your automated driving or robotics efforts, feel free to reach out to us!
     Timo Woopen - Manager Research Area Vehicle Intelligence & Automated Driving
     +49 241 80 23549
     [email protected]

Installation

The mqtt_client package is released as an official ROS / ROS 2 package and can easily be installed via a package manager.

sudo apt update
sudo apt install ros-$ROS_DISTRO-mqtt-client

If you would like to install mqtt_client from source, simply clone this repository into your ROS workspace. All dependencies that are listed in the ROS package.xml can be installed using rosdep.

# mqtt_client$
rosdep install -r --ignore-src --from-paths .

# ROS
# workspace$
catkin build -DCMAKE_BUILD_TYPE=Release mqtt_client

# ROS 2
# workspace$
colcon build --packages-up-to mqtt_client --cmake-args -DCMAKE_BUILD_TYPE=Release

docker-ros

mqtt_client is also available as a Docker image, containerized through docker-ros.

# ROS
docker run --rm ghcr.io/ika-rwth-aachen/mqtt_client:ros

# ROS 2
docker run --rm ghcr.io/ika-rwth-aachen/mqtt_client:ros2

Usage

The mqtt_client can be easily integrated into an existing ROS-based system. Below, you first find a quick start guide to test the mqtt_client on a single machine. Then, more details are presented on how to launch and configure it in more complex applications.

Quick Start

Follow these steps to quickly launch a working mqtt_client that is sending ROS messages via an MQTT broker to itself.

Demo Broker

It is assumed that an MQTT broker (such as Mosquitto) is running on localhost:1883.

For this demo, you may easily launch Mosquitto with its default configuration using Docker.

docker run --rm --network host --name mosquitto eclipse-mosquitto

For a more advanced setup of your own broker, check out our instructions for running an MQTT broker in Docker with enabled authentication and encryption here.

Demo Configuration

The mqtt_client is best configured with a ROS parameter yaml file. The configuration shown below (also see params.yaml / params.ros2.yaml) allows an exchange of messages as follows:

  • ROS messages received locally on ROS topic /ping/ros are sent to the broker on MQTT topic pingpong/ros;
  • MQTT messages received from the broker on MQTT topic pingpong/ros are published locally on ROS topic /pong/ros;
  • primitive ROS messages received locally on ROS topic /ping/primitive are sent as primitive (string) messages to the broker on MQTT topic pingpong/primitive;
  • MQTT messages received from the broker on MQTT topic pingpong/primitive are published locally as primitive ROS messages on ROS topic /pong/primitive.
  • ROS messages received locally on ROS topic /ping/json are sent to the broker in JSON format on MQTT topic pingpong/json;
  • MQTT messages received from the broker on MQTT topic pingpong/json are recieved as JSON and published locally as a ROS message on ROS topic /pong/json;
broker:
  host: localhost
  port: 1883
bridge:
  ros2mqtt:
    - ros_topic: /ping/ros
      mqtt_topic: pingpong/ros
    - ros_topic: /ping/primitive
      mqtt_topic: pingpong/primitive
      primitive: true
    - ros_topic: /ping/json
      mqtt_topic: pingpong/json
      json: true
  mqtt2ros:
    - mqtt_topic: pingpong/ros
      ros_topic: /pong/ros
    - mqtt_topic: pingpong/primitive
      ros_topic: /pong/primitive
      primitive: true
    - mqtt_topic: pingpong/json
      ros_topic: /pong/json
      json: true

Demo Client Launch

After building your ROS workspace, launch the mqtt_client node with the pre-configured demo parameters using roslaunch, which should yield the following output.

# ROS
roslaunch mqtt_client standalone.launch

# ROS 2
ros2 launch mqtt_client standalone.launch.ros2.xml
[ WARN] [1665575657.358869079]: Parameter 'broker/tls/enabled' not set, defaulting to '0'
[ WARN] [1665575657.359798329]: Parameter 'client/id' not set, defaulting to ''
[ WARN] [1665575657.359810889]: Client buffer can not be enabled when client ID is empty
[ WARN] [1665575657.360300703]: Parameter 'client/clean_session' not set, defaulting to '1'
[ WARN] [1665575657.360576344]: Parameter 'client/keep_alive_interval' not set, defaulting to '60.000000'
[ WARN] [1665575657.360847295]: Parameter 'client/max_inflight' not set, defaulting to '65535'
[ INFO] [1665575657.361281461]: Bridging ROS topic '/ping/ros' to MQTT topic 'pingpong/ros'
[ INFO] [1665575657.361303380]: Bridging primitive ROS topic '/ping/primitive' to MQTT topic 'pingpong/primitive'
[ INFO] [1665575657.361352809]: Bridging MQTT topic 'pingpong/ros' to ROS topic '/pong/ros'
[ INFO] [1665575657.361370558]: Bridging MQTT topic 'pingpong/primitive' to primitive ROS topic '/pong/primitive'
[ INFO] [1665575657.362153083]: Connecting to broker at 'tcp://localhost:1883' ...
[ INFO] [1665575657.462622065]: Connected to broker at 'tcp://localhost:1883'

Note that the mqtt_client successfully connected to the broker and also echoed which ROS/MQTT topics are being bridged. For testing the communication between mqtt_client, itself, and other MQTT clients, open eight new terminals.

In order to test the communication among mqtt_clients, publish any ROS message on ROS topic /ping/ros and wait for a response on ROS topic /pong/ros.

# 1st terminal: publish ROS message to /ping

# ROS
rostopic pub -r 1 /ping/ros std_msgs/String "Hello MQTT"

# ROS 2
ros2 topic pub /ping/ros std_msgs/msg/String "{data: \"Hello MQTT\"}"
# 2nd terminal: listen for ROS messages on /pong

# ROS
rostopic echo /pong/ros

# ROS 2
ros2 topic echo /pong/ros

In order to test the communication between mqtt_client and other MQTT clients, publish a ROS message on ROS topic /ping/json, directly publish a json MQTT message on MQTT topic pingpong/json and wait for responses on ROS topic /pong/json.

# 3rd terminal: publish ROS message to /ping/json

# ROS
rostopic pub -r 1 /ping/json geometry_msgs/PoseStamped "header:
  seq: 1
  stamp:
    secs: 0
    nsecs: 0
  frame_id: 'map'
pose:
  position:
    x: 1.0
    y: 2.0
    z: 3.0
  orientation:
    x: 0.0
    y: 0.0
    z: 0.0
    w: 1.0"

# ROS2

ros2 topic pub /ping/json geometry_msgs/PoseStamped '{header: {stamp: {sec: 1, nanosec: 50}, frame_id: "map"}, pose: {position: {x: 1.2, y: 3.4, z: 5.6}, orientation: {x: 7.8, y: 0.0, z: 0.0, w: 1.0}}}'


# 4th terminal: listen for primitive ROS messages on /pong/json

# ROS
rostopic echo /pong/json

# ROS2
ros2 topic echo /pong/json

# 5th terminal: publish primitive MQTT message to pingpong/json directly using mosquitto_pub
docker run --rm --network host eclipse-mosquitto mosquitto_pub -h localhost -t "pingpong/json" --repeat 20 --repeat-delay 1 -m "{\"header\":{\"seq\":1,\"stamp\":{\"secs\":0,\"nsecs\":0},\"frame_id\":\"map\"},\"pose\":{\"position\":{\"x\":1.0,\"y\":2.0,\"z\":0.0},\"orientation\":{\"x\":0.0,\"y\":0.0,\"z\":0.0,\"w\":1.0}}}"

In order to test the communication between mqtt_client and other MQTT clients for primitive messages, publish a primitive ROS message on ROS topic /ping/primitive, directly publish a primitive MQTT message on MQTT topic pingpong/primitive and wait for responses on ROS topic /pong/primitive. Note that you need to restart the ROS 2 mqtt_client with a different config file.

# ROS 2
# mqtt_client$
ros2 launch mqtt_client standalone.launch.ros2.xml params_file:=$(ros2 pkg prefix mqtt_client)/share/mqtt_client/config/params.ros2.primitive.yaml
# 6th terminal: publish primitive ROS message to /ping/primitive

# ROS
rostopic pub -r 1 /ping/primitive std_msgs/Int32 42

# ROS2
ros2 topic pub /ping/primitive std_msgs/msg/Int32 "{data: 42}"
# 7th terminal: listen for primitive ROS messages on /pong/primitive

# ROS
rostopic echo /pong/primitive

# ROS2
ros2 topic echo /pong/primitive
# 8th terminal: publish primitive MQTT message to pingpong/primitive directly using mosquitto_pub
docker run --rm --network host eclipse-mosquitto mosquitto_pub -h localhost -t "pingpong/primitive" --repeat 20 --repeat-delay 1 -m 69

If everything works as expected, the second terminal should print a message at 1Hz, while the fourth terminal should print two different messages at 1Hz.

Launch

You can start the mqtt_client node with:

# ROS
roslaunch mqtt_client standalone.launch

# ROS 2
ros2 launch mqtt_client standalone.launch.ros2.xml

This will automatically load the provided demo params.yaml / params.ros2.yaml. If you wish to load your custom configuration file, simply pass params_file.

# ROS
roslaunch mqtt_client standalone.launch params_file:="</PATH/TO/PARAMS.YAML>"

# ROS 2
ros2 launch mqtt_client standalone.launch.ros2.xml params_file:="</PATH/TO/PARAMS.YAML>"

In order to exploit the benefits of mqtt_client being a ROS nodelet / ROS 2 component, load the nodelet / component to your own nodelet manager / component container.

Configuration

All available ROS parameters supported by the mqtt_client and their default values (in []) are listed in the following.

Broker Parameters

broker:
  host:              # [localhost] IP address or hostname of the machine running the MQTT broker
  port:              # [1883] port the MQTT broker is listening on
  user:              # username used for authenticating to the broker (if empty, will try to connect anonymously)
  pass:              # password used for authenticating to the broker
  tls:
    enabled:           # [false] whether to connect via SSL/TLS
    ca_certificate:    # [/etc/ssl/certs/ca-certificates.crt] CA certificate file trusted by client (relative to ROS_HOME)

Client Parameters

client:
  id:                   # unique ID string used to identify the client (broker may allow empty ID and automatically generate one)
  buffer:
    size:                 # [0] maximum number of messages buffered by the bridge when not connected to broker (only available if client ID is not empty)
    directory:            # [buffer] directory used to buffer messages when not connected to broker (relative to ROS_HOME)
  last_will:
    topic:                # topic used for this client's last-will message (no last will, if not specified)
    message:              # [offline] last-will message
    qos:                  # [0] QoS value for last-will message
    retained:             # [false] whether to retain last-will message
  clean_session:        # [true] whether to use a clean session for this client
  keep_alive_interval:  # [60.0] keep-alive interval in seconds
  max_inflight:         # [65535] maximum number of inflight messages
  tls:
    certificate:          # client certificate file (only needed if broker requires client certificates; relative to ROS_HOME)
    key:                  # client private key file (relative to ROS_HOME)
    password:             # client private key password
    version:              # TLS version (https://github.com/eclipse/paho.mqtt.cpp/blob/master/src/mqtt/ssl_options.h#L305)
    verify:               # verify the client should conduct post-connect checks.
    alpn_protos:          # list of ALPN protocols (https://www.openssl.org/docs/man1.1.1/man3/SSL_CTX_set_alpn_protos.html)

Bridge Parameters

ROS
bridge:
  ros2mqtt:            # Array specifying which ROS topics to map to which MQTT topics
    - ros_topic:         # ROS topic whose messages are transformed to MQTT messages
      mqtt_topic:        # MQTT topic on which the corresponding ROS messages are sent to the broker
      primitive:         # [false] whether to publish as primitive message
      json:         # [false] whether message exchanging in in JSON format
      inject_timestamp:  # [false] whether to attach a timestamp to a ROS2MQTT payload (for latency computation on receiver side)
      advanced:
        ros:
          queue_size:      # [1] ROS subscriber queue size
        mqtt:
          qos:             # [0] MQTT QoS value
          retained:        # [false] whether to retain MQTT message
  mqtt2ros:            # Array specifying which MQTT topics to map to which ROS topics
    - mqtt_topic:        # MQTT topic on which messages are received from the broker
      ros_topic:         # ROS topic on which corresponding MQTT messages are published
      primitive:         # [false] whether to publish as primitive message (if coming from non-ROS MQTT client)
      json:         # [false] whether message exchanging in in JSON format
      advanced:
        mqtt:
          qos:             # [0] MQTT QoS value
        ros:
          queue_size:        # [1] ROS publisher queue size
          latched:           # [false] whether to latch ROS message
ROS 2
bridge:
  ros2mqtt:            # Object specifying which ROS topics to map to which MQTT topics
    ros_topics:          # Array specifying which ROS topics to bridge
      - {{ ros_topic_name }} # The ROS topic that should be bridged, corresponds to the sub-object in the YAML
    {{ ros_topic_name }}:
      mqtt_topic:          # MQTT topic on which the corresponding ROS messages are sent to the broker
      primitive:           # [false] whether to publish as primitive message
      json:         # [false] whether message exchanging in in JSON format
      inject_timestamp:    # [false] whether to attach a timestamp to a ROS2MQTT payload (for latency computation on receiver side)
      advanced:
        ros:
          queue_size:        # [1] ROS subscriber queue size
        mqtt:
          qos:               # [0] MQTT QoS value
          retained:          # [false] whether to retain MQTT message
  mqtt2ros:            # Object specifying which MQTT topics to map to which ROS topics
    mqtt_topics:         # Array specifying which ROS topics to bridge
      - {{ mqtt_topic_name }} # The MQTT topic that should be bridged, corresponds to the sub-object in the YAML
    {{ mqtt_topic_name }}:
      ros_topic:           # ROS topic on which corresponding MQTT messages are published
      primitive:           # [false] whether to publish as primitive message (if coming from non-ROS MQTT client)
      json:         # [false] whether message exchanging in in JSON format
      advanced:
        mqtt:
          qos:               # [0] MQTT QoS value
        ros:
          queue_size:          # [1] ROS publisher queue size
          latched:             # [false] whether to latch ROS message

JSON Messages

As seen in the Quick Start, the mqtt_client can not only exchange arbitrary ROS messages with other mqtt_clients, but it can also exchange arbitrary messages with other non-mqtt_client MQTT clients using JSON. This allows ROS-based devices to exchange ROS messages with devices not based on ROS, and non-mqtt_client MQTT clients can send a JSON string with a format that matches the needed ROS message to be casted into. The json parameter can be set for both ROS-to-MQTT (bridge/ros2mqtt) and for MQTT-to-ROS (bridge/mqtt2ros) transmissions.

If a ROS-to-MQTT transmission is configured as json, the message is published as a serialized JSON string.

If an MQTT-to-ROS transmission is configured as json, the MQTT message is interpreted as a JSON string and transformed into a ROS message to be published.

The json property of both Ros-to-MQTT and MQTT-to-ROS should be equal.

Primitive Messages

Additionally, the mqtt_client can also exchange primitive message data with other non-mqtt_client MQTT clients. This allows ROS-based devices to exchange primitive messages with devices not based on ROS. The primitive parameter can be set for both ROS-to-MQTT (bridge/ros2mqtt) and for MQTT-to-ROS (bridge/mqtt2ros) transmissions.

If a ROS-to-MQTT transmission is configured as primitive and the ROS message type is one of the supported primitive ROS message types, the raw data is published as a string. The supported primitive ROS message types are std_msgs/String, std_msgs/Bool, std_msgs/Char, std_msgs/UInt8, std_msgs/UInt16, std_msgs/UInt32, std_msgs/UInt64, std_msgs/Int8, std_msgs/Int16, std_msgs/Int32, std_msgs/Int64, std_msgs/Float32, std_msgs/Float32.

If an MQTT-to-ROS transmission is configured as primitive, the MQTT message is interpreted and published as a primitive data type, if possible. The message is probed in the following order: bool (std_msgs/Bool), int (std_msgs/Int32), float (std_msgs/Float32), string (std_msgs/String).

Latency Computation

The mqtt_client provides built-in functionality to measure the latency of transferring a ROS message via an MQTT broker back to ROS. Note that this functionality is only available for non-primitive messages (see Primitive Messages). To this end, the sending client injects the current timestamp into the MQTT message. The receiving client can then compute the latency between message reception time and the injected timestamp. Naturally, this is only accurate to the level of synchronization between clocks on sending and receiving machine.

In order to inject the current timestamp into outgoing MQTT messages, the parameter inject_timestamp has to be set for the corresponding bridge/ros2mqtt entry. The receiving mqtt_client will then automatically publish the measured latency in seconds as a ROS std_msgs/Float64 message on topic /<mqtt_client_name>/latencies/<mqtt2ros/ros_topic>.

These latencies can be printed easily with rostopic echo

# ROS
rostopic echo --clear /<mqtt_client_name>/latencies/<mqtt2ros/ros_topic>/data

# ROS 2
ros2 topic echo /<mqtt_client_name>/latencies/<mqtt2ros/ros_topic>/data

or plotted with rqt_plot:

# ROS
rosrun rqt_plot rqt_plot /<mqtt_client_name>/latencies/<mqtt2ros/ros_topic>/data

# ROS 2
ros2 run rqt_plot rqt_plot /<mqtt_client_name>/latencies/<mqtt2ros/ros_topic>/data

Package Summary

This short package summary documents the package in line with the ROS Wiki Style Guide.

ROS

Nodelets

mqtt_client/MqttClient

Enables connected ROS-based devices or robots to exchange ROS messages via an MQTT broker using the MQTT protocol.

Subscribed Topics
  • <bridge/ros2mqtt[*]/ros_topic> (topic_tools/ShapeShifter) ROS topic whose messages are transformed to MQTT messages and sent to the MQTT broker. May have arbitrary ROS message type.
Published Topics
  • <bridge/mqtt2ros[*]/ros_topic> (topic_tools/ShapeShifter) ROS topic on which MQTT messages received from the MQTT broker are published. May have arbitrary ROS message type.
  • ~/latencies/<bridge/mqtt2ros[*]/ros_topic> (std_msgs/Float64) Latencies measured on the message transfer to <bridge/mqtt2ros[*]/ros_topic> are published here, if the received messages have a timestamp injected (see Latency Computation).
Services
Parameters

See Configuration.

ROS 2

Components

mqtt_client/MqttClient

Enables connected ROS-based devices or robots to exchange ROS messages via an MQTT broker using the MQTT protocol.

Subscribed Topics
  • <bridge/ros2mqtt/ros_topic> (rclcpp::SerializedMessage) ROS topic whose messages are transformed to MQTT messages and sent to the MQTT broker. May have arbitrary ROS message type.
Published Topics
  • <bridge/mqtt2ros/ros_topic> (rclcpp::SerializedMessage) ROS topic on which MQTT messages received from the MQTT broker are published. May have arbitrary ROS message type.
  • ~/latencies/<bridge/mqtt2ros/ros_topic> (std_msgs/Float64) Latencies measured on the message transfer to <bridge/mqtt2ros/ros_topic> are published here, if the received messages have a timestamp injected (see Latency Computation).
Services
Parameters

See Configuration.

How It Works

ROS

The mqtt_client is able to bridge ROS messages of arbitrary message type to an MQTT broker. In addition, it is able to exchange arbitrary ROS messages with non-ROS-based devices, using JSON interpretations of ROS messages. To this end, it needs to employ generic ROS subscribers, publishers, and JSON parsers, which only take shape at runtime.

The generic JSON parser is realized through the updated version of RosMsgParser::Parser, and the generic ROS subscribers and publishers are realized through topic_tools::ShapeShifter. For each pair of ros_topic and mqtt_topic specified under bridge/ros2mqtt/, a ROS subscriber is setup with the following callback signature:

void ros2mqtt(topic_tools::ShapeShifter::ConstPtr&, std::string&)

Inside the callback, the generic messages received on the ros_topic are serialized using ros::serialization. The serialized form is then either sent to the MQTT broker on the specified mqtt_topic, or transformed into a serialized JSON representation of the ROS message using RosMsgParser::Parser::deserializeIntoJson before sending through mqtt_topic.

Upon retrieval of an MQTT message, it is republished as a ROS message on the ROS network. To this end, topic_tools::ShapeShifter::morph is used to have the ShapeShifter publisher take the shape of the specific ROS message type.

If the recieved MQTT message is in JSON format, it is converted to a serialized ROS message using RosMsgParser::Parser::serializeFromJson

The required metainformation on the ROS message type can however only be extracted in the ROS subscriber callback of the publishing mqtt_client with calls to topic_tools::ShapeShifter::getMD5Sum, topic_tools::ShapeShifter::getDataType, and topic_tools::ShapeShifter::getMessageDefinition. These attributes are wrapped in a ROS message of custom type mqtt_client::RosMsgType, serialized using ros::serialization and also shared via the MQTT broker on a special topic.

When an mqtt_client receives such ROS message type metainformation, it configures the corresponding ROS ShapeShifter publisher using topic_tools::ShapeShifter::morph, as well as instantiates a RosMsgParser::Parser object that matched the metainformation.

The mqtt_client also provides functionality to measure the latency of transferring a ROS message via an MQTT broker back to ROS. To this end, the sending client injects the current timestamp into the MQTT message. The receiving client can then compute the latency between message reception time and the injected timestamp. The information about whether a timestamp is injected is also included in the custom mqtt_client::RosMsgType message that is sent before. The actual std::vector<uint8> message payload takes on one of the following forms:

[... serialized timestamp ... | ... serialized ROS messsage ...]
[... serialized ROS messsage ...]

To summarize, the dataflow is as follows:

  • a ROS message of arbitrary type is received on ROS topic <ros2mqtt_ros_topic> and passed to the generic callback
    • ROS message type information is extracted and wrapped as a RosMsgType
    • ROS message type information is serialized and sent via the MQTT broker on MQTT topic mqtt_client/ros_msg_type/<ros2mqtt_mqtt_topic>
    • the actual ROS message is serialized
    • if inject_timestamp, the current timestamp is serialized and concatenated with the message
    • the actual MQTT message is sent via the MQTT broker on MQTT topic <ros2mqtt_mqtt_topic>
  • an MQTT message containing the ROS message type information is received on MQTT topic mqtt_client/ros_msg_type/<ros2mqtt_mqtt_topic>
    • message type information is extracted and the ShapeShifter ROS publisher is configured
    • information about whether a timestamp is injected is stored for the specific topic
  • an MQTT message containing the actual ROS message is received
    • depending on whether a timestamp is injected, it is decoded into the serialized ROS message and the serialized timestamp
    • if the message contained a timestamp, the latency is computed and published on ROS topic ~/latencies/<mqtt2ros_ros_topic>
    • the serialized ROS message is published using the ShapeShifter on ROS topic <mqtt2ros_ros_topic>

Acknowledgements

This research is accomplished within the projects 6GEM (FKZ 16KISK036K) and UNICARagil (FKZ 16EMO0284K). We acknowledge the financial support for the projects by the Federal Ministry of Education and Research of Germany (BMBF).