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