1 files changed, 89 insertions, 0 deletions
diff --git a/src/phasor~~.c b/src/phasor~~.c
new file mode 100755
index 0000000..a6504f7
--- /dev/null
+++ b/src/phasor~~.c
@@ -0,0 +1,89 @@
+/* For information on usage and redistribution, and for a DISCLAIMER OF ALL
+* WARRANTIES, see the file, "LICENSE.txt," in this distribution.
+
+iem_dp written by IOhannes m zmoelnig, Thomas Musil, Copyright (c) IEM KUG Graz Austria 1999 - 2007 */
+/* double precision library */
+
+#include "m_pd.h"
+#include "iemlib.h"
+#include "iem_dp.h"
+
+
+/* -------------------------- phasor~~ ------------------------------ */
+/* based on miller's phasor~ which is part of pd */
+
+static t_class *phasor_tilde_tilde_class, *scalarphasor_tilde_tilde_class;
+
+typedef struct _phasor_tilde_tilde
+{
+  t_object  x_obj;
+  double    x_phase;
+  double    x_rcp_sr;
+  t_float   x_freq;
+} t_phasor_tilde_tilde;
+
+static void *phasor_tilde_tilde_new(t_floatarg freq)
+{
+  t_phasor_tilde_tilde *x = (t_phasor_tilde_tilde *)pd_new(phasor_tilde_tilde_class);
+  
+  inlet_new(&x->x_obj, &x->x_obj.ob_pd, &s_float, gensym("ft1"));
+  x->x_phase = 0;
+  x->x_rcp_sr = 0;
+  outlet_new(&x->x_obj, &s_signal);
+  outlet_new(&x->x_obj, &s_signal);
+  x->x_freq = freq;
+  return(x);
+}
+
+static t_int *phasor_tilde_tilde_perform(t_int *w)
+{
+  t_phasor_tilde_tilde *x = (t_phasor_tilde_tilde *)(w[1]);
+  t_sample *freq_in = (t_sample *)(w[2]);
+  t_sample *outc = (t_sample *)(w[3]);
+  t_sample *outf = (t_sample *)(w[4]);
+  int n = (int)(w[5]);
+  double dphase = x->x_phase;
+  double rcp_sr = x->x_rcp_sr;
+  double fin;
+  t_float fphase;
+  int k;
+  
+  while(n--)
+  {
+    fin = (double)*freq_in++;
+	
+    k = (int)dphase;
+    if(dphase >= 0)
+      dphase -= (double)k;
+    else
+      dphase -= (double)(k-1);
+	
+    fphase = iem_dp_cast_to_float(dphase);
+    *outf++ = iem_dp_calc_residual(dphase, fphase);
+    *outc++ = fphase;
+
+    dphase += fin * rcp_sr;
+  }
+  x->x_phase = dphase;
+  return(w+6);
+}
+
+static void phasor_tilde_tilde_dsp(t_phasor_tilde_tilde *x, t_signal **sp)
+{
+  x->x_rcp_sr = (double)(1.0)/(double)(sp[0]->s_sr);
+  dsp_add(phasor_tilde_tilde_perform, 5, x, sp[0]->s_vec, sp[1]->s_vec, sp[2]->s_vec, sp[0]->s_n);
+}
+
+static void phasor_tilde_tilde_ft1(t_phasor_tilde_tilde *x, t_floatarg ph)
+{
+  x->x_phase = (double)ph;
+}
+
+void phasor_tilde_tilde_setup(void)
+{
+  phasor_tilde_tilde_class = class_new(gensym("phasor~~"), (t_newmethod)phasor_tilde_tilde_new, 0, 
+    sizeof(t_phasor_tilde_tilde), 0, A_DEFFLOAT, 0);
+  CLASS_MAINSIGNALIN(phasor_tilde_tilde_class, t_phasor_tilde_tilde, x_freq);
+  class_addmethod(phasor_tilde_tilde_class, (t_method)phasor_tilde_tilde_dsp, gensym("dsp"), 0);
+  class_addmethod(phasor_tilde_tilde_class, (t_method)phasor_tilde_tilde_ft1, gensym("ft1"), A_FLOAT, 0);
+}