mirror of
https://github.com/tildearrow/furnace.git
synced 2024-11-16 09:45:06 +00:00
299 lines
8.2 KiB
C
299 lines
8.2 KiB
C
/*
|
|
* Copyright (c) 2003, 2007-14 Matteo Frigo
|
|
* Copyright (c) 2003, 2007-14 Massachusetts Institute of Technology
|
|
*
|
|
* VSX SIMD implementation added 2015 Erik Lindahl.
|
|
* Erik Lindahl places his modifications in the public domain.
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; either version 2 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, write to the Free Software
|
|
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
|
|
*
|
|
*/
|
|
|
|
#if defined(FFTW_LDOUBLE) || defined(FFTW_QUAD)
|
|
# error "VSX only works in single or double precision"
|
|
#endif
|
|
|
|
#ifdef FFTW_SINGLE
|
|
# define DS(d,s) s /* single-precision option */
|
|
# define SUFF(name) name ## s
|
|
#else
|
|
# define DS(d,s) d /* double-precision option */
|
|
# define SUFF(name) name ## d
|
|
#endif
|
|
|
|
#define SIMD_SUFFIX _vsx /* for renaming */
|
|
#define VL DS(1,2) /* SIMD vector length, in term of complex numbers */
|
|
#define SIMD_VSTRIDE_OKA(x) DS(SIMD_STRIDE_OKA(x),((x) == 2))
|
|
#define SIMD_STRIDE_OKPAIR SIMD_STRIDE_OK
|
|
|
|
#include <altivec.h>
|
|
#include <stdio.h>
|
|
|
|
typedef DS(vector double,vector float) V;
|
|
|
|
#define VADD(a,b) vec_add(a,b)
|
|
#define VSUB(a,b) vec_sub(a,b)
|
|
#define VMUL(a,b) vec_mul(a,b)
|
|
#define VXOR(a,b) vec_xor(a,b)
|
|
#define UNPCKL(a,b) vec_mergel(a,b)
|
|
#define UNPCKH(a,b) vec_mergeh(a,b)
|
|
#ifdef FFTW_SINGLE
|
|
# define VDUPL(a) ({ const vector unsigned char perm = {0,1,2,3,0,1,2,3,8,9,10,11,8,9,10,11}; vec_perm(a,a,perm); })
|
|
# define VDUPH(a) ({ const vector unsigned char perm = {4,5,6,7,4,5,6,7,12,13,14,15,12,13,14,15}; vec_perm(a,a,perm); })
|
|
#else
|
|
# define VDUPL(a) ({ const vector unsigned char perm = {0,1,2,3,4,5,6,7,0,1,2,3,4,5,6,7}; vec_perm(a,a,perm); })
|
|
# define VDUPH(a) ({ const vector unsigned char perm = {8,9,10,11,12,13,14,15,8,9,10,11,12,13,14,15}; vec_perm(a,a,perm); })
|
|
#endif
|
|
|
|
static inline V LDK(R f) { return vec_splats(f); }
|
|
|
|
#define DVK(var, val) const R var = K(val)
|
|
|
|
static inline V VCONJ(V x)
|
|
{
|
|
const V pmpm = vec_mergel(vec_splats((R)0.0),-(vec_splats((R)0.0)));
|
|
return vec_xor(x, pmpm);
|
|
}
|
|
|
|
static inline V LDA(const R *x, INT ivs, const R *aligned_like)
|
|
{
|
|
#ifdef __ibmxl__
|
|
return vec_xl(0,(DS(double,float) *)x);
|
|
#else
|
|
return (*(const V *)(x));
|
|
#endif
|
|
}
|
|
|
|
static inline void STA(R *x, V v, INT ovs, const R *aligned_like)
|
|
{
|
|
#ifdef __ibmxl__
|
|
vec_xst(v,0,x);
|
|
#else
|
|
*(V *)x = v;
|
|
#endif
|
|
}
|
|
|
|
static inline V FLIP_RI(V x)
|
|
{
|
|
#ifdef FFTW_SINGLE
|
|
const vector unsigned char perm = { 4,5,6,7,0,1,2,3,12,13,14,15,8,9,10,11 };
|
|
#else
|
|
const vector unsigned char perm = { 8,9,10,11,12,13,14,15,0,1,2,3,4,5,6,7 };
|
|
#endif
|
|
return vec_perm(x,x,perm);
|
|
}
|
|
|
|
#ifdef FFTW_SINGLE
|
|
|
|
static inline V LD(const R *x, INT ivs, const R *aligned_like)
|
|
{
|
|
const vector unsigned char perm = {0,1,2,3,4,5,6,7,16,17,18,19,20,21,22,23};
|
|
|
|
return vec_perm((vector float)vec_splats(*(double *)(x)),
|
|
(vector float)vec_splats(*(double *)(x+ivs)),perm);
|
|
}
|
|
|
|
static inline void ST(R *x, V v, INT ovs, const R *aligned_like)
|
|
{
|
|
*(double *)(x+ovs) = vec_extract( (vector double)v, 1 );
|
|
*(double *)x = vec_extract( (vector double)v, 0 );
|
|
}
|
|
#else
|
|
/* DOUBLE */
|
|
|
|
# define LD LDA
|
|
# define ST STA
|
|
|
|
#endif
|
|
|
|
#define STM2 DS(STA,ST)
|
|
#define STN2(x, v0, v1, ovs) /* nop */
|
|
|
|
#ifdef FFTW_SINGLE
|
|
|
|
# define STM4(x, v, ovs, aligned_like) /* no-op */
|
|
static inline void STN4(R *x, V v0, V v1, V v2, V v3, int ovs)
|
|
{
|
|
V xxx0, xxx1, xxx2, xxx3;
|
|
xxx0 = vec_mergeh(v0,v1);
|
|
xxx1 = vec_mergel(v0,v1);
|
|
xxx2 = vec_mergeh(v2,v3);
|
|
xxx3 = vec_mergel(v2,v3);
|
|
*(double *)x = vec_extract( (vector double)xxx0, 0 );
|
|
*(double *)(x+ovs) = vec_extract( (vector double)xxx0, 1 );
|
|
*(double *)(x+2*ovs) = vec_extract( (vector double)xxx1, 0 );
|
|
*(double *)(x+3*ovs) = vec_extract( (vector double)xxx1, 1 );
|
|
*(double *)(x+2) = vec_extract( (vector double)xxx2, 0 );
|
|
*(double *)(x+ovs+2) = vec_extract( (vector double)xxx2, 1 );
|
|
*(double *)(x+2*ovs+2) = vec_extract( (vector double)xxx3, 0 );
|
|
*(double *)(x+3*ovs+2) = vec_extract( (vector double)xxx3, 1 );
|
|
}
|
|
#else /* !FFTW_SINGLE */
|
|
|
|
static inline void STM4(R *x, V v, INT ovs, const R *aligned_like)
|
|
{
|
|
(void)aligned_like; /* UNUSED */
|
|
x[0] = vec_extract(v,0);
|
|
x[ovs] = vec_extract(v,1);
|
|
}
|
|
# define STN4(x, v0, v1, v2, v3, ovs) /* nothing */
|
|
#endif
|
|
|
|
static inline V VBYI(V x)
|
|
{
|
|
/* FIXME [matteof 2017-09-21] It is possible to use vpermxor(),
|
|
but gcc and xlc treat the permutation bits differently, and
|
|
gcc-6 seems to generate incorrect code when using
|
|
__builtin_crypto_vpermxor() (i.e., VBYI() works for a small
|
|
test case but fails in the large).
|
|
|
|
Punt on vpermxor() for now and do the simple thing.
|
|
*/
|
|
return FLIP_RI(VCONJ(x));
|
|
}
|
|
|
|
/* FMA support */
|
|
#define VFMA(a, b, c) vec_madd(a,b,c)
|
|
#define VFNMS(a, b, c) vec_nmsub(a,b,c)
|
|
#define VFMS(a, b, c) vec_msub(a,b,c)
|
|
#define VFMAI(b, c) VADD(c, VBYI(b))
|
|
#define VFNMSI(b, c) VSUB(c, VBYI(b))
|
|
#define VFMACONJ(b,c) VADD(VCONJ(b),c)
|
|
#define VFMSCONJ(b,c) VSUB(VCONJ(b),c)
|
|
#define VFNMSCONJ(b,c) VSUB(c, VCONJ(b))
|
|
|
|
static inline V VZMUL(V tx, V sr)
|
|
{
|
|
V tr = VDUPL(tx);
|
|
V ti = VDUPH(tx);
|
|
tr = VMUL(sr, tr);
|
|
sr = VBYI(sr);
|
|
return VFMA(ti, sr, tr);
|
|
}
|
|
|
|
static inline V VZMULJ(V tx, V sr)
|
|
{
|
|
V tr = VDUPL(tx);
|
|
V ti = VDUPH(tx);
|
|
tr = VMUL(sr, tr);
|
|
sr = VBYI(sr);
|
|
return VFNMS(ti, sr, tr);
|
|
}
|
|
|
|
static inline V VZMULI(V tx, V sr)
|
|
{
|
|
V tr = VDUPL(tx);
|
|
V ti = VDUPH(tx);
|
|
ti = VMUL(ti, sr);
|
|
sr = VBYI(sr);
|
|
return VFMS(tr, sr, ti);
|
|
}
|
|
|
|
static inline V VZMULIJ(V tx, V sr)
|
|
{
|
|
V tr = VDUPL(tx);
|
|
V ti = VDUPH(tx);
|
|
ti = VMUL(ti, sr);
|
|
sr = VBYI(sr);
|
|
return VFMA(tr, sr, ti);
|
|
}
|
|
|
|
/* twiddle storage #1: compact, slower */
|
|
#ifdef FFTW_SINGLE
|
|
# define VTW1(v,x) \
|
|
{TW_COS, v, x}, {TW_COS, v+1, x}, {TW_SIN, v, x}, {TW_SIN, v+1, x}
|
|
static inline V BYTW1(const R *t, V sr)
|
|
{
|
|
V tx = LDA(t,0,t);
|
|
V tr = UNPCKH(tx, tx);
|
|
V ti = UNPCKL(tx, tx);
|
|
tr = VMUL(tr, sr);
|
|
sr = VBYI(sr);
|
|
return VFMA(ti, sr, tr);
|
|
}
|
|
static inline V BYTWJ1(const R *t, V sr)
|
|
{
|
|
V tx = LDA(t,0,t);
|
|
V tr = UNPCKH(tx, tx);
|
|
V ti = UNPCKL(tx, tx);
|
|
tr = VMUL(tr, sr);
|
|
sr = VBYI(sr);
|
|
return VFNMS(ti, sr, tr);
|
|
}
|
|
#else /* !FFTW_SINGLE */
|
|
# define VTW1(v,x) {TW_CEXP, v, x}
|
|
static inline V BYTW1(const R *t, V sr)
|
|
{
|
|
V tx = LD(t, 1, t);
|
|
return VZMUL(tx, sr);
|
|
}
|
|
static inline V BYTWJ1(const R *t, V sr)
|
|
{
|
|
V tx = LD(t, 1, t);
|
|
return VZMULJ(tx, sr);
|
|
}
|
|
#endif
|
|
#define TWVL1 (VL)
|
|
|
|
/* twiddle storage #2: twice the space, faster (when in cache) */
|
|
#ifdef FFTW_SINGLE
|
|
# define VTW2(v,x) \
|
|
{TW_COS, v, x}, {TW_COS, v, x}, {TW_COS, v+1, x}, {TW_COS, v+1, x}, \
|
|
{TW_SIN, v, -x}, {TW_SIN, v, x}, {TW_SIN, v+1, -x}, {TW_SIN, v+1, x}
|
|
#else /* !FFTW_SINGLE */
|
|
# define VTW2(v,x) \
|
|
{TW_COS, v, x}, {TW_COS, v, x}, {TW_SIN, v, -x}, {TW_SIN, v, x}
|
|
#endif
|
|
#define TWVL2 (2 * VL)
|
|
static inline V BYTW2(const R *t, V sr)
|
|
{
|
|
V si = FLIP_RI(sr);
|
|
V ti = LDA(t+2*VL,0,t);
|
|
V tt = VMUL(ti, si);
|
|
V tr = LDA(t,0,t);
|
|
return VFMA(tr, sr, tt);
|
|
}
|
|
static inline V BYTWJ2(const R *t, V sr)
|
|
{
|
|
V si = FLIP_RI(sr);
|
|
V tr = LDA(t,0,t);
|
|
V tt = VMUL(tr, sr);
|
|
V ti = LDA(t+2*VL,0,t);
|
|
return VFNMS(ti, si, tt);
|
|
}
|
|
|
|
/* twiddle storage #3 */
|
|
#ifdef FFTW_SINGLE
|
|
# define VTW3(v,x) {TW_CEXP, v, x}, {TW_CEXP, v+1, x}
|
|
# define TWVL3 (VL)
|
|
#else
|
|
# define VTW3(v,x) VTW1(v,x)
|
|
# define TWVL3 TWVL1
|
|
#endif
|
|
|
|
/* twiddle storage for split arrays */
|
|
#ifdef FFTW_SINGLE
|
|
# define VTWS(v,x) \
|
|
{TW_COS, v, x}, {TW_COS, v+1, x}, {TW_COS, v+2, x}, {TW_COS, v+3, x}, \
|
|
{TW_SIN, v, x}, {TW_SIN, v+1, x}, {TW_SIN, v+2, x}, {TW_SIN, v+3, x}
|
|
#else
|
|
# define VTWS(v,x) \
|
|
{TW_COS, v, x}, {TW_COS, v+1, x}, {TW_SIN, v, x}, {TW_SIN, v+1, x}
|
|
#endif
|
|
#define TWVLS (2 * VL)
|
|
|
|
#define VLEAVE() /* nothing */
|
|
|
|
#include "simd-common.h"
|