hrl-kdl Kinematics and geometry utilities for KDL See documentation here: http://wiki.ros.org/hrl-kdl