Possible solution

found a problem in the calculation of RHS2 in the code. might have
worked. code converges.