blob: ab6f38fa2be46cea445539355f829b0d08489aa0 [file] [log] [blame]
Glenn Kasten99e53b82012-01-19 08:59:58 -08001/*
Mathias Agopian65ab4712010-07-14 17:59:35 -07002**
3** Copyright 2007, The Android Open Source Project
4**
5** Licensed under the Apache License, Version 2.0 (the "License");
6** you may not use this file except in compliance with the License.
7** You may obtain a copy of the License at
8**
9** http://www.apache.org/licenses/LICENSE-2.0
10**
11** Unless required by applicable law or agreed to in writing, software
12** distributed under the License is distributed on an "AS IS" BASIS,
13** WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
14** See the License for the specific language governing permissions and
15** limitations under the License.
16*/
17
18#define LOG_TAG "AudioMixer"
19//#define LOG_NDEBUG 0
20
21#include <stdint.h>
22#include <string.h>
23#include <stdlib.h>
24#include <sys/types.h>
25
26#include <utils/Errors.h>
27#include <utils/Log.h>
28
Jean-Michel Trivi0d255b22011-05-24 15:53:33 -070029#include <cutils/bitops.h>
Glenn Kastenf6b16782011-12-15 09:51:17 -080030#include <cutils/compiler.h>
Glenn Kasten5798d4e2012-03-08 12:18:35 -080031#include <utils/Debug.h>
Jean-Michel Trivi0d255b22011-05-24 15:53:33 -070032
33#include <system/audio.h>
34
Glenn Kasten3b21c502011-12-15 09:52:39 -080035#include <audio_utils/primitives.h>
John Grossman4ff14ba2012-02-08 16:37:41 -080036#include <common_time/local_clock.h>
37#include <common_time/cc_helper.h>
Glenn Kasten3b21c502011-12-15 09:52:39 -080038
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -070039#include <media/EffectsFactoryApi.h>
40
Mathias Agopian65ab4712010-07-14 17:59:35 -070041#include "AudioMixer.h"
42
43namespace android {
Mathias Agopian65ab4712010-07-14 17:59:35 -070044
45// ----------------------------------------------------------------------------
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -070046AudioMixer::DownmixerBufferProvider::DownmixerBufferProvider() : AudioBufferProvider(),
47 mTrackBufferProvider(NULL), mDownmixHandle(NULL)
48{
49}
50
51AudioMixer::DownmixerBufferProvider::~DownmixerBufferProvider()
52{
53 ALOGV("AudioMixer deleting DownmixerBufferProvider (%p)", this);
54 EffectRelease(mDownmixHandle);
55}
56
57status_t AudioMixer::DownmixerBufferProvider::getNextBuffer(AudioBufferProvider::Buffer *pBuffer,
58 int64_t pts) {
59 //ALOGV("DownmixerBufferProvider::getNextBuffer()");
60 if (this->mTrackBufferProvider != NULL) {
61 status_t res = mTrackBufferProvider->getNextBuffer(pBuffer, pts);
62 if (res == OK) {
63 mDownmixConfig.inputCfg.buffer.frameCount = pBuffer->frameCount;
64 mDownmixConfig.inputCfg.buffer.raw = pBuffer->raw;
65 mDownmixConfig.outputCfg.buffer.frameCount = pBuffer->frameCount;
66 mDownmixConfig.outputCfg.buffer.raw = mDownmixConfig.inputCfg.buffer.raw;
67 // in-place so overwrite the buffer contents, has been set in prepareTrackForDownmix()
68 //mDownmixConfig.outputCfg.accessMode = EFFECT_BUFFER_ACCESS_WRITE;
69
70 res = (*mDownmixHandle)->process(mDownmixHandle,
71 &mDownmixConfig.inputCfg.buffer, &mDownmixConfig.outputCfg.buffer);
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -070072 //ALOGV("getNextBuffer is downmixing");
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -070073 }
74 return res;
75 } else {
76 ALOGE("DownmixerBufferProvider::getNextBuffer() error: NULL track buffer provider");
77 return NO_INIT;
78 }
79}
80
81void AudioMixer::DownmixerBufferProvider::releaseBuffer(AudioBufferProvider::Buffer *pBuffer) {
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -070082 //ALOGV("DownmixerBufferProvider::releaseBuffer()");
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -070083 if (this->mTrackBufferProvider != NULL) {
84 mTrackBufferProvider->releaseBuffer(pBuffer);
85 } else {
86 ALOGE("DownmixerBufferProvider::releaseBuffer() error: NULL track buffer provider");
87 }
88}
89
90
91// ----------------------------------------------------------------------------
92bool AudioMixer::isMultichannelCapable = false;
93
94effect_descriptor_t AudioMixer::dwnmFxDesc;
Mathias Agopian65ab4712010-07-14 17:59:35 -070095
Paul Lind3c0a0e82012-08-01 18:49:49 -070096// Ensure mConfiguredNames bitmask is initialized properly on all architectures.
97// The value of 1 << x is undefined in C when x >= 32.
98
Glenn Kasten5c94b6c2012-03-20 17:01:29 -070099AudioMixer::AudioMixer(size_t frameCount, uint32_t sampleRate, uint32_t maxNumTracks)
Paul Lind3c0a0e82012-08-01 18:49:49 -0700100 : mTrackNames(0), mConfiguredNames((maxNumTracks >= 32 ? 0 : 1 << maxNumTracks) - 1),
101 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
John Grossman4ff14ba2012-02-08 16:37:41 -0800109 LocalClock lc;
110
Mathias Agopian65ab4712010-07-14 17:59:35 -0700111 mState.enabledTracks= 0;
112 mState.needsChanged = 0;
113 mState.frameCount = frameCount;
Glenn Kasten84afa3b2012-01-25 15:28:08 -0800114 mState.hook = process__nop;
Glenn Kastene0feee32011-12-13 11:53:26 -0800115 mState.outputTemp = NULL;
116 mState.resampleTemp = NULL;
Glenn Kasten84afa3b2012-01-25 15:28:08 -0800117 // mState.reserved
Glenn Kasten17a736c2012-02-14 08:52:15 -0800118
119 // FIXME Most of the following initialization is probably redundant since
120 // tracks[i] should only be referenced if (mTrackNames & (1 << i)) != 0
121 // and mTrackNames is initially 0. However, leave it here until that's verified.
Mathias Agopian65ab4712010-07-14 17:59:35 -0700122 track_t* t = mState.tracks;
Glenn Kastenbf71f1e2011-12-13 11:52:35 -0800123 for (unsigned i=0 ; i < MAX_NUM_TRACKS ; i++) {
Glenn Kastendeeb1282012-03-25 11:59:31 -0700124 // FIXME redundant per track
John Grossman4ff14ba2012-02-08 16:37:41 -0800125 t->localTimeFreq = lc.getLocalFreq();
Eric Laurenta5e82142012-04-16 13:47:17 -0700126 t->resampler = NULL;
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700127 t->downmixerBufferProvider = NULL;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700128 t++;
129 }
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700130
131 // find multichannel downmix effect if we have to play multichannel content
132 uint32_t numEffects = 0;
133 int ret = EffectQueryNumberEffects(&numEffects);
134 if (ret != 0) {
135 ALOGE("AudioMixer() error %d querying number of effects", ret);
136 return;
137 }
138 ALOGV("EffectQueryNumberEffects() numEffects=%d", numEffects);
139
140 for (uint32_t i = 0 ; i < numEffects ; i++) {
141 if (EffectQueryEffect(i, &dwnmFxDesc) == 0) {
142 ALOGV("effect %d is called %s", i, dwnmFxDesc.name);
143 if (memcmp(&dwnmFxDesc.type, EFFECT_UIID_DOWNMIX, sizeof(effect_uuid_t)) == 0) {
144 ALOGI("found effect \"%s\" from %s",
145 dwnmFxDesc.name, dwnmFxDesc.implementor);
146 isMultichannelCapable = true;
147 break;
148 }
149 }
150 }
151 ALOGE_IF(!isMultichannelCapable, "unable to find downmix effect");
Mathias Agopian65ab4712010-07-14 17:59:35 -0700152}
153
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800154AudioMixer::~AudioMixer()
155{
156 track_t* t = mState.tracks;
Glenn Kastenbf71f1e2011-12-13 11:52:35 -0800157 for (unsigned i=0 ; i < MAX_NUM_TRACKS ; i++) {
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800158 delete t->resampler;
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700159 delete t->downmixerBufferProvider;
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800160 t++;
161 }
162 delete [] mState.outputTemp;
163 delete [] mState.resampleTemp;
164}
Mathias Agopian65ab4712010-07-14 17:59:35 -0700165
Jean-Michel Trivife3156e2012-09-10 18:58:27 -0700166int AudioMixer::getTrackName(audio_channel_mask_t channelMask, int sessionId)
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800167{
Glenn Kasten5c94b6c2012-03-20 17:01:29 -0700168 uint32_t names = (~mTrackNames) & mConfiguredNames;
Glenn Kasten98dd5422011-12-15 14:38:29 -0800169 if (names != 0) {
170 int n = __builtin_ctz(names);
Steve Block3856b092011-10-20 11:56:00 +0100171 ALOGV("add track (%d)", n);
Glenn Kasten98dd5422011-12-15 14:38:29 -0800172 mTrackNames |= 1 << n;
Glenn Kastendeeb1282012-03-25 11:59:31 -0700173 // assume default parameters for the track, except where noted below
174 track_t* t = &mState.tracks[n];
175 t->needs = 0;
176 t->volume[0] = UNITY_GAIN;
177 t->volume[1] = UNITY_GAIN;
178 // no initialization needed
179 // t->prevVolume[0]
180 // t->prevVolume[1]
181 t->volumeInc[0] = 0;
182 t->volumeInc[1] = 0;
183 t->auxLevel = 0;
184 t->auxInc = 0;
185 // no initialization needed
186 // t->prevAuxLevel
187 // t->frameCount
188 t->channelCount = 2;
189 t->enabled = false;
190 t->format = 16;
191 t->channelMask = AUDIO_CHANNEL_OUT_STEREO;
Jean-Michel Trivife3156e2012-09-10 18:58:27 -0700192 t->sessionId = sessionId;
Glenn Kastendeeb1282012-03-25 11:59:31 -0700193 // setBufferProvider(name, AudioBufferProvider *) is required before enable(name)
194 t->bufferProvider = NULL;
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700195 t->downmixerBufferProvider = NULL;
Glenn Kastendeeb1282012-03-25 11:59:31 -0700196 t->buffer.raw = NULL;
197 // no initialization needed
198 // t->buffer.frameCount
199 t->hook = NULL;
200 t->in = NULL;
201 t->resampler = NULL;
202 t->sampleRate = mSampleRate;
203 // setParameter(name, TRACK, MAIN_BUFFER, mixBuffer) is required before enable(name)
204 t->mainBuffer = NULL;
205 t->auxBuffer = NULL;
206 // see t->localTimeFreq in constructor above
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700207
208 status_t status = initTrackDownmix(&mState.tracks[n], n, channelMask);
209 if (status == OK) {
210 return TRACK0 + n;
211 }
212 ALOGE("AudioMixer::getTrackName(0x%x) failed, error preparing track for downmix",
213 channelMask);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700214 }
215 return -1;
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800216}
Mathias Agopian65ab4712010-07-14 17:59:35 -0700217
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800218void AudioMixer::invalidateState(uint32_t mask)
219{
Mathias Agopian65ab4712010-07-14 17:59:35 -0700220 if (mask) {
221 mState.needsChanged |= mask;
222 mState.hook = process__validate;
223 }
224 }
225
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700226status_t AudioMixer::initTrackDownmix(track_t* pTrack, int trackNum, audio_channel_mask_t mask)
227{
228 uint32_t channelCount = popcount(mask);
229 ALOG_ASSERT((channelCount <= MAX_NUM_CHANNELS_TO_DOWNMIX) && channelCount);
230 status_t status = OK;
231 if (channelCount > MAX_NUM_CHANNELS) {
232 pTrack->channelMask = mask;
233 pTrack->channelCount = channelCount;
234 ALOGV("initTrackDownmix(track=%d, mask=0x%x) calls prepareTrackForDownmix()",
235 trackNum, mask);
236 status = prepareTrackForDownmix(pTrack, trackNum);
237 } else {
238 unprepareTrackForDownmix(pTrack, trackNum);
239 }
240 return status;
241}
242
243void AudioMixer::unprepareTrackForDownmix(track_t* pTrack, int trackName) {
244 ALOGV("AudioMixer::unprepareTrackForDownmix(%d)", trackName);
245
246 if (pTrack->downmixerBufferProvider != NULL) {
247 // this track had previously been configured with a downmixer, delete it
248 ALOGV(" deleting old downmixer");
249 pTrack->bufferProvider = pTrack->downmixerBufferProvider->mTrackBufferProvider;
250 delete pTrack->downmixerBufferProvider;
251 pTrack->downmixerBufferProvider = NULL;
252 } else {
253 ALOGV(" nothing to do, no downmixer to delete");
254 }
255}
256
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700257status_t AudioMixer::prepareTrackForDownmix(track_t* pTrack, int trackName)
258{
259 ALOGV("AudioMixer::prepareTrackForDownmix(%d) with mask 0x%x", trackName, pTrack->channelMask);
260
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700261 // discard the previous downmixer if there was one
262 unprepareTrackForDownmix(pTrack, trackName);
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700263
264 DownmixerBufferProvider* pDbp = new DownmixerBufferProvider();
265 int32_t status;
266
267 if (!isMultichannelCapable) {
268 ALOGE("prepareTrackForDownmix(%d) fails: mixer doesn't support multichannel content",
269 trackName);
270 goto noDownmixForActiveTrack;
271 }
272
273 if (EffectCreate(&dwnmFxDesc.uuid,
Jean-Michel Trivife3156e2012-09-10 18:58:27 -0700274 pTrack->sessionId /*sessionId*/, -2 /*ioId not relevant here, using random value*/,
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700275 &pDbp->mDownmixHandle/*pHandle*/) != 0) {
276 ALOGE("prepareTrackForDownmix(%d) fails: error creating downmixer effect", trackName);
277 goto noDownmixForActiveTrack;
278 }
279
280 // channel input configuration will be overridden per-track
281 pDbp->mDownmixConfig.inputCfg.channels = pTrack->channelMask;
282 pDbp->mDownmixConfig.outputCfg.channels = AUDIO_CHANNEL_OUT_STEREO;
283 pDbp->mDownmixConfig.inputCfg.format = AUDIO_FORMAT_PCM_16_BIT;
284 pDbp->mDownmixConfig.outputCfg.format = AUDIO_FORMAT_PCM_16_BIT;
285 pDbp->mDownmixConfig.inputCfg.samplingRate = pTrack->sampleRate;
286 pDbp->mDownmixConfig.outputCfg.samplingRate = pTrack->sampleRate;
287 pDbp->mDownmixConfig.inputCfg.accessMode = EFFECT_BUFFER_ACCESS_READ;
288 pDbp->mDownmixConfig.outputCfg.accessMode = EFFECT_BUFFER_ACCESS_WRITE;
289 // input and output buffer provider, and frame count will not be used as the downmix effect
290 // process() function is called directly (see DownmixerBufferProvider::getNextBuffer())
291 pDbp->mDownmixConfig.inputCfg.mask = EFFECT_CONFIG_SMP_RATE | EFFECT_CONFIG_CHANNELS |
292 EFFECT_CONFIG_FORMAT | EFFECT_CONFIG_ACC_MODE;
293 pDbp->mDownmixConfig.outputCfg.mask = pDbp->mDownmixConfig.inputCfg.mask;
294
295 {// scope for local variables that are not used in goto label "noDownmixForActiveTrack"
296 int cmdStatus;
297 uint32_t replySize = sizeof(int);
298
299 // Configure and enable downmixer
300 status = (*pDbp->mDownmixHandle)->command(pDbp->mDownmixHandle,
301 EFFECT_CMD_SET_CONFIG /*cmdCode*/, sizeof(effect_config_t) /*cmdSize*/,
302 &pDbp->mDownmixConfig /*pCmdData*/,
303 &replySize /*replySize*/, &cmdStatus /*pReplyData*/);
304 if ((status != 0) || (cmdStatus != 0)) {
305 ALOGE("error %d while configuring downmixer for track %d", status, trackName);
306 goto noDownmixForActiveTrack;
307 }
308 replySize = sizeof(int);
309 status = (*pDbp->mDownmixHandle)->command(pDbp->mDownmixHandle,
310 EFFECT_CMD_ENABLE /*cmdCode*/, 0 /*cmdSize*/, NULL /*pCmdData*/,
311 &replySize /*replySize*/, &cmdStatus /*pReplyData*/);
312 if ((status != 0) || (cmdStatus != 0)) {
313 ALOGE("error %d while enabling downmixer for track %d", status, trackName);
314 goto noDownmixForActiveTrack;
315 }
316
317 // Set downmix type
318 // parameter size rounded for padding on 32bit boundary
319 const int psizePadded = ((sizeof(downmix_params_t) - 1)/sizeof(int) + 1) * sizeof(int);
320 const int downmixParamSize =
321 sizeof(effect_param_t) + psizePadded + sizeof(downmix_type_t);
322 effect_param_t * const param = (effect_param_t *) malloc(downmixParamSize);
323 param->psize = sizeof(downmix_params_t);
324 const downmix_params_t downmixParam = DOWNMIX_PARAM_TYPE;
325 memcpy(param->data, &downmixParam, param->psize);
326 const downmix_type_t downmixType = DOWNMIX_TYPE_FOLD;
327 param->vsize = sizeof(downmix_type_t);
328 memcpy(param->data + psizePadded, &downmixType, param->vsize);
329
330 status = (*pDbp->mDownmixHandle)->command(pDbp->mDownmixHandle,
331 EFFECT_CMD_SET_PARAM /* cmdCode */, downmixParamSize/* cmdSize */,
332 param /*pCmndData*/, &replySize /*replySize*/, &cmdStatus /*pReplyData*/);
333
334 free(param);
335
336 if ((status != 0) || (cmdStatus != 0)) {
337 ALOGE("error %d while setting downmix type for track %d", status, trackName);
338 goto noDownmixForActiveTrack;
339 } else {
340 ALOGV("downmix type set to %d for track %d", (int) downmixType, trackName);
341 }
342 }// end of scope for local variables that are not used in goto label "noDownmixForActiveTrack"
343
344 // initialization successful:
345 // - keep track of the real buffer provider in case it was set before
346 pDbp->mTrackBufferProvider = pTrack->bufferProvider;
347 // - we'll use the downmix effect integrated inside this
348 // track's buffer provider, and we'll use it as the track's buffer provider
349 pTrack->downmixerBufferProvider = pDbp;
350 pTrack->bufferProvider = pDbp;
351
352 return NO_ERROR;
353
354noDownmixForActiveTrack:
355 delete pDbp;
356 pTrack->downmixerBufferProvider = NULL;
357 return NO_INIT;
358}
359
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800360void AudioMixer::deleteTrackName(int name)
361{
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700362 ALOGV("AudioMixer::deleteTrackName(%d)", name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700363 name -= TRACK0;
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800364 ALOG_ASSERT(uint32_t(name) < MAX_NUM_TRACKS, "bad track name %d", name);
Glenn Kasten237a6242011-12-15 15:32:27 -0800365 ALOGV("deleteTrackName(%d)", name);
366 track_t& track(mState.tracks[ name ]);
Glenn Kasten4c340c62012-01-27 12:33:54 -0800367 if (track.enabled) {
368 track.enabled = false;
Glenn Kasten237a6242011-12-15 15:32:27 -0800369 invalidateState(1<<name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700370 }
Glenn Kasten4e2293f2012-04-12 09:39:07 -0700371 // delete the resampler
372 delete track.resampler;
373 track.resampler = NULL;
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700374 // delete the downmixer
375 unprepareTrackForDownmix(&mState.tracks[name], name);
376
Glenn Kasten237a6242011-12-15 15:32:27 -0800377 mTrackNames &= ~(1<<name);
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800378}
Mathias Agopian65ab4712010-07-14 17:59:35 -0700379
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800380void AudioMixer::enable(int name)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700381{
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800382 name -= TRACK0;
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800383 ALOG_ASSERT(uint32_t(name) < MAX_NUM_TRACKS, "bad track name %d", name);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800384 track_t& track = mState.tracks[name];
385
Glenn Kasten4c340c62012-01-27 12:33:54 -0800386 if (!track.enabled) {
387 track.enabled = true;
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800388 ALOGV("enable(%d)", name);
389 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700390 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700391}
392
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800393void AudioMixer::disable(int name)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700394{
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800395 name -= TRACK0;
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800396 ALOG_ASSERT(uint32_t(name) < MAX_NUM_TRACKS, "bad track name %d", name);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800397 track_t& track = mState.tracks[name];
398
Glenn Kasten4c340c62012-01-27 12:33:54 -0800399 if (track.enabled) {
400 track.enabled = false;
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800401 ALOGV("disable(%d)", name);
402 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700403 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700404}
405
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800406void AudioMixer::setParameter(int name, int target, int param, void *value)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700407{
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800408 name -= TRACK0;
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800409 ALOG_ASSERT(uint32_t(name) < MAX_NUM_TRACKS, "bad track name %d", name);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800410 track_t& track = mState.tracks[name];
Mathias Agopian65ab4712010-07-14 17:59:35 -0700411
Mathias Agopian65ab4712010-07-14 17:59:35 -0700412 int valueInt = (int)value;
413 int32_t *valueBuf = (int32_t *)value;
414
415 switch (target) {
Glenn Kasten788040c2011-05-05 08:19:00 -0700416
Mathias Agopian65ab4712010-07-14 17:59:35 -0700417 case TRACK:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800418 switch (param) {
Glenn Kasten788040c2011-05-05 08:19:00 -0700419 case CHANNEL_MASK: {
Glenn Kasten254af182012-07-03 14:59:05 -0700420 audio_channel_mask_t mask = (audio_channel_mask_t) value;
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800421 if (track.channelMask != mask) {
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800422 uint32_t channelCount = popcount(mask);
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700423 ALOG_ASSERT((channelCount <= MAX_NUM_CHANNELS_TO_DOWNMIX) && channelCount);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800424 track.channelMask = mask;
425 track.channelCount = channelCount;
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700426 // the mask has changed, does this track need a downmixer?
427 initTrackDownmix(&mState.tracks[name], name, mask);
Glenn Kasten788040c2011-05-05 08:19:00 -0700428 ALOGV("setParameter(TRACK, CHANNEL_MASK, %x)", mask);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800429 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700430 }
Glenn Kasten788040c2011-05-05 08:19:00 -0700431 } break;
432 case MAIN_BUFFER:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800433 if (track.mainBuffer != valueBuf) {
434 track.mainBuffer = valueBuf;
Steve Block3856b092011-10-20 11:56:00 +0100435 ALOGV("setParameter(TRACK, MAIN_BUFFER, %p)", valueBuf);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800436 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700437 }
Glenn Kasten788040c2011-05-05 08:19:00 -0700438 break;
439 case AUX_BUFFER:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800440 if (track.auxBuffer != valueBuf) {
441 track.auxBuffer = valueBuf;
Steve Block3856b092011-10-20 11:56:00 +0100442 ALOGV("setParameter(TRACK, AUX_BUFFER, %p)", valueBuf);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800443 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700444 }
Glenn Kasten788040c2011-05-05 08:19:00 -0700445 break;
Glenn Kastendeeb1282012-03-25 11:59:31 -0700446 case FORMAT:
447 ALOG_ASSERT(valueInt == AUDIO_FORMAT_PCM_16_BIT);
448 break;
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700449 // FIXME do we want to support setting the downmix type from AudioFlinger?
450 // for a specific track? or per mixer?
451 /* case DOWNMIX_TYPE:
452 break */
Glenn Kasten788040c2011-05-05 08:19:00 -0700453 default:
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800454 LOG_FATAL("bad param");
Mathias Agopian65ab4712010-07-14 17:59:35 -0700455 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700456 break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700457
Mathias Agopian65ab4712010-07-14 17:59:35 -0700458 case RESAMPLE:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800459 switch (param) {
460 case SAMPLE_RATE:
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800461 ALOG_ASSERT(valueInt > 0, "bad sample rate %d", valueInt);
Glenn Kasten788040c2011-05-05 08:19:00 -0700462 if (track.setResampler(uint32_t(valueInt), mSampleRate)) {
463 ALOGV("setParameter(RESAMPLE, SAMPLE_RATE, %u)",
464 uint32_t(valueInt));
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800465 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700466 }
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800467 break;
468 case RESET:
Eric Laurent243f5f92011-02-28 16:52:51 -0800469 track.resetResampler();
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800470 invalidateState(1 << name);
471 break;
Glenn Kasten4e2293f2012-04-12 09:39:07 -0700472 case REMOVE:
473 delete track.resampler;
474 track.resampler = NULL;
475 track.sampleRate = mSampleRate;
476 invalidateState(1 << name);
477 break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700478 default:
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800479 LOG_FATAL("bad param");
Eric Laurent243f5f92011-02-28 16:52:51 -0800480 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700481 break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700482
Mathias Agopian65ab4712010-07-14 17:59:35 -0700483 case RAMP_VOLUME:
484 case VOLUME:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800485 switch (param) {
Glenn Kasten788040c2011-05-05 08:19:00 -0700486 case VOLUME0:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800487 case VOLUME1:
488 if (track.volume[param-VOLUME0] != valueInt) {
Steve Block3856b092011-10-20 11:56:00 +0100489 ALOGV("setParameter(VOLUME, VOLUME0/1: %04x)", valueInt);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800490 track.prevVolume[param-VOLUME0] = track.volume[param-VOLUME0] << 16;
491 track.volume[param-VOLUME0] = valueInt;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700492 if (target == VOLUME) {
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800493 track.prevVolume[param-VOLUME0] = valueInt << 16;
494 track.volumeInc[param-VOLUME0] = 0;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700495 } else {
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800496 int32_t d = (valueInt<<16) - track.prevVolume[param-VOLUME0];
Mathias Agopian65ab4712010-07-14 17:59:35 -0700497 int32_t volInc = d / int32_t(mState.frameCount);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800498 track.volumeInc[param-VOLUME0] = volInc;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700499 if (volInc == 0) {
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800500 track.prevVolume[param-VOLUME0] = valueInt << 16;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700501 }
502 }
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800503 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700504 }
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800505 break;
506 case AUXLEVEL:
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800507 //ALOG_ASSERT(0 <= valueInt && valueInt <= MAX_GAIN_INT, "bad aux level %d", valueInt);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700508 if (track.auxLevel != valueInt) {
Steve Block3856b092011-10-20 11:56:00 +0100509 ALOGV("setParameter(VOLUME, AUXLEVEL: %04x)", valueInt);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700510 track.prevAuxLevel = track.auxLevel << 16;
511 track.auxLevel = valueInt;
512 if (target == VOLUME) {
513 track.prevAuxLevel = valueInt << 16;
514 track.auxInc = 0;
515 } else {
516 int32_t d = (valueInt<<16) - track.prevAuxLevel;
517 int32_t volInc = d / int32_t(mState.frameCount);
518 track.auxInc = volInc;
519 if (volInc == 0) {
520 track.prevAuxLevel = valueInt << 16;
521 }
522 }
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800523 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700524 }
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800525 break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700526 default:
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800527 LOG_FATAL("bad param");
Mathias Agopian65ab4712010-07-14 17:59:35 -0700528 }
529 break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700530
531 default:
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800532 LOG_FATAL("bad target");
Mathias Agopian65ab4712010-07-14 17:59:35 -0700533 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700534}
535
536bool AudioMixer::track_t::setResampler(uint32_t value, uint32_t devSampleRate)
537{
Glenn Kasten4e2293f2012-04-12 09:39:07 -0700538 if (value != devSampleRate || resampler != NULL) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700539 if (sampleRate != value) {
540 sampleRate = value;
Glenn Kastene0feee32011-12-13 11:53:26 -0800541 if (resampler == NULL) {
Glenn Kastenac602052012-10-01 14:04:31 -0700542 ALOGV("creating resampler from track %d Hz to device %d Hz", value, devSampleRate);
543 AudioResampler::src_quality quality;
544 // force lowest quality level resampler if use case isn't music or video
545 // FIXME this is flawed for dynamic sample rates, as we choose the resampler
546 // quality level based on the initial ratio, but that could change later.
547 // Should have a way to distinguish tracks with static ratios vs. dynamic ratios.
548 if (!((value == 44100 && devSampleRate == 48000) ||
549 (value == 48000 && devSampleRate == 44100))) {
550 quality = AudioResampler::LOW_QUALITY;
551 } else {
Mingming Yin9b3dd172013-01-10 18:42:38 -0800552#ifdef QCOM_ENHANCED_AUDIO
553 quality = AudioResampler::VERY_HIGH_QUALITY;
554#else
Glenn Kastenac602052012-10-01 14:04:31 -0700555 quality = AudioResampler::DEFAULT_QUALITY;
Mingming Yin9b3dd172013-01-10 18:42:38 -0800556#endif
Glenn Kastenac602052012-10-01 14:04:31 -0700557 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700558 resampler = AudioResampler::create(
Jean-Michel Triviacb86cc2012-04-16 12:43:57 -0700559 format,
560 // the resampler sees the number of channels after the downmixer, if any
561 downmixerBufferProvider != NULL ? MAX_NUM_CHANNELS : channelCount,
Glenn Kastenac602052012-10-01 14:04:31 -0700562 devSampleRate, quality);
John Grossman4ff14ba2012-02-08 16:37:41 -0800563 resampler->setLocalTimeFreq(localTimeFreq);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700564 }
565 return true;
566 }
567 }
568 return false;
569}
570
Mathias Agopian65ab4712010-07-14 17:59:35 -0700571inline
572void AudioMixer::track_t::adjustVolumeRamp(bool aux)
573{
Glenn Kastenf9a27772012-01-06 07:47:26 -0800574 for (uint32_t i=0 ; i<MAX_NUM_CHANNELS ; i++) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700575 if (((volumeInc[i]>0) && (((prevVolume[i]+volumeInc[i])>>16) >= volume[i])) ||
576 ((volumeInc[i]<0) && (((prevVolume[i]+volumeInc[i])>>16) <= volume[i]))) {
577 volumeInc[i] = 0;
578 prevVolume[i] = volume[i]<<16;
579 }
580 }
581 if (aux) {
582 if (((auxInc>0) && (((prevAuxLevel+auxInc)>>16) >= auxLevel)) ||
583 ((auxInc<0) && (((prevAuxLevel+auxInc)>>16) <= auxLevel))) {
584 auxInc = 0;
585 prevAuxLevel = auxLevel<<16;
586 }
587 }
588}
589
Glenn Kastenc59c0042012-02-02 14:06:11 -0800590size_t AudioMixer::getUnreleasedFrames(int name) const
Eric Laurent071ccd52011-12-22 16:08:41 -0800591{
592 name -= TRACK0;
593 if (uint32_t(name) < MAX_NUM_TRACKS) {
Glenn Kastenc59c0042012-02-02 14:06:11 -0800594 return mState.tracks[name].getUnreleasedFrames();
Eric Laurent071ccd52011-12-22 16:08:41 -0800595 }
596 return 0;
597}
Mathias Agopian65ab4712010-07-14 17:59:35 -0700598
Glenn Kasten01c4ebf2012-02-22 10:47:35 -0800599void AudioMixer::setBufferProvider(int name, AudioBufferProvider* bufferProvider)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700600{
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800601 name -= TRACK0;
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800602 ALOG_ASSERT(uint32_t(name) < MAX_NUM_TRACKS, "bad track name %d", name);
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700603
604 if (mState.tracks[name].downmixerBufferProvider != NULL) {
605 // update required?
606 if (mState.tracks[name].downmixerBufferProvider->mTrackBufferProvider != bufferProvider) {
607 ALOGV("AudioMixer::setBufferProvider(%p) for downmix", bufferProvider);
608 // setting the buffer provider for a track that gets downmixed consists in:
609 // 1/ setting the buffer provider to the "downmix / buffer provider" wrapper
610 // so it's the one that gets called when the buffer provider is needed,
611 mState.tracks[name].bufferProvider = mState.tracks[name].downmixerBufferProvider;
612 // 2/ saving the buffer provider for the track so the wrapper can use it
613 // when it downmixes.
614 mState.tracks[name].downmixerBufferProvider->mTrackBufferProvider = bufferProvider;
615 }
616 } else {
617 mState.tracks[name].bufferProvider = bufferProvider;
618 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700619}
620
621
622
John Grossman4ff14ba2012-02-08 16:37:41 -0800623void AudioMixer::process(int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700624{
John Grossman4ff14ba2012-02-08 16:37:41 -0800625 mState.hook(&mState, pts);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700626}
627
628
John Grossman4ff14ba2012-02-08 16:37:41 -0800629void AudioMixer::process__validate(state_t* state, int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700630{
Steve Block5ff1dd52012-01-05 23:22:43 +0000631 ALOGW_IF(!state->needsChanged,
Mathias Agopian65ab4712010-07-14 17:59:35 -0700632 "in process__validate() but nothing's invalid");
633
634 uint32_t changed = state->needsChanged;
635 state->needsChanged = 0; // clear the validation flag
636
637 // recompute which tracks are enabled / disabled
638 uint32_t enabled = 0;
639 uint32_t disabled = 0;
640 while (changed) {
641 const int i = 31 - __builtin_clz(changed);
642 const uint32_t mask = 1<<i;
643 changed &= ~mask;
644 track_t& t = state->tracks[i];
645 (t.enabled ? enabled : disabled) |= mask;
646 }
647 state->enabledTracks &= ~disabled;
648 state->enabledTracks |= enabled;
649
650 // compute everything we need...
651 int countActiveTracks = 0;
Glenn Kasten4c340c62012-01-27 12:33:54 -0800652 bool all16BitsStereoNoResample = true;
653 bool resampling = false;
654 bool volumeRamp = false;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700655 uint32_t en = state->enabledTracks;
656 while (en) {
657 const int i = 31 - __builtin_clz(en);
658 en &= ~(1<<i);
659
660 countActiveTracks++;
661 track_t& t = state->tracks[i];
662 uint32_t n = 0;
663 n |= NEEDS_CHANNEL_1 + t.channelCount - 1;
664 n |= NEEDS_FORMAT_16;
665 n |= t.doesResample() ? NEEDS_RESAMPLE_ENABLED : NEEDS_RESAMPLE_DISABLED;
666 if (t.auxLevel != 0 && t.auxBuffer != NULL) {
667 n |= NEEDS_AUX_ENABLED;
668 }
669
670 if (t.volumeInc[0]|t.volumeInc[1]) {
Glenn Kasten4c340c62012-01-27 12:33:54 -0800671 volumeRamp = true;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700672 } else if (!t.doesResample() && t.volumeRL == 0) {
673 n |= NEEDS_MUTE_ENABLED;
674 }
675 t.needs = n;
676
677 if ((n & NEEDS_MUTE__MASK) == NEEDS_MUTE_ENABLED) {
678 t.hook = track__nop;
679 } else {
680 if ((n & NEEDS_AUX__MASK) == NEEDS_AUX_ENABLED) {
Glenn Kasten4c340c62012-01-27 12:33:54 -0800681 all16BitsStereoNoResample = false;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700682 }
683 if ((n & NEEDS_RESAMPLE__MASK) == NEEDS_RESAMPLE_ENABLED) {
Glenn Kasten4c340c62012-01-27 12:33:54 -0800684 all16BitsStereoNoResample = false;
685 resampling = true;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700686 t.hook = track__genericResample;
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700687 ALOGV_IF((n & NEEDS_CHANNEL_COUNT__MASK) > NEEDS_CHANNEL_2,
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700688 "Track %d needs downmix + resample", i);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700689 } else {
690 if ((n & NEEDS_CHANNEL_COUNT__MASK) == NEEDS_CHANNEL_1){
691 t.hook = track__16BitsMono;
Glenn Kasten4c340c62012-01-27 12:33:54 -0800692 all16BitsStereoNoResample = false;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700693 }
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700694 if ((n & NEEDS_CHANNEL_COUNT__MASK) >= NEEDS_CHANNEL_2){
Mathias Agopian65ab4712010-07-14 17:59:35 -0700695 t.hook = track__16BitsStereo;
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700696 ALOGV_IF((n & NEEDS_CHANNEL_COUNT__MASK) > NEEDS_CHANNEL_2,
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700697 "Track %d needs downmix", i);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700698 }
699 }
700 }
701 }
702
703 // select the processing hooks
704 state->hook = process__nop;
705 if (countActiveTracks) {
706 if (resampling) {
707 if (!state->outputTemp) {
708 state->outputTemp = new int32_t[MAX_NUM_CHANNELS * state->frameCount];
709 }
710 if (!state->resampleTemp) {
711 state->resampleTemp = new int32_t[MAX_NUM_CHANNELS * state->frameCount];
712 }
713 state->hook = process__genericResampling;
714 } else {
715 if (state->outputTemp) {
716 delete [] state->outputTemp;
Glenn Kastene0feee32011-12-13 11:53:26 -0800717 state->outputTemp = NULL;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700718 }
719 if (state->resampleTemp) {
720 delete [] state->resampleTemp;
Glenn Kastene0feee32011-12-13 11:53:26 -0800721 state->resampleTemp = NULL;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700722 }
723 state->hook = process__genericNoResampling;
724 if (all16BitsStereoNoResample && !volumeRamp) {
725 if (countActiveTracks == 1) {
726 state->hook = process__OneTrack16BitsStereoNoResampling;
727 }
728 }
729 }
730 }
731
Steve Block3856b092011-10-20 11:56:00 +0100732 ALOGV("mixer configuration change: %d activeTracks (%08x) "
Mathias Agopian65ab4712010-07-14 17:59:35 -0700733 "all16BitsStereoNoResample=%d, resampling=%d, volumeRamp=%d",
734 countActiveTracks, state->enabledTracks,
735 all16BitsStereoNoResample, resampling, volumeRamp);
736
John Grossman4ff14ba2012-02-08 16:37:41 -0800737 state->hook(state, pts);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700738
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800739 // Now that the volume ramp has been done, set optimal state and
740 // track hooks for subsequent mixer process
741 if (countActiveTracks) {
Glenn Kasten4c340c62012-01-27 12:33:54 -0800742 bool allMuted = true;
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800743 uint32_t en = state->enabledTracks;
744 while (en) {
745 const int i = 31 - __builtin_clz(en);
746 en &= ~(1<<i);
747 track_t& t = state->tracks[i];
748 if (!t.doesResample() && t.volumeRL == 0)
749 {
750 t.needs |= NEEDS_MUTE_ENABLED;
751 t.hook = track__nop;
752 } else {
Glenn Kasten4c340c62012-01-27 12:33:54 -0800753 allMuted = false;
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800754 }
755 }
756 if (allMuted) {
757 state->hook = process__nop;
758 } else if (all16BitsStereoNoResample) {
759 if (countActiveTracks == 1) {
760 state->hook = process__OneTrack16BitsStereoNoResampling;
761 }
762 }
763 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700764}
765
Mathias Agopian65ab4712010-07-14 17:59:35 -0700766
767void AudioMixer::track__genericResample(track_t* t, int32_t* out, size_t outFrameCount, int32_t* temp, int32_t* aux)
768{
769 t->resampler->setSampleRate(t->sampleRate);
770
771 // ramp gain - resample to temp buffer and scale/mix in 2nd step
772 if (aux != NULL) {
773 // always resample with unity gain when sending to auxiliary buffer to be able
774 // to apply send level after resampling
775 // TODO: modify each resampler to support aux channel?
776 t->resampler->setVolume(UNITY_GAIN, UNITY_GAIN);
777 memset(temp, 0, outFrameCount * MAX_NUM_CHANNELS * sizeof(int32_t));
778 t->resampler->resample(temp, outFrameCount, t->bufferProvider);
Glenn Kastenf6b16782011-12-15 09:51:17 -0800779 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1]|t->auxInc)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700780 volumeRampStereo(t, out, outFrameCount, temp, aux);
781 } else {
782 volumeStereo(t, out, outFrameCount, temp, aux);
783 }
784 } else {
Glenn Kastenf6b16782011-12-15 09:51:17 -0800785 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1])) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700786 t->resampler->setVolume(UNITY_GAIN, UNITY_GAIN);
787 memset(temp, 0, outFrameCount * MAX_NUM_CHANNELS * sizeof(int32_t));
788 t->resampler->resample(temp, outFrameCount, t->bufferProvider);
789 volumeRampStereo(t, out, outFrameCount, temp, aux);
790 }
791
792 // constant gain
793 else {
794 t->resampler->setVolume(t->volume[0], t->volume[1]);
795 t->resampler->resample(out, outFrameCount, t->bufferProvider);
796 }
797 }
798}
799
800void AudioMixer::track__nop(track_t* t, int32_t* out, size_t outFrameCount, int32_t* temp, int32_t* aux)
801{
802}
803
804void AudioMixer::volumeRampStereo(track_t* t, int32_t* out, size_t frameCount, int32_t* temp, int32_t* aux)
805{
806 int32_t vl = t->prevVolume[0];
807 int32_t vr = t->prevVolume[1];
808 const int32_t vlInc = t->volumeInc[0];
809 const int32_t vrInc = t->volumeInc[1];
810
Steve Blockb8a80522011-12-20 16:23:08 +0000811 //ALOGD("[0] %p: inc=%f, v0=%f, v1=%d, final=%f, count=%d",
Mathias Agopian65ab4712010-07-14 17:59:35 -0700812 // t, vlInc/65536.0f, vl/65536.0f, t->volume[0],
813 // (vl + vlInc*frameCount)/65536.0f, frameCount);
814
815 // ramp volume
Glenn Kastenf6b16782011-12-15 09:51:17 -0800816 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700817 int32_t va = t->prevAuxLevel;
818 const int32_t vaInc = t->auxInc;
819 int32_t l;
820 int32_t r;
821
822 do {
823 l = (*temp++ >> 12);
824 r = (*temp++ >> 12);
825 *out++ += (vl >> 16) * l;
826 *out++ += (vr >> 16) * r;
827 *aux++ += (va >> 17) * (l + r);
828 vl += vlInc;
829 vr += vrInc;
830 va += vaInc;
831 } while (--frameCount);
832 t->prevAuxLevel = va;
833 } else {
834 do {
835 *out++ += (vl >> 16) * (*temp++ >> 12);
836 *out++ += (vr >> 16) * (*temp++ >> 12);
837 vl += vlInc;
838 vr += vrInc;
839 } while (--frameCount);
840 }
841 t->prevVolume[0] = vl;
842 t->prevVolume[1] = vr;
Glenn Kastena1117922012-01-26 10:53:32 -0800843 t->adjustVolumeRamp(aux != NULL);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700844}
845
846void AudioMixer::volumeStereo(track_t* t, int32_t* out, size_t frameCount, int32_t* temp, int32_t* aux)
847{
848 const int16_t vl = t->volume[0];
849 const int16_t vr = t->volume[1];
850
Glenn Kastenf6b16782011-12-15 09:51:17 -0800851 if (CC_UNLIKELY(aux != NULL)) {
Glenn Kasten3b81aca2012-01-27 15:26:23 -0800852 const int16_t va = t->auxLevel;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700853 do {
854 int16_t l = (int16_t)(*temp++ >> 12);
855 int16_t r = (int16_t)(*temp++ >> 12);
856 out[0] = mulAdd(l, vl, out[0]);
857 int16_t a = (int16_t)(((int32_t)l + r) >> 1);
858 out[1] = mulAdd(r, vr, out[1]);
859 out += 2;
860 aux[0] = mulAdd(a, va, aux[0]);
861 aux++;
862 } while (--frameCount);
863 } else {
864 do {
865 int16_t l = (int16_t)(*temp++ >> 12);
866 int16_t r = (int16_t)(*temp++ >> 12);
867 out[0] = mulAdd(l, vl, out[0]);
868 out[1] = mulAdd(r, vr, out[1]);
869 out += 2;
870 } while (--frameCount);
871 }
872}
873
874void AudioMixer::track__16BitsStereo(track_t* t, int32_t* out, size_t frameCount, int32_t* temp, int32_t* aux)
875{
Glenn Kasten54c3b662012-01-06 07:46:30 -0800876 const int16_t *in = static_cast<const int16_t *>(t->in);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700877
Glenn Kastenf6b16782011-12-15 09:51:17 -0800878 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700879 int32_t l;
880 int32_t r;
881 // ramp gain
Glenn Kastenf6b16782011-12-15 09:51:17 -0800882 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1]|t->auxInc)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700883 int32_t vl = t->prevVolume[0];
884 int32_t vr = t->prevVolume[1];
885 int32_t va = t->prevAuxLevel;
886 const int32_t vlInc = t->volumeInc[0];
887 const int32_t vrInc = t->volumeInc[1];
888 const int32_t vaInc = t->auxInc;
Steve Blockb8a80522011-12-20 16:23:08 +0000889 // ALOGD("[1] %p: inc=%f, v0=%f, v1=%d, final=%f, count=%d",
Mathias Agopian65ab4712010-07-14 17:59:35 -0700890 // t, vlInc/65536.0f, vl/65536.0f, t->volume[0],
891 // (vl + vlInc*frameCount)/65536.0f, frameCount);
892
893 do {
894 l = (int32_t)*in++;
895 r = (int32_t)*in++;
896 *out++ += (vl >> 16) * l;
897 *out++ += (vr >> 16) * r;
898 *aux++ += (va >> 17) * (l + r);
899 vl += vlInc;
900 vr += vrInc;
901 va += vaInc;
902 } while (--frameCount);
903
904 t->prevVolume[0] = vl;
905 t->prevVolume[1] = vr;
906 t->prevAuxLevel = va;
907 t->adjustVolumeRamp(true);
908 }
909
910 // constant gain
911 else {
912 const uint32_t vrl = t->volumeRL;
913 const int16_t va = (int16_t)t->auxLevel;
914 do {
Glenn Kasten54c3b662012-01-06 07:46:30 -0800915 uint32_t rl = *reinterpret_cast<const uint32_t *>(in);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700916 int16_t a = (int16_t)(((int32_t)in[0] + in[1]) >> 1);
917 in += 2;
918 out[0] = mulAddRL(1, rl, vrl, out[0]);
919 out[1] = mulAddRL(0, rl, vrl, out[1]);
920 out += 2;
921 aux[0] = mulAdd(a, va, aux[0]);
922 aux++;
923 } while (--frameCount);
924 }
925 } else {
926 // ramp gain
Glenn Kastenf6b16782011-12-15 09:51:17 -0800927 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1])) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700928 int32_t vl = t->prevVolume[0];
929 int32_t vr = t->prevVolume[1];
930 const int32_t vlInc = t->volumeInc[0];
931 const int32_t vrInc = t->volumeInc[1];
932
Steve Blockb8a80522011-12-20 16:23:08 +0000933 // ALOGD("[1] %p: inc=%f, v0=%f, v1=%d, final=%f, count=%d",
Mathias Agopian65ab4712010-07-14 17:59:35 -0700934 // t, vlInc/65536.0f, vl/65536.0f, t->volume[0],
935 // (vl + vlInc*frameCount)/65536.0f, frameCount);
936
937 do {
938 *out++ += (vl >> 16) * (int32_t) *in++;
939 *out++ += (vr >> 16) * (int32_t) *in++;
940 vl += vlInc;
941 vr += vrInc;
942 } while (--frameCount);
943
944 t->prevVolume[0] = vl;
945 t->prevVolume[1] = vr;
946 t->adjustVolumeRamp(false);
947 }
948
949 // constant gain
950 else {
951 const uint32_t vrl = t->volumeRL;
952 do {
Glenn Kasten54c3b662012-01-06 07:46:30 -0800953 uint32_t rl = *reinterpret_cast<const uint32_t *>(in);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700954 in += 2;
955 out[0] = mulAddRL(1, rl, vrl, out[0]);
956 out[1] = mulAddRL(0, rl, vrl, out[1]);
957 out += 2;
958 } while (--frameCount);
959 }
960 }
961 t->in = in;
962}
963
964void AudioMixer::track__16BitsMono(track_t* t, int32_t* out, size_t frameCount, int32_t* temp, int32_t* aux)
965{
Glenn Kasten54c3b662012-01-06 07:46:30 -0800966 const int16_t *in = static_cast<int16_t const *>(t->in);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700967
Glenn Kastenf6b16782011-12-15 09:51:17 -0800968 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700969 // ramp gain
Glenn Kastenf6b16782011-12-15 09:51:17 -0800970 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1]|t->auxInc)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700971 int32_t vl = t->prevVolume[0];
972 int32_t vr = t->prevVolume[1];
973 int32_t va = t->prevAuxLevel;
974 const int32_t vlInc = t->volumeInc[0];
975 const int32_t vrInc = t->volumeInc[1];
976 const int32_t vaInc = t->auxInc;
977
Steve Blockb8a80522011-12-20 16:23:08 +0000978 // ALOGD("[2] %p: inc=%f, v0=%f, v1=%d, final=%f, count=%d",
Mathias Agopian65ab4712010-07-14 17:59:35 -0700979 // t, vlInc/65536.0f, vl/65536.0f, t->volume[0],
980 // (vl + vlInc*frameCount)/65536.0f, frameCount);
981
982 do {
983 int32_t l = *in++;
984 *out++ += (vl >> 16) * l;
985 *out++ += (vr >> 16) * l;
986 *aux++ += (va >> 16) * l;
987 vl += vlInc;
988 vr += vrInc;
989 va += vaInc;
990 } while (--frameCount);
991
992 t->prevVolume[0] = vl;
993 t->prevVolume[1] = vr;
994 t->prevAuxLevel = va;
995 t->adjustVolumeRamp(true);
996 }
997 // constant gain
998 else {
999 const int16_t vl = t->volume[0];
1000 const int16_t vr = t->volume[1];
1001 const int16_t va = (int16_t)t->auxLevel;
1002 do {
1003 int16_t l = *in++;
1004 out[0] = mulAdd(l, vl, out[0]);
1005 out[1] = mulAdd(l, vr, out[1]);
1006 out += 2;
1007 aux[0] = mulAdd(l, va, aux[0]);
1008 aux++;
1009 } while (--frameCount);
1010 }
1011 } else {
1012 // ramp gain
Glenn Kastenf6b16782011-12-15 09:51:17 -08001013 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1])) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001014 int32_t vl = t->prevVolume[0];
1015 int32_t vr = t->prevVolume[1];
1016 const int32_t vlInc = t->volumeInc[0];
1017 const int32_t vrInc = t->volumeInc[1];
1018
Steve Blockb8a80522011-12-20 16:23:08 +00001019 // ALOGD("[2] %p: inc=%f, v0=%f, v1=%d, final=%f, count=%d",
Mathias Agopian65ab4712010-07-14 17:59:35 -07001020 // t, vlInc/65536.0f, vl/65536.0f, t->volume[0],
1021 // (vl + vlInc*frameCount)/65536.0f, frameCount);
1022
1023 do {
1024 int32_t l = *in++;
1025 *out++ += (vl >> 16) * l;
1026 *out++ += (vr >> 16) * l;
1027 vl += vlInc;
1028 vr += vrInc;
1029 } while (--frameCount);
1030
1031 t->prevVolume[0] = vl;
1032 t->prevVolume[1] = vr;
1033 t->adjustVolumeRamp(false);
1034 }
1035 // constant gain
1036 else {
1037 const int16_t vl = t->volume[0];
1038 const int16_t vr = t->volume[1];
1039 do {
1040 int16_t l = *in++;
1041 out[0] = mulAdd(l, vl, out[0]);
1042 out[1] = mulAdd(l, vr, out[1]);
1043 out += 2;
1044 } while (--frameCount);
1045 }
1046 }
1047 t->in = in;
1048}
1049
Mathias Agopian65ab4712010-07-14 17:59:35 -07001050// no-op case
John Grossman4ff14ba2012-02-08 16:37:41 -08001051void AudioMixer::process__nop(state_t* state, int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001052{
1053 uint32_t e0 = state->enabledTracks;
1054 size_t bufSize = state->frameCount * sizeof(int16_t) * MAX_NUM_CHANNELS;
1055 while (e0) {
1056 // process by group of tracks with same output buffer to
1057 // avoid multiple memset() on same buffer
1058 uint32_t e1 = e0, e2 = e0;
1059 int i = 31 - __builtin_clz(e1);
1060 track_t& t1 = state->tracks[i];
1061 e2 &= ~(1<<i);
1062 while (e2) {
1063 i = 31 - __builtin_clz(e2);
1064 e2 &= ~(1<<i);
1065 track_t& t2 = state->tracks[i];
Glenn Kastenf6b16782011-12-15 09:51:17 -08001066 if (CC_UNLIKELY(t2.mainBuffer != t1.mainBuffer)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001067 e1 &= ~(1<<i);
1068 }
1069 }
1070 e0 &= ~(e1);
1071
1072 memset(t1.mainBuffer, 0, bufSize);
1073
1074 while (e1) {
1075 i = 31 - __builtin_clz(e1);
1076 e1 &= ~(1<<i);
1077 t1 = state->tracks[i];
1078 size_t outFrames = state->frameCount;
1079 while (outFrames) {
1080 t1.buffer.frameCount = outFrames;
John Grossman4ff14ba2012-02-08 16:37:41 -08001081 int64_t outputPTS = calculateOutputPTS(
1082 t1, pts, state->frameCount - outFrames);
1083 t1.bufferProvider->getNextBuffer(&t1.buffer, outputPTS);
Glenn Kastena0d68332012-01-27 16:47:15 -08001084 if (t1.buffer.raw == NULL) break;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001085 outFrames -= t1.buffer.frameCount;
1086 t1.bufferProvider->releaseBuffer(&t1.buffer);
1087 }
1088 }
1089 }
1090}
1091
1092// generic code without resampling
John Grossman4ff14ba2012-02-08 16:37:41 -08001093void AudioMixer::process__genericNoResampling(state_t* state, int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001094{
1095 int32_t outTemp[BLOCKSIZE * MAX_NUM_CHANNELS] __attribute__((aligned(32)));
1096
1097 // acquire each track's buffer
1098 uint32_t enabledTracks = state->enabledTracks;
1099 uint32_t e0 = enabledTracks;
1100 while (e0) {
1101 const int i = 31 - __builtin_clz(e0);
1102 e0 &= ~(1<<i);
1103 track_t& t = state->tracks[i];
1104 t.buffer.frameCount = state->frameCount;
Glenn Kastenf0ff9082012-12-07 14:13:35 -08001105 int valid = t.bufferProvider->getValid();
1106 if (valid != AudioBufferProvider::kValid) {
1107 ALOGE("invalid bufferProvider=%p name=%d frameCount=%d valid=%#x enabledTracks=%#x",
1108 t.bufferProvider, i, t.buffer.frameCount, valid, enabledTracks);
1109 // expect to crash
1110 }
John Grossman4ff14ba2012-02-08 16:37:41 -08001111 t.bufferProvider->getNextBuffer(&t.buffer, pts);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001112 t.frameCount = t.buffer.frameCount;
1113 t.in = t.buffer.raw;
1114 // t.in == NULL can happen if the track was flushed just after having
1115 // been enabled for mixing.
1116 if (t.in == NULL)
1117 enabledTracks &= ~(1<<i);
1118 }
1119
1120 e0 = enabledTracks;
1121 while (e0) {
1122 // process by group of tracks with same output buffer to
1123 // optimize cache use
1124 uint32_t e1 = e0, e2 = e0;
1125 int j = 31 - __builtin_clz(e1);
1126 track_t& t1 = state->tracks[j];
1127 e2 &= ~(1<<j);
1128 while (e2) {
1129 j = 31 - __builtin_clz(e2);
1130 e2 &= ~(1<<j);
1131 track_t& t2 = state->tracks[j];
Glenn Kastenf6b16782011-12-15 09:51:17 -08001132 if (CC_UNLIKELY(t2.mainBuffer != t1.mainBuffer)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001133 e1 &= ~(1<<j);
1134 }
1135 }
1136 e0 &= ~(e1);
1137 // this assumes output 16 bits stereo, no resampling
1138 int32_t *out = t1.mainBuffer;
1139 size_t numFrames = 0;
1140 do {
1141 memset(outTemp, 0, sizeof(outTemp));
1142 e2 = e1;
1143 while (e2) {
1144 const int i = 31 - __builtin_clz(e2);
1145 e2 &= ~(1<<i);
1146 track_t& t = state->tracks[i];
1147 size_t outFrames = BLOCKSIZE;
1148 int32_t *aux = NULL;
Glenn Kastenf6b16782011-12-15 09:51:17 -08001149 if (CC_UNLIKELY((t.needs & NEEDS_AUX__MASK) == NEEDS_AUX_ENABLED)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001150 aux = t.auxBuffer + numFrames;
1151 }
1152 while (outFrames) {
1153 size_t inFrames = (t.frameCount > outFrames)?outFrames:t.frameCount;
1154 if (inFrames) {
Glenn Kastena1117922012-01-26 10:53:32 -08001155 t.hook(&t, outTemp + (BLOCKSIZE-outFrames)*MAX_NUM_CHANNELS, inFrames, state->resampleTemp, aux);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001156 t.frameCount -= inFrames;
1157 outFrames -= inFrames;
Glenn Kastenf6b16782011-12-15 09:51:17 -08001158 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001159 aux += inFrames;
1160 }
1161 }
1162 if (t.frameCount == 0 && outFrames) {
1163 t.bufferProvider->releaseBuffer(&t.buffer);
1164 t.buffer.frameCount = (state->frameCount - numFrames) - (BLOCKSIZE - outFrames);
John Grossman4ff14ba2012-02-08 16:37:41 -08001165 int64_t outputPTS = calculateOutputPTS(
1166 t, pts, numFrames + (BLOCKSIZE - outFrames));
1167 t.bufferProvider->getNextBuffer(&t.buffer, outputPTS);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001168 t.in = t.buffer.raw;
1169 if (t.in == NULL) {
1170 enabledTracks &= ~(1<<i);
1171 e1 &= ~(1<<i);
1172 break;
1173 }
1174 t.frameCount = t.buffer.frameCount;
1175 }
1176 }
1177 }
1178 ditherAndClamp(out, outTemp, BLOCKSIZE);
1179 out += BLOCKSIZE;
1180 numFrames += BLOCKSIZE;
1181 } while (numFrames < state->frameCount);
1182 }
1183
1184 // release each track's buffer
1185 e0 = enabledTracks;
1186 while (e0) {
1187 const int i = 31 - __builtin_clz(e0);
1188 e0 &= ~(1<<i);
1189 track_t& t = state->tracks[i];
1190 t.bufferProvider->releaseBuffer(&t.buffer);
1191 }
1192}
1193
1194
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -08001195// generic code with resampling
John Grossman4ff14ba2012-02-08 16:37:41 -08001196void AudioMixer::process__genericResampling(state_t* state, int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001197{
Glenn Kasten54c3b662012-01-06 07:46:30 -08001198 // this const just means that local variable outTemp doesn't change
Mathias Agopian65ab4712010-07-14 17:59:35 -07001199 int32_t* const outTemp = state->outputTemp;
1200 const size_t size = sizeof(int32_t) * MAX_NUM_CHANNELS * state->frameCount;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001201
1202 size_t numFrames = state->frameCount;
1203
1204 uint32_t e0 = state->enabledTracks;
1205 while (e0) {
1206 // process by group of tracks with same output buffer
1207 // to optimize cache use
1208 uint32_t e1 = e0, e2 = e0;
1209 int j = 31 - __builtin_clz(e1);
1210 track_t& t1 = state->tracks[j];
1211 e2 &= ~(1<<j);
1212 while (e2) {
1213 j = 31 - __builtin_clz(e2);
1214 e2 &= ~(1<<j);
1215 track_t& t2 = state->tracks[j];
Glenn Kastenf6b16782011-12-15 09:51:17 -08001216 if (CC_UNLIKELY(t2.mainBuffer != t1.mainBuffer)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001217 e1 &= ~(1<<j);
1218 }
1219 }
1220 e0 &= ~(e1);
1221 int32_t *out = t1.mainBuffer;
Yuuhi Yamaguchi2151d7b2011-02-04 15:24:34 +01001222 memset(outTemp, 0, size);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001223 while (e1) {
1224 const int i = 31 - __builtin_clz(e1);
1225 e1 &= ~(1<<i);
1226 track_t& t = state->tracks[i];
1227 int32_t *aux = NULL;
Glenn Kastenf6b16782011-12-15 09:51:17 -08001228 if (CC_UNLIKELY((t.needs & NEEDS_AUX__MASK) == NEEDS_AUX_ENABLED)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001229 aux = t.auxBuffer;
1230 }
1231
1232 // this is a little goofy, on the resampling case we don't
1233 // acquire/release the buffers because it's done by
1234 // the resampler.
1235 if ((t.needs & NEEDS_RESAMPLE__MASK) == NEEDS_RESAMPLE_ENABLED) {
John Grossman4ff14ba2012-02-08 16:37:41 -08001236 t.resampler->setPTS(pts);
Glenn Kastena1117922012-01-26 10:53:32 -08001237 t.hook(&t, outTemp, numFrames, state->resampleTemp, aux);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001238 } else {
1239
1240 size_t outFrames = 0;
1241
1242 while (outFrames < numFrames) {
1243 t.buffer.frameCount = numFrames - outFrames;
John Grossman4ff14ba2012-02-08 16:37:41 -08001244 int64_t outputPTS = calculateOutputPTS(t, pts, outFrames);
1245 t.bufferProvider->getNextBuffer(&t.buffer, outputPTS);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001246 t.in = t.buffer.raw;
1247 // t.in == NULL can happen if the track was flushed just after having
1248 // been enabled for mixing.
1249 if (t.in == NULL) break;
1250
Glenn Kastenf6b16782011-12-15 09:51:17 -08001251 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001252 aux += outFrames;
1253 }
Glenn Kastena1117922012-01-26 10:53:32 -08001254 t.hook(&t, outTemp + outFrames*MAX_NUM_CHANNELS, t.buffer.frameCount, state->resampleTemp, aux);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001255 outFrames += t.buffer.frameCount;
1256 t.bufferProvider->releaseBuffer(&t.buffer);
1257 }
1258 }
1259 }
1260 ditherAndClamp(out, outTemp, numFrames);
1261 }
1262}
1263
1264// one track, 16 bits stereo without resampling is the most common case
John Grossman4ff14ba2012-02-08 16:37:41 -08001265void AudioMixer::process__OneTrack16BitsStereoNoResampling(state_t* state,
1266 int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001267{
Glenn Kasten99e53b82012-01-19 08:59:58 -08001268 // This method is only called when state->enabledTracks has exactly
1269 // one bit set. The asserts below would verify this, but are commented out
1270 // since the whole point of this method is to optimize performance.
Glenn Kasten5798d4e2012-03-08 12:18:35 -08001271 //ALOG_ASSERT(0 != state->enabledTracks, "no tracks enabled");
Mathias Agopian65ab4712010-07-14 17:59:35 -07001272 const int i = 31 - __builtin_clz(state->enabledTracks);
Glenn Kasten5798d4e2012-03-08 12:18:35 -08001273 //ALOG_ASSERT((1 << i) == state->enabledTracks, "more than 1 track enabled");
Mathias Agopian65ab4712010-07-14 17:59:35 -07001274 const track_t& t = state->tracks[i];
1275
1276 AudioBufferProvider::Buffer& b(t.buffer);
1277
1278 int32_t* out = t.mainBuffer;
1279 size_t numFrames = state->frameCount;
1280
1281 const int16_t vl = t.volume[0];
1282 const int16_t vr = t.volume[1];
1283 const uint32_t vrl = t.volumeRL;
1284 while (numFrames) {
1285 b.frameCount = numFrames;
John Grossman4ff14ba2012-02-08 16:37:41 -08001286 int64_t outputPTS = calculateOutputPTS(t, pts, out - t.mainBuffer);
1287 t.bufferProvider->getNextBuffer(&b, outputPTS);
Glenn Kasten54c3b662012-01-06 07:46:30 -08001288 const int16_t *in = b.i16;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001289
1290 // in == NULL can happen if the track was flushed just after having
1291 // been enabled for mixing.
1292 if (in == NULL || ((unsigned long)in & 3)) {
1293 memset(out, 0, numFrames*MAX_NUM_CHANNELS*sizeof(int16_t));
Steve Block29357bc2012-01-06 19:20:56 +00001294 ALOGE_IF(((unsigned long)in & 3), "process stereo track: input buffer alignment pb: buffer %p track %d, channels %d, needs %08x",
Mathias Agopian65ab4712010-07-14 17:59:35 -07001295 in, i, t.channelCount, t.needs);
1296 return;
1297 }
1298 size_t outFrames = b.frameCount;
1299
Glenn Kastenf6b16782011-12-15 09:51:17 -08001300 if (CC_UNLIKELY(uint32_t(vl) > UNITY_GAIN || uint32_t(vr) > UNITY_GAIN)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001301 // volume is boosted, so we might need to clamp even though
1302 // we process only one track.
1303 do {
Glenn Kasten54c3b662012-01-06 07:46:30 -08001304 uint32_t rl = *reinterpret_cast<const uint32_t *>(in);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001305 in += 2;
1306 int32_t l = mulRL(1, rl, vrl) >> 12;
1307 int32_t r = mulRL(0, rl, vrl) >> 12;
1308 // clamping...
1309 l = clamp16(l);
1310 r = clamp16(r);
1311 *out++ = (r<<16) | (l & 0xFFFF);
1312 } while (--outFrames);
1313 } else {
1314 do {
Glenn Kasten54c3b662012-01-06 07:46:30 -08001315 uint32_t rl = *reinterpret_cast<const uint32_t *>(in);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001316 in += 2;
1317 int32_t l = mulRL(1, rl, vrl) >> 12;
1318 int32_t r = mulRL(0, rl, vrl) >> 12;
1319 *out++ = (r<<16) | (l & 0xFFFF);
1320 } while (--outFrames);
1321 }
1322 numFrames -= b.frameCount;
1323 t.bufferProvider->releaseBuffer(&b);
1324 }
1325}
1326
Glenn Kasten81a028f2011-12-15 09:53:12 -08001327#if 0
Mathias Agopian65ab4712010-07-14 17:59:35 -07001328// 2 tracks is also a common case
1329// NEVER used in current implementation of process__validate()
1330// only use if the 2 tracks have the same output buffer
John Grossman4ff14ba2012-02-08 16:37:41 -08001331void AudioMixer::process__TwoTracks16BitsStereoNoResampling(state_t* state,
1332 int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001333{
1334 int i;
1335 uint32_t en = state->enabledTracks;
1336
1337 i = 31 - __builtin_clz(en);
1338 const track_t& t0 = state->tracks[i];
1339 AudioBufferProvider::Buffer& b0(t0.buffer);
1340
1341 en &= ~(1<<i);
1342 i = 31 - __builtin_clz(en);
1343 const track_t& t1 = state->tracks[i];
1344 AudioBufferProvider::Buffer& b1(t1.buffer);
1345
Glenn Kasten54c3b662012-01-06 07:46:30 -08001346 const int16_t *in0;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001347 const int16_t vl0 = t0.volume[0];
1348 const int16_t vr0 = t0.volume[1];
1349 size_t frameCount0 = 0;
1350
Glenn Kasten54c3b662012-01-06 07:46:30 -08001351 const int16_t *in1;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001352 const int16_t vl1 = t1.volume[0];
1353 const int16_t vr1 = t1.volume[1];
1354 size_t frameCount1 = 0;
1355
1356 //FIXME: only works if two tracks use same buffer
1357 int32_t* out = t0.mainBuffer;
1358 size_t numFrames = state->frameCount;
Glenn Kasten54c3b662012-01-06 07:46:30 -08001359 const int16_t *buff = NULL;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001360
1361
1362 while (numFrames) {
1363
1364 if (frameCount0 == 0) {
1365 b0.frameCount = numFrames;
John Grossman4ff14ba2012-02-08 16:37:41 -08001366 int64_t outputPTS = calculateOutputPTS(t0, pts,
1367 out - t0.mainBuffer);
1368 t0.bufferProvider->getNextBuffer(&b0, outputPTS);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001369 if (b0.i16 == NULL) {
1370 if (buff == NULL) {
1371 buff = new int16_t[MAX_NUM_CHANNELS * state->frameCount];
1372 }
1373 in0 = buff;
1374 b0.frameCount = numFrames;
1375 } else {
1376 in0 = b0.i16;
1377 }
1378 frameCount0 = b0.frameCount;
1379 }
1380 if (frameCount1 == 0) {
1381 b1.frameCount = numFrames;
John Grossman4ff14ba2012-02-08 16:37:41 -08001382 int64_t outputPTS = calculateOutputPTS(t1, pts,
1383 out - t0.mainBuffer);
1384 t1.bufferProvider->getNextBuffer(&b1, outputPTS);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001385 if (b1.i16 == NULL) {
1386 if (buff == NULL) {
1387 buff = new int16_t[MAX_NUM_CHANNELS * state->frameCount];
1388 }
1389 in1 = buff;
1390 b1.frameCount = numFrames;
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -08001391 } else {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001392 in1 = b1.i16;
1393 }
1394 frameCount1 = b1.frameCount;
1395 }
1396
1397 size_t outFrames = frameCount0 < frameCount1?frameCount0:frameCount1;
1398
1399 numFrames -= outFrames;
1400 frameCount0 -= outFrames;
1401 frameCount1 -= outFrames;
1402
1403 do {
1404 int32_t l0 = *in0++;
1405 int32_t r0 = *in0++;
1406 l0 = mul(l0, vl0);
1407 r0 = mul(r0, vr0);
1408 int32_t l = *in1++;
1409 int32_t r = *in1++;
1410 l = mulAdd(l, vl1, l0) >> 12;
1411 r = mulAdd(r, vr1, r0) >> 12;
1412 // clamping...
1413 l = clamp16(l);
1414 r = clamp16(r);
1415 *out++ = (r<<16) | (l & 0xFFFF);
1416 } while (--outFrames);
1417
1418 if (frameCount0 == 0) {
1419 t0.bufferProvider->releaseBuffer(&b0);
1420 }
1421 if (frameCount1 == 0) {
1422 t1.bufferProvider->releaseBuffer(&b1);
1423 }
1424 }
1425
Glenn Kastene9dd0172012-01-27 18:08:45 -08001426 delete [] buff;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001427}
Glenn Kasten81a028f2011-12-15 09:53:12 -08001428#endif
Mathias Agopian65ab4712010-07-14 17:59:35 -07001429
John Grossman4ff14ba2012-02-08 16:37:41 -08001430int64_t AudioMixer::calculateOutputPTS(const track_t& t, int64_t basePTS,
1431 int outputFrameIndex)
1432{
1433 if (AudioBufferProvider::kInvalidPTS == basePTS)
1434 return AudioBufferProvider::kInvalidPTS;
1435
1436 return basePTS + ((outputFrameIndex * t.localTimeFreq) / t.sampleRate);
1437}
1438
Mathias Agopian65ab4712010-07-14 17:59:35 -07001439// ----------------------------------------------------------------------------
1440}; // namespace android