blob: a01c6a84b22b1e14a8e8729454e9aba96beca5b5 [file] [log] [blame]
Mathias Agopian65ab4712010-07-14 17:59:35 -07001/* //device/include/server/AudioFlinger/AudioMixer.cpp
2**
3** Copyright 2007, The Android Open Source Project
4**
5** Licensed under the Apache License, Version 2.0 (the "License");
6** you may not use this file except in compliance with the License.
7** You may obtain a copy of the License at
8**
9** http://www.apache.org/licenses/LICENSE-2.0
10**
11** Unless required by applicable law or agreed to in writing, software
12** distributed under the License is distributed on an "AS IS" BASIS,
13** WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
14** See the License for the specific language governing permissions and
15** limitations under the License.
16*/
17
18#define LOG_TAG "AudioMixer"
19//#define LOG_NDEBUG 0
20
Glenn Kastenfba380a2011-12-15 15:46:46 -080021#include <assert.h>
Mathias Agopian65ab4712010-07-14 17:59:35 -070022#include <stdint.h>
23#include <string.h>
24#include <stdlib.h>
25#include <sys/types.h>
26
27#include <utils/Errors.h>
28#include <utils/Log.h>
29
Jean-Michel Trivi0d255b22011-05-24 15:53:33 -070030#include <cutils/bitops.h>
Glenn Kastenf6b16782011-12-15 09:51:17 -080031#include <cutils/compiler.h>
Jean-Michel Trivi0d255b22011-05-24 15:53:33 -070032
33#include <system/audio.h>
34
Glenn Kasten3b21c502011-12-15 09:52:39 -080035#include <audio_utils/primitives.h>
36
Mathias Agopian65ab4712010-07-14 17:59:35 -070037#include "AudioMixer.h"
38
39namespace android {
Mathias Agopian65ab4712010-07-14 17:59:35 -070040
41// ----------------------------------------------------------------------------
42
43AudioMixer::AudioMixer(size_t frameCount, uint32_t sampleRate)
Glenn Kasten9c56d4a2011-12-19 15:06:39 -080044 : mTrackNames(0), mSampleRate(sampleRate)
Mathias Agopian65ab4712010-07-14 17:59:35 -070045{
Glenn Kasten788040c2011-05-05 08:19:00 -070046 // AudioMixer is not yet capable of multi-channel beyond stereo
47 assert(2 == MAX_NUM_CHANNELS);
Mathias Agopian65ab4712010-07-14 17:59:35 -070048 mState.enabledTracks= 0;
49 mState.needsChanged = 0;
50 mState.frameCount = frameCount;
Glenn Kastene0feee32011-12-13 11:53:26 -080051 mState.outputTemp = NULL;
52 mState.resampleTemp = NULL;
Mathias Agopian65ab4712010-07-14 17:59:35 -070053 mState.hook = process__nop;
54 track_t* t = mState.tracks;
Glenn Kastenbf71f1e2011-12-13 11:52:35 -080055 for (unsigned i=0 ; i < MAX_NUM_TRACKS ; i++) {
Mathias Agopian65ab4712010-07-14 17:59:35 -070056 t->needs = 0;
57 t->volume[0] = UNITY_GAIN;
58 t->volume[1] = UNITY_GAIN;
Glenn Kasten0cfd8232011-12-13 11:58:23 -080059 // no initialization needed
60 // t->prevVolume[0]
61 // t->prevVolume[1]
Mathias Agopian65ab4712010-07-14 17:59:35 -070062 t->volumeInc[0] = 0;
63 t->volumeInc[1] = 0;
64 t->auxLevel = 0;
65 t->auxInc = 0;
Glenn Kasten0cfd8232011-12-13 11:58:23 -080066 // no initialization needed
67 // t->prevAuxLevel
68 // t->frameCount
Mathias Agopian65ab4712010-07-14 17:59:35 -070069 t->channelCount = 2;
70 t->enabled = 0;
71 t->format = 16;
Jean-Michel Trivi0d255b22011-05-24 15:53:33 -070072 t->channelMask = AUDIO_CHANNEL_OUT_STEREO;
Mathias Agopian65ab4712010-07-14 17:59:35 -070073 t->buffer.raw = 0;
Glenn Kastene0feee32011-12-13 11:53:26 -080074 t->bufferProvider = NULL;
75 t->hook = NULL;
76 t->resampler = NULL;
Mathias Agopian65ab4712010-07-14 17:59:35 -070077 t->sampleRate = mSampleRate;
Glenn Kastene0feee32011-12-13 11:53:26 -080078 t->in = NULL;
Mathias Agopian65ab4712010-07-14 17:59:35 -070079 t->mainBuffer = NULL;
80 t->auxBuffer = NULL;
81 t++;
82 }
83}
84
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -080085AudioMixer::~AudioMixer()
86{
87 track_t* t = mState.tracks;
Glenn Kastenbf71f1e2011-12-13 11:52:35 -080088 for (unsigned i=0 ; i < MAX_NUM_TRACKS ; i++) {
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -080089 delete t->resampler;
90 t++;
91 }
92 delete [] mState.outputTemp;
93 delete [] mState.resampleTemp;
94}
Mathias Agopian65ab4712010-07-14 17:59:35 -070095
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -080096int AudioMixer::getTrackName()
97{
Glenn Kasten98dd5422011-12-15 14:38:29 -080098 uint32_t names = ~mTrackNames;
99 if (names != 0) {
100 int n = __builtin_ctz(names);
Steve Block3856b092011-10-20 11:56:00 +0100101 ALOGV("add track (%d)", n);
Glenn Kasten98dd5422011-12-15 14:38:29 -0800102 mTrackNames |= 1 << n;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700103 return TRACK0 + n;
104 }
105 return -1;
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800106}
Mathias Agopian65ab4712010-07-14 17:59:35 -0700107
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800108void AudioMixer::invalidateState(uint32_t mask)
109{
Mathias Agopian65ab4712010-07-14 17:59:35 -0700110 if (mask) {
111 mState.needsChanged |= mask;
112 mState.hook = process__validate;
113 }
114 }
115
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800116void AudioMixer::deleteTrackName(int name)
117{
Mathias Agopian65ab4712010-07-14 17:59:35 -0700118 name -= TRACK0;
Glenn Kasten237a6242011-12-15 15:32:27 -0800119 assert(uint32_t(name) < MAX_NUM_TRACKS);
120 ALOGV("deleteTrackName(%d)", name);
121 track_t& track(mState.tracks[ name ]);
122 if (track.enabled != 0) {
123 track.enabled = 0;
124 invalidateState(1<<name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700125 }
Glenn Kasten237a6242011-12-15 15:32:27 -0800126 if (track.resampler) {
127 // delete the resampler
128 delete track.resampler;
129 track.resampler = NULL;
130 track.sampleRate = mSampleRate;
131 invalidateState(1<<name);
132 }
133 track.volumeInc[0] = 0;
134 track.volumeInc[1] = 0;
135 mTrackNames &= ~(1<<name);
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800136}
Mathias Agopian65ab4712010-07-14 17:59:35 -0700137
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800138void AudioMixer::enable(int name)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700139{
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800140 name -= TRACK0;
141 assert(uint32_t(name) < MAX_NUM_TRACKS);
142 track_t& track = mState.tracks[name];
143
144 if (track.enabled != 1) {
145 track.enabled = 1;
146 ALOGV("enable(%d)", name);
147 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700148 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700149}
150
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800151void AudioMixer::disable(int name)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700152{
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800153 name -= TRACK0;
154 assert(uint32_t(name) < MAX_NUM_TRACKS);
155 track_t& track = mState.tracks[name];
156
157 if (track.enabled != 0) {
158 track.enabled = 0;
159 ALOGV("disable(%d)", name);
160 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700161 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700162}
163
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800164void AudioMixer::setParameter(int name, int target, int param, void *value)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700165{
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800166 name -= TRACK0;
167 assert(uint32_t(name) < MAX_NUM_TRACKS);
168 track_t& track = mState.tracks[name];
Mathias Agopian65ab4712010-07-14 17:59:35 -0700169
Mathias Agopian65ab4712010-07-14 17:59:35 -0700170 int valueInt = (int)value;
171 int32_t *valueBuf = (int32_t *)value;
172
173 switch (target) {
Glenn Kasten788040c2011-05-05 08:19:00 -0700174
Mathias Agopian65ab4712010-07-14 17:59:35 -0700175 case TRACK:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800176 switch (param) {
Glenn Kasten788040c2011-05-05 08:19:00 -0700177 case CHANNEL_MASK: {
Jean-Michel Trivi0d255b22011-05-24 15:53:33 -0700178 uint32_t mask = (uint32_t)value;
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800179 if (track.channelMask != mask) {
Jean-Michel Trivi0d255b22011-05-24 15:53:33 -0700180 uint8_t channelCount = popcount(mask);
Glenn Kasten788040c2011-05-05 08:19:00 -0700181 assert((channelCount <= MAX_NUM_CHANNELS) && (channelCount));
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800182 track.channelMask = mask;
183 track.channelCount = channelCount;
Glenn Kasten788040c2011-05-05 08:19:00 -0700184 ALOGV("setParameter(TRACK, CHANNEL_MASK, %x)", mask);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800185 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700186 }
Glenn Kasten788040c2011-05-05 08:19:00 -0700187 } break;
188 case MAIN_BUFFER:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800189 if (track.mainBuffer != valueBuf) {
190 track.mainBuffer = valueBuf;
Steve Block3856b092011-10-20 11:56:00 +0100191 ALOGV("setParameter(TRACK, MAIN_BUFFER, %p)", valueBuf);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800192 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700193 }
Glenn Kasten788040c2011-05-05 08:19:00 -0700194 break;
195 case AUX_BUFFER:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800196 if (track.auxBuffer != valueBuf) {
197 track.auxBuffer = valueBuf;
Steve Block3856b092011-10-20 11:56:00 +0100198 ALOGV("setParameter(TRACK, AUX_BUFFER, %p)", valueBuf);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800199 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700200 }
Glenn Kasten788040c2011-05-05 08:19:00 -0700201 break;
202 default:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800203 // bad param
Glenn Kasten788040c2011-05-05 08:19:00 -0700204 assert(false);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700205 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700206 break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700207
Mathias Agopian65ab4712010-07-14 17:59:35 -0700208 case RESAMPLE:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800209 switch (param) {
210 case SAMPLE_RATE:
Glenn Kasten788040c2011-05-05 08:19:00 -0700211 assert(valueInt > 0);
Glenn Kasten788040c2011-05-05 08:19:00 -0700212 if (track.setResampler(uint32_t(valueInt), mSampleRate)) {
213 ALOGV("setParameter(RESAMPLE, SAMPLE_RATE, %u)",
214 uint32_t(valueInt));
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800215 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700216 }
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800217 break;
218 case RESET:
Eric Laurent243f5f92011-02-28 16:52:51 -0800219 track.resetResampler();
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800220 invalidateState(1 << name);
221 break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700222 default:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800223 // bad param
Glenn Kasten788040c2011-05-05 08:19:00 -0700224 assert(false);
Eric Laurent243f5f92011-02-28 16:52:51 -0800225 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700226 break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700227
Mathias Agopian65ab4712010-07-14 17:59:35 -0700228 case RAMP_VOLUME:
229 case VOLUME:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800230 switch (param) {
Glenn Kasten788040c2011-05-05 08:19:00 -0700231 case VOLUME0:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800232 case VOLUME1:
233 if (track.volume[param-VOLUME0] != valueInt) {
Steve Block3856b092011-10-20 11:56:00 +0100234 ALOGV("setParameter(VOLUME, VOLUME0/1: %04x)", valueInt);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800235 track.prevVolume[param-VOLUME0] = track.volume[param-VOLUME0] << 16;
236 track.volume[param-VOLUME0] = valueInt;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700237 if (target == VOLUME) {
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800238 track.prevVolume[param-VOLUME0] = valueInt << 16;
239 track.volumeInc[param-VOLUME0] = 0;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700240 } else {
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800241 int32_t d = (valueInt<<16) - track.prevVolume[param-VOLUME0];
Mathias Agopian65ab4712010-07-14 17:59:35 -0700242 int32_t volInc = d / int32_t(mState.frameCount);
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800243 track.volumeInc[param-VOLUME0] = volInc;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700244 if (volInc == 0) {
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800245 track.prevVolume[param-VOLUME0] = valueInt << 16;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700246 }
247 }
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800248 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700249 }
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800250 break;
251 case AUXLEVEL:
Mathias Agopian65ab4712010-07-14 17:59:35 -0700252 if (track.auxLevel != valueInt) {
Steve Block3856b092011-10-20 11:56:00 +0100253 ALOGV("setParameter(VOLUME, AUXLEVEL: %04x)", valueInt);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700254 track.prevAuxLevel = track.auxLevel << 16;
255 track.auxLevel = valueInt;
256 if (target == VOLUME) {
257 track.prevAuxLevel = valueInt << 16;
258 track.auxInc = 0;
259 } else {
260 int32_t d = (valueInt<<16) - track.prevAuxLevel;
261 int32_t volInc = d / int32_t(mState.frameCount);
262 track.auxInc = volInc;
263 if (volInc == 0) {
264 track.prevAuxLevel = valueInt << 16;
265 }
266 }
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800267 invalidateState(1 << name);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700268 }
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800269 break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700270 default:
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800271 // bad param
Glenn Kasten788040c2011-05-05 08:19:00 -0700272 assert(false);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700273 }
274 break;
Glenn Kasten788040c2011-05-05 08:19:00 -0700275
276 default:
277 // bad target
278 assert(false);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700279 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700280}
281
282bool AudioMixer::track_t::setResampler(uint32_t value, uint32_t devSampleRate)
283{
284 if (value!=devSampleRate || resampler) {
285 if (sampleRate != value) {
286 sampleRate = value;
Glenn Kastene0feee32011-12-13 11:53:26 -0800287 if (resampler == NULL) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700288 resampler = AudioResampler::create(
289 format, channelCount, devSampleRate);
290 }
291 return true;
292 }
293 }
294 return false;
295}
296
297bool AudioMixer::track_t::doesResample() const
298{
Glenn Kastene0feee32011-12-13 11:53:26 -0800299 return resampler != NULL;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700300}
301
Eric Laurent243f5f92011-02-28 16:52:51 -0800302void AudioMixer::track_t::resetResampler()
303{
Glenn Kastene0feee32011-12-13 11:53:26 -0800304 if (resampler != NULL) {
Eric Laurent243f5f92011-02-28 16:52:51 -0800305 resampler->reset();
306 }
307}
308
Mathias Agopian65ab4712010-07-14 17:59:35 -0700309inline
310void AudioMixer::track_t::adjustVolumeRamp(bool aux)
311{
Glenn Kastenf9a27772012-01-06 07:47:26 -0800312 for (uint32_t i=0 ; i<MAX_NUM_CHANNELS ; i++) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700313 if (((volumeInc[i]>0) && (((prevVolume[i]+volumeInc[i])>>16) >= volume[i])) ||
314 ((volumeInc[i]<0) && (((prevVolume[i]+volumeInc[i])>>16) <= volume[i]))) {
315 volumeInc[i] = 0;
316 prevVolume[i] = volume[i]<<16;
317 }
318 }
319 if (aux) {
320 if (((auxInc>0) && (((prevAuxLevel+auxInc)>>16) >= auxLevel)) ||
321 ((auxInc<0) && (((prevAuxLevel+auxInc)>>16) <= auxLevel))) {
322 auxInc = 0;
323 prevAuxLevel = auxLevel<<16;
324 }
325 }
326}
327
Eric Laurent071ccd52011-12-22 16:08:41 -0800328size_t AudioMixer::track_t::getUnreleasedFrames()
329{
330 if (resampler != NULL) {
331 return resampler->getUnreleasedFrames();
332 }
333 return 0;
334}
335
336size_t AudioMixer::getUnreleasedFrames(int name)
337{
338 name -= TRACK0;
339 if (uint32_t(name) < MAX_NUM_TRACKS) {
340 track_t& track(mState.tracks[name]);
341 return track.getUnreleasedFrames();
342 }
343 return 0;
344}
Mathias Agopian65ab4712010-07-14 17:59:35 -0700345
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800346void AudioMixer::setBufferProvider(int name, AudioBufferProvider* buffer)
Mathias Agopian65ab4712010-07-14 17:59:35 -0700347{
Glenn Kasten9c56d4a2011-12-19 15:06:39 -0800348 name -= TRACK0;
349 assert(uint32_t(name) < MAX_NUM_TRACKS);
350 mState.tracks[name].bufferProvider = buffer;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700351}
352
353
354
355void AudioMixer::process()
356{
357 mState.hook(&mState);
358}
359
360
361void AudioMixer::process__validate(state_t* state)
362{
Steve Block5ff1dd52012-01-05 23:22:43 +0000363 ALOGW_IF(!state->needsChanged,
Mathias Agopian65ab4712010-07-14 17:59:35 -0700364 "in process__validate() but nothing's invalid");
365
366 uint32_t changed = state->needsChanged;
367 state->needsChanged = 0; // clear the validation flag
368
369 // recompute which tracks are enabled / disabled
370 uint32_t enabled = 0;
371 uint32_t disabled = 0;
372 while (changed) {
373 const int i = 31 - __builtin_clz(changed);
374 const uint32_t mask = 1<<i;
375 changed &= ~mask;
376 track_t& t = state->tracks[i];
377 (t.enabled ? enabled : disabled) |= mask;
378 }
379 state->enabledTracks &= ~disabled;
380 state->enabledTracks |= enabled;
381
382 // compute everything we need...
383 int countActiveTracks = 0;
384 int all16BitsStereoNoResample = 1;
385 int resampling = 0;
386 int volumeRamp = 0;
387 uint32_t en = state->enabledTracks;
388 while (en) {
389 const int i = 31 - __builtin_clz(en);
390 en &= ~(1<<i);
391
392 countActiveTracks++;
393 track_t& t = state->tracks[i];
394 uint32_t n = 0;
395 n |= NEEDS_CHANNEL_1 + t.channelCount - 1;
396 n |= NEEDS_FORMAT_16;
397 n |= t.doesResample() ? NEEDS_RESAMPLE_ENABLED : NEEDS_RESAMPLE_DISABLED;
398 if (t.auxLevel != 0 && t.auxBuffer != NULL) {
399 n |= NEEDS_AUX_ENABLED;
400 }
401
402 if (t.volumeInc[0]|t.volumeInc[1]) {
403 volumeRamp = 1;
404 } else if (!t.doesResample() && t.volumeRL == 0) {
405 n |= NEEDS_MUTE_ENABLED;
406 }
407 t.needs = n;
408
409 if ((n & NEEDS_MUTE__MASK) == NEEDS_MUTE_ENABLED) {
410 t.hook = track__nop;
411 } else {
412 if ((n & NEEDS_AUX__MASK) == NEEDS_AUX_ENABLED) {
413 all16BitsStereoNoResample = 0;
414 }
415 if ((n & NEEDS_RESAMPLE__MASK) == NEEDS_RESAMPLE_ENABLED) {
416 all16BitsStereoNoResample = 0;
417 resampling = 1;
418 t.hook = track__genericResample;
419 } else {
420 if ((n & NEEDS_CHANNEL_COUNT__MASK) == NEEDS_CHANNEL_1){
421 t.hook = track__16BitsMono;
422 all16BitsStereoNoResample = 0;
423 }
424 if ((n & NEEDS_CHANNEL_COUNT__MASK) == NEEDS_CHANNEL_2){
425 t.hook = track__16BitsStereo;
426 }
427 }
428 }
429 }
430
431 // select the processing hooks
432 state->hook = process__nop;
433 if (countActiveTracks) {
434 if (resampling) {
435 if (!state->outputTemp) {
436 state->outputTemp = new int32_t[MAX_NUM_CHANNELS * state->frameCount];
437 }
438 if (!state->resampleTemp) {
439 state->resampleTemp = new int32_t[MAX_NUM_CHANNELS * state->frameCount];
440 }
441 state->hook = process__genericResampling;
442 } else {
443 if (state->outputTemp) {
444 delete [] state->outputTemp;
Glenn Kastene0feee32011-12-13 11:53:26 -0800445 state->outputTemp = NULL;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700446 }
447 if (state->resampleTemp) {
448 delete [] state->resampleTemp;
Glenn Kastene0feee32011-12-13 11:53:26 -0800449 state->resampleTemp = NULL;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700450 }
451 state->hook = process__genericNoResampling;
452 if (all16BitsStereoNoResample && !volumeRamp) {
453 if (countActiveTracks == 1) {
454 state->hook = process__OneTrack16BitsStereoNoResampling;
455 }
456 }
457 }
458 }
459
Steve Block3856b092011-10-20 11:56:00 +0100460 ALOGV("mixer configuration change: %d activeTracks (%08x) "
Mathias Agopian65ab4712010-07-14 17:59:35 -0700461 "all16BitsStereoNoResample=%d, resampling=%d, volumeRamp=%d",
462 countActiveTracks, state->enabledTracks,
463 all16BitsStereoNoResample, resampling, volumeRamp);
464
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800465 state->hook(state);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700466
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800467 // Now that the volume ramp has been done, set optimal state and
468 // track hooks for subsequent mixer process
469 if (countActiveTracks) {
470 int allMuted = 1;
471 uint32_t en = state->enabledTracks;
472 while (en) {
473 const int i = 31 - __builtin_clz(en);
474 en &= ~(1<<i);
475 track_t& t = state->tracks[i];
476 if (!t.doesResample() && t.volumeRL == 0)
477 {
478 t.needs |= NEEDS_MUTE_ENABLED;
479 t.hook = track__nop;
480 } else {
481 allMuted = 0;
482 }
483 }
484 if (allMuted) {
485 state->hook = process__nop;
486 } else if (all16BitsStereoNoResample) {
487 if (countActiveTracks == 1) {
488 state->hook = process__OneTrack16BitsStereoNoResampling;
489 }
490 }
491 }
Mathias Agopian65ab4712010-07-14 17:59:35 -0700492}
493
Mathias Agopian65ab4712010-07-14 17:59:35 -0700494
495void AudioMixer::track__genericResample(track_t* t, int32_t* out, size_t outFrameCount, int32_t* temp, int32_t* aux)
496{
497 t->resampler->setSampleRate(t->sampleRate);
498
499 // ramp gain - resample to temp buffer and scale/mix in 2nd step
500 if (aux != NULL) {
501 // always resample with unity gain when sending to auxiliary buffer to be able
502 // to apply send level after resampling
503 // TODO: modify each resampler to support aux channel?
504 t->resampler->setVolume(UNITY_GAIN, UNITY_GAIN);
505 memset(temp, 0, outFrameCount * MAX_NUM_CHANNELS * sizeof(int32_t));
506 t->resampler->resample(temp, outFrameCount, t->bufferProvider);
Glenn Kastenf6b16782011-12-15 09:51:17 -0800507 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1]|t->auxInc)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700508 volumeRampStereo(t, out, outFrameCount, temp, aux);
509 } else {
510 volumeStereo(t, out, outFrameCount, temp, aux);
511 }
512 } else {
Glenn Kastenf6b16782011-12-15 09:51:17 -0800513 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1])) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700514 t->resampler->setVolume(UNITY_GAIN, UNITY_GAIN);
515 memset(temp, 0, outFrameCount * MAX_NUM_CHANNELS * sizeof(int32_t));
516 t->resampler->resample(temp, outFrameCount, t->bufferProvider);
517 volumeRampStereo(t, out, outFrameCount, temp, aux);
518 }
519
520 // constant gain
521 else {
522 t->resampler->setVolume(t->volume[0], t->volume[1]);
523 t->resampler->resample(out, outFrameCount, t->bufferProvider);
524 }
525 }
526}
527
528void AudioMixer::track__nop(track_t* t, int32_t* out, size_t outFrameCount, int32_t* temp, int32_t* aux)
529{
530}
531
532void AudioMixer::volumeRampStereo(track_t* t, int32_t* out, size_t frameCount, int32_t* temp, int32_t* aux)
533{
534 int32_t vl = t->prevVolume[0];
535 int32_t vr = t->prevVolume[1];
536 const int32_t vlInc = t->volumeInc[0];
537 const int32_t vrInc = t->volumeInc[1];
538
Steve Blockb8a80522011-12-20 16:23:08 +0000539 //ALOGD("[0] %p: inc=%f, v0=%f, v1=%d, final=%f, count=%d",
Mathias Agopian65ab4712010-07-14 17:59:35 -0700540 // t, vlInc/65536.0f, vl/65536.0f, t->volume[0],
541 // (vl + vlInc*frameCount)/65536.0f, frameCount);
542
543 // ramp volume
Glenn Kastenf6b16782011-12-15 09:51:17 -0800544 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700545 int32_t va = t->prevAuxLevel;
546 const int32_t vaInc = t->auxInc;
547 int32_t l;
548 int32_t r;
549
550 do {
551 l = (*temp++ >> 12);
552 r = (*temp++ >> 12);
553 *out++ += (vl >> 16) * l;
554 *out++ += (vr >> 16) * r;
555 *aux++ += (va >> 17) * (l + r);
556 vl += vlInc;
557 vr += vrInc;
558 va += vaInc;
559 } while (--frameCount);
560 t->prevAuxLevel = va;
561 } else {
562 do {
563 *out++ += (vl >> 16) * (*temp++ >> 12);
564 *out++ += (vr >> 16) * (*temp++ >> 12);
565 vl += vlInc;
566 vr += vrInc;
567 } while (--frameCount);
568 }
569 t->prevVolume[0] = vl;
570 t->prevVolume[1] = vr;
571 t->adjustVolumeRamp((aux != NULL));
572}
573
574void AudioMixer::volumeStereo(track_t* t, int32_t* out, size_t frameCount, int32_t* temp, int32_t* aux)
575{
576 const int16_t vl = t->volume[0];
577 const int16_t vr = t->volume[1];
578
Glenn Kastenf6b16782011-12-15 09:51:17 -0800579 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700580 const int16_t va = (int16_t)t->auxLevel;
581 do {
582 int16_t l = (int16_t)(*temp++ >> 12);
583 int16_t r = (int16_t)(*temp++ >> 12);
584 out[0] = mulAdd(l, vl, out[0]);
585 int16_t a = (int16_t)(((int32_t)l + r) >> 1);
586 out[1] = mulAdd(r, vr, out[1]);
587 out += 2;
588 aux[0] = mulAdd(a, va, aux[0]);
589 aux++;
590 } while (--frameCount);
591 } else {
592 do {
593 int16_t l = (int16_t)(*temp++ >> 12);
594 int16_t r = (int16_t)(*temp++ >> 12);
595 out[0] = mulAdd(l, vl, out[0]);
596 out[1] = mulAdd(r, vr, out[1]);
597 out += 2;
598 } while (--frameCount);
599 }
600}
601
602void AudioMixer::track__16BitsStereo(track_t* t, int32_t* out, size_t frameCount, int32_t* temp, int32_t* aux)
603{
Glenn Kasten54c3b662012-01-06 07:46:30 -0800604 const int16_t *in = static_cast<const int16_t *>(t->in);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700605
Glenn Kastenf6b16782011-12-15 09:51:17 -0800606 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700607 int32_t l;
608 int32_t r;
609 // ramp gain
Glenn Kastenf6b16782011-12-15 09:51:17 -0800610 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1]|t->auxInc)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700611 int32_t vl = t->prevVolume[0];
612 int32_t vr = t->prevVolume[1];
613 int32_t va = t->prevAuxLevel;
614 const int32_t vlInc = t->volumeInc[0];
615 const int32_t vrInc = t->volumeInc[1];
616 const int32_t vaInc = t->auxInc;
Steve Blockb8a80522011-12-20 16:23:08 +0000617 // ALOGD("[1] %p: inc=%f, v0=%f, v1=%d, final=%f, count=%d",
Mathias Agopian65ab4712010-07-14 17:59:35 -0700618 // t, vlInc/65536.0f, vl/65536.0f, t->volume[0],
619 // (vl + vlInc*frameCount)/65536.0f, frameCount);
620
621 do {
622 l = (int32_t)*in++;
623 r = (int32_t)*in++;
624 *out++ += (vl >> 16) * l;
625 *out++ += (vr >> 16) * r;
626 *aux++ += (va >> 17) * (l + r);
627 vl += vlInc;
628 vr += vrInc;
629 va += vaInc;
630 } while (--frameCount);
631
632 t->prevVolume[0] = vl;
633 t->prevVolume[1] = vr;
634 t->prevAuxLevel = va;
635 t->adjustVolumeRamp(true);
636 }
637
638 // constant gain
639 else {
640 const uint32_t vrl = t->volumeRL;
641 const int16_t va = (int16_t)t->auxLevel;
642 do {
Glenn Kasten54c3b662012-01-06 07:46:30 -0800643 uint32_t rl = *reinterpret_cast<const uint32_t *>(in);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700644 int16_t a = (int16_t)(((int32_t)in[0] + in[1]) >> 1);
645 in += 2;
646 out[0] = mulAddRL(1, rl, vrl, out[0]);
647 out[1] = mulAddRL(0, rl, vrl, out[1]);
648 out += 2;
649 aux[0] = mulAdd(a, va, aux[0]);
650 aux++;
651 } while (--frameCount);
652 }
653 } else {
654 // ramp gain
Glenn Kastenf6b16782011-12-15 09:51:17 -0800655 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1])) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700656 int32_t vl = t->prevVolume[0];
657 int32_t vr = t->prevVolume[1];
658 const int32_t vlInc = t->volumeInc[0];
659 const int32_t vrInc = t->volumeInc[1];
660
Steve Blockb8a80522011-12-20 16:23:08 +0000661 // ALOGD("[1] %p: inc=%f, v0=%f, v1=%d, final=%f, count=%d",
Mathias Agopian65ab4712010-07-14 17:59:35 -0700662 // t, vlInc/65536.0f, vl/65536.0f, t->volume[0],
663 // (vl + vlInc*frameCount)/65536.0f, frameCount);
664
665 do {
666 *out++ += (vl >> 16) * (int32_t) *in++;
667 *out++ += (vr >> 16) * (int32_t) *in++;
668 vl += vlInc;
669 vr += vrInc;
670 } while (--frameCount);
671
672 t->prevVolume[0] = vl;
673 t->prevVolume[1] = vr;
674 t->adjustVolumeRamp(false);
675 }
676
677 // constant gain
678 else {
679 const uint32_t vrl = t->volumeRL;
680 do {
Glenn Kasten54c3b662012-01-06 07:46:30 -0800681 uint32_t rl = *reinterpret_cast<const uint32_t *>(in);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700682 in += 2;
683 out[0] = mulAddRL(1, rl, vrl, out[0]);
684 out[1] = mulAddRL(0, rl, vrl, out[1]);
685 out += 2;
686 } while (--frameCount);
687 }
688 }
689 t->in = in;
690}
691
692void AudioMixer::track__16BitsMono(track_t* t, int32_t* out, size_t frameCount, int32_t* temp, int32_t* aux)
693{
Glenn Kasten54c3b662012-01-06 07:46:30 -0800694 const int16_t *in = static_cast<int16_t const *>(t->in);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700695
Glenn Kastenf6b16782011-12-15 09:51:17 -0800696 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700697 // ramp gain
Glenn Kastenf6b16782011-12-15 09:51:17 -0800698 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1]|t->auxInc)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700699 int32_t vl = t->prevVolume[0];
700 int32_t vr = t->prevVolume[1];
701 int32_t va = t->prevAuxLevel;
702 const int32_t vlInc = t->volumeInc[0];
703 const int32_t vrInc = t->volumeInc[1];
704 const int32_t vaInc = t->auxInc;
705
Steve Blockb8a80522011-12-20 16:23:08 +0000706 // ALOGD("[2] %p: inc=%f, v0=%f, v1=%d, final=%f, count=%d",
Mathias Agopian65ab4712010-07-14 17:59:35 -0700707 // t, vlInc/65536.0f, vl/65536.0f, t->volume[0],
708 // (vl + vlInc*frameCount)/65536.0f, frameCount);
709
710 do {
711 int32_t l = *in++;
712 *out++ += (vl >> 16) * l;
713 *out++ += (vr >> 16) * l;
714 *aux++ += (va >> 16) * l;
715 vl += vlInc;
716 vr += vrInc;
717 va += vaInc;
718 } while (--frameCount);
719
720 t->prevVolume[0] = vl;
721 t->prevVolume[1] = vr;
722 t->prevAuxLevel = va;
723 t->adjustVolumeRamp(true);
724 }
725 // constant gain
726 else {
727 const int16_t vl = t->volume[0];
728 const int16_t vr = t->volume[1];
729 const int16_t va = (int16_t)t->auxLevel;
730 do {
731 int16_t l = *in++;
732 out[0] = mulAdd(l, vl, out[0]);
733 out[1] = mulAdd(l, vr, out[1]);
734 out += 2;
735 aux[0] = mulAdd(l, va, aux[0]);
736 aux++;
737 } while (--frameCount);
738 }
739 } else {
740 // ramp gain
Glenn Kastenf6b16782011-12-15 09:51:17 -0800741 if (CC_UNLIKELY(t->volumeInc[0]|t->volumeInc[1])) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700742 int32_t vl = t->prevVolume[0];
743 int32_t vr = t->prevVolume[1];
744 const int32_t vlInc = t->volumeInc[0];
745 const int32_t vrInc = t->volumeInc[1];
746
Steve Blockb8a80522011-12-20 16:23:08 +0000747 // ALOGD("[2] %p: inc=%f, v0=%f, v1=%d, final=%f, count=%d",
Mathias Agopian65ab4712010-07-14 17:59:35 -0700748 // t, vlInc/65536.0f, vl/65536.0f, t->volume[0],
749 // (vl + vlInc*frameCount)/65536.0f, frameCount);
750
751 do {
752 int32_t l = *in++;
753 *out++ += (vl >> 16) * l;
754 *out++ += (vr >> 16) * l;
755 vl += vlInc;
756 vr += vrInc;
757 } while (--frameCount);
758
759 t->prevVolume[0] = vl;
760 t->prevVolume[1] = vr;
761 t->adjustVolumeRamp(false);
762 }
763 // constant gain
764 else {
765 const int16_t vl = t->volume[0];
766 const int16_t vr = t->volume[1];
767 do {
768 int16_t l = *in++;
769 out[0] = mulAdd(l, vl, out[0]);
770 out[1] = mulAdd(l, vr, out[1]);
771 out += 2;
772 } while (--frameCount);
773 }
774 }
775 t->in = in;
776}
777
Mathias Agopian65ab4712010-07-14 17:59:35 -0700778// no-op case
779void AudioMixer::process__nop(state_t* state)
780{
781 uint32_t e0 = state->enabledTracks;
782 size_t bufSize = state->frameCount * sizeof(int16_t) * MAX_NUM_CHANNELS;
783 while (e0) {
784 // process by group of tracks with same output buffer to
785 // avoid multiple memset() on same buffer
786 uint32_t e1 = e0, e2 = e0;
787 int i = 31 - __builtin_clz(e1);
788 track_t& t1 = state->tracks[i];
789 e2 &= ~(1<<i);
790 while (e2) {
791 i = 31 - __builtin_clz(e2);
792 e2 &= ~(1<<i);
793 track_t& t2 = state->tracks[i];
Glenn Kastenf6b16782011-12-15 09:51:17 -0800794 if (CC_UNLIKELY(t2.mainBuffer != t1.mainBuffer)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700795 e1 &= ~(1<<i);
796 }
797 }
798 e0 &= ~(e1);
799
800 memset(t1.mainBuffer, 0, bufSize);
801
802 while (e1) {
803 i = 31 - __builtin_clz(e1);
804 e1 &= ~(1<<i);
805 t1 = state->tracks[i];
806 size_t outFrames = state->frameCount;
807 while (outFrames) {
808 t1.buffer.frameCount = outFrames;
809 t1.bufferProvider->getNextBuffer(&t1.buffer);
810 if (!t1.buffer.raw) break;
811 outFrames -= t1.buffer.frameCount;
812 t1.bufferProvider->releaseBuffer(&t1.buffer);
813 }
814 }
815 }
816}
817
818// generic code without resampling
819void AudioMixer::process__genericNoResampling(state_t* state)
820{
821 int32_t outTemp[BLOCKSIZE * MAX_NUM_CHANNELS] __attribute__((aligned(32)));
822
823 // acquire each track's buffer
824 uint32_t enabledTracks = state->enabledTracks;
825 uint32_t e0 = enabledTracks;
826 while (e0) {
827 const int i = 31 - __builtin_clz(e0);
828 e0 &= ~(1<<i);
829 track_t& t = state->tracks[i];
830 t.buffer.frameCount = state->frameCount;
831 t.bufferProvider->getNextBuffer(&t.buffer);
832 t.frameCount = t.buffer.frameCount;
833 t.in = t.buffer.raw;
834 // t.in == NULL can happen if the track was flushed just after having
835 // been enabled for mixing.
836 if (t.in == NULL)
837 enabledTracks &= ~(1<<i);
838 }
839
840 e0 = enabledTracks;
841 while (e0) {
842 // process by group of tracks with same output buffer to
843 // optimize cache use
844 uint32_t e1 = e0, e2 = e0;
845 int j = 31 - __builtin_clz(e1);
846 track_t& t1 = state->tracks[j];
847 e2 &= ~(1<<j);
848 while (e2) {
849 j = 31 - __builtin_clz(e2);
850 e2 &= ~(1<<j);
851 track_t& t2 = state->tracks[j];
Glenn Kastenf6b16782011-12-15 09:51:17 -0800852 if (CC_UNLIKELY(t2.mainBuffer != t1.mainBuffer)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700853 e1 &= ~(1<<j);
854 }
855 }
856 e0 &= ~(e1);
857 // this assumes output 16 bits stereo, no resampling
858 int32_t *out = t1.mainBuffer;
859 size_t numFrames = 0;
860 do {
861 memset(outTemp, 0, sizeof(outTemp));
862 e2 = e1;
863 while (e2) {
864 const int i = 31 - __builtin_clz(e2);
865 e2 &= ~(1<<i);
866 track_t& t = state->tracks[i];
867 size_t outFrames = BLOCKSIZE;
868 int32_t *aux = NULL;
Glenn Kastenf6b16782011-12-15 09:51:17 -0800869 if (CC_UNLIKELY((t.needs & NEEDS_AUX__MASK) == NEEDS_AUX_ENABLED)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700870 aux = t.auxBuffer + numFrames;
871 }
872 while (outFrames) {
873 size_t inFrames = (t.frameCount > outFrames)?outFrames:t.frameCount;
874 if (inFrames) {
875 (t.hook)(&t, outTemp + (BLOCKSIZE-outFrames)*MAX_NUM_CHANNELS, inFrames, state->resampleTemp, aux);
876 t.frameCount -= inFrames;
877 outFrames -= inFrames;
Glenn Kastenf6b16782011-12-15 09:51:17 -0800878 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700879 aux += inFrames;
880 }
881 }
882 if (t.frameCount == 0 && outFrames) {
883 t.bufferProvider->releaseBuffer(&t.buffer);
884 t.buffer.frameCount = (state->frameCount - numFrames) - (BLOCKSIZE - outFrames);
885 t.bufferProvider->getNextBuffer(&t.buffer);
886 t.in = t.buffer.raw;
887 if (t.in == NULL) {
888 enabledTracks &= ~(1<<i);
889 e1 &= ~(1<<i);
890 break;
891 }
892 t.frameCount = t.buffer.frameCount;
893 }
894 }
895 }
896 ditherAndClamp(out, outTemp, BLOCKSIZE);
897 out += BLOCKSIZE;
898 numFrames += BLOCKSIZE;
899 } while (numFrames < state->frameCount);
900 }
901
902 // release each track's buffer
903 e0 = enabledTracks;
904 while (e0) {
905 const int i = 31 - __builtin_clz(e0);
906 e0 &= ~(1<<i);
907 track_t& t = state->tracks[i];
908 t.bufferProvider->releaseBuffer(&t.buffer);
909 }
910}
911
912
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -0800913// generic code with resampling
Mathias Agopian65ab4712010-07-14 17:59:35 -0700914void AudioMixer::process__genericResampling(state_t* state)
915{
Glenn Kasten54c3b662012-01-06 07:46:30 -0800916 // this const just means that local variable outTemp doesn't change
Mathias Agopian65ab4712010-07-14 17:59:35 -0700917 int32_t* const outTemp = state->outputTemp;
918 const size_t size = sizeof(int32_t) * MAX_NUM_CHANNELS * state->frameCount;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700919
920 size_t numFrames = state->frameCount;
921
922 uint32_t e0 = state->enabledTracks;
923 while (e0) {
924 // process by group of tracks with same output buffer
925 // to optimize cache use
926 uint32_t e1 = e0, e2 = e0;
927 int j = 31 - __builtin_clz(e1);
928 track_t& t1 = state->tracks[j];
929 e2 &= ~(1<<j);
930 while (e2) {
931 j = 31 - __builtin_clz(e2);
932 e2 &= ~(1<<j);
933 track_t& t2 = state->tracks[j];
Glenn Kastenf6b16782011-12-15 09:51:17 -0800934 if (CC_UNLIKELY(t2.mainBuffer != t1.mainBuffer)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700935 e1 &= ~(1<<j);
936 }
937 }
938 e0 &= ~(e1);
939 int32_t *out = t1.mainBuffer;
Yuuhi Yamaguchi2151d7b2011-02-04 15:24:34 +0100940 memset(outTemp, 0, size);
Mathias Agopian65ab4712010-07-14 17:59:35 -0700941 while (e1) {
942 const int i = 31 - __builtin_clz(e1);
943 e1 &= ~(1<<i);
944 track_t& t = state->tracks[i];
945 int32_t *aux = NULL;
Glenn Kastenf6b16782011-12-15 09:51:17 -0800946 if (CC_UNLIKELY((t.needs & NEEDS_AUX__MASK) == NEEDS_AUX_ENABLED)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700947 aux = t.auxBuffer;
948 }
949
950 // this is a little goofy, on the resampling case we don't
951 // acquire/release the buffers because it's done by
952 // the resampler.
953 if ((t.needs & NEEDS_RESAMPLE__MASK) == NEEDS_RESAMPLE_ENABLED) {
954 (t.hook)(&t, outTemp, numFrames, state->resampleTemp, aux);
955 } else {
956
957 size_t outFrames = 0;
958
959 while (outFrames < numFrames) {
960 t.buffer.frameCount = numFrames - outFrames;
961 t.bufferProvider->getNextBuffer(&t.buffer);
962 t.in = t.buffer.raw;
963 // t.in == NULL can happen if the track was flushed just after having
964 // been enabled for mixing.
965 if (t.in == NULL) break;
966
Glenn Kastenf6b16782011-12-15 09:51:17 -0800967 if (CC_UNLIKELY(aux != NULL)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -0700968 aux += outFrames;
969 }
970 (t.hook)(&t, outTemp + outFrames*MAX_NUM_CHANNELS, t.buffer.frameCount, state->resampleTemp, aux);
971 outFrames += t.buffer.frameCount;
972 t.bufferProvider->releaseBuffer(&t.buffer);
973 }
974 }
975 }
976 ditherAndClamp(out, outTemp, numFrames);
977 }
978}
979
980// one track, 16 bits stereo without resampling is the most common case
981void AudioMixer::process__OneTrack16BitsStereoNoResampling(state_t* state)
982{
983 const int i = 31 - __builtin_clz(state->enabledTracks);
984 const track_t& t = state->tracks[i];
985
986 AudioBufferProvider::Buffer& b(t.buffer);
987
988 int32_t* out = t.mainBuffer;
989 size_t numFrames = state->frameCount;
990
991 const int16_t vl = t.volume[0];
992 const int16_t vr = t.volume[1];
993 const uint32_t vrl = t.volumeRL;
994 while (numFrames) {
995 b.frameCount = numFrames;
996 t.bufferProvider->getNextBuffer(&b);
Glenn Kasten54c3b662012-01-06 07:46:30 -0800997 const int16_t *in = b.i16;
Mathias Agopian65ab4712010-07-14 17:59:35 -0700998
999 // in == NULL can happen if the track was flushed just after having
1000 // been enabled for mixing.
1001 if (in == NULL || ((unsigned long)in & 3)) {
1002 memset(out, 0, numFrames*MAX_NUM_CHANNELS*sizeof(int16_t));
Steve Block29357bc2012-01-06 19:20:56 +00001003 ALOGE_IF(((unsigned long)in & 3), "process stereo track: input buffer alignment pb: buffer %p track %d, channels %d, needs %08x",
Mathias Agopian65ab4712010-07-14 17:59:35 -07001004 in, i, t.channelCount, t.needs);
1005 return;
1006 }
1007 size_t outFrames = b.frameCount;
1008
Glenn Kastenf6b16782011-12-15 09:51:17 -08001009 if (CC_UNLIKELY(uint32_t(vl) > UNITY_GAIN || uint32_t(vr) > UNITY_GAIN)) {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001010 // volume is boosted, so we might need to clamp even though
1011 // we process only one track.
1012 do {
Glenn Kasten54c3b662012-01-06 07:46:30 -08001013 uint32_t rl = *reinterpret_cast<const uint32_t *>(in);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001014 in += 2;
1015 int32_t l = mulRL(1, rl, vrl) >> 12;
1016 int32_t r = mulRL(0, rl, vrl) >> 12;
1017 // clamping...
1018 l = clamp16(l);
1019 r = clamp16(r);
1020 *out++ = (r<<16) | (l & 0xFFFF);
1021 } while (--outFrames);
1022 } else {
1023 do {
Glenn Kasten54c3b662012-01-06 07:46:30 -08001024 uint32_t rl = *reinterpret_cast<const uint32_t *>(in);
Mathias Agopian65ab4712010-07-14 17:59:35 -07001025 in += 2;
1026 int32_t l = mulRL(1, rl, vrl) >> 12;
1027 int32_t r = mulRL(0, rl, vrl) >> 12;
1028 *out++ = (r<<16) | (l & 0xFFFF);
1029 } while (--outFrames);
1030 }
1031 numFrames -= b.frameCount;
1032 t.bufferProvider->releaseBuffer(&b);
1033 }
1034}
1035
Glenn Kasten81a028f2011-12-15 09:53:12 -08001036#if 0
Mathias Agopian65ab4712010-07-14 17:59:35 -07001037// 2 tracks is also a common case
1038// NEVER used in current implementation of process__validate()
1039// only use if the 2 tracks have the same output buffer
1040void AudioMixer::process__TwoTracks16BitsStereoNoResampling(state_t* state)
1041{
1042 int i;
1043 uint32_t en = state->enabledTracks;
1044
1045 i = 31 - __builtin_clz(en);
1046 const track_t& t0 = state->tracks[i];
1047 AudioBufferProvider::Buffer& b0(t0.buffer);
1048
1049 en &= ~(1<<i);
1050 i = 31 - __builtin_clz(en);
1051 const track_t& t1 = state->tracks[i];
1052 AudioBufferProvider::Buffer& b1(t1.buffer);
1053
Glenn Kasten54c3b662012-01-06 07:46:30 -08001054 const int16_t *in0;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001055 const int16_t vl0 = t0.volume[0];
1056 const int16_t vr0 = t0.volume[1];
1057 size_t frameCount0 = 0;
1058
Glenn Kasten54c3b662012-01-06 07:46:30 -08001059 const int16_t *in1;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001060 const int16_t vl1 = t1.volume[0];
1061 const int16_t vr1 = t1.volume[1];
1062 size_t frameCount1 = 0;
1063
1064 //FIXME: only works if two tracks use same buffer
1065 int32_t* out = t0.mainBuffer;
1066 size_t numFrames = state->frameCount;
Glenn Kasten54c3b662012-01-06 07:46:30 -08001067 const int16_t *buff = NULL;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001068
1069
1070 while (numFrames) {
1071
1072 if (frameCount0 == 0) {
1073 b0.frameCount = numFrames;
1074 t0.bufferProvider->getNextBuffer(&b0);
1075 if (b0.i16 == NULL) {
1076 if (buff == NULL) {
1077 buff = new int16_t[MAX_NUM_CHANNELS * state->frameCount];
1078 }
1079 in0 = buff;
1080 b0.frameCount = numFrames;
1081 } else {
1082 in0 = b0.i16;
1083 }
1084 frameCount0 = b0.frameCount;
1085 }
1086 if (frameCount1 == 0) {
1087 b1.frameCount = numFrames;
1088 t1.bufferProvider->getNextBuffer(&b1);
1089 if (b1.i16 == NULL) {
1090 if (buff == NULL) {
1091 buff = new int16_t[MAX_NUM_CHANNELS * state->frameCount];
1092 }
1093 in1 = buff;
1094 b1.frameCount = numFrames;
Glenn Kastenc5ac4cb2011-12-12 09:05:55 -08001095 } else {
Mathias Agopian65ab4712010-07-14 17:59:35 -07001096 in1 = b1.i16;
1097 }
1098 frameCount1 = b1.frameCount;
1099 }
1100
1101 size_t outFrames = frameCount0 < frameCount1?frameCount0:frameCount1;
1102
1103 numFrames -= outFrames;
1104 frameCount0 -= outFrames;
1105 frameCount1 -= outFrames;
1106
1107 do {
1108 int32_t l0 = *in0++;
1109 int32_t r0 = *in0++;
1110 l0 = mul(l0, vl0);
1111 r0 = mul(r0, vr0);
1112 int32_t l = *in1++;
1113 int32_t r = *in1++;
1114 l = mulAdd(l, vl1, l0) >> 12;
1115 r = mulAdd(r, vr1, r0) >> 12;
1116 // clamping...
1117 l = clamp16(l);
1118 r = clamp16(r);
1119 *out++ = (r<<16) | (l & 0xFFFF);
1120 } while (--outFrames);
1121
1122 if (frameCount0 == 0) {
1123 t0.bufferProvider->releaseBuffer(&b0);
1124 }
1125 if (frameCount1 == 0) {
1126 t1.bufferProvider->releaseBuffer(&b1);
1127 }
1128 }
1129
Glenn Kastene9dd0172012-01-27 18:08:45 -08001130 delete [] buff;
Mathias Agopian65ab4712010-07-14 17:59:35 -07001131}
Glenn Kasten81a028f2011-12-15 09:53:12 -08001132#endif
Mathias Agopian65ab4712010-07-14 17:59:35 -07001133
1134// ----------------------------------------------------------------------------
1135}; // namespace android