Fixed boundary update issue, but rms is still going up after a while and not converging.
Refactor, fix double update of boundary conditions