提交 7fdecb2d 编写于 作者: Y yangkairui 提交者: Liangliang Zhang

make drive_event more usable (#1934)

上级 46d7b598
...@@ -89,19 +89,27 @@ if __name__ == "__main__": ...@@ -89,19 +89,27 @@ if __name__ == "__main__":
queue_size=10) queue_size=10)
seq_num = 0 seq_num = 0
while not rospy.is_shutdown(): while not rospy.is_shutdown():
event_str = raw_input("Type in event and press Enter (current time: " + event_type = raw_input(
str(datetime.datetime.now()) + ")\n>") "Type in Event Type('d') and press Enter (current time: " +
event_str = event_str.strip() str(datetime.datetime.now()) + ")\n>")
if len(event_str) == 0: event_type = event_type.strip()
if len(event_type) != 1:
continue continue
if event_type[0].lower() != 'd':
continue
current_time = rospy.get_rostime()
event_str = None
while not event_str:
event_str = raw_input("Type Event:>")
event_str = event_str.strip()
seq_num += 1 seq_num += 1
filename = "%03d_drive_event.pb.txt" % seq_num time = datetime.datetime.now().strftime("%Y%m%d%H%M%S")
filename = time + "%03d_drive_event.pb.txt" % seq_num
filename = os.path.join(g_args.dir, filename) filename = os.path.join(g_args.dir, filename)
while os.path.isfile(filename): while os.path.isfile(filename):
seq_num += 1 seq_num += 1
filename = os.path.join(g_args.dir, filename = os.path.join(g_args.dir,
"%03d_drive_event.pb.txt" % seq_num) "%03d_drive_event.pb.txt" % seq_num)
current_time = rospy.get_rostime()
seconds = current_time.secs + current_time.nsecs / 1000.0 seconds = current_time.secs + current_time.nsecs / 1000.0
event_msg = drive_event_meta_msg.msg_type()() event_msg = drive_event_meta_msg.msg_type()()
event_msg.header.timestamp_sec = seconds event_msg.header.timestamp_sec = seconds
...@@ -113,4 +121,4 @@ if __name__ == "__main__": ...@@ -113,4 +121,4 @@ if __name__ == "__main__":
event_msg.location.CopyFrom(g_localization.pose) event_msg.location.CopyFrom(g_localization.pose)
pub.publish(event_msg) pub.publish(event_msg)
proto_utils.write_pb_to_text_file(event_msg, filename) proto_utils.write_pb_to_text_file(event_msg, filename)
print("logged to rosbag and file %s" % filename) print("logged to rosbag and written file %s" % filename)
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册