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
  22 namespace Jack
  23 {
  24
  25 JackLibSampleRateResampler::JackLibSampleRateResampler()
  26     :JackResampler()
  27 {
  28     int error;
  29     fResampler = src_new(SRC_LINEAR, 1, &error);
  30     if (error != 0)
  31         jack_error("JackLibSampleRateResampler::JackLibSampleRateResampler err = %s", src_strerror(error));
  32 }
  33
  34 JackLibSampleRateResampler::JackLibSampleRateResampler(unsigned int quality)
  35     :JackResampler()
  36 {
  37      switch (quality) {
  38        case 0:
  39             quality = SRC_LINEAR;
  40             break;
  41         case 1:
  42             quality = SRC_ZERO_ORDER_HOLD;
  43             break;
  44         case 2:
  45             quality = SRC_SINC_FASTEST;
  46             break;
  47         case 3:
  48             quality = SRC_SINC_MEDIUM_QUALITY;
  49             break;
  50         case 4:
  51             quality = SRC_SINC_BEST_QUALITY;
  52             break;
  53         default:
  54             quality = SRC_LINEAR;
  55             jack_error("Out of range resample quality");
  56             break;
  57     }
  58
  59     int error;
  60     fResampler = src_new(quality, 1, &error);
  61     if (error != 0)
  62         jack_error("JackLibSampleRateResampler::JackLibSampleRateResampler err = %s", src_strerror(error));
  63 }
  64
  65 JackLibSampleRateResampler::~JackLibSampleRateResampler()
  66 {
  67     src_delete(fResampler);
  68 }
  69
  70 void JackLibSampleRateResampler::Reset(unsigned int new_size)
  71 {
  72     JackResampler::Reset(new_size);
  73     src_reset(fResampler);
  74 }
  75
  76 unsigned int JackLibSampleRateResampler::ReadResample(jack_default_audio_sample_t* buffer, unsigned int frames)
  77 {
  78     jack_ringbuffer_data_t ring_buffer_data[2];
  79     SRC_DATA src_data;
  80     unsigned int frames_to_write = frames;
  81     unsigned int written_frames = 0;
  82     int res;
  83
  84     jack_ringbuffer_get_read_vector(fRingBuffer, ring_buffer_data);
  85     unsigned int available_frames = (ring_buffer_data[0].len + ring_buffer_data[1].len) / sizeof(jack_default_audio_sample_t);
  86     jack_log("Output available = %ld", available_frames);
  87
  88     for (int j = 0; j < 2; j++) {
  89
  90         if (ring_buffer_data[j].len > 0) {
  91
  92             src_data.data_in = (jack_default_audio_sample_t*)ring_buffer_data[j].buf;
  93             src_data.data_out = &buffer[written_frames];
  94             src_data.input_frames = ring_buffer_data[j].len / sizeof(jack_default_audio_sample_t);
  95             src_data.output_frames = frames_to_write;
  96             src_data.end_of_input = 0;
  97             src_data.src_ratio = fRatio;
  98
  99             res = src_process(fResampler, &src_data);
 100             if (res != 0) {
 101                 jack_error("JackLibSampleRateResampler::ReadResample ratio = %f err = %s", fRatio, src_strerror(res));
 102                 return 0;
 103             }
 104
 105             frames_to_write -= src_data.output_frames_gen;
 106             written_frames += src_data.output_frames_gen;
 107
 108             if ((src_data.input_frames_used == 0 || src_data.output_frames_gen == 0) && j == 0) {
 109                 jack_log("Output : j = %d input_frames_used = %ld output_frames_gen = %ld frames1 = %lu frames2 = %lu"
 110                     , j, src_data.input_frames_used, src_data.output_frames_gen, ring_buffer_data[0].len, ring_buffer_data[1].len);
 111             }
 112
 113             jack_log("Output : j = %d input_frames_used = %ld output_frames_gen = %ld", j, src_data.input_frames_used, src_data.output_frames_gen);
 114             jack_ringbuffer_read_advance(fRingBuffer, src_data.input_frames_used * sizeof(jack_default_audio_sample_t));
 115         }
 116     }
 117
 118     if (written_frames < frames) {
 119         jack_error("Output available = %ld", available_frames);
 120         jack_error("JackLibSampleRateResampler::ReadResample error written_frames = %ld", written_frames);
 121     }
 122
 123     return written_frames;
 124 }
 125
 126 unsigned int JackLibSampleRateResampler::WriteResample(jack_default_audio_sample_t* buffer, unsigned int frames)
 127 {
 128     jack_ringbuffer_data_t ring_buffer_data[2];
 129     SRC_DATA src_data;
 130     unsigned int frames_to_read = frames;
 131     unsigned int read_frames = 0;
 132     int res;
 133
 134     jack_ringbuffer_get_write_vector(fRingBuffer, ring_buffer_data);
 135     unsigned int available_frames = (ring_buffer_data[0].len + ring_buffer_data[1].len) / sizeof(jack_default_audio_sample_t);
 136     jack_log("Input available = %ld", available_frames);
 137
 138     for (int j = 0; j < 2; j++) {
 139
 140         if (ring_buffer_data[j].len > 0) {
 141
 142             src_data.data_in = &buffer[read_frames];
 143             src_data.data_out = (jack_default_audio_sample_t*)ring_buffer_data[j].buf;
 144             src_data.input_frames = frames_to_read;
 145             src_data.output_frames = (ring_buffer_data[j].len / sizeof(jack_default_audio_sample_t));
 146             src_data.end_of_input = 0;
 147             src_data.src_ratio = fRatio;
 148
 149             res = src_process(fResampler, &src_data);
 150             if (res != 0) {
 151                 jack_error("JackLibSampleRateResampler::ReadResample ratio = %f err = %s", fRatio, src_strerror(res));
 152                 return 0;
 153             }
 154
 155             frames_to_read -= src_data.input_frames_used;
 156             read_frames += src_data.input_frames_used;
 157
 158             if ((src_data.input_frames_used == 0 || src_data.output_frames_gen == 0) && j == 0) {
 159                 jack_log("Input : j = %d input_frames_used = %ld output_frames_gen = %ld frames1 = %lu frames2 = %lu"
 160                     , j, src_data.input_frames_used, src_data.output_frames_gen, ring_buffer_data[0].len, ring_buffer_data[1].len);
 161             }
 162
 163             jack_log("Input : j = %d input_frames_used = %ld output_frames_gen = %ld", j, src_data.input_frames_used, src_data.output_frames_gen);
 164             jack_ringbuffer_write_advance(fRingBuffer, src_data.output_frames_gen * sizeof(jack_default_audio_sample_t));
 165         }
 166     }
 167
 168     if (read_frames < frames) {
 169         jack_error("Input available = %ld", available_frames);
 170         jack_error("JackLibSampleRateResampler::ReadResample error read_frames = %ld", read_frames);
 171     }
 172
 173     return read_frames;
 174 }
 175
 176 }