jdelay/0040755000175000001440000000000010240504060011205 5ustar fonsusersjdelay/Makefile0100644000175000001440000000207510240501544012652 0ustar fonsusers# Copyright (C) 2004 Fons Adriaensen # # 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. CPPFLAGS += -O3 #CPPFLAGS += -mcpu=pentium4 LDFLAGS += -L/usr/X11R6/lib LDLIBS += -ljack -lrt JDELAY_O = jdelay.o jdelay: $(JDELAY_O) g++ $(LDFLAGS) -o jdelay $(JDELAY_O) $(LDLIBS) DIR := $(shell basename `pwd`) archive: distclean cd ..; /bin/rm -f $(DIR).tar.bz2; tar cvf $(DIR).tar $(DIR); bzip2 $(DIR).tar jdelay/BUILD0100644000175000001440000000014710240504014011765 0ustar fonsusersTo install, cd to this directory and make. Copy the binary to your preferred location. That's all !!! jdelay/jdelay.cc0100600000175000001440000001110010240503603012744 0ustar fonsusers/* Copyright (C) 2003 Fons Adriaensen 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 #include #include #include class Freq { public: int p; int f; float a; float xa; float ya; float xf; float yf; }; class MTDM { public: MTDM (void); int process (size_t len, float *inp, float *out); int resolve (void); void invert (void) { _inv ^= 1; } int inv (void) { return _inv; } double del (void) { return _del; } double err (void) { return _err; } private: double _del; double _err; int _cnt; int _inv; Freq _freq [5]; }; MTDM::MTDM (void) : _cnt (0), _inv (0) { int i; Freq *F; _freq [0].f = 4096; _freq [1].f = 512; _freq [2].f = 1088; _freq [3].f = 1544; _freq [4].f = 2049; _freq [0].a = 0.2f; _freq [1].a = 0.1f; _freq [2].a = 0.1f; _freq [3].a = 0.1f; _freq [4].a = 0.1f; for (i = 0, F = _freq; i < 5; i++, F++) { F->p = 128; F->xa = F->ya = 0.0f; F->xf = F->yf = 0.0f; } } int MTDM::process (size_t len, float *ip, float *op) { int i; float vip, vop, a, c, s; Freq *F; while (len--) { vop = 0.0f; vip = *ip++; for (i = 0, F = _freq; i < 5; i++, F++) { a = 2 * M_PI * (F->p & 0xFFFF) / 65536.0; F->p += F->f; c = cosf (a); s = -sinf (a); vop += F->a * s; F->xa += s * vip; F->ya += c * vip; } *op++ = vop; if (++_cnt == 16) { for (i = 0, F = _freq; i < 5; i++, F++) { F->xf += 1e-3f * (F->xa - F->xf + 1e-20); F->yf += 1e-3f * (F->ya - F->yf + 1e-20); F->xa = F->ya = 0.0f; } _cnt = 0; } } return 0; } int MTDM::resolve (void) { int i, k, m; double d, e, f0, p; Freq *F = _freq; if (hypot (F->xf, F->yf) < 0.01) return -1; d = atan2 (F->yf, F->xf) / (2 * M_PI); if (_inv) d += 0.5f; if (d > 0.5f) d -= 1.0f; f0 = _freq [0].f; m = 1; _err = 0.0; for (i = 0; i < 4; i++) { F++; p = atan2 (F->yf, F->xf) / (2 * M_PI) - d * F->f / f0; if (_inv) p += 0.5f; p -= floor (p); p *= 8; k = (int)(floor (p + 0.5)); e = fabs (p - k); if (e > _err) _err = e; if (e > 0.4) return 1; d += m * (k & 7); m *= 8; } _del = 16 * d; return 0; } // -------------------------------------------------------------------------------- static MTDM mtdm; static jack_client_t *jack_handle; static jack_port_t *jack_capt; static jack_port_t *jack_play; int jack_callback (jack_nframes_t nframes, void *arg) { float *ip, *op; ip = (float *)(jack_port_get_buffer (jack_capt, nframes)); op = (float *)(jack_port_get_buffer (jack_play, nframes)); return mtdm.process (nframes, ip, op);; } int main (int ac, char *av []) { int i, k; if ((jack_handle = jack_client_new ("jdelay")) == 0) { fprintf (stderr, "Can't connect to JACK\n"); return 1; } jack_set_process_callback (jack_handle, jack_callback, 0); jack_capt = jack_port_register (jack_handle, "in", JACK_DEFAULT_AUDIO_TYPE, JackPortIsInput, 0); jack_play = jack_port_register (jack_handle, "out", JACK_DEFAULT_AUDIO_TYPE, JackPortIsOutput, 0); if (jack_activate (jack_handle)) { fprintf(stderr, "Can't activate JACK"); return 1; } while (1) { usleep (250000); if (mtdm.resolve () < 0) printf ("Signal below threshold...\n"); else { if (mtdm.err () > 0.3) { mtdm.invert (); mtdm.resolve (); } printf ("%10.3lf", mtdm.del ()); if (mtdm.err () > 0.2) printf (" ??"); if (mtdm.inv ()) printf (" Inv"); printf ("\n"); } } return 0; } // -------------------------------------------------------------------------------- jdelay/AUTHORS0100644000175000001440000000005510111622461012255 0ustar fonsusersFons Adriaensen