Sosatb

function hemm
    clc, clear, close all;

    x0 = [1, 1, 1, 1, 1, 1, 1,-1,-1,-1,-1, 1, 1,-1,-1,-1,-1, 1, 1,-1,-1,-1,-1, 1, 1,-1,-1,-1,-1, 1, 1,-1,-1,-1,-1, 1, 1,-1,-1,-1,-1, 1, 1,-1,-1,-1,-1, 1, 1,-1,-1,-1,-1, 1, 1,-1,-1,-1,-1, 1, 1,-1,-1,-1,-1, 1, 1, 1, 1, 1, 1, 1];
%   y0 = [1, 1, 1, 1, 1, 1,
%           1,-1,-1,-1,-1, 1,
%           1,-1,-1,-1,-1, 1,
%           1,-1,-1,-1,-1, 1,
%           1,-1,-1,-1,-1, 1,
%           1,-1,-1,-1,-1, 1,
%           1,-1,-1,-1,-1, 1,
%           1,-1,-1,-1,-1, 1,
%           1,-1,-1,-1,-1, 1,
%           1,-1,-1,-1,-1, 1,
%           1,-1,-1,-1,-1, 1,
%          -1,-1,-1,-1,-1,-1];
    y1 = [-1,-1,-1,-1,-1, 1,-1,-1,-1,-1, 1, 1,-1,-1,-1, 1,-1, 1,-1,-1, 1,-1,-1, 1, -1, 1,-1,-1,-1, 1,-1,-1,-1,-1,-1,-1,-1,-1,-1,-1,-1, 1,-1,-1,-1,-1,-1, 1,-1,-1,-1,-1,-1, 1,-1,-1,-1,-1,-1, 1,-1,-1,-1,-1,-1,-1,-1,-1,-1,-1,-1,-1];
    y0 = [1, 1, 1, 1, 1, 1, 1,-1,-1,-1,-1, 1, 1,-1,-1,-1,-1, 1, 1,-1,-1,-1,-1, 1, 1,-1,-1,-1,-1, 1, 1,-1,-1,-1,-1, 1, 1,-1,-1,-1,-1, 1, 1,-1,-1,-1,-1, 1, 1,-1,-1,-1,-1, 1, 1,-1,-1,-1,-1, 1, 1,-1,-1,-1,-1, 1,-1,-1,-1,-1,-1,-1];
    x1 = [-1 -1 -1 -1 -1 1 -1 -1 -1 -1 1 1 -1 -1 -1 1 -1 1 -1 -1 1 -1 -1 1 -1 1 -1 -1 -1 1 1 -1 -1 -1 -1 1 -1 -1 -1 -1 -1 1 -1 -1 -1 -1 -1 1 -1 -1 -1 -1 -1 1 -1 -1 -1 -1 -1 1 -1 -1 -1 -1 -1 1 -1 -1 -1 -1 -1 1];
    x2 = [1 1 1 1 1 1 -1 -1 -1 -1 -1 1 -1 -1 -1 -1 -1 1 -1 -1 -1 -1 -1 1 -1 -1 -1 -1 -1 1 -1 -1 -1 -1 -1 1 -1 -1 -1 -1 1 -1 -1 -1 -1 1 -1 -1 -1 -1 1 -1 -1 -1 -1 1 -1 -1 -1 -1 1 -1 -1 -1 -1 -1 1 1 1 1 1 1];
    x3 = [1 1 1 1 1 1 -1 -1 -1 -1 1 -1 -1 -1 -1 1 -1 -1 -1 -1 1 -1 -1 -1 -1 1 -1 -1 -1 -1 1 -1 -1 -1 -1 -1 1 1 1 1 1 1 -1 -1 -1 -1 1 -1 -1 -1 -1 1 -1 -1 -1 -1 1 -1 -1 -1 -1 1 -1 -1 -1 -1 1 -1 -1 -1 -1 -1];
    x4 = [1 -1 -1 -1 -1 1 1 -1 -1 -1 -1 1 1 -1 -1 -1 -1 1 1 -1 -1 -1 -1 1 1 -1 -1 -1 -1 1 1 -1 -1 -1 -1 1 1 1 1 1 1 1 -1 -1 -1 -1 -1 1 -1 -1 -1 -1 -1 1 -1 -1 -1 -1 -1 1 -1 -1 -1 -1 -1 1 -1 -1 -1 -1 -1 1];
    x5 = [1 1 1 1 1 1 1 -1 -1 -1 -1 -1 1 -1 -1 -1 -1 -1 1 -1 -1 -1 -1 -1 1 -1 -1 -1 -1 -1 1 -1 -1 -1 -1 -1 1 1 1 1 1 1 -1 -1 -1 -1 -1 1 -1 -1 -1 -1 -1 1 -1 -1 -1 -1 -1 1 -1 -1 -1 -1 -1 1 1 1 1 1 1 1];
    x6 = [-1 -1 -1 -1 -1 1 -1 -1 -1 -1 1 -1 -1 -1 -1 1 -1 -1 -1 -1 1 -1 -1 -1 -1 1 -1 -1 -1 -1 1 -1 -1 -1 -1 -1 1 1 1 1 1 1 1 -1 -1 -1 -1 1 1 -1 -1 -1 -1 1 1 -1 -1 -1 -1 1 1 -1 -1 -1 -1 1 1 1 1 1 1 1];
    x7 = [1 1 1 1 1 1 -1 -1 -1 -1 -1 1 -1 -1 -1 -1 1 -1 -1 -1 -1 1 -1 -1 -1 -1 1 -1 -1 -1 -1 1 -1 -1 -1 -1 1 -1 -1 -1 -1 -1 1 -1 -1 -1 -1 -1 1 -1 -1 -1 -1 -1 1 -1 -1 -1 -1 -1 1 -1 -1 -1 -1 -1 1 -1 -1 -1 -1 -1];
    x8 = [1 1 1 1 1 1 1 -1 -1 -1 -1 1 1 -1 -1 -1 -1 1 1 -1 -1 -1 -1 1 1 -1 -1 -1 -1 1 1 -1 -1 -1 -1 1 1 1 1 1 1 1 1 -1 -1 -1 -1 1 1 -1 -1 -1 -1 1 1 -1 -1 -1 -1 1 1 -1 -1 -1 -1 1 1 1 1 1 1 1];
    x9 = [1 1 1 1 1 1 1 -1 -1 -1 -1 1 1 -1 -1 -1 -1 1 1 -1 -1 -1 -1 1 1 -1 -1 -1 -1 1 1 1 1 1 1 1 -1 -1 -1 -1 -1 1 -1 -1 -1 -1 1 -1 -1 -1 -1 1 -1 -1 -1 -1 1 -1 -1 -1 -1 1 -1 -1 -1 -1 1 -1 -1 -1 -1 -1];

    y9 = [1 1 1 -1 1 1 1 -1 -1 -1 -1 1 1 -1 -1 -1 -1 1 1 -1 -1 -1 -1 1 1 -1 -1 -1 -1 1 1 1 -1 1 1 1 -1 -1 -1 -1 -1 1 -1 -1 -1 -1 1 -1 -1 -1 -1 1 -1 -1 -1 -1 1 -1 -1 -1 -1 -1 -1 -1 -1 -1 -1 -1 -1 -1 -1 -1];
    K = 10;
    W = 1/2*[x0; x1; x2; x3; x4; x5; x6; x7; x8; x9];
    T = 72/2;%?
    E = 0.1;
    V = zeros(K);
    for i=1:K
        for j=1:K
            if(i==j)
                V(i, j) = 1;
            else
                V(i, j) = -E;
            end
        end
    end
    obr(y1)
    Hemm(W, V, T, y1, K)
    obr(y9)
    Hemm(W, V, T, y9, K)
    obr(y0)
    Hemm(W, V, T, y0, K)
    Hemm(W, V, T, x6, K)
end

function f = F(z, T)
    if(z<=0)
        f = 0;
    end
    if(z>0 && z<=T)
        f = z;
    end
    if(z>=T)
        f = T;
    end
end

function f = Hemm(W, V, T, y, K)
    S = 0;
    Y1 = W*y' + T;
    Y2 = V*Y1;
    for i=1:K
        Y2(i) = F(Y2(i), T);
        S = S + (Y1(i) - Y2(i)).^2;
    end
    while(S>0.1)
        S = 0;
        Y1 = Y2;
        Y2 = V*Y1;
        for i=1:K
            Y2(i) = F(Y2(i), T);
            S = S + (Y1(i) - Y2(i)).^2;
        end
    end
    f = Y2;
end

function [y1] = obr(y)
    y1 = zeros(12,6);
    for i=1:12
        for j=1:6
            y1(i,j) = y(6*(i-1)+j);
        end
    end
end