blob: 529d1b579d7058df37414066580eb4e7b78e3f24 [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);
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -070072 //ALOGV("getNextBuffer is downmixing");
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -070073 }
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) {
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -070082 //ALOGV("DownmixerBufferProvider::releaseBuffer()");
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -070083 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
Paul Lind3c0a0e82012-08-01 18:49:49 -070096// Ensure mConfiguredNames bitmask is initialized properly on all architectures.
97// The value of 1 << x is undefined in C when x >= 32.
98
Glenn Kasten5c94b6c2012-03-20 17:01:29 -070099AudioMixer::AudioMixer(size_t frameCount, uint32_t sampleRate, uint32_t maxNumTracks)
Paul Lind3c0a0e82012-08-01 18:49:49 -0700100 : mTrackNames(0), mConfiguredNames((maxNumTracks >= 32 ? 0 : 1 << maxNumTracks) - 1),
Glenn Kasten5881f182013-02-13 14:46:45 -0800101 mSampleRate(sampleRate), mLog(&mDummyLog)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700102{
Glenn Kasten788040c2011-05-05 08:19:00 -0700103 // AudioMixer is not yet capable of multi-channel beyond stereo
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800104 COMPILE_TIME_ASSERT_FUNCTION_SCOPE(2 == MAX_NUM_CHANNELS);
Jean-Michel Triviacb86cc2012-04-16 12:43:57 -0700105
Glenn Kasten5c94b6c2012-03-20 17:01:29 -0700106 ALOG_ASSERT(maxNumTracks <= MAX_NUM_TRACKS, "maxNumTracks %u > MAX_NUM_TRACKS %u",
107 maxNumTracks, MAX_NUM_TRACKS);
108
Glenn Kastend82c7502012-03-08 12:33:37 -0800109 // AudioMixer is not yet capable of more than 32 active track inputs
110 ALOG_ASSERT(32 >= MAX_NUM_TRACKS, "bad MAX_NUM_TRACKS %d", MAX_NUM_TRACKS);
111
112 // AudioMixer is not yet capable of multi-channel output beyond stereo
113 ALOG_ASSERT(2 == MAX_NUM_CHANNELS, "bad MAX_NUM_CHANNELS %d", MAX_NUM_CHANNELS);
114
John Grossman4ff14ba2012-02-08 16:37:41 -0800115 LocalClock lc;
116
Glenn Kasten52008f82012-03-18 09:34:41 -0700117 pthread_once(&sOnceControl, &sInitRoutine);
118
Mathias Agopian65ab4712010-07-14 17:59:35 -0700119 mState.enabledTracks= 0;
120 mState.needsChanged = 0;
121 mState.frameCount = frameCount;
Glenn Kasten84afa3b2012-01-25 15:28:08 -0800122 mState.hook = process__nop;
Glenn Kastene0feee32011-12-13 11:53:26 -0800123 mState.outputTemp = NULL;
124 mState.resampleTemp = NULL;
Glenn Kasten5881f182013-02-13 14:46:45 -0800125 mState.mLog = &mDummyLog;
Glenn Kasten84afa3b2012-01-25 15:28:08 -0800126 // mState.reserved
Glenn Kasten17a736c2012-02-14 08:52:15 -0800127
128 // FIXME Most of the following initialization is probably redundant since
129 // tracks[i] should only be referenced if (mTrackNames & (1 << i)) != 0
130 // and mTrackNames is initially 0. However, leave it here until that's verified.
Mathias Agopian65ab4712010-07-14 17:59:35 -0700131 track_t* t = mState.tracks;
Glenn Kastenbf71f1e2011-12-13 11:52:35 -0800132 for (unsigned i=0 ; i < MAX_NUM_TRACKS ; i++) {
Eric Laurenta5e82142012-04-16 13:47:17 -0700133 t->resampler = NULL;
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700134 t->downmixerBufferProvider = NULL;
Glenn Kasten5881f182013-02-13 14:46:45 -0800135 t->magic = track_t::kMagic;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700136 t++;
137 }
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700138
139 // find multichannel downmix effect if we have to play multichannel content
140 uint32_t numEffects = 0;
141 int ret = EffectQueryNumberEffects(&numEffects);
142 if (ret != 0) {
143 ALOGE("AudioMixer() error %d querying number of effects", ret);
144 return;
145 }
146 ALOGV("EffectQueryNumberEffects() numEffects=%d", numEffects);
147
148 for (uint32_t i = 0 ; i < numEffects ; i++) {
149 if (EffectQueryEffect(i, &dwnmFxDesc) == 0) {
150 ALOGV("effect %d is called %s", i, dwnmFxDesc.name);
151 if (memcmp(&dwnmFxDesc.type, EFFECT_UIID_DOWNMIX, sizeof(effect_uuid_t)) == 0) {
152 ALOGI("found effect \"%s\" from %s",
153 dwnmFxDesc.name, dwnmFxDesc.implementor);
154 isMultichannelCapable = true;
155 break;
156 }
157 }
158 }
159 ALOGE_IF(!isMultichannelCapable, "unable to find downmix effect");
Mathias Agopian65ab4712010-07-14 17:59:35 -0700160}
161
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800162AudioMixer::~AudioMixer()
163{
164 track_t* t = mState.tracks;
Glenn Kastenbf71f1e2011-12-13 11:52:35 -0800165 for (unsigned i=0 ; i < MAX_NUM_TRACKS ; i++) {
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800166 delete t->resampler;
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700167 delete t->downmixerBufferProvider;
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800168 t++;
169 }
170 delete [] mState.outputTemp;
171 delete [] mState.resampleTemp;
172}
Mathias Agopian65ab4712010-07-14 17:59:35 -0700173
Glenn Kasten5881f182013-02-13 14:46:45 -0800174void AudioMixer::setLog(NBLog::Writer *log)
175{
176 mLog = log;
177 mState.mLog = log;
178}
179
Jean-Michel Trivia59d2712012-09-12 15:47:07 -0700180int AudioMixer::getTrackName(audio_channel_mask_t channelMask, int sessionId)
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800181{
Glenn Kasten5c94b6c2012-03-20 17:01:29 -0700182 uint32_t names = (~mTrackNames) & mConfiguredNames;
Glenn Kasten98dd5422011-12-15 14:38:29 -0800183 if (names != 0) {
184 int n = __builtin_ctz(names);
Steve Block3856b092011-10-20 11:56:00 +0100185 ALOGV("add track (%d)", n);
Glenn Kasten98dd5422011-12-15 14:38:29 -0800186 mTrackNames |= 1 << n;
Glenn Kastendeeb1282012-03-25 11:59:31 -0700187 // assume default parameters for the track, except where noted below
188 track_t* t = &mState.tracks[n];
189 t->needs = 0;
190 t->volume[0] = UNITY_GAIN;
191 t->volume[1] = UNITY_GAIN;
192 // no initialization needed
193 // t->prevVolume[0]
194 // t->prevVolume[1]
195 t->volumeInc[0] = 0;
196 t->volumeInc[1] = 0;
197 t->auxLevel = 0;
198 t->auxInc = 0;
199 // no initialization needed
200 // t->prevAuxLevel
201 // t->frameCount
202 t->channelCount = 2;
203 t->enabled = false;
204 t->format = 16;
205 t->channelMask = AUDIO_CHANNEL_OUT_STEREO;
Jean-Michel Trivia59d2712012-09-12 15:47:07 -0700206 t->sessionId = sessionId;
Glenn Kastendeeb1282012-03-25 11:59:31 -0700207 // setBufferProvider(name, AudioBufferProvider *) is required before enable(name)
208 t->bufferProvider = NULL;
209 t->buffer.raw = NULL;
210 // no initialization needed
211 // t->buffer.frameCount
212 t->hook = NULL;
213 t->in = NULL;
214 t->resampler = NULL;
215 t->sampleRate = mSampleRate;
216 // setParameter(name, TRACK, MAIN_BUFFER, mixBuffer) is required before enable(name)
217 t->mainBuffer = NULL;
218 t->auxBuffer = NULL;
Glenn Kasten52008f82012-03-18 09:34:41 -0700219 t->downmixerBufferProvider = NULL;
Glenn Kasten5881f182013-02-13 14:46:45 -0800220 t->fastIndex = -1;
221 // t->magic unchanged
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700222
223 status_t status = initTrackDownmix(&mState.tracks[n], n, channelMask);
224 if (status == OK) {
Glenn Kasten5881f182013-02-13 14:46:45 -0800225 mLog->logf("getTrackName %d", n);
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700226 return TRACK0 + n;
227 }
228 ALOGE("AudioMixer::getTrackName(0x%x) failed, error preparing track for downmix",
229 channelMask);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700230 }
231 return -1;
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800232}
Mathias Agopian65ab4712010-07-14 17:59:35 -0700233
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800234void AudioMixer::invalidateState(uint32_t mask)
235{
Mathias Agopian65ab4712010-07-14 17:59:35 -0700236 if (mask) {
237 mState.needsChanged |= mask;
238 mState.hook = process__validate;
239 }
240 }
241
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700242status_t AudioMixer::initTrackDownmix(track_t* pTrack, int trackNum, audio_channel_mask_t mask)
243{
244 uint32_t channelCount = popcount(mask);
245 ALOG_ASSERT((channelCount <= MAX_NUM_CHANNELS_TO_DOWNMIX) && channelCount);
246 status_t status = OK;
247 if (channelCount > MAX_NUM_CHANNELS) {
248 pTrack->channelMask = mask;
249 pTrack->channelCount = channelCount;
250 ALOGV("initTrackDownmix(track=%d, mask=0x%x) calls prepareTrackForDownmix()",
251 trackNum, mask);
252 status = prepareTrackForDownmix(pTrack, trackNum);
253 } else {
254 unprepareTrackForDownmix(pTrack, trackNum);
255 }
256 return status;
257}
258
259void AudioMixer::unprepareTrackForDownmix(track_t* pTrack, int trackName) {
260 ALOGV("AudioMixer::unprepareTrackForDownmix(%d)", trackName);
261
262 if (pTrack->downmixerBufferProvider != NULL) {
263 // this track had previously been configured with a downmixer, delete it
264 ALOGV(" deleting old downmixer");
265 pTrack->bufferProvider = pTrack->downmixerBufferProvider->mTrackBufferProvider;
266 delete pTrack->downmixerBufferProvider;
267 pTrack->downmixerBufferProvider = NULL;
268 } else {
269 ALOGV(" nothing to do, no downmixer to delete");
270 }
271}
272
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700273status_t AudioMixer::prepareTrackForDownmix(track_t* pTrack, int trackName)
274{
275 ALOGV("AudioMixer::prepareTrackForDownmix(%d) with mask 0x%x", trackName, pTrack->channelMask);
276
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700277 // discard the previous downmixer if there was one
278 unprepareTrackForDownmix(pTrack, trackName);
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700279
280 DownmixerBufferProvider* pDbp = new DownmixerBufferProvider();
281 int32_t status;
282
283 if (!isMultichannelCapable) {
284 ALOGE("prepareTrackForDownmix(%d) fails: mixer doesn't support multichannel content",
285 trackName);
286 goto noDownmixForActiveTrack;
287 }
288
289 if (EffectCreate(&dwnmFxDesc.uuid,
Jean-Michel Trivia59d2712012-09-12 15:47:07 -0700290 pTrack->sessionId /*sessionId*/, -2 /*ioId not relevant here, using random value*/,
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700291 &pDbp->mDownmixHandle/*pHandle*/) != 0) {
292 ALOGE("prepareTrackForDownmix(%d) fails: error creating downmixer effect", trackName);
293 goto noDownmixForActiveTrack;
294 }
295
296 // channel input configuration will be overridden per-track
297 pDbp->mDownmixConfig.inputCfg.channels = pTrack->channelMask;
298 pDbp->mDownmixConfig.outputCfg.channels = AUDIO_CHANNEL_OUT_STEREO;
299 pDbp->mDownmixConfig.inputCfg.format = AUDIO_FORMAT_PCM_16_BIT;
300 pDbp->mDownmixConfig.outputCfg.format = AUDIO_FORMAT_PCM_16_BIT;
301 pDbp->mDownmixConfig.inputCfg.samplingRate = pTrack->sampleRate;
302 pDbp->mDownmixConfig.outputCfg.samplingRate = pTrack->sampleRate;
303 pDbp->mDownmixConfig.inputCfg.accessMode = EFFECT_BUFFER_ACCESS_READ;
304 pDbp->mDownmixConfig.outputCfg.accessMode = EFFECT_BUFFER_ACCESS_WRITE;
305 // input and output buffer provider, and frame count will not be used as the downmix effect
306 // process() function is called directly (see DownmixerBufferProvider::getNextBuffer())
307 pDbp->mDownmixConfig.inputCfg.mask = EFFECT_CONFIG_SMP_RATE | EFFECT_CONFIG_CHANNELS |
308 EFFECT_CONFIG_FORMAT | EFFECT_CONFIG_ACC_MODE;
309 pDbp->mDownmixConfig.outputCfg.mask = pDbp->mDownmixConfig.inputCfg.mask;
310
311 {// scope for local variables that are not used in goto label "noDownmixForActiveTrack"
312 int cmdStatus;
313 uint32_t replySize = sizeof(int);
314
315 // Configure and enable downmixer
316 status = (*pDbp->mDownmixHandle)->command(pDbp->mDownmixHandle,
317 EFFECT_CMD_SET_CONFIG /*cmdCode*/, sizeof(effect_config_t) /*cmdSize*/,
318 &pDbp->mDownmixConfig /*pCmdData*/,
319 &replySize /*replySize*/, &cmdStatus /*pReplyData*/);
320 if ((status != 0) || (cmdStatus != 0)) {
321 ALOGE("error %d while configuring downmixer for track %d", status, trackName);
322 goto noDownmixForActiveTrack;
323 }
324 replySize = sizeof(int);
325 status = (*pDbp->mDownmixHandle)->command(pDbp->mDownmixHandle,
326 EFFECT_CMD_ENABLE /*cmdCode*/, 0 /*cmdSize*/, NULL /*pCmdData*/,
327 &replySize /*replySize*/, &cmdStatus /*pReplyData*/);
328 if ((status != 0) || (cmdStatus != 0)) {
329 ALOGE("error %d while enabling downmixer for track %d", status, trackName);
330 goto noDownmixForActiveTrack;
331 }
332
333 // Set downmix type
334 // parameter size rounded for padding on 32bit boundary
335 const int psizePadded = ((sizeof(downmix_params_t) - 1)/sizeof(int) + 1) * sizeof(int);
336 const int downmixParamSize =
337 sizeof(effect_param_t) + psizePadded + sizeof(downmix_type_t);
338 effect_param_t * const param = (effect_param_t *) malloc(downmixParamSize);
339 param->psize = sizeof(downmix_params_t);
340 const downmix_params_t downmixParam = DOWNMIX_PARAM_TYPE;
341 memcpy(param->data, &downmixParam, param->psize);
342 const downmix_type_t downmixType = DOWNMIX_TYPE_FOLD;
343 param->vsize = sizeof(downmix_type_t);
344 memcpy(param->data + psizePadded, &downmixType, param->vsize);
345
346 status = (*pDbp->mDownmixHandle)->command(pDbp->mDownmixHandle,
347 EFFECT_CMD_SET_PARAM /* cmdCode */, downmixParamSize/* cmdSize */,
348 param /*pCmndData*/, &replySize /*replySize*/, &cmdStatus /*pReplyData*/);
349
350 free(param);
351
352 if ((status != 0) || (cmdStatus != 0)) {
353 ALOGE("error %d while setting downmix type for track %d", status, trackName);
354 goto noDownmixForActiveTrack;
355 } else {
356 ALOGV("downmix type set to %d for track %d", (int) downmixType, trackName);
357 }
358 }// end of scope for local variables that are not used in goto label "noDownmixForActiveTrack"
359
360 // initialization successful:
361 // - keep track of the real buffer provider in case it was set before
362 pDbp->mTrackBufferProvider = pTrack->bufferProvider;
363 // - we'll use the downmix effect integrated inside this
364 // track's buffer provider, and we'll use it as the track's buffer provider
365 pTrack->downmixerBufferProvider = pDbp;
366 pTrack->bufferProvider = pDbp;
367
368 return NO_ERROR;
369
370noDownmixForActiveTrack:
371 delete pDbp;
372 pTrack->downmixerBufferProvider = NULL;
373 return NO_INIT;
374}
375
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800376void AudioMixer::deleteTrackName(int name)
377{
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700378 ALOGV("AudioMixer::deleteTrackName(%d)", name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700379 name -= TRACK0;
Glenn Kasten5881f182013-02-13 14:46:45 -0800380 mLog->logf("deleteTrackName %d", name);
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800381 ALOG_ASSERT(uint32_t(name) < MAX_NUM_TRACKS, "bad track name %d", name);
Glenn Kasten237a6242011-12-15 15:32:27 -0800382 ALOGV("deleteTrackName(%d)", name);
383 track_t& track(mState.tracks[ name ]);
Glenn Kasten5881f182013-02-13 14:46:45 -0800384 track.checkMagic();
Glenn Kasten4c340c62012-01-27 12:33:54 -0800385 if (track.enabled) {
386 track.enabled = false;
Glenn Kasten237a6242011-12-15 15:32:27 -0800387 invalidateState(1<<name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700388 }
Glenn Kasten4e2293f2012-04-12 09:39:07 -0700389 // delete the resampler
390 delete track.resampler;
391 track.resampler = NULL;
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700392 // delete the downmixer
393 unprepareTrackForDownmix(&mState.tracks[name], name);
394
Glenn Kasten237a6242011-12-15 15:32:27 -0800395 mTrackNames &= ~(1<<name);
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800396}
Mathias Agopian65ab4712010-07-14 17:59:35 -0700397
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800398void AudioMixer::enable(int name)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700399{
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800400 name -= TRACK0;
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800401 ALOG_ASSERT(uint32_t(name) < MAX_NUM_TRACKS, "bad track name %d", name);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800402 track_t& track = mState.tracks[name];
Glenn Kasten5881f182013-02-13 14:46:45 -0800403 track.checkMagic();
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800404
Glenn Kasten4c340c62012-01-27 12:33:54 -0800405 if (!track.enabled) {
Glenn Kasten5881f182013-02-13 14:46:45 -0800406 mLog->logf("enable %d", name);
Glenn Kasten4c340c62012-01-27 12:33:54 -0800407 track.enabled = true;
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800408 ALOGV("enable(%d)", name);
409 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700410 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700411}
412
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800413void AudioMixer::disable(int name)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700414{
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800415 name -= TRACK0;
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800416 ALOG_ASSERT(uint32_t(name) < MAX_NUM_TRACKS, "bad track name %d", name);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800417 track_t& track = mState.tracks[name];
Glenn Kasten5881f182013-02-13 14:46:45 -0800418 track.checkMagic();
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800419
Glenn Kasten4c340c62012-01-27 12:33:54 -0800420 if (track.enabled) {
Glenn Kasten5881f182013-02-13 14:46:45 -0800421 mLog->logf("disable %d", name);
Glenn Kasten4c340c62012-01-27 12:33:54 -0800422 track.enabled = false;
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800423 ALOGV("disable(%d)", name);
424 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700425 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700426}
427
Glenn Kasten5881f182013-02-13 14:46:45 -0800428bool AudioMixer::enabled(int name)
429{
430 name -= TRACK0;
431 ALOG_ASSERT(uint32_t(name) < MAX_NUM_TRACKS, "bad track name %d", name);
432 track_t& track = mState.tracks[name];
433 track.checkMagic();
434
435 return track.enabled;
436}
437
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800438void AudioMixer::setParameter(int name, int target, int param, void *value)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700439{
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800440 name -= TRACK0;
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800441 ALOG_ASSERT(uint32_t(name) < MAX_NUM_TRACKS, "bad track name %d", name);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800442 track_t& track = mState.tracks[name];
Glenn Kasten5881f182013-02-13 14:46:45 -0800443 track.checkMagic();
Mathias Agopian65ab4712010-07-14 17:59:35 -0700444
Mathias Agopian65ab4712010-07-14 17:59:35 -0700445 int valueInt = (int)value;
446 int32_t *valueBuf = (int32_t *)value;
447
448 switch (target) {
Glenn Kasten788040c2011-05-05 08:19:00 -0700449
Mathias Agopian65ab4712010-07-14 17:59:35 -0700450 case TRACK:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800451 switch (param) {
Glenn Kasten788040c2011-05-05 08:19:00 -0700452 case CHANNEL_MASK: {
Glenn Kasten254af182012-07-03 14:59:05 -0700453 audio_channel_mask_t mask = (audio_channel_mask_t) value;
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800454 if (track.channelMask != mask) {
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800455 uint32_t channelCount = popcount(mask);
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700456 ALOG_ASSERT((channelCount <= MAX_NUM_CHANNELS_TO_DOWNMIX) && channelCount);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800457 track.channelMask = mask;
458 track.channelCount = channelCount;
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700459 // the mask has changed, does this track need a downmixer?
460 initTrackDownmix(&mState.tracks[name], name, mask);
Glenn Kasten788040c2011-05-05 08:19:00 -0700461 ALOGV("setParameter(TRACK, CHANNEL_MASK, %x)", mask);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800462 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700463 }
Glenn Kasten788040c2011-05-05 08:19:00 -0700464 } break;
465 case MAIN_BUFFER:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800466 if (track.mainBuffer != valueBuf) {
467 track.mainBuffer = valueBuf;
Steve Block3856b092011-10-20 11:56:00 +0100468 ALOGV("setParameter(TRACK, MAIN_BUFFER, %p)", valueBuf);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800469 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700470 }
Glenn Kasten788040c2011-05-05 08:19:00 -0700471 break;
472 case AUX_BUFFER:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800473 if (track.auxBuffer != valueBuf) {
474 track.auxBuffer = valueBuf;
Steve Block3856b092011-10-20 11:56:00 +0100475 ALOGV("setParameter(TRACK, AUX_BUFFER, %p)", valueBuf);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800476 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700477 }
Glenn Kasten788040c2011-05-05 08:19:00 -0700478 break;
Glenn Kastendeeb1282012-03-25 11:59:31 -0700479 case FORMAT:
480 ALOG_ASSERT(valueInt == AUDIO_FORMAT_PCM_16_BIT);
481 break;
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700482 // FIXME do we want to support setting the downmix type from AudioFlinger?
483 // for a specific track? or per mixer?
484 /* case DOWNMIX_TYPE:
485 break */
Glenn Kasten5881f182013-02-13 14:46:45 -0800486 case FAST_INDEX:
487 track.fastIndex = valueInt;
488 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 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700492 break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700493
Mathias Agopian65ab4712010-07-14 17:59:35 -0700494 case RESAMPLE:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800495 switch (param) {
496 case SAMPLE_RATE:
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800497 ALOG_ASSERT(valueInt > 0, "bad sample rate %d", valueInt);
Glenn Kasten788040c2011-05-05 08:19:00 -0700498 if (track.setResampler(uint32_t(valueInt), mSampleRate)) {
499 ALOGV("setParameter(RESAMPLE, SAMPLE_RATE, %u)",
500 uint32_t(valueInt));
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800501 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700502 }
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800503 break;
504 case RESET:
Eric Laurent243f5f92011-02-28 16:52:51 -0800505 track.resetResampler();
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800506 invalidateState(1 << name);
507 break;
Glenn Kasten4e2293f2012-04-12 09:39:07 -0700508 case REMOVE:
509 delete track.resampler;
510 track.resampler = NULL;
511 track.sampleRate = mSampleRate;
512 invalidateState(1 << name);
513 break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700514 default:
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800515 LOG_FATAL("bad param");
Eric Laurent243f5f92011-02-28 16:52:51 -0800516 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700517 break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700518
Mathias Agopian65ab4712010-07-14 17:59:35 -0700519 case RAMP_VOLUME:
520 case VOLUME:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800521 switch (param) {
Glenn Kasten788040c2011-05-05 08:19:00 -0700522 case VOLUME0:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800523 case VOLUME1:
524 if (track.volume[param-VOLUME0] != valueInt) {
Steve Block3856b092011-10-20 11:56:00 +0100525 ALOGV("setParameter(VOLUME, VOLUME0/1: %04x)", valueInt);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800526 track.prevVolume[param-VOLUME0] = track.volume[param-VOLUME0] << 16;
527 track.volume[param-VOLUME0] = valueInt;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700528 if (target == VOLUME) {
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800529 track.prevVolume[param-VOLUME0] = valueInt << 16;
530 track.volumeInc[param-VOLUME0] = 0;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700531 } else {
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800532 int32_t d = (valueInt<<16) - track.prevVolume[param-VOLUME0];
Mathias Agopian65ab4712010-07-14 17:59:35 -0700533 int32_t volInc = d / int32_t(mState.frameCount);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800534 track.volumeInc[param-VOLUME0] = volInc;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700535 if (volInc == 0) {
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800536 track.prevVolume[param-VOLUME0] = valueInt << 16;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700537 }
538 }
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800539 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700540 }
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800541 break;
542 case AUXLEVEL:
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800543 //ALOG_ASSERT(0 <= valueInt && valueInt <= MAX_GAIN_INT, "bad aux level %d", valueInt);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700544 if (track.auxLevel != valueInt) {
Steve Block3856b092011-10-20 11:56:00 +0100545 ALOGV("setParameter(VOLUME, AUXLEVEL: %04x)", valueInt);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700546 track.prevAuxLevel = track.auxLevel << 16;
547 track.auxLevel = valueInt;
548 if (target == VOLUME) {
549 track.prevAuxLevel = valueInt << 16;
550 track.auxInc = 0;
551 } else {
552 int32_t d = (valueInt<<16) - track.prevAuxLevel;
553 int32_t volInc = d / int32_t(mState.frameCount);
554 track.auxInc = volInc;
555 if (volInc == 0) {
556 track.prevAuxLevel = valueInt << 16;
557 }
558 }
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800559 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700560 }
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800561 break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700562 default:
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800563 LOG_FATAL("bad param");
Mathias Agopian65ab4712010-07-14 17:59:35 -0700564 }
565 break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700566
567 default:
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800568 LOG_FATAL("bad target");
Mathias Agopian65ab4712010-07-14 17:59:35 -0700569 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700570}
571
572bool AudioMixer::track_t::setResampler(uint32_t value, uint32_t devSampleRate)
573{
Glenn Kasten5881f182013-02-13 14:46:45 -0800574 checkMagic();
Glenn Kasten4e2293f2012-04-12 09:39:07 -0700575 if (value != devSampleRate || resampler != NULL) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700576 if (sampleRate != value) {
577 sampleRate = value;
Glenn Kastene0feee32011-12-13 11:53:26 -0800578 if (resampler == NULL) {
Glenn Kastena6d41332012-10-01 14:04:31 -0700579 ALOGV("creating resampler from track %d Hz to device %d Hz", value, devSampleRate);
580 AudioResampler::src_quality quality;
581 // force lowest quality level resampler if use case isn't music or video
582 // FIXME this is flawed for dynamic sample rates, as we choose the resampler
583 // quality level based on the initial ratio, but that could change later.
584 // Should have a way to distinguish tracks with static ratios vs. dynamic ratios.
585 if (!((value == 44100 && devSampleRate == 48000) ||
586 (value == 48000 && devSampleRate == 44100))) {
587 quality = AudioResampler::LOW_QUALITY;
588 } else {
589 quality = AudioResampler::DEFAULT_QUALITY;
590 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700591 resampler = AudioResampler::create(
Jean-Michel Triviacb86cc2012-04-16 12:43:57 -0700592 format,
593 // the resampler sees the number of channels after the downmixer, if any
594 downmixerBufferProvider != NULL ? MAX_NUM_CHANNELS : channelCount,
Glenn Kastena6d41332012-10-01 14:04:31 -0700595 devSampleRate, quality);
Glenn Kasten52008f82012-03-18 09:34:41 -0700596 resampler->setLocalTimeFreq(sLocalTimeFreq);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700597 }
598 return true;
599 }
600 }
601 return false;
602}
603
Mathias Agopian65ab4712010-07-14 17:59:35 -0700604inline
605void AudioMixer::track_t::adjustVolumeRamp(bool aux)
606{
Glenn Kasten5881f182013-02-13 14:46:45 -0800607 checkMagic();
Glenn Kastenf9a27772012-01-06 07:47:26 -0800608 for (uint32_t i=0 ; i<MAX_NUM_CHANNELS ; i++) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700609 if (((volumeInc[i]>0) && (((prevVolume[i]+volumeInc[i])>>16) >= volume[i])) ||
610 ((volumeInc[i]<0) && (((prevVolume[i]+volumeInc[i])>>16) <= volume[i]))) {
611 volumeInc[i] = 0;
612 prevVolume[i] = volume[i]<<16;
613 }
614 }
615 if (aux) {
616 if (((auxInc>0) && (((prevAuxLevel+auxInc)>>16) >= auxLevel)) ||
617 ((auxInc<0) && (((prevAuxLevel+auxInc)>>16) <= auxLevel))) {
618 auxInc = 0;
619 prevAuxLevel = auxLevel<<16;
620 }
621 }
622}
623
Glenn Kastenc59c0042012-02-02 14:06:11 -0800624size_t AudioMixer::getUnreleasedFrames(int name) const
Eric Laurent071ccd52011-12-22 16:08:41 -0800625{
626 name -= TRACK0;
627 if (uint32_t(name) < MAX_NUM_TRACKS) {
Glenn Kastenc59c0042012-02-02 14:06:11 -0800628 return mState.tracks[name].getUnreleasedFrames();
Eric Laurent071ccd52011-12-22 16:08:41 -0800629 }
630 return 0;
631}
Mathias Agopian65ab4712010-07-14 17:59:35 -0700632
Glenn Kasten01c4ebf2012-02-22 10:47:35 -0800633void AudioMixer::setBufferProvider(int name, AudioBufferProvider* bufferProvider)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700634{
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800635 name -= TRACK0;
Glenn Kasten5881f182013-02-13 14:46:45 -0800636 mLog->logf("bp %d-%p", name, bufferProvider);
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800637 ALOG_ASSERT(uint32_t(name) < MAX_NUM_TRACKS, "bad track name %d", name);
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700638
Glenn Kasten5881f182013-02-13 14:46:45 -0800639 mState.tracks[name].checkMagic();
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700640 if (mState.tracks[name].downmixerBufferProvider != NULL) {
641 // update required?
642 if (mState.tracks[name].downmixerBufferProvider->mTrackBufferProvider != bufferProvider) {
643 ALOGV("AudioMixer::setBufferProvider(%p) for downmix", bufferProvider);
644 // setting the buffer provider for a track that gets downmixed consists in:
645 // 1/ setting the buffer provider to the "downmix / buffer provider" wrapper
646 // so it's the one that gets called when the buffer provider is needed,
647 mState.tracks[name].bufferProvider = mState.tracks[name].downmixerBufferProvider;
648 // 2/ saving the buffer provider for the track so the wrapper can use it
649 // when it downmixes.
650 mState.tracks[name].downmixerBufferProvider->mTrackBufferProvider = bufferProvider;
651 }
652 } else {
653 mState.tracks[name].bufferProvider = bufferProvider;
654 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700655}
656
657
658
John Grossman4ff14ba2012-02-08 16:37:41 -0800659void AudioMixer::process(int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700660{
Glenn Kasten5881f182013-02-13 14:46:45 -0800661 if (mState.needsChanged) {
662 mLog->logf("process needs=%#x", mState.needsChanged);
663 }
John Grossman4ff14ba2012-02-08 16:37:41 -0800664 mState.hook(&mState, pts);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700665}
666
667
John Grossman4ff14ba2012-02-08 16:37:41 -0800668void AudioMixer::process__validate(state_t* state, int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700669{
Steve Block5ff1dd52012-01-05 23:22:43 +0000670 ALOGW_IF(!state->needsChanged,
Mathias Agopian65ab4712010-07-14 17:59:35 -0700671 "in process__validate() but nothing's invalid");
672
673 uint32_t changed = state->needsChanged;
674 state->needsChanged = 0; // clear the validation flag
675
676 // recompute which tracks are enabled / disabled
677 uint32_t enabled = 0;
678 uint32_t disabled = 0;
679 while (changed) {
680 const int i = 31 - __builtin_clz(changed);
681 const uint32_t mask = 1<<i;
682 changed &= ~mask;
683 track_t& t = state->tracks[i];
684 (t.enabled ? enabled : disabled) |= mask;
685 }
686 state->enabledTracks &= ~disabled;
687 state->enabledTracks |= enabled;
Glenn Kasten5881f182013-02-13 14:46:45 -0800688 state->mLog->logf("process_validate ena=%#x", state->enabledTracks);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700689
690 // compute everything we need...
691 int countActiveTracks = 0;
Glenn Kasten4c340c62012-01-27 12:33:54 -0800692 bool all16BitsStereoNoResample = true;
693 bool resampling = false;
694 bool volumeRamp = false;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700695 uint32_t en = state->enabledTracks;
696 while (en) {
697 const int i = 31 - __builtin_clz(en);
698 en &= ~(1<<i);
699
700 countActiveTracks++;
701 track_t& t = state->tracks[i];
702 uint32_t n = 0;
703 n |= NEEDS_CHANNEL_1 + t.channelCount - 1;
704 n |= NEEDS_FORMAT_16;
705 n |= t.doesResample() ? NEEDS_RESAMPLE_ENABLED : NEEDS_RESAMPLE_DISABLED;
706 if (t.auxLevel != 0 && t.auxBuffer != NULL) {
707 n |= NEEDS_AUX_ENABLED;
708 }
709
710 if (t.volumeInc[0]|t.volumeInc[1]) {
Glenn Kasten4c340c62012-01-27 12:33:54 -0800711 volumeRamp = true;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700712 } else if (!t.doesResample() && t.volumeRL == 0) {
713 n |= NEEDS_MUTE_ENABLED;
714 }
715 t.needs = n;
716
717 if ((n & NEEDS_MUTE__MASK) == NEEDS_MUTE_ENABLED) {
718 t.hook = track__nop;
719 } else {
720 if ((n & NEEDS_AUX__MASK) == NEEDS_AUX_ENABLED) {
Glenn Kasten4c340c62012-01-27 12:33:54 -0800721 all16BitsStereoNoResample = false;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700722 }
723 if ((n & NEEDS_RESAMPLE__MASK) == NEEDS_RESAMPLE_ENABLED) {
Glenn Kasten4c340c62012-01-27 12:33:54 -0800724 all16BitsStereoNoResample = false;
725 resampling = true;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700726 t.hook = track__genericResample;
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700727 ALOGV_IF((n & NEEDS_CHANNEL_COUNT__MASK) > NEEDS_CHANNEL_2,
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700728 "Track %d needs downmix + resample", i);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700729 } else {
730 if ((n & NEEDS_CHANNEL_COUNT__MASK) == NEEDS_CHANNEL_1){
731 t.hook = track__16BitsMono;
Glenn Kasten4c340c62012-01-27 12:33:54 -0800732 all16BitsStereoNoResample = false;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700733 }
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700734 if ((n & NEEDS_CHANNEL_COUNT__MASK) >= NEEDS_CHANNEL_2){
Mathias Agopian65ab4712010-07-14 17:59:35 -0700735 t.hook = track__16BitsStereo;
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700736 ALOGV_IF((n & NEEDS_CHANNEL_COUNT__MASK) > NEEDS_CHANNEL_2,
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700737 "Track %d needs downmix", i);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700738 }
739 }
740 }
741 }
742
743 // select the processing hooks
744 state->hook = process__nop;
745 if (countActiveTracks) {
746 if (resampling) {
747 if (!state->outputTemp) {
748 state->outputTemp = new int32_t[MAX_NUM_CHANNELS * state->frameCount];
749 }
750 if (!state->resampleTemp) {
751 state->resampleTemp = new int32_t[MAX_NUM_CHANNELS * state->frameCount];
752 }
753 state->hook = process__genericResampling;
754 } else {
755 if (state->outputTemp) {
756 delete [] state->outputTemp;
Glenn Kastene0feee32011-12-13 11:53:26 -0800757 state->outputTemp = NULL;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700758 }
759 if (state->resampleTemp) {
760 delete [] state->resampleTemp;
Glenn Kastene0feee32011-12-13 11:53:26 -0800761 state->resampleTemp = NULL;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700762 }
763 state->hook = process__genericNoResampling;
764 if (all16BitsStereoNoResample && !volumeRamp) {
765 if (countActiveTracks == 1) {
766 state->hook = process__OneTrack16BitsStereoNoResampling;
767 }
768 }
769 }
770 }
771
Steve Block3856b092011-10-20 11:56:00 +0100772 ALOGV("mixer configuration change: %d activeTracks (%08x) "
Mathias Agopian65ab4712010-07-14 17:59:35 -0700773 "all16BitsStereoNoResample=%d, resampling=%d, volumeRamp=%d",
774 countActiveTracks, state->enabledTracks,
775 all16BitsStereoNoResample, resampling, volumeRamp);
776
John Grossman4ff14ba2012-02-08 16:37:41 -0800777 state->hook(state, pts);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700778
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800779 // Now that the volume ramp has been done, set optimal state and
780 // track hooks for subsequent mixer process
781 if (countActiveTracks) {
Glenn Kasten4c340c62012-01-27 12:33:54 -0800782 bool allMuted = true;
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800783 uint32_t en = state->enabledTracks;
784 while (en) {
785 const int i = 31 - __builtin_clz(en);
786 en &= ~(1<<i);
787 track_t& t = state->tracks[i];
788 if (!t.doesResample() && t.volumeRL == 0)
789 {
790 t.needs |= NEEDS_MUTE_ENABLED;
791 t.hook = track__nop;
792 } else {
Glenn Kasten4c340c62012-01-27 12:33:54 -0800793 allMuted = false;
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800794 }
795 }
796 if (allMuted) {
797 state->hook = process__nop;
798 } else if (all16BitsStereoNoResample) {
799 if (countActiveTracks == 1) {
800 state->hook = process__OneTrack16BitsStereoNoResampling;
801 }
802 }
803 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700804}
805
Mathias Agopian65ab4712010-07-14 17:59:35 -0700806
Glenn Kasten8af901c2012-11-01 11:11:38 -0700807void AudioMixer::track__genericResample(track_t* t, int32_t* out, size_t outFrameCount,
808 int32_t* temp, int32_t* aux)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700809{
810 t->resampler->setSampleRate(t->sampleRate);
811
812 // ramp gain - resample to temp buffer and scale/mix in 2nd step
813 if (aux != NULL) {
814 // always resample with unity gain when sending to auxiliary buffer to be able
815 // to apply send level after resampling
816 // TODO: modify each resampler to support aux channel?
817 t->resampler->setVolume(UNITY_GAIN, UNITY_GAIN);
818 memset(temp, 0, outFrameCount * MAX_NUM_CHANNELS * sizeof(int32_t));
819 t->resampler->resample(temp, outFrameCount, t->bufferProvider);
Glenn Kastenf6b16782011-12-15 09:51:17 -0800820 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1]|t->auxInc)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700821 volumeRampStereo(t, out, outFrameCount, temp, aux);
822 } else {
823 volumeStereo(t, out, outFrameCount, temp, aux);
824 }
825 } else {
Glenn Kastenf6b16782011-12-15 09:51:17 -0800826 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1])) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700827 t->resampler->setVolume(UNITY_GAIN, UNITY_GAIN);
828 memset(temp, 0, outFrameCount * MAX_NUM_CHANNELS * sizeof(int32_t));
829 t->resampler->resample(temp, outFrameCount, t->bufferProvider);
830 volumeRampStereo(t, out, outFrameCount, temp, aux);
831 }
832
833 // constant gain
834 else {
835 t->resampler->setVolume(t->volume[0], t->volume[1]);
836 t->resampler->resample(out, outFrameCount, t->bufferProvider);
837 }
838 }
839}
840
Glenn Kasten8af901c2012-11-01 11:11:38 -0700841void AudioMixer::track__nop(track_t* t, int32_t* out, size_t outFrameCount, int32_t* temp,
842 int32_t* aux)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700843{
844}
845
Glenn Kasten8af901c2012-11-01 11:11:38 -0700846void AudioMixer::volumeRampStereo(track_t* t, int32_t* out, size_t frameCount, int32_t* temp,
847 int32_t* aux)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700848{
849 int32_t vl = t->prevVolume[0];
850 int32_t vr = t->prevVolume[1];
851 const int32_t vlInc = t->volumeInc[0];
852 const int32_t vrInc = t->volumeInc[1];
853
Steve Blockb8a80522011-12-20 16:23:08 +0000854 //ALOGD("[0] %p: inc=%f, v0=%f, v1=%d, final=%f, count=%d",
Mathias Agopian65ab4712010-07-14 17:59:35 -0700855 // t, vlInc/65536.0f, vl/65536.0f, t->volume[0],
856 // (vl + vlInc*frameCount)/65536.0f, frameCount);
857
858 // ramp volume
Glenn Kastenf6b16782011-12-15 09:51:17 -0800859 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700860 int32_t va = t->prevAuxLevel;
861 const int32_t vaInc = t->auxInc;
862 int32_t l;
863 int32_t r;
864
865 do {
866 l = (*temp++ >> 12);
867 r = (*temp++ >> 12);
868 *out++ += (vl >> 16) * l;
869 *out++ += (vr >> 16) * r;
870 *aux++ += (va >> 17) * (l + r);
871 vl += vlInc;
872 vr += vrInc;
873 va += vaInc;
874 } while (--frameCount);
875 t->prevAuxLevel = va;
876 } else {
877 do {
878 *out++ += (vl >> 16) * (*temp++ >> 12);
879 *out++ += (vr >> 16) * (*temp++ >> 12);
880 vl += vlInc;
881 vr += vrInc;
882 } while (--frameCount);
883 }
884 t->prevVolume[0] = vl;
885 t->prevVolume[1] = vr;
Glenn Kastena1117922012-01-26 10:53:32 -0800886 t->adjustVolumeRamp(aux != NULL);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700887}
888
Glenn Kasten8af901c2012-11-01 11:11:38 -0700889void AudioMixer::volumeStereo(track_t* t, int32_t* out, size_t frameCount, int32_t* temp,
890 int32_t* aux)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700891{
892 const int16_t vl = t->volume[0];
893 const int16_t vr = t->volume[1];
894
Glenn Kastenf6b16782011-12-15 09:51:17 -0800895 if (CC_UNLIKELY(aux != NULL)) {
Glenn Kasten3b81aca2012-01-27 15:26:23 -0800896 const int16_t va = t->auxLevel;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700897 do {
898 int16_t l = (int16_t)(*temp++ >> 12);
899 int16_t r = (int16_t)(*temp++ >> 12);
900 out[0] = mulAdd(l, vl, out[0]);
901 int16_t a = (int16_t)(((int32_t)l + r) >> 1);
902 out[1] = mulAdd(r, vr, out[1]);
903 out += 2;
904 aux[0] = mulAdd(a, va, aux[0]);
905 aux++;
906 } while (--frameCount);
907 } else {
908 do {
909 int16_t l = (int16_t)(*temp++ >> 12);
910 int16_t r = (int16_t)(*temp++ >> 12);
911 out[0] = mulAdd(l, vl, out[0]);
912 out[1] = mulAdd(r, vr, out[1]);
913 out += 2;
914 } while (--frameCount);
915 }
916}
917
Glenn Kasten8af901c2012-11-01 11:11:38 -0700918void AudioMixer::track__16BitsStereo(track_t* t, int32_t* out, size_t frameCount, int32_t* temp,
919 int32_t* aux)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700920{
Glenn Kasten54c3b662012-01-06 07:46:30 -0800921 const int16_t *in = static_cast<const int16_t *>(t->in);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700922
Glenn Kastenf6b16782011-12-15 09:51:17 -0800923 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700924 int32_t l;
925 int32_t r;
926 // ramp gain
Glenn Kastenf6b16782011-12-15 09:51:17 -0800927 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1]|t->auxInc)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700928 int32_t vl = t->prevVolume[0];
929 int32_t vr = t->prevVolume[1];
930 int32_t va = t->prevAuxLevel;
931 const int32_t vlInc = t->volumeInc[0];
932 const int32_t vrInc = t->volumeInc[1];
933 const int32_t vaInc = t->auxInc;
Steve Blockb8a80522011-12-20 16:23:08 +0000934 // ALOGD("[1] %p: inc=%f, v0=%f, v1=%d, final=%f, count=%d",
Mathias Agopian65ab4712010-07-14 17:59:35 -0700935 // t, vlInc/65536.0f, vl/65536.0f, t->volume[0],
936 // (vl + vlInc*frameCount)/65536.0f, frameCount);
937
938 do {
939 l = (int32_t)*in++;
940 r = (int32_t)*in++;
941 *out++ += (vl >> 16) * l;
942 *out++ += (vr >> 16) * r;
943 *aux++ += (va >> 17) * (l + r);
944 vl += vlInc;
945 vr += vrInc;
946 va += vaInc;
947 } while (--frameCount);
948
949 t->prevVolume[0] = vl;
950 t->prevVolume[1] = vr;
951 t->prevAuxLevel = va;
952 t->adjustVolumeRamp(true);
953 }
954
955 // constant gain
956 else {
957 const uint32_t vrl = t->volumeRL;
958 const int16_t va = (int16_t)t->auxLevel;
959 do {
Glenn Kasten54c3b662012-01-06 07:46:30 -0800960 uint32_t rl = *reinterpret_cast<const uint32_t *>(in);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700961 int16_t a = (int16_t)(((int32_t)in[0] + in[1]) >> 1);
962 in += 2;
963 out[0] = mulAddRL(1, rl, vrl, out[0]);
964 out[1] = mulAddRL(0, rl, vrl, out[1]);
965 out += 2;
966 aux[0] = mulAdd(a, va, aux[0]);
967 aux++;
968 } while (--frameCount);
969 }
970 } else {
971 // ramp gain
Glenn Kastenf6b16782011-12-15 09:51:17 -0800972 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1])) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700973 int32_t vl = t->prevVolume[0];
974 int32_t vr = t->prevVolume[1];
975 const int32_t vlInc = t->volumeInc[0];
976 const int32_t vrInc = t->volumeInc[1];
977
Steve Blockb8a80522011-12-20 16:23:08 +0000978 // ALOGD("[1] %p: inc=%f, v0=%f, v1=%d, final=%f, count=%d",
Mathias Agopian65ab4712010-07-14 17:59:35 -0700979 // t, vlInc/65536.0f, vl/65536.0f, t->volume[0],
980 // (vl + vlInc*frameCount)/65536.0f, frameCount);
981
982 do {
983 *out++ += (vl >> 16) * (int32_t) *in++;
984 *out++ += (vr >> 16) * (int32_t) *in++;
985 vl += vlInc;
986 vr += vrInc;
987 } while (--frameCount);
988
989 t->prevVolume[0] = vl;
990 t->prevVolume[1] = vr;
991 t->adjustVolumeRamp(false);
992 }
993
994 // constant gain
995 else {
996 const uint32_t vrl = t->volumeRL;
997 do {
Glenn Kasten54c3b662012-01-06 07:46:30 -0800998 uint32_t rl = *reinterpret_cast<const uint32_t *>(in);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700999 in += 2;
1000 out[0] = mulAddRL(1, rl, vrl, out[0]);
1001 out[1] = mulAddRL(0, rl, vrl, out[1]);
1002 out += 2;
1003 } while (--frameCount);
1004 }
1005 }
1006 t->in = in;
1007}
1008
Glenn Kasten8af901c2012-11-01 11:11:38 -07001009void AudioMixer::track__16BitsMono(track_t* t, int32_t* out, size_t frameCount, int32_t* temp,
1010 int32_t* aux)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001011{
Glenn Kasten54c3b662012-01-06 07:46:30 -08001012 const int16_t *in = static_cast<int16_t const *>(t->in);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001013
Glenn Kastenf6b16782011-12-15 09:51:17 -08001014 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001015 // ramp gain
Glenn Kastenf6b16782011-12-15 09:51:17 -08001016 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1]|t->auxInc)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001017 int32_t vl = t->prevVolume[0];
1018 int32_t vr = t->prevVolume[1];
1019 int32_t va = t->prevAuxLevel;
1020 const int32_t vlInc = t->volumeInc[0];
1021 const int32_t vrInc = t->volumeInc[1];
1022 const int32_t vaInc = t->auxInc;
1023
Steve Blockb8a80522011-12-20 16:23:08 +00001024 // ALOGD("[2] %p: inc=%f, v0=%f, v1=%d, final=%f, count=%d",
Mathias Agopian65ab4712010-07-14 17:59:35 -07001025 // t, vlInc/65536.0f, vl/65536.0f, t->volume[0],
1026 // (vl + vlInc*frameCount)/65536.0f, frameCount);
1027
1028 do {
1029 int32_t l = *in++;
1030 *out++ += (vl >> 16) * l;
1031 *out++ += (vr >> 16) * l;
1032 *aux++ += (va >> 16) * l;
1033 vl += vlInc;
1034 vr += vrInc;
1035 va += vaInc;
1036 } while (--frameCount);
1037
1038 t->prevVolume[0] = vl;
1039 t->prevVolume[1] = vr;
1040 t->prevAuxLevel = va;
1041 t->adjustVolumeRamp(true);
1042 }
1043 // constant gain
1044 else {
1045 const int16_t vl = t->volume[0];
1046 const int16_t vr = t->volume[1];
1047 const int16_t va = (int16_t)t->auxLevel;
1048 do {
1049 int16_t l = *in++;
1050 out[0] = mulAdd(l, vl, out[0]);
1051 out[1] = mulAdd(l, vr, out[1]);
1052 out += 2;
1053 aux[0] = mulAdd(l, va, aux[0]);
1054 aux++;
1055 } while (--frameCount);
1056 }
1057 } else {
1058 // ramp gain
Glenn Kastenf6b16782011-12-15 09:51:17 -08001059 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1])) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001060 int32_t vl = t->prevVolume[0];
1061 int32_t vr = t->prevVolume[1];
1062 const int32_t vlInc = t->volumeInc[0];
1063 const int32_t vrInc = t->volumeInc[1];
1064
Steve Blockb8a80522011-12-20 16:23:08 +00001065 // ALOGD("[2] %p: inc=%f, v0=%f, v1=%d, final=%f, count=%d",
Mathias Agopian65ab4712010-07-14 17:59:35 -07001066 // t, vlInc/65536.0f, vl/65536.0f, t->volume[0],
1067 // (vl + vlInc*frameCount)/65536.0f, frameCount);
1068
1069 do {
1070 int32_t l = *in++;
1071 *out++ += (vl >> 16) * l;
1072 *out++ += (vr >> 16) * l;
1073 vl += vlInc;
1074 vr += vrInc;
1075 } while (--frameCount);
1076
1077 t->prevVolume[0] = vl;
1078 t->prevVolume[1] = vr;
1079 t->adjustVolumeRamp(false);
1080 }
1081 // constant gain
1082 else {
1083 const int16_t vl = t->volume[0];
1084 const int16_t vr = t->volume[1];
1085 do {
1086 int16_t l = *in++;
1087 out[0] = mulAdd(l, vl, out[0]);
1088 out[1] = mulAdd(l, vr, out[1]);
1089 out += 2;
1090 } while (--frameCount);
1091 }
1092 }
1093 t->in = in;
1094}
1095
Mathias Agopian65ab4712010-07-14 17:59:35 -07001096// no-op case
John Grossman4ff14ba2012-02-08 16:37:41 -08001097void AudioMixer::process__nop(state_t* state, int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001098{
1099 uint32_t e0 = state->enabledTracks;
1100 size_t bufSize = state->frameCount * sizeof(int16_t) * MAX_NUM_CHANNELS;
1101 while (e0) {
1102 // process by group of tracks with same output buffer to
1103 // avoid multiple memset() on same buffer
1104 uint32_t e1 = e0, e2 = e0;
1105 int i = 31 - __builtin_clz(e1);
1106 track_t& t1 = state->tracks[i];
1107 e2 &= ~(1<<i);
1108 while (e2) {
1109 i = 31 - __builtin_clz(e2);
1110 e2 &= ~(1<<i);
1111 track_t& t2 = state->tracks[i];
Glenn Kastenf6b16782011-12-15 09:51:17 -08001112 if (CC_UNLIKELY(t2.mainBuffer != t1.mainBuffer)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001113 e1 &= ~(1<<i);
1114 }
1115 }
1116 e0 &= ~(e1);
1117
1118 memset(t1.mainBuffer, 0, bufSize);
1119
1120 while (e1) {
1121 i = 31 - __builtin_clz(e1);
1122 e1 &= ~(1<<i);
1123 t1 = state->tracks[i];
1124 size_t outFrames = state->frameCount;
1125 while (outFrames) {
1126 t1.buffer.frameCount = outFrames;
John Grossman4ff14ba2012-02-08 16:37:41 -08001127 int64_t outputPTS = calculateOutputPTS(
1128 t1, pts, state->frameCount - outFrames);
1129 t1.bufferProvider->getNextBuffer(&t1.buffer, outputPTS);
Glenn Kastena0d68332012-01-27 16:47:15 -08001130 if (t1.buffer.raw == NULL) break;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001131 outFrames -= t1.buffer.frameCount;
1132 t1.bufferProvider->releaseBuffer(&t1.buffer);
1133 }
1134 }
1135 }
1136}
1137
1138// generic code without resampling
John Grossman4ff14ba2012-02-08 16:37:41 -08001139void AudioMixer::process__genericNoResampling(state_t* state, int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001140{
1141 int32_t outTemp[BLOCKSIZE * MAX_NUM_CHANNELS] __attribute__((aligned(32)));
1142
1143 // acquire each track's buffer
1144 uint32_t enabledTracks = state->enabledTracks;
Glenn Kasten5881f182013-02-13 14:46:45 -08001145 state->mLog->logf("process_gNR ena=%#x", enabledTracks);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001146 uint32_t e0 = enabledTracks;
1147 while (e0) {
1148 const int i = 31 - __builtin_clz(e0);
1149 e0 &= ~(1<<i);
1150 track_t& t = state->tracks[i];
1151 t.buffer.frameCount = state->frameCount;
Glenn Kastenef5abc32012-12-07 14:13:35 -08001152 int valid = t.bufferProvider->getValid();
1153 if (valid != AudioBufferProvider::kValid) {
Glenn Kasten5881f182013-02-13 14:46:45 -08001154 ALOGE("invalid bufferProvider=%p name=%d fastIndex=%d frameCount=%d valid=%#x enabledTracks=%#x",
1155 t.bufferProvider, i, t.fastIndex, t.buffer.frameCount, valid, enabledTracks);
Glenn Kastenef5abc32012-12-07 14:13:35 -08001156 // expect to crash
1157 }
John Grossman4ff14ba2012-02-08 16:37:41 -08001158 t.bufferProvider->getNextBuffer(&t.buffer, pts);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001159 t.frameCount = t.buffer.frameCount;
1160 t.in = t.buffer.raw;
1161 // t.in == NULL can happen if the track was flushed just after having
1162 // been enabled for mixing.
1163 if (t.in == NULL)
1164 enabledTracks &= ~(1<<i);
1165 }
1166
1167 e0 = enabledTracks;
1168 while (e0) {
1169 // process by group of tracks with same output buffer to
1170 // optimize cache use
1171 uint32_t e1 = e0, e2 = e0;
1172 int j = 31 - __builtin_clz(e1);
1173 track_t& t1 = state->tracks[j];
1174 e2 &= ~(1<<j);
1175 while (e2) {
1176 j = 31 - __builtin_clz(e2);
1177 e2 &= ~(1<<j);
1178 track_t& t2 = state->tracks[j];
Glenn Kastenf6b16782011-12-15 09:51:17 -08001179 if (CC_UNLIKELY(t2.mainBuffer != t1.mainBuffer)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001180 e1 &= ~(1<<j);
1181 }
1182 }
1183 e0 &= ~(e1);
1184 // this assumes output 16 bits stereo, no resampling
1185 int32_t *out = t1.mainBuffer;
1186 size_t numFrames = 0;
1187 do {
1188 memset(outTemp, 0, sizeof(outTemp));
1189 e2 = e1;
1190 while (e2) {
1191 const int i = 31 - __builtin_clz(e2);
1192 e2 &= ~(1<<i);
1193 track_t& t = state->tracks[i];
1194 size_t outFrames = BLOCKSIZE;
1195 int32_t *aux = NULL;
Glenn Kastenf6b16782011-12-15 09:51:17 -08001196 if (CC_UNLIKELY((t.needs & NEEDS_AUX__MASK) == NEEDS_AUX_ENABLED)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001197 aux = t.auxBuffer + numFrames;
1198 }
1199 while (outFrames) {
1200 size_t inFrames = (t.frameCount > outFrames)?outFrames:t.frameCount;
1201 if (inFrames) {
Glenn Kasten8af901c2012-11-01 11:11:38 -07001202 t.hook(&t, outTemp + (BLOCKSIZE-outFrames)*MAX_NUM_CHANNELS, inFrames,
1203 state->resampleTemp, aux);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001204 t.frameCount -= inFrames;
1205 outFrames -= inFrames;
Glenn Kastenf6b16782011-12-15 09:51:17 -08001206 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001207 aux += inFrames;
1208 }
1209 }
1210 if (t.frameCount == 0 && outFrames) {
1211 t.bufferProvider->releaseBuffer(&t.buffer);
Glenn Kasten8af901c2012-11-01 11:11:38 -07001212 t.buffer.frameCount = (state->frameCount - numFrames) -
1213 (BLOCKSIZE - outFrames);
John Grossman4ff14ba2012-02-08 16:37:41 -08001214 int64_t outputPTS = calculateOutputPTS(
1215 t, pts, numFrames + (BLOCKSIZE - outFrames));
1216 t.bufferProvider->getNextBuffer(&t.buffer, outputPTS);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001217 t.in = t.buffer.raw;
1218 if (t.in == NULL) {
1219 enabledTracks &= ~(1<<i);
1220 e1 &= ~(1<<i);
1221 break;
1222 }
1223 t.frameCount = t.buffer.frameCount;
1224 }
1225 }
1226 }
1227 ditherAndClamp(out, outTemp, BLOCKSIZE);
1228 out += BLOCKSIZE;
1229 numFrames += BLOCKSIZE;
1230 } while (numFrames < state->frameCount);
1231 }
1232
1233 // release each track's buffer
1234 e0 = enabledTracks;
1235 while (e0) {
1236 const int i = 31 - __builtin_clz(e0);
1237 e0 &= ~(1<<i);
1238 track_t& t = state->tracks[i];
1239 t.bufferProvider->releaseBuffer(&t.buffer);
1240 }
1241}
1242
1243
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -08001244// generic code with resampling
John Grossman4ff14ba2012-02-08 16:37:41 -08001245void AudioMixer::process__genericResampling(state_t* state, int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001246{
Glenn Kasten54c3b662012-01-06 07:46:30 -08001247 // this const just means that local variable outTemp doesn't change
Mathias Agopian65ab4712010-07-14 17:59:35 -07001248 int32_t* const outTemp = state->outputTemp;
1249 const size_t size = sizeof(int32_t) * MAX_NUM_CHANNELS * state->frameCount;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001250
1251 size_t numFrames = state->frameCount;
1252
1253 uint32_t e0 = state->enabledTracks;
1254 while (e0) {
1255 // process by group of tracks with same output buffer
1256 // to optimize cache use
1257 uint32_t e1 = e0, e2 = e0;
1258 int j = 31 - __builtin_clz(e1);
1259 track_t& t1 = state->tracks[j];
1260 e2 &= ~(1<<j);
1261 while (e2) {
1262 j = 31 - __builtin_clz(e2);
1263 e2 &= ~(1<<j);
1264 track_t& t2 = state->tracks[j];
Glenn Kastenf6b16782011-12-15 09:51:17 -08001265 if (CC_UNLIKELY(t2.mainBuffer != t1.mainBuffer)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001266 e1 &= ~(1<<j);
1267 }
1268 }
1269 e0 &= ~(e1);
1270 int32_t *out = t1.mainBuffer;
Yuuhi Yamaguchi2151d7b2011-02-04 15:24:34 +01001271 memset(outTemp, 0, size);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001272 while (e1) {
1273 const int i = 31 - __builtin_clz(e1);
1274 e1 &= ~(1<<i);
1275 track_t& t = state->tracks[i];
1276 int32_t *aux = NULL;
Glenn Kastenf6b16782011-12-15 09:51:17 -08001277 if (CC_UNLIKELY((t.needs & NEEDS_AUX__MASK) == NEEDS_AUX_ENABLED)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001278 aux = t.auxBuffer;
1279 }
1280
1281 // this is a little goofy, on the resampling case we don't
1282 // acquire/release the buffers because it's done by
1283 // the resampler.
1284 if ((t.needs & NEEDS_RESAMPLE__MASK) == NEEDS_RESAMPLE_ENABLED) {
John Grossman4ff14ba2012-02-08 16:37:41 -08001285 t.resampler->setPTS(pts);
Glenn Kastena1117922012-01-26 10:53:32 -08001286 t.hook(&t, outTemp, numFrames, state->resampleTemp, aux);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001287 } else {
1288
1289 size_t outFrames = 0;
1290
1291 while (outFrames < numFrames) {
1292 t.buffer.frameCount = numFrames - outFrames;
John Grossman4ff14ba2012-02-08 16:37:41 -08001293 int64_t outputPTS = calculateOutputPTS(t, pts, outFrames);
1294 t.bufferProvider->getNextBuffer(&t.buffer, outputPTS);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001295 t.in = t.buffer.raw;
1296 // t.in == NULL can happen if the track was flushed just after having
1297 // been enabled for mixing.
1298 if (t.in == NULL) break;
1299
Glenn Kastenf6b16782011-12-15 09:51:17 -08001300 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001301 aux += outFrames;
1302 }
Glenn Kasten8af901c2012-11-01 11:11:38 -07001303 t.hook(&t, outTemp + outFrames*MAX_NUM_CHANNELS, t.buffer.frameCount,
1304 state->resampleTemp, aux);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001305 outFrames += t.buffer.frameCount;
1306 t.bufferProvider->releaseBuffer(&t.buffer);
1307 }
1308 }
1309 }
1310 ditherAndClamp(out, outTemp, numFrames);
1311 }
1312}
1313
1314// one track, 16 bits stereo without resampling is the most common case
John Grossman4ff14ba2012-02-08 16:37:41 -08001315void AudioMixer::process__OneTrack16BitsStereoNoResampling(state_t* state,
1316 int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001317{
Glenn Kasten99e53b82012-01-19 08:59:58 -08001318 // This method is only called when state->enabledTracks has exactly
1319 // one bit set. The asserts below would verify this, but are commented out
1320 // since the whole point of this method is to optimize performance.
Glenn Kasten5798d4e2012-03-08 12:18:35 -08001321 //ALOG_ASSERT(0 != state->enabledTracks, "no tracks enabled");
Mathias Agopian65ab4712010-07-14 17:59:35 -07001322 const int i = 31 - __builtin_clz(state->enabledTracks);
Glenn Kasten5798d4e2012-03-08 12:18:35 -08001323 //ALOG_ASSERT((1 << i) == state->enabledTracks, "more than 1 track enabled");
Mathias Agopian65ab4712010-07-14 17:59:35 -07001324 const track_t& t = state->tracks[i];
1325
1326 AudioBufferProvider::Buffer& b(t.buffer);
1327
1328 int32_t* out = t.mainBuffer;
1329 size_t numFrames = state->frameCount;
1330
1331 const int16_t vl = t.volume[0];
1332 const int16_t vr = t.volume[1];
1333 const uint32_t vrl = t.volumeRL;
1334 while (numFrames) {
1335 b.frameCount = numFrames;
John Grossman4ff14ba2012-02-08 16:37:41 -08001336 int64_t outputPTS = calculateOutputPTS(t, pts, out - t.mainBuffer);
1337 t.bufferProvider->getNextBuffer(&b, outputPTS);
Glenn Kasten54c3b662012-01-06 07:46:30 -08001338 const int16_t *in = b.i16;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001339
1340 // in == NULL can happen if the track was flushed just after having
1341 // been enabled for mixing.
1342 if (in == NULL || ((unsigned long)in & 3)) {
1343 memset(out, 0, numFrames*MAX_NUM_CHANNELS*sizeof(int16_t));
Glenn Kasten8af901c2012-11-01 11:11:38 -07001344 ALOGE_IF(((unsigned long)in & 3), "process stereo track: input buffer alignment pb: "
1345 "buffer %p track %d, channels %d, needs %08x",
Mathias Agopian65ab4712010-07-14 17:59:35 -07001346 in, i, t.channelCount, t.needs);
1347 return;
1348 }
1349 size_t outFrames = b.frameCount;
1350
Glenn Kastenf6b16782011-12-15 09:51:17 -08001351 if (CC_UNLIKELY(uint32_t(vl) > UNITY_GAIN || uint32_t(vr) > UNITY_GAIN)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001352 // volume is boosted, so we might need to clamp even though
1353 // we process only one track.
1354 do {
Glenn Kasten54c3b662012-01-06 07:46:30 -08001355 uint32_t rl = *reinterpret_cast<const uint32_t *>(in);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001356 in += 2;
1357 int32_t l = mulRL(1, rl, vrl) >> 12;
1358 int32_t r = mulRL(0, rl, vrl) >> 12;
1359 // clamping...
1360 l = clamp16(l);
1361 r = clamp16(r);
1362 *out++ = (r<<16) | (l & 0xFFFF);
1363 } while (--outFrames);
1364 } else {
1365 do {
Glenn Kasten54c3b662012-01-06 07:46:30 -08001366 uint32_t rl = *reinterpret_cast<const uint32_t *>(in);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001367 in += 2;
1368 int32_t l = mulRL(1, rl, vrl) >> 12;
1369 int32_t r = mulRL(0, rl, vrl) >> 12;
1370 *out++ = (r<<16) | (l & 0xFFFF);
1371 } while (--outFrames);
1372 }
1373 numFrames -= b.frameCount;
1374 t.bufferProvider->releaseBuffer(&b);
1375 }
1376}
1377
Glenn Kasten81a028f2011-12-15 09:53:12 -08001378#if 0
Mathias Agopian65ab4712010-07-14 17:59:35 -07001379// 2 tracks is also a common case
1380// NEVER used in current implementation of process__validate()
1381// only use if the 2 tracks have the same output buffer
John Grossman4ff14ba2012-02-08 16:37:41 -08001382void AudioMixer::process__TwoTracks16BitsStereoNoResampling(state_t* state,
1383 int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001384{
1385 int i;
1386 uint32_t en = state->enabledTracks;
1387
1388 i = 31 - __builtin_clz(en);
1389 const track_t& t0 = state->tracks[i];
1390 AudioBufferProvider::Buffer& b0(t0.buffer);
1391
1392 en &= ~(1<<i);
1393 i = 31 - __builtin_clz(en);
1394 const track_t& t1 = state->tracks[i];
1395 AudioBufferProvider::Buffer& b1(t1.buffer);
1396
Glenn Kasten54c3b662012-01-06 07:46:30 -08001397 const int16_t *in0;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001398 const int16_t vl0 = t0.volume[0];
1399 const int16_t vr0 = t0.volume[1];
1400 size_t frameCount0 = 0;
1401
Glenn Kasten54c3b662012-01-06 07:46:30 -08001402 const int16_t *in1;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001403 const int16_t vl1 = t1.volume[0];
1404 const int16_t vr1 = t1.volume[1];
1405 size_t frameCount1 = 0;
1406
1407 //FIXME: only works if two tracks use same buffer
1408 int32_t* out = t0.mainBuffer;
1409 size_t numFrames = state->frameCount;
Glenn Kasten54c3b662012-01-06 07:46:30 -08001410 const int16_t *buff = NULL;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001411
1412
1413 while (numFrames) {
1414
1415 if (frameCount0 == 0) {
1416 b0.frameCount = numFrames;
John Grossman4ff14ba2012-02-08 16:37:41 -08001417 int64_t outputPTS = calculateOutputPTS(t0, pts,
1418 out - t0.mainBuffer);
1419 t0.bufferProvider->getNextBuffer(&b0, outputPTS);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001420 if (b0.i16 == NULL) {
1421 if (buff == NULL) {
1422 buff = new int16_t[MAX_NUM_CHANNELS * state->frameCount];
1423 }
1424 in0 = buff;
1425 b0.frameCount = numFrames;
1426 } else {
1427 in0 = b0.i16;
1428 }
1429 frameCount0 = b0.frameCount;
1430 }
1431 if (frameCount1 == 0) {
1432 b1.frameCount = numFrames;
John Grossman4ff14ba2012-02-08 16:37:41 -08001433 int64_t outputPTS = calculateOutputPTS(t1, pts,
1434 out - t0.mainBuffer);
1435 t1.bufferProvider->getNextBuffer(&b1, outputPTS);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001436 if (b1.i16 == NULL) {
1437 if (buff == NULL) {
1438 buff = new int16_t[MAX_NUM_CHANNELS * state->frameCount];
1439 }
1440 in1 = buff;
1441 b1.frameCount = numFrames;
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -08001442 } else {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001443 in1 = b1.i16;
1444 }
1445 frameCount1 = b1.frameCount;
1446 }
1447
1448 size_t outFrames = frameCount0 < frameCount1?frameCount0:frameCount1;
1449
1450 numFrames -= outFrames;
1451 frameCount0 -= outFrames;
1452 frameCount1 -= outFrames;
1453
1454 do {
1455 int32_t l0 = *in0++;
1456 int32_t r0 = *in0++;
1457 l0 = mul(l0, vl0);
1458 r0 = mul(r0, vr0);
1459 int32_t l = *in1++;
1460 int32_t r = *in1++;
1461 l = mulAdd(l, vl1, l0) >> 12;
1462 r = mulAdd(r, vr1, r0) >> 12;
1463 // clamping...
1464 l = clamp16(l);
1465 r = clamp16(r);
1466 *out++ = (r<<16) | (l & 0xFFFF);
1467 } while (--outFrames);
1468
1469 if (frameCount0 == 0) {
1470 t0.bufferProvider->releaseBuffer(&b0);
1471 }
1472 if (frameCount1 == 0) {
1473 t1.bufferProvider->releaseBuffer(&b1);
1474 }
1475 }
1476
Glenn Kastene9dd0172012-01-27 18:08:45 -08001477 delete [] buff;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001478}
Glenn Kasten81a028f2011-12-15 09:53:12 -08001479#endif
Mathias Agopian65ab4712010-07-14 17:59:35 -07001480
John Grossman4ff14ba2012-02-08 16:37:41 -08001481int64_t AudioMixer::calculateOutputPTS(const track_t& t, int64_t basePTS,
1482 int outputFrameIndex)
1483{
1484 if (AudioBufferProvider::kInvalidPTS == basePTS)
1485 return AudioBufferProvider::kInvalidPTS;
1486
Glenn Kasten52008f82012-03-18 09:34:41 -07001487 return basePTS + ((outputFrameIndex * sLocalTimeFreq) / t.sampleRate);
1488}
1489
1490/*static*/ uint64_t AudioMixer::sLocalTimeFreq;
1491/*static*/ pthread_once_t AudioMixer::sOnceControl = PTHREAD_ONCE_INIT;
1492
1493/*static*/ void AudioMixer::sInitRoutine()
1494{
1495 LocalClock lc;
1496 sLocalTimeFreq = lc.getLocalFreq();
John Grossman4ff14ba2012-02-08 16:37:41 -08001497}
1498
Mathias Agopian65ab4712010-07-14 17:59:35 -07001499// ----------------------------------------------------------------------------
1500}; // namespace android