vga.c

void s2_VGADrawBufferI(s2_UInt8 *buffer)
{
    for (int c = 0; c < 4; c++)
    {
        s2_UInt8 colorMask = 1<<c;
        s2_OutB(S2_VGAPORT_SEQIP, 0x02);
        s2_OutB(S2_VGAPORT_SEQDP, colorMask);
        s2_UInt32 v = 0;
        s2_UInt32 *loc = 0;
        for (s2_UInt32 i = 0; i < (640*480); i++)
        {
            s2_UInt32 r = (i+1)%32;
            if (buffer[i] & colorMask)
            {
                v |= (1<<r);
            }
            else 
            {
                v &= ~(1<<r);
            }
            if (r == 0) {
                loc = ((s2_UInt32*)s2_VGALoc)+(i>>5);
                
                *loc = v;

                v = 0;
            }
        }
    }
}