Import file for executing cmd_vel [closed]

asked 2013-01-09 15:37:59 -0600

229 ●24 ●29 ●42

updated 2013-01-20 21:14:16 -0600

Sorry I am new to ROS. I have an external program that generates an ASCII text file (say 'walk.dat') which consists of two columns of values of linear velocity and angular velocity, say 1000 rows of (a,b). Would like to write a ROS package that can read in the data and execute rostopic pub cmd_vel geometry_msgs/Twist '[a,0,0]' '[0,0,b]' according to the values in the file. I also want to do it by Turtlebot simulator in Gazebo. I really appreciate if someone can teach me step by step from the very beginning (e.g. open a terminal) to the very end (e.g. rosrun something). Thank you very much indeed.

edit retag flag offensive reopen merge delete

Closed for the following reason the question is answered, right answer was accepted by Chik
close date 2013-03-10 15:15:03

add a comment

1

answered 2013-01-20 19:32:27 -0600

mmwise

8372 ●45 ●74 ●99 http://www.meloneewise.com/

Below is a bit of python that will do what you want. I tried to make it a bit generic for you so you can extend it.

#!/usr/bin/python                                                              

import roslib; roslib.load_manifest('test')
import rospy
import sys

from geometry_msgs.msg import Twist

class Walk(object):

    def __init__(self):
        rospy.init_node('walk_reader_node')
        self._init_params()
        self._init_pubsub()
        self.fh = open(self.file)

    def _init_pubsub(self):
        self.cmd_vel_pub = rospy.Publisher('cmd_vel', Twist)

    def _init_params(self):
        self.file = rospy.get_param('~file', 'walk.dat')

    def run(self):
        r = rospy.Rate(10.0)
        while not rospy.is_shutdown():
            for line in self.fh:
                l = line.split()
                cmd = Twist()
                cmd.linear.x = float(l[0])
                cmd.angular.z = float(l[1])
                self.cmd_vel_pub.publish(cmd)
                r.sleep()
            self.fh.close()
            exit()

if __name__ == '__main__':
    w = Walk()
    w.run()

edit flag offensive delete link

Comments

Thank you very much indeed. It works now.

Chik ( 2013-01-20 21:44:42 -0600 )edit

Do you have the launch file for this example?

Christopher ( 2013-10-15 10:17:56 -0600 )edit

add a comment

3

answered 2013-01-09 16:27:13 -0600

allenh1

3045 ●62 ●89 ●110 http://allen-software.com/

This is an example of publishing some command topics with a threaded ros node. Basically, the message format is:

sim_velocity  = nh.advertise<geometry_msgs::Twist>("/cmd_vel", 100);

geometry_msgs::Twist cmd_msg;
cmd_msg.linear.x = m_speed;
cmd_msg.angular.z = m_angle;

sim_velocity.publish(msg);

The above is published each time ROS spins. m_speed and m_angle are doubles that are member variables to the thread, but you could use global variables in a non class-based approach. Questions? I don't mind answering! Just comment and I'll revise this answer. Best of luck, and welcome to ROS!

edit flag offensive delete link

Comments

Hmmm.......

Chik ( 2013-01-17 18:15:32 -0600 )edit

add a comment

Import file for executing cmd_vel [closed]

Closed for the following reason the question is answered, right answer was accepted by Chik
close date 2013-03-10 15:15:03

2 Answers

Comments

Comments

Question Tools

Stats

Related questions

Import file for executing cmd_vel [closed] edit

Closed for the following reason the question is answered, right answer was accepted by Chik close date 2013-03-10 15:15:03

2 Answers

Comments

Comments

Question Tools

Stats

Related questions

Import file for executing cmd_vel [closed]

Closed for the following reason the question is answered, right answer was accepted by Chik
close date 2013-03-10 15:15:03