blob: f92421eed98f1e843cd2c8c0d37aaaa2f91554e5 [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"
Glenn Kasten7f5d3352013-02-15 23:55:04 +000019//#define LOG_NDEBUG 0
Mathias Agopian65ab4712010-07-14 17:59:35 -070020
Glenn Kasten153b9fe2013-07-15 11:23:36 -070021#include "Configuration.h"
Mathias Agopian65ab4712010-07-14 17:59:35 -070022#include <stdint.h>
23#include <string.h>
24#include <stdlib.h>
25#include <sys/types.h>
26
27#include <utils/Errors.h>
28#include <utils/Log.h>
29
Jean-Michel Trivi0d255b22011-05-24 15:53:33 -070030#include <cutils/bitops.h>
Glenn Kastenf6b16782011-12-15 09:51:17 -080031#include <cutils/compiler.h>
Glenn Kasten5798d4e2012-03-08 12:18:35 -080032#include <utils/Debug.h>
Jean-Michel Trivi0d255b22011-05-24 15:53:33 -070033
34#include <system/audio.h>
35
Glenn Kasten3b21c502011-12-15 09:52:39 -080036#include <audio_utils/primitives.h>
John Grossman4ff14ba2012-02-08 16:37:41 -080037#include <common_time/local_clock.h>
38#include <common_time/cc_helper.h>
Glenn Kasten3b21c502011-12-15 09:52:39 -080039
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -070040#include <media/EffectsFactoryApi.h>
41
Mathias Agopian65ab4712010-07-14 17:59:35 -070042#include "AudioMixer.h"
43
44namespace android {
Mathias Agopian65ab4712010-07-14 17:59:35 -070045
46// ----------------------------------------------------------------------------
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -070047AudioMixer::DownmixerBufferProvider::DownmixerBufferProvider() : AudioBufferProvider(),
48 mTrackBufferProvider(NULL), mDownmixHandle(NULL)
49{
50}
51
52AudioMixer::DownmixerBufferProvider::~DownmixerBufferProvider()
53{
54 ALOGV("AudioMixer deleting DownmixerBufferProvider (%p)", this);
55 EffectRelease(mDownmixHandle);
56}
57
58status_t AudioMixer::DownmixerBufferProvider::getNextBuffer(AudioBufferProvider::Buffer *pBuffer,
59 int64_t pts) {
60 //ALOGV("DownmixerBufferProvider::getNextBuffer()");
61 if (this->mTrackBufferProvider != NULL) {
62 status_t res = mTrackBufferProvider->getNextBuffer(pBuffer, pts);
63 if (res == OK) {
64 mDownmixConfig.inputCfg.buffer.frameCount = pBuffer->frameCount;
65 mDownmixConfig.inputCfg.buffer.raw = pBuffer->raw;
66 mDownmixConfig.outputCfg.buffer.frameCount = pBuffer->frameCount;
67 mDownmixConfig.outputCfg.buffer.raw = mDownmixConfig.inputCfg.buffer.raw;
68 // in-place so overwrite the buffer contents, has been set in prepareTrackForDownmix()
69 //mDownmixConfig.outputCfg.accessMode = EFFECT_BUFFER_ACCESS_WRITE;
70
71 res = (*mDownmixHandle)->process(mDownmixHandle,
72 &mDownmixConfig.inputCfg.buffer, &mDownmixConfig.outputCfg.buffer);
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -070073 //ALOGV("getNextBuffer is downmixing");
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -070074 }
75 return res;
76 } else {
77 ALOGE("DownmixerBufferProvider::getNextBuffer() error: NULL track buffer provider");
78 return NO_INIT;
79 }
80}
81
82void AudioMixer::DownmixerBufferProvider::releaseBuffer(AudioBufferProvider::Buffer *pBuffer) {
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -070083 //ALOGV("DownmixerBufferProvider::releaseBuffer()");
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -070084 if (this->mTrackBufferProvider != NULL) {
85 mTrackBufferProvider->releaseBuffer(pBuffer);
86 } else {
87 ALOGE("DownmixerBufferProvider::releaseBuffer() error: NULL track buffer provider");
88 }
89}
90
91
92// ----------------------------------------------------------------------------
93bool AudioMixer::isMultichannelCapable = false;
94
95effect_descriptor_t AudioMixer::dwnmFxDesc;
Mathias Agopian65ab4712010-07-14 17:59:35 -070096
Paul Lind3c0a0e82012-08-01 18:49:49 -070097// Ensure mConfiguredNames bitmask is initialized properly on all architectures.
98// The value of 1 << x is undefined in C when x >= 32.
99
Glenn Kasten5c94b6c2012-03-20 17:01:29 -0700100AudioMixer::AudioMixer(size_t frameCount, uint32_t sampleRate, uint32_t maxNumTracks)
Paul Lind3c0a0e82012-08-01 18:49:49 -0700101 : mTrackNames(0), mConfiguredNames((maxNumTracks >= 32 ? 0 : 1 << maxNumTracks) - 1),
Glenn Kasten7f5d3352013-02-15 23:55:04 +0000102 mSampleRate(sampleRate)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700103{
Glenn Kasten788040c2011-05-05 08:19:00 -0700104 // AudioMixer is not yet capable of multi-channel beyond stereo
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800105 COMPILE_TIME_ASSERT_FUNCTION_SCOPE(2 == MAX_NUM_CHANNELS);
Jean-Michel Triviacb86cc2012-04-16 12:43:57 -0700106
Glenn Kasten5c94b6c2012-03-20 17:01:29 -0700107 ALOG_ASSERT(maxNumTracks <= MAX_NUM_TRACKS, "maxNumTracks %u > MAX_NUM_TRACKS %u",
108 maxNumTracks, MAX_NUM_TRACKS);
109
Glenn Kasten599fabc2012-03-08 12:33:37 -0800110 // AudioMixer is not yet capable of more than 32 active track inputs
111 ALOG_ASSERT(32 >= MAX_NUM_TRACKS, "bad MAX_NUM_TRACKS %d", MAX_NUM_TRACKS);
112
113 // AudioMixer is not yet capable of multi-channel output beyond stereo
114 ALOG_ASSERT(2 == MAX_NUM_CHANNELS, "bad MAX_NUM_CHANNELS %d", MAX_NUM_CHANNELS);
115
John Grossman4ff14ba2012-02-08 16:37:41 -0800116 LocalClock lc;
117
Glenn Kasten52008f82012-03-18 09:34:41 -0700118 pthread_once(&sOnceControl, &sInitRoutine);
119
Mathias Agopian65ab4712010-07-14 17:59:35 -0700120 mState.enabledTracks= 0;
121 mState.needsChanged = 0;
122 mState.frameCount = frameCount;
Glenn Kasten84afa3b2012-01-25 15:28:08 -0800123 mState.hook = process__nop;
Glenn Kastene0feee32011-12-13 11:53:26 -0800124 mState.outputTemp = NULL;
125 mState.resampleTemp = NULL;
Glenn Kastenab7d72f2013-02-27 09:05:28 -0800126 mState.mLog = &mDummyLog;
Glenn Kasten84afa3b2012-01-25 15:28:08 -0800127 // mState.reserved
Glenn Kasten17a736c2012-02-14 08:52:15 -0800128
129 // FIXME Most of the following initialization is probably redundant since
130 // tracks[i] should only be referenced if (mTrackNames & (1 << i)) != 0
131 // and mTrackNames is initially 0. However, leave it here until that's verified.
Mathias Agopian65ab4712010-07-14 17:59:35 -0700132 track_t* t = mState.tracks;
Glenn Kastenbf71f1e2011-12-13 11:52:35 -0800133 for (unsigned i=0 ; i < MAX_NUM_TRACKS ; i++) {
Eric Laurenta5e82142012-04-16 13:47:17 -0700134 t->resampler = NULL;
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700135 t->downmixerBufferProvider = NULL;
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 Kastenab7d72f2013-02-27 09:05:28 -0800174void AudioMixer::setLog(NBLog::Writer *log)
175{
176 mState.mLog = log;
177}
178
Jean-Michel Trivid06e1322012-09-12 15:47:07 -0700179int AudioMixer::getTrackName(audio_channel_mask_t channelMask, int sessionId)
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800180{
Glenn Kasten5c94b6c2012-03-20 17:01:29 -0700181 uint32_t names = (~mTrackNames) & mConfiguredNames;
Glenn Kasten98dd5422011-12-15 14:38:29 -0800182 if (names != 0) {
183 int n = __builtin_ctz(names);
Steve Block3856b092011-10-20 11:56:00 +0100184 ALOGV("add track (%d)", n);
Glenn Kasten98dd5422011-12-15 14:38:29 -0800185 mTrackNames |= 1 << n;
Glenn Kastendeeb1282012-03-25 11:59:31 -0700186 // assume default parameters for the track, except where noted below
187 track_t* t = &mState.tracks[n];
188 t->needs = 0;
189 t->volume[0] = UNITY_GAIN;
190 t->volume[1] = UNITY_GAIN;
191 // no initialization needed
192 // t->prevVolume[0]
193 // t->prevVolume[1]
194 t->volumeInc[0] = 0;
195 t->volumeInc[1] = 0;
196 t->auxLevel = 0;
197 t->auxInc = 0;
198 // no initialization needed
199 // t->prevAuxLevel
200 // t->frameCount
201 t->channelCount = 2;
202 t->enabled = false;
203 t->format = 16;
204 t->channelMask = AUDIO_CHANNEL_OUT_STEREO;
Jean-Michel Trivid06e1322012-09-12 15:47:07 -0700205 t->sessionId = sessionId;
Glenn Kastendeeb1282012-03-25 11:59:31 -0700206 // setBufferProvider(name, AudioBufferProvider *) is required before enable(name)
207 t->bufferProvider = NULL;
208 t->buffer.raw = NULL;
209 // no initialization needed
210 // t->buffer.frameCount
211 t->hook = NULL;
212 t->in = NULL;
213 t->resampler = NULL;
214 t->sampleRate = mSampleRate;
215 // setParameter(name, TRACK, MAIN_BUFFER, mixBuffer) is required before enable(name)
216 t->mainBuffer = NULL;
217 t->auxBuffer = NULL;
Glenn Kasten52008f82012-03-18 09:34:41 -0700218 t->downmixerBufferProvider = NULL;
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700219
220 status_t status = initTrackDownmix(&mState.tracks[n], n, channelMask);
221 if (status == OK) {
222 return TRACK0 + n;
223 }
224 ALOGE("AudioMixer::getTrackName(0x%x) failed, error preparing track for downmix",
225 channelMask);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700226 }
227 return -1;
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800228}
Mathias Agopian65ab4712010-07-14 17:59:35 -0700229
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800230void AudioMixer::invalidateState(uint32_t mask)
231{
Mathias Agopian65ab4712010-07-14 17:59:35 -0700232 if (mask) {
233 mState.needsChanged |= mask;
234 mState.hook = process__validate;
235 }
236 }
237
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700238status_t AudioMixer::initTrackDownmix(track_t* pTrack, int trackNum, audio_channel_mask_t mask)
239{
240 uint32_t channelCount = popcount(mask);
241 ALOG_ASSERT((channelCount <= MAX_NUM_CHANNELS_TO_DOWNMIX) && channelCount);
242 status_t status = OK;
243 if (channelCount > MAX_NUM_CHANNELS) {
244 pTrack->channelMask = mask;
245 pTrack->channelCount = channelCount;
246 ALOGV("initTrackDownmix(track=%d, mask=0x%x) calls prepareTrackForDownmix()",
247 trackNum, mask);
248 status = prepareTrackForDownmix(pTrack, trackNum);
249 } else {
250 unprepareTrackForDownmix(pTrack, trackNum);
251 }
252 return status;
253}
254
255void AudioMixer::unprepareTrackForDownmix(track_t* pTrack, int trackName) {
256 ALOGV("AudioMixer::unprepareTrackForDownmix(%d)", trackName);
257
258 if (pTrack->downmixerBufferProvider != NULL) {
259 // this track had previously been configured with a downmixer, delete it
260 ALOGV(" deleting old downmixer");
261 pTrack->bufferProvider = pTrack->downmixerBufferProvider->mTrackBufferProvider;
262 delete pTrack->downmixerBufferProvider;
263 pTrack->downmixerBufferProvider = NULL;
264 } else {
265 ALOGV(" nothing to do, no downmixer to delete");
266 }
267}
268
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700269status_t AudioMixer::prepareTrackForDownmix(track_t* pTrack, int trackName)
270{
271 ALOGV("AudioMixer::prepareTrackForDownmix(%d) with mask 0x%x", trackName, pTrack->channelMask);
272
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700273 // discard the previous downmixer if there was one
274 unprepareTrackForDownmix(pTrack, trackName);
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700275
276 DownmixerBufferProvider* pDbp = new DownmixerBufferProvider();
277 int32_t status;
278
279 if (!isMultichannelCapable) {
280 ALOGE("prepareTrackForDownmix(%d) fails: mixer doesn't support multichannel content",
281 trackName);
282 goto noDownmixForActiveTrack;
283 }
284
285 if (EffectCreate(&dwnmFxDesc.uuid,
Jean-Michel Trivid06e1322012-09-12 15:47:07 -0700286 pTrack->sessionId /*sessionId*/, -2 /*ioId not relevant here, using random value*/,
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700287 &pDbp->mDownmixHandle/*pHandle*/) != 0) {
288 ALOGE("prepareTrackForDownmix(%d) fails: error creating downmixer effect", trackName);
289 goto noDownmixForActiveTrack;
290 }
291
292 // channel input configuration will be overridden per-track
293 pDbp->mDownmixConfig.inputCfg.channels = pTrack->channelMask;
294 pDbp->mDownmixConfig.outputCfg.channels = AUDIO_CHANNEL_OUT_STEREO;
295 pDbp->mDownmixConfig.inputCfg.format = AUDIO_FORMAT_PCM_16_BIT;
296 pDbp->mDownmixConfig.outputCfg.format = AUDIO_FORMAT_PCM_16_BIT;
297 pDbp->mDownmixConfig.inputCfg.samplingRate = pTrack->sampleRate;
298 pDbp->mDownmixConfig.outputCfg.samplingRate = pTrack->sampleRate;
299 pDbp->mDownmixConfig.inputCfg.accessMode = EFFECT_BUFFER_ACCESS_READ;
300 pDbp->mDownmixConfig.outputCfg.accessMode = EFFECT_BUFFER_ACCESS_WRITE;
301 // input and output buffer provider, and frame count will not be used as the downmix effect
302 // process() function is called directly (see DownmixerBufferProvider::getNextBuffer())
303 pDbp->mDownmixConfig.inputCfg.mask = EFFECT_CONFIG_SMP_RATE | EFFECT_CONFIG_CHANNELS |
304 EFFECT_CONFIG_FORMAT | EFFECT_CONFIG_ACC_MODE;
305 pDbp->mDownmixConfig.outputCfg.mask = pDbp->mDownmixConfig.inputCfg.mask;
306
307 {// scope for local variables that are not used in goto label "noDownmixForActiveTrack"
308 int cmdStatus;
309 uint32_t replySize = sizeof(int);
310
311 // Configure and enable downmixer
312 status = (*pDbp->mDownmixHandle)->command(pDbp->mDownmixHandle,
313 EFFECT_CMD_SET_CONFIG /*cmdCode*/, sizeof(effect_config_t) /*cmdSize*/,
314 &pDbp->mDownmixConfig /*pCmdData*/,
315 &replySize /*replySize*/, &cmdStatus /*pReplyData*/);
316 if ((status != 0) || (cmdStatus != 0)) {
317 ALOGE("error %d while configuring downmixer for track %d", status, trackName);
318 goto noDownmixForActiveTrack;
319 }
320 replySize = sizeof(int);
321 status = (*pDbp->mDownmixHandle)->command(pDbp->mDownmixHandle,
322 EFFECT_CMD_ENABLE /*cmdCode*/, 0 /*cmdSize*/, NULL /*pCmdData*/,
323 &replySize /*replySize*/, &cmdStatus /*pReplyData*/);
324 if ((status != 0) || (cmdStatus != 0)) {
325 ALOGE("error %d while enabling downmixer for track %d", status, trackName);
326 goto noDownmixForActiveTrack;
327 }
328
329 // Set downmix type
330 // parameter size rounded for padding on 32bit boundary
331 const int psizePadded = ((sizeof(downmix_params_t) - 1)/sizeof(int) + 1) * sizeof(int);
332 const int downmixParamSize =
333 sizeof(effect_param_t) + psizePadded + sizeof(downmix_type_t);
334 effect_param_t * const param = (effect_param_t *) malloc(downmixParamSize);
335 param->psize = sizeof(downmix_params_t);
336 const downmix_params_t downmixParam = DOWNMIX_PARAM_TYPE;
337 memcpy(param->data, &downmixParam, param->psize);
338 const downmix_type_t downmixType = DOWNMIX_TYPE_FOLD;
339 param->vsize = sizeof(downmix_type_t);
340 memcpy(param->data + psizePadded, &downmixType, param->vsize);
341
342 status = (*pDbp->mDownmixHandle)->command(pDbp->mDownmixHandle,
343 EFFECT_CMD_SET_PARAM /* cmdCode */, downmixParamSize/* cmdSize */,
344 param /*pCmndData*/, &replySize /*replySize*/, &cmdStatus /*pReplyData*/);
345
346 free(param);
347
348 if ((status != 0) || (cmdStatus != 0)) {
349 ALOGE("error %d while setting downmix type for track %d", status, trackName);
350 goto noDownmixForActiveTrack;
351 } else {
352 ALOGV("downmix type set to %d for track %d", (int) downmixType, trackName);
353 }
354 }// end of scope for local variables that are not used in goto label "noDownmixForActiveTrack"
355
356 // initialization successful:
357 // - keep track of the real buffer provider in case it was set before
358 pDbp->mTrackBufferProvider = pTrack->bufferProvider;
359 // - we'll use the downmix effect integrated inside this
360 // track's buffer provider, and we'll use it as the track's buffer provider
361 pTrack->downmixerBufferProvider = pDbp;
362 pTrack->bufferProvider = pDbp;
363
364 return NO_ERROR;
365
366noDownmixForActiveTrack:
367 delete pDbp;
368 pTrack->downmixerBufferProvider = NULL;
369 return NO_INIT;
370}
371
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800372void AudioMixer::deleteTrackName(int name)
373{
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700374 ALOGV("AudioMixer::deleteTrackName(%d)", name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700375 name -= TRACK0;
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800376 ALOG_ASSERT(uint32_t(name) < MAX_NUM_TRACKS, "bad track name %d", name);
Glenn Kasten237a6242011-12-15 15:32:27 -0800377 ALOGV("deleteTrackName(%d)", name);
378 track_t& track(mState.tracks[ name ]);
Glenn Kasten4c340c62012-01-27 12:33:54 -0800379 if (track.enabled) {
380 track.enabled = false;
Glenn Kasten237a6242011-12-15 15:32:27 -0800381 invalidateState(1<<name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700382 }
Glenn Kasten4e2293f2012-04-12 09:39:07 -0700383 // delete the resampler
384 delete track.resampler;
385 track.resampler = NULL;
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700386 // delete the downmixer
387 unprepareTrackForDownmix(&mState.tracks[name], name);
388
Glenn Kasten237a6242011-12-15 15:32:27 -0800389 mTrackNames &= ~(1<<name);
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800390}
Mathias Agopian65ab4712010-07-14 17:59:35 -0700391
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800392void AudioMixer::enable(int name)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700393{
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800394 name -= TRACK0;
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800395 ALOG_ASSERT(uint32_t(name) < MAX_NUM_TRACKS, "bad track name %d", name);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800396 track_t& track = mState.tracks[name];
397
Glenn Kasten4c340c62012-01-27 12:33:54 -0800398 if (!track.enabled) {
399 track.enabled = true;
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800400 ALOGV("enable(%d)", name);
401 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700402 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700403}
404
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800405void AudioMixer::disable(int name)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700406{
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800407 name -= TRACK0;
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800408 ALOG_ASSERT(uint32_t(name) < MAX_NUM_TRACKS, "bad track name %d", name);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800409 track_t& track = mState.tracks[name];
410
Glenn Kasten4c340c62012-01-27 12:33:54 -0800411 if (track.enabled) {
412 track.enabled = false;
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800413 ALOGV("disable(%d)", name);
414 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700415 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700416}
417
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800418void AudioMixer::setParameter(int name, int target, int param, void *value)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700419{
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800420 name -= TRACK0;
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800421 ALOG_ASSERT(uint32_t(name) < MAX_NUM_TRACKS, "bad track name %d", name);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800422 track_t& track = mState.tracks[name];
Mathias Agopian65ab4712010-07-14 17:59:35 -0700423
Kévin PETIT377b2ec2014-02-03 12:35:36 +0000424 int valueInt = static_cast<int>(reinterpret_cast<uintptr_t>(value));
425 int32_t *valueBuf = reinterpret_cast<int32_t*>(value);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700426
427 switch (target) {
Glenn Kasten788040c2011-05-05 08:19:00 -0700428
Mathias Agopian65ab4712010-07-14 17:59:35 -0700429 case TRACK:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800430 switch (param) {
Glenn Kasten788040c2011-05-05 08:19:00 -0700431 case CHANNEL_MASK: {
Kévin PETIT377b2ec2014-02-03 12:35:36 +0000432 audio_channel_mask_t mask =
433 static_cast<audio_channel_mask_t>(reinterpret_cast<uintptr_t>(value));
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800434 if (track.channelMask != mask) {
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800435 uint32_t channelCount = popcount(mask);
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700436 ALOG_ASSERT((channelCount <= MAX_NUM_CHANNELS_TO_DOWNMIX) && channelCount);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800437 track.channelMask = mask;
438 track.channelCount = channelCount;
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700439 // the mask has changed, does this track need a downmixer?
440 initTrackDownmix(&mState.tracks[name], name, mask);
Glenn Kasten788040c2011-05-05 08:19:00 -0700441 ALOGV("setParameter(TRACK, CHANNEL_MASK, %x)", mask);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800442 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700443 }
Glenn Kasten788040c2011-05-05 08:19:00 -0700444 } break;
445 case MAIN_BUFFER:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800446 if (track.mainBuffer != valueBuf) {
447 track.mainBuffer = valueBuf;
Steve Block3856b092011-10-20 11:56:00 +0100448 ALOGV("setParameter(TRACK, MAIN_BUFFER, %p)", valueBuf);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800449 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700450 }
Glenn Kasten788040c2011-05-05 08:19:00 -0700451 break;
452 case AUX_BUFFER:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800453 if (track.auxBuffer != valueBuf) {
454 track.auxBuffer = valueBuf;
Steve Block3856b092011-10-20 11:56:00 +0100455 ALOGV("setParameter(TRACK, AUX_BUFFER, %p)", valueBuf);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800456 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700457 }
Glenn Kasten788040c2011-05-05 08:19:00 -0700458 break;
Glenn Kastendeeb1282012-03-25 11:59:31 -0700459 case FORMAT:
460 ALOG_ASSERT(valueInt == AUDIO_FORMAT_PCM_16_BIT);
461 break;
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700462 // FIXME do we want to support setting the downmix type from AudioFlinger?
463 // for a specific track? or per mixer?
464 /* case DOWNMIX_TYPE:
465 break */
Glenn Kasten788040c2011-05-05 08:19:00 -0700466 default:
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800467 LOG_FATAL("bad param");
Mathias Agopian65ab4712010-07-14 17:59:35 -0700468 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700469 break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700470
Mathias Agopian65ab4712010-07-14 17:59:35 -0700471 case RESAMPLE:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800472 switch (param) {
473 case SAMPLE_RATE:
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800474 ALOG_ASSERT(valueInt > 0, "bad sample rate %d", valueInt);
Glenn Kasten788040c2011-05-05 08:19:00 -0700475 if (track.setResampler(uint32_t(valueInt), mSampleRate)) {
476 ALOGV("setParameter(RESAMPLE, SAMPLE_RATE, %u)",
477 uint32_t(valueInt));
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800478 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700479 }
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800480 break;
481 case RESET:
Eric Laurent243f5f92011-02-28 16:52:51 -0800482 track.resetResampler();
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800483 invalidateState(1 << name);
484 break;
Glenn Kasten4e2293f2012-04-12 09:39:07 -0700485 case REMOVE:
486 delete track.resampler;
487 track.resampler = NULL;
488 track.sampleRate = mSampleRate;
489 invalidateState(1 << name);
490 break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700491 default:
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800492 LOG_FATAL("bad param");
Eric Laurent243f5f92011-02-28 16:52:51 -0800493 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700494 break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700495
Mathias Agopian65ab4712010-07-14 17:59:35 -0700496 case RAMP_VOLUME:
497 case VOLUME:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800498 switch (param) {
Glenn Kasten788040c2011-05-05 08:19:00 -0700499 case VOLUME0:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800500 case VOLUME1:
501 if (track.volume[param-VOLUME0] != valueInt) {
Steve Block3856b092011-10-20 11:56:00 +0100502 ALOGV("setParameter(VOLUME, VOLUME0/1: %04x)", valueInt);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800503 track.prevVolume[param-VOLUME0] = track.volume[param-VOLUME0] << 16;
504 track.volume[param-VOLUME0] = valueInt;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700505 if (target == VOLUME) {
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800506 track.prevVolume[param-VOLUME0] = valueInt << 16;
507 track.volumeInc[param-VOLUME0] = 0;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700508 } else {
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800509 int32_t d = (valueInt<<16) - track.prevVolume[param-VOLUME0];
Mathias Agopian65ab4712010-07-14 17:59:35 -0700510 int32_t volInc = d / int32_t(mState.frameCount);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800511 track.volumeInc[param-VOLUME0] = volInc;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700512 if (volInc == 0) {
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800513 track.prevVolume[param-VOLUME0] = valueInt << 16;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700514 }
515 }
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800516 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700517 }
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800518 break;
519 case AUXLEVEL:
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800520 //ALOG_ASSERT(0 <= valueInt && valueInt <= MAX_GAIN_INT, "bad aux level %d", valueInt);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700521 if (track.auxLevel != valueInt) {
Steve Block3856b092011-10-20 11:56:00 +0100522 ALOGV("setParameter(VOLUME, AUXLEVEL: %04x)", valueInt);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700523 track.prevAuxLevel = track.auxLevel << 16;
524 track.auxLevel = valueInt;
525 if (target == VOLUME) {
526 track.prevAuxLevel = valueInt << 16;
527 track.auxInc = 0;
528 } else {
529 int32_t d = (valueInt<<16) - track.prevAuxLevel;
530 int32_t volInc = d / int32_t(mState.frameCount);
531 track.auxInc = volInc;
532 if (volInc == 0) {
533 track.prevAuxLevel = valueInt << 16;
534 }
535 }
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800536 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700537 }
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800538 break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700539 default:
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800540 LOG_FATAL("bad param");
Mathias Agopian65ab4712010-07-14 17:59:35 -0700541 }
542 break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700543
544 default:
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800545 LOG_FATAL("bad target");
Mathias Agopian65ab4712010-07-14 17:59:35 -0700546 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700547}
548
549bool AudioMixer::track_t::setResampler(uint32_t value, uint32_t devSampleRate)
550{
Glenn Kasten4e2293f2012-04-12 09:39:07 -0700551 if (value != devSampleRate || resampler != NULL) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700552 if (sampleRate != value) {
553 sampleRate = value;
Glenn Kastene0feee32011-12-13 11:53:26 -0800554 if (resampler == NULL) {
Glenn Kastenac602052012-10-01 14:04:31 -0700555 ALOGV("creating resampler from track %d Hz to device %d Hz", value, devSampleRate);
556 AudioResampler::src_quality quality;
557 // force lowest quality level resampler if use case isn't music or video
558 // FIXME this is flawed for dynamic sample rates, as we choose the resampler
559 // quality level based on the initial ratio, but that could change later.
560 // Should have a way to distinguish tracks with static ratios vs. dynamic ratios.
561 if (!((value == 44100 && devSampleRate == 48000) ||
562 (value == 48000 && devSampleRate == 44100))) {
563 quality = AudioResampler::LOW_QUALITY;
564 } else {
565 quality = AudioResampler::DEFAULT_QUALITY;
566 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700567 resampler = AudioResampler::create(
Jean-Michel Triviacb86cc2012-04-16 12:43:57 -0700568 format,
569 // the resampler sees the number of channels after the downmixer, if any
570 downmixerBufferProvider != NULL ? MAX_NUM_CHANNELS : channelCount,
Glenn Kastenac602052012-10-01 14:04:31 -0700571 devSampleRate, quality);
Glenn Kasten52008f82012-03-18 09:34:41 -0700572 resampler->setLocalTimeFreq(sLocalTimeFreq);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700573 }
574 return true;
575 }
576 }
577 return false;
578}
579
Mathias Agopian65ab4712010-07-14 17:59:35 -0700580inline
581void AudioMixer::track_t::adjustVolumeRamp(bool aux)
582{
Glenn Kastenf9a27772012-01-06 07:47:26 -0800583 for (uint32_t i=0 ; i<MAX_NUM_CHANNELS ; i++) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700584 if (((volumeInc[i]>0) && (((prevVolume[i]+volumeInc[i])>>16) >= volume[i])) ||
585 ((volumeInc[i]<0) && (((prevVolume[i]+volumeInc[i])>>16) <= volume[i]))) {
586 volumeInc[i] = 0;
587 prevVolume[i] = volume[i]<<16;
588 }
589 }
590 if (aux) {
591 if (((auxInc>0) && (((prevAuxLevel+auxInc)>>16) >= auxLevel)) ||
592 ((auxInc<0) && (((prevAuxLevel+auxInc)>>16) <= auxLevel))) {
593 auxInc = 0;
594 prevAuxLevel = auxLevel<<16;
595 }
596 }
597}
598
Glenn Kastenc59c0042012-02-02 14:06:11 -0800599size_t AudioMixer::getUnreleasedFrames(int name) const
Eric Laurent071ccd52011-12-22 16:08:41 -0800600{
601 name -= TRACK0;
602 if (uint32_t(name) < MAX_NUM_TRACKS) {
Glenn Kastenc59c0042012-02-02 14:06:11 -0800603 return mState.tracks[name].getUnreleasedFrames();
Eric Laurent071ccd52011-12-22 16:08:41 -0800604 }
605 return 0;
606}
Mathias Agopian65ab4712010-07-14 17:59:35 -0700607
Glenn Kasten01c4ebf2012-02-22 10:47:35 -0800608void AudioMixer::setBufferProvider(int name, AudioBufferProvider* bufferProvider)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700609{
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800610 name -= TRACK0;
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800611 ALOG_ASSERT(uint32_t(name) < MAX_NUM_TRACKS, "bad track name %d", name);
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700612
613 if (mState.tracks[name].downmixerBufferProvider != NULL) {
614 // update required?
615 if (mState.tracks[name].downmixerBufferProvider->mTrackBufferProvider != bufferProvider) {
616 ALOGV("AudioMixer::setBufferProvider(%p) for downmix", bufferProvider);
617 // setting the buffer provider for a track that gets downmixed consists in:
618 // 1/ setting the buffer provider to the "downmix / buffer provider" wrapper
619 // so it's the one that gets called when the buffer provider is needed,
620 mState.tracks[name].bufferProvider = mState.tracks[name].downmixerBufferProvider;
621 // 2/ saving the buffer provider for the track so the wrapper can use it
622 // when it downmixes.
623 mState.tracks[name].downmixerBufferProvider->mTrackBufferProvider = bufferProvider;
624 }
625 } else {
626 mState.tracks[name].bufferProvider = bufferProvider;
627 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700628}
629
630
John Grossman4ff14ba2012-02-08 16:37:41 -0800631void AudioMixer::process(int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700632{
John Grossman4ff14ba2012-02-08 16:37:41 -0800633 mState.hook(&mState, pts);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700634}
635
636
John Grossman4ff14ba2012-02-08 16:37:41 -0800637void AudioMixer::process__validate(state_t* state, int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700638{
Steve Block5ff1dd52012-01-05 23:22:43 +0000639 ALOGW_IF(!state->needsChanged,
Mathias Agopian65ab4712010-07-14 17:59:35 -0700640 "in process__validate() but nothing's invalid");
641
642 uint32_t changed = state->needsChanged;
643 state->needsChanged = 0; // clear the validation flag
644
645 // recompute which tracks are enabled / disabled
646 uint32_t enabled = 0;
647 uint32_t disabled = 0;
648 while (changed) {
649 const int i = 31 - __builtin_clz(changed);
650 const uint32_t mask = 1<<i;
651 changed &= ~mask;
652 track_t& t = state->tracks[i];
653 (t.enabled ? enabled : disabled) |= mask;
654 }
655 state->enabledTracks &= ~disabled;
656 state->enabledTracks |= enabled;
657
658 // compute everything we need...
659 int countActiveTracks = 0;
Glenn Kasten4c340c62012-01-27 12:33:54 -0800660 bool all16BitsStereoNoResample = true;
661 bool resampling = false;
662 bool volumeRamp = false;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700663 uint32_t en = state->enabledTracks;
664 while (en) {
665 const int i = 31 - __builtin_clz(en);
666 en &= ~(1<<i);
667
668 countActiveTracks++;
669 track_t& t = state->tracks[i];
670 uint32_t n = 0;
671 n |= NEEDS_CHANNEL_1 + t.channelCount - 1;
672 n |= NEEDS_FORMAT_16;
673 n |= t.doesResample() ? NEEDS_RESAMPLE_ENABLED : NEEDS_RESAMPLE_DISABLED;
674 if (t.auxLevel != 0 && t.auxBuffer != NULL) {
675 n |= NEEDS_AUX_ENABLED;
676 }
677
678 if (t.volumeInc[0]|t.volumeInc[1]) {
Glenn Kasten4c340c62012-01-27 12:33:54 -0800679 volumeRamp = true;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700680 } else if (!t.doesResample() && t.volumeRL == 0) {
681 n |= NEEDS_MUTE_ENABLED;
682 }
683 t.needs = n;
684
685 if ((n & NEEDS_MUTE__MASK) == NEEDS_MUTE_ENABLED) {
686 t.hook = track__nop;
687 } else {
688 if ((n & NEEDS_AUX__MASK) == NEEDS_AUX_ENABLED) {
Glenn Kasten4c340c62012-01-27 12:33:54 -0800689 all16BitsStereoNoResample = false;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700690 }
691 if ((n & NEEDS_RESAMPLE__MASK) == NEEDS_RESAMPLE_ENABLED) {
Glenn Kasten4c340c62012-01-27 12:33:54 -0800692 all16BitsStereoNoResample = false;
693 resampling = true;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700694 t.hook = track__genericResample;
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700695 ALOGV_IF((n & NEEDS_CHANNEL_COUNT__MASK) > NEEDS_CHANNEL_2,
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700696 "Track %d needs downmix + resample", i);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700697 } else {
698 if ((n & NEEDS_CHANNEL_COUNT__MASK) == NEEDS_CHANNEL_1){
699 t.hook = track__16BitsMono;
Glenn Kasten4c340c62012-01-27 12:33:54 -0800700 all16BitsStereoNoResample = false;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700701 }
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700702 if ((n & NEEDS_CHANNEL_COUNT__MASK) >= NEEDS_CHANNEL_2){
Mathias Agopian65ab4712010-07-14 17:59:35 -0700703 t.hook = track__16BitsStereo;
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700704 ALOGV_IF((n & NEEDS_CHANNEL_COUNT__MASK) > NEEDS_CHANNEL_2,
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700705 "Track %d needs downmix", i);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700706 }
707 }
708 }
709 }
710
711 // select the processing hooks
712 state->hook = process__nop;
713 if (countActiveTracks) {
714 if (resampling) {
715 if (!state->outputTemp) {
716 state->outputTemp = new int32_t[MAX_NUM_CHANNELS * state->frameCount];
717 }
718 if (!state->resampleTemp) {
719 state->resampleTemp = new int32_t[MAX_NUM_CHANNELS * state->frameCount];
720 }
721 state->hook = process__genericResampling;
722 } else {
723 if (state->outputTemp) {
724 delete [] state->outputTemp;
Glenn Kastene0feee32011-12-13 11:53:26 -0800725 state->outputTemp = NULL;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700726 }
727 if (state->resampleTemp) {
728 delete [] state->resampleTemp;
Glenn Kastene0feee32011-12-13 11:53:26 -0800729 state->resampleTemp = NULL;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700730 }
731 state->hook = process__genericNoResampling;
732 if (all16BitsStereoNoResample && !volumeRamp) {
733 if (countActiveTracks == 1) {
734 state->hook = process__OneTrack16BitsStereoNoResampling;
735 }
736 }
737 }
738 }
739
Steve Block3856b092011-10-20 11:56:00 +0100740 ALOGV("mixer configuration change: %d activeTracks (%08x) "
Mathias Agopian65ab4712010-07-14 17:59:35 -0700741 "all16BitsStereoNoResample=%d, resampling=%d, volumeRamp=%d",
742 countActiveTracks, state->enabledTracks,
743 all16BitsStereoNoResample, resampling, volumeRamp);
744
John Grossman4ff14ba2012-02-08 16:37:41 -0800745 state->hook(state, pts);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700746
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800747 // Now that the volume ramp has been done, set optimal state and
748 // track hooks for subsequent mixer process
749 if (countActiveTracks) {
Glenn Kasten4c340c62012-01-27 12:33:54 -0800750 bool allMuted = true;
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800751 uint32_t en = state->enabledTracks;
752 while (en) {
753 const int i = 31 - __builtin_clz(en);
754 en &= ~(1<<i);
755 track_t& t = state->tracks[i];
756 if (!t.doesResample() && t.volumeRL == 0)
757 {
758 t.needs |= NEEDS_MUTE_ENABLED;
759 t.hook = track__nop;
760 } else {
Glenn Kasten4c340c62012-01-27 12:33:54 -0800761 allMuted = false;
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800762 }
763 }
764 if (allMuted) {
765 state->hook = process__nop;
766 } else if (all16BitsStereoNoResample) {
767 if (countActiveTracks == 1) {
768 state->hook = process__OneTrack16BitsStereoNoResampling;
769 }
770 }
771 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700772}
773
Mathias Agopian65ab4712010-07-14 17:59:35 -0700774
Glenn Kasten85ab62c2012-11-01 11:11:38 -0700775void AudioMixer::track__genericResample(track_t* t, int32_t* out, size_t outFrameCount,
776 int32_t* temp, int32_t* aux)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700777{
778 t->resampler->setSampleRate(t->sampleRate);
779
780 // ramp gain - resample to temp buffer and scale/mix in 2nd step
781 if (aux != NULL) {
782 // always resample with unity gain when sending to auxiliary buffer to be able
783 // to apply send level after resampling
784 // TODO: modify each resampler to support aux channel?
785 t->resampler->setVolume(UNITY_GAIN, UNITY_GAIN);
786 memset(temp, 0, outFrameCount * MAX_NUM_CHANNELS * sizeof(int32_t));
787 t->resampler->resample(temp, outFrameCount, t->bufferProvider);
Glenn Kastenf6b16782011-12-15 09:51:17 -0800788 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1]|t->auxInc)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700789 volumeRampStereo(t, out, outFrameCount, temp, aux);
790 } else {
791 volumeStereo(t, out, outFrameCount, temp, aux);
792 }
793 } else {
Glenn Kastenf6b16782011-12-15 09:51:17 -0800794 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1])) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700795 t->resampler->setVolume(UNITY_GAIN, UNITY_GAIN);
796 memset(temp, 0, outFrameCount * MAX_NUM_CHANNELS * sizeof(int32_t));
797 t->resampler->resample(temp, outFrameCount, t->bufferProvider);
798 volumeRampStereo(t, out, outFrameCount, temp, aux);
799 }
800
801 // constant gain
802 else {
803 t->resampler->setVolume(t->volume[0], t->volume[1]);
804 t->resampler->resample(out, outFrameCount, t->bufferProvider);
805 }
806 }
807}
808
Glenn Kasten85ab62c2012-11-01 11:11:38 -0700809void AudioMixer::track__nop(track_t* t, int32_t* out, size_t outFrameCount, int32_t* temp,
810 int32_t* aux)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700811{
812}
813
Glenn Kasten85ab62c2012-11-01 11:11:38 -0700814void AudioMixer::volumeRampStereo(track_t* t, int32_t* out, size_t frameCount, int32_t* temp,
815 int32_t* aux)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700816{
817 int32_t vl = t->prevVolume[0];
818 int32_t vr = t->prevVolume[1];
819 const int32_t vlInc = t->volumeInc[0];
820 const int32_t vrInc = t->volumeInc[1];
821
Steve Blockb8a80522011-12-20 16:23:08 +0000822 //ALOGD("[0] %p: inc=%f, v0=%f, v1=%d, final=%f, count=%d",
Mathias Agopian65ab4712010-07-14 17:59:35 -0700823 // t, vlInc/65536.0f, vl/65536.0f, t->volume[0],
824 // (vl + vlInc*frameCount)/65536.0f, frameCount);
825
826 // ramp volume
Glenn Kastenf6b16782011-12-15 09:51:17 -0800827 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700828 int32_t va = t->prevAuxLevel;
829 const int32_t vaInc = t->auxInc;
830 int32_t l;
831 int32_t r;
832
833 do {
834 l = (*temp++ >> 12);
835 r = (*temp++ >> 12);
836 *out++ += (vl >> 16) * l;
837 *out++ += (vr >> 16) * r;
838 *aux++ += (va >> 17) * (l + r);
839 vl += vlInc;
840 vr += vrInc;
841 va += vaInc;
842 } while (--frameCount);
843 t->prevAuxLevel = va;
844 } else {
845 do {
846 *out++ += (vl >> 16) * (*temp++ >> 12);
847 *out++ += (vr >> 16) * (*temp++ >> 12);
848 vl += vlInc;
849 vr += vrInc;
850 } while (--frameCount);
851 }
852 t->prevVolume[0] = vl;
853 t->prevVolume[1] = vr;
Glenn Kastena1117922012-01-26 10:53:32 -0800854 t->adjustVolumeRamp(aux != NULL);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700855}
856
Glenn Kasten85ab62c2012-11-01 11:11:38 -0700857void AudioMixer::volumeStereo(track_t* t, int32_t* out, size_t frameCount, int32_t* temp,
858 int32_t* aux)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700859{
860 const int16_t vl = t->volume[0];
861 const int16_t vr = t->volume[1];
862
Glenn Kastenf6b16782011-12-15 09:51:17 -0800863 if (CC_UNLIKELY(aux != NULL)) {
Glenn Kasten3b81aca2012-01-27 15:26:23 -0800864 const int16_t va = t->auxLevel;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700865 do {
866 int16_t l = (int16_t)(*temp++ >> 12);
867 int16_t r = (int16_t)(*temp++ >> 12);
868 out[0] = mulAdd(l, vl, out[0]);
869 int16_t a = (int16_t)(((int32_t)l + r) >> 1);
870 out[1] = mulAdd(r, vr, out[1]);
871 out += 2;
872 aux[0] = mulAdd(a, va, aux[0]);
873 aux++;
874 } while (--frameCount);
875 } else {
876 do {
877 int16_t l = (int16_t)(*temp++ >> 12);
878 int16_t r = (int16_t)(*temp++ >> 12);
879 out[0] = mulAdd(l, vl, out[0]);
880 out[1] = mulAdd(r, vr, out[1]);
881 out += 2;
882 } while (--frameCount);
883 }
884}
885
Glenn Kasten85ab62c2012-11-01 11:11:38 -0700886void AudioMixer::track__16BitsStereo(track_t* t, int32_t* out, size_t frameCount, int32_t* temp,
887 int32_t* aux)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700888{
Glenn Kasten54c3b662012-01-06 07:46:30 -0800889 const int16_t *in = static_cast<const int16_t *>(t->in);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700890
Glenn Kastenf6b16782011-12-15 09:51:17 -0800891 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700892 int32_t l;
893 int32_t r;
894 // ramp gain
Glenn Kastenf6b16782011-12-15 09:51:17 -0800895 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1]|t->auxInc)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700896 int32_t vl = t->prevVolume[0];
897 int32_t vr = t->prevVolume[1];
898 int32_t va = t->prevAuxLevel;
899 const int32_t vlInc = t->volumeInc[0];
900 const int32_t vrInc = t->volumeInc[1];
901 const int32_t vaInc = t->auxInc;
Steve Blockb8a80522011-12-20 16:23:08 +0000902 // ALOGD("[1] %p: inc=%f, v0=%f, v1=%d, final=%f, count=%d",
Mathias Agopian65ab4712010-07-14 17:59:35 -0700903 // t, vlInc/65536.0f, vl/65536.0f, t->volume[0],
904 // (vl + vlInc*frameCount)/65536.0f, frameCount);
905
906 do {
907 l = (int32_t)*in++;
908 r = (int32_t)*in++;
909 *out++ += (vl >> 16) * l;
910 *out++ += (vr >> 16) * r;
911 *aux++ += (va >> 17) * (l + r);
912 vl += vlInc;
913 vr += vrInc;
914 va += vaInc;
915 } while (--frameCount);
916
917 t->prevVolume[0] = vl;
918 t->prevVolume[1] = vr;
919 t->prevAuxLevel = va;
920 t->adjustVolumeRamp(true);
921 }
922
923 // constant gain
924 else {
925 const uint32_t vrl = t->volumeRL;
926 const int16_t va = (int16_t)t->auxLevel;
927 do {
Glenn Kasten54c3b662012-01-06 07:46:30 -0800928 uint32_t rl = *reinterpret_cast<const uint32_t *>(in);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700929 int16_t a = (int16_t)(((int32_t)in[0] + in[1]) >> 1);
930 in += 2;
931 out[0] = mulAddRL(1, rl, vrl, out[0]);
932 out[1] = mulAddRL(0, rl, vrl, out[1]);
933 out += 2;
934 aux[0] = mulAdd(a, va, aux[0]);
935 aux++;
936 } while (--frameCount);
937 }
938 } else {
939 // ramp gain
Glenn Kastenf6b16782011-12-15 09:51:17 -0800940 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1])) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700941 int32_t vl = t->prevVolume[0];
942 int32_t vr = t->prevVolume[1];
943 const int32_t vlInc = t->volumeInc[0];
944 const int32_t vrInc = t->volumeInc[1];
945
Steve Blockb8a80522011-12-20 16:23:08 +0000946 // ALOGD("[1] %p: inc=%f, v0=%f, v1=%d, final=%f, count=%d",
Mathias Agopian65ab4712010-07-14 17:59:35 -0700947 // t, vlInc/65536.0f, vl/65536.0f, t->volume[0],
948 // (vl + vlInc*frameCount)/65536.0f, frameCount);
949
950 do {
951 *out++ += (vl >> 16) * (int32_t) *in++;
952 *out++ += (vr >> 16) * (int32_t) *in++;
953 vl += vlInc;
954 vr += vrInc;
955 } while (--frameCount);
956
957 t->prevVolume[0] = vl;
958 t->prevVolume[1] = vr;
959 t->adjustVolumeRamp(false);
960 }
961
962 // constant gain
963 else {
964 const uint32_t vrl = t->volumeRL;
965 do {
Glenn Kasten54c3b662012-01-06 07:46:30 -0800966 uint32_t rl = *reinterpret_cast<const uint32_t *>(in);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700967 in += 2;
968 out[0] = mulAddRL(1, rl, vrl, out[0]);
969 out[1] = mulAddRL(0, rl, vrl, out[1]);
970 out += 2;
971 } while (--frameCount);
972 }
973 }
974 t->in = in;
975}
976
Glenn Kasten85ab62c2012-11-01 11:11:38 -0700977void AudioMixer::track__16BitsMono(track_t* t, int32_t* out, size_t frameCount, int32_t* temp,
978 int32_t* aux)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700979{
Glenn Kasten54c3b662012-01-06 07:46:30 -0800980 const int16_t *in = static_cast<int16_t const *>(t->in);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700981
Glenn Kastenf6b16782011-12-15 09:51:17 -0800982 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700983 // ramp gain
Glenn Kastenf6b16782011-12-15 09:51:17 -0800984 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1]|t->auxInc)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700985 int32_t vl = t->prevVolume[0];
986 int32_t vr = t->prevVolume[1];
987 int32_t va = t->prevAuxLevel;
988 const int32_t vlInc = t->volumeInc[0];
989 const int32_t vrInc = t->volumeInc[1];
990 const int32_t vaInc = t->auxInc;
991
Steve Blockb8a80522011-12-20 16:23:08 +0000992 // ALOGD("[2] %p: inc=%f, v0=%f, v1=%d, final=%f, count=%d",
Mathias Agopian65ab4712010-07-14 17:59:35 -0700993 // t, vlInc/65536.0f, vl/65536.0f, t->volume[0],
994 // (vl + vlInc*frameCount)/65536.0f, frameCount);
995
996 do {
997 int32_t l = *in++;
998 *out++ += (vl >> 16) * l;
999 *out++ += (vr >> 16) * l;
1000 *aux++ += (va >> 16) * l;
1001 vl += vlInc;
1002 vr += vrInc;
1003 va += vaInc;
1004 } while (--frameCount);
1005
1006 t->prevVolume[0] = vl;
1007 t->prevVolume[1] = vr;
1008 t->prevAuxLevel = va;
1009 t->adjustVolumeRamp(true);
1010 }
1011 // constant gain
1012 else {
1013 const int16_t vl = t->volume[0];
1014 const int16_t vr = t->volume[1];
1015 const int16_t va = (int16_t)t->auxLevel;
1016 do {
1017 int16_t l = *in++;
1018 out[0] = mulAdd(l, vl, out[0]);
1019 out[1] = mulAdd(l, vr, out[1]);
1020 out += 2;
1021 aux[0] = mulAdd(l, va, aux[0]);
1022 aux++;
1023 } while (--frameCount);
1024 }
1025 } else {
1026 // ramp gain
Glenn Kastenf6b16782011-12-15 09:51:17 -08001027 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1])) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001028 int32_t vl = t->prevVolume[0];
1029 int32_t vr = t->prevVolume[1];
1030 const int32_t vlInc = t->volumeInc[0];
1031 const int32_t vrInc = t->volumeInc[1];
1032
Steve Blockb8a80522011-12-20 16:23:08 +00001033 // ALOGD("[2] %p: inc=%f, v0=%f, v1=%d, final=%f, count=%d",
Mathias Agopian65ab4712010-07-14 17:59:35 -07001034 // t, vlInc/65536.0f, vl/65536.0f, t->volume[0],
1035 // (vl + vlInc*frameCount)/65536.0f, frameCount);
1036
1037 do {
1038 int32_t l = *in++;
1039 *out++ += (vl >> 16) * l;
1040 *out++ += (vr >> 16) * l;
1041 vl += vlInc;
1042 vr += vrInc;
1043 } while (--frameCount);
1044
1045 t->prevVolume[0] = vl;
1046 t->prevVolume[1] = vr;
1047 t->adjustVolumeRamp(false);
1048 }
1049 // constant gain
1050 else {
1051 const int16_t vl = t->volume[0];
1052 const int16_t vr = t->volume[1];
1053 do {
1054 int16_t l = *in++;
1055 out[0] = mulAdd(l, vl, out[0]);
1056 out[1] = mulAdd(l, vr, out[1]);
1057 out += 2;
1058 } while (--frameCount);
1059 }
1060 }
1061 t->in = in;
1062}
1063
Mathias Agopian65ab4712010-07-14 17:59:35 -07001064// no-op case
John Grossman4ff14ba2012-02-08 16:37:41 -08001065void AudioMixer::process__nop(state_t* state, int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001066{
1067 uint32_t e0 = state->enabledTracks;
1068 size_t bufSize = state->frameCount * sizeof(int16_t) * MAX_NUM_CHANNELS;
1069 while (e0) {
1070 // process by group of tracks with same output buffer to
1071 // avoid multiple memset() on same buffer
1072 uint32_t e1 = e0, e2 = e0;
1073 int i = 31 - __builtin_clz(e1);
Glenn Kastenfc900c92013-02-18 12:47:49 -08001074 {
1075 track_t& t1 = state->tracks[i];
Mathias Agopian65ab4712010-07-14 17:59:35 -07001076 e2 &= ~(1<<i);
Glenn Kastenfc900c92013-02-18 12:47:49 -08001077 while (e2) {
1078 i = 31 - __builtin_clz(e2);
1079 e2 &= ~(1<<i);
1080 track_t& t2 = state->tracks[i];
1081 if (CC_UNLIKELY(t2.mainBuffer != t1.mainBuffer)) {
1082 e1 &= ~(1<<i);
1083 }
Mathias Agopian65ab4712010-07-14 17:59:35 -07001084 }
Glenn Kastenfc900c92013-02-18 12:47:49 -08001085 e0 &= ~(e1);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001086
Glenn Kastenfc900c92013-02-18 12:47:49 -08001087 memset(t1.mainBuffer, 0, bufSize);
1088 }
Mathias Agopian65ab4712010-07-14 17:59:35 -07001089
1090 while (e1) {
1091 i = 31 - __builtin_clz(e1);
1092 e1 &= ~(1<<i);
Glenn Kastenfc900c92013-02-18 12:47:49 -08001093 {
1094 track_t& t3 = state->tracks[i];
1095 size_t outFrames = state->frameCount;
1096 while (outFrames) {
1097 t3.buffer.frameCount = outFrames;
1098 int64_t outputPTS = calculateOutputPTS(
1099 t3, pts, state->frameCount - outFrames);
1100 t3.bufferProvider->getNextBuffer(&t3.buffer, outputPTS);
1101 if (t3.buffer.raw == NULL) break;
1102 outFrames -= t3.buffer.frameCount;
1103 t3.bufferProvider->releaseBuffer(&t3.buffer);
1104 }
Mathias Agopian65ab4712010-07-14 17:59:35 -07001105 }
1106 }
1107 }
1108}
1109
1110// generic code without resampling
John Grossman4ff14ba2012-02-08 16:37:41 -08001111void AudioMixer::process__genericNoResampling(state_t* state, int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001112{
1113 int32_t outTemp[BLOCKSIZE * MAX_NUM_CHANNELS] __attribute__((aligned(32)));
1114
1115 // acquire each track's buffer
1116 uint32_t enabledTracks = state->enabledTracks;
1117 uint32_t e0 = enabledTracks;
1118 while (e0) {
1119 const int i = 31 - __builtin_clz(e0);
1120 e0 &= ~(1<<i);
1121 track_t& t = state->tracks[i];
1122 t.buffer.frameCount = state->frameCount;
John Grossman4ff14ba2012-02-08 16:37:41 -08001123 t.bufferProvider->getNextBuffer(&t.buffer, pts);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001124 t.frameCount = t.buffer.frameCount;
1125 t.in = t.buffer.raw;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001126 }
1127
1128 e0 = enabledTracks;
1129 while (e0) {
1130 // process by group of tracks with same output buffer to
1131 // optimize cache use
1132 uint32_t e1 = e0, e2 = e0;
1133 int j = 31 - __builtin_clz(e1);
1134 track_t& t1 = state->tracks[j];
1135 e2 &= ~(1<<j);
1136 while (e2) {
1137 j = 31 - __builtin_clz(e2);
1138 e2 &= ~(1<<j);
1139 track_t& t2 = state->tracks[j];
Glenn Kastenf6b16782011-12-15 09:51:17 -08001140 if (CC_UNLIKELY(t2.mainBuffer != t1.mainBuffer)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001141 e1 &= ~(1<<j);
1142 }
1143 }
1144 e0 &= ~(e1);
1145 // this assumes output 16 bits stereo, no resampling
1146 int32_t *out = t1.mainBuffer;
1147 size_t numFrames = 0;
1148 do {
1149 memset(outTemp, 0, sizeof(outTemp));
1150 e2 = e1;
1151 while (e2) {
1152 const int i = 31 - __builtin_clz(e2);
1153 e2 &= ~(1<<i);
1154 track_t& t = state->tracks[i];
1155 size_t outFrames = BLOCKSIZE;
1156 int32_t *aux = NULL;
Glenn Kastenf6b16782011-12-15 09:51:17 -08001157 if (CC_UNLIKELY((t.needs & NEEDS_AUX__MASK) == NEEDS_AUX_ENABLED)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001158 aux = t.auxBuffer + numFrames;
1159 }
1160 while (outFrames) {
Gaurav Kumar7e79cd22014-01-06 10:57:18 +05301161 // 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 e1 &= ~(1<<i);
1166 break;
1167 }
Mathias Agopian65ab4712010-07-14 17:59:35 -07001168 size_t inFrames = (t.frameCount > outFrames)?outFrames:t.frameCount;
1169 if (inFrames) {
Glenn Kasten85ab62c2012-11-01 11:11:38 -07001170 t.hook(&t, outTemp + (BLOCKSIZE-outFrames)*MAX_NUM_CHANNELS, inFrames,
1171 state->resampleTemp, aux);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001172 t.frameCount -= inFrames;
1173 outFrames -= inFrames;
Glenn Kastenf6b16782011-12-15 09:51:17 -08001174 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001175 aux += inFrames;
1176 }
1177 }
1178 if (t.frameCount == 0 && outFrames) {
1179 t.bufferProvider->releaseBuffer(&t.buffer);
Glenn Kasten85ab62c2012-11-01 11:11:38 -07001180 t.buffer.frameCount = (state->frameCount - numFrames) -
1181 (BLOCKSIZE - outFrames);
John Grossman4ff14ba2012-02-08 16:37:41 -08001182 int64_t outputPTS = calculateOutputPTS(
1183 t, pts, numFrames + (BLOCKSIZE - outFrames));
1184 t.bufferProvider->getNextBuffer(&t.buffer, outputPTS);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001185 t.in = t.buffer.raw;
1186 if (t.in == NULL) {
1187 enabledTracks &= ~(1<<i);
1188 e1 &= ~(1<<i);
1189 break;
1190 }
1191 t.frameCount = t.buffer.frameCount;
1192 }
1193 }
1194 }
1195 ditherAndClamp(out, outTemp, BLOCKSIZE);
1196 out += BLOCKSIZE;
1197 numFrames += BLOCKSIZE;
1198 } while (numFrames < state->frameCount);
1199 }
1200
1201 // release each track's buffer
1202 e0 = enabledTracks;
1203 while (e0) {
1204 const int i = 31 - __builtin_clz(e0);
1205 e0 &= ~(1<<i);
1206 track_t& t = state->tracks[i];
1207 t.bufferProvider->releaseBuffer(&t.buffer);
1208 }
1209}
1210
1211
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -08001212// generic code with resampling
John Grossman4ff14ba2012-02-08 16:37:41 -08001213void AudioMixer::process__genericResampling(state_t* state, int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001214{
Glenn Kasten54c3b662012-01-06 07:46:30 -08001215 // this const just means that local variable outTemp doesn't change
Mathias Agopian65ab4712010-07-14 17:59:35 -07001216 int32_t* const outTemp = state->outputTemp;
1217 const size_t size = sizeof(int32_t) * MAX_NUM_CHANNELS * state->frameCount;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001218
1219 size_t numFrames = state->frameCount;
1220
1221 uint32_t e0 = state->enabledTracks;
1222 while (e0) {
1223 // process by group of tracks with same output buffer
1224 // to optimize cache use
1225 uint32_t e1 = e0, e2 = e0;
1226 int j = 31 - __builtin_clz(e1);
1227 track_t& t1 = state->tracks[j];
1228 e2 &= ~(1<<j);
1229 while (e2) {
1230 j = 31 - __builtin_clz(e2);
1231 e2 &= ~(1<<j);
1232 track_t& t2 = state->tracks[j];
Glenn Kastenf6b16782011-12-15 09:51:17 -08001233 if (CC_UNLIKELY(t2.mainBuffer != t1.mainBuffer)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001234 e1 &= ~(1<<j);
1235 }
1236 }
1237 e0 &= ~(e1);
1238 int32_t *out = t1.mainBuffer;
Yuuhi Yamaguchi2151d7b2011-02-04 15:24:34 +01001239 memset(outTemp, 0, size);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001240 while (e1) {
1241 const int i = 31 - __builtin_clz(e1);
1242 e1 &= ~(1<<i);
1243 track_t& t = state->tracks[i];
1244 int32_t *aux = NULL;
Glenn Kastenf6b16782011-12-15 09:51:17 -08001245 if (CC_UNLIKELY((t.needs & NEEDS_AUX__MASK) == NEEDS_AUX_ENABLED)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001246 aux = t.auxBuffer;
1247 }
1248
1249 // this is a little goofy, on the resampling case we don't
1250 // acquire/release the buffers because it's done by
1251 // the resampler.
1252 if ((t.needs & NEEDS_RESAMPLE__MASK) == NEEDS_RESAMPLE_ENABLED) {
John Grossman4ff14ba2012-02-08 16:37:41 -08001253 t.resampler->setPTS(pts);
Glenn Kastena1117922012-01-26 10:53:32 -08001254 t.hook(&t, outTemp, numFrames, state->resampleTemp, aux);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001255 } else {
1256
1257 size_t outFrames = 0;
1258
1259 while (outFrames < numFrames) {
1260 t.buffer.frameCount = numFrames - outFrames;
John Grossman4ff14ba2012-02-08 16:37:41 -08001261 int64_t outputPTS = calculateOutputPTS(t, pts, outFrames);
1262 t.bufferProvider->getNextBuffer(&t.buffer, outputPTS);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001263 t.in = t.buffer.raw;
1264 // t.in == NULL can happen if the track was flushed just after having
1265 // been enabled for mixing.
1266 if (t.in == NULL) break;
1267
Glenn Kastenf6b16782011-12-15 09:51:17 -08001268 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001269 aux += outFrames;
1270 }
Glenn Kasten85ab62c2012-11-01 11:11:38 -07001271 t.hook(&t, outTemp + outFrames*MAX_NUM_CHANNELS, t.buffer.frameCount,
1272 state->resampleTemp, aux);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001273 outFrames += t.buffer.frameCount;
1274 t.bufferProvider->releaseBuffer(&t.buffer);
1275 }
1276 }
1277 }
1278 ditherAndClamp(out, outTemp, numFrames);
1279 }
1280}
1281
1282// one track, 16 bits stereo without resampling is the most common case
John Grossman4ff14ba2012-02-08 16:37:41 -08001283void AudioMixer::process__OneTrack16BitsStereoNoResampling(state_t* state,
1284 int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001285{
Glenn Kasten99e53b82012-01-19 08:59:58 -08001286 // This method is only called when state->enabledTracks has exactly
1287 // one bit set. The asserts below would verify this, but are commented out
1288 // since the whole point of this method is to optimize performance.
Glenn Kasten5798d4e2012-03-08 12:18:35 -08001289 //ALOG_ASSERT(0 != state->enabledTracks, "no tracks enabled");
Mathias Agopian65ab4712010-07-14 17:59:35 -07001290 const int i = 31 - __builtin_clz(state->enabledTracks);
Glenn Kasten5798d4e2012-03-08 12:18:35 -08001291 //ALOG_ASSERT((1 << i) == state->enabledTracks, "more than 1 track enabled");
Mathias Agopian65ab4712010-07-14 17:59:35 -07001292 const track_t& t = state->tracks[i];
1293
1294 AudioBufferProvider::Buffer& b(t.buffer);
1295
1296 int32_t* out = t.mainBuffer;
1297 size_t numFrames = state->frameCount;
1298
1299 const int16_t vl = t.volume[0];
1300 const int16_t vr = t.volume[1];
1301 const uint32_t vrl = t.volumeRL;
1302 while (numFrames) {
1303 b.frameCount = numFrames;
John Grossman4ff14ba2012-02-08 16:37:41 -08001304 int64_t outputPTS = calculateOutputPTS(t, pts, out - t.mainBuffer);
1305 t.bufferProvider->getNextBuffer(&b, outputPTS);
Glenn Kasten54c3b662012-01-06 07:46:30 -08001306 const int16_t *in = b.i16;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001307
1308 // in == NULL can happen if the track was flushed just after having
1309 // been enabled for mixing.
1310 if (in == NULL || ((unsigned long)in & 3)) {
1311 memset(out, 0, numFrames*MAX_NUM_CHANNELS*sizeof(int16_t));
Glenn Kasten85ab62c2012-11-01 11:11:38 -07001312 ALOGE_IF(((unsigned long)in & 3), "process stereo track: input buffer alignment pb: "
1313 "buffer %p track %d, channels %d, needs %08x",
Mathias Agopian65ab4712010-07-14 17:59:35 -07001314 in, i, t.channelCount, t.needs);
1315 return;
1316 }
1317 size_t outFrames = b.frameCount;
1318
Glenn Kastenf6b16782011-12-15 09:51:17 -08001319 if (CC_UNLIKELY(uint32_t(vl) > UNITY_GAIN || uint32_t(vr) > UNITY_GAIN)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001320 // volume is boosted, so we might need to clamp even though
1321 // we process only one track.
1322 do {
Glenn Kasten54c3b662012-01-06 07:46:30 -08001323 uint32_t rl = *reinterpret_cast<const uint32_t *>(in);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001324 in += 2;
1325 int32_t l = mulRL(1, rl, vrl) >> 12;
1326 int32_t r = mulRL(0, rl, vrl) >> 12;
1327 // clamping...
1328 l = clamp16(l);
1329 r = clamp16(r);
1330 *out++ = (r<<16) | (l & 0xFFFF);
1331 } while (--outFrames);
1332 } else {
1333 do {
Glenn Kasten54c3b662012-01-06 07:46:30 -08001334 uint32_t rl = *reinterpret_cast<const uint32_t *>(in);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001335 in += 2;
1336 int32_t l = mulRL(1, rl, vrl) >> 12;
1337 int32_t r = mulRL(0, rl, vrl) >> 12;
1338 *out++ = (r<<16) | (l & 0xFFFF);
1339 } while (--outFrames);
1340 }
1341 numFrames -= b.frameCount;
1342 t.bufferProvider->releaseBuffer(&b);
1343 }
1344}
1345
Glenn Kasten81a028f2011-12-15 09:53:12 -08001346#if 0
Mathias Agopian65ab4712010-07-14 17:59:35 -07001347// 2 tracks is also a common case
1348// NEVER used in current implementation of process__validate()
1349// only use if the 2 tracks have the same output buffer
John Grossman4ff14ba2012-02-08 16:37:41 -08001350void AudioMixer::process__TwoTracks16BitsStereoNoResampling(state_t* state,
1351 int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001352{
1353 int i;
1354 uint32_t en = state->enabledTracks;
1355
1356 i = 31 - __builtin_clz(en);
1357 const track_t& t0 = state->tracks[i];
1358 AudioBufferProvider::Buffer& b0(t0.buffer);
1359
1360 en &= ~(1<<i);
1361 i = 31 - __builtin_clz(en);
1362 const track_t& t1 = state->tracks[i];
1363 AudioBufferProvider::Buffer& b1(t1.buffer);
1364
Glenn Kasten54c3b662012-01-06 07:46:30 -08001365 const int16_t *in0;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001366 const int16_t vl0 = t0.volume[0];
1367 const int16_t vr0 = t0.volume[1];
1368 size_t frameCount0 = 0;
1369
Glenn Kasten54c3b662012-01-06 07:46:30 -08001370 const int16_t *in1;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001371 const int16_t vl1 = t1.volume[0];
1372 const int16_t vr1 = t1.volume[1];
1373 size_t frameCount1 = 0;
1374
1375 //FIXME: only works if two tracks use same buffer
1376 int32_t* out = t0.mainBuffer;
1377 size_t numFrames = state->frameCount;
Glenn Kasten54c3b662012-01-06 07:46:30 -08001378 const int16_t *buff = NULL;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001379
1380
1381 while (numFrames) {
1382
1383 if (frameCount0 == 0) {
1384 b0.frameCount = numFrames;
John Grossman4ff14ba2012-02-08 16:37:41 -08001385 int64_t outputPTS = calculateOutputPTS(t0, pts,
1386 out - t0.mainBuffer);
1387 t0.bufferProvider->getNextBuffer(&b0, outputPTS);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001388 if (b0.i16 == NULL) {
1389 if (buff == NULL) {
1390 buff = new int16_t[MAX_NUM_CHANNELS * state->frameCount];
1391 }
1392 in0 = buff;
1393 b0.frameCount = numFrames;
1394 } else {
1395 in0 = b0.i16;
1396 }
1397 frameCount0 = b0.frameCount;
1398 }
1399 if (frameCount1 == 0) {
1400 b1.frameCount = numFrames;
John Grossman4ff14ba2012-02-08 16:37:41 -08001401 int64_t outputPTS = calculateOutputPTS(t1, pts,
1402 out - t0.mainBuffer);
1403 t1.bufferProvider->getNextBuffer(&b1, outputPTS);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001404 if (b1.i16 == NULL) {
1405 if (buff == NULL) {
1406 buff = new int16_t[MAX_NUM_CHANNELS * state->frameCount];
1407 }
1408 in1 = buff;
1409 b1.frameCount = numFrames;
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -08001410 } else {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001411 in1 = b1.i16;
1412 }
1413 frameCount1 = b1.frameCount;
1414 }
1415
1416 size_t outFrames = frameCount0 < frameCount1?frameCount0:frameCount1;
1417
1418 numFrames -= outFrames;
1419 frameCount0 -= outFrames;
1420 frameCount1 -= outFrames;
1421
1422 do {
1423 int32_t l0 = *in0++;
1424 int32_t r0 = *in0++;
1425 l0 = mul(l0, vl0);
1426 r0 = mul(r0, vr0);
1427 int32_t l = *in1++;
1428 int32_t r = *in1++;
1429 l = mulAdd(l, vl1, l0) >> 12;
1430 r = mulAdd(r, vr1, r0) >> 12;
1431 // clamping...
1432 l = clamp16(l);
1433 r = clamp16(r);
1434 *out++ = (r<<16) | (l & 0xFFFF);
1435 } while (--outFrames);
1436
1437 if (frameCount0 == 0) {
1438 t0.bufferProvider->releaseBuffer(&b0);
1439 }
1440 if (frameCount1 == 0) {
1441 t1.bufferProvider->releaseBuffer(&b1);
1442 }
1443 }
1444
Glenn Kastene9dd0172012-01-27 18:08:45 -08001445 delete [] buff;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001446}
Glenn Kasten81a028f2011-12-15 09:53:12 -08001447#endif
Mathias Agopian65ab4712010-07-14 17:59:35 -07001448
John Grossman4ff14ba2012-02-08 16:37:41 -08001449int64_t AudioMixer::calculateOutputPTS(const track_t& t, int64_t basePTS,
1450 int outputFrameIndex)
1451{
1452 if (AudioBufferProvider::kInvalidPTS == basePTS)
1453 return AudioBufferProvider::kInvalidPTS;
1454
Glenn Kasten52008f82012-03-18 09:34:41 -07001455 return basePTS + ((outputFrameIndex * sLocalTimeFreq) / t.sampleRate);
1456}
1457
1458/*static*/ uint64_t AudioMixer::sLocalTimeFreq;
1459/*static*/ pthread_once_t AudioMixer::sOnceControl = PTHREAD_ONCE_INIT;
1460
1461/*static*/ void AudioMixer::sInitRoutine()
1462{
1463 LocalClock lc;
1464 sLocalTimeFreq = lc.getLocalFreq();
John Grossman4ff14ba2012-02-08 16:37:41 -08001465}
1466
Mathias Agopian65ab4712010-07-14 17:59:35 -07001467// ----------------------------------------------------------------------------
1468}; // namespace android