Using ps instruction.
This commit is contained in:
traz
parent
b29d327d14
commit
2e8cdd1542
|
|
@ -0,0 +1,632 @@
|
|||
#define REALNAME ASMNAME
|
||||
#define ASSEMBLER
|
||||
#include "common.h"
|
||||
|
||||
#define gsLQC1(base,fq,ft,offset) .word(0x32<<26|base<<21|ft<<16|0x1<<15|offset<<6|0x1<<5|fq)
|
||||
#define gsSQC1(base,fq,ft,offset) .word(0x3A<<26|base<<21|ft<<16|0x1<<15|offset<<6|0x1<<5|fq)
|
||||
|
||||
|
||||
#define FETCH ld
|
||||
#define STACKSIZE 192
|
||||
|
||||
##### Parameter registers ####
|
||||
|
||||
#define M $4
|
||||
#define N $5
|
||||
#define K $6
|
||||
#define A $8
|
||||
#define B $9
|
||||
#define C $10
|
||||
#define LDC $11
|
||||
|
||||
#### Pointer A, B, C ####
|
||||
#define AO $12
|
||||
#define BO $13
|
||||
|
||||
#define CO1 $14
|
||||
#define CO2 $15
|
||||
#define CO3 $16
|
||||
#define CO4 $17
|
||||
|
||||
#define PREA $18
|
||||
#define PREB $19
|
||||
|
||||
#### Used registers ####
|
||||
#define A1 $f0
|
||||
#define A2 $f1
|
||||
#define A3 $f2
|
||||
#define A4 $f3
|
||||
#define A5 $f4
|
||||
#define A6 $f5
|
||||
#define A7 $f6
|
||||
#define A8 $f7
|
||||
|
||||
#define B1 $f8
|
||||
#define B2 $f9
|
||||
#define B3 $f10
|
||||
#define B4 $f11
|
||||
#define B5 $f12
|
||||
#define B6 $f13
|
||||
#define B7 $f14
|
||||
#define B8 $f15
|
||||
|
||||
#define C11 $f16
|
||||
#define C12 $f17
|
||||
#define C21 $f18
|
||||
#define C22 $f19
|
||||
#define C31 $f20
|
||||
#define C32 $f21
|
||||
#define C41 $f22
|
||||
#define C42 $f23
|
||||
#define C13 $f24
|
||||
#define C14 $f25
|
||||
#define C23 $f26
|
||||
#define C24 $f27
|
||||
#define C33 $f28
|
||||
#define C34 $f29
|
||||
#define C43 $f30
|
||||
#define C44 $f31
|
||||
|
||||
#define I $2
|
||||
#define J $3
|
||||
#define L $7
|
||||
|
||||
#### Alpha register ####
|
||||
#define ALPHA $f15
|
||||
|
||||
#define F31 31
|
||||
#define F30 30
|
||||
#define F29 29
|
||||
#define F28 28
|
||||
#define F27 27
|
||||
#define F26 26
|
||||
#define F25 25
|
||||
#define F24 24
|
||||
#define F23 23
|
||||
#define F22 22
|
||||
#define F21 21
|
||||
#define F20 20
|
||||
#define F19 19
|
||||
#define F18 18
|
||||
#define F17 17
|
||||
#define F16 16
|
||||
#define F15 15
|
||||
#define F14 14
|
||||
#define F13 13
|
||||
#define F12 12
|
||||
#define F11 11
|
||||
#define F10 10
|
||||
#define F9 9
|
||||
#define F8 8
|
||||
#define F7 7
|
||||
#define F6 6
|
||||
#define F5 5
|
||||
#define F4 4
|
||||
#define F3 3
|
||||
#define F2 2
|
||||
#define F1 1
|
||||
#define F0 0
|
||||
|
||||
#define R12 12
|
||||
#define R13 13
|
||||
|
||||
#define R14 14
|
||||
#define R15 15
|
||||
#define R16 16
|
||||
#define R17 17
|
||||
|
||||
#.text
|
||||
#.align 2
|
||||
# .globl REALNAME
|
||||
# .set nomips16
|
||||
# .ent REALNAME
|
||||
# .type REALNAME, @function
|
||||
#REALNAME:
|
||||
# .frame $fp,STACKSIZE,$31 # vars= 48, regs= 1/0, args= 0, gp= 0
|
||||
# .mask 0x40000000,-8
|
||||
# .fmask 0x00000000,0
|
||||
# .set noreorder
|
||||
# .set nomacro
|
||||
|
||||
|
||||
PROLOGUE
|
||||
|
||||
daddiu $sp,$sp,-STACKSIZE
|
||||
sd $fp,184($sp)
|
||||
move $fp,$sp
|
||||
|
||||
sd $16, 0($fp)
|
||||
sd $17, 8($fp)
|
||||
sd $18, 16($fp)
|
||||
sd $19, 24($fp)
|
||||
sd $20, 32($fp)
|
||||
sd $21, 40($fp)
|
||||
sd $22, 48($fp)
|
||||
|
||||
ST $f24, 56($fp)
|
||||
ST $f25, 64($fp)
|
||||
ST $f26, 72($fp)
|
||||
ST $f27, 80($fp)
|
||||
ST $f28, 88($fp)
|
||||
|
||||
#if defined(TRMMKERNEL)
|
||||
sd $23, 96($fp)
|
||||
sd $24, 104($fp)
|
||||
sd $25, 112($fp)
|
||||
#endif
|
||||
|
||||
#ifndef __64BIT__
|
||||
ST $f20,120($fp)
|
||||
ST $f21,128($fp)
|
||||
ST $f22,136($fp)
|
||||
ST $f23,144($fp)
|
||||
#endif
|
||||
|
||||
.align 4
|
||||
.L4:
|
||||
dsra J, N, 2 # NR=4
|
||||
dsll LDC, LDC, BASE_SHIFT# LDC*SIZE
|
||||
|
||||
ST ALPHA, 152($fp) # Store alpha
|
||||
blez J, .L2
|
||||
NOP
|
||||
|
||||
|
||||
.L48:
|
||||
dsra I, M, 3 # MR=8
|
||||
dsll PREA, K, BASE_SHIFT
|
||||
|
||||
move AO, A # Reset A
|
||||
move CO1, C
|
||||
|
||||
daddu CO2, C, LDC
|
||||
daddu CO3, CO2, LDC
|
||||
|
||||
daddu CO4, CO3, LDC
|
||||
daddu PREA, A, PREA
|
||||
|
||||
blez I, .L44
|
||||
daddu C, CO4, LDC
|
||||
|
||||
.align 4
|
||||
.L488:
|
||||
move BO, B # Reset B
|
||||
dsra L, K, 2 # UnRoll K=8
|
||||
|
||||
MTC $0, C11 # CLEAR REAULTS REGISTERS
|
||||
MOV C12, C11
|
||||
|
||||
dsll PREB, K, BASE_SHIFT
|
||||
MOV C21, C11
|
||||
MOV C22, C11
|
||||
|
||||
MOV C31, C11
|
||||
MOV C32, C11
|
||||
gsLQC1(R13, F9, F8, 0) # B1 B2
|
||||
|
||||
MOV C41, C11
|
||||
MOV C42, C11
|
||||
gsLQC1(R12, F1, F0, 0) # A1 A2
|
||||
|
||||
MOV C13, C11
|
||||
MOV C14, C11
|
||||
gsLQC1(R12, F3, F2, 1) # A3 A4
|
||||
|
||||
MOV C23, C11
|
||||
FETCH $0, 0 * SIZE(CO1)
|
||||
MOV C24, C11
|
||||
FETCH $0, 4 * SIZE(CO1)
|
||||
|
||||
MOV C33, C11
|
||||
FETCH $0, 0 * SIZE(CO2)
|
||||
MOV C34, C11
|
||||
FETCH $0, 4 * SIZE(CO2)
|
||||
|
||||
daddu PREB, B, PREB
|
||||
MOV C43, C11
|
||||
FETCH $0, 0 * SIZE(CO3)
|
||||
|
||||
MOV C44, C11
|
||||
FETCH $0, 4 * SIZE(CO3)
|
||||
|
||||
PLU B3, B1, B1
|
||||
FETCH $0, 0 * SIZE(CO4)
|
||||
|
||||
PLU B4, B2, B2
|
||||
blez L, .L484
|
||||
FETCH $0, 0 * SIZE(CO4)
|
||||
|
||||
.L4880:
|
||||
daddiu L, L, -1
|
||||
MADPS C11, C11, A1, B1
|
||||
MADPS C21, C21, A2, B1
|
||||
gsLQC1(R13, F13, F12, 1) # B3 B4
|
||||
|
||||
MADPS C12, C12, A1, B2
|
||||
MADPS C22, C22, A2, B2
|
||||
gsLQC1(R12, F5, F4, 2) # A5 A6
|
||||
|
||||
MADPS C31, C31, A3, B1
|
||||
MADPS C41, C41, A4, B1
|
||||
gsLQC1(R12, F7, F6, 3) # A7 A8
|
||||
|
||||
MADPS C32, C32, A3, B2
|
||||
MADPS C42, C42, A4, B2
|
||||
|
||||
MADPS C13, C13, A1, B3
|
||||
MADPS C23, C23, A2, B3
|
||||
|
||||
FETCH $0, 0 * SIZE(PREA)
|
||||
MADPS C33, C33, A3, B3
|
||||
MADPS C43, C43, A4, B3
|
||||
|
||||
FETCH $0, 0 * SIZE(PREB)
|
||||
MADPS C14, C14, A1, B4
|
||||
PLU B7, B5, B5
|
||||
|
||||
FETCH $0, 4 * SIZE(PREA)
|
||||
MADPS C24, C24, A2, B4
|
||||
PLU B8, B6, B6
|
||||
|
||||
MADPS C34, C34, A3, B4
|
||||
MADPS C44, C44, A4, B4
|
||||
|
||||
MADPS C11, C11, A5, B5
|
||||
MADPS C21, C21, A6, B5
|
||||
gsLQC1(R13, F9, F8, 2) # B1 B2
|
||||
|
||||
MADPS C12, C12, A5, B6
|
||||
MADPS C22, C22, A6, B6
|
||||
gsLQC1(R12, F1, F0, 4) # A1 A2
|
||||
|
||||
MADPS C31, C31, A7, B5
|
||||
MADPS C41, C41, A8, B5
|
||||
gsLQC1(R12, F3, F2, 5) # A3 A4
|
||||
|
||||
MADPS C32, C32, A7, B6
|
||||
MADPS C42, C42, A8, B6
|
||||
|
||||
FETCH $0, 4 * SIZE(PREB)
|
||||
MADPS C13, C13, A5, B7
|
||||
MADPS C23, C23, A6, B7
|
||||
|
||||
FETCH $0, 8 * SIZE(PREA)
|
||||
MADPS C33, C33, A7, B7
|
||||
MADPS C43, C43, A8, B7
|
||||
|
||||
FETCH $0, 12 * SIZE(PREA)
|
||||
MADPS C14, C14, A5, B8
|
||||
PLU B3, B1, B1
|
||||
|
||||
MADPS C24, C24, A6, B8
|
||||
PLU B4, B2, B2
|
||||
|
||||
MADPS C34, C34, A7, B8
|
||||
MADPS C44, C44, A8, B8
|
||||
|
||||
MADPS C11, C11, A1, B1
|
||||
MADPS C21, C21, A2, B1
|
||||
gsLQC1(R13, F13, F12, 3) # B3 B4
|
||||
|
||||
MADPS C12, C12, A1, B2
|
||||
MADPS C22, C22, A2, B2
|
||||
gsLQC1(R12, F5, F4, 6) # A5 A6
|
||||
|
||||
MADPS C31, C31, A3, B1
|
||||
MADPS C41, C41, A4, B1
|
||||
gsLQC1(R12, F7, F6, 7) # A7 A8
|
||||
|
||||
FETCH $0, 16 * SIZE(PREA)
|
||||
MADPS C32, C32, A3, B2
|
||||
MADPS C42, C42, A4, B2
|
||||
|
||||
MADPS C13, C13, A1, B3
|
||||
daddiu BO, BO, 16 * SIZE # 4KR*4NR
|
||||
MADPS C23, C23, A2, B3
|
||||
daddiu AO, AO, 32 * SIZE # 4KR*8MR
|
||||
|
||||
FETCH $0, 20 * SIZE(PREA)
|
||||
MADPS C33, C33, A3, B3
|
||||
MADPS C43, C43, A4, B3
|
||||
|
||||
FETCH $0, 8 * SIZE(PREB)
|
||||
MADPS C14, C14, A1, B4
|
||||
PLU B7, B5, B5
|
||||
|
||||
MADPS C24, C24, A2, B4
|
||||
PLU B8, B6, B6
|
||||
|
||||
MADPS C34, C34, A3, B4
|
||||
MADPS C44, C44, A4, B4
|
||||
|
||||
MADPS C11, C11, A5, B5
|
||||
MADPS C21, C21, A6, B5
|
||||
gsLQC1(R13, F9, F8, 0) # B1 B2
|
||||
|
||||
MADPS C12, C12, A5, B6
|
||||
MADPS C22, C22, A6, B6
|
||||
gsLQC1(R12, F1, F0, 0) # A1 A2
|
||||
|
||||
MADPS C31, C31, A7, B5
|
||||
MADPS C41, C41, A8, B5
|
||||
gsLQC1(R12, F3, F2, 1) # A3 A4
|
||||
|
||||
MADPS C32, C32, A7, B6
|
||||
MADPS C42, C42, A8, B6
|
||||
|
||||
FETCH $0, 12 * SIZE(PREB)
|
||||
MADPS C13, C13, A5, B7
|
||||
MADPS C23, C23, A6, B7
|
||||
|
||||
FETCH $0, 24 * SIZE(PREA)
|
||||
MADPS C33, C33, A7, B7
|
||||
MADPS C43, C43, A8, B7
|
||||
|
||||
FETCH $0, 28 * SIZE(PREA)
|
||||
MADPS C14, C14, A5, B8
|
||||
PLU B3, B1, B1
|
||||
daddiu PREB, PREB, 16 * SIZE
|
||||
|
||||
MADPS C24, C24, A6, B8
|
||||
PLU B4, B2, B2
|
||||
daddiu PREA, PREA, 32 * SIZE
|
||||
|
||||
MADPS C34, C34, A7, B8
|
||||
bgtz L, .L4880
|
||||
MADPS C44, C44, A8, B8
|
||||
|
||||
.align 4
|
||||
.L484:
|
||||
andi L, K, 4
|
||||
blez L, .L482
|
||||
NOP
|
||||
|
||||
.align 4
|
||||
.L482:
|
||||
andi L, K, 2
|
||||
blez L, .L481
|
||||
NOP
|
||||
|
||||
.align 4
|
||||
.L481:
|
||||
andi L, K, 1
|
||||
blez L, .L480
|
||||
NOP
|
||||
|
||||
.align 4
|
||||
.L480: # Write Back
|
||||
daddiu I, I, -1
|
||||
CVTU A1, C13 # A1=C13.upper=c12
|
||||
CVTU A2, C11 # A2=C11.upper=c22
|
||||
|
||||
CVTU A3, C23 # A3=C23.upper=c14
|
||||
LD B1, 1 * SIZE(CO1)
|
||||
|
||||
CVTU A4, C21 # A4=C21.upper=c24
|
||||
LD B2, 1 * SIZE(CO2)
|
||||
|
||||
CVTU A5, C33 # A5=C33.upper=c16
|
||||
LD B3, 3 * SIZE(CO1)
|
||||
|
||||
CVTU A6, C31 # A6=C31.upper=c26
|
||||
LD B4, 3 * SIZE(CO2)
|
||||
|
||||
CVTU A7, C43 # A7=C43.upper=c18
|
||||
LD B5, 5 * SIZE(CO1)
|
||||
|
||||
CVTU A8, C41 # A8=C41.upper=c28
|
||||
LD B6, 5 * SIZE(CO2)
|
||||
|
||||
MADD A1, B1, A1, ALPHA # c12
|
||||
LD B7, 7 * SIZE(CO1)
|
||||
|
||||
MADD A2, B2, A2, ALPHA # c22
|
||||
LD B1, 7 * SIZE(CO2)
|
||||
|
||||
MADD A3, B3, A3, ALPHA # c14
|
||||
LD B2, 0 * SIZE(CO1)
|
||||
|
||||
MADD A4, B4, A4, ALPHA # c24
|
||||
LD B3, 0 * SIZE(CO2)
|
||||
|
||||
MADD A5, B5, A5, ALPHA # c16
|
||||
LD B4, 2 * SIZE(CO1)
|
||||
|
||||
MADD A6, B6, A6, ALPHA # c26
|
||||
LD B5, 2 * SIZE(CO2)
|
||||
|
||||
MADD A7, B7, A7, ALPHA # c18
|
||||
LD B6, 4 * SIZE(CO1)
|
||||
ST A1, 1 * SIZE(CO1)
|
||||
|
||||
MADD A8, B1, A8, ALPHA # c28
|
||||
LD B7, 4 * SIZE(CO2)
|
||||
ST A2, 1 * SIZE(CO2)
|
||||
|
||||
MADD C11, B2, C11, ALPHA # c12
|
||||
LD A1, 6 * SIZE(CO1)
|
||||
ST A3, 3 * SIZE(CO1)
|
||||
|
||||
MADD C13, B3, C13, ALPHA # c22
|
||||
LD A2, 6 * SIZE(CO2)
|
||||
ST A4, 3 * SIZE(CO2)
|
||||
|
||||
MADD C21, B4, C21, ALPHA # c14
|
||||
ST A5, 5 * SIZE(CO1)
|
||||
|
||||
MADD C23, B5, C23, ALPHA # c24
|
||||
ST A6, 5 * SIZE(CO2)
|
||||
|
||||
MADD C31, B6, C31, ALPHA # c16
|
||||
ST A7, 7 * SIZE(CO1)
|
||||
|
||||
MADD C33, B7, C33, ALPHA # c26
|
||||
ST A8, 7 * SIZE(CO2)
|
||||
|
||||
MADD C41, A1, C41, ALPHA # c18
|
||||
ST C11, 0 * SIZE(CO1)
|
||||
|
||||
MADD C43, A2, C43, ALPHA # c28
|
||||
ST C13, 0 * SIZE(CO2)
|
||||
|
||||
ST C21, 2 * SIZE(CO1)
|
||||
ST C23, 2 * SIZE(CO2)
|
||||
ST C31, 4 * SIZE(CO1)
|
||||
ST C33, 4 * SIZE(CO2)
|
||||
ST C41, 6 * SIZE(CO1)
|
||||
|
||||
CVTU A1, C14 # B1=C12.upper=c42
|
||||
ST C43, 6 * SIZE(CO2)
|
||||
|
||||
CVTU A2, C12 # B2=C14.upper=c32
|
||||
LD B1, 1 * SIZE(CO3)
|
||||
|
||||
CVTU A3, C24 # B3=C22.upper=c44
|
||||
LD B2, 1 * SIZE(CO4)
|
||||
|
||||
CVTU A4, C22 # B4=C24.upper=c34
|
||||
LD B3, 3 * SIZE(CO3)
|
||||
|
||||
CVTU A5, C34 # B5=C32.upper=c46
|
||||
LD B4, 3 * SIZE(CO4)
|
||||
|
||||
CVTU A6, C32 # B6=C24.upper=c36
|
||||
LD B5, 5 * SIZE(CO3)
|
||||
|
||||
CVTU A7, C44 # B7=C42.upper=c48
|
||||
LD B6, 5 * SIZE(CO4)
|
||||
|
||||
CVTU A8, C42 # A1=C44.upper=c38
|
||||
LD B7, 7 * SIZE(CO3)
|
||||
|
||||
MADD A1, B1, A1, ALPHA # c31
|
||||
LD C11, 7 * SIZE(CO4)
|
||||
|
||||
MADD A2, B2, A2, ALPHA
|
||||
LD C13, 0 * SIZE(CO3)
|
||||
|
||||
MADD A3, B3, A3, ALPHA
|
||||
LD C21, 0 * SIZE(CO4)
|
||||
|
||||
MADD A4, B4, A4, ALPHA
|
||||
LD C23, 2 * SIZE(CO3)
|
||||
|
||||
MADD A5, B5, A5, ALPHA
|
||||
LD C31, 2 * SIZE(CO4)
|
||||
|
||||
MADD A6, B6, A6, ALPHA
|
||||
LD C33, 4 * SIZE(CO3)
|
||||
|
||||
MADD A7, B7, A7, ALPHA
|
||||
LD C41, 4 * SIZE(CO4)
|
||||
ST A1, 1 * SIZE(CO3)
|
||||
|
||||
MADD A8, C11, A8, ALPHA
|
||||
LD C43, 6 * SIZE(CO3)
|
||||
ST A2, 1 * SIZE(CO4)
|
||||
|
||||
MADD C12, C13, C12, ALPHA
|
||||
LD B1, 6 * SIZE(CO4)
|
||||
ST A3, 3 * SIZE(CO3)
|
||||
|
||||
MADD C14, C21, C14, ALPHA
|
||||
ST A4, 3 * SIZE(CO4)
|
||||
|
||||
MADD C22, C23, C22, ALPHA
|
||||
ST A5, 5 * SIZE(CO3)
|
||||
|
||||
MADD C24, C31, C24, ALPHA
|
||||
ST A6, 5 * SIZE(CO4)
|
||||
|
||||
MADD C32, C33, C32, ALPHA
|
||||
ST A7, 7 * SIZE(CO3)
|
||||
|
||||
MADD C34, C41, C34, ALPHA
|
||||
ST A8, 7 * SIZE(CO4)
|
||||
|
||||
MADD C42, C43, C42, ALPHA
|
||||
ST C12, 0 * SIZE(CO3)
|
||||
|
||||
MADD C44, B1, C44, ALPHA
|
||||
ST C14, 0 * SIZE(CO4)
|
||||
|
||||
ST C22, 2 * SIZE(CO3)
|
||||
daddiu CO1, CO1, 8 * SIZE
|
||||
|
||||
ST C24, 2 * SIZE(CO4)
|
||||
daddiu CO2, CO2, 8 * SIZE
|
||||
|
||||
ST C32, 4 * SIZE(CO3)
|
||||
ST C34, 4 * SIZE(CO4)
|
||||
ST C42, 6 * SIZE(CO3)
|
||||
ST C44, 6 * SIZE(CO4)
|
||||
|
||||
daddiu CO3, CO3, 8 * SIZE
|
||||
bgtz I, .L488
|
||||
daddiu CO4, CO4, 8 * SIZE
|
||||
|
||||
.L44:
|
||||
|
||||
.L40:
|
||||
daddiu J, J, -1
|
||||
move B, BO
|
||||
|
||||
bgtz J, .L48
|
||||
NOP
|
||||
|
||||
.align 4
|
||||
.L2: # Nr=2
|
||||
andi J, N, 2
|
||||
blez J, .L1
|
||||
NOP
|
||||
|
||||
|
||||
|
||||
.align 4
|
||||
.L1:
|
||||
andi J, N, 1
|
||||
blez J, .L999
|
||||
NOP
|
||||
|
||||
|
||||
|
||||
.L999:
|
||||
ld $16, 0($fp)
|
||||
ld $17, 8($fp)
|
||||
ld $18, 16($fp)
|
||||
ld $19, 24($fp)
|
||||
ld $20, 32($fp)
|
||||
ld $21, 40($fp)
|
||||
ld $22, 48($fp)
|
||||
|
||||
LD $f24, 56($fp)
|
||||
LD $f25, 64($fp)
|
||||
LD $f26, 72($fp)
|
||||
LD $f27, 80($fp)
|
||||
LD $f28, 88($fp)
|
||||
|
||||
#if defined(TRMMKERNEL)
|
||||
ld $23, 96($fp)
|
||||
ld $24, 104($fp)
|
||||
ld $25, 112($fp)
|
||||
#endif
|
||||
|
||||
#ifndef __64BIT__
|
||||
LD $f20,120($fp)
|
||||
LD $f21,128($fp)
|
||||
LD $f22,136($fp)
|
||||
LD $f23,144($fp)
|
||||
#endif
|
||||
|
||||
move $sp,$fp
|
||||
ld $fp,184($sp)
|
||||
daddiu $sp,$sp,STACKSIZE
|
||||
j $31
|
||||
nop
|
||||
|
||||
EPILOGUE
|
||||
# .set macro
|
||||
# .set reorder
|
||||
# .end REALNAME
|
||||
# .size REALNAME, .-REALNAME
|
||||
#.ident "GCC: (Debian 4.4.6-6) 4.4.6"
|
||||
Loading…
Reference in New Issue