Adding HHKinFit code with convergence issues fixed, tag v1.0