ref: a8e09ce5a8a2818a11f926962f1cbd71d469d0bf
dir: /test/ding.c/
/* ding.c -- program to generate testpatterns for DSP code. Copyright (C) 1999 Stanley J. Brooks <stabro@megsinet.net> 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., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA */ #include <string.h> // for open,read,write: #include <sys/types.h> #include <sys/stat.h> #include <fcntl.h> #include <errno.h> #include <unistd.h> #include <math.h> #include <stdio.h> #include <stdlib.h> #define FLOAT double #ifndef LSAMPL # define SAMPL short # define MAXSAMPL 0x7fff # define MINSAMPL -0x7fff #else # define SAMPL long # define MAXSAMPL 0x7fffffff # define MINSAMPL -0x7fffffff #endif struct _Env { struct _Env *next; int r; /* rise */ int m; /* middle */ int f; /* fall */ int e; /* end */ FLOAT frq; /* frequency */ FLOAT b; /* bend (not quite implemented) */ FLOAT v; /* volume */ FLOAT d; /* decay */ FLOAT x,y; /* current x,y */ FLOAT phx,phy;/* per-sample phase multiplier cos(PI*frq),sin(PI*frq) */ }; const struct _Env EnvTemplate = {NULL,0,0,0,0,0.0,0.0,0.5,1.0,0.0,1.0,1.0,0.0}; struct _Env * Env0 = NULL; /* 1st */ struct _Env * EnvL = NULL; /* last */ struct _Env *env_new(struct _Env *L) { struct _Env *E; E = (struct _Env *) malloc(sizeof(struct _Env)); if (E) { memcpy(E, (L)? L : &EnvTemplate, sizeof(struct _Env)); } return E; } static void env_init(struct _Env *E) { if (0<E->frq && E->frq<1) { E->x = 1; E->y = 0; } else { E->x = 0; E->y = 1; } E->phx = cos(E->frq*M_PI); E->phy = sin(E->frq*M_PI); } static void env_post(struct _Env *E, int k) { double x1; x1 = E->x*E->phx - E->y*E->phy; E->y = E->x*E->phy + E->y*E->phx; E->x = x1; /* update (x,y) for next tic */ if (!(k&0x0f)) { /* norm correction each 16 samples */ x1 = 1/sqrt(E->x*E->x+E->y*E->y); E->x *= x1; E->y *= x1; } } /* rise/fall function, monotonic [0,1] -> [1-0] */ static inline double ramp(double s) { return 0.5*(1 + cos(M_PI * s)); } static double env(struct _Env *Env, int k) { double u = 0; //if (k >= Env->r && k < Env->e) { if (k<Env->m) { u = Env->v * ramp((double)(Env->m-k)/(Env->m-Env->r)); }else if (k<Env->f) { u = Env->v; Env->v *= Env->d; }else{ u = Env->v * ramp((double)(k-Env->f)/(Env->e-Env->f)); } u *= Env->y; env_post(Env,k); //} return u; } static void Usage(void)__attribute__((noreturn)); static void Usage(void) { fprintf(stderr, "Usage: ./ding [options] [<in-file>] <out-file>\n"); fprintf(stderr, " Options:\n"); fprintf(stderr, " -f <freq> float, frequency = freq*nyquist_rate\n"); fprintf(stderr, " [-v <vol>] float, volume, 1.00 is max\n"); fprintf(stderr, " [-d <decay>] float, per-sample decay factor\n"); fprintf(stderr, " [-e start:attack:duration:mute] ints \n"); exit(-1); } static int ReadN(int fd, SAMPL *v, int n) { int r,m; static SAMPL frag=0; static int fraglen=0; char *q; q=(char*)v; if (fraglen) memcpy(q, (char*)&frag, fraglen); m = n*sizeof(SAMPL) - fraglen; q += fraglen; if (fd>=0) { do { r = read(fd, q, m); }while(r==-1 && errno==EINTR); if (r==-1) { perror("Error reading fd1"); exit(-1); } }else{ bzero(q,m); r = m; } r += fraglen; fraglen = r%sizeof(SAMPL); if (fraglen) memcpy((char*)&frag, (char*)v, fraglen); return (r/sizeof(SAMPL)); } #define BSIZ 0x10000 int main(int argct, char **argv) { int optc; int fd1,fd2; char *fnam1,*fnam2; int len, st; SAMPL *ibuff,max,min; int poflo,moflo; FLOAT Vol0=1; struct _Env *E; /* Parse the options */ E = NULL; len = 0; while ((optc = getopt(argct, argv, "d:e:f:v:h")) != -1) { char *p; switch(optc) { case 'd': if (!E) { fprintf(stderr,"option -f must precede -%c\n", optc); Usage(); } E->d = strtod(optarg,&p); if (p==optarg || *p) { fprintf(stderr,"option -%c expects float value (%s)\n", optc, optarg); Usage(); } break; case 'f': E = env_new(EnvL); if (EnvL) EnvL->next = E; EnvL = E; if (!Env0) Env0 = E; E->frq = strtod(optarg,&p); if (p==optarg || *p) { fprintf(stderr,"option -%c expects float value (%s)\n", optc, optarg); Usage(); } break; case 'e': { int t[5], tmin=0; int i,ct=0; if (!E) { fprintf(stderr,"option -f must precede -%c\n", optc); Usage(); } for (p=optarg,ct=0; ct<5; p++) { t[ct] = 0; if (*p && *p != ':') { t[ct] = strtol(p,&p,10); if (t[ct]<tmin) tmin=t[ct]; } ct++; if (*p != ':') break; } if (ct==4) t[ct++] = 0; if (*p || tmin<0 || ct!=5) { fprintf(stderr,"option -%c not valid (%s)\n", optc, optarg); Usage(); } for (i=1; i<ct; i++) t[i] += t[i-1]; E->r = t[0]; E->m = t[1]; E->f = t[2]; E->e = t[3]; if (len<t[4]) len=t[4]; break; } case 'v': if (!E) { fprintf(stderr,"option -f must precede -%c\n", optc); Usage(); } E->v = MAXSAMPL*strtod(optarg,&p); if (E->frq==0.0) E->v *= sqrt(0.5); if (p==optarg || *p) { fprintf(stderr,"option -%c expects float value (%s)\n", optc, optarg); Usage(); } break; case 'h': default: Usage(); } } //fprintf(stderr,"Vol0 %8.3f\n", Vol0); fnam1=NULL; fd1=-1; //fprintf(stderr,"optind=%d argct=%d\n",optind,argct); if (optind <= argct-2) { int ln1; fnam1=argv[optind++]; fd1=open(fnam1,O_RDONLY); if (fd1<0) { fprintf(stderr,"Open: %s %s\n",fnam1,strerror(errno)); return(1); } ln1=lseek(fd1,0,SEEK_END)/2; lseek(fd1,0,SEEK_SET); if (len<ln1) len = ln1; } if (optind != argct-1) Usage(); fd2 = 1; /* stdout */ fnam2=argv[optind++]; if (strcmp(fnam2,"-")) { fd2=open(fnam2,O_WRONLY|O_CREAT|O_TRUNC,0644); if (fd2<0) { fprintf(stderr,"Open: %s %s\n",fnam2,strerror(errno)); return(1); } } //fprintf(stderr, "Files: %s %s\n",fnam1,fnam2); for (E=Env0; (E); E=E->next) env_init(E); ibuff=(SAMPL*)malloc(BSIZ*sizeof(SAMPL)); poflo=moflo=0; max =MINSAMPL; min=MAXSAMPL; for(st=0; st<len; ){ int ct; SAMPL *ibp; ct = len - st; if (ct>BSIZ) ct=BSIZ; ReadN(fd1,ibuff,ct); for (ibp=ibuff; ibp<ibuff+ct; ibp++,st++) { double v = *ibp; if (max<*ibp) max=*ibp; else if (min>*ibp) min=*ibp; v *= Vol0; for (E=Env0; (E); E=E->next) { if (st>=E->r && st<E->e) { v += env(E, st); } } if (v>MAXSAMPL) { poflo++; v=MAXSAMPL; } else if (v<MINSAMPL) { moflo++; v=MINSAMPL; } *ibp = rint(v); } write(fd2,(char*)ibuff,ct*sizeof(SAMPL)); } fprintf(stderr,"input range: [%ld,%ld] pos/neg oflos: %d/%d\n",min,max,poflo,moflo); return 0; }