/*
 * tabread4~~: a tabread with 2 inputs for higher precision
 *
 * (c) 1999-2011 IOhannes m zmölnig, forum::für::umläute, institute of electronic music and acoustics (iem)
 *
 * 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, see <http://www.gnu.org/licenses/>.
 */
/* based on tabread4~ which is part of pd */

#include "zexy.h"

/******************** tabread4~~ ***********************/


static t_class *tabread4_tilde_class=NULL;

typedef struct _tabread4_tilde {
  t_object x_obj;
  int x_npoints;
  t_word *x_vec;
  t_symbol *x_arrayname;
  t_float x_f;
} t_tabread4_tilde;

static void *tabread4_tilde_new(t_symbol *s)
{
  t_tabread4_tilde *x = (t_tabread4_tilde *)pd_new(tabread4_tilde_class);
  x->x_arrayname = s;
  x->x_vec = 0;
  x->x_npoints=0;

  inlet_new(&x->x_obj, &x->x_obj.ob_pd, gensym("signal"), gensym("signal"));
  outlet_new(&x->x_obj, gensym("signal"));
  x->x_f = 0;
  return (x);
}

static t_int *tabread4_tilde_perform(t_int *w)
{
  t_tabread4_tilde *x = (t_tabread4_tilde *)(w[1]);
  t_sample *in = (t_sample *)(w[2]);
  t_sample *in1 = (t_sample *)(w[3]);
  t_sample *out = (t_sample *)(w[4]);
  int n = (int)(w[5]);
  int maxindex;
  t_word *buf = x->x_vec, *wp;
  int i;

  maxindex = x->x_npoints - 3;
  if (!buf) {
    while (n--) {
      *out++ = 0;
    }
    return (w+6);
  }
  for (i = 0; i < n; i++) {
    t_sample in0_s=*in++;
    t_sample in1_s=*in1++;
    double findex = (double)in0_s + (double)in1_s;
    long int index = findex;
    double frac;
    t_sample a,  b,  c,  d, cminusb;
    if (index < 1) {
      index = 1, frac = 0;
    } else if (index > maxindex) {
      index = maxindex, frac = 1;
    } else {
      frac = findex - index;
    }

    wp = buf + index;

    a = wp[-1].w_float;
    b = wp[ 0].w_float;
    c = wp[ 1].w_float;
    d = wp[ 2].w_float;

    cminusb = c-b;
    *out++ = b + frac * (
               cminusb - 0.1666667f * (1.-frac) * (
                 (d - a - 3.0f * cminusb) * frac + (d + 2.0f*a - 3.0f*b)
               )
             );
  }
  return (w+6);
}

static void tabread4_tilde_set(t_tabread4_tilde *x, t_symbol *s)
{
  t_garray *a;

  x->x_arrayname = s;
  if (!(a = (t_garray *)pd_findbyclass(x->x_arrayname, garray_class))) {
    if (*s->s_name) {
      pd_error(x, "tabread4~~: %s: no such array", x->x_arrayname->s_name);
    }
    x->x_vec = 0;
  } else if (!garray_getfloatwords(a, &x->x_npoints, &x->x_vec)) {
    pd_error(x, "%s: bad template for tabread4~~", x->x_arrayname->s_name);
    x->x_vec = 0;
  } else {
    garray_usedindsp(a);
  }
}

static void tabread4_tilde_dsp(t_tabread4_tilde *x, t_signal **sp)
{
  tabread4_tilde_set(x, x->x_arrayname);

  dsp_add(tabread4_tilde_perform, 5, x,
          sp[0]->s_vec, sp[1]->s_vec, sp[2]->s_vec, (t_int)sp[0]->s_n);

}

static void tabread4_tilde_free(t_tabread4_tilde *UNUSED(x))
{
}

ZEXY_SETUP void tabread4_tilde_tilde_setup(void)
{
  tabread4_tilde_class = zexy_new("tabread4~~",
                                  tabread4_tilde_new, tabread4_tilde_free, t_tabread4_tilde, 0, "S");
  CLASS_MAINSIGNALIN(tabread4_tilde_class, t_tabread4_tilde, x_f);
  zexy_addmethod(tabread4_tilde_class, (t_method)tabread4_tilde_dsp, "dsp",
                 "!");
  zexy_addmethod(tabread4_tilde_class, (t_method)tabread4_tilde_set, "set",
                 "s");

  zexy_register("tabread4~~");
}

void setup_tabread40x7e_tilde(void)
{
  tabread4_tilde_tilde_setup();
}

void setup_tabread40x7e0x7e(void)
{
  tabread4_tilde_tilde_setup();
}
