@@ -0,0 +1,20 @@ | |||
MAINTAINERCLEANFILES = Makefile.in | |||
# | |||
# in-process ALSA/JACK MIDI bridge client | |||
# | |||
zalsadir = $(ADDON_DIR) | |||
zalsa_LTLIBRARIES = zalsa_in.la zalsa_out.la | |||
zalsa_in_la_CPPFLAGS = -DAPPNAME=\"zalsa_in\" -DVERSION=\"0.4.0\" | |||
zalsa_in_la_SOURCES = zita-a2j.cc alsathread.cc jackclient.cc pxthread.cc lfqueue.cc | |||
zalsa_in_la_LDFLAGS = -module -avoid-version -lzita-resampler -lzita-alsa-pcmi -ljack -lasound -lpthread -lm -lrt @OS_LDFLAGS@ | |||
zalsa_out_la_CPPFLAGS = -DAPPNAME=\"zalsa_out\" -DVERSION=\"0.4.0\" | |||
zalsa_out_la_SOURCES = zita-j2a.cc alsathread.cc jackclient.cc pxthread.cc lfqueue.cc | |||
zalsa_out_la_LDFLAGS = -module -avoid-version -lzita-resampler -lzita-alsa-pcmi -ljack -lasound -lpthread -lm -lrt @OS_LDFLAGS@ | |||
noinst_HEADERS = alsathread.h jackclient.h lfqueue.h pxthread.h | |||
@@ -0,0 +1,226 @@ | |||
// ---------------------------------------------------------------------------- | |||
// | |||
// Copyright (C) 2012 Fons Adriaensen <fons@linuxaudio.org> | |||
// | |||
// 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 3 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, see <http://www.gnu.org/licenses/>. | |||
// | |||
// ---------------------------------------------------------------------------- | |||
#include <stdlib.h> | |||
#include <string.h> | |||
#include <stdio.h> | |||
#include <math.h> | |||
#include <jack/jack.h> | |||
#include "alsathread.h" | |||
Alsathread::Alsathread (Alsa_pcmi *alsadev, int mode) : | |||
_alsadev (alsadev ), | |||
_mode (mode), | |||
_state (INIT), | |||
_fsize (alsadev->fsize ()), | |||
_audioq (0), | |||
_commq (0), | |||
_alsaq (0) | |||
{ | |||
// Compute DLL filter coefficients. | |||
_dt = (double) _fsize / _alsadev->fsamp (); | |||
_w1 = 2 * M_PI * 0.1 * _dt; | |||
_w2 = _w1 * _w1; | |||
_w1 *= 1.6; | |||
// Time wraps around after 2^28 usecs. | |||
_tq = ldexp (1e-6, 28); | |||
} | |||
Alsathread::~Alsathread (void) | |||
{ | |||
_alsadev->pcm_stop (); | |||
} | |||
int Alsathread::start (Lfq_audio *audioq, Lfq_int32 *commq, Lfq_adata *alsaq, int rtprio) | |||
{ | |||
// Start the ALSA thread. | |||
_audioq = audioq; | |||
_commq = commq; | |||
_alsaq = alsaq; | |||
_state = WAIT; | |||
if (thr_start (SCHED_FIFO, rtprio, 0x10000)) return 1; | |||
return 0; | |||
} | |||
void Alsathread::send (int k, double t) | |||
{ | |||
Adata *D; | |||
// Send (state, frame count, timestamp) to Jack thread. | |||
if (_alsaq->wr_avail ()) | |||
{ | |||
D = _alsaq->wr_datap (); | |||
D->_state = _state; | |||
D->_nsamp = k; | |||
D->_timer = t; | |||
_alsaq->wr_commit (); | |||
} | |||
} | |||
// The following two functions transfer data between the audio queue | |||
// and the ALSA device. Note that we do *not* check the queue's fill | |||
// state, and it may overrun or underrun. It actually will in the first | |||
// few iterations and in error conditions. This is entirely intentional. | |||
// The queue keeps correct read and write counters even in that case, | |||
// and the main control loop and error recovery depend on it working | |||
// and being used in this way. | |||
int Alsathread::capture (void) | |||
{ | |||
int c, n, k; | |||
float *p; | |||
// Start reading from ALSA device. | |||
_alsadev->capt_init (_fsize); | |||
if (_state == PROC) | |||
{ | |||
// Input frames from the ALSA device to the audio queue. | |||
// The outer loop takes care of wraparound. | |||
for (n = _fsize; n; n -= k) | |||
{ | |||
p = _audioq->wr_datap (); // Audio queue write pointer. | |||
k = _audioq->wr_linav (); // Number of frames that can be | |||
if (k > n) k = n; // written without wraparound. | |||
for (c = 0; c < _audioq->nchan (); c++) | |||
{ | |||
// Copy and interleave one channel. | |||
_alsadev->capt_chan (c, p + c, k, _audioq->nchan ()); | |||
} | |||
_audioq->wr_commit (k); // Update audio queue state. | |||
} | |||
} | |||
// Finish reading from ALSA device. | |||
_alsadev->capt_done (_fsize); | |||
return _fsize; | |||
} | |||
int Alsathread::playback (void) | |||
{ | |||
int c, n, k; | |||
float *p; | |||
// Start writing to ALSA device. | |||
_alsadev->play_init (_fsize); | |||
c = 0; | |||
if (_state == PROC) | |||
{ | |||
// Output frames from the audio queue to the ALSA device. | |||
// The outer loop takes care of wraparound. | |||
for (n = _fsize; n; n -= k) | |||
{ | |||
p = _audioq->rd_datap (); // Audio queue read pointer. | |||
k = _audioq->rd_linav (); // Number of frames that can | |||
if (k > n) k = n; // be read without wraparound. | |||
for (c = 0; c < _audioq->nchan (); c++) | |||
{ | |||
// De-interleave and copy one channel. | |||
_alsadev->play_chan (c, p + c, k, _audioq->nchan ()); | |||
} | |||
_audioq->rd_commit (k); // Update audio queue state. | |||
} | |||
} | |||
// Clear all or remaining channels. | |||
while (c < _alsadev->nplay ()) _alsadev->clear_chan (c++, _fsize); | |||
// Finish writing to ALSA device. | |||
_alsadev->play_done (_fsize); | |||
return _fsize; | |||
} | |||
void Alsathread::thr_main (void) | |||
{ | |||
int na, nu; | |||
double tw, er; | |||
_alsadev->pcm_start (); | |||
while (_state != TERM) | |||
{ | |||
// Wait for next cycle, then take timestamp. | |||
na = _alsadev->pcm_wait (); | |||
tw = 1e-6 * (int)(jack_get_time () & 0x0FFFFFFF); | |||
// Check for errors - requires restart. | |||
if (_alsadev->state () && (na == 0)) | |||
{ | |||
_state = WAIT; | |||
send (0, 0); | |||
continue; | |||
} | |||
// Check for commands from the Jack thread. | |||
if (_commq->rd_avail ()) | |||
{ | |||
_state = _commq->rd_int32 (); | |||
if (_state == PROC) _first = true; | |||
if (_state == TERM) send (0, 0); | |||
} | |||
// We could have more than one period. | |||
nu = 0; | |||
while (na >= _fsize) | |||
{ | |||
// Transfer frames. | |||
if (_mode == PLAY) nu += playback (); | |||
else nu += capture (); | |||
// Update loop condition. | |||
na -= _fsize; | |||
// Run the DLL if in PROC state. | |||
if (_state == PROC) | |||
{ | |||
if (_first) | |||
{ | |||
// Init DLL in first iteration. | |||
_first = false; | |||
_t0 = tw; | |||
_t1 = tw + _dt; | |||
// Required for initial delay calculation. | |||
if (_mode == PLAY) nu -= _fsize; | |||
else nu += _fsize; | |||
} | |||
else | |||
{ | |||
// Update the DLL. | |||
er = tw - _t1; | |||
// Check for time wraparound. | |||
if (er < -200) | |||
{ | |||
_t1 -= _tq; | |||
er = tw - _t1; | |||
} | |||
// If we have more than one period, use | |||
// the time error only for the last one. | |||
if (na >= _fsize) er = 0; | |||
_t0 = _t1; | |||
_t1 += _w1 * er + _dt; | |||
_dt += _w2 * er; | |||
} | |||
} | |||
} | |||
// Send number of frames used and timestamp to Jack thread. | |||
if (_state == PROC) send (nu, _t1); | |||
} | |||
_alsadev->pcm_stop (); | |||
} |
@@ -0,0 +1,66 @@ | |||
// ---------------------------------------------------------------------------- | |||
// | |||
// Copyright (C) 2012 Fons Adriaensen <fons@linuxaudio.org> | |||
// | |||
// 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 3 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, see <http://www.gnu.org/licenses/>. | |||
// | |||
// ---------------------------------------------------------------------------- | |||
#ifndef __ALSATHREAD_H | |||
#define __ALSATHREAD_H | |||
#include <zita-alsa-pcmi.h> | |||
#include "pxthread.h" | |||
#include "lfqueue.h" | |||
class Alsathread : public Pxthread | |||
{ | |||
public: | |||
enum { INIT, WAIT, PROC, TERM }; | |||
enum { PLAY, CAPT }; | |||
Alsathread (Alsa_pcmi *alsadev, int mode); | |||
virtual ~Alsathread (void); | |||
virtual void thr_main (void); | |||
int start (Lfq_audio *audioq, Lfq_int32 *commq, Lfq_adata *alsaq, int rtprio); | |||
private: | |||
void send (int k, double t); | |||
int capture (void); | |||
int playback (void); | |||
Alsa_pcmi *_alsadev; | |||
int _mode; | |||
int _state; | |||
int _fsize; | |||
Lfq_audio *_audioq; | |||
Lfq_int32 *_commq; | |||
Lfq_adata *_alsaq; | |||
bool _first; | |||
double _tq; | |||
double _t0; | |||
double _t1; | |||
double _dt; | |||
double _w1; | |||
double _w2; | |||
}; | |||
#endif |
@@ -0,0 +1,510 @@ | |||
// ---------------------------------------------------------------------------- | |||
// | |||
// Copyright (C) 2012 Fons Adriaensen <fons@linuxaudio.org> | |||
// | |||
// 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 3 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, see <http://www.gnu.org/licenses/>. | |||
// | |||
// ---------------------------------------------------------------------------- | |||
#include <iostream> | |||
#include <stdio.h> | |||
#include <math.h> | |||
#include <jack/thread.h> | |||
#include "jackclient.h" | |||
#include "alsathread.h" | |||
Jackclient::Jackclient (jack_client_t* cl, const char*jserv, int mode, int nchan) : | |||
_client (cl), | |||
_mode (mode), | |||
_nchan (nchan), | |||
_state (INIT), | |||
_freew (false) | |||
{ | |||
init (jserv); | |||
} | |||
Jackclient::~Jackclient (void) | |||
{ | |||
fini (); | |||
} | |||
void Jackclient::init (const char *jserv) | |||
{ | |||
int i, spol, flags; | |||
char s [64]; | |||
jack_status_t stat; | |||
struct sched_param spar; | |||
if (_client == 0) | |||
{ | |||
return; | |||
} | |||
jack_set_process_callback (_client, jack_static_process, (void *) this); | |||
jack_set_latency_callback (_client, jack_static_latency, (void *) this); | |||
jack_set_freewheel_callback (_client, jack_static_freewheel, (void *) this); | |||
jack_set_buffer_size_callback (_client, jack_static_buffsize, (void *) this); | |||
jack_on_shutdown (_client, jack_static_shutdown, (void *) this); | |||
_bsize = 0; | |||
_fsamp = 0; | |||
_jname = jack_get_client_name (_client); | |||
_bsize = jack_get_buffer_size (_client); | |||
_fsamp = jack_get_sample_rate (_client); | |||
flags = JackPortIsTerminal | JackPortIsPhysical; | |||
for (i = 0; i < _nchan; i++) | |||
{ | |||
if (_mode == PLAY) | |||
{ | |||
sprintf (s, "playback_%d", i + 1); | |||
_ports [i] = jack_port_register (_client, s, JACK_DEFAULT_AUDIO_TYPE, | |||
flags | JackPortIsInput, 0); | |||
} | |||
else | |||
{ | |||
sprintf (s, "capture_%d", i + 1); | |||
_ports [i] = jack_port_register (_client, s, JACK_DEFAULT_AUDIO_TYPE, | |||
flags | JackPortIsOutput, 0); | |||
} | |||
} | |||
_rprio = jack_client_real_time_priority (_client) - sched_get_priority_max (spol); | |||
_buff = new float [_bsize * _nchan]; | |||
} | |||
void Jackclient::fini (void) | |||
{ | |||
delete[] _buff; | |||
} | |||
void Jackclient::jack_static_shutdown (void *arg) | |||
{ | |||
((Jackclient *) arg)->sendinfo (TERM, 0, 0); | |||
} | |||
int Jackclient::jack_static_buffsize (jack_nframes_t nframes, void *arg) | |||
{ | |||
Jackclient *J = (Jackclient *) arg; | |||
if (J->_bsize == 0) J->_bsize = nframes; | |||
else if (J->_bsize != (int) nframes) J->_state = Jackclient::TERM; | |||
return 0; | |||
} | |||
void Jackclient::jack_static_freewheel (int state, void *arg) | |||
{ | |||
((Jackclient *) arg)->jack_freewheel (state); | |||
} | |||
void Jackclient::jack_static_latency (jack_latency_callback_mode_t jlcm, void *arg) | |||
{ | |||
((Jackclient *) arg)->jack_latency (jlcm); | |||
} | |||
int Jackclient::jack_static_process (jack_nframes_t nframes, void *arg) | |||
{ | |||
return ((Jackclient *) arg)->jack_process (nframes); | |||
} | |||
void Jackclient::start (Lfq_audio *audioq, | |||
Lfq_int32 *commq, | |||
Lfq_adata *alsaq, | |||
Lfq_jdata *infoq, | |||
double ratio, | |||
int delay, | |||
int ltcor, | |||
int rqual) | |||
{ | |||
double d; | |||
_audioq = audioq; | |||
_commq = commq; | |||
_alsaq = alsaq; | |||
_infoq = infoq; | |||
_quant = ldexp (1e-6f, 28); | |||
_ratio = ratio; | |||
_rcorr = 1.0; | |||
_resamp.setup (_ratio, _nchan, rqual); | |||
_resamp.set_rrfilt (100); | |||
d = _resamp.inpsize () / 2.0; | |||
if (_mode == PLAY) d *= _ratio; | |||
_delay = delay + d; | |||
_ltcor = ltcor; | |||
_ppsec = (_fsamp + _bsize / 2) / _bsize; | |||
if (jack_activate (_client)) | |||
{ | |||
fprintf(stderr, "Can't activate Jack"); | |||
return; | |||
} | |||
initwait (_ppsec / 2); | |||
jack_recompute_total_latencies (_client); | |||
} | |||
void Jackclient::initwait (int nwait) | |||
{ | |||
_count = -nwait; | |||
_commq->wr_int32 (Alsathread::WAIT); | |||
_state = WAIT; | |||
if (nwait > _ppsec) sendinfo (WAIT, 0, 0); | |||
} | |||
void Jackclient::initsync (void) | |||
{ | |||
// Reset all lock-free queues. | |||
_commq->reset (); | |||
_alsaq->reset (); | |||
_audioq->reset (); | |||
// Reset and prefill the resampler. | |||
_resamp.reset (); | |||
_resamp.inp_count = _resamp.inpsize () / 2 - 1; | |||
_resamp.out_count = 10000; | |||
_resamp.process (); | |||
// Initiliase state variables. | |||
_t_a0 = _t_a1 = 0; | |||
_k_a0 = _k_a1 = 0; | |||
_k_j0 = 0; | |||
// Initialise loop filter state. | |||
_z1 = _z2 = _z3 = 0; | |||
// Activate the ALSA thread, | |||
_commq->wr_int32 (Alsathread::PROC); | |||
_state = SYNC0; | |||
sendinfo (SYNC0, 0, 0); | |||
} | |||
void Jackclient::setloop (double bw) | |||
{ | |||
double w; | |||
// Set the loop bandwidth to bw Hz. | |||
w = 6.28f * 20 * bw * _bsize / _fsamp; | |||
_w0 = 1.0 - exp (-w); | |||
w = 6.28f * bw * _ratio / _fsamp; | |||
_w1 = w * 1.6; | |||
_w2 = w * _bsize / 1.6; | |||
} | |||
void Jackclient::playback (int nframes) | |||
{ | |||
int i, j, n; | |||
float *p, *q; | |||
// Interleave inputs into _buff. | |||
for (i = 0; i < _nchan; i++) | |||
{ | |||
p = (float *)(jack_port_get_buffer (_ports [i], nframes)); | |||
q = _buff + i; | |||
for (j = 0; j < _bsize; j++) q [j * _nchan] = p [j]; | |||
} | |||
// Resample _buff and write to audio queue. | |||
// The while loop takes care of wraparound. | |||
_resamp.inp_count = _bsize; | |||
_resamp.inp_data = _buff; | |||
while (_resamp.inp_count) | |||
{ | |||
_resamp.out_count = _audioq->wr_linav (); | |||
_resamp.out_data = _audioq->wr_datap (); | |||
n = _resamp.out_count; | |||
_resamp.process (); | |||
n -= _resamp.out_count; | |||
_audioq->wr_commit (n); | |||
// Adjust state by the number of frames used. | |||
_k_j0 += n; | |||
} | |||
} | |||
void Jackclient::capture (int nframes) | |||
{ | |||
int i, j, n; | |||
float *p, *q; | |||
// Read from audio queue and resample. | |||
// The while loop takes care of wraparound. | |||
_resamp.out_count = _bsize; | |||
_resamp.out_data = _buff; | |||
while (_resamp.out_count) | |||
{ | |||
_resamp.inp_count = _audioq->rd_linav (); | |||
_resamp.inp_data = _audioq->rd_datap (); | |||
n = _resamp.inp_count; | |||
_resamp.process (); | |||
n -= _resamp.inp_count; | |||
_audioq->rd_commit (n); | |||
// Adjust state by the number of frames used. | |||
_k_j0 += n; | |||
} | |||
// Deinterleave _buff to outputs. | |||
for (i = 0; i < _nchan; i++) | |||
{ | |||
p = _buff + i; | |||
q = (float *)(jack_port_get_buffer (_ports [i], nframes)); | |||
for (j = 0; j < _bsize; j++) q [j] = p [j * _nchan]; | |||
} | |||
} | |||
void Jackclient::silence (int nframes) | |||
{ | |||
int i; | |||
float *q; | |||
// Write silence to all jack ports. | |||
for (i = 0; i < _nchan; i++) | |||
{ | |||
q = (float *)(jack_port_get_buffer (_ports [i], nframes)); | |||
memset (q, 0, nframes * sizeof (float)); | |||
} | |||
} | |||
void Jackclient::sendinfo (int state, double error, double ratio) | |||
{ | |||
Jdata *J; | |||
if (_infoq->wr_avail ()) | |||
{ | |||
J = _infoq->wr_datap (); | |||
J->_state = state; | |||
J->_error = error; | |||
J->_ratio = ratio; | |||
_infoq->wr_commit (); | |||
} | |||
} | |||
void Jackclient::jack_freewheel (int state) | |||
{ | |||
_freew = state ? true : false; | |||
if (_freew) initwait (_ppsec / 4); | |||
} | |||
void Jackclient::jack_latency (jack_latency_callback_mode_t jlcm) | |||
{ | |||
jack_latency_range_t R; | |||
int i; | |||
if (_state < WAIT) return; | |||
if (_mode == PLAY) | |||
{ | |||
if (jlcm != JackPlaybackLatency) return; | |||
R.min = R.max = (int)(_delay / _ratio) + _ltcor; | |||
} | |||
else | |||
{ | |||
if (jlcm != JackCaptureLatency) return; | |||
R.min = R.max = (int)(_delay * _ratio) + _ltcor; | |||
} | |||
for (i = 0; i < _nchan; i++) | |||
{ | |||
jack_port_set_latency_range (_ports [i], jlcm, &R); | |||
} | |||
} | |||
int Jackclient::jack_process (int nframes) | |||
{ | |||
int dk, n; | |||
Adata *D; | |||
jack_nframes_t ft; | |||
double tj, err, d1, d2; | |||
// Buffer size change or other evil. | |||
if (_state == TERM) | |||
{ | |||
sendinfo (TERM, 0, 0); | |||
return 0; | |||
} | |||
// Skip cylce if ports may not yet exist. | |||
if (_state < WAIT) return 0; | |||
// Start synchronisation 1/2 second after entering | |||
// the WAIT state. This delay allows the ALSA thread | |||
// to restart cleanly if necessary. Disabled while | |||
// freewheeling. | |||
if (_state == WAIT) | |||
{ | |||
if (_freew) return 0; | |||
if (_mode == CAPT) silence (nframes); | |||
if (++_count == 0) initsync (); | |||
else return 0; | |||
} | |||
// Compute the start time of the current cycle. | |||
// Jack should really provide the usecs directly. | |||
ft = jack_last_frame_time (_client); | |||
tj = 1e-6 * (jack_frames_to_time (_client, ft) & 0x0FFFFFFF); | |||
// Check for any skipped cycles. This is invalid | |||
// the first time, but won't be used then anyway. | |||
dk = ft - _ft - _bsize; | |||
_ft = ft; | |||
// Check if we have timing data from the ALSA thread. | |||
n = _alsaq->rd_avail (); | |||
// If the data queue is full restart synchronisation. | |||
// This can happen e.g. on a jack engine timeout, or | |||
// when too many cycles have been skipped. | |||
if (n == _alsaq->size ()) | |||
{ | |||
initwait (_ppsec / 2); | |||
return 0; | |||
} | |||
if (n) | |||
{ | |||
// Else move interval end to start, and update the | |||
// interval end keeping only the most recent data. | |||
if (_state < SYNC2) _state++; | |||
_t_a0 = _t_a1; | |||
_k_a0 = _k_a1; | |||
while (_alsaq->rd_avail ()) | |||
{ | |||
D = _alsaq->rd_datap (); | |||
// Restart synchronisation in case of | |||
// an error in the ALSA interface. | |||
if (D->_state == Alsathread::WAIT) | |||
{ | |||
initwait (_ppsec / 2); | |||
return 0; | |||
} | |||
_t_a1 = D->_timer; | |||
_k_a1 += D->_nsamp; | |||
_alsaq->rd_commit (); | |||
} | |||
} | |||
err = 0; | |||
if (_state >= SYNC2) | |||
{ | |||
// Compute the delay error. | |||
d1 = modtime (tj - _t_a0); | |||
d2 = modtime (_t_a1 - _t_a0); | |||
if (_mode == PLAY) | |||
{ | |||
n = _k_j0 - _k_a0; // Must be done as integer as both terms will overflow. | |||
err = n - (_k_a1 - _k_a0) * d1 / d2 + _resamp.inpdist () * _ratio - _delay; | |||
} | |||
else | |||
{ | |||
n = _k_a0 - _k_j0; | |||
err = n + (_k_a1 - _k_a0) * d1 / d2 + _resamp.inpdist () - _delay ; | |||
} | |||
n = (int)(floor (err + 0.5)); | |||
if (_state == SYNC2) | |||
{ | |||
// We have the first delay error value. Adjust both the state | |||
// variables and the audio queue by the same number of frames | |||
// to obtain the actually wanted delay, and start tracking. | |||
if (_mode == PLAY) | |||
{ | |||
_audioq->wr_commit (-n); | |||
_k_j0 -= n; | |||
} | |||
else | |||
{ | |||
_audioq->rd_commit (n); | |||
_k_j0 += n; | |||
} | |||
err -= n; | |||
setloop (1.0); | |||
_state = PROC1; | |||
} | |||
else if (_state >= PROC1) | |||
{ | |||
// Check error conditions. | |||
if (dk) | |||
{ | |||
// Jack skipped some cycles. Adjust both the state | |||
// and the audio queue so we can just continue. | |||
// The loop will correct the remaining fraction | |||
// of a frame. | |||
if (_mode == PLAY) | |||
{ | |||
dk = (int)(dk * _ratio + 0.5); | |||
if (abs (dk + n) < _bsize / 4) | |||
{ | |||
_audioq->wr_commit (dk); | |||
_k_j0 += dk; | |||
err += dk; | |||
n = 0; | |||
} | |||
} | |||
else | |||
{ | |||
dk = (int)(dk / _ratio + 0.5); | |||
if (abs (dk - n) < _bsize / 4) | |||
{ | |||
_audioq->rd_commit (dk); | |||
_k_j0 += dk; | |||
err -= dk; | |||
n = 0; | |||
} | |||
} | |||
} | |||
if (fabs (err) >= 50) | |||
{ | |||
// Something is really wrong, wait 15 seconds then restart. | |||
initwait (15 * _ppsec); | |||
return 0; | |||
} | |||
} | |||
} | |||
// Switch to lower bandwidth after 4 seconds. | |||
if ((_state == PROC1) && (++_count == 4 * _ppsec)) | |||
{ | |||
_state = PROC2; | |||
setloop (0.05); | |||
} | |||
if (_state >= PROC1) | |||
{ | |||
// Run loop filter and set resample ratio. | |||
_z1 += _w0 * (_w1 * err - _z1); | |||
_z2 += _w0 * (_z1 - _z2); | |||
_z3 += _w2 * _z2; | |||
_rcorr = 1 - _z2 - _z3; | |||
if (_rcorr > 1.05) _rcorr = 1.05; | |||
if (_rcorr < 0.95) _rcorr = 0.95; | |||
_resamp.set_rratio (_rcorr); | |||
sendinfo (_state, err, _rcorr); | |||
// Resample and transfer between audio | |||
// queue and jack ports. | |||
if (_mode == PLAY) playback (nframes); | |||
else capture (nframes); | |||
} | |||
else if (_mode == CAPT) silence (nframes); | |||
return 0; | |||
} |
@@ -0,0 +1,127 @@ | |||
// ---------------------------------------------------------------------------- | |||
// | |||
// Copyright (C) 2012 Fons Adriaensen <fons@linuxaudio.org> | |||
// | |||
// 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 3 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, see <http://www.gnu.org/licenses/>. | |||
// | |||
// ---------------------------------------------------------------------------- | |||
#ifndef __JACKCLIENT_H | |||
#define __JACKCLIENT_H | |||
#include <zita-resampler/vresampler.h> | |||
#include <jack/jack.h> | |||
#include "lfqueue.h" | |||
class Jackclient | |||
{ | |||
public: | |||
Jackclient (jack_client_t*, const char *jserv, int mode, int nchan); | |||
virtual ~Jackclient (void); | |||
enum { PLAY, CAPT }; | |||
enum { INIT, TERM, WAIT, SYNC0, SYNC1, SYNC2, PROC1, PROC2 }; | |||
void start (Lfq_audio *audioq, | |||
Lfq_int32 *commq, | |||
Lfq_adata *alsaq, | |||
Lfq_jdata *infoq, | |||
double ratio, | |||
int delay, | |||
int ltcor, | |||
int rqual); | |||
const char *jname (void) const { return _jname; } | |||
int fsamp (void) const { return _fsamp; } | |||
int bsize (void) const { return _bsize; } | |||
int rprio (void) const { return _rprio; } | |||
private: | |||
void init (const char *jserv); | |||
void fini (void); | |||
double modtime (double d) | |||
{ | |||
if (d < -200) d += _quant; | |||
if (d > 200) d -= _quant; | |||
return d; | |||
} | |||
void initwait (int nwait); | |||
void initsync (void); | |||
void setloop (double bw); | |||
void silence (int nframes); | |||
void playback (int nframes); | |||
void capture (int nframes); | |||
void sendinfo (int state, double error, double ratio); | |||
virtual void thr_main (void) {} | |||
void jack_freewheel (int state); | |||
void jack_latency (jack_latency_callback_mode_t jlcm); | |||
int jack_process (int nframes); | |||
jack_client_t *_client; | |||
jack_port_t *_ports [64]; | |||
const char *_jname; | |||
int _mode; | |||
int _nchan; | |||
int _state; | |||
int _count; | |||
int _fsamp; | |||
int _bsize; | |||
int _rprio; | |||
bool _freew; | |||
float *_buff; | |||
Lfq_audio *_audioq; | |||
Lfq_int32 *_commq; | |||
Lfq_adata *_alsaq; | |||
Lfq_jdata *_infoq; | |||
double _ratio; | |||
double _quant; | |||
int _ppsec; | |||
jack_nframes_t _ft; | |||
double _t_a0; | |||
double _t_a1; | |||
int _k_a0; | |||
int _k_a1; | |||
int _k_j0; | |||
double _delay; | |||
int _ltcor; | |||
double _w0; | |||
double _w1; | |||
double _w2; | |||
double _z1; | |||
double _z2; | |||
double _z3; | |||
double _rcorr; | |||
VResampler _resamp; | |||
static void jack_static_shutdown (void *arg); | |||
static int jack_static_buffsize (jack_nframes_t nframes, void *arg); | |||
static void jack_static_freewheel (int state, void *arg); | |||
static void jack_static_latency (jack_latency_callback_mode_t jlcm, void *arg); | |||
static int jack_static_process (jack_nframes_t nframes, void *arg); | |||
}; | |||
#endif |
@@ -0,0 +1,89 @@ | |||
// ---------------------------------------------------------------------------- | |||
// | |||
// Copyright (C) 2012 Fons Adriaensen <fons@linuxaudio.org> | |||
// | |||
// 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 3 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, see <http://www.gnu.org/licenses/>. | |||
// | |||
// ---------------------------------------------------------------------------- | |||
#include <assert.h> | |||
#include "lfqueue.h" | |||
Lfq_adata::Lfq_adata (int size) : | |||
_size (size), | |||
_mask (size - 1), | |||
_nwr (0), | |||
_nrd (0) | |||
{ | |||
assert (!(_size & _mask)); | |||
_data = new Adata [_size]; | |||
} | |||
Lfq_adata::~Lfq_adata (void) | |||
{ | |||
delete[] _data; | |||
} | |||
Lfq_jdata::Lfq_jdata (int size) : | |||
_size (size), | |||
_mask (size - 1), | |||
_nwr (0), | |||
_nrd (0) | |||
{ | |||
assert (!(_size & _mask)); | |||
_data = new Jdata [_size]; | |||
} | |||
Lfq_jdata::~Lfq_jdata (void) | |||
{ | |||
delete[] _data; | |||
} | |||
Lfq_int32::Lfq_int32 (int size) : | |||
_size (size), | |||
_mask (size - 1), | |||
_nwr (0), | |||
_nrd (0) | |||
{ | |||
assert (!(_size & _mask)); | |||
_data = new int32_t [_size]; | |||
} | |||
Lfq_int32::~Lfq_int32 (void) | |||
{ | |||
delete[] _data; | |||
} | |||
Lfq_audio::Lfq_audio (int nsamp, int nchan) : | |||
_size (nsamp), | |||
_mask (nsamp - 1), | |||
_nch (nchan), | |||
_nwr (0), | |||
_nrd (0) | |||
{ | |||
assert (!(_size & _mask)); | |||
_data = new float [_nch * _size]; | |||
} | |||
Lfq_audio::~Lfq_audio (void) | |||
{ | |||
delete[] _data; | |||
} | |||
@@ -0,0 +1,181 @@ | |||
// ---------------------------------------------------------------------------- | |||
// | |||
// Copyright (C) 2012 Fons Adriaensen <fons@linuxaudio.org> | |||
// | |||
// 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 3 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, see <http://www.gnu.org/licenses/>. | |||
// | |||
// ---------------------------------------------------------------------------- | |||
#ifndef __LFQUEUE_H | |||
#define __LFQUEUE_H | |||
#include <stdint.h> | |||
#include <string.h> | |||
class Adata | |||
{ | |||
public: | |||
int32_t _state; | |||
int32_t _nsamp; | |||
double _timer; | |||
}; | |||
class Lfq_adata | |||
{ | |||
public: | |||
Lfq_adata (int size); | |||
~Lfq_adata (void); | |||
void reset (void) { _nwr = _nrd = 0; } | |||
int size (void) const { return _size; } | |||
int wr_avail (void) const { return _size - _nwr + _nrd; } | |||
Adata *wr_datap (void) { return _data + (_nwr & _mask); } | |||
void wr_commit (void) { _nwr++; } | |||
int rd_avail (void) const { return _nwr - _nrd; } | |||
Adata *rd_datap (void) { return _data + (_nrd & _mask); } | |||
void rd_commit (void) { _nrd++; } | |||
private: | |||
Adata *_data; | |||
int _size; | |||
int _mask; | |||
int _nwr; | |||
int _nrd; | |||
}; | |||
class Jdata | |||
{ | |||
public: | |||
int32_t _state; | |||
double _error; | |||
double _ratio; | |||
}; | |||
class Lfq_jdata | |||
{ | |||
public: | |||
Lfq_jdata (int size); | |||
~Lfq_jdata (void); | |||
void reset (void) { _nwr = _nrd = 0; } | |||
int size (void) const { return _size; } | |||
int wr_avail (void) const { return _size - _nwr + _nrd; } | |||
Jdata *wr_datap (void) { return _data + (_nwr & _mask); } | |||
void wr_commit (void) { _nwr++; } | |||
int rd_avail (void) const { return _nwr - _nrd; } | |||
Jdata *rd_datap (void) { return _data + (_nrd & _mask); } | |||
void rd_commit (void) { _nrd++; } | |||
private: | |||
Jdata *_data; | |||
int _size; | |||
int _mask; | |||
int _nwr; | |||
int _nrd; | |||
}; | |||
class Lfq_int32 | |||
{ | |||
public: | |||
Lfq_int32 (int size); | |||
~Lfq_int32 (void); | |||
int size (void) const { return _size; } | |||
void reset (void) { _nwr = _nrd = 0; } | |||
int wr_avail (void) const { return _size - _nwr + _nrd; } | |||
int32_t *wr_datap (void) { return _data + (_nwr & _mask); } | |||
void wr_commit (void) { _nwr++; } | |||
int rd_avail (void) const { return _nwr - _nrd; } | |||
int32_t *rd_datap (void) { return _data + (_nrd & _mask); } | |||
void rd_commit (void) { _nrd++; } | |||
void wr_int32 (int32_t v) { _data [_nwr++ & _mask] = v; } | |||
void wr_uint32 (uint32_t v) { _data [_nwr++ & _mask] = v; } | |||
void wr_float (float v) { *(float *)(_data + (_nwr++ & _mask)) = v; } | |||
int32_t rd_int32 (void) { return _data [_nrd++ & _mask]; } | |||
int32_t rd_uint32 (void) { return _data [_nrd++ & _mask]; } | |||
float rd_float (void) { return *(float *)(_data + (_nrd++ & _mask)); } | |||
private: | |||
int32_t *_data; | |||
int _size; | |||
int _mask; | |||
int _nwr; | |||
int _nrd; | |||
}; | |||
class Lfq_audio | |||
{ | |||
public: | |||
Lfq_audio (int nsamp, int nchan); | |||
~Lfq_audio (void); | |||
int size (void) const { return _size; } | |||
void reset (void) | |||
{ | |||
_nwr = _nrd = 0; | |||
memset (_data, 0, _size * _nch * sizeof (float)); | |||
} | |||
int nchan (void) const { return _nch; } | |||
int nwr (void) const { return _nwr; }; | |||
int nrd (void) const { return _nrd; }; | |||
int wr_avail (void) const { return _size - _nwr + _nrd; } | |||
int wr_linav (void) const { return _size - (_nwr & _mask); } | |||
float *wr_datap (void) { return _data + _nch * (_nwr & _mask); } | |||
void wr_commit (int k) { _nwr += k; } | |||
int rd_avail (void) const { return _nwr - _nrd; } | |||
int rd_linav (void) const { return _size - (_nrd & _mask); } | |||
float *rd_datap (void) { return _data + _nch * (_nrd & _mask); } | |||
void rd_commit (int k) { _nrd += k; } | |||
private: | |||
float *_data; | |||
int _size; | |||
int _mask; | |||
int _nch; | |||
int _nwr; | |||
int _nrd; | |||
}; | |||
#endif | |||
@@ -0,0 +1,78 @@ | |||
// ---------------------------------------------------------------------------- | |||
// | |||
// Copyright (C) 2012 Fons Adriaensen <fons@linuxaudio.org> | |||
// | |||
// 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 3 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, see <http://www.gnu.org/licenses/>. | |||
// | |||
// ---------------------------------------------------------------------------- | |||
#include "pxthread.h" | |||
Pxthread::Pxthread (void) : _thrid (0) | |||
{ | |||
} | |||
Pxthread::~Pxthread (void) | |||
{ | |||
} | |||
extern "C" void *Pxthread_entry_point (void *arg) | |||
{ | |||
Pxthread *T = (Pxthread *) arg; | |||
T->thr_main (); | |||
return NULL; | |||
} | |||
int Pxthread::thr_start (int policy, int priority, size_t stacksize) | |||
{ | |||
int min, max, rc; | |||
pthread_attr_t attr; | |||
struct sched_param parm; | |||
min = sched_get_priority_min (policy); | |||
max = sched_get_priority_max (policy); | |||
priority += max; | |||
if (priority > max) priority = max; | |||
if (priority < min) priority = min; | |||
parm.sched_priority = priority; | |||
pthread_attr_init (&attr); | |||
pthread_attr_setdetachstate (&attr, PTHREAD_CREATE_DETACHED); | |||
pthread_attr_setschedpolicy (&attr, policy); | |||
pthread_attr_setschedparam (&attr, &parm); | |||
pthread_attr_setscope (&attr, PTHREAD_SCOPE_SYSTEM); | |||
pthread_attr_setinheritsched (&attr, PTHREAD_EXPLICIT_SCHED); | |||
pthread_attr_setstacksize (&attr, stacksize); | |||
_thrid = 0; | |||
rc = pthread_create (&_thrid, | |||
&attr, | |||
Pxthread_entry_point, | |||
this); | |||
pthread_attr_destroy (&attr); | |||
return rc; | |||
} | |||
void Pxthread::thr_main (void) | |||
{ | |||
} | |||
@@ -0,0 +1,52 @@ | |||
// ---------------------------------------------------------------------------- | |||
// | |||
// Copyright (C) 2012 Fons Adriaensen <fons@linuxaudio.org> | |||
// | |||
// 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 3 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, see <http://www.gnu.org/licenses/>. | |||
// | |||
// ---------------------------------------------------------------------------- | |||
#ifndef __PXTHREAD_H | |||
#define __PXTHREAD_H | |||
#include <sys/types.h> | |||
#include <stdlib.h> | |||
#include <stdio.h> | |||
#include <stdarg.h> | |||
#include <assert.h> | |||
#include <errno.h> | |||
#include <pthread.h> | |||
class Pxthread | |||
{ | |||
public: | |||
Pxthread (void); | |||
virtual ~Pxthread (void); | |||
Pxthread (const Pxthread&); | |||
Pxthread& operator=(const Pxthread&); | |||
virtual void thr_main (void) = 0; | |||
virtual int thr_start (int policy, int priority, size_t stacksize = 0); | |||
private: | |||
pthread_t _thrid; | |||
}; | |||
#endif |
@@ -0,0 +1,269 @@ | |||
// ---------------------------------------------------------------------------- | |||
// | |||
// Copyright (C) 2012 Fons Adriaensen <fons@linuxaudio.org> | |||
// | |||
// 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 3 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, see <http://www.gnu.org/licenses/>. | |||
// | |||
// ---------------------------------------------------------------------------- | |||
#include <stdlib.h> | |||
#include <string.h> | |||
#include <ctype.h> | |||
#include <stdio.h> | |||
#include <signal.h> | |||
#include "alsathread.h" | |||
#include "jackclient.h" | |||
#include "lfqueue.h" | |||
static Lfq_int32 commq (16); | |||
static Lfq_adata alsaq (256); | |||
static Lfq_jdata infoq (256); | |||
static Lfq_audio *audioq = 0; | |||
static bool stop = false; | |||
static const char *clopt = "hvLj:d:r:p:n:c:Q:I:"; | |||
static bool v_opt = false; | |||
static bool L_opt = false; | |||
static const char *jname = APPNAME; | |||
static const char *device = 0; | |||
static int fsamp = 48000; | |||
static int bsize = 256; | |||
static int nfrag = 2; | |||
static int nchan = 2; | |||
static int rqual = 48; | |||
static int ltcor = 0; | |||
static void help (void) | |||
{ | |||
fprintf (stderr, "\n%s-%s\n", APPNAME, VERSION); | |||
fprintf (stderr, "(C) 2012-2013 Fons Adriaensen <fons@linuxaudio.org>\n"); | |||
fprintf (stderr, "Use ALSA capture device as a Jack client, with resampling.\n\n"); | |||
fprintf (stderr, "Usage: %s <options>\n", APPNAME); | |||
fprintf (stderr, "Options:\n"); | |||
fprintf (stderr, " -h Display this text\n"); | |||
fprintf (stderr, " -j <jackname> Name as Jack client [%s]\n", APPNAME); | |||
fprintf (stderr, " -d <device> ALSA capture device [none]\n"); | |||
fprintf (stderr, " -r <rate> Sample rate [48000]\n"); | |||
fprintf (stderr, " -p <period> Period size [256]\n"); | |||
fprintf (stderr, " -n <nfrags> Number of fragments [2]\n"); | |||
fprintf (stderr, " -c <nchannels> Number of channels [2]\n"); | |||
fprintf (stderr, " -Q <quality> Resampling quality [48]\n"); | |||
fprintf (stderr, " -I <latency> Latency adjustment[0]\n"); | |||
fprintf (stderr, " -L Force 16-bit and 2 channels [off]\n"); | |||
fprintf (stderr, " -v Print tracing information [off]\n"); | |||
exit (1); | |||
} | |||
static int procoptions (int ac, const char *av []) | |||
{ | |||
int k; | |||
optind = 1; | |||
opterr = 0; | |||
while ((k = getopt (ac, (char **) av, (char *) clopt)) != -1) | |||
{ | |||
if (optarg && (*optarg == '-')) | |||
{ | |||
fprintf (stderr, " Missing argument for '-%c' option.\n", k); | |||
fprintf (stderr, " Use '-h' to see all options.\n"); | |||
exit (1); | |||
} | |||
switch (k) | |||
{ | |||
case 'h' : help (); exit (0); | |||
case 'v' : v_opt = true; break; | |||
case 'L' : L_opt = true; break; | |||
case 'j' : jname = optarg; break; | |||
case 'd' : device = optarg; break; | |||
case 'r' : fsamp = atoi (optarg); break; | |||
case 'p' : bsize = atoi (optarg); break; | |||
case 'n' : nfrag = atoi (optarg); break; | |||
case 'c' : nchan = atoi (optarg); break; | |||
case 'Q' : rqual = atoi (optarg); break; | |||
case 'I' : ltcor = atoi (optarg); break; | |||
case '?': | |||
if (optopt != ':' && strchr (clopt, optopt)) | |||
{ | |||
fprintf (stderr, " Missing argument for '-%c' option.\n", optopt); | |||
} | |||
else if (isprint (optopt)) | |||
{ | |||
fprintf (stderr, " Unknown option '-%c'.\n", optopt); | |||
} | |||
else | |||
{ | |||
fprintf (stderr, " Unknown option character '0x%02x'.\n", optopt & 255); | |||
} | |||
fprintf (stderr, " Use '-h' to see all options.\n"); | |||
return 1; | |||
default: | |||
return 1; | |||
} | |||
} | |||
return 0; | |||
} | |||
static int parse_options (const char* load_init) | |||
{ | |||
int argsz; | |||
int argc = 0; | |||
const char** argv; | |||
char* args = strdup (load_init); | |||
char* token; | |||
char* ptr = args; | |||
char* savep; | |||
if (!load_init) { | |||
return 0; | |||
} | |||
argsz = 8; /* random guess at "maxargs" */ | |||
argv = (const char **) malloc (sizeof (char *) * argsz); | |||
argv[argc++] = APPNAME; | |||
while (1) { | |||
if ((token = strtok_r (ptr, " ", &savep)) == NULL) { | |||
break; | |||
} | |||
if (argc == argsz) { | |||
argsz *= 2; | |||
argv = (const char **) realloc (argv, sizeof (char *) * argsz); | |||
} | |||
argv[argc++] = token; | |||
fprintf (stderr, "stash argv[%d] as %s\n", argc, token); | |||
ptr = NULL; | |||
} | |||
return procoptions (argc, argv); | |||
} | |||
static void printinfo (void) | |||
{ | |||
int n; | |||
double e, r; | |||
Jdata *J; | |||
n = 0; | |||
e = r = 0; | |||
while (infoq.rd_avail ()) | |||
{ | |||
J = infoq.rd_datap (); | |||
if (J->_state == Jackclient::TERM) | |||
{ | |||
printf ("Fatal error condition, terminating.\n"); | |||
stop = true; | |||
return; | |||
} | |||
else if (J->_state == Jackclient::WAIT) | |||
{ | |||
printf ("Detected excessive timing errors, waiting 15 seconds.\n"); | |||
printf ("This may happen with current Jack1 after freewheeling.\n"); | |||
n = 0; | |||
} | |||
else if (J->_state == Jackclient::SYNC0) | |||
{ | |||
printf ("Starting synchronisation.\n"); | |||
} | |||
else if (v_opt) | |||
{ | |||
n++; | |||
e += J->_error; | |||
r += J->_ratio; | |||
} | |||
infoq.rd_commit (); | |||
} | |||
if (n) printf ("%8.3lf %10.6lf\n", e / n, r / n); | |||
} | |||
static Alsa_pcmi *A = 0; | |||
static Alsathread *C = 0; | |||
static Jackclient *J = 0; | |||
extern "C" { | |||
int | |||
jack_initialize (jack_client_t* client, const char* load_init) | |||
{ | |||
int k, k_del, opts; | |||
double t_jack; | |||
double t_alsa; | |||
double t_del; | |||
if (parse_options (load_init)) { | |||
fprintf (stderr, "parse options failed\n"); | |||
return 1; | |||
} | |||
if (device == 0) help (); | |||
if (rqual < 16) rqual = 16; | |||
if (rqual > 96) rqual = 96; | |||
if ((fsamp < 8000) || (bsize < 16) || (nfrag < 2) || (nchan < 1)) | |||
{ | |||
fprintf (stderr, "Illegal parameter value(s).\n"); | |||
return 1; | |||
} | |||
opts = 0; | |||
if (v_opt) opts |= Alsa_pcmi::DEBUG_ALL; | |||
if (L_opt) opts |= Alsa_pcmi::FORCE_16B | Alsa_pcmi::FORCE_2CH; | |||
A = new Alsa_pcmi (0, device, 0, fsamp, bsize, nfrag, opts); | |||
if (A->state ()) | |||
{ | |||
fprintf (stderr, "Can't open ALSA capture device '%s'.\n", device); | |||
return 1; | |||
} | |||
if (v_opt) A->printinfo (); | |||
if (nchan > A->ncapt ()) | |||
{ | |||
nchan = A->ncapt (); | |||
fprintf (stderr, "Warning: only %d channels are available.\n", nchan); | |||
} | |||
C = new Alsathread (A, Alsathread::CAPT); | |||
J = new Jackclient (client, 0, Jackclient::CAPT, nchan); | |||
usleep (100000); | |||
t_alsa = (double) bsize / fsamp; | |||
if (t_alsa < 1e-3) t_alsa = 1e-3; | |||
t_jack = (double) J->bsize () / J->fsamp (); | |||
t_del = 1.5 * t_alsa + t_jack; | |||
k_del = (int)(t_del * fsamp); | |||
for (k = 256; k < k_del + J->bsize (); k *= 2); | |||
audioq = new Lfq_audio (k, nchan); | |||
C->start (audioq, &commq, &alsaq, J->rprio () + 10); | |||
J->start (audioq, &commq, &alsaq, &infoq, J->fsamp () / (double) fsamp, k_del, ltcor, rqual); | |||
return 0; | |||
} | |||
void jack_finish (void* arg) | |||
{ | |||
commq.wr_int32 (Alsathread::TERM); | |||
usleep (100000); | |||
delete C; | |||
delete A; | |||
delete J; | |||
delete audioq; | |||
} | |||
} /* extern "C" */ |
@@ -0,0 +1,265 @@ | |||
// ---------------------------------------------------------------------------- | |||
// | |||
// Copyright (C) 2012 Fons Adriaensen <fons@linuxaudio.org> | |||
// | |||
// 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 3 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, see <http://www.gnu.org/licenses/>. | |||
// | |||
// ---------------------------------------------------------------------------- | |||
#include <iostream> | |||
#include <stdlib.h> | |||
#include <string.h> | |||
#include <ctype.h> | |||
#include <stdio.h> | |||
#include <signal.h> | |||
#include "alsathread.h" | |||
#include "jackclient.h" | |||
#include "lfqueue.h" | |||
static Lfq_int32 commq (16); | |||
static Lfq_adata alsaq (256); | |||
static Lfq_jdata infoq (256); | |||
static Lfq_audio *audioq = 0; | |||
static bool stop = false; | |||
static const char *clopt = "hvLj:d:r:p:n:c:Q:O:"; | |||
static bool v_opt = false; | |||
static bool L_opt = false; | |||
static const char *jname = APPNAME; | |||
static const char *device = 0; | |||
static int fsamp = 48000; | |||
static int bsize = 256; | |||
static int nfrag = 2; | |||
static int nchan = 2; | |||
static int rqual = 48; | |||
static int ltcor = 0; | |||
static void help (void) | |||
{ | |||
fprintf (stderr, "\n%s-%s\n", APPNAME, VERSION); | |||
fprintf (stderr, "(C) 2012-2013 Fons Adriaensen <fons@linuxaudio.org>\n"); | |||
fprintf (stderr, "Use ALSA playback device as a Jack client, with resampling.\n\n"); | |||
fprintf (stderr, "Usage: %s <options>\n", APPNAME); | |||
fprintf (stderr, "Options:\n"); | |||
fprintf (stderr, " -h Display this text\n"); | |||
fprintf (stderr, " -j <jackname> Name as Jack client [%s]\n", APPNAME); | |||
fprintf (stderr, " -d <device> ALSA playback device [none]\n"); | |||
fprintf (stderr, " -r <rate> Sample rate [48000]\n"); | |||
fprintf (stderr, " -p <period> Period size [256]\n"); | |||
fprintf (stderr, " -n <nfrags> Number of fragments [2]\n"); | |||
fprintf (stderr, " -c <nchannels> Number of channels [2]\n"); | |||
fprintf (stderr, " -Q <quality> Resampling quality [48]\n"); | |||
fprintf (stderr, " -O <latency> Latency adjustment[0]\n"); | |||
fprintf (stderr, " -L Force 16-bit and 2 channels [off]\n"); | |||
fprintf (stderr, " -v Print tracing information [off]\n"); | |||
exit (1); | |||
} | |||
static int procoptions (int ac, const char *av []) | |||
{ | |||
int k; | |||
optind = 1; | |||
opterr = 0; | |||
while ((k = getopt (ac, (char **) av, (char *) clopt)) != -1) | |||
{ | |||
if (optarg && (*optarg == '-')) | |||
{ | |||
fprintf (stderr, " Missing argument for '-%c' option.\n", k); | |||
fprintf (stderr, " Use '-h' to see all options.\n"); | |||
exit (1); | |||
} | |||
switch (k) | |||
{ | |||
case 'h' : help (); exit (0); | |||
case 'v' : v_opt = true; break; | |||
case 'L' : L_opt = true; break; | |||
case 'j' : jname = optarg; break; | |||
case 'd' : device = optarg; break; | |||
case 'r' : fsamp = atoi (optarg); break; | |||
case 'p' : bsize = atoi (optarg); break; | |||
case 'n' : nfrag = atoi (optarg); break; | |||
case 'c' : nchan = atoi (optarg); break; | |||
case 'Q' : rqual = atoi (optarg); break; | |||
case 'O' : ltcor = atoi (optarg); break; | |||
case '?': | |||
if (optopt != ':' && strchr (clopt, optopt)) | |||
{ | |||
fprintf (stderr, " Missing argument for '-%c' option.\n", optopt); | |||
} | |||
else if (isprint (optopt)) | |||
{ | |||
fprintf (stderr, " Unknown option '-%c'.\n", optopt); | |||
} | |||
else | |||
{ | |||
fprintf (stderr, " Unknown option character '0x%02x'.\n", optopt & 255); | |||
} | |||
fprintf (stderr, " Use '-h' to see all options.\n"); | |||
return 1; | |||
default: | |||
return 1; | |||
} | |||
} | |||
return 0; | |||
} | |||
static int parse_options (const char* load_init) | |||
{ | |||
int argsz; | |||
int argc = 0; | |||
const char** argv; | |||
char* args = strdup (load_init); | |||
char* token; | |||
char* ptr = args; | |||
char* savep; | |||
if (!load_init) { | |||
return 0; | |||
} | |||
argsz = 8; /* random guess at "maxargs" */ | |||
argv = (const char **) malloc (sizeof (char *) * argsz); | |||
argv[argc++] = APPNAME; | |||
while (1) { | |||
if ((token = strtok_r (ptr, " ", &savep)) == NULL) { | |||
break; | |||
} | |||
if (argc == argsz) { | |||
argsz *= 2; | |||
argv = (const char **) realloc (argv, sizeof (char *) * argsz); | |||
} | |||
argv[argc++] = token; | |||
ptr = NULL; | |||
} | |||
return procoptions (argc, argv); | |||
} | |||
static void printinfo (void) | |||
{ | |||
int n; | |||
double e, r; | |||
Jdata *J; | |||
n = 0; | |||
e = r = 0; | |||
while (infoq.rd_avail ()) | |||
{ | |||
J = infoq.rd_datap (); | |||
if (J->_state == Jackclient::TERM) | |||
{ | |||
printf ("Fatal error condition, terminating.\n"); | |||
stop = true; | |||
return; | |||
} | |||
else if (J->_state == Jackclient::WAIT) | |||
{ | |||
printf ("Detected excessive timing errors, waiting 15 seconds.\n"); | |||
printf ("This may happen with current Jack1 after freewheeling.\n"); | |||
n = 0; | |||
} | |||
else if (J->_state == Jackclient::SYNC0) | |||
{ | |||
printf ("Starting synchronisation.\n"); | |||
} | |||
else if (v_opt) | |||
{ | |||
n++; | |||
e += J->_error; | |||
r += J->_ratio; | |||
} | |||
infoq.rd_commit (); | |||
} | |||
if (n) printf ("%8.3lf %10.6lf\n", e / n, r / n); | |||
} | |||
Alsa_pcmi *A = 0; | |||
Alsathread *P = 0; | |||
Jackclient *J = 0; | |||
extern "C" { | |||
int jack_initialize (jack_client_t* client, const char* load_init) | |||
{ | |||
int k, k_del, opts; | |||
double t_jack; | |||
double t_alsa; | |||
double t_del; | |||
if (parse_options (load_init)) { | |||
return 1; | |||
} | |||
if (device == 0) help (); | |||
if (rqual < 16) rqual = 16; | |||
if (rqual > 96) rqual = 96; | |||
if ((fsamp < 8000) || (bsize < 16) || (nfrag < 2) || (nchan < 1)) | |||
{ | |||
fprintf (stderr, "Illegal parameter value(s).\n"); | |||
return 1; | |||
} | |||
opts = 0; | |||
if (v_opt) opts |= Alsa_pcmi::DEBUG_ALL; | |||
if (L_opt) opts |= Alsa_pcmi::FORCE_16B | Alsa_pcmi::FORCE_2CH; | |||
A = new Alsa_pcmi (device, 0, 0, fsamp, bsize, nfrag, opts); | |||
if (A->state ()) | |||
{ | |||
fprintf (stderr, "Can't open ALSA playback device '%s'.\n", device); | |||
return 1; | |||
} | |||
if (v_opt) A->printinfo (); | |||
if (nchan > A->nplay ()) | |||
{ | |||
nchan = A->nplay (); | |||
fprintf (stderr, "Warning: only %d channels are available.\n", nchan); | |||
} | |||
P = new Alsathread (A, Alsathread::PLAY); | |||
J = new Jackclient (client, 0, Jackclient::PLAY, nchan); | |||
usleep (100000); | |||
t_alsa = (double) bsize / fsamp; | |||
if (t_alsa < 1e-3) t_alsa = 1e-3; | |||
t_jack = (double) J->bsize () / J->fsamp (); | |||
t_del = 1.5 * t_alsa + t_jack; | |||
k_del = (int)(t_del * fsamp); | |||
for (k = 256; k < k_del + J->bsize (); k *= 2); | |||
audioq = new Lfq_audio (k, nchan); | |||
P->start (audioq, &commq, &alsaq, J->rprio () + 10); | |||
J->start (audioq, &commq, &alsaq, &infoq, (double) fsamp / J->fsamp (), k_del, ltcor, rqual); | |||
return 0; | |||
} | |||
void jack_finish (void* arg) | |||
{ | |||
commq.wr_int32 (Alsathread::TERM); | |||
usleep (100000); | |||
delete P; | |||
delete A; | |||
delete J; | |||
delete audioq; | |||
} | |||
} /* extern "C" */ |