Redundant Iterations

[ichabod801]

I don't see an obvious solution, and your code is totally opaque (no documentation, non-descriptive variable names). The only thing I note at this point is that line 40 should maybe be return Optm(S + 2, H, GH, q) instead of Optm(5 + 2, H, GH, q) (that is, ess not five).