savePointStamped.py

# coding=utf-8
import sys
import rospy
from geometry_msgs.msg import PointStamped




def callback(PointStamped):
    timestamp = PointStamped.header.stamp
    pos = PointStamped.point
    pos_x = pos.x
    pos_y = pos.y
    pos_z = pos.z
    ori_x = 0.0
    ori_y = 0.0
    ori_z = 0.0
    ori_w = 1.0
    fout.write(str(timestamp)+" "+str(pos_x)+" "+str(pos_y)+" "+str(pos_z)+" "+str(ori_x)+" "+str(ori_y)+" "+str(ori_z)+" "+str(ori_w)+"\n")
    print("Save to file",timestamp)


if __name__ == '__main__':
    subscriber_name = sys.argv[1]
    topic_name = sys.argv[2]
    out_path = sys.argv[3]

    fout = open(out_path,'a')

    # 初始化节点
    rospy.init_node(subscriber_name)
    # 开始订阅
    rospy.Subscriber(topic_name, PointStamped, callback)
    # 循环
    rospy.spin()