blob: af312c470bdea73efee70eb49aec5cc05e03623e [file] [log] [blame]
Glenn Kasten99e53b82012-01-19 08:59:58 -08001/*
Mathias Agopian65ab4712010-07-14 17:59:35 -07002**
3** Copyright 2007, The Android Open Source Project
4**
5** Licensed under the Apache License, Version 2.0 (the "License");
6** you may not use this file except in compliance with the License.
7** You may obtain a copy of the License at
8**
9** http://www.apache.org/licenses/LICENSE-2.0
10**
11** Unless required by applicable law or agreed to in writing, software
12** distributed under the License is distributed on an "AS IS" BASIS,
13** WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
14** See the License for the specific language governing permissions and
15** limitations under the License.
16*/
17
18#define LOG_TAG "AudioMixer"
Glenn Kasten7f5d3352013-02-15 23:55:04 +000019//#define LOG_NDEBUG 0
Mathias Agopian65ab4712010-07-14 17:59:35 -070020
Glenn Kasten153b9fe2013-07-15 11:23:36 -070021#include "Configuration.h"
Mathias Agopian65ab4712010-07-14 17:59:35 -070022#include <stdint.h>
23#include <string.h>
24#include <stdlib.h>
25#include <sys/types.h>
26
27#include <utils/Errors.h>
28#include <utils/Log.h>
29
Jean-Michel Trivi0d255b22011-05-24 15:53:33 -070030#include <cutils/bitops.h>
Glenn Kastenf6b16782011-12-15 09:51:17 -080031#include <cutils/compiler.h>
Glenn Kasten5798d4e2012-03-08 12:18:35 -080032#include <utils/Debug.h>
Jean-Michel Trivi0d255b22011-05-24 15:53:33 -070033
34#include <system/audio.h>
35
Glenn Kasten3b21c502011-12-15 09:52:39 -080036#include <audio_utils/primitives.h>
Andy Hungef7c7fb2014-05-12 16:51:41 -070037#include <audio_utils/format.h>
John Grossman4ff14ba2012-02-08 16:37:41 -080038#include <common_time/local_clock.h>
39#include <common_time/cc_helper.h>
Glenn Kasten3b21c502011-12-15 09:52:39 -080040
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -070041#include <media/EffectsFactoryApi.h>
42
Andy Hung296b7412014-06-17 15:25:47 -070043#include "AudioMixerOps.h"
Mathias Agopian65ab4712010-07-14 17:59:35 -070044#include "AudioMixer.h"
45
Andy Hung296b7412014-06-17 15:25:47 -070046// Use the FCC_2 macro for code assuming Fixed Channel Count of 2 and
47// whose stereo assumption may need to be revisited later.
48#ifndef FCC_2
49#define FCC_2 2
50#endif
51
52/* VERY_VERY_VERBOSE_LOGGING will show exactly which process hook and track hook is
53 * being used. This is a considerable amount of log spam, so don't enable unless you
54 * are verifying the hook based code.
55 */
56//#define VERY_VERY_VERBOSE_LOGGING
57#ifdef VERY_VERY_VERBOSE_LOGGING
58#define ALOGVV ALOGV
59//define ALOGVV printf // for test-mixer.cpp
60#else
61#define ALOGVV(a...) do { } while (0)
62#endif
63
64// Set kUseNewMixer to true to use the new mixer engine. Otherwise the
65// original code will be used. This is false for now.
66static const bool kUseNewMixer = false;
67
68// Set kUseFloat to true to allow floating input into the mixer engine.
69// If kUseNewMixer is false, this is ignored or may be overridden internally
70// because of downmix/upmix support.
71static const bool kUseFloat = true;
72
Mathias Agopian65ab4712010-07-14 17:59:35 -070073namespace android {
Mathias Agopian65ab4712010-07-14 17:59:35 -070074
75// ----------------------------------------------------------------------------
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -070076AudioMixer::DownmixerBufferProvider::DownmixerBufferProvider() : AudioBufferProvider(),
77 mTrackBufferProvider(NULL), mDownmixHandle(NULL)
78{
79}
80
81AudioMixer::DownmixerBufferProvider::~DownmixerBufferProvider()
82{
83 ALOGV("AudioMixer deleting DownmixerBufferProvider (%p)", this);
84 EffectRelease(mDownmixHandle);
85}
86
87status_t AudioMixer::DownmixerBufferProvider::getNextBuffer(AudioBufferProvider::Buffer *pBuffer,
88 int64_t pts) {
89 //ALOGV("DownmixerBufferProvider::getNextBuffer()");
Glenn Kasten8f325372013-10-30 14:36:47 -070090 if (mTrackBufferProvider != NULL) {
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -070091 status_t res = mTrackBufferProvider->getNextBuffer(pBuffer, pts);
92 if (res == OK) {
93 mDownmixConfig.inputCfg.buffer.frameCount = pBuffer->frameCount;
94 mDownmixConfig.inputCfg.buffer.raw = pBuffer->raw;
95 mDownmixConfig.outputCfg.buffer.frameCount = pBuffer->frameCount;
96 mDownmixConfig.outputCfg.buffer.raw = mDownmixConfig.inputCfg.buffer.raw;
97 // in-place so overwrite the buffer contents, has been set in prepareTrackForDownmix()
98 //mDownmixConfig.outputCfg.accessMode = EFFECT_BUFFER_ACCESS_WRITE;
99
100 res = (*mDownmixHandle)->process(mDownmixHandle,
101 &mDownmixConfig.inputCfg.buffer, &mDownmixConfig.outputCfg.buffer);
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700102 //ALOGV("getNextBuffer is downmixing");
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700103 }
104 return res;
105 } else {
106 ALOGE("DownmixerBufferProvider::getNextBuffer() error: NULL track buffer provider");
107 return NO_INIT;
108 }
109}
110
111void AudioMixer::DownmixerBufferProvider::releaseBuffer(AudioBufferProvider::Buffer *pBuffer) {
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700112 //ALOGV("DownmixerBufferProvider::releaseBuffer()");
Glenn Kasten8f325372013-10-30 14:36:47 -0700113 if (mTrackBufferProvider != NULL) {
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700114 mTrackBufferProvider->releaseBuffer(pBuffer);
115 } else {
116 ALOGE("DownmixerBufferProvider::releaseBuffer() error: NULL track buffer provider");
117 }
118}
119
Andy Hungef7c7fb2014-05-12 16:51:41 -0700120template <typename T>
121T min(const T& a, const T& b)
122{
123 return a < b ? a : b;
124}
125
126AudioMixer::ReformatBufferProvider::ReformatBufferProvider(int32_t channels,
127 audio_format_t inputFormat, audio_format_t outputFormat) :
128 mTrackBufferProvider(NULL),
129 mChannels(channels),
130 mInputFormat(inputFormat),
131 mOutputFormat(outputFormat),
132 mInputFrameSize(channels * audio_bytes_per_sample(inputFormat)),
133 mOutputFrameSize(channels * audio_bytes_per_sample(outputFormat)),
134 mOutputData(NULL),
135 mOutputCount(0),
136 mConsumed(0)
137{
138 ALOGV("ReformatBufferProvider(%p)(%d, %#x, %#x)", this, channels, inputFormat, outputFormat);
139 if (requiresInternalBuffers()) {
140 mOutputCount = 256;
141 (void)posix_memalign(&mOutputData, 32, mOutputCount * mOutputFrameSize);
142 }
143 mBuffer.frameCount = 0;
144}
145
146AudioMixer::ReformatBufferProvider::~ReformatBufferProvider()
147{
148 ALOGV("~ReformatBufferProvider(%p)", this);
149 if (mBuffer.frameCount != 0) {
150 mTrackBufferProvider->releaseBuffer(&mBuffer);
151 }
152 free(mOutputData);
153}
154
155status_t AudioMixer::ReformatBufferProvider::getNextBuffer(AudioBufferProvider::Buffer *pBuffer,
156 int64_t pts) {
157 //ALOGV("ReformatBufferProvider(%p)::getNextBuffer(%p (%zu), %lld)",
158 // this, pBuffer, pBuffer->frameCount, pts);
159 if (!requiresInternalBuffers()) {
160 status_t res = mTrackBufferProvider->getNextBuffer(pBuffer, pts);
161 if (res == OK) {
162 memcpy_by_audio_format(pBuffer->raw, mOutputFormat, pBuffer->raw, mInputFormat,
163 pBuffer->frameCount * mChannels);
164 }
165 return res;
166 }
167 if (mBuffer.frameCount == 0) {
168 mBuffer.frameCount = pBuffer->frameCount;
169 status_t res = mTrackBufferProvider->getNextBuffer(&mBuffer, pts);
170 // TODO: Track down a bug in the upstream provider
171 // LOG_ALWAYS_FATAL_IF(res == OK && mBuffer.frameCount == 0,
172 // "ReformatBufferProvider::getNextBuffer():"
173 // " Invalid zero framecount returned from getNextBuffer()");
174 if (res != OK || mBuffer.frameCount == 0) {
175 pBuffer->raw = NULL;
176 pBuffer->frameCount = 0;
177 return res;
178 }
179 }
180 ALOG_ASSERT(mConsumed < mBuffer.frameCount);
181 size_t count = min(mOutputCount, mBuffer.frameCount - mConsumed);
182 count = min(count, pBuffer->frameCount);
183 pBuffer->raw = mOutputData;
184 pBuffer->frameCount = count;
185 //ALOGV("reformatting %d frames from %#x to %#x, %d chan",
186 // pBuffer->frameCount, mInputFormat, mOutputFormat, mChannels);
187 memcpy_by_audio_format(pBuffer->raw, mOutputFormat,
188 (uint8_t*)mBuffer.raw + mConsumed * mInputFrameSize, mInputFormat,
189 pBuffer->frameCount * mChannels);
190 return OK;
191}
192
193void AudioMixer::ReformatBufferProvider::releaseBuffer(AudioBufferProvider::Buffer *pBuffer) {
194 //ALOGV("ReformatBufferProvider(%p)::releaseBuffer(%p(%zu))",
195 // this, pBuffer, pBuffer->frameCount);
196 if (!requiresInternalBuffers()) {
197 mTrackBufferProvider->releaseBuffer(pBuffer);
198 return;
199 }
200 // LOG_ALWAYS_FATAL_IF(pBuffer->frameCount == 0, "Invalid framecount");
201 mConsumed += pBuffer->frameCount; // TODO: update for efficiency to reuse existing content
202 if (mConsumed != 0 && mConsumed >= mBuffer.frameCount) {
203 mConsumed = 0;
204 mTrackBufferProvider->releaseBuffer(&mBuffer);
205 // ALOG_ASSERT(mBuffer.frameCount == 0);
206 }
207 pBuffer->raw = NULL;
208 pBuffer->frameCount = 0;
209}
210
211void AudioMixer::ReformatBufferProvider::reset() {
212 if (mBuffer.frameCount != 0) {
213 mTrackBufferProvider->releaseBuffer(&mBuffer);
214 }
215 mConsumed = 0;
216}
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700217
218// ----------------------------------------------------------------------------
Glenn Kasten49c34ac2013-10-30 14:37:01 -0700219bool AudioMixer::sIsMultichannelCapable = false;
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700220
Glenn Kasten49c34ac2013-10-30 14:37:01 -0700221effect_descriptor_t AudioMixer::sDwnmFxDesc;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700222
Paul Lind3c0a0e82012-08-01 18:49:49 -0700223// Ensure mConfiguredNames bitmask is initialized properly on all architectures.
224// The value of 1 << x is undefined in C when x >= 32.
225
Glenn Kasten5c94b6c2012-03-20 17:01:29 -0700226AudioMixer::AudioMixer(size_t frameCount, uint32_t sampleRate, uint32_t maxNumTracks)
Paul Lind3c0a0e82012-08-01 18:49:49 -0700227 : mTrackNames(0), mConfiguredNames((maxNumTracks >= 32 ? 0 : 1 << maxNumTracks) - 1),
Glenn Kasten7f5d3352013-02-15 23:55:04 +0000228 mSampleRate(sampleRate)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700229{
Glenn Kasten788040c2011-05-05 08:19:00 -0700230 // AudioMixer is not yet capable of multi-channel beyond stereo
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800231 COMPILE_TIME_ASSERT_FUNCTION_SCOPE(2 == MAX_NUM_CHANNELS);
Jean-Michel Triviacb86cc2012-04-16 12:43:57 -0700232
Glenn Kasten5c94b6c2012-03-20 17:01:29 -0700233 ALOG_ASSERT(maxNumTracks <= MAX_NUM_TRACKS, "maxNumTracks %u > MAX_NUM_TRACKS %u",
234 maxNumTracks, MAX_NUM_TRACKS);
235
Glenn Kasten599fabc2012-03-08 12:33:37 -0800236 // AudioMixer is not yet capable of more than 32 active track inputs
237 ALOG_ASSERT(32 >= MAX_NUM_TRACKS, "bad MAX_NUM_TRACKS %d", MAX_NUM_TRACKS);
238
239 // AudioMixer is not yet capable of multi-channel output beyond stereo
240 ALOG_ASSERT(2 == MAX_NUM_CHANNELS, "bad MAX_NUM_CHANNELS %d", MAX_NUM_CHANNELS);
241
Glenn Kasten52008f82012-03-18 09:34:41 -0700242 pthread_once(&sOnceControl, &sInitRoutine);
243
Mathias Agopian65ab4712010-07-14 17:59:35 -0700244 mState.enabledTracks= 0;
245 mState.needsChanged = 0;
246 mState.frameCount = frameCount;
Glenn Kasten84afa3b2012-01-25 15:28:08 -0800247 mState.hook = process__nop;
Glenn Kastene0feee32011-12-13 11:53:26 -0800248 mState.outputTemp = NULL;
249 mState.resampleTemp = NULL;
Glenn Kastenab7d72f2013-02-27 09:05:28 -0800250 mState.mLog = &mDummyLog;
Glenn Kasten84afa3b2012-01-25 15:28:08 -0800251 // mState.reserved
Glenn Kasten17a736c2012-02-14 08:52:15 -0800252
253 // FIXME Most of the following initialization is probably redundant since
254 // tracks[i] should only be referenced if (mTrackNames & (1 << i)) != 0
255 // and mTrackNames is initially 0. However, leave it here until that's verified.
Mathias Agopian65ab4712010-07-14 17:59:35 -0700256 track_t* t = mState.tracks;
Glenn Kastenbf71f1e2011-12-13 11:52:35 -0800257 for (unsigned i=0 ; i < MAX_NUM_TRACKS ; i++) {
Eric Laurenta5e82142012-04-16 13:47:17 -0700258 t->resampler = NULL;
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700259 t->downmixerBufferProvider = NULL;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700260 t++;
261 }
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700262
Mathias Agopian65ab4712010-07-14 17:59:35 -0700263}
264
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800265AudioMixer::~AudioMixer()
266{
267 track_t* t = mState.tracks;
Glenn Kastenbf71f1e2011-12-13 11:52:35 -0800268 for (unsigned i=0 ; i < MAX_NUM_TRACKS ; i++) {
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800269 delete t->resampler;
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700270 delete t->downmixerBufferProvider;
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800271 t++;
272 }
273 delete [] mState.outputTemp;
274 delete [] mState.resampleTemp;
275}
Mathias Agopian65ab4712010-07-14 17:59:35 -0700276
Glenn Kastenab7d72f2013-02-27 09:05:28 -0800277void AudioMixer::setLog(NBLog::Writer *log)
278{
279 mState.mLog = log;
280}
281
Andy Hunge8a1ced2014-05-09 15:02:21 -0700282int AudioMixer::getTrackName(audio_channel_mask_t channelMask,
283 audio_format_t format, int sessionId)
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800284{
Andy Hunge8a1ced2014-05-09 15:02:21 -0700285 if (!isValidPcmTrackFormat(format)) {
286 ALOGE("AudioMixer::getTrackName invalid format (%#x)", format);
287 return -1;
288 }
Glenn Kasten5c94b6c2012-03-20 17:01:29 -0700289 uint32_t names = (~mTrackNames) & mConfiguredNames;
Glenn Kasten98dd5422011-12-15 14:38:29 -0800290 if (names != 0) {
291 int n = __builtin_ctz(names);
Steve Block3856b092011-10-20 11:56:00 +0100292 ALOGV("add track (%d)", n);
Glenn Kastendeeb1282012-03-25 11:59:31 -0700293 // assume default parameters for the track, except where noted below
294 track_t* t = &mState.tracks[n];
295 t->needs = 0;
Andy Hung97ae8242014-05-30 10:35:47 -0700296 t->volume[0] = UNITY_GAIN_INT;
297 t->volume[1] = UNITY_GAIN_INT;
Glenn Kastendeeb1282012-03-25 11:59:31 -0700298 // no initialization needed
299 // t->prevVolume[0]
300 // t->prevVolume[1]
301 t->volumeInc[0] = 0;
302 t->volumeInc[1] = 0;
303 t->auxLevel = 0;
304 t->auxInc = 0;
305 // no initialization needed
306 // t->prevAuxLevel
307 // t->frameCount
Andy Hung68112fc2014-05-14 14:13:23 -0700308 t->channelCount = audio_channel_count_from_out_mask(channelMask);
Glenn Kastendeeb1282012-03-25 11:59:31 -0700309 t->enabled = false;
Andy Hungef7c7fb2014-05-12 16:51:41 -0700310 ALOGV_IF(channelMask != AUDIO_CHANNEL_OUT_STEREO,
311 "Non-stereo channel mask: %d\n", channelMask);
Andy Hung68112fc2014-05-14 14:13:23 -0700312 t->channelMask = channelMask;
Jean-Michel Trivid06e1322012-09-12 15:47:07 -0700313 t->sessionId = sessionId;
Glenn Kastendeeb1282012-03-25 11:59:31 -0700314 // setBufferProvider(name, AudioBufferProvider *) is required before enable(name)
315 t->bufferProvider = NULL;
316 t->buffer.raw = NULL;
317 // no initialization needed
318 // t->buffer.frameCount
319 t->hook = NULL;
320 t->in = NULL;
321 t->resampler = NULL;
322 t->sampleRate = mSampleRate;
323 // setParameter(name, TRACK, MAIN_BUFFER, mixBuffer) is required before enable(name)
324 t->mainBuffer = NULL;
325 t->auxBuffer = NULL;
Andy Hungef7c7fb2014-05-12 16:51:41 -0700326 t->mInputBufferProvider = NULL;
327 t->mReformatBufferProvider = NULL;
Glenn Kasten52008f82012-03-18 09:34:41 -0700328 t->downmixerBufferProvider = NULL;
Andy Hung78820702014-02-28 16:23:02 -0800329 t->mMixerFormat = AUDIO_FORMAT_PCM_16_BIT;
Andy Hunge8a1ced2014-05-09 15:02:21 -0700330 t->mFormat = format;
Andy Hung296b7412014-06-17 15:25:47 -0700331 t->mMixerInFormat = kUseFloat && kUseNewMixer
332 ? AUDIO_FORMAT_PCM_FLOAT : AUDIO_FORMAT_PCM_16_BIT;
333 // Check the downmixing (or upmixing) requirements.
334 status_t status = initTrackDownmix(t, n, channelMask);
Andy Hung68112fc2014-05-14 14:13:23 -0700335 if (status != OK) {
336 ALOGE("AudioMixer::getTrackName invalid channelMask (%#x)", channelMask);
337 return -1;
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700338 }
Andy Hung296b7412014-06-17 15:25:47 -0700339 // initTrackDownmix() may change the input format requirement.
340 // If you desire floating point input to the mixer, it may change
341 // to integer because the downmixer requires integer to process.
342 ALOGVV("mMixerFormat:%#x mMixerInFormat:%#x\n", t->mMixerFormat, t->mMixerInFormat);
343 prepareTrackForReformat(t, n);
Andy Hung68112fc2014-05-14 14:13:23 -0700344 mTrackNames |= 1 << n;
345 return TRACK0 + n;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700346 }
Andy Hung68112fc2014-05-14 14:13:23 -0700347 ALOGE("AudioMixer::getTrackName out of available tracks");
Mathias Agopian65ab4712010-07-14 17:59:35 -0700348 return -1;
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800349}
Mathias Agopian65ab4712010-07-14 17:59:35 -0700350
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800351void AudioMixer::invalidateState(uint32_t mask)
352{
Glenn Kasten34fca342013-08-13 09:48:14 -0700353 if (mask != 0) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700354 mState.needsChanged |= mask;
355 mState.hook = process__validate;
356 }
357 }
358
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700359status_t AudioMixer::initTrackDownmix(track_t* pTrack, int trackNum, audio_channel_mask_t mask)
360{
Andy Hunge5412692014-05-16 11:25:07 -0700361 uint32_t channelCount = audio_channel_count_from_out_mask(mask);
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700362 ALOG_ASSERT((channelCount <= MAX_NUM_CHANNELS_TO_DOWNMIX) && channelCount);
363 status_t status = OK;
364 if (channelCount > MAX_NUM_CHANNELS) {
365 pTrack->channelMask = mask;
366 pTrack->channelCount = channelCount;
367 ALOGV("initTrackDownmix(track=%d, mask=0x%x) calls prepareTrackForDownmix()",
368 trackNum, mask);
369 status = prepareTrackForDownmix(pTrack, trackNum);
370 } else {
371 unprepareTrackForDownmix(pTrack, trackNum);
372 }
373 return status;
374}
375
Andy Hungee931ff2014-01-28 13:44:14 -0800376void AudioMixer::unprepareTrackForDownmix(track_t* pTrack, int trackName __unused) {
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700377 ALOGV("AudioMixer::unprepareTrackForDownmix(%d)", trackName);
378
379 if (pTrack->downmixerBufferProvider != NULL) {
380 // this track had previously been configured with a downmixer, delete it
381 ALOGV(" deleting old downmixer");
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700382 delete pTrack->downmixerBufferProvider;
383 pTrack->downmixerBufferProvider = NULL;
Andy Hungef7c7fb2014-05-12 16:51:41 -0700384 reconfigureBufferProviders(pTrack);
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700385 } else {
386 ALOGV(" nothing to do, no downmixer to delete");
387 }
388}
389
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700390status_t AudioMixer::prepareTrackForDownmix(track_t* pTrack, int trackName)
391{
392 ALOGV("AudioMixer::prepareTrackForDownmix(%d) with mask 0x%x", trackName, pTrack->channelMask);
393
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700394 // discard the previous downmixer if there was one
395 unprepareTrackForDownmix(pTrack, trackName);
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700396
397 DownmixerBufferProvider* pDbp = new DownmixerBufferProvider();
398 int32_t status;
399
Glenn Kasten49c34ac2013-10-30 14:37:01 -0700400 if (!sIsMultichannelCapable) {
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700401 ALOGE("prepareTrackForDownmix(%d) fails: mixer doesn't support multichannel content",
402 trackName);
403 goto noDownmixForActiveTrack;
404 }
405
Glenn Kasten49c34ac2013-10-30 14:37:01 -0700406 if (EffectCreate(&sDwnmFxDesc.uuid,
Jean-Michel Trivid06e1322012-09-12 15:47:07 -0700407 pTrack->sessionId /*sessionId*/, -2 /*ioId not relevant here, using random value*/,
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700408 &pDbp->mDownmixHandle/*pHandle*/) != 0) {
409 ALOGE("prepareTrackForDownmix(%d) fails: error creating downmixer effect", trackName);
410 goto noDownmixForActiveTrack;
411 }
412
413 // channel input configuration will be overridden per-track
414 pDbp->mDownmixConfig.inputCfg.channels = pTrack->channelMask;
415 pDbp->mDownmixConfig.outputCfg.channels = AUDIO_CHANNEL_OUT_STEREO;
416 pDbp->mDownmixConfig.inputCfg.format = AUDIO_FORMAT_PCM_16_BIT;
417 pDbp->mDownmixConfig.outputCfg.format = AUDIO_FORMAT_PCM_16_BIT;
418 pDbp->mDownmixConfig.inputCfg.samplingRate = pTrack->sampleRate;
419 pDbp->mDownmixConfig.outputCfg.samplingRate = pTrack->sampleRate;
420 pDbp->mDownmixConfig.inputCfg.accessMode = EFFECT_BUFFER_ACCESS_READ;
421 pDbp->mDownmixConfig.outputCfg.accessMode = EFFECT_BUFFER_ACCESS_WRITE;
422 // input and output buffer provider, and frame count will not be used as the downmix effect
423 // process() function is called directly (see DownmixerBufferProvider::getNextBuffer())
424 pDbp->mDownmixConfig.inputCfg.mask = EFFECT_CONFIG_SMP_RATE | EFFECT_CONFIG_CHANNELS |
425 EFFECT_CONFIG_FORMAT | EFFECT_CONFIG_ACC_MODE;
426 pDbp->mDownmixConfig.outputCfg.mask = pDbp->mDownmixConfig.inputCfg.mask;
427
428 {// scope for local variables that are not used in goto label "noDownmixForActiveTrack"
429 int cmdStatus;
430 uint32_t replySize = sizeof(int);
431
432 // Configure and enable downmixer
433 status = (*pDbp->mDownmixHandle)->command(pDbp->mDownmixHandle,
434 EFFECT_CMD_SET_CONFIG /*cmdCode*/, sizeof(effect_config_t) /*cmdSize*/,
435 &pDbp->mDownmixConfig /*pCmdData*/,
436 &replySize /*replySize*/, &cmdStatus /*pReplyData*/);
437 if ((status != 0) || (cmdStatus != 0)) {
438 ALOGE("error %d while configuring downmixer for track %d", status, trackName);
439 goto noDownmixForActiveTrack;
440 }
441 replySize = sizeof(int);
442 status = (*pDbp->mDownmixHandle)->command(pDbp->mDownmixHandle,
443 EFFECT_CMD_ENABLE /*cmdCode*/, 0 /*cmdSize*/, NULL /*pCmdData*/,
444 &replySize /*replySize*/, &cmdStatus /*pReplyData*/);
445 if ((status != 0) || (cmdStatus != 0)) {
446 ALOGE("error %d while enabling downmixer for track %d", status, trackName);
447 goto noDownmixForActiveTrack;
448 }
449
450 // Set downmix type
451 // parameter size rounded for padding on 32bit boundary
452 const int psizePadded = ((sizeof(downmix_params_t) - 1)/sizeof(int) + 1) * sizeof(int);
453 const int downmixParamSize =
454 sizeof(effect_param_t) + psizePadded + sizeof(downmix_type_t);
455 effect_param_t * const param = (effect_param_t *) malloc(downmixParamSize);
456 param->psize = sizeof(downmix_params_t);
457 const downmix_params_t downmixParam = DOWNMIX_PARAM_TYPE;
458 memcpy(param->data, &downmixParam, param->psize);
459 const downmix_type_t downmixType = DOWNMIX_TYPE_FOLD;
460 param->vsize = sizeof(downmix_type_t);
461 memcpy(param->data + psizePadded, &downmixType, param->vsize);
462
463 status = (*pDbp->mDownmixHandle)->command(pDbp->mDownmixHandle,
464 EFFECT_CMD_SET_PARAM /* cmdCode */, downmixParamSize/* cmdSize */,
465 param /*pCmndData*/, &replySize /*replySize*/, &cmdStatus /*pReplyData*/);
466
467 free(param);
468
469 if ((status != 0) || (cmdStatus != 0)) {
470 ALOGE("error %d while setting downmix type for track %d", status, trackName);
471 goto noDownmixForActiveTrack;
472 } else {
473 ALOGV("downmix type set to %d for track %d", (int) downmixType, trackName);
474 }
475 }// end of scope for local variables that are not used in goto label "noDownmixForActiveTrack"
476
477 // initialization successful:
Andy Hung296b7412014-06-17 15:25:47 -0700478 pTrack->mMixerInFormat = AUDIO_FORMAT_PCM_16_BIT; // 16 bit input is required for downmix
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700479 pTrack->downmixerBufferProvider = pDbp;
Andy Hungef7c7fb2014-05-12 16:51:41 -0700480 reconfigureBufferProviders(pTrack);
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700481 return NO_ERROR;
482
483noDownmixForActiveTrack:
484 delete pDbp;
485 pTrack->downmixerBufferProvider = NULL;
Andy Hungef7c7fb2014-05-12 16:51:41 -0700486 reconfigureBufferProviders(pTrack);
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700487 return NO_INIT;
488}
489
Andy Hungef7c7fb2014-05-12 16:51:41 -0700490void AudioMixer::unprepareTrackForReformat(track_t* pTrack, int trackName __unused) {
491 ALOGV("AudioMixer::unprepareTrackForReformat(%d)", trackName);
492 if (pTrack->mReformatBufferProvider != NULL) {
493 delete pTrack->mReformatBufferProvider;
494 pTrack->mReformatBufferProvider = NULL;
495 reconfigureBufferProviders(pTrack);
496 }
497}
498
499status_t AudioMixer::prepareTrackForReformat(track_t* pTrack, int trackName)
500{
501 ALOGV("AudioMixer::prepareTrackForReformat(%d) with format %#x", trackName, pTrack->mFormat);
502 // discard the previous reformatter if there was one
Andy Hung296b7412014-06-17 15:25:47 -0700503 unprepareTrackForReformat(pTrack, trackName);
504 // only configure reformatter if needed
505 if (pTrack->mFormat != pTrack->mMixerInFormat) {
506 pTrack->mReformatBufferProvider = new ReformatBufferProvider(
507 audio_channel_count_from_out_mask(pTrack->channelMask),
508 pTrack->mFormat, pTrack->mMixerInFormat);
509 reconfigureBufferProviders(pTrack);
510 }
511 return NO_ERROR;
Andy Hungef7c7fb2014-05-12 16:51:41 -0700512}
513
514void AudioMixer::reconfigureBufferProviders(track_t* pTrack)
515{
516 pTrack->bufferProvider = pTrack->mInputBufferProvider;
517 if (pTrack->mReformatBufferProvider) {
518 pTrack->mReformatBufferProvider->mTrackBufferProvider = pTrack->bufferProvider;
519 pTrack->bufferProvider = pTrack->mReformatBufferProvider;
520 }
521 if (pTrack->downmixerBufferProvider) {
522 pTrack->downmixerBufferProvider->mTrackBufferProvider = pTrack->bufferProvider;
523 pTrack->bufferProvider = pTrack->downmixerBufferProvider;
524 }
525}
526
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800527void AudioMixer::deleteTrackName(int name)
528{
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700529 ALOGV("AudioMixer::deleteTrackName(%d)", name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700530 name -= TRACK0;
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800531 ALOG_ASSERT(uint32_t(name) < MAX_NUM_TRACKS, "bad track name %d", name);
Glenn Kasten237a6242011-12-15 15:32:27 -0800532 ALOGV("deleteTrackName(%d)", name);
533 track_t& track(mState.tracks[ name ]);
Glenn Kasten4c340c62012-01-27 12:33:54 -0800534 if (track.enabled) {
535 track.enabled = false;
Glenn Kasten237a6242011-12-15 15:32:27 -0800536 invalidateState(1<<name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700537 }
Glenn Kasten4e2293f2012-04-12 09:39:07 -0700538 // delete the resampler
539 delete track.resampler;
540 track.resampler = NULL;
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700541 // delete the downmixer
542 unprepareTrackForDownmix(&mState.tracks[name], name);
Andy Hungef7c7fb2014-05-12 16:51:41 -0700543 // delete the reformatter
544 unprepareTrackForReformat(&mState.tracks[name], name);
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700545
Glenn Kasten237a6242011-12-15 15:32:27 -0800546 mTrackNames &= ~(1<<name);
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800547}
Mathias Agopian65ab4712010-07-14 17:59:35 -0700548
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800549void AudioMixer::enable(int name)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700550{
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800551 name -= TRACK0;
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800552 ALOG_ASSERT(uint32_t(name) < MAX_NUM_TRACKS, "bad track name %d", name);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800553 track_t& track = mState.tracks[name];
554
Glenn Kasten4c340c62012-01-27 12:33:54 -0800555 if (!track.enabled) {
556 track.enabled = true;
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800557 ALOGV("enable(%d)", name);
558 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700559 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700560}
561
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800562void AudioMixer::disable(int name)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700563{
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800564 name -= TRACK0;
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800565 ALOG_ASSERT(uint32_t(name) < MAX_NUM_TRACKS, "bad track name %d", name);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800566 track_t& track = mState.tracks[name];
567
Glenn Kasten4c340c62012-01-27 12:33:54 -0800568 if (track.enabled) {
569 track.enabled = false;
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800570 ALOGV("disable(%d)", name);
571 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700572 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700573}
574
Andy Hung5866a3b2014-05-29 21:33:13 -0700575/* Sets the volume ramp variables for the AudioMixer.
576 *
577 * The volume ramp variables are used to transition between the previous
578 * volume to the target volume. The duration of the transition is
579 * set by ramp, which is either 0 for immediate, or typically one state
580 * framecount period.
581 *
Andy Hung6be49402014-05-30 10:42:03 -0700582 * @param newFloatValue new volume target in float [0.0, 1.0].
Andy Hung5866a3b2014-05-29 21:33:13 -0700583 * @param ramp number of frames to increment over. ramp is 0 if the volume
584 * should be set immediately.
585 * @param volume reference to the U4.12 target volume, set on return.
586 * @param prevVolume reference to the U4.27 previous volume, set on return.
587 * @param volumeInc reference to the increment per output audio frame, set on return.
588 * @return true if the volume has changed, false if volume is same.
589 */
Andy Hung6be49402014-05-30 10:42:03 -0700590static inline bool setVolumeRampVariables(float newFloatValue, int32_t ramp,
Andy Hung5866a3b2014-05-29 21:33:13 -0700591 int16_t &volume, int32_t &prevVolume, int32_t &volumeInc) {
Andy Hung6be49402014-05-30 10:42:03 -0700592 int32_t newValue = newFloatValue * AudioMixer::UNITY_GAIN_INT;
593 if (newValue > AudioMixer::UNITY_GAIN_INT) {
594 newValue = AudioMixer::UNITY_GAIN_INT;
595 } else if (newValue < 0) {
596 ALOGE("negative volume %.7g", newFloatValue);
597 newValue = 0; // should never happen, but for safety check.
598 }
Andy Hung5866a3b2014-05-29 21:33:13 -0700599 if (newValue == volume) {
600 return false;
601 }
602 if (ramp != 0) {
603 volumeInc = ((newValue - volume) << 16) / ramp;
604 prevVolume = (volumeInc == 0 ? newValue : volume) << 16;
605 } else {
606 volumeInc = 0;
607 prevVolume = newValue << 16;
608 }
609 volume = newValue;
610 return true;
611}
612
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800613void AudioMixer::setParameter(int name, int target, int param, void *value)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700614{
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800615 name -= TRACK0;
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800616 ALOG_ASSERT(uint32_t(name) < MAX_NUM_TRACKS, "bad track name %d", name);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800617 track_t& track = mState.tracks[name];
Mathias Agopian65ab4712010-07-14 17:59:35 -0700618
Kévin PETIT377b2ec2014-02-03 12:35:36 +0000619 int valueInt = static_cast<int>(reinterpret_cast<uintptr_t>(value));
620 int32_t *valueBuf = reinterpret_cast<int32_t*>(value);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700621
622 switch (target) {
Glenn Kasten788040c2011-05-05 08:19:00 -0700623
Mathias Agopian65ab4712010-07-14 17:59:35 -0700624 case TRACK:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800625 switch (param) {
Glenn Kasten788040c2011-05-05 08:19:00 -0700626 case CHANNEL_MASK: {
Kévin PETIT377b2ec2014-02-03 12:35:36 +0000627 audio_channel_mask_t mask =
628 static_cast<audio_channel_mask_t>(reinterpret_cast<uintptr_t>(value));
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800629 if (track.channelMask != mask) {
Andy Hunge5412692014-05-16 11:25:07 -0700630 uint32_t channelCount = audio_channel_count_from_out_mask(mask);
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700631 ALOG_ASSERT((channelCount <= MAX_NUM_CHANNELS_TO_DOWNMIX) && channelCount);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800632 track.channelMask = mask;
633 track.channelCount = channelCount;
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700634 // the mask has changed, does this track need a downmixer?
Andy Hung296b7412014-06-17 15:25:47 -0700635 // update to try using our desired format (if we aren't already using it)
636 track.mMixerInFormat = kUseFloat && kUseNewMixer
637 ? AUDIO_FORMAT_PCM_FLOAT : AUDIO_FORMAT_PCM_16_BIT;
638 status_t status = initTrackDownmix(&mState.tracks[name], name, mask);
639 ALOGE_IF(status != OK,
640 "Invalid channel mask %#x, initTrackDownmix returned %d",
641 mask, status);
Glenn Kasten788040c2011-05-05 08:19:00 -0700642 ALOGV("setParameter(TRACK, CHANNEL_MASK, %x)", mask);
Andy Hung296b7412014-06-17 15:25:47 -0700643 prepareTrackForReformat(&track, name); // format may have changed
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800644 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700645 }
Glenn Kasten788040c2011-05-05 08:19:00 -0700646 } break;
647 case MAIN_BUFFER:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800648 if (track.mainBuffer != valueBuf) {
649 track.mainBuffer = valueBuf;
Steve Block3856b092011-10-20 11:56:00 +0100650 ALOGV("setParameter(TRACK, MAIN_BUFFER, %p)", valueBuf);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800651 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700652 }
Glenn Kasten788040c2011-05-05 08:19:00 -0700653 break;
654 case AUX_BUFFER:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800655 if (track.auxBuffer != valueBuf) {
656 track.auxBuffer = valueBuf;
Steve Block3856b092011-10-20 11:56:00 +0100657 ALOGV("setParameter(TRACK, AUX_BUFFER, %p)", valueBuf);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800658 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700659 }
Glenn Kasten788040c2011-05-05 08:19:00 -0700660 break;
Andy Hungef7c7fb2014-05-12 16:51:41 -0700661 case FORMAT: {
662 audio_format_t format = static_cast<audio_format_t>(valueInt);
663 if (track.mFormat != format) {
664 ALOG_ASSERT(audio_is_linear_pcm(format), "Invalid format %#x", format);
665 track.mFormat = format;
666 ALOGV("setParameter(TRACK, FORMAT, %#x)", format);
Andy Hung296b7412014-06-17 15:25:47 -0700667 prepareTrackForReformat(&track, name);
Andy Hungef7c7fb2014-05-12 16:51:41 -0700668 invalidateState(1 << name);
669 }
670 } break;
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700671 // FIXME do we want to support setting the downmix type from AudioFlinger?
672 // for a specific track? or per mixer?
673 /* case DOWNMIX_TYPE:
674 break */
Andy Hung78820702014-02-28 16:23:02 -0800675 case MIXER_FORMAT: {
Andy Hunga1ab7cc2014-02-24 19:26:52 -0800676 audio_format_t format = static_cast<audio_format_t>(valueInt);
Andy Hung78820702014-02-28 16:23:02 -0800677 if (track.mMixerFormat != format) {
678 track.mMixerFormat = format;
679 ALOGV("setParameter(TRACK, MIXER_FORMAT, %#x)", format);
Andy Hunga1ab7cc2014-02-24 19:26:52 -0800680 }
681 } break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700682 default:
Glenn Kastenadad3d72014-02-21 14:51:43 -0800683 LOG_ALWAYS_FATAL("setParameter track: bad param %d", param);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700684 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700685 break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700686
Mathias Agopian65ab4712010-07-14 17:59:35 -0700687 case RESAMPLE:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800688 switch (param) {
689 case SAMPLE_RATE:
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800690 ALOG_ASSERT(valueInt > 0, "bad sample rate %d", valueInt);
Glenn Kasten788040c2011-05-05 08:19:00 -0700691 if (track.setResampler(uint32_t(valueInt), mSampleRate)) {
692 ALOGV("setParameter(RESAMPLE, SAMPLE_RATE, %u)",
693 uint32_t(valueInt));
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800694 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700695 }
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800696 break;
697 case RESET:
Eric Laurent243f5f92011-02-28 16:52:51 -0800698 track.resetResampler();
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800699 invalidateState(1 << name);
700 break;
Glenn Kasten4e2293f2012-04-12 09:39:07 -0700701 case REMOVE:
702 delete track.resampler;
703 track.resampler = NULL;
704 track.sampleRate = mSampleRate;
705 invalidateState(1 << name);
706 break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700707 default:
Glenn Kastenadad3d72014-02-21 14:51:43 -0800708 LOG_ALWAYS_FATAL("setParameter resample: bad param %d", param);
Eric Laurent243f5f92011-02-28 16:52:51 -0800709 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700710 break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700711
Mathias Agopian65ab4712010-07-14 17:59:35 -0700712 case RAMP_VOLUME:
713 case VOLUME:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800714 switch (param) {
Glenn Kasten788040c2011-05-05 08:19:00 -0700715 case VOLUME0:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800716 case VOLUME1:
Andy Hung6be49402014-05-30 10:42:03 -0700717 if (setVolumeRampVariables(*reinterpret_cast<float*>(value),
Andy Hung5866a3b2014-05-29 21:33:13 -0700718 target == RAMP_VOLUME ? mState.frameCount : 0,
719 track.volume[param - VOLUME0], track.prevVolume[param - VOLUME0],
720 track.volumeInc[param - VOLUME0])) {
721 ALOGV("setParameter(%s, VOLUME%d: %04x)",
Andy Hung6be49402014-05-30 10:42:03 -0700722 target == VOLUME ? "VOLUME" : "RAMP_VOLUME", param - VOLUME0,
723 track.volume[param - VOLUME0]);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800724 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700725 }
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800726 break;
727 case AUXLEVEL:
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800728 //ALOG_ASSERT(0 <= valueInt && valueInt <= MAX_GAIN_INT, "bad aux level %d", valueInt);
Andy Hung6be49402014-05-30 10:42:03 -0700729 if (setVolumeRampVariables(*reinterpret_cast<float*>(value),
Andy Hung5866a3b2014-05-29 21:33:13 -0700730 target == RAMP_VOLUME ? mState.frameCount : 0,
731 track.auxLevel, track.prevAuxLevel, track.auxInc)) {
732 ALOGV("setParameter(%s, AUXLEVEL: %04x)",
Andy Hung6be49402014-05-30 10:42:03 -0700733 target == VOLUME ? "VOLUME" : "RAMP_VOLUME", track.auxLevel);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800734 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700735 }
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800736 break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700737 default:
Glenn Kastenadad3d72014-02-21 14:51:43 -0800738 LOG_ALWAYS_FATAL("setParameter volume: bad param %d", param);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700739 }
740 break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700741
742 default:
Glenn Kastenadad3d72014-02-21 14:51:43 -0800743 LOG_ALWAYS_FATAL("setParameter: bad target %d", target);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700744 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700745}
746
747bool AudioMixer::track_t::setResampler(uint32_t value, uint32_t devSampleRate)
748{
Glenn Kasten4e2293f2012-04-12 09:39:07 -0700749 if (value != devSampleRate || resampler != NULL) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700750 if (sampleRate != value) {
751 sampleRate = value;
Glenn Kastene0feee32011-12-13 11:53:26 -0800752 if (resampler == NULL) {
Glenn Kastenac602052012-10-01 14:04:31 -0700753 ALOGV("creating resampler from track %d Hz to device %d Hz", value, devSampleRate);
754 AudioResampler::src_quality quality;
755 // force lowest quality level resampler if use case isn't music or video
756 // FIXME this is flawed for dynamic sample rates, as we choose the resampler
757 // quality level based on the initial ratio, but that could change later.
758 // Should have a way to distinguish tracks with static ratios vs. dynamic ratios.
759 if (!((value == 44100 && devSampleRate == 48000) ||
760 (value == 48000 && devSampleRate == 44100))) {
Andy Hung9e0308c2014-01-30 14:32:31 -0800761 quality = AudioResampler::DYN_LOW_QUALITY;
Glenn Kastenac602052012-10-01 14:04:31 -0700762 } else {
763 quality = AudioResampler::DEFAULT_QUALITY;
764 }
Andy Hung296b7412014-06-17 15:25:47 -0700765
766 int bits;
767 switch (mMixerInFormat) {
768 case AUDIO_FORMAT_PCM_16_BIT:
769 bits = 16;
770 break;
771 case AUDIO_FORMAT_PCM_FLOAT:
772 bits = 32; // 32 bits to the AudioResampler::create() indicates float.
773 break;
774 default:
775 LOG_ALWAYS_FATAL("Invalid mMixerInFormat: %#x", mMixerInFormat);
776 break;
777 }
778 ALOGVV("Creating resampler with %d bits\n", bits);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700779 resampler = AudioResampler::create(
Andy Hungef7c7fb2014-05-12 16:51:41 -0700780 bits,
Jean-Michel Triviacb86cc2012-04-16 12:43:57 -0700781 // the resampler sees the number of channels after the downmixer, if any
Glenn Kastenf551e992013-08-19 18:45:42 -0700782 (int) (downmixerBufferProvider != NULL ? MAX_NUM_CHANNELS : channelCount),
Glenn Kastenac602052012-10-01 14:04:31 -0700783 devSampleRate, quality);
Glenn Kasten52008f82012-03-18 09:34:41 -0700784 resampler->setLocalTimeFreq(sLocalTimeFreq);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700785 }
786 return true;
787 }
788 }
789 return false;
790}
791
Mathias Agopian65ab4712010-07-14 17:59:35 -0700792inline
793void AudioMixer::track_t::adjustVolumeRamp(bool aux)
794{
Glenn Kastenf9a27772012-01-06 07:47:26 -0800795 for (uint32_t i=0 ; i<MAX_NUM_CHANNELS ; i++) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700796 if (((volumeInc[i]>0) && (((prevVolume[i]+volumeInc[i])>>16) >= volume[i])) ||
797 ((volumeInc[i]<0) && (((prevVolume[i]+volumeInc[i])>>16) <= volume[i]))) {
798 volumeInc[i] = 0;
799 prevVolume[i] = volume[i]<<16;
800 }
801 }
802 if (aux) {
803 if (((auxInc>0) && (((prevAuxLevel+auxInc)>>16) >= auxLevel)) ||
804 ((auxInc<0) && (((prevAuxLevel+auxInc)>>16) <= auxLevel))) {
805 auxInc = 0;
806 prevAuxLevel = auxLevel<<16;
807 }
808 }
809}
810
Glenn Kastenc59c0042012-02-02 14:06:11 -0800811size_t AudioMixer::getUnreleasedFrames(int name) const
Eric Laurent071ccd52011-12-22 16:08:41 -0800812{
813 name -= TRACK0;
814 if (uint32_t(name) < MAX_NUM_TRACKS) {
Glenn Kastenc59c0042012-02-02 14:06:11 -0800815 return mState.tracks[name].getUnreleasedFrames();
Eric Laurent071ccd52011-12-22 16:08:41 -0800816 }
817 return 0;
818}
Mathias Agopian65ab4712010-07-14 17:59:35 -0700819
Glenn Kasten01c4ebf2012-02-22 10:47:35 -0800820void AudioMixer::setBufferProvider(int name, AudioBufferProvider* bufferProvider)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700821{
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800822 name -= TRACK0;
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800823 ALOG_ASSERT(uint32_t(name) < MAX_NUM_TRACKS, "bad track name %d", name);
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700824
Andy Hung1d26ddf2014-05-29 15:53:09 -0700825 if (mState.tracks[name].mInputBufferProvider == bufferProvider) {
826 return; // don't reset any buffer providers if identical.
827 }
Andy Hungef7c7fb2014-05-12 16:51:41 -0700828 if (mState.tracks[name].mReformatBufferProvider != NULL) {
829 mState.tracks[name].mReformatBufferProvider->reset();
830 } else if (mState.tracks[name].downmixerBufferProvider != NULL) {
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700831 }
Andy Hungef7c7fb2014-05-12 16:51:41 -0700832
833 mState.tracks[name].mInputBufferProvider = bufferProvider;
834 reconfigureBufferProviders(&mState.tracks[name]);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700835}
836
837
John Grossman4ff14ba2012-02-08 16:37:41 -0800838void AudioMixer::process(int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700839{
John Grossman4ff14ba2012-02-08 16:37:41 -0800840 mState.hook(&mState, pts);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700841}
842
843
John Grossman4ff14ba2012-02-08 16:37:41 -0800844void AudioMixer::process__validate(state_t* state, int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700845{
Steve Block5ff1dd52012-01-05 23:22:43 +0000846 ALOGW_IF(!state->needsChanged,
Mathias Agopian65ab4712010-07-14 17:59:35 -0700847 "in process__validate() but nothing's invalid");
848
849 uint32_t changed = state->needsChanged;
850 state->needsChanged = 0; // clear the validation flag
851
852 // recompute which tracks are enabled / disabled
853 uint32_t enabled = 0;
854 uint32_t disabled = 0;
855 while (changed) {
856 const int i = 31 - __builtin_clz(changed);
857 const uint32_t mask = 1<<i;
858 changed &= ~mask;
859 track_t& t = state->tracks[i];
860 (t.enabled ? enabled : disabled) |= mask;
861 }
862 state->enabledTracks &= ~disabled;
863 state->enabledTracks |= enabled;
864
865 // compute everything we need...
866 int countActiveTracks = 0;
Glenn Kasten4c340c62012-01-27 12:33:54 -0800867 bool all16BitsStereoNoResample = true;
868 bool resampling = false;
869 bool volumeRamp = false;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700870 uint32_t en = state->enabledTracks;
871 while (en) {
872 const int i = 31 - __builtin_clz(en);
873 en &= ~(1<<i);
874
875 countActiveTracks++;
876 track_t& t = state->tracks[i];
877 uint32_t n = 0;
Glenn Kastend6fadf02013-10-30 14:37:29 -0700878 // FIXME can overflow (mask is only 3 bits)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700879 n |= NEEDS_CHANNEL_1 + t.channelCount - 1;
Glenn Kastend6fadf02013-10-30 14:37:29 -0700880 if (t.doesResample()) {
881 n |= NEEDS_RESAMPLE;
882 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700883 if (t.auxLevel != 0 && t.auxBuffer != NULL) {
Glenn Kastend6fadf02013-10-30 14:37:29 -0700884 n |= NEEDS_AUX;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700885 }
886
887 if (t.volumeInc[0]|t.volumeInc[1]) {
Glenn Kasten4c340c62012-01-27 12:33:54 -0800888 volumeRamp = true;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700889 } else if (!t.doesResample() && t.volumeRL == 0) {
Glenn Kastend6fadf02013-10-30 14:37:29 -0700890 n |= NEEDS_MUTE;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700891 }
892 t.needs = n;
893
Glenn Kastend6fadf02013-10-30 14:37:29 -0700894 if (n & NEEDS_MUTE) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700895 t.hook = track__nop;
896 } else {
Glenn Kastend6fadf02013-10-30 14:37:29 -0700897 if (n & NEEDS_AUX) {
Glenn Kasten4c340c62012-01-27 12:33:54 -0800898 all16BitsStereoNoResample = false;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700899 }
Glenn Kastend6fadf02013-10-30 14:37:29 -0700900 if (n & NEEDS_RESAMPLE) {
Glenn Kasten4c340c62012-01-27 12:33:54 -0800901 all16BitsStereoNoResample = false;
902 resampling = true;
Andy Hung296b7412014-06-17 15:25:47 -0700903 t.hook = getTrackHook(TRACKTYPE_RESAMPLE, FCC_2,
904 t.mMixerInFormat, t.mMixerFormat);
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700905 ALOGV_IF((n & NEEDS_CHANNEL_COUNT__MASK) > NEEDS_CHANNEL_2,
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700906 "Track %d needs downmix + resample", i);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700907 } else {
908 if ((n & NEEDS_CHANNEL_COUNT__MASK) == NEEDS_CHANNEL_1){
Andy Hung296b7412014-06-17 15:25:47 -0700909 t.hook = getTrackHook(TRACKTYPE_NORESAMPLEMONO, FCC_2,
910 t.mMixerInFormat, t.mMixerFormat);
Glenn Kasten4c340c62012-01-27 12:33:54 -0800911 all16BitsStereoNoResample = false;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700912 }
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700913 if ((n & NEEDS_CHANNEL_COUNT__MASK) >= NEEDS_CHANNEL_2){
Andy Hung296b7412014-06-17 15:25:47 -0700914 t.hook = getTrackHook(TRACKTYPE_NORESAMPLE, FCC_2,
915 t.mMixerInFormat, t.mMixerFormat);
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700916 ALOGV_IF((n & NEEDS_CHANNEL_COUNT__MASK) > NEEDS_CHANNEL_2,
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700917 "Track %d needs downmix", i);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700918 }
919 }
920 }
921 }
922
923 // select the processing hooks
924 state->hook = process__nop;
Glenn Kasten34fca342013-08-13 09:48:14 -0700925 if (countActiveTracks > 0) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700926 if (resampling) {
927 if (!state->outputTemp) {
928 state->outputTemp = new int32_t[MAX_NUM_CHANNELS * state->frameCount];
929 }
930 if (!state->resampleTemp) {
931 state->resampleTemp = new int32_t[MAX_NUM_CHANNELS * state->frameCount];
932 }
933 state->hook = process__genericResampling;
934 } else {
935 if (state->outputTemp) {
936 delete [] state->outputTemp;
Glenn Kastene0feee32011-12-13 11:53:26 -0800937 state->outputTemp = NULL;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700938 }
939 if (state->resampleTemp) {
940 delete [] state->resampleTemp;
Glenn Kastene0feee32011-12-13 11:53:26 -0800941 state->resampleTemp = NULL;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700942 }
943 state->hook = process__genericNoResampling;
944 if (all16BitsStereoNoResample && !volumeRamp) {
945 if (countActiveTracks == 1) {
Andy Hung296b7412014-06-17 15:25:47 -0700946 const int i = 31 - __builtin_clz(state->enabledTracks);
947 track_t& t = state->tracks[i];
948 state->hook = getProcessHook(PROCESSTYPE_NORESAMPLEONETRACK, FCC_2,
949 t.mMixerInFormat, t.mMixerFormat);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700950 }
951 }
952 }
953 }
954
Steve Block3856b092011-10-20 11:56:00 +0100955 ALOGV("mixer configuration change: %d activeTracks (%08x) "
Mathias Agopian65ab4712010-07-14 17:59:35 -0700956 "all16BitsStereoNoResample=%d, resampling=%d, volumeRamp=%d",
957 countActiveTracks, state->enabledTracks,
958 all16BitsStereoNoResample, resampling, volumeRamp);
959
John Grossman4ff14ba2012-02-08 16:37:41 -0800960 state->hook(state, pts);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700961
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800962 // Now that the volume ramp has been done, set optimal state and
963 // track hooks for subsequent mixer process
Glenn Kasten34fca342013-08-13 09:48:14 -0700964 if (countActiveTracks > 0) {
Glenn Kasten4c340c62012-01-27 12:33:54 -0800965 bool allMuted = true;
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800966 uint32_t en = state->enabledTracks;
967 while (en) {
968 const int i = 31 - __builtin_clz(en);
969 en &= ~(1<<i);
970 track_t& t = state->tracks[i];
Glenn Kasten6e2ebe92013-08-13 09:14:51 -0700971 if (!t.doesResample() && t.volumeRL == 0) {
Glenn Kastend6fadf02013-10-30 14:37:29 -0700972 t.needs |= NEEDS_MUTE;
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800973 t.hook = track__nop;
974 } else {
Glenn Kasten4c340c62012-01-27 12:33:54 -0800975 allMuted = false;
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800976 }
977 }
978 if (allMuted) {
979 state->hook = process__nop;
980 } else if (all16BitsStereoNoResample) {
981 if (countActiveTracks == 1) {
982 state->hook = process__OneTrack16BitsStereoNoResampling;
983 }
984 }
985 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700986}
987
Mathias Agopian65ab4712010-07-14 17:59:35 -0700988
Glenn Kasten85ab62c2012-11-01 11:11:38 -0700989void AudioMixer::track__genericResample(track_t* t, int32_t* out, size_t outFrameCount,
990 int32_t* temp, int32_t* aux)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700991{
Andy Hung296b7412014-06-17 15:25:47 -0700992 ALOGVV("track__genericResample\n");
Mathias Agopian65ab4712010-07-14 17:59:35 -0700993 t->resampler->setSampleRate(t->sampleRate);
994
995 // ramp gain - resample to temp buffer and scale/mix in 2nd step
996 if (aux != NULL) {
997 // always resample with unity gain when sending to auxiliary buffer to be able
998 // to apply send level after resampling
999 // TODO: modify each resampler to support aux channel?
Andy Hung97ae8242014-05-30 10:35:47 -07001000 t->resampler->setVolume(UNITY_GAIN_INT, UNITY_GAIN_INT);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001001 memset(temp, 0, outFrameCount * MAX_NUM_CHANNELS * sizeof(int32_t));
1002 t->resampler->resample(temp, outFrameCount, t->bufferProvider);
Glenn Kastenf6b16782011-12-15 09:51:17 -08001003 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1]|t->auxInc)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001004 volumeRampStereo(t, out, outFrameCount, temp, aux);
1005 } else {
1006 volumeStereo(t, out, outFrameCount, temp, aux);
1007 }
1008 } else {
Glenn Kastenf6b16782011-12-15 09:51:17 -08001009 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1])) {
Andy Hung97ae8242014-05-30 10:35:47 -07001010 t->resampler->setVolume(UNITY_GAIN_INT, UNITY_GAIN_INT);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001011 memset(temp, 0, outFrameCount * MAX_NUM_CHANNELS * sizeof(int32_t));
1012 t->resampler->resample(temp, outFrameCount, t->bufferProvider);
1013 volumeRampStereo(t, out, outFrameCount, temp, aux);
1014 }
1015
1016 // constant gain
1017 else {
1018 t->resampler->setVolume(t->volume[0], t->volume[1]);
1019 t->resampler->resample(out, outFrameCount, t->bufferProvider);
1020 }
1021 }
1022}
1023
Andy Hungee931ff2014-01-28 13:44:14 -08001024void AudioMixer::track__nop(track_t* t __unused, int32_t* out __unused,
1025 size_t outFrameCount __unused, int32_t* temp __unused, int32_t* aux __unused)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001026{
1027}
1028
Glenn Kasten85ab62c2012-11-01 11:11:38 -07001029void AudioMixer::volumeRampStereo(track_t* t, int32_t* out, size_t frameCount, int32_t* temp,
1030 int32_t* aux)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001031{
1032 int32_t vl = t->prevVolume[0];
1033 int32_t vr = t->prevVolume[1];
1034 const int32_t vlInc = t->volumeInc[0];
1035 const int32_t vrInc = t->volumeInc[1];
1036
Steve Blockb8a80522011-12-20 16:23:08 +00001037 //ALOGD("[0] %p: inc=%f, v0=%f, v1=%d, final=%f, count=%d",
Mathias Agopian65ab4712010-07-14 17:59:35 -07001038 // t, vlInc/65536.0f, vl/65536.0f, t->volume[0],
1039 // (vl + vlInc*frameCount)/65536.0f, frameCount);
1040
1041 // ramp volume
Glenn Kastenf6b16782011-12-15 09:51:17 -08001042 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001043 int32_t va = t->prevAuxLevel;
1044 const int32_t vaInc = t->auxInc;
1045 int32_t l;
1046 int32_t r;
1047
1048 do {
1049 l = (*temp++ >> 12);
1050 r = (*temp++ >> 12);
1051 *out++ += (vl >> 16) * l;
1052 *out++ += (vr >> 16) * r;
1053 *aux++ += (va >> 17) * (l + r);
1054 vl += vlInc;
1055 vr += vrInc;
1056 va += vaInc;
1057 } while (--frameCount);
1058 t->prevAuxLevel = va;
1059 } else {
1060 do {
1061 *out++ += (vl >> 16) * (*temp++ >> 12);
1062 *out++ += (vr >> 16) * (*temp++ >> 12);
1063 vl += vlInc;
1064 vr += vrInc;
1065 } while (--frameCount);
1066 }
1067 t->prevVolume[0] = vl;
1068 t->prevVolume[1] = vr;
Glenn Kastena1117922012-01-26 10:53:32 -08001069 t->adjustVolumeRamp(aux != NULL);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001070}
1071
Glenn Kasten85ab62c2012-11-01 11:11:38 -07001072void AudioMixer::volumeStereo(track_t* t, int32_t* out, size_t frameCount, int32_t* temp,
1073 int32_t* aux)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001074{
1075 const int16_t vl = t->volume[0];
1076 const int16_t vr = t->volume[1];
1077
Glenn Kastenf6b16782011-12-15 09:51:17 -08001078 if (CC_UNLIKELY(aux != NULL)) {
Glenn Kasten3b81aca2012-01-27 15:26:23 -08001079 const int16_t va = t->auxLevel;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001080 do {
1081 int16_t l = (int16_t)(*temp++ >> 12);
1082 int16_t r = (int16_t)(*temp++ >> 12);
1083 out[0] = mulAdd(l, vl, out[0]);
1084 int16_t a = (int16_t)(((int32_t)l + r) >> 1);
1085 out[1] = mulAdd(r, vr, out[1]);
1086 out += 2;
1087 aux[0] = mulAdd(a, va, aux[0]);
1088 aux++;
1089 } while (--frameCount);
1090 } else {
1091 do {
1092 int16_t l = (int16_t)(*temp++ >> 12);
1093 int16_t r = (int16_t)(*temp++ >> 12);
1094 out[0] = mulAdd(l, vl, out[0]);
1095 out[1] = mulAdd(r, vr, out[1]);
1096 out += 2;
1097 } while (--frameCount);
1098 }
1099}
1100
Andy Hungee931ff2014-01-28 13:44:14 -08001101void AudioMixer::track__16BitsStereo(track_t* t, int32_t* out, size_t frameCount,
1102 int32_t* temp __unused, int32_t* aux)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001103{
Andy Hung296b7412014-06-17 15:25:47 -07001104 ALOGVV("track__16BitsStereo\n");
Glenn Kasten54c3b662012-01-06 07:46:30 -08001105 const int16_t *in = static_cast<const int16_t *>(t->in);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001106
Glenn Kastenf6b16782011-12-15 09:51:17 -08001107 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001108 int32_t l;
1109 int32_t r;
1110 // ramp gain
Glenn Kastenf6b16782011-12-15 09:51:17 -08001111 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1]|t->auxInc)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001112 int32_t vl = t->prevVolume[0];
1113 int32_t vr = t->prevVolume[1];
1114 int32_t va = t->prevAuxLevel;
1115 const int32_t vlInc = t->volumeInc[0];
1116 const int32_t vrInc = t->volumeInc[1];
1117 const int32_t vaInc = t->auxInc;
Steve Blockb8a80522011-12-20 16:23:08 +00001118 // ALOGD("[1] %p: inc=%f, v0=%f, v1=%d, final=%f, count=%d",
Mathias Agopian65ab4712010-07-14 17:59:35 -07001119 // t, vlInc/65536.0f, vl/65536.0f, t->volume[0],
1120 // (vl + vlInc*frameCount)/65536.0f, frameCount);
1121
1122 do {
1123 l = (int32_t)*in++;
1124 r = (int32_t)*in++;
1125 *out++ += (vl >> 16) * l;
1126 *out++ += (vr >> 16) * r;
1127 *aux++ += (va >> 17) * (l + r);
1128 vl += vlInc;
1129 vr += vrInc;
1130 va += vaInc;
1131 } while (--frameCount);
1132
1133 t->prevVolume[0] = vl;
1134 t->prevVolume[1] = vr;
1135 t->prevAuxLevel = va;
1136 t->adjustVolumeRamp(true);
1137 }
1138
1139 // constant gain
1140 else {
1141 const uint32_t vrl = t->volumeRL;
1142 const int16_t va = (int16_t)t->auxLevel;
1143 do {
Glenn Kasten54c3b662012-01-06 07:46:30 -08001144 uint32_t rl = *reinterpret_cast<const uint32_t *>(in);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001145 int16_t a = (int16_t)(((int32_t)in[0] + in[1]) >> 1);
1146 in += 2;
1147 out[0] = mulAddRL(1, rl, vrl, out[0]);
1148 out[1] = mulAddRL(0, rl, vrl, out[1]);
1149 out += 2;
1150 aux[0] = mulAdd(a, va, aux[0]);
1151 aux++;
1152 } while (--frameCount);
1153 }
1154 } else {
1155 // ramp gain
Glenn Kastenf6b16782011-12-15 09:51:17 -08001156 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1])) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001157 int32_t vl = t->prevVolume[0];
1158 int32_t vr = t->prevVolume[1];
1159 const int32_t vlInc = t->volumeInc[0];
1160 const int32_t vrInc = t->volumeInc[1];
1161
Steve Blockb8a80522011-12-20 16:23:08 +00001162 // ALOGD("[1] %p: inc=%f, v0=%f, v1=%d, final=%f, count=%d",
Mathias Agopian65ab4712010-07-14 17:59:35 -07001163 // t, vlInc/65536.0f, vl/65536.0f, t->volume[0],
1164 // (vl + vlInc*frameCount)/65536.0f, frameCount);
1165
1166 do {
1167 *out++ += (vl >> 16) * (int32_t) *in++;
1168 *out++ += (vr >> 16) * (int32_t) *in++;
1169 vl += vlInc;
1170 vr += vrInc;
1171 } while (--frameCount);
1172
1173 t->prevVolume[0] = vl;
1174 t->prevVolume[1] = vr;
1175 t->adjustVolumeRamp(false);
1176 }
1177
1178 // constant gain
1179 else {
1180 const uint32_t vrl = t->volumeRL;
1181 do {
Glenn Kasten54c3b662012-01-06 07:46:30 -08001182 uint32_t rl = *reinterpret_cast<const uint32_t *>(in);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001183 in += 2;
1184 out[0] = mulAddRL(1, rl, vrl, out[0]);
1185 out[1] = mulAddRL(0, rl, vrl, out[1]);
1186 out += 2;
1187 } while (--frameCount);
1188 }
1189 }
1190 t->in = in;
1191}
1192
Andy Hungee931ff2014-01-28 13:44:14 -08001193void AudioMixer::track__16BitsMono(track_t* t, int32_t* out, size_t frameCount,
1194 int32_t* temp __unused, int32_t* aux)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001195{
Andy Hung296b7412014-06-17 15:25:47 -07001196 ALOGVV("track__16BitsMono\n");
Glenn Kasten54c3b662012-01-06 07:46:30 -08001197 const int16_t *in = static_cast<int16_t const *>(t->in);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001198
Glenn Kastenf6b16782011-12-15 09:51:17 -08001199 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001200 // ramp gain
Glenn Kastenf6b16782011-12-15 09:51:17 -08001201 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1]|t->auxInc)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001202 int32_t vl = t->prevVolume[0];
1203 int32_t vr = t->prevVolume[1];
1204 int32_t va = t->prevAuxLevel;
1205 const int32_t vlInc = t->volumeInc[0];
1206 const int32_t vrInc = t->volumeInc[1];
1207 const int32_t vaInc = t->auxInc;
1208
Steve Blockb8a80522011-12-20 16:23:08 +00001209 // ALOGD("[2] %p: inc=%f, v0=%f, v1=%d, final=%f, count=%d",
Mathias Agopian65ab4712010-07-14 17:59:35 -07001210 // t, vlInc/65536.0f, vl/65536.0f, t->volume[0],
1211 // (vl + vlInc*frameCount)/65536.0f, frameCount);
1212
1213 do {
1214 int32_t l = *in++;
1215 *out++ += (vl >> 16) * l;
1216 *out++ += (vr >> 16) * l;
1217 *aux++ += (va >> 16) * l;
1218 vl += vlInc;
1219 vr += vrInc;
1220 va += vaInc;
1221 } while (--frameCount);
1222
1223 t->prevVolume[0] = vl;
1224 t->prevVolume[1] = vr;
1225 t->prevAuxLevel = va;
1226 t->adjustVolumeRamp(true);
1227 }
1228 // constant gain
1229 else {
1230 const int16_t vl = t->volume[0];
1231 const int16_t vr = t->volume[1];
1232 const int16_t va = (int16_t)t->auxLevel;
1233 do {
1234 int16_t l = *in++;
1235 out[0] = mulAdd(l, vl, out[0]);
1236 out[1] = mulAdd(l, vr, out[1]);
1237 out += 2;
1238 aux[0] = mulAdd(l, va, aux[0]);
1239 aux++;
1240 } while (--frameCount);
1241 }
1242 } else {
1243 // ramp gain
Glenn Kastenf6b16782011-12-15 09:51:17 -08001244 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1])) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001245 int32_t vl = t->prevVolume[0];
1246 int32_t vr = t->prevVolume[1];
1247 const int32_t vlInc = t->volumeInc[0];
1248 const int32_t vrInc = t->volumeInc[1];
1249
Steve Blockb8a80522011-12-20 16:23:08 +00001250 // ALOGD("[2] %p: inc=%f, v0=%f, v1=%d, final=%f, count=%d",
Mathias Agopian65ab4712010-07-14 17:59:35 -07001251 // t, vlInc/65536.0f, vl/65536.0f, t->volume[0],
1252 // (vl + vlInc*frameCount)/65536.0f, frameCount);
1253
1254 do {
1255 int32_t l = *in++;
1256 *out++ += (vl >> 16) * l;
1257 *out++ += (vr >> 16) * l;
1258 vl += vlInc;
1259 vr += vrInc;
1260 } while (--frameCount);
1261
1262 t->prevVolume[0] = vl;
1263 t->prevVolume[1] = vr;
1264 t->adjustVolumeRamp(false);
1265 }
1266 // constant gain
1267 else {
1268 const int16_t vl = t->volume[0];
1269 const int16_t vr = t->volume[1];
1270 do {
1271 int16_t l = *in++;
1272 out[0] = mulAdd(l, vl, out[0]);
1273 out[1] = mulAdd(l, vr, out[1]);
1274 out += 2;
1275 } while (--frameCount);
1276 }
1277 }
1278 t->in = in;
1279}
1280
Mathias Agopian65ab4712010-07-14 17:59:35 -07001281// no-op case
John Grossman4ff14ba2012-02-08 16:37:41 -08001282void AudioMixer::process__nop(state_t* state, int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001283{
Andy Hung296b7412014-06-17 15:25:47 -07001284 ALOGVV("process__nop\n");
Mathias Agopian65ab4712010-07-14 17:59:35 -07001285 uint32_t e0 = state->enabledTracks;
Andy Hunga1ab7cc2014-02-24 19:26:52 -08001286 size_t sampleCount = state->frameCount * MAX_NUM_CHANNELS;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001287 while (e0) {
1288 // process by group of tracks with same output buffer to
1289 // avoid multiple memset() on same buffer
1290 uint32_t e1 = e0, e2 = e0;
1291 int i = 31 - __builtin_clz(e1);
Glenn Kastenfc900c92013-02-18 12:47:49 -08001292 {
1293 track_t& t1 = state->tracks[i];
Mathias Agopian65ab4712010-07-14 17:59:35 -07001294 e2 &= ~(1<<i);
Glenn Kastenfc900c92013-02-18 12:47:49 -08001295 while (e2) {
1296 i = 31 - __builtin_clz(e2);
1297 e2 &= ~(1<<i);
1298 track_t& t2 = state->tracks[i];
1299 if (CC_UNLIKELY(t2.mainBuffer != t1.mainBuffer)) {
1300 e1 &= ~(1<<i);
1301 }
Mathias Agopian65ab4712010-07-14 17:59:35 -07001302 }
Glenn Kastenfc900c92013-02-18 12:47:49 -08001303 e0 &= ~(e1);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001304
Andy Hunga1ab7cc2014-02-24 19:26:52 -08001305 memset(t1.mainBuffer, 0, sampleCount
Andy Hung78820702014-02-28 16:23:02 -08001306 * audio_bytes_per_sample(t1.mMixerFormat));
Glenn Kastenfc900c92013-02-18 12:47:49 -08001307 }
Mathias Agopian65ab4712010-07-14 17:59:35 -07001308
1309 while (e1) {
1310 i = 31 - __builtin_clz(e1);
1311 e1 &= ~(1<<i);
Glenn Kastenfc900c92013-02-18 12:47:49 -08001312 {
1313 track_t& t3 = state->tracks[i];
1314 size_t outFrames = state->frameCount;
1315 while (outFrames) {
1316 t3.buffer.frameCount = outFrames;
1317 int64_t outputPTS = calculateOutputPTS(
1318 t3, pts, state->frameCount - outFrames);
1319 t3.bufferProvider->getNextBuffer(&t3.buffer, outputPTS);
1320 if (t3.buffer.raw == NULL) break;
1321 outFrames -= t3.buffer.frameCount;
1322 t3.bufferProvider->releaseBuffer(&t3.buffer);
1323 }
Mathias Agopian65ab4712010-07-14 17:59:35 -07001324 }
1325 }
1326 }
1327}
1328
1329// generic code without resampling
John Grossman4ff14ba2012-02-08 16:37:41 -08001330void AudioMixer::process__genericNoResampling(state_t* state, int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001331{
Andy Hung296b7412014-06-17 15:25:47 -07001332 ALOGVV("process__genericNoResampling\n");
Mathias Agopian65ab4712010-07-14 17:59:35 -07001333 int32_t outTemp[BLOCKSIZE * MAX_NUM_CHANNELS] __attribute__((aligned(32)));
1334
1335 // acquire each track's buffer
1336 uint32_t enabledTracks = state->enabledTracks;
1337 uint32_t e0 = enabledTracks;
1338 while (e0) {
1339 const int i = 31 - __builtin_clz(e0);
1340 e0 &= ~(1<<i);
1341 track_t& t = state->tracks[i];
1342 t.buffer.frameCount = state->frameCount;
John Grossman4ff14ba2012-02-08 16:37:41 -08001343 t.bufferProvider->getNextBuffer(&t.buffer, pts);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001344 t.frameCount = t.buffer.frameCount;
1345 t.in = t.buffer.raw;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001346 }
1347
1348 e0 = enabledTracks;
1349 while (e0) {
1350 // process by group of tracks with same output buffer to
1351 // optimize cache use
1352 uint32_t e1 = e0, e2 = e0;
1353 int j = 31 - __builtin_clz(e1);
1354 track_t& t1 = state->tracks[j];
1355 e2 &= ~(1<<j);
1356 while (e2) {
1357 j = 31 - __builtin_clz(e2);
1358 e2 &= ~(1<<j);
1359 track_t& t2 = state->tracks[j];
Glenn Kastenf6b16782011-12-15 09:51:17 -08001360 if (CC_UNLIKELY(t2.mainBuffer != t1.mainBuffer)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001361 e1 &= ~(1<<j);
1362 }
1363 }
1364 e0 &= ~(e1);
1365 // this assumes output 16 bits stereo, no resampling
1366 int32_t *out = t1.mainBuffer;
1367 size_t numFrames = 0;
1368 do {
1369 memset(outTemp, 0, sizeof(outTemp));
1370 e2 = e1;
1371 while (e2) {
1372 const int i = 31 - __builtin_clz(e2);
1373 e2 &= ~(1<<i);
1374 track_t& t = state->tracks[i];
1375 size_t outFrames = BLOCKSIZE;
1376 int32_t *aux = NULL;
Glenn Kastend6fadf02013-10-30 14:37:29 -07001377 if (CC_UNLIKELY(t.needs & NEEDS_AUX)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001378 aux = t.auxBuffer + numFrames;
1379 }
1380 while (outFrames) {
Gaurav Kumar7e79cd22014-01-06 10:57:18 +05301381 // t.in == NULL can happen if the track was flushed just after having
1382 // been enabled for mixing.
1383 if (t.in == NULL) {
1384 enabledTracks &= ~(1<<i);
1385 e1 &= ~(1<<i);
1386 break;
1387 }
Mathias Agopian65ab4712010-07-14 17:59:35 -07001388 size_t inFrames = (t.frameCount > outFrames)?outFrames:t.frameCount;
Glenn Kasten34fca342013-08-13 09:48:14 -07001389 if (inFrames > 0) {
Glenn Kasten85ab62c2012-11-01 11:11:38 -07001390 t.hook(&t, outTemp + (BLOCKSIZE-outFrames)*MAX_NUM_CHANNELS, inFrames,
1391 state->resampleTemp, aux);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001392 t.frameCount -= inFrames;
1393 outFrames -= inFrames;
Glenn Kastenf6b16782011-12-15 09:51:17 -08001394 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001395 aux += inFrames;
1396 }
1397 }
1398 if (t.frameCount == 0 && outFrames) {
1399 t.bufferProvider->releaseBuffer(&t.buffer);
Glenn Kasten85ab62c2012-11-01 11:11:38 -07001400 t.buffer.frameCount = (state->frameCount - numFrames) -
1401 (BLOCKSIZE - outFrames);
John Grossman4ff14ba2012-02-08 16:37:41 -08001402 int64_t outputPTS = calculateOutputPTS(
1403 t, pts, numFrames + (BLOCKSIZE - outFrames));
1404 t.bufferProvider->getNextBuffer(&t.buffer, outputPTS);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001405 t.in = t.buffer.raw;
1406 if (t.in == NULL) {
1407 enabledTracks &= ~(1<<i);
1408 e1 &= ~(1<<i);
1409 break;
1410 }
1411 t.frameCount = t.buffer.frameCount;
1412 }
1413 }
1414 }
Andy Hung296b7412014-06-17 15:25:47 -07001415
1416 convertMixerFormat(out, t1.mMixerFormat, outTemp, t1.mMixerInFormat,
1417 BLOCKSIZE * FCC_2);
1418 // TODO: fix ugly casting due to choice of out pointer type
1419 out = reinterpret_cast<int32_t*>((uint8_t*)out
1420 + BLOCKSIZE * FCC_2 * audio_bytes_per_sample(t1.mMixerFormat));
Mathias Agopian65ab4712010-07-14 17:59:35 -07001421 numFrames += BLOCKSIZE;
1422 } while (numFrames < state->frameCount);
1423 }
1424
1425 // release each track's buffer
1426 e0 = enabledTracks;
1427 while (e0) {
1428 const int i = 31 - __builtin_clz(e0);
1429 e0 &= ~(1<<i);
1430 track_t& t = state->tracks[i];
1431 t.bufferProvider->releaseBuffer(&t.buffer);
1432 }
1433}
1434
1435
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -08001436// generic code with resampling
John Grossman4ff14ba2012-02-08 16:37:41 -08001437void AudioMixer::process__genericResampling(state_t* state, int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001438{
Andy Hung296b7412014-06-17 15:25:47 -07001439 ALOGVV("process__genericResampling\n");
Glenn Kasten54c3b662012-01-06 07:46:30 -08001440 // this const just means that local variable outTemp doesn't change
Mathias Agopian65ab4712010-07-14 17:59:35 -07001441 int32_t* const outTemp = state->outputTemp;
1442 const size_t size = sizeof(int32_t) * MAX_NUM_CHANNELS * state->frameCount;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001443
1444 size_t numFrames = state->frameCount;
1445
1446 uint32_t e0 = state->enabledTracks;
1447 while (e0) {
1448 // process by group of tracks with same output buffer
1449 // to optimize cache use
1450 uint32_t e1 = e0, e2 = e0;
1451 int j = 31 - __builtin_clz(e1);
1452 track_t& t1 = state->tracks[j];
1453 e2 &= ~(1<<j);
1454 while (e2) {
1455 j = 31 - __builtin_clz(e2);
1456 e2 &= ~(1<<j);
1457 track_t& t2 = state->tracks[j];
Glenn Kastenf6b16782011-12-15 09:51:17 -08001458 if (CC_UNLIKELY(t2.mainBuffer != t1.mainBuffer)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001459 e1 &= ~(1<<j);
1460 }
1461 }
1462 e0 &= ~(e1);
1463 int32_t *out = t1.mainBuffer;
Yuuhi Yamaguchi2151d7b2011-02-04 15:24:34 +01001464 memset(outTemp, 0, size);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001465 while (e1) {
1466 const int i = 31 - __builtin_clz(e1);
1467 e1 &= ~(1<<i);
1468 track_t& t = state->tracks[i];
1469 int32_t *aux = NULL;
Glenn Kastend6fadf02013-10-30 14:37:29 -07001470 if (CC_UNLIKELY(t.needs & NEEDS_AUX)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001471 aux = t.auxBuffer;
1472 }
1473
1474 // this is a little goofy, on the resampling case we don't
1475 // acquire/release the buffers because it's done by
1476 // the resampler.
Glenn Kastend6fadf02013-10-30 14:37:29 -07001477 if (t.needs & NEEDS_RESAMPLE) {
John Grossman4ff14ba2012-02-08 16:37:41 -08001478 t.resampler->setPTS(pts);
Glenn Kastena1117922012-01-26 10:53:32 -08001479 t.hook(&t, outTemp, numFrames, state->resampleTemp, aux);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001480 } else {
1481
1482 size_t outFrames = 0;
1483
1484 while (outFrames < numFrames) {
1485 t.buffer.frameCount = numFrames - outFrames;
John Grossman4ff14ba2012-02-08 16:37:41 -08001486 int64_t outputPTS = calculateOutputPTS(t, pts, outFrames);
1487 t.bufferProvider->getNextBuffer(&t.buffer, outputPTS);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001488 t.in = t.buffer.raw;
1489 // t.in == NULL can happen if the track was flushed just after having
1490 // been enabled for mixing.
1491 if (t.in == NULL) break;
1492
Glenn Kastenf6b16782011-12-15 09:51:17 -08001493 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001494 aux += outFrames;
1495 }
Glenn Kasten85ab62c2012-11-01 11:11:38 -07001496 t.hook(&t, outTemp + outFrames*MAX_NUM_CHANNELS, t.buffer.frameCount,
1497 state->resampleTemp, aux);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001498 outFrames += t.buffer.frameCount;
1499 t.bufferProvider->releaseBuffer(&t.buffer);
1500 }
1501 }
1502 }
Andy Hung296b7412014-06-17 15:25:47 -07001503 convertMixerFormat(out, t1.mMixerFormat, outTemp, t1.mMixerInFormat, numFrames * FCC_2);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001504 }
1505}
1506
1507// one track, 16 bits stereo without resampling is the most common case
John Grossman4ff14ba2012-02-08 16:37:41 -08001508void AudioMixer::process__OneTrack16BitsStereoNoResampling(state_t* state,
1509 int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001510{
Andy Hung296b7412014-06-17 15:25:47 -07001511 ALOGVV("process__OneTrack16BitsStereoNoResampling\n");
Glenn Kasten99e53b82012-01-19 08:59:58 -08001512 // This method is only called when state->enabledTracks has exactly
1513 // one bit set. The asserts below would verify this, but are commented out
1514 // since the whole point of this method is to optimize performance.
Glenn Kasten5798d4e2012-03-08 12:18:35 -08001515 //ALOG_ASSERT(0 != state->enabledTracks, "no tracks enabled");
Mathias Agopian65ab4712010-07-14 17:59:35 -07001516 const int i = 31 - __builtin_clz(state->enabledTracks);
Glenn Kasten5798d4e2012-03-08 12:18:35 -08001517 //ALOG_ASSERT((1 << i) == state->enabledTracks, "more than 1 track enabled");
Mathias Agopian65ab4712010-07-14 17:59:35 -07001518 const track_t& t = state->tracks[i];
1519
1520 AudioBufferProvider::Buffer& b(t.buffer);
1521
1522 int32_t* out = t.mainBuffer;
Andy Hungf8a106a2014-05-29 18:52:38 -07001523 float *fout = reinterpret_cast<float*>(out);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001524 size_t numFrames = state->frameCount;
1525
1526 const int16_t vl = t.volume[0];
1527 const int16_t vr = t.volume[1];
1528 const uint32_t vrl = t.volumeRL;
1529 while (numFrames) {
1530 b.frameCount = numFrames;
John Grossman4ff14ba2012-02-08 16:37:41 -08001531 int64_t outputPTS = calculateOutputPTS(t, pts, out - t.mainBuffer);
1532 t.bufferProvider->getNextBuffer(&b, outputPTS);
Glenn Kasten54c3b662012-01-06 07:46:30 -08001533 const int16_t *in = b.i16;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001534
1535 // in == NULL can happen if the track was flushed just after having
1536 // been enabled for mixing.
Andy Hungf8a106a2014-05-29 18:52:38 -07001537 if (in == NULL || (((uintptr_t)in) & 3)) {
1538 memset(out, 0, numFrames
1539 * MAX_NUM_CHANNELS * audio_bytes_per_sample(t.mMixerFormat));
1540 ALOGE_IF((((uintptr_t)in) & 3), "process stereo track: input buffer alignment pb: "
Glenn Kasten85ab62c2012-11-01 11:11:38 -07001541 "buffer %p track %d, channels %d, needs %08x",
Mathias Agopian65ab4712010-07-14 17:59:35 -07001542 in, i, t.channelCount, t.needs);
1543 return;
1544 }
1545 size_t outFrames = b.frameCount;
1546
Andy Hung78820702014-02-28 16:23:02 -08001547 switch (t.mMixerFormat) {
Andy Hungf8a106a2014-05-29 18:52:38 -07001548 case AUDIO_FORMAT_PCM_FLOAT:
Mathias Agopian65ab4712010-07-14 17:59:35 -07001549 do {
Glenn Kasten54c3b662012-01-06 07:46:30 -08001550 uint32_t rl = *reinterpret_cast<const uint32_t *>(in);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001551 in += 2;
Andy Hunga1ab7cc2014-02-24 19:26:52 -08001552 int32_t l = mulRL(1, rl, vrl);
1553 int32_t r = mulRL(0, rl, vrl);
Andy Hung84a0c6e2014-04-02 11:24:53 -07001554 *fout++ = float_from_q4_27(l);
1555 *fout++ = float_from_q4_27(r);
Andy Hung3375bde2014-02-28 15:51:47 -08001556 // Note: In case of later int16_t sink output,
1557 // conversion and clamping is done by memcpy_to_i16_from_float().
Mathias Agopian65ab4712010-07-14 17:59:35 -07001558 } while (--outFrames);
Andy Hungf8a106a2014-05-29 18:52:38 -07001559 break;
Andy Hunga1ab7cc2014-02-24 19:26:52 -08001560 case AUDIO_FORMAT_PCM_16_BIT:
Andy Hung97ae8242014-05-30 10:35:47 -07001561 if (CC_UNLIKELY(uint32_t(vl) > UNITY_GAIN_INT || uint32_t(vr) > UNITY_GAIN_INT)) {
Andy Hunga1ab7cc2014-02-24 19:26:52 -08001562 // volume is boosted, so we might need to clamp even though
1563 // we process only one track.
1564 do {
1565 uint32_t rl = *reinterpret_cast<const uint32_t *>(in);
1566 in += 2;
1567 int32_t l = mulRL(1, rl, vrl) >> 12;
1568 int32_t r = mulRL(0, rl, vrl) >> 12;
1569 // clamping...
1570 l = clamp16(l);
1571 r = clamp16(r);
1572 *out++ = (r<<16) | (l & 0xFFFF);
1573 } while (--outFrames);
1574 } else {
1575 do {
1576 uint32_t rl = *reinterpret_cast<const uint32_t *>(in);
1577 in += 2;
1578 int32_t l = mulRL(1, rl, vrl) >> 12;
1579 int32_t r = mulRL(0, rl, vrl) >> 12;
1580 *out++ = (r<<16) | (l & 0xFFFF);
1581 } while (--outFrames);
1582 }
1583 break;
1584 default:
Andy Hung78820702014-02-28 16:23:02 -08001585 LOG_ALWAYS_FATAL("bad mixer format: %d", t.mMixerFormat);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001586 }
1587 numFrames -= b.frameCount;
1588 t.bufferProvider->releaseBuffer(&b);
1589 }
1590}
1591
Glenn Kasten81a028f2011-12-15 09:53:12 -08001592#if 0
Mathias Agopian65ab4712010-07-14 17:59:35 -07001593// 2 tracks is also a common case
1594// NEVER used in current implementation of process__validate()
1595// only use if the 2 tracks have the same output buffer
John Grossman4ff14ba2012-02-08 16:37:41 -08001596void AudioMixer::process__TwoTracks16BitsStereoNoResampling(state_t* state,
1597 int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001598{
1599 int i;
1600 uint32_t en = state->enabledTracks;
1601
1602 i = 31 - __builtin_clz(en);
1603 const track_t& t0 = state->tracks[i];
1604 AudioBufferProvider::Buffer& b0(t0.buffer);
1605
1606 en &= ~(1<<i);
1607 i = 31 - __builtin_clz(en);
1608 const track_t& t1 = state->tracks[i];
1609 AudioBufferProvider::Buffer& b1(t1.buffer);
1610
Glenn Kasten54c3b662012-01-06 07:46:30 -08001611 const int16_t *in0;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001612 const int16_t vl0 = t0.volume[0];
1613 const int16_t vr0 = t0.volume[1];
1614 size_t frameCount0 = 0;
1615
Glenn Kasten54c3b662012-01-06 07:46:30 -08001616 const int16_t *in1;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001617 const int16_t vl1 = t1.volume[0];
1618 const int16_t vr1 = t1.volume[1];
1619 size_t frameCount1 = 0;
1620
1621 //FIXME: only works if two tracks use same buffer
1622 int32_t* out = t0.mainBuffer;
1623 size_t numFrames = state->frameCount;
Glenn Kasten54c3b662012-01-06 07:46:30 -08001624 const int16_t *buff = NULL;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001625
1626
1627 while (numFrames) {
1628
1629 if (frameCount0 == 0) {
1630 b0.frameCount = numFrames;
John Grossman4ff14ba2012-02-08 16:37:41 -08001631 int64_t outputPTS = calculateOutputPTS(t0, pts,
1632 out - t0.mainBuffer);
1633 t0.bufferProvider->getNextBuffer(&b0, outputPTS);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001634 if (b0.i16 == NULL) {
1635 if (buff == NULL) {
1636 buff = new int16_t[MAX_NUM_CHANNELS * state->frameCount];
1637 }
1638 in0 = buff;
1639 b0.frameCount = numFrames;
1640 } else {
1641 in0 = b0.i16;
1642 }
1643 frameCount0 = b0.frameCount;
1644 }
1645 if (frameCount1 == 0) {
1646 b1.frameCount = numFrames;
John Grossman4ff14ba2012-02-08 16:37:41 -08001647 int64_t outputPTS = calculateOutputPTS(t1, pts,
1648 out - t0.mainBuffer);
1649 t1.bufferProvider->getNextBuffer(&b1, outputPTS);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001650 if (b1.i16 == NULL) {
1651 if (buff == NULL) {
1652 buff = new int16_t[MAX_NUM_CHANNELS * state->frameCount];
1653 }
1654 in1 = buff;
1655 b1.frameCount = numFrames;
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -08001656 } else {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001657 in1 = b1.i16;
1658 }
1659 frameCount1 = b1.frameCount;
1660 }
1661
1662 size_t outFrames = frameCount0 < frameCount1?frameCount0:frameCount1;
1663
1664 numFrames -= outFrames;
1665 frameCount0 -= outFrames;
1666 frameCount1 -= outFrames;
1667
1668 do {
1669 int32_t l0 = *in0++;
1670 int32_t r0 = *in0++;
1671 l0 = mul(l0, vl0);
1672 r0 = mul(r0, vr0);
1673 int32_t l = *in1++;
1674 int32_t r = *in1++;
1675 l = mulAdd(l, vl1, l0) >> 12;
1676 r = mulAdd(r, vr1, r0) >> 12;
1677 // clamping...
1678 l = clamp16(l);
1679 r = clamp16(r);
1680 *out++ = (r<<16) | (l & 0xFFFF);
1681 } while (--outFrames);
1682
1683 if (frameCount0 == 0) {
1684 t0.bufferProvider->releaseBuffer(&b0);
1685 }
1686 if (frameCount1 == 0) {
1687 t1.bufferProvider->releaseBuffer(&b1);
1688 }
1689 }
1690
Glenn Kastene9dd0172012-01-27 18:08:45 -08001691 delete [] buff;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001692}
Glenn Kasten81a028f2011-12-15 09:53:12 -08001693#endif
Mathias Agopian65ab4712010-07-14 17:59:35 -07001694
John Grossman4ff14ba2012-02-08 16:37:41 -08001695int64_t AudioMixer::calculateOutputPTS(const track_t& t, int64_t basePTS,
1696 int outputFrameIndex)
1697{
Glenn Kasten6e2ebe92013-08-13 09:14:51 -07001698 if (AudioBufferProvider::kInvalidPTS == basePTS) {
John Grossman4ff14ba2012-02-08 16:37:41 -08001699 return AudioBufferProvider::kInvalidPTS;
Glenn Kasten6e2ebe92013-08-13 09:14:51 -07001700 }
John Grossman4ff14ba2012-02-08 16:37:41 -08001701
Glenn Kasten52008f82012-03-18 09:34:41 -07001702 return basePTS + ((outputFrameIndex * sLocalTimeFreq) / t.sampleRate);
1703}
1704
1705/*static*/ uint64_t AudioMixer::sLocalTimeFreq;
1706/*static*/ pthread_once_t AudioMixer::sOnceControl = PTHREAD_ONCE_INIT;
1707
1708/*static*/ void AudioMixer::sInitRoutine()
1709{
1710 LocalClock lc;
1711 sLocalTimeFreq = lc.getLocalFreq();
Glenn Kasten49c34ac2013-10-30 14:37:01 -07001712
1713 // find multichannel downmix effect if we have to play multichannel content
1714 uint32_t numEffects = 0;
1715 int ret = EffectQueryNumberEffects(&numEffects);
1716 if (ret != 0) {
1717 ALOGE("AudioMixer() error %d querying number of effects", ret);
1718 return;
1719 }
1720 ALOGV("EffectQueryNumberEffects() numEffects=%d", numEffects);
1721
1722 for (uint32_t i = 0 ; i < numEffects ; i++) {
1723 if (EffectQueryEffect(i, &sDwnmFxDesc) == 0) {
1724 ALOGV("effect %d is called %s", i, sDwnmFxDesc.name);
1725 if (memcmp(&sDwnmFxDesc.type, EFFECT_UIID_DOWNMIX, sizeof(effect_uuid_t)) == 0) {
1726 ALOGI("found effect \"%s\" from %s",
1727 sDwnmFxDesc.name, sDwnmFxDesc.implementor);
1728 sIsMultichannelCapable = true;
1729 break;
1730 }
1731 }
1732 }
1733 ALOGW_IF(!sIsMultichannelCapable, "unable to find downmix effect");
John Grossman4ff14ba2012-02-08 16:37:41 -08001734}
1735
Andy Hung296b7412014-06-17 15:25:47 -07001736/* This process hook is called when there is a single track without
1737 * aux buffer, volume ramp, or resampling.
1738 * TODO: Update the hook selection: this can properly handle aux and ramp.
1739 */
1740template <int MIXTYPE, int NCHAN, typename TO, typename TI, typename TA>
1741void AudioMixer::process_NoResampleOneTrack(state_t* state, int64_t pts)
1742{
1743 ALOGVV("process_NoResampleOneTrack\n");
1744 // CLZ is faster than CTZ on ARM, though really not sure if true after 31 - clz.
1745 const int i = 31 - __builtin_clz(state->enabledTracks);
1746 ALOG_ASSERT((1 << i) == state->enabledTracks, "more than 1 track enabled");
1747 track_t *t = &state->tracks[i];
1748 TO* out = reinterpret_cast<TO*>(t->mainBuffer);
1749 TA* aux = reinterpret_cast<TA*>(t->auxBuffer);
1750 const bool ramp = t->needsRamp();
1751
1752 for (size_t numFrames = state->frameCount; numFrames; ) {
1753 AudioBufferProvider::Buffer& b(t->buffer);
1754 // get input buffer
1755 b.frameCount = numFrames;
1756 const int64_t outputPTS = calculateOutputPTS(*t, pts, state->frameCount - numFrames);
1757 t->bufferProvider->getNextBuffer(&b, outputPTS);
1758 const TI *in = reinterpret_cast<TI*>(b.raw);
1759
1760 // in == NULL can happen if the track was flushed just after having
1761 // been enabled for mixing.
1762 if (in == NULL || (((uintptr_t)in) & 3)) {
1763 memset(out, 0, numFrames
1764 * NCHAN * audio_bytes_per_sample(t->mMixerFormat));
1765 ALOGE_IF((((uintptr_t)in) & 3), "process_NoResampleOneTrack: bus error: "
1766 "buffer %p track %p, channels %d, needs %#x",
1767 in, t, t->channelCount, t->needs);
1768 return;
1769 }
1770
1771 const size_t outFrames = b.frameCount;
1772 if (ramp) {
1773 volumeRampMulti<MIXTYPE_MULTI_SAVEONLY, NCHAN>(out, outFrames, in, aux,
1774 t->prevVolume, t->volumeInc, &t->prevAuxLevel, t->auxInc);
1775 } else {
1776 volumeMulti<MIXTYPE_MULTI_SAVEONLY, NCHAN>(out, outFrames, in, aux,
1777 t->volume, t->auxLevel);
1778 }
1779 out += outFrames * NCHAN;
1780 if (aux != NULL) {
1781 aux += NCHAN;
1782 }
1783 numFrames -= b.frameCount;
1784
1785 // release buffer
1786 t->bufferProvider->releaseBuffer(&b);
1787 }
1788 if (ramp) {
1789 t->adjustVolumeRamp(aux != NULL);
1790 }
1791}
1792
1793/* This track hook is called to do resampling then mixing,
1794 * pulling from the track's upstream AudioBufferProvider.
1795 */
1796template <int MIXTYPE, int NCHAN, typename TO, typename TI, typename TA>
1797void AudioMixer::track__Resample(track_t* t, TO* out, size_t outFrameCount, TO* temp, TA* aux)
1798{
1799 ALOGVV("track__Resample\n");
1800 t->resampler->setSampleRate(t->sampleRate);
1801
1802 const bool ramp = t->needsRamp();
1803 if (ramp || aux != NULL) {
1804 // if ramp: resample with unity gain to temp buffer and scale/mix in 2nd step.
1805 // if aux != NULL: resample with unity gain to temp buffer then apply send level.
1806
1807 t->resampler->setVolume(UNITY_GAIN_INT, UNITY_GAIN_INT);
1808 memset(temp, 0, outFrameCount * NCHAN * sizeof(TO));
1809 t->resampler->resample((int32_t*)temp, outFrameCount, t->bufferProvider);
1810 if (ramp) {
1811 volumeRampMulti<MIXTYPE_MULTI, NCHAN>(out, outFrameCount, temp, aux,
1812 t->prevVolume, t->volumeInc, &t->prevAuxLevel, t->auxInc);
1813 t->adjustVolumeRamp(aux != NULL);
1814 } else {
1815 volumeMulti<MIXTYPE_MULTI, NCHAN>(out, outFrameCount, temp, aux,
1816 t->volume, t->auxLevel);
1817 }
1818 } else { // constant volume gain
1819 t->resampler->setVolume(t->volume[0], t->volume[1]);
1820 t->resampler->resample((int32_t*)out, outFrameCount, t->bufferProvider);
1821 }
1822}
1823
1824/* This track hook is called to mix a track, when no resampling is required.
1825 * The input buffer should be present in t->in.
1826 */
1827template <int MIXTYPE, int NCHAN, typename TO, typename TI, typename TA>
1828void AudioMixer::track__NoResample(track_t* t, TO* out, size_t frameCount,
1829 TO* temp __unused, TA* aux)
1830{
1831 ALOGVV("track__NoResample\n");
1832 const TI *in = static_cast<const TI *>(t->in);
1833
1834 if (t->needsRamp()) {
1835 volumeRampMulti<MIXTYPE, NCHAN>(out, frameCount, in, aux,
1836 t->prevVolume, t->volumeInc, &t->prevAuxLevel, t->auxInc);
1837 t->adjustVolumeRamp(aux != NULL);
1838 } else {
1839 volumeMulti<MIXTYPE, NCHAN>(out, frameCount, in, aux, t->volume, t->auxLevel);
1840 }
1841 // MIXTYPE_MONOEXPAND reads a single input channel and expands to NCHAN output channels.
1842 // MIXTYPE_MULTI reads NCHAN input channels and places to NCHAN output channels.
1843 in += (MIXTYPE == MIXTYPE_MONOEXPAND) ? frameCount : frameCount * NCHAN;
1844 t->in = in;
1845}
1846
1847/* The Mixer engine generates either int32_t (Q4_27) or float data.
1848 * We use this function to convert the engine buffers
1849 * to the desired mixer output format, either int16_t (Q.15) or float.
1850 */
1851void AudioMixer::convertMixerFormat(void *out, audio_format_t mixerOutFormat,
1852 void *in, audio_format_t mixerInFormat, size_t sampleCount)
1853{
1854 switch (mixerInFormat) {
1855 case AUDIO_FORMAT_PCM_FLOAT:
1856 switch (mixerOutFormat) {
1857 case AUDIO_FORMAT_PCM_FLOAT:
1858 memcpy(out, in, sampleCount * sizeof(float)); // MEMCPY. TODO optimize out
1859 break;
1860 case AUDIO_FORMAT_PCM_16_BIT:
1861 memcpy_to_i16_from_float((int16_t*)out, (float*)in, sampleCount);
1862 break;
1863 default:
1864 LOG_ALWAYS_FATAL("bad mixerOutFormat: %#x", mixerOutFormat);
1865 break;
1866 }
1867 break;
1868 case AUDIO_FORMAT_PCM_16_BIT:
1869 switch (mixerOutFormat) {
1870 case AUDIO_FORMAT_PCM_FLOAT:
1871 memcpy_to_float_from_q4_27((float*)out, (int32_t*)in, sampleCount);
1872 break;
1873 case AUDIO_FORMAT_PCM_16_BIT:
1874 // two int16_t are produced per iteration
1875 ditherAndClamp((int32_t*)out, (int32_t*)in, sampleCount >> 1);
1876 break;
1877 default:
1878 LOG_ALWAYS_FATAL("bad mixerOutFormat: %#x", mixerOutFormat);
1879 break;
1880 }
1881 break;
1882 default:
1883 LOG_ALWAYS_FATAL("bad mixerInFormat: %#x", mixerInFormat);
1884 break;
1885 }
1886}
1887
1888/* Returns the proper track hook to use for mixing the track into the output buffer.
1889 */
1890AudioMixer::hook_t AudioMixer::getTrackHook(int trackType, int channels,
1891 audio_format_t mixerInFormat, audio_format_t mixerOutFormat __unused)
1892{
1893 if (!kUseNewMixer && channels == FCC_2 && mixerInFormat == AUDIO_FORMAT_PCM_16_BIT) {
1894 switch (trackType) {
1895 case TRACKTYPE_NOP:
1896 return track__nop;
1897 case TRACKTYPE_RESAMPLE:
1898 return track__genericResample;
1899 case TRACKTYPE_NORESAMPLEMONO:
1900 return track__16BitsMono;
1901 case TRACKTYPE_NORESAMPLE:
1902 return track__16BitsStereo;
1903 default:
1904 LOG_ALWAYS_FATAL("bad trackType: %d", trackType);
1905 break;
1906 }
1907 }
1908 LOG_ALWAYS_FATAL_IF(channels != FCC_2); // TODO: must be stereo right now
1909 switch (trackType) {
1910 case TRACKTYPE_NOP:
1911 return track__nop;
1912 case TRACKTYPE_RESAMPLE:
1913 switch (mixerInFormat) {
1914 case AUDIO_FORMAT_PCM_FLOAT:
1915 return (AudioMixer::hook_t)
1916 track__Resample<MIXTYPE_MULTI, 2, float, float, int32_t>;
1917 case AUDIO_FORMAT_PCM_16_BIT:
1918 return (AudioMixer::hook_t)\
1919 track__Resample<MIXTYPE_MULTI, 2, int32_t, int16_t, int32_t>;
1920 default:
1921 LOG_ALWAYS_FATAL("bad mixerInFormat: %#x", mixerInFormat);
1922 break;
1923 }
1924 break;
1925 case TRACKTYPE_NORESAMPLEMONO:
1926 switch (mixerInFormat) {
1927 case AUDIO_FORMAT_PCM_FLOAT:
1928 return (AudioMixer::hook_t)
1929 track__NoResample<MIXTYPE_MONOEXPAND, 2, float, float, int32_t>;
1930 case AUDIO_FORMAT_PCM_16_BIT:
1931 return (AudioMixer::hook_t)
1932 track__NoResample<MIXTYPE_MONOEXPAND, 2, int32_t, int16_t, int32_t>;
1933 default:
1934 LOG_ALWAYS_FATAL("bad mixerInFormat: %#x", mixerInFormat);
1935 break;
1936 }
1937 break;
1938 case TRACKTYPE_NORESAMPLE:
1939 switch (mixerInFormat) {
1940 case AUDIO_FORMAT_PCM_FLOAT:
1941 return (AudioMixer::hook_t)
1942 track__NoResample<MIXTYPE_MULTI, 2, float, float, int32_t>;
1943 case AUDIO_FORMAT_PCM_16_BIT:
1944 return (AudioMixer::hook_t)
1945 track__NoResample<MIXTYPE_MULTI, 2, int32_t, int16_t, int32_t>;
1946 default:
1947 LOG_ALWAYS_FATAL("bad mixerInFormat: %#x", mixerInFormat);
1948 break;
1949 }
1950 break;
1951 default:
1952 LOG_ALWAYS_FATAL("bad trackType: %d", trackType);
1953 break;
1954 }
1955 return NULL;
1956}
1957
1958/* Returns the proper process hook for mixing tracks. Currently works only for
1959 * PROCESSTYPE_NORESAMPLEONETRACK, a mix involving one track, no resampling.
1960 */
1961AudioMixer::process_hook_t AudioMixer::getProcessHook(int processType, int channels,
1962 audio_format_t mixerInFormat, audio_format_t mixerOutFormat)
1963{
1964 if (processType != PROCESSTYPE_NORESAMPLEONETRACK) { // Only NORESAMPLEONETRACK
1965 LOG_ALWAYS_FATAL("bad processType: %d", processType);
1966 return NULL;
1967 }
1968 if (!kUseNewMixer && channels == FCC_2 && mixerInFormat == AUDIO_FORMAT_PCM_16_BIT) {
1969 return process__OneTrack16BitsStereoNoResampling;
1970 }
1971 LOG_ALWAYS_FATAL_IF(channels != FCC_2); // TODO: must be stereo right now
1972 switch (mixerInFormat) {
1973 case AUDIO_FORMAT_PCM_FLOAT:
1974 switch (mixerOutFormat) {
1975 case AUDIO_FORMAT_PCM_FLOAT:
1976 return process_NoResampleOneTrack<MIXTYPE_MULTI_SAVEONLY, 2,
1977 float, float, int32_t>;
1978 case AUDIO_FORMAT_PCM_16_BIT:
1979 return process_NoResampleOneTrack<MIXTYPE_MULTI_SAVEONLY, 2,
1980 int16_t, float, int32_t>;
1981 default:
1982 LOG_ALWAYS_FATAL("bad mixerOutFormat: %#x", mixerOutFormat);
1983 break;
1984 }
1985 break;
1986 case AUDIO_FORMAT_PCM_16_BIT:
1987 switch (mixerOutFormat) {
1988 case AUDIO_FORMAT_PCM_FLOAT:
1989 return process_NoResampleOneTrack<MIXTYPE_MULTI_SAVEONLY, 2,
1990 float, int16_t, int32_t>;
1991 case AUDIO_FORMAT_PCM_16_BIT:
1992 return process_NoResampleOneTrack<MIXTYPE_MULTI_SAVEONLY, 2,
1993 int16_t, int16_t, int32_t>;
1994 default:
1995 LOG_ALWAYS_FATAL("bad mixerOutFormat: %#x", mixerOutFormat);
1996 break;
1997 }
1998 break;
1999 default:
2000 LOG_ALWAYS_FATAL("bad mixerInFormat: %#x", mixerInFormat);
2001 break;
2002 }
2003 return NULL;
2004}
2005
Mathias Agopian65ab4712010-07-14 17:59:35 -07002006// ----------------------------------------------------------------------------
2007}; // namespace android