clear,close all

A12=[0 0 0 1 0
    0 0 0 0 1
    1 0 0 0 0
    0 1 0 0 0
    0 0 1 0 0]
A11=[1 0 0 0 0
    0 1 0 0 0
    0 0 1 0 0
    0 0 0 1 0
    0 0 0 0 1]
A13=[0 1 0 0 0
    0 0 1 0 0
    0 0 0 1 0
    0 0 0 0 1
    1 0 0 0 0]
A23=[0 0 1 0 0
    0 0 0 1 0
    0 0 0 0 1
    1 0 0 0 0
    0 1 0 0 0]
A22=[0 0 0 0 1
    1 0 0 0 0
    0 1 0 0 0
    0 0 1 0 0
    0 0 0 1 0]
A21=[1 0 0 0 0
    0 1 0 0 0
    0 0 1 0 0
    0 0 0 1 0
    0 0 0 0 1]

Hqc=[A11,A12,A13;A21,A22,A23]
[br,bc]=size(A11);
[cb,tb]=size(Hqc);
D=Hqc(1:cb,tb-cb+1:tb)
rd=rank(D);
r=rank(Hqc);
if r==cb
    delta_r=r-rd

switch delta_r
    case 0
        D=[D,eye(cb)]
        D=em3(D)
        invD=D(1:cb,cb+1:2*cb)
        M=Hqc(1:cb,1:tb-cb)
        TEM=mod(invD*M,2)
        I=eye(tb-cb)
        Z=mod(TEM*I,2)
        P=conj(Z)'
        Gqc=[I,P]
        
        
    otherwise 
        tmp=Hqc(1:cb,tb-delta_r+1:tb)
        Hqc(1:cb,1+delta_r:tb)=Hqc(1:cb,1:tb-delta_r)
        Hqc(1:cb,1:delta_r)=tmp
        per_D=Hqc(1:cb,tb-cb+1:tb)
        per_D1=per_D
        delta_l=0
        
        %如果D仍然非滿秩，則增加列數(shù)
        
       while (r-rank(per_D1))>0
            delta_l=delta_l+1
            per_D=Hqc(1:cb,tb-cb+1-delta_l*br:tb)
            per_D1=per_D,end
            lb=delta_l*br+cb, %得到新的列數(shù)
    end

else
    delta_r=r-rd
    switch delta_r
    case 0
        per_D=D
        per_D1=em3(per_D(1:r,1:cb))
        Q=[per_D1;per_D(r+1:cb,1:cb)]
        Q=Q(1:cb,r+1:cb)
        Q=conj(Q)'
        O=zeros(cb-r,tb-cb)
        Q=[O,Q]
        Dg=D(1:r,1:cb)
        Dg=[Dg,eye(r)]
        Dg=em3(Dg)
        invDg=Dg(1:r,1+r:cb+r)
        invDg=[invDg;zeros(cb-r,cb)]
        M=Hqc(1:cb,1:tb-cb)
        TEM=mod(invDg*M,2)
        I=eye(tb-cb)
        Z=mod(TEM*I,2)
        P=conj(Z)'
        G=[I,P]
        Gqc=[G;Q]
    otherwise
        tmp=Hqc(1:cb,tb-delta_r+1:tb);
        Hqc(1:cb,1+delta_r:tb)=Hqc(1:cb,1:tb-delta_r);
        Hqc(1:cb,1:delta_r)=tmp;
        per_D=Hqc(1:cb,tb-cb+1:tb);
        per_D1=per_D
        delta_l=0;
       while (r-rank(per_D1))>0
            delta_l=delta_l+1;
            per_D=Hqc(1:cb,tb-cb+1-delta_l*br:tb);
            per_D1=per_D;end;
            lb=delta_l*br+cb
    end
        per_D2=em3(per_D1(1:r,1:lb));
        w=[per_D2;per_D1(r+1:cb,1:lb)];
        Q=w(1:cb,r+1:lb);
        Q=conj(Q)'
        O=zeros(cb-r,tb-lb);
        Q=[O,Q];
        Dg=per_D1(1:r,1:lb);
        Dg=[Dg,eye(r)];
        Dg=em3(Dg);
        invDg=Dg(1:r,1+r:lb+r);
        invDg=[invDg;zeros(cb-r,lb)];
        M=Hqc(1:cb,1:tb-lb);
        TEM=mod(invDg*M,2);
        I=eye(tb-lb);
        Z=mod(TEM*I,2);
        P=conj(Z)';
        G=[I,P]
        Gqc=[G;Q]
end