;

; pII-optimised MMX format converters for HERMES

; Copyright (c) 1998 Christian Nentwich (c.nentwich@cs.ucl.ac.uk)

; and (c) 1999 Jonathan Matthew (jmatthew@uq.net.au)

; This source code is licensed under the GNU LGPL

;

; Please refer to the file COPYING.LIB contained in the distribution for

; licensing conditions

;

; COPYRIGHT NOTICE

;

; This file partly contains code that is (c) Intel Corporation, specifically

; the mode detection routine, and the converter to 15 bit (8 pixel

; conversion routine from the mmx programming tutorial pages).

;

;

; These routines aren't exactly pII optimised - it's just that as they

; are, they're terrible on p5 MMXs, but less so on pIIs. Someone needs to

; optimise them for p5 MMXs..

BITS 32

GLOBAL _ConvertMMXpII32_24RGB888

GLOBAL _ConvertMMXpII32_16RGB565

GLOBAL _ConvertMMXpII32_16BGR565

GLOBAL _ConvertMMXpII32_16RGB555

GLOBAL _ConvertMMXpII32_16BGR555

EXTERN _mmxreturn

;; Macros for conversion routines

%macro _push_immq_mask 1

push dword %1

push dword %1

%endmacro

%macro load_immq 2

_push_immq_mask %2

movq %1, [esp]

%endmacro

%macro pand_immq 2

_push_immq_mask %2

pand %1, [esp]

%endmacro

%define CLEANUP_IMMQ_LOADS(num) \

add esp, byte 8 * num

%define mmx32_rgb888_mask 00ffffffh

%define mmx32_rgb565_b 000000f8h

%define mmx32_rgb565_g 0000fc00h

%define mmx32_rgb565_r 00f80000h

%define mmx32_rgb555_rb 00f800f8h

%define mmx32_rgb555_g 0000f800h

%define mmx32_rgb555_mul 20000008h

%define mmx32_bgr555_mul 00082000h

SECTION .text

_ConvertMMXpII32_24RGB888:

; set up mm6 as the mask, mm7 as zero

load_immq mm6, mmx32_rgb888_mask

CLEANUP_IMMQ_LOADS(1)

pxor mm7, mm7

mov edx, ecx ; save ecx

and ecx, 0fffffffch ; clear lower two bits

jnz .L1

jmp .L2

.L1:

movq mm0, [esi] ; A R G B a r g b

pand mm0, mm6 ; 0 R G B 0 r g b

movq mm1, [esi+8] ; A R G B a r g b

pand mm1, mm6 ; 0 R G B 0 r g b

movq mm2, mm0 ; 0 R G B 0 r g b

punpckhdq mm2, mm7 ; 0 0 0 0 0 R G B

punpckldq mm0, mm7 ; 0 0 0 0 0 r g b

psllq mm2, 24 ; 0 0 R G B 0 0 0

por mm0, mm2 ; 0 0 R G B r g b

movq mm3, mm1 ; 0 R G B 0 r g b

psllq mm3, 48 ; g b 0 0 0 0 0 0

por mm0, mm3 ; g b R G B r g b

movq mm4, mm1 ; 0 R G B 0 r g b

punpckhdq mm4, mm7 ; 0 0 0 0 0 R G B

punpckldq mm1, mm7 ; 0 0 0 0 0 r g b

psrlq mm1, 16 ; 0 0 0 R G B 0 r

psllq mm4, 8 ; 0 0 0 0 R G B 0

por mm1, mm4 ; 0 0 0 0 R G B r

movq [edi], mm0

add esi, BYTE 16

movd [edi+8], mm1

add edi, BYTE 12

sub ecx, BYTE 4

jnz .L1

.L2:

mov ecx, edx

and ecx, BYTE 3

jz .L4

.L3:

mov al, [esi]

mov bl, [esi+1]

mov dl, [esi+2]

mov [edi], al

mov [edi+1], bl

mov [edi+2], dl

add esi, BYTE 4

add edi, BYTE 3

dec ecx

jnz .L3

.L4:

jmp _mmxreturn

_ConvertMMXpII32_16RGB565:

; set up masks

load_immq mm5, mmx32_rgb565_b

load_immq mm6, mmx32_rgb565_g

load_immq mm7, mmx32_rgb565_r

CLEANUP_IMMQ_LOADS(3)

mov edx, ecx

shr ecx, 2

jnz .L1

jmp .L2 ; not necessary at the moment, but doesn't hurt (much)

.L1:

movq mm0, [esi] ; argb

movq mm1, mm0 ; argb

pand mm0, mm6 ; 00g0

movq mm3, mm1 ; argb

pand mm1, mm5 ; 000b

pand mm3, mm7 ; 0r00

pslld mm1, 2 ; 0 0 000000bb bbb00000

por mm0, mm1 ; 0 0 ggggggbb bbb00000

psrld mm0, 5 ; 0 0 00000ggg gggbbbbb

movq mm4, [esi+8] ; argb

movq mm2, mm4 ; argb

pand mm4, mm6 ; 00g0

movq mm1, mm2 ; argb

pand mm2, mm5 ; 000b

pand mm1, mm7 ; 0r00

pslld mm2, 2 ; 0 0 000000bb bbb00000

por mm4, mm2 ; 0 0 ggggggbb bbb00000

psrld mm4, 5 ; 0 0 00000ggg gggbbbbb

packuswb mm3, mm1 ; R 0 r 0

packssdw mm0, mm4 ; as above.. ish

por mm0, mm3 ; done.

movq [edi], mm0

add esi, 16

add edi, 8

dec ecx

jnz .L1

.L2:

mov ecx, edx

and ecx, BYTE 3

jz .L4

.L3:

mov al, [esi]

mov bh, [esi+1]

mov ah, [esi+2]

shr al, 3

and eax, 0F81Fh ; BYTE?

shr ebx, 5

and ebx, 07E0h ; BYTE?

add eax, ebx

mov [edi], al

mov [edi+1], ah

add esi, BYTE 4

add edi, BYTE 2

dec ecx

jnz .L3

.L4:

jmp _mmxreturn

_ConvertMMXpII32_16BGR565:

load_immq mm5, mmx32_rgb565_r

load_immq mm6, mmx32_rgb565_g

load_immq mm7, mmx32_rgb565_b

CLEANUP_IMMQ_LOADS(3)

mov edx, ecx

shr ecx, 2

jnz .L1

jmp .L2

.L1:

movq mm0, [esi] ; a r g b

movq mm1, mm0 ; a r g b

pand mm0, mm6 ; 0 0 g 0

movq mm3, mm1 ; a r g b

pand mm1, mm5 ; 0 r 0 0

pand mm3, mm7 ; 0 0 0 b

psllq mm3, 16 ; 0 b 0 0

psrld mm1, 14 ; 0 0 000000rr rrr00000

por mm0, mm1 ; 0 0 ggggggrr rrr00000

psrld mm0, 5 ; 0 0 00000ggg gggrrrrr

movq mm4, [esi+8] ; a r g b

movq mm2, mm4 ; a r g b

pand mm4, mm6 ; 0 0 g 0

movq mm1, mm2 ; a r g b

pand mm2, mm5 ; 0 r 0 0

pand mm1, mm7 ; 0 0 0 b

psllq mm1, 16 ; 0 b 0 0

psrld mm2, 14 ; 0 0 000000rr rrr00000

por mm4, mm2 ; 0 0 ggggggrr rrr00000

psrld mm4, 5 ; 0 0 00000ggg gggrrrrr

packuswb mm3, mm1 ; BBBBB000 00000000 bbbbb000 00000000

packssdw mm0, mm4 ; 00000GGG GGGRRRRR 00000GGG GGGRRRRR

por mm0, mm3 ; BBBBBGGG GGGRRRRR bbbbbggg gggrrrrr

movq [edi], mm0

add esi, BYTE 16

add edi, BYTE 8

dec ecx

jnz .L1

.L2:

and edx, BYTE 3

jz .L4

.L3:

mov al, [esi+2]

mov bh, [esi+1]

mov ah, [esi]

shr al, 3

and eax, 0F81Fh ; BYTE ?

shr ebx, 5

and ebx, 07E0h ; BYTE ?

add eax, ebx

mov [edi], al

mov [edi+1], ah

add esi, BYTE 4

add edi, BYTE 2

dec edx

jnz .L3

.L4:

jmp _mmxreturn

_ConvertMMXpII32_16BGR555:

; the 16BGR555 converter is identical to the RGB555 one,

; except it uses a different multiplier for the pmaddwd

; instruction. cool huh.

jmp _convert_bgr555_cheat

; This is the same as the Intel version.. they obviously went to

; much more trouble to expand/coil the loop than I did, so theirs

; would almost certainly be faster, even if only a little.

; I did rename 'mmx32_rgb555_add' to 'mmx32_rgb555_mul', which is

; (I think) a more accurate name..

_ConvertMMXpII32_16RGB555:

load_immq mm6, mmx32_rgb555_g

CLEANUP_IMMQ_LOADS(2)

mov edx,ecx ; Save ecx

and ecx,BYTE 0fffffff8h ; clear lower three bits

jnz .L_OK

.L_OK:

movq mm2,[esi+8]

movq mm0,[esi]

movq mm3,mm2

movq mm1,mm0

pmaddwd mm3,mm7

CLEANUP_IMMQ_LOADS(2)

pmaddwd mm1,mm7

pand mm2,mm6

.L1:

movq mm4,[esi+24]

pand mm0,mm6

movq mm5,[esi+16]

por mm3,mm2

psrld mm3,6

por mm1,mm0

movq mm0,mm4

psrld mm1,6

packssdw mm1,mm3

movq mm3,mm5

pmaddwd mm0,mm7

pand mm4,mm6

movq [edi],mm1

pmaddwd mm3,mm7

add esi,BYTE 32

por mm4,mm0

pand mm5,mm6

psrld mm4,6

movq mm2,[esi+8]

por mm5,mm3

movq mm0,[esi]

psrld mm5,6

movq mm3,mm2

movq mm1,mm0

packssdw mm5,mm4

pand mm2,mm6

CLEANUP_IMMQ_LOADS(4)

movq [edi+8],mm5

pmaddwd mm3,mm7

pmaddwd mm1,mm7

add edi,BYTE 16

sub ecx,BYTE 8

jz .L2

jmp .L1

.L2:

mov ecx,edx

and ecx,BYTE 7

jz .L4

.L3:

mov ebx,[esi]

add esi,BYTE 4

mov eax,ebx

mov edx,ebx

shr eax,3

shr edx,6

and eax,BYTE 0000000000011111b

and edx, 0000001111100000b

shr ebx,9

or eax,edx

and ebx, 0111110000000000b

or eax,ebx

mov [edi],ax

add edi,BYTE 2

dec ecx

jnz .L3

.L4:

jmp _mmxreturn

%ifidn __OUTPUT_FORMAT__,elf

section .note.GNU-stack noalloc noexec nowrite progbits

%endif