Get foundationpose on jetson testbed talking to the behavior UI locally.

Author: calvertdw

ihmc-communication/src/main/java/us/ihmc/communication/ros2/ROS2Helper.java

@@ -3,6 +3,7 @@
 import org.apache.commons.lang3.mutable.MutableInt;
 import std_msgs.msg.dds.Bool;
 import std_msgs.msg.dds.Empty;
+import std_msgs.msg.dds.Int32;
 import us.ihmc.commons.thread.Notification;
 import us.ihmc.commons.thread.Throttler;
 import us.ihmc.commons.thread.TypedNotification;
@@ -179,6 +180,13 @@ public void publish(ROS2Topic<Empty> topic)
       ros2PublisherMap.publish(topic);
    }
 
+   public void publish(ROS2Topic<Int32> topic, int value)
+   {
+      Int32 message = new Int32();
+      message.setData(value);
+      ros2PublisherMap.publish(topic, message);
+   }
+
    @Override
    public void publish(ROS2Topic<Bool> topic, boolean message)
    {