blob: 7d38f8031dea573c22c04247426eb8ad71e6638a [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
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 Kasten7f5d3352013-02-15 23:55:04 +0000101 mSampleRate(sampleRate)
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 Kasten599fabc2012-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 Kastenab7d72f2013-02-27 09:05:28 -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;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700135 t++;
136 }
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700137
138 // find multichannel downmix effect if we have to play multichannel content
139 uint32_t numEffects = 0;
140 int ret = EffectQueryNumberEffects(&numEffects);
141 if (ret != 0) {
142 ALOGE("AudioMixer() error %d querying number of effects", ret);
143 return;
144 }
145 ALOGV("EffectQueryNumberEffects() numEffects=%d", numEffects);
146
147 for (uint32_t i = 0 ; i < numEffects ; i++) {
148 if (EffectQueryEffect(i, &dwnmFxDesc) == 0) {
149 ALOGV("effect %d is called %s", i, dwnmFxDesc.name);
150 if (memcmp(&dwnmFxDesc.type, EFFECT_UIID_DOWNMIX, sizeof(effect_uuid_t)) == 0) {
151 ALOGI("found effect \"%s\" from %s",
152 dwnmFxDesc.name, dwnmFxDesc.implementor);
153 isMultichannelCapable = true;
154 break;
155 }
156 }
157 }
158 ALOGE_IF(!isMultichannelCapable, "unable to find downmix effect");
Mathias Agopian65ab4712010-07-14 17:59:35 -0700159}
160
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800161AudioMixer::~AudioMixer()
162{
163 track_t* t = mState.tracks;
Glenn Kastenbf71f1e2011-12-13 11:52:35 -0800164 for (unsigned i=0 ; i < MAX_NUM_TRACKS ; i++) {
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800165 delete t->resampler;
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700166 delete t->downmixerBufferProvider;
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800167 t++;
168 }
169 delete [] mState.outputTemp;
170 delete [] mState.resampleTemp;
171}
Mathias Agopian65ab4712010-07-14 17:59:35 -0700172
Glenn Kastenab7d72f2013-02-27 09:05:28 -0800173void AudioMixer::setLog(NBLog::Writer *log)
174{
175 mState.mLog = log;
176}
177
Jean-Michel Trivid06e1322012-09-12 15:47:07 -0700178int AudioMixer::getTrackName(audio_channel_mask_t channelMask, int sessionId)
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800179{
Glenn Kasten5c94b6c2012-03-20 17:01:29 -0700180 uint32_t names = (~mTrackNames) & mConfiguredNames;
Glenn Kasten98dd5422011-12-15 14:38:29 -0800181 if (names != 0) {
182 int n = __builtin_ctz(names);
Steve Block3856b092011-10-20 11:56:00 +0100183 ALOGV("add track (%d)", n);
Glenn Kasten98dd5422011-12-15 14:38:29 -0800184 mTrackNames |= 1 << n;
Glenn Kastendeeb1282012-03-25 11:59:31 -0700185 // assume default parameters for the track, except where noted below
186 track_t* t = &mState.tracks[n];
187 t->needs = 0;
188 t->volume[0] = UNITY_GAIN;
189 t->volume[1] = UNITY_GAIN;
190 // no initialization needed
191 // t->prevVolume[0]
192 // t->prevVolume[1]
193 t->volumeInc[0] = 0;
194 t->volumeInc[1] = 0;
195 t->auxLevel = 0;
196 t->auxInc = 0;
197 // no initialization needed
198 // t->prevAuxLevel
199 // t->frameCount
200 t->channelCount = 2;
201 t->enabled = false;
202 t->format = 16;
203 t->channelMask = AUDIO_CHANNEL_OUT_STEREO;
Jean-Michel Trivid06e1322012-09-12 15:47:07 -0700204 t->sessionId = sessionId;
Glenn Kastendeeb1282012-03-25 11:59:31 -0700205 // setBufferProvider(name, AudioBufferProvider *) is required before enable(name)
206 t->bufferProvider = NULL;
207 t->buffer.raw = NULL;
208 // no initialization needed
209 // t->buffer.frameCount
210 t->hook = NULL;
211 t->in = NULL;
212 t->resampler = NULL;
213 t->sampleRate = mSampleRate;
214 // setParameter(name, TRACK, MAIN_BUFFER, mixBuffer) is required before enable(name)
215 t->mainBuffer = NULL;
216 t->auxBuffer = NULL;
Glenn Kasten52008f82012-03-18 09:34:41 -0700217 t->downmixerBufferProvider = NULL;
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700218
219 status_t status = initTrackDownmix(&mState.tracks[n], n, channelMask);
220 if (status == OK) {
221 return TRACK0 + n;
222 }
223 ALOGE("AudioMixer::getTrackName(0x%x) failed, error preparing track for downmix",
224 channelMask);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700225 }
226 return -1;
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800227}
Mathias Agopian65ab4712010-07-14 17:59:35 -0700228
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800229void AudioMixer::invalidateState(uint32_t mask)
230{
Mathias Agopian65ab4712010-07-14 17:59:35 -0700231 if (mask) {
232 mState.needsChanged |= mask;
233 mState.hook = process__validate;
234 }
235 }
236
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700237status_t AudioMixer::initTrackDownmix(track_t* pTrack, int trackNum, audio_channel_mask_t mask)
238{
239 uint32_t channelCount = popcount(mask);
240 ALOG_ASSERT((channelCount <= MAX_NUM_CHANNELS_TO_DOWNMIX) && channelCount);
241 status_t status = OK;
242 if (channelCount > MAX_NUM_CHANNELS) {
243 pTrack->channelMask = mask;
244 pTrack->channelCount = channelCount;
245 ALOGV("initTrackDownmix(track=%d, mask=0x%x) calls prepareTrackForDownmix()",
246 trackNum, mask);
247 status = prepareTrackForDownmix(pTrack, trackNum);
248 } else {
249 unprepareTrackForDownmix(pTrack, trackNum);
250 }
251 return status;
252}
253
254void AudioMixer::unprepareTrackForDownmix(track_t* pTrack, int trackName) {
255 ALOGV("AudioMixer::unprepareTrackForDownmix(%d)", trackName);
256
257 if (pTrack->downmixerBufferProvider != NULL) {
258 // this track had previously been configured with a downmixer, delete it
259 ALOGV(" deleting old downmixer");
260 pTrack->bufferProvider = pTrack->downmixerBufferProvider->mTrackBufferProvider;
261 delete pTrack->downmixerBufferProvider;
262 pTrack->downmixerBufferProvider = NULL;
263 } else {
264 ALOGV(" nothing to do, no downmixer to delete");
265 }
266}
267
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700268status_t AudioMixer::prepareTrackForDownmix(track_t* pTrack, int trackName)
269{
270 ALOGV("AudioMixer::prepareTrackForDownmix(%d) with mask 0x%x", trackName, pTrack->channelMask);
271
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700272 // discard the previous downmixer if there was one
273 unprepareTrackForDownmix(pTrack, trackName);
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700274
275 DownmixerBufferProvider* pDbp = new DownmixerBufferProvider();
276 int32_t status;
277
278 if (!isMultichannelCapable) {
279 ALOGE("prepareTrackForDownmix(%d) fails: mixer doesn't support multichannel content",
280 trackName);
281 goto noDownmixForActiveTrack;
282 }
283
284 if (EffectCreate(&dwnmFxDesc.uuid,
Jean-Michel Trivid06e1322012-09-12 15:47:07 -0700285 pTrack->sessionId /*sessionId*/, -2 /*ioId not relevant here, using random value*/,
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700286 &pDbp->mDownmixHandle/*pHandle*/) != 0) {
287 ALOGE("prepareTrackForDownmix(%d) fails: error creating downmixer effect", trackName);
288 goto noDownmixForActiveTrack;
289 }
290
291 // channel input configuration will be overridden per-track
292 pDbp->mDownmixConfig.inputCfg.channels = pTrack->channelMask;
293 pDbp->mDownmixConfig.outputCfg.channels = AUDIO_CHANNEL_OUT_STEREO;
294 pDbp->mDownmixConfig.inputCfg.format = AUDIO_FORMAT_PCM_16_BIT;
295 pDbp->mDownmixConfig.outputCfg.format = AUDIO_FORMAT_PCM_16_BIT;
296 pDbp->mDownmixConfig.inputCfg.samplingRate = pTrack->sampleRate;
297 pDbp->mDownmixConfig.outputCfg.samplingRate = pTrack->sampleRate;
298 pDbp->mDownmixConfig.inputCfg.accessMode = EFFECT_BUFFER_ACCESS_READ;
299 pDbp->mDownmixConfig.outputCfg.accessMode = EFFECT_BUFFER_ACCESS_WRITE;
300 // input and output buffer provider, and frame count will not be used as the downmix effect
301 // process() function is called directly (see DownmixerBufferProvider::getNextBuffer())
302 pDbp->mDownmixConfig.inputCfg.mask = EFFECT_CONFIG_SMP_RATE | EFFECT_CONFIG_CHANNELS |
303 EFFECT_CONFIG_FORMAT | EFFECT_CONFIG_ACC_MODE;
304 pDbp->mDownmixConfig.outputCfg.mask = pDbp->mDownmixConfig.inputCfg.mask;
305
306 {// scope for local variables that are not used in goto label "noDownmixForActiveTrack"
307 int cmdStatus;
308 uint32_t replySize = sizeof(int);
309
310 // Configure and enable downmixer
311 status = (*pDbp->mDownmixHandle)->command(pDbp->mDownmixHandle,
312 EFFECT_CMD_SET_CONFIG /*cmdCode*/, sizeof(effect_config_t) /*cmdSize*/,
313 &pDbp->mDownmixConfig /*pCmdData*/,
314 &replySize /*replySize*/, &cmdStatus /*pReplyData*/);
315 if ((status != 0) || (cmdStatus != 0)) {
316 ALOGE("error %d while configuring downmixer for track %d", status, trackName);
317 goto noDownmixForActiveTrack;
318 }
319 replySize = sizeof(int);
320 status = (*pDbp->mDownmixHandle)->command(pDbp->mDownmixHandle,
321 EFFECT_CMD_ENABLE /*cmdCode*/, 0 /*cmdSize*/, NULL /*pCmdData*/,
322 &replySize /*replySize*/, &cmdStatus /*pReplyData*/);
323 if ((status != 0) || (cmdStatus != 0)) {
324 ALOGE("error %d while enabling downmixer for track %d", status, trackName);
325 goto noDownmixForActiveTrack;
326 }
327
328 // Set downmix type
329 // parameter size rounded for padding on 32bit boundary
330 const int psizePadded = ((sizeof(downmix_params_t) - 1)/sizeof(int) + 1) * sizeof(int);
331 const int downmixParamSize =
332 sizeof(effect_param_t) + psizePadded + sizeof(downmix_type_t);
333 effect_param_t * const param = (effect_param_t *) malloc(downmixParamSize);
334 param->psize = sizeof(downmix_params_t);
335 const downmix_params_t downmixParam = DOWNMIX_PARAM_TYPE;
336 memcpy(param->data, &downmixParam, param->psize);
337 const downmix_type_t downmixType = DOWNMIX_TYPE_FOLD;
338 param->vsize = sizeof(downmix_type_t);
339 memcpy(param->data + psizePadded, &downmixType, param->vsize);
340
341 status = (*pDbp->mDownmixHandle)->command(pDbp->mDownmixHandle,
342 EFFECT_CMD_SET_PARAM /* cmdCode */, downmixParamSize/* cmdSize */,
343 param /*pCmndData*/, &replySize /*replySize*/, &cmdStatus /*pReplyData*/);
344
345 free(param);
346
347 if ((status != 0) || (cmdStatus != 0)) {
348 ALOGE("error %d while setting downmix type for track %d", status, trackName);
349 goto noDownmixForActiveTrack;
350 } else {
351 ALOGV("downmix type set to %d for track %d", (int) downmixType, trackName);
352 }
353 }// end of scope for local variables that are not used in goto label "noDownmixForActiveTrack"
354
355 // initialization successful:
356 // - keep track of the real buffer provider in case it was set before
357 pDbp->mTrackBufferProvider = pTrack->bufferProvider;
358 // - we'll use the downmix effect integrated inside this
359 // track's buffer provider, and we'll use it as the track's buffer provider
360 pTrack->downmixerBufferProvider = pDbp;
361 pTrack->bufferProvider = pDbp;
362
363 return NO_ERROR;
364
365noDownmixForActiveTrack:
366 delete pDbp;
367 pTrack->downmixerBufferProvider = NULL;
368 return NO_INIT;
369}
370
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800371void AudioMixer::deleteTrackName(int name)
372{
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700373 ALOGV("AudioMixer::deleteTrackName(%d)", name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700374 name -= TRACK0;
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800375 ALOG_ASSERT(uint32_t(name) < MAX_NUM_TRACKS, "bad track name %d", name);
Glenn Kasten237a6242011-12-15 15:32:27 -0800376 ALOGV("deleteTrackName(%d)", name);
377 track_t& track(mState.tracks[ name ]);
Glenn Kasten4c340c62012-01-27 12:33:54 -0800378 if (track.enabled) {
379 track.enabled = false;
Glenn Kasten237a6242011-12-15 15:32:27 -0800380 invalidateState(1<<name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700381 }
Glenn Kasten4e2293f2012-04-12 09:39:07 -0700382 // delete the resampler
383 delete track.resampler;
384 track.resampler = NULL;
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700385 // delete the downmixer
386 unprepareTrackForDownmix(&mState.tracks[name], name);
387
Glenn Kasten237a6242011-12-15 15:32:27 -0800388 mTrackNames &= ~(1<<name);
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800389}
Mathias Agopian65ab4712010-07-14 17:59:35 -0700390
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800391void AudioMixer::enable(int name)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700392{
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800393 name -= TRACK0;
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800394 ALOG_ASSERT(uint32_t(name) < MAX_NUM_TRACKS, "bad track name %d", name);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800395 track_t& track = mState.tracks[name];
396
Glenn Kasten4c340c62012-01-27 12:33:54 -0800397 if (!track.enabled) {
398 track.enabled = true;
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800399 ALOGV("enable(%d)", name);
400 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700401 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700402}
403
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800404void AudioMixer::disable(int name)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700405{
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800406 name -= TRACK0;
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800407 ALOG_ASSERT(uint32_t(name) < MAX_NUM_TRACKS, "bad track name %d", name);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800408 track_t& track = mState.tracks[name];
409
Glenn Kasten4c340c62012-01-27 12:33:54 -0800410 if (track.enabled) {
411 track.enabled = false;
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800412 ALOGV("disable(%d)", name);
413 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700414 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700415}
416
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800417void AudioMixer::setParameter(int name, int target, int param, void *value)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700418{
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800419 name -= TRACK0;
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800420 ALOG_ASSERT(uint32_t(name) < MAX_NUM_TRACKS, "bad track name %d", name);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800421 track_t& track = mState.tracks[name];
Mathias Agopian65ab4712010-07-14 17:59:35 -0700422
Mathias Agopian65ab4712010-07-14 17:59:35 -0700423 int valueInt = (int)value;
424 int32_t *valueBuf = (int32_t *)value;
425
426 switch (target) {
Glenn Kasten788040c2011-05-05 08:19:00 -0700427
Mathias Agopian65ab4712010-07-14 17:59:35 -0700428 case TRACK:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800429 switch (param) {
Glenn Kasten788040c2011-05-05 08:19:00 -0700430 case CHANNEL_MASK: {
Glenn Kasten254af182012-07-03 14:59:05 -0700431 audio_channel_mask_t mask = (audio_channel_mask_t) value;
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800432 if (track.channelMask != mask) {
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800433 uint32_t channelCount = popcount(mask);
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700434 ALOG_ASSERT((channelCount <= MAX_NUM_CHANNELS_TO_DOWNMIX) && channelCount);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800435 track.channelMask = mask;
436 track.channelCount = channelCount;
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700437 // the mask has changed, does this track need a downmixer?
438 initTrackDownmix(&mState.tracks[name], name, mask);
Glenn Kasten788040c2011-05-05 08:19:00 -0700439 ALOGV("setParameter(TRACK, CHANNEL_MASK, %x)", mask);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800440 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700441 }
Glenn Kasten788040c2011-05-05 08:19:00 -0700442 } break;
443 case MAIN_BUFFER:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800444 if (track.mainBuffer != valueBuf) {
445 track.mainBuffer = valueBuf;
Steve Block3856b092011-10-20 11:56:00 +0100446 ALOGV("setParameter(TRACK, MAIN_BUFFER, %p)", valueBuf);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800447 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700448 }
Glenn Kasten788040c2011-05-05 08:19:00 -0700449 break;
450 case AUX_BUFFER:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800451 if (track.auxBuffer != valueBuf) {
452 track.auxBuffer = valueBuf;
Steve Block3856b092011-10-20 11:56:00 +0100453 ALOGV("setParameter(TRACK, AUX_BUFFER, %p)", valueBuf);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800454 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700455 }
Glenn Kasten788040c2011-05-05 08:19:00 -0700456 break;
Glenn Kastendeeb1282012-03-25 11:59:31 -0700457 case FORMAT:
458 ALOG_ASSERT(valueInt == AUDIO_FORMAT_PCM_16_BIT);
459 break;
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700460 // FIXME do we want to support setting the downmix type from AudioFlinger?
461 // for a specific track? or per mixer?
462 /* case DOWNMIX_TYPE:
463 break */
Glenn Kasten788040c2011-05-05 08:19:00 -0700464 default:
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800465 LOG_FATAL("bad param");
Mathias Agopian65ab4712010-07-14 17:59:35 -0700466 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700467 break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700468
Mathias Agopian65ab4712010-07-14 17:59:35 -0700469 case RESAMPLE:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800470 switch (param) {
471 case SAMPLE_RATE:
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800472 ALOG_ASSERT(valueInt > 0, "bad sample rate %d", valueInt);
Glenn Kasten788040c2011-05-05 08:19:00 -0700473 if (track.setResampler(uint32_t(valueInt), mSampleRate)) {
474 ALOGV("setParameter(RESAMPLE, SAMPLE_RATE, %u)",
475 uint32_t(valueInt));
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800476 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700477 }
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800478 break;
479 case RESET:
Eric Laurent243f5f92011-02-28 16:52:51 -0800480 track.resetResampler();
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800481 invalidateState(1 << name);
482 break;
Glenn Kasten4e2293f2012-04-12 09:39:07 -0700483 case REMOVE:
484 delete track.resampler;
485 track.resampler = NULL;
486 track.sampleRate = mSampleRate;
487 invalidateState(1 << name);
488 break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700489 default:
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800490 LOG_FATAL("bad param");
Eric Laurent243f5f92011-02-28 16:52:51 -0800491 }
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 RAMP_VOLUME:
495 case VOLUME:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800496 switch (param) {
Glenn Kasten788040c2011-05-05 08:19:00 -0700497 case VOLUME0:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800498 case VOLUME1:
499 if (track.volume[param-VOLUME0] != valueInt) {
Steve Block3856b092011-10-20 11:56:00 +0100500 ALOGV("setParameter(VOLUME, VOLUME0/1: %04x)", valueInt);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800501 track.prevVolume[param-VOLUME0] = track.volume[param-VOLUME0] << 16;
502 track.volume[param-VOLUME0] = valueInt;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700503 if (target == VOLUME) {
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800504 track.prevVolume[param-VOLUME0] = valueInt << 16;
505 track.volumeInc[param-VOLUME0] = 0;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700506 } else {
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800507 int32_t d = (valueInt<<16) - track.prevVolume[param-VOLUME0];
Mathias Agopian65ab4712010-07-14 17:59:35 -0700508 int32_t volInc = d / int32_t(mState.frameCount);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800509 track.volumeInc[param-VOLUME0] = volInc;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700510 if (volInc == 0) {
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800511 track.prevVolume[param-VOLUME0] = valueInt << 16;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700512 }
513 }
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800514 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700515 }
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800516 break;
517 case AUXLEVEL:
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800518 //ALOG_ASSERT(0 <= valueInt && valueInt <= MAX_GAIN_INT, "bad aux level %d", valueInt);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700519 if (track.auxLevel != valueInt) {
Steve Block3856b092011-10-20 11:56:00 +0100520 ALOGV("setParameter(VOLUME, AUXLEVEL: %04x)", valueInt);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700521 track.prevAuxLevel = track.auxLevel << 16;
522 track.auxLevel = valueInt;
523 if (target == VOLUME) {
524 track.prevAuxLevel = valueInt << 16;
525 track.auxInc = 0;
526 } else {
527 int32_t d = (valueInt<<16) - track.prevAuxLevel;
528 int32_t volInc = d / int32_t(mState.frameCount);
529 track.auxInc = volInc;
530 if (volInc == 0) {
531 track.prevAuxLevel = valueInt << 16;
532 }
533 }
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800534 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700535 }
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800536 break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700537 default:
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800538 LOG_FATAL("bad param");
Mathias Agopian65ab4712010-07-14 17:59:35 -0700539 }
540 break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700541
542 default:
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800543 LOG_FATAL("bad target");
Mathias Agopian65ab4712010-07-14 17:59:35 -0700544 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700545}
546
547bool AudioMixer::track_t::setResampler(uint32_t value, uint32_t devSampleRate)
548{
Glenn Kasten4e2293f2012-04-12 09:39:07 -0700549 if (value != devSampleRate || resampler != NULL) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700550 if (sampleRate != value) {
551 sampleRate = value;
Glenn Kastene0feee32011-12-13 11:53:26 -0800552 if (resampler == NULL) {
Glenn Kastenac602052012-10-01 14:04:31 -0700553 ALOGV("creating resampler from track %d Hz to device %d Hz", value, devSampleRate);
554 AudioResampler::src_quality quality;
555 // force lowest quality level resampler if use case isn't music or video
556 // FIXME this is flawed for dynamic sample rates, as we choose the resampler
557 // quality level based on the initial ratio, but that could change later.
558 // Should have a way to distinguish tracks with static ratios vs. dynamic ratios.
559 if (!((value == 44100 && devSampleRate == 48000) ||
560 (value == 48000 && devSampleRate == 44100))) {
561 quality = AudioResampler::LOW_QUALITY;
562 } else {
563 quality = AudioResampler::DEFAULT_QUALITY;
564 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700565 resampler = AudioResampler::create(
Jean-Michel Triviacb86cc2012-04-16 12:43:57 -0700566 format,
567 // the resampler sees the number of channels after the downmixer, if any
568 downmixerBufferProvider != NULL ? MAX_NUM_CHANNELS : channelCount,
Glenn Kastenac602052012-10-01 14:04:31 -0700569 devSampleRate, quality);
Glenn Kasten52008f82012-03-18 09:34:41 -0700570 resampler->setLocalTimeFreq(sLocalTimeFreq);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700571 }
572 return true;
573 }
574 }
575 return false;
576}
577
Mathias Agopian65ab4712010-07-14 17:59:35 -0700578inline
579void AudioMixer::track_t::adjustVolumeRamp(bool aux)
580{
Glenn Kastenf9a27772012-01-06 07:47:26 -0800581 for (uint32_t i=0 ; i<MAX_NUM_CHANNELS ; i++) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700582 if (((volumeInc[i]>0) && (((prevVolume[i]+volumeInc[i])>>16) >= volume[i])) ||
583 ((volumeInc[i]<0) && (((prevVolume[i]+volumeInc[i])>>16) <= volume[i]))) {
584 volumeInc[i] = 0;
585 prevVolume[i] = volume[i]<<16;
586 }
587 }
588 if (aux) {
589 if (((auxInc>0) && (((prevAuxLevel+auxInc)>>16) >= auxLevel)) ||
590 ((auxInc<0) && (((prevAuxLevel+auxInc)>>16) <= auxLevel))) {
591 auxInc = 0;
592 prevAuxLevel = auxLevel<<16;
593 }
594 }
595}
596
Glenn Kastenc59c0042012-02-02 14:06:11 -0800597size_t AudioMixer::getUnreleasedFrames(int name) const
Eric Laurent071ccd52011-12-22 16:08:41 -0800598{
599 name -= TRACK0;
600 if (uint32_t(name) < MAX_NUM_TRACKS) {
Glenn Kastenc59c0042012-02-02 14:06:11 -0800601 return mState.tracks[name].getUnreleasedFrames();
Eric Laurent071ccd52011-12-22 16:08:41 -0800602 }
603 return 0;
604}
Mathias Agopian65ab4712010-07-14 17:59:35 -0700605
Glenn Kasten01c4ebf2012-02-22 10:47:35 -0800606void AudioMixer::setBufferProvider(int name, AudioBufferProvider* bufferProvider)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700607{
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800608 name -= TRACK0;
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800609 ALOG_ASSERT(uint32_t(name) < MAX_NUM_TRACKS, "bad track name %d", name);
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700610
611 if (mState.tracks[name].downmixerBufferProvider != NULL) {
612 // update required?
613 if (mState.tracks[name].downmixerBufferProvider->mTrackBufferProvider != bufferProvider) {
614 ALOGV("AudioMixer::setBufferProvider(%p) for downmix", bufferProvider);
615 // setting the buffer provider for a track that gets downmixed consists in:
616 // 1/ setting the buffer provider to the "downmix / buffer provider" wrapper
617 // so it's the one that gets called when the buffer provider is needed,
618 mState.tracks[name].bufferProvider = mState.tracks[name].downmixerBufferProvider;
619 // 2/ saving the buffer provider for the track so the wrapper can use it
620 // when it downmixes.
621 mState.tracks[name].downmixerBufferProvider->mTrackBufferProvider = bufferProvider;
622 }
623 } else {
624 mState.tracks[name].bufferProvider = bufferProvider;
625 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700626}
627
628
John Grossman4ff14ba2012-02-08 16:37:41 -0800629void AudioMixer::process(int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700630{
John Grossman4ff14ba2012-02-08 16:37:41 -0800631 mState.hook(&mState, pts);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700632}
633
634
John Grossman4ff14ba2012-02-08 16:37:41 -0800635void AudioMixer::process__validate(state_t* state, int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700636{
Steve Block5ff1dd52012-01-05 23:22:43 +0000637 ALOGW_IF(!state->needsChanged,
Mathias Agopian65ab4712010-07-14 17:59:35 -0700638 "in process__validate() but nothing's invalid");
639
640 uint32_t changed = state->needsChanged;
641 state->needsChanged = 0; // clear the validation flag
642
643 // recompute which tracks are enabled / disabled
644 uint32_t enabled = 0;
645 uint32_t disabled = 0;
646 while (changed) {
647 const int i = 31 - __builtin_clz(changed);
648 const uint32_t mask = 1<<i;
649 changed &= ~mask;
650 track_t& t = state->tracks[i];
651 (t.enabled ? enabled : disabled) |= mask;
652 }
653 state->enabledTracks &= ~disabled;
654 state->enabledTracks |= enabled;
655
656 // compute everything we need...
657 int countActiveTracks = 0;
Glenn Kasten4c340c62012-01-27 12:33:54 -0800658 bool all16BitsStereoNoResample = true;
659 bool resampling = false;
660 bool volumeRamp = false;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700661 uint32_t en = state->enabledTracks;
662 while (en) {
663 const int i = 31 - __builtin_clz(en);
664 en &= ~(1<<i);
665
666 countActiveTracks++;
667 track_t& t = state->tracks[i];
668 uint32_t n = 0;
669 n |= NEEDS_CHANNEL_1 + t.channelCount - 1;
670 n |= NEEDS_FORMAT_16;
671 n |= t.doesResample() ? NEEDS_RESAMPLE_ENABLED : NEEDS_RESAMPLE_DISABLED;
672 if (t.auxLevel != 0 && t.auxBuffer != NULL) {
673 n |= NEEDS_AUX_ENABLED;
674 }
675
676 if (t.volumeInc[0]|t.volumeInc[1]) {
Glenn Kasten4c340c62012-01-27 12:33:54 -0800677 volumeRamp = true;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700678 } else if (!t.doesResample() && t.volumeRL == 0) {
679 n |= NEEDS_MUTE_ENABLED;
680 }
681 t.needs = n;
682
683 if ((n & NEEDS_MUTE__MASK) == NEEDS_MUTE_ENABLED) {
684 t.hook = track__nop;
685 } else {
686 if ((n & NEEDS_AUX__MASK) == NEEDS_AUX_ENABLED) {
Glenn Kasten4c340c62012-01-27 12:33:54 -0800687 all16BitsStereoNoResample = false;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700688 }
689 if ((n & NEEDS_RESAMPLE__MASK) == NEEDS_RESAMPLE_ENABLED) {
Glenn Kasten4c340c62012-01-27 12:33:54 -0800690 all16BitsStereoNoResample = false;
691 resampling = true;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700692 t.hook = track__genericResample;
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700693 ALOGV_IF((n & NEEDS_CHANNEL_COUNT__MASK) > NEEDS_CHANNEL_2,
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700694 "Track %d needs downmix + resample", i);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700695 } else {
696 if ((n & NEEDS_CHANNEL_COUNT__MASK) == NEEDS_CHANNEL_1){
697 t.hook = track__16BitsMono;
Glenn Kasten4c340c62012-01-27 12:33:54 -0800698 all16BitsStereoNoResample = false;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700699 }
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700700 if ((n & NEEDS_CHANNEL_COUNT__MASK) >= NEEDS_CHANNEL_2){
Mathias Agopian65ab4712010-07-14 17:59:35 -0700701 t.hook = track__16BitsStereo;
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700702 ALOGV_IF((n & NEEDS_CHANNEL_COUNT__MASK) > NEEDS_CHANNEL_2,
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700703 "Track %d needs downmix", i);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700704 }
705 }
706 }
707 }
708
709 // select the processing hooks
710 state->hook = process__nop;
711 if (countActiveTracks) {
712 if (resampling) {
713 if (!state->outputTemp) {
714 state->outputTemp = new int32_t[MAX_NUM_CHANNELS * state->frameCount];
715 }
716 if (!state->resampleTemp) {
717 state->resampleTemp = new int32_t[MAX_NUM_CHANNELS * state->frameCount];
718 }
719 state->hook = process__genericResampling;
720 } else {
721 if (state->outputTemp) {
722 delete [] state->outputTemp;
Glenn Kastene0feee32011-12-13 11:53:26 -0800723 state->outputTemp = NULL;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700724 }
725 if (state->resampleTemp) {
726 delete [] state->resampleTemp;
Glenn Kastene0feee32011-12-13 11:53:26 -0800727 state->resampleTemp = NULL;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700728 }
729 state->hook = process__genericNoResampling;
730 if (all16BitsStereoNoResample && !volumeRamp) {
731 if (countActiveTracks == 1) {
732 state->hook = process__OneTrack16BitsStereoNoResampling;
733 }
734 }
735 }
736 }
737
Steve Block3856b092011-10-20 11:56:00 +0100738 ALOGV("mixer configuration change: %d activeTracks (%08x) "
Mathias Agopian65ab4712010-07-14 17:59:35 -0700739 "all16BitsStereoNoResample=%d, resampling=%d, volumeRamp=%d",
740 countActiveTracks, state->enabledTracks,
741 all16BitsStereoNoResample, resampling, volumeRamp);
742
John Grossman4ff14ba2012-02-08 16:37:41 -0800743 state->hook(state, pts);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700744
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800745 // Now that the volume ramp has been done, set optimal state and
746 // track hooks for subsequent mixer process
747 if (countActiveTracks) {
Glenn Kasten4c340c62012-01-27 12:33:54 -0800748 bool allMuted = true;
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800749 uint32_t en = state->enabledTracks;
750 while (en) {
751 const int i = 31 - __builtin_clz(en);
752 en &= ~(1<<i);
753 track_t& t = state->tracks[i];
754 if (!t.doesResample() && t.volumeRL == 0)
755 {
756 t.needs |= NEEDS_MUTE_ENABLED;
757 t.hook = track__nop;
758 } else {
Glenn Kasten4c340c62012-01-27 12:33:54 -0800759 allMuted = false;
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800760 }
761 }
762 if (allMuted) {
763 state->hook = process__nop;
764 } else if (all16BitsStereoNoResample) {
765 if (countActiveTracks == 1) {
766 state->hook = process__OneTrack16BitsStereoNoResampling;
767 }
768 }
769 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700770}
771
Mathias Agopian65ab4712010-07-14 17:59:35 -0700772
Glenn Kasten85ab62c2012-11-01 11:11:38 -0700773void AudioMixer::track__genericResample(track_t* t, int32_t* out, size_t outFrameCount,
774 int32_t* temp, int32_t* aux)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700775{
776 t->resampler->setSampleRate(t->sampleRate);
777
778 // ramp gain - resample to temp buffer and scale/mix in 2nd step
779 if (aux != NULL) {
780 // always resample with unity gain when sending to auxiliary buffer to be able
781 // to apply send level after resampling
782 // TODO: modify each resampler to support aux channel?
783 t->resampler->setVolume(UNITY_GAIN, UNITY_GAIN);
784 memset(temp, 0, outFrameCount * MAX_NUM_CHANNELS * sizeof(int32_t));
785 t->resampler->resample(temp, outFrameCount, t->bufferProvider);
Glenn Kastenf6b16782011-12-15 09:51:17 -0800786 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1]|t->auxInc)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700787 volumeRampStereo(t, out, outFrameCount, temp, aux);
788 } else {
789 volumeStereo(t, out, outFrameCount, temp, aux);
790 }
791 } else {
Glenn Kastenf6b16782011-12-15 09:51:17 -0800792 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1])) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700793 t->resampler->setVolume(UNITY_GAIN, UNITY_GAIN);
794 memset(temp, 0, outFrameCount * MAX_NUM_CHANNELS * sizeof(int32_t));
795 t->resampler->resample(temp, outFrameCount, t->bufferProvider);
796 volumeRampStereo(t, out, outFrameCount, temp, aux);
797 }
798
799 // constant gain
800 else {
801 t->resampler->setVolume(t->volume[0], t->volume[1]);
802 t->resampler->resample(out, outFrameCount, t->bufferProvider);
803 }
804 }
805}
806
Glenn Kasten85ab62c2012-11-01 11:11:38 -0700807void AudioMixer::track__nop(track_t* t, int32_t* out, size_t outFrameCount, int32_t* temp,
808 int32_t* aux)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700809{
810}
811
Glenn Kasten85ab62c2012-11-01 11:11:38 -0700812void AudioMixer::volumeRampStereo(track_t* t, int32_t* out, size_t frameCount, int32_t* temp,
813 int32_t* aux)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700814{
815 int32_t vl = t->prevVolume[0];
816 int32_t vr = t->prevVolume[1];
817 const int32_t vlInc = t->volumeInc[0];
818 const int32_t vrInc = t->volumeInc[1];
819
Steve Blockb8a80522011-12-20 16:23:08 +0000820 //ALOGD("[0] %p: inc=%f, v0=%f, v1=%d, final=%f, count=%d",
Mathias Agopian65ab4712010-07-14 17:59:35 -0700821 // t, vlInc/65536.0f, vl/65536.0f, t->volume[0],
822 // (vl + vlInc*frameCount)/65536.0f, frameCount);
823
824 // ramp volume
Glenn Kastenf6b16782011-12-15 09:51:17 -0800825 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700826 int32_t va = t->prevAuxLevel;
827 const int32_t vaInc = t->auxInc;
828 int32_t l;
829 int32_t r;
830
831 do {
832 l = (*temp++ >> 12);
833 r = (*temp++ >> 12);
834 *out++ += (vl >> 16) * l;
835 *out++ += (vr >> 16) * r;
836 *aux++ += (va >> 17) * (l + r);
837 vl += vlInc;
838 vr += vrInc;
839 va += vaInc;
840 } while (--frameCount);
841 t->prevAuxLevel = va;
842 } else {
843 do {
844 *out++ += (vl >> 16) * (*temp++ >> 12);
845 *out++ += (vr >> 16) * (*temp++ >> 12);
846 vl += vlInc;
847 vr += vrInc;
848 } while (--frameCount);
849 }
850 t->prevVolume[0] = vl;
851 t->prevVolume[1] = vr;
Glenn Kastena1117922012-01-26 10:53:32 -0800852 t->adjustVolumeRamp(aux != NULL);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700853}
854
Glenn Kasten85ab62c2012-11-01 11:11:38 -0700855void AudioMixer::volumeStereo(track_t* t, int32_t* out, size_t frameCount, int32_t* temp,
856 int32_t* aux)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700857{
858 const int16_t vl = t->volume[0];
859 const int16_t vr = t->volume[1];
860
Glenn Kastenf6b16782011-12-15 09:51:17 -0800861 if (CC_UNLIKELY(aux != NULL)) {
Glenn Kasten3b81aca2012-01-27 15:26:23 -0800862 const int16_t va = t->auxLevel;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700863 do {
864 int16_t l = (int16_t)(*temp++ >> 12);
865 int16_t r = (int16_t)(*temp++ >> 12);
866 out[0] = mulAdd(l, vl, out[0]);
867 int16_t a = (int16_t)(((int32_t)l + r) >> 1);
868 out[1] = mulAdd(r, vr, out[1]);
869 out += 2;
870 aux[0] = mulAdd(a, va, aux[0]);
871 aux++;
872 } while (--frameCount);
873 } else {
874 do {
875 int16_t l = (int16_t)(*temp++ >> 12);
876 int16_t r = (int16_t)(*temp++ >> 12);
877 out[0] = mulAdd(l, vl, out[0]);
878 out[1] = mulAdd(r, vr, out[1]);
879 out += 2;
880 } while (--frameCount);
881 }
882}
883
Glenn Kasten85ab62c2012-11-01 11:11:38 -0700884void AudioMixer::track__16BitsStereo(track_t* t, int32_t* out, size_t frameCount, int32_t* temp,
885 int32_t* aux)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700886{
Glenn Kasten54c3b662012-01-06 07:46:30 -0800887 const int16_t *in = static_cast<const int16_t *>(t->in);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700888
Glenn Kastenf6b16782011-12-15 09:51:17 -0800889 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700890 int32_t l;
891 int32_t r;
892 // ramp gain
Glenn Kastenf6b16782011-12-15 09:51:17 -0800893 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1]|t->auxInc)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700894 int32_t vl = t->prevVolume[0];
895 int32_t vr = t->prevVolume[1];
896 int32_t va = t->prevAuxLevel;
897 const int32_t vlInc = t->volumeInc[0];
898 const int32_t vrInc = t->volumeInc[1];
899 const int32_t vaInc = t->auxInc;
Steve Blockb8a80522011-12-20 16:23:08 +0000900 // ALOGD("[1] %p: inc=%f, v0=%f, v1=%d, final=%f, count=%d",
Mathias Agopian65ab4712010-07-14 17:59:35 -0700901 // t, vlInc/65536.0f, vl/65536.0f, t->volume[0],
902 // (vl + vlInc*frameCount)/65536.0f, frameCount);
903
904 do {
905 l = (int32_t)*in++;
906 r = (int32_t)*in++;
907 *out++ += (vl >> 16) * l;
908 *out++ += (vr >> 16) * r;
909 *aux++ += (va >> 17) * (l + r);
910 vl += vlInc;
911 vr += vrInc;
912 va += vaInc;
913 } while (--frameCount);
914
915 t->prevVolume[0] = vl;
916 t->prevVolume[1] = vr;
917 t->prevAuxLevel = va;
918 t->adjustVolumeRamp(true);
919 }
920
921 // constant gain
922 else {
923 const uint32_t vrl = t->volumeRL;
924 const int16_t va = (int16_t)t->auxLevel;
925 do {
Glenn Kasten54c3b662012-01-06 07:46:30 -0800926 uint32_t rl = *reinterpret_cast<const uint32_t *>(in);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700927 int16_t a = (int16_t)(((int32_t)in[0] + in[1]) >> 1);
928 in += 2;
929 out[0] = mulAddRL(1, rl, vrl, out[0]);
930 out[1] = mulAddRL(0, rl, vrl, out[1]);
931 out += 2;
932 aux[0] = mulAdd(a, va, aux[0]);
933 aux++;
934 } while (--frameCount);
935 }
936 } else {
937 // ramp gain
Glenn Kastenf6b16782011-12-15 09:51:17 -0800938 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1])) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700939 int32_t vl = t->prevVolume[0];
940 int32_t vr = t->prevVolume[1];
941 const int32_t vlInc = t->volumeInc[0];
942 const int32_t vrInc = t->volumeInc[1];
943
Steve Blockb8a80522011-12-20 16:23:08 +0000944 // ALOGD("[1] %p: inc=%f, v0=%f, v1=%d, final=%f, count=%d",
Mathias Agopian65ab4712010-07-14 17:59:35 -0700945 // t, vlInc/65536.0f, vl/65536.0f, t->volume[0],
946 // (vl + vlInc*frameCount)/65536.0f, frameCount);
947
948 do {
949 *out++ += (vl >> 16) * (int32_t) *in++;
950 *out++ += (vr >> 16) * (int32_t) *in++;
951 vl += vlInc;
952 vr += vrInc;
953 } while (--frameCount);
954
955 t->prevVolume[0] = vl;
956 t->prevVolume[1] = vr;
957 t->adjustVolumeRamp(false);
958 }
959
960 // constant gain
961 else {
962 const uint32_t vrl = t->volumeRL;
963 do {
Glenn Kasten54c3b662012-01-06 07:46:30 -0800964 uint32_t rl = *reinterpret_cast<const uint32_t *>(in);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700965 in += 2;
966 out[0] = mulAddRL(1, rl, vrl, out[0]);
967 out[1] = mulAddRL(0, rl, vrl, out[1]);
968 out += 2;
969 } while (--frameCount);
970 }
971 }
972 t->in = in;
973}
974
Glenn Kasten85ab62c2012-11-01 11:11:38 -0700975void AudioMixer::track__16BitsMono(track_t* t, int32_t* out, size_t frameCount, int32_t* temp,
976 int32_t* aux)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700977{
Glenn Kasten54c3b662012-01-06 07:46:30 -0800978 const int16_t *in = static_cast<int16_t const *>(t->in);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700979
Glenn Kastenf6b16782011-12-15 09:51:17 -0800980 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700981 // ramp gain
Glenn Kastenf6b16782011-12-15 09:51:17 -0800982 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1]|t->auxInc)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700983 int32_t vl = t->prevVolume[0];
984 int32_t vr = t->prevVolume[1];
985 int32_t va = t->prevAuxLevel;
986 const int32_t vlInc = t->volumeInc[0];
987 const int32_t vrInc = t->volumeInc[1];
988 const int32_t vaInc = t->auxInc;
989
Steve Blockb8a80522011-12-20 16:23:08 +0000990 // ALOGD("[2] %p: inc=%f, v0=%f, v1=%d, final=%f, count=%d",
Mathias Agopian65ab4712010-07-14 17:59:35 -0700991 // t, vlInc/65536.0f, vl/65536.0f, t->volume[0],
992 // (vl + vlInc*frameCount)/65536.0f, frameCount);
993
994 do {
995 int32_t l = *in++;
996 *out++ += (vl >> 16) * l;
997 *out++ += (vr >> 16) * l;
998 *aux++ += (va >> 16) * l;
999 vl += vlInc;
1000 vr += vrInc;
1001 va += vaInc;
1002 } while (--frameCount);
1003
1004 t->prevVolume[0] = vl;
1005 t->prevVolume[1] = vr;
1006 t->prevAuxLevel = va;
1007 t->adjustVolumeRamp(true);
1008 }
1009 // constant gain
1010 else {
1011 const int16_t vl = t->volume[0];
1012 const int16_t vr = t->volume[1];
1013 const int16_t va = (int16_t)t->auxLevel;
1014 do {
1015 int16_t l = *in++;
1016 out[0] = mulAdd(l, vl, out[0]);
1017 out[1] = mulAdd(l, vr, out[1]);
1018 out += 2;
1019 aux[0] = mulAdd(l, va, aux[0]);
1020 aux++;
1021 } while (--frameCount);
1022 }
1023 } else {
1024 // ramp gain
Glenn Kastenf6b16782011-12-15 09:51:17 -08001025 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1])) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001026 int32_t vl = t->prevVolume[0];
1027 int32_t vr = t->prevVolume[1];
1028 const int32_t vlInc = t->volumeInc[0];
1029 const int32_t vrInc = t->volumeInc[1];
1030
Steve Blockb8a80522011-12-20 16:23:08 +00001031 // ALOGD("[2] %p: inc=%f, v0=%f, v1=%d, final=%f, count=%d",
Mathias Agopian65ab4712010-07-14 17:59:35 -07001032 // t, vlInc/65536.0f, vl/65536.0f, t->volume[0],
1033 // (vl + vlInc*frameCount)/65536.0f, frameCount);
1034
1035 do {
1036 int32_t l = *in++;
1037 *out++ += (vl >> 16) * l;
1038 *out++ += (vr >> 16) * l;
1039 vl += vlInc;
1040 vr += vrInc;
1041 } while (--frameCount);
1042
1043 t->prevVolume[0] = vl;
1044 t->prevVolume[1] = vr;
1045 t->adjustVolumeRamp(false);
1046 }
1047 // constant gain
1048 else {
1049 const int16_t vl = t->volume[0];
1050 const int16_t vr = t->volume[1];
1051 do {
1052 int16_t l = *in++;
1053 out[0] = mulAdd(l, vl, out[0]);
1054 out[1] = mulAdd(l, vr, out[1]);
1055 out += 2;
1056 } while (--frameCount);
1057 }
1058 }
1059 t->in = in;
1060}
1061
Mathias Agopian65ab4712010-07-14 17:59:35 -07001062// no-op case
John Grossman4ff14ba2012-02-08 16:37:41 -08001063void AudioMixer::process__nop(state_t* state, int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001064{
1065 uint32_t e0 = state->enabledTracks;
1066 size_t bufSize = state->frameCount * sizeof(int16_t) * MAX_NUM_CHANNELS;
1067 while (e0) {
1068 // process by group of tracks with same output buffer to
1069 // avoid multiple memset() on same buffer
1070 uint32_t e1 = e0, e2 = e0;
1071 int i = 31 - __builtin_clz(e1);
Glenn Kastenfc900c92013-02-18 12:47:49 -08001072 {
1073 track_t& t1 = state->tracks[i];
Mathias Agopian65ab4712010-07-14 17:59:35 -07001074 e2 &= ~(1<<i);
Glenn Kastenfc900c92013-02-18 12:47:49 -08001075 while (e2) {
1076 i = 31 - __builtin_clz(e2);
1077 e2 &= ~(1<<i);
1078 track_t& t2 = state->tracks[i];
1079 if (CC_UNLIKELY(t2.mainBuffer != t1.mainBuffer)) {
1080 e1 &= ~(1<<i);
1081 }
Mathias Agopian65ab4712010-07-14 17:59:35 -07001082 }
Glenn Kastenfc900c92013-02-18 12:47:49 -08001083 e0 &= ~(e1);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001084
Glenn Kastenfc900c92013-02-18 12:47:49 -08001085 memset(t1.mainBuffer, 0, bufSize);
1086 }
Mathias Agopian65ab4712010-07-14 17:59:35 -07001087
1088 while (e1) {
1089 i = 31 - __builtin_clz(e1);
1090 e1 &= ~(1<<i);
Glenn Kastenfc900c92013-02-18 12:47:49 -08001091 {
1092 track_t& t3 = state->tracks[i];
1093 size_t outFrames = state->frameCount;
1094 while (outFrames) {
1095 t3.buffer.frameCount = outFrames;
1096 int64_t outputPTS = calculateOutputPTS(
1097 t3, pts, state->frameCount - outFrames);
1098 t3.bufferProvider->getNextBuffer(&t3.buffer, outputPTS);
1099 if (t3.buffer.raw == NULL) break;
1100 outFrames -= t3.buffer.frameCount;
1101 t3.bufferProvider->releaseBuffer(&t3.buffer);
1102 }
Mathias Agopian65ab4712010-07-14 17:59:35 -07001103 }
1104 }
1105 }
1106}
1107
1108// generic code without resampling
John Grossman4ff14ba2012-02-08 16:37:41 -08001109void AudioMixer::process__genericNoResampling(state_t* state, int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001110{
1111 int32_t outTemp[BLOCKSIZE * MAX_NUM_CHANNELS] __attribute__((aligned(32)));
1112
1113 // acquire each track's buffer
1114 uint32_t enabledTracks = state->enabledTracks;
1115 uint32_t e0 = enabledTracks;
1116 while (e0) {
1117 const int i = 31 - __builtin_clz(e0);
1118 e0 &= ~(1<<i);
1119 track_t& t = state->tracks[i];
1120 t.buffer.frameCount = state->frameCount;
John Grossman4ff14ba2012-02-08 16:37:41 -08001121 t.bufferProvider->getNextBuffer(&t.buffer, pts);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001122 t.frameCount = t.buffer.frameCount;
1123 t.in = t.buffer.raw;
1124 // t.in == NULL can happen if the track was flushed just after having
1125 // been enabled for mixing.
1126 if (t.in == NULL)
1127 enabledTracks &= ~(1<<i);
1128 }
1129
1130 e0 = enabledTracks;
1131 while (e0) {
1132 // process by group of tracks with same output buffer to
1133 // optimize cache use
1134 uint32_t e1 = e0, e2 = e0;
1135 int j = 31 - __builtin_clz(e1);
1136 track_t& t1 = state->tracks[j];
1137 e2 &= ~(1<<j);
1138 while (e2) {
1139 j = 31 - __builtin_clz(e2);
1140 e2 &= ~(1<<j);
1141 track_t& t2 = state->tracks[j];
Glenn Kastenf6b16782011-12-15 09:51:17 -08001142 if (CC_UNLIKELY(t2.mainBuffer != t1.mainBuffer)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001143 e1 &= ~(1<<j);
1144 }
1145 }
1146 e0 &= ~(e1);
1147 // this assumes output 16 bits stereo, no resampling
1148 int32_t *out = t1.mainBuffer;
1149 size_t numFrames = 0;
1150 do {
1151 memset(outTemp, 0, sizeof(outTemp));
1152 e2 = e1;
1153 while (e2) {
1154 const int i = 31 - __builtin_clz(e2);
1155 e2 &= ~(1<<i);
1156 track_t& t = state->tracks[i];
1157 size_t outFrames = BLOCKSIZE;
1158 int32_t *aux = NULL;
Glenn Kastenf6b16782011-12-15 09:51:17 -08001159 if (CC_UNLIKELY((t.needs & NEEDS_AUX__MASK) == NEEDS_AUX_ENABLED)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001160 aux = t.auxBuffer + numFrames;
1161 }
1162 while (outFrames) {
1163 size_t inFrames = (t.frameCount > outFrames)?outFrames:t.frameCount;
1164 if (inFrames) {
Glenn Kasten85ab62c2012-11-01 11:11:38 -07001165 t.hook(&t, outTemp + (BLOCKSIZE-outFrames)*MAX_NUM_CHANNELS, inFrames,
1166 state->resampleTemp, aux);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001167 t.frameCount -= inFrames;
1168 outFrames -= inFrames;
Glenn Kastenf6b16782011-12-15 09:51:17 -08001169 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001170 aux += inFrames;
1171 }
1172 }
1173 if (t.frameCount == 0 && outFrames) {
1174 t.bufferProvider->releaseBuffer(&t.buffer);
Glenn Kasten85ab62c2012-11-01 11:11:38 -07001175 t.buffer.frameCount = (state->frameCount - numFrames) -
1176 (BLOCKSIZE - outFrames);
John Grossman4ff14ba2012-02-08 16:37:41 -08001177 int64_t outputPTS = calculateOutputPTS(
1178 t, pts, numFrames + (BLOCKSIZE - outFrames));
1179 t.bufferProvider->getNextBuffer(&t.buffer, outputPTS);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001180 t.in = t.buffer.raw;
1181 if (t.in == NULL) {
1182 enabledTracks &= ~(1<<i);
1183 e1 &= ~(1<<i);
1184 break;
1185 }
1186 t.frameCount = t.buffer.frameCount;
1187 }
1188 }
1189 }
1190 ditherAndClamp(out, outTemp, BLOCKSIZE);
1191 out += BLOCKSIZE;
1192 numFrames += BLOCKSIZE;
1193 } while (numFrames < state->frameCount);
1194 }
1195
1196 // release each track's buffer
1197 e0 = enabledTracks;
1198 while (e0) {
1199 const int i = 31 - __builtin_clz(e0);
1200 e0 &= ~(1<<i);
1201 track_t& t = state->tracks[i];
1202 t.bufferProvider->releaseBuffer(&t.buffer);
1203 }
1204}
1205
1206
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -08001207// generic code with resampling
John Grossman4ff14ba2012-02-08 16:37:41 -08001208void AudioMixer::process__genericResampling(state_t* state, int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001209{
Glenn Kasten54c3b662012-01-06 07:46:30 -08001210 // this const just means that local variable outTemp doesn't change
Mathias Agopian65ab4712010-07-14 17:59:35 -07001211 int32_t* const outTemp = state->outputTemp;
1212 const size_t size = sizeof(int32_t) * MAX_NUM_CHANNELS * state->frameCount;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001213
1214 size_t numFrames = state->frameCount;
1215
1216 uint32_t e0 = state->enabledTracks;
1217 while (e0) {
1218 // process by group of tracks with same output buffer
1219 // to optimize cache use
1220 uint32_t e1 = e0, e2 = e0;
1221 int j = 31 - __builtin_clz(e1);
1222 track_t& t1 = state->tracks[j];
1223 e2 &= ~(1<<j);
1224 while (e2) {
1225 j = 31 - __builtin_clz(e2);
1226 e2 &= ~(1<<j);
1227 track_t& t2 = state->tracks[j];
Glenn Kastenf6b16782011-12-15 09:51:17 -08001228 if (CC_UNLIKELY(t2.mainBuffer != t1.mainBuffer)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001229 e1 &= ~(1<<j);
1230 }
1231 }
1232 e0 &= ~(e1);
1233 int32_t *out = t1.mainBuffer;
Yuuhi Yamaguchi2151d7b2011-02-04 15:24:34 +01001234 memset(outTemp, 0, size);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001235 while (e1) {
1236 const int i = 31 - __builtin_clz(e1);
1237 e1 &= ~(1<<i);
1238 track_t& t = state->tracks[i];
1239 int32_t *aux = NULL;
Glenn Kastenf6b16782011-12-15 09:51:17 -08001240 if (CC_UNLIKELY((t.needs & NEEDS_AUX__MASK) == NEEDS_AUX_ENABLED)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001241 aux = t.auxBuffer;
1242 }
1243
1244 // this is a little goofy, on the resampling case we don't
1245 // acquire/release the buffers because it's done by
1246 // the resampler.
1247 if ((t.needs & NEEDS_RESAMPLE__MASK) == NEEDS_RESAMPLE_ENABLED) {
John Grossman4ff14ba2012-02-08 16:37:41 -08001248 t.resampler->setPTS(pts);
Glenn Kastena1117922012-01-26 10:53:32 -08001249 t.hook(&t, outTemp, numFrames, state->resampleTemp, aux);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001250 } else {
1251
1252 size_t outFrames = 0;
1253
1254 while (outFrames < numFrames) {
1255 t.buffer.frameCount = numFrames - outFrames;
John Grossman4ff14ba2012-02-08 16:37:41 -08001256 int64_t outputPTS = calculateOutputPTS(t, pts, outFrames);
1257 t.bufferProvider->getNextBuffer(&t.buffer, outputPTS);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001258 t.in = t.buffer.raw;
1259 // t.in == NULL can happen if the track was flushed just after having
1260 // been enabled for mixing.
1261 if (t.in == NULL) break;
1262
Glenn Kastenf6b16782011-12-15 09:51:17 -08001263 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001264 aux += outFrames;
1265 }
Glenn Kasten85ab62c2012-11-01 11:11:38 -07001266 t.hook(&t, outTemp + outFrames*MAX_NUM_CHANNELS, t.buffer.frameCount,
1267 state->resampleTemp, aux);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001268 outFrames += t.buffer.frameCount;
1269 t.bufferProvider->releaseBuffer(&t.buffer);
1270 }
1271 }
1272 }
1273 ditherAndClamp(out, outTemp, numFrames);
1274 }
1275}
1276
1277// one track, 16 bits stereo without resampling is the most common case
John Grossman4ff14ba2012-02-08 16:37:41 -08001278void AudioMixer::process__OneTrack16BitsStereoNoResampling(state_t* state,
1279 int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001280{
Glenn Kasten99e53b82012-01-19 08:59:58 -08001281 // This method is only called when state->enabledTracks has exactly
1282 // one bit set. The asserts below would verify this, but are commented out
1283 // since the whole point of this method is to optimize performance.
Glenn Kasten5798d4e2012-03-08 12:18:35 -08001284 //ALOG_ASSERT(0 != state->enabledTracks, "no tracks enabled");
Mathias Agopian65ab4712010-07-14 17:59:35 -07001285 const int i = 31 - __builtin_clz(state->enabledTracks);
Glenn Kasten5798d4e2012-03-08 12:18:35 -08001286 //ALOG_ASSERT((1 << i) == state->enabledTracks, "more than 1 track enabled");
Mathias Agopian65ab4712010-07-14 17:59:35 -07001287 const track_t& t = state->tracks[i];
1288
1289 AudioBufferProvider::Buffer& b(t.buffer);
1290
1291 int32_t* out = t.mainBuffer;
1292 size_t numFrames = state->frameCount;
1293
1294 const int16_t vl = t.volume[0];
1295 const int16_t vr = t.volume[1];
1296 const uint32_t vrl = t.volumeRL;
1297 while (numFrames) {
1298 b.frameCount = numFrames;
John Grossman4ff14ba2012-02-08 16:37:41 -08001299 int64_t outputPTS = calculateOutputPTS(t, pts, out - t.mainBuffer);
1300 t.bufferProvider->getNextBuffer(&b, outputPTS);
Glenn Kasten54c3b662012-01-06 07:46:30 -08001301 const int16_t *in = b.i16;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001302
1303 // in == NULL can happen if the track was flushed just after having
1304 // been enabled for mixing.
1305 if (in == NULL || ((unsigned long)in & 3)) {
1306 memset(out, 0, numFrames*MAX_NUM_CHANNELS*sizeof(int16_t));
Glenn Kasten85ab62c2012-11-01 11:11:38 -07001307 ALOGE_IF(((unsigned long)in & 3), "process stereo track: input buffer alignment pb: "
1308 "buffer %p track %d, channels %d, needs %08x",
Mathias Agopian65ab4712010-07-14 17:59:35 -07001309 in, i, t.channelCount, t.needs);
1310 return;
1311 }
1312 size_t outFrames = b.frameCount;
1313
Glenn Kastenf6b16782011-12-15 09:51:17 -08001314 if (CC_UNLIKELY(uint32_t(vl) > UNITY_GAIN || uint32_t(vr) > UNITY_GAIN)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001315 // volume is boosted, so we might need to clamp even though
1316 // we process only one track.
1317 do {
Glenn Kasten54c3b662012-01-06 07:46:30 -08001318 uint32_t rl = *reinterpret_cast<const uint32_t *>(in);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001319 in += 2;
1320 int32_t l = mulRL(1, rl, vrl) >> 12;
1321 int32_t r = mulRL(0, rl, vrl) >> 12;
1322 // clamping...
1323 l = clamp16(l);
1324 r = clamp16(r);
1325 *out++ = (r<<16) | (l & 0xFFFF);
1326 } while (--outFrames);
1327 } else {
1328 do {
Glenn Kasten54c3b662012-01-06 07:46:30 -08001329 uint32_t rl = *reinterpret_cast<const uint32_t *>(in);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001330 in += 2;
1331 int32_t l = mulRL(1, rl, vrl) >> 12;
1332 int32_t r = mulRL(0, rl, vrl) >> 12;
1333 *out++ = (r<<16) | (l & 0xFFFF);
1334 } while (--outFrames);
1335 }
1336 numFrames -= b.frameCount;
1337 t.bufferProvider->releaseBuffer(&b);
1338 }
1339}
1340
Glenn Kasten81a028f2011-12-15 09:53:12 -08001341#if 0
Mathias Agopian65ab4712010-07-14 17:59:35 -07001342// 2 tracks is also a common case
1343// NEVER used in current implementation of process__validate()
1344// only use if the 2 tracks have the same output buffer
John Grossman4ff14ba2012-02-08 16:37:41 -08001345void AudioMixer::process__TwoTracks16BitsStereoNoResampling(state_t* state,
1346 int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001347{
1348 int i;
1349 uint32_t en = state->enabledTracks;
1350
1351 i = 31 - __builtin_clz(en);
1352 const track_t& t0 = state->tracks[i];
1353 AudioBufferProvider::Buffer& b0(t0.buffer);
1354
1355 en &= ~(1<<i);
1356 i = 31 - __builtin_clz(en);
1357 const track_t& t1 = state->tracks[i];
1358 AudioBufferProvider::Buffer& b1(t1.buffer);
1359
Glenn Kasten54c3b662012-01-06 07:46:30 -08001360 const int16_t *in0;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001361 const int16_t vl0 = t0.volume[0];
1362 const int16_t vr0 = t0.volume[1];
1363 size_t frameCount0 = 0;
1364
Glenn Kasten54c3b662012-01-06 07:46:30 -08001365 const int16_t *in1;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001366 const int16_t vl1 = t1.volume[0];
1367 const int16_t vr1 = t1.volume[1];
1368 size_t frameCount1 = 0;
1369
1370 //FIXME: only works if two tracks use same buffer
1371 int32_t* out = t0.mainBuffer;
1372 size_t numFrames = state->frameCount;
Glenn Kasten54c3b662012-01-06 07:46:30 -08001373 const int16_t *buff = NULL;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001374
1375
1376 while (numFrames) {
1377
1378 if (frameCount0 == 0) {
1379 b0.frameCount = numFrames;
John Grossman4ff14ba2012-02-08 16:37:41 -08001380 int64_t outputPTS = calculateOutputPTS(t0, pts,
1381 out - t0.mainBuffer);
1382 t0.bufferProvider->getNextBuffer(&b0, outputPTS);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001383 if (b0.i16 == NULL) {
1384 if (buff == NULL) {
1385 buff = new int16_t[MAX_NUM_CHANNELS * state->frameCount];
1386 }
1387 in0 = buff;
1388 b0.frameCount = numFrames;
1389 } else {
1390 in0 = b0.i16;
1391 }
1392 frameCount0 = b0.frameCount;
1393 }
1394 if (frameCount1 == 0) {
1395 b1.frameCount = numFrames;
John Grossman4ff14ba2012-02-08 16:37:41 -08001396 int64_t outputPTS = calculateOutputPTS(t1, pts,
1397 out - t0.mainBuffer);
1398 t1.bufferProvider->getNextBuffer(&b1, outputPTS);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001399 if (b1.i16 == NULL) {
1400 if (buff == NULL) {
1401 buff = new int16_t[MAX_NUM_CHANNELS * state->frameCount];
1402 }
1403 in1 = buff;
1404 b1.frameCount = numFrames;
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -08001405 } else {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001406 in1 = b1.i16;
1407 }
1408 frameCount1 = b1.frameCount;
1409 }
1410
1411 size_t outFrames = frameCount0 < frameCount1?frameCount0:frameCount1;
1412
1413 numFrames -= outFrames;
1414 frameCount0 -= outFrames;
1415 frameCount1 -= outFrames;
1416
1417 do {
1418 int32_t l0 = *in0++;
1419 int32_t r0 = *in0++;
1420 l0 = mul(l0, vl0);
1421 r0 = mul(r0, vr0);
1422 int32_t l = *in1++;
1423 int32_t r = *in1++;
1424 l = mulAdd(l, vl1, l0) >> 12;
1425 r = mulAdd(r, vr1, r0) >> 12;
1426 // clamping...
1427 l = clamp16(l);
1428 r = clamp16(r);
1429 *out++ = (r<<16) | (l & 0xFFFF);
1430 } while (--outFrames);
1431
1432 if (frameCount0 == 0) {
1433 t0.bufferProvider->releaseBuffer(&b0);
1434 }
1435 if (frameCount1 == 0) {
1436 t1.bufferProvider->releaseBuffer(&b1);
1437 }
1438 }
1439
Glenn Kastene9dd0172012-01-27 18:08:45 -08001440 delete [] buff;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001441}
Glenn Kasten81a028f2011-12-15 09:53:12 -08001442#endif
Mathias Agopian65ab4712010-07-14 17:59:35 -07001443
John Grossman4ff14ba2012-02-08 16:37:41 -08001444int64_t AudioMixer::calculateOutputPTS(const track_t& t, int64_t basePTS,
1445 int outputFrameIndex)
1446{
1447 if (AudioBufferProvider::kInvalidPTS == basePTS)
1448 return AudioBufferProvider::kInvalidPTS;
1449
Glenn Kasten52008f82012-03-18 09:34:41 -07001450 return basePTS + ((outputFrameIndex * sLocalTimeFreq) / t.sampleRate);
1451}
1452
1453/*static*/ uint64_t AudioMixer::sLocalTimeFreq;
1454/*static*/ pthread_once_t AudioMixer::sOnceControl = PTHREAD_ONCE_INIT;
1455
1456/*static*/ void AudioMixer::sInitRoutine()
1457{
1458 LocalClock lc;
1459 sLocalTimeFreq = lc.getLocalFreq();
John Grossman4ff14ba2012-02-08 16:37:41 -08001460}
1461
Mathias Agopian65ab4712010-07-14 17:59:35 -07001462// ----------------------------------------------------------------------------
1463}; // namespace android