Стеганография в BMP. Полное руководство.

IMAGE_SIZE = WIDTH*HEIGHT*3

 
BYTE WriteTwoBitsToByte(int Bit1, int Bit2, BYTE B)
/* Записывает в байт B на первые две позиции биты Bit1 и Bit2 */ {
    BYTE A1 = 00000011;
    BYTE A2 = 00000010;    //маски возможных ситуаций
    BYTE A3 = 00000001;
    BYTE Result = B;
*       
       //если биты уже в нужном состоянии, то оставить
    if ((Bit1 == GetBitValue(B, 8)) && (Bit2 == GetBitValue(B, 7))) {               
        return B;
    }
 
    //иначе, если 11 - логическое ИЛИ с соответствующей маской
        else if ((Bit1 == 1) &&(Bit2 == 1)) {                                                    
            return Result | A1;
         }
 
        //иначе, если 10 - вычесть соответствующую маску 
    else if ((Bit1 == 1)&& (Bit2 == 0)) {                                                    
            return Result - A2;
         }
 
        //иначе, если 01 - вычесть соответствующую маску
    else if ((Bit1 == 0) &&(Bit2 == 1)) {                                                       
             return Result - A3;
         }
 
        //иначе, если 00 - вычесть  маску A1
    else if ((Bit1 == 0) && (Bit2 == 0)) {                                                     
             return Result - A1;
         }   
    
    return NULL;
}