mirror of
https://github.com/Ardour/ardour.git
synced 2025-12-10 00:34:59 +01:00
add queen mary DSP library
git-svn-id: svn://localhost/ardour2/branches/3.0@9029 d708f5d6-7413-0410-9779-e7cbd77b26cf
This commit is contained in:
parent
fa41cfef58
commit
3deba1921b
85 changed files with 69852 additions and 0 deletions
79
libs/qm-dsp/dsp/phasevocoder/PhaseVocoder.cpp
Normal file
79
libs/qm-dsp/dsp/phasevocoder/PhaseVocoder.cpp
Normal file
|
|
@ -0,0 +1,79 @@
|
|||
/* -*- c-basic-offset: 4 indent-tabs-mode: nil -*- vi:set ts=8 sts=4 sw=4: */
|
||||
|
||||
/*
|
||||
QM DSP Library
|
||||
|
||||
Centre for Digital Music, Queen Mary, University of London.
|
||||
This file 2005-2006 Christian Landone.
|
||||
|
||||
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. See the file
|
||||
COPYING included with this distribution for more information.
|
||||
*/
|
||||
|
||||
#include "PhaseVocoder.h"
|
||||
#include "dsp/transforms/FFT.h"
|
||||
#include <math.h>
|
||||
|
||||
//////////////////////////////////////////////////////////////////////
|
||||
// Construction/Destruction
|
||||
//////////////////////////////////////////////////////////////////////
|
||||
|
||||
PhaseVocoder::PhaseVocoder(unsigned int n) :
|
||||
m_n(n)
|
||||
{
|
||||
m_fft = new FFTReal(m_n);
|
||||
m_realOut = new double[m_n];
|
||||
m_imagOut = new double[m_n];
|
||||
}
|
||||
|
||||
PhaseVocoder::~PhaseVocoder()
|
||||
{
|
||||
delete [] m_realOut;
|
||||
delete [] m_imagOut;
|
||||
delete m_fft;
|
||||
}
|
||||
|
||||
void PhaseVocoder::FFTShift(unsigned int size, double *src)
|
||||
{
|
||||
const int hs = size/2;
|
||||
for (int i = 0; i < hs; ++i) {
|
||||
double tmp = src[i];
|
||||
src[i] = src[i + hs];
|
||||
src[i + hs] = tmp;
|
||||
}
|
||||
}
|
||||
|
||||
void PhaseVocoder::process(double *src, double *mag, double *theta)
|
||||
{
|
||||
FFTShift( m_n, src);
|
||||
|
||||
m_fft->process(0, src, m_realOut, m_imagOut);
|
||||
|
||||
getMagnitude( m_n/2, mag, m_realOut, m_imagOut);
|
||||
getPhase( m_n/2, theta, m_realOut, m_imagOut);
|
||||
}
|
||||
|
||||
void PhaseVocoder::getMagnitude(unsigned int size, double *mag, double *real, double *imag)
|
||||
{
|
||||
unsigned int j;
|
||||
|
||||
for( j = 0; j < size; j++)
|
||||
{
|
||||
mag[ j ] = sqrt( real[ j ] * real[ j ] + imag[ j ] * imag[ j ]);
|
||||
}
|
||||
}
|
||||
|
||||
void PhaseVocoder::getPhase(unsigned int size, double *theta, double *real, double *imag)
|
||||
{
|
||||
unsigned int k;
|
||||
|
||||
// Phase Angle "matlab" style
|
||||
//Watch out for quadrant mapping !!!
|
||||
for( k = 0; k < size; k++)
|
||||
{
|
||||
theta[ k ] = atan2( -imag[ k ], real[ k ]);
|
||||
}
|
||||
}
|
||||
Loading…
Add table
Add a link
Reference in a new issue