blob: d84cf63a1551cfba1d69791f3e7f07ccf3134f58 [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>
Andy Hung5e58b0a2014-06-23 19:07:29 -070025#include <math.h>
Mathias Agopian65ab4712010-07-14 17:59:35 -070026#include <sys/types.h>
27
28#include <utils/Errors.h>
29#include <utils/Log.h>
30
Jean-Michel Trivi0d255b22011-05-24 15:53:33 -070031#include <cutils/bitops.h>
Glenn Kastenf6b16782011-12-15 09:51:17 -080032#include <cutils/compiler.h>
Glenn Kasten5798d4e2012-03-08 12:18:35 -080033#include <utils/Debug.h>
Jean-Michel Trivi0d255b22011-05-24 15:53:33 -070034
35#include <system/audio.h>
36
Glenn Kasten3b21c502011-12-15 09:52:39 -080037#include <audio_utils/primitives.h>
Andy Hungef7c7fb2014-05-12 16:51:41 -070038#include <audio_utils/format.h>
John Grossman4ff14ba2012-02-08 16:37:41 -080039#include <common_time/local_clock.h>
40#include <common_time/cc_helper.h>
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -070041
Andy Hung296b7412014-06-17 15:25:47 -070042#include "AudioMixerOps.h"
Mathias Agopian65ab4712010-07-14 17:59:35 -070043#include "AudioMixer.h"
44
Andy Hunge93b6b72014-07-17 21:30:53 -070045// The FCC_2 macro refers to the Fixed Channel Count of 2 for the legacy integer mixer.
Andy Hung296b7412014-06-17 15:25:47 -070046#ifndef FCC_2
47#define FCC_2 2
48#endif
49
Andy Hunge93b6b72014-07-17 21:30:53 -070050// Look for MONO_HACK for any Mono hack involving legacy mono channel to
51// stereo channel conversion.
52
Andy Hung296b7412014-06-17 15:25:47 -070053/* VERY_VERY_VERBOSE_LOGGING will show exactly which process hook and track hook is
54 * being used. This is a considerable amount of log spam, so don't enable unless you
55 * are verifying the hook based code.
56 */
57//#define VERY_VERY_VERBOSE_LOGGING
58#ifdef VERY_VERY_VERBOSE_LOGGING
59#define ALOGVV ALOGV
60//define ALOGVV printf // for test-mixer.cpp
61#else
62#define ALOGVV(a...) do { } while (0)
63#endif
64
Andy Hunga08810b2014-07-16 21:53:43 -070065#ifndef ARRAY_SIZE
66#define ARRAY_SIZE(x) (sizeof(x)/sizeof((x)[0]))
67#endif
68
Andy Hunge09c9942015-05-08 16:58:13 -070069// TODO: Move these macro/inlines to a header file.
70template <typename T>
71static inline
72T max(const T& x, const T& y) {
73 return x > y ? x : y;
74}
75
Andy Hung5b8fde72014-09-02 21:14:34 -070076// Set kUseNewMixer to true to use the new mixer engine always. Otherwise the
77// original code will be used for stereo sinks, the new mixer for multichannel.
78static const bool kUseNewMixer = true;
Andy Hung296b7412014-06-17 15:25:47 -070079
80// Set kUseFloat to true to allow floating input into the mixer engine.
81// If kUseNewMixer is false, this is ignored or may be overridden internally
82// because of downmix/upmix support.
83static const bool kUseFloat = true;
84
Andy Hung1b2fdcb2014-07-16 17:44:34 -070085// Set to default copy buffer size in frames for input processing.
86static const size_t kCopyBufferFrameCount = 256;
87
Mathias Agopian65ab4712010-07-14 17:59:35 -070088namespace android {
Mathias Agopian65ab4712010-07-14 17:59:35 -070089
90// ----------------------------------------------------------------------------
Andy Hung1b2fdcb2014-07-16 17:44:34 -070091
92template <typename T>
93T min(const T& a, const T& b)
94{
95 return a < b ? a : b;
96}
97
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -070098// ----------------------------------------------------------------------------
Mathias Agopian65ab4712010-07-14 17:59:35 -070099
Paul Lind3c0a0e82012-08-01 18:49:49 -0700100// Ensure mConfiguredNames bitmask is initialized properly on all architectures.
101// The value of 1 << x is undefined in C when x >= 32.
102
Glenn Kasten5c94b6c2012-03-20 17:01:29 -0700103AudioMixer::AudioMixer(size_t frameCount, uint32_t sampleRate, uint32_t maxNumTracks)
Paul Lind3c0a0e82012-08-01 18:49:49 -0700104 : mTrackNames(0), mConfiguredNames((maxNumTracks >= 32 ? 0 : 1 << maxNumTracks) - 1),
Glenn Kasten7f5d3352013-02-15 23:55:04 +0000105 mSampleRate(sampleRate)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700106{
Glenn Kasten5c94b6c2012-03-20 17:01:29 -0700107 ALOG_ASSERT(maxNumTracks <= MAX_NUM_TRACKS, "maxNumTracks %u > MAX_NUM_TRACKS %u",
108 maxNumTracks, MAX_NUM_TRACKS);
109
Glenn Kasten599fabc2012-03-08 12:33:37 -0800110 // AudioMixer is not yet capable of more than 32 active track inputs
111 ALOG_ASSERT(32 >= MAX_NUM_TRACKS, "bad MAX_NUM_TRACKS %d", MAX_NUM_TRACKS);
112
Glenn Kasten52008f82012-03-18 09:34:41 -0700113 pthread_once(&sOnceControl, &sInitRoutine);
114
Mathias Agopian65ab4712010-07-14 17:59:35 -0700115 mState.enabledTracks= 0;
116 mState.needsChanged = 0;
117 mState.frameCount = frameCount;
Glenn Kasten84afa3b2012-01-25 15:28:08 -0800118 mState.hook = process__nop;
Glenn Kastene0feee32011-12-13 11:53:26 -0800119 mState.outputTemp = NULL;
120 mState.resampleTemp = NULL;
Glenn Kastenab7d72f2013-02-27 09:05:28 -0800121 mState.mLog = &mDummyLog;
Glenn Kasten84afa3b2012-01-25 15:28:08 -0800122 // mState.reserved
Glenn Kasten17a736c2012-02-14 08:52:15 -0800123
124 // FIXME Most of the following initialization is probably redundant since
125 // tracks[i] should only be referenced if (mTrackNames & (1 << i)) != 0
126 // and mTrackNames is initially 0. However, leave it here until that's verified.
Mathias Agopian65ab4712010-07-14 17:59:35 -0700127 track_t* t = mState.tracks;
Glenn Kastenbf71f1e2011-12-13 11:52:35 -0800128 for (unsigned i=0 ; i < MAX_NUM_TRACKS ; i++) {
Eric Laurenta5e82142012-04-16 13:47:17 -0700129 t->resampler = NULL;
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700130 t->downmixerBufferProvider = NULL;
Andy Hung1b2fdcb2014-07-16 17:44:34 -0700131 t->mReformatBufferProvider = NULL;
Andy Hungc5656cc2015-03-26 19:04:33 -0700132 t->mTimestretchBufferProvider = NULL;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700133 t++;
134 }
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700135
Mathias Agopian65ab4712010-07-14 17:59:35 -0700136}
137
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800138AudioMixer::~AudioMixer()
139{
140 track_t* t = mState.tracks;
Glenn Kastenbf71f1e2011-12-13 11:52:35 -0800141 for (unsigned i=0 ; i < MAX_NUM_TRACKS ; i++) {
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800142 delete t->resampler;
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700143 delete t->downmixerBufferProvider;
Andy Hung1b2fdcb2014-07-16 17:44:34 -0700144 delete t->mReformatBufferProvider;
Andy Hungc5656cc2015-03-26 19:04:33 -0700145 delete t->mTimestretchBufferProvider;
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800146 t++;
147 }
148 delete [] mState.outputTemp;
149 delete [] mState.resampleTemp;
150}
Mathias Agopian65ab4712010-07-14 17:59:35 -0700151
Glenn Kastenab7d72f2013-02-27 09:05:28 -0800152void AudioMixer::setLog(NBLog::Writer *log)
153{
154 mState.mLog = log;
155}
156
Andy Hung7f475492014-08-25 16:36:37 -0700157static inline audio_format_t selectMixerInFormat(audio_format_t inputFormat __unused) {
158 return kUseFloat && kUseNewMixer ? AUDIO_FORMAT_PCM_FLOAT : AUDIO_FORMAT_PCM_16_BIT;
159}
160
Andy Hunge8a1ced2014-05-09 15:02:21 -0700161int AudioMixer::getTrackName(audio_channel_mask_t channelMask,
162 audio_format_t format, int sessionId)
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800163{
Andy Hunge8a1ced2014-05-09 15:02:21 -0700164 if (!isValidPcmTrackFormat(format)) {
165 ALOGE("AudioMixer::getTrackName invalid format (%#x)", format);
166 return -1;
167 }
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 Kastendeeb1282012-03-25 11:59:31 -0700172 // assume default parameters for the track, except where noted below
173 track_t* t = &mState.tracks[n];
174 t->needs = 0;
Andy Hung5e58b0a2014-06-23 19:07:29 -0700175
176 // Integer volume.
177 // Currently integer volume is kept for the legacy integer mixer.
178 // Will be removed when the legacy mixer path is removed.
Andy Hung97ae8242014-05-30 10:35:47 -0700179 t->volume[0] = UNITY_GAIN_INT;
180 t->volume[1] = UNITY_GAIN_INT;
Andy Hung5e58b0a2014-06-23 19:07:29 -0700181 t->prevVolume[0] = UNITY_GAIN_INT << 16;
182 t->prevVolume[1] = UNITY_GAIN_INT << 16;
Glenn Kastendeeb1282012-03-25 11:59:31 -0700183 t->volumeInc[0] = 0;
184 t->volumeInc[1] = 0;
185 t->auxLevel = 0;
186 t->auxInc = 0;
Andy Hung5e58b0a2014-06-23 19:07:29 -0700187 t->prevAuxLevel = 0;
188
189 // Floating point volume.
190 t->mVolume[0] = UNITY_GAIN_FLOAT;
191 t->mVolume[1] = UNITY_GAIN_FLOAT;
192 t->mPrevVolume[0] = UNITY_GAIN_FLOAT;
193 t->mPrevVolume[1] = UNITY_GAIN_FLOAT;
194 t->mVolumeInc[0] = 0.;
195 t->mVolumeInc[1] = 0.;
196 t->mAuxLevel = 0.;
197 t->mAuxInc = 0.;
198 t->mPrevAuxLevel = 0.;
199
Glenn Kastendeeb1282012-03-25 11:59:31 -0700200 // no initialization needed
Glenn Kastendeeb1282012-03-25 11:59:31 -0700201 // t->frameCount
Andy Hung68112fc2014-05-14 14:13:23 -0700202 t->channelCount = audio_channel_count_from_out_mask(channelMask);
Glenn Kastendeeb1282012-03-25 11:59:31 -0700203 t->enabled = false;
Andy Hunge93b6b72014-07-17 21:30:53 -0700204 ALOGV_IF(audio_channel_mask_get_bits(channelMask) != AUDIO_CHANNEL_OUT_STEREO,
Andy Hungef7c7fb2014-05-12 16:51:41 -0700205 "Non-stereo channel mask: %d\n", channelMask);
Andy Hung68112fc2014-05-14 14:13:23 -0700206 t->channelMask = channelMask;
Jean-Michel Trivid06e1322012-09-12 15:47:07 -0700207 t->sessionId = sessionId;
Glenn Kastendeeb1282012-03-25 11:59:31 -0700208 // setBufferProvider(name, AudioBufferProvider *) is required before enable(name)
209 t->bufferProvider = NULL;
210 t->buffer.raw = NULL;
211 // no initialization needed
212 // t->buffer.frameCount
213 t->hook = NULL;
214 t->in = NULL;
215 t->resampler = NULL;
216 t->sampleRate = mSampleRate;
217 // setParameter(name, TRACK, MAIN_BUFFER, mixBuffer) is required before enable(name)
218 t->mainBuffer = NULL;
219 t->auxBuffer = NULL;
Andy Hungef7c7fb2014-05-12 16:51:41 -0700220 t->mInputBufferProvider = NULL;
221 t->mReformatBufferProvider = NULL;
Glenn Kasten52008f82012-03-18 09:34:41 -0700222 t->downmixerBufferProvider = NULL;
Andy Hung7f475492014-08-25 16:36:37 -0700223 t->mPostDownmixReformatBufferProvider = NULL;
Andy Hungc5656cc2015-03-26 19:04:33 -0700224 t->mTimestretchBufferProvider = NULL;
Andy Hung78820702014-02-28 16:23:02 -0800225 t->mMixerFormat = AUDIO_FORMAT_PCM_16_BIT;
Andy Hunge8a1ced2014-05-09 15:02:21 -0700226 t->mFormat = format;
Andy Hung7f475492014-08-25 16:36:37 -0700227 t->mMixerInFormat = selectMixerInFormat(format);
228 t->mDownmixRequiresFormat = AUDIO_FORMAT_INVALID; // no format required
Andy Hunge93b6b72014-07-17 21:30:53 -0700229 t->mMixerChannelMask = audio_channel_mask_from_representation_and_bits(
230 AUDIO_CHANNEL_REPRESENTATION_POSITION, AUDIO_CHANNEL_OUT_STEREO);
231 t->mMixerChannelCount = audio_channel_count_from_out_mask(t->mMixerChannelMask);
Ricardo Garcia5a8a95d2015-04-18 14:47:04 -0700232 t->mPlaybackRate = AUDIO_PLAYBACK_RATE_DEFAULT;
Andy Hung296b7412014-06-17 15:25:47 -0700233 // Check the downmixing (or upmixing) requirements.
Andy Hung0f451e92014-08-04 21:28:47 -0700234 status_t status = t->prepareForDownmix();
Andy Hung68112fc2014-05-14 14:13:23 -0700235 if (status != OK) {
236 ALOGE("AudioMixer::getTrackName invalid channelMask (%#x)", channelMask);
237 return -1;
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700238 }
Andy Hung7f475492014-08-25 16:36:37 -0700239 // prepareForDownmix() may change mDownmixRequiresFormat
Andy Hung296b7412014-06-17 15:25:47 -0700240 ALOGVV("mMixerFormat:%#x mMixerInFormat:%#x\n", t->mMixerFormat, t->mMixerInFormat);
Andy Hung0f451e92014-08-04 21:28:47 -0700241 t->prepareForReformat();
Andy Hung68112fc2014-05-14 14:13:23 -0700242 mTrackNames |= 1 << n;
243 return TRACK0 + n;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700244 }
Andy Hung68112fc2014-05-14 14:13:23 -0700245 ALOGE("AudioMixer::getTrackName out of available tracks");
Mathias Agopian65ab4712010-07-14 17:59:35 -0700246 return -1;
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800247}
Mathias Agopian65ab4712010-07-14 17:59:35 -0700248
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800249void AudioMixer::invalidateState(uint32_t mask)
250{
Glenn Kasten34fca342013-08-13 09:48:14 -0700251 if (mask != 0) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700252 mState.needsChanged |= mask;
253 mState.hook = process__validate;
254 }
255 }
256
Andy Hunge93b6b72014-07-17 21:30:53 -0700257// Called when channel masks have changed for a track name
Andy Hung7f475492014-08-25 16:36:37 -0700258// TODO: Fix DownmixerBufferProvider not to (possibly) change mixer input format,
Andy Hunge93b6b72014-07-17 21:30:53 -0700259// which will simplify this logic.
260bool AudioMixer::setChannelMasks(int name,
261 audio_channel_mask_t trackChannelMask, audio_channel_mask_t mixerChannelMask) {
262 track_t &track = mState.tracks[name];
263
264 if (trackChannelMask == track.channelMask
265 && mixerChannelMask == track.mMixerChannelMask) {
266 return false; // no need to change
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700267 }
Andy Hunge93b6b72014-07-17 21:30:53 -0700268 // always recompute for both channel masks even if only one has changed.
269 const uint32_t trackChannelCount = audio_channel_count_from_out_mask(trackChannelMask);
270 const uint32_t mixerChannelCount = audio_channel_count_from_out_mask(mixerChannelMask);
271 const bool mixerChannelCountChanged = track.mMixerChannelCount != mixerChannelCount;
272
273 ALOG_ASSERT((trackChannelCount <= MAX_NUM_CHANNELS_TO_DOWNMIX)
274 && trackChannelCount
275 && mixerChannelCount);
276 track.channelMask = trackChannelMask;
277 track.channelCount = trackChannelCount;
278 track.mMixerChannelMask = mixerChannelMask;
279 track.mMixerChannelCount = mixerChannelCount;
280
281 // channel masks have changed, does this track need a downmixer?
282 // update to try using our desired format (if we aren't already using it)
Andy Hung7f475492014-08-25 16:36:37 -0700283 const audio_format_t prevDownmixerFormat = track.mDownmixRequiresFormat;
Andy Hung0f451e92014-08-04 21:28:47 -0700284 const status_t status = mState.tracks[name].prepareForDownmix();
Andy Hunge93b6b72014-07-17 21:30:53 -0700285 ALOGE_IF(status != OK,
Andy Hung0f451e92014-08-04 21:28:47 -0700286 "prepareForDownmix error %d, track channel mask %#x, mixer channel mask %#x",
Andy Hunge93b6b72014-07-17 21:30:53 -0700287 status, track.channelMask, track.mMixerChannelMask);
288
Andy Hung7f475492014-08-25 16:36:37 -0700289 if (prevDownmixerFormat != track.mDownmixRequiresFormat) {
Andy Hung0f451e92014-08-04 21:28:47 -0700290 track.prepareForReformat(); // because of downmixer, track format may change!
Andy Hunge93b6b72014-07-17 21:30:53 -0700291 }
292
Andy Hung7f475492014-08-25 16:36:37 -0700293 if (track.resampler && mixerChannelCountChanged) {
294 // resampler channels may have changed.
Andy Hunge93b6b72014-07-17 21:30:53 -0700295 const uint32_t resetToSampleRate = track.sampleRate;
296 delete track.resampler;
297 track.resampler = NULL;
298 track.sampleRate = mSampleRate; // without resampler, track rate is device sample rate.
299 // recreate the resampler with updated format, channels, saved sampleRate.
300 track.setResampler(resetToSampleRate /*trackSampleRate*/, mSampleRate /*devSampleRate*/);
301 }
302 return true;
303}
304
Andy Hung0f451e92014-08-04 21:28:47 -0700305void AudioMixer::track_t::unprepareForDownmix() {
306 ALOGV("AudioMixer::unprepareForDownmix(%p)", this);
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700307
Andy Hung7f475492014-08-25 16:36:37 -0700308 mDownmixRequiresFormat = AUDIO_FORMAT_INVALID;
Andy Hung0f451e92014-08-04 21:28:47 -0700309 if (downmixerBufferProvider != NULL) {
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700310 // this track had previously been configured with a downmixer, delete it
311 ALOGV(" deleting old downmixer");
Andy Hung0f451e92014-08-04 21:28:47 -0700312 delete downmixerBufferProvider;
313 downmixerBufferProvider = NULL;
314 reconfigureBufferProviders();
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700315 } else {
316 ALOGV(" nothing to do, no downmixer to delete");
317 }
318}
319
Andy Hung0f451e92014-08-04 21:28:47 -0700320status_t AudioMixer::track_t::prepareForDownmix()
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700321{
Andy Hung0f451e92014-08-04 21:28:47 -0700322 ALOGV("AudioMixer::prepareForDownmix(%p) with mask 0x%x",
323 this, channelMask);
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700324
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700325 // discard the previous downmixer if there was one
Andy Hung0f451e92014-08-04 21:28:47 -0700326 unprepareForDownmix();
Andy Hung73e62e22015-04-20 12:06:38 -0700327 // MONO_HACK Only remix (upmix or downmix) if the track and mixer/device channel masks
Andy Hung0f451e92014-08-04 21:28:47 -0700328 // are not the same and not handled internally, as mono -> stereo currently is.
329 if (channelMask == mMixerChannelMask
330 || (channelMask == AUDIO_CHANNEL_OUT_MONO
331 && mMixerChannelMask == AUDIO_CHANNEL_OUT_STEREO)) {
332 return NO_ERROR;
333 }
Andy Hung650ceb92015-01-29 13:31:12 -0800334 // DownmixerBufferProvider is only used for position masks.
335 if (audio_channel_mask_get_representation(channelMask)
336 == AUDIO_CHANNEL_REPRESENTATION_POSITION
337 && DownmixerBufferProvider::isMultichannelCapable()) {
Andy Hung0f451e92014-08-04 21:28:47 -0700338 DownmixerBufferProvider* pDbp = new DownmixerBufferProvider(channelMask,
339 mMixerChannelMask,
340 AUDIO_FORMAT_PCM_16_BIT /* TODO: use mMixerInFormat, now only PCM 16 */,
341 sampleRate, sessionId, kCopyBufferFrameCount);
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700342
Andy Hung34803d52014-07-16 21:41:35 -0700343 if (pDbp->isValid()) { // if constructor completed properly
Andy Hung7f475492014-08-25 16:36:37 -0700344 mDownmixRequiresFormat = AUDIO_FORMAT_PCM_16_BIT; // PCM 16 bit required for downmix
Andy Hung0f451e92014-08-04 21:28:47 -0700345 downmixerBufferProvider = pDbp;
346 reconfigureBufferProviders();
Andy Hung34803d52014-07-16 21:41:35 -0700347 return NO_ERROR;
348 }
349 delete pDbp;
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700350 }
Andy Hunge93b6b72014-07-17 21:30:53 -0700351
352 // Effect downmixer does not accept the channel conversion. Let's use our remixer.
Andy Hung0f451e92014-08-04 21:28:47 -0700353 RemixBufferProvider* pRbp = new RemixBufferProvider(channelMask,
354 mMixerChannelMask, mMixerInFormat, kCopyBufferFrameCount);
Andy Hunge93b6b72014-07-17 21:30:53 -0700355 // Remix always finds a conversion whereas Downmixer effect above may fail.
Andy Hung0f451e92014-08-04 21:28:47 -0700356 downmixerBufferProvider = pRbp;
357 reconfigureBufferProviders();
Andy Hunge93b6b72014-07-17 21:30:53 -0700358 return NO_ERROR;
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700359}
360
Andy Hung0f451e92014-08-04 21:28:47 -0700361void AudioMixer::track_t::unprepareForReformat() {
362 ALOGV("AudioMixer::unprepareForReformat(%p)", this);
Andy Hung7f475492014-08-25 16:36:37 -0700363 bool requiresReconfigure = false;
Andy Hung0f451e92014-08-04 21:28:47 -0700364 if (mReformatBufferProvider != NULL) {
365 delete mReformatBufferProvider;
366 mReformatBufferProvider = NULL;
Andy Hung7f475492014-08-25 16:36:37 -0700367 requiresReconfigure = true;
368 }
369 if (mPostDownmixReformatBufferProvider != NULL) {
370 delete mPostDownmixReformatBufferProvider;
371 mPostDownmixReformatBufferProvider = NULL;
372 requiresReconfigure = true;
373 }
374 if (requiresReconfigure) {
Andy Hung0f451e92014-08-04 21:28:47 -0700375 reconfigureBufferProviders();
Andy Hungef7c7fb2014-05-12 16:51:41 -0700376 }
377}
378
Andy Hung0f451e92014-08-04 21:28:47 -0700379status_t AudioMixer::track_t::prepareForReformat()
Andy Hungef7c7fb2014-05-12 16:51:41 -0700380{
Andy Hung0f451e92014-08-04 21:28:47 -0700381 ALOGV("AudioMixer::prepareForReformat(%p) with format %#x", this, mFormat);
Andy Hung7f475492014-08-25 16:36:37 -0700382 // discard previous reformatters
Andy Hung0f451e92014-08-04 21:28:47 -0700383 unprepareForReformat();
Andy Hung7f475492014-08-25 16:36:37 -0700384 // only configure reformatters as needed
385 const audio_format_t targetFormat = mDownmixRequiresFormat != AUDIO_FORMAT_INVALID
386 ? mDownmixRequiresFormat : mMixerInFormat;
387 bool requiresReconfigure = false;
388 if (mFormat != targetFormat) {
Andy Hung0f451e92014-08-04 21:28:47 -0700389 mReformatBufferProvider = new ReformatBufferProvider(
390 audio_channel_count_from_out_mask(channelMask),
Andy Hung7f475492014-08-25 16:36:37 -0700391 mFormat,
392 targetFormat,
Andy Hung1b2fdcb2014-07-16 17:44:34 -0700393 kCopyBufferFrameCount);
Andy Hung7f475492014-08-25 16:36:37 -0700394 requiresReconfigure = true;
395 }
396 if (targetFormat != mMixerInFormat) {
397 mPostDownmixReformatBufferProvider = new ReformatBufferProvider(
398 audio_channel_count_from_out_mask(mMixerChannelMask),
399 targetFormat,
400 mMixerInFormat,
401 kCopyBufferFrameCount);
402 requiresReconfigure = true;
403 }
404 if (requiresReconfigure) {
Andy Hung0f451e92014-08-04 21:28:47 -0700405 reconfigureBufferProviders();
Andy Hung296b7412014-06-17 15:25:47 -0700406 }
407 return NO_ERROR;
Andy Hungef7c7fb2014-05-12 16:51:41 -0700408}
409
Andy Hung0f451e92014-08-04 21:28:47 -0700410void AudioMixer::track_t::reconfigureBufferProviders()
Andy Hungef7c7fb2014-05-12 16:51:41 -0700411{
Andy Hung0f451e92014-08-04 21:28:47 -0700412 bufferProvider = mInputBufferProvider;
413 if (mReformatBufferProvider) {
414 mReformatBufferProvider->setBufferProvider(bufferProvider);
415 bufferProvider = mReformatBufferProvider;
Andy Hungef7c7fb2014-05-12 16:51:41 -0700416 }
Andy Hung0f451e92014-08-04 21:28:47 -0700417 if (downmixerBufferProvider) {
418 downmixerBufferProvider->setBufferProvider(bufferProvider);
419 bufferProvider = downmixerBufferProvider;
Andy Hungef7c7fb2014-05-12 16:51:41 -0700420 }
Andy Hung7f475492014-08-25 16:36:37 -0700421 if (mPostDownmixReformatBufferProvider) {
422 mPostDownmixReformatBufferProvider->setBufferProvider(bufferProvider);
423 bufferProvider = mPostDownmixReformatBufferProvider;
424 }
Andy Hungc5656cc2015-03-26 19:04:33 -0700425 if (mTimestretchBufferProvider) {
426 mTimestretchBufferProvider->setBufferProvider(bufferProvider);
427 bufferProvider = mTimestretchBufferProvider;
428 }
Andy Hungef7c7fb2014-05-12 16:51:41 -0700429}
430
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800431void AudioMixer::deleteTrackName(int name)
432{
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700433 ALOGV("AudioMixer::deleteTrackName(%d)", name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700434 name -= TRACK0;
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800435 ALOG_ASSERT(uint32_t(name) < MAX_NUM_TRACKS, "bad track name %d", name);
Glenn Kasten237a6242011-12-15 15:32:27 -0800436 ALOGV("deleteTrackName(%d)", name);
437 track_t& track(mState.tracks[ name ]);
Glenn Kasten4c340c62012-01-27 12:33:54 -0800438 if (track.enabled) {
439 track.enabled = false;
Glenn Kasten237a6242011-12-15 15:32:27 -0800440 invalidateState(1<<name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700441 }
Glenn Kasten4e2293f2012-04-12 09:39:07 -0700442 // delete the resampler
443 delete track.resampler;
444 track.resampler = NULL;
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700445 // delete the downmixer
Andy Hung0f451e92014-08-04 21:28:47 -0700446 mState.tracks[name].unprepareForDownmix();
Andy Hungef7c7fb2014-05-12 16:51:41 -0700447 // delete the reformatter
Andy Hung0f451e92014-08-04 21:28:47 -0700448 mState.tracks[name].unprepareForReformat();
Andy Hungc5656cc2015-03-26 19:04:33 -0700449 // delete the timestretch provider
450 delete track.mTimestretchBufferProvider;
451 track.mTimestretchBufferProvider = NULL;
Glenn Kasten237a6242011-12-15 15:32:27 -0800452 mTrackNames &= ~(1<<name);
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800453}
Mathias Agopian65ab4712010-07-14 17:59:35 -0700454
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800455void AudioMixer::enable(int name)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700456{
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800457 name -= TRACK0;
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800458 ALOG_ASSERT(uint32_t(name) < MAX_NUM_TRACKS, "bad track name %d", name);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800459 track_t& track = mState.tracks[name];
460
Glenn Kasten4c340c62012-01-27 12:33:54 -0800461 if (!track.enabled) {
462 track.enabled = true;
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800463 ALOGV("enable(%d)", name);
464 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700465 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700466}
467
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800468void AudioMixer::disable(int name)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700469{
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800470 name -= TRACK0;
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800471 ALOG_ASSERT(uint32_t(name) < MAX_NUM_TRACKS, "bad track name %d", name);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800472 track_t& track = mState.tracks[name];
473
Glenn Kasten4c340c62012-01-27 12:33:54 -0800474 if (track.enabled) {
475 track.enabled = false;
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800476 ALOGV("disable(%d)", name);
477 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700478 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700479}
480
Andy Hung5866a3b2014-05-29 21:33:13 -0700481/* Sets the volume ramp variables for the AudioMixer.
482 *
Andy Hung5e58b0a2014-06-23 19:07:29 -0700483 * The volume ramp variables are used to transition from the previous
484 * volume to the set volume. ramp controls the duration of the transition.
485 * Its value is typically one state framecount period, but may also be 0,
486 * meaning "immediate."
Andy Hung5866a3b2014-05-29 21:33:13 -0700487 *
Andy Hung5e58b0a2014-06-23 19:07:29 -0700488 * FIXME: 1) Volume ramp is enabled only if there is a nonzero integer increment
489 * even if there is a nonzero floating point increment (in that case, the volume
490 * change is immediate). This restriction should be changed when the legacy mixer
491 * is removed (see #2).
492 * FIXME: 2) Integer volume variables are used for Legacy mixing and should be removed
493 * when no longer needed.
494 *
495 * @param newVolume set volume target in floating point [0.0, 1.0].
496 * @param ramp number of frames to increment over. if ramp is 0, the volume
497 * should be set immediately. Currently ramp should not exceed 65535 (frames).
498 * @param pIntSetVolume pointer to the U4.12 integer target volume, set on return.
499 * @param pIntPrevVolume pointer to the U4.28 integer previous volume, set on return.
500 * @param pIntVolumeInc pointer to the U4.28 increment per output audio frame, set on return.
501 * @param pSetVolume pointer to the float target volume, set on return.
502 * @param pPrevVolume pointer to the float previous volume, set on return.
503 * @param pVolumeInc pointer to the float increment per output audio frame, set on return.
Andy Hung5866a3b2014-05-29 21:33:13 -0700504 * @return true if the volume has changed, false if volume is same.
505 */
Andy Hung5e58b0a2014-06-23 19:07:29 -0700506static inline bool setVolumeRampVariables(float newVolume, int32_t ramp,
507 int16_t *pIntSetVolume, int32_t *pIntPrevVolume, int32_t *pIntVolumeInc,
508 float *pSetVolume, float *pPrevVolume, float *pVolumeInc) {
Andy Hunge09c9942015-05-08 16:58:13 -0700509 // check floating point volume to see if it is identical to the previously
510 // set volume.
511 // We do not use a tolerance here (and reject changes too small)
512 // as it may be confusing to use a different value than the one set.
513 // If the resulting volume is too small to ramp, it is a direct set of the volume.
Andy Hung5e58b0a2014-06-23 19:07:29 -0700514 if (newVolume == *pSetVolume) {
Andy Hung5866a3b2014-05-29 21:33:13 -0700515 return false;
516 }
Andy Hunge09c9942015-05-08 16:58:13 -0700517 if (newVolume < 0) {
518 newVolume = 0; // should not have negative volumes
Andy Hung5866a3b2014-05-29 21:33:13 -0700519 } else {
Andy Hunge09c9942015-05-08 16:58:13 -0700520 switch (fpclassify(newVolume)) {
521 case FP_SUBNORMAL:
522 case FP_NAN:
523 newVolume = 0;
524 break;
525 case FP_ZERO:
526 break; // zero volume is fine
527 case FP_INFINITE:
528 // Infinite volume could be handled consistently since
529 // floating point math saturates at infinities,
530 // but we limit volume to unity gain float.
531 // ramp = 0; break;
532 //
533 newVolume = AudioMixer::UNITY_GAIN_FLOAT;
534 break;
535 case FP_NORMAL:
536 default:
537 // Floating point does not have problems with overflow wrap
538 // that integer has. However, we limit the volume to
539 // unity gain here.
540 // TODO: Revisit the volume limitation and perhaps parameterize.
541 if (newVolume > AudioMixer::UNITY_GAIN_FLOAT) {
542 newVolume = AudioMixer::UNITY_GAIN_FLOAT;
543 }
544 break;
545 }
Andy Hung5866a3b2014-05-29 21:33:13 -0700546 }
Andy Hung5e58b0a2014-06-23 19:07:29 -0700547
Andy Hunge09c9942015-05-08 16:58:13 -0700548 // set floating point volume ramp
549 if (ramp != 0) {
550 // when the ramp completes, *pPrevVolume is set to *pSetVolume, so there
551 // is no computational mismatch; hence equality is checked here.
552 ALOGD_IF(*pPrevVolume != *pSetVolume, "previous float ramp hasn't finished,"
553 " prev:%f set_to:%f", *pPrevVolume, *pSetVolume);
554 const float inc = (newVolume - *pPrevVolume) / ramp; // could be inf, nan, subnormal
555 const float maxv = max(newVolume, *pPrevVolume); // could be inf, cannot be nan, subnormal
556
557 if (isnormal(inc) // inc must be a normal number (no subnormals, infinite, nan)
558 && maxv + inc != maxv) { // inc must make forward progress
559 *pVolumeInc = inc;
560 // ramp is set now.
561 // Note: if newVolume is 0, then near the end of the ramp,
562 // it may be possible that the ramped volume may be subnormal or
563 // temporarily negative by a small amount or subnormal due to floating
564 // point inaccuracies.
565 } else {
566 ramp = 0; // ramp not allowed
567 }
Andy Hung5e58b0a2014-06-23 19:07:29 -0700568 }
Andy Hunge09c9942015-05-08 16:58:13 -0700569
570 // compute and check integer volume, no need to check negative values
571 // The integer volume is limited to "unity_gain" to avoid wrapping and other
572 // audio artifacts, so it never reaches the range limit of U4.28.
573 // We safely use signed 16 and 32 bit integers here.
574 const float scaledVolume = newVolume * AudioMixer::UNITY_GAIN_INT; // not neg, subnormal, nan
575 const int32_t intVolume = (scaledVolume >= (float)AudioMixer::UNITY_GAIN_INT) ?
576 AudioMixer::UNITY_GAIN_INT : (int32_t)scaledVolume;
577
578 // set integer volume ramp
579 if (ramp != 0) {
580 // integer volume is U4.12 (to use 16 bit multiplies), but ramping uses U4.28.
581 // when the ramp completes, *pIntPrevVolume is set to *pIntSetVolume << 16, so there
582 // is no computational mismatch; hence equality is checked here.
583 ALOGD_IF(*pIntPrevVolume != *pIntSetVolume << 16, "previous int ramp hasn't finished,"
584 " prev:%d set_to:%d", *pIntPrevVolume, *pIntSetVolume << 16);
585 const int32_t inc = ((intVolume << 16) - *pIntPrevVolume) / ramp;
586
587 if (inc != 0) { // inc must make forward progress
588 *pIntVolumeInc = inc;
589 } else {
590 ramp = 0; // ramp not allowed
591 }
592 }
593
594 // if no ramp, or ramp not allowed, then clear float and integer increments
595 if (ramp == 0) {
Andy Hung5e58b0a2014-06-23 19:07:29 -0700596 *pVolumeInc = 0;
597 *pPrevVolume = newVolume;
Andy Hung5e58b0a2014-06-23 19:07:29 -0700598 *pIntVolumeInc = 0;
599 *pIntPrevVolume = intVolume << 16;
600 }
Andy Hunge09c9942015-05-08 16:58:13 -0700601 *pSetVolume = newVolume;
Andy Hung5e58b0a2014-06-23 19:07:29 -0700602 *pIntSetVolume = intVolume;
Andy Hung5866a3b2014-05-29 21:33:13 -0700603 return true;
604}
605
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800606void AudioMixer::setParameter(int name, int target, int param, void *value)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700607{
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800608 name -= TRACK0;
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800609 ALOG_ASSERT(uint32_t(name) < MAX_NUM_TRACKS, "bad track name %d", name);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800610 track_t& track = mState.tracks[name];
Mathias Agopian65ab4712010-07-14 17:59:35 -0700611
Kévin PETIT377b2ec2014-02-03 12:35:36 +0000612 int valueInt = static_cast<int>(reinterpret_cast<uintptr_t>(value));
613 int32_t *valueBuf = reinterpret_cast<int32_t*>(value);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700614
615 switch (target) {
Glenn Kasten788040c2011-05-05 08:19:00 -0700616
Mathias Agopian65ab4712010-07-14 17:59:35 -0700617 case TRACK:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800618 switch (param) {
Glenn Kasten788040c2011-05-05 08:19:00 -0700619 case CHANNEL_MASK: {
Andy Hunge93b6b72014-07-17 21:30:53 -0700620 const audio_channel_mask_t trackChannelMask =
621 static_cast<audio_channel_mask_t>(valueInt);
622 if (setChannelMasks(name, trackChannelMask, track.mMixerChannelMask)) {
623 ALOGV("setParameter(TRACK, CHANNEL_MASK, %x)", trackChannelMask);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800624 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700625 }
Glenn Kasten788040c2011-05-05 08:19:00 -0700626 } break;
627 case MAIN_BUFFER:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800628 if (track.mainBuffer != valueBuf) {
629 track.mainBuffer = valueBuf;
Steve Block3856b092011-10-20 11:56:00 +0100630 ALOGV("setParameter(TRACK, MAIN_BUFFER, %p)", valueBuf);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800631 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700632 }
Glenn Kasten788040c2011-05-05 08:19:00 -0700633 break;
634 case AUX_BUFFER:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800635 if (track.auxBuffer != valueBuf) {
636 track.auxBuffer = valueBuf;
Steve Block3856b092011-10-20 11:56:00 +0100637 ALOGV("setParameter(TRACK, AUX_BUFFER, %p)", valueBuf);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800638 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700639 }
Glenn Kasten788040c2011-05-05 08:19:00 -0700640 break;
Andy Hungef7c7fb2014-05-12 16:51:41 -0700641 case FORMAT: {
642 audio_format_t format = static_cast<audio_format_t>(valueInt);
643 if (track.mFormat != format) {
644 ALOG_ASSERT(audio_is_linear_pcm(format), "Invalid format %#x", format);
645 track.mFormat = format;
646 ALOGV("setParameter(TRACK, FORMAT, %#x)", format);
Andy Hung0f451e92014-08-04 21:28:47 -0700647 track.prepareForReformat();
Andy Hungef7c7fb2014-05-12 16:51:41 -0700648 invalidateState(1 << name);
649 }
650 } break;
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700651 // FIXME do we want to support setting the downmix type from AudioFlinger?
652 // for a specific track? or per mixer?
653 /* case DOWNMIX_TYPE:
654 break */
Andy Hung78820702014-02-28 16:23:02 -0800655 case MIXER_FORMAT: {
Andy Hunga1ab7cc2014-02-24 19:26:52 -0800656 audio_format_t format = static_cast<audio_format_t>(valueInt);
Andy Hung78820702014-02-28 16:23:02 -0800657 if (track.mMixerFormat != format) {
658 track.mMixerFormat = format;
659 ALOGV("setParameter(TRACK, MIXER_FORMAT, %#x)", format);
Andy Hunga1ab7cc2014-02-24 19:26:52 -0800660 }
661 } break;
Andy Hunge93b6b72014-07-17 21:30:53 -0700662 case MIXER_CHANNEL_MASK: {
663 const audio_channel_mask_t mixerChannelMask =
664 static_cast<audio_channel_mask_t>(valueInt);
665 if (setChannelMasks(name, track.channelMask, mixerChannelMask)) {
666 ALOGV("setParameter(TRACK, MIXER_CHANNEL_MASK, %#x)", mixerChannelMask);
667 invalidateState(1 << name);
668 }
669 } break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700670 default:
Glenn Kastenadad3d72014-02-21 14:51:43 -0800671 LOG_ALWAYS_FATAL("setParameter track: bad param %d", param);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700672 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700673 break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700674
Mathias Agopian65ab4712010-07-14 17:59:35 -0700675 case RESAMPLE:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800676 switch (param) {
677 case SAMPLE_RATE:
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800678 ALOG_ASSERT(valueInt > 0, "bad sample rate %d", valueInt);
Glenn Kasten788040c2011-05-05 08:19:00 -0700679 if (track.setResampler(uint32_t(valueInt), mSampleRate)) {
680 ALOGV("setParameter(RESAMPLE, SAMPLE_RATE, %u)",
681 uint32_t(valueInt));
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800682 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700683 }
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800684 break;
685 case RESET:
Eric Laurent243f5f92011-02-28 16:52:51 -0800686 track.resetResampler();
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800687 invalidateState(1 << name);
688 break;
Glenn Kasten4e2293f2012-04-12 09:39:07 -0700689 case REMOVE:
690 delete track.resampler;
691 track.resampler = NULL;
692 track.sampleRate = mSampleRate;
693 invalidateState(1 << name);
694 break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700695 default:
Glenn Kastenadad3d72014-02-21 14:51:43 -0800696 LOG_ALWAYS_FATAL("setParameter resample: bad param %d", param);
Eric Laurent243f5f92011-02-28 16:52:51 -0800697 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700698 break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700699
Mathias Agopian65ab4712010-07-14 17:59:35 -0700700 case RAMP_VOLUME:
701 case VOLUME:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800702 switch (param) {
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800703 case AUXLEVEL:
Andy Hung6be49402014-05-30 10:42:03 -0700704 if (setVolumeRampVariables(*reinterpret_cast<float*>(value),
Andy Hung5866a3b2014-05-29 21:33:13 -0700705 target == RAMP_VOLUME ? mState.frameCount : 0,
Andy Hung5e58b0a2014-06-23 19:07:29 -0700706 &track.auxLevel, &track.prevAuxLevel, &track.auxInc,
707 &track.mAuxLevel, &track.mPrevAuxLevel, &track.mAuxInc)) {
Andy Hung5866a3b2014-05-29 21:33:13 -0700708 ALOGV("setParameter(%s, AUXLEVEL: %04x)",
Andy Hung6be49402014-05-30 10:42:03 -0700709 target == VOLUME ? "VOLUME" : "RAMP_VOLUME", track.auxLevel);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800710 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700711 }
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800712 break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700713 default:
Andy Hunge93b6b72014-07-17 21:30:53 -0700714 if ((unsigned)param >= VOLUME0 && (unsigned)param < VOLUME0 + MAX_NUM_VOLUMES) {
715 if (setVolumeRampVariables(*reinterpret_cast<float*>(value),
716 target == RAMP_VOLUME ? mState.frameCount : 0,
717 &track.volume[param - VOLUME0], &track.prevVolume[param - VOLUME0],
718 &track.volumeInc[param - VOLUME0],
719 &track.mVolume[param - VOLUME0], &track.mPrevVolume[param - VOLUME0],
720 &track.mVolumeInc[param - VOLUME0])) {
721 ALOGV("setParameter(%s, VOLUME%d: %04x)",
722 target == VOLUME ? "VOLUME" : "RAMP_VOLUME", param - VOLUME0,
723 track.volume[param - VOLUME0]);
724 invalidateState(1 << name);
725 }
726 } else {
727 LOG_ALWAYS_FATAL("setParameter volume: bad param %d", param);
728 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700729 }
730 break;
Andy Hungc5656cc2015-03-26 19:04:33 -0700731 case TIMESTRETCH:
732 switch (param) {
733 case PLAYBACK_RATE: {
Ricardo Garcia5a8a95d2015-04-18 14:47:04 -0700734 const AudioPlaybackRate *playbackRate =
735 reinterpret_cast<AudioPlaybackRate*>(value);
Ricardo Garcia6c7f0622015-04-30 18:39:16 -0700736 ALOGW_IF(!isAudioPlaybackRateValid(*playbackRate),
737 "bad parameters speed %f, pitch %f",playbackRate->mSpeed,
738 playbackRate->mPitch);
Ricardo Garcia5a8a95d2015-04-18 14:47:04 -0700739 if (track.setPlaybackRate(*playbackRate)) {
740 ALOGV("setParameter(TIMESTRETCH, PLAYBACK_RATE, STRETCH_MODE, FALLBACK_MODE "
741 "%f %f %d %d",
742 playbackRate->mSpeed,
743 playbackRate->mPitch,
744 playbackRate->mStretchMode,
745 playbackRate->mFallbackMode);
Andy Hungc5656cc2015-03-26 19:04:33 -0700746 // invalidateState(1 << name);
747 }
Ricardo Garcia5a8a95d2015-04-18 14:47:04 -0700748 } break;
Andy Hungc5656cc2015-03-26 19:04:33 -0700749 default:
750 LOG_ALWAYS_FATAL("setParameter timestretch: bad param %d", param);
751 }
752 break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700753
754 default:
Glenn Kastenadad3d72014-02-21 14:51:43 -0800755 LOG_ALWAYS_FATAL("setParameter: bad target %d", target);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700756 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700757}
758
Andy Hunge93b6b72014-07-17 21:30:53 -0700759bool AudioMixer::track_t::setResampler(uint32_t trackSampleRate, uint32_t devSampleRate)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700760{
Andy Hunge93b6b72014-07-17 21:30:53 -0700761 if (trackSampleRate != devSampleRate || resampler != NULL) {
762 if (sampleRate != trackSampleRate) {
763 sampleRate = trackSampleRate;
Glenn Kastene0feee32011-12-13 11:53:26 -0800764 if (resampler == NULL) {
Andy Hunge93b6b72014-07-17 21:30:53 -0700765 ALOGV("Creating resampler from track %d Hz to device %d Hz",
766 trackSampleRate, devSampleRate);
Glenn Kastenac602052012-10-01 14:04:31 -0700767 AudioResampler::src_quality quality;
768 // force lowest quality level resampler if use case isn't music or video
769 // FIXME this is flawed for dynamic sample rates, as we choose the resampler
770 // quality level based on the initial ratio, but that could change later.
771 // Should have a way to distinguish tracks with static ratios vs. dynamic ratios.
Andy Hungdb4c0312015-05-06 08:46:52 -0700772 if (isMusicRate(trackSampleRate)) {
Glenn Kastenac602052012-10-01 14:04:31 -0700773 quality = AudioResampler::DEFAULT_QUALITY;
Andy Hungdb4c0312015-05-06 08:46:52 -0700774 } else {
775 quality = AudioResampler::DYN_LOW_QUALITY;
Glenn Kastenac602052012-10-01 14:04:31 -0700776 }
Andy Hung296b7412014-06-17 15:25:47 -0700777
Andy Hunge93b6b72014-07-17 21:30:53 -0700778 // TODO: Remove MONO_HACK. Resampler sees #channels after the downmixer
779 // but if none exists, it is the channel count (1 for mono).
780 const int resamplerChannelCount = downmixerBufferProvider != NULL
781 ? mMixerChannelCount : channelCount;
Andy Hung9a592762014-07-21 21:56:01 -0700782 ALOGVV("Creating resampler:"
783 " format(%#x) channels(%d) devSampleRate(%u) quality(%d)\n",
784 mMixerInFormat, resamplerChannelCount, devSampleRate, quality);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700785 resampler = AudioResampler::create(
Andy Hung3348e362014-07-07 10:21:44 -0700786 mMixerInFormat,
Andy Hunge93b6b72014-07-17 21:30:53 -0700787 resamplerChannelCount,
Glenn Kastenac602052012-10-01 14:04:31 -0700788 devSampleRate, quality);
Glenn Kasten52008f82012-03-18 09:34:41 -0700789 resampler->setLocalTimeFreq(sLocalTimeFreq);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700790 }
791 return true;
792 }
793 }
794 return false;
795}
796
Ricardo Garcia5a8a95d2015-04-18 14:47:04 -0700797bool AudioMixer::track_t::setPlaybackRate(const AudioPlaybackRate &playbackRate)
Andy Hungc5656cc2015-03-26 19:04:33 -0700798{
Ricardo Garcia5a8a95d2015-04-18 14:47:04 -0700799 if ((mTimestretchBufferProvider == NULL &&
800 fabs(playbackRate.mSpeed - mPlaybackRate.mSpeed) < AUDIO_TIMESTRETCH_SPEED_MIN_DELTA &&
801 fabs(playbackRate.mPitch - mPlaybackRate.mPitch) < AUDIO_TIMESTRETCH_PITCH_MIN_DELTA) ||
802 isAudioPlaybackRateEqual(playbackRate, mPlaybackRate)) {
Andy Hungc5656cc2015-03-26 19:04:33 -0700803 return false;
804 }
Ricardo Garcia5a8a95d2015-04-18 14:47:04 -0700805 mPlaybackRate = playbackRate;
Andy Hungc5656cc2015-03-26 19:04:33 -0700806 if (mTimestretchBufferProvider == NULL) {
807 // TODO: Remove MONO_HACK. Resampler sees #channels after the downmixer
808 // but if none exists, it is the channel count (1 for mono).
809 const int timestretchChannelCount = downmixerBufferProvider != NULL
810 ? mMixerChannelCount : channelCount;
811 mTimestretchBufferProvider = new TimestretchBufferProvider(timestretchChannelCount,
Ricardo Garcia5a8a95d2015-04-18 14:47:04 -0700812 mMixerInFormat, sampleRate, playbackRate);
Andy Hungc5656cc2015-03-26 19:04:33 -0700813 reconfigureBufferProviders();
814 } else {
815 reinterpret_cast<TimestretchBufferProvider*>(mTimestretchBufferProvider)
Ricardo Garcia5a8a95d2015-04-18 14:47:04 -0700816 ->setPlaybackRate(playbackRate);
Andy Hungc5656cc2015-03-26 19:04:33 -0700817 }
818 return true;
819}
820
Andy Hung5e58b0a2014-06-23 19:07:29 -0700821/* Checks to see if the volume ramp has completed and clears the increment
822 * variables appropriately.
823 *
824 * FIXME: There is code to handle int/float ramp variable switchover should it not
825 * complete within a mixer buffer processing call, but it is preferred to avoid switchover
826 * due to precision issues. The switchover code is included for legacy code purposes
827 * and can be removed once the integer volume is removed.
828 *
829 * It is not sufficient to clear only the volumeInc integer variable because
830 * if one channel requires ramping, all channels are ramped.
831 *
832 * There is a bit of duplicated code here, but it keeps backward compatibility.
833 */
834inline void AudioMixer::track_t::adjustVolumeRamp(bool aux, bool useFloat)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700835{
Andy Hung5e58b0a2014-06-23 19:07:29 -0700836 if (useFloat) {
Andy Hunge93b6b72014-07-17 21:30:53 -0700837 for (uint32_t i = 0; i < MAX_NUM_VOLUMES; i++) {
Eric Laurent43412fc2015-05-08 16:14:36 -0700838 if ((mVolumeInc[i] > 0 && mPrevVolume[i] + mVolumeInc[i] >= mVolume[i]) ||
839 (mVolumeInc[i] < 0 && mPrevVolume[i] + mVolumeInc[i] <= mVolume[i])) {
Andy Hung5e58b0a2014-06-23 19:07:29 -0700840 volumeInc[i] = 0;
841 prevVolume[i] = volume[i] << 16;
842 mVolumeInc[i] = 0.;
843 mPrevVolume[i] = mVolume[i];
Andy Hung5e58b0a2014-06-23 19:07:29 -0700844 } else {
845 //ALOGV("ramp: %f %f %f", mVolume[i], mPrevVolume[i], mVolumeInc[i]);
846 prevVolume[i] = u4_28_from_float(mPrevVolume[i]);
847 }
848 }
849 } else {
Andy Hunge93b6b72014-07-17 21:30:53 -0700850 for (uint32_t i = 0; i < MAX_NUM_VOLUMES; i++) {
Andy Hung5e58b0a2014-06-23 19:07:29 -0700851 if (((volumeInc[i]>0) && (((prevVolume[i]+volumeInc[i])>>16) >= volume[i])) ||
852 ((volumeInc[i]<0) && (((prevVolume[i]+volumeInc[i])>>16) <= volume[i]))) {
853 volumeInc[i] = 0;
854 prevVolume[i] = volume[i] << 16;
855 mVolumeInc[i] = 0.;
856 mPrevVolume[i] = mVolume[i];
857 } else {
858 //ALOGV("ramp: %d %d %d", volume[i] << 16, prevVolume[i], volumeInc[i]);
859 mPrevVolume[i] = float_from_u4_28(prevVolume[i]);
860 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700861 }
862 }
Andy Hung5e58b0a2014-06-23 19:07:29 -0700863 /* TODO: aux is always integer regardless of output buffer type */
Mathias Agopian65ab4712010-07-14 17:59:35 -0700864 if (aux) {
865 if (((auxInc>0) && (((prevAuxLevel+auxInc)>>16) >= auxLevel)) ||
Andy Hung5e58b0a2014-06-23 19:07:29 -0700866 ((auxInc<0) && (((prevAuxLevel+auxInc)>>16) <= auxLevel))) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700867 auxInc = 0;
Andy Hung5e58b0a2014-06-23 19:07:29 -0700868 prevAuxLevel = auxLevel << 16;
869 mAuxInc = 0.;
870 mPrevAuxLevel = mAuxLevel;
871 } else {
872 //ALOGV("aux ramp: %d %d %d", auxLevel << 16, prevAuxLevel, auxInc);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700873 }
874 }
875}
876
Glenn Kastenc59c0042012-02-02 14:06:11 -0800877size_t AudioMixer::getUnreleasedFrames(int name) const
Eric Laurent071ccd52011-12-22 16:08:41 -0800878{
879 name -= TRACK0;
880 if (uint32_t(name) < MAX_NUM_TRACKS) {
Glenn Kastenc59c0042012-02-02 14:06:11 -0800881 return mState.tracks[name].getUnreleasedFrames();
Eric Laurent071ccd52011-12-22 16:08:41 -0800882 }
883 return 0;
884}
Mathias Agopian65ab4712010-07-14 17:59:35 -0700885
Glenn Kasten01c4ebf2012-02-22 10:47:35 -0800886void AudioMixer::setBufferProvider(int name, AudioBufferProvider* bufferProvider)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700887{
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800888 name -= TRACK0;
Glenn Kasten5798d4e2012-03-08 12:18:35 -0800889 ALOG_ASSERT(uint32_t(name) < MAX_NUM_TRACKS, "bad track name %d", name);
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700890
Andy Hung1d26ddf2014-05-29 15:53:09 -0700891 if (mState.tracks[name].mInputBufferProvider == bufferProvider) {
892 return; // don't reset any buffer providers if identical.
893 }
Andy Hungef7c7fb2014-05-12 16:51:41 -0700894 if (mState.tracks[name].mReformatBufferProvider != NULL) {
895 mState.tracks[name].mReformatBufferProvider->reset();
896 } else if (mState.tracks[name].downmixerBufferProvider != NULL) {
Andy Hung7f475492014-08-25 16:36:37 -0700897 mState.tracks[name].downmixerBufferProvider->reset();
898 } else if (mState.tracks[name].mPostDownmixReformatBufferProvider != NULL) {
899 mState.tracks[name].mPostDownmixReformatBufferProvider->reset();
Andy Hungc5656cc2015-03-26 19:04:33 -0700900 } else if (mState.tracks[name].mTimestretchBufferProvider != NULL) {
901 mState.tracks[name].mTimestretchBufferProvider->reset();
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700902 }
Andy Hungef7c7fb2014-05-12 16:51:41 -0700903
904 mState.tracks[name].mInputBufferProvider = bufferProvider;
Andy Hung0f451e92014-08-04 21:28:47 -0700905 mState.tracks[name].reconfigureBufferProviders();
Mathias Agopian65ab4712010-07-14 17:59:35 -0700906}
907
908
John Grossman4ff14ba2012-02-08 16:37:41 -0800909void AudioMixer::process(int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700910{
John Grossman4ff14ba2012-02-08 16:37:41 -0800911 mState.hook(&mState, pts);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700912}
913
914
John Grossman4ff14ba2012-02-08 16:37:41 -0800915void AudioMixer::process__validate(state_t* state, int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700916{
Steve Block5ff1dd52012-01-05 23:22:43 +0000917 ALOGW_IF(!state->needsChanged,
Mathias Agopian65ab4712010-07-14 17:59:35 -0700918 "in process__validate() but nothing's invalid");
919
920 uint32_t changed = state->needsChanged;
921 state->needsChanged = 0; // clear the validation flag
922
923 // recompute which tracks are enabled / disabled
924 uint32_t enabled = 0;
925 uint32_t disabled = 0;
926 while (changed) {
927 const int i = 31 - __builtin_clz(changed);
928 const uint32_t mask = 1<<i;
929 changed &= ~mask;
930 track_t& t = state->tracks[i];
931 (t.enabled ? enabled : disabled) |= mask;
932 }
933 state->enabledTracks &= ~disabled;
934 state->enabledTracks |= enabled;
935
936 // compute everything we need...
937 int countActiveTracks = 0;
Andy Hung395db4b2014-08-25 17:15:29 -0700938 // TODO: fix all16BitsStereNoResample logic to
939 // either properly handle muted tracks (it should ignore them)
940 // or remove altogether as an obsolete optimization.
Glenn Kasten4c340c62012-01-27 12:33:54 -0800941 bool all16BitsStereoNoResample = true;
942 bool resampling = false;
943 bool volumeRamp = false;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700944 uint32_t en = state->enabledTracks;
945 while (en) {
946 const int i = 31 - __builtin_clz(en);
947 en &= ~(1<<i);
948
949 countActiveTracks++;
950 track_t& t = state->tracks[i];
951 uint32_t n = 0;
Glenn Kastend6fadf02013-10-30 14:37:29 -0700952 // FIXME can overflow (mask is only 3 bits)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700953 n |= NEEDS_CHANNEL_1 + t.channelCount - 1;
Glenn Kastend6fadf02013-10-30 14:37:29 -0700954 if (t.doesResample()) {
955 n |= NEEDS_RESAMPLE;
956 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700957 if (t.auxLevel != 0 && t.auxBuffer != NULL) {
Glenn Kastend6fadf02013-10-30 14:37:29 -0700958 n |= NEEDS_AUX;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700959 }
960
961 if (t.volumeInc[0]|t.volumeInc[1]) {
Glenn Kasten4c340c62012-01-27 12:33:54 -0800962 volumeRamp = true;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700963 } else if (!t.doesResample() && t.volumeRL == 0) {
Glenn Kastend6fadf02013-10-30 14:37:29 -0700964 n |= NEEDS_MUTE;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700965 }
966 t.needs = n;
967
Glenn Kastend6fadf02013-10-30 14:37:29 -0700968 if (n & NEEDS_MUTE) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700969 t.hook = track__nop;
970 } else {
Glenn Kastend6fadf02013-10-30 14:37:29 -0700971 if (n & NEEDS_AUX) {
Glenn Kasten4c340c62012-01-27 12:33:54 -0800972 all16BitsStereoNoResample = false;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700973 }
Glenn Kastend6fadf02013-10-30 14:37:29 -0700974 if (n & NEEDS_RESAMPLE) {
Glenn Kasten4c340c62012-01-27 12:33:54 -0800975 all16BitsStereoNoResample = false;
976 resampling = true;
Andy Hunge93b6b72014-07-17 21:30:53 -0700977 t.hook = getTrackHook(TRACKTYPE_RESAMPLE, t.mMixerChannelCount,
Andy Hung296b7412014-06-17 15:25:47 -0700978 t.mMixerInFormat, t.mMixerFormat);
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700979 ALOGV_IF((n & NEEDS_CHANNEL_COUNT__MASK) > NEEDS_CHANNEL_2,
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700980 "Track %d needs downmix + resample", i);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700981 } else {
982 if ((n & NEEDS_CHANNEL_COUNT__MASK) == NEEDS_CHANNEL_1){
Andy Hunge93b6b72014-07-17 21:30:53 -0700983 t.hook = getTrackHook(
Andy Hung73e62e22015-04-20 12:06:38 -0700984 (t.mMixerChannelMask == AUDIO_CHANNEL_OUT_STEREO // TODO: MONO_HACK
985 && t.channelMask == AUDIO_CHANNEL_OUT_MONO)
Andy Hunge93b6b72014-07-17 21:30:53 -0700986 ? TRACKTYPE_NORESAMPLEMONO : TRACKTYPE_NORESAMPLE,
987 t.mMixerChannelCount,
Andy Hung296b7412014-06-17 15:25:47 -0700988 t.mMixerInFormat, t.mMixerFormat);
Glenn Kasten4c340c62012-01-27 12:33:54 -0800989 all16BitsStereoNoResample = false;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700990 }
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700991 if ((n & NEEDS_CHANNEL_COUNT__MASK) >= NEEDS_CHANNEL_2){
Andy Hunge93b6b72014-07-17 21:30:53 -0700992 t.hook = getTrackHook(TRACKTYPE_NORESAMPLE, t.mMixerChannelCount,
Andy Hung296b7412014-06-17 15:25:47 -0700993 t.mMixerInFormat, t.mMixerFormat);
Jean-Michel Trivi7d5b2622012-04-04 18:54:36 -0700994 ALOGV_IF((n & NEEDS_CHANNEL_COUNT__MASK) > NEEDS_CHANNEL_2,
Jean-Michel Trivi9bd23222012-04-16 13:43:48 -0700995 "Track %d needs downmix", i);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700996 }
997 }
998 }
999 }
1000
1001 // select the processing hooks
1002 state->hook = process__nop;
Glenn Kasten34fca342013-08-13 09:48:14 -07001003 if (countActiveTracks > 0) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001004 if (resampling) {
1005 if (!state->outputTemp) {
1006 state->outputTemp = new int32_t[MAX_NUM_CHANNELS * state->frameCount];
1007 }
1008 if (!state->resampleTemp) {
1009 state->resampleTemp = new int32_t[MAX_NUM_CHANNELS * state->frameCount];
1010 }
1011 state->hook = process__genericResampling;
1012 } else {
1013 if (state->outputTemp) {
1014 delete [] state->outputTemp;
Glenn Kastene0feee32011-12-13 11:53:26 -08001015 state->outputTemp = NULL;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001016 }
1017 if (state->resampleTemp) {
1018 delete [] state->resampleTemp;
Glenn Kastene0feee32011-12-13 11:53:26 -08001019 state->resampleTemp = NULL;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001020 }
1021 state->hook = process__genericNoResampling;
1022 if (all16BitsStereoNoResample && !volumeRamp) {
1023 if (countActiveTracks == 1) {
Andy Hung296b7412014-06-17 15:25:47 -07001024 const int i = 31 - __builtin_clz(state->enabledTracks);
1025 track_t& t = state->tracks[i];
Andy Hung395db4b2014-08-25 17:15:29 -07001026 if ((t.needs & NEEDS_MUTE) == 0) {
1027 // The check prevents a muted track from acquiring a process hook.
1028 //
1029 // This is dangerous if the track is MONO as that requires
1030 // special case handling due to implicit channel duplication.
1031 // Stereo or Multichannel should actually be fine here.
1032 state->hook = getProcessHook(PROCESSTYPE_NORESAMPLEONETRACK,
1033 t.mMixerChannelCount, t.mMixerInFormat, t.mMixerFormat);
1034 }
Mathias Agopian65ab4712010-07-14 17:59:35 -07001035 }
1036 }
1037 }
1038 }
1039
Steve Block3856b092011-10-20 11:56:00 +01001040 ALOGV("mixer configuration change: %d activeTracks (%08x) "
Mathias Agopian65ab4712010-07-14 17:59:35 -07001041 "all16BitsStereoNoResample=%d, resampling=%d, volumeRamp=%d",
1042 countActiveTracks, state->enabledTracks,
1043 all16BitsStereoNoResample, resampling, volumeRamp);
1044
John Grossman4ff14ba2012-02-08 16:37:41 -08001045 state->hook(state, pts);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001046
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -08001047 // Now that the volume ramp has been done, set optimal state and
1048 // track hooks for subsequent mixer process
Glenn Kasten34fca342013-08-13 09:48:14 -07001049 if (countActiveTracks > 0) {
Glenn Kasten4c340c62012-01-27 12:33:54 -08001050 bool allMuted = true;
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -08001051 uint32_t en = state->enabledTracks;
1052 while (en) {
1053 const int i = 31 - __builtin_clz(en);
1054 en &= ~(1<<i);
1055 track_t& t = state->tracks[i];
Glenn Kasten6e2ebe92013-08-13 09:14:51 -07001056 if (!t.doesResample() && t.volumeRL == 0) {
Glenn Kastend6fadf02013-10-30 14:37:29 -07001057 t.needs |= NEEDS_MUTE;
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -08001058 t.hook = track__nop;
1059 } else {
Glenn Kasten4c340c62012-01-27 12:33:54 -08001060 allMuted = false;
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -08001061 }
1062 }
1063 if (allMuted) {
1064 state->hook = process__nop;
1065 } else if (all16BitsStereoNoResample) {
1066 if (countActiveTracks == 1) {
Andy Hunge93b6b72014-07-17 21:30:53 -07001067 const int i = 31 - __builtin_clz(state->enabledTracks);
1068 track_t& t = state->tracks[i];
Andy Hung395db4b2014-08-25 17:15:29 -07001069 // Muted single tracks handled by allMuted above.
Andy Hunge93b6b72014-07-17 21:30:53 -07001070 state->hook = getProcessHook(PROCESSTYPE_NORESAMPLEONETRACK,
1071 t.mMixerChannelCount, t.mMixerInFormat, t.mMixerFormat);
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -08001072 }
1073 }
1074 }
Mathias Agopian65ab4712010-07-14 17:59:35 -07001075}
1076
Mathias Agopian65ab4712010-07-14 17:59:35 -07001077
Glenn Kasten85ab62c2012-11-01 11:11:38 -07001078void AudioMixer::track__genericResample(track_t* t, int32_t* out, size_t outFrameCount,
1079 int32_t* temp, int32_t* aux)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001080{
Andy Hung296b7412014-06-17 15:25:47 -07001081 ALOGVV("track__genericResample\n");
Mathias Agopian65ab4712010-07-14 17:59:35 -07001082 t->resampler->setSampleRate(t->sampleRate);
1083
1084 // ramp gain - resample to temp buffer and scale/mix in 2nd step
1085 if (aux != NULL) {
1086 // always resample with unity gain when sending to auxiliary buffer to be able
1087 // to apply send level after resampling
Andy Hung5e58b0a2014-06-23 19:07:29 -07001088 t->resampler->setVolume(UNITY_GAIN_FLOAT, UNITY_GAIN_FLOAT);
Andy Hunge93b6b72014-07-17 21:30:53 -07001089 memset(temp, 0, outFrameCount * t->mMixerChannelCount * sizeof(int32_t));
Mathias Agopian65ab4712010-07-14 17:59:35 -07001090 t->resampler->resample(temp, outFrameCount, t->bufferProvider);
Glenn Kastenf6b16782011-12-15 09:51:17 -08001091 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1]|t->auxInc)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001092 volumeRampStereo(t, out, outFrameCount, temp, aux);
1093 } else {
1094 volumeStereo(t, out, outFrameCount, temp, aux);
1095 }
1096 } else {
Glenn Kastenf6b16782011-12-15 09:51:17 -08001097 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1])) {
Andy Hung5e58b0a2014-06-23 19:07:29 -07001098 t->resampler->setVolume(UNITY_GAIN_FLOAT, UNITY_GAIN_FLOAT);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001099 memset(temp, 0, outFrameCount * MAX_NUM_CHANNELS * sizeof(int32_t));
1100 t->resampler->resample(temp, outFrameCount, t->bufferProvider);
1101 volumeRampStereo(t, out, outFrameCount, temp, aux);
1102 }
1103
1104 // constant gain
1105 else {
Andy Hung5e58b0a2014-06-23 19:07:29 -07001106 t->resampler->setVolume(t->mVolume[0], t->mVolume[1]);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001107 t->resampler->resample(out, outFrameCount, t->bufferProvider);
1108 }
1109 }
1110}
1111
Andy Hungee931ff2014-01-28 13:44:14 -08001112void AudioMixer::track__nop(track_t* t __unused, int32_t* out __unused,
1113 size_t outFrameCount __unused, int32_t* temp __unused, int32_t* aux __unused)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001114{
1115}
1116
Glenn Kasten85ab62c2012-11-01 11:11:38 -07001117void AudioMixer::volumeRampStereo(track_t* t, int32_t* out, size_t frameCount, int32_t* temp,
1118 int32_t* aux)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001119{
1120 int32_t vl = t->prevVolume[0];
1121 int32_t vr = t->prevVolume[1];
1122 const int32_t vlInc = t->volumeInc[0];
1123 const int32_t vrInc = t->volumeInc[1];
1124
Steve Blockb8a80522011-12-20 16:23:08 +00001125 //ALOGD("[0] %p: inc=%f, v0=%f, v1=%d, final=%f, count=%d",
Mathias Agopian65ab4712010-07-14 17:59:35 -07001126 // t, vlInc/65536.0f, vl/65536.0f, t->volume[0],
1127 // (vl + vlInc*frameCount)/65536.0f, frameCount);
1128
1129 // ramp volume
Glenn Kastenf6b16782011-12-15 09:51:17 -08001130 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001131 int32_t va = t->prevAuxLevel;
1132 const int32_t vaInc = t->auxInc;
1133 int32_t l;
1134 int32_t r;
1135
1136 do {
1137 l = (*temp++ >> 12);
1138 r = (*temp++ >> 12);
1139 *out++ += (vl >> 16) * l;
1140 *out++ += (vr >> 16) * r;
1141 *aux++ += (va >> 17) * (l + r);
1142 vl += vlInc;
1143 vr += vrInc;
1144 va += vaInc;
1145 } while (--frameCount);
1146 t->prevAuxLevel = va;
1147 } else {
1148 do {
1149 *out++ += (vl >> 16) * (*temp++ >> 12);
1150 *out++ += (vr >> 16) * (*temp++ >> 12);
1151 vl += vlInc;
1152 vr += vrInc;
1153 } while (--frameCount);
1154 }
1155 t->prevVolume[0] = vl;
1156 t->prevVolume[1] = vr;
Glenn Kastena1117922012-01-26 10:53:32 -08001157 t->adjustVolumeRamp(aux != NULL);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001158}
1159
Glenn Kasten85ab62c2012-11-01 11:11:38 -07001160void AudioMixer::volumeStereo(track_t* t, int32_t* out, size_t frameCount, int32_t* temp,
1161 int32_t* aux)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001162{
1163 const int16_t vl = t->volume[0];
1164 const int16_t vr = t->volume[1];
1165
Glenn Kastenf6b16782011-12-15 09:51:17 -08001166 if (CC_UNLIKELY(aux != NULL)) {
Glenn Kasten3b81aca2012-01-27 15:26:23 -08001167 const int16_t va = t->auxLevel;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001168 do {
1169 int16_t l = (int16_t)(*temp++ >> 12);
1170 int16_t r = (int16_t)(*temp++ >> 12);
1171 out[0] = mulAdd(l, vl, out[0]);
1172 int16_t a = (int16_t)(((int32_t)l + r) >> 1);
1173 out[1] = mulAdd(r, vr, out[1]);
1174 out += 2;
1175 aux[0] = mulAdd(a, va, aux[0]);
1176 aux++;
1177 } while (--frameCount);
1178 } else {
1179 do {
1180 int16_t l = (int16_t)(*temp++ >> 12);
1181 int16_t r = (int16_t)(*temp++ >> 12);
1182 out[0] = mulAdd(l, vl, out[0]);
1183 out[1] = mulAdd(r, vr, out[1]);
1184 out += 2;
1185 } while (--frameCount);
1186 }
1187}
1188
Andy Hungee931ff2014-01-28 13:44:14 -08001189void AudioMixer::track__16BitsStereo(track_t* t, int32_t* out, size_t frameCount,
1190 int32_t* temp __unused, int32_t* aux)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001191{
Andy Hung296b7412014-06-17 15:25:47 -07001192 ALOGVV("track__16BitsStereo\n");
Glenn Kasten54c3b662012-01-06 07:46:30 -08001193 const int16_t *in = static_cast<const int16_t *>(t->in);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001194
Glenn Kastenf6b16782011-12-15 09:51:17 -08001195 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001196 int32_t l;
1197 int32_t r;
1198 // ramp gain
Glenn Kastenf6b16782011-12-15 09:51:17 -08001199 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1]|t->auxInc)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001200 int32_t vl = t->prevVolume[0];
1201 int32_t vr = t->prevVolume[1];
1202 int32_t va = t->prevAuxLevel;
1203 const int32_t vlInc = t->volumeInc[0];
1204 const int32_t vrInc = t->volumeInc[1];
1205 const int32_t vaInc = t->auxInc;
Steve Blockb8a80522011-12-20 16:23:08 +00001206 // ALOGD("[1] %p: inc=%f, v0=%f, v1=%d, final=%f, count=%d",
Mathias Agopian65ab4712010-07-14 17:59:35 -07001207 // t, vlInc/65536.0f, vl/65536.0f, t->volume[0],
1208 // (vl + vlInc*frameCount)/65536.0f, frameCount);
1209
1210 do {
1211 l = (int32_t)*in++;
1212 r = (int32_t)*in++;
1213 *out++ += (vl >> 16) * l;
1214 *out++ += (vr >> 16) * r;
1215 *aux++ += (va >> 17) * (l + r);
1216 vl += vlInc;
1217 vr += vrInc;
1218 va += vaInc;
1219 } while (--frameCount);
1220
1221 t->prevVolume[0] = vl;
1222 t->prevVolume[1] = vr;
1223 t->prevAuxLevel = va;
1224 t->adjustVolumeRamp(true);
1225 }
1226
1227 // constant gain
1228 else {
1229 const uint32_t vrl = t->volumeRL;
1230 const int16_t va = (int16_t)t->auxLevel;
1231 do {
Glenn Kasten54c3b662012-01-06 07:46:30 -08001232 uint32_t rl = *reinterpret_cast<const uint32_t *>(in);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001233 int16_t a = (int16_t)(((int32_t)in[0] + in[1]) >> 1);
1234 in += 2;
1235 out[0] = mulAddRL(1, rl, vrl, out[0]);
1236 out[1] = mulAddRL(0, rl, vrl, out[1]);
1237 out += 2;
1238 aux[0] = mulAdd(a, 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("[1] %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 *out++ += (vl >> 16) * (int32_t) *in++;
1256 *out++ += (vr >> 16) * (int32_t) *in++;
1257 vl += vlInc;
1258 vr += vrInc;
1259 } while (--frameCount);
1260
1261 t->prevVolume[0] = vl;
1262 t->prevVolume[1] = vr;
1263 t->adjustVolumeRamp(false);
1264 }
1265
1266 // constant gain
1267 else {
1268 const uint32_t vrl = t->volumeRL;
1269 do {
Glenn Kasten54c3b662012-01-06 07:46:30 -08001270 uint32_t rl = *reinterpret_cast<const uint32_t *>(in);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001271 in += 2;
1272 out[0] = mulAddRL(1, rl, vrl, out[0]);
1273 out[1] = mulAddRL(0, rl, vrl, out[1]);
1274 out += 2;
1275 } while (--frameCount);
1276 }
1277 }
1278 t->in = in;
1279}
1280
Andy Hungee931ff2014-01-28 13:44:14 -08001281void AudioMixer::track__16BitsMono(track_t* t, int32_t* out, size_t frameCount,
1282 int32_t* temp __unused, int32_t* aux)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001283{
Andy Hung296b7412014-06-17 15:25:47 -07001284 ALOGVV("track__16BitsMono\n");
Glenn Kasten54c3b662012-01-06 07:46:30 -08001285 const int16_t *in = static_cast<int16_t const *>(t->in);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001286
Glenn Kastenf6b16782011-12-15 09:51:17 -08001287 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001288 // ramp gain
Glenn Kastenf6b16782011-12-15 09:51:17 -08001289 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1]|t->auxInc)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001290 int32_t vl = t->prevVolume[0];
1291 int32_t vr = t->prevVolume[1];
1292 int32_t va = t->prevAuxLevel;
1293 const int32_t vlInc = t->volumeInc[0];
1294 const int32_t vrInc = t->volumeInc[1];
1295 const int32_t vaInc = t->auxInc;
1296
Steve Blockb8a80522011-12-20 16:23:08 +00001297 // ALOGD("[2] %p: inc=%f, v0=%f, v1=%d, final=%f, count=%d",
Mathias Agopian65ab4712010-07-14 17:59:35 -07001298 // t, vlInc/65536.0f, vl/65536.0f, t->volume[0],
1299 // (vl + vlInc*frameCount)/65536.0f, frameCount);
1300
1301 do {
1302 int32_t l = *in++;
1303 *out++ += (vl >> 16) * l;
1304 *out++ += (vr >> 16) * l;
1305 *aux++ += (va >> 16) * l;
1306 vl += vlInc;
1307 vr += vrInc;
1308 va += vaInc;
1309 } while (--frameCount);
1310
1311 t->prevVolume[0] = vl;
1312 t->prevVolume[1] = vr;
1313 t->prevAuxLevel = va;
1314 t->adjustVolumeRamp(true);
1315 }
1316 // constant gain
1317 else {
1318 const int16_t vl = t->volume[0];
1319 const int16_t vr = t->volume[1];
1320 const int16_t va = (int16_t)t->auxLevel;
1321 do {
1322 int16_t l = *in++;
1323 out[0] = mulAdd(l, vl, out[0]);
1324 out[1] = mulAdd(l, vr, out[1]);
1325 out += 2;
1326 aux[0] = mulAdd(l, va, aux[0]);
1327 aux++;
1328 } while (--frameCount);
1329 }
1330 } else {
1331 // ramp gain
Glenn Kastenf6b16782011-12-15 09:51:17 -08001332 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1])) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001333 int32_t vl = t->prevVolume[0];
1334 int32_t vr = t->prevVolume[1];
1335 const int32_t vlInc = t->volumeInc[0];
1336 const int32_t vrInc = t->volumeInc[1];
1337
Steve Blockb8a80522011-12-20 16:23:08 +00001338 // ALOGD("[2] %p: inc=%f, v0=%f, v1=%d, final=%f, count=%d",
Mathias Agopian65ab4712010-07-14 17:59:35 -07001339 // t, vlInc/65536.0f, vl/65536.0f, t->volume[0],
1340 // (vl + vlInc*frameCount)/65536.0f, frameCount);
1341
1342 do {
1343 int32_t l = *in++;
1344 *out++ += (vl >> 16) * l;
1345 *out++ += (vr >> 16) * l;
1346 vl += vlInc;
1347 vr += vrInc;
1348 } while (--frameCount);
1349
1350 t->prevVolume[0] = vl;
1351 t->prevVolume[1] = vr;
1352 t->adjustVolumeRamp(false);
1353 }
1354 // constant gain
1355 else {
1356 const int16_t vl = t->volume[0];
1357 const int16_t vr = t->volume[1];
1358 do {
1359 int16_t l = *in++;
1360 out[0] = mulAdd(l, vl, out[0]);
1361 out[1] = mulAdd(l, vr, out[1]);
1362 out += 2;
1363 } while (--frameCount);
1364 }
1365 }
1366 t->in = in;
1367}
1368
Mathias Agopian65ab4712010-07-14 17:59:35 -07001369// no-op case
John Grossman4ff14ba2012-02-08 16:37:41 -08001370void AudioMixer::process__nop(state_t* state, int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001371{
Andy Hung296b7412014-06-17 15:25:47 -07001372 ALOGVV("process__nop\n");
Mathias Agopian65ab4712010-07-14 17:59:35 -07001373 uint32_t e0 = state->enabledTracks;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001374 while (e0) {
1375 // process by group of tracks with same output buffer to
1376 // avoid multiple memset() on same buffer
1377 uint32_t e1 = e0, e2 = e0;
1378 int i = 31 - __builtin_clz(e1);
Glenn Kastenfc900c92013-02-18 12:47:49 -08001379 {
1380 track_t& t1 = state->tracks[i];
Mathias Agopian65ab4712010-07-14 17:59:35 -07001381 e2 &= ~(1<<i);
Glenn Kastenfc900c92013-02-18 12:47:49 -08001382 while (e2) {
1383 i = 31 - __builtin_clz(e2);
1384 e2 &= ~(1<<i);
1385 track_t& t2 = state->tracks[i];
1386 if (CC_UNLIKELY(t2.mainBuffer != t1.mainBuffer)) {
1387 e1 &= ~(1<<i);
1388 }
Mathias Agopian65ab4712010-07-14 17:59:35 -07001389 }
Glenn Kastenfc900c92013-02-18 12:47:49 -08001390 e0 &= ~(e1);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001391
Andy Hunge93b6b72014-07-17 21:30:53 -07001392 memset(t1.mainBuffer, 0, state->frameCount * t1.mMixerChannelCount
Andy Hung78820702014-02-28 16:23:02 -08001393 * audio_bytes_per_sample(t1.mMixerFormat));
Glenn Kastenfc900c92013-02-18 12:47:49 -08001394 }
Mathias Agopian65ab4712010-07-14 17:59:35 -07001395
1396 while (e1) {
1397 i = 31 - __builtin_clz(e1);
1398 e1 &= ~(1<<i);
Glenn Kastenfc900c92013-02-18 12:47:49 -08001399 {
1400 track_t& t3 = state->tracks[i];
1401 size_t outFrames = state->frameCount;
1402 while (outFrames) {
1403 t3.buffer.frameCount = outFrames;
1404 int64_t outputPTS = calculateOutputPTS(
1405 t3, pts, state->frameCount - outFrames);
1406 t3.bufferProvider->getNextBuffer(&t3.buffer, outputPTS);
1407 if (t3.buffer.raw == NULL) break;
1408 outFrames -= t3.buffer.frameCount;
1409 t3.bufferProvider->releaseBuffer(&t3.buffer);
1410 }
Mathias Agopian65ab4712010-07-14 17:59:35 -07001411 }
1412 }
1413 }
1414}
1415
1416// generic code without resampling
John Grossman4ff14ba2012-02-08 16:37:41 -08001417void AudioMixer::process__genericNoResampling(state_t* state, int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001418{
Andy Hung296b7412014-06-17 15:25:47 -07001419 ALOGVV("process__genericNoResampling\n");
Mathias Agopian65ab4712010-07-14 17:59:35 -07001420 int32_t outTemp[BLOCKSIZE * MAX_NUM_CHANNELS] __attribute__((aligned(32)));
1421
1422 // acquire each track's buffer
1423 uint32_t enabledTracks = state->enabledTracks;
1424 uint32_t e0 = enabledTracks;
1425 while (e0) {
1426 const int i = 31 - __builtin_clz(e0);
1427 e0 &= ~(1<<i);
1428 track_t& t = state->tracks[i];
1429 t.buffer.frameCount = state->frameCount;
John Grossman4ff14ba2012-02-08 16:37:41 -08001430 t.bufferProvider->getNextBuffer(&t.buffer, pts);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001431 t.frameCount = t.buffer.frameCount;
1432 t.in = t.buffer.raw;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001433 }
1434
1435 e0 = enabledTracks;
1436 while (e0) {
1437 // process by group of tracks with same output buffer to
1438 // optimize cache use
1439 uint32_t e1 = e0, e2 = e0;
1440 int j = 31 - __builtin_clz(e1);
1441 track_t& t1 = state->tracks[j];
1442 e2 &= ~(1<<j);
1443 while (e2) {
1444 j = 31 - __builtin_clz(e2);
1445 e2 &= ~(1<<j);
1446 track_t& t2 = state->tracks[j];
Glenn Kastenf6b16782011-12-15 09:51:17 -08001447 if (CC_UNLIKELY(t2.mainBuffer != t1.mainBuffer)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001448 e1 &= ~(1<<j);
1449 }
1450 }
1451 e0 &= ~(e1);
1452 // this assumes output 16 bits stereo, no resampling
1453 int32_t *out = t1.mainBuffer;
1454 size_t numFrames = 0;
1455 do {
1456 memset(outTemp, 0, sizeof(outTemp));
1457 e2 = e1;
1458 while (e2) {
1459 const int i = 31 - __builtin_clz(e2);
1460 e2 &= ~(1<<i);
1461 track_t& t = state->tracks[i];
1462 size_t outFrames = BLOCKSIZE;
1463 int32_t *aux = NULL;
Glenn Kastend6fadf02013-10-30 14:37:29 -07001464 if (CC_UNLIKELY(t.needs & NEEDS_AUX)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001465 aux = t.auxBuffer + numFrames;
1466 }
1467 while (outFrames) {
Gaurav Kumar7e79cd22014-01-06 10:57:18 +05301468 // t.in == NULL can happen if the track was flushed just after having
1469 // been enabled for mixing.
1470 if (t.in == NULL) {
1471 enabledTracks &= ~(1<<i);
1472 e1 &= ~(1<<i);
1473 break;
1474 }
Mathias Agopian65ab4712010-07-14 17:59:35 -07001475 size_t inFrames = (t.frameCount > outFrames)?outFrames:t.frameCount;
Glenn Kasten34fca342013-08-13 09:48:14 -07001476 if (inFrames > 0) {
Andy Hunge93b6b72014-07-17 21:30:53 -07001477 t.hook(&t, outTemp + (BLOCKSIZE - outFrames) * t.mMixerChannelCount,
1478 inFrames, state->resampleTemp, aux);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001479 t.frameCount -= inFrames;
1480 outFrames -= inFrames;
Glenn Kastenf6b16782011-12-15 09:51:17 -08001481 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001482 aux += inFrames;
1483 }
1484 }
1485 if (t.frameCount == 0 && outFrames) {
1486 t.bufferProvider->releaseBuffer(&t.buffer);
Glenn Kasten85ab62c2012-11-01 11:11:38 -07001487 t.buffer.frameCount = (state->frameCount - numFrames) -
1488 (BLOCKSIZE - outFrames);
John Grossman4ff14ba2012-02-08 16:37:41 -08001489 int64_t outputPTS = calculateOutputPTS(
1490 t, pts, numFrames + (BLOCKSIZE - outFrames));
1491 t.bufferProvider->getNextBuffer(&t.buffer, outputPTS);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001492 t.in = t.buffer.raw;
1493 if (t.in == NULL) {
1494 enabledTracks &= ~(1<<i);
1495 e1 &= ~(1<<i);
1496 break;
1497 }
1498 t.frameCount = t.buffer.frameCount;
1499 }
1500 }
1501 }
Andy Hung296b7412014-06-17 15:25:47 -07001502
1503 convertMixerFormat(out, t1.mMixerFormat, outTemp, t1.mMixerInFormat,
Andy Hunge93b6b72014-07-17 21:30:53 -07001504 BLOCKSIZE * t1.mMixerChannelCount);
Andy Hung296b7412014-06-17 15:25:47 -07001505 // TODO: fix ugly casting due to choice of out pointer type
1506 out = reinterpret_cast<int32_t*>((uint8_t*)out
Andy Hunge93b6b72014-07-17 21:30:53 -07001507 + BLOCKSIZE * t1.mMixerChannelCount
1508 * audio_bytes_per_sample(t1.mMixerFormat));
Mathias Agopian65ab4712010-07-14 17:59:35 -07001509 numFrames += BLOCKSIZE;
1510 } while (numFrames < state->frameCount);
1511 }
1512
1513 // release each track's buffer
1514 e0 = enabledTracks;
1515 while (e0) {
1516 const int i = 31 - __builtin_clz(e0);
1517 e0 &= ~(1<<i);
1518 track_t& t = state->tracks[i];
1519 t.bufferProvider->releaseBuffer(&t.buffer);
1520 }
1521}
1522
1523
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -08001524// generic code with resampling
John Grossman4ff14ba2012-02-08 16:37:41 -08001525void AudioMixer::process__genericResampling(state_t* state, int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001526{
Andy Hung296b7412014-06-17 15:25:47 -07001527 ALOGVV("process__genericResampling\n");
Glenn Kasten54c3b662012-01-06 07:46:30 -08001528 // this const just means that local variable outTemp doesn't change
Mathias Agopian65ab4712010-07-14 17:59:35 -07001529 int32_t* const outTemp = state->outputTemp;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001530 size_t numFrames = state->frameCount;
1531
1532 uint32_t e0 = state->enabledTracks;
1533 while (e0) {
1534 // process by group of tracks with same output buffer
1535 // to optimize cache use
1536 uint32_t e1 = e0, e2 = e0;
1537 int j = 31 - __builtin_clz(e1);
1538 track_t& t1 = state->tracks[j];
1539 e2 &= ~(1<<j);
1540 while (e2) {
1541 j = 31 - __builtin_clz(e2);
1542 e2 &= ~(1<<j);
1543 track_t& t2 = state->tracks[j];
Glenn Kastenf6b16782011-12-15 09:51:17 -08001544 if (CC_UNLIKELY(t2.mainBuffer != t1.mainBuffer)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001545 e1 &= ~(1<<j);
1546 }
1547 }
1548 e0 &= ~(e1);
1549 int32_t *out = t1.mainBuffer;
Andy Hunge93b6b72014-07-17 21:30:53 -07001550 memset(outTemp, 0, sizeof(*outTemp) * t1.mMixerChannelCount * state->frameCount);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001551 while (e1) {
1552 const int i = 31 - __builtin_clz(e1);
1553 e1 &= ~(1<<i);
1554 track_t& t = state->tracks[i];
1555 int32_t *aux = NULL;
Glenn Kastend6fadf02013-10-30 14:37:29 -07001556 if (CC_UNLIKELY(t.needs & NEEDS_AUX)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001557 aux = t.auxBuffer;
1558 }
1559
1560 // this is a little goofy, on the resampling case we don't
1561 // acquire/release the buffers because it's done by
1562 // the resampler.
Glenn Kastend6fadf02013-10-30 14:37:29 -07001563 if (t.needs & NEEDS_RESAMPLE) {
John Grossman4ff14ba2012-02-08 16:37:41 -08001564 t.resampler->setPTS(pts);
Glenn Kastena1117922012-01-26 10:53:32 -08001565 t.hook(&t, outTemp, numFrames, state->resampleTemp, aux);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001566 } else {
1567
1568 size_t outFrames = 0;
1569
1570 while (outFrames < numFrames) {
1571 t.buffer.frameCount = numFrames - outFrames;
John Grossman4ff14ba2012-02-08 16:37:41 -08001572 int64_t outputPTS = calculateOutputPTS(t, pts, outFrames);
1573 t.bufferProvider->getNextBuffer(&t.buffer, outputPTS);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001574 t.in = t.buffer.raw;
1575 // t.in == NULL can happen if the track was flushed just after having
1576 // been enabled for mixing.
1577 if (t.in == NULL) break;
1578
Glenn Kastenf6b16782011-12-15 09:51:17 -08001579 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001580 aux += outFrames;
1581 }
Andy Hunge93b6b72014-07-17 21:30:53 -07001582 t.hook(&t, outTemp + outFrames * t.mMixerChannelCount, t.buffer.frameCount,
Glenn Kasten85ab62c2012-11-01 11:11:38 -07001583 state->resampleTemp, aux);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001584 outFrames += t.buffer.frameCount;
1585 t.bufferProvider->releaseBuffer(&t.buffer);
1586 }
1587 }
1588 }
Andy Hunge93b6b72014-07-17 21:30:53 -07001589 convertMixerFormat(out, t1.mMixerFormat,
1590 outTemp, t1.mMixerInFormat, numFrames * t1.mMixerChannelCount);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001591 }
1592}
1593
1594// one track, 16 bits stereo without resampling is the most common case
John Grossman4ff14ba2012-02-08 16:37:41 -08001595void AudioMixer::process__OneTrack16BitsStereoNoResampling(state_t* state,
1596 int64_t pts)
Mathias Agopian65ab4712010-07-14 17:59:35 -07001597{
Andy Hung296b7412014-06-17 15:25:47 -07001598 ALOGVV("process__OneTrack16BitsStereoNoResampling\n");
Glenn Kasten99e53b82012-01-19 08:59:58 -08001599 // This method is only called when state->enabledTracks has exactly
1600 // one bit set. The asserts below would verify this, but are commented out
1601 // since the whole point of this method is to optimize performance.
Glenn Kasten5798d4e2012-03-08 12:18:35 -08001602 //ALOG_ASSERT(0 != state->enabledTracks, "no tracks enabled");
Mathias Agopian65ab4712010-07-14 17:59:35 -07001603 const int i = 31 - __builtin_clz(state->enabledTracks);
Glenn Kasten5798d4e2012-03-08 12:18:35 -08001604 //ALOG_ASSERT((1 << i) == state->enabledTracks, "more than 1 track enabled");
Mathias Agopian65ab4712010-07-14 17:59:35 -07001605 const track_t& t = state->tracks[i];
1606
1607 AudioBufferProvider::Buffer& b(t.buffer);
1608
1609 int32_t* out = t.mainBuffer;
Andy Hungf8a106a2014-05-29 18:52:38 -07001610 float *fout = reinterpret_cast<float*>(out);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001611 size_t numFrames = state->frameCount;
1612
1613 const int16_t vl = t.volume[0];
1614 const int16_t vr = t.volume[1];
1615 const uint32_t vrl = t.volumeRL;
1616 while (numFrames) {
1617 b.frameCount = numFrames;
John Grossman4ff14ba2012-02-08 16:37:41 -08001618 int64_t outputPTS = calculateOutputPTS(t, pts, out - t.mainBuffer);
1619 t.bufferProvider->getNextBuffer(&b, outputPTS);
Glenn Kasten54c3b662012-01-06 07:46:30 -08001620 const int16_t *in = b.i16;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001621
1622 // in == NULL can happen if the track was flushed just after having
1623 // been enabled for mixing.
Andy Hungf8a106a2014-05-29 18:52:38 -07001624 if (in == NULL || (((uintptr_t)in) & 3)) {
1625 memset(out, 0, numFrames
Andy Hunge93b6b72014-07-17 21:30:53 -07001626 * t.mMixerChannelCount * audio_bytes_per_sample(t.mMixerFormat));
Andy Hung395db4b2014-08-25 17:15:29 -07001627 ALOGE_IF((((uintptr_t)in) & 3),
1628 "process__OneTrack16BitsStereoNoResampling: misaligned buffer"
1629 " %p track %d, channels %d, needs %08x, volume %08x vfl %f vfr %f",
1630 in, i, t.channelCount, t.needs, vrl, t.mVolume[0], t.mVolume[1]);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001631 return;
1632 }
1633 size_t outFrames = b.frameCount;
1634
Andy Hung78820702014-02-28 16:23:02 -08001635 switch (t.mMixerFormat) {
Andy Hungf8a106a2014-05-29 18:52:38 -07001636 case AUDIO_FORMAT_PCM_FLOAT:
Mathias Agopian65ab4712010-07-14 17:59:35 -07001637 do {
Glenn Kasten54c3b662012-01-06 07:46:30 -08001638 uint32_t rl = *reinterpret_cast<const uint32_t *>(in);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001639 in += 2;
Andy Hunga1ab7cc2014-02-24 19:26:52 -08001640 int32_t l = mulRL(1, rl, vrl);
1641 int32_t r = mulRL(0, rl, vrl);
Andy Hung84a0c6e2014-04-02 11:24:53 -07001642 *fout++ = float_from_q4_27(l);
1643 *fout++ = float_from_q4_27(r);
Andy Hung3375bde2014-02-28 15:51:47 -08001644 // Note: In case of later int16_t sink output,
1645 // conversion and clamping is done by memcpy_to_i16_from_float().
Mathias Agopian65ab4712010-07-14 17:59:35 -07001646 } while (--outFrames);
Andy Hungf8a106a2014-05-29 18:52:38 -07001647 break;
Andy Hunga1ab7cc2014-02-24 19:26:52 -08001648 case AUDIO_FORMAT_PCM_16_BIT:
Andy Hung97ae8242014-05-30 10:35:47 -07001649 if (CC_UNLIKELY(uint32_t(vl) > UNITY_GAIN_INT || uint32_t(vr) > UNITY_GAIN_INT)) {
Andy Hunga1ab7cc2014-02-24 19:26:52 -08001650 // volume is boosted, so we might need to clamp even though
1651 // we process only one track.
1652 do {
1653 uint32_t rl = *reinterpret_cast<const uint32_t *>(in);
1654 in += 2;
1655 int32_t l = mulRL(1, rl, vrl) >> 12;
1656 int32_t r = mulRL(0, rl, vrl) >> 12;
1657 // clamping...
1658 l = clamp16(l);
1659 r = clamp16(r);
1660 *out++ = (r<<16) | (l & 0xFFFF);
1661 } while (--outFrames);
1662 } else {
1663 do {
1664 uint32_t rl = *reinterpret_cast<const uint32_t *>(in);
1665 in += 2;
1666 int32_t l = mulRL(1, rl, vrl) >> 12;
1667 int32_t r = mulRL(0, rl, vrl) >> 12;
1668 *out++ = (r<<16) | (l & 0xFFFF);
1669 } while (--outFrames);
1670 }
1671 break;
1672 default:
Andy Hung78820702014-02-28 16:23:02 -08001673 LOG_ALWAYS_FATAL("bad mixer format: %d", t.mMixerFormat);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001674 }
1675 numFrames -= b.frameCount;
1676 t.bufferProvider->releaseBuffer(&b);
1677 }
1678}
1679
John Grossman4ff14ba2012-02-08 16:37:41 -08001680int64_t AudioMixer::calculateOutputPTS(const track_t& t, int64_t basePTS,
1681 int outputFrameIndex)
1682{
Glenn Kasten6e2ebe92013-08-13 09:14:51 -07001683 if (AudioBufferProvider::kInvalidPTS == basePTS) {
John Grossman4ff14ba2012-02-08 16:37:41 -08001684 return AudioBufferProvider::kInvalidPTS;
Glenn Kasten6e2ebe92013-08-13 09:14:51 -07001685 }
John Grossman4ff14ba2012-02-08 16:37:41 -08001686
Glenn Kasten52008f82012-03-18 09:34:41 -07001687 return basePTS + ((outputFrameIndex * sLocalTimeFreq) / t.sampleRate);
1688}
1689
1690/*static*/ uint64_t AudioMixer::sLocalTimeFreq;
1691/*static*/ pthread_once_t AudioMixer::sOnceControl = PTHREAD_ONCE_INIT;
1692
1693/*static*/ void AudioMixer::sInitRoutine()
1694{
1695 LocalClock lc;
Andy Hung34803d52014-07-16 21:41:35 -07001696 sLocalTimeFreq = lc.getLocalFreq(); // for the resampler
Glenn Kasten49c34ac2013-10-30 14:37:01 -07001697
Andy Hung34803d52014-07-16 21:41:35 -07001698 DownmixerBufferProvider::init(); // for the downmixer
John Grossman4ff14ba2012-02-08 16:37:41 -08001699}
1700
Andy Hunge93b6b72014-07-17 21:30:53 -07001701/* TODO: consider whether this level of optimization is necessary.
1702 * Perhaps just stick with a single for loop.
1703 */
1704
1705// Needs to derive a compile time constant (constexpr). Could be targeted to go
1706// to a MONOVOL mixtype based on MAX_NUM_VOLUMES, but that's an unnecessary complication.
Chih-Hung Hsiehbf291732016-05-17 15:16:07 -07001707#define MIXTYPE_MONOVOL(mixtype) ((mixtype) == MIXTYPE_MULTI ? MIXTYPE_MULTI_MONOVOL : \
1708 (mixtype) == MIXTYPE_MULTI_SAVEONLY ? MIXTYPE_MULTI_SAVEONLY_MONOVOL : (mixtype))
Andy Hunge93b6b72014-07-17 21:30:53 -07001709
1710/* MIXTYPE (see AudioMixerOps.h MIXTYPE_* enumeration)
1711 * TO: int32_t (Q4.27) or float
1712 * TI: int32_t (Q4.27) or int16_t (Q0.15) or float
1713 * TA: int32_t (Q4.27)
1714 */
1715template <int MIXTYPE,
1716 typename TO, typename TI, typename TV, typename TA, typename TAV>
1717static void volumeRampMulti(uint32_t channels, TO* out, size_t frameCount,
1718 const TI* in, TA* aux, TV *vol, const TV *volinc, TAV *vola, TAV volainc)
1719{
1720 switch (channels) {
1721 case 1:
1722 volumeRampMulti<MIXTYPE, 1>(out, frameCount, in, aux, vol, volinc, vola, volainc);
1723 break;
1724 case 2:
1725 volumeRampMulti<MIXTYPE, 2>(out, frameCount, in, aux, vol, volinc, vola, volainc);
1726 break;
1727 case 3:
1728 volumeRampMulti<MIXTYPE_MONOVOL(MIXTYPE), 3>(out,
1729 frameCount, in, aux, vol, volinc, vola, volainc);
1730 break;
1731 case 4:
1732 volumeRampMulti<MIXTYPE_MONOVOL(MIXTYPE), 4>(out,
1733 frameCount, in, aux, vol, volinc, vola, volainc);
1734 break;
1735 case 5:
1736 volumeRampMulti<MIXTYPE_MONOVOL(MIXTYPE), 5>(out,
1737 frameCount, in, aux, vol, volinc, vola, volainc);
1738 break;
1739 case 6:
1740 volumeRampMulti<MIXTYPE_MONOVOL(MIXTYPE), 6>(out,
1741 frameCount, in, aux, vol, volinc, vola, volainc);
1742 break;
1743 case 7:
1744 volumeRampMulti<MIXTYPE_MONOVOL(MIXTYPE), 7>(out,
1745 frameCount, in, aux, vol, volinc, vola, volainc);
1746 break;
1747 case 8:
1748 volumeRampMulti<MIXTYPE_MONOVOL(MIXTYPE), 8>(out,
1749 frameCount, in, aux, vol, volinc, vola, volainc);
1750 break;
1751 }
1752}
1753
1754/* MIXTYPE (see AudioMixerOps.h MIXTYPE_* enumeration)
1755 * TO: int32_t (Q4.27) or float
1756 * TI: int32_t (Q4.27) or int16_t (Q0.15) or float
1757 * TA: int32_t (Q4.27)
1758 */
1759template <int MIXTYPE,
1760 typename TO, typename TI, typename TV, typename TA, typename TAV>
1761static void volumeMulti(uint32_t channels, TO* out, size_t frameCount,
1762 const TI* in, TA* aux, const TV *vol, TAV vola)
1763{
1764 switch (channels) {
1765 case 1:
1766 volumeMulti<MIXTYPE, 1>(out, frameCount, in, aux, vol, vola);
1767 break;
1768 case 2:
1769 volumeMulti<MIXTYPE, 2>(out, frameCount, in, aux, vol, vola);
1770 break;
1771 case 3:
1772 volumeMulti<MIXTYPE_MONOVOL(MIXTYPE), 3>(out, frameCount, in, aux, vol, vola);
1773 break;
1774 case 4:
1775 volumeMulti<MIXTYPE_MONOVOL(MIXTYPE), 4>(out, frameCount, in, aux, vol, vola);
1776 break;
1777 case 5:
1778 volumeMulti<MIXTYPE_MONOVOL(MIXTYPE), 5>(out, frameCount, in, aux, vol, vola);
1779 break;
1780 case 6:
1781 volumeMulti<MIXTYPE_MONOVOL(MIXTYPE), 6>(out, frameCount, in, aux, vol, vola);
1782 break;
1783 case 7:
1784 volumeMulti<MIXTYPE_MONOVOL(MIXTYPE), 7>(out, frameCount, in, aux, vol, vola);
1785 break;
1786 case 8:
1787 volumeMulti<MIXTYPE_MONOVOL(MIXTYPE), 8>(out, frameCount, in, aux, vol, vola);
1788 break;
1789 }
1790}
1791
1792/* MIXTYPE (see AudioMixerOps.h MIXTYPE_* enumeration)
1793 * USEFLOATVOL (set to true if float volume is used)
1794 * ADJUSTVOL (set to true if volume ramp parameters needs adjustment afterwards)
1795 * TO: int32_t (Q4.27) or float
1796 * TI: int32_t (Q4.27) or int16_t (Q0.15) or float
1797 * TA: int32_t (Q4.27)
1798 */
1799template <int MIXTYPE, bool USEFLOATVOL, bool ADJUSTVOL,
Andy Hung5e58b0a2014-06-23 19:07:29 -07001800 typename TO, typename TI, typename TA>
1801void AudioMixer::volumeMix(TO *out, size_t outFrames,
1802 const TI *in, TA *aux, bool ramp, AudioMixer::track_t *t)
1803{
1804 if (USEFLOATVOL) {
1805 if (ramp) {
Andy Hunge93b6b72014-07-17 21:30:53 -07001806 volumeRampMulti<MIXTYPE>(t->mMixerChannelCount, out, outFrames, in, aux,
Andy Hung5e58b0a2014-06-23 19:07:29 -07001807 t->mPrevVolume, t->mVolumeInc, &t->prevAuxLevel, t->auxInc);
1808 if (ADJUSTVOL) {
1809 t->adjustVolumeRamp(aux != NULL, true);
1810 }
1811 } else {
Andy Hunge93b6b72014-07-17 21:30:53 -07001812 volumeMulti<MIXTYPE>(t->mMixerChannelCount, out, outFrames, in, aux,
Andy Hung5e58b0a2014-06-23 19:07:29 -07001813 t->mVolume, t->auxLevel);
1814 }
1815 } else {
1816 if (ramp) {
Andy Hunge93b6b72014-07-17 21:30:53 -07001817 volumeRampMulti<MIXTYPE>(t->mMixerChannelCount, out, outFrames, in, aux,
Andy Hung5e58b0a2014-06-23 19:07:29 -07001818 t->prevVolume, t->volumeInc, &t->prevAuxLevel, t->auxInc);
1819 if (ADJUSTVOL) {
1820 t->adjustVolumeRamp(aux != NULL);
1821 }
1822 } else {
Andy Hunge93b6b72014-07-17 21:30:53 -07001823 volumeMulti<MIXTYPE>(t->mMixerChannelCount, out, outFrames, in, aux,
Andy Hung5e58b0a2014-06-23 19:07:29 -07001824 t->volume, t->auxLevel);
1825 }
1826 }
1827}
1828
Andy Hung296b7412014-06-17 15:25:47 -07001829/* This process hook is called when there is a single track without
1830 * aux buffer, volume ramp, or resampling.
1831 * TODO: Update the hook selection: this can properly handle aux and ramp.
Andy Hunge93b6b72014-07-17 21:30:53 -07001832 *
1833 * MIXTYPE (see AudioMixerOps.h MIXTYPE_* enumeration)
1834 * TO: int32_t (Q4.27) or float
1835 * TI: int32_t (Q4.27) or int16_t (Q0.15) or float
1836 * TA: int32_t (Q4.27)
Andy Hung296b7412014-06-17 15:25:47 -07001837 */
Andy Hunge93b6b72014-07-17 21:30:53 -07001838template <int MIXTYPE, typename TO, typename TI, typename TA>
Andy Hung296b7412014-06-17 15:25:47 -07001839void AudioMixer::process_NoResampleOneTrack(state_t* state, int64_t pts)
1840{
1841 ALOGVV("process_NoResampleOneTrack\n");
1842 // CLZ is faster than CTZ on ARM, though really not sure if true after 31 - clz.
1843 const int i = 31 - __builtin_clz(state->enabledTracks);
1844 ALOG_ASSERT((1 << i) == state->enabledTracks, "more than 1 track enabled");
1845 track_t *t = &state->tracks[i];
Andy Hunge93b6b72014-07-17 21:30:53 -07001846 const uint32_t channels = t->mMixerChannelCount;
Andy Hung296b7412014-06-17 15:25:47 -07001847 TO* out = reinterpret_cast<TO*>(t->mainBuffer);
1848 TA* aux = reinterpret_cast<TA*>(t->auxBuffer);
1849 const bool ramp = t->needsRamp();
1850
1851 for (size_t numFrames = state->frameCount; numFrames; ) {
1852 AudioBufferProvider::Buffer& b(t->buffer);
1853 // get input buffer
1854 b.frameCount = numFrames;
1855 const int64_t outputPTS = calculateOutputPTS(*t, pts, state->frameCount - numFrames);
1856 t->bufferProvider->getNextBuffer(&b, outputPTS);
1857 const TI *in = reinterpret_cast<TI*>(b.raw);
1858
1859 // in == NULL can happen if the track was flushed just after having
1860 // been enabled for mixing.
1861 if (in == NULL || (((uintptr_t)in) & 3)) {
1862 memset(out, 0, numFrames
Andy Hunge93b6b72014-07-17 21:30:53 -07001863 * channels * audio_bytes_per_sample(t->mMixerFormat));
Andy Hung296b7412014-06-17 15:25:47 -07001864 ALOGE_IF((((uintptr_t)in) & 3), "process_NoResampleOneTrack: bus error: "
1865 "buffer %p track %p, channels %d, needs %#x",
1866 in, t, t->channelCount, t->needs);
1867 return;
1868 }
1869
1870 const size_t outFrames = b.frameCount;
Andy Hunge93b6b72014-07-17 21:30:53 -07001871 volumeMix<MIXTYPE, is_same<TI, float>::value, false> (
1872 out, outFrames, in, aux, ramp, t);
Andy Hung5e58b0a2014-06-23 19:07:29 -07001873
Andy Hunge93b6b72014-07-17 21:30:53 -07001874 out += outFrames * channels;
Andy Hung296b7412014-06-17 15:25:47 -07001875 if (aux != NULL) {
Andy Hunge93b6b72014-07-17 21:30:53 -07001876 aux += channels;
Andy Hung296b7412014-06-17 15:25:47 -07001877 }
1878 numFrames -= b.frameCount;
1879
1880 // release buffer
1881 t->bufferProvider->releaseBuffer(&b);
1882 }
1883 if (ramp) {
Andy Hung5e58b0a2014-06-23 19:07:29 -07001884 t->adjustVolumeRamp(aux != NULL, is_same<TI, float>::value);
Andy Hung296b7412014-06-17 15:25:47 -07001885 }
1886}
1887
1888/* This track hook is called to do resampling then mixing,
1889 * pulling from the track's upstream AudioBufferProvider.
Andy Hunge93b6b72014-07-17 21:30:53 -07001890 *
1891 * MIXTYPE (see AudioMixerOps.h MIXTYPE_* enumeration)
1892 * TO: int32_t (Q4.27) or float
1893 * TI: int32_t (Q4.27) or int16_t (Q0.15) or float
1894 * TA: int32_t (Q4.27)
Andy Hung296b7412014-06-17 15:25:47 -07001895 */
Andy Hunge93b6b72014-07-17 21:30:53 -07001896template <int MIXTYPE, typename TO, typename TI, typename TA>
Andy Hung296b7412014-06-17 15:25:47 -07001897void AudioMixer::track__Resample(track_t* t, TO* out, size_t outFrameCount, TO* temp, TA* aux)
1898{
1899 ALOGVV("track__Resample\n");
1900 t->resampler->setSampleRate(t->sampleRate);
Andy Hung296b7412014-06-17 15:25:47 -07001901 const bool ramp = t->needsRamp();
1902 if (ramp || aux != NULL) {
1903 // if ramp: resample with unity gain to temp buffer and scale/mix in 2nd step.
1904 // if aux != NULL: resample with unity gain to temp buffer then apply send level.
1905
Andy Hung5e58b0a2014-06-23 19:07:29 -07001906 t->resampler->setVolume(UNITY_GAIN_FLOAT, UNITY_GAIN_FLOAT);
Andy Hunge93b6b72014-07-17 21:30:53 -07001907 memset(temp, 0, outFrameCount * t->mMixerChannelCount * sizeof(TO));
Andy Hung296b7412014-06-17 15:25:47 -07001908 t->resampler->resample((int32_t*)temp, outFrameCount, t->bufferProvider);
Andy Hung5e58b0a2014-06-23 19:07:29 -07001909
Andy Hunge93b6b72014-07-17 21:30:53 -07001910 volumeMix<MIXTYPE, is_same<TI, float>::value, true>(
1911 out, outFrameCount, temp, aux, ramp, t);
Andy Hung5e58b0a2014-06-23 19:07:29 -07001912
Andy Hung296b7412014-06-17 15:25:47 -07001913 } else { // constant volume gain
Andy Hung5e58b0a2014-06-23 19:07:29 -07001914 t->resampler->setVolume(t->mVolume[0], t->mVolume[1]);
Andy Hung296b7412014-06-17 15:25:47 -07001915 t->resampler->resample((int32_t*)out, outFrameCount, t->bufferProvider);
1916 }
1917}
1918
1919/* This track hook is called to mix a track, when no resampling is required.
1920 * The input buffer should be present in t->in.
Andy Hunge93b6b72014-07-17 21:30:53 -07001921 *
1922 * MIXTYPE (see AudioMixerOps.h MIXTYPE_* enumeration)
1923 * TO: int32_t (Q4.27) or float
1924 * TI: int32_t (Q4.27) or int16_t (Q0.15) or float
1925 * TA: int32_t (Q4.27)
Andy Hung296b7412014-06-17 15:25:47 -07001926 */
Andy Hunge93b6b72014-07-17 21:30:53 -07001927template <int MIXTYPE, typename TO, typename TI, typename TA>
Andy Hung296b7412014-06-17 15:25:47 -07001928void AudioMixer::track__NoResample(track_t* t, TO* out, size_t frameCount,
1929 TO* temp __unused, TA* aux)
1930{
1931 ALOGVV("track__NoResample\n");
1932 const TI *in = static_cast<const TI *>(t->in);
1933
Andy Hunge93b6b72014-07-17 21:30:53 -07001934 volumeMix<MIXTYPE, is_same<TI, float>::value, true>(
1935 out, frameCount, in, aux, t->needsRamp(), t);
Andy Hung5e58b0a2014-06-23 19:07:29 -07001936
Andy Hung296b7412014-06-17 15:25:47 -07001937 // MIXTYPE_MONOEXPAND reads a single input channel and expands to NCHAN output channels.
1938 // MIXTYPE_MULTI reads NCHAN input channels and places to NCHAN output channels.
Andy Hunge93b6b72014-07-17 21:30:53 -07001939 in += (MIXTYPE == MIXTYPE_MONOEXPAND) ? frameCount : frameCount * t->mMixerChannelCount;
Andy Hung296b7412014-06-17 15:25:47 -07001940 t->in = in;
1941}
1942
1943/* The Mixer engine generates either int32_t (Q4_27) or float data.
1944 * We use this function to convert the engine buffers
1945 * to the desired mixer output format, either int16_t (Q.15) or float.
1946 */
1947void AudioMixer::convertMixerFormat(void *out, audio_format_t mixerOutFormat,
1948 void *in, audio_format_t mixerInFormat, size_t sampleCount)
1949{
1950 switch (mixerInFormat) {
1951 case AUDIO_FORMAT_PCM_FLOAT:
1952 switch (mixerOutFormat) {
1953 case AUDIO_FORMAT_PCM_FLOAT:
1954 memcpy(out, in, sampleCount * sizeof(float)); // MEMCPY. TODO optimize out
1955 break;
1956 case AUDIO_FORMAT_PCM_16_BIT:
1957 memcpy_to_i16_from_float((int16_t*)out, (float*)in, sampleCount);
1958 break;
1959 default:
1960 LOG_ALWAYS_FATAL("bad mixerOutFormat: %#x", mixerOutFormat);
1961 break;
1962 }
1963 break;
1964 case AUDIO_FORMAT_PCM_16_BIT:
1965 switch (mixerOutFormat) {
1966 case AUDIO_FORMAT_PCM_FLOAT:
1967 memcpy_to_float_from_q4_27((float*)out, (int32_t*)in, sampleCount);
1968 break;
1969 case AUDIO_FORMAT_PCM_16_BIT:
1970 // two int16_t are produced per iteration
1971 ditherAndClamp((int32_t*)out, (int32_t*)in, sampleCount >> 1);
1972 break;
1973 default:
1974 LOG_ALWAYS_FATAL("bad mixerOutFormat: %#x", mixerOutFormat);
1975 break;
1976 }
1977 break;
1978 default:
1979 LOG_ALWAYS_FATAL("bad mixerInFormat: %#x", mixerInFormat);
1980 break;
1981 }
1982}
1983
1984/* Returns the proper track hook to use for mixing the track into the output buffer.
1985 */
Andy Hunge93b6b72014-07-17 21:30:53 -07001986AudioMixer::hook_t AudioMixer::getTrackHook(int trackType, uint32_t channelCount,
Andy Hung296b7412014-06-17 15:25:47 -07001987 audio_format_t mixerInFormat, audio_format_t mixerOutFormat __unused)
1988{
Andy Hunge93b6b72014-07-17 21:30:53 -07001989 if (!kUseNewMixer && channelCount == FCC_2 && mixerInFormat == AUDIO_FORMAT_PCM_16_BIT) {
Andy Hung296b7412014-06-17 15:25:47 -07001990 switch (trackType) {
1991 case TRACKTYPE_NOP:
1992 return track__nop;
1993 case TRACKTYPE_RESAMPLE:
1994 return track__genericResample;
1995 case TRACKTYPE_NORESAMPLEMONO:
1996 return track__16BitsMono;
1997 case TRACKTYPE_NORESAMPLE:
1998 return track__16BitsStereo;
1999 default:
2000 LOG_ALWAYS_FATAL("bad trackType: %d", trackType);
2001 break;
2002 }
2003 }
Andy Hunge93b6b72014-07-17 21:30:53 -07002004 LOG_ALWAYS_FATAL_IF(channelCount > MAX_NUM_CHANNELS);
Andy Hung296b7412014-06-17 15:25:47 -07002005 switch (trackType) {
2006 case TRACKTYPE_NOP:
2007 return track__nop;
2008 case TRACKTYPE_RESAMPLE:
2009 switch (mixerInFormat) {
2010 case AUDIO_FORMAT_PCM_FLOAT:
2011 return (AudioMixer::hook_t)
Andy Hunge93b6b72014-07-17 21:30:53 -07002012 track__Resample<MIXTYPE_MULTI, float /*TO*/, float /*TI*/, int32_t /*TA*/>;
Andy Hung296b7412014-06-17 15:25:47 -07002013 case AUDIO_FORMAT_PCM_16_BIT:
2014 return (AudioMixer::hook_t)\
Andy Hunge93b6b72014-07-17 21:30:53 -07002015 track__Resample<MIXTYPE_MULTI, int32_t, int16_t, int32_t>;
Andy Hung296b7412014-06-17 15:25:47 -07002016 default:
2017 LOG_ALWAYS_FATAL("bad mixerInFormat: %#x", mixerInFormat);
2018 break;
2019 }
2020 break;
2021 case TRACKTYPE_NORESAMPLEMONO:
2022 switch (mixerInFormat) {
2023 case AUDIO_FORMAT_PCM_FLOAT:
2024 return (AudioMixer::hook_t)
Andy Hunge93b6b72014-07-17 21:30:53 -07002025 track__NoResample<MIXTYPE_MONOEXPAND, float, float, int32_t>;
Andy Hung296b7412014-06-17 15:25:47 -07002026 case AUDIO_FORMAT_PCM_16_BIT:
2027 return (AudioMixer::hook_t)
Andy Hunge93b6b72014-07-17 21:30:53 -07002028 track__NoResample<MIXTYPE_MONOEXPAND, int32_t, int16_t, int32_t>;
Andy Hung296b7412014-06-17 15:25:47 -07002029 default:
2030 LOG_ALWAYS_FATAL("bad mixerInFormat: %#x", mixerInFormat);
2031 break;
2032 }
2033 break;
2034 case TRACKTYPE_NORESAMPLE:
2035 switch (mixerInFormat) {
2036 case AUDIO_FORMAT_PCM_FLOAT:
2037 return (AudioMixer::hook_t)
Andy Hunge93b6b72014-07-17 21:30:53 -07002038 track__NoResample<MIXTYPE_MULTI, float, float, int32_t>;
Andy Hung296b7412014-06-17 15:25:47 -07002039 case AUDIO_FORMAT_PCM_16_BIT:
2040 return (AudioMixer::hook_t)
Andy Hunge93b6b72014-07-17 21:30:53 -07002041 track__NoResample<MIXTYPE_MULTI, int32_t, int16_t, int32_t>;
Andy Hung296b7412014-06-17 15:25:47 -07002042 default:
2043 LOG_ALWAYS_FATAL("bad mixerInFormat: %#x", mixerInFormat);
2044 break;
2045 }
2046 break;
2047 default:
2048 LOG_ALWAYS_FATAL("bad trackType: %d", trackType);
2049 break;
2050 }
2051 return NULL;
2052}
2053
2054/* Returns the proper process hook for mixing tracks. Currently works only for
2055 * PROCESSTYPE_NORESAMPLEONETRACK, a mix involving one track, no resampling.
Andy Hung395db4b2014-08-25 17:15:29 -07002056 *
2057 * TODO: Due to the special mixing considerations of duplicating to
2058 * a stereo output track, the input track cannot be MONO. This should be
2059 * prevented by the caller.
Andy Hung296b7412014-06-17 15:25:47 -07002060 */
Andy Hunge93b6b72014-07-17 21:30:53 -07002061AudioMixer::process_hook_t AudioMixer::getProcessHook(int processType, uint32_t channelCount,
Andy Hung296b7412014-06-17 15:25:47 -07002062 audio_format_t mixerInFormat, audio_format_t mixerOutFormat)
2063{
2064 if (processType != PROCESSTYPE_NORESAMPLEONETRACK) { // Only NORESAMPLEONETRACK
2065 LOG_ALWAYS_FATAL("bad processType: %d", processType);
2066 return NULL;
2067 }
Andy Hunge93b6b72014-07-17 21:30:53 -07002068 if (!kUseNewMixer && channelCount == FCC_2 && mixerInFormat == AUDIO_FORMAT_PCM_16_BIT) {
Andy Hung296b7412014-06-17 15:25:47 -07002069 return process__OneTrack16BitsStereoNoResampling;
2070 }
Andy Hunge93b6b72014-07-17 21:30:53 -07002071 LOG_ALWAYS_FATAL_IF(channelCount > MAX_NUM_CHANNELS);
Andy Hung296b7412014-06-17 15:25:47 -07002072 switch (mixerInFormat) {
2073 case AUDIO_FORMAT_PCM_FLOAT:
2074 switch (mixerOutFormat) {
2075 case AUDIO_FORMAT_PCM_FLOAT:
Andy Hunge93b6b72014-07-17 21:30:53 -07002076 return process_NoResampleOneTrack<MIXTYPE_MULTI_SAVEONLY,
2077 float /*TO*/, float /*TI*/, int32_t /*TA*/>;
Andy Hung296b7412014-06-17 15:25:47 -07002078 case AUDIO_FORMAT_PCM_16_BIT:
Andy Hunge93b6b72014-07-17 21:30:53 -07002079 return process_NoResampleOneTrack<MIXTYPE_MULTI_SAVEONLY,
Andy Hung296b7412014-06-17 15:25:47 -07002080 int16_t, float, int32_t>;
2081 default:
2082 LOG_ALWAYS_FATAL("bad mixerOutFormat: %#x", mixerOutFormat);
2083 break;
2084 }
2085 break;
2086 case AUDIO_FORMAT_PCM_16_BIT:
2087 switch (mixerOutFormat) {
2088 case AUDIO_FORMAT_PCM_FLOAT:
Andy Hunge93b6b72014-07-17 21:30:53 -07002089 return process_NoResampleOneTrack<MIXTYPE_MULTI_SAVEONLY,
Andy Hung296b7412014-06-17 15:25:47 -07002090 float, int16_t, int32_t>;
2091 case AUDIO_FORMAT_PCM_16_BIT:
Andy Hunge93b6b72014-07-17 21:30:53 -07002092 return process_NoResampleOneTrack<MIXTYPE_MULTI_SAVEONLY,
Andy Hung296b7412014-06-17 15:25:47 -07002093 int16_t, int16_t, int32_t>;
2094 default:
2095 LOG_ALWAYS_FATAL("bad mixerOutFormat: %#x", mixerOutFormat);
2096 break;
2097 }
2098 break;
2099 default:
2100 LOG_ALWAYS_FATAL("bad mixerInFormat: %#x", mixerInFormat);
2101 break;
2102 }
2103 return NULL;
2104}
2105
Mathias Agopian65ab4712010-07-14 17:59:35 -07002106// ----------------------------------------------------------------------------
Glenn Kasten63238ef2015-03-02 15:50:29 -08002107} // namespace android