kusano 2b45e8
/*********************************************************************/
kusano 2b45e8
/* Copyright 2009, 2010 The University of Texas at Austin.           */
kusano 2b45e8
/* All rights reserved.                                              */
kusano 2b45e8
/*                                                                   */
kusano 2b45e8
/* Redistribution and use in source and binary forms, with or        */
kusano 2b45e8
/* without modification, are permitted provided that the following   */
kusano 2b45e8
/* conditions are met:                                               */
kusano 2b45e8
/*                                                                   */
kusano 2b45e8
/*   1. Redistributions of source code must retain the above         */
kusano 2b45e8
/*      copyright notice, this list of conditions and the following  */
kusano 2b45e8
/*      disclaimer.                                                  */
kusano 2b45e8
/*                                                                   */
kusano 2b45e8
/*   2. Redistributions in binary form must reproduce the above      */
kusano 2b45e8
/*      copyright notice, this list of conditions and the following  */
kusano 2b45e8
/*      disclaimer in the documentation and/or other materials       */
kusano 2b45e8
/*      provided with the distribution.                              */
kusano 2b45e8
/*                                                                   */
kusano 2b45e8
/*    THIS  SOFTWARE IS PROVIDED  BY THE  UNIVERSITY OF  TEXAS AT    */
kusano 2b45e8
/*    AUSTIN  ``AS IS''  AND ANY  EXPRESS OR  IMPLIED WARRANTIES,    */
kusano 2b45e8
/*    INCLUDING, BUT  NOT LIMITED  TO, THE IMPLIED  WARRANTIES OF    */
kusano 2b45e8
/*    MERCHANTABILITY  AND FITNESS FOR  A PARTICULAR  PURPOSE ARE    */
kusano 2b45e8
/*    DISCLAIMED.  IN  NO EVENT SHALL THE UNIVERSITY  OF TEXAS AT    */
kusano 2b45e8
/*    AUSTIN OR CONTRIBUTORS BE  LIABLE FOR ANY DIRECT, INDIRECT,    */
kusano 2b45e8
/*    INCIDENTAL,  SPECIAL, EXEMPLARY,  OR  CONSEQUENTIAL DAMAGES    */
kusano 2b45e8
/*    (INCLUDING, BUT  NOT LIMITED TO,  PROCUREMENT OF SUBSTITUTE    */
kusano 2b45e8
/*    GOODS  OR  SERVICES; LOSS  OF  USE,  DATA,  OR PROFITS;  OR    */
kusano 2b45e8
/*    BUSINESS INTERRUPTION) HOWEVER CAUSED  AND ON ANY THEORY OF    */
kusano 2b45e8
/*    LIABILITY, WHETHER  IN CONTRACT, STRICT  LIABILITY, OR TORT    */
kusano 2b45e8
/*    (INCLUDING NEGLIGENCE OR OTHERWISE)  ARISING IN ANY WAY OUT    */
kusano 2b45e8
/*    OF  THE  USE OF  THIS  SOFTWARE,  EVEN  IF ADVISED  OF  THE    */
kusano 2b45e8
/*    POSSIBILITY OF SUCH DAMAGE.                                    */
kusano 2b45e8
/*                                                                   */
kusano 2b45e8
/* The views and conclusions contained in the software and           */
kusano 2b45e8
/* documentation are those of the authors and should not be          */
kusano 2b45e8
/* interpreted as representing official policies, either expressed   */
kusano 2b45e8
/* or implied, of The University of Texas at Austin.                 */
kusano 2b45e8
/*********************************************************************/
kusano 2b45e8
kusano 2b45e8
#define ASSEMBLER
kusano 2b45e8
#include "common.h"
kusano 2b45e8
	
kusano 2b45e8
#ifdef linux
kusano 2b45e8
#ifndef __64BIT__
kusano 2b45e8
#define N	r3
kusano 2b45e8
#define X	r6
kusano 2b45e8
#define INCX	r7	
kusano 2b45e8
#define Y	r8
kusano 2b45e8
#define INCY	r9
kusano 2b45e8
#define PREA	r4
kusano 2b45e8
#define	XX	r5
kusano 2b45e8
#define	YY	r10
kusano 2b45e8
#else
kusano 2b45e8
#define N	r3
kusano 2b45e8
#define X	r8
kusano 2b45e8
#define INCX	r9	
kusano 2b45e8
#define Y	r10
kusano 2b45e8
#define INCY	r4
kusano 2b45e8
#define PREA	r5
kusano 2b45e8
#define	XX	r6
kusano 2b45e8
#define	YY	r7
kusano 2b45e8
#endif
kusano 2b45e8
#endif
kusano 2b45e8
kusano 2b45e8
#if defined(_AIX) || defined(__APPLE__)
kusano 2b45e8
#if !defined(__64BIT__) && defined(DOUBLE)
kusano 2b45e8
#define N	r3
kusano 2b45e8
#define X	r10
kusano 2b45e8
#define INCX	r4	
kusano 2b45e8
#define Y	r5
kusano 2b45e8
#define INCY	r6
kusano 2b45e8
#define PREA	r7
kusano 2b45e8
#define	XX	r8
kusano 2b45e8
#define	YY	r9
kusano 2b45e8
#else
kusano 2b45e8
#define N	r3
kusano 2b45e8
#define X	r8
kusano 2b45e8
#define INCX	r9	
kusano 2b45e8
#define Y	r10
kusano 2b45e8
#define INCY	r4
kusano 2b45e8
#define PREA	r5
kusano 2b45e8
#define	XX	r6
kusano 2b45e8
#define	YY	r7
kusano 2b45e8
#endif
kusano 2b45e8
#endif
kusano 2b45e8
kusano 2b45e8
#define INCXM1	r11
kusano 2b45e8
#define INCYM1	r12
kusano 2b45e8
kusano 2b45e8
#define STACKSIZE 160
kusano 2b45e8
kusano 2b45e8
	PROLOGUE
kusano 2b45e8
	PROFCODE
kusano 2b45e8
kusano 2b45e8
	addi	SP, SP, -STACKSIZE
kusano 2b45e8
	li	r0,   0
kusano 2b45e8
kusano 2b45e8
	stfd	f14,    0(SP)
kusano 2b45e8
	stfd	f15,    8(SP)
kusano 2b45e8
	stfd	f16,   16(SP)
kusano 2b45e8
	stfd	f17,   24(SP)
kusano 2b45e8
kusano 2b45e8
	stfd	f18,   32(SP)
kusano 2b45e8
	stfd	f19,   40(SP)
kusano 2b45e8
	stfd	f20,   48(SP)
kusano 2b45e8
	stfd	f21,   56(SP)
kusano 2b45e8
kusano 2b45e8
	stfd	f22,   64(SP)
kusano 2b45e8
	stfd	f23,   72(SP)
kusano 2b45e8
	stfd	f24,   80(SP)
kusano 2b45e8
	stfd	f25,   88(SP)
kusano 2b45e8
kusano 2b45e8
	stfd	f26,   96(SP)
kusano 2b45e8
	stfd	f27,  104(SP)
kusano 2b45e8
	stfd	f28,  112(SP)
kusano 2b45e8
	stfd	f29,  120(SP)
kusano 2b45e8
kusano 2b45e8
	stfd	f30,  128(SP)
kusano 2b45e8
	stfd	f31,  136(SP)
kusano 2b45e8
kusano 2b45e8
#if defined(linux) && defined(__64BIT__)
kusano 2b45e8
	ld	INCY, 112 + STACKSIZE(SP)
kusano 2b45e8
#endif
kusano 2b45e8
	
kusano 2b45e8
#if defined(_AIX) || defined(__APPLE__)
kusano 2b45e8
#ifdef __64BIT__
kusano 2b45e8
	ld	INCY,   112 + STACKSIZE(SP)
kusano 2b45e8
#else
kusano 2b45e8
#ifdef DOUBLE
kusano 2b45e8
	lwz	INCX,    56 + STACKSIZE(SP)
kusano 2b45e8
	lwz	Y,       60 + STACKSIZE(SP)
kusano 2b45e8
	lwz	INCY,    64 + STACKSIZE(SP)
kusano 2b45e8
#else
kusano 2b45e8
	lwz	INCY,    56 + STACKSIZE(SP)
kusano 2b45e8
#endif
kusano 2b45e8
#endif
kusano 2b45e8
#endif
kusano 2b45e8
kusano 2b45e8
	slwi	INCX, INCX, ZBASE_SHIFT
kusano 2b45e8
	slwi	INCY, INCY, ZBASE_SHIFT
kusano 2b45e8
	subi	INCXM1, INCX, SIZE
kusano 2b45e8
	subi	INCYM1, INCY, SIZE
kusano 2b45e8
kusano 2b45e8
#ifdef L1_DUALFETCH
kusano 2b45e8
	li	PREA, (L1_PREFETCHSIZE) / 2
kusano 2b45e8
#else
kusano 2b45e8
	li	PREA, (L1_PREFETCHSIZE) 
kusano 2b45e8
#endif
kusano 2b45e8
kusano 2b45e8
	cmpwi	cr0, N, 0
kusano 2b45e8
	ble-	LL(999)
kusano 2b45e8
kusano 2b45e8
	cmpwi	cr0, INCX, 2 * SIZE
kusano 2b45e8
	bne-	cr0, LL(100)
kusano 2b45e8
	cmpwi	cr0, INCY, 2 * SIZE
kusano 2b45e8
	bne-	cr0, LL(100)
kusano 2b45e8
kusano 2b45e8
	srawi.	r0, N, 3
kusano 2b45e8
	mtspr	CTR, r0
kusano 2b45e8
	beq-	cr0, LL(50)
kusano 2b45e8
	.align 4
kusano 2b45e8
kusano 2b45e8
LL(10):
kusano 2b45e8
	LFD	f0,    0 * SIZE(X)
kusano 2b45e8
	LFD	f1,    1 * SIZE(X)
kusano 2b45e8
	LFD	f2,    2 * SIZE(X)
kusano 2b45e8
	LFD	f3,    3 * SIZE(X)
kusano 2b45e8
kusano 2b45e8
	LFD	f16,   0 * SIZE(Y)
kusano 2b45e8
	LFD	f17,   1 * SIZE(Y)
kusano 2b45e8
	LFD	f18,   2 * SIZE(Y)
kusano 2b45e8
	LFD	f19,   3 * SIZE(Y)
kusano 2b45e8
kusano 2b45e8
	LFD	f4,    4 * SIZE(X)
kusano 2b45e8
	LFD	f5,    5 * SIZE(X)
kusano 2b45e8
	LFD	f6,    6 * SIZE(X)
kusano 2b45e8
	LFD	f7,    7 * SIZE(X)
kusano 2b45e8
kusano 2b45e8
	LFD	f20,   4 * SIZE(Y)
kusano 2b45e8
	LFD	f21,   5 * SIZE(Y)
kusano 2b45e8
	LFD	f22,   6 * SIZE(Y)
kusano 2b45e8
	LFD	f23,   7 * SIZE(Y)
kusano 2b45e8
kusano 2b45e8
	LFD	f8,    8 * SIZE(X)
kusano 2b45e8
	LFD	f9,    9 * SIZE(X)
kusano 2b45e8
	LFD	f10,  10 * SIZE(X)
kusano 2b45e8
	LFD	f11,  11 * SIZE(X)
kusano 2b45e8
kusano 2b45e8
	LFD	f24,   8 * SIZE(Y)
kusano 2b45e8
	LFD	f25,   9 * SIZE(Y)
kusano 2b45e8
	LFD	f26,  10 * SIZE(Y)
kusano 2b45e8
	LFD	f27,  11 * SIZE(Y)
kusano 2b45e8
kusano 2b45e8
	LFD	f12,  12 * SIZE(X)
kusano 2b45e8
	LFD	f13,  13 * SIZE(X)
kusano 2b45e8
	LFD	f14,  14 * SIZE(X)
kusano 2b45e8
	LFD	f15,  15 * SIZE(X)
kusano 2b45e8
kusano 2b45e8
	LFD	f28,  12 * SIZE(Y)
kusano 2b45e8
	LFD	f29,  13 * SIZE(Y)
kusano 2b45e8
	LFD	f30,  14 * SIZE(Y)
kusano 2b45e8
	LFD	f31,  15 * SIZE(Y)
kusano 2b45e8
kusano 2b45e8
	STFD	f16,   0 * SIZE(X)
kusano 2b45e8
	STFD	f17,   1 * SIZE(X)
kusano 2b45e8
	STFD	f18,   2 * SIZE(X)
kusano 2b45e8
	STFD	f19,   3 * SIZE(X)
kusano 2b45e8
kusano 2b45e8
	STFD	f0,    0 * SIZE(Y)
kusano 2b45e8
	STFD	f1,    1 * SIZE(Y)
kusano 2b45e8
	STFD	f2,    2 * SIZE(Y)
kusano 2b45e8
	STFD	f3,    3 * SIZE(Y)
kusano 2b45e8
kusano 2b45e8
	STFD	f20,   4 * SIZE(X)
kusano 2b45e8
	STFD	f21,   5 * SIZE(X)
kusano 2b45e8
	STFD	f22,   6 * SIZE(X)
kusano 2b45e8
	STFD	f23,   7 * SIZE(X)
kusano 2b45e8
kusano 2b45e8
	STFD	f4,    4 * SIZE(Y)
kusano 2b45e8
	STFD	f5,    5 * SIZE(Y)
kusano 2b45e8
	STFD	f6,    6 * SIZE(Y)
kusano 2b45e8
	STFD	f7,    7 * SIZE(Y)
kusano 2b45e8
kusano 2b45e8
	STFD	f24,   8 * SIZE(X)
kusano 2b45e8
	STFD	f25,   9 * SIZE(X)
kusano 2b45e8
	STFD	f26,  10 * SIZE(X)
kusano 2b45e8
	STFD	f27,  11 * SIZE(X)
kusano 2b45e8
kusano 2b45e8
	STFD	f8,    8 * SIZE(Y)
kusano 2b45e8
	STFD	f9,    9 * SIZE(Y)
kusano 2b45e8
	STFD	f10,  10 * SIZE(Y)
kusano 2b45e8
	STFD	f11,  11 * SIZE(Y)
kusano 2b45e8
kusano 2b45e8
	STFD	f28,  12 * SIZE(X)
kusano 2b45e8
	STFD	f29,  13 * SIZE(X)
kusano 2b45e8
	STFD	f30,  14 * SIZE(X)
kusano 2b45e8
	STFD	f31,  15 * SIZE(X)
kusano 2b45e8
kusano 2b45e8
	STFD	f12,  12 * SIZE(Y)
kusano 2b45e8
	STFD	f13,  13 * SIZE(Y)
kusano 2b45e8
	STFD	f14,  14 * SIZE(Y)
kusano 2b45e8
	STFD	f15,  15 * SIZE(Y)
kusano 2b45e8
kusano 2b45e8
	addi	X, X, 16 * SIZE
kusano 2b45e8
	addi	Y, Y, 16 * SIZE
kusano 2b45e8
	dcbtst	X, PREA
kusano 2b45e8
#ifdef	L1_DUALFETCH
kusano 2b45e8
	dcbtst	Y, PREA
kusano 2b45e8
#endif
kusano 2b45e8
	bdnz	LL(10)
kusano 2b45e8
	.align 4
kusano 2b45e8
kusano 2b45e8
LL(50):
kusano 2b45e8
	andi.	r0,  N, 7
kusano 2b45e8
	mtspr	CTR, r0
kusano 2b45e8
	beq	LL(999)
kusano 2b45e8
	.align 4
kusano 2b45e8
kusano 2b45e8
LL(60):
kusano 2b45e8
	LFD	f0,  0 * SIZE(X)
kusano 2b45e8
	LFD	f1,  1 * SIZE(X)
kusano 2b45e8
	LFD	f2,  0 * SIZE(Y)
kusano 2b45e8
	LFD	f3,  1 * SIZE(Y)
kusano 2b45e8
kusano 2b45e8
	STFD	f2,  0 * SIZE(X)
kusano 2b45e8
	STFD	f3,  1 * SIZE(X)
kusano 2b45e8
	STFD	f0,  0 * SIZE(Y)
kusano 2b45e8
	STFD	f1,  1 * SIZE(Y)
kusano 2b45e8
kusano 2b45e8
	addi	X, X,  2 * SIZE
kusano 2b45e8
	addi	Y, Y,  2 * SIZE
kusano 2b45e8
	bdnz	LL(60)
kusano 2b45e8
	b	LL(999)
kusano 2b45e8
	.align 4
kusano 2b45e8
kusano 2b45e8
LL(100):
kusano 2b45e8
	sub	X, X, INCXM1
kusano 2b45e8
	sub	Y, Y, INCYM1
kusano 2b45e8
kusano 2b45e8
	mr	XX, X
kusano 2b45e8
	mr	YY, Y
kusano 2b45e8
kusano 2b45e8
	srawi.	r0, N, 3
kusano 2b45e8
	mtspr	CTR,  r0
kusano 2b45e8
	beq-	LL(150)
kusano 2b45e8
	.align 4
kusano 2b45e8
kusano 2b45e8
LL(110):
kusano 2b45e8
	LFDX	f0,    X, INCXM1
kusano 2b45e8
	LFDUX	f1,    X, INCX
kusano 2b45e8
	LFDX	f2,    X, INCXM1
kusano 2b45e8
	LFDUX	f3,    X, INCX
kusano 2b45e8
kusano 2b45e8
	LFDX	f16,   Y, INCYM1
kusano 2b45e8
	LFDUX	f17,   Y, INCY
kusano 2b45e8
	LFDX	f18,   Y, INCYM1
kusano 2b45e8
	LFDUX	f19,   Y, INCY
kusano 2b45e8
kusano 2b45e8
	LFDX	f4,    X, INCXM1
kusano 2b45e8
	LFDUX	f5,    X, INCX
kusano 2b45e8
	LFDX	f6,    X, INCXM1
kusano 2b45e8
	LFDUX	f7,    X, INCX
kusano 2b45e8
kusano 2b45e8
	LFDX	f20,   Y, INCYM1
kusano 2b45e8
	LFDUX	f21,   Y, INCY
kusano 2b45e8
	LFDX	f22,   Y, INCYM1
kusano 2b45e8
	LFDUX	f23,   Y, INCY
kusano 2b45e8
kusano 2b45e8
	LFDX	f8,    X, INCXM1
kusano 2b45e8
	LFDUX	f9,    X, INCX
kusano 2b45e8
	LFDX	f10,   X, INCXM1
kusano 2b45e8
	LFDUX	f11,   X, INCX
kusano 2b45e8
kusano 2b45e8
	LFDX	f24,   Y, INCYM1
kusano 2b45e8
	LFDUX	f25,   Y, INCY
kusano 2b45e8
	LFDX	f26,   Y, INCYM1
kusano 2b45e8
	LFDUX	f27,   Y, INCY
kusano 2b45e8
kusano 2b45e8
	LFDX	f12,   X, INCXM1
kusano 2b45e8
	LFDUX	f13,   X, INCX
kusano 2b45e8
	LFDX	f14,   X, INCXM1
kusano 2b45e8
	LFDUX	f15,   X, INCX
kusano 2b45e8
kusano 2b45e8
	LFDX	f28,   Y, INCYM1
kusano 2b45e8
	LFDUX	f29,   Y, INCY
kusano 2b45e8
	LFDX	f30,   Y, INCYM1
kusano 2b45e8
	LFDUX	f31,   Y, INCY
kusano 2b45e8
kusano 2b45e8
	STFDX	f16,   XX, INCXM1
kusano 2b45e8
	STFDUX	f17,   XX, INCX
kusano 2b45e8
	STFDX	f18,   XX, INCXM1
kusano 2b45e8
	STFDUX	f19,   XX, INCX
kusano 2b45e8
kusano 2b45e8
	STFDX	f0,    YY, INCYM1
kusano 2b45e8
	STFDUX	f1,    YY, INCY
kusano 2b45e8
	STFDX	f2,    YY, INCYM1
kusano 2b45e8
	STFDUX	f3,    YY, INCY
kusano 2b45e8
kusano 2b45e8
	STFDX	f20,   XX, INCXM1
kusano 2b45e8
	STFDUX	f21,   XX, INCX
kusano 2b45e8
	STFDX	f22,   XX, INCXM1
kusano 2b45e8
	STFDUX	f23,   XX, INCX
kusano 2b45e8
kusano 2b45e8
	STFDX	f4,    YY, INCYM1
kusano 2b45e8
	STFDUX	f5,    YY, INCY
kusano 2b45e8
	STFDX	f6,    YY, INCYM1
kusano 2b45e8
	STFDUX	f7,    YY, INCY
kusano 2b45e8
kusano 2b45e8
	STFDX	f24,   XX, INCXM1
kusano 2b45e8
	STFDUX	f25,   XX, INCX
kusano 2b45e8
	STFDX	f26,   XX, INCXM1
kusano 2b45e8
	STFDUX	f27,   XX, INCX
kusano 2b45e8
kusano 2b45e8
	STFDX	f8,    YY, INCYM1
kusano 2b45e8
	STFDUX	f9,    YY, INCY
kusano 2b45e8
	STFDX	f10,   YY, INCYM1
kusano 2b45e8
	STFDUX	f11,   YY, INCY
kusano 2b45e8
kusano 2b45e8
	STFDX	f28,   XX, INCXM1
kusano 2b45e8
	STFDUX	f29,   XX, INCX
kusano 2b45e8
	STFDX	f30,   XX, INCXM1
kusano 2b45e8
	STFDUX	f31,   XX, INCX
kusano 2b45e8
kusano 2b45e8
	STFDX	f12,   YY, INCYM1
kusano 2b45e8
	STFDUX	f13,   YY, INCY
kusano 2b45e8
	STFDX	f14,   YY, INCYM1
kusano 2b45e8
	STFDUX	f15,   YY, INCY
kusano 2b45e8
	bdnz	LL(110)
kusano 2b45e8
	.align 4
kusano 2b45e8
kusano 2b45e8
LL(150):
kusano 2b45e8
	andi.	r0,  N, 7
kusano 2b45e8
	mtspr	CTR, r0
kusano 2b45e8
	beq	LL(999)
kusano 2b45e8
	.align 4
kusano 2b45e8
kusano 2b45e8
LL(160):
kusano 2b45e8
	LFDX	f0,    X,  INCXM1
kusano 2b45e8
	LFDUX	f1,    X,  INCX
kusano 2b45e8
	LFDX	f2,    Y,  INCYM1
kusano 2b45e8
	LFDUX	f3,    Y,  INCY
kusano 2b45e8
	STFDX	f2,    XX, INCXM1
kusano 2b45e8
	STFDUX	f3,    XX, INCX
kusano 2b45e8
	STFDX	f0,    YY, INCYM1
kusano 2b45e8
	STFDUX	f1,    YY, INCY
kusano 2b45e8
	bdnz	LL(160)
kusano 2b45e8
	.align 4
kusano 2b45e8
kusano 2b45e8
LL(999):
kusano 2b45e8
	lfd	f14,    0(SP)
kusano 2b45e8
	lfd	f15,    8(SP)
kusano 2b45e8
	lfd	f16,   16(SP)
kusano 2b45e8
	lfd	f17,   24(SP)
kusano 2b45e8
kusano 2b45e8
	lfd	f18,   32(SP)
kusano 2b45e8
	lfd	f19,   40(SP)
kusano 2b45e8
	lfd	f20,   48(SP)
kusano 2b45e8
	lfd	f21,   56(SP)
kusano 2b45e8
kusano 2b45e8
	lfd	f22,   64(SP)
kusano 2b45e8
	lfd	f23,   72(SP)
kusano 2b45e8
	lfd	f24,   80(SP)
kusano 2b45e8
	lfd	f25,   88(SP)
kusano 2b45e8
kusano 2b45e8
	lfd	f26,   96(SP)
kusano 2b45e8
	lfd	f27,  104(SP)
kusano 2b45e8
	lfd	f28,  112(SP)
kusano 2b45e8
	lfd	f29,  120(SP)
kusano 2b45e8
kusano 2b45e8
	lfd	f30,  128(SP)
kusano 2b45e8
	lfd	f31,  136(SP)
kusano 2b45e8
	addi	SP, SP, STACKSIZE
kusano 2b45e8
	blr
kusano 2b45e8
kusano 2b45e8
	EPILOGUE