227 lines
		
	
	
		
			8.0 KiB
		
	
	
	
		
			C
		
	
	
	
			
		
		
	
	
			227 lines
		
	
	
		
			8.0 KiB
		
	
	
	
		
			C
		
	
	
	
/***************************************************************************
 | 
						|
Copyright (c) 2013-2019, The OpenBLAS Project
 | 
						|
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.
 | 
						|
3. Neither the name of the OpenBLAS project nor the names of
 | 
						|
its contributors may be used to endorse or promote products
 | 
						|
derived from this software without specific prior written permission.
 | 
						|
THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "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 OPENBLAS PROJECT 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.
 | 
						|
*****************************************************************************/
 | 
						|
 | 
						|
#include "common.h"
 | 
						|
 | 
						|
static void srot_kernel_64(BLASLONG n, FLOAT *x, FLOAT *y, FLOAT *c, FLOAT *s) {
 | 
						|
  __asm__("vlrepf %%v0,%[c]\n\t"
 | 
						|
    "vlrepf %%v1,%[s]\n\t"
 | 
						|
    "srlg   %[n],%[n],6\n\t"
 | 
						|
    "xgr    %%r1,%%r1\n\t"
 | 
						|
    "0:\n\t"
 | 
						|
    "pfd 2, 1024(%%r1,%[x])\n\t"
 | 
						|
    "pfd 2, 1024(%%r1,%[y])\n\t"
 | 
						|
    "vl  %%v24, 0(%%r1,%[x])\n\t"
 | 
						|
    "vl  %%v25, 16(%%r1,%[x])\n\t"
 | 
						|
    "vl  %%v26, 32(%%r1,%[x])\n\t"
 | 
						|
    "vl  %%v27, 48(%%r1,%[x])\n\t"
 | 
						|
    "vl  %%v16, 0(%%r1,%[y])\n\t"
 | 
						|
    "vl  %%v17, 16(%%r1,%[y])\n\t"
 | 
						|
    "vl  %%v18, 32(%%r1,%[y])\n\t"
 | 
						|
    "vl  %%v19, 48(%%r1,%[y])\n\t"
 | 
						|
    "vfmsb %%v28,%%v24,%%v0\n\t"
 | 
						|
    "vfmsb %%v29,%%v25,%%v0\n\t"
 | 
						|
    "vfmsb %%v20,%%v24,%%v1\n\t" /* yn=x*s */
 | 
						|
    "vfmsb %%v21,%%v25,%%v1\n\t" /* yn=x*s */
 | 
						|
    "vfmsb %%v30,%%v26,%%v0\n\t"
 | 
						|
    "vfmsb %%v22,%%v26,%%v1\n\t" /* yn=x*s */
 | 
						|
    "vfmsb %%v31,%%v27,%%v0\n\t"
 | 
						|
    "vfmsb %%v23,%%v27,%%v1\n\t" /* yn=x*s */
 | 
						|
    /* 2nd parts */
 | 
						|
    "vfmasb %%v28,%%v16,%%v1,%%v28\n\t"
 | 
						|
    "vfmssb %%v20,%%v16,%%v0,%%v20\n\t" /* yn=y*c-yn */
 | 
						|
    "vfmasb %%v29,%%v17,%%v1,%%v29\n\t"
 | 
						|
    "vfmssb %%v21,%%v17,%%v0,%%v21\n\t" /* yn=y*c-yn */
 | 
						|
    "vfmasb %%v30,%%v18,%%v1,%%v30\n\t"
 | 
						|
    "vfmssb %%v22,%%v18,%%v0,%%v22\n\t" /* yn=y*c-yn */
 | 
						|
    "vfmasb %%v31,%%v19,%%v1,%%v31\n\t"
 | 
						|
    "vfmssb %%v23,%%v19,%%v0,%%v23\n\t" /* yn=y*c-yn */
 | 
						|
    "vst  %%v28, 0(%%r1,%[x])\n\t"
 | 
						|
    "vst  %%v29, 16(%%r1,%[x])\n\t"
 | 
						|
    "vst  %%v30, 32(%%r1,%[x])\n\t"
 | 
						|
    "vst  %%v31, 48(%%r1,%[x])\n\t"
 | 
						|
    "vst  %%v20, 0(%%r1,%[y])\n\t"
 | 
						|
    "vst  %%v21, 16(%%r1,%[y])\n\t"
 | 
						|
    "vst  %%v22, 32(%%r1,%[y])\n\t"
 | 
						|
    "vst  %%v23, 48(%%r1,%[y])\n\t"
 | 
						|
    "vl  %%v24, 64(%%r1,%[x])\n\t"
 | 
						|
    "vl  %%v25, 80(%%r1,%[x])\n\t"
 | 
						|
    "vl  %%v26, 96(%%r1,%[x])\n\t"
 | 
						|
    "vl  %%v27, 112(%%r1,%[x])\n\t"
 | 
						|
    "vl  %%v16, 64(%%r1,%[y])\n\t"
 | 
						|
    "vl  %%v17, 80(%%r1,%[y])\n\t"
 | 
						|
    "vl  %%v18, 96(%%r1,%[y])\n\t"
 | 
						|
    "vl  %%v19, 112(%%r1,%[y])\n\t"
 | 
						|
    "vfmsb %%v28,%%v24,%%v0\n\t"
 | 
						|
    "vfmsb %%v29,%%v25,%%v0\n\t"
 | 
						|
    "vfmsb %%v20,%%v24,%%v1\n\t" /* yn=x*s */
 | 
						|
    "vfmsb %%v21,%%v25,%%v1\n\t" /* yn=x*s */
 | 
						|
    "vfmsb %%v30,%%v26,%%v0\n\t"
 | 
						|
    "vfmsb %%v22,%%v26,%%v1\n\t" /* yn=x*s */
 | 
						|
    "vfmsb %%v31,%%v27,%%v0\n\t"
 | 
						|
    "vfmsb %%v23,%%v27,%%v1\n\t" /* yn=x*s */
 | 
						|
    /* 2nd parts */
 | 
						|
    "vfmasb %%v28,%%v16,%%v1,%%v28\n\t"
 | 
						|
    "vfmssb %%v20,%%v16,%%v0,%%v20\n\t" /* yn=y*c-yn */
 | 
						|
    "vfmasb %%v29,%%v17,%%v1,%%v29\n\t"
 | 
						|
    "vfmssb %%v21,%%v17,%%v0,%%v21\n\t" /* yn=y*c-yn */
 | 
						|
    "vfmasb %%v30,%%v18,%%v1,%%v30\n\t"
 | 
						|
    "vfmssb %%v22,%%v18,%%v0,%%v22\n\t" /* yn=y*c-yn */
 | 
						|
    "vfmasb %%v31,%%v19,%%v1,%%v31\n\t"
 | 
						|
    "vfmssb %%v23,%%v19,%%v0,%%v23\n\t" /* yn=y*c-yn */
 | 
						|
    "vst  %%v28, 64(%%r1,%[x])\n\t"
 | 
						|
    "vst  %%v29, 80(%%r1,%[x])\n\t"
 | 
						|
    "vst  %%v30, 96(%%r1,%[x])\n\t"
 | 
						|
    "vst  %%v31, 112(%%r1,%[x])\n\t"
 | 
						|
    "vst  %%v20, 64(%%r1,%[y])\n\t"
 | 
						|
    "vst  %%v21, 80(%%r1,%[y])\n\t"
 | 
						|
    "vst  %%v22, 96(%%r1,%[y])\n\t"
 | 
						|
    "vst  %%v23, 112(%%r1,%[y])\n\t"
 | 
						|
    "vl  %%v24, 128(%%r1,%[x])\n\t"
 | 
						|
    "vl  %%v25, 144(%%r1,%[x])\n\t"
 | 
						|
    "vl  %%v26, 160(%%r1,%[x])\n\t"
 | 
						|
    "vl  %%v27, 176(%%r1,%[x])\n\t"
 | 
						|
    "vl  %%v16, 128(%%r1,%[y])\n\t"
 | 
						|
    "vl  %%v17, 144(%%r1,%[y])\n\t"
 | 
						|
    "vl  %%v18, 160(%%r1,%[y])\n\t"
 | 
						|
    "vl  %%v19, 176(%%r1,%[y])\n\t"
 | 
						|
    "vfmsb %%v28,%%v24,%%v0\n\t"
 | 
						|
    "vfmsb %%v29,%%v25,%%v0\n\t"
 | 
						|
    "vfmsb %%v20,%%v24,%%v1\n\t" /* yn=x*s */
 | 
						|
    "vfmsb %%v21,%%v25,%%v1\n\t" /* yn=x*s */
 | 
						|
    "vfmsb %%v30,%%v26,%%v0\n\t"
 | 
						|
    "vfmsb %%v22,%%v26,%%v1\n\t" /* yn=x*s */
 | 
						|
    "vfmsb %%v31,%%v27,%%v0\n\t"
 | 
						|
    "vfmsb %%v23,%%v27,%%v1\n\t" /* yn=x*s */
 | 
						|
    /* 2nd parts */
 | 
						|
    "vfmasb %%v28,%%v16,%%v1,%%v28\n\t"
 | 
						|
    "vfmssb %%v20,%%v16,%%v0,%%v20\n\t" /* yn=y*c-yn */
 | 
						|
    "vfmasb %%v29,%%v17,%%v1,%%v29\n\t"
 | 
						|
    "vfmssb %%v21,%%v17,%%v0,%%v21\n\t" /* yn=y*c-yn */
 | 
						|
    "vfmasb %%v30,%%v18,%%v1,%%v30\n\t"
 | 
						|
    "vfmssb %%v22,%%v18,%%v0,%%v22\n\t" /* yn=y*c-yn */
 | 
						|
    "vfmasb %%v31,%%v19,%%v1,%%v31\n\t"
 | 
						|
    "vfmssb %%v23,%%v19,%%v0,%%v23\n\t" /* yn=y*c-yn */
 | 
						|
    "vst  %%v28, 128(%%r1,%[x])\n\t"
 | 
						|
    "vst  %%v29, 144(%%r1,%[x])\n\t"
 | 
						|
    "vst  %%v30, 160(%%r1,%[x])\n\t"
 | 
						|
    "vst  %%v31, 176(%%r1,%[x])\n\t"
 | 
						|
    "vst  %%v20, 128(%%r1,%[y])\n\t"
 | 
						|
    "vst  %%v21, 144(%%r1,%[y])\n\t"
 | 
						|
    "vst  %%v22, 160(%%r1,%[y])\n\t"
 | 
						|
    "vst  %%v23, 176(%%r1,%[y])\n\t"
 | 
						|
    "vl  %%v24, 192(%%r1,%[x])\n\t"
 | 
						|
    "vl  %%v25, 208(%%r1,%[x])\n\t"
 | 
						|
    "vl  %%v26, 224(%%r1,%[x])\n\t"
 | 
						|
    "vl  %%v27, 240(%%r1,%[x])\n\t"
 | 
						|
    "vl  %%v16, 192(%%r1,%[y])\n\t"
 | 
						|
    "vl  %%v17, 208(%%r1,%[y])\n\t"
 | 
						|
    "vl  %%v18, 224(%%r1,%[y])\n\t"
 | 
						|
    "vl  %%v19, 240(%%r1,%[y])\n\t"
 | 
						|
    "vfmsb %%v28,%%v24,%%v0\n\t"
 | 
						|
    "vfmsb %%v29,%%v25,%%v0\n\t"
 | 
						|
    "vfmsb %%v20,%%v24,%%v1\n\t" /* yn=x*s */
 | 
						|
    "vfmsb %%v21,%%v25,%%v1\n\t" /* yn=x*s */
 | 
						|
    "vfmsb %%v30,%%v26,%%v0\n\t"
 | 
						|
    "vfmsb %%v22,%%v26,%%v1\n\t" /* yn=x*s */
 | 
						|
    "vfmsb %%v31,%%v27,%%v0\n\t"
 | 
						|
    "vfmsb %%v23,%%v27,%%v1\n\t" /* yn=x*s */
 | 
						|
    /* 2nd parts */
 | 
						|
    "vfmasb %%v28,%%v16,%%v1,%%v28\n\t"
 | 
						|
    "vfmssb %%v20,%%v16,%%v0,%%v20\n\t" /* yn=y*c-yn */
 | 
						|
    "vfmasb %%v29,%%v17,%%v1,%%v29\n\t"
 | 
						|
    "vfmssb %%v21,%%v17,%%v0,%%v21\n\t" /* yn=y*c-yn */
 | 
						|
    "vfmasb %%v30,%%v18,%%v1,%%v30\n\t"
 | 
						|
    "vfmssb %%v22,%%v18,%%v0,%%v22\n\t" /* yn=y*c-yn */
 | 
						|
    "vfmasb %%v31,%%v19,%%v1,%%v31\n\t"
 | 
						|
    "vfmssb %%v23,%%v19,%%v0,%%v23\n\t" /* yn=y*c-yn */
 | 
						|
    "vst  %%v28, 192(%%r1,%[x])\n\t"
 | 
						|
    "vst  %%v29, 208(%%r1,%[x])\n\t"
 | 
						|
    "vst  %%v30, 224(%%r1,%[x])\n\t"
 | 
						|
    "vst  %%v31, 240(%%r1,%[x])\n\t"
 | 
						|
    "vst  %%v20, 192(%%r1,%[y])\n\t"
 | 
						|
    "vst  %%v21, 208(%%r1,%[y])\n\t"
 | 
						|
    "vst  %%v22, 224(%%r1,%[y])\n\t"
 | 
						|
    "vst  %%v23, 240(%%r1,%[y])\n\t"
 | 
						|
    "agfi  %%r1,256\n\t"
 | 
						|
    "brctg %[n],0b"
 | 
						|
    : "+m"(*(FLOAT (*)[n]) x), "+m"(*(FLOAT (*)[n]) y),
 | 
						|
       [n] "+&r"(n)
 | 
						|
    : [x] "a"(x),[y] "a"(y),[c] "Q"(*c),[s] "Q"(*s)
 | 
						|
    : "cc", "r1", "v0", "v1", "v16", "v17", "v18", "v19", "v20", "v21",
 | 
						|
       "v22", "v23", "v24", "v25", "v26", "v27", "v28", "v29", "v30",
 | 
						|
       "v31");
 | 
						|
}
 | 
						|
 | 
						|
int CNAME(BLASLONG n, FLOAT *x, BLASLONG inc_x, FLOAT *y, BLASLONG inc_y,
 | 
						|
          FLOAT c, FLOAT s) {
 | 
						|
  BLASLONG i = 0;
 | 
						|
  BLASLONG ix = 0, iy = 0;
 | 
						|
 | 
						|
  FLOAT temp;
 | 
						|
 | 
						|
  if (n <= 0)
 | 
						|
    return (0);
 | 
						|
 | 
						|
  if ((inc_x == 1) && (inc_y == 1)) {
 | 
						|
 | 
						|
    BLASLONG n1 = n & -64;
 | 
						|
    if (n1 > 0) {
 | 
						|
      FLOAT cosa, sina;
 | 
						|
      cosa = c;
 | 
						|
      sina = s;
 | 
						|
      srot_kernel_64(n1, x, y, &cosa, &sina);
 | 
						|
      i = n1;
 | 
						|
    }
 | 
						|
 | 
						|
    while (i < n) {
 | 
						|
      temp = c * x[i] + s * y[i];
 | 
						|
      y[i] = c * y[i] - s * x[i];
 | 
						|
      x[i] = temp;
 | 
						|
 | 
						|
      i++;
 | 
						|
 | 
						|
    }
 | 
						|
 | 
						|
  } else {
 | 
						|
 | 
						|
    while (i < n) {
 | 
						|
      temp = c * x[ix] + s * y[iy];
 | 
						|
      y[iy] = c * y[iy] - s * x[ix];
 | 
						|
      x[ix] = temp;
 | 
						|
 | 
						|
      ix += inc_x;
 | 
						|
      iy += inc_y;
 | 
						|
      i++;
 | 
						|
 | 
						|
    }
 | 
						|
 | 
						|
  }
 | 
						|
  return (0);
 | 
						|
 | 
						|
}
 |