Step size adjustment etc.

Have attempted to add step-size adjustment, which helped. Depending on
the convergence criterion, results are produced.

However, the gradient is not at all zero - which it should be. This
must (!) be fixed, otherwise the whole point of the iteration does not
work.