Added options struct to kinematics, KDL kinematics