blob: 183c1f3368af0efaa8d23f6d07d291c27be64ee7 [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
Glenn Kasten52008f82012-03-18 09:34:41 -0700111 pthread_once(&sOnceControl, &sInitRoutine);
112
Mathias Agopian65ab4712010-07-14 17:59:35 -0700113 mState.enabledTracks= 0;
114 mState.needsChanged = 0;
115 mState.frameCount = frameCount;
Glenn Kasten84afa3b2012-01-25 15:28:08 -0800116 mState.hook = process__nop;
Glenn Kastene0feee32011-12-13 11:53:26 -0800117 mState.outputTemp = NULL;
118 mState.resampleTemp = NULL;
Glenn Kasten84afa3b2012-01-25 15:28:08 -0800119 // mState.reserved
Glenn Kasten17a736c2012-02-14 08:52:15 -0800120
121 // FIXME Most of the following initialization is probably redundant since
122 // tracks[i] should only be referenced if (mTrackNames & (1 << i)) != 0
123 // and mTrackNames is initially 0. However, leave it here until that's verified.
Mathias Agopian65ab4712010-07-14 17:59:35 -0700124 track_t* t = mState.tracks;
Glenn Kastenbf71f1e2011-12-13 11:52:35 -0800125 for (unsigned i=0 ; i < MAX_NUM_TRACKS ; i++) {
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 Trivi9bd23222012-04-16 13:43:48 -0700166int AudioMixer::getTrackName(audio_channel_mask_t channelMask)
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;
192 // setBufferProvider(name, AudioBufferProvider *) is required before enable(name)
193 t->bufferProvider = NULL;
194 t->buffer.raw = NULL;
195 // no initialization needed
196 // t->buffer.frameCount
197 t->hook = NULL;
198 t->in = NULL;
199 t->resampler = NULL;
200 t->sampleRate = mSampleRate;
201 // setParameter(name, TRACK, MAIN_BUFFER, mixBuffer) is required before enable(name)
202 t->mainBuffer = NULL;
203 t->auxBuffer = NULL;
Glenn Kasten52008f82012-03-18 09:34:41 -0700204 t->downmixerBufferProvider = NULL;
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700205
206 status_t status = initTrackDownmix(&mState.tracks[n], n, channelMask);
207 if (status == OK) {
208 return TRACK0 + n;
209 }
210 ALOGE("AudioMixer::getTrackName(0x%x) failed, error preparing track for downmix",
211 channelMask);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700212 }
213 return -1;
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800214}
Mathias Agopian65ab4712010-07-14 17:59:35 -0700215
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800216void AudioMixer::invalidateState(uint32_t mask)
217{
Mathias Agopian65ab4712010-07-14 17:59:35 -0700218 if (mask) {
219 mState.needsChanged |= mask;
220 mState.hook = process__validate;
221 }
222 }
223
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700224status_t AudioMixer::initTrackDownmix(track_t* pTrack, int trackNum, audio_channel_mask_t mask)
225{
226 uint32_t channelCount = popcount(mask);
227 ALOG_ASSERT((channelCount <= MAX_NUM_CHANNELS_TO_DOWNMIX) && channelCount);
228 status_t status = OK;
229 if (channelCount > MAX_NUM_CHANNELS) {
230 pTrack->channelMask = mask;
231 pTrack->channelCount = channelCount;
232 ALOGV("initTrackDownmix(track=%d, mask=0x%x) calls prepareTrackForDownmix()",
233 trackNum, mask);
234 status = prepareTrackForDownmix(pTrack, trackNum);
235 } else {
236 unprepareTrackForDownmix(pTrack, trackNum);
237 }
238 return status;
239}
240
241void AudioMixer::unprepareTrackForDownmix(track_t* pTrack, int trackName) {
242 ALOGV("AudioMixer::unprepareTrackForDownmix(%d)", trackName);
243
244 if (pTrack->downmixerBufferProvider != NULL) {
245 // this track had previously been configured with a downmixer, delete it
246 ALOGV(" deleting old downmixer");
247 pTrack->bufferProvider = pTrack->downmixerBufferProvider->mTrackBufferProvider;
248 delete pTrack->downmixerBufferProvider;
249 pTrack->downmixerBufferProvider = NULL;
250 } else {
251 ALOGV(" nothing to do, no downmixer to delete");
252 }
253}
254
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700255status_t AudioMixer::prepareTrackForDownmix(track_t* pTrack, int trackName)
256{
257 ALOGV("AudioMixer::prepareTrackForDownmix(%d) with mask 0x%x", trackName, pTrack->channelMask);
258
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700259 // discard the previous downmixer if there was one
260 unprepareTrackForDownmix(pTrack, trackName);
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700261
262 DownmixerBufferProvider* pDbp = new DownmixerBufferProvider();
263 int32_t status;
264
265 if (!isMultichannelCapable) {
266 ALOGE("prepareTrackForDownmix(%d) fails: mixer doesn't support multichannel content",
267 trackName);
268 goto noDownmixForActiveTrack;
269 }
270
271 if (EffectCreate(&dwnmFxDesc.uuid,
272 -2 /*sessionId*/, -2 /*ioId*/,// both not relevant here, using random value
273 &pDbp->mDownmixHandle/*pHandle*/) != 0) {
274 ALOGE("prepareTrackForDownmix(%d) fails: error creating downmixer effect", trackName);
275 goto noDownmixForActiveTrack;
276 }
277
278 // channel input configuration will be overridden per-track
279 pDbp->mDownmixConfig.inputCfg.channels = pTrack->channelMask;
280 pDbp->mDownmixConfig.outputCfg.channels = AUDIO_CHANNEL_OUT_STEREO;
281 pDbp->mDownmixConfig.inputCfg.format = AUDIO_FORMAT_PCM_16_BIT;
282 pDbp->mDownmixConfig.outputCfg.format = AUDIO_FORMAT_PCM_16_BIT;
283 pDbp->mDownmixConfig.inputCfg.samplingRate = pTrack->sampleRate;
284 pDbp->mDownmixConfig.outputCfg.samplingRate = pTrack->sampleRate;
285 pDbp->mDownmixConfig.inputCfg.accessMode = EFFECT_BUFFER_ACCESS_READ;
286 pDbp->mDownmixConfig.outputCfg.accessMode = EFFECT_BUFFER_ACCESS_WRITE;
287 // input and output buffer provider, and frame count will not be used as the downmix effect
288 // process() function is called directly (see DownmixerBufferProvider::getNextBuffer())
289 pDbp->mDownmixConfig.inputCfg.mask = EFFECT_CONFIG_SMP_RATE | EFFECT_CONFIG_CHANNELS |
290 EFFECT_CONFIG_FORMAT | EFFECT_CONFIG_ACC_MODE;
291 pDbp->mDownmixConfig.outputCfg.mask = pDbp->mDownmixConfig.inputCfg.mask;
292
293 {// scope for local variables that are not used in goto label "noDownmixForActiveTrack"
294 int cmdStatus;
295 uint32_t replySize = sizeof(int);
296
297 // Configure and enable downmixer
298 status = (*pDbp->mDownmixHandle)->command(pDbp->mDownmixHandle,
299 EFFECT_CMD_SET_CONFIG /*cmdCode*/, sizeof(effect_config_t) /*cmdSize*/,
300 &pDbp->mDownmixConfig /*pCmdData*/,
301 &replySize /*replySize*/, &cmdStatus /*pReplyData*/);
302 if ((status != 0) || (cmdStatus != 0)) {
303 ALOGE("error %d while configuring downmixer for track %d", status, trackName);
304 goto noDownmixForActiveTrack;
305 }
306 replySize = sizeof(int);
307 status = (*pDbp->mDownmixHandle)->command(pDbp->mDownmixHandle,
308 EFFECT_CMD_ENABLE /*cmdCode*/, 0 /*cmdSize*/, NULL /*pCmdData*/,
309 &replySize /*replySize*/, &cmdStatus /*pReplyData*/);
310 if ((status != 0) || (cmdStatus != 0)) {
311 ALOGE("error %d while enabling downmixer for track %d", status, trackName);
312 goto noDownmixForActiveTrack;
313 }
314
315 // Set downmix type
316 // parameter size rounded for padding on 32bit boundary
317 const int psizePadded = ((sizeof(downmix_params_t) - 1)/sizeof(int) + 1) * sizeof(int);
318 const int downmixParamSize =
319 sizeof(effect_param_t) + psizePadded + sizeof(downmix_type_t);
320 effect_param_t * const param = (effect_param_t *) malloc(downmixParamSize);
321 param->psize = sizeof(downmix_params_t);
322 const downmix_params_t downmixParam = DOWNMIX_PARAM_TYPE;
323 memcpy(param->data, &downmixParam, param->psize);
324 const downmix_type_t downmixType = DOWNMIX_TYPE_FOLD;
325 param->vsize = sizeof(downmix_type_t);
326 memcpy(param->data + psizePadded, &downmixType, param->vsize);
327
328 status = (*pDbp->mDownmixHandle)->command(pDbp->mDownmixHandle,
329 EFFECT_CMD_SET_PARAM /* cmdCode */, downmixParamSize/* cmdSize */,
330 param /*pCmndData*/, &replySize /*replySize*/, &cmdStatus /*pReplyData*/);
331
332 free(param);
333
334 if ((status != 0) || (cmdStatus != 0)) {
335 ALOGE("error %d while setting downmix type for track %d", status, trackName);
336 goto noDownmixForActiveTrack;
337 } else {
338 ALOGV("downmix type set to %d for track %d", (int) downmixType, trackName);
339 }
340 }// end of scope for local variables that are not used in goto label "noDownmixForActiveTrack"
341
342 // initialization successful:
343 // - keep track of the real buffer provider in case it was set before
344 pDbp->mTrackBufferProvider = pTrack->bufferProvider;
345 // - we'll use the downmix effect integrated inside this
346 // track's buffer provider, and we'll use it as the track's buffer provider
347 pTrack->downmixerBufferProvider = pDbp;
348 pTrack->bufferProvider = pDbp;
349
350 return NO_ERROR;
351
352noDownmixForActiveTrack:
353 delete pDbp;
354 pTrack->downmixerBufferProvider = NULL;
355 return NO_INIT;
356}
357
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800358void AudioMixer::deleteTrackName(int name)
359{
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700360 ALOGV("AudioMixer::deleteTrackName(%d)", name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700361 name -= TRACK0;
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800362 ALOG_ASSERT(uint32_t(name) < MAX_NUM_TRACKS, "bad track name %d", name);
Glenn Kasten237a6242011-12-15 15:32:27 -0800363 ALOGV("deleteTrackName(%d)", name);
364 track_t& track(mState.tracks[ name ]);
Glenn Kasten4c340c62012-01-27 12:33:54 -0800365 if (track.enabled) {
366 track.enabled = false;
Glenn Kasten237a6242011-12-15 15:32:27 -0800367 invalidateState(1<<name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700368 }
Glenn Kasten4e2293f2012-04-12 09:39:07 -0700369 // delete the resampler
370 delete track.resampler;
371 track.resampler = NULL;
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700372 // delete the downmixer
373 unprepareTrackForDownmix(&mState.tracks[name], name);
374
Glenn Kasten237a6242011-12-15 15:32:27 -0800375 mTrackNames &= ~(1<<name);
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800376}
Mathias Agopian65ab4712010-07-14 17:59:35 -0700377
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800378void AudioMixer::enable(int name)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700379{
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800380 name -= TRACK0;
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800381 ALOG_ASSERT(uint32_t(name) < MAX_NUM_TRACKS, "bad track name %d", name);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800382 track_t& track = mState.tracks[name];
383
Glenn Kasten4c340c62012-01-27 12:33:54 -0800384 if (!track.enabled) {
385 track.enabled = true;
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800386 ALOGV("enable(%d)", name);
387 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700388 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700389}
390
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800391void AudioMixer::disable(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 = false;
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800399 ALOGV("disable(%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::setParameter(int name, int target, int param, void *value)
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];
Mathias Agopian65ab4712010-07-14 17:59:35 -0700409
Mathias Agopian65ab4712010-07-14 17:59:35 -0700410 int valueInt = (int)value;
411 int32_t *valueBuf = (int32_t *)value;
412
413 switch (target) {
Glenn Kasten788040c2011-05-05 08:19:00 -0700414
Mathias Agopian65ab4712010-07-14 17:59:35 -0700415 case TRACK:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800416 switch (param) {
Glenn Kasten788040c2011-05-05 08:19:00 -0700417 case CHANNEL_MASK: {
Glenn Kasten254af182012-07-03 14:59:05 -0700418 audio_channel_mask_t mask = (audio_channel_mask_t) value;
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800419 if (track.channelMask != mask) {
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800420 uint32_t channelCount = popcount(mask);
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700421 ALOG_ASSERT((channelCount <= MAX_NUM_CHANNELS_TO_DOWNMIX) && channelCount);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800422 track.channelMask = mask;
423 track.channelCount = channelCount;
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700424 // the mask has changed, does this track need a downmixer?
425 initTrackDownmix(&mState.tracks[name], name, mask);
Glenn Kasten788040c2011-05-05 08:19:00 -0700426 ALOGV("setParameter(TRACK, CHANNEL_MASK, %x)", mask);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800427 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700428 }
Glenn Kasten788040c2011-05-05 08:19:00 -0700429 } break;
430 case MAIN_BUFFER:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800431 if (track.mainBuffer != valueBuf) {
432 track.mainBuffer = valueBuf;
Steve Block3856b092011-10-20 11:56:00 +0100433 ALOGV("setParameter(TRACK, MAIN_BUFFER, %p)", valueBuf);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800434 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700435 }
Glenn Kasten788040c2011-05-05 08:19:00 -0700436 break;
437 case AUX_BUFFER:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800438 if (track.auxBuffer != valueBuf) {
439 track.auxBuffer = valueBuf;
Steve Block3856b092011-10-20 11:56:00 +0100440 ALOGV("setParameter(TRACK, AUX_BUFFER, %p)", valueBuf);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800441 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700442 }
Glenn Kasten788040c2011-05-05 08:19:00 -0700443 break;
Glenn Kastendeeb1282012-03-25 11:59:31 -0700444 case FORMAT:
445 ALOG_ASSERT(valueInt == AUDIO_FORMAT_PCM_16_BIT);
446 break;
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700447 // FIXME do we want to support setting the downmix type from AudioFlinger?
448 // for a specific track? or per mixer?
449 /* case DOWNMIX_TYPE:
450 break */
Glenn Kasten788040c2011-05-05 08:19:00 -0700451 default:
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800452 LOG_FATAL("bad param");
Mathias Agopian65ab4712010-07-14 17:59:35 -0700453 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700454 break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700455
Mathias Agopian65ab4712010-07-14 17:59:35 -0700456 case RESAMPLE:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800457 switch (param) {
458 case SAMPLE_RATE:
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800459 ALOG_ASSERT(valueInt > 0, "bad sample rate %d", valueInt);
Glenn Kasten788040c2011-05-05 08:19:00 -0700460 if (track.setResampler(uint32_t(valueInt), mSampleRate)) {
461 ALOGV("setParameter(RESAMPLE, SAMPLE_RATE, %u)",
462 uint32_t(valueInt));
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800463 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700464 }
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800465 break;
466 case RESET:
Eric Laurent243f5f92011-02-28 16:52:51 -0800467 track.resetResampler();
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800468 invalidateState(1 << name);
469 break;
Glenn Kasten4e2293f2012-04-12 09:39:07 -0700470 case REMOVE:
471 delete track.resampler;
472 track.resampler = NULL;
473 track.sampleRate = mSampleRate;
474 invalidateState(1 << name);
475 break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700476 default:
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800477 LOG_FATAL("bad param");
Eric Laurent243f5f92011-02-28 16:52:51 -0800478 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700479 break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700480
Mathias Agopian65ab4712010-07-14 17:59:35 -0700481 case RAMP_VOLUME:
482 case VOLUME:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800483 switch (param) {
Glenn Kasten788040c2011-05-05 08:19:00 -0700484 case VOLUME0:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800485 case VOLUME1:
486 if (track.volume[param-VOLUME0] != valueInt) {
Steve Block3856b092011-10-20 11:56:00 +0100487 ALOGV("setParameter(VOLUME, VOLUME0/1: %04x)", valueInt);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800488 track.prevVolume[param-VOLUME0] = track.volume[param-VOLUME0] << 16;
489 track.volume[param-VOLUME0] = valueInt;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700490 if (target == VOLUME) {
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800491 track.prevVolume[param-VOLUME0] = valueInt << 16;
492 track.volumeInc[param-VOLUME0] = 0;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700493 } else {
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800494 int32_t d = (valueInt<<16) - track.prevVolume[param-VOLUME0];
Mathias Agopian65ab4712010-07-14 17:59:35 -0700495 int32_t volInc = d / int32_t(mState.frameCount);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800496 track.volumeInc[param-VOLUME0] = volInc;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700497 if (volInc == 0) {
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800498 track.prevVolume[param-VOLUME0] = valueInt << 16;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700499 }
500 }
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800501 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700502 }
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800503 break;
504 case AUXLEVEL:
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800505 //ALOG_ASSERT(0 <= valueInt && valueInt <= MAX_GAIN_INT, "bad aux level %d", valueInt);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700506 if (track.auxLevel != valueInt) {
Steve Block3856b092011-10-20 11:56:00 +0100507 ALOGV("setParameter(VOLUME, AUXLEVEL: %04x)", valueInt);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700508 track.prevAuxLevel = track.auxLevel << 16;
509 track.auxLevel = valueInt;
510 if (target == VOLUME) {
511 track.prevAuxLevel = valueInt << 16;
512 track.auxInc = 0;
513 } else {
514 int32_t d = (valueInt<<16) - track.prevAuxLevel;
515 int32_t volInc = d / int32_t(mState.frameCount);
516 track.auxInc = volInc;
517 if (volInc == 0) {
518 track.prevAuxLevel = valueInt << 16;
519 }
520 }
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800521 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700522 }
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800523 break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700524 default:
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800525 LOG_FATAL("bad param");
Mathias Agopian65ab4712010-07-14 17:59:35 -0700526 }
527 break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700528
529 default:
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800530 LOG_FATAL("bad target");
Mathias Agopian65ab4712010-07-14 17:59:35 -0700531 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700532}
533
534bool AudioMixer::track_t::setResampler(uint32_t value, uint32_t devSampleRate)
535{
Glenn Kasten4e2293f2012-04-12 09:39:07 -0700536 if (value != devSampleRate || resampler != NULL) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700537 if (sampleRate != value) {
538 sampleRate = value;
Glenn Kastene0feee32011-12-13 11:53:26 -0800539 if (resampler == NULL) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700540 resampler = AudioResampler::create(
Jean-Michel Triviacb86cc2012-04-16 12:43:57 -0700541 format,
542 // the resampler sees the number of channels after the downmixer, if any
543 downmixerBufferProvider != NULL ? MAX_NUM_CHANNELS : channelCount,
544 devSampleRate);
Glenn Kasten52008f82012-03-18 09:34:41 -0700545 resampler->setLocalTimeFreq(sLocalTimeFreq);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700546 }
547 return true;
548 }
549 }
550 return false;
551}
552
Mathias Agopian65ab4712010-07-14 17:59:35 -0700553inline
554void AudioMixer::track_t::adjustVolumeRamp(bool aux)
555{
Glenn Kastenf9a27772012-01-06 07:47:26 -0800556 for (uint32_t i=0 ; i<MAX_NUM_CHANNELS ; i++) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700557 if (((volumeInc[i]>0) && (((prevVolume[i]+volumeInc[i])>>16) >= volume[i])) ||
558 ((volumeInc[i]<0) && (((prevVolume[i]+volumeInc[i])>>16) <= volume[i]))) {
559 volumeInc[i] = 0;
560 prevVolume[i] = volume[i]<<16;
561 }
562 }
563 if (aux) {
564 if (((auxInc>0) && (((prevAuxLevel+auxInc)>>16) >= auxLevel)) ||
565 ((auxInc<0) && (((prevAuxLevel+auxInc)>>16) <= auxLevel))) {
566 auxInc = 0;
567 prevAuxLevel = auxLevel<<16;
568 }
569 }
570}
571
Glenn Kastenc59c0042012-02-02 14:06:11 -0800572size_t AudioMixer::getUnreleasedFrames(int name) const
Eric Laurent071ccd52011-12-22 16:08:41 -0800573{
574 name -= TRACK0;
575 if (uint32_t(name) < MAX_NUM_TRACKS) {
Glenn Kastenc59c0042012-02-02 14:06:11 -0800576 return mState.tracks[name].getUnreleasedFrames();
Eric Laurent071ccd52011-12-22 16:08:41 -0800577 }
578 return 0;
579}
Mathias Agopian65ab4712010-07-14 17:59:35 -0700580
Glenn Kasten01c4ebf2012-02-22 10:47:35 -0800581void AudioMixer::setBufferProvider(int name, AudioBufferProvider* bufferProvider)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700582{
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800583 name -= TRACK0;
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800584 ALOG_ASSERT(uint32_t(name) < MAX_NUM_TRACKS, "bad track name %d", name);
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700585
586 if (mState.tracks[name].downmixerBufferProvider != NULL) {
587 // update required?
588 if (mState.tracks[name].downmixerBufferProvider->mTrackBufferProvider != bufferProvider) {
589 ALOGV("AudioMixer::setBufferProvider(%p) for downmix", bufferProvider);
590 // setting the buffer provider for a track that gets downmixed consists in:
591 // 1/ setting the buffer provider to the "downmix / buffer provider" wrapper
592 // so it's the one that gets called when the buffer provider is needed,
593 mState.tracks[name].bufferProvider = mState.tracks[name].downmixerBufferProvider;
594 // 2/ saving the buffer provider for the track so the wrapper can use it
595 // when it downmixes.
596 mState.tracks[name].downmixerBufferProvider->mTrackBufferProvider = bufferProvider;
597 }
598 } else {
599 mState.tracks[name].bufferProvider = bufferProvider;
600 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700601}
602
603
604
John Grossman4ff14ba2012-02-08 16:37:41 -0800605void AudioMixer::process(int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700606{
John Grossman4ff14ba2012-02-08 16:37:41 -0800607 mState.hook(&mState, pts);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700608}
609
610
John Grossman4ff14ba2012-02-08 16:37:41 -0800611void AudioMixer::process__validate(state_t* state, int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700612{
Steve Block5ff1dd52012-01-05 23:22:43 +0000613 ALOGW_IF(!state->needsChanged,
Mathias Agopian65ab4712010-07-14 17:59:35 -0700614 "in process__validate() but nothing's invalid");
615
616 uint32_t changed = state->needsChanged;
617 state->needsChanged = 0; // clear the validation flag
618
619 // recompute which tracks are enabled / disabled
620 uint32_t enabled = 0;
621 uint32_t disabled = 0;
622 while (changed) {
623 const int i = 31 - __builtin_clz(changed);
624 const uint32_t mask = 1<<i;
625 changed &= ~mask;
626 track_t& t = state->tracks[i];
627 (t.enabled ? enabled : disabled) |= mask;
628 }
629 state->enabledTracks &= ~disabled;
630 state->enabledTracks |= enabled;
631
632 // compute everything we need...
633 int countActiveTracks = 0;
Glenn Kasten4c340c62012-01-27 12:33:54 -0800634 bool all16BitsStereoNoResample = true;
635 bool resampling = false;
636 bool volumeRamp = false;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700637 uint32_t en = state->enabledTracks;
638 while (en) {
639 const int i = 31 - __builtin_clz(en);
640 en &= ~(1<<i);
641
642 countActiveTracks++;
643 track_t& t = state->tracks[i];
644 uint32_t n = 0;
645 n |= NEEDS_CHANNEL_1 + t.channelCount - 1;
646 n |= NEEDS_FORMAT_16;
647 n |= t.doesResample() ? NEEDS_RESAMPLE_ENABLED : NEEDS_RESAMPLE_DISABLED;
648 if (t.auxLevel != 0 && t.auxBuffer != NULL) {
649 n |= NEEDS_AUX_ENABLED;
650 }
651
652 if (t.volumeInc[0]|t.volumeInc[1]) {
Glenn Kasten4c340c62012-01-27 12:33:54 -0800653 volumeRamp = true;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700654 } else if (!t.doesResample() && t.volumeRL == 0) {
655 n |= NEEDS_MUTE_ENABLED;
656 }
657 t.needs = n;
658
659 if ((n & NEEDS_MUTE__MASK) == NEEDS_MUTE_ENABLED) {
660 t.hook = track__nop;
661 } else {
662 if ((n & NEEDS_AUX__MASK) == NEEDS_AUX_ENABLED) {
Glenn Kasten4c340c62012-01-27 12:33:54 -0800663 all16BitsStereoNoResample = false;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700664 }
665 if ((n & NEEDS_RESAMPLE__MASK) == NEEDS_RESAMPLE_ENABLED) {
Glenn Kasten4c340c62012-01-27 12:33:54 -0800666 all16BitsStereoNoResample = false;
667 resampling = true;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700668 t.hook = track__genericResample;
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700669 ALOGV_IF((n & NEEDS_CHANNEL_COUNT__MASK) > NEEDS_CHANNEL_2,
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700670 "Track %d needs downmix + resample", i);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700671 } else {
672 if ((n & NEEDS_CHANNEL_COUNT__MASK) == NEEDS_CHANNEL_1){
673 t.hook = track__16BitsMono;
Glenn Kasten4c340c62012-01-27 12:33:54 -0800674 all16BitsStereoNoResample = false;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700675 }
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700676 if ((n & NEEDS_CHANNEL_COUNT__MASK) >= NEEDS_CHANNEL_2){
Mathias Agopian65ab4712010-07-14 17:59:35 -0700677 t.hook = track__16BitsStereo;
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700678 ALOGV_IF((n & NEEDS_CHANNEL_COUNT__MASK) > NEEDS_CHANNEL_2,
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700679 "Track %d needs downmix", i);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700680 }
681 }
682 }
683 }
684
685 // select the processing hooks
686 state->hook = process__nop;
687 if (countActiveTracks) {
688 if (resampling) {
689 if (!state->outputTemp) {
690 state->outputTemp = new int32_t[MAX_NUM_CHANNELS * state->frameCount];
691 }
692 if (!state->resampleTemp) {
693 state->resampleTemp = new int32_t[MAX_NUM_CHANNELS * state->frameCount];
694 }
695 state->hook = process__genericResampling;
696 } else {
697 if (state->outputTemp) {
698 delete [] state->outputTemp;
Glenn Kastene0feee32011-12-13 11:53:26 -0800699 state->outputTemp = NULL;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700700 }
701 if (state->resampleTemp) {
702 delete [] state->resampleTemp;
Glenn Kastene0feee32011-12-13 11:53:26 -0800703 state->resampleTemp = NULL;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700704 }
705 state->hook = process__genericNoResampling;
706 if (all16BitsStereoNoResample && !volumeRamp) {
707 if (countActiveTracks == 1) {
708 state->hook = process__OneTrack16BitsStereoNoResampling;
709 }
710 }
711 }
712 }
713
Steve Block3856b092011-10-20 11:56:00 +0100714 ALOGV("mixer configuration change: %d activeTracks (%08x) "
Mathias Agopian65ab4712010-07-14 17:59:35 -0700715 "all16BitsStereoNoResample=%d, resampling=%d, volumeRamp=%d",
716 countActiveTracks, state->enabledTracks,
717 all16BitsStereoNoResample, resampling, volumeRamp);
718
John Grossman4ff14ba2012-02-08 16:37:41 -0800719 state->hook(state, pts);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700720
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800721 // Now that the volume ramp has been done, set optimal state and
722 // track hooks for subsequent mixer process
723 if (countActiveTracks) {
Glenn Kasten4c340c62012-01-27 12:33:54 -0800724 bool allMuted = true;
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800725 uint32_t en = state->enabledTracks;
726 while (en) {
727 const int i = 31 - __builtin_clz(en);
728 en &= ~(1<<i);
729 track_t& t = state->tracks[i];
730 if (!t.doesResample() && t.volumeRL == 0)
731 {
732 t.needs |= NEEDS_MUTE_ENABLED;
733 t.hook = track__nop;
734 } else {
Glenn Kasten4c340c62012-01-27 12:33:54 -0800735 allMuted = false;
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800736 }
737 }
738 if (allMuted) {
739 state->hook = process__nop;
740 } else if (all16BitsStereoNoResample) {
741 if (countActiveTracks == 1) {
742 state->hook = process__OneTrack16BitsStereoNoResampling;
743 }
744 }
745 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700746}
747
Mathias Agopian65ab4712010-07-14 17:59:35 -0700748
749void AudioMixer::track__genericResample(track_t* t, int32_t* out, size_t outFrameCount, int32_t* temp, int32_t* aux)
750{
751 t->resampler->setSampleRate(t->sampleRate);
752
753 // ramp gain - resample to temp buffer and scale/mix in 2nd step
754 if (aux != NULL) {
755 // always resample with unity gain when sending to auxiliary buffer to be able
756 // to apply send level after resampling
757 // TODO: modify each resampler to support aux channel?
758 t->resampler->setVolume(UNITY_GAIN, UNITY_GAIN);
759 memset(temp, 0, outFrameCount * MAX_NUM_CHANNELS * sizeof(int32_t));
760 t->resampler->resample(temp, outFrameCount, t->bufferProvider);
Glenn Kastenf6b16782011-12-15 09:51:17 -0800761 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1]|t->auxInc)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700762 volumeRampStereo(t, out, outFrameCount, temp, aux);
763 } else {
764 volumeStereo(t, out, outFrameCount, temp, aux);
765 }
766 } else {
Glenn Kastenf6b16782011-12-15 09:51:17 -0800767 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1])) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700768 t->resampler->setVolume(UNITY_GAIN, UNITY_GAIN);
769 memset(temp, 0, outFrameCount * MAX_NUM_CHANNELS * sizeof(int32_t));
770 t->resampler->resample(temp, outFrameCount, t->bufferProvider);
771 volumeRampStereo(t, out, outFrameCount, temp, aux);
772 }
773
774 // constant gain
775 else {
776 t->resampler->setVolume(t->volume[0], t->volume[1]);
777 t->resampler->resample(out, outFrameCount, t->bufferProvider);
778 }
779 }
780}
781
782void AudioMixer::track__nop(track_t* t, int32_t* out, size_t outFrameCount, int32_t* temp, int32_t* aux)
783{
784}
785
786void AudioMixer::volumeRampStereo(track_t* t, int32_t* out, size_t frameCount, int32_t* temp, int32_t* aux)
787{
788 int32_t vl = t->prevVolume[0];
789 int32_t vr = t->prevVolume[1];
790 const int32_t vlInc = t->volumeInc[0];
791 const int32_t vrInc = t->volumeInc[1];
792
Steve Blockb8a80522011-12-20 16:23:08 +0000793 //ALOGD("[0] %p: inc=%f, v0=%f, v1=%d, final=%f, count=%d",
Mathias Agopian65ab4712010-07-14 17:59:35 -0700794 // t, vlInc/65536.0f, vl/65536.0f, t->volume[0],
795 // (vl + vlInc*frameCount)/65536.0f, frameCount);
796
797 // ramp volume
Glenn Kastenf6b16782011-12-15 09:51:17 -0800798 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700799 int32_t va = t->prevAuxLevel;
800 const int32_t vaInc = t->auxInc;
801 int32_t l;
802 int32_t r;
803
804 do {
805 l = (*temp++ >> 12);
806 r = (*temp++ >> 12);
807 *out++ += (vl >> 16) * l;
808 *out++ += (vr >> 16) * r;
809 *aux++ += (va >> 17) * (l + r);
810 vl += vlInc;
811 vr += vrInc;
812 va += vaInc;
813 } while (--frameCount);
814 t->prevAuxLevel = va;
815 } else {
816 do {
817 *out++ += (vl >> 16) * (*temp++ >> 12);
818 *out++ += (vr >> 16) * (*temp++ >> 12);
819 vl += vlInc;
820 vr += vrInc;
821 } while (--frameCount);
822 }
823 t->prevVolume[0] = vl;
824 t->prevVolume[1] = vr;
Glenn Kastena1117922012-01-26 10:53:32 -0800825 t->adjustVolumeRamp(aux != NULL);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700826}
827
828void AudioMixer::volumeStereo(track_t* t, int32_t* out, size_t frameCount, int32_t* temp, int32_t* aux)
829{
830 const int16_t vl = t->volume[0];
831 const int16_t vr = t->volume[1];
832
Glenn Kastenf6b16782011-12-15 09:51:17 -0800833 if (CC_UNLIKELY(aux != NULL)) {
Glenn Kasten3b81aca2012-01-27 15:26:23 -0800834 const int16_t va = t->auxLevel;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700835 do {
836 int16_t l = (int16_t)(*temp++ >> 12);
837 int16_t r = (int16_t)(*temp++ >> 12);
838 out[0] = mulAdd(l, vl, out[0]);
839 int16_t a = (int16_t)(((int32_t)l + r) >> 1);
840 out[1] = mulAdd(r, vr, out[1]);
841 out += 2;
842 aux[0] = mulAdd(a, va, aux[0]);
843 aux++;
844 } while (--frameCount);
845 } else {
846 do {
847 int16_t l = (int16_t)(*temp++ >> 12);
848 int16_t r = (int16_t)(*temp++ >> 12);
849 out[0] = mulAdd(l, vl, out[0]);
850 out[1] = mulAdd(r, vr, out[1]);
851 out += 2;
852 } while (--frameCount);
853 }
854}
855
856void AudioMixer::track__16BitsStereo(track_t* t, int32_t* out, size_t frameCount, int32_t* temp, int32_t* aux)
857{
Glenn Kasten54c3b662012-01-06 07:46:30 -0800858 const int16_t *in = static_cast<const int16_t *>(t->in);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700859
Glenn Kastenf6b16782011-12-15 09:51:17 -0800860 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700861 int32_t l;
862 int32_t r;
863 // ramp gain
Glenn Kastenf6b16782011-12-15 09:51:17 -0800864 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1]|t->auxInc)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700865 int32_t vl = t->prevVolume[0];
866 int32_t vr = t->prevVolume[1];
867 int32_t va = t->prevAuxLevel;
868 const int32_t vlInc = t->volumeInc[0];
869 const int32_t vrInc = t->volumeInc[1];
870 const int32_t vaInc = t->auxInc;
Steve Blockb8a80522011-12-20 16:23:08 +0000871 // ALOGD("[1] %p: inc=%f, v0=%f, v1=%d, final=%f, count=%d",
Mathias Agopian65ab4712010-07-14 17:59:35 -0700872 // t, vlInc/65536.0f, vl/65536.0f, t->volume[0],
873 // (vl + vlInc*frameCount)/65536.0f, frameCount);
874
875 do {
876 l = (int32_t)*in++;
877 r = (int32_t)*in++;
878 *out++ += (vl >> 16) * l;
879 *out++ += (vr >> 16) * r;
880 *aux++ += (va >> 17) * (l + r);
881 vl += vlInc;
882 vr += vrInc;
883 va += vaInc;
884 } while (--frameCount);
885
886 t->prevVolume[0] = vl;
887 t->prevVolume[1] = vr;
888 t->prevAuxLevel = va;
889 t->adjustVolumeRamp(true);
890 }
891
892 // constant gain
893 else {
894 const uint32_t vrl = t->volumeRL;
895 const int16_t va = (int16_t)t->auxLevel;
896 do {
Glenn Kasten54c3b662012-01-06 07:46:30 -0800897 uint32_t rl = *reinterpret_cast<const uint32_t *>(in);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700898 int16_t a = (int16_t)(((int32_t)in[0] + in[1]) >> 1);
899 in += 2;
900 out[0] = mulAddRL(1, rl, vrl, out[0]);
901 out[1] = mulAddRL(0, rl, vrl, out[1]);
902 out += 2;
903 aux[0] = mulAdd(a, va, aux[0]);
904 aux++;
905 } while (--frameCount);
906 }
907 } else {
908 // ramp gain
Glenn Kastenf6b16782011-12-15 09:51:17 -0800909 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1])) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700910 int32_t vl = t->prevVolume[0];
911 int32_t vr = t->prevVolume[1];
912 const int32_t vlInc = t->volumeInc[0];
913 const int32_t vrInc = t->volumeInc[1];
914
Steve Blockb8a80522011-12-20 16:23:08 +0000915 // ALOGD("[1] %p: inc=%f, v0=%f, v1=%d, final=%f, count=%d",
Mathias Agopian65ab4712010-07-14 17:59:35 -0700916 // t, vlInc/65536.0f, vl/65536.0f, t->volume[0],
917 // (vl + vlInc*frameCount)/65536.0f, frameCount);
918
919 do {
920 *out++ += (vl >> 16) * (int32_t) *in++;
921 *out++ += (vr >> 16) * (int32_t) *in++;
922 vl += vlInc;
923 vr += vrInc;
924 } while (--frameCount);
925
926 t->prevVolume[0] = vl;
927 t->prevVolume[1] = vr;
928 t->adjustVolumeRamp(false);
929 }
930
931 // constant gain
932 else {
933 const uint32_t vrl = t->volumeRL;
934 do {
Glenn Kasten54c3b662012-01-06 07:46:30 -0800935 uint32_t rl = *reinterpret_cast<const uint32_t *>(in);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700936 in += 2;
937 out[0] = mulAddRL(1, rl, vrl, out[0]);
938 out[1] = mulAddRL(0, rl, vrl, out[1]);
939 out += 2;
940 } while (--frameCount);
941 }
942 }
943 t->in = in;
944}
945
946void AudioMixer::track__16BitsMono(track_t* t, int32_t* out, size_t frameCount, int32_t* temp, int32_t* aux)
947{
Glenn Kasten54c3b662012-01-06 07:46:30 -0800948 const int16_t *in = static_cast<int16_t const *>(t->in);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700949
Glenn Kastenf6b16782011-12-15 09:51:17 -0800950 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700951 // ramp gain
Glenn Kastenf6b16782011-12-15 09:51:17 -0800952 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1]|t->auxInc)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700953 int32_t vl = t->prevVolume[0];
954 int32_t vr = t->prevVolume[1];
955 int32_t va = t->prevAuxLevel;
956 const int32_t vlInc = t->volumeInc[0];
957 const int32_t vrInc = t->volumeInc[1];
958 const int32_t vaInc = t->auxInc;
959
Steve Blockb8a80522011-12-20 16:23:08 +0000960 // ALOGD("[2] %p: inc=%f, v0=%f, v1=%d, final=%f, count=%d",
Mathias Agopian65ab4712010-07-14 17:59:35 -0700961 // t, vlInc/65536.0f, vl/65536.0f, t->volume[0],
962 // (vl + vlInc*frameCount)/65536.0f, frameCount);
963
964 do {
965 int32_t l = *in++;
966 *out++ += (vl >> 16) * l;
967 *out++ += (vr >> 16) * l;
968 *aux++ += (va >> 16) * l;
969 vl += vlInc;
970 vr += vrInc;
971 va += vaInc;
972 } while (--frameCount);
973
974 t->prevVolume[0] = vl;
975 t->prevVolume[1] = vr;
976 t->prevAuxLevel = va;
977 t->adjustVolumeRamp(true);
978 }
979 // constant gain
980 else {
981 const int16_t vl = t->volume[0];
982 const int16_t vr = t->volume[1];
983 const int16_t va = (int16_t)t->auxLevel;
984 do {
985 int16_t l = *in++;
986 out[0] = mulAdd(l, vl, out[0]);
987 out[1] = mulAdd(l, vr, out[1]);
988 out += 2;
989 aux[0] = mulAdd(l, va, aux[0]);
990 aux++;
991 } while (--frameCount);
992 }
993 } else {
994 // ramp gain
Glenn Kastenf6b16782011-12-15 09:51:17 -0800995 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1])) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700996 int32_t vl = t->prevVolume[0];
997 int32_t vr = t->prevVolume[1];
998 const int32_t vlInc = t->volumeInc[0];
999 const int32_t vrInc = t->volumeInc[1];
1000
Steve Blockb8a80522011-12-20 16:23:08 +00001001 // ALOGD("[2] %p: inc=%f, v0=%f, v1=%d, final=%f, count=%d",
Mathias Agopian65ab4712010-07-14 17:59:35 -07001002 // t, vlInc/65536.0f, vl/65536.0f, t->volume[0],
1003 // (vl + vlInc*frameCount)/65536.0f, frameCount);
1004
1005 do {
1006 int32_t l = *in++;
1007 *out++ += (vl >> 16) * l;
1008 *out++ += (vr >> 16) * l;
1009 vl += vlInc;
1010 vr += vrInc;
1011 } while (--frameCount);
1012
1013 t->prevVolume[0] = vl;
1014 t->prevVolume[1] = vr;
1015 t->adjustVolumeRamp(false);
1016 }
1017 // constant gain
1018 else {
1019 const int16_t vl = t->volume[0];
1020 const int16_t vr = t->volume[1];
1021 do {
1022 int16_t l = *in++;
1023 out[0] = mulAdd(l, vl, out[0]);
1024 out[1] = mulAdd(l, vr, out[1]);
1025 out += 2;
1026 } while (--frameCount);
1027 }
1028 }
1029 t->in = in;
1030}
1031
Mathias Agopian65ab4712010-07-14 17:59:35 -07001032// no-op case
John Grossman4ff14ba2012-02-08 16:37:41 -08001033void AudioMixer::process__nop(state_t* state, int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001034{
1035 uint32_t e0 = state->enabledTracks;
1036 size_t bufSize = state->frameCount * sizeof(int16_t) * MAX_NUM_CHANNELS;
1037 while (e0) {
1038 // process by group of tracks with same output buffer to
1039 // avoid multiple memset() on same buffer
1040 uint32_t e1 = e0, e2 = e0;
1041 int i = 31 - __builtin_clz(e1);
1042 track_t& t1 = state->tracks[i];
1043 e2 &= ~(1<<i);
1044 while (e2) {
1045 i = 31 - __builtin_clz(e2);
1046 e2 &= ~(1<<i);
1047 track_t& t2 = state->tracks[i];
Glenn Kastenf6b16782011-12-15 09:51:17 -08001048 if (CC_UNLIKELY(t2.mainBuffer != t1.mainBuffer)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001049 e1 &= ~(1<<i);
1050 }
1051 }
1052 e0 &= ~(e1);
1053
1054 memset(t1.mainBuffer, 0, bufSize);
1055
1056 while (e1) {
1057 i = 31 - __builtin_clz(e1);
1058 e1 &= ~(1<<i);
1059 t1 = state->tracks[i];
1060 size_t outFrames = state->frameCount;
1061 while (outFrames) {
1062 t1.buffer.frameCount = outFrames;
John Grossman4ff14ba2012-02-08 16:37:41 -08001063 int64_t outputPTS = calculateOutputPTS(
1064 t1, pts, state->frameCount - outFrames);
1065 t1.bufferProvider->getNextBuffer(&t1.buffer, outputPTS);
Glenn Kastena0d68332012-01-27 16:47:15 -08001066 if (t1.buffer.raw == NULL) break;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001067 outFrames -= t1.buffer.frameCount;
1068 t1.bufferProvider->releaseBuffer(&t1.buffer);
1069 }
1070 }
1071 }
1072}
1073
1074// generic code without resampling
John Grossman4ff14ba2012-02-08 16:37:41 -08001075void AudioMixer::process__genericNoResampling(state_t* state, int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001076{
1077 int32_t outTemp[BLOCKSIZE * MAX_NUM_CHANNELS] __attribute__((aligned(32)));
1078
1079 // acquire each track's buffer
1080 uint32_t enabledTracks = state->enabledTracks;
1081 uint32_t e0 = enabledTracks;
1082 while (e0) {
1083 const int i = 31 - __builtin_clz(e0);
1084 e0 &= ~(1<<i);
1085 track_t& t = state->tracks[i];
1086 t.buffer.frameCount = state->frameCount;
John Grossman4ff14ba2012-02-08 16:37:41 -08001087 t.bufferProvider->getNextBuffer(&t.buffer, pts);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001088 t.frameCount = t.buffer.frameCount;
1089 t.in = t.buffer.raw;
1090 // t.in == NULL can happen if the track was flushed just after having
1091 // been enabled for mixing.
1092 if (t.in == NULL)
1093 enabledTracks &= ~(1<<i);
1094 }
1095
1096 e0 = enabledTracks;
1097 while (e0) {
1098 // process by group of tracks with same output buffer to
1099 // optimize cache use
1100 uint32_t e1 = e0, e2 = e0;
1101 int j = 31 - __builtin_clz(e1);
1102 track_t& t1 = state->tracks[j];
1103 e2 &= ~(1<<j);
1104 while (e2) {
1105 j = 31 - __builtin_clz(e2);
1106 e2 &= ~(1<<j);
1107 track_t& t2 = state->tracks[j];
Glenn Kastenf6b16782011-12-15 09:51:17 -08001108 if (CC_UNLIKELY(t2.mainBuffer != t1.mainBuffer)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001109 e1 &= ~(1<<j);
1110 }
1111 }
1112 e0 &= ~(e1);
1113 // this assumes output 16 bits stereo, no resampling
1114 int32_t *out = t1.mainBuffer;
1115 size_t numFrames = 0;
1116 do {
1117 memset(outTemp, 0, sizeof(outTemp));
1118 e2 = e1;
1119 while (e2) {
1120 const int i = 31 - __builtin_clz(e2);
1121 e2 &= ~(1<<i);
1122 track_t& t = state->tracks[i];
1123 size_t outFrames = BLOCKSIZE;
1124 int32_t *aux = NULL;
Glenn Kastenf6b16782011-12-15 09:51:17 -08001125 if (CC_UNLIKELY((t.needs & NEEDS_AUX__MASK) == NEEDS_AUX_ENABLED)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001126 aux = t.auxBuffer + numFrames;
1127 }
1128 while (outFrames) {
1129 size_t inFrames = (t.frameCount > outFrames)?outFrames:t.frameCount;
1130 if (inFrames) {
Glenn Kastena1117922012-01-26 10:53:32 -08001131 t.hook(&t, outTemp + (BLOCKSIZE-outFrames)*MAX_NUM_CHANNELS, inFrames, state->resampleTemp, aux);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001132 t.frameCount -= inFrames;
1133 outFrames -= inFrames;
Glenn Kastenf6b16782011-12-15 09:51:17 -08001134 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001135 aux += inFrames;
1136 }
1137 }
1138 if (t.frameCount == 0 && outFrames) {
1139 t.bufferProvider->releaseBuffer(&t.buffer);
1140 t.buffer.frameCount = (state->frameCount - numFrames) - (BLOCKSIZE - outFrames);
John Grossman4ff14ba2012-02-08 16:37:41 -08001141 int64_t outputPTS = calculateOutputPTS(
1142 t, pts, numFrames + (BLOCKSIZE - outFrames));
1143 t.bufferProvider->getNextBuffer(&t.buffer, outputPTS);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001144 t.in = t.buffer.raw;
1145 if (t.in == NULL) {
1146 enabledTracks &= ~(1<<i);
1147 e1 &= ~(1<<i);
1148 break;
1149 }
1150 t.frameCount = t.buffer.frameCount;
1151 }
1152 }
1153 }
1154 ditherAndClamp(out, outTemp, BLOCKSIZE);
1155 out += BLOCKSIZE;
1156 numFrames += BLOCKSIZE;
1157 } while (numFrames < state->frameCount);
1158 }
1159
1160 // release each track's buffer
1161 e0 = enabledTracks;
1162 while (e0) {
1163 const int i = 31 - __builtin_clz(e0);
1164 e0 &= ~(1<<i);
1165 track_t& t = state->tracks[i];
1166 t.bufferProvider->releaseBuffer(&t.buffer);
1167 }
1168}
1169
1170
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -08001171// generic code with resampling
John Grossman4ff14ba2012-02-08 16:37:41 -08001172void AudioMixer::process__genericResampling(state_t* state, int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001173{
Glenn Kasten54c3b662012-01-06 07:46:30 -08001174 // this const just means that local variable outTemp doesn't change
Mathias Agopian65ab4712010-07-14 17:59:35 -07001175 int32_t* const outTemp = state->outputTemp;
1176 const size_t size = sizeof(int32_t) * MAX_NUM_CHANNELS * state->frameCount;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001177
1178 size_t numFrames = state->frameCount;
1179
1180 uint32_t e0 = state->enabledTracks;
1181 while (e0) {
1182 // process by group of tracks with same output buffer
1183 // to optimize cache use
1184 uint32_t e1 = e0, e2 = e0;
1185 int j = 31 - __builtin_clz(e1);
1186 track_t& t1 = state->tracks[j];
1187 e2 &= ~(1<<j);
1188 while (e2) {
1189 j = 31 - __builtin_clz(e2);
1190 e2 &= ~(1<<j);
1191 track_t& t2 = state->tracks[j];
Glenn Kastenf6b16782011-12-15 09:51:17 -08001192 if (CC_UNLIKELY(t2.mainBuffer != t1.mainBuffer)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001193 e1 &= ~(1<<j);
1194 }
1195 }
1196 e0 &= ~(e1);
1197 int32_t *out = t1.mainBuffer;
Yuuhi Yamaguchi2151d7b2011-02-04 15:24:34 +01001198 memset(outTemp, 0, size);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001199 while (e1) {
1200 const int i = 31 - __builtin_clz(e1);
1201 e1 &= ~(1<<i);
1202 track_t& t = state->tracks[i];
1203 int32_t *aux = NULL;
Glenn Kastenf6b16782011-12-15 09:51:17 -08001204 if (CC_UNLIKELY((t.needs & NEEDS_AUX__MASK) == NEEDS_AUX_ENABLED)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001205 aux = t.auxBuffer;
1206 }
1207
1208 // this is a little goofy, on the resampling case we don't
1209 // acquire/release the buffers because it's done by
1210 // the resampler.
1211 if ((t.needs & NEEDS_RESAMPLE__MASK) == NEEDS_RESAMPLE_ENABLED) {
John Grossman4ff14ba2012-02-08 16:37:41 -08001212 t.resampler->setPTS(pts);
Glenn Kastena1117922012-01-26 10:53:32 -08001213 t.hook(&t, outTemp, numFrames, state->resampleTemp, aux);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001214 } else {
1215
1216 size_t outFrames = 0;
1217
1218 while (outFrames < numFrames) {
1219 t.buffer.frameCount = numFrames - outFrames;
John Grossman4ff14ba2012-02-08 16:37:41 -08001220 int64_t outputPTS = calculateOutputPTS(t, pts, outFrames);
1221 t.bufferProvider->getNextBuffer(&t.buffer, outputPTS);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001222 t.in = t.buffer.raw;
1223 // t.in == NULL can happen if the track was flushed just after having
1224 // been enabled for mixing.
1225 if (t.in == NULL) break;
1226
Glenn Kastenf6b16782011-12-15 09:51:17 -08001227 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001228 aux += outFrames;
1229 }
Glenn Kastena1117922012-01-26 10:53:32 -08001230 t.hook(&t, outTemp + outFrames*MAX_NUM_CHANNELS, t.buffer.frameCount, state->resampleTemp, aux);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001231 outFrames += t.buffer.frameCount;
1232 t.bufferProvider->releaseBuffer(&t.buffer);
1233 }
1234 }
1235 }
1236 ditherAndClamp(out, outTemp, numFrames);
1237 }
1238}
1239
1240// one track, 16 bits stereo without resampling is the most common case
John Grossman4ff14ba2012-02-08 16:37:41 -08001241void AudioMixer::process__OneTrack16BitsStereoNoResampling(state_t* state,
1242 int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001243{
Glenn Kasten99e53b82012-01-19 08:59:58 -08001244 // This method is only called when state->enabledTracks has exactly
1245 // one bit set. The asserts below would verify this, but are commented out
1246 // since the whole point of this method is to optimize performance.
Glenn Kasten5798d4e2012-03-08 12:18:35 -08001247 //ALOG_ASSERT(0 != state->enabledTracks, "no tracks enabled");
Mathias Agopian65ab4712010-07-14 17:59:35 -07001248 const int i = 31 - __builtin_clz(state->enabledTracks);
Glenn Kasten5798d4e2012-03-08 12:18:35 -08001249 //ALOG_ASSERT((1 << i) == state->enabledTracks, "more than 1 track enabled");
Mathias Agopian65ab4712010-07-14 17:59:35 -07001250 const track_t& t = state->tracks[i];
1251
1252 AudioBufferProvider::Buffer& b(t.buffer);
1253
1254 int32_t* out = t.mainBuffer;
1255 size_t numFrames = state->frameCount;
1256
1257 const int16_t vl = t.volume[0];
1258 const int16_t vr = t.volume[1];
1259 const uint32_t vrl = t.volumeRL;
1260 while (numFrames) {
1261 b.frameCount = numFrames;
John Grossman4ff14ba2012-02-08 16:37:41 -08001262 int64_t outputPTS = calculateOutputPTS(t, pts, out - t.mainBuffer);
1263 t.bufferProvider->getNextBuffer(&b, outputPTS);
Glenn Kasten54c3b662012-01-06 07:46:30 -08001264 const int16_t *in = b.i16;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001265
1266 // in == NULL can happen if the track was flushed just after having
1267 // been enabled for mixing.
1268 if (in == NULL || ((unsigned long)in & 3)) {
1269 memset(out, 0, numFrames*MAX_NUM_CHANNELS*sizeof(int16_t));
Steve Block29357bc2012-01-06 19:20:56 +00001270 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 -07001271 in, i, t.channelCount, t.needs);
1272 return;
1273 }
1274 size_t outFrames = b.frameCount;
1275
Glenn Kastenf6b16782011-12-15 09:51:17 -08001276 if (CC_UNLIKELY(uint32_t(vl) > UNITY_GAIN || uint32_t(vr) > UNITY_GAIN)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001277 // volume is boosted, so we might need to clamp even though
1278 // we process only one track.
1279 do {
Glenn Kasten54c3b662012-01-06 07:46:30 -08001280 uint32_t rl = *reinterpret_cast<const uint32_t *>(in);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001281 in += 2;
1282 int32_t l = mulRL(1, rl, vrl) >> 12;
1283 int32_t r = mulRL(0, rl, vrl) >> 12;
1284 // clamping...
1285 l = clamp16(l);
1286 r = clamp16(r);
1287 *out++ = (r<<16) | (l & 0xFFFF);
1288 } while (--outFrames);
1289 } else {
1290 do {
Glenn Kasten54c3b662012-01-06 07:46:30 -08001291 uint32_t rl = *reinterpret_cast<const uint32_t *>(in);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001292 in += 2;
1293 int32_t l = mulRL(1, rl, vrl) >> 12;
1294 int32_t r = mulRL(0, rl, vrl) >> 12;
1295 *out++ = (r<<16) | (l & 0xFFFF);
1296 } while (--outFrames);
1297 }
1298 numFrames -= b.frameCount;
1299 t.bufferProvider->releaseBuffer(&b);
1300 }
1301}
1302
Glenn Kasten81a028f2011-12-15 09:53:12 -08001303#if 0
Mathias Agopian65ab4712010-07-14 17:59:35 -07001304// 2 tracks is also a common case
1305// NEVER used in current implementation of process__validate()
1306// only use if the 2 tracks have the same output buffer
John Grossman4ff14ba2012-02-08 16:37:41 -08001307void AudioMixer::process__TwoTracks16BitsStereoNoResampling(state_t* state,
1308 int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001309{
1310 int i;
1311 uint32_t en = state->enabledTracks;
1312
1313 i = 31 - __builtin_clz(en);
1314 const track_t& t0 = state->tracks[i];
1315 AudioBufferProvider::Buffer& b0(t0.buffer);
1316
1317 en &= ~(1<<i);
1318 i = 31 - __builtin_clz(en);
1319 const track_t& t1 = state->tracks[i];
1320 AudioBufferProvider::Buffer& b1(t1.buffer);
1321
Glenn Kasten54c3b662012-01-06 07:46:30 -08001322 const int16_t *in0;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001323 const int16_t vl0 = t0.volume[0];
1324 const int16_t vr0 = t0.volume[1];
1325 size_t frameCount0 = 0;
1326
Glenn Kasten54c3b662012-01-06 07:46:30 -08001327 const int16_t *in1;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001328 const int16_t vl1 = t1.volume[0];
1329 const int16_t vr1 = t1.volume[1];
1330 size_t frameCount1 = 0;
1331
1332 //FIXME: only works if two tracks use same buffer
1333 int32_t* out = t0.mainBuffer;
1334 size_t numFrames = state->frameCount;
Glenn Kasten54c3b662012-01-06 07:46:30 -08001335 const int16_t *buff = NULL;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001336
1337
1338 while (numFrames) {
1339
1340 if (frameCount0 == 0) {
1341 b0.frameCount = numFrames;
John Grossman4ff14ba2012-02-08 16:37:41 -08001342 int64_t outputPTS = calculateOutputPTS(t0, pts,
1343 out - t0.mainBuffer);
1344 t0.bufferProvider->getNextBuffer(&b0, outputPTS);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001345 if (b0.i16 == NULL) {
1346 if (buff == NULL) {
1347 buff = new int16_t[MAX_NUM_CHANNELS * state->frameCount];
1348 }
1349 in0 = buff;
1350 b0.frameCount = numFrames;
1351 } else {
1352 in0 = b0.i16;
1353 }
1354 frameCount0 = b0.frameCount;
1355 }
1356 if (frameCount1 == 0) {
1357 b1.frameCount = numFrames;
John Grossman4ff14ba2012-02-08 16:37:41 -08001358 int64_t outputPTS = calculateOutputPTS(t1, pts,
1359 out - t0.mainBuffer);
1360 t1.bufferProvider->getNextBuffer(&b1, outputPTS);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001361 if (b1.i16 == NULL) {
1362 if (buff == NULL) {
1363 buff = new int16_t[MAX_NUM_CHANNELS * state->frameCount];
1364 }
1365 in1 = buff;
1366 b1.frameCount = numFrames;
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -08001367 } else {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001368 in1 = b1.i16;
1369 }
1370 frameCount1 = b1.frameCount;
1371 }
1372
1373 size_t outFrames = frameCount0 < frameCount1?frameCount0:frameCount1;
1374
1375 numFrames -= outFrames;
1376 frameCount0 -= outFrames;
1377 frameCount1 -= outFrames;
1378
1379 do {
1380 int32_t l0 = *in0++;
1381 int32_t r0 = *in0++;
1382 l0 = mul(l0, vl0);
1383 r0 = mul(r0, vr0);
1384 int32_t l = *in1++;
1385 int32_t r = *in1++;
1386 l = mulAdd(l, vl1, l0) >> 12;
1387 r = mulAdd(r, vr1, r0) >> 12;
1388 // clamping...
1389 l = clamp16(l);
1390 r = clamp16(r);
1391 *out++ = (r<<16) | (l & 0xFFFF);
1392 } while (--outFrames);
1393
1394 if (frameCount0 == 0) {
1395 t0.bufferProvider->releaseBuffer(&b0);
1396 }
1397 if (frameCount1 == 0) {
1398 t1.bufferProvider->releaseBuffer(&b1);
1399 }
1400 }
1401
Glenn Kastene9dd0172012-01-27 18:08:45 -08001402 delete [] buff;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001403}
Glenn Kasten81a028f2011-12-15 09:53:12 -08001404#endif
Mathias Agopian65ab4712010-07-14 17:59:35 -07001405
John Grossman4ff14ba2012-02-08 16:37:41 -08001406int64_t AudioMixer::calculateOutputPTS(const track_t& t, int64_t basePTS,
1407 int outputFrameIndex)
1408{
1409 if (AudioBufferProvider::kInvalidPTS == basePTS)
1410 return AudioBufferProvider::kInvalidPTS;
1411
Glenn Kasten52008f82012-03-18 09:34:41 -07001412 return basePTS + ((outputFrameIndex * sLocalTimeFreq) / t.sampleRate);
1413}
1414
1415/*static*/ uint64_t AudioMixer::sLocalTimeFreq;
1416/*static*/ pthread_once_t AudioMixer::sOnceControl = PTHREAD_ONCE_INIT;
1417
1418/*static*/ void AudioMixer::sInitRoutine()
1419{
1420 LocalClock lc;
1421 sLocalTimeFreq = lc.getLocalFreq();
John Grossman4ff14ba2012-02-08 16:37:41 -08001422}
1423
Mathias Agopian65ab4712010-07-14 17:59:35 -07001424// ----------------------------------------------------------------------------
1425}; // namespace android