Laurie/topic list (#41)

config/params.yaml

@@ -0,0 +1 @@
+ROS_IP: 127.0.0.1

launch/endpoint.launch

@@ -0,0 +1,4 @@
+<launch>
+    <rosparam file="$(find ros_tcp_endpoint)/config/params.yaml" command="load"/>
+    <node name="server_endpoint" pkg="ros_tcp_endpoint" type="default_server_endpoint.py" args="--wait" output="screen" respawn="true" />
+</launch>

src/ros_tcp_endpoint/client.py

@@ -102,7 +102,7 @@ def read_message(conn):
 
             data += packet
 
-        if not data:
+        if full_message_size > 0 and not data:
             print("No data for a message size of {}, breaking!".format(full_message_size))
             return
 
@@ -164,6 +164,11 @@ def run(self):
             response_message = self.serialize_message(destination, response)
             self.conn.send(response_message)
             return
+        elif destination == '__topic_list':
+            response = self.tcp_server.topic_list(data)
+            response_message = self.serialize_message(destination, response)
+            self.conn.send(response_message)
+            return
         elif destination not in self.tcp_server.source_destination_dict.keys():
             error_msg = "Topic/service destination '{}' is not defined! Known topics are: {} "\
                 .format(destination, self.tcp_server.source_destination_dict.keys())

src/ros_tcp_endpoint/server.py

@@ -25,6 +25,7 @@
 from .subscriber import RosSubscriber
 from .publisher import RosPublisher
 from ros_tcp_endpoint.msg import RosUnitySysCommand
+from ros_tcp_endpoint.srv import RosUnityTopicListResponse
 
 class TcpServer:
     """
@@ -96,6 +97,9 @@ def send_unity_message(self, topic, message):
     def send_unity_service(self, topic, service_class, request):
         return self.unity_tcp_sender.send_unity_service(topic, service_class, request)
 
+    def topic_list(self, data):
+        return RosUnityTopicListResponse(self.source_destination_dict.keys())
+
     def handle_syscommand(self, data):
         message = RosUnitySysCommand().deserialize(data)
         function = getattr(self.syscommands, message.command)

srv/RosUnityTopicList.srv

@@ -0,0 +1,2 @@
+---
+string[] topics