blob: 399d987b3ad61318f18baeb11ef2aa257b739ffc [file] [log] [blame]
Glenn Kasten99e53b82012-01-19 08:59:58 -08001/*
Mathias Agopian65ab4712010-07-14 17:59:35 -07002**
3** Copyright 2007, The Android Open Source Project
4**
5** Licensed under the Apache License, Version 2.0 (the "License");
6** you may not use this file except in compliance with the License.
7** You may obtain a copy of the License at
8**
9** http://www.apache.org/licenses/LICENSE-2.0
10**
11** Unless required by applicable law or agreed to in writing, software
12** distributed under the License is distributed on an "AS IS" BASIS,
13** WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
14** See the License for the specific language governing permissions and
15** limitations under the License.
16*/
17
18#define LOG_TAG "AudioMixer"
19//#define LOG_NDEBUG 0
20
21#include <stdint.h>
22#include <string.h>
23#include <stdlib.h>
24#include <sys/types.h>
25
26#include <utils/Errors.h>
27#include <utils/Log.h>
28
Jean-Michel Trivi0d255b22011-05-24 15:53:33 -070029#include <cutils/bitops.h>
Glenn Kastenf6b16782011-12-15 09:51:17 -080030#include <cutils/compiler.h>
Glenn Kasten5798d4e2012-03-08 12:18:35 -080031#include <utils/Debug.h>
Jean-Michel Trivi0d255b22011-05-24 15:53:33 -070032
33#include <system/audio.h>
34
Glenn Kasten3b21c502011-12-15 09:52:39 -080035#include <audio_utils/primitives.h>
John Grossman4ff14ba2012-02-08 16:37:41 -080036#include <common_time/local_clock.h>
37#include <common_time/cc_helper.h>
Glenn Kasten3b21c502011-12-15 09:52:39 -080038
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -070039#include <media/EffectsFactoryApi.h>
40
Mathias Agopian65ab4712010-07-14 17:59:35 -070041#include "AudioMixer.h"
42
43namespace android {
Mathias Agopian65ab4712010-07-14 17:59:35 -070044
45// ----------------------------------------------------------------------------
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -070046AudioMixer::DownmixerBufferProvider::DownmixerBufferProvider() : AudioBufferProvider(),
47 mTrackBufferProvider(NULL), mDownmixHandle(NULL)
48{
49}
50
51AudioMixer::DownmixerBufferProvider::~DownmixerBufferProvider()
52{
53 ALOGV("AudioMixer deleting DownmixerBufferProvider (%p)", this);
54 EffectRelease(mDownmixHandle);
55}
56
57status_t AudioMixer::DownmixerBufferProvider::getNextBuffer(AudioBufferProvider::Buffer *pBuffer,
58 int64_t pts) {
59 //ALOGV("DownmixerBufferProvider::getNextBuffer()");
60 if (this->mTrackBufferProvider != NULL) {
61 status_t res = mTrackBufferProvider->getNextBuffer(pBuffer, pts);
62 if (res == OK) {
63 mDownmixConfig.inputCfg.buffer.frameCount = pBuffer->frameCount;
64 mDownmixConfig.inputCfg.buffer.raw = pBuffer->raw;
65 mDownmixConfig.outputCfg.buffer.frameCount = pBuffer->frameCount;
66 mDownmixConfig.outputCfg.buffer.raw = mDownmixConfig.inputCfg.buffer.raw;
67 // in-place so overwrite the buffer contents, has been set in prepareTrackForDownmix()
68 //mDownmixConfig.outputCfg.accessMode = EFFECT_BUFFER_ACCESS_WRITE;
69
70 res = (*mDownmixHandle)->process(mDownmixHandle,
71 &mDownmixConfig.inputCfg.buffer, &mDownmixConfig.outputCfg.buffer);
72 ALOGV("getNextBuffer is downmixing");
73 }
74 return res;
75 } else {
76 ALOGE("DownmixerBufferProvider::getNextBuffer() error: NULL track buffer provider");
77 return NO_INIT;
78 }
79}
80
81void AudioMixer::DownmixerBufferProvider::releaseBuffer(AudioBufferProvider::Buffer *pBuffer) {
82 ALOGV("DownmixerBufferProvider::releaseBuffer()");
83 if (this->mTrackBufferProvider != NULL) {
84 mTrackBufferProvider->releaseBuffer(pBuffer);
85 } else {
86 ALOGE("DownmixerBufferProvider::releaseBuffer() error: NULL track buffer provider");
87 }
88}
89
90
91// ----------------------------------------------------------------------------
92bool AudioMixer::isMultichannelCapable = false;
93
94effect_descriptor_t AudioMixer::dwnmFxDesc;
Mathias Agopian65ab4712010-07-14 17:59:35 -070095
Glenn Kasten5c94b6c2012-03-20 17:01:29 -070096AudioMixer::AudioMixer(size_t frameCount, uint32_t sampleRate, uint32_t maxNumTracks)
97 : mTrackNames(0), mConfiguredNames((1 << maxNumTracks) - 1), mSampleRate(sampleRate)
Mathias Agopian65ab4712010-07-14 17:59:35 -070098{
Glenn Kasten788040c2011-05-05 08:19:00 -070099 // AudioMixer is not yet capable of multi-channel beyond stereo
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800100 COMPILE_TIME_ASSERT_FUNCTION_SCOPE(2 == MAX_NUM_CHANNELS);
John Grossman4ff14ba2012-02-08 16:37:41 -0800101
Glenn Kasten5c94b6c2012-03-20 17:01:29 -0700102 ALOG_ASSERT(maxNumTracks <= MAX_NUM_TRACKS, "maxNumTracks %u > MAX_NUM_TRACKS %u",
103 maxNumTracks, MAX_NUM_TRACKS);
104
John Grossman4ff14ba2012-02-08 16:37:41 -0800105 LocalClock lc;
106
Mathias Agopian65ab4712010-07-14 17:59:35 -0700107 mState.enabledTracks= 0;
108 mState.needsChanged = 0;
109 mState.frameCount = frameCount;
Glenn Kasten84afa3b2012-01-25 15:28:08 -0800110 mState.hook = process__nop;
Glenn Kastene0feee32011-12-13 11:53:26 -0800111 mState.outputTemp = NULL;
112 mState.resampleTemp = NULL;
Glenn Kasten84afa3b2012-01-25 15:28:08 -0800113 // mState.reserved
Glenn Kasten17a736c2012-02-14 08:52:15 -0800114
115 // FIXME Most of the following initialization is probably redundant since
116 // tracks[i] should only be referenced if (mTrackNames & (1 << i)) != 0
117 // and mTrackNames is initially 0. However, leave it here until that's verified.
Mathias Agopian65ab4712010-07-14 17:59:35 -0700118 track_t* t = mState.tracks;
Glenn Kastenbf71f1e2011-12-13 11:52:35 -0800119 for (unsigned i=0 ; i < MAX_NUM_TRACKS ; i++) {
Glenn Kastendeeb1282012-03-25 11:59:31 -0700120 // FIXME redundant per track
John Grossman4ff14ba2012-02-08 16:37:41 -0800121 t->localTimeFreq = lc.getLocalFreq();
Mathias Agopian65ab4712010-07-14 17:59:35 -0700122 t++;
123 }
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700124
125 // find multichannel downmix effect if we have to play multichannel content
126 uint32_t numEffects = 0;
127 int ret = EffectQueryNumberEffects(&numEffects);
128 if (ret != 0) {
129 ALOGE("AudioMixer() error %d querying number of effects", ret);
130 return;
131 }
132 ALOGV("EffectQueryNumberEffects() numEffects=%d", numEffects);
133
134 for (uint32_t i = 0 ; i < numEffects ; i++) {
135 if (EffectQueryEffect(i, &dwnmFxDesc) == 0) {
136 ALOGV("effect %d is called %s", i, dwnmFxDesc.name);
137 if (memcmp(&dwnmFxDesc.type, EFFECT_UIID_DOWNMIX, sizeof(effect_uuid_t)) == 0) {
138 ALOGI("found effect \"%s\" from %s",
139 dwnmFxDesc.name, dwnmFxDesc.implementor);
140 isMultichannelCapable = true;
141 break;
142 }
143 }
144 }
145 ALOGE_IF(!isMultichannelCapable, "unable to find downmix effect");
Mathias Agopian65ab4712010-07-14 17:59:35 -0700146}
147
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800148AudioMixer::~AudioMixer()
149{
150 track_t* t = mState.tracks;
Glenn Kastenbf71f1e2011-12-13 11:52:35 -0800151 for (unsigned i=0 ; i < MAX_NUM_TRACKS ; i++) {
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800152 delete t->resampler;
153 t++;
154 }
155 delete [] mState.outputTemp;
156 delete [] mState.resampleTemp;
157}
Mathias Agopian65ab4712010-07-14 17:59:35 -0700158
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800159int AudioMixer::getTrackName()
160{
Glenn Kasten5c94b6c2012-03-20 17:01:29 -0700161 uint32_t names = (~mTrackNames) & mConfiguredNames;
Glenn Kasten98dd5422011-12-15 14:38:29 -0800162 if (names != 0) {
163 int n = __builtin_ctz(names);
Steve Block3856b092011-10-20 11:56:00 +0100164 ALOGV("add track (%d)", n);
Glenn Kasten98dd5422011-12-15 14:38:29 -0800165 mTrackNames |= 1 << n;
Glenn Kastendeeb1282012-03-25 11:59:31 -0700166 // assume default parameters for the track, except where noted below
167 track_t* t = &mState.tracks[n];
168 t->needs = 0;
169 t->volume[0] = UNITY_GAIN;
170 t->volume[1] = UNITY_GAIN;
171 // no initialization needed
172 // t->prevVolume[0]
173 // t->prevVolume[1]
174 t->volumeInc[0] = 0;
175 t->volumeInc[1] = 0;
176 t->auxLevel = 0;
177 t->auxInc = 0;
178 // no initialization needed
179 // t->prevAuxLevel
180 // t->frameCount
181 t->channelCount = 2;
182 t->enabled = false;
183 t->format = 16;
184 t->channelMask = AUDIO_CHANNEL_OUT_STEREO;
185 // setBufferProvider(name, AudioBufferProvider *) is required before enable(name)
186 t->bufferProvider = NULL;
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700187 t->downmixerBufferProvider = NULL;
Glenn Kastendeeb1282012-03-25 11:59:31 -0700188 t->buffer.raw = NULL;
189 // no initialization needed
190 // t->buffer.frameCount
191 t->hook = NULL;
192 t->in = NULL;
193 t->resampler = NULL;
194 t->sampleRate = mSampleRate;
195 // setParameter(name, TRACK, MAIN_BUFFER, mixBuffer) is required before enable(name)
196 t->mainBuffer = NULL;
197 t->auxBuffer = NULL;
198 // see t->localTimeFreq in constructor above
Mathias Agopian65ab4712010-07-14 17:59:35 -0700199 return TRACK0 + n;
200 }
201 return -1;
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800202}
Mathias Agopian65ab4712010-07-14 17:59:35 -0700203
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800204void AudioMixer::invalidateState(uint32_t mask)
205{
Mathias Agopian65ab4712010-07-14 17:59:35 -0700206 if (mask) {
207 mState.needsChanged |= mask;
208 mState.hook = process__validate;
209 }
210 }
211
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700212status_t AudioMixer::prepareTrackForDownmix(track_t* pTrack, int trackName)
213{
214 ALOGV("AudioMixer::prepareTrackForDownmix(%d) with mask 0x%x", trackName, pTrack->channelMask);
215
216 if (pTrack->downmixerBufferProvider != NULL) {
217 // this track had previously been configured with a downmixer, reset it
218 ALOGV("AudioMixer::prepareTrackForDownmix(%d) deleting old downmixer", trackName);
219 pTrack->bufferProvider = pTrack->downmixerBufferProvider->mTrackBufferProvider;
220 delete pTrack->downmixerBufferProvider;
221 }
222
223 DownmixerBufferProvider* pDbp = new DownmixerBufferProvider();
224 int32_t status;
225
226 if (!isMultichannelCapable) {
227 ALOGE("prepareTrackForDownmix(%d) fails: mixer doesn't support multichannel content",
228 trackName);
229 goto noDownmixForActiveTrack;
230 }
231
232 if (EffectCreate(&dwnmFxDesc.uuid,
233 -2 /*sessionId*/, -2 /*ioId*/,// both not relevant here, using random value
234 &pDbp->mDownmixHandle/*pHandle*/) != 0) {
235 ALOGE("prepareTrackForDownmix(%d) fails: error creating downmixer effect", trackName);
236 goto noDownmixForActiveTrack;
237 }
238
239 // channel input configuration will be overridden per-track
240 pDbp->mDownmixConfig.inputCfg.channels = pTrack->channelMask;
241 pDbp->mDownmixConfig.outputCfg.channels = AUDIO_CHANNEL_OUT_STEREO;
242 pDbp->mDownmixConfig.inputCfg.format = AUDIO_FORMAT_PCM_16_BIT;
243 pDbp->mDownmixConfig.outputCfg.format = AUDIO_FORMAT_PCM_16_BIT;
244 pDbp->mDownmixConfig.inputCfg.samplingRate = pTrack->sampleRate;
245 pDbp->mDownmixConfig.outputCfg.samplingRate = pTrack->sampleRate;
246 pDbp->mDownmixConfig.inputCfg.accessMode = EFFECT_BUFFER_ACCESS_READ;
247 pDbp->mDownmixConfig.outputCfg.accessMode = EFFECT_BUFFER_ACCESS_WRITE;
248 // input and output buffer provider, and frame count will not be used as the downmix effect
249 // process() function is called directly (see DownmixerBufferProvider::getNextBuffer())
250 pDbp->mDownmixConfig.inputCfg.mask = EFFECT_CONFIG_SMP_RATE | EFFECT_CONFIG_CHANNELS |
251 EFFECT_CONFIG_FORMAT | EFFECT_CONFIG_ACC_MODE;
252 pDbp->mDownmixConfig.outputCfg.mask = pDbp->mDownmixConfig.inputCfg.mask;
253
254 {// scope for local variables that are not used in goto label "noDownmixForActiveTrack"
255 int cmdStatus;
256 uint32_t replySize = sizeof(int);
257
258 // Configure and enable downmixer
259 status = (*pDbp->mDownmixHandle)->command(pDbp->mDownmixHandle,
260 EFFECT_CMD_SET_CONFIG /*cmdCode*/, sizeof(effect_config_t) /*cmdSize*/,
261 &pDbp->mDownmixConfig /*pCmdData*/,
262 &replySize /*replySize*/, &cmdStatus /*pReplyData*/);
263 if ((status != 0) || (cmdStatus != 0)) {
264 ALOGE("error %d while configuring downmixer for track %d", status, trackName);
265 goto noDownmixForActiveTrack;
266 }
267 replySize = sizeof(int);
268 status = (*pDbp->mDownmixHandle)->command(pDbp->mDownmixHandle,
269 EFFECT_CMD_ENABLE /*cmdCode*/, 0 /*cmdSize*/, NULL /*pCmdData*/,
270 &replySize /*replySize*/, &cmdStatus /*pReplyData*/);
271 if ((status != 0) || (cmdStatus != 0)) {
272 ALOGE("error %d while enabling downmixer for track %d", status, trackName);
273 goto noDownmixForActiveTrack;
274 }
275
276 // Set downmix type
277 // parameter size rounded for padding on 32bit boundary
278 const int psizePadded = ((sizeof(downmix_params_t) - 1)/sizeof(int) + 1) * sizeof(int);
279 const int downmixParamSize =
280 sizeof(effect_param_t) + psizePadded + sizeof(downmix_type_t);
281 effect_param_t * const param = (effect_param_t *) malloc(downmixParamSize);
282 param->psize = sizeof(downmix_params_t);
283 const downmix_params_t downmixParam = DOWNMIX_PARAM_TYPE;
284 memcpy(param->data, &downmixParam, param->psize);
285 const downmix_type_t downmixType = DOWNMIX_TYPE_FOLD;
286 param->vsize = sizeof(downmix_type_t);
287 memcpy(param->data + psizePadded, &downmixType, param->vsize);
288
289 status = (*pDbp->mDownmixHandle)->command(pDbp->mDownmixHandle,
290 EFFECT_CMD_SET_PARAM /* cmdCode */, downmixParamSize/* cmdSize */,
291 param /*pCmndData*/, &replySize /*replySize*/, &cmdStatus /*pReplyData*/);
292
293 free(param);
294
295 if ((status != 0) || (cmdStatus != 0)) {
296 ALOGE("error %d while setting downmix type for track %d", status, trackName);
297 goto noDownmixForActiveTrack;
298 } else {
299 ALOGV("downmix type set to %d for track %d", (int) downmixType, trackName);
300 }
301 }// end of scope for local variables that are not used in goto label "noDownmixForActiveTrack"
302
303 // initialization successful:
304 // - keep track of the real buffer provider in case it was set before
305 pDbp->mTrackBufferProvider = pTrack->bufferProvider;
306 // - we'll use the downmix effect integrated inside this
307 // track's buffer provider, and we'll use it as the track's buffer provider
308 pTrack->downmixerBufferProvider = pDbp;
309 pTrack->bufferProvider = pDbp;
310
311 return NO_ERROR;
312
313noDownmixForActiveTrack:
314 delete pDbp;
315 pTrack->downmixerBufferProvider = NULL;
316 return NO_INIT;
317}
318
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800319void AudioMixer::deleteTrackName(int name)
320{
Mathias Agopian65ab4712010-07-14 17:59:35 -0700321 name -= TRACK0;
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800322 ALOG_ASSERT(uint32_t(name) < MAX_NUM_TRACKS, "bad track name %d", name);
Glenn Kasten237a6242011-12-15 15:32:27 -0800323 ALOGV("deleteTrackName(%d)", name);
324 track_t& track(mState.tracks[ name ]);
Glenn Kasten4c340c62012-01-27 12:33:54 -0800325 if (track.enabled) {
326 track.enabled = false;
Glenn Kasten237a6242011-12-15 15:32:27 -0800327 invalidateState(1<<name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700328 }
Glenn Kastena0d68332012-01-27 16:47:15 -0800329 if (track.resampler != NULL) {
Glenn Kastenea7939a2012-03-14 12:56:26 -0700330 // delete the resampler
Glenn Kasten237a6242011-12-15 15:32:27 -0800331 delete track.resampler;
332 track.resampler = NULL;
333 track.sampleRate = mSampleRate;
334 invalidateState(1<<name);
335 }
336 track.volumeInc[0] = 0;
337 track.volumeInc[1] = 0;
338 mTrackNames &= ~(1<<name);
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800339}
Mathias Agopian65ab4712010-07-14 17:59:35 -0700340
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800341void AudioMixer::enable(int name)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700342{
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800343 name -= TRACK0;
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800344 ALOG_ASSERT(uint32_t(name) < MAX_NUM_TRACKS, "bad track name %d", name);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800345 track_t& track = mState.tracks[name];
346
Glenn Kasten4c340c62012-01-27 12:33:54 -0800347 if (!track.enabled) {
348 track.enabled = true;
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800349 ALOGV("enable(%d)", name);
350 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700351 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700352}
353
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800354void AudioMixer::disable(int name)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700355{
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800356 name -= TRACK0;
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800357 ALOG_ASSERT(uint32_t(name) < MAX_NUM_TRACKS, "bad track name %d", name);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800358 track_t& track = mState.tracks[name];
359
Glenn Kasten4c340c62012-01-27 12:33:54 -0800360 if (track.enabled) {
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700361 if (track.downmixerBufferProvider != NULL) {
362 ALOGV("AudioMixer::disable(%d) deleting downmixerBufferProvider", name);
363 delete track.downmixerBufferProvider;
364 track.downmixerBufferProvider = NULL;
365 }
Glenn Kasten4c340c62012-01-27 12:33:54 -0800366 track.enabled = false;
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800367 ALOGV("disable(%d)", name);
368 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700369 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700370}
371
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800372void AudioMixer::setParameter(int name, int target, int param, void *value)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700373{
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800374 name -= TRACK0;
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800375 ALOG_ASSERT(uint32_t(name) < MAX_NUM_TRACKS, "bad track name %d", name);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800376 track_t& track = mState.tracks[name];
Mathias Agopian65ab4712010-07-14 17:59:35 -0700377
Mathias Agopian65ab4712010-07-14 17:59:35 -0700378 int valueInt = (int)value;
379 int32_t *valueBuf = (int32_t *)value;
380
381 switch (target) {
Glenn Kasten788040c2011-05-05 08:19:00 -0700382
Mathias Agopian65ab4712010-07-14 17:59:35 -0700383 case TRACK:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800384 switch (param) {
Glenn Kasten788040c2011-05-05 08:19:00 -0700385 case CHANNEL_MASK: {
Jean-Michel Trivi0d255b22011-05-24 15:53:33 -0700386 uint32_t mask = (uint32_t)value;
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800387 if (track.channelMask != mask) {
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800388 uint32_t channelCount = popcount(mask);
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700389 ALOG_ASSERT((channelCount <= MAX_NUM_CHANNELS_TO_DOWNMIX) && channelCount);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800390 track.channelMask = mask;
391 track.channelCount = channelCount;
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700392 if (channelCount > MAX_NUM_CHANNELS) {
393 ALOGV("AudioMixer::setParameter(TRACK, CHANNEL_MASK, mask=0x%x count=%d)",
394 mask, channelCount);
395 status_t status = prepareTrackForDownmix(&mState.tracks[name], name);
396 }
Glenn Kasten788040c2011-05-05 08:19:00 -0700397 ALOGV("setParameter(TRACK, CHANNEL_MASK, %x)", mask);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800398 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700399 }
Glenn Kasten788040c2011-05-05 08:19:00 -0700400 } break;
401 case MAIN_BUFFER:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800402 if (track.mainBuffer != valueBuf) {
403 track.mainBuffer = valueBuf;
Steve Block3856b092011-10-20 11:56:00 +0100404 ALOGV("setParameter(TRACK, MAIN_BUFFER, %p)", valueBuf);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800405 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700406 }
Glenn Kasten788040c2011-05-05 08:19:00 -0700407 break;
408 case AUX_BUFFER:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800409 if (track.auxBuffer != valueBuf) {
410 track.auxBuffer = valueBuf;
Steve Block3856b092011-10-20 11:56:00 +0100411 ALOGV("setParameter(TRACK, AUX_BUFFER, %p)", valueBuf);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800412 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700413 }
Glenn Kasten788040c2011-05-05 08:19:00 -0700414 break;
Glenn Kastendeeb1282012-03-25 11:59:31 -0700415 case FORMAT:
416 ALOG_ASSERT(valueInt == AUDIO_FORMAT_PCM_16_BIT);
417 break;
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700418 // FIXME do we want to support setting the downmix type from AudioFlinger?
419 // for a specific track? or per mixer?
420 /* case DOWNMIX_TYPE:
421 break */
Glenn Kasten788040c2011-05-05 08:19:00 -0700422 default:
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800423 LOG_FATAL("bad param");
Mathias Agopian65ab4712010-07-14 17:59:35 -0700424 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700425 break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700426
Mathias Agopian65ab4712010-07-14 17:59:35 -0700427 case RESAMPLE:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800428 switch (param) {
429 case SAMPLE_RATE:
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800430 ALOG_ASSERT(valueInt > 0, "bad sample rate %d", valueInt);
Glenn Kasten788040c2011-05-05 08:19:00 -0700431 if (track.setResampler(uint32_t(valueInt), mSampleRate)) {
432 ALOGV("setParameter(RESAMPLE, SAMPLE_RATE, %u)",
433 uint32_t(valueInt));
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800434 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700435 }
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800436 break;
437 case RESET:
Eric Laurent243f5f92011-02-28 16:52:51 -0800438 track.resetResampler();
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800439 invalidateState(1 << name);
440 break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700441 default:
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800442 LOG_FATAL("bad param");
Eric Laurent243f5f92011-02-28 16:52:51 -0800443 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700444 break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700445
Mathias Agopian65ab4712010-07-14 17:59:35 -0700446 case RAMP_VOLUME:
447 case VOLUME:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800448 switch (param) {
Glenn Kasten788040c2011-05-05 08:19:00 -0700449 case VOLUME0:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800450 case VOLUME1:
451 if (track.volume[param-VOLUME0] != valueInt) {
Steve Block3856b092011-10-20 11:56:00 +0100452 ALOGV("setParameter(VOLUME, VOLUME0/1: %04x)", valueInt);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800453 track.prevVolume[param-VOLUME0] = track.volume[param-VOLUME0] << 16;
454 track.volume[param-VOLUME0] = valueInt;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700455 if (target == VOLUME) {
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800456 track.prevVolume[param-VOLUME0] = valueInt << 16;
457 track.volumeInc[param-VOLUME0] = 0;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700458 } else {
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800459 int32_t d = (valueInt<<16) - track.prevVolume[param-VOLUME0];
Mathias Agopian65ab4712010-07-14 17:59:35 -0700460 int32_t volInc = d / int32_t(mState.frameCount);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800461 track.volumeInc[param-VOLUME0] = volInc;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700462 if (volInc == 0) {
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800463 track.prevVolume[param-VOLUME0] = valueInt << 16;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700464 }
465 }
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800466 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700467 }
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800468 break;
469 case AUXLEVEL:
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800470 //ALOG_ASSERT(0 <= valueInt && valueInt <= MAX_GAIN_INT, "bad aux level %d", valueInt);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700471 if (track.auxLevel != valueInt) {
Steve Block3856b092011-10-20 11:56:00 +0100472 ALOGV("setParameter(VOLUME, AUXLEVEL: %04x)", valueInt);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700473 track.prevAuxLevel = track.auxLevel << 16;
474 track.auxLevel = valueInt;
475 if (target == VOLUME) {
476 track.prevAuxLevel = valueInt << 16;
477 track.auxInc = 0;
478 } else {
479 int32_t d = (valueInt<<16) - track.prevAuxLevel;
480 int32_t volInc = d / int32_t(mState.frameCount);
481 track.auxInc = volInc;
482 if (volInc == 0) {
483 track.prevAuxLevel = valueInt << 16;
484 }
485 }
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800486 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700487 }
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800488 break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700489 default:
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800490 LOG_FATAL("bad param");
Mathias Agopian65ab4712010-07-14 17:59:35 -0700491 }
492 break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700493
494 default:
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800495 LOG_FATAL("bad target");
Mathias Agopian65ab4712010-07-14 17:59:35 -0700496 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700497}
498
499bool AudioMixer::track_t::setResampler(uint32_t value, uint32_t devSampleRate)
500{
501 if (value!=devSampleRate || resampler) {
502 if (sampleRate != value) {
503 sampleRate = value;
Glenn Kastene0feee32011-12-13 11:53:26 -0800504 if (resampler == NULL) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700505 resampler = AudioResampler::create(
506 format, channelCount, devSampleRate);
John Grossman4ff14ba2012-02-08 16:37:41 -0800507 resampler->setLocalTimeFreq(localTimeFreq);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700508 }
509 return true;
510 }
511 }
512 return false;
513}
514
Mathias Agopian65ab4712010-07-14 17:59:35 -0700515inline
516void AudioMixer::track_t::adjustVolumeRamp(bool aux)
517{
Glenn Kastenf9a27772012-01-06 07:47:26 -0800518 for (uint32_t i=0 ; i<MAX_NUM_CHANNELS ; i++) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700519 if (((volumeInc[i]>0) && (((prevVolume[i]+volumeInc[i])>>16) >= volume[i])) ||
520 ((volumeInc[i]<0) && (((prevVolume[i]+volumeInc[i])>>16) <= volume[i]))) {
521 volumeInc[i] = 0;
522 prevVolume[i] = volume[i]<<16;
523 }
524 }
525 if (aux) {
526 if (((auxInc>0) && (((prevAuxLevel+auxInc)>>16) >= auxLevel)) ||
527 ((auxInc<0) && (((prevAuxLevel+auxInc)>>16) <= auxLevel))) {
528 auxInc = 0;
529 prevAuxLevel = auxLevel<<16;
530 }
531 }
532}
533
Glenn Kastenc59c0042012-02-02 14:06:11 -0800534size_t AudioMixer::getUnreleasedFrames(int name) const
Eric Laurent071ccd52011-12-22 16:08:41 -0800535{
536 name -= TRACK0;
537 if (uint32_t(name) < MAX_NUM_TRACKS) {
Glenn Kastenc59c0042012-02-02 14:06:11 -0800538 return mState.tracks[name].getUnreleasedFrames();
Eric Laurent071ccd52011-12-22 16:08:41 -0800539 }
540 return 0;
541}
Mathias Agopian65ab4712010-07-14 17:59:35 -0700542
Glenn Kasten01c4ebf2012-02-22 10:47:35 -0800543void AudioMixer::setBufferProvider(int name, AudioBufferProvider* bufferProvider)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700544{
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800545 name -= TRACK0;
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800546 ALOG_ASSERT(uint32_t(name) < MAX_NUM_TRACKS, "bad track name %d", name);
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700547
548 if (mState.tracks[name].downmixerBufferProvider != NULL) {
549 // update required?
550 if (mState.tracks[name].downmixerBufferProvider->mTrackBufferProvider != bufferProvider) {
551 ALOGV("AudioMixer::setBufferProvider(%p) for downmix", bufferProvider);
552 // setting the buffer provider for a track that gets downmixed consists in:
553 // 1/ setting the buffer provider to the "downmix / buffer provider" wrapper
554 // so it's the one that gets called when the buffer provider is needed,
555 mState.tracks[name].bufferProvider = mState.tracks[name].downmixerBufferProvider;
556 // 2/ saving the buffer provider for the track so the wrapper can use it
557 // when it downmixes.
558 mState.tracks[name].downmixerBufferProvider->mTrackBufferProvider = bufferProvider;
559 }
560 } else {
561 mState.tracks[name].bufferProvider = bufferProvider;
562 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700563}
564
565
566
John Grossman4ff14ba2012-02-08 16:37:41 -0800567void AudioMixer::process(int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700568{
John Grossman4ff14ba2012-02-08 16:37:41 -0800569 mState.hook(&mState, pts);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700570}
571
572
John Grossman4ff14ba2012-02-08 16:37:41 -0800573void AudioMixer::process__validate(state_t* state, int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700574{
Steve Block5ff1dd52012-01-05 23:22:43 +0000575 ALOGW_IF(!state->needsChanged,
Mathias Agopian65ab4712010-07-14 17:59:35 -0700576 "in process__validate() but nothing's invalid");
577
578 uint32_t changed = state->needsChanged;
579 state->needsChanged = 0; // clear the validation flag
580
581 // recompute which tracks are enabled / disabled
582 uint32_t enabled = 0;
583 uint32_t disabled = 0;
584 while (changed) {
585 const int i = 31 - __builtin_clz(changed);
586 const uint32_t mask = 1<<i;
587 changed &= ~mask;
588 track_t& t = state->tracks[i];
589 (t.enabled ? enabled : disabled) |= mask;
590 }
591 state->enabledTracks &= ~disabled;
592 state->enabledTracks |= enabled;
593
594 // compute everything we need...
595 int countActiveTracks = 0;
Glenn Kasten4c340c62012-01-27 12:33:54 -0800596 bool all16BitsStereoNoResample = true;
597 bool resampling = false;
598 bool volumeRamp = false;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700599 uint32_t en = state->enabledTracks;
600 while (en) {
601 const int i = 31 - __builtin_clz(en);
602 en &= ~(1<<i);
603
604 countActiveTracks++;
605 track_t& t = state->tracks[i];
606 uint32_t n = 0;
607 n |= NEEDS_CHANNEL_1 + t.channelCount - 1;
608 n |= NEEDS_FORMAT_16;
609 n |= t.doesResample() ? NEEDS_RESAMPLE_ENABLED : NEEDS_RESAMPLE_DISABLED;
610 if (t.auxLevel != 0 && t.auxBuffer != NULL) {
611 n |= NEEDS_AUX_ENABLED;
612 }
613
614 if (t.volumeInc[0]|t.volumeInc[1]) {
Glenn Kasten4c340c62012-01-27 12:33:54 -0800615 volumeRamp = true;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700616 } else if (!t.doesResample() && t.volumeRL == 0) {
617 n |= NEEDS_MUTE_ENABLED;
618 }
619 t.needs = n;
620
621 if ((n & NEEDS_MUTE__MASK) == NEEDS_MUTE_ENABLED) {
622 t.hook = track__nop;
623 } else {
624 if ((n & NEEDS_AUX__MASK) == NEEDS_AUX_ENABLED) {
Glenn Kasten4c340c62012-01-27 12:33:54 -0800625 all16BitsStereoNoResample = false;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700626 }
627 if ((n & NEEDS_RESAMPLE__MASK) == NEEDS_RESAMPLE_ENABLED) {
Glenn Kasten4c340c62012-01-27 12:33:54 -0800628 all16BitsStereoNoResample = false;
629 resampling = true;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700630 t.hook = track__genericResample;
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700631 ALOGV_IF((n & NEEDS_CHANNEL_COUNT__MASK) > NEEDS_CHANNEL_2,
632 "Track needs downmix + resample");
Mathias Agopian65ab4712010-07-14 17:59:35 -0700633 } else {
634 if ((n & NEEDS_CHANNEL_COUNT__MASK) == NEEDS_CHANNEL_1){
635 t.hook = track__16BitsMono;
Glenn Kasten4c340c62012-01-27 12:33:54 -0800636 all16BitsStereoNoResample = false;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700637 }
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700638 if ((n & NEEDS_CHANNEL_COUNT__MASK) >= NEEDS_CHANNEL_2){
Mathias Agopian65ab4712010-07-14 17:59:35 -0700639 t.hook = track__16BitsStereo;
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700640 ALOGV_IF((n & NEEDS_CHANNEL_COUNT__MASK) > NEEDS_CHANNEL_2,
641 "Track needs downmix");
Mathias Agopian65ab4712010-07-14 17:59:35 -0700642 }
643 }
644 }
645 }
646
647 // select the processing hooks
648 state->hook = process__nop;
649 if (countActiveTracks) {
650 if (resampling) {
651 if (!state->outputTemp) {
652 state->outputTemp = new int32_t[MAX_NUM_CHANNELS * state->frameCount];
653 }
654 if (!state->resampleTemp) {
655 state->resampleTemp = new int32_t[MAX_NUM_CHANNELS * state->frameCount];
656 }
657 state->hook = process__genericResampling;
658 } else {
659 if (state->outputTemp) {
660 delete [] state->outputTemp;
Glenn Kastene0feee32011-12-13 11:53:26 -0800661 state->outputTemp = NULL;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700662 }
663 if (state->resampleTemp) {
664 delete [] state->resampleTemp;
Glenn Kastene0feee32011-12-13 11:53:26 -0800665 state->resampleTemp = NULL;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700666 }
667 state->hook = process__genericNoResampling;
668 if (all16BitsStereoNoResample && !volumeRamp) {
669 if (countActiveTracks == 1) {
670 state->hook = process__OneTrack16BitsStereoNoResampling;
671 }
672 }
673 }
674 }
675
Steve Block3856b092011-10-20 11:56:00 +0100676 ALOGV("mixer configuration change: %d activeTracks (%08x) "
Mathias Agopian65ab4712010-07-14 17:59:35 -0700677 "all16BitsStereoNoResample=%d, resampling=%d, volumeRamp=%d",
678 countActiveTracks, state->enabledTracks,
679 all16BitsStereoNoResample, resampling, volumeRamp);
680
John Grossman4ff14ba2012-02-08 16:37:41 -0800681 state->hook(state, pts);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700682
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800683 // Now that the volume ramp has been done, set optimal state and
684 // track hooks for subsequent mixer process
685 if (countActiveTracks) {
Glenn Kasten4c340c62012-01-27 12:33:54 -0800686 bool allMuted = true;
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800687 uint32_t en = state->enabledTracks;
688 while (en) {
689 const int i = 31 - __builtin_clz(en);
690 en &= ~(1<<i);
691 track_t& t = state->tracks[i];
692 if (!t.doesResample() && t.volumeRL == 0)
693 {
694 t.needs |= NEEDS_MUTE_ENABLED;
695 t.hook = track__nop;
696 } else {
Glenn Kasten4c340c62012-01-27 12:33:54 -0800697 allMuted = false;
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800698 }
699 }
700 if (allMuted) {
701 state->hook = process__nop;
702 } else if (all16BitsStereoNoResample) {
703 if (countActiveTracks == 1) {
704 state->hook = process__OneTrack16BitsStereoNoResampling;
705 }
706 }
707 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700708}
709
Mathias Agopian65ab4712010-07-14 17:59:35 -0700710
711void AudioMixer::track__genericResample(track_t* t, int32_t* out, size_t outFrameCount, int32_t* temp, int32_t* aux)
712{
713 t->resampler->setSampleRate(t->sampleRate);
714
715 // ramp gain - resample to temp buffer and scale/mix in 2nd step
716 if (aux != NULL) {
717 // always resample with unity gain when sending to auxiliary buffer to be able
718 // to apply send level after resampling
719 // TODO: modify each resampler to support aux channel?
720 t->resampler->setVolume(UNITY_GAIN, UNITY_GAIN);
721 memset(temp, 0, outFrameCount * MAX_NUM_CHANNELS * sizeof(int32_t));
722 t->resampler->resample(temp, outFrameCount, t->bufferProvider);
Glenn Kastenf6b16782011-12-15 09:51:17 -0800723 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1]|t->auxInc)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700724 volumeRampStereo(t, out, outFrameCount, temp, aux);
725 } else {
726 volumeStereo(t, out, outFrameCount, temp, aux);
727 }
728 } else {
Glenn Kastenf6b16782011-12-15 09:51:17 -0800729 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1])) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700730 t->resampler->setVolume(UNITY_GAIN, UNITY_GAIN);
731 memset(temp, 0, outFrameCount * MAX_NUM_CHANNELS * sizeof(int32_t));
732 t->resampler->resample(temp, outFrameCount, t->bufferProvider);
733 volumeRampStereo(t, out, outFrameCount, temp, aux);
734 }
735
736 // constant gain
737 else {
738 t->resampler->setVolume(t->volume[0], t->volume[1]);
739 t->resampler->resample(out, outFrameCount, t->bufferProvider);
740 }
741 }
742}
743
744void AudioMixer::track__nop(track_t* t, int32_t* out, size_t outFrameCount, int32_t* temp, int32_t* aux)
745{
746}
747
748void AudioMixer::volumeRampStereo(track_t* t, int32_t* out, size_t frameCount, int32_t* temp, int32_t* aux)
749{
750 int32_t vl = t->prevVolume[0];
751 int32_t vr = t->prevVolume[1];
752 const int32_t vlInc = t->volumeInc[0];
753 const int32_t vrInc = t->volumeInc[1];
754
Steve Blockb8a80522011-12-20 16:23:08 +0000755 //ALOGD("[0] %p: inc=%f, v0=%f, v1=%d, final=%f, count=%d",
Mathias Agopian65ab4712010-07-14 17:59:35 -0700756 // t, vlInc/65536.0f, vl/65536.0f, t->volume[0],
757 // (vl + vlInc*frameCount)/65536.0f, frameCount);
758
759 // ramp volume
Glenn Kastenf6b16782011-12-15 09:51:17 -0800760 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700761 int32_t va = t->prevAuxLevel;
762 const int32_t vaInc = t->auxInc;
763 int32_t l;
764 int32_t r;
765
766 do {
767 l = (*temp++ >> 12);
768 r = (*temp++ >> 12);
769 *out++ += (vl >> 16) * l;
770 *out++ += (vr >> 16) * r;
771 *aux++ += (va >> 17) * (l + r);
772 vl += vlInc;
773 vr += vrInc;
774 va += vaInc;
775 } while (--frameCount);
776 t->prevAuxLevel = va;
777 } else {
778 do {
779 *out++ += (vl >> 16) * (*temp++ >> 12);
780 *out++ += (vr >> 16) * (*temp++ >> 12);
781 vl += vlInc;
782 vr += vrInc;
783 } while (--frameCount);
784 }
785 t->prevVolume[0] = vl;
786 t->prevVolume[1] = vr;
Glenn Kastena1117922012-01-26 10:53:32 -0800787 t->adjustVolumeRamp(aux != NULL);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700788}
789
790void AudioMixer::volumeStereo(track_t* t, int32_t* out, size_t frameCount, int32_t* temp, int32_t* aux)
791{
792 const int16_t vl = t->volume[0];
793 const int16_t vr = t->volume[1];
794
Glenn Kastenf6b16782011-12-15 09:51:17 -0800795 if (CC_UNLIKELY(aux != NULL)) {
Glenn Kasten3b81aca2012-01-27 15:26:23 -0800796 const int16_t va = t->auxLevel;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700797 do {
798 int16_t l = (int16_t)(*temp++ >> 12);
799 int16_t r = (int16_t)(*temp++ >> 12);
800 out[0] = mulAdd(l, vl, out[0]);
801 int16_t a = (int16_t)(((int32_t)l + r) >> 1);
802 out[1] = mulAdd(r, vr, out[1]);
803 out += 2;
804 aux[0] = mulAdd(a, va, aux[0]);
805 aux++;
806 } while (--frameCount);
807 } else {
808 do {
809 int16_t l = (int16_t)(*temp++ >> 12);
810 int16_t r = (int16_t)(*temp++ >> 12);
811 out[0] = mulAdd(l, vl, out[0]);
812 out[1] = mulAdd(r, vr, out[1]);
813 out += 2;
814 } while (--frameCount);
815 }
816}
817
818void AudioMixer::track__16BitsStereo(track_t* t, int32_t* out, size_t frameCount, int32_t* temp, int32_t* aux)
819{
Glenn Kasten54c3b662012-01-06 07:46:30 -0800820 const int16_t *in = static_cast<const int16_t *>(t->in);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700821
Glenn Kastenf6b16782011-12-15 09:51:17 -0800822 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700823 int32_t l;
824 int32_t r;
825 // ramp gain
Glenn Kastenf6b16782011-12-15 09:51:17 -0800826 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1]|t->auxInc)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700827 int32_t vl = t->prevVolume[0];
828 int32_t vr = t->prevVolume[1];
829 int32_t va = t->prevAuxLevel;
830 const int32_t vlInc = t->volumeInc[0];
831 const int32_t vrInc = t->volumeInc[1];
832 const int32_t vaInc = t->auxInc;
Steve Blockb8a80522011-12-20 16:23:08 +0000833 // ALOGD("[1] %p: inc=%f, v0=%f, v1=%d, final=%f, count=%d",
Mathias Agopian65ab4712010-07-14 17:59:35 -0700834 // t, vlInc/65536.0f, vl/65536.0f, t->volume[0],
835 // (vl + vlInc*frameCount)/65536.0f, frameCount);
836
837 do {
838 l = (int32_t)*in++;
839 r = (int32_t)*in++;
840 *out++ += (vl >> 16) * l;
841 *out++ += (vr >> 16) * r;
842 *aux++ += (va >> 17) * (l + r);
843 vl += vlInc;
844 vr += vrInc;
845 va += vaInc;
846 } while (--frameCount);
847
848 t->prevVolume[0] = vl;
849 t->prevVolume[1] = vr;
850 t->prevAuxLevel = va;
851 t->adjustVolumeRamp(true);
852 }
853
854 // constant gain
855 else {
856 const uint32_t vrl = t->volumeRL;
857 const int16_t va = (int16_t)t->auxLevel;
858 do {
Glenn Kasten54c3b662012-01-06 07:46:30 -0800859 uint32_t rl = *reinterpret_cast<const uint32_t *>(in);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700860 int16_t a = (int16_t)(((int32_t)in[0] + in[1]) >> 1);
861 in += 2;
862 out[0] = mulAddRL(1, rl, vrl, out[0]);
863 out[1] = mulAddRL(0, rl, vrl, out[1]);
864 out += 2;
865 aux[0] = mulAdd(a, va, aux[0]);
866 aux++;
867 } while (--frameCount);
868 }
869 } else {
870 // ramp gain
Glenn Kastenf6b16782011-12-15 09:51:17 -0800871 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1])) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700872 int32_t vl = t->prevVolume[0];
873 int32_t vr = t->prevVolume[1];
874 const int32_t vlInc = t->volumeInc[0];
875 const int32_t vrInc = t->volumeInc[1];
876
Steve Blockb8a80522011-12-20 16:23:08 +0000877 // ALOGD("[1] %p: inc=%f, v0=%f, v1=%d, final=%f, count=%d",
Mathias Agopian65ab4712010-07-14 17:59:35 -0700878 // t, vlInc/65536.0f, vl/65536.0f, t->volume[0],
879 // (vl + vlInc*frameCount)/65536.0f, frameCount);
880
881 do {
882 *out++ += (vl >> 16) * (int32_t) *in++;
883 *out++ += (vr >> 16) * (int32_t) *in++;
884 vl += vlInc;
885 vr += vrInc;
886 } while (--frameCount);
887
888 t->prevVolume[0] = vl;
889 t->prevVolume[1] = vr;
890 t->adjustVolumeRamp(false);
891 }
892
893 // constant gain
894 else {
895 const uint32_t vrl = t->volumeRL;
896 do {
Glenn Kasten54c3b662012-01-06 07:46:30 -0800897 uint32_t rl = *reinterpret_cast<const uint32_t *>(in);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700898 in += 2;
899 out[0] = mulAddRL(1, rl, vrl, out[0]);
900 out[1] = mulAddRL(0, rl, vrl, out[1]);
901 out += 2;
902 } while (--frameCount);
903 }
904 }
905 t->in = in;
906}
907
908void AudioMixer::track__16BitsMono(track_t* t, int32_t* out, size_t frameCount, int32_t* temp, int32_t* aux)
909{
Glenn Kasten54c3b662012-01-06 07:46:30 -0800910 const int16_t *in = static_cast<int16_t const *>(t->in);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700911
Glenn Kastenf6b16782011-12-15 09:51:17 -0800912 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700913 // ramp gain
Glenn Kastenf6b16782011-12-15 09:51:17 -0800914 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1]|t->auxInc)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700915 int32_t vl = t->prevVolume[0];
916 int32_t vr = t->prevVolume[1];
917 int32_t va = t->prevAuxLevel;
918 const int32_t vlInc = t->volumeInc[0];
919 const int32_t vrInc = t->volumeInc[1];
920 const int32_t vaInc = t->auxInc;
921
Steve Blockb8a80522011-12-20 16:23:08 +0000922 // ALOGD("[2] %p: inc=%f, v0=%f, v1=%d, final=%f, count=%d",
Mathias Agopian65ab4712010-07-14 17:59:35 -0700923 // t, vlInc/65536.0f, vl/65536.0f, t->volume[0],
924 // (vl + vlInc*frameCount)/65536.0f, frameCount);
925
926 do {
927 int32_t l = *in++;
928 *out++ += (vl >> 16) * l;
929 *out++ += (vr >> 16) * l;
930 *aux++ += (va >> 16) * l;
931 vl += vlInc;
932 vr += vrInc;
933 va += vaInc;
934 } while (--frameCount);
935
936 t->prevVolume[0] = vl;
937 t->prevVolume[1] = vr;
938 t->prevAuxLevel = va;
939 t->adjustVolumeRamp(true);
940 }
941 // constant gain
942 else {
943 const int16_t vl = t->volume[0];
944 const int16_t vr = t->volume[1];
945 const int16_t va = (int16_t)t->auxLevel;
946 do {
947 int16_t l = *in++;
948 out[0] = mulAdd(l, vl, out[0]);
949 out[1] = mulAdd(l, vr, out[1]);
950 out += 2;
951 aux[0] = mulAdd(l, va, aux[0]);
952 aux++;
953 } while (--frameCount);
954 }
955 } else {
956 // ramp gain
Glenn Kastenf6b16782011-12-15 09:51:17 -0800957 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1])) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700958 int32_t vl = t->prevVolume[0];
959 int32_t vr = t->prevVolume[1];
960 const int32_t vlInc = t->volumeInc[0];
961 const int32_t vrInc = t->volumeInc[1];
962
Steve Blockb8a80522011-12-20 16:23:08 +0000963 // ALOGD("[2] %p: inc=%f, v0=%f, v1=%d, final=%f, count=%d",
Mathias Agopian65ab4712010-07-14 17:59:35 -0700964 // t, vlInc/65536.0f, vl/65536.0f, t->volume[0],
965 // (vl + vlInc*frameCount)/65536.0f, frameCount);
966
967 do {
968 int32_t l = *in++;
969 *out++ += (vl >> 16) * l;
970 *out++ += (vr >> 16) * l;
971 vl += vlInc;
972 vr += vrInc;
973 } while (--frameCount);
974
975 t->prevVolume[0] = vl;
976 t->prevVolume[1] = vr;
977 t->adjustVolumeRamp(false);
978 }
979 // constant gain
980 else {
981 const int16_t vl = t->volume[0];
982 const int16_t vr = t->volume[1];
983 do {
984 int16_t l = *in++;
985 out[0] = mulAdd(l, vl, out[0]);
986 out[1] = mulAdd(l, vr, out[1]);
987 out += 2;
988 } while (--frameCount);
989 }
990 }
991 t->in = in;
992}
993
Mathias Agopian65ab4712010-07-14 17:59:35 -0700994// no-op case
John Grossman4ff14ba2012-02-08 16:37:41 -0800995void AudioMixer::process__nop(state_t* state, int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700996{
997 uint32_t e0 = state->enabledTracks;
998 size_t bufSize = state->frameCount * sizeof(int16_t) * MAX_NUM_CHANNELS;
999 while (e0) {
1000 // process by group of tracks with same output buffer to
1001 // avoid multiple memset() on same buffer
1002 uint32_t e1 = e0, e2 = e0;
1003 int i = 31 - __builtin_clz(e1);
1004 track_t& t1 = state->tracks[i];
1005 e2 &= ~(1<<i);
1006 while (e2) {
1007 i = 31 - __builtin_clz(e2);
1008 e2 &= ~(1<<i);
1009 track_t& t2 = state->tracks[i];
Glenn Kastenf6b16782011-12-15 09:51:17 -08001010 if (CC_UNLIKELY(t2.mainBuffer != t1.mainBuffer)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001011 e1 &= ~(1<<i);
1012 }
1013 }
1014 e0 &= ~(e1);
1015
1016 memset(t1.mainBuffer, 0, bufSize);
1017
1018 while (e1) {
1019 i = 31 - __builtin_clz(e1);
1020 e1 &= ~(1<<i);
1021 t1 = state->tracks[i];
1022 size_t outFrames = state->frameCount;
1023 while (outFrames) {
1024 t1.buffer.frameCount = outFrames;
John Grossman4ff14ba2012-02-08 16:37:41 -08001025 int64_t outputPTS = calculateOutputPTS(
1026 t1, pts, state->frameCount - outFrames);
1027 t1.bufferProvider->getNextBuffer(&t1.buffer, outputPTS);
Glenn Kastena0d68332012-01-27 16:47:15 -08001028 if (t1.buffer.raw == NULL) break;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001029 outFrames -= t1.buffer.frameCount;
1030 t1.bufferProvider->releaseBuffer(&t1.buffer);
1031 }
1032 }
1033 }
1034}
1035
1036// generic code without resampling
John Grossman4ff14ba2012-02-08 16:37:41 -08001037void AudioMixer::process__genericNoResampling(state_t* state, int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001038{
1039 int32_t outTemp[BLOCKSIZE * MAX_NUM_CHANNELS] __attribute__((aligned(32)));
1040
1041 // acquire each track's buffer
1042 uint32_t enabledTracks = state->enabledTracks;
1043 uint32_t e0 = enabledTracks;
1044 while (e0) {
1045 const int i = 31 - __builtin_clz(e0);
1046 e0 &= ~(1<<i);
1047 track_t& t = state->tracks[i];
1048 t.buffer.frameCount = state->frameCount;
John Grossman4ff14ba2012-02-08 16:37:41 -08001049 t.bufferProvider->getNextBuffer(&t.buffer, pts);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001050 t.frameCount = t.buffer.frameCount;
1051 t.in = t.buffer.raw;
1052 // t.in == NULL can happen if the track was flushed just after having
1053 // been enabled for mixing.
1054 if (t.in == NULL)
1055 enabledTracks &= ~(1<<i);
1056 }
1057
1058 e0 = enabledTracks;
1059 while (e0) {
1060 // process by group of tracks with same output buffer to
1061 // optimize cache use
1062 uint32_t e1 = e0, e2 = e0;
1063 int j = 31 - __builtin_clz(e1);
1064 track_t& t1 = state->tracks[j];
1065 e2 &= ~(1<<j);
1066 while (e2) {
1067 j = 31 - __builtin_clz(e2);
1068 e2 &= ~(1<<j);
1069 track_t& t2 = state->tracks[j];
Glenn Kastenf6b16782011-12-15 09:51:17 -08001070 if (CC_UNLIKELY(t2.mainBuffer != t1.mainBuffer)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001071 e1 &= ~(1<<j);
1072 }
1073 }
1074 e0 &= ~(e1);
1075 // this assumes output 16 bits stereo, no resampling
1076 int32_t *out = t1.mainBuffer;
1077 size_t numFrames = 0;
1078 do {
1079 memset(outTemp, 0, sizeof(outTemp));
1080 e2 = e1;
1081 while (e2) {
1082 const int i = 31 - __builtin_clz(e2);
1083 e2 &= ~(1<<i);
1084 track_t& t = state->tracks[i];
1085 size_t outFrames = BLOCKSIZE;
1086 int32_t *aux = NULL;
Glenn Kastenf6b16782011-12-15 09:51:17 -08001087 if (CC_UNLIKELY((t.needs & NEEDS_AUX__MASK) == NEEDS_AUX_ENABLED)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001088 aux = t.auxBuffer + numFrames;
1089 }
1090 while (outFrames) {
1091 size_t inFrames = (t.frameCount > outFrames)?outFrames:t.frameCount;
1092 if (inFrames) {
Glenn Kastena1117922012-01-26 10:53:32 -08001093 t.hook(&t, outTemp + (BLOCKSIZE-outFrames)*MAX_NUM_CHANNELS, inFrames, state->resampleTemp, aux);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001094 t.frameCount -= inFrames;
1095 outFrames -= inFrames;
Glenn Kastenf6b16782011-12-15 09:51:17 -08001096 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001097 aux += inFrames;
1098 }
1099 }
1100 if (t.frameCount == 0 && outFrames) {
1101 t.bufferProvider->releaseBuffer(&t.buffer);
1102 t.buffer.frameCount = (state->frameCount - numFrames) - (BLOCKSIZE - outFrames);
John Grossman4ff14ba2012-02-08 16:37:41 -08001103 int64_t outputPTS = calculateOutputPTS(
1104 t, pts, numFrames + (BLOCKSIZE - outFrames));
1105 t.bufferProvider->getNextBuffer(&t.buffer, outputPTS);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001106 t.in = t.buffer.raw;
1107 if (t.in == NULL) {
1108 enabledTracks &= ~(1<<i);
1109 e1 &= ~(1<<i);
1110 break;
1111 }
1112 t.frameCount = t.buffer.frameCount;
1113 }
1114 }
1115 }
1116 ditherAndClamp(out, outTemp, BLOCKSIZE);
1117 out += BLOCKSIZE;
1118 numFrames += BLOCKSIZE;
1119 } while (numFrames < state->frameCount);
1120 }
1121
1122 // release each track's buffer
1123 e0 = enabledTracks;
1124 while (e0) {
1125 const int i = 31 - __builtin_clz(e0);
1126 e0 &= ~(1<<i);
1127 track_t& t = state->tracks[i];
1128 t.bufferProvider->releaseBuffer(&t.buffer);
1129 }
1130}
1131
1132
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -08001133// generic code with resampling
John Grossman4ff14ba2012-02-08 16:37:41 -08001134void AudioMixer::process__genericResampling(state_t* state, int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001135{
Glenn Kasten54c3b662012-01-06 07:46:30 -08001136 // this const just means that local variable outTemp doesn't change
Mathias Agopian65ab4712010-07-14 17:59:35 -07001137 int32_t* const outTemp = state->outputTemp;
1138 const size_t size = sizeof(int32_t) * MAX_NUM_CHANNELS * state->frameCount;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001139
1140 size_t numFrames = state->frameCount;
1141
1142 uint32_t e0 = state->enabledTracks;
1143 while (e0) {
1144 // process by group of tracks with same output buffer
1145 // to optimize cache use
1146 uint32_t e1 = e0, e2 = e0;
1147 int j = 31 - __builtin_clz(e1);
1148 track_t& t1 = state->tracks[j];
1149 e2 &= ~(1<<j);
1150 while (e2) {
1151 j = 31 - __builtin_clz(e2);
1152 e2 &= ~(1<<j);
1153 track_t& t2 = state->tracks[j];
Glenn Kastenf6b16782011-12-15 09:51:17 -08001154 if (CC_UNLIKELY(t2.mainBuffer != t1.mainBuffer)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001155 e1 &= ~(1<<j);
1156 }
1157 }
1158 e0 &= ~(e1);
1159 int32_t *out = t1.mainBuffer;
Yuuhi Yamaguchi2151d7b2011-02-04 15:24:34 +01001160 memset(outTemp, 0, size);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001161 while (e1) {
1162 const int i = 31 - __builtin_clz(e1);
1163 e1 &= ~(1<<i);
1164 track_t& t = state->tracks[i];
1165 int32_t *aux = NULL;
Glenn Kastenf6b16782011-12-15 09:51:17 -08001166 if (CC_UNLIKELY((t.needs & NEEDS_AUX__MASK) == NEEDS_AUX_ENABLED)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001167 aux = t.auxBuffer;
1168 }
1169
1170 // this is a little goofy, on the resampling case we don't
1171 // acquire/release the buffers because it's done by
1172 // the resampler.
1173 if ((t.needs & NEEDS_RESAMPLE__MASK) == NEEDS_RESAMPLE_ENABLED) {
John Grossman4ff14ba2012-02-08 16:37:41 -08001174 t.resampler->setPTS(pts);
Glenn Kastena1117922012-01-26 10:53:32 -08001175 t.hook(&t, outTemp, numFrames, state->resampleTemp, aux);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001176 } else {
1177
1178 size_t outFrames = 0;
1179
1180 while (outFrames < numFrames) {
1181 t.buffer.frameCount = numFrames - outFrames;
John Grossman4ff14ba2012-02-08 16:37:41 -08001182 int64_t outputPTS = calculateOutputPTS(t, pts, outFrames);
1183 t.bufferProvider->getNextBuffer(&t.buffer, outputPTS);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001184 t.in = t.buffer.raw;
1185 // t.in == NULL can happen if the track was flushed just after having
1186 // been enabled for mixing.
1187 if (t.in == NULL) break;
1188
Glenn Kastenf6b16782011-12-15 09:51:17 -08001189 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001190 aux += outFrames;
1191 }
Glenn Kastena1117922012-01-26 10:53:32 -08001192 t.hook(&t, outTemp + outFrames*MAX_NUM_CHANNELS, t.buffer.frameCount, state->resampleTemp, aux);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001193 outFrames += t.buffer.frameCount;
1194 t.bufferProvider->releaseBuffer(&t.buffer);
1195 }
1196 }
1197 }
1198 ditherAndClamp(out, outTemp, numFrames);
1199 }
1200}
1201
1202// one track, 16 bits stereo without resampling is the most common case
John Grossman4ff14ba2012-02-08 16:37:41 -08001203void AudioMixer::process__OneTrack16BitsStereoNoResampling(state_t* state,
1204 int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001205{
Glenn Kasten99e53b82012-01-19 08:59:58 -08001206 // This method is only called when state->enabledTracks has exactly
1207 // one bit set. The asserts below would verify this, but are commented out
1208 // since the whole point of this method is to optimize performance.
Glenn Kasten5798d4e2012-03-08 12:18:35 -08001209 //ALOG_ASSERT(0 != state->enabledTracks, "no tracks enabled");
Mathias Agopian65ab4712010-07-14 17:59:35 -07001210 const int i = 31 - __builtin_clz(state->enabledTracks);
Glenn Kasten5798d4e2012-03-08 12:18:35 -08001211 //ALOG_ASSERT((1 << i) == state->enabledTracks, "more than 1 track enabled");
Mathias Agopian65ab4712010-07-14 17:59:35 -07001212 const track_t& t = state->tracks[i];
1213
1214 AudioBufferProvider::Buffer& b(t.buffer);
1215
1216 int32_t* out = t.mainBuffer;
1217 size_t numFrames = state->frameCount;
1218
1219 const int16_t vl = t.volume[0];
1220 const int16_t vr = t.volume[1];
1221 const uint32_t vrl = t.volumeRL;
1222 while (numFrames) {
1223 b.frameCount = numFrames;
John Grossman4ff14ba2012-02-08 16:37:41 -08001224 int64_t outputPTS = calculateOutputPTS(t, pts, out - t.mainBuffer);
1225 t.bufferProvider->getNextBuffer(&b, outputPTS);
Glenn Kasten54c3b662012-01-06 07:46:30 -08001226 const int16_t *in = b.i16;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001227
1228 // in == NULL can happen if the track was flushed just after having
1229 // been enabled for mixing.
1230 if (in == NULL || ((unsigned long)in & 3)) {
1231 memset(out, 0, numFrames*MAX_NUM_CHANNELS*sizeof(int16_t));
Steve Block29357bc2012-01-06 19:20:56 +00001232 ALOGE_IF(((unsigned long)in & 3), "process stereo track: input buffer alignment pb: buffer %p track %d, channels %d, needs %08x",
Mathias Agopian65ab4712010-07-14 17:59:35 -07001233 in, i, t.channelCount, t.needs);
1234 return;
1235 }
1236 size_t outFrames = b.frameCount;
1237
Glenn Kastenf6b16782011-12-15 09:51:17 -08001238 if (CC_UNLIKELY(uint32_t(vl) > UNITY_GAIN || uint32_t(vr) > UNITY_GAIN)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001239 // volume is boosted, so we might need to clamp even though
1240 // we process only one track.
1241 do {
Glenn Kasten54c3b662012-01-06 07:46:30 -08001242 uint32_t rl = *reinterpret_cast<const uint32_t *>(in);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001243 in += 2;
1244 int32_t l = mulRL(1, rl, vrl) >> 12;
1245 int32_t r = mulRL(0, rl, vrl) >> 12;
1246 // clamping...
1247 l = clamp16(l);
1248 r = clamp16(r);
1249 *out++ = (r<<16) | (l & 0xFFFF);
1250 } while (--outFrames);
1251 } else {
1252 do {
Glenn Kasten54c3b662012-01-06 07:46:30 -08001253 uint32_t rl = *reinterpret_cast<const uint32_t *>(in);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001254 in += 2;
1255 int32_t l = mulRL(1, rl, vrl) >> 12;
1256 int32_t r = mulRL(0, rl, vrl) >> 12;
1257 *out++ = (r<<16) | (l & 0xFFFF);
1258 } while (--outFrames);
1259 }
1260 numFrames -= b.frameCount;
1261 t.bufferProvider->releaseBuffer(&b);
1262 }
1263}
1264
Glenn Kasten81a028f2011-12-15 09:53:12 -08001265#if 0
Mathias Agopian65ab4712010-07-14 17:59:35 -07001266// 2 tracks is also a common case
1267// NEVER used in current implementation of process__validate()
1268// only use if the 2 tracks have the same output buffer
John Grossman4ff14ba2012-02-08 16:37:41 -08001269void AudioMixer::process__TwoTracks16BitsStereoNoResampling(state_t* state,
1270 int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001271{
1272 int i;
1273 uint32_t en = state->enabledTracks;
1274
1275 i = 31 - __builtin_clz(en);
1276 const track_t& t0 = state->tracks[i];
1277 AudioBufferProvider::Buffer& b0(t0.buffer);
1278
1279 en &= ~(1<<i);
1280 i = 31 - __builtin_clz(en);
1281 const track_t& t1 = state->tracks[i];
1282 AudioBufferProvider::Buffer& b1(t1.buffer);
1283
Glenn Kasten54c3b662012-01-06 07:46:30 -08001284 const int16_t *in0;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001285 const int16_t vl0 = t0.volume[0];
1286 const int16_t vr0 = t0.volume[1];
1287 size_t frameCount0 = 0;
1288
Glenn Kasten54c3b662012-01-06 07:46:30 -08001289 const int16_t *in1;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001290 const int16_t vl1 = t1.volume[0];
1291 const int16_t vr1 = t1.volume[1];
1292 size_t frameCount1 = 0;
1293
1294 //FIXME: only works if two tracks use same buffer
1295 int32_t* out = t0.mainBuffer;
1296 size_t numFrames = state->frameCount;
Glenn Kasten54c3b662012-01-06 07:46:30 -08001297 const int16_t *buff = NULL;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001298
1299
1300 while (numFrames) {
1301
1302 if (frameCount0 == 0) {
1303 b0.frameCount = numFrames;
John Grossman4ff14ba2012-02-08 16:37:41 -08001304 int64_t outputPTS = calculateOutputPTS(t0, pts,
1305 out - t0.mainBuffer);
1306 t0.bufferProvider->getNextBuffer(&b0, outputPTS);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001307 if (b0.i16 == NULL) {
1308 if (buff == NULL) {
1309 buff = new int16_t[MAX_NUM_CHANNELS * state->frameCount];
1310 }
1311 in0 = buff;
1312 b0.frameCount = numFrames;
1313 } else {
1314 in0 = b0.i16;
1315 }
1316 frameCount0 = b0.frameCount;
1317 }
1318 if (frameCount1 == 0) {
1319 b1.frameCount = numFrames;
John Grossman4ff14ba2012-02-08 16:37:41 -08001320 int64_t outputPTS = calculateOutputPTS(t1, pts,
1321 out - t0.mainBuffer);
1322 t1.bufferProvider->getNextBuffer(&b1, outputPTS);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001323 if (b1.i16 == NULL) {
1324 if (buff == NULL) {
1325 buff = new int16_t[MAX_NUM_CHANNELS * state->frameCount];
1326 }
1327 in1 = buff;
1328 b1.frameCount = numFrames;
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -08001329 } else {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001330 in1 = b1.i16;
1331 }
1332 frameCount1 = b1.frameCount;
1333 }
1334
1335 size_t outFrames = frameCount0 < frameCount1?frameCount0:frameCount1;
1336
1337 numFrames -= outFrames;
1338 frameCount0 -= outFrames;
1339 frameCount1 -= outFrames;
1340
1341 do {
1342 int32_t l0 = *in0++;
1343 int32_t r0 = *in0++;
1344 l0 = mul(l0, vl0);
1345 r0 = mul(r0, vr0);
1346 int32_t l = *in1++;
1347 int32_t r = *in1++;
1348 l = mulAdd(l, vl1, l0) >> 12;
1349 r = mulAdd(r, vr1, r0) >> 12;
1350 // clamping...
1351 l = clamp16(l);
1352 r = clamp16(r);
1353 *out++ = (r<<16) | (l & 0xFFFF);
1354 } while (--outFrames);
1355
1356 if (frameCount0 == 0) {
1357 t0.bufferProvider->releaseBuffer(&b0);
1358 }
1359 if (frameCount1 == 0) {
1360 t1.bufferProvider->releaseBuffer(&b1);
1361 }
1362 }
1363
Glenn Kastene9dd0172012-01-27 18:08:45 -08001364 delete [] buff;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001365}
Glenn Kasten81a028f2011-12-15 09:53:12 -08001366#endif
Mathias Agopian65ab4712010-07-14 17:59:35 -07001367
John Grossman4ff14ba2012-02-08 16:37:41 -08001368int64_t AudioMixer::calculateOutputPTS(const track_t& t, int64_t basePTS,
1369 int outputFrameIndex)
1370{
1371 if (AudioBufferProvider::kInvalidPTS == basePTS)
1372 return AudioBufferProvider::kInvalidPTS;
1373
1374 return basePTS + ((outputFrameIndex * t.localTimeFreq) / t.sampleRate);
1375}
1376
Mathias Agopian65ab4712010-07-14 17:59:35 -07001377// ----------------------------------------------------------------------------
1378}; // namespace android