fix rosmsg show from bag

ros · Mar 24, 2017 · 0d4d664 · 0d4d664
1 parent 1246727
commit 0d4d664
Show file tree

Hide file tree

Showing 2 changed files with 10 additions and 1 deletion.
diff --git a/tools/rosmsg/package.xml b/tools/rosmsg/package.xml
@@ -21,6 +21,7 @@
 
   <run_depend version_gte="0.6.4">catkin</run_depend>
   <run_depend>genmsg</run_depend>
+  <run_depend version_gte="0.6.5">genpy</run_depend>
   <run_depend>python-rospkg</run_depend>
   <run_depend>rosbag</run_depend>
   <run_depend>roslib</run_depend>

diff --git a/tools/rosmsg/src/rosmsg/__init__.py b/tools/rosmsg/src/rosmsg/__init__.py
@@ -48,6 +48,7 @@
 
 import rospkg
 import genmsg
+from genpy.dynamic import generate_dynamic
 
 import roslib.message
 import rosbag
@@ -603,7 +604,14 @@ def rosmsg_cmd_show(mode, full, alias='show'):
         for topic, msg, t in rosbag.Bag(bag_file).read_messages(raw=True):
             datatype, _, _, _, pytype = msg
             if datatype == arg:
-                print(get_msg_text(datatype, options.raw, pytype._full_text))
+                if options.raw:
+                    print(pytype._full_text)
+                else:
+                    context = genmsg.MsgContext.create_default()
+                    msgs = generate_dynamic(datatype, pytype._full_text)
+                    for t, msg in msgs.items():
+                        context.register(t, msg._spec)
+                    print(spec_to_str(context, msgs[datatype]._spec))
                 break
     else:
         rospack = rospkg.RosPack()