%_________________________________________________________________
%雅克比迭代法解方程AX=B，方法簡述如下：
%A分解成D（對角矩陣）負的上三角矩陣和負的下三角矩陣U和L,即有A=D-L-U
%                      迭代式子為：X(k+1)=D^(-1)(L+U)*X(k)+D^(-1)B
%迭代法收斂的充分必要條件：當k趨于無窮大時候，B^k=0
%                          迭代矩陣B的普半徑（B矩陣特征值的最大值）小于1
%__________________________________________________________________

%~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
%調用格式：[X,k,err]=jacobi(A,B,P,delta,max1)
% 參數說明：輸入參數 -A，B輸入的方程中的兩個參數（AX=B)
%                    -P,初始迭代值，任取
%                    -delta,誤差項，max1,循環的最大次數
function [X,k,err]=jacobi(A,B,P,delta,max1)
N=length(B);
D=zeros(N);
for i=1:N
    D(i,i)=A(i,i);
end
%求出迭代式中的兩個參數
Bj=inv(D)*(D-A);
Fj=inv(D)*B;
%迭代過程
for k=1:max1
    X=Bj*P+Fj;
    if (norm(abs(X-P))<delta)|((norm(abs(X-P))/(norm(abs(X-P))+eps))<delta)
        err=norm(abs(X-P));
        break
    end
        P=X;
    end