/*

SDL - Simple DirectMedia Layer

This library is free software; you can redistribute it and/or

This library is distributed in the hope that it will be useful,

but WITHOUT ANY WARRANTY; without even the implied warranty of

MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU

You should have received a copy of the GNU Lesser General Public

License along with this library; if not, write to the Free Software

Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA

Sam Lantinga

#include "SDL_video.h"

#include "SDL_blit.h"

/* Functions to perform alpha blended blitting */

/* N->1 blending with per-surface alpha */

static void

BlitNto1SurfaceAlpha(SDL_BlitInfo * info)

int width = info->dst_w;

int height = info->dst_h;

Uint8 *src = info->src;

SDL_PixelFormat *srcfmt = info->src_fmt;

SDL_PixelFormat *dstfmt = info->dst_fmt;

int srcbpp = srcfmt->BytesPerPixel;

while (height--) {

/* *INDENT-OFF* */

DUFFS_LOOP4(

{

unsigned sR;

unsigned sG;

unsigned sB;

unsigned dR;

unsigned dG;

unsigned dB;

dR = dstfmt->palette->colors[*dst].r;

dG = dstfmt->palette->colors[*dst].g;

dB = dstfmt->palette->colors[*dst].b;

ALPHA_BLEND(sR, sG, sB, A, dR, dG, dB);

dR &= 0xff;

dG &= 0xff;

dB &= 0xff;

/* Pack RGB into 8bit pixel */

if ( palmap == NULL ) {

*dst =((dR>>5)<<(3+2))|

((dG>>5)<<(2))|

((dB>>6)<<(0));

} else {

*dst = palmap[((dR>>5)<<(3+2))|

((dG>>5)<<(2)) |

((dB>>6)<<(0))];

}

dst++;

src += srcbpp;

},

width);

/* *INDENT-ON* */

src += srcskip;

dst += dstskip;

}

}

/* N->1 blending with pixel alpha */

static void

BlitNto1PixelAlpha(SDL_BlitInfo * info)

int width = info->dst_w;

int height = info->dst_h;

Uint8 *src = info->src;

SDL_PixelFormat *srcfmt = info->src_fmt;

SDL_PixelFormat *dstfmt = info->dst_fmt;

int srcbpp = srcfmt->BytesPerPixel;

while (height--) {

/* *INDENT-OFF* */

DUFFS_LOOP4(

{

unsigned sR;

unsigned sG;

unsigned sB;

unsigned sA;

unsigned dR;

unsigned dG;

unsigned dB;

dR = dstfmt->palette->colors[*dst].r;

dG = dstfmt->palette->colors[*dst].g;

dB = dstfmt->palette->colors[*dst].b;

ALPHA_BLEND(sR, sG, sB, sA, dR, dG, dB);

dR &= 0xff;

dG &= 0xff;

dB &= 0xff;

/* Pack RGB into 8bit pixel */

if ( palmap == NULL ) {

*dst =((dR>>5)<<(3+2))|

((dG>>5)<<(2))|

((dB>>6)<<(0));

} else {

*dst = palmap[((dR>>5)<<(3+2))|

((dG>>5)<<(2)) |

((dB>>6)<<(0)) ];

}

dst++;

src += srcbpp;

},

width);

/* *INDENT-ON* */

src += srcskip;

dst += dstskip;

}

}

/* colorkeyed N->1 blending with per-surface alpha */

static void

BlitNto1SurfaceAlphaKey(SDL_BlitInfo * info)

int width = info->dst_w;

int height = info->dst_h;

Uint8 *src = info->src;

SDL_PixelFormat *srcfmt = info->src_fmt;

SDL_PixelFormat *dstfmt = info->dst_fmt;

while (height--) {

/* *INDENT-OFF* */

DUFFS_LOOP(

{

unsigned sR;

unsigned sG;

unsigned sB;

unsigned dR;

unsigned dG;

unsigned dB;

DISEMBLE_RGB(src, srcbpp, srcfmt, Pixel, sR, sG, sB);

if ( Pixel != ckey ) {

dR = dstfmt->palette->colors[*dst].r;

dG = dstfmt->palette->colors[*dst].g;

dB = dstfmt->palette->colors[*dst].b;

ALPHA_BLEND(sR, sG, sB, A, dR, dG, dB);

dR &= 0xff;

dG &= 0xff;

dB &= 0xff;

/* Pack RGB into 8bit pixel */

if ( palmap == NULL ) {

*dst =((dR>>5)<<(3+2))|

((dG>>5)<<(2)) |

((dB>>6)<<(0));

} else {

*dst = palmap[((dR>>5)<<(3+2))|

((dG>>5)<<(2)) |

((dB>>6)<<(0)) ];

}

}

dst++;

src += srcbpp;

},

width);

/* *INDENT-ON* */

src += srcskip;

dst += dstskip;

}

}

static void

BlitRGBtoRGBSurfaceAlpha128MMX(SDL_BlitInfo * info)

int width = info->dst_w;

int height = info->dst_h;

Uint32 *srcp = (Uint32 *) info->src;

int dstskip = info->dst_skip >> 2;

Uint32 dalpha = info->dst_fmt->Amask;

__m64 src1, src2, dst1, dst2, lmask, hmask, dsta;

hmask = _mm_set_pi32(0x00fefefe, 0x00fefefe); /* alpha128 mask -> hmask */

lmask = _mm_set_pi32(0x00010101, 0x00010101); /* !alpha128 mask -> lmask */

dsta = _mm_set_pi32(dalpha, dalpha); /* dst alpha mask -> dsta */

while (height--) {

int n = width;

if (n & 1) {

Uint32 s = *srcp++;

Uint32 d = *dstp;

*dstp++ = ((((s & 0x00fefefe) + (d & 0x00fefefe)) >> 1)

+ (s & d & 0x00010101)) | dalpha;

n--;

}

for (n >>= 1; n > 0; --n) {

dst1 = *(__m64 *) dstp; /* 2 x dst -> dst1(ARGBARGB) */

dst2 = dst1; /* 2 x dst -> dst2(ARGBARGB) */

src1 = *(__m64 *) srcp; /* 2 x src -> src1(ARGBARGB) */

src2 = src1; /* 2 x src -> src2(ARGBARGB) */

dst2 = _mm_and_si64(dst2, hmask); /* dst & mask -> dst2 */

src2 = _mm_and_si64(src2, hmask); /* src & mask -> src2 */

src2 = _mm_add_pi32(src2, dst2); /* dst2 + src2 -> src2 */

src2 = _mm_srli_pi32(src2, 1); /* src2 >> 1 -> src2 */

dst1 = _mm_and_si64(dst1, src1); /* src & dst -> dst1 */

dst1 = _mm_and_si64(dst1, lmask); /* dst1 & !mask -> dst1 */

dst1 = _mm_add_pi32(dst1, src2); /* src2 + dst1 -> dst1 */

dst1 = _mm_or_si64(dst1, dsta); /* dsta(full alpha) | dst1 -> dst1 */

*(__m64 *) dstp = dst1; /* dst1 -> 2 x dst pixels */

dstp += 2;

srcp += 2;

}

srcp += srcskip;

dstp += dstskip;

}

_mm_empty();

}

/* fast RGB888->(A)RGB888 blending with surface alpha */

static void

BlitRGBtoRGBSurfaceAlphaMMX(SDL_BlitInfo * info)

if (alpha == 128 && (df->Rmask | df->Gmask | df->Bmask) == 0x00FFFFFF) {

/* only call a128 version when R,G,B occupy lower bits */

BlitRGBtoRGBSurfaceAlpha128MMX(info);

} else {

int width = info->dst_w;

int height = info->dst_h;

Uint32 *srcp = (Uint32 *) info->src;

Uint32 dalpha = df->Amask;

Uint32 amult;

__m64 src1, src2, dst1, dst2, mm_alpha, mm_zero, dsta;

mm_zero = _mm_setzero_si64(); /* 0 -> mm_zero */

/* form the alpha mult */

amult = alpha | (alpha << 8);

amult = amult | (amult << 16);

chanmask =

(0xff << df->Rshift) | (0xff << df->

Gshift) | (0xff << df->Bshift);

mm_alpha = _mm_set_pi32(0, amult & chanmask); /* 0000AAAA -> mm_alpha, minus 1 chan */

mm_alpha = _mm_unpacklo_pi8(mm_alpha, mm_zero); /* 0A0A0A0A -> mm_alpha, minus 1 chan */

/* at this point mm_alpha can be 000A0A0A or 0A0A0A00 or another combo */

dsta = _mm_set_pi32(dalpha, dalpha); /* dst alpha mask -> dsta */

while (height--) {

int n = width;

if (n & 1) {

/* One Pixel Blend */

src2 = _mm_cvtsi32_si64(*srcp); /* src(ARGB) -> src2 (0000ARGB) */

src2 = _mm_unpacklo_pi8(src2, mm_zero); /* 0A0R0G0B -> src2 */

dst1 = _mm_cvtsi32_si64(*dstp); /* dst(ARGB) -> dst1 (0000ARGB) */

dst1 = _mm_unpacklo_pi8(dst1, mm_zero); /* 0A0R0G0B -> dst1 */

src2 = _mm_sub_pi16(src2, dst1); /* src2 - dst2 -> src2 */

src2 = _mm_mullo_pi16(src2, mm_alpha); /* src2 * alpha -> src2 */

src2 = _mm_srli_pi16(src2, 8); /* src2 >> 8 -> src2 */

dst1 = _mm_add_pi8(src2, dst1); /* src2 + dst1 -> dst1 */

dst1 = _mm_packs_pu16(dst1, mm_zero); /* 0000ARGB -> dst1 */

dst1 = _mm_or_si64(dst1, dsta); /* dsta | dst1 -> dst1 */

*dstp = _mm_cvtsi64_si32(dst1); /* dst1 -> pixel */

++srcp;

++dstp;

n--;

}

for (n >>= 1; n > 0; --n) {

/* Two Pixels Blend */

src1 = *(__m64 *) srcp; /* 2 x src -> src1(ARGBARGB) */

src2 = src1; /* 2 x src -> src2(ARGBARGB) */

src1 = _mm_unpacklo_pi8(src1, mm_zero); /* low - 0A0R0G0B -> src1 */

src2 = _mm_unpackhi_pi8(src2, mm_zero); /* high - 0A0R0G0B -> src2 */

dst1 = *(__m64 *) dstp; /* 2 x dst -> dst1(ARGBARGB) */

dst2 = dst1; /* 2 x dst -> dst2(ARGBARGB) */

dst1 = _mm_unpacklo_pi8(dst1, mm_zero); /* low - 0A0R0G0B -> dst1 */

dst2 = _mm_unpackhi_pi8(dst2, mm_zero); /* high - 0A0R0G0B -> dst2 */

src1 = _mm_sub_pi16(src1, dst1); /* src1 - dst1 -> src1 */

src1 = _mm_mullo_pi16(src1, mm_alpha); /* src1 * alpha -> src1 */

src1 = _mm_srli_pi16(src1, 8); /* src1 >> 8 -> src1 */

dst1 = _mm_add_pi8(src1, dst1); /* src1 + dst1(dst1) -> dst1 */

src2 = _mm_sub_pi16(src2, dst2); /* src2 - dst2 -> src2 */

src2 = _mm_mullo_pi16(src2, mm_alpha); /* src2 * alpha -> src2 */

src2 = _mm_srli_pi16(src2, 8); /* src2 >> 8 -> src2 */

dst2 = _mm_add_pi8(src2, dst2); /* src2 + dst2(dst2) -> dst2 */

dst1 = _mm_packs_pu16(dst1, dst2); /* 0A0R0G0B(res1), 0A0R0G0B(res2) -> dst1(ARGBARGB) */

dst1 = _mm_or_si64(dst1, dsta); /* dsta | dst1 -> dst1 */

*(__m64 *) dstp = dst1; /* dst1 -> 2 x pixel */

srcp += 2;

dstp += 2;

}

srcp += srcskip;

dstp += dstskip;

}

_mm_empty();

}

}

/* fast ARGB888->(A)RGB888 blending with pixel alpha */

static void

BlitRGBtoRGBPixelAlphaMMX(SDL_BlitInfo * info)

int width = info->dst_w;

int height = info->dst_h;

Uint32 *srcp = (Uint32 *) info->src;

int dstskip = info->dst_skip >> 2;

SDL_PixelFormat *sf = info->src_fmt;

Uint32 chanmask = sf->Rmask | sf->Gmask | sf->Bmask;

Uint32 amask = sf->Amask;

Uint32 ashift = sf->Ashift;

Uint64 multmask;

__m64 src1, dst1, mm_alpha, mm_zero, dmask;

mm_zero = _mm_setzero_si64(); /* 0 -> mm_zero */

multmask <<= (ashift * 2);

multmask = ~multmask;

dmask = *(__m64 *) & multmask; /* dst alpha mask -> dmask */

while (height--) {

/* *INDENT-OFF* */

DUFFS_LOOP4({

Uint32 alpha = *srcp & amask;

if (alpha == 0) {

/* do nothing */

} else if (alpha == amask) {

/* opaque alpha -- copy RGB, keep dst alpha */

*dstp = (*srcp & chanmask) | (*dstp & ~chanmask);

} else {

src1 = _mm_cvtsi32_si64(*srcp); /* src(ARGB) -> src1 (0000ARGB)*/

src1 = _mm_unpacklo_pi8(src1, mm_zero); /* 0A0R0G0B -> src1 */

dst1 = _mm_cvtsi32_si64(*dstp); /* dst(ARGB) -> dst1 (0000ARGB)*/

dst1 = _mm_unpacklo_pi8(dst1, mm_zero); /* 0A0R0G0B -> dst1 */

mm_alpha = _mm_cvtsi32_si64(alpha); /* alpha -> mm_alpha (0000000A) */

mm_alpha = _mm_srli_si64(mm_alpha, ashift); /* mm_alpha >> ashift -> mm_alpha(0000000A) */

mm_alpha = _mm_unpacklo_pi16(mm_alpha, mm_alpha); /* 00000A0A -> mm_alpha */

mm_alpha = _mm_unpacklo_pi32(mm_alpha, mm_alpha); /* 0A0A0A0A -> mm_alpha */

mm_alpha = _mm_and_si64(mm_alpha, dmask); /* 000A0A0A -> mm_alpha, preserve dst alpha on add */

/* blend */

src1 = _mm_sub_pi16(src1, dst1);/* src1 - dst1 -> src1 */

src1 = _mm_mullo_pi16(src1, mm_alpha); /* (src1 - dst1) * alpha -> src1 */

src1 = _mm_srli_pi16(src1, 8); /* src1 >> 8 -> src1(000R0G0B) */

dst1 = _mm_add_pi8(src1, dst1); /* src1 + dst1 -> dst1(0A0R0G0B) */

dst1 = _mm_packs_pu16(dst1, mm_zero); /* 0000ARGB -> dst1 */

*dstp = _mm_cvtsi64_si32(dst1); /* dst1 -> pixel */

}

++srcp;

++dstp;

}, width);

/* *INDENT-ON* */

srcp += srcskip;

dstp += dstskip;

}

_mm_empty();

#if SDL_ALTIVEC_BLITTERS

#if __MWERKS__

#pragma altivec_model on

#endif

#if HAVE_ALTIVEC_H

#include <altivec.h>

#endif

#include <assert.h>

#if (defined(__MACOSX__) && (__GNUC__ < 4))

#define VECUINT8_LITERAL(a,b,c,d,e,f,g,h,i,j,k,l,m,n,o,p) \

(vector unsigned char) ( a,b,c,d,e,f,g,h,i,j,k,l,m,n,o,p )

#define VECUINT16_LITERAL(a,b,c,d,e,f,g,h) \

(vector unsigned short) ( a,b,c,d,e,f,g,h )

#else

#define VECUINT8_LITERAL(a,b,c,d,e,f,g,h,i,j,k,l,m,n,o,p) \

(vector unsigned char) { a,b,c,d,e,f,g,h,i,j,k,l,m,n,o,p }

#define VECUINT16_LITERAL(a,b,c,d,e,f,g,h) \

(vector unsigned short) { a,b,c,d,e,f,g,h }

#endif

#define UNALIGNED_PTR(x) (((size_t) x) & 0x0000000F)

#define VECPRINT(msg, v) do { \

vector unsigned int tmpvec = (vector unsigned int)(v); \

unsigned int *vp = (unsigned int *)&tmpvec; \

printf("%s = %08X %08X %08X %08X\n", msg, vp[0], vp[1], vp[2], vp[3]); \

} while (0)

/* the permuation vector that takes the high bytes out of all the appropriate shorts

(vector unsigned char)(

0x00, 0x10, 0x02, 0x12,

0x04, 0x14, 0x06, 0x16,

0x08, 0x18, 0x0A, 0x1A,

0x0C, 0x1C, 0x0E, 0x1E );

*/

#define VEC_MERGE_PERMUTE() (vec_add(vec_lvsl(0, (int*)NULL), (vector unsigned char)vec_splat_u16(0x0F)))

#define VEC_U32_24() (vec_add(vec_splat_u32(12), vec_splat_u32(12)))

#define VEC_ALPHA_MASK() ((vector unsigned char)vec_sl((vector unsigned int)vec_splat_s8(-1), VEC_U32_24()))

#define VEC_ALIGNER(src) ((UNALIGNED_PTR(src)) \

? vec_lvsl(0, src) \

: vec_add(vec_lvsl(8, src), vec_splat_u8(8)))

#define VEC_MULTIPLY_ALPHA(vs, vd, valpha, mergePermute, v1_16, v8_16) do { \

/* vtemp1 contains source AAGGAAGGAAGGAAGG */ \

vector unsigned short vtemp1 = vec_mule(vs, valpha); \

/* vtemp2 contains source RRBBRRBBRRBBRRBB */ \

vector unsigned short vtemp2 = vec_mulo(vs, valpha); \

/* valpha2 is 255-alpha */ \

vector unsigned char valpha2 = vec_nor(valpha, valpha); \

/* vtemp3 contains dest AAGGAAGGAAGGAAGG */ \

vector unsigned short vtemp3 = vec_mule(vd, valpha2); \

/* vtemp4 contains dest RRBBRRBBRRBBRRBB */ \

vector unsigned short vtemp4 = vec_mulo(vd, valpha2); \

/* add source and dest */ \

vtemp1 = vec_add(vtemp1, vtemp3); \

vtemp2 = vec_add(vtemp2, vtemp4); \

/* vtemp1 = (vtemp1 + 1) + ((vtemp1 + 1) >> 8) */ \

vtemp1 = vec_add(vtemp1, v1_16); \

vtemp3 = vec_sr(vtemp1, v8_16); \

vtemp1 = vec_add(vtemp1, vtemp3); \

/* vtemp2 = (vtemp2 + 1) + ((vtemp2 + 1) >> 8) */ \

vtemp2 = vec_add(vtemp2, v1_16); \

vtemp4 = vec_sr(vtemp2, v8_16); \

vtemp2 = vec_add(vtemp2, vtemp4); \

/* (>>8) and get ARGBARGBARGBARGB */ \

vd = (vector unsigned char)vec_perm(vtemp1, vtemp2, mergePermute); \

} while (0)

/* Calculate the permute vector used for 32->32 swizzling */

static vector unsigned char

calc_swizzle32(const SDL_PixelFormat * srcfmt, const SDL_PixelFormat * dstfmt)

{

/*

* We have to assume that the bits that aren't used by other

* colors is alpha, and it's one complete byte, since some formats

* leave alpha with a zero mask, but we should still swizzle the bits.

*/

/* ARGB */

const static struct SDL_PixelFormat default_pixel_format = {

0, 0, 0, 0,

16, 8, 0, 24,

0x00FF0000, 0x0000FF00, 0x000000FF, 0xFF000000,

0, NULL

};

if (!srcfmt) {

srcfmt = &default_pixel_format;

}

if (!dstfmt) {

dstfmt = &default_pixel_format;

}

const vector unsigned char plus = VECUINT8_LITERAL(0x00, 0x00, 0x00, 0x00,

0x04, 0x04, 0x04, 0x04,

0x08, 0x08, 0x08, 0x08,

0x0C, 0x0C, 0x0C,

0x0C);

vector unsigned char vswiz;

vector unsigned int srcvec;

#define RESHIFT(X) (3 - ((X) >> 3))

Uint32 rmask = RESHIFT(srcfmt->Rshift) << (dstfmt->Rshift);

Uint32 gmask = RESHIFT(srcfmt->Gshift) << (dstfmt->Gshift);

Uint32 bmask = RESHIFT(srcfmt->Bshift) << (dstfmt->Bshift);

Uint32 amask;

/* Use zero for alpha if either surface doesn't have alpha */

if (dstfmt->Amask) {

amask =

((srcfmt->Amask) ? RESHIFT(srcfmt->

Ashift) : 0x10) << (dstfmt->Ashift);

} else {

amask =

0x10101010 & ((dstfmt->Rmask | dstfmt->Gmask | dstfmt->Bmask) ^

0xFFFFFFFF);

}

#undef RESHIFT

((unsigned int *) (char *) &srcvec)[0] = (rmask | gmask | bmask | amask);

vswiz = vec_add(plus, (vector unsigned char) vec_splat(srcvec, 0));

return (vswiz);

}

static void

Blit32to565PixelAlphaAltivec(SDL_BlitInfo * info)

{

int height = info->dst_h;

Uint8 *src = (Uint8 *) info->src;

int srcskip = info->src_skip;

Uint8 *dst = (Uint8 *) info->dst;

int dstskip = info->dst_skip;

SDL_PixelFormat *srcfmt = info->src_fmt;

vector unsigned char v0 = vec_splat_u8(0);

vector unsigned short v8_16 = vec_splat_u16(8);

vector unsigned short v1_16 = vec_splat_u16(1);

vector unsigned short v2_16 = vec_splat_u16(2);

vector unsigned short v3_16 = vec_splat_u16(3);

vector unsigned int v8_32 = vec_splat_u32(8);

vector unsigned int v16_32 = vec_add(v8_32, v8_32);

vector unsigned short v3f =

VECUINT16_LITERAL(0x003f, 0x003f, 0x003f, 0x003f,

0x003f, 0x003f, 0x003f, 0x003f);

vector unsigned short vfc =

VECUINT16_LITERAL(0x00fc, 0x00fc, 0x00fc, 0x00fc,

0x00fc, 0x00fc, 0x00fc, 0x00fc);

/*

0x10 - 0x1f is the alpha

0x00 - 0x0e evens are the red

0x01 - 0x0f odds are zero

*/

vector unsigned char vredalpha1 = VECUINT8_LITERAL(0x10, 0x00, 0x01, 0x01,

0x10, 0x02, 0x01, 0x01,

0x10, 0x04, 0x01, 0x01,

0x10, 0x06, 0x01,

0x01);

vector unsigned char vredalpha2 =

(vector unsigned char) (vec_add((vector unsigned int) vredalpha1,

vec_sl(v8_32, v16_32))

);

/*

0x00 - 0x0f is ARxx ARxx ARxx ARxx

0x11 - 0x0f odds are blue

*/

vector unsigned char vblue1 = VECUINT8_LITERAL(0x00, 0x01, 0x02, 0x11,

0x04, 0x05, 0x06, 0x13,

0x08, 0x09, 0x0a, 0x15,

0x0c, 0x0d, 0x0e, 0x17);

vector unsigned char vblue2 =

(vector unsigned char) (vec_add((vector unsigned int) vblue1, v8_32)

);

/*

0x00 - 0x0f is ARxB ARxB ARxB ARxB

0x10 - 0x0e evens are green

*/

vector unsigned char vgreen1 = VECUINT8_LITERAL(0x00, 0x01, 0x10, 0x03,

0x04, 0x05, 0x12, 0x07,

0x08, 0x09, 0x14, 0x0b,

0x0c, 0x0d, 0x16, 0x0f);

vector unsigned char vgreen2 =

(vector unsigned

char) (vec_add((vector unsigned int) vgreen1, vec_sl(v8_32, v8_32))

);

vector unsigned char vgmerge = VECUINT8_LITERAL(0x00, 0x02, 0x00, 0x06,

0x00, 0x0a, 0x00, 0x0e,

0x00, 0x12, 0x00, 0x16,

0x00, 0x1a, 0x00, 0x1e);

vector unsigned char mergePermute = VEC_MERGE_PERMUTE();

vector unsigned char vpermute = calc_swizzle32(srcfmt, NULL);

vector unsigned char valphaPermute =

vec_and(vec_lvsl(0, (int *) NULL), vec_splat_u8(0xC));

vector unsigned short vf800 = (vector unsigned short) vec_splat_u8(-7);

vf800 = vec_sl(vf800, vec_splat_u16(8));

while (height--) {

int extrawidth;

vector unsigned char valigner;

vector unsigned char vsrc;

vector unsigned char voverflow;

int width = info->dst_w;

#define ONE_PIXEL_BLEND(condition, widthvar) \

while (condition) { \

Uint32 Pixel; \

unsigned sR, sG, sB, dR, dG, dB, sA; \

DISEMBLE_RGBA(src, 4, srcfmt, Pixel, sR, sG, sB, sA); \

if(sA) { \

unsigned short dstpixel = *((unsigned short *)dst); \

dR = (dstpixel >> 8) & 0xf8; \

dG = (dstpixel >> 3) & 0xfc; \

dB = (dstpixel << 3) & 0xf8; \

ALPHA_BLEND(sR, sG, sB, sA, dR, dG, dB); \

*((unsigned short *)dst) = ( \

((dR & 0xf8) << 8) | ((dG & 0xfc) << 3) | (dB >> 3) \

); \

} \

src += 4; \

dst += 2; \

widthvar--; \

}

ONE_PIXEL_BLEND((UNALIGNED_PTR(dst)) && (width), width);

extrawidth = (width % 8);

valigner = VEC_ALIGNER(src);

vsrc = (vector unsigned char) vec_ld(0, src);

width -= extrawidth;

while (width) {

vector unsigned char valpha;

vector unsigned char vsrc1, vsrc2;

vector unsigned char vdst1, vdst2;

vector unsigned short vR, vG, vB;

vector unsigned short vpixel, vrpixel, vgpixel, vbpixel;

/* Load 8 pixels from src as ARGB */

voverflow = (vector unsigned char) vec_ld(15, src);

vsrc = vec_perm(vsrc, voverflow, valigner);

vsrc1 = vec_perm(vsrc, vsrc, vpermute);

src += 16;

vsrc = (vector unsigned char) vec_ld(15, src);

voverflow = vec_perm(voverflow, vsrc, valigner);

vsrc2 = vec_perm(voverflow, voverflow, vpermute);

src += 16;

/* Load 8 pixels from dst as XRGB */

voverflow = vec_ld(0, dst);

vR = vec_and((vector unsigned short) voverflow, vf800);

vB = vec_sl((vector unsigned short) voverflow, v3_16);

vG = vec_sl(vB, v2_16);

vdst1 =

(vector unsigned char) vec_perm((vector unsigned char) vR,

(vector unsigned char) vR,

vredalpha1);

vdst1 = vec_perm(vdst1, (vector unsigned char) vB, vblue1);

vdst1 = vec_perm(vdst1, (vector unsigned char) vG, vgreen1);

vdst2 =

(vector unsigned char) vec_perm((vector unsigned char) vR,

(vector unsigned char) vR,

vredalpha2);

vdst2 = vec_perm(vdst2, (vector unsigned char) vB, vblue2);

vdst2 = vec_perm(vdst2, (vector unsigned char) vG, vgreen2);

/* Alpha blend 8 pixels as ARGB */

valpha = vec_perm(vsrc1, v0, valphaPermute);

VEC_MULTIPLY_ALPHA(vsrc1, vdst1, valpha, mergePermute, v1_16,

v8_16);

valpha = vec_perm(vsrc2, v0, valphaPermute);

VEC_MULTIPLY_ALPHA(vsrc2, vdst2, valpha, mergePermute, v1_16,

v8_16);

/* Convert 8 pixels to 565 */

vpixel = (vector unsigned short) vec_packpx((vector unsigned int)

vdst1,

(vector unsigned int)

vdst2);

vgpixel = (vector unsigned short) vec_perm(vdst1, vdst2, vgmerge);

vgpixel = vec_and(vgpixel, vfc);

vgpixel = vec_sl(vgpixel, v3_16);

vrpixel = vec_sl(vpixel, v1_16);

vrpixel = vec_and(vrpixel, vf800);

vbpixel = vec_and(vpixel, v3f);

vdst1 =

vec_or((vector unsigned char) vrpixel,

(vector unsigned char) vgpixel);

vdst1 = vec_or(vdst1, (vector unsigned char) vbpixel);

/* Store 8 pixels */

vec_st(vdst1, 0, dst);

width -= 8;

dst += 16;

}

ONE_PIXEL_BLEND((extrawidth), extrawidth);

#undef ONE_PIXEL_BLEND

src += srcskip;

dst += dstskip;

}

}

static void

Blit32to32SurfaceAlphaKeyAltivec(SDL_BlitInfo * info)

{

int height = info->dst_h;

Uint32 *srcp = (Uint32 *) info->src;

int srcskip = info->src_skip >> 2;

Uint32 *dstp = (Uint32 *) info->dst;

int dstskip = info->dst_skip >> 2;

SDL_PixelFormat *srcfmt = info->src_fmt;

SDL_PixelFormat *dstfmt = info->dst_fmt;

unsigned sA = info->a;

unsigned dA = dstfmt->Amask ? SDL_ALPHA_OPAQUE : 0;

Uint32 rgbmask = srcfmt->Rmask | srcfmt->Gmask | srcfmt->Bmask;

Uint32 ckey = info->colorkey;

vector unsigned char mergePermute;

vector unsigned char vsrcPermute;

vector unsigned char vdstPermute;

vector unsigned char vsdstPermute;

vector unsigned char valpha;

vector unsigned char valphamask;

vector unsigned char vbits;

vector unsigned char v0;

vector unsigned short v1;

vector unsigned short v8;

vector unsigned int vckey;

vector unsigned int vrgbmask;

mergePermute = VEC_MERGE_PERMUTE();

v0 = vec_splat_u8(0);

v1 = vec_splat_u16(1);

v8 = vec_splat_u16(8);

/* set the alpha to 255 on the destination surf */

valphamask = VEC_ALPHA_MASK();

vsrcPermute = calc_swizzle32(srcfmt, NULL);

vdstPermute = calc_swizzle32(NULL, dstfmt);

vsdstPermute = calc_swizzle32(dstfmt, NULL);

/* set a vector full of alpha and 255-alpha */

((unsigned char *) &valpha)[0] = sA;

valpha = vec_splat(valpha, 0);

vbits = (vector unsigned char) vec_splat_s8(-1);

ckey &= rgbmask;

((unsigned int *) (char *) &vckey)[0] = ckey;

vckey = vec_splat(vckey, 0);

((unsigned int *) (char *) &vrgbmask)[0] = rgbmask;

vrgbmask = vec_splat(vrgbmask, 0);

while (height--) {

int width = info->dst_w;

#define ONE_PIXEL_BLEND(condition, widthvar) \

while (condition) { \

Uint32 Pixel; \

unsigned sR, sG, sB, dR, dG, dB; \

RETRIEVE_RGB_PIXEL(((Uint8 *)srcp), 4, Pixel); \

if(sA && Pixel != ckey) { \

RGB_FROM_PIXEL(Pixel, srcfmt, sR, sG, sB); \

DISEMBLE_RGB(((Uint8 *)dstp), 4, dstfmt, Pixel, dR, dG, dB); \

ALPHA_BLEND(sR, sG, sB, sA, dR, dG, dB); \

ASSEMBLE_RGBA(((Uint8 *)dstp), 4, dstfmt, dR, dG, dB, dA); \

} \

dstp++; \

srcp++; \

widthvar--; \

}

ONE_PIXEL_BLEND((UNALIGNED_PTR(dstp)) && (width), width);

if (width > 0) {

int extrawidth = (width % 4);

vector unsigned char valigner = VEC_ALIGNER(srcp);

vector unsigned char vs = (vector unsigned char) vec_ld(0, srcp);

width -= extrawidth;

while (width) {

vector unsigned char vsel;

vector unsigned char voverflow;

vector unsigned char vd;

vector unsigned char vd_orig;

/* s = *srcp */

voverflow = (vector unsigned char) vec_ld(15, srcp);

vs = vec_perm(vs, voverflow, valigner);

/* vsel is set for items that match the key */

vsel =

(vector unsigned char) vec_and((vector unsigned int) vs,

vrgbmask);

vsel = (vector unsigned char) vec_cmpeq((vector unsigned int)

vsel, vckey);

/* permute to source format */

vs = vec_perm(vs, valpha, vsrcPermute);

/* d = *dstp */

vd = (vector unsigned char) vec_ld(0, dstp);

vd_orig = vd = vec_perm(vd, v0, vsdstPermute);

VEC_MULTIPLY_ALPHA(vs, vd, valpha, mergePermute, v1, v8);

/* set the alpha channel to full on */

vd = vec_or(vd, valphamask);

/* mask out color key */

vd = vec_sel(vd, vd_orig, vsel);

/* permute to dest format */

vd = vec_perm(vd, vbits, vdstPermute);

/* *dstp = res */

vec_st((vector unsigned int) vd, 0, dstp);

srcp += 4;

dstp += 4;

width -= 4;

vs = voverflow;

}

ONE_PIXEL_BLEND((extrawidth), extrawidth);

}

#undef ONE_PIXEL_BLEND

srcp += srcskip;

dstp += dstskip;

}

}

static void

Blit32to32PixelAlphaAltivec(SDL_BlitInfo * info)

{

int width = info->dst_w;

int height = info->dst_h;

Uint32 *srcp = (Uint32 *) info->src;

int srcskip = info->src_skip >> 2;

Uint32 *dstp = (Uint32 *) info->dst;

int dstskip = info->dst_skip >> 2;

SDL_PixelFormat *srcfmt = info->src_fmt;

SDL_PixelFormat *dstfmt = info->dst_fmt;

vector unsigned char mergePermute;

vector unsigned char valphaPermute;

vector unsigned char vsrcPermute;

vector unsigned char vdstPermute;

vector unsigned char vsdstPermute;

vector unsigned char valphamask;

vector unsigned char vpixelmask;

vector unsigned char v0;

vector unsigned short v1;

vector unsigned short v8;

v0 = vec_splat_u8(0);

v1 = vec_splat_u16(1);

v8 = vec_splat_u16(8);

mergePermute = VEC_MERGE_PERMUTE();

valphamask = VEC_ALPHA_MASK();

valphaPermute = vec_and(vec_lvsl(0, (int *) NULL), vec_splat_u8(0xC));

vpixelmask = vec_nor(valphamask, v0);

vsrcPermute = calc_swizzle32(srcfmt, NULL);

vdstPermute = calc_swizzle32(NULL, dstfmt);

vsdstPermute = calc_swizzle32(dstfmt, NULL);

while (height--) {

width = info->dst_w;

#define ONE_PIXEL_BLEND(condition, widthvar) while ((condition)) { \

Uint32 Pixel; \

unsigned sR, sG, sB, dR, dG, dB, sA, dA; \

DISEMBLE_RGBA((Uint8 *)srcp, 4, srcfmt, Pixel, sR, sG, sB, sA); \

if(sA) { \

DISEMBLE_RGBA((Uint8 *)dstp, 4, dstfmt, Pixel, dR, dG, dB, dA); \

ALPHA_BLEND(sR, sG, sB, sA, dR, dG, dB); \

ASSEMBLE_RGBA((Uint8 *)dstp, 4, dstfmt, dR, dG, dB, dA); \

} \

++srcp; \

++dstp; \

widthvar--; \

}

ONE_PIXEL_BLEND((UNALIGNED_PTR(dstp)) && (width), width);

if (width > 0) {

/* vsrcPermute */

/* vdstPermute */

int extrawidth = (width % 4);

vector unsigned char valigner = VEC_ALIGNER(srcp);

vector unsigned char vs = (vector unsigned char) vec_ld(0, srcp);

width -= extrawidth;

while (width) {

vector unsigned char voverflow;

vector unsigned char vd;

vector unsigned char valpha;

vector unsigned char vdstalpha;

/* s = *srcp */

voverflow = (vector unsigned char) vec_ld(15, srcp);

vs = vec_perm(vs, voverflow, valigner);

vs = vec_perm(vs, v0, vsrcPermute);

valpha = vec_perm(vs, v0, valphaPermute);

/* d = *dstp */

vd = (vector unsigned char) vec_ld(0, dstp);

vd = vec_perm(vd, v0, vsdstPermute);

vdstalpha = vec_and(vd, valphamask);

VEC_MULTIPLY_ALPHA(vs, vd, valpha, mergePermute, v1, v8);

/* set the alpha to the dest alpha */

vd = vec_and(vd, vpixelmask);

vd = vec_or(vd, vdstalpha);

vd = vec_perm(vd, v0, vdstPermute);

/* *dstp = res */

vec_st((vector unsigned int) vd, 0, dstp);

srcp += 4;

dstp += 4;

width -= 4;

vs = voverflow;

}

ONE_PIXEL_BLEND((extrawidth), extrawidth);

}

srcp += srcskip;

dstp += dstskip;

#undef ONE_PIXEL_BLEND

}

}

/* fast ARGB888->(A)RGB888 blending with pixel alpha */

static void

BlitRGBtoRGBPixelAlphaAltivec(SDL_BlitInfo * info)

{

int width = info->dst_w;

int height = info->dst_h;

Uint32 *srcp = (Uint32 *) info->src;

int srcskip = info->src_skip >> 2;

Uint32 *dstp = (Uint32 *) info->dst;

int dstskip = info->dst_skip >> 2;

vector unsigned char mergePermute;

vector unsigned char valphaPermute;

vector unsigned char valphamask;

vector unsigned char vpixelmask;

vector unsigned char v0;

vector unsigned short v1;

vector unsigned short v8;

v0 = vec_splat_u8(0);

v1 = vec_splat_u16(1);

v8 = vec_splat_u16(8);

mergePermute = VEC_MERGE_PERMUTE();

valphamask = VEC_ALPHA_MASK();

valphaPermute = vec_and(vec_lvsl(0, (int *) NULL), vec_splat_u8(0xC));

vpixelmask = vec_nor(valphamask, v0);

while (height--) {

width = info->dst_w;

#define ONE_PIXEL_BLEND(condition, widthvar) \

while ((condition)) { \

Uint32 dalpha; \

Uint32 d; \

Uint32 s1; \

Uint32 d1; \

Uint32 s = *srcp; \

Uint32 alpha = s >> 24; \

if(alpha) { \

if(alpha == SDL_ALPHA_OPAQUE) { \

*dstp = (s & 0x00ffffff) | (*dstp & 0xff000000); \

} else { \

d = *dstp; \

dalpha = d & 0xff000000; \

s1 = s & 0xff00ff; \

d1 = d & 0xff00ff; \

d1 = (d1 + ((s1 - d1) * alpha >> 8)) & 0xff00ff; \

s &= 0xff00; \

d &= 0xff00; \

d = (d + ((s - d) * alpha >> 8)) & 0xff00; \

*dstp = d1 | d | dalpha; \

} \

} \

++srcp; \

++dstp; \

widthvar--; \

}

ONE_PIXEL_BLEND((UNALIGNED_PTR(dstp)) && (width), width);

if (width > 0) {

int extrawidth = (width % 4);

vector unsigned char valigner = VEC_ALIGNER(srcp);

vector unsigned char vs = (vector unsigned char) vec_ld(0, srcp);

width -= extrawidth;