Refactored kinematics into a generic Eigen interface to a KDL kinematic chain and an Apollo specific portion that accounts for the constrained kinematics of the fingers.