arm_kinematics David Lu!! BSD http://ros.org/wiki/arm_kinematics