TrajOpt timeout check constraint convergence and if satisfied report converged

[Levi-Armstrong]

Currently a timeout is considered a failure, but if constraints are satisfied it should report convergence.