1.9 Publishing to topics

Although we are able to get some sensordata (as topics) from the robot, and also drive around (by calling services), this might not be the ideal way of driving your robot. In ROS the default of driving around a mobile platform is not by calling services, but by publishing to a topic of the Twist type. As you can see this interface has two components:

Vector3  linear
     float64 x
     float64 y
     float64 z
Vector3  angular
     float64 x
     float64 y
     float64 z

This message type is expressing the velocity of the robot brokin into linear and angular speed (in m/s). For a dirrential drive robot this means we can only use linear.x (forward/backward) and angular.z (turning around its axis).

This also means there needs to be someting (a ROS node) that is listening to a topic with this Twist type. Usually this is a topic with ‘cmd_vel’ (command velocity) in its name. With all nodes running you should be able to identify which topic is expecting a Twist message. We again have all the information we need to publish to this topic:

1. Creating a new node called drive.py

2. Put the code below in that file

3. Adding this node to setup.py

4. Build everything

5. Start the node

info

For debugging purposes, you can again also send data to this topic from the commandline:

$ ros2 topic pub --once /mirte_base_controller/cmd_vel geometry_msgs/msg/Twist "{linear: {x: 0.5}}"

import rclpy
from rclpy.node import Node
from geometry_msgs.msg import Twist

class MinimalPublisher(Node):
   def __init__(self):
      super().__init__('drive_publisher')
      self.publisher_ = self.create_publisher(
          Twist,
          '/mirte_base_controller/cmd_vel',
          10)
      timer_period = 0.5  # seconds
      self.timer = self.create_timer(timer_period, self.timer_callback)

   def timer_callback(self):
      msg = Twist()
      msg.linear.x = 0.5  # m/s
      self.publisher_.publish(msg)
      self.get_logger().info('Publishing linear.x: "%f"' % msg.linear.x)

def main(args=None):
   rclpy.init(args=args)
   minimal_publisher = MinimalPublisher()
   rclpy.spin(minimal_publisher)
   minimal_publisher.destroy_node()
   rclpy.shutdown()

if __name__ == '__main__':
   main()