; PowerPC optimized drawing methods for Goom
; © 2003 Guillaume Borios
; This library is free software; you can redistribute it and/or
; modify it under the terms of the GNU Library General Public
; License as published by the Free Software Foundation; either
; version 2 of the License, or (at your option) any later version.
;
; 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
; Library General Public License for more details.
;
; You should have received a copy of the GNU Library 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.
; Change log :
; 30 May 2003 : File creation
; Section definition : We use a read only code section for the whole file
.section __TEXT,__text,regular,pure_instructions
; --------------------------------------------------------------------------------------
; Single 32b pixel drawing macros
; Usage :
; DRAWMETHOD_XXXX_MACRO *pixelIN, *pixelOUT, COLOR, WR1, WR2, WR3, WR4
; Only the work registers (WR) can be touched by the macros
;
; Available methods :
; DRAWMETHOD_DFLT_MACRO : Default drawing method (Actually OVRW)
; DRAWMETHOD_PLUS_MACRO : RVB Saturated per channel addition (SLOWEST)
; DRAWMETHOD_HALF_MACRO : 50% Transparency color drawing
; DRAWMETHOD_OVRW_MACRO : Direct COLOR drawing (FASTEST)
; DRAWMETHOD_B_OR_MACRO : Bitwise OR
; DRAWMETHOD_BAND_MACRO : Bitwise AND
; DRAWMETHOD_BXOR_MACRO : Bitwise XOR
; DRAWMETHOD_BNOT_MACRO : Bitwise NOT
; --------------------------------------------------------------------------------------
.macro DRAWMETHOD_OVRW_MACRO
stw $2,0($1) ;; *$1 <- $2
.endmacro
.macro DRAWMETHOD_B_OR_MACRO
lwz $3,0($0) ;; $3 <- *$0
or $3,$3,$2 ;; $3 <- $3 | $2
stw $3,0($1) ;; *$1 <- $3
.endmacro
.macro DRAWMETHOD_BAND_MACRO
lwz $3,0($0) ;; $3 <- *$0
and $3,$3,$2 ;; $3 <- $3 & $2
stw $3,0($1) ;; *$1 <- $3
.endmacro
.macro DRAWMETHOD_BXOR_MACRO
lwz $3,0($0) ;; $3 <- *$0
xor $3,$3,$2 ;; $3 <- $3 ^ $2
stw $3,0($1) ;; *$1 <- $3
.endmacro
.macro DRAWMETHOD_BNOT_MACRO
lwz $3,0($0) ;; $3 <- *$0
nand $3,$3,$3 ;; $3 <- ~$3
stw $3,0($1) ;; *$1 <- $3
.endmacro
.macro DRAWMETHOD_PLUS_MACRO
lwz $4,0($0) ;; $4 <- *$0
andi. $3,$4,0xFF00 ;; $3 <- $4 & 0x0000FF00
andi. $5,$2,0xFF00 ;; $5 <- $2 & 0x0000FF00
add $3,$3,$5 ;; $3 <- $3 + $5
rlwinm $5,$3,15,0,0 ;; $5 <- 0 | ($3[15] << 15)
srawi $5,$5,23 ;; $5 <- $5 >> 23 (algebraic for sign extension)
or $3,$3,$5 ;; $3 <- $3 | $5
lis $5,0xFF ;; $5 <- 0x00FF00FF
addi $5,$5,0xFF
and $4,$4,$5 ;; $4 <- $4 & $5
and $6,$2,$5 ;; $6 <- $2 & $5
add $4,$4,$6 ;; $4 <- $4 + $6
rlwinm $6,$4,7,0,0 ;; $6 <- 0 | ($4[7] << 7)
srawi $6,$6,15 ;; $6 <- $6 >> 15 (algebraic for sign extension)
rlwinm $5,$4,23,0,0 ;; $5 <- 0 | ($4[23] << 23)
srawi $5,$5,31 ;; $5 <- $5 >> 31 (algebraic for sign extension)
rlwimi $6,$5,0,24,31 ;; $6[24..31] <- $5[24..31]
or $4,$4,$6 ;; $4 <- $4 | $6
rlwimi $4,$3,0,16,23 ;; $4[16..23] <- $3[16..23]
stw $4,0($1) ;; *$1 <- $4
.endmacro
.macro DRAWMETHOD_HALF_MACRO
lwz $4,0($0) ;; $4 <- *$0
andi. $3,$4,0xFF00 ;; $3 <- $4 & 0x0000FF00
andi. $5,$2,0xFF00 ;; $5 <- $2 & 0x0000FF00
add $3,$3,$5 ;; $3 <- $3 + $5
lis $5,0xFF ;; $5 <- 0x00FF00FF
addi $5,$5,0xFF
and $4,$4,$5 ;; $4 <- $4 & $5
and $5,$2,$5 ;; $5 <- $2 & $5
add $4,$4,$5 ;; $4 <- $4 + $5
srwi $4,$4,1 ;; $4 <- $4 >> 1
rlwimi $4,$3,31,16,23 ;; $4[16..23] <- $3[15..22]
stw $4,0($1) ;; *$1 <- $4
.endmacro
.macro DRAWMETHOD_DFLT_MACRO
DRAWMETHOD_PLUS_MACRO
.endmacro
; --------------------------------------------------------------------------------------
; **************************************************************************************
; void DRAWMETHOD_PLUS_PPC(unsigned int * buf, unsigned int _col);
; void DRAWMETHOD_PLUS_2_PPC(unsigned * in, unsigned int * out, unsigned int _col);
; **************************************************************************************
.globl _DRAWMETHOD_PLUS_2_PPC
.align 3
_DRAWMETHOD_PLUS_2_PPC:
DRAWMETHOD_PLUS_MACRO r3,r4,r5,r6,r7,r8,r9
blr ;; return
.globl _DRAWMETHOD_PLUS_PPC
.align 3
_DRAWMETHOD_PLUS_PPC:
DRAWMETHOD_PLUS_MACRO r3,r3,r4,r5,r6,r7,r9
blr ;; return
; **************************************************************************************
; void DRAWMETHOD_HALF_PPC(unsigned int * buf, unsigned int _col);
; void DRAWMETHOD_HALF_2_PPC(unsigned * in, unsigned int * out, unsigned int _col);
; **************************************************************************************
.globl _DRAWMETHOD_HALF_2_PPC
.align 3
_DRAWMETHOD_HALF_2_PPC:
DRAWMETHOD_HALF_MACRO r3,r4,r5,r6,r7,r8
blr ;; return
.globl _DRAWMETHOD_HALF_PPC
.align 3
_DRAWMETHOD_HALF_PPC:
DRAWMETHOD_HALF_MACRO r3,r3,r4,r5,r6,r7
blr ;; return
; **************************************************************************************
; void DRAW_LINE_PPC(unsigned int *data, int x1, int y1, int x2, int y2, unsigned int col,
; unsigned int screenx, unsigned int screeny)
; **************************************************************************************
.globl _DRAW_LINE_PPC
.align 3
_DRAW_LINE_PPC:
;; NOT IMPLEMENTED YET
blr ;; return
; **************************************************************************************
; void _ppc_brightness(Pixel * src, Pixel * dest, unsigned int size, unsigned int coeff)
; **************************************************************************************
.const
.align 4
vectorZERO:
.long 0,0,0,0
.long 0x10101000, 0x10101001, 0x10101002, 0x10101003
.long 0x10101004, 0x10101005, 0x10101006, 0x10101007
.long 0x10101008, 0x10101009, 0x1010100A, 0x1010100B
.long 0x1010100C, 0x1010100D, 0x1010100E, 0x1010100F
.section __TEXT,__text,regular,pure_instructions
.globl _ppc_brightness_G4
.align 3
_ppc_brightness_G4:
;; PowerPC Altivec code
srwi r5,r5,2
mtctr r5
;;vrsave
mfspr r11,256
lis r12,0xCFFC
mtspr 256,r12
mflr r0
bcl 20,31,"L00000000001$pb"
"L00000000001$pb":
mflr r10
mtlr r0
addis r9,r10,ha16(vectorZERO-"L00000000001$pb")
addi r9,r9,lo16(vectorZERO-"L00000000001$pb")
vxor v0,v0,v0 ;; V0 = NULL vector
addi r9,r9,16
lvx v10,0,r9
addi r9,r9,16
lvx v11,0,r9
addi r9,r9,16
lvx v12,0,r9
addi r9,r9,16
lvx v13,0,r9
addis r9,r10,ha16(vectortmpwork-"L00000000001$pb")
addi r9,r9,lo16(vectortmpwork-"L00000000001$pb")
stw r6,0(r9)
li r6,8
stw r6,4(r9)
lvx v9,0,r9
li r9,128
vspltw v8,v9,0
vspltw v9,v9,1
;; elt counter
li r9,0
lis r7,0x0F01
b L7
.align 4
L7:
lvx v1,r9,r3
vperm v4,v1,v0,v10
;*********************
add r10,r9,r3
;*********************
vperm v5,v1,v0,v11
vperm v6,v1,v0,v12
vperm v7,v1,v0,v13
vmulouh v4,v4,v8
;*********************
dst r10,r7,3
;*********************
vmulouh v5,v5,v8
vmulouh v6,v6,v8
vmulouh v7,v7,v8
vsrw v4,v4,v9
vsrw v5,v5,v9
vsrw v6,v6,v9
vsrw v7,v7,v9
vpkuwus v4,v4,v5
vpkuwus v6,v6,v7
vpkuhus v1,v4,v6
stvx v1,r9,r4
addi r9,r9,16
bdnz L7
mtspr 256,r11
blr
.globl _ppc_brightness_G5
.align 3
_ppc_brightness_G5:
;; PowerPC Altivec G5 code
srwi r5,r5,2
mtctr r5
;;vrsave
mfspr r11,256
lis r12,0xCFFC
mtspr 256,r12
mflr r0
bcl 20,31,"L00000000002$pb"
"L00000000002$pb":
mflr r10
mtlr r0
addis r9,r10,ha16(vectorZERO-"L00000000002$pb")
addi r9,r9,lo16(vectorZERO-"L00000000002$pb")
vxor v0,v0,v0 ;; V0 = NULL vector
addi r9,r9,16
lvx v10,0,r9
addi r9,r9,16
lvx v11,0,r9
addi r9,r9,16
lvx v12,0,r9
addi r9,r9,16
lvx v13,0,r9
addis r9,r10,ha16(vectortmpwork-"L00000000002$pb")
addi r9,r9,lo16(vectortmpwork-"L00000000002$pb")
stw r6,0(r9)
li r6,8
stw r6,4(r9)
lvx v9,0,r9
li r9,128
vspltw v8,v9,0
vspltw v9,v9,1
;; elt counter
li r9,0
lis r7,0x0F01
b L6
.align 4
L6:
lvx v1,r9,r3
vperm v4,v1,v0,v10
;*********************
add r10,r9,r3
;*********************
vperm v5,v1,v0,v11
vperm v6,v1,v0,v12
vperm v7,v1,v0,v13
vmulouh v4,v4,v8
vmulouh v5,v5,v8
vmulouh v6,v6,v8
vmulouh v7,v7,v8
vsrw v4,v4,v9
vsrw v5,v5,v9
vsrw v6,v6,v9
vsrw v7,v7,v9
vpkuwus v4,v4,v5
vpkuwus v6,v6,v7
vpkuhus v1,v4,v6
stvx v1,r9,r4
addi r9,r9,16
bdnz L6
mtspr 256,r11
blr
.globl _ppc_brightness_generic
.align 3
_ppc_brightness_generic:
lis r12,0x00FF
ori r12,r12,0x00FF
subi r3,r3,4
subi r4,r4,4
mtctr r5
b L1
.align 4
L1:
lwzu r7,4(r3)
rlwinm r8,r7,16,24,31
rlwinm r9,r7,24,24,31
mullw r8,r8,r6
rlwinm r10,r7,0,24,31
mullw r9,r9,r6
srwi r8,r8,8
mullw r10,r10,r6
srwi r9,r9,8
rlwinm. r11,r8,0,0,23
beq L2
li r8,0xFF
L2:
srwi r10,r10,8
rlwinm. r11,r9,0,0,23
beq L3
li r9,0xFF
L3:
rlwinm r7,r8,16,8,15
rlwinm. r11,r10,0,0,23
beq L4
li r10,0xFF
L4:
rlwimi r7,r9,8,16,23
rlwimi r7,r10,0,24,31
stwu r7,4(r4)
bdnz L1
blr
.static_data
.align 4
vectortmpwork:
.long 0,0,0,0