adding kdl ik solver tests back in