using System;
using NAudio.Dsp;
namespace NAudio.Wave.SampleProviders
{
///
/// Author: Freefall
/// Date: 05.08.16
/// Based on: the port of Stephan M. Bernsee“s pitch shifting class
/// Port site: https://sites.google.com/site/mikescoderama/pitch-shifting
/// Test application and github site: https://github.com/Freefall63/NAudio-Pitchshifter
///
/// NOTE: I strongly advice to add a Limiter for post-processing.
/// For my needs the FastAttackCompressor1175 provides acceptable results:
/// https://github.com/Jiyuu/SkypeFX/blob/master/JSNet/FastAttackCompressor1175.cs
///
/// UPDATE: Added a simple Limiter based on the pydirac implementation.
/// https://github.com/echonest/remix/blob/master/external/pydirac225/source/Dirac_LE.cpp
///
///
public class SmbPitchShiftingSampleProvider : ISampleProvider
{
//Shifter objects
private readonly ISampleProvider sourceStream;
private readonly WaveFormat waveFormat;
private float pitch = 1f;
private readonly int fftSize;
private readonly long osamp;
private readonly SmbPitchShifter shifterLeft = new SmbPitchShifter();
private readonly SmbPitchShifter shifterRight = new SmbPitchShifter();
//Limiter constants
const float LIM_THRESH = 0.95f;
const float LIM_RANGE = (1f - LIM_THRESH);
const float M_PI_2 = (float) (Math.PI/2);
///
/// Creates a new SMB Pitch Shifting Sample Provider with default settings
///
/// Source provider
public SmbPitchShiftingSampleProvider(ISampleProvider sourceProvider)
: this(sourceProvider, 4096, 4L, 1f)
{
}
///
/// Creates a new SMB Pitch Shifting Sample Provider with custom settings
///
/// Source provider
/// FFT Size (any power of two <= 4096: 4096, 2048, 1024, 512, ...)
/// Oversampling (number of overlapping windows)
/// Initial pitch (0.5f = octave down, 1.0f = normal, 2.0f = octave up)
public SmbPitchShiftingSampleProvider(ISampleProvider sourceProvider, int fftSize, long osamp,
float initialPitch)
{
sourceStream = sourceProvider;
waveFormat = sourceProvider.WaveFormat;
this.fftSize = fftSize;
this.osamp = osamp;
PitchFactor = initialPitch;
}
///
/// Read from this sample provider
///
public int Read(float[] buffer, int offset, int count)
{
int sampRead = sourceStream.Read(buffer, offset, count);
if (pitch == 1f)
{
//Nothing to do.
return sampRead;
}
if (waveFormat.Channels == 1)
{
var mono = new float[sampRead];
var index = 0;
for (var sample = offset; sample <= sampRead + offset - 1; sample++)
{
mono[index] = buffer[sample];
index += 1;
}
shifterLeft.PitchShift(pitch, sampRead, fftSize, osamp, waveFormat.SampleRate, mono);
index = 0;
for (var sample = offset; sample <= sampRead + offset - 1; sample++)
{
buffer[sample] = Limiter(mono[index]);
index += 1;
}
return sampRead;
}
if (waveFormat.Channels == 2)
{
var left = new float[(sampRead >> 1)];
var right = new float[(sampRead >> 1)];
var index = 0;
for (var sample = offset; sample <= sampRead + offset - 1; sample += 2)
{
left[index] = buffer[sample];
right[index] = buffer[sample + 1];
index += 1;
}
shifterLeft.PitchShift(pitch, sampRead >> 1, fftSize, osamp, waveFormat.SampleRate, left);
shifterRight.PitchShift(pitch, sampRead >> 1, fftSize, osamp, waveFormat.SampleRate, right);
index = 0;
for (var sample = offset; sample <= sampRead + offset - 1; sample += 2)
{
buffer[sample] = Limiter(left[index]);
buffer[sample + 1] = Limiter(right[index]);
index += 1;
}
return sampRead;
}
throw new Exception("Shifting of more than 2 channels is currently not supported.");
}
///
/// WaveFormat
///
public WaveFormat WaveFormat => waveFormat;
///
/// Pitch Factor (0.5f = octave down, 1.0f = normal, 2.0f = octave up)
///
public float PitchFactor
{
get { return pitch; }
set { pitch = value; }
}
private float Limiter(float sample)
{
float res;
if ((LIM_THRESH < sample))
{
res = (sample - LIM_THRESH)/LIM_RANGE;
res = (float) ((Math.Atan(res)/M_PI_2)*LIM_RANGE + LIM_THRESH);
}
else if ((sample < -LIM_THRESH))
{
res = -(sample + LIM_THRESH)/LIM_RANGE;
res = -(float) ((Math.Atan(res)/M_PI_2)*LIM_RANGE + LIM_THRESH);
}
else
{
res = sample;
}
return res;
}
}
}