Updated library to comply with new Orocos KDL version