Ros print position and other info of robot

asked 2022-06-12 17:52:17 -0500

NickRos gravatar image

updated 2022-06-12 17:55:17 -0500

Hello.I have robot and I want to print the (x,y) position and other information such as velocity ,distance and time line by line such like that:

   (x,y) = position values  ,   velocity = velocity value  ,   distance = distance value  ,   time = time value
   (x,y) = position values  ,   velocity = velocity value  ,   distance = distance value  ,   time = time value
   (x,y) = position values  ,   velocity = velocity value  ,   distance = distance value  ,   time = time value
   (x,y) = position values  ,   velocity = velocity value  ,   distance = distance value  ,   time = time value
   etc...

What I have done so far:

def print_position_orientation(msg):  
     print(str(msg.pose.pose.position.x) + "    " + str(msg.pose.pose.position.y))

def print_messages(option , time__ , final_X , first_X , final_Y , first_Y , current_time , start_time):  
               print("Linear velocity: " + "{:.9f}".format(linear_velocity(current_time - start_time , time__ , final_X , first_X , final_Y , first_Y)) + " m/sec. , " + "Elapsed distance: " + "{:.6f}".format(elapsed_distance(current_time - start_time , time__ , final_X , first_X , final_Y , first_Y)) + " meters , " + "Elasped time: " + "{:.6f}".format(current_time - start_time) + " sec.")



while(not rospy.is_shutdown() ):
       odometry_ = rospy.Subscriber('/pioneer/RosAria/odom', Odometry , print_position_orientation)
       print_messages(1 , 1.2 , orientation_interm , orientation_init , None , None , current_time , start_time)

but this code doesnt print the way I want, but something like that:

(x,y) = position value
(x,y) = position value 
(x,y) = position value   
(x,y) = position value
(x,y) = position value
(x,y) = position value
(x,y) = position value
velocity = velocity value  ,   distance = distance value  ,   time = time value
(x,y) = position value
(x,y) = position value
(x,y) = position value
(x,y) = position value
(x,y) = position value
(x,y) = position value
(x,y) = position value
velocity = velocity value  ,   distance = distance value  ,   time = time value
etc...

What can I do?

edit retag flag offensive close merge delete