ROS Resources: Documentation | Support | Discussion Forum | Index | Service Status | ros @ Robotics Stack Exchange
Ask Your Question

How do i get the distancies between frames in openni_tracker?

asked 2015-02-17 05:57:12 -0500

chiaraDark gravatar image

Hi all! I'm running ROS hydro with ubuntu 12.04 (I'm new for both of them). I'm using kinect for skeletal tracking, but I don't know how to get the length of the limbs during a movement. Can someone help me? Regards

edit retag flag offensive close merge delete

1 Answer

Sort by ยป oldest newest most voted

answered 2015-02-17 07:58:16 -0500

If you're using openni_tracker, the general way to do this would be to create a tf listener, and in some sort of loop use the listener to lookup the transform between the joints that you're interested in. This method will return a vector and a quaternion representing the transform between the two frames. If all you're interested in is distance, then you can simply calculate that using the transformation vector. Here's a simple example adapted from the previously-linked tf listener tutorial:

#!/usr/bin/env python  
import rospy
import tf
import geometry_msgs.msg
import numpy as np

if __name__ == '__main__':

    listener = tf.TransformListener()

    rate = rospy.Rate(10.0)
    while not rospy.is_shutdown():
            (trans,rot) = listener.lookupTransform('/right_hand_1', '/left_hand_1', rospy.Time(0))
            rospy.loginfo("Distance between the hands is = {0:f}".format(np.linalg.norm(trans)))
        except (tf.LookupException, tf.ConnectivityException, tf.ExtrapolationException):


The only key to making this example work is ensuring that your tf tree is fully connected. My version of openni_tracker uses, by default, openni_depth_frame as the frame it produces transforms in, but the openni.launch file uses camera as its default name to define all frames and topics. This inconsistency can be fixed, for example, by running openni.launch in the following way:

roslaunch openni_launch openni.launch camera:=openni

Then openni_tracker could be started with just rosrun openni_tracker openni_tracker

edit flag offensive delete link more


Is the same if i run this command in the terminal? rosrun tf tf_echo right_shoulder_1 right_hand_1 With this i get a vector for translation and one for rotation, but what i need is the effective registered length of the limb (i have to see if my track is affected by noise and i have to measure it)

chiaraDark gravatar image chiaraDark  ( 2015-02-17 08:51:09 -0500 )edit

The "trans" part in my code is exactly the vector for translation. If you want, for example, the length of the right forearm simply lookup the transform from "/right_hand_1" to "/right_elbow_1". That will give you a translation between those frames. Then the Euclidean norm will give the distance.

jarvisschultz gravatar image jarvisschultz  ( 2015-02-17 09:24:12 -0500 )edit

Thanks a lot!

chiaraDark gravatar image chiaraDark  ( 2015-02-17 10:38:09 -0500 )edit

Question Tools


Asked: 2015-02-17 05:57:12 -0500

Seen: 1,601 times

Last updated: Feb 17 '15