Recreating my GSoC branch.
[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
32 #define CC channels + channel
33
34 AUD_LinearResampleReader::AUD_LinearResampleReader(AUD_IReader* reader,
35                                                                                                    AUD_Specs specs) :
36                 AUD_EffectReader(reader)
37 {
38         m_sspecs = reader->getSpecs();
39
40         m_tspecs = specs;
41         m_tspecs.channels = m_sspecs.channels;
42         m_factor = (float)m_tspecs.rate / (float)m_sspecs.rate;
43
44         m_position = 0;
45         m_sposition = 0;
46
47         m_buffer = new AUD_Buffer(); AUD_NEW("buffer")
48         m_cache = new AUD_Buffer(2 * AUD_SAMPLE_SIZE(specs)); AUD_NEW("buffer")
49 }
50
51 AUD_LinearResampleReader::~AUD_LinearResampleReader()
52 {
53         delete m_buffer; AUD_DELETE("buffer")
54         delete m_cache; AUD_DELETE("buffer")
55 }
56
57 void AUD_LinearResampleReader::seek(int position)
58 {
59         m_position = position;
60         m_sposition = floor(position / m_factor);
61         m_reader->seek(m_sposition);
62 }
63
64 int AUD_LinearResampleReader::getLength()
65 {
66         return m_reader->getLength() * m_factor;
67 }
68
69 int AUD_LinearResampleReader::getPosition()
70 {
71         return m_position;
72 }
73
74 AUD_Specs AUD_LinearResampleReader::getSpecs()
75 {
76         return m_tspecs;
77 }
78
79 void AUD_LinearResampleReader::read(int & length, sample_t* & buffer)
80 {
81         int samplesize = AUD_SAMPLE_SIZE(m_tspecs);
82         int size = length * samplesize;
83
84         if(m_buffer->getSize() < size)
85                 m_buffer->resize(size);
86
87         int need = ceil((m_position + length) / m_factor) + 1 - m_sposition;
88         int len = need;
89         sample_t* buf;
90         buffer = m_buffer->getBuffer();
91
92         m_reader->read(len, buf);
93
94         if(len < need)
95                 length = floor((m_sposition + len - 1) * m_factor) - m_position;
96
97         float spos;
98         sample_t low, high;
99         int channels = m_sspecs.channels;
100
101         for(int channel = 0; channel < channels; channel++)
102         {
103                 for(int i = 0; i < length; i++)
104                 {
105                         spos = (m_position + i) / m_factor - m_sposition;
106
107                         if(floor(spos) < 0)
108                         {
109                                 low = m_cache->getBuffer()[(int)(floor(spos) + 2) * CC];
110                                 if(ceil(spos) < 0)
111                                         high = m_cache->getBuffer()[(int)(ceil(spos) + 2) * CC];
112                                 else
113                                         high = buf[(int)ceil(spos) * CC];
114                         }
115                         else
116                         {
117                                         low = buf[(int)floor(spos) * CC];
118                                         high = buf[(int)ceil(spos) * CC];
119                         }
120                         buffer[i * CC] = low + (spos - floor(spos)) * (high - low);
121                 }
122         }
123
124         if(len > 1)
125                 memcpy(m_cache->getBuffer(),
126                            buf + (len - 2) * channels,
127                            2 * samplesize);
128         else if(len == 1)
129                 memcpy(m_cache->getBuffer() + 1 * channels, buf, samplesize);
130
131         m_sposition += len;
132         m_position += length;
133 }