A few minor updates
Add convergence checks in threshold and step size, output objective, etc