104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi/* 204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Copyright (C) 2012 The Android Open Source Project 304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Licensed under the Apache License, Version 2.0 (the "License"); 504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * you may not use this file except in compliance with the License. 604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * You may obtain a copy of the License at 704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * http://www.apache.org/licenses/LICENSE-2.0 904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 1004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Unless required by applicable law or agreed to in writing, software 1104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * distributed under the License is distributed on an "AS IS" BASIS, 1204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. 1304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * See the License for the specific language governing permissions and 1404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * limitations under the License. 1504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi */ 1604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 1704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi#define LOG_TAG "EffectDownmix" 18f28c8792f64e10c3c477d86bf4804a8566ff524eJean-Michel Trivi//#define LOG_NDEBUG 0 197cb0e733210c2ce7dd2a7c9d32f6d83c4dab9656Mark Salyzyn#include <log/log.h> 207cb0e733210c2ce7dd2a7c9d32f6d83c4dab9656Mark Salyzyn#include <inttypes.h> 2104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi#include <stdlib.h> 2204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi#include <string.h> 2304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi#include <stdbool.h> 2404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi#include "EffectDownmix.h" 2504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 266895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi// Do not submit with DOWNMIX_TEST_CHANNEL_INDEX defined, strictly for testing 276895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi//#define DOWNMIX_TEST_CHANNEL_INDEX 0 286895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi// Do not submit with DOWNMIX_ALWAYS_USE_GENERIC_DOWNMIXER defined, strictly for testing 296895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi//#define DOWNMIX_ALWAYS_USE_GENERIC_DOWNMIXER 0 306895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi 3104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi#define MINUS_3_DB_IN_Q19_12 2896 // -3dB = 0.707 * 2^12 = 2896 3204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 33029a64e0327ecc1215a3d17ce50f508edae1c4a6Glenn Kasten// subset of possible audio_channel_mask_t values, and AUDIO_CHANNEL_OUT_* renamed to CHANNEL_MASK_* 34db46b48d24e03f5bcb8de6d0ff852ec4153401e7Jean-Michel Trivitypedef enum { 35029a64e0327ecc1215a3d17ce50f508edae1c4a6Glenn Kasten CHANNEL_MASK_QUAD_BACK = AUDIO_CHANNEL_OUT_QUAD_BACK, 36029a64e0327ecc1215a3d17ce50f508edae1c4a6Glenn Kasten CHANNEL_MASK_QUAD_SIDE = AUDIO_CHANNEL_OUT_QUAD_SIDE, 37029a64e0327ecc1215a3d17ce50f508edae1c4a6Glenn Kasten CHANNEL_MASK_5POINT1_BACK = AUDIO_CHANNEL_OUT_5POINT1_BACK, 38029a64e0327ecc1215a3d17ce50f508edae1c4a6Glenn Kasten CHANNEL_MASK_5POINT1_SIDE = AUDIO_CHANNEL_OUT_5POINT1_SIDE, 39029a64e0327ecc1215a3d17ce50f508edae1c4a6Glenn Kasten CHANNEL_MASK_7POINT1 = AUDIO_CHANNEL_OUT_7POINT1, 40db46b48d24e03f5bcb8de6d0ff852ec4153401e7Jean-Michel Trivi} downmix_input_channel_mask_t; 41db46b48d24e03f5bcb8de6d0ff852ec4153401e7Jean-Michel Trivi 4204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi// effect_handle_t interface implementation for downmix effect 4304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Triviconst struct effect_interface_s gDownmixInterface = { 4404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi Downmix_Process, 4504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi Downmix_Command, 4604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi Downmix_GetDescriptor, 4704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi NULL /* no process_reverse function, no reference stream needed */ 4804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi}; 4904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 507f16b197c76fbae9399242f055a7ee16dcd0fd6dMarco Nelissen// This is the only symbol that needs to be exported 517f16b197c76fbae9399242f055a7ee16dcd0fd6dMarco Nelissen__attribute__ ((visibility ("default"))) 5204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Triviaudio_effect_library_t AUDIO_EFFECT_LIBRARY_INFO_SYM = { 53c9d8ea7f8f9a1ca8ecd266695e3cac423790b2f9synergydev .tag = AUDIO_EFFECT_LIBRARY_TAG, 54c9d8ea7f8f9a1ca8ecd266695e3cac423790b2f9synergydev .version = EFFECT_LIBRARY_API_VERSION, 55c9d8ea7f8f9a1ca8ecd266695e3cac423790b2f9synergydev .name = "Downmix Library", 56c9d8ea7f8f9a1ca8ecd266695e3cac423790b2f9synergydev .implementor = "The Android Open Source Project", 57c9d8ea7f8f9a1ca8ecd266695e3cac423790b2f9synergydev .create_effect = DownmixLib_Create, 58c9d8ea7f8f9a1ca8ecd266695e3cac423790b2f9synergydev .release_effect = DownmixLib_Release, 59c9d8ea7f8f9a1ca8ecd266695e3cac423790b2f9synergydev .get_descriptor = DownmixLib_GetDescriptor, 6004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi}; 6104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 6204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 6304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi// AOSP insert downmix UUID: 93f04452-e4fe-41cc-91f9-e475b6d1d69f 6404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivistatic const effect_descriptor_t gDownmixDescriptor = { 6504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi EFFECT_UIID_DOWNMIX__, //type 6604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi {0x93f04452, 0xe4fe, 0x41cc, 0x91f9, {0xe4, 0x75, 0xb6, 0xd1, 0xd6, 0x9f}}, // uuid 6704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi EFFECT_CONTROL_API_VERSION, 6804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi EFFECT_FLAG_TYPE_INSERT | EFFECT_FLAG_INSERT_FIRST, 6904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 0, //FIXME what value should be reported? // cpu load 7004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 0, //FIXME what value should be reported? // memory usage 7104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi "Multichannel Downmix To Stereo", // human readable effect name 7204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi "The Android Open Source Project" // human readable effect implementor name 7304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi}; 7404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 7504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi// gDescriptors contains pointers to all defined effect descriptor in this library 7604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivistatic const effect_descriptor_t * const gDescriptors[] = { 7704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi &gDownmixDescriptor 7804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi}; 7904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 8004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi// number of effects in this library 8104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Triviconst int kNbEffects = sizeof(gDescriptors) / sizeof(const effect_descriptor_t *); 8204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 8304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 8404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi/*---------------------------------------------------------------------------- 856895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * Test code 866895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi *--------------------------------------------------------------------------*/ 876895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi#ifdef DOWNMIX_TEST_CHANNEL_INDEX 886895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi// strictly for testing, logs the indices of the channels for a given mask, 896895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi// uses the same code as Downmix_foldGeneric() 906895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivivoid Downmix_testIndexComputation(uint32_t mask) { 917cb0e733210c2ce7dd2a7c9d32f6d83c4dab9656Mark Salyzyn ALOGI("Testing index computation for 0x%" PRIx32 ":", mask); 926895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // check against unsupported channels 936895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi if (mask & kUnsupported) { 946895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi ALOGE("Unsupported channels (top or front left/right of center)"); 956895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi return; 966895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi } 976895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // verify has FL/FR 986895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi if ((mask & AUDIO_CHANNEL_OUT_STEREO) != AUDIO_CHANNEL_OUT_STEREO) { 996895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi ALOGE("Front channels must be present"); 1006895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi return; 1016895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi } 1026895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // verify uses SIDE as a pair (ok if not using SIDE at all) 1036895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi bool hasSides = false; 1046895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi if ((mask & kSides) != 0) { 1056895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi if ((mask & kSides) != kSides) { 1066895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi ALOGE("Side channels must be used as a pair"); 1076895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi return; 1086895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi } 1096895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi hasSides = true; 1106895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi } 1116895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // verify uses BACK as a pair (ok if not using BACK at all) 1126895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi bool hasBacks = false; 1136895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi if ((mask & kBacks) != 0) { 1146895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi if ((mask & kBacks) != kBacks) { 1156895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi ALOGE("Back channels must be used as a pair"); 1166895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi return; 1176895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi } 1186895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi hasBacks = true; 1196895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi } 1206895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi 121e541269be94f3a1072932d51537905b120ef4733Andy Hung const int numChan = audio_channel_count_from_out_mask(mask); 1226895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi const bool hasFC = ((mask & AUDIO_CHANNEL_OUT_FRONT_CENTER) == AUDIO_CHANNEL_OUT_FRONT_CENTER); 1236895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi const bool hasLFE = 1246895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi ((mask & AUDIO_CHANNEL_OUT_LOW_FREQUENCY) == AUDIO_CHANNEL_OUT_LOW_FREQUENCY); 1256895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi const bool hasBC = ((mask & AUDIO_CHANNEL_OUT_BACK_CENTER) == AUDIO_CHANNEL_OUT_BACK_CENTER); 1266895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // compute at what index each channel is: samples will be in the following order: 1276895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // FL FR FC LFE BL BR BC SL SR 1286895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // when a channel is not present, its index is set to the same as the index of the preceding 1296895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // channel 1306895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi const int indexFC = hasFC ? 2 : 1; // front center 1316895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi const int indexLFE = hasLFE ? indexFC + 1 : indexFC; // low frequency 1326895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi const int indexBL = hasBacks ? indexLFE + 1 : indexLFE; // back left 1336895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi const int indexBR = hasBacks ? indexBL + 1 : indexBL; // back right 1346895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi const int indexBC = hasBC ? indexBR + 1 : indexBR; // back center 1356895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi const int indexSL = hasSides ? indexBC + 1 : indexBC; // side left 1366895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi const int indexSR = hasSides ? indexSL + 1 : indexSL; // side right 1376895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi 1386895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi ALOGI(" FL FR FC LFE BL BR BC SL SR"); 1396895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi ALOGI(" %d %d %d %d %d %d %d %d %d", 1406895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi 0, 1, indexFC, indexLFE, indexBL, indexBR, indexBC, indexSL, indexSR); 1416895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi} 1426895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi#endif 1436895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi 1446895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi 1456895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi/*---------------------------------------------------------------------------- 14604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Effect API implementation 14704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *--------------------------------------------------------------------------*/ 14804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 14904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi/*--- Effect Library Interface Implementation ---*/ 15004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 15104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Triviint32_t DownmixLib_Create(const effect_uuid_t *uuid, 1520f714a464d2425afe00d6450535e763131b40844Eric Laurent int32_t sessionId __unused, 1530f714a464d2425afe00d6450535e763131b40844Eric Laurent int32_t ioId __unused, 15404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi effect_handle_t *pHandle) { 15504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi int ret; 15604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi int i; 15704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi downmix_module_t *module; 15804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi const effect_descriptor_t *desc; 15904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 16004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi ALOGV("DownmixLib_Create()"); 16104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 1626895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi#ifdef DOWNMIX_TEST_CHANNEL_INDEX 1636895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // should work (won't log an error) 1646895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi ALOGI("DOWNMIX_TEST_CHANNEL_INDEX: should work:"); 1656895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi Downmix_testIndexComputation(AUDIO_CHANNEL_OUT_FRONT_LEFT | AUDIO_CHANNEL_OUT_FRONT_RIGHT | 1666895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi AUDIO_CHANNEL_OUT_LOW_FREQUENCY | AUDIO_CHANNEL_OUT_BACK_CENTER); 1676895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi Downmix_testIndexComputation(CHANNEL_MASK_QUAD_SIDE | CHANNEL_MASK_QUAD_BACK); 1686895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi Downmix_testIndexComputation(CHANNEL_MASK_5POINT1_SIDE | AUDIO_CHANNEL_OUT_BACK_CENTER); 1696895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi Downmix_testIndexComputation(CHANNEL_MASK_5POINT1_BACK | AUDIO_CHANNEL_OUT_BACK_CENTER); 1706895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // shouldn't work (will log an error, won't display channel indices) 1716895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi ALOGI("DOWNMIX_TEST_CHANNEL_INDEX: should NOT work:"); 1726895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi Downmix_testIndexComputation(AUDIO_CHANNEL_OUT_FRONT_LEFT | AUDIO_CHANNEL_OUT_FRONT_RIGHT | 1736895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi AUDIO_CHANNEL_OUT_LOW_FREQUENCY | AUDIO_CHANNEL_OUT_BACK_LEFT); 1746895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi Downmix_testIndexComputation(AUDIO_CHANNEL_OUT_FRONT_LEFT | AUDIO_CHANNEL_OUT_FRONT_RIGHT | 1756895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi AUDIO_CHANNEL_OUT_LOW_FREQUENCY | AUDIO_CHANNEL_OUT_SIDE_LEFT); 1766895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi Downmix_testIndexComputation(AUDIO_CHANNEL_OUT_FRONT_LEFT | 1776895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi AUDIO_CHANNEL_OUT_BACK_LEFT | AUDIO_CHANNEL_OUT_BACK_RIGHT); 1786895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi Downmix_testIndexComputation(AUDIO_CHANNEL_OUT_FRONT_LEFT | 1796895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi AUDIO_CHANNEL_OUT_SIDE_LEFT | AUDIO_CHANNEL_OUT_SIDE_RIGHT); 1806895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi#endif 1816895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi 18204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (pHandle == NULL || uuid == NULL) { 18304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 18404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 18504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 18604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi for (i = 0 ; i < kNbEffects ; i++) { 18704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi desc = gDescriptors[i]; 18804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (memcmp(uuid, &desc->uuid, sizeof(effect_uuid_t)) == 0) { 18904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi break; 19004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 19104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 19204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 19304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (i == kNbEffects) { 19404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -ENOENT; 19504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 19604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 19704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi module = malloc(sizeof(downmix_module_t)); 19804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 19904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi module->itfe = &gDownmixInterface; 20004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 20104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi module->context.state = DOWNMIX_STATE_UNINITIALIZED; 20204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 20304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi ret = Downmix_Init(module); 20404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (ret < 0) { 20504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi ALOGW("DownmixLib_Create() init failed"); 20604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi free(module); 20704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return ret; 20804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 20904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 21004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *pHandle = (effect_handle_t) module; 21104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 2127cb0e733210c2ce7dd2a7c9d32f6d83c4dab9656Mark Salyzyn ALOGV("DownmixLib_Create() %p , size %zu", module, sizeof(downmix_module_t)); 21304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 21404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return 0; 21504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi} 21604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 21704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 21804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Triviint32_t DownmixLib_Release(effect_handle_t handle) { 21904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi downmix_module_t *pDwmModule = (downmix_module_t *)handle; 22004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 22104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi ALOGV("DownmixLib_Release() %p", handle); 22204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (handle == NULL) { 22304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 22404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 22504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 22604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDwmModule->context.state = DOWNMIX_STATE_UNINITIALIZED; 22704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 22804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi free(pDwmModule); 22904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return 0; 23004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi} 23104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 23204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 23304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Triviint32_t DownmixLib_GetDescriptor(const effect_uuid_t *uuid, effect_descriptor_t *pDescriptor) { 23404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi ALOGV("DownmixLib_GetDescriptor()"); 23504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi int i; 23604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 23704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (pDescriptor == NULL || uuid == NULL){ 23804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi ALOGE("DownmixLib_Create() called with NULL pointer"); 23904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 24004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 24104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi ALOGV("DownmixLib_GetDescriptor() nb effects=%d", kNbEffects); 24204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi for (i = 0; i < kNbEffects; i++) { 24304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi ALOGV("DownmixLib_GetDescriptor() i=%d", i); 24404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (memcmp(uuid, &gDescriptors[i]->uuid, sizeof(effect_uuid_t)) == 0) { 24504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi memcpy(pDescriptor, gDescriptors[i], sizeof(effect_descriptor_t)); 2467cb0e733210c2ce7dd2a7c9d32f6d83c4dab9656Mark Salyzyn ALOGV("EffectGetDescriptor - UUID matched downmix type %d, UUID = %" PRIx32, 24704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi i, gDescriptors[i]->uuid.timeLow); 24804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return 0; 24904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 25004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 25104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 25204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 25304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi} 25404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 25504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 25604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi/*--- Effect Control Interface Implementation ---*/ 25704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 25804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivistatic int Downmix_Process(effect_handle_t self, 25904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi audio_buffer_t *inBuffer, audio_buffer_t *outBuffer) { 26004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 26104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi downmix_object_t *pDownmixer; 26204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi int16_t *pSrc, *pDst; 26304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi downmix_module_t *pDwmModule = (downmix_module_t *)self; 26404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 26504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (pDwmModule == NULL) { 26604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 26704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 26804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 26904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (inBuffer == NULL || inBuffer->raw == NULL || 27004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi outBuffer == NULL || outBuffer->raw == NULL || 27104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi inBuffer->frameCount != outBuffer->frameCount) { 27204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 27304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 27404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 27504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDownmixer = (downmix_object_t*) &pDwmModule->context; 27604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 27704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (pDownmixer->state == DOWNMIX_STATE_UNINITIALIZED) { 27804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi ALOGE("Downmix_Process error: trying to use an uninitialized downmixer"); 27904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 28004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } else if (pDownmixer->state == DOWNMIX_STATE_INITIALIZED) { 28104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi ALOGE("Downmix_Process error: trying to use a non-configured downmixer"); 28204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -ENODATA; 28304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 28404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 28504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pSrc = inBuffer->s16; 28604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDst = outBuffer->s16; 28704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi size_t numFrames = outBuffer->frameCount; 28804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 28904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi const bool accumulate = 29004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi (pDwmModule->config.outputCfg.accessMode == EFFECT_BUFFER_ACCESS_ACCUMULATE); 2916895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi const uint32_t downmixInputChannelMask = pDwmModule->config.inputCfg.channels; 29204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 29304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi switch(pDownmixer->type) { 29404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 29504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi case DOWNMIX_TYPE_STRIP: 29604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (accumulate) { 29704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi while (numFrames) { 29804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDst[0] = clamp16(pDst[0] + pSrc[0]); 29904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDst[1] = clamp16(pDst[1] + pSrc[1]); 30004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pSrc += pDownmixer->input_channel_count; 30104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDst += 2; 30204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi numFrames--; 30304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 30404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } else { 30504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi while (numFrames) { 30604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDst[0] = pSrc[0]; 30704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDst[1] = pSrc[1]; 30804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pSrc += pDownmixer->input_channel_count; 30904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDst += 2; 31004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi numFrames--; 31104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 31204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 31304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi break; 31404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 31504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi case DOWNMIX_TYPE_FOLD: 3166895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi#ifdef DOWNMIX_ALWAYS_USE_GENERIC_DOWNMIXER 3176895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // bypass the optimized downmix routines for the common formats 3186895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi if (!Downmix_foldGeneric( 3196895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi downmixInputChannelMask, pSrc, pDst, numFrames, accumulate)) { 3207cb0e733210c2ce7dd2a7c9d32f6d83c4dab9656Mark Salyzyn ALOGE("Multichannel configuration 0x%" PRIx32 " is not supported", downmixInputChannelMask); 3216895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi return -EINVAL; 3226895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi } 3236895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi break; 3246895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi#endif 32504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // optimize for the common formats 3266895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi switch((downmix_input_channel_mask_t)downmixInputChannelMask) { 327db46b48d24e03f5bcb8de6d0ff852ec4153401e7Jean-Michel Trivi case CHANNEL_MASK_QUAD_BACK: 328db46b48d24e03f5bcb8de6d0ff852ec4153401e7Jean-Michel Trivi case CHANNEL_MASK_QUAD_SIDE: 32904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi Downmix_foldFromQuad(pSrc, pDst, numFrames, accumulate); 33004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi break; 331db46b48d24e03f5bcb8de6d0ff852ec4153401e7Jean-Michel Trivi case CHANNEL_MASK_5POINT1_BACK: 332db46b48d24e03f5bcb8de6d0ff852ec4153401e7Jean-Michel Trivi case CHANNEL_MASK_5POINT1_SIDE: 33304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi Downmix_foldFrom5Point1(pSrc, pDst, numFrames, accumulate); 33404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi break; 335029a64e0327ecc1215a3d17ce50f508edae1c4a6Glenn Kasten case CHANNEL_MASK_7POINT1: 33604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi Downmix_foldFrom7Point1(pSrc, pDst, numFrames, accumulate); 33704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi break; 33804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi default: 3396895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi if (!Downmix_foldGeneric( 3406895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi downmixInputChannelMask, pSrc, pDst, numFrames, accumulate)) { 3417cb0e733210c2ce7dd2a7c9d32f6d83c4dab9656Mark Salyzyn ALOGE("Multichannel configuration 0x%" PRIx32 " is not supported", downmixInputChannelMask); 3426895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi return -EINVAL; 3436895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi } 34404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi break; 34504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 34604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi break; 34704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 34804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi default: 34904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 35004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 35104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 35204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return 0; 35304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi} 35404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 35504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 35604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivistatic int Downmix_Command(effect_handle_t self, uint32_t cmdCode, uint32_t cmdSize, 35704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi void *pCmdData, uint32_t *replySize, void *pReplyData) { 35804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 35904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi downmix_module_t *pDwmModule = (downmix_module_t *) self; 36004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi downmix_object_t *pDownmixer; 36104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi int retsize; 36204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 36304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (pDwmModule == NULL || pDwmModule->context.state == DOWNMIX_STATE_UNINITIALIZED) { 36404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 36504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 36604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 36704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDownmixer = (downmix_object_t*) &pDwmModule->context; 36804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 3697cb0e733210c2ce7dd2a7c9d32f6d83c4dab9656Mark Salyzyn ALOGV("Downmix_Command command %" PRIu32 " cmdSize %" PRIu32, cmdCode, cmdSize); 37004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 37104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi switch (cmdCode) { 37204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi case EFFECT_CMD_INIT: 3730f714a464d2425afe00d6450535e763131b40844Eric Laurent if (pReplyData == NULL || replySize == NULL || *replySize != sizeof(int)) { 37404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 37504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 37604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *(int *) pReplyData = Downmix_Init(pDwmModule); 37704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi break; 37804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 37904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi case EFFECT_CMD_SET_CONFIG: 38004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (pCmdData == NULL || cmdSize != sizeof(effect_config_t) 3810f714a464d2425afe00d6450535e763131b40844Eric Laurent || pReplyData == NULL || replySize == NULL || *replySize != sizeof(int)) { 38204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 38304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 38404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *(int *) pReplyData = Downmix_Configure(pDwmModule, 38504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi (effect_config_t *)pCmdData, false); 38604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi break; 38704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 38804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi case EFFECT_CMD_RESET: 38904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi Downmix_Reset(pDownmixer, false); 39004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi break; 39104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 39204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi case EFFECT_CMD_GET_PARAM: 3937cb0e733210c2ce7dd2a7c9d32f6d83c4dab9656Mark Salyzyn ALOGV("Downmix_Command EFFECT_CMD_GET_PARAM pCmdData %p, *replySize %" PRIu32 ", pReplyData: %p", 39404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pCmdData, *replySize, pReplyData); 39504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (pCmdData == NULL || cmdSize < (int)(sizeof(effect_param_t) + sizeof(int32_t)) || 3960f714a464d2425afe00d6450535e763131b40844Eric Laurent pReplyData == NULL || replySize == NULL || 39704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *replySize < (int) sizeof(effect_param_t) + 2 * sizeof(int32_t)) { 39804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 39904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 40004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi effect_param_t *rep = (effect_param_t *) pReplyData; 40104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi memcpy(pReplyData, pCmdData, sizeof(effect_param_t) + sizeof(int32_t)); 4027cb0e733210c2ce7dd2a7c9d32f6d83c4dab9656Mark Salyzyn ALOGV("Downmix_Command EFFECT_CMD_GET_PARAM param %" PRId32 ", replySize %" PRIu32, 40304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *(int32_t *)rep->data, rep->vsize); 40404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi rep->status = Downmix_getParameter(pDownmixer, *(int32_t *)rep->data, &rep->vsize, 40504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi rep->data + sizeof(int32_t)); 40604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *replySize = sizeof(effect_param_t) + sizeof(int32_t) + rep->vsize; 40704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi break; 40804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 40904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi case EFFECT_CMD_SET_PARAM: 4107cb0e733210c2ce7dd2a7c9d32f6d83c4dab9656Mark Salyzyn ALOGV("Downmix_Command EFFECT_CMD_SET_PARAM cmdSize %d pCmdData %p, *replySize %" PRIu32 4117cb0e733210c2ce7dd2a7c9d32f6d83c4dab9656Mark Salyzyn ", pReplyData %p", cmdSize, pCmdData, *replySize, pReplyData); 41204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (pCmdData == NULL || (cmdSize < (int)(sizeof(effect_param_t) + sizeof(int32_t))) 4130f714a464d2425afe00d6450535e763131b40844Eric Laurent || pReplyData == NULL || replySize == NULL || *replySize != (int)sizeof(int32_t)) { 41404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 41504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 41604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi effect_param_t *cmd = (effect_param_t *) pCmdData; 41704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *(int *)pReplyData = Downmix_setParameter(pDownmixer, *(int32_t *)cmd->data, 41804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi cmd->vsize, cmd->data + sizeof(int32_t)); 41904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi break; 42004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 42104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi case EFFECT_CMD_SET_PARAM_DEFERRED: 42204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi //FIXME implement 42304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi ALOGW("Downmix_Command command EFFECT_CMD_SET_PARAM_DEFERRED not supported, FIXME"); 42404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi break; 42504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 42604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi case EFFECT_CMD_SET_PARAM_COMMIT: 42704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi //FIXME implement 42804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi ALOGW("Downmix_Command command EFFECT_CMD_SET_PARAM_COMMIT not supported, FIXME"); 42904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi break; 43004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 43104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi case EFFECT_CMD_ENABLE: 4320f714a464d2425afe00d6450535e763131b40844Eric Laurent if (pReplyData == NULL || replySize == NULL || *replySize != sizeof(int)) { 43304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 43404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 43504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (pDownmixer->state != DOWNMIX_STATE_INITIALIZED) { 43604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -ENOSYS; 43704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 43804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDownmixer->state = DOWNMIX_STATE_ACTIVE; 43904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi ALOGV("EFFECT_CMD_ENABLE() OK"); 44004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *(int *)pReplyData = 0; 44104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi break; 44204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 44304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi case EFFECT_CMD_DISABLE: 4440f714a464d2425afe00d6450535e763131b40844Eric Laurent if (pReplyData == NULL || replySize == NULL || *replySize != sizeof(int)) { 44504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 44604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 44704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (pDownmixer->state != DOWNMIX_STATE_ACTIVE) { 44804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -ENOSYS; 44904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 45004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDownmixer->state = DOWNMIX_STATE_INITIALIZED; 45104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi ALOGV("EFFECT_CMD_DISABLE() OK"); 45204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *(int *)pReplyData = 0; 45304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi break; 45404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 45504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi case EFFECT_CMD_SET_DEVICE: 45604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (pCmdData == NULL || cmdSize != (int)sizeof(uint32_t)) { 45704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 45804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 45904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // FIXME change type if playing on headset vs speaker 4607cb0e733210c2ce7dd2a7c9d32f6d83c4dab9656Mark Salyzyn ALOGV("Downmix_Command EFFECT_CMD_SET_DEVICE: 0x%08" PRIx32, *(uint32_t *)pCmdData); 46104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi break; 46204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 46304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi case EFFECT_CMD_SET_VOLUME: { 46404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // audio output is always stereo => 2 channel volumes 46504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (pCmdData == NULL || cmdSize != (int)sizeof(uint32_t) * 2) { 46604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 46704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 46804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // FIXME change volume 46904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi ALOGW("Downmix_Command command EFFECT_CMD_SET_VOLUME not supported, FIXME"); 47004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi float left = (float)(*(uint32_t *)pCmdData) / (1 << 24); 47104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi float right = (float)(*((uint32_t *)pCmdData + 1)) / (1 << 24); 47204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi ALOGV("Downmix_Command EFFECT_CMD_SET_VOLUME: left %f, right %f ", left, right); 47304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi break; 47404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 47504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 47604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi case EFFECT_CMD_SET_AUDIO_MODE: 47704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (pCmdData == NULL || cmdSize != (int)sizeof(uint32_t)) { 47804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 47904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 4807cb0e733210c2ce7dd2a7c9d32f6d83c4dab9656Mark Salyzyn ALOGV("Downmix_Command EFFECT_CMD_SET_AUDIO_MODE: %" PRIu32, *(uint32_t *)pCmdData); 48104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi break; 48204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 48304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi case EFFECT_CMD_SET_CONFIG_REVERSE: 48404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi case EFFECT_CMD_SET_INPUT_DEVICE: 48504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // these commands are ignored by a downmix effect 48604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi break; 48704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 48804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi default: 4897cb0e733210c2ce7dd2a7c9d32f6d83c4dab9656Mark Salyzyn ALOGW("Downmix_Command invalid command %" PRIu32, cmdCode); 49004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 49104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 49204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 49304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return 0; 49404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi} 49504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 49604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 49704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Triviint Downmix_GetDescriptor(effect_handle_t self, effect_descriptor_t *pDescriptor) 49804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi{ 49904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi downmix_module_t *pDwnmxModule = (downmix_module_t *) self; 50004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 50104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (pDwnmxModule == NULL || 50204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDwnmxModule->context.state == DOWNMIX_STATE_UNINITIALIZED) { 50304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 50404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 50504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 50604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi memcpy(pDescriptor, &gDownmixDescriptor, sizeof(effect_descriptor_t)); 50704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 50804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return 0; 50904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi} 51004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 51104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 51204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi/*---------------------------------------------------------------------------- 51304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Downmix internal functions 51404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *--------------------------------------------------------------------------*/ 51504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 51604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi/*---------------------------------------------------------------------------- 51704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Downmix_Init() 51804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *---------------------------------------------------------------------------- 51904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Purpose: 52004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Initialize downmix context and apply default parameters 52104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 52204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Inputs: 52304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pDwmModule pointer to downmix effect module 52404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 52504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Outputs: 52604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 52704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Returns: 52804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 0 indicates success 52904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 53004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Side Effects: 53104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * updates: 53204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pDwmModule->context.type 53304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pDwmModule->context.apply_volume_correction 53404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pDwmModule->config.inputCfg 53504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pDwmModule->config.outputCfg 53604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pDwmModule->config.inputCfg.samplingRate 53704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pDwmModule->config.outputCfg.samplingRate 53804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pDwmModule->context.state 53904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * doesn't set: 54004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pDwmModule->itfe 54104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 54204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *---------------------------------------------------------------------------- 54304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi */ 54404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 54504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Triviint Downmix_Init(downmix_module_t *pDwmModule) { 54604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 54704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi ALOGV("Downmix_Init module %p", pDwmModule); 54804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi int ret = 0; 54904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 55004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi memset(&pDwmModule->context, 0, sizeof(downmix_object_t)); 55104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 55204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDwmModule->config.inputCfg.accessMode = EFFECT_BUFFER_ACCESS_READ; 55304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDwmModule->config.inputCfg.format = AUDIO_FORMAT_PCM_16_BIT; 55404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDwmModule->config.inputCfg.channels = AUDIO_CHANNEL_OUT_7POINT1; 55504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDwmModule->config.inputCfg.bufferProvider.getBuffer = NULL; 55604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDwmModule->config.inputCfg.bufferProvider.releaseBuffer = NULL; 55704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDwmModule->config.inputCfg.bufferProvider.cookie = NULL; 55804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDwmModule->config.inputCfg.mask = EFFECT_CONFIG_ALL; 55904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 56004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDwmModule->config.inputCfg.samplingRate = 44100; 56104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDwmModule->config.outputCfg.samplingRate = pDwmModule->config.inputCfg.samplingRate; 56204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 56304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // set a default value for the access mode, but should be overwritten by caller 56404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDwmModule->config.outputCfg.accessMode = EFFECT_BUFFER_ACCESS_ACCUMULATE; 56504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDwmModule->config.outputCfg.format = AUDIO_FORMAT_PCM_16_BIT; 56604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDwmModule->config.outputCfg.channels = AUDIO_CHANNEL_OUT_STEREO; 56704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDwmModule->config.outputCfg.bufferProvider.getBuffer = NULL; 56804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDwmModule->config.outputCfg.bufferProvider.releaseBuffer = NULL; 56904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDwmModule->config.outputCfg.bufferProvider.cookie = NULL; 57004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDwmModule->config.outputCfg.mask = EFFECT_CONFIG_ALL; 57104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 57204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi ret = Downmix_Configure(pDwmModule, &pDwmModule->config, true); 57304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (ret != 0) { 57404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi ALOGV("Downmix_Init error %d on module %p", ret, pDwmModule); 57504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } else { 57604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDwmModule->context.state = DOWNMIX_STATE_INITIALIZED; 57704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 57804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 57904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return ret; 58004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi} 58104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 58204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 58304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi/*---------------------------------------------------------------------------- 58404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Downmix_Configure() 58504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *---------------------------------------------------------------------------- 58604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Purpose: 58704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Set input and output audio configuration. 58804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 58904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Inputs: 59004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pDwmModule pointer to downmix effect module 59104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pConfig pointer to effect_config_t structure containing input 59204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * and output audio parameters configuration 59304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * init true if called from init function 59404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 59504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Outputs: 59604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 59704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Returns: 59804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 0 indicates success 59904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 60004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Side Effects: 60104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 60204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *---------------------------------------------------------------------------- 60304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi */ 60404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 60504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Triviint Downmix_Configure(downmix_module_t *pDwmModule, effect_config_t *pConfig, bool init) { 60604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 60704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi downmix_object_t *pDownmixer = &pDwmModule->context; 60804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 60904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // Check configuration compatibility with build options, and effect capabilities 61004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (pConfig->inputCfg.samplingRate != pConfig->outputCfg.samplingRate 61104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi || pConfig->outputCfg.channels != DOWNMIX_OUTPUT_CHANNELS 61204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi || pConfig->inputCfg.format != AUDIO_FORMAT_PCM_16_BIT 61304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi || pConfig->outputCfg.format != AUDIO_FORMAT_PCM_16_BIT) { 61404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi ALOGE("Downmix_Configure error: invalid config"); 61504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 61604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 61704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 618a93c8c9c89ba679cf312c7d082913121bb5543c2Chih-Wei Huang if (&pDwmModule->config != pConfig) { 619a93c8c9c89ba679cf312c7d082913121bb5543c2Chih-Wei Huang memcpy(&pDwmModule->config, pConfig, sizeof(effect_config_t)); 620a93c8c9c89ba679cf312c7d082913121bb5543c2Chih-Wei Huang } 62104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 62204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (init) { 62304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDownmixer->type = DOWNMIX_TYPE_FOLD; 62404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDownmixer->apply_volume_correction = false; 62504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDownmixer->input_channel_count = 8; // matches default input of AUDIO_CHANNEL_OUT_7POINT1 62604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } else { 62704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // when configuring the effect, do not allow a blank channel mask 62804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (pConfig->inputCfg.channels == 0) { 62904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi ALOGE("Downmix_Configure error: input channel mask can't be 0"); 63004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 63104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 632e541269be94f3a1072932d51537905b120ef4733Andy Hung pDownmixer->input_channel_count = 633e541269be94f3a1072932d51537905b120ef4733Andy Hung audio_channel_count_from_out_mask(pConfig->inputCfg.channels); 63404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 63504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 63604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi Downmix_Reset(pDownmixer, init); 63704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 63804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return 0; 63904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi} 64004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 64104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 64204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi/*---------------------------------------------------------------------------- 64304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Downmix_Reset() 64404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *---------------------------------------------------------------------------- 64504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Purpose: 64604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Reset internal states. 64704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 64804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Inputs: 64904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pDownmixer pointer to downmix context 65004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * init true if called from init function 65104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 65204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Outputs: 65304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi* 65404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Returns: 65504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 0 indicates success 65604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 65704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Side Effects: 65804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 65904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *---------------------------------------------------------------------------- 66004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi */ 66104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 6620f714a464d2425afe00d6450535e763131b40844Eric Laurentint Downmix_Reset(downmix_object_t *pDownmixer __unused, bool init __unused) { 66304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // nothing to do here 66404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return 0; 66504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi} 66604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 66704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 66804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi/*---------------------------------------------------------------------------- 66904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Downmix_setParameter() 67004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *---------------------------------------------------------------------------- 67104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Purpose: 67204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Set a Downmix parameter 67304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 67404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Inputs: 67504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pDownmixer handle to instance data 67604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * param parameter 67704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pValue pointer to parameter value 67804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * size value size 67904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 68004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Outputs: 68104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 68204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Returns: 68304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 0 indicates success 68404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 68504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Side Effects: 68604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 68704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *---------------------------------------------------------------------------- 68804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi */ 689b302bd5d288be2d3363b80053ca2392560b00b25Ashok Bhatint Downmix_setParameter(downmix_object_t *pDownmixer, int32_t param, uint32_t size, void *pValue) { 69004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 69104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi int16_t value16; 6927cb0e733210c2ce7dd2a7c9d32f6d83c4dab9656Mark Salyzyn ALOGV("Downmix_setParameter, context %p, param %" PRId32 ", value16 %" PRId16 ", value32 %" PRId32, 69304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDownmixer, param, *(int16_t *)pValue, *(int32_t *)pValue); 69404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 69504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi switch (param) { 69604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 69704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi case DOWNMIX_PARAM_TYPE: 69804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (size != sizeof(downmix_type_t)) { 6997cb0e733210c2ce7dd2a7c9d32f6d83c4dab9656Mark Salyzyn ALOGE("Downmix_setParameter(DOWNMIX_PARAM_TYPE) invalid size %" PRIu32 ", should be %zu", 70004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi size, sizeof(downmix_type_t)); 70104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 70204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 70304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi value16 = *(int16_t *)pValue; 7047cb0e733210c2ce7dd2a7c9d32f6d83c4dab9656Mark Salyzyn ALOGV("set DOWNMIX_PARAM_TYPE, type %" PRId16, value16); 7057d5b26230a179cd7bcc01f6578cd80d8c15a92a5Jean-Michel Trivi if (!((value16 > DOWNMIX_TYPE_INVALID) && (value16 <= DOWNMIX_TYPE_LAST))) { 7067cb0e733210c2ce7dd2a7c9d32f6d83c4dab9656Mark Salyzyn ALOGE("Downmix_setParameter invalid DOWNMIX_PARAM_TYPE value %" PRId16, value16); 70704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 70804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } else { 70904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDownmixer->type = (downmix_type_t) value16; 71004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi break; 71104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 71204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi default: 7137cb0e733210c2ce7dd2a7c9d32f6d83c4dab9656Mark Salyzyn ALOGE("Downmix_setParameter unknown parameter %" PRId32, param); 71404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 71504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 71604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi} 71704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 71804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return 0; 71904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi} /* end Downmix_setParameter */ 72004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 72104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 72204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi/*---------------------------------------------------------------------------- 72304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Downmix_getParameter() 72404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *---------------------------------------------------------------------------- 72504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Purpose: 72604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Get a Downmix parameter 72704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 72804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Inputs: 72904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pDownmixer handle to instance data 73004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * param parameter 73104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pValue pointer to variable to hold retrieved value 73204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pSize pointer to value size: maximum size as input 73304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 73404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Outputs: 73504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * *pValue updated with parameter value 73604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * *pSize updated with actual value size 73704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 73804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Returns: 73904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 0 indicates success 74004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 74104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Side Effects: 74204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 74304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *---------------------------------------------------------------------------- 74404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi */ 745b302bd5d288be2d3363b80053ca2392560b00b25Ashok Bhatint Downmix_getParameter(downmix_object_t *pDownmixer, int32_t param, uint32_t *pSize, void *pValue) { 74604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi int16_t *pValue16; 74704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 74804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi switch (param) { 74904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 75004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi case DOWNMIX_PARAM_TYPE: 75104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (*pSize < sizeof(int16_t)) { 7527cb0e733210c2ce7dd2a7c9d32f6d83c4dab9656Mark Salyzyn ALOGE("Downmix_getParameter invalid parameter size %" PRIu32 " for DOWNMIX_PARAM_TYPE", *pSize); 75304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 75404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 75504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pValue16 = (int16_t *)pValue; 75604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *pValue16 = (int16_t) pDownmixer->type; 75704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *pSize = sizeof(int16_t); 7587cb0e733210c2ce7dd2a7c9d32f6d83c4dab9656Mark Salyzyn ALOGV("Downmix_getParameter DOWNMIX_PARAM_TYPE is %" PRId16, *pValue16); 75904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi break; 76004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 76104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi default: 7627cb0e733210c2ce7dd2a7c9d32f6d83c4dab9656Mark Salyzyn ALOGE("Downmix_getParameter unknown parameter %" PRId16, param); 76304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 76404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 76504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 76604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return 0; 76704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi} /* end Downmix_getParameter */ 76804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 76904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 77004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi/*---------------------------------------------------------------------------- 77104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Downmix_foldFromQuad() 77204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *---------------------------------------------------------------------------- 77304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Purpose: 77404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * downmix a quad signal to stereo 77504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 77604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Inputs: 77704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pSrc quad audio samples to downmix 77804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * numFrames the number of quad frames to downmix 7796895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * accumulate whether to mix (when true) the result of the downmix with the contents of pDst, 7806895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * or overwrite pDst (when false) 78104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 78204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Outputs: 78304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pDst downmixed stereo audio samples 78404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 78504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *---------------------------------------------------------------------------- 78604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi */ 78704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivivoid Downmix_foldFromQuad(int16_t *pSrc, int16_t*pDst, size_t numFrames, bool accumulate) { 78804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // sample at index 0 is FL 78904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // sample at index 1 is FR 79004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // sample at index 2 is RL 79104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // sample at index 3 is RR 79204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (accumulate) { 79304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi while (numFrames) { 79404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // FL + RL 795aea2715e65994e665a3732551880419ba1cecc0dJean-Michel Trivi pDst[0] = clamp16(pDst[0] + ((pSrc[0] + pSrc[2]) >> 1)); 79604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // FR + RR 797aea2715e65994e665a3732551880419ba1cecc0dJean-Michel Trivi pDst[1] = clamp16(pDst[1] + ((pSrc[1] + pSrc[3]) >> 1)); 79804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pSrc += 4; 79904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDst += 2; 80004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi numFrames--; 80104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 80204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } else { // same code as above but without adding and clamping pDst[i] to itself 80304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi while (numFrames) { 80404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // FL + RL 805aea2715e65994e665a3732551880419ba1cecc0dJean-Michel Trivi pDst[0] = clamp16((pSrc[0] + pSrc[2]) >> 1); 80604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // FR + RR 807aea2715e65994e665a3732551880419ba1cecc0dJean-Michel Trivi pDst[1] = clamp16((pSrc[1] + pSrc[3]) >> 1); 80804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pSrc += 4; 80904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDst += 2; 81004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi numFrames--; 81104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 81204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 81304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi} 81404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 81504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 81604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi/*---------------------------------------------------------------------------- 81704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Downmix_foldFrom5Point1() 81804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *---------------------------------------------------------------------------- 81904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Purpose: 82004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * downmix a 5.1 signal to stereo 82104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 82204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Inputs: 82304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pSrc 5.1 audio samples to downmix 82404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * numFrames the number of 5.1 frames to downmix 8256895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * accumulate whether to mix (when true) the result of the downmix with the contents of pDst, 8266895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * or overwrite pDst (when false) 82704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 82804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Outputs: 82904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pDst downmixed stereo audio samples 83004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 83104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *---------------------------------------------------------------------------- 83204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi */ 83304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivivoid Downmix_foldFrom5Point1(int16_t *pSrc, int16_t*pDst, size_t numFrames, bool accumulate) { 83404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi int32_t lt, rt, centerPlusLfeContrib; // samples in Q19.12 format 83504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // sample at index 0 is FL 83604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // sample at index 1 is FR 83704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // sample at index 2 is FC 83804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // sample at index 3 is LFE 83904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // sample at index 4 is RL 84004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // sample at index 5 is RR 8416895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // code is mostly duplicated between the two values of accumulate to avoid repeating the test 8426895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // for every sample 84304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (accumulate) { 84404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi while (numFrames) { 84504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // centerPlusLfeContrib = FC(-3dB) + LFE(-3dB) 84604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi centerPlusLfeContrib = (pSrc[2] * MINUS_3_DB_IN_Q19_12) 84704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi + (pSrc[3] * MINUS_3_DB_IN_Q19_12); 84804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // FL + centerPlusLfeContrib + RL 84904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi lt = (pSrc[0] << 12) + centerPlusLfeContrib + (pSrc[4] << 12); 85004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // FR + centerPlusLfeContrib + RR 85104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi rt = (pSrc[1] << 12) + centerPlusLfeContrib + (pSrc[5] << 12); 8526895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // accumulate in destination 853aea2715e65994e665a3732551880419ba1cecc0dJean-Michel Trivi pDst[0] = clamp16(pDst[0] + (lt >> 13)); 854aea2715e65994e665a3732551880419ba1cecc0dJean-Michel Trivi pDst[1] = clamp16(pDst[1] + (rt >> 13)); 85504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pSrc += 6; 85604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDst += 2; 85704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi numFrames--; 85804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 85904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } else { // same code as above but without adding and clamping pDst[i] to itself 86004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi while (numFrames) { 86104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // centerPlusLfeContrib = FC(-3dB) + LFE(-3dB) 86204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi centerPlusLfeContrib = (pSrc[2] * MINUS_3_DB_IN_Q19_12) 86304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi + (pSrc[3] * MINUS_3_DB_IN_Q19_12); 86404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // FL + centerPlusLfeContrib + RL 86504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi lt = (pSrc[0] << 12) + centerPlusLfeContrib + (pSrc[4] << 12); 86604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // FR + centerPlusLfeContrib + RR 86704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi rt = (pSrc[1] << 12) + centerPlusLfeContrib + (pSrc[5] << 12); 8686895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // store in destination 869aea2715e65994e665a3732551880419ba1cecc0dJean-Michel Trivi pDst[0] = clamp16(lt >> 13); // differs from when accumulate is true above 870aea2715e65994e665a3732551880419ba1cecc0dJean-Michel Trivi pDst[1] = clamp16(rt >> 13); // differs from when accumulate is true above 87104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pSrc += 6; 87204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDst += 2; 87304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi numFrames--; 87404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 87504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 87604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi} 87704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 87804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 87904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi/*---------------------------------------------------------------------------- 88004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Downmix_foldFrom7Point1() 88104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *---------------------------------------------------------------------------- 88204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Purpose: 88304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * downmix a 7.1 signal to stereo 88404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 88504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Inputs: 88604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pSrc 7.1 audio samples to downmix 88704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * numFrames the number of 7.1 frames to downmix 8886895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * accumulate whether to mix (when true) the result of the downmix with the contents of pDst, 8896895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * or overwrite pDst (when false) 89004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 89104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Outputs: 89204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pDst downmixed stereo audio samples 89304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 89404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *---------------------------------------------------------------------------- 89504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi */ 89604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivivoid Downmix_foldFrom7Point1(int16_t *pSrc, int16_t*pDst, size_t numFrames, bool accumulate) { 89704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi int32_t lt, rt, centerPlusLfeContrib; // samples in Q19.12 format 89804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // sample at index 0 is FL 89904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // sample at index 1 is FR 90004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // sample at index 2 is FC 90104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // sample at index 3 is LFE 90204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // sample at index 4 is RL 90304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // sample at index 5 is RR 90404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // sample at index 6 is SL 90504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // sample at index 7 is SR 9066895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // code is mostly duplicated between the two values of accumulate to avoid repeating the test 9076895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // for every sample 90804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (accumulate) { 90904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi while (numFrames) { 91004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // centerPlusLfeContrib = FC(-3dB) + LFE(-3dB) 91104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi centerPlusLfeContrib = (pSrc[2] * MINUS_3_DB_IN_Q19_12) 91204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi + (pSrc[3] * MINUS_3_DB_IN_Q19_12); 91304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // FL + centerPlusLfeContrib + SL + RL 91404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi lt = (pSrc[0] << 12) + centerPlusLfeContrib + (pSrc[6] << 12) + (pSrc[4] << 12); 91504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // FR + centerPlusLfeContrib + SR + RR 91604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi rt = (pSrc[1] << 12) + centerPlusLfeContrib + (pSrc[7] << 12) + (pSrc[5] << 12); 9176895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi //accumulate in destination 918aea2715e65994e665a3732551880419ba1cecc0dJean-Michel Trivi pDst[0] = clamp16(pDst[0] + (lt >> 13)); 919aea2715e65994e665a3732551880419ba1cecc0dJean-Michel Trivi pDst[1] = clamp16(pDst[1] + (rt >> 13)); 92004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pSrc += 8; 92104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDst += 2; 92204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi numFrames--; 92304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 92404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } else { // same code as above but without adding and clamping pDst[i] to itself 92504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi while (numFrames) { 92604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // centerPlusLfeContrib = FC(-3dB) + LFE(-3dB) 92704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi centerPlusLfeContrib = (pSrc[2] * MINUS_3_DB_IN_Q19_12) 92804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi + (pSrc[3] * MINUS_3_DB_IN_Q19_12); 92904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // FL + centerPlusLfeContrib + SL + RL 93004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi lt = (pSrc[0] << 12) + centerPlusLfeContrib + (pSrc[6] << 12) + (pSrc[4] << 12); 93104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // FR + centerPlusLfeContrib + SR + RR 93204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi rt = (pSrc[1] << 12) + centerPlusLfeContrib + (pSrc[7] << 12) + (pSrc[5] << 12); 9336895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // store in destination 934aea2715e65994e665a3732551880419ba1cecc0dJean-Michel Trivi pDst[0] = clamp16(lt >> 13); // differs from when accumulate is true above 935aea2715e65994e665a3732551880419ba1cecc0dJean-Michel Trivi pDst[1] = clamp16(rt >> 13); // differs from when accumulate is true above 93604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pSrc += 8; 93704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDst += 2; 93804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi numFrames--; 93904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 94004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 94104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi} 94204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 9436895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi 9446895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi/*---------------------------------------------------------------------------- 9456895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * Downmix_foldGeneric() 9466895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi *---------------------------------------------------------------------------- 9476895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * Purpose: 9486895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * downmix to stereo a multichannel signal whose format is: 9496895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * - has FL/FR 9506895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * - if using AUDIO_CHANNEL_OUT_SIDE*, it contains both left and right 9516895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * - if using AUDIO_CHANNEL_OUT_BACK*, it contains both left and right 9526895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * - doesn't use any of the AUDIO_CHANNEL_OUT_TOP* channels 9536895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * - doesn't use any of the AUDIO_CHANNEL_OUT_FRONT_*_OF_CENTER channels 9546895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * Only handles channel masks not enumerated in downmix_input_channel_mask_t 9556895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * 9566895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * Inputs: 9576895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * mask the channel mask of pSrc 9586895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * pSrc multichannel audio buffer to downmix 9596895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * numFrames the number of multichannel frames to downmix 9606895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * accumulate whether to mix (when true) the result of the downmix with the contents of pDst, 9616895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * or overwrite pDst (when false) 9626895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * 9636895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * Outputs: 9646895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * pDst downmixed stereo audio samples 9656895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * 9666895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * Returns: false if multichannel format is not supported 9676895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * 9686895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi *---------------------------------------------------------------------------- 9696895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi */ 9706895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivibool Downmix_foldGeneric( 9716895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi uint32_t mask, int16_t *pSrc, int16_t*pDst, size_t numFrames, bool accumulate) { 9726895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // check against unsupported channels 9736895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi if (mask & kUnsupported) { 9746895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi ALOGE("Unsupported channels (top or front left/right of center)"); 9756895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi return false; 9766895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi } 9776895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // verify has FL/FR 9786895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi if ((mask & AUDIO_CHANNEL_OUT_STEREO) != AUDIO_CHANNEL_OUT_STEREO) { 9796895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi ALOGE("Front channels must be present"); 9806895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi return false; 9816895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi } 9826895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // verify uses SIDE as a pair (ok if not using SIDE at all) 9836895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi bool hasSides = false; 9846895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi if ((mask & kSides) != 0) { 9856895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi if ((mask & kSides) != kSides) { 9866895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi ALOGE("Side channels must be used as a pair"); 9876895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi return false; 9886895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi } 9896895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi hasSides = true; 9906895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi } 9916895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // verify uses BACK as a pair (ok if not using BACK at all) 9926895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi bool hasBacks = false; 9936895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi if ((mask & kBacks) != 0) { 9946895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi if ((mask & kBacks) != kBacks) { 9956895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi ALOGE("Back channels must be used as a pair"); 9966895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi return false; 9976895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi } 9986895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi hasBacks = true; 9996895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi } 10006895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi 1001e541269be94f3a1072932d51537905b120ef4733Andy Hung const int numChan = audio_channel_count_from_out_mask(mask); 10026895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi const bool hasFC = ((mask & AUDIO_CHANNEL_OUT_FRONT_CENTER) == AUDIO_CHANNEL_OUT_FRONT_CENTER); 10036895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi const bool hasLFE = 10046895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi ((mask & AUDIO_CHANNEL_OUT_LOW_FREQUENCY) == AUDIO_CHANNEL_OUT_LOW_FREQUENCY); 10056895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi const bool hasBC = ((mask & AUDIO_CHANNEL_OUT_BACK_CENTER) == AUDIO_CHANNEL_OUT_BACK_CENTER); 10066895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // compute at what index each channel is: samples will be in the following order: 10076895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // FL FR FC LFE BL BR BC SL SR 10086895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // when a channel is not present, its index is set to the same as the index of the preceding 10096895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // channel 10106895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi const int indexFC = hasFC ? 2 : 1; // front center 10116895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi const int indexLFE = hasLFE ? indexFC + 1 : indexFC; // low frequency 10126895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi const int indexBL = hasBacks ? indexLFE + 1 : indexLFE; // back left 10136895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi const int indexBR = hasBacks ? indexBL + 1 : indexBL; // back right 10146895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi const int indexBC = hasBC ? indexBR + 1 : indexBR; // back center 10156895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi const int indexSL = hasSides ? indexBC + 1 : indexBC; // side left 10166895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi const int indexSR = hasSides ? indexSL + 1 : indexSL; // side right 10176895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi 10186895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi int32_t lt, rt, centersLfeContrib; // samples in Q19.12 format 10196895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // code is mostly duplicated between the two values of accumulate to avoid repeating the test 10206895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // for every sample 10216895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi if (accumulate) { 10226895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi while (numFrames) { 10236895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // compute contribution of FC, BC and LFE 10246895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi centersLfeContrib = 0; 10256895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi if (hasFC) { centersLfeContrib += pSrc[indexFC]; } 10266895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi if (hasLFE) { centersLfeContrib += pSrc[indexLFE]; } 10276895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi if (hasBC) { centersLfeContrib += pSrc[indexBC]; } 10286895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi centersLfeContrib *= MINUS_3_DB_IN_Q19_12; 10296895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // always has FL/FR 10306895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi lt = (pSrc[0] << 12); 10316895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi rt = (pSrc[1] << 12); 10326895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // mix in sides and backs 10336895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi if (hasSides) { 10346895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi lt += pSrc[indexSL] << 12; 10356895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi rt += pSrc[indexSR] << 12; 10366895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi } 10376895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi if (hasBacks) { 10386895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi lt += pSrc[indexBL] << 12; 10396895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi rt += pSrc[indexBR] << 12; 10406895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi } 10416895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi lt += centersLfeContrib; 10426895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi rt += centersLfeContrib; 10436895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // accumulate in destination 1044aea2715e65994e665a3732551880419ba1cecc0dJean-Michel Trivi pDst[0] = clamp16(pDst[0] + (lt >> 13)); 1045aea2715e65994e665a3732551880419ba1cecc0dJean-Michel Trivi pDst[1] = clamp16(pDst[1] + (rt >> 13)); 10466895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi pSrc += numChan; 10476895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi pDst += 2; 10486895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi numFrames--; 10496895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi } 10506895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi } else { 10516895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi while (numFrames) { 10526895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // compute contribution of FC, BC and LFE 10536895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi centersLfeContrib = 0; 10546895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi if (hasFC) { centersLfeContrib += pSrc[indexFC]; } 10556895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi if (hasLFE) { centersLfeContrib += pSrc[indexLFE]; } 10566895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi if (hasBC) { centersLfeContrib += pSrc[indexBC]; } 10576895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi centersLfeContrib *= MINUS_3_DB_IN_Q19_12; 10586895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // always has FL/FR 10596895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi lt = (pSrc[0] << 12); 10606895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi rt = (pSrc[1] << 12); 10616895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // mix in sides and backs 10626895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi if (hasSides) { 10636895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi lt += pSrc[indexSL] << 12; 10646895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi rt += pSrc[indexSR] << 12; 10656895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi } 10666895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi if (hasBacks) { 10676895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi lt += pSrc[indexBL] << 12; 10686895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi rt += pSrc[indexBR] << 12; 10696895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi } 10706895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi lt += centersLfeContrib; 10716895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi rt += centersLfeContrib; 10726895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // store in destination 1073aea2715e65994e665a3732551880419ba1cecc0dJean-Michel Trivi pDst[0] = clamp16(lt >> 13); // differs from when accumulate is true above 1074aea2715e65994e665a3732551880419ba1cecc0dJean-Michel Trivi pDst[1] = clamp16(rt >> 13); // differs from when accumulate is true above 10756895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi pSrc += numChan; 10766895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi pDst += 2; 10776895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi numFrames--; 10786895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi } 10796895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi } 10806895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi return true; 10816895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi} 1082