ceshi

%kadd.m
clc
clear all
% img = imread('testimg\debug\left_small1.png');
im(:,:,1) = importdata('img1.txt');
im(:,:,2) = importdata('img2.txt');
im(:,:,3) = importdata('img0.txt');
im = im(1:12,1:12,:);
[m n d] = size(im);
cl_Q = 10;
n_bufs = 61;
m_nPixels = m*n;
m_height = m;
m_width = n;
k_ind = zeros(m,n);
exp2 = zeros(12,1);
exp2(0+1) = 1;
for i=1:32
    exp2(i+1) = exp2(i+1-1)*2;
end
lg2Q = 0;
while(exp2(lg2Q+1) < cl_Q)
    lg2Q = lg2Q + 1;
end
exp2
cl_Q = exp2(lg2Q+1)
H = zeros(cl_Q,256);
Cnt = zeros(cl_Q,1);
Thr = zeros(cl_Q,1);

for l = 0:lg2Q-1
    ch = mod(l+1,3);
    if (ch == 0)
        ch = 3;
    end
    imch = im(:,:,ch);
    H = zeros(cl_Q,256);
    Cnt = zeros(cl_Q,1);
    Thr = zeros(cl_Q,1);
    lB = exp2(l+1);

    for i = 1:m
        for j = 1:n
            q = k_ind(i,j);
            H(q+1, imch(i,j)+1) = H(q+1, imch(i,j)+1) + 1;
            Cnt(q+1) = Cnt(q+1) + 1;
        end
    end

    for ll = 0:lB-1
        Cnt(ll+1) = floor(Cnt(ll+1) / 2);
        sumv = 0;
        md = 0;   
        while(Cnt(ll+1) > sumv)
            sumv  = sumv + H(ll+1, md + 1);
            md = md + 1;
        end    
        if(md > 0)
            md = md - 1;
        end
        Thr(ll+1) = md;
        Cnt(ll+1) = floor(H(ll+1, md + 1) / 2);
    end

    for i = 1:m
        for j = 1:n
            q = k_ind(i,j);
            if(imch(i,j) == Thr(q + 1))
                if(Cnt(q+1) == 0 )
                    k_ind(i,j) = k_ind(i,j) + lB;
                else
                    Cnt(q+1) = Cnt(q+1) - 1;
                end
            elseif(imch(i,j) > Thr(q+1))
                k_ind(i,j) = k_ind(i,j) + lB;
            end
        end
    end
end
% kind_vs = importdata('kind1.txt');
% diff = kind_vs - k_ind;
% diff1 = sum(diff(:))