apps/plugins/pdbox/PDa/intern/sfread~.c

   1 #ifdef ROCKBOX
   2 #include "plugin.h"
   3 #include "../../pdbox.h"
   4 #else /* ROCKBOX */
   5 #include <unistd.h>
   6 #include <fcntl.h>
   7 #include <errno.h>
   8 #include <stdio.h>
   9 #include <string.h>
  10 #include <unistd.h>
  11 #include <sys/mman.h>
  12 #include <sys/stat.h>
  13 #endif /* ROCKBOX */
  14
  15 #include "../src/m_pd.h"
  16 #include <../src/m_fixed.h>
  17 #include "../src/g_canvas.h"
  18
  19 /* ------------------------ sfread~ ----------------------------- */
  20
  21 #include "sformat.h"
  22
  23 static t_class *sfread_class;
  24
  25
  26 typedef struct _sfread
  27 {
  28      t_object x_obj;
  29      void*     x_mapaddr;
  30      int       x_fd;
  31
  32      int    x_play;
  33      int    x_channels;
  34      long long    x_size;
  35      int    x_loop;
  36      t_time x_pos;
  37
  38      t_sample x_skip;
  39      t_sample x_speed;
  40
  41      t_glist * x_glist;
  42      t_outlet *x_bangout;
  43 } t_sfread;
  44
  45
  46 void sfread_open(t_sfread *x,t_symbol *filename)
  47 {
  48 #ifndef ROCKBOX
  49      struct stat  fstate;
  50 #endif
  51      char fname[MAXPDSTRING];
  52
  53      if (filename == &s_) {
  54           post("sfread: open without filename");
  55           return;
  56      }
  57
  58      canvas_makefilename(glist_getcanvas(x->x_glist), filename->s_name,
  59                          fname, MAXPDSTRING);
  60
  61
  62      /* close the old file */
  63
  64 #ifdef ROCKBOX
  65      if (x->x_mapaddr) freebytes(x->x_mapaddr, x->x_size);
  66 #else
  67      if (x->x_mapaddr) munmap(x->x_mapaddr,x->x_size);
  68 #endif
  69      if (x->x_fd >= 0) close(x->x_fd);
  70
  71      if ((x->x_fd = open(fname,O_RDONLY)) < 0)
  72      {
  73           error("can't open %s",fname);
  74           x->x_play = 0;
  75           x->x_mapaddr = NULL;
  76           return;
  77      }
  78
  79      /* get the size */
  80 #ifdef ROCKBOX
  81      x->x_size = rb->filesize(x->x_fd);
  82 #else
  83      fstat(x->x_fd,&fstate);
  84      x->x_size = fstate.st_size;
  85 #endif
  86
  87      /* map the file into memory */
  88
  89 #ifdef ROCKBOX
  90      x->x_mapaddr = getbytes(x->x_size);
  91      if (!x->x_mapaddr)
  92      {
  93           error("can't mmap %s",fname);
  94           return;
  95      }
  96      int r = read(x->x_fd, x->x_mapaddr, x->x_size);
  97      if (r != x->x_size)
  98      {
  99           error("can't mmap %s",fname);
 100           return;
 101      }
 102 #else
 103      if (!(x->x_mapaddr = mmap(NULL,x->x_size,PROT_READ,MAP_PRIVATE,x->x_fd,0)))
 104      {
 105           error("can't mmap %s",fname);
 106           return;
 107      }
 108 #endif
 109 }
 110
 111 #define MAX_CHANS 4
 112
 113 static t_int *sfread_perform(t_int *w)
 114 {
 115      t_sfread* x = (t_sfread*)(w[1]);
 116      short* buf = x->x_mapaddr;
 117      t_time tmp;
 118      int c = x->x_channels;
 119      t_time pos = x->x_pos;
 120      t_sample speed = x->x_speed;
 121      t_time end =  itofix(x->x_size/sizeof(short)/c);
 122      int i,n;
 123      t_sample* out[MAX_CHANS];
 124
 125      for (i=0;i<c;i++)
 126           out[i] = (t_sample *)(w[3+i]);
 127      n = (int)(w[3+c]);
 128
 129      /* loop */
 130
 131      if (pos >  end)
 132           pos = end;
 133
 134      if (pos + n*speed >= end) { // playing forward end
 135           if (!x->x_loop) {
 136                x->x_play=0;
 137           }
 138           pos = x->x_skip;
 139      }
 140      tmp = n*speed;
 141
 142      if (pos + n*speed <= 0) {  // playing backwards end
 143           if (!x->x_loop) {
 144                x->x_play=0;
 145           }
 146           pos = end;
 147
 148      }
 149      if (x->x_play && x->x_mapaddr) {
 150        t_time aoff = fixtoi(pos)*c;
 151        while (n--) {
 152          long frac = (long long)((1<<fix1)-1)&pos;
 153
 154          for (i=0;i<c;i++)  {
 155            t_sample bs = *(buf+aoff+i)<<(fix1-16);
 156            t_sample cs = *(buf+aoff+i+1)<<(fix1-16);
 157            *out[i]++ = bs + mult((cs - bs),frac);
 158
 159          }
 160          pos += speed;
 161          aoff = fixtoi(pos)*c;
 162          if (aoff > end) {
 163            if (x->x_loop) pos = x->x_skip;
 164            else break;
 165          }
 166          if (aoff < x->x_skip) {
 167            if (x->x_loop) pos = end;
 168            else break;
 169          }
 170        }
 171        /* Fill with zero in case of end */
 172        n++;
 173        while (n--)
 174          for (i=0;i<c;i++)
 175            *out[i]++ = 0;
 176      }
 177      else {
 178        while (n--) {
 179          for (i=0;i<c;i++)
 180            *out[i]++ = 0.;
 181        }
 182      }
 183
 184      x->x_pos = pos;
 185      return (w+c+4);
 186 }
 187
 188
 189 static void sfread_float(t_sfread *x, t_floatarg f)
 190 {
 191      int t = f;
 192      if (t && x->x_mapaddr) {
 193           x->x_play=1;
 194      }
 195      else {
 196           x->x_play=0;
 197      }
 198
 199 }
 200
 201 static void sfread_loop(t_sfread *x, t_floatarg f)
 202 {
 203      x->x_loop = f;
 204 }
 205
 206
 207
 208 static void sfread_size(t_sfread* x)
 209 {
 210      t_atom a;
 211
 212      SETFLOAT(&a,x->x_size*0.5/x->x_channels);
 213      outlet_list(x->x_bangout, gensym("size"),1,&a);
 214 }
 215
 216 static void sfread_state(t_sfread* x)
 217 {
 218      t_atom a;
 219
 220      SETFLOAT(&a,x->x_play);
 221      outlet_list(x->x_bangout, gensym("state"),1,&a);
 222 }
 223
 224
 225
 226
 227 static void sfread_bang(t_sfread* x)
 228 {
 229      x->x_pos = x->x_skip;
 230      sfread_float(x,1.0);
 231 }
 232
 233
 234 static void sfread_dsp(t_sfread *x, t_signal **sp)
 235 {
 236 /*     post("sfread: dsp"); */
 237      switch (x->x_channels) {
 238      case 1:
 239           dsp_add(sfread_perform, 4, x, sp[0]->s_vec,
 240                   sp[1]->s_vec, sp[0]->s_n);
 241           break;
 242      case 2:
 243           dsp_add(sfread_perform, 5, x, sp[0]->s_vec,
 244                   sp[1]->s_vec,sp[2]->s_vec, sp[0]->s_n);
 245           break;
 246      case 4:
 247           dsp_add(sfread_perform, 6, x, sp[0]->s_vec,
 248                   sp[1]->s_vec,sp[2]->s_vec,
 249                   sp[3]->s_vec,sp[4]->s_vec,
 250                   sp[0]->s_n);
 251           break;
 252      }
 253 }
 254
 255
 256 static void sfread_speed(t_sfread* x, t_floatarg f)
 257 {
 258   x->x_speed = ftofix(f);
 259 }
 260
 261 static void sfread_offset(t_sfread* x, t_floatarg f)
 262 {
 263   x->x_pos = (int)f;
 264 }
 265
 266 static void *sfread_new(t_floatarg chan,t_floatarg skip)
 267 {
 268 #ifdef ROCKBOX
 269     (void) skip;
 270 #endif
 271     t_sfread *x = (t_sfread *)pd_new(sfread_class);
 272     t_int c = chan;
 273
 274     x->x_glist = (t_glist*) canvas_getcurrent();
 275
 276     if (c<1 || c > MAX_CHANS) c = 1;
 277     inlet_new(&x->x_obj, &x->x_obj.ob_pd, &s_float, gensym("ft1"));
 278     inlet_new(&x->x_obj, &x->x_obj.ob_pd, &s_float, gensym("ft2"));
 279
 280
 281     x->x_fd = -1;
 282     x->x_mapaddr = NULL;
 283
 284     x->x_size = 0;
 285     x->x_loop = 0;
 286     x->x_channels = c;
 287     x->x_mapaddr=NULL;
 288     x->x_pos = 0;
 289     x->x_skip = 0;
 290     x->x_speed = ftofix(1.0);
 291     x->x_play = 0;
 292
 293     while (c--) {
 294          outlet_new(&x->x_obj, gensym("signal"));
 295     }
 296
 297      x->x_bangout = outlet_new(&x->x_obj, &s_float);
 298
 299     return (x);
 300 }
 301
 302 void sfread_tilde_setup(void)
 303 {
 304      /* sfread */
 305
 306     sfread_class = class_new(gensym("sfread~"), (t_newmethod)sfread_new, 0,
 307         sizeof(t_sfread), 0,A_DEFFLOAT,A_DEFFLOAT,0);
 308     class_addmethod(sfread_class, nullfn, gensym("signal"), 0);
 309     class_addmethod(sfread_class, (t_method) sfread_dsp, gensym("dsp"), 0);
 310     class_addmethod(sfread_class, (t_method) sfread_open, gensym("open"), A_SYMBOL,A_NULL);
 311     class_addmethod(sfread_class, (t_method) sfread_size, gensym("size"), 0);
 312     class_addmethod(sfread_class, (t_method) sfread_offset, gensym("ft1"), A_FLOAT, A_NULL);
 313     class_addmethod(sfread_class, (t_method) sfread_speed, gensym("ft2"), A_FLOAT, A_NULL);
 314     class_addmethod(sfread_class, (t_method) sfread_state, gensym("state"), 0);
 315     class_addfloat(sfread_class, sfread_float);
 316     class_addbang(sfread_class,sfread_bang);
 317     class_addmethod(sfread_class,(t_method)sfread_loop,gensym("loop"),A_FLOAT,A_NULL);
 318
 319 }
 320