pocketfft_hdronly.h 105 KB
Newer Older
1
/*
2 3 4
This file is part of pocketfft.

Copyright (C) 2010-2019 Max-Planck-Society
5 6 7 8 9 10 11
Copyright (C) 2019 Peter Bell

For the odd-sized DCT-IV transforms:
  Copyright (C) 2003, 2007-14 Matteo Frigo
  Copyright (C) 2003, 2007-14 Massachusetts Institute of Technology

Authors: Martin Reinecke, Peter Bell
12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37

All rights reserved.

Redistribution and use in source and binary forms, with or without modification,
are permitted provided that the following conditions are met:

* Redistributions of source code must retain the above copyright notice, this
  list of conditions and the following disclaimer.
* 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.
* Neither the name of the copyright holder 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 COPYRIGHT HOLDER 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.
*/
38 39 40 41

#ifndef POCKETFFT_HDRONLY_H
#define POCKETFFT_HDRONLY_H

42
#ifndef __cplusplus
43
#error This file is C++ and requires a C++ compiler.
44 45
#endif

Martin Reinecke's avatar
sync  
Martin Reinecke committed
46
#if !(__cplusplus >= 201103L || _MSVC_LANG+0L >= 201103L)
47
#error This file requires at least C++11 support.
48 49
#endif

50 51 52 53
#ifndef POCKETFFT_CACHE_SIZE
#define POCKETFFT_CACHE_SIZE 16
#endif

54 55 56 57 58 59
#include <cmath>
#include <cstring>
#include <cstdlib>
#include <stdexcept>
#include <memory>
#include <vector>
Martin Reinecke's avatar
sync  
Martin Reinecke committed
60
#include <complex>
61 62
#if POCKETFFT_CACHE_SIZE!=0
#include <array>
Martin Reinecke's avatar
Martin Reinecke committed
63
#include <mutex>
64
#endif
Peter Bell's avatar
Peter Bell committed
65 66 67 68 69 70 71

#include <mutex>
#include <condition_variable>
#include <thread>
#include <queue>
#include <atomic>
#include <functional>
Martin Reinecke's avatar
Martin Reinecke committed
72

73

Martin Reinecke's avatar
Martin Reinecke committed
74
#if defined(__GNUC__)
75 76
#define POCKETFFT_NOINLINE __attribute__((noinline))
#define POCKETFFT_RESTRICT __restrict__
Martin Reinecke's avatar
Martin Reinecke committed
77
#elif defined(_MSC_VER)
78 79
#define POCKETFFT_NOINLINE __declspec(noinline)
#define POCKETFFT_RESTRICT __restrict
80
#else
81 82
#define POCKETFFT_NOINLINE
#define POCKETFFT_RESTRICT
83 84 85 86 87 88
#endif

namespace pocketfft {

namespace detail {

Martin Reinecke's avatar
Martin Reinecke committed
89 90
using namespace std;

Martin Reinecke's avatar
Martin Reinecke committed
91 92 93 94 95 96
using shape_t = vector<size_t>;
using stride_t = vector<ptrdiff_t>;

constexpr bool FORWARD  = true,
               BACKWARD = false;

Martin Reinecke's avatar
sync  
Martin Reinecke committed
97 98 99 100
// only enable vector support for gcc>=5.0 and clang>=5.0
#ifndef POCKETFFT_NO_VECTORS
#define POCKETFFT_NO_VECTORS
#if defined(__INTEL_COMPILER)
101
// do nothing. This is necessary because this compiler also sets __GNUC__.
Martin Reinecke's avatar
sync  
Martin Reinecke committed
102 103 104 105 106 107 108 109 110 111 112
#elif defined(__clang__)
#if __clang__>=5
#undef POCKETFFT_NO_VECTORS
#endif
#elif defined(__GNUC__)
#if __GNUC__>=5
#undef POCKETFFT_NO_VECTORS
#endif
#endif
#endif

Martin Reinecke's avatar
Martin Reinecke committed
113 114
template<typename T> struct VLEN { static constexpr size_t val=1; };

Martin Reinecke's avatar
Martin Reinecke committed
115 116
#ifndef POCKETFFT_NO_VECTORS
#if (defined(__AVX512F__))
Martin Reinecke's avatar
Martin Reinecke committed
117 118
template<> struct VLEN<float> { static constexpr size_t val=16; };
template<> struct VLEN<double> { static constexpr size_t val=8; };
Martin Reinecke's avatar
Martin Reinecke committed
119
#elif (defined(__AVX__))
Martin Reinecke's avatar
Martin Reinecke committed
120 121
template<> struct VLEN<float> { static constexpr size_t val=8; };
template<> struct VLEN<double> { static constexpr size_t val=4; };
Martin Reinecke's avatar
Martin Reinecke committed
122
#elif (defined(__SSE2__))
Martin Reinecke's avatar
Martin Reinecke committed
123 124
template<> struct VLEN<float> { static constexpr size_t val=4; };
template<> struct VLEN<double> { static constexpr size_t val=2; };
Martin Reinecke's avatar
sync  
Martin Reinecke committed
125
#elif (defined(__VSX__))
Martin Reinecke's avatar
Martin Reinecke committed
126 127
template<> struct VLEN<float> { static constexpr size_t val=4; };
template<> struct VLEN<double> { static constexpr size_t val=2; };
Martin Reinecke's avatar
Martin Reinecke committed
128 129 130 131 132
#else
#define POCKETFFT_NO_VECTORS
#endif
#endif

Martin Reinecke's avatar
Martin Reinecke committed
133
template<typename T> class arr
134 135 136 137 138
  {
  private:
    T *p;
    size_t sz;

Martin Reinecke's avatar
Martin Reinecke committed
139
#if defined(POCKETFFT_NO_VECTORS)
140 141 142 143 144
    static T *ralloc(size_t num)
      {
      if (num==0) return nullptr;
      void *res = malloc(num*sizeof(T));
      if (!res) throw bad_alloc();
Martin Reinecke's avatar
Martin Reinecke committed
145 146 147 148 149 150 151 152
      return reinterpret_cast<T *>(res);
      }
    static void dealloc(T *ptr)
      { free(ptr); }
#elif __cplusplus >= 201703L
    static T *ralloc(size_t num)
      {
      if (num==0) return nullptr;
153 154
      void *res = aligned_alloc(64,num*sizeof(T));
      if (!res) throw bad_alloc();
Martin Reinecke's avatar
Martin Reinecke committed
155 156 157 158
      return reinterpret_cast<T *>(res);
      }
    static void dealloc(T *ptr)
      { free(ptr); }
159
#else // portable emulation
Martin Reinecke's avatar
Martin Reinecke committed
160 161 162
    static T *ralloc(size_t num)
      {
      if (num==0) return nullptr;
163 164 165 166 167 168
      void *ptr = malloc(num*sizeof(T)+64);
      if (!ptr) throw bad_alloc();
      T *res = reinterpret_cast<T *>
        ((reinterpret_cast<size_t>(ptr) & ~(size_t(63))) + 64);
      (reinterpret_cast<void**>(res))[-1] = ptr;
      return res;
Martin Reinecke's avatar
Martin Reinecke committed
169 170
      }
    static void dealloc(T *ptr)
171
      { if (ptr) free((reinterpret_cast<void**>(ptr))[-1]); }
Martin Reinecke's avatar
Martin Reinecke committed
172
#endif
173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204

  public:
    arr() : p(0), sz(0) {}
    arr(size_t n) : p(ralloc(n)), sz(n) {}
    arr(arr &&other)
      : p(other.p), sz(other.sz)
      { other.p=nullptr; other.sz=0; }
    ~arr() { dealloc(p); }

    void resize(size_t n)
      {
      if (n==sz) return;
      dealloc(p);
      p = ralloc(n);
      sz = n;
      }

    T &operator[](size_t idx) { return p[idx]; }
    const T &operator[](size_t idx) const { return p[idx]; }

    T *data() { return p; }
    const T *data() const { return p; }

    size_t size() const { return sz; }
  };

template<typename T> struct cmplx {
  T r, i;
  cmplx() {}
  cmplx(T r_, T i_) : r(r_), i(i_) {}
  void Set(T r_, T i_) { r=r_; i=i_; }
  void Set(T r_) { r=r_; i=T(0); }
Martin Reinecke's avatar
Martin Reinecke committed
205 206
  void Split(T &r_, T &i_) const { r_=r; i_=i; }
  void SplitConj(T &r_, T &i_) const { r_=r; i_=-i; }
207 208 209 210
  cmplx &operator+= (const cmplx &other)
    { r+=other.r; i+=other.i; return *this; }
  template<typename T2>cmplx &operator*= (T2 other)
    { r*=other; i*=other; return *this; }
211 212 213 214 215 216 217
  template<typename T2>cmplx &operator*= (const cmplx<T2> &other)
    {
    T tmp = r*other.r - i*other.i;
    i = r*other.i + i*other.r;
    r = tmp;
    return *this;
    }
Martin Reinecke's avatar
Martin Reinecke committed
218 219 220 221
  template<typename T2>cmplx &operator+= (const cmplx<T2> &other)
    { r+=other.r; i+=other.i; return *this; }
  template<typename T2>cmplx &operator-= (const cmplx<T2> &other)
    { r-=other.r; i-=other.i; return *this; }
222 223 224
  template<typename T2> auto operator* (const T2 &other) const
    -> cmplx<decltype(r*other)>
    { return {r*other, i*other}; }
Martin Reinecke's avatar
Martin Reinecke committed
225 226 227 228 229 230
  template<typename T2> auto operator+ (const cmplx<T2> &other) const
    -> cmplx<decltype(r+other.r)>
    { return {r+other.r, i+other.i}; }
  template<typename T2> auto operator- (const cmplx<T2> &other) const
    -> cmplx<decltype(r+other.r)>
    { return {r-other.r, i-other.i}; }
231 232 233
  template<typename T2> auto operator* (const cmplx<T2> &other) const
    -> cmplx<decltype(r+other.r)>
    { return {r*other.r-i*other.i, r*other.i + i*other.r}; }
Martin Reinecke's avatar
Martin Reinecke committed
234
  template<bool fwd, typename T2> auto special_mul (const cmplx<T2> &other) const
235 236
    -> cmplx<decltype(r+other.r)>
    {
Martin Reinecke's avatar
sync  
Martin Reinecke committed
237
    using Tres = cmplx<decltype(r+other.r)>;
Martin Reinecke's avatar
Martin Reinecke committed
238 239
    return fwd ? Tres(r*other.r+i*other.i, i*other.r-r*other.i)
               : Tres(r*other.r-i*other.i, r*other.i+i*other.r);
240 241
    }
};
Martin Reinecke's avatar
Martin Reinecke committed
242 243
template<typename T> inline void PM(T &a, T &b, T c, T d)
  { a=c+d; b=c-d; }
Martin Reinecke's avatar
Martin Reinecke committed
244 245
template<typename T> inline void PMINPLACE(T &a, T &b)
  { T t = a; a+=b; b=t-b; }
246 247
template<typename T> inline void MPINPLACE(T &a, T &b)
  { T t = a; a-=b; b=t+b; }
248 249
template<typename T> cmplx<T> conj(const cmplx<T> &a)
  { return {a.r, -a.i}; }
Martin Reinecke's avatar
Martin Reinecke committed
250 251 252 253 254
template<bool fwd, typename T, typename T2> void special_mul (const cmplx<T> &v1, const cmplx<T2> &v2, cmplx<T> &res)
  {
  res = fwd ? cmplx<T>(v1.r*v2.r+v1.i*v2.i, v1.i*v2.r-v1.r*v2.i)
            : cmplx<T>(v1.r*v2.r-v1.i*v2.i, v1.r*v2.i+v1.i*v2.r);
  }
255 256 257

template<typename T> void ROT90(cmplx<T> &a)
  { auto tmp_=a.r; a.r=-a.i; a.i=tmp_; }
Martin Reinecke's avatar
Martin Reinecke committed
258 259
template<bool fwd, typename T> void ROTX90(cmplx<T> &a)
  { auto tmp_= fwd ? -a.r : a.r; a.r = fwd ? a.i : -a.i; a.i=tmp_; }
260 261 262 263 264 265 266 267

//
// twiddle factor section
//

template<typename T> class sincos_2pibyn
  {
  private:
Martin Reinecke's avatar
cleanup  
Martin Reinecke committed
268
    using Thigh = typename conditional<(sizeof(T)>sizeof(double)), T, double>::type;
269 270
    arr<T> data;

271
    void my_sincosm1pi (Thigh a_, Thigh *POCKETFFT_RESTRICT res)
272
      {
Martin Reinecke's avatar
sync  
Martin Reinecke committed
273 274
      if (sizeof(Thigh)>sizeof(double)) // don't have the code for long double
        {
Martin Reinecke's avatar
sync  
Martin Reinecke committed
275 276 277
        constexpr Thigh pi = Thigh(3.141592653589793238462643383279502884197L);
        auto s = sin(pi*a_);
        res[1] = s;
Martin Reinecke's avatar
sync  
Martin Reinecke committed
278 279 280
        res[0] = (s*s)/(-sqrt((1-s)*(1+s))-1);
        return;
        }
Martin Reinecke's avatar
sync  
Martin Reinecke committed
281 282 283
      // adapted from https://stackoverflow.com/questions/42792939/
      // CAUTION: this function only works for arguments in the range
      //          [-0.25; 0.25]!
Martin Reinecke's avatar
sync  
Martin Reinecke committed
284
      double a = double(a_);
285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308
      double s = a * a;
      /* Approximate cos(pi*x)-1 for x in [-0.25,0.25] */
      double r =     -1.0369917389758117e-4;
      r = fma (r, s,  1.9294935641298806e-3);
      r = fma (r, s, -2.5806887942825395e-2);
      r = fma (r, s,  2.3533063028328211e-1);
      r = fma (r, s, -1.3352627688538006e+0);
      r = fma (r, s,  4.0587121264167623e+0);
      r = fma (r, s, -4.9348022005446790e+0);
      double c = r*s;
      /* Approximate sin(pi*x) for x in [-0.25,0.25] */
      r =             4.6151442520157035e-4;
      r = fma (r, s, -7.3700183130883555e-3);
      r = fma (r, s,  8.2145868949323936e-2);
      r = fma (r, s, -5.9926452893214921e-1);
      r = fma (r, s,  2.5501640398732688e+0);
      r = fma (r, s, -5.1677127800499516e+0);
      s = s * a;
      r = r * s;
      s = fma (a, 3.1415926535897931e+0, r);
      res[0] = c;
      res[1] = s;
      }

309 310
    POCKETFFT_NOINLINE void calc_first_octant(size_t den,
      T * POCKETFFT_RESTRICT res)
311 312 313 314 315
      {
      size_t n = (den+4)>>3;
      if (n==0) return;
      res[0]=1.; res[1]=0.;
      if (n==1) return;
Martin Reinecke's avatar
Martin Reinecke committed
316
      size_t l1 = size_t(sqrt(n));
Martin Reinecke's avatar
sync  
Martin Reinecke committed
317
      arr<Thigh> tmp(2*l1);
318 319
      for (size_t i=1; i<l1; ++i)
        {
Martin Reinecke's avatar
sync  
Martin Reinecke committed
320 321 322
        my_sincosm1pi(Thigh(2*i)/Thigh(den),&tmp[2*i]);
        res[2*i  ] = T(tmp[2*i]+1);
        res[2*i+1] = T(tmp[2*i+1]);
323 324 325 326
        }
      size_t start=l1;
      while(start<n)
        {
Martin Reinecke's avatar
sync  
Martin Reinecke committed
327
        Thigh cs[2];
Martin Reinecke's avatar
sync  
Martin Reinecke committed
328 329 330
        my_sincosm1pi((Thigh(2*start))/Thigh(den),cs);
        res[2*start] = T(cs[0]+1);
        res[2*start+1] = T(cs[1]);
331 332 333 334
        size_t end = l1;
        if (start+end>n) end = n-start;
        for (size_t i=1; i<end; ++i)
          {
Martin Reinecke's avatar
sync  
Martin Reinecke committed
335
          Thigh csx[2]={tmp[2*i], tmp[2*i+1]};
Martin Reinecke's avatar
sync  
Martin Reinecke committed
336 337
          res[2*(start+i)] = T(((cs[0]*csx[0] - cs[1]*csx[1] + cs[0]) + csx[0]) + 1);
          res[2*(start+i)+1] = T((cs[0]*csx[1] + cs[1]*csx[0]) + cs[1] + csx[1]);
338 339 340 341 342
          }
        start += l1;
        }
      }

343
    void calc_first_quadrant(size_t n, T * POCKETFFT_RESTRICT res)
344
      {
345
      T * POCKETFFT_RESTRICT p = res+n;
346 347 348 349 350
      calc_first_octant(n<<1, p);
      size_t ndone=(n+2)>>2;
      size_t i=0, idx1=0, idx2=2*ndone-2;
      for (; i+1<ndone; i+=2, idx1+=2, idx2-=2)
        {
Martin Reinecke's avatar
Martin Reinecke committed
351 352
        res[idx1] = p[2*i  ]; res[idx1+1] = p[2*i+1];
        res[idx2] = p[2*i+3]; res[idx2+1] = p[2*i+2];
353 354
        }
      if (i!=ndone)
Martin Reinecke's avatar
Martin Reinecke committed
355
        { res[idx1] = p[2*i]; res[idx1+1] = p[2*i+1]; }
356 357
      }

358
    void calc_first_half(size_t n, T * POCKETFFT_RESTRICT res)
359
      {
Martin Reinecke's avatar
sync  
Martin Reinecke committed
360
      int ndone=int(n+1)>>1;
361 362
      T * p = res+n-1;
      calc_first_octant(n<<2, p);
Martin Reinecke's avatar
sync  
Martin Reinecke committed
363
      int i4=0, in=int(n), i=0;
364
      for (; i4<=in-i4; ++i, i4+=4) // octant 0
Martin Reinecke's avatar
Martin Reinecke committed
365
        { res[2*i] = p[2*i4]; res[2*i+1] = p[2*i4+1]; }
366
      for (; i4-in <= 0; ++i, i4+=4) // octant 1
Martin Reinecke's avatar
sync  
Martin Reinecke committed
367
        { auto xm = in-i4; res[2*i] = p[2*xm+1]; res[2*i+1] = p[2*xm]; }
368
      for (; i4<=3*in-i4; ++i, i4+=4) // octant 2
Martin Reinecke's avatar
sync  
Martin Reinecke committed
369
        { auto xm = i4-in; res[2*i] = -p[2*xm+1]; res[2*i+1] = p[2*xm]; }
370
      for (; i<ndone; ++i, i4+=4) // octant 3
Martin Reinecke's avatar
sync  
Martin Reinecke committed
371
        { auto xm = 2*in-i4; res[2*i] = -p[2*xm]; res[2*i+1] = p[2*xm+1]; }
372 373
      }

374
    void fill_first_quadrant(size_t n, T * POCKETFFT_RESTRICT res)
375
      {
Martin Reinecke's avatar
sync  
Martin Reinecke committed
376
      constexpr T hsqt2 = T(0.707106781186547524400844362104849L);
377 378 379 380
      size_t quart = n>>2;
      if ((n&7)==0)
        res[quart] = res[quart+1] = hsqt2;
      for (size_t i=2, j=2*quart-2; i<quart; i+=2, j-=2)
Martin Reinecke's avatar
Martin Reinecke committed
381
        { res[j] = res[i+1]; res[j+1] = res[i]; }
382 383
      }

384
    POCKETFFT_NOINLINE void fill_first_half(size_t n, T * POCKETFFT_RESTRICT res)
385 386 387 388
      {
      size_t half = n>>1;
      if ((n&3)==0)
        for (size_t i=0; i<half; i+=2)
Martin Reinecke's avatar
Martin Reinecke committed
389
          { res[i+half] = -res[i+1]; res[i+half+1] = res[i]; }
390 391
      else
        for (size_t i=2, j=2*half-2; i<half; i+=2, j-=2)
Martin Reinecke's avatar
Martin Reinecke committed
392
          { res[j] = -res[i]; res[j+1] = res[i+1]; }
393 394
      }

395
    void fill_second_half(size_t n, T * POCKETFFT_RESTRICT res)
396 397 398 399 400 401
      {
      if ((n&1)==0)
        for (size_t i=0; i<n; ++i)
          res[i+n] = -res[i];
      else
        for (size_t i=2, j=2*n-2; i<n; i+=2, j-=2)
Martin Reinecke's avatar
Martin Reinecke committed
402
          { res[j] = res[i]; res[j+1] = -res[i+1]; }
403 404
      }

405
    POCKETFFT_NOINLINE void sincos_2pibyn_half(size_t n, T * POCKETFFT_RESTRICT res)
406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422
      {
      if ((n&3)==0)
        {
        calc_first_octant(n, res);
        fill_first_quadrant(n, res);
        fill_first_half(n, res);
        }
      else if ((n&1)==0)
        {
        calc_first_quadrant(n, res);
        fill_first_half(n, res);
        }
      else
        calc_first_half(n, res);
      }

  public:
423
    POCKETFFT_NOINLINE sincos_2pibyn(size_t n, bool half)
424 425 426 427 428 429 430 431 432 433 434 435
      : data(2*n)
      {
      sincos_2pibyn_half(n, data.data());
      if (!half) fill_second_half(n, data.data());
      }

    T operator[](size_t idx) const { return data[idx]; }
    const T *rdata() const { return data; }
    const cmplx<T> *cdata() const
      { return reinterpret_cast<const cmplx<T> *>(data.data()); }
  };

Martin Reinecke's avatar
Martin Reinecke committed
436
struct util // hack to avoid duplicate symbols
437
  {
438
  static POCKETFFT_NOINLINE size_t largest_prime_factor (size_t n)
439
    {
Martin Reinecke's avatar
Martin Reinecke committed
440 441 442
    size_t res=1;
    while ((n&1)==0)
      { res=2; n>>=1; }
Martin Reinecke's avatar
Martin Reinecke committed
443 444 445
    for (size_t x=3; x*x<=n; x+=2)
      while ((n%x)==0)
        { res=x; n/=x; }
Martin Reinecke's avatar
Martin Reinecke committed
446 447 448 449
    if (n>1) res=n;
    return res;
    }

450
  static POCKETFFT_NOINLINE double cost_guess (size_t n)
451
    {
Martin Reinecke's avatar
sync  
Martin Reinecke committed
452
    constexpr double lfp=1.1; // penalty for non-hardcoded larger factors
Martin Reinecke's avatar
Martin Reinecke committed
453 454 455 456
    size_t ni=n;
    double result=0.;
    while ((n&1)==0)
      { result+=2; n>>=1; }
Martin Reinecke's avatar
Martin Reinecke committed
457 458 459 460 461 462
    for (size_t x=3; x*x<=n; x+=2)
      while ((n%x)==0)
        {
        result+= (x<=5) ? double(x) : lfp*double(x); // penalize larger prime factors
        n/=x;
        }
Martin Reinecke's avatar
sync  
Martin Reinecke committed
463 464
    if (n>1) result+=(n<=5) ? double(n) : lfp*double(n);
    return result*double(ni);
465 466
    }

Martin Reinecke's avatar
Martin Reinecke committed
467
  /* returns the smallest composite of 2, 3, 5, 7 and 11 which is >= n */
468
  static POCKETFFT_NOINLINE size_t good_size_cmplx(size_t n)
Martin Reinecke's avatar
Martin Reinecke committed
469 470 471 472
    {
    if (n<=12) return n;

    size_t bestfac=2*n;
473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519
    for (size_t f11=1; f11<bestfac; f11*=11)
      for (size_t f117=f11; f117<bestfac; f117*=7)
        for (size_t f1175=f117; f1175<bestfac; f1175*=5)
          {
          size_t x=f1175;
          while (x<n) x*=2;
          for (;;)
            {
            if (x<n)
              x*=3;
            else if (x>n)
              {
              if (x<bestfac) bestfac=x;
              if (x&1) break;
              x>>=1;
              }
            else
              return n;
            }
          }
    return bestfac;
    }

  /* returns the smallest composite of 2, 3, 5 which is >= n */
  static POCKETFFT_NOINLINE size_t good_size_real(size_t n)
    {
    if (n<=6) return n;

    size_t bestfac=2*n;
    for (size_t f5=1; f5<bestfac; f5*=5)
      {
      size_t x = f5;
      while (x<n) x *= 2;
      for (;;)
        {
        if (x<n)
          x*=3;
        else if (x>n)
          {
          if (x<bestfac) bestfac=x;
          if (x&1) break;
          x>>=1;
          }
        else
          return n;
        }
      }
Martin Reinecke's avatar
Martin Reinecke committed
520 521
    return bestfac;
    }
522

Martin Reinecke's avatar
Martin Reinecke committed
523 524 525 526 527 528 529
  static size_t prod(const shape_t &shape)
    {
    size_t res=1;
    for (auto sz: shape)
      res*=sz;
    return res;
    }
Martin Reinecke's avatar
Martin Reinecke committed
530

531
  static POCKETFFT_NOINLINE void sanity_check(const shape_t &shape,
Martin Reinecke's avatar
Martin Reinecke committed
532 533 534 535 536 537
    const stride_t &stride_in, const stride_t &stride_out, bool inplace)
    {
    auto ndim = shape.size();
    if (ndim<1) throw runtime_error("ndim must be >= 1");
    if ((stride_in.size()!=ndim) || (stride_out.size()!=ndim))
      throw runtime_error("stride dimension mismatch");
Martin Reinecke's avatar
sync  
Martin Reinecke committed
538 539
    if (inplace && (stride_in!=stride_out))
      throw runtime_error("stride mismatch");
Martin Reinecke's avatar
Martin Reinecke committed
540 541
    }

542
  static POCKETFFT_NOINLINE void sanity_check(const shape_t &shape,
Martin Reinecke's avatar
Martin Reinecke committed
543 544 545 546 547 548 549 550
    const stride_t &stride_in, const stride_t &stride_out, bool inplace,
    const shape_t &axes)
    {
    sanity_check(shape, stride_in, stride_out, inplace);
    auto ndim = shape.size();
    shape_t tmp(ndim,0);
    for (auto ax : axes)
      {
551 552
      if (ax>=ndim) throw invalid_argument("bad axis number");
      if (++tmp[ax]>1) throw invalid_argument("axis specified repeatedly");
Martin Reinecke's avatar
Martin Reinecke committed
553 554 555
      }
    }

556
  static POCKETFFT_NOINLINE void sanity_check(const shape_t &shape,
Martin Reinecke's avatar
Martin Reinecke committed
557 558 559 560
    const stride_t &stride_in, const stride_t &stride_out, bool inplace,
    size_t axis)
    {
    sanity_check(shape, stride_in, stride_out, inplace);
561
    if (axis>=shape.size()) throw invalid_argument("bad axis number");
Martin Reinecke's avatar
Martin Reinecke committed
562
    }
Martin Reinecke's avatar
Martin Reinecke committed
563

Martin Reinecke's avatar
Martin Reinecke committed
564 565 566 567
    static size_t thread_count (size_t nthreads, const shape_t &shape,
      size_t axis)
      {
      if (nthreads==1) return 1;
Martin Reinecke's avatar
Martin Reinecke committed
568
      if (prod(shape) < 20*shape[axis]) return 1;
Peter Bell's avatar
Peter Bell committed
569 570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689
      return (nthreads==0) ? thread::hardware_concurrency() : nthreads;
      }
  };

namespace threading {
thread_local size_t thread_id = 0;
thread_local size_t num_threads = 1;

class latch
  {
    atomic<size_t> num_left_;
    mutex mut_;
    condition_variable completed_;
    using lock_t = unique_lock<mutex>;

  public:
    latch(size_t n): num_left_(n) {}

    void count_down()
      {
      {
      lock_t lock(mut_);
      if (--num_left_)
        return;
      }
      completed_.notify_all();
      }

    void wait()
      {
      lock_t lock(mut_);
      completed_.wait(lock, [this]{ return is_ready(); });
      }
    bool is_ready() { return num_left_ == 0; }
  };

template <typename T> class concurrent_queue
  {
  queue<T> q_;
  mutex mut_;
  condition_variable item_added_;
  bool shutdown_;
  using lock_t = unique_lock<mutex>;

  public:
    concurrent_queue(): shutdown_(false) {}

    void push(T val)
      {
      {
      lock_t lock(mut_);
      if (shutdown_)
        throw runtime_error("Item added to queue after shutdown");
      q_.push(move(val));
      }
      item_added_.notify_one();
      }

    bool pop(T & val)
      {
      lock_t lock(mut_);
      item_added_.wait(lock, [this] { return (!q_.empty() || shutdown_); });
      if (q_.empty())
        return false;  // We are shutting down

      val = std::move(q_.front());
      q_.pop();
      return true;
      }

    void shutdown()
      {
      {
      lock_t lock(mut_);
      shutdown_ = true;
      }
      item_added_.notify_all();
      }
  };

class thread_pool
  {
    concurrent_queue<function<void()>> work_queue_;
    vector<thread> threads_;

    void worker_main()
      {
      function<void()> work;
      while (work_queue_.pop(work))
        work();
      }

  public:
    explicit thread_pool(size_t nthreads):
      threads_(nthreads)
      {
      for (size_t i=0; i<nthreads; ++i)
        {
        try { threads_[i] = thread([this]{ worker_main(); }); }
        catch (...)
          {
          work_queue_.shutdown();
          for (size_t j = 0; j < i; ++j)
            threads_[j].join();
          throw;
          }
        }
      }

    thread_pool(): thread_pool(thread::hardware_concurrency()) {}

    ~thread_pool()
      {
      work_queue_.shutdown();
      for (size_t i=0; i<threads_.size(); ++i)
        threads_[i].join();
      }

    void submit(function<void()> work)
      {
      work_queue_.push(move(work));
Martin Reinecke's avatar
Martin Reinecke committed
690
      }
Martin Reinecke's avatar
Martin Reinecke committed
691
  };
692

Peter Bell's avatar
Peter Bell committed
693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708 709 710 711 712 713 714 715 716 717 718 719 720 721 722 723 724
thread_pool & get_pool()
  {
  static thread_pool pool;
  return pool;
  }

/** Map a function f over nthreads */
template <typename Func>
void thread_map(size_t nthreads, Func f)
  {
  auto & pool = get_pool();
  if (nthreads == 0)
    nthreads = thread::hardware_concurrency();

  if (nthreads == 1)
    { f(); return; }

  latch counter(nthreads);
  for (size_t i=0; i<nthreads; ++i)
    {
    pool.submit(
      [&f, &counter, i, nthreads] {
      thread_id = i;
      num_threads = nthreads;
      f();
      counter.count_down();
      });
    }
  counter.wait();
  }
}

725 726 727 728 729 730 731 732 733 734 735 736 737
//
// complex FFTPACK transforms
//

template<typename T0> class cfftp
  {
  private:
    struct fctdata
      {
      size_t fct;
      cmplx<T0> *tw, *tws;
      };

Martin Reinecke's avatar
Martin Reinecke committed
738
    size_t length;
739
    arr<cmplx<T0>> mem;
Martin Reinecke's avatar
Martin Reinecke committed
740
    vector<fctdata> fact;
741 742

    void add_factor(size_t factor)
Martin Reinecke's avatar
Martin Reinecke committed
743
      { fact.push_back({factor, nullptr, nullptr}); }
744

Martin Reinecke's avatar
Martin Reinecke committed
745
template<bool fwd, typename T> void pass2 (size_t ido, size_t l1,
746
  const T * POCKETFFT_RESTRICT cc, T * POCKETFFT_RESTRICT ch,
Martin Reinecke's avatar
Martin Reinecke committed
747
  const cmplx<T0> * POCKETFFT_RESTRICT wa) const
748 749 750
  {
  constexpr size_t cdim=2;

751 752
  auto CH = [ch,ido,l1](size_t a, size_t b, size_t c) -> T&
    { return ch[a+ido*(b+l1*c)]; };
753
  auto CC = [cc,ido,cdim](size_t a, size_t b, size_t c) -> const T&
754 755 756 757
    { return cc[a+ido*(b+cdim*c)]; };
  auto WA = [wa, ido](size_t x, size_t i)
    { return wa[i-1+x*(ido-1)]; };

758 759 760 761 762 763 764 765 766 767 768 769 770 771
  if (ido==1)
    for (size_t k=0; k<l1; ++k)
      {
      CH(0,k,0) = CC(0,0,k)+CC(0,1,k);
      CH(0,k,1) = CC(0,0,k)-CC(0,1,k);
      }
  else
    for (size_t k=0; k<l1; ++k)
      {
      CH(0,k,0) = CC(0,0,k)+CC(0,1,k);
      CH(0,k,1) = CC(0,0,k)-CC(0,1,k);
      for (size_t i=1; i<ido; ++i)
        {
        CH(i,k,0) = CC(i,0,k)+CC(i,1,k);
Martin Reinecke's avatar
Martin Reinecke committed
772
        special_mul<fwd>(CC(i,0,k)-CC(i,1,k),WA(0,i),CH(i,k,1));
773 774 775 776
        }
      }
  }

777
#define POCKETFFT_PREP3(idx) \
778
        T t0 = CC(idx,0,k), t1, t2; \
Martin Reinecke's avatar
Martin Reinecke committed
779
        PM (t1,t2,CC(idx,1,k),CC(idx,2,k)); \
780
        CH(idx,k,0)=t0+t1;
781
#define POCKETFFT_PARTSTEP3a(u1,u2,twr,twi) \
782
        { \
Martin Reinecke's avatar
Martin Reinecke committed
783 784 785
        T ca=t0+t1*twr; \
        T cb{-t2.i*twi, t2.r*twi}; \
        PM(CH(0,k,u1),CH(0,k,u2),ca,cb) ;\
786
        }
787
#define POCKETFFT_PARTSTEP3b(u1,u2,twr,twi) \
788
        { \
Martin Reinecke's avatar
Martin Reinecke committed
789 790 791 792
        T ca=t0+t1*twr; \
        T cb{-t2.i*twi, t2.r*twi}; \
        special_mul<fwd>(ca+cb,WA(u1-1,i),CH(i,k,u1)); \
        special_mul<fwd>(ca-cb,WA(u2-1,i),CH(i,k,u2)); \
793
        }
Martin Reinecke's avatar
Martin Reinecke committed
794
template<bool fwd, typename T> void pass3 (size_t ido, size_t l1,
795
  const T * POCKETFFT_RESTRICT cc, T * POCKETFFT_RESTRICT ch,
Martin Reinecke's avatar
Martin Reinecke committed
796
  const cmplx<T0> * POCKETFFT_RESTRICT wa) const
797 798
  {
  constexpr size_t cdim=3;
Martin Reinecke's avatar
sync  
Martin Reinecke committed
799
  constexpr T0 tw1r=-0.5,
Martin Reinecke's avatar
Martin Reinecke committed
800
               tw1i= (fwd ? -1: 1) * T0(0.8660254037844386467637231707529362L);
801

802 803
  auto CH = [ch,ido,l1](size_t a, size_t b, size_t c) -> T&
    { return ch[a+ido*(b+l1*c)]; };
804
  auto CC = [cc,ido,cdim](size_t a, size_t b, size_t c) -> const T&
805 806 807 808
    { return cc[a+ido*(b+cdim*c)]; };
  auto WA = [wa, ido](size_t x, size_t i)
    { return wa[i-1+x*(ido-1)]; };

809 810 811
  if (ido==1)
    for (size_t k=0; k<l1; ++k)
      {
812 813
      POCKETFFT_PREP3(0)
      POCKETFFT_PARTSTEP3a(1,2,tw1r,tw1i)
814 815 816 817 818
      }
  else
    for (size_t k=0; k<l1; ++k)
      {
      {
819 820
      POCKETFFT_PREP3(0)
      POCKETFFT_PARTSTEP3a(1,2,tw1r,tw1i)
821 822 823
      }
      for (size_t i=1; i<ido; ++i)
        {
824 825
        POCKETFFT_PREP3(i)
        POCKETFFT_PARTSTEP3b(1,2,tw1r,tw1i)
826 827 828 829
        }
      }
  }

830 831 832
#undef POCKETFFT_PARTSTEP3b
#undef POCKETFFT_PARTSTEP3a
#undef POCKETFFT_PREP3
833

Martin Reinecke's avatar
Martin Reinecke committed
834
template<bool fwd, typename T> void pass4 (size_t ido, size_t l1,
835
  const T * POCKETFFT_RESTRICT cc, T * POCKETFFT_RESTRICT ch,
Martin Reinecke's avatar
Martin Reinecke committed
836
  const cmplx<T0> * POCKETFFT_RESTRICT wa) const
837 838 839
  {
  constexpr size_t cdim=4;

840 841
  auto CH = [ch,ido,l1](size_t a, size_t b, size_t c) -> T&
    { return ch[a+ido*(b+l1*c)]; };
842
  auto CC = [cc,ido,cdim](size_t a, size_t b, size_t c) -> const T&
843 844 845 846
    { return cc[a+ido*(b+cdim*c)]; };
  auto WA = [wa, ido](size_t x, size_t i)
    { return wa[i-1+x*(ido-1)]; };

847 848 849 850
  if (ido==1)
    for (size_t k=0; k<l1; ++k)
      {
      T t1, t2, t3, t4;
Martin Reinecke's avatar
Martin Reinecke committed
851 852
      PM(t2,t1,CC(0,0,k),CC(0,2,k));
      PM(t3,t4,CC(0,1,k),CC(0,3,k));
Martin Reinecke's avatar
Martin Reinecke committed
853
      ROTX90<fwd>(t4);
Martin Reinecke's avatar
Martin Reinecke committed
854 855
      PM(CH(0,k,0),CH(0,k,2),t2,t3);
      PM(CH(0,k,1),CH(0,k,3),t1,t4);
856 857 858 859 860 861
      }
  else
    for (size_t k=0; k<l1; ++k)
      {
      {
      T t1, t2, t3, t4;
Martin Reinecke's avatar
Martin Reinecke committed
862 863
      PM(t2,t1,CC(0,0,k),CC(0,2,k));
      PM(t3,t4,CC(0,1,k),CC(0,3,k));
Martin Reinecke's avatar
Martin Reinecke committed
864
      ROTX90<fwd>(t4);
Martin Reinecke's avatar
Martin Reinecke committed
865 866
      PM(CH(0,k,0),CH(0,k,2),t2,t3);
      PM(CH(0,k,1),CH(0,k,3),t1,t4);
867 868 869
      }
      for (size_t i=1; i<ido; ++i)
        {
Martin Reinecke's avatar
Martin Reinecke committed
870
        T t1, t2, t3, t4;
871
        T cc0=CC(i,0,k), cc1=CC(i,1,k),cc2=CC(i,2,k),cc3=CC(i,3,k);
Martin Reinecke's avatar
Martin Reinecke committed
872 873
        PM(t2,t1,cc0,cc2);
        PM(t3,t4,cc1,cc3);
Martin Reinecke's avatar
Martin Reinecke committed
874
        ROTX90<fwd>(t4);
Martin Reinecke's avatar
Martin Reinecke committed
875 876 877 878
        CH(i,k,0) = t2+t3;
        special_mul<fwd>(t1+t4,WA(0,i),CH(i,k,1));
        special_mul<fwd>(t2-t3,WA(1,i),CH(i,k,2));
        special_mul<fwd>(t1-t4,WA(2,i),CH(i,k,3));
879 880 881 882
        }
      }
  }

883
#define POCKETFFT_PREP5(idx) \
884
        T t0 = CC(idx,0,k), t1, t2, t3, t4; \
Martin Reinecke's avatar
Martin Reinecke committed
885 886
        PM (t1,t4,CC(idx,1,k),CC(idx,4,k)); \
        PM (t2,t3,CC(idx,2,k),CC(idx,3,k)); \
887 888 889
        CH(idx,k,0).r=t0.r+t1.r+t2.r; \
        CH(idx,k,0).i=t0.i+t1.i+t2.i;

890
#define POCKETFFT_PARTSTEP5a(u1,u2,twar,twbr,twai,twbi) \
891 892 893 894 895 896
        { \
        T ca,cb; \
        ca.r=t0.r+twar*t1.r+twbr*t2.r; \
        ca.i=t0.i+twar*t1.i+twbr*t2.i; \
        cb.i=twai*t4.r twbi*t3.r; \
        cb.r=-(twai*t4.i twbi*t3.i); \
Martin Reinecke's avatar
Martin Reinecke committed
897
        PM(CH(0,k,u1),CH(0,k,u2),ca,cb); \
898 899
        }

900
#define POCKETFFT_PARTSTEP5b(u1,u2,twar,twbr,twai,twbi) \
901 902 903 904 905 906
        { \
        T ca,cb,da,db; \
        ca.r=t0.r+twar*t1.r+twbr*t2.r; \
        ca.i=t0.i+twar*t1.i+twbr*t2.i; \
        cb.i=twai*t4.r twbi*t3.r; \
        cb.r=-(twai*t4.i twbi*t3.i); \
Martin Reinecke's avatar
Martin Reinecke committed
907 908
        special_mul<fwd>(ca+cb,WA(u1-1,i),CH(i,k,u1)); \
        special_mul<fwd>(ca-cb,WA(u2-1,i),CH(i,k,u2)); \
909
        }
Martin Reinecke's avatar
Martin Reinecke committed
910
template<bool fwd, typename T> void pass5 (size_t ido, size_t l1,
911
  const T * POCKETFFT_RESTRICT cc, T * POCKETFFT_RESTRICT ch,
Martin Reinecke's avatar
Martin Reinecke committed
912
  const cmplx<T0> * POCKETFFT_RESTRICT wa) const
913 914
  {
  constexpr size_t cdim=5;
Martin Reinecke's avatar
sync  
Martin Reinecke committed
915
  constexpr T0 tw1r= T0(0.3090169943749474241022934171828191L),
Martin Reinecke's avatar
Martin Reinecke committed
916
               tw1i= (fwd ? -1: 1) * T0(0.9510565162951535721164393333793821L),
Martin Reinecke's avatar
sync  
Martin Reinecke committed
917
               tw2r= T0(-0.8090169943749474241022934171828191L),
Martin Reinecke's avatar
Martin Reinecke committed
918
               tw2i= (fwd ? -1: 1) * T0(0.5877852522924731291687059546390728L);
919

920 921
  auto CH = [ch,ido,l1](size_t a, size_t b, size_t c) -> T&
    { return ch[a+ido*(b+l1*c)]; };
922
  auto CC = [cc,ido,cdim](size_t a, size_t b, size_t c) -> const T&
923 924 925 926
    { return cc[a+ido*(b+cdim*c)]; };
  auto WA = [wa, ido](size_t x, size_t i)
    { return wa[i-1+x*(ido-1)]; };

927 928 929
  if (ido==1)
    for (size_t k=0; k<l1; ++k)
      {
930 931 932
      POCKETFFT_PREP5(0)
      POCKETFFT_PARTSTEP5a(1,4,tw1r,tw2r,+tw1i,+tw2i)
      POCKETFFT_PARTSTEP5a(2,3,tw2r,tw1r,+tw2i,-tw1i)
933 934 935 936 937
      }
  else
    for (size_t k=0; k<l1; ++k)
      {
      {
938 939 940
      POCKETFFT_PREP5(0)
      POCKETFFT_PARTSTEP5a(1,4,tw1r,tw2r,+tw1i,+tw2i)
      POCKETFFT_PARTSTEP5a(2,3,tw2r,tw1r,+tw2i,-tw1i)
941 942 943
      }
      for (size_t i=1; i<ido; ++i)
        {
944 945 946
        POCKETFFT_PREP5(i)
        POCKETFFT_PARTSTEP5b(1,4,tw1r,tw2r,+tw1i,+tw2i)
        POCKETFFT_PARTSTEP5b(2,3,tw2r,tw1r,+tw2i,-tw1i)
947 948 949 950
        }
      }
  }

951 952 953
#undef POCKETFFT_PARTSTEP5b
#undef POCKETFFT_PARTSTEP5a
#undef POCKETFFT_PREP5
954

955
#define POCKETFFT_PREP7(idx) \
956
        T t1 = CC(idx,0,k), t2, t3, t4, t5, t6, t7; \
Martin Reinecke's avatar
Martin Reinecke committed
957 958 959
        PM (t2,t7,CC(idx,1,k),CC(idx,6,k)); \
        PM (t3,t6,CC(idx,2,k),CC(idx,5,k)); \
        PM (t4,t5,CC(idx,3,k),CC(idx,4,k)); \
960 961 962
        CH(idx,k,0).r=t1.r+t2.r+t3.r+t4.r; \
        CH(idx,k,0).i=t1.i+t2.i+t3.i+t4.i;

963
#define POCKETFFT_PARTSTEP7a0(u1,u2,x1,x2,x3,y1,y2,y3,out1,out2) \
964 965 966 967 968 969
        { \
        T ca,cb; \
        ca.r=t1.r+x1*t2.r+x2*t3.r+x3*t4.r; \
        ca.i=t1.i+x1*t2.i+x2*t3.i+x3*t4.i; \
        cb.i=y1*t7.r y2*t6.r y3*t5.r; \
        cb.r=-(y1*t7.i y2*t6.i y3*t5.i); \
Martin Reinecke's avatar
Martin Reinecke committed
970
        PM(out1,out2,ca,cb); \
971
        }
972 973 974
#define POCKETFFT_PARTSTEP7a(u1,u2,x1,x2,x3,y1,y2,y3) \
        POCKETFFT_PARTSTEP7a0(u1,u2,x1,x2,x3,y1,y2,y3,CH(0,k,u1),CH(0,k,u2))
#define POCKETFFT_PARTSTEP7(u1,u2,x1,x2,x3,y1,y2,y3) \
975 976
        { \
        T da,db; \
977
        POCKETFFT_PARTSTEP7a0(u1,u2,x1,x2,x3,y1,y2,y3,da,db) \
Martin Reinecke's avatar
Martin Reinecke committed
978 979
        special_mul<fwd>(da,WA(u1-1,i),CH(i,k,u1)); \
        special_mul<fwd>(db,WA(u2-1,i),CH(i,k,u2)); \
980 981
        }

Martin Reinecke's avatar
Martin Reinecke committed
982
template<bool fwd, typename T> void pass7(size_t ido, size_t l1,
983
  const T * POCKETFFT_RESTRICT cc, T * POCKETFFT_RESTRICT ch,
Martin Reinecke's avatar
Martin Reinecke committed
984
  const cmplx<T0> * POCKETFFT_RESTRICT wa) const
985 986
  {
  constexpr size_t cdim=7;
Martin Reinecke's avatar
sync  
Martin Reinecke committed
987
  constexpr T0 tw1r= T0(0.6234898018587335305250048840042398L),
Martin Reinecke's avatar
Martin Reinecke committed
988
               tw1i= (fwd ? -1 : 1) * T0(0.7818314824680298087084445266740578L),
Martin Reinecke's avatar
sync  
Martin Reinecke committed
989
               tw2r= T0(-0.2225209339563144042889025644967948L),
Martin Reinecke's avatar
Martin Reinecke committed
990
               tw2i= (fwd ? -1 : 1) * T0(0.9749279121818236070181316829939312L),
Martin Reinecke's avatar
sync  
Martin Reinecke committed
991
               tw3r= T0(-0.9009688679024191262361023195074451L),
Martin Reinecke's avatar
Martin Reinecke committed
992
               tw3i= (fwd ? -1 : 1) * T0(0.433883739117558120475768332848359L);
993

994 995
  auto CH = [ch,ido,l1](size_t a, size_t b, size_t c) -> T&
    { return ch[a+ido*(b+l1*c)]; };
996
  auto CC = [cc,ido,cdim](size_t a, size_t b, size_t c) -> const T&
997 998 999 1000
    { return cc[a+ido*(b+cdim*c)]; };
  auto WA = [wa, ido](size_t x, size_t i)
    { return wa[i-1+x*(ido-1)]; };

1001 1002 1003
  if (ido==1)
    for (size_t k=0; k<l1; ++k)
      {
1004 1005 1006 1007
      POCKETFFT_PREP7(0)
      POCKETFFT_PARTSTEP7a(1,6,tw1r,tw2r,tw3r,+tw1i,+tw2i,+tw3i)
      POCKETFFT_PARTSTEP7a(2,5,tw2r,tw3r,tw1r,+tw2i,-tw3i,-tw1i)
      POCKETFFT_PARTSTEP7a(3,4,tw3r,tw1r,tw2r,+tw3i,-tw1i,+tw2i)
1008 1009 1010 1011 1012
      }
  else
    for (size_t k=0; k<l1; ++k)
      {
      {
1013 1014 1015 1016
      POCKETFFT_PREP7(0)
      POCKETFFT_PARTSTEP7a(1,6,tw1r,tw2r,tw3r,+tw1i,+tw2i,+tw3i)
      POCKETFFT_PARTSTEP7a(2,5,tw2r,tw3r,tw1r,+tw2i,-tw3i,-tw1i)
      POCKETFFT_PARTSTEP7a(3,4,tw3r,tw1r,tw2r,+tw3i,-tw1i,+tw2i)
1017 1018 1019
      }
      for (size_t i=1; i<ido; ++i)
        {
1020 1021 1022 1023
        POCKETFFT_PREP7(i)
        POCKETFFT_PARTSTEP7(1,6,tw1r,tw2r,tw3r,+tw1i,+tw2i,+tw3i)
        POCKETFFT_PARTSTEP7(2,5,tw2r,tw3r,tw1r,+tw2i,-tw3i,-tw1i)
        POCKETFFT_PARTSTEP7(3,4,tw3r,tw1r,tw2r,+tw3i,-tw1i,+tw2i)
1024 1025 1026 1027
        }
      }
  }

1028 1029 1030 1031
#undef POCKETFFT_PARTSTEP7
#undef POCKETFFT_PARTSTEP7a0
#undef POCKETFFT_PARTSTEP7a
#undef POCKETFFT_PREP7
1032

Martin Reinecke's avatar
Martin Reinecke committed
1033
template <bool fwd, typename T> void ROTX45(T &a) const
Martin Reinecke's avatar
sync  
Martin Reinecke committed
1034 1035
  {
  constexpr T0 hsqt2=T0(0.707106781186547524400844362104849L);
Martin Reinecke's avatar
Martin Reinecke committed
1036
  if (fwd)
Martin Reinecke's avatar
sync  
Martin Reinecke committed
1037
    { auto tmp_=a.r; a.r=hsqt2*(a.r+a.i); a.i=hsqt2*(a.i-tmp_); }
Martin Reinecke's avatar
Martin Reinecke committed
1038 1039
  else
    { auto tmp_=a.r; a.r=hsqt2*(a.r-a.i); a.i=hsqt2*(a.i+tmp_); }
Martin Reinecke's avatar
sync  
Martin Reinecke committed
1040
  }
Martin Reinecke's avatar
Martin Reinecke committed
1041
template <bool fwd, typename T> void ROTX135(T &a) const
Martin Reinecke's avatar
sync  
Martin Reinecke committed
1042 1043
  {
  constexpr T0 hsqt2=T0(0.707106781186547524400844362104849L);
Martin Reinecke's avatar
Martin Reinecke committed
1044
  if (fwd)
Martin Reinecke's avatar
sync  
Martin Reinecke committed
1045
    { auto tmp_=a.r; a.r=hsqt2*(a.i-a.r); a.i=hsqt2*(-tmp_-a.i); }
Martin Reinecke's avatar
Martin Reinecke committed
1046 1047
  else
    { auto tmp_=a.r; a.r=hsqt2*(-a.r-a.i); a.i=hsqt2*(tmp_-a.i); }
Martin Reinecke's avatar
sync  
Martin Reinecke committed
1048 1049
  }

Martin Reinecke's avatar
Martin Reinecke committed
1050
template<bool fwd, typename T> void pass8 (size_t ido, size_t l1,
1051
  const T * POCKETFFT_RESTRICT cc, T * POCKETFFT_RESTRICT ch,
Martin Reinecke's avatar
Martin Reinecke committed
1052
  const cmplx<T0> * POCKETFFT_RESTRICT wa) const
Martin Reinecke's avatar
sync  
Martin Reinecke committed
1053 1054 1055
  {
  constexpr size_t cdim=8;

1056 1057
  auto CH = [ch,ido,l1](size_t a, size_t b, size_t c) -> T&
    { return ch[a+ido*(b+l1*c)]; };
1058
  auto CC = [cc,ido,cdim](size_t a, size_t b, size_t c) -> const T&
1059 1060 1061 1062
    { return cc[a+ido*(b+cdim*c)]; };
  auto WA = [wa, ido](size_t x, size_t i)
    { return wa[i-1+x*(ido-1)]; };

Martin Reinecke's avatar
sync  
Martin Reinecke committed
1063 1064 1065 1066
  if (ido==1)
    for (size_t k=0; k<l1; ++k)
      {
      T a0, a1, a2, a3, a4, a5, a6, a7;
Martin Reinecke's avatar
Martin Reinecke committed
1067 1068
      PM(a1,a5,CC(0,1,k),CC(0,5,k));
      PM(a3,a7,CC(0,3,k),CC(0,7,k));
Martin Reinecke's avatar
sync  
Martin Reinecke committed
1069
      PMINPLACE(a1,a3);
Martin Reinecke's avatar
Martin Reinecke committed
1070
      ROTX90<fwd>(a3);
Martin Reinecke's avatar
Martin Reinecke committed
1071 1072

      ROTX90<fwd>(a7);
Martin Reinecke's avatar
sync  
Martin Reinecke committed
1073
      PMINPLACE(a5,a7);
Martin Reinecke's avatar
Martin Reinecke committed
1074 1075