Jacobi Method

program jacobi
    implicit none
    integer, parameter::n=3, M=100
    integer::i,j,k
    real::a(n,n+1),b(n),x(n),x0(n), tol=0.00001,s,norm
    open(11, file="in.txt")
    ! reading matrix
    do i=1,n
        read(11,*) (a(i,j), j=1,n+1)
    end do
    ! reading initial guess
    read(11,*) (x0(i), i=1,n)
    ! separating b
    do i=1,n
        b(i)= a(i,n+1)
    end do

    do k=1,M
        do i=1,n
            s=0.0
            do j=1,n
                if(i /= j) s=s+a(i,j)*x(j)
            end do
            x(i) = ((-s+b(i))) / a(i,i)
        end do
        !write(*,*) (x(i), i=1,n)
        if(norm(x,x0)<tol) then
            write(*,*) (x(i), i=1,n)
            STOP
        end if
        do i=1,n
            x0(i)=x(i)
        end do

    end do
    write(*,*) (x(i), i=1,n)

end program jacobi

function norm(x,x0)
    integer,parameter::n=3
    integer::i
    real::x(n),x0(n),s,norm
    s=0.0
    do i=1,n
        s=s+(x(i)-x0(i))**2
    end do
    norm = SQRT(s)
end function