提交 b4e723be 编写于 作者: “jason_tao” 提交者: Jiangtao Hu

update dump_gpsbin too to cybertron

上级 cf037246
......@@ -27,24 +27,28 @@ import glob
import os
import shutil
import rosbag
import std_msgs
from std_msgs.msg import String
from cyber_py import cyber
from cyber_py.record import RecordReader
from modules.drivers.gnss.proto import gnss_pb2
g_args = None
g_args = None
kRawDataTopic = '/apollo/sensor/gnss/raw_data'
def dump_bag(in_dir):
"""out_bag = in_bag"""
print "begin"
gnss = gnss_pb2.RawData()
global g_args
bag_files = glob.glob(in_dir + "/*.bag")
bag_files = glob.glob(in_dir + "/*.record.*")
f = file("/tmp/gpsimu.bin", 'w')
for bag_file in sorted(bag_files):
print "Processing ", bag_file, " ..."
bag = rosbag.Bag(bag_file, 'r')
for topic, msg, t in bag.read_messages():
if topic == "/apollo/sensor/gnss/raw_data":
f.write(str(msg))
reader = RecordReader(bag_file)
for msg in reader.read_messages():
if msg.topic == kRawDataTopic:
gnss.ParseFromString(msg.message)
f.write(str(gnss))
f.close()
......
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册