00001
00002
00003 """
00004 usage: %(progname)s <track_file1.txt> ..
00005 """
00006
00007 import roslib; roslib.load_manifest('articulation_models')
00008 import rospy
00009 from articulation_models import track_utils
00010 from articulation_models.track_utils import *
00011
00012 def main():
00013 rospy.init_node('simple_publisher')
00014 pub = rospy.Publisher('track', TrackMsg)
00015
00016 for id,filename in enumerate(rospy.myargv()[1:]):
00017 track = readtrack(filename)
00018
00019 print filename
00020 msg = track
00021 msg.pose = zero_start(msg.pose)
00022 msg.id = id
00023 pub.publish(msg)
00024 if rospy.is_shutdown():
00025 exit(0)
00026
00027 if __name__ == '__main__':
00028 main()
00029