Added kinematics plugin that uses Levenberg-Marquardt method