[kdl_parser] Fix bug in importing com if inertia and link frames are different