added some ros_to_kdl conversions