; PowerPC optimized zoom for Goom
; © 2001-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 :
; 21 Dec 2003 : Use of altivec is now determined with a parameter
; Section definition : We use a read only section
.text
; name of the function to call by C program : ppc_zoom
; We declare this label as a global to extend its scope outside this file
.globl _ppc_zoom_generic
.globl _ppc_zoom_G4
; Description :
; This routine dynamically computes and applies a zoom filter
; parameters :
; r3 <=> unsigned int sizeX (in pixels)
; r4 <=> unsigned int sizeY (in pixels)
; r5 <=> unsigned int * frompixmap
; r6 <=> unsigned int * topixmap
; r7 <=> unsigned int * brutS
; r8 <=> unsigned int * brutD
; r9 <=> unsigned int buffratio
; r10 <=> int [16][16] precalccoeffs
; globals after init
; r5 <=> frompixmap - 1 byte needed for preincremental fetch (replaces r5)
; r6 <=> topixmap - 1 byte needed for preincremental fetch (replaces r6)
; r3 <=> ax = x max in 16th of pixels (replaces old r3)
; r4 <=> ay = y max in 16th of pixels (replaces old r4)
; r20 <=> row size in bytes
; r12 <=> 0xFF00FF (mask for parallel 32 bits pixs computing)
; r30 <=> brutS - 1 byte needed for preincremental fetch (replaces r7)
; r31 <=> brutD - 1 byte needed for preincremental fetch (replaces r8)
; ABI notes :
; r1 is the Stack Pointer (SP) => Do not use
; r13..r31 are non-volatiles => Do not use
_ppc_zoom_generic:
; Saves the used non volatile registers in the Mach-O stack s Red-Zone
stmw r18,-56(r1)
; init
li r18,0 ; Default value if out of range : 0 (Black)
mr r11,r10
lis r12,0xFF
mullw r2,r3,r4 ; Number of pixels to compute
subi r30,r8,0
slwi r20,r3,2
srawi r19,r20,2
ori r12,r12,0xFF
subi r3,r3,1
subi r4,r4,1
mtspr ctr,r2 ; Init the loop count (one loop per pixel computed)
subi r31,r7,0
subi r6,r6,4
slwi r3,r3,4
slwi r4,r4,4
;pre init for loop
lwz r2,0(r31) ; px
lwz r29,4(r31) ; py
lwz r8,0(r30) ; px2
lwz r10,4(r30) ; py2
b L1
.align 5
L1:
; computes dynamically the position to fetch
sub r8,r8,r2
sub r10,r10,r29
mullw r8,r8,r9
addi r31,r31,8
mullw r10,r10,r9
addi r30,r30,8
srawi r8,r8,16
srawi r10,r10,16
add r2,r2,r8
add r29,r29,r10
; if px>ax or py>ay goto outofrange
; computes the attenuation coeffs and the original point address
rlwinm r10,r2,6,28-6,31-6 ; r10 <- (r2 << 2) & 0x000002D0 (r10=(r2%16)*4*16)
cmpl cr4,0,r2,r3
rlwimi r10, r29, 2, 28-2, 31-2 ; r10 <- ((r29 << 2) & 0x0000002D) | (r10 & !0x0000002D) (r10=(r10%16)*4 | r10)
cmpl cr7,0,r29,r4
srawi r29,r29,4 ; pos computing
bge- cr4,L4
srawi r2,r2,4 ; pos computing
mullw r29, r29,r19 ; pos computing
bge- cr7,L4
; Channels notation : 00112233 (AARRVVBB)
add r2,r2,r29 ; pos computing
lwzx r10,r11,r10 ; Loads coefs
slwi r2,r2,2 ; pos computing
add r2,r2,r5 ; pos computing
rlwinm r21,r10,0,24,31 ; Isolates coef1 (??????11 -> 00000011)
lwz r25,0(r2) ; Loads col1 -> r25
lwz r26,4(r2) ; Loads col2 -> r26
rlwinm r22,r10,24,24,31 ; Isolates coef2 (????22?? -> 00000022)
rlwinm r23,r10,16,24,31 ; Isolates coef3 (??33???? -> 00000033)
add r2,r2,r20 ; Adds one line for future load of col3 and col4
and r8, r25,r12 ; Masks col1 channels 1 & 3 : 0x00XX00XX
rlwinm r24,r10,8,24,31 ; Isolates coef4 (44?????? -> 00000044)
andi. r25,r25,0xFF00 ; Masks col1 channel 2 : 0x0000XX00
mullw r8, r8, r21 ; Applies coef1 on col1 channels 1 & 3
; computes final pixel color
and r10,r26,r12 ; Masks col2 channels 1 & 3 : 0x00XX00XX
lwz r27,0(r2) ; Loads col3 -> r27
mullw r10,r10,r22 ; Applies coef2 on col2 channels 1 & 3
mullw r25,r25,r21 ; Applies coef1 on col1 channel 2
andi. r29,r26,0xFF00 ; Masks col2 channel 2 : 0x0000XX00
mullw r29,r29,r22 ; Applies coef2 on col2 channel 2
lwz r28,4(r2) ; Loads col4 -> r28
add r8 ,r8 ,r10 ; Adds col1 & col2 channels 1 & 3
and r10,r27,r12 ; Masks col3 channels 1 & 3 : 0x00XX00XX
add r25,r25,r29 ; Adds col1 & col2 channel 2
mullw r10,r10,r23 ; Applies coef3 on col3 channels 1 & 3
andi. r29,r27,0xFF00 ; Masks col3 channel 2 : 0x0000XX00
mullw r29,r29,r23 ; Applies coef3 on col3 channel 2
lwz r2,0(r31) ; px
add r7 ,r8 ,r10 ; Adds col3 to (col1 + col2) channels 1 & 3
and r10,r28,r12 ; Masks col4 channels 1 & 3 : 0x00XX00XX
mullw r10,r10,r24 ; Applies coef4 on col4 channels 1 & 3
add r25,r25,r29 ; Adds col 3 to (col1 + col2) channel 2
lwz r8,0(r30) ; px2
andi. r28,r28,0xFF00 ; Masks col4 channel 2 : 0x0000XX00
add r7 ,r7 ,r10 ; Adds col4 to (col1 + col2 + col3) channels 1 & 3
lwz r10,4(r30) ; py2
mullw r28,r28,r24 ; Applies coef4 on col4 channel 2
srawi r7, r7, 8 ; (sum of channels 1 & 3) >> 8
lwz r29,4(r31) ; py
add r25,r25,r28 ; Adds col 4 to (col1 + col2 + col3) channel 2
rlwimi r7, r25, 24, 16, 23 ; (((sum of channels 2) >> 8 ) & 0x0000FF00) | ((sum of channels 1 and 3) & 0xFFFF00FF)
stwu r7,4(r6) ; Stores the computed pixel
bdnz L1 ; Iterate again if needed
b L3 ;goto end ; If not, returns from the function
; if out of range
L4:
stwu r18,4(r6)
lwz r8,0(r30) ; px2
lwz r10,4(r30) ; py2
lwz r2,0(r31) ; px
lwz r29,4(r31) ; py
bdnz L1
L3:
; Restore saved registers and return
lmw r18,-56(r1)
blr
_ppc_zoom_G4:
; Saves the used non volatile registers in the Mach-O stack s Red-Zone
stmw r17,-60(r1)
; init
li r18,0 ; Default value if out of range : 0 (Black)
mr r11,r10
lis r12,0xFF
mullw r2,r3,r4 ; Number of pixels to compute
subi r30,r8,0
slwi r20,r3,2
srawi r19,r20,2
ori r12,r12,0xFF
subi r3,r3,1
subi r4,r4,1
mtspr ctr,r2 ; Init the loop count (one loop per pixel computed)
subi r31,r7,0
subi r6,r6,4
slwi r3,r3,4
slwi r4,r4,4
;pre init for loop
lwz r2,0(r31) ; px
lwz r29,4(r31) ; py
lwz r8,0(r30) ; px2
lwz r10,4(r30) ; py2
;*********************
lis r17,0x0F01
b L100
.align 5
L100:
addi r6,r6,4
; Optimization to ensure the destination buffer
; won't be loaded into the data cache
rlwinm. r0,r6,0,27,31
bne+ L500
dcbz 0,r6
;dcba 0,r6
L500:
; computes dynamically the position to fetch
;mullw r8,r8,r29
;mullw r2,r2,r29
;add r2,r8,r2
;srawi r2,r2,17
sub r8,r8,r2
sub r10,r10,r29
mullw r8,r8,r9
addi r31,r31,8
mullw r10,r10,r9
addi r30,r30,8
dst r30,r17,0
srawi r8,r8,16
srawi r10,r10,16
add r2,r2,r8
add r29,r29,r10
dst r31,r17,1
; if px>ax or py>ay goto outofrange
; computes the attenuation coeffs and the original point address
rlwinm r10,r2,6,28-6,31-6 ; r10 <- (r2 << 2) & 0x000002D0 (r10=(r2%16)*4*16)
cmpl cr4,0,r2,r3
rlwimi r10, r29, 2, 28-2, 31-2 ; r10 <- ((r29 << 2) & 0x0000002D) | (r10 & !0x0000002D) (r10=(r29%16)*4 | r10)
cmpl cr7,0,r29,r4
srawi r29,r29,4 ; pos computing
bge- cr4,L400
srawi r2,r2,4 ; pos computing
mullw r29, r29,r19 ; pos computing
bge- cr7,L400
; Channels notation : 00112233 (AARRVVBB)
add r2,r2,r29 ; pos computing
lwzx r10,r11,r10 ; Loads coefs
slwi r2,r2,2 ; pos computing
add r2,r2,r5 ; pos computing
rlwinm r21,r10,0,24,31 ; Isolates coef1 (??????11 -> 00000011)
lwz r25,0(r2) ; Loads col1 -> r25
lwz r26,4(r2) ; Loads col2 -> r26
rlwinm r22,r10,24,24,31 ; Isolates coef2 (????22?? -> 00000022)
rlwinm r23,r10,16,24,31 ; Isolates coef3 (??33???? -> 00000033)
add r2,r2,r20 ; Adds one line for future load of col3 and col4
and r8, r25,r12 ; Masks col1 channels 1 & 3 : 0x00XX00XX
rlwinm r24,r10,8,24,31 ; Isolates coef4 (44?????? -> 00000044)
dst r2,r17,2
rlwinm r25,r25,0,16,23 ; Masks col1 channel 2 : 0x0000XX00
;andi. r25,r25,0xFF00 ; Masks col1 channel 2 : 0x0000XX00
mullw r8, r8, r21 ; Applies coef1 on col1 channels 1 & 3
; computes final pixel color
and r10,r26,r12 ; Masks col2 channels 1 & 3 : 0x00XX00XX
lwz r27,0(r2) ; Loads col3 -> r27
mullw r10,r10,r22 ; Applies coef2 on col2 channels 1 & 3
mullw r25,r25,r21 ; Applies coef1 on col1 channel 2
rlwinm r29,r26,0,16,23 ; Masks col2 channel 2 : 0x0000XX00
;andi. r29,r26,0xFF00 ; Masks col2 channel 2 : 0x0000XX00
mullw r29,r29,r22 ; Applies coef2 on col2 channel 2
lwz r28,4(r2) ; Loads col4 -> r28
add r8 ,r8 ,r10 ; Adds col1 & col2 channels 1 & 3
and r10,r27,r12 ; Masks col3 channels 1 & 3 : 0x00XX00XX
add r25,r25,r29 ; Adds col1 & col2 channel 2
mullw r10,r10,r23 ; Applies coef3 on col3 channels 1 & 3
rlwinm r29,r27,0,16,23 ; Masks col3 channel 2 : 0x0000XX00
;andi. r29,r27,0xFF00 ; Masks col3 channel 2 : 0x0000XX00
mullw r29,r29,r23 ; Applies coef3 on col3 channel 2
lwz r2,0(r31) ; px
add r7 ,r8 ,r10 ; Adds col3 to (col1 + col2) channels 1 & 3
and r10,r28,r12 ; Masks col4 channels 1 & 3 : 0x00XX00XX
mullw r10,r10,r24 ; Applies coef4 on col4 channels 1 & 3
add r25,r25,r29 ; Adds col 3 to (col1 + col2) channel 2
lwz r8,0(r30) ; px2
rlwinm r28,r28,0,16,23 ; Masks col4 channel 2 : 0x0000XX00
;andi. r28,r28,0xFF00 ; Masks col4 channel 2 : 0x0000XX00
add r7 ,r7 ,r10 ; Adds col4 to (col1 + col2 + col3) channels 1 & 3
lwz r10,4(r30) ; py2
mullw r28,r28,r24 ; Applies coef4 on col4 channel 2
srawi r7, r7, 8 ; (sum of channels 1 & 3) >> 8
lwz r29,4(r31) ; py
add r25,r25,r28 ; Adds col 4 to (col1 + col2 + col3) channel 2
rlwimi r7, r25, 24, 16, 23 ; (((sum of channels 2) >> 8 ) & 0x0000FF00) | ((sum of channels 1 and 3) & 0xFFFF00FF)
stw r7,0(r6) ; Stores the computed pixel
bdnz L100 ; Iterate again if needed
b L300 ;goto end ; If not, returns from the function
; if out of range
L400:
stw r18,0(r6)
lwz r8,0(r30) ; px2
lwz r10,4(r30) ; py2
lwz r2,0(r31) ; px
lwz r29,4(r31) ; py
bdnz L100
L300:
; Restore saved registers and return
lmw r17,-60(r1)
blr