Ensure that all parameter blocks have finite values before the minimizer is called. Change-Id: I15fd9c487247989626f799496bb8f5ea8728d6f0
more than just the residual block evaluation routines now. Check the step computed by the linear solver for finiteness, and terminate early if it is not. This will prevent bugs where the solver continues to run after encountering an nan.