#define PACK_CODE_1 253   
#define PACK_CODE_2 254

//***********************************

int Pack(unsigned char *data,int size,unsigned char *out)
{
    int p=0,count=0,count2=0,pos=0,x=0,co=0,rlll=0,batt=0,pcc=0;
    unsigned char old=0,ne=0;

    int no=0;
    
    while(p<size) {
       
        old=data[p];
        x=p+1;
        count=1;

        while(x<(p+240) && x<size) {
             ne=data[x];
             if (old==ne) count++;
             else break;
             x++;
        }


        
        if (p<240) x=0;
        else x=p-240;
        
        count2=0;

        for(;x<p;x++) {
             co=0;
             if (old==data[x]) {
                 while(data[x+co]==data[p+co] && (x+co)<p && (p+co)<size) co++;        
                 if (count2<co) count2=co,pos=(p-x);
             }
        }
        

        if (count<4 && count2<4) {
            if (old==PACK_CODE_1 || old==PACK_CODE_2) {
                if (out) {
                        *out=PACK_CODE_1; out++;
                        *out=1; out++;
                        *out=old; out++;
                }
                pcc++;
                no+=3,p++;
            }
            else {
                if (out) *out=old,out++;
                no++,p++;
            }
            
        }
        else
        if (count>count2) {
                if (out) {
                *out=PACK_CODE_1; out++;
                *out=count; out++;
                *out=old; out++;
                }
                p+=count;      
                rlll+=3;                          
        }
        else {
                if (out) {
                *out=PACK_CODE_2; out++;
                *out=count2; out++;
                *out=pos; out++;
                }
                p+=count2;  
                batt+=3;                         
        }
    }

    return(no+rlll+batt);
} 




int UnPack(unsigned char *data,int size,unsigned char *out)
{
    int p=0,count=0,pos=0,x=0,si=0;
    unsigned char old=0,dat=0;
   
    unsigned char *outti;
    
    while(p<size) {
       
        old=data[p];

        if (old==PACK_CODE_1) {
            count=data[p+1];
            dat=data[p+2];
            for(x=0;x<count;x++) {
                if (out) *out=dat,out++;
                si++;
            }
            p+=3;
        }
        else
        if (old==PACK_CODE_2) {
            count=data[p+1];
            pos=data[p+2];
            outti=out-pos;
            for(x=0;x<count;x++) {
                if (out) *out=outti[x],out++;
                si++;
            }
            p+=3;       
        }
        else {
            if (out) *out=old,out++;
            p++,si++;
        }
    
    }
    
    return(si);
}