Fixing Gauss Seidel iteration
Fix forward substitution
Allow Gauss-Seidel to run until the tolerance is reached