Ros print position and other info of robot
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?