0x3d0x3d_tilde.c 7.06 KB
Newer Older
Jonathan Wilkes's avatar
Jonathan Wilkes committed
1
/*
Ivica Bukvic's avatar
Ivica Bukvic committed
2
 * ==~: test signals for equality
Ivica Ico Bukvic's avatar
Ivica Ico Bukvic committed
3
 *
Ivica Bukvic's avatar
Ivica Bukvic committed
4
 * (c) 1999-2011 IOhannes m zmölnig, forum::für::umläute, institute of electronic music and acoustics (iem)
Ivica Ico Bukvic's avatar
Ivica Ico Bukvic committed
5
 *
Ivica Bukvic's avatar
Ivica Bukvic committed
6
7
8
9
 * 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.
Jonathan Wilkes's avatar
Jonathan Wilkes committed
10
 *
Ivica Bukvic's avatar
Ivica Bukvic committed
11
12
13
14
 * 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.
Jonathan Wilkes's avatar
Jonathan Wilkes committed
15
 *
Ivica Bukvic's avatar
Ivica Bukvic committed
16
17
18
 * You should have received a copy of the GNU General Public License along
 * with this program.  If not, see <http://www.gnu.org/licenses/>.
 */
Ivica Ico Bukvic's avatar
Ivica Ico Bukvic committed
19
20
21
22
23
24

#include "zexySIMD.h"

/* ----------------------------- eq_tilde ----------------------------- */
static t_class *eq_tilde_class, *scalareq_tilde_class;

Jonathan Wilkes's avatar
Jonathan Wilkes committed
25
typedef struct _eq_tilde {
Ivica Ico Bukvic's avatar
Ivica Ico Bukvic committed
26
27
28
29
  t_object x_obj;
  t_float x_f;
} t_eq_tilde;

Jonathan Wilkes's avatar
Jonathan Wilkes committed
30
typedef struct _scalareq_tilde {
Ivica Ico Bukvic's avatar
Ivica Ico Bukvic committed
31
32
33
34
35
  t_object x_obj;
  t_float x_f;
  t_float x_g;    	    /* inlet value */
} t_scalareq_tilde;

Ivica Bukvic's avatar
Ivica Bukvic committed
36
static void *eq_tilde_new(t_symbol* UNUSED(s), int argc, t_atom *argv)
Ivica Ico Bukvic's avatar
Ivica Ico Bukvic committed
37
{
Jonathan Wilkes's avatar
Jonathan Wilkes committed
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
  if (argc > 1) {
    post("==~: extra arguments ignored");
  }
  if (argc) {
    t_scalareq_tilde *x = (t_scalareq_tilde *)pd_new(scalareq_tilde_class);
    floatinlet_new(&x->x_obj, &x->x_g);
    x->x_g = atom_getfloatarg(0, argc, argv);
    outlet_new(&x->x_obj, gensym("signal"));
    x->x_f = 0;
    return (x);
  } else {
    t_eq_tilde *x = (t_eq_tilde *)pd_new(eq_tilde_class);
    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);
  }
Ivica Ico Bukvic's avatar
Ivica Ico Bukvic committed
55
56
57
58
59
60
61
62
}

static t_int *eq_tilde_perform(t_int *w)
{
  t_sample *in1 = (t_sample *)(w[1]);
  t_sample *in2 = (t_sample *)(w[2]);
  t_sample *out = (t_sample *)(w[3]);
  int n = (int)(w[4]);
Jonathan Wilkes's avatar
Jonathan Wilkes committed
63
64
65
  while (n--) {
    *out++ = (*in1++ == *in2++);
  }
Ivica Ico Bukvic's avatar
Ivica Ico Bukvic committed
66
67
68
69
70
71
72
73
74
  return (w+5);
}

static t_int *eq_tilde_perf8(t_int *w)
{
  t_sample *in1 = (t_sample *)(w[1]);
  t_sample *in2 = (t_sample *)(w[2]);
  t_sample *out = (t_sample *)(w[3]);
  int n = (int)(w[4]);
Jonathan Wilkes's avatar
Jonathan Wilkes committed
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
  for (; n; n -= 8, in1 += 8, in2 += 8, out += 8) {
    t_sample f0 = in1[0], f1 = in1[1], f2 = in1[2], f3 = in1[3];
    t_sample f4 = in1[4], f5 = in1[5], f6 = in1[6], f7 = in1[7];

    t_sample g0 = in2[0], g1 = in2[1], g2 = in2[2], g3 = in2[3];
    t_sample g4 = in2[4], g5 = in2[5], g6 = in2[6], g7 = in2[7];

    out[0] = f0 == g0;
    out[1] = f1 == g1;
    out[2] = f2 == g2;
    out[3] = f3 == g3;
    out[4] = f4 == g4;
    out[5] = f5 == g5;
    out[6] = f6 == g6;
    out[7] = f7 == g7;
  }
Ivica Ico Bukvic's avatar
Ivica Ico Bukvic committed
91
92
93
94
95
96
97
98
99
  return (w+5);
}

static t_int *scalareq_tilde_perform(t_int *w)
{
  t_sample *in  = (t_sample *)(w[1]);
  t_sample f    = *(t_float *)(w[2]);
  t_sample *out = (t_sample *)(w[3]);
  int n = (int)(w[4]);
Jonathan Wilkes's avatar
Jonathan Wilkes committed
100
101
102
  while (n--) {
    *out++ = (*in++ == f);
  }
Ivica Ico Bukvic's avatar
Ivica Ico Bukvic committed
103
104
105
106
107
108
109
110
111
  return (w+5);
}

static t_int *scalareq_tilde_perf8(t_int *w)
{
  t_sample *in  = (t_sample *)(w[1]);
  t_sample  g   = *(t_float *)(w[2]);
  t_sample *out = (t_sample *)(w[3]);
  int n = (int)(w[4]);
Jonathan Wilkes's avatar
Jonathan Wilkes committed
112
113
114
  for (; n; n -= 8, in += 8, out += 8) {
    t_sample f0 = in[0], f1 = in[1], f2 = in[2], f3 = in[3];
    t_sample f4 = in[4], f5 = in[5], f6 = in[6], f7 = in[7];
Ivica Ico Bukvic's avatar
Ivica Ico Bukvic committed
115

Jonathan Wilkes's avatar
Jonathan Wilkes committed
116
117
118
119
120
121
122
123
124
    out[0] = (f0 == g);
    out[1] = (f1 == g);
    out[2] = (f2 == g);
    out[3] = (f3 == g);
    out[4] = (f4 == g);
    out[5] = (f5 == g);
    out[6] = (f6 == g);
    out[7] = (f7 == g);
  }
Ivica Ico Bukvic's avatar
Ivica Ico Bukvic committed
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
  return (w+5);
}

#ifdef __SSE__
static t_int *eq_tilde_performSSE(t_int *w)
{
  __m128 *in1 = (__m128 *)(w[1]);
  __m128 *in2 = (__m128 *)(w[2]);
  __m128 *out = (__m128 *)(w[3]);
  int n = (int)(w[4])>>4;
  const __m128 one    = _mm_set1_ps(1.f);

  while (n--) {
    __m128 xmm0, xmm1;
    xmm0   = _mm_cmpeq_ps(in1[0], in2[0]);
    out[0] = _mm_and_ps  (xmm0 , one);

    xmm1   = _mm_cmpeq_ps(in1[1], in2[1]);
    out[1] = _mm_and_ps  (xmm1 , one);

    xmm0   = _mm_cmpeq_ps(in1[2], in2[2]);
    out[2] = _mm_and_ps  (xmm0 , one);

    xmm1   = _mm_cmpeq_ps(in1[3], in2[3]);
    out[3] = _mm_and_ps  (xmm1 , one);

    in1+=4;
    in2+=4;
    out+=4;
Jonathan Wilkes's avatar
Jonathan Wilkes committed
154
  }
Ivica Ico Bukvic's avatar
Ivica Ico Bukvic committed
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187

  return (w+5);
}
static t_int *scalareq_tilde_performSSE(t_int *w)
{
  __m128 *in = (__m128 *)(w[1]);
  __m128 *out = (__m128 *)(w[3]);
  float f = *(float *)(w[2]);
  __m128 scalar = _mm_set1_ps(f);
  int n = (int)(w[4])>>4;
  const __m128 one    = _mm_set1_ps(1.f);

  while (n--) {
    __m128 xmm0, xmm1;
    xmm0   = _mm_cmpeq_ps (in[0], scalar);
    out[0] = _mm_and_ps   (xmm0,  one);

    xmm1   = _mm_cmpeq_ps (in[1], scalar);
    out[1] = _mm_and_ps   (xmm1,  one);

    xmm0   = _mm_cmpeq_ps (in[2], scalar);
    out[2] = _mm_and_ps   (xmm0,  one);

    xmm1   = _mm_cmpeq_ps (in[3], scalar);
    out[3] = _mm_and_ps   (xmm1,  one);

    in +=4;
    out+=4;
  }
  return (w+5);
}
#endif /* __SSE__ */

Ivica Bukvic's avatar
Ivica Bukvic committed
188
static void eq_tilde_dsp(t_eq_tilde* UNUSED(x), t_signal **sp)
Ivica Ico Bukvic's avatar
Ivica Ico Bukvic committed
189
190
191
192
193
194
195
196
197
{
  t_sample*in1=sp[0]->s_vec;
  t_sample*in2=sp[1]->s_vec;
  t_sample*out=sp[2]->s_vec;

  int n=sp[0]->s_n;

#ifdef __SSE__
  if(
Jonathan Wilkes's avatar
Jonathan Wilkes committed
198
199
200
201
202
203
204
205
    Z_SIMD_CHKBLOCKSIZE(n)&&
    Z_SIMD_CHKALIGN(in1)&&
    Z_SIMD_CHKALIGN(in2)&&
    Z_SIMD_CHKALIGN(out)&&
    ZEXY_TYPE_EQUAL(t_sample, float)
  ) {
    dsp_add(eq_tilde_performSSE, 4, in1, in2, out, n);
  } else
Ivica Ico Bukvic's avatar
Ivica Ico Bukvic committed
206
#endif
Jonathan Wilkes's avatar
Jonathan Wilkes committed
207
208
209
210
211
    if (n&7) {
      dsp_add(eq_tilde_perform, 4, in1, in2, out, n);
    } else {
      dsp_add(eq_tilde_perf8, 4, in1, in2, out, n);
    }
Ivica Ico Bukvic's avatar
Ivica Ico Bukvic committed
212
213
214
215
216
217
218
219
220
221
}

static void scalareq_tilde_dsp(t_scalareq_tilde *x, t_signal **sp)
{
  t_sample*in =sp[0]->s_vec;
  t_sample*out=sp[1]->s_vec;
  int n       =sp[0]->s_n;

#ifdef __SSE__
  if(
Jonathan Wilkes's avatar
Jonathan Wilkes committed
222
223
224
225
226
227
228
    Z_SIMD_CHKBLOCKSIZE(n)&&
    Z_SIMD_CHKALIGN(in)&&
    Z_SIMD_CHKALIGN(out) &&
    ZEXY_TYPE_EQUAL(t_sample, float)
  ) {
    dsp_add(scalareq_tilde_performSSE, 4, in, &x->x_g, out, n);
  } else
Ivica Ico Bukvic's avatar
Ivica Ico Bukvic committed
229
#endif
Jonathan Wilkes's avatar
Jonathan Wilkes committed
230
231
232
233
234
    if (n&7) {
      dsp_add(scalareq_tilde_perform, 4, in, &x->x_g, out, n);
    } else {
      dsp_add(scalareq_tilde_perf8,   4, in, &x->x_g, out, n);
    }
Ivica Ico Bukvic's avatar
Ivica Ico Bukvic committed
235
236
237
238
}

static void eq_tilde_help(t_object*x)
{
Jonathan Wilkes's avatar
Jonathan Wilkes committed
239
  post("\n"HEARTSYMBOL " &&~\t\t:: test 2 signals for equality");
Ivica Ico Bukvic's avatar
Ivica Ico Bukvic committed
240
}
241
void setup_0x3d0x3d_tilde(void)
Ivica Ico Bukvic's avatar
Ivica Ico Bukvic committed
242
243
{
  eq_tilde_class = class_new(gensym("==~"), (t_newmethod)eq_tilde_new, 0,
Jonathan Wilkes's avatar
Jonathan Wilkes committed
244
                             sizeof(t_eq_tilde), 0, A_GIMME, 0);
245
246
  class_addmethod(eq_tilde_class, (t_method)eq_tilde_dsp, gensym("dsp"),
                    A_CANT, 0);
Ivica Ico Bukvic's avatar
Ivica Ico Bukvic committed
247
  CLASS_MAINSIGNALIN(eq_tilde_class, t_eq_tilde, x_f);
Jonathan Wilkes's avatar
Jonathan Wilkes committed
248
249
  class_addmethod  (eq_tilde_class, (t_method)eq_tilde_help, gensym("help"),
                    A_NULL);
Ivica Ico Bukvic's avatar
Ivica Ico Bukvic committed
250
251
252
  class_sethelpsymbol(eq_tilde_class, gensym("zigbinops"));

  scalareq_tilde_class = class_new(gensym("==~"), 0, 0,
Jonathan Wilkes's avatar
Jonathan Wilkes committed
253
                                   sizeof(t_scalareq_tilde), 0, 0);
Ivica Ico Bukvic's avatar
Ivica Ico Bukvic committed
254
  CLASS_MAINSIGNALIN(scalareq_tilde_class, t_scalareq_tilde, x_f);
Jonathan Wilkes's avatar
Jonathan Wilkes committed
255
256
  class_addmethod(scalareq_tilde_class, (t_method)scalareq_tilde_dsp,
                  gensym("dsp"),
257
                  A_CANT, 0);
Jonathan Wilkes's avatar
Jonathan Wilkes committed
258
259
  class_addmethod  (scalareq_tilde_class, (t_method)eq_tilde_help,
                    gensym("help"), A_NULL);
Ivica Ico Bukvic's avatar
Ivica Ico Bukvic committed
260
261
262
263
  class_sethelpsymbol(scalareq_tilde_class, gensym("zigbinops"));

  zexy_register("==~");
}
Ivica Bukvic's avatar
Ivica Bukvic committed
264
265
266
267

#ifndef ZEXY_LIBRARY
void setup(void)
{
268
  setup_0x3d0x3d_tilde();
Ivica Bukvic's avatar
Ivica Bukvic committed
269
270
}
#endif