Fix linking error for kdl