Huge new year audio commit!
[blender.git] / intern / audaspace / intern / AUD_LinearResampleReader.cpp
1 /*
2  * $Id$
3  *
4  * ***** BEGIN LGPL LICENSE BLOCK *****
5  *
6  * Copyright 2009 Jörg Hermann Müller
7  *
8  * This file is part of AudaSpace.
9  *
10  * AudaSpace is free software: you can redistribute it and/or modify
11  * it under the terms of the GNU Lesser General Public License as published by
12  * the Free Software Foundation, either version 3 of the License, or
13  * (at your option) any later version.
14  *
15  * AudaSpace is distributed in the hope that it will be useful,
16  * but WITHOUT ANY WARRANTY; without even the implied warranty of
17  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
18  * GNU Lesser General Public License for more details.
19  *
20  * You should have received a copy of the GNU Lesser General Public License
21  * along with AudaSpace.  If not, see <http://www.gnu.org/licenses/>.
22  *
23  * ***** END LGPL LICENSE BLOCK *****
24  */
25
26 #include "AUD_LinearResampleReader.h"
27 #include "AUD_Buffer.h"
28
29 #include <cmath>
30 #include <cstring>
31 #include <cstdio>
32
33 AUD_LinearResampleReader::AUD_LinearResampleReader(AUD_IReader* reader,
34                                                                                                    AUD_Specs specs) :
35                 AUD_EffectReader(reader)
36 {
37         m_sspecs = reader->getSpecs();
38
39         m_tspecs = specs;
40         m_tspecs.channels = m_sspecs.channels;
41         m_factor = (float)m_tspecs.rate / (float)m_sspecs.rate;
42
43         m_position = 0;
44         m_sposition = 0;
45
46         m_buffer = new AUD_Buffer(); AUD_NEW("buffer")
47         m_cache = new AUD_Buffer(2 * AUD_SAMPLE_SIZE(specs)); AUD_NEW("buffer")
48 }
49
50 AUD_LinearResampleReader::~AUD_LinearResampleReader()
51 {
52         delete m_buffer; AUD_DELETE("buffer")
53         delete m_cache; AUD_DELETE("buffer")
54 }
55
56 void AUD_LinearResampleReader::seek(int position)
57 {
58         m_position = position;
59         m_sposition = floor(position / m_factor);
60         m_reader->seek(m_sposition);
61 }
62
63 int AUD_LinearResampleReader::getLength()
64 {
65         return m_reader->getLength() * m_factor;
66 }
67
68 int AUD_LinearResampleReader::getPosition()
69 {
70         return m_position;
71 }
72
73 AUD_Specs AUD_LinearResampleReader::getSpecs()
74 {
75         return m_tspecs;
76 }
77
78 void AUD_LinearResampleReader::read(int & length, sample_t* & buffer)
79 {
80         int size = length * AUD_SAMPLE_SIZE(m_tspecs);
81
82         if(m_buffer->getSize() < size)
83                 m_buffer->resize(size);
84
85         int need = ceil((m_position + length) / m_factor) + 1 - m_sposition;
86         int len = need;
87         sample_t* buf;
88         buffer = m_buffer->getBuffer();
89
90         m_reader->read(len, buf);
91
92         if(len < need)
93                 length = floor((m_sposition + len - 1) * m_factor) - m_position;
94
95         float spos;
96         sample_t low, high;
97         int channels = m_sspecs.channels;
98
99         for(int channel = 0; channel < channels; channel++)
100         {
101                 for(int i = 0; i < length; i++)
102                 {
103                         spos = (m_position + i) / m_factor - m_sposition;
104
105                         if((floor(spos) < -2) || (ceil(spos) >= len))
106                         {
107                                 fprintf(stderr, "FATAL ERROR: REPORT THIS TO neXyon!\n");
108 //                              exit(1);
109                         }
110
111                         if(floor(spos) < 0)
112                         {
113                                 low = m_cache->getBuffer()[(int)(floor(spos) + 2) * channels
114                                                                                    + channel];
115                                 if(ceil(spos) < 0)
116                                         high = m_cache->getBuffer()[(int)(ceil(spos) + 2)
117                                                                                                 * channels + channel];
118                                 else
119                                         high = buf[(int)ceil(spos) * channels + channel];
120                         }
121                         else
122                         {
123                                         low = buf[(int)floor(spos) * channels + channel];
124                                         high = buf[(int)ceil(spos) * channels + channel];
125                         }
126                         buffer[i * channels + channel] = low + (spos - floor(spos)) *
127                                                                                                    (high - low);
128                 }
129         }
130
131         if(len > 1)
132                 memcpy(m_cache->getBuffer(), buf + (len - 2) * channels, 2 * channels);
133         else if(len == 1)
134                 memcpy(m_cache->getBuffer() + 1 * channels, buf, channels);
135
136         m_sposition += len;
137         m_position += length;
138 }