/*********************************************************************/ /* Copyright 2009, 2010 The University of Texas at Austin. */ /* All rights reserved. */ /* */ /* Redistribution and use in source and binary forms, with or */ /* without modification, are permitted provided that the following */ /* conditions are met: */ /* */ /* 1. Redistributions of source code must retain the above */ /* copyright notice, this list of conditions and the following */ /* disclaimer. */ /* */ /* 2. Redistributions in binary form must reproduce the above */ /* copyright notice, this list of conditions and the following */ /* disclaimer in the documentation and/or other materials */ /* provided with the distribution. */ /* */ /* THIS SOFTWARE IS PROVIDED BY THE UNIVERSITY OF TEXAS AT */ /* AUSTIN ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, */ /* INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF */ /* MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE */ /* DISCLAIMED. IN NO EVENT SHALL THE UNIVERSITY OF TEXAS AT */ /* AUSTIN OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, */ /* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES */ /* (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE */ /* GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR */ /* BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF */ /* LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT */ /* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT */ /* OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE */ /* POSSIBILITY OF SUCH DAMAGE. */ /* */ /* The views and conclusions contained in the software and */ /* documentation are those of the authors and should not be */ /* interpreted as representing official policies, either expressed */ /* or implied, of The University of Texas at Austin. */ /*********************************************************************/ #define ASSEMBLER #include "common.h" #define N r3 #define X r4 #define INCX r5 #define INCX2 r6 #define X2 r7 #define C1 f1 #define C2 f0 #define C3 f2 #define C4 f3 #define C5 f4 #define C6 f5 #define C7 f6 #define C8 f7 #define A1 f8 #define A2 f9 #define A3 f10 #define A4 f11 #define A5 f12 #define A6 f13 #define A7 f14 #define A8 f15 #define A9 f16 #define A10 f17 #define A11 f18 #define A12 f19 #define A13 f20 #define A14 f21 #define A15 f22 #define A16 f23 PROLOGUE PROFCODE li r10, -16 stfpdux f14, SP, r10 stfpdux f15, SP, r10 stfpdux f16, SP, r10 stfpdux f17, SP, r10 stfpdux f18, SP, r10 stfpdux f19, SP, r10 stfpdux f20, SP, r10 stfpdux f21, SP, r10 stfpdux f22, SP, r10 stfpdux f23, SP, r10 li r10, 0 stwu r10, -4(SP) stwu r10, -4(SP) stwu r10, -4(SP) stwu r10, -4(SP) #ifdef F_INTERFACE LDINT N, 0(N) LDINT INCX, 0(INCX) #endif lfpdx C1, SP, r10 # Zero clear slwi INCX, INCX, BASE_SHIFT add INCX2, INCX, INCX fpmr C2, C1 fpmr C3, C1 fpmr C4, C1 fpmr C5, C1 fpmr C6, C1 fpmr C7, C1 fpmr C8, C1 cmpwi cr0, N, 0 ble LL(99) cmpwi cr0, INCX, 0 ble LL(99) cmpwi cr0, INCX, SIZE bne LL(100) andi. r0, X, 2 * SIZE - 1 beq LL(05) LFD C1, 0(X) addi X, X, 1 * SIZE addi N, N, -1 cmpwi cr0, N, 0 fmul C1, C1, C1 ble LL(998) .align 4 LL(05): srawi. r0, N, 5 sub X, X, INCX2 mtspr CTR, r0 beq- LL(15) LFPDUX A1, X, INCX2 LFPDUX A2, X, INCX2 LFPDUX A3, X, INCX2 LFPDUX A4, X, INCX2 LFPDUX A5, X, INCX2 LFPDUX A6, X, INCX2 LFPDUX A7, X, INCX2 LFPDUX A8, X, INCX2 LFPDUX A9, X, INCX2 LFPDUX A10, X, INCX2 LFPDUX A11, X, INCX2 LFPDUX A12, X, INCX2 LFPDUX A13, X, INCX2 LFPDUX A14, X, INCX2 LFPDUX A15, X, INCX2 LFPDUX A16, X, INCX2 bdz LL(13) .align 4 LL(12): fpmadd C1, A1, A1, C1 LFPDUX A1, X, INCX2 fpmadd C2, A2, A2, C2 LFPDUX A2, X, INCX2 fpmadd C3, A3, A3, C3 LFPDUX A3, X, INCX2 fpmadd C4, A4, A4, C4 LFPDUX A4, X, INCX2 fpmadd C5, A5, A5, C5 LFPDUX A5, X, INCX2 fpmadd C6, A6, A6, C6 LFPDUX A6, X, INCX2 fpmadd C7, A7, A7, C7 LFPDUX A7, X, INCX2 fpmadd C8, A8, A8, C8 LFPDUX A8, X, INCX2 fpmadd C1, A9, A9, C1 LFPDUX A9, X, INCX2 fpmadd C2, A10, A10, C2 LFPDUX A10, X, INCX2 fpmadd C3, A11, A11, C3 LFPDUX A11, X, INCX2 fpmadd C4, A12, A12, C4 LFPDUX A12, X, INCX2 fpmadd C5, A13, A13, C5 LFPDUX A13, X, INCX2 fpmadd C6, A14, A14, C6 LFPDUX A14, X, INCX2 fpmadd C7, A15, A15, C7 LFPDUX A15, X, INCX2 fpmadd C8, A16, A16, C8 LFPDUX A16, X, INCX2 bdnz LL(12) .align 4 LL(13): fpmadd C1, A1, A1, C1 fpmadd C2, A2, A2, C2 fpmadd C3, A3, A3, C3 fpmadd C4, A4, A4, C4 fpmadd C5, A5, A5, C5 fpmadd C6, A6, A6, C6 fpmadd C7, A7, A7, C7 fpmadd C8, A8, A8, C8 fpmadd C1, A9, A9, C1 fpmadd C2, A10, A10, C2 fpmadd C3, A11, A11, C3 fpmadd C4, A12, A12, C4 fpmadd C5, A13, A13, C5 fpmadd C6, A14, A14, C6 fpmadd C7, A15, A15, C7 fpmadd C8, A16, A16, C8 .align 4 LL(15): andi. r0, N, 31 beq LL(98) andi. r0, N, 16 beq LL(16) LFPDUX A1, X, INCX2 LFPDUX A2, X, INCX2 LFPDUX A3, X, INCX2 LFPDUX A4, X, INCX2 LFPDUX A5, X, INCX2 LFPDUX A6, X, INCX2 LFPDUX A7, X, INCX2 LFPDUX A8, X, INCX2 fpmadd C1, A1, A1, C1 fpmadd C2, A2, A2, C2 fpmadd C3, A3, A3, C3 fpmadd C4, A4, A4, C4 fpmadd C5, A5, A5, C5 fpmadd C6, A6, A6, C6 fpmadd C7, A7, A7, C7 fpmadd C8, A8, A8, C8 .align 4 LL(16): andi. r0, N, 8 beq LL(17) LFPDUX A1, X, INCX2 LFPDUX A2, X, INCX2 LFPDUX A3, X, INCX2 LFPDUX A4, X, INCX2 fpmadd C1, A1, A1, C1 fpmadd C2, A2, A2, C2 fpmadd C3, A3, A3, C3 fpmadd C4, A4, A4, C4 .align 4 LL(17): andi. r0, N, 4 beq LL(18) LFPDUX A1, X, INCX2 LFPDUX A2, X, INCX2 fpmadd C1, A1, A1, C1 fpmadd C2, A2, A2, C2 .align 4 LL(18): andi. r0, N, 2 beq LL(19) LFPDUX A1, X, INCX2 fpmadd C3, A1, A1, C3 .align 4 LL(19): andi. r0, N, 1 beq LL(98) LFDX A1, X, INCX2 fmadd C4, A1, A1, C4 .align 4 LL(98): fpadd C1, C1, C5 lis r3, 0x3f00 fpadd C2, C2, C6 lis r4, 0x4040 fpadd C3, C3, C7 stw r3, 4(SP) fpadd C4, C4, C8 stw r4, 8(SP) fpadd C1, C1, C2 fpadd C3, C3, C4 lfs f10, 4(SP) fpadd C1, C1, C3 lfs f11, 4(SP) lfs f12, 8(SP) fsmtp C2, C1 fadd C1, C2, C1 fcmpu cr0, f10, C1 beq cr0, LL(99) #ifndef HUMMER_EMULATOR frsqrte f9, f1 li r10, 16 fmul f2, f1, f9 lfpdux f23, SP, r10 fmul f3, f9, f11 lfpdux f22, SP, r10 fnmsub f4, f2, f9, f12 lfpdux f21, SP, r10 fmul f9, f3, f4 lfpdux f20, SP, r10 fadd f13, f11, f11 lfpdux f19, SP, r10 fmul f12, f1, f9 lfpdux f18, SP, r10 fmul f11, f12, f11 lfpdux f17, SP, r10 fnmsub f1, f12, f9, f13 lfpdux f16, SP, r10 lfpdux f15, SP, r10 lfpdux f14, SP, r10 addi SP, SP, 16 fmadd f1, f11, f1, f12 blr #else fsqrt f1, f1 li r10, 16 lfpdux f23, SP, r10 lfpdux f22, SP, r10 lfpdux f21, SP, r10 lfpdux f20, SP, r10 lfpdux f19, SP, r10 lfpdux f18, SP, r10 lfpdux f17, SP, r10 lfpdux f16, SP, r10 lfpdux f15, SP, r10 lfpdux f14, SP, r10 addi SP, SP, 16 blr #endif .align 4 LL(99): li r10, 16 lfpdux f23, SP, r10 lfpdux f22, SP, r10 lfpdux f21, SP, r10 lfpdux f20, SP, r10 lfpdux f19, SP, r10 lfpdux f18, SP, r10 lfpdux f17, SP, r10 lfpdux f16, SP, r10 lfpdux f15, SP, r10 lfpdux f14, SP, r10 addi SP, SP, 16 blr .align 4 LL(100): sub X2, X, INCX sub X, X, INCX2 srawi. r0, N, 4 mtspr CTR, r0 beq- LL(115) LFDUX A1, X, INCX2 LFDUX A2, X2, INCX2 LFDUX A3, X, INCX2 LFDUX A4, X2, INCX2 LFDUX A5, X, INCX2 LFDUX A6, X2, INCX2 LFDUX A7, X, INCX2 LFDUX A8, X2, INCX2 LFDUX A9, X, INCX2 LFDUX A10, X2, INCX2 LFDUX A11, X, INCX2 LFDUX A12, X2, INCX2 LFDUX A13, X, INCX2 LFDUX A14, X2, INCX2 LFDUX A15, X, INCX2 LFDUX A16, X2, INCX2 bdz LL(113) .align 4 LL(112): fmadd C1, A1, A1, C1 LFDUX A1, X, INCX2 fmadd C2, A2, A2, C2 LFDUX A2, X2, INCX2 fmadd C3, A3, A3, C3 LFDUX A3, X, INCX2 fmadd C4, A4, A4, C4 LFDUX A4, X2, INCX2 fmadd C5, A5, A5, C5 LFDUX A5, X, INCX2 fmadd C6, A6, A6, C6 LFDUX A6, X2, INCX2 fmadd C7, A7, A7, C7 LFDUX A7, X, INCX2 fmadd C8, A8, A8, C8 LFDUX A8, X2, INCX2 fmadd C1, A9, A9, C1 LFDUX A9, X, INCX2 fmadd C2, A10, A10, C2 LFDUX A10, X2, INCX2 fmadd C3, A11, A11, C3 LFDUX A11, X, INCX2 fmadd C4, A12, A12, C4 LFDUX A12, X2, INCX2 fmadd C5, A13, A13, C5 LFDUX A13, X, INCX2 fmadd C6, A14, A14, C6 LFDUX A14, X2, INCX2 fmadd C7, A15, A15, C7 LFDUX A15, X, INCX2 fmadd C8, A16, A16, C8 LFDUX A16, X2, INCX2 bdnz LL(112) .align 4 LL(113): fmadd C1, A1, A1, C1 fmadd C2, A2, A2, C2 fmadd C3, A3, A3, C3 fmadd C4, A4, A4, C4 fmadd C5, A5, A5, C5 fmadd C6, A6, A6, C6 fmadd C7, A7, A7, C7 fmadd C8, A8, A8, C8 fmadd C1, A9, A9, C1 fmadd C2, A10, A10, C2 fmadd C3, A11, A11, C3 fmadd C4, A12, A12, C4 fmadd C5, A13, A13, C5 fmadd C6, A14, A14, C6 fmadd C7, A15, A15, C7 fmadd C8, A16, A16, C8 .align 4 LL(115): andi. r0, N, 15 beq LL(998) andi. r0, N, 8 beq LL(116) LFDUX A1, X, INCX2 LFDUX A2, X2, INCX2 LFDUX A3, X, INCX2 LFDUX A4, X2, INCX2 LFDUX A5, X, INCX2 LFDUX A6, X2, INCX2 LFDUX A7, X, INCX2 LFDUX A8, X2, INCX2 fmadd C1, A1, A1, C1 fmadd C2, A2, A2, C2 fmadd C3, A3, A3, C3 fmadd C4, A4, A4, C4 fmadd C5, A5, A5, C5 fmadd C6, A6, A6, C6 fmadd C7, A7, A7, C7 fmadd C8, A8, A8, C8 .align 4 LL(116): andi. r0, N, 4 beq LL(117) LFDUX A1, X, INCX2 LFDUX A2, X2, INCX2 LFDUX A3, X, INCX2 LFDUX A4, X2, INCX2 fmadd C1, A1, A1, C1 fmadd C2, A2, A2, C2 fmadd C3, A3, A3, C3 fmadd C4, A4, A4, C4 .align 4 LL(117): andi. r0, N, 2 beq LL(118) LFDUX A1, X, INCX2 LFDUX A2, X2, INCX2 fmadd C1, A1, A1, C1 fmadd C2, A2, A2, C2 .align 4 LL(118): andi. r0, N, 1 beq LL(998) LFDX A1, X, INCX2 fmadd C1, A1, A1, C1 .align 4 LL(998): fadd C1, C1, C5 lis r3, 0x3f00 fadd C2, C2, C6 lis r4, 0x4040 fadd C3, C3, C7 stw r3, 4(SP) fadd C4, C4, C8 stw r4, 8(SP) fadd C1, C1, C2 lfs f10, 0(SP) fadd C3, C3, C4 lfs f11, 4(SP) lfs f12, 8(SP) fadd C1, C1, C3 fcmpu cr0, f10, C1 beq cr0, LL(999) #ifndef HUMMER_EMULATOR frsqrte f9, f1 li r10, 16 fmul f2, f1, f9 lfpdux f23, SP, r10 fmul f3, f9, f11 lfpdux f22, SP, r10 fnmsub f4, f2, f9, f12 lfpdux f21, SP, r10 fmul f9, f3, f4 lfpdux f20, SP, r10 fadd f13, f11, f11 lfpdux f19, SP, r10 fmul f12, f1, f9 lfpdux f18, SP, r10 fmul f11, f12, f11 lfpdux f17, SP, r10 fnmsub f1, f12, f9, f13 lfpdux f16, SP, r10 lfpdux f15, SP, r10 lfpdux f14, SP, r10 addi SP, SP, 16 fmadd f1, f11, f1, f12 blr #else fsqrt f1, f1 li r10, 16 lfpdux f23, SP, r10 lfpdux f22, SP, r10 lfpdux f21, SP, r10 lfpdux f20, SP, r10 lfpdux f19, SP, r10 lfpdux f18, SP, r10 lfpdux f17, SP, r10 lfpdux f16, SP, r10 lfpdux f15, SP, r10 lfpdux f14, SP, r10 addi SP, SP, 16 blr #endif .align 4 LL(999): li r10, 16 lfpdux f23, SP, r10 lfpdux f22, SP, r10 lfpdux f21, SP, r10 lfpdux f20, SP, r10 lfpdux f19, SP, r10 lfpdux f18, SP, r10 lfpdux f17, SP, r10 lfpdux f16, SP, r10 lfpdux f15, SP, r10 lfpdux f14, SP, r10 addi SP, SP, 16 blr EPILOGUE