mupen64plus-oldsvn/glN64/convert.h

#ifndef CONVERT_H
#define CONVERT_H

#include "Types.h"

const volatile unsigned char Five2Eight[32] =
{
      0, // 00000 = 00000000
      8, // 00001 = 00001000
     16, // 00010 = 00010000
     25, // 00011 = 00011001
     33, // 00100 = 00100001
     41, // 00101 = 00101001
     49, // 00110 = 00110001
     58, // 00111 = 00111010
     66, // 01000 = 01000010
     74, // 01001 = 01001010
     82, // 01010 = 01010010
     90, // 01011 = 01011010
     99, // 01100 = 01100011
    107, // 01101 = 01101011
    115, // 01110 = 01110011
    123, // 01111 = 01111011
    132, // 10000 = 10000100
    140, // 10001 = 10001100
    148, // 10010 = 10010100
    156, // 10011 = 10011100
    165, // 10100 = 10100101
    173, // 10101 = 10101101
    181, // 10110 = 10110101
    189, // 10111 = 10111101
    197, // 11000 = 11000101
    206, // 11001 = 11001110
    214, // 11010 = 11010110
    222, // 11011 = 11011110
    230, // 11100 = 11100110
    239, // 11101 = 11101111
    247, // 11110 = 11110111
    255  // 11111 = 11111111
};

const volatile unsigned char Four2Eight[16] =
{
      0, // 0000 = 00000000
     17, // 0001 = 00010001
     34, // 0010 = 00100010
     51, // 0011 = 00110011
     68, // 0100 = 01000100
     85, // 0101 = 01010101
    102, // 0110 = 01100110
    119, // 0111 = 01110111
    136, // 1000 = 10001000
    153, // 1001 = 10011001
    170, // 1010 = 10101010
    187, // 1011 = 10111011
    204, // 1100 = 11001100
    221, // 1101 = 11011101
    238, // 1110 = 11101110
    255  // 1111 = 11111111
};

const volatile unsigned char Three2Four[8] =
{
     0, // 000 = 0000
     2, // 001 = 0010
     4, // 010 = 0100
     6, // 011 = 0110
     9, // 100 = 1001
    11, // 101 = 1011
    13, // 110 = 1101
    15, // 111 = 1111
};

const volatile unsigned char Three2Eight[8] =
{
      0, // 000 = 00000000
     36, // 001 = 00100100
     73, // 010 = 01001001
    109, // 011 = 01101101
    146, // 100 = 10010010
    182, // 101 = 10110110
    219, // 110 = 11011011
    255, // 111 = 11111111
};
const volatile unsigned char Two2Eight[4] =
{
      0, // 00 = 00000000
     85, // 01 = 01010101
    170, // 10 = 10101010
    255  // 11 = 11111111
};

const volatile unsigned char One2Four[2] =
{
     0, // 0 = 0000
    15, // 1 = 1111
};

const volatile unsigned char One2Eight[2] =
{
      0, // 0 = 00000000
    255, // 1 = 11111111
};

static inline void UnswapCopy( void *src, void *dest, u32 numBytes )
{
    // copy leading bytes
    int leadingBytes = ((long)src) & 3;
    if (leadingBytes != 0)
    {
        leadingBytes = 4-leadingBytes;
        if ((unsigned int)leadingBytes > numBytes)
            leadingBytes = numBytes;
        numBytes -= leadingBytes;

        src = (void *)((long)src ^ 3);
        for (int i = 0; i < leadingBytes; i++)
        {
            *(u8 *)(dest) = *(u8 *)(src);
            dest = (void *)((long)dest+1);
            src  = (void *)((long)src -1);
        }
        src = (void *)((long)src+5);
    }

    // copy dwords
    int numDWords = numBytes >> 2;
    while (numDWords--)
    {
        u32 dword = *(u32 *)src;
        dword = ((dword<<24)|((dword<<8)&0x00FF0000)|((dword>>8)&0x0000FF00)|(dword>>24));
        *(u32 *)dest = dword;
        dest = (void *)((long)dest+4);
        src  = (void *)((long)src +4);
    }

    // copy trailing bytes
    int trailingBytes = numBytes & 3;
    if (trailingBytes)
    {
        src = (void *)((long)src ^ 3);
        for (int i = 0; i < trailingBytes; i++)
        {
            *(u8 *)(dest) = *(u8 *)(src);
            dest = (void *)((long)dest+1);
            src  = (void *)((long)src -1);
        }
    }
}

static inline void DWordInterleave( void *mem, u32 numDWords )
{
    int tmp;
    while( numDWords-- )
    {
        tmp = *(int *)((long)mem + 0);
        *(int *)((long)mem + 0) = *(int *)((long)mem + 4);
        *(int *)((long)mem + 4) = tmp;

        mem = (void *)((long)mem + 8);
    }
}

inline void QWordInterleave( void *mem, u32 numDWords )
{
    int tmp;
    numDWords >>= 1; // qwords
    while( numDWords-- )
    {
        tmp = *(int *)((long)mem + 0);
        *(int *)((long)mem + 0) = *(int *)((long)mem + 8);
        *(int *)((long)mem + 8) = tmp;

        tmp = *(int *)((long)mem + 4);
        *(int *)((long)mem + 4) = *(int *)((long)mem + 12);
        *(int *)((long)mem + 12) = tmp;

        mem = (void *)((long)mem + 16);
    }
}


inline u32 swapdword( u32 value )
{
#if defined(__GNUC__) && !defined(NO_ASM)
    asm volatile( "bswapl %0" : "+r"(value) );
    return value;
#else
    return ((value & 0xff000000) >> 24) |
           ((value & 0x00ff0000) >>  8) |
           ((value & 0x0000ff00) <<  8) |
           ((value & 0x000000ff) << 24);
#endif
}

inline u16 swapword( u16 value )
{
#if !defined(__GNUC__) && !defined(NO_ASM)
    asm volatile("xchgb  %%al, %%ah;" : "+a"(value));
    return value;
# else
    return (value << 8) | (value >> 8);
#endif
}

inline u16 RGBA8888_RGBA4444( u32 color )
{
    return ((color & 0x000000f0) <<  8) |   // r
           ((color & 0x0000f000) >>  4) |   // g
           ((color & 0x00f00000) >> 16) |   // b
           ((color & 0xf0000000) >> 28);    // a
}

inline u32 RGBA5551_RGBA8888( u16 color )
{
    color = swapword( color );
    u8 r, g, b, a;
    r = Five2Eight[color >> 11];
    g = Five2Eight[(color >> 6) & 0x001f];
    b = Five2Eight[(color >> 1) & 0x001f];
    a = One2Eight [(color     ) & 0x0001];
    return (a << 24) | (b << 16) | (g << 8) | r;
}

// Just swaps the word
inline u16 RGBA5551_RGBA5551( u16 color )
{
  return swapword( color );
}

inline u32 IA88_RGBA8888( u16 color )
{
    u8 a = color >> 8;
    u8 i = color & 0x00FF;
    return (a << 24) | (i << 16) | (i << 8) | i;
}

inline u16 IA88_RGBA4444( u16 color )
{
    u8 i = color >> 12;
    u8 a = (color >> 4) & 0x000F;
    return (i << 12) | (i << 8) | (i << 4) | a;
}

inline u16 IA44_RGBA4444( u8 color )
{
    return ((color & 0xf0) << 8) | ((color & 0xf0) << 4) | (color);
}

inline u32 IA44_RGBA8888( u8 color )
{
    u8 i = Four2Eight[color >> 4];
    u8 a = Four2Eight[color & 0x0F];
    return (a << 24) | (i << 16) | (i << 8) | i;
}

inline u16 IA31_RGBA4444( u8 color )
{
    u8 i = Three2Four[color >> 1];
    u8 a = One2Four[color & 0x01];
    return (i << 12) | (i << 8) | (i << 4) | a;
}

inline u32 IA31_RGBA8888( u8 color )
{
    u8 i = Three2Eight[color >> 1];
    u8 a = One2Eight[color & 0x01];
    return (i << 24) | (i << 16) | (i << 8) | a;
}

inline u16 I8_RGBA4444( u8 color )
{
    u8 c = color >> 4;
    return (c << 12) | (c << 8) | (c << 4) | c;
}

inline u32 I8_RGBA8888( u8 color )
{
    return (color << 24) | (color << 16) | (color << 8) | color;
}

inline u16 I4_RGBA4444( u8 color )
{
    u16 ret = color & 0x0f;
    ret |= ret << 4;
    ret |= ret << 8;
    return ret;
}

inline u32 I4_RGBA8888( u8 color )
{
    u8 c = Four2Eight[color];
    c |= c << 4;
    return (c << 24) | (c << 16) | (c << 8) | c;
}

#endif // CONVERT_H