A = [2, -1, 0, 0;
    -1, 2, -1, 0;
    0, -1, 2, -1;
    0, 0, -1, 2];
b = [0;0;0;5];
B = Alg5([A b])

B =

    1.0000         0         0         0    1.0000
         0    1.0000         0         0    2.0000
         0         0    1.0000         0    3.0000
         0         0         0    1.0000    4.0000