0x3c_tilde.c 7.05 KB
Newer Older
Jonathan Wilkes's avatar
Jonathan Wilkes committed
1
/*
Ivica Bukvic's avatar
Ivica Bukvic committed
2
 * <~: signal comparision
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
25
26
27

#include "zexySIMD.h"

/* ------------------------ relational~ ----------------------------- */


/* ----------------------------- lt_tilde ----------------------------- */
static t_class *lt_tilde_class, *scalarlt_tilde_class;

Jonathan Wilkes's avatar
Jonathan Wilkes committed
28
typedef struct _lt_tilde {
Ivica Ico Bukvic's avatar
Ivica Ico Bukvic committed
29
30
31
32
  t_object x_obj;
  t_float x_f;
} t_lt_tilde;

Jonathan Wilkes's avatar
Jonathan Wilkes committed
33
typedef struct _scalarlt_tilde {
Ivica Ico Bukvic's avatar
Ivica Ico Bukvic committed
34
35
36
37
38
  t_object x_obj;
  t_float x_f;
  t_float x_g;    	    /* inlet value */
} t_scalarlt_tilde;

Ivica Bukvic's avatar
Ivica Bukvic committed
39
static void *lt_tilde_new(t_symbol *UNUSED(s), int argc, t_atom *argv)
Ivica Ico Bukvic's avatar
Ivica Ico Bukvic committed
40
{
Jonathan Wilkes's avatar
Jonathan Wilkes committed
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
  if (argc > 1) {
    post("<~: extra arguments ignored");
  }
  if (argc) {
    t_scalarlt_tilde *x = (t_scalarlt_tilde *)pd_new(scalarlt_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_lt_tilde *x = (t_lt_tilde *)pd_new(lt_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
58
59
60
61
62
63
64
65
}

static t_int *lt_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
66
67
68
  while (n--) {
    *out++ = *in1++ < *in2++;
  }
Ivica Ico Bukvic's avatar
Ivica Ico Bukvic committed
69
70
71
72
73
74
75
76
77
  return (w+5);
}

static t_int *lt_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
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
  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
94
95
96
97
98
99
100
101
102
  return (w+5);
}

static t_int *scalarlt_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
103
104
105
  while (n--) {
    *out++ = *in++ < f;
  }
Ivica Ico Bukvic's avatar
Ivica Ico Bukvic committed
106
107
108
109
110
111
112
113
114
  return (w+5);
}

static t_int *scalarlt_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
115
116
117
118
119
120
121
122
123
124
125
126
127
  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];

    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
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
154
155
  return (w+5);
}
#ifdef __SSE__
static t_int *lt_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_cmplt_ps(in1[0], in2[0]);
    out[0] = _mm_and_ps  (xmm0 , one);

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

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

    xmm1   = _mm_cmplt_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
156
  }
Ivica Ico Bukvic's avatar
Ivica Ico Bukvic committed
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
188
189

  return (w+5);
}
static t_int *scalarlt_tilde_performSSE(t_int *w)
{
  __m128 *in = (__m128 *)(w[1]);
  __m128 *out = (__m128 *)(w[3]);
  float f = *(t_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_cmplt_ps (in[0], scalar);
    out[0] = _mm_and_ps   (xmm0,  one);

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

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

    xmm1   = _mm_cmplt_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
190
static void lt_tilde_dsp(t_lt_tilde* UNUSED(x), t_signal **sp)
Ivica Ico Bukvic's avatar
Ivica Ico Bukvic committed
191
192
193
194
195
196
197
198
{
  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
199
200
201
202
203
204
205
206
    Z_SIMD_CHKBLOCKSIZE(n)&&
    Z_SIMD_CHKALIGN(in1)&&
    Z_SIMD_CHKALIGN(in2)&&
    Z_SIMD_CHKALIGN(out)&&
    ZEXY_TYPE_EQUAL(t_sample, float)
  ) {
    dsp_add(lt_tilde_performSSE, 4, in1, in2, out, n);
  } else
Ivica Ico Bukvic's avatar
Ivica Ico Bukvic committed
207
#endif
Jonathan Wilkes's avatar
Jonathan Wilkes committed
208
209
210
211
212
    if(n&7) {
      dsp_add(lt_tilde_perform, 4, in1, in2, out, n);
    } else {
      dsp_add(lt_tilde_perf8, 4, in1, in2, out, n);
    }
Ivica Ico Bukvic's avatar
Ivica Ico Bukvic committed
213
214
215
216
217
218
219
220
221
222
}

static void scalarlt_tilde_dsp(t_scalarlt_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
223
224
225
226
227
228
229
    Z_SIMD_CHKBLOCKSIZE(n)&&
    Z_SIMD_CHKALIGN(in)&&
    Z_SIMD_CHKALIGN(out)&&
    ZEXY_TYPE_EQUAL(t_sample, float)
  ) {
    dsp_add(scalarlt_tilde_performSSE, 4, in, &x->x_g, out, n);
  } else
Ivica Ico Bukvic's avatar
Ivica Ico Bukvic committed
230
#endif
Jonathan Wilkes's avatar
Jonathan Wilkes committed
231
232
233
234
235
    if (n&7) {
      dsp_add(scalarlt_tilde_perform, 4, in, &x->x_g, out, n);
    } else {
      dsp_add(scalarlt_tilde_perf8, 4, in, &x->x_g, out, n);
    }
Ivica Ico Bukvic's avatar
Ivica Ico Bukvic committed
236
237
238
}
static void lt_tilde_help(t_object*x)
{
Jonathan Wilkes's avatar
Jonathan Wilkes committed
239
  post("\n"HEARTSYMBOL " <~\t\t:: compare 2 signals");
Ivica Ico Bukvic's avatar
Ivica Ico Bukvic committed
240
241
}

242
void setup_0x3c_tilde(void)
Ivica Ico Bukvic's avatar
Ivica Ico Bukvic committed
243
244
{
  lt_tilde_class = class_new(gensym("<~"), (t_newmethod)lt_tilde_new, 0,
Jonathan Wilkes's avatar
Jonathan Wilkes committed
245
                             sizeof(t_lt_tilde), 0, A_GIMME, 0);
246
247
  class_addmethod(lt_tilde_class, (t_method)lt_tilde_dsp, gensym("dsp"),
                  A_CANT, 0);
Ivica Ico Bukvic's avatar
Ivica Ico Bukvic committed
248
  CLASS_MAINSIGNALIN(lt_tilde_class, t_lt_tilde, x_f);
Jonathan Wilkes's avatar
Jonathan Wilkes committed
249
250
  class_addmethod  (lt_tilde_class, (t_method)lt_tilde_help, gensym("help"),
                    A_NULL);
Ivica Ico Bukvic's avatar
Ivica Ico Bukvic committed
251
252
253
  class_sethelpsymbol(lt_tilde_class, gensym("zigbinops"));

  scalarlt_tilde_class = class_new(gensym("<~"), 0, 0,
Jonathan Wilkes's avatar
Jonathan Wilkes committed
254
                                   sizeof(t_scalarlt_tilde), 0, 0);
Ivica Ico Bukvic's avatar
Ivica Ico Bukvic committed
255
  CLASS_MAINSIGNALIN(scalarlt_tilde_class, t_scalarlt_tilde, x_f);
Jonathan Wilkes's avatar
Jonathan Wilkes committed
256
257
  class_addmethod(scalarlt_tilde_class, (t_method)scalarlt_tilde_dsp,
                  gensym("dsp"),
258
                  A_CANT, 0);
Jonathan Wilkes's avatar
Jonathan Wilkes committed
259
260
  class_addmethod  (scalarlt_tilde_class, (t_method)lt_tilde_help,
                    gensym("help"), A_NULL);
Ivica Ico Bukvic's avatar
Ivica Ico Bukvic committed
261
262
263
  class_sethelpsymbol(scalarlt_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_0x3c_tilde();
Ivica Bukvic's avatar
Ivica Bukvic committed
269
270
}
#endif