summaryrefslogtreecommitdiff
path: root/libs/qm-dsp/dsp/tonal/TonalEstimator.cpp
blob: 16d1aa89956f8a827db2f0a4fce9401ccce990a0 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
/* -*- 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 copyright 2006 Martin Gasser.

    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 "TonalEstimator.h"

#include <cmath>
#include <iostream>

#ifndef PI
#define PI (3.14159265358979232846)
#endif

TonalEstimator::TonalEstimator()
{
	m_Basis.resize(6);

	int i = 0;
	
	
	// circle of fifths
	m_Basis[i].resize(12);
	for (int iP = 0; iP < 12; iP++)
	{
		m_Basis[i][iP] = std::sin( (7.0 / 6.0) * iP * PI);
	}
	
	i++;

	m_Basis[i].resize(12);
	for (int iP = 0; iP < 12; iP++)
	{
		m_Basis[i][iP] = std::cos( (7.0 / 6.0) * iP * PI);
	}
	
	i++;
	
	
	// circle of major thirds
	m_Basis[i].resize(12);
	for (int iP = 0; iP < 12; iP++)
	{
		m_Basis[i][iP] = 0.6 * std::sin( (2.0 / 3.0) * iP * PI);
	}
	
	i++;

	m_Basis[i].resize(12);
	for (int iP = 0; iP < 12; iP++)
	{
		m_Basis[i][iP] = 0.6 * std::cos( (2.0 / 3.0) * iP * PI);
	}

	i++;


	// circle of minor thirds
	m_Basis[i].resize(12);
	for (int iP = 0; iP < 12; iP++)
	{
		m_Basis[i][iP] = 1.1 * std::sin( (3.0 / 2.0) * iP * PI);
	}
	
	i++;

	m_Basis[i].resize(12);
	for (int iP = 0; iP < 12; iP++)
	{
		m_Basis[i][iP] = 1.1 * std::cos( (3.0 / 2.0) * iP * PI);
	}

}

TonalEstimator::~TonalEstimator()
{
}

TCSVector TonalEstimator::transform2TCS(const ChromaVector& rVector)
{
	TCSVector vaRetVal;
	vaRetVal.resize(6, 0.0);
		
	for (int i = 0; i < 6; i++)
	{
		for (int iP = 0; iP < 12; iP++)
		{
			vaRetVal[i] += m_Basis[i][iP] * rVector[iP];
		}
	}
	
	return vaRetVal;
}