cannam@127: /*
cannam@127:  * Copyright (c) 2003, 2007-14 Matteo Frigo
cannam@127:  * Copyright (c) 2003, 2007-14 Massachusetts Institute of Technology
cannam@127:  *
cannam@127:  * This program is free software; you can redistribute it and/or modify
cannam@127:  * it under the terms of the GNU General Public License as published by
cannam@127:  * the Free Software Foundation; either version 2 of the License, or
cannam@127:  * (at your option) any later version.
cannam@127:  *
cannam@127:  * This program is distributed in the hope that it will be useful,
cannam@127:  * but WITHOUT ANY WARRANTY; without even the implied warranty of
cannam@127:  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
cannam@127:  * GNU General Public License for more details.
cannam@127:  *
cannam@127:  * You should have received a copy of the GNU General Public License
cannam@127:  * along with this program; if not, write to the Free Software
cannam@127:  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301  USA
cannam@127:  *
cannam@127:  */
cannam@127: 
cannam@127: /* express a hc2hc problem in terms of rdft + multiplication by
cannam@127:    twiddle factors */
cannam@127: 
cannam@127: #include "hc2hc.h"
cannam@127: 
cannam@127: typedef hc2hc_solver S;
cannam@127: 
cannam@127: typedef struct {
cannam@127:      plan_hc2hc super;
cannam@127: 
cannam@127:      INT r, m, s, vl, vs, mstart1, mcount1;
cannam@127:      plan *cld0;
cannam@127:      plan *cld;
cannam@127:      twid *td;
cannam@127: } P;
cannam@127: 
cannam@127: 
cannam@127: /**************************************************************/
cannam@127: static void mktwiddle(P *ego, enum wakefulness wakefulness)
cannam@127: {
cannam@127:      static const tw_instr tw[] = { { TW_HALF, 0, 0 }, { TW_NEXT, 1, 0 } };
cannam@127: 
cannam@127:      /* note that R and M are swapped, to allow for sequential
cannam@127: 	access both to data and twiddles */
cannam@127:      X(twiddle_awake)(wakefulness, &ego->td, tw, 
cannam@127: 		      ego->r * ego->m, ego->m, ego->r);
cannam@127: }
cannam@127: 
cannam@127: static void bytwiddle(const P *ego, R *IO, R sign)
cannam@127: {
cannam@127:      INT i, j, k;
cannam@127:      INT r = ego->r, m = ego->m, s = ego->s, vl = ego->vl, vs = ego->vs;
cannam@127:      INT ms = m * s;
cannam@127:      INT mstart1 = ego->mstart1, mcount1 = ego->mcount1;
cannam@127:      INT wrem = 2 * ((m-1)/2 - mcount1);
cannam@127: 
cannam@127:      for (i = 0; i < vl; ++i, IO += vs) {
cannam@127: 	  const R *W = ego->td->W;
cannam@127: 
cannam@127: 	  A(m % 2 == 1);
cannam@127: 	  for (k = 1, W += (m - 1) + 2*(mstart1-1); k < r; ++k) {
cannam@127: 	       /* pr := IO + (j + mstart1) * s + k * ms */
cannam@127: 	       R *pr = IO + mstart1 * s + k * ms;
cannam@127: 
cannam@127: 	       /* pi := IO + (m - j - mstart1) * s + k * ms */
cannam@127: 	       R *pi = IO - mstart1 * s + (k + 1) * ms;
cannam@127: 
cannam@127: 	       for (j = 0; j < mcount1; ++j, pr += s, pi -= s) {
cannam@127: 		    E xr = *pr;
cannam@127: 		    E xi = *pi;
cannam@127: 		    E wr = W[0];
cannam@127: 		    E wi = sign * W[1];
cannam@127: 		    *pr = xr * wr - xi * wi;
cannam@127: 		    *pi = xi * wr + xr * wi;
cannam@127: 		    W += 2;
cannam@127: 	       }
cannam@127: 	       W += wrem;
cannam@127: 	  }
cannam@127:      }
cannam@127: }
cannam@127: 
cannam@127: static void swapri(R *IO, INT r, INT m, INT s, INT jstart, INT jend)
cannam@127: {
cannam@127:      INT k;
cannam@127:      INT ms = m * s;
cannam@127:      INT js = jstart * s;
cannam@127:      for (k = 0; k + k < r; ++k) {
cannam@127: 	  /* pr := IO + (m - j) * s + k * ms */
cannam@127: 	  R *pr = IO + (k + 1) * ms - js;
cannam@127: 	  /* pi := IO + (m - j) * s + (r - 1 - k) * ms */
cannam@127: 	  R *pi = IO + (r - k) * ms - js;
cannam@127: 	  INT j;
cannam@127: 	  for (j = jstart; j < jend; j += 1, pr -= s, pi -= s) {
cannam@127: 	       R t = *pr;
cannam@127: 	       *pr = *pi;
cannam@127: 	       *pi = t;
cannam@127: 	  }
cannam@127:      }
cannam@127: }
cannam@127: 
cannam@127: static void reorder_dit(const P *ego, R *IO)
cannam@127: {
cannam@127:      INT i, k;
cannam@127:      INT r = ego->r, m = ego->m, s = ego->s, vl = ego->vl, vs = ego->vs;
cannam@127:      INT ms = m * s;
cannam@127:      INT mstart1 = ego->mstart1, mend1 = mstart1 + ego->mcount1;
cannam@127: 
cannam@127:      for (i = 0; i < vl; ++i, IO += vs) {
cannam@127: 	  for (k = 1; k + k < r; ++k) {
cannam@127: 	       R *p0 = IO + k * ms;
cannam@127: 	       R *p1 = IO + (r - k) * ms;
cannam@127: 	       INT j;
cannam@127: 
cannam@127: 	       for (j = mstart1; j < mend1; ++j) {
cannam@127: 		    E rp, ip, im, rm;
cannam@127: 		    rp = p0[j * s];
cannam@127: 		    im = p1[ms - j * s];
cannam@127: 		    rm = p1[j * s];
cannam@127: 		    ip = p0[ms - j * s];
cannam@127: 		    p0[j * s] = rp - im;
cannam@127: 		    p1[ms - j * s] = rp + im;
cannam@127: 		    p1[j * s] = rm - ip;
cannam@127: 		    p0[ms - j * s] = ip + rm;
cannam@127: 	       }
cannam@127: 	  }
cannam@127: 
cannam@127: 	  swapri(IO, r, m, s, mstart1, mend1);
cannam@127:      }
cannam@127: }
cannam@127: 
cannam@127: static void reorder_dif(const P *ego, R *IO)
cannam@127: {
cannam@127:      INT i, k;
cannam@127:      INT r = ego->r, m = ego->m, s = ego->s, vl = ego->vl, vs = ego->vs;
cannam@127:      INT ms = m * s;
cannam@127:      INT mstart1 = ego->mstart1, mend1 = mstart1 + ego->mcount1;
cannam@127: 
cannam@127:      for (i = 0; i < vl; ++i, IO += vs) {
cannam@127: 	  swapri(IO, r, m, s, mstart1, mend1);
cannam@127: 
cannam@127: 	  for (k = 1; k + k < r; ++k) {
cannam@127: 	       R *p0 = IO + k * ms;
cannam@127: 	       R *p1 = IO + (r - k) * ms;
cannam@127: 	       const R half = K(0.5);
cannam@127: 	       INT j;
cannam@127: 
cannam@127: 	       for (j = mstart1; j < mend1; ++j) {
cannam@127: 		    E rp, ip, im, rm;
cannam@127: 		    rp = half * p0[j * s];
cannam@127: 		    im = half * p1[ms - j * s];
cannam@127: 		    rm = half * p1[j * s];
cannam@127: 		    ip = half * p0[ms - j * s];
cannam@127: 		    p0[j * s] = rp + im;
cannam@127: 		    p1[ms - j * s] = im - rp;
cannam@127: 		    p1[j * s] = rm + ip;
cannam@127: 		    p0[ms - j * s] = ip - rm;
cannam@127: 	       }
cannam@127: 	  }
cannam@127:      }
cannam@127: }
cannam@127: 
cannam@127: static int applicable(rdft_kind kind, INT r, INT m, const planner *plnr)
cannam@127: {
cannam@127:      return (1 
cannam@127: 	     && (kind == R2HC || kind == HC2R)
cannam@127: 	     && (m % 2)
cannam@127: 	     && (r % 2)
cannam@127: 	     && !NO_SLOWP(plnr)
cannam@127: 	  );
cannam@127: }
cannam@127: 
cannam@127: /**************************************************************/
cannam@127: 
cannam@127: static void apply_dit(const plan *ego_, R *IO)
cannam@127: {
cannam@127:      const P *ego = (const P *) ego_;
cannam@127:      INT start;
cannam@127:      plan_rdft *cld, *cld0;
cannam@127: 
cannam@127:      bytwiddle(ego, IO, K(-1.0));
cannam@127: 
cannam@127:      cld0 = (plan_rdft *) ego->cld0;
cannam@127:      cld0->apply(ego->cld0, IO, IO);
cannam@127: 
cannam@127:      start = ego->mstart1 * ego->s;
cannam@127:      cld = (plan_rdft *) ego->cld;
cannam@127:      cld->apply(ego->cld, IO + start, IO + start);
cannam@127: 
cannam@127:      reorder_dit(ego, IO);
cannam@127: }
cannam@127: 
cannam@127: static void apply_dif(const plan *ego_, R *IO)
cannam@127: {
cannam@127:      const P *ego = (const P *) ego_;
cannam@127:      INT start;
cannam@127:      plan_rdft *cld, *cld0;
cannam@127: 
cannam@127:      reorder_dif(ego, IO);
cannam@127: 
cannam@127:      cld0 = (plan_rdft *) ego->cld0;
cannam@127:      cld0->apply(ego->cld0, IO, IO);
cannam@127: 
cannam@127:      start = ego->mstart1 * ego->s;
cannam@127:      cld = (plan_rdft *) ego->cld;
cannam@127:      cld->apply(ego->cld, IO + start, IO + start);
cannam@127: 
cannam@127:      bytwiddle(ego, IO, K(1.0));
cannam@127: }
cannam@127: 
cannam@127: 
cannam@127: static void awake(plan *ego_, enum wakefulness wakefulness)
cannam@127: {
cannam@127:      P *ego = (P *) ego_;
cannam@127:      X(plan_awake)(ego->cld0, wakefulness);
cannam@127:      X(plan_awake)(ego->cld, wakefulness);
cannam@127:      mktwiddle(ego, wakefulness);
cannam@127: }
cannam@127: 
cannam@127: static void destroy(plan *ego_)
cannam@127: {
cannam@127:      P *ego = (P *) ego_;
cannam@127:      X(plan_destroy_internal)(ego->cld);
cannam@127:      X(plan_destroy_internal)(ego->cld0);
cannam@127: }
cannam@127: 
cannam@127: static void print(const plan *ego_, printer *p)
cannam@127: {
cannam@127:      const P *ego = (const P *) ego_;
cannam@127:      p->print(p, "(hc2hc-generic-%s-%D-%D%v%(%p%)%(%p%))", 
cannam@127: 	      ego->super.apply == apply_dit ? "dit" : "dif",
cannam@127: 	      ego->r, ego->m, ego->vl, ego->cld0, ego->cld);
cannam@127: }
cannam@127: 
cannam@127: static plan *mkcldw(const hc2hc_solver *ego_, 
cannam@127: 		    rdft_kind kind, INT r, INT m, INT s, INT vl, INT vs, 
cannam@127: 		    INT mstart, INT mcount,
cannam@127: 		    R *IO, planner *plnr)
cannam@127: {
cannam@127:      P *pln;
cannam@127:      plan *cld0 = 0, *cld = 0;
cannam@127:      INT mstart1, mcount1, mstride;
cannam@127: 
cannam@127:      static const plan_adt padt = {
cannam@127: 	  0, awake, print, destroy
cannam@127:      };
cannam@127: 
cannam@127:      UNUSED(ego_);
cannam@127: 
cannam@127:      A(mstart >= 0 && mcount > 0 && mstart + mcount <= (m+2)/2);
cannam@127: 
cannam@127:      if (!applicable(kind, r, m, plnr))
cannam@127:           return (plan *)0;
cannam@127: 
cannam@127:      A(m % 2);
cannam@127:      mstart1 = mstart + (mstart == 0);
cannam@127:      mcount1 = mcount - (mstart == 0);
cannam@127:      mstride = m - (mstart + mcount - 1) - mstart1;
cannam@127: 
cannam@127:      /* 0th (DC) transform (vl of these), if mstart == 0 */
cannam@127:      cld0 = X(mkplan_d)(plnr, 
cannam@127: 			X(mkproblem_rdft_1_d)(
cannam@127: 			     mstart == 0 ? X(mktensor_1d)(r, m * s, m * s)
cannam@127: 			     : X(mktensor_0d)(),
cannam@127: 			     X(mktensor_1d)(vl, vs, vs),
cannam@127: 			     IO, IO, kind)
cannam@127: 			);
cannam@127:      if (!cld0) goto nada;
cannam@127: 
cannam@127:      /* twiddle transforms: there are 2 x mcount1 x vl of these
cannam@127: 	(where 2 corresponds to the real and imaginary parts) ...
cannam@127:         the 2 x mcount1 loops are combined if mstart=0 and mcount=(m+2)/2. */
cannam@127:      cld = X(mkplan_d)(plnr, 
cannam@127: 			X(mkproblem_rdft_1_d)(
cannam@127: 			     X(mktensor_1d)(r, m * s, m * s),
cannam@127: 			     X(mktensor_3d)(2, mstride * s, mstride * s,
cannam@127: 					    mcount1, s, s, 
cannam@127: 					    vl, vs, vs),
cannam@127: 			     IO + s * mstart1, IO + s * mstart1, kind)
cannam@127: 	                );
cannam@127:      if (!cld) goto nada;
cannam@127:      
cannam@127:      pln = MKPLAN_HC2HC(P, &padt, (kind == R2HC) ? apply_dit : apply_dif);
cannam@127:      pln->cld = cld;
cannam@127:      pln->cld0 = cld0;
cannam@127:      pln->r = r;
cannam@127:      pln->m = m;
cannam@127:      pln->s = s;
cannam@127:      pln->vl = vl;
cannam@127:      pln->vs = vs;
cannam@127:      pln->td = 0;
cannam@127:      pln->mstart1 = mstart1;
cannam@127:      pln->mcount1 = mcount1;
cannam@127: 
cannam@127:      {
cannam@127: 	  double n0 = 0.5 * (r - 1) * (2 * mcount1) * vl;
cannam@127: 	  pln->super.super.ops = cld->ops;
cannam@127: 	  pln->super.super.ops.mul += (kind == R2HC ? 5.0 : 7.0) * n0;
cannam@127: 	  pln->super.super.ops.add += 4.0 * n0;
cannam@127: 	  pln->super.super.ops.other += 11.0 * n0;
cannam@127:      }
cannam@127:      return &(pln->super.super);
cannam@127: 
cannam@127:  nada:
cannam@127:      X(plan_destroy_internal)(cld);
cannam@127:      X(plan_destroy_internal)(cld0);
cannam@127:      return (plan *) 0;
cannam@127: }
cannam@127: 
cannam@127: static void regsolver(planner *plnr, INT r)
cannam@127: {
cannam@127:      S *slv = (S *)X(mksolver_hc2hc)(sizeof(S), r, mkcldw);
cannam@127:      REGISTER_SOLVER(plnr, &(slv->super));
cannam@127:      if (X(mksolver_hc2hc_hook)) {
cannam@127: 	  slv = (S *)X(mksolver_hc2hc_hook)(sizeof(S), r, mkcldw);
cannam@127: 	  REGISTER_SOLVER(plnr, &(slv->super));
cannam@127:      }
cannam@127: }
cannam@127: 
cannam@127: void X(hc2hc_generic_register)(planner *p)
cannam@127: {
cannam@127:      regsolver(p, 0);
cannam@127: }