fixing kdl linking
fixing unit tests