303 lines
		
	
	
		
			9.1 KiB
		
	
	
	
		
			C
		
	
	
	
			
		
		
	
	
			303 lines
		
	
	
		
			9.1 KiB
		
	
	
	
		
			C
		
	
	
	
| /***************************************************************************
 | |
| Copyright (c) 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"
 | |
| #include <math.h>
 | |
| 
 | |
| #define CABS1(x,i) (fabsf(x[i]) + fabsf(x[i + 1]))
 | |
| 
 | |
| static BLASLONG icamax_kernel_32(BLASLONG n, FLOAT *x, FLOAT *amax) {
 | |
|   BLASLONG iamax;
 | |
| 
 | |
|   __asm__("vlef   %%v0,0(%[x]),0\n\t"
 | |
|     "vlef   %%v1,4(%[x]),0\n\t"
 | |
|     "vlef   %%v0,8(%[x]),1\n\t"
 | |
|     "vlef   %%v1,12(%[x]),1\n\t"
 | |
|     "vlef   %%v0,16(%[x]),2\n\t"
 | |
|     "vlef   %%v1,20(%[x]),2\n\t"
 | |
|     "vlef   %%v0,24(%[x]),3\n\t"
 | |
|     "vlef   %%v1,28(%[x]),3\n\t"
 | |
|     "vflpsb %%v0,%%v0\n\t"
 | |
|     "vflpsb %%v1,%%v1\n\t"
 | |
|     "vfasb  %%v0,%%v0,%%v1\n\t"
 | |
|     "vleig  %%v1,0,0\n\t"
 | |
|     "vleig  %%v1,2,1\n\t"
 | |
|     "vleig  %%v2,1,0\n\t"
 | |
|     "vleig  %%v2,3,1\n\t"
 | |
|     "vrepig %%v3,16\n\t"
 | |
|     "vzero  %%v4\n\t"
 | |
|     "vleib  %%v9,0,0\n\t"
 | |
|     "vleib  %%v9,1,1\n\t"
 | |
|     "vleib  %%v9,2,2\n\t"
 | |
|     "vleib  %%v9,3,3\n\t"
 | |
|     "vleib  %%v9,8,4\n\t"
 | |
|     "vleib  %%v9,9,5\n\t"
 | |
|     "vleib  %%v9,10,6\n\t"
 | |
|     "vleib  %%v9,11,7\n\t"
 | |
|     "vleib  %%v9,16,8\n\t"
 | |
|     "vleib  %%v9,17,9\n\t"
 | |
|     "vleib  %%v9,18,10\n\t"
 | |
|     "vleib  %%v9,19,11\n\t"
 | |
|     "vleib  %%v9,24,12\n\t"
 | |
|     "vleib  %%v9,25,13\n\t"
 | |
|     "vleib  %%v9,26,14\n\t"
 | |
|     "vleib  %%v9,27,15\n\t"
 | |
|     "vleif  %%v24,0,0\n\t"
 | |
|     "vleif  %%v24,1,1\n\t"
 | |
|     "vleif  %%v24,2,2\n\t"
 | |
|     "vleif  %%v24,3,3\n\t"
 | |
|     "vleif  %%v25,4,0\n\t"
 | |
|     "vleif  %%v25,5,1\n\t"
 | |
|     "vleif  %%v25,6,2\n\t"
 | |
|     "vleif  %%v25,7,3\n\t"
 | |
|     "vleif  %%v26,8,0\n\t"
 | |
|     "vleif  %%v26,9,1\n\t"
 | |
|     "vleif  %%v26,10,2\n\t"
 | |
|     "vleif  %%v26,11,3\n\t"
 | |
|     "vleif  %%v27,12,0\n\t"
 | |
|     "vleif  %%v27,13,1\n\t"
 | |
|     "vleif  %%v27,14,2\n\t"
 | |
|     "vleif  %%v27,15,3\n\t"
 | |
|     "srlg  %[n],%[n],5\n\t"
 | |
|     "xgr %%r1,%%r1\n\t"
 | |
|     "0:\n\t"
 | |
|     "pfd 1, 1024(%%r1,%[x])\n\t"
 | |
|     "vl    %%v16,0(%%r1,%[x])\n\t"
 | |
|     "vl    %%v28,16(%%r1,%[x])\n\t"
 | |
|     "vpkg  %%v17,%%v16,%%v28\n\t"
 | |
|     "vperm %%v16,%%v16,%%v28,%%v9\n\t"
 | |
|     "vl    %%v18,32(%%r1,%[x])\n\t"
 | |
|     "vl    %%v29,48(%%r1,%[x])\n\t"
 | |
|     "vpkg  %%v19,%%v18,%%v29\n\t"
 | |
|     "vperm %%v18,%%v18,%%v29,%%v9\n\t"
 | |
|     "vl    %%v20,64(%%r1,%[x])\n\t"
 | |
|     "vl    %%v30,80(%%r1,%[x])\n\t"
 | |
|     "vpkg  %%v21,%%v20,%%v30\n\t"
 | |
|     "vperm %%v20,%%v20,%%v30,%%v9\n\t"
 | |
|     "vl    %%v22,96(%%r1,%[x])\n\t"
 | |
|     "vl    %%v31,112(%%r1,%[x])\n\t"
 | |
|     "vpkg  %%v23,%%v22,%%v31\n\t"
 | |
|     "vperm %%v22,%%v22,%%v31,%%v9\n\t"
 | |
|     "vflpsb  %%v16, %%v16\n\t"
 | |
|     "vflpsb  %%v17, %%v17\n\t"
 | |
|     "vflpsb  %%v18, %%v18\n\t"
 | |
|     "vflpsb  %%v19, %%v19\n\t"
 | |
|     "vflpsb  %%v20, %%v20\n\t"
 | |
|     "vflpsb  %%v21, %%v21\n\t"
 | |
|     "vflpsb  %%v22, %%v22\n\t"
 | |
|     "vflpsb  %%v23, %%v23\n\t"
 | |
|     "vfasb %%v16,%%v16,%%v17\n\t"
 | |
|     "vfasb %%v17,%%v18,%%v19\n\t"
 | |
|     "vfasb %%v18,%%v20,%%v21\n\t"
 | |
|     "vfasb %%v19,%%v22,%%v23\n\t"
 | |
|     "vfchesb  %%v5,%%v16,%%v17\n\t"
 | |
|     "vfchesb  %%v6,%%v18,%%v19\n\t"
 | |
|     "vsel    %%v16,%%v16,%%v17,%%v5\n\t"
 | |
|     "vsel    %%v5,%%v24,%%v25,%%v5\n\t"
 | |
|     "vsel    %%v17,%%v18,%%v19,%%v6\n\t"
 | |
|     "vsel    %%v6,%%v26,%%v27,%%v6\n\t"
 | |
|     "vfchesb  %%v18,%%v16,%%v17\n\t"
 | |
|     "vsel    %%v16,%%v16,%%v17,%%v18\n\t"
 | |
|     "vsel    %%v5,%%v5,%%v6,%%v18\n\t"
 | |
|     "vsegf   %%v6,%%v5\n\t"
 | |
|     "vesrlg  %%v5,%%v5,32\n\t"
 | |
|     "vag     %%v5,%%v5,%%v4\n\t"
 | |
|     "vag     %%v6,%%v6,%%v4\n\t"
 | |
|     "vfchesb  %%v7,%%v0,%%v16\n\t"
 | |
|     "vsel    %%v0,%%v0,%%v16,%%v7\n\t"
 | |
|     "vsegf   %%v8,%%v7\n\t"
 | |
|     "vesrlg  %%v7,%%v7,32\n\t"
 | |
|     "vsegf   %%v7,%%v7\n\t"
 | |
|     "vsel    %%v1,%%v1,%%v5,%%v7\n\t"
 | |
|     "vsel    %%v2,%%v2,%%v6,%%v8\n\t"
 | |
|     "vag     %%v4,%%v4,%%v3\n\t"
 | |
|     "vl    %%v16,128(%%r1,%[x])\n\t"
 | |
|     "vl    %%v28,144(%%r1,%[x])\n\t"
 | |
|     "vpkg  %%v17,%%v16,%%v28\n\t"
 | |
|     "vperm %%v16,%%v16,%%v28,%%v9\n\t"
 | |
|     "vl    %%v18,160(%%r1,%[x])\n\t"
 | |
|     "vl    %%v29,176(%%r1,%[x])\n\t"
 | |
|     "vpkg  %%v19,%%v18,%%v29\n\t"
 | |
|     "vperm %%v18,%%v18,%%v29,%%v9\n\t"
 | |
|     "vl    %%v20,192(%%r1,%[x])\n\t"
 | |
|     "vl    %%v30,208(%%r1,%[x])\n\t"
 | |
|     "vpkg  %%v21,%%v20,%%v30\n\t"
 | |
|     "vperm %%v20,%%v20,%%v30,%%v9\n\t"
 | |
|     "vl    %%v22,224(%%r1,%[x])\n\t"
 | |
|     "vl    %%v31,240(%%r1,%[x])\n\t"
 | |
|     "vpkg  %%v23,%%v22,%%v31\n\t"
 | |
|     "vperm %%v22,%%v22,%%v31,%%v9\n\t"
 | |
|     "vflpsb  %%v16, %%v16\n\t"
 | |
|     "vflpsb  %%v17, %%v17\n\t"
 | |
|     "vflpsb  %%v18, %%v18\n\t"
 | |
|     "vflpsb  %%v19, %%v19\n\t"
 | |
|     "vflpsb  %%v20, %%v20\n\t"
 | |
|     "vflpsb  %%v21, %%v21\n\t"
 | |
|     "vflpsb  %%v22, %%v22\n\t"
 | |
|     "vflpsb  %%v23, %%v23\n\t"
 | |
|     "vfasb %%v16,%%v16,%%v17\n\t"
 | |
|     "vfasb %%v17,%%v18,%%v19\n\t"
 | |
|     "vfasb %%v18,%%v20,%%v21\n\t"
 | |
|     "vfasb %%v19,%%v22,%%v23\n\t"
 | |
|     "vfchesb  %%v5,%%v16,%%v17\n\t"
 | |
|     "vfchesb  %%v6,%%v18,%%v19\n\t"
 | |
|     "vsel    %%v16,%%v16,%%v17,%%v5\n\t"
 | |
|     "vsel    %%v5,%%v24,%%v25,%%v5\n\t"
 | |
|     "vsel    %%v17,%%v18,%%v19,%%v6\n\t"
 | |
|     "vsel    %%v6,%%v26,%%v27,%%v6\n\t"
 | |
|     "vfchesb  %%v18,%%v16,%%v17\n\t"
 | |
|     "vsel    %%v16,%%v16,%%v17,%%v18\n\t"
 | |
|     "vsel    %%v5,%%v5,%%v6,%%v18\n\t"
 | |
|     "vsegf   %%v6,%%v5\n\t"
 | |
|     "vesrlg  %%v5,%%v5,32\n\t"
 | |
|     "vag     %%v5,%%v5,%%v4\n\t"
 | |
|     "vag     %%v6,%%v6,%%v4\n\t"
 | |
|     "vfchesb  %%v7,%%v0,%%v16\n\t"
 | |
|     "vsel    %%v0,%%v0,%%v16,%%v7\n\t"
 | |
|     "vsegf   %%v8,%%v7\n\t"
 | |
|     "vesrlg  %%v7,%%v7,32\n\t"
 | |
|     "vsegf   %%v7,%%v7\n\t"
 | |
|     "vsel    %%v1,%%v1,%%v5,%%v7\n\t"
 | |
|     "vsel    %%v2,%%v2,%%v6,%%v8\n\t"
 | |
|     "vag     %%v4,%%v4,%%v3\n\t"
 | |
|     "agfi    %%r1, 256\n\t"
 | |
|     "brctg   %[n], 0b\n\t"
 | |
|     "veslg   %%v3,%%v0,32\n\t"
 | |
|     "vfchsb  %%v4,%%v0,%%v3\n\t"
 | |
|     "vchlg   %%v5,%%v2,%%v1\n\t"
 | |
|     "vfcesb  %%v6,%%v0,%%v3\n\t"
 | |
|     "vn      %%v5,%%v5,%%v6\n\t"
 | |
|     "vo      %%v4,%%v4,%%v5\n\t"
 | |
|     "vsel    %%v0,%%v0,%%v3,%%v4\n\t"
 | |
|     "vesrlg  %%v4,%%v4,32\n\t"
 | |
|     "vsegf   %%v4,%%v4\n\t"
 | |
|     "vsel    %%v1,%%v1,%%v2,%%v4\n\t"
 | |
|     "vrepf  %%v2,%%v0,2\n\t"
 | |
|     "vrepg  %%v3,%%v1,1\n\t"
 | |
|     "wfcsb  %%v2,%%v0\n\t"
 | |
|     "jne 1f\n\t"
 | |
|     "vstef  %%v0,%[amax],0\n\t"
 | |
|     "vmnlg  %%v0,%%v1,%%v3\n\t"
 | |
|     "vlgvg  %[iamax],%%v0,0\n\t"
 | |
|     "j 2f\n\t"
 | |
|     "1:\n\t"
 | |
|     "wfchsb %%v4,%%v2,%%v0\n\t"
 | |
|     "vesrlg %%v4,%%v4,32\n\t"
 | |
|     "vsegf  %%v4,%%v4\n\t"
 | |
|     "vsel   %%v1,%%v3,%%v1,%%v4\n\t"
 | |
|     "vsel   %%v0,%%v2,%%v0,%%v4\n\t"
 | |
|     "ste    %%f0,%[amax]\n\t"
 | |
|     "vlgvg  %[iamax],%%v1,0\n\t"
 | |
|     "2:\n\t"
 | |
|     "nop 0"
 | |
|     : [iamax] "=r"(iamax),[amax] "=Q"(*amax),[n] "+&r"(n)
 | |
|     : "m"(*(const FLOAT (*)[n * 2]) x),[x] "a"(x)
 | |
|     : "cc", "r1", "v0", "v1", "v2", "v3", "v4", "v5", "v6", "v7", "v8",
 | |
|        "v9", "v16", "v17", "v18", "v19", "v20", "v21", "v22", "v23", "v24",
 | |
|        "v25", "v26", "v27", "v28", "v29", "v30", "v31");
 | |
| 
 | |
|   return iamax;
 | |
| }
 | |
| 
 | |
| BLASLONG CNAME(BLASLONG n, FLOAT *x, BLASLONG inc_x) {
 | |
|   BLASLONG i = 0;
 | |
|   BLASLONG ix = 0;
 | |
|   FLOAT maxf = 0;
 | |
|   BLASLONG max = 0;
 | |
|   BLASLONG inc_x2;
 | |
| 
 | |
|   if (n <= 0 || inc_x <= 0)
 | |
|     return (max);
 | |
| 
 | |
|   if (inc_x == 1) {
 | |
| 
 | |
|     BLASLONG n1 = n & -32;
 | |
|     if (n1 > 0) {
 | |
| 
 | |
|       max = icamax_kernel_32(n1, x, &maxf);
 | |
|       ix = n1 * 2;
 | |
|       i = n1;
 | |
|     } else {
 | |
|       maxf = CABS1(x, 0);
 | |
|       ix += 2;
 | |
|       i++;
 | |
|     }
 | |
| 
 | |
|     while (i < n) {
 | |
|       if (CABS1(x, ix) > maxf) {
 | |
|         max = i;
 | |
|         maxf = CABS1(x, ix);
 | |
|       }
 | |
|       ix += 2;
 | |
|       i++;
 | |
|     }
 | |
|     return (max + 1);
 | |
| 
 | |
|   } else {
 | |
| 
 | |
|     max = 0;
 | |
|     maxf = CABS1(x, 0);
 | |
|     inc_x2 = 2 * inc_x;
 | |
| 
 | |
|     BLASLONG n1 = n & -4;
 | |
|     while (i < n1) {
 | |
| 
 | |
|       if (CABS1(x, ix) > maxf) {
 | |
|         max = i;
 | |
|         maxf = CABS1(x, ix);
 | |
|       }
 | |
|       if (CABS1(x, ix + inc_x2) > maxf) {
 | |
|         max = i + 1;
 | |
|         maxf = CABS1(x, ix + inc_x2);
 | |
|       }
 | |
|       if (CABS1(x, ix + 2 * inc_x2) > maxf) {
 | |
|         max = i + 2;
 | |
|         maxf = CABS1(x, ix + 2 * inc_x2);
 | |
|       }
 | |
|       if (CABS1(x, ix + 3 * inc_x2) > maxf) {
 | |
|         max = i + 3;
 | |
|         maxf = CABS1(x, ix + 3 * inc_x2);
 | |
|       }
 | |
| 
 | |
|       ix += inc_x2 * 4;
 | |
| 
 | |
|       i += 4;
 | |
| 
 | |
|     }
 | |
| 
 | |
|     while (i < n) {
 | |
|       if (CABS1(x, ix) > maxf) {
 | |
|         max = i;
 | |
|         maxf = CABS1(x, ix);
 | |
|       }
 | |
|       ix += inc_x2;
 | |
|       i++;
 | |
|     }
 | |
|     return (max + 1);
 | |
|   }
 | |
| }
 |