Changed the kinematics plugin for the KDL implementation of LMA