aboutsummaryrefslogtreecommitdiff
path: root/modules/qnorm.c
diff options
context:
space:
mode:
Diffstat (limited to 'modules/qnorm.c')
-rw-r--r--modules/qnorm.c137
1 files changed, 137 insertions, 0 deletions
diff --git a/modules/qnorm.c b/modules/qnorm.c
new file mode 100644
index 0000000..e826b1b
--- /dev/null
+++ b/modules/qnorm.c
@@ -0,0 +1,137 @@
+/*
+ * qnorm.c - quaternion normalization dsp object
+ * Copyright (c) 2000-2003 by Tom Schouten
+ *
+ * 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., 675 Mass Ave, Cambridge, MA 02139, USA.
+ */
+
+#include "m_pd.h"
+#include <math.h>
+#include <stdlib.h>
+#include <stdio.h>
+#include <math.h>
+
+
+typedef struct qnormctl
+{
+ t_float *c_input[4];
+ t_float *c_output[4];
+} t_qnormctl;
+
+typedef struct qnorm
+{
+ t_object x_obj;
+ t_float x_f;
+ t_qnormctl x_ctl;
+} t_qnorm;
+
+
+static t_int *qnorm_perform(t_int *word)
+{
+
+
+
+ t_qnormctl *ctl = (t_qnormctl *)(word[1]);
+ t_int n = (t_int)(word[2]);
+ t_int i;
+
+ t_float *in0 = ctl->c_input[0];
+ t_float *in1 = ctl->c_input[1];
+ t_float *in2 = ctl->c_input[2];
+ t_float *in3 = ctl->c_input[3];
+
+ t_float *out0 = ctl->c_output[0];
+ t_float *out1 = ctl->c_output[1];
+ t_float *out2 = ctl->c_output[2];
+ t_float *out3 = ctl->c_output[3];
+
+ t_float w, x, y, z;
+ t_float norm;
+ t_float inorm;
+
+ for (i=0;i<n;i++)
+ {
+
+ /* read input */
+ w = *in0++;
+ x = *in1++;
+ y = *in2++;
+ z = *in3++;
+
+ /* transform */
+ norm = w * w;
+ norm += x * x;
+ norm += y * y;
+ norm += z * z;
+
+ inorm = (norm == 0.0f) ? (0.0f) : (1.0f / sqrt(norm));
+
+ /* write output */
+ *out0++ = w * inorm;
+ *out1++ = x * inorm;
+ *out2++ = y * inorm;
+ *out3++ = z * inorm;
+ }
+
+
+ return (word+3);
+}
+
+
+
+static void qnorm_dsp(t_qnorm *x, t_signal **sp)
+{
+
+ int i;
+ for (i=0;i<4;i++)
+ {
+ x->x_ctl.c_input[i] = sp[i]->s_vec;
+ x->x_ctl.c_output[i] = sp[i+4]->s_vec;
+ }
+
+ dsp_add(qnorm_perform, 2, &x->x_ctl, sp[0]->s_n);
+
+
+}
+
+
+static void qnorm_free(t_qnorm *x)
+{
+
+}
+
+t_class *qnorm_class;
+
+static void *qnorm_new(t_floatarg channels)
+{
+ int i;
+ t_qnorm *x = (t_qnorm *)pd_new(qnorm_class);
+
+ for (i=1;i<4;i++) inlet_new(&x->x_obj, &x->x_obj.ob_pd, gensym("signal"), gensym("signal"));
+ for (i=0;i<4;i++) outlet_new(&x->x_obj, gensym("signal"));
+
+ return (void *)x;
+}
+
+void qnorm_tilde_setup(void)
+{
+ //post("qnorm~ v0.1");
+ qnorm_class = class_new(gensym("qnorm~"), (t_newmethod)qnorm_new,
+ (t_method)qnorm_free, sizeof(t_qnorm), 0, 0);
+ CLASS_MAINSIGNALIN(qnorm_class, t_qnorm, x_f);
+ class_addmethod(qnorm_class, (t_method)qnorm_dsp, gensym("dsp"), 0);
+
+}
+