common/JackLibSampleRateResampler.cpp

   1 /*
   2 Copyright (C) 2008 Grame
   3
   4 This program is free software; you can redistribute it and/or modify
   5 it under the terms of the GNU General Public License as published by
   6 the Free Software Foundation; either version 2 of the License, or
   7 (at your option) any later version.
   8
   9 This program is distributed in the hope that it will be useful,
  10 but WITHOUT ANY WARRANTY; without even the implied warranty of
  11 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  12 GNU General Public License for more details.
  13
  14 You should have received a copy of the GNU General Public License
  15 along with this program; if not, write to the Free Software
  16 Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  17
  18 */
  19
  20 #include "JackLibSampleRateResampler.h"
  21 #include "JackError.h"
  22
  23 namespace Jack
  24 {
  25
  26 JackLibSampleRateResampler::JackLibSampleRateResampler()
  27     :JackResampler()
  28 {
  29     int error;
  30     fResampler = src_new(SRC_LINEAR, 1, &error);
  31     if (error != 0)
  32         jack_error("JackLibSampleRateResampler::JackLibSampleRateResampler err = %s", src_strerror(error));
  33 }
  34
  35 JackLibSampleRateResampler::JackLibSampleRateResampler(unsigned int quality)
  36     :JackResampler()
  37 {
  38      switch (quality) {
  39        case 0:
  40             quality = SRC_LINEAR;
  41             break;
  42         case 1:
  43             quality = SRC_ZERO_ORDER_HOLD;
  44             break;
  45         case 2:
  46             quality = SRC_SINC_FASTEST;
  47             break;
  48         case 3:
  49             quality = SRC_SINC_MEDIUM_QUALITY;
  50             break;
  51         case 4:
  52             quality = SRC_SINC_BEST_QUALITY;
  53             break;
  54         default:
  55             quality = SRC_LINEAR;
  56             jack_error("Out of range resample quality");
  57             break;
  58     }
  59
  60     int error;
  61     fResampler = src_new(quality, 1, &error);
  62     if (error != 0) {
  63         jack_error("JackLibSampleRateResampler::JackLibSampleRateResampler err = %s", src_strerror(error));
  64     }
  65 }
  66
  67 JackLibSampleRateResampler::~JackLibSampleRateResampler()
  68 {
  69     src_delete(fResampler);
  70 }
  71
  72 void JackLibSampleRateResampler::Reset(unsigned int new_size)
  73 {
  74     JackResampler::Reset(new_size);
  75     src_reset(fResampler);
  76 }
  77
  78 unsigned int JackLibSampleRateResampler::ReadResample(jack_default_audio_sample_t* buffer, unsigned int frames)
  79 {
  80     jack_ringbuffer_data_t ring_buffer_data[2];
  81     SRC_DATA src_data;
  82     unsigned int frames_to_write = frames;
  83     unsigned int written_frames = 0;
  84     int res;
  85
  86     jack_ringbuffer_get_read_vector(fRingBuffer, ring_buffer_data);
  87     unsigned int available_frames = (ring_buffer_data[0].len + ring_buffer_data[1].len) / sizeof(jack_default_audio_sample_t);
  88     jack_log("Output available = %ld", available_frames);
  89
  90     for (int j = 0; j < 2; j++) {
  91
  92         if (ring_buffer_data[j].len > 0) {
  93
  94             src_data.data_in = (jack_default_audio_sample_t*)ring_buffer_data[j].buf;
  95             src_data.data_out = &buffer[written_frames];
  96             src_data.input_frames = ring_buffer_data[j].len / sizeof(jack_default_audio_sample_t);
  97             src_data.output_frames = frames_to_write;
  98             src_data.end_of_input = 0;
  99             src_data.src_ratio = fRatio;
 100
 101             res = src_process(fResampler, &src_data);
 102             if (res != 0) {
 103                 jack_error("JackLibSampleRateResampler::ReadResample ratio = %f err = %s", fRatio, src_strerror(res));
 104                 return 0;
 105             }
 106
 107             frames_to_write -= src_data.output_frames_gen;
 108             written_frames += src_data.output_frames_gen;
 109
 110             if ((src_data.input_frames_used == 0 || src_data.output_frames_gen == 0) && j == 0) {
 111                 jack_log("Output : j = %d input_frames_used = %ld output_frames_gen = %ld frames1 = %lu frames2 = %lu"
 112                     , j, src_data.input_frames_used, src_data.output_frames_gen, ring_buffer_data[0].len, ring_buffer_data[1].len);
 113             }
 114
 115             jack_log("Output : j = %d input_frames_used = %ld output_frames_gen = %ld", j, src_data.input_frames_used, src_data.output_frames_gen);
 116             jack_ringbuffer_read_advance(fRingBuffer, src_data.input_frames_used * sizeof(jack_default_audio_sample_t));
 117         }
 118     }
 119
 120     if (written_frames < frames) {
 121         jack_error("Output available = %ld", available_frames);
 122         jack_error("JackLibSampleRateResampler::ReadResample error written_frames = %ld", written_frames);
 123     }
 124
 125     return written_frames;
 126 }
 127
 128 unsigned int JackLibSampleRateResampler::WriteResample(jack_default_audio_sample_t* buffer, unsigned int frames)
 129 {
 130     jack_ringbuffer_data_t ring_buffer_data[2];
 131     SRC_DATA src_data;
 132     unsigned int frames_to_read = frames;
 133     unsigned int read_frames = 0;
 134     int res;
 135
 136     jack_ringbuffer_get_write_vector(fRingBuffer, ring_buffer_data);
 137     unsigned int available_frames = (ring_buffer_data[0].len + ring_buffer_data[1].len) / sizeof(jack_default_audio_sample_t);
 138     jack_log("Input available = %ld", available_frames);
 139
 140     for (int j = 0; j < 2; j++) {
 141
 142         if (ring_buffer_data[j].len > 0) {
 143
 144             src_data.data_in = &buffer[read_frames];
 145             src_data.data_out = (jack_default_audio_sample_t*)ring_buffer_data[j].buf;
 146             src_data.input_frames = frames_to_read;
 147             src_data.output_frames = (ring_buffer_data[j].len / sizeof(jack_default_audio_sample_t));
 148             src_data.end_of_input = 0;
 149             src_data.src_ratio = fRatio;
 150
 151             res = src_process(fResampler, &src_data);
 152             if (res != 0) {
 153                 jack_error("JackLibSampleRateResampler::WriteResample ratio = %f err = %s", fRatio, src_strerror(res));
 154                 return 0;
 155             }
 156
 157             frames_to_read -= src_data.input_frames_used;
 158             read_frames += src_data.input_frames_used;
 159
 160             if ((src_data.input_frames_used == 0 || src_data.output_frames_gen == 0) && j == 0) {
 161                 jack_log("Input : j = %d input_frames_used = %ld output_frames_gen = %ld frames1 = %lu frames2 = %lu"
 162                     , j, src_data.input_frames_used, src_data.output_frames_gen, ring_buffer_data[0].len, ring_buffer_data[1].len);
 163             }
 164
 165             jack_log("Input : j = %d input_frames_used = %ld output_frames_gen = %ld", j, src_data.input_frames_used, src_data.output_frames_gen);
 166             jack_ringbuffer_write_advance(fRingBuffer, src_data.output_frames_gen * sizeof(jack_default_audio_sample_t));
 167         }
 168     }
 169
 170     if (read_frames < frames) {
 171         jack_error("Input available = %ld", available_frames);
 172         jack_error("JackLibSampleRateResampler::WriteResample error read_frames = %ld", read_frames);
 173     }
 174
 175     return read_frames;
 176 }
 177
 178 }