floraachy
/
OpenBLAS
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity
OpenBLAS/lapack/laswp/generic/laswp_k_8.c

1480 lines
23 KiB
C
Raw Blame History

/*********************************************************************/
/* 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. */
/*********************************************************************/
#include <stdio.h>
#include "common.h"
#ifndef MINUS
#define a2 (a1 + 1)
#define a4 (a3 + 1)
#define a6 (a5 + 1)
#define a8 (a7 + 1)
#define a10 (a9 + 1)
#define a12 (a11 + 1)
#define a14 (a13 + 1)
#define a16 (a15 + 1)
#else
#define a2 (a1 - 1)
#define a4 (a3 - 1)
#define a6 (a5 - 1)
#define a8 (a7 - 1)
#define a10 (a9 - 1)
#define a12 (a11 - 1)
#define a14 (a13 - 1)
#define a16 (a15 - 1)
#endif
int CNAME(BLASLONG n, BLASLONG k1, BLASLONG k2, FLOAT dummy1, FLOAT *a, BLASLONG lda,
FLOAT *dummy2, BLASLONG dumy3, blasint *ipiv, BLASLONG incx){
BLASLONG i, j, ip1, ip2, rows;
blasint *piv;
FLOAT *a1, *a3, *a5, *a7;
FLOAT *a9, *a11, *a13, *a15;
FLOAT *b1, *b2, *b3, *b4;
FLOAT *b5, *b6, *b7, *b8;
FLOAT *b9, *b10, *b11, *b12;
FLOAT *b13, *b14, *b15, *b16;
FLOAT A1, A2, B1, B2, A3, A4, B3, B4;
FLOAT A5, A6, B5, B6, A7, A8, B7, B8;
FLOAT A9, A10, B9, B10, A11, A12, B11, B12;
FLOAT A13, A14, B13, B14, A15, A16, B15, B16;
a--;
k1 --;
#ifndef MINUS
ipiv += k1;
#else
ipiv -= (k2 - 1) * incx;
#endif
if (n <= 0) return 0;
rows = k2-k1;
if (rows <=0) return 0;
if (rows == 1) {
//Only have 1 row
ip1 = *ipiv;
a1 = a + k1 + 1;
b1 = a + ip1;
if(a1 == b1) return 0;
for(j=0; j<n; j++){
A1 = *a1;
B1 = *b1;
*a1 = B1;
*b1 = A1;
a1 += lda;
b1 += lda;
}
return 0;
}
j = (n >> 3);
if (j > 0) {
do {
piv = ipiv;
#ifndef MINUS
a1 = a + k1 + 1;
#else
a1 = a + k2;
#endif
a3 = a1 + 1 * lda;
a5 = a1 + 2 * lda;
a7 = a1 + 3 * lda;
a9 = a1 + 4 * lda;
a11 = a1 + 5 * lda;
a13 = a1 + 6 * lda;
a15 = a1 + 7 * lda;
ip1 = *piv;
piv += incx;
ip2 = *piv;
piv += incx;
b1 = a + ip1;
b2 = a + ip2;
b3 = b1 + 1 * lda;
b4 = b2 + 1 * lda;
b5 = b1 + 2 * lda;
b6 = b2 + 2 * lda;
b7 = b1 + 3 * lda;
b8 = b2 + 3 * lda;
b9 = b1 + 4 * lda;
b10 = b2 + 4 * lda;
b11 = b1 + 5 * lda;
b12 = b2 + 5 * lda;
b13 = b1 + 6 * lda;
b14 = b2 + 6 * lda;
b15 = b1 + 7 * lda;
b16 = b2 + 7 * lda;
i = (rows >> 1);
i--;
//Loop pipeline
//Main Loop
while (i > 0) {
B1 = *b1;
B2 = *b2;
B3 = *b3;
B4 = *b4;
B5 = *b5;
B6 = *b6;
B7 = *b7;
B8 = *b8;
B9 = *b9;
B10 = *b10;
B11 = *b11;
B12 = *b12;
B13 = *b13;
B14 = *b14;
B15 = *b15;
B16 = *b16;
A1 = *a1;
A2 = *a2;
A3 = *a3;
A4 = *a4;
A5 = *a5;
A6 = *a6;
A7 = *a7;
A8 = *a8;
A9 = *a9;
A10 = *a10;
A11 = *a11;
A12 = *a12;
A13 = *a13;
A14 = *a14;
A15 = *a15;
A16 = *a16;
ip1 = *piv;
piv += incx;
ip2 = *piv;
piv += incx;
if (b1 == a1) {
if (b2 == a1) {
*a1 = A2;
*a2 = A1;
*a3 = A4;
*a4 = A3;
*a5 = A6;
*a6 = A5;
*a7 = A8;
*a8 = A7;
*a9 = A10;
*a10 = A9;
*a11 = A12;
*a12 = A11;
*a13 = A14;
*a14 = A13;
*a15 = A16;
*a16 = A15;
} else
if (b2 != a2) {
*a2 = B2;
*b2 = A2;
*a4 = B4;
*b4 = A4;
*a6 = B6;
*b6 = A6;
*a8 = B8;
*b8 = A8;
*a10 = B10;
*b10 = A10;
*a12 = B12;
*b12 = A12;
*a14 = B14;
*b14 = A14;
*a16 = B16;
*b16 = A16;
}
} else
if (b1 == a2) {
if (b2 != a1) {
if (b2 == a2) {
*a1 = A2;
*a2 = A1;
*a3 = A4;
*a4 = A3;
*a5 = A6;
*a6 = A5;
*a7 = A8;
*a8 = A7;
*a9 = A10;
*a10 = A9;
*a11 = A12;
*a12 = A11;
*a13 = A14;
*a14 = A13;
*a15 = A16;
*a16 = A15;
} else {
*a1 = A2;
*a2 = B2;
*b2 = A1;
*a3 = A4;
*a4 = B4;
*b4 = A3;
*a5 = A6;
*a6 = B6;
*b6 = A5;
*a7 = A8;
*a8 = B8;
*b8 = A7;
*a9 = A10;
*a10 = B10;
*b10 = A9;
*a11 = A12;
*a12 = B12;
*b12 = A11;
*a13 = A14;
*a14 = B14;
*b14 = A13;
*a15 = A16;
*a16 = B16;
*b16 = A15;
}
}
} else {
if (b2 == a1) {
*a1 = A2;
*a2 = B1;
*b1 = A1;
*a3 = A4;
*a4 = B3;
*b3 = A3;
*a5 = A6;
*a6 = B5;
*b5 = A5;
*a7 = A8;
*a8 = B7;
*b7 = A7;
*a9 = A10;
*a10 = B9;
*b9 = A9;
*a11 = A12;
*a12 = B11;
*b11 = A11;
*a13 = A14;
*a14 = B13;
*b13 = A13;
*a15 = A16;
*a16 = B15;
*b15 = A15;
} else
if (b2 == a2) {
*a1 = B1;
*b1 = A1;
*a3 = B3;
*b3 = A3;
*a5 = B5;
*b5 = A5;
*a7 = B7;
*b7 = A7;
*a9 = B9;
*b9 = A9;
*a11 = B11;
*b11 = A11;
*a13 = B13;
*b13 = A13;
*a15 = B15;
*b15 = A15;
} else
if (b2 == b1) {
*a1 = B1;
*a2 = A1;
*b1 = A2;
*a3 = B3;
*a4 = A3;
*b3 = A4;
*a5 = B5;
*a6 = A5;
*b5 = A6;
*a7 = B7;
*a8 = A7;
*b7 = A8;
*a9 = B9;
*a10 = A9;
*b9 = A10;
*a11 = B11;
*a12 = A11;
*b11 = A12;
*a13 = B13;
*a14 = A13;
*b13 = A14;
*a15 = B15;
*a16 = A15;
*b15 = A16;
} else {
*a1 = B1;
*a2 = B2;
*b1 = A1;
*b2 = A2;
*a3 = B3;
*a4 = B4;
*b3 = A3;
*b4 = A4;
*a5 = B5;
*a6 = B6;
*b5 = A5;
*b6 = A6;
*a7 = B7;
*a8 = B8;
*b7 = A7;
*b8 = A8;
*a9 = B9;
*a10 = B10;
*b9 = A9;
*b10 = A10;
*a11 = B11;
*a12 = B12;
*b11 = A11;
*b12 = A12;
*a13 = B13;
*a14 = B14;
*b13 = A13;
*b14 = A14;
*a15 = B15;
*a16 = B16;
*b15 = A15;
*b16 = A16;
}
}
b1 = a + ip1;
b2 = a + ip2;
b3 = b1 + 1 * lda;
b4 = b2 + 1 * lda;
b5 = b1 + 2 * lda;
b6 = b2 + 2 * lda;
b7 = b1 + 3 * lda;
b8 = b2 + 3 * lda;
b9 = b1 + 4 * lda;
b10 = b2 + 4 * lda;
b11 = b1 + 5 * lda;
b12 = b2 + 5 * lda;
b13 = b1 + 6 * lda;
b14 = b2 + 6 * lda;
b15 = b1 + 7 * lda;
b16 = b2 + 7 * lda;
#ifndef MINUS
a1 += 2;
a3 += 2;
a5 += 2;
a7 += 2;
a9 += 2;
a11 += 2;
a13 += 2;
a15 += 2;
#else
a1 -= 2;
a3 -= 2;
a5 -= 2;
a7 -= 2;
a9 -= 2;
a11 -= 2;
a13 -= 2;
a15 -= 2;
#endif
i --;
}
//Loop Ending
B1 = *b1;
B2 = *b2;
B3 = *b3;
B4 = *b4;
B5 = *b5;
B6 = *b6;
B7 = *b7;
B8 = *b8;
B9 = *b9;
B10 = *b10;
B11 = *b11;
B12 = *b12;
B13 = *b13;
B14 = *b14;
B15 = *b15;
B16 = *b16;
A1 = *a1;
A2 = *a2;
A3 = *a3;
A4 = *a4;
A5 = *a5;
A6 = *a6;
A7 = *a7;
A8 = *a8;
A9 = *a9;
A10 = *a10;
A11 = *a11;
A12 = *a12;
A13 = *a13;
A14 = *a14;
A15 = *a15;
A16 = *a16;
if (b1 == a1) {
if (b2 == a1) {
*a1 = A2;
*a2 = A1;
*a3 = A4;
*a4 = A3;
*a5 = A6;
*a6 = A5;
*a7 = A8;
*a8 = A7;
*a9 = A10;
*a10 = A9;
*a11 = A12;
*a12 = A11;
*a13 = A14;
*a14 = A13;
*a15 = A16;
*a16 = A15;
} else
if (b2 != a2) {
*a2 = B2;
*b2 = A2;
*a4 = B4;
*b4 = A4;
*a6 = B6;
*b6 = A6;
*a8 = B8;
*b8 = A8;
*a10 = B10;
*b10 = A10;
*a12 = B12;
*b12 = A12;
*a14 = B14;
*b14 = A14;
*a16 = B16;
*b16 = A16;
}
} else
if (b1 == a2) {
if (b2 != a1) {
if (b2 == a2) {
*a1 = A2;
*a2 = A1;
*a3 = A4;
*a4 = A3;
*a5 = A6;
*a6 = A5;
*a7 = A8;
*a8 = A7;
*a9 = A10;
*a10 = A9;
*a11 = A12;
*a12 = A11;
*a13 = A14;
*a14 = A13;
*a15 = A16;
*a16 = A15;
} else {
*a1 = A2;
*a2 = B2;
*b2 = A1;
*a3 = A4;
*a4 = B4;
*b4 = A3;
*a5 = A6;
*a6 = B6;
*b6 = A5;
*a7 = A8;
*a8 = B8;
*b8 = A7;
*a9 = A10;
*a10 = B10;
*b10 = A9;
*a11 = A12;
*a12 = B12;
*b12 = A11;
*a13 = A14;
*a14 = B14;
*b14 = A13;
*a15 = A16;
*a16 = B16;
*b16 = A15;
}
}
} else {
if (b2 == a1) {
*a1 = A2;
*a2 = B1;
*b1 = A1;
*a3 = A4;
*a4 = B3;
*b3 = A3;
*a5 = A6;
*a6 = B5;
*b5 = A5;
*a7 = A8;
*a8 = B7;
*b7 = A7;
*a9 = A10;
*a10 = B9;
*b9 = A9;
*a11 = A12;
*a12 = B11;
*b11 = A11;
*a13 = A14;
*a14 = B13;
*b13 = A13;
*a15 = A16;
*a16 = B15;
*b15 = A15;
} else
if (b2 == a2) {
*a1 = B1;
*b1 = A1;
*a3 = B3;
*b3 = A3;
*a5 = B5;
*b5 = A5;
*a7 = B7;
*b7 = A7;
*a9 = B9;
*b9 = A9;
*a11 = B11;
*b11 = A11;
*a13 = B13;
*b13 = A13;
*a15 = B15;
*b15 = A15;
} else
if (b2 == b1) {
*a1 = B1;
*a2 = A1;
*b1 = A2;
*a3 = B3;
*a4 = A3;
*b3 = A4;
*a5 = B5;
*a6 = A5;
*b5 = A6;
*a7 = B7;
*a8 = A7;
*b7 = A8;
*a9 = B9;
*a10 = A9;
*b9 = A10;
*a11 = B11;
*a12 = A11;
*b11 = A12;
*a13 = B13;
*a14 = A13;
*b13 = A14;
*a15 = B15;
*a16 = A15;
*b15 = A16;
} else {
*a1 = B1;
*a2 = B2;
*b1 = A1;
*b2 = A2;
*a3 = B3;
*a4 = B4;
*b3 = A3;
*b4 = A4;
*a5 = B5;
*a6 = B6;
*b5 = A5;
*b6 = A6;
*a7 = B7;
*a8 = B8;
*b7 = A7;
*b8 = A8;
*a9 = B9;
*a10 = B10;
*b9 = A9;
*b10 = A10;
*a11 = B11;
*a12 = B12;
*b11 = A11;
*b12 = A12;
*a13 = B13;
*a14 = B14;
*b13 = A13;
*b14 = A14;
*a15 = B15;
*a16 = B16;
*b15 = A15;
*b16 = A16;
}
}
#ifndef MINUS
a1 += 2;
a3 += 2;
a5 += 2;
a7 += 2;
a9 += 2;
a11 += 2;
a13 += 2;
a15 += 2;
#else
a1 -= 2;
a3 -= 2;
a5 -= 2;
a7 -= 2;
a9 -= 2;
a11 -= 2;
a13 -= 2;
a15 -= 2;
#endif
//Remain
i = (rows & 1);
if (i > 0) {
ip1 = *piv;
b1 = a + ip1;
b3 = b1 + 1 * lda;
b5 = b1 + 2 * lda;
b7 = b1 + 3 * lda;
b9 = b1 + 4 * lda;
b11 = b1 + 5 * lda;
b13 = b1 + 6 * lda;
b15 = b1 + 7 * lda;
A1 = *a1;
B1 = *b1;
A3 = *a3;
B3 = *b3;
A5 = *a5;
B5 = *b5;
A7 = *a7;
B7 = *b7;
A9 = *a9;
B9 = *b9;
A11 = *a11;
B11 = *b11;
A13 = *a13;
B13 = *b13;
A15 = *a15;
B15 = *b15;
*a1 = B1;
*b1 = A1;
*a3 = B3;
*b3 = A3;
*a5 = B5;
*b5 = A5;
*a7 = B7;
*b7 = A7;
*a9 = B9;
*b9 = A9;
*a11 = B11;
*b11 = A11;
*a13 = B13;
*b13 = A13;
*a15 = B15;
*b15 = A15;
}
a += 8 * lda;
j --;
} while (j > 0);
}
if (n & 4) {
piv = ipiv;
#ifndef MINUS
a1 = a + k1 + 1;
#else
a1 = a + k2;
#endif
a3 = a1 + 1 * lda;
a5 = a1 + 2 * lda;
a7 = a1 + 3 * lda;
ip1 = *piv;
piv += incx;
ip2 = *piv;
piv += incx;
b1 = a + ip1;
b2 = a + ip2;
b3 = b1 + 1 * lda;
b4 = b2 + 1 * lda;
b5 = b1 + 2 * lda;
b6 = b2 + 2 * lda;
b7 = b1 + 3 * lda;
b8 = b2 + 3 * lda;
i = (rows >> 1);
i --;
while (i > 0) {
A1 = *a1;
A2 = *a2;
A3 = *a3;
A4 = *a4;
A5 = *a5;
A6 = *a6;
A7 = *a7;
A8 = *a8;
B1 = *b1;
B2 = *b2;
B3 = *b3;
B4 = *b4;
B5 = *b5;
B6 = *b6;
B7 = *b7;
B8 = *b8;
ip1 = *piv;
piv += incx;
ip2 = *piv;
piv += incx;
if (b1 == a1) {
if (b2 == a1) {
*a1 = A2;
*a2 = A1;
*a3 = A4;
*a4 = A3;
*a5 = A6;
*a6 = A5;
*a7 = A8;
*a8 = A7;
} else
if (b2 != a2) {
*a2 = B2;
*b2 = A2;
*a4 = B4;
*b4 = A4;
*a6 = B6;
*b6 = A6;
*a8 = B8;
*b8 = A8;
}
} else
if (b1 == a2) {
if (b2 != a1) {
if (b2 == a2) {
*a1 = A2;
*a2 = A1;
*a3 = A4;
*a4 = A3;
*a5 = A6;
*a6 = A5;
*a7 = A8;
*a8 = A7;
} else {
*a1 = A2;
*a2 = B2;
*b2 = A1;
*a3 = A4;
*a4 = B4;
*b4 = A3;
*a5 = A6;
*a6 = B6;
*b6 = A5;
*a7 = A8;
*a8 = B8;
*b8 = A7;
}
}
} else {
if (b2 == a1) {
*a1 = A2;
*a2 = B1;
*b1 = A1;
*a3 = A4;
*a4 = B3;
*b3 = A3;
*a5 = A6;
*a6 = B5;
*b5 = A5;
*a7 = A8;
*a8 = B7;
*b7 = A7;
} else
if (b2 == a2) {
*a1 = B1;
*b1 = A1;
*a3 = B3;
*b3 = A3;
*a5 = B5;
*b5 = A5;
*a7 = B7;
*b7 = A7;
} else
if (b2 == b1) {
*a1 = B1;
*a2 = A1;
*b1 = A2;
*a3 = B3;
*a4 = A3;
*b3 = A4;
*a5 = B5;
*a6 = A5;
*b5 = A6;
*a7 = B7;
*a8 = A7;
*b7 = A8;
} else {
*a1 = B1;
*a2 = B2;
*b1 = A1;
*b2 = A2;
*a3 = B3;
*a4 = B4;
*b3 = A3;
*b4 = A4;
*a5 = B5;
*a6 = B6;
*b5 = A5;
*b6 = A6;
*a7 = B7;
*a8 = B8;
*b7 = A7;
*b8 = A8;
}
}
b1 = a + ip1;
b2 = a + ip2;
b3 = b1 + 1 * lda;
b4 = b2 + 1 * lda;
b5 = b1 + 2 * lda;
b6 = b2 + 2 * lda;
b7 = b1 + 3 * lda;
b8 = b2 + 3 * lda;
#ifndef MINUS
a1 += 2;
a3 += 2;
a5 += 2;
a7 += 2;
#else
a1 -= 2;
a3 -= 2;
a5 -= 2;
a7 -= 2;
#endif
i --;
}
A1 = *a1;
A2 = *a2;
A3 = *a3;
A4 = *a4;
A5 = *a5;
A6 = *a6;
A7 = *a7;
A8 = *a8;
B1 = *b1;
B2 = *b2;
B3 = *b3;
B4 = *b4;
B5 = *b5;
B6 = *b6;
B7 = *b7;
B8 = *b8;
if (b1 == a1) {
if (b2 == a1) {
*a1 = A2;
*a2 = A1;
*a3 = A4;
*a4 = A3;
*a5 = A6;
*a6 = A5;
*a7 = A8;
*a8 = A7;
} else
if (b2 != a2) {
*a2 = B2;
*b2 = A2;
*a4 = B4;
*b4 = A4;
*a6 = B6;
*b6 = A6;
*a8 = B8;
*b8 = A8;
}
} else
if (b1 == a2) {
if (b2 != a1) {
if (b2 == a2) {
*a1 = A2;
*a2 = A1;
*a3 = A4;
*a4 = A3;
*a5 = A6;
*a6 = A5;
*a7 = A8;
*a8 = A7;
} else {
*a1 = A2;
*a2 = B2;
*b2 = A1;
*a3 = A4;
*a4 = B4;
*b4 = A3;
*a5 = A6;
*a6 = B6;
*b6 = A5;
*a7 = A8;
*a8 = B8;
*b8 = A7;
}
}
} else {
if (b2 == a1) {
*a1 = A2;
*a2 = B1;
*b1 = A1;
*a3 = A4;
*a4 = B3;
*b3 = A3;
*a5 = A6;
*a6 = B5;
*b5 = A5;
*a7 = A8;
*a8 = B7;
*b7 = A7;
} else
if (b2 == a2) {
*a1 = B1;
*b1 = A1;
*a3 = B3;
*b3 = A3;
*a5 = B5;
*b5 = A5;
*a7 = B7;
*b7 = A7;
} else
if (b2 == b1) {
*a1 = B1;
*a2 = A1;
*b1 = A2;
*a3 = B3;
*a4 = A3;
*b3 = A4;
*a5 = B5;
*a6 = A5;
*b5 = A6;
*a7 = B7;
*a8 = A7;
*b7 = A8;
} else {
*a1 = B1;
*a2 = B2;
*b1 = A1;
*b2 = A2;
*a3 = B3;
*a4 = B4;
*b3 = A3;
*b4 = A4;
*a5 = B5;
*a6 = B6;
*b5 = A5;
*b6 = A6;
*a7 = B7;
*a8 = B8;
*b7 = A7;
*b8 = A8;
}
}
#ifndef MINUS
a1 += 2;
a3 += 2;
a5 += 2;
a7 += 2;
#else
a1 -= 2;
a3 -= 2;
a5 -= 2;
a7 -= 2;
#endif
i = (rows & 1);
if (i > 0) {
ip1 = *piv;
b1 = a + ip1;
b3 = b1 + 1 * lda;
b5 = b1 + 2 * lda;
b7 = b1 + 3 * lda;
A1 = *a1;
B1 = *b1;
A3 = *a3;
B3 = *b3;
A5 = *a5;
B5 = *b5;
A7 = *a7;
B7 = *b7;
*a1 = B1;
*b1 = A1;
*a3 = B3;
*b3 = A3;
*a5 = B5;
*b5 = A5;
*a7 = B7;
*b7 = A7;
}
a += 4 * lda;
}
if (n & 2) {
piv = ipiv;
#ifndef MINUS
a1 = a + k1 + 1;
#else
a1 = a + k2;
#endif
a3 = a1 + 1 * lda;
ip1 = *piv;
piv += incx;
ip2 = *piv;
piv += incx;
b1 = a + ip1;
b2 = a + ip2;
b3 = b1 + 1 * lda;
b4 = b2 + 1 * lda;
i = ((rows) >> 1);
i--;
while (i > 0) {
A1 = *a1;
A2 = *a2;
A3 = *a3;
A4 = *a4;
B1 = *b1;
B2 = *b2;
B3 = *b3;
B4 = *b4;
ip1 = *piv;
piv += incx;
ip2 = *piv;
piv += incx;
if (b1 == a1) {
if (b2 == a1) {
*a1 = A2;
*a2 = A1;
*a3 = A4;
*a4 = A3;
} else
if (b2 != a2) {
*a2 = B2;
*b2 = A2;
*a4 = B4;
*b4 = A4;
}
} else
if (b1 == a2) {
if (b2 != a1) {
if (b2 == a2) {
*a1 = A2;
*a2 = A1;
*a3 = A4;
*a4 = A3;
} else {
*a1 = A2;
*a2 = B2;
*b2 = A1;
*a3 = A4;
*a4 = B4;
*b4 = A3;
}
}
} else {
if (b2 == a1) {
*a1 = A2;
*a2 = B1;
*b1 = A1;
*a3 = A4;
*a4 = B3;
*b3 = A3;
} else
if (b2 == a2) {
*a1 = B1;
*b1 = A1;
*a3 = B3;
*b3 = A3;
} else
if (b2 == b1) {
*a1 = B1;
*a2 = A1;
*b1 = A2;
*a3 = B3;
*a4 = A3;
*b3 = A4;
} else {
*a1 = B1;
*a2 = B2;
*b1 = A1;
*b2 = A2;
*a3 = B3;
*a4 = B4;
*b3 = A3;
*b4 = A4;
}
}
b1 = a + ip1;
b2 = a + ip2;
b3 = b1 + 1 * lda;
b4 = b2 + 1 * lda;
#ifndef MINUS
a1 += 2;
a3 += 2;
#else
a1 -= 2;
a3 -= 2;
#endif
i --;
}
//Loop Ending
B1 = *b1;
B2 = *b2;
B3 = *b3;
B4 = *b4;
A1 = *a1;
A2 = *a2;
A3 = *a3;
A4 = *a4;
if (b1 == a1) {
if (b2 == a1) {
*a1 = A2;
*a2 = A1;
*a3 = A4;
*a4 = A3;
} else
if (b2 != a2) {
*a2 = B2;
*b2 = A2;
*a4 = B4;
*b4 = A4;
}
} else
if (b1 == a2) {
if (b2 != a1) {
if (b2 == a2) {
*a1 = A2;
*a2 = A1;
*a3 = A4;
*a4 = A3;
} else {
*a1 = A2;
*a2 = B2;
*b2 = A1;
*a3 = A4;
*a4 = B4;
*b4 = A3;
}
}
} else {
if (b2 == a1) {
*a1 = A2;
*a2 = B1;
*b1 = A1;
*a3 = A4;
*a4 = B3;
*b3 = A3;
} else
if (b2 == a2) {
*a1 = B1;
*b1 = A1;
*a3 = B3;
*b3 = A3;
} else
if (b2 == b1) {
*a1 = B1;
*a2 = A1;
*b1 = A2;
*a3 = B3;
*a4 = A3;
*b3 = A4;
} else {
*a1 = B1;
*a2 = B2;
*b1 = A1;
*b2 = A2;
*a3 = B3;
*a4 = B4;
*b3 = A3;
*b4 = A4;
}
}
#ifndef MINUS
a1 += 2;
a3 += 2;
#else
a1 -= 2;
a3 -= 2;
#endif
i = ((rows) & 1);
if (i > 0) {
ip1 = *piv;
b1 = a + ip1;
b3 = b1 + 1 * lda;
A1 = *a1;
B1 = *b1;
A3 = *a3;
B3 = *b3;
*a1 = B1;
*b1 = A1;
*a3 = B3;
*b3 = A3;
}
a += 2 * lda;
}
if (n & 1) {
piv = ipiv;
#ifndef MINUS
a1 = a + k1 + 1;
#else
a1 = a + k2;
#endif
ip1 = *piv;
piv += incx;
ip2 = *piv;
piv += incx;
b1 = a + ip1;
b2 = a + ip2;
i = ((rows) >> 1);
i --;
while (i > 0) {
A1 = *a1;
A2 = *a2;
B1 = *b1;
B2 = *b2;
ip1 = *piv;
piv += incx;
ip2 = *piv;
piv += incx;
if (b1 == a1) {
if (b2 == a1) {
*a1 = A2;
*a2 = A1;
} else
if (b2 != a2) {
*a2 = B2;
*b2 = A2;
}
} else
if (b1 == a2) {
if (b2 != a1) {
if (b2 == a2) {
*a1 = A2;
*a2 = A1;
} else {
*a1 = A2;
*a2 = B2;
*b2 = A1;
}
}
} else {
if (b2 == a1) {
*a1 = A2;
*a2 = B1;
*b1 = A1;
} else
if (b2 == a2) {
*a1 = B1;
*b1 = A1;
} else
if (b2 == b1) {
*a1 = B1;
*a2 = A1;
*b1 = A2;
} else {
*a1 = B1;
*a2 = B2;
*b1 = A1;
*b2 = A2;
}
}
b1 = a + ip1;
b2 = a + ip2;
#ifndef MINUS
a1 += 2;
#else
a1 -= 2;
#endif
i --;
}
//Loop Ending (n=1)
A1 = *a1;
A2 = *a2;
B1 = *b1;
B2 = *b2;
if (b1 == a1) {
if (b2 == a1) {
*a1 = A2;
*a2 = A1;
} else
if (b2 != a2) {
*a2 = B2;
*b2 = A2;
}
} else
if (b1 == a2) {
if (b2 != a1) {
if (b2 == a2) {
*a1 = A2;
*a2 = A1;
} else {
*a1 = A2;
*a2 = B2;
*b2 = A1;
}
}
} else {
if (b2 == a1) {
*a1 = A2;
*a2 = B1;
*b1 = A1;
} else
if (b2 == a2) {
*a1 = B1;
*b1 = A1;
} else
if (b2 == b1) {
*a1 = B1;
*a2 = A1;
*b1 = A2;
} else {
*a1 = B1;
*a2 = B2;
*b1 = A1;
*b2 = A2;
}
}
#ifndef MINUS
a1 += 2;
#else
a1 -= 2;
#endif
//Remain
i = (rows & 1);
if (i > 0) {
ip1 = *piv;
b1 = a + ip1;
A1 = *a1;
B1 = *b1;
*a1 = B1;
*b1 = A1;
}
}
return 0;
}
Reference in New Issue View Git Blame Copy Permalink