Fixed DiagGmin Stepping Algorithm