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 1960d02077d86d2d1092443519290101f503aa6f7aMark Salyzyn 207cb0e733210c2ce7dd2a7c9d32f6d83c4dab9656Mark Salyzyn#include <inttypes.h> 2160d02077d86d2d1092443519290101f503aa6f7aMark Salyzyn#include <stdbool.h> 2204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi#include <stdlib.h> 2304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi#include <string.h> 2460d02077d86d2d1092443519290101f503aa6f7aMark Salyzyn 25eb16561336e6445f7edae047998f2459e046cdfeMark Salyzyn#include <log/log.h> 2660d02077d86d2d1092443519290101f503aa6f7aMark Salyzyn 2704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi#include "EffectDownmix.h" 2804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 296895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi// Do not submit with DOWNMIX_TEST_CHANNEL_INDEX defined, strictly for testing 306895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi//#define DOWNMIX_TEST_CHANNEL_INDEX 0 316895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi// Do not submit with DOWNMIX_ALWAYS_USE_GENERIC_DOWNMIXER defined, strictly for testing 326895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi//#define DOWNMIX_ALWAYS_USE_GENERIC_DOWNMIXER 0 336895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi 3404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi#define MINUS_3_DB_IN_Q19_12 2896 // -3dB = 0.707 * 2^12 = 2896 3504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 36029a64e0327ecc1215a3d17ce50f508edae1c4a6Glenn Kasten// subset of possible audio_channel_mask_t values, and AUDIO_CHANNEL_OUT_* renamed to CHANNEL_MASK_* 37db46b48d24e03f5bcb8de6d0ff852ec4153401e7Jean-Michel Trivitypedef enum { 38029a64e0327ecc1215a3d17ce50f508edae1c4a6Glenn Kasten CHANNEL_MASK_QUAD_BACK = AUDIO_CHANNEL_OUT_QUAD_BACK, 39029a64e0327ecc1215a3d17ce50f508edae1c4a6Glenn Kasten CHANNEL_MASK_QUAD_SIDE = AUDIO_CHANNEL_OUT_QUAD_SIDE, 40029a64e0327ecc1215a3d17ce50f508edae1c4a6Glenn Kasten CHANNEL_MASK_5POINT1_BACK = AUDIO_CHANNEL_OUT_5POINT1_BACK, 41029a64e0327ecc1215a3d17ce50f508edae1c4a6Glenn Kasten CHANNEL_MASK_5POINT1_SIDE = AUDIO_CHANNEL_OUT_5POINT1_SIDE, 42029a64e0327ecc1215a3d17ce50f508edae1c4a6Glenn Kasten CHANNEL_MASK_7POINT1 = AUDIO_CHANNEL_OUT_7POINT1, 43db46b48d24e03f5bcb8de6d0ff852ec4153401e7Jean-Michel Trivi} downmix_input_channel_mask_t; 44db46b48d24e03f5bcb8de6d0ff852ec4153401e7Jean-Michel Trivi 4504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi// effect_handle_t interface implementation for downmix effect 4604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Triviconst struct effect_interface_s gDownmixInterface = { 4704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi Downmix_Process, 4804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi Downmix_Command, 4904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi Downmix_GetDescriptor, 5004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi NULL /* no process_reverse function, no reference stream needed */ 5104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi}; 5204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 537f16b197c76fbae9399242f055a7ee16dcd0fd6dMarco Nelissen// This is the only symbol that needs to be exported 547f16b197c76fbae9399242f055a7ee16dcd0fd6dMarco Nelissen__attribute__ ((visibility ("default"))) 5504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Triviaudio_effect_library_t AUDIO_EFFECT_LIBRARY_INFO_SYM = { 56c9d8ea7f8f9a1ca8ecd266695e3cac423790b2f9synergydev .tag = AUDIO_EFFECT_LIBRARY_TAG, 57c9d8ea7f8f9a1ca8ecd266695e3cac423790b2f9synergydev .version = EFFECT_LIBRARY_API_VERSION, 58c9d8ea7f8f9a1ca8ecd266695e3cac423790b2f9synergydev .name = "Downmix Library", 59c9d8ea7f8f9a1ca8ecd266695e3cac423790b2f9synergydev .implementor = "The Android Open Source Project", 60c9d8ea7f8f9a1ca8ecd266695e3cac423790b2f9synergydev .create_effect = DownmixLib_Create, 61c9d8ea7f8f9a1ca8ecd266695e3cac423790b2f9synergydev .release_effect = DownmixLib_Release, 62c9d8ea7f8f9a1ca8ecd266695e3cac423790b2f9synergydev .get_descriptor = DownmixLib_GetDescriptor, 6304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi}; 6404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 6504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 6604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi// AOSP insert downmix UUID: 93f04452-e4fe-41cc-91f9-e475b6d1d69f 6704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivistatic const effect_descriptor_t gDownmixDescriptor = { 6804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi EFFECT_UIID_DOWNMIX__, //type 6904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi {0x93f04452, 0xe4fe, 0x41cc, 0x91f9, {0xe4, 0x75, 0xb6, 0xd1, 0xd6, 0x9f}}, // uuid 7004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi EFFECT_CONTROL_API_VERSION, 7104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi EFFECT_FLAG_TYPE_INSERT | EFFECT_FLAG_INSERT_FIRST, 7204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 0, //FIXME what value should be reported? // cpu load 7304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 0, //FIXME what value should be reported? // memory usage 7404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi "Multichannel Downmix To Stereo", // human readable effect name 7504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi "The Android Open Source Project" // human readable effect implementor name 7604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi}; 7704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 7804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi// gDescriptors contains pointers to all defined effect descriptor in this library 7904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivistatic const effect_descriptor_t * const gDescriptors[] = { 8004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi &gDownmixDescriptor 8104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi}; 8204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 8304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi// number of effects in this library 8404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Triviconst int kNbEffects = sizeof(gDescriptors) / sizeof(const effect_descriptor_t *); 8504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 8604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 8704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi/*---------------------------------------------------------------------------- 886895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * Test code 896895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi *--------------------------------------------------------------------------*/ 906895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi#ifdef DOWNMIX_TEST_CHANNEL_INDEX 916895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi// strictly for testing, logs the indices of the channels for a given mask, 926895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi// uses the same code as Downmix_foldGeneric() 936895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivivoid Downmix_testIndexComputation(uint32_t mask) { 947cb0e733210c2ce7dd2a7c9d32f6d83c4dab9656Mark Salyzyn ALOGI("Testing index computation for 0x%" PRIx32 ":", mask); 956895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // check against unsupported channels 966895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi if (mask & kUnsupported) { 976895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi ALOGE("Unsupported channels (top or front left/right of center)"); 986895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi return; 996895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi } 1006895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // verify has FL/FR 1016895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi if ((mask & AUDIO_CHANNEL_OUT_STEREO) != AUDIO_CHANNEL_OUT_STEREO) { 1026895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi ALOGE("Front channels must be present"); 1036895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi return; 1046895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi } 1056895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // verify uses SIDE as a pair (ok if not using SIDE at all) 1066895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi bool hasSides = false; 1076895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi if ((mask & kSides) != 0) { 1086895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi if ((mask & kSides) != kSides) { 1096895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi ALOGE("Side channels must be used as a pair"); 1106895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi return; 1116895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi } 1126895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi hasSides = true; 1136895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi } 1146895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // verify uses BACK as a pair (ok if not using BACK at all) 1156895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi bool hasBacks = false; 1166895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi if ((mask & kBacks) != 0) { 1176895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi if ((mask & kBacks) != kBacks) { 1186895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi ALOGE("Back channels must be used as a pair"); 1196895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi return; 1206895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi } 1216895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi hasBacks = true; 1226895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi } 1236895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi 124e541269be94f3a1072932d51537905b120ef4733Andy Hung const int numChan = audio_channel_count_from_out_mask(mask); 1256895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi const bool hasFC = ((mask & AUDIO_CHANNEL_OUT_FRONT_CENTER) == AUDIO_CHANNEL_OUT_FRONT_CENTER); 1266895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi const bool hasLFE = 1276895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi ((mask & AUDIO_CHANNEL_OUT_LOW_FREQUENCY) == AUDIO_CHANNEL_OUT_LOW_FREQUENCY); 1286895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi const bool hasBC = ((mask & AUDIO_CHANNEL_OUT_BACK_CENTER) == AUDIO_CHANNEL_OUT_BACK_CENTER); 1296895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // compute at what index each channel is: samples will be in the following order: 1306895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // FL FR FC LFE BL BR BC SL SR 1316895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // when a channel is not present, its index is set to the same as the index of the preceding 1326895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // channel 1336895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi const int indexFC = hasFC ? 2 : 1; // front center 1346895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi const int indexLFE = hasLFE ? indexFC + 1 : indexFC; // low frequency 1356895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi const int indexBL = hasBacks ? indexLFE + 1 : indexLFE; // back left 1366895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi const int indexBR = hasBacks ? indexBL + 1 : indexBL; // back right 1376895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi const int indexBC = hasBC ? indexBR + 1 : indexBR; // back center 1386895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi const int indexSL = hasSides ? indexBC + 1 : indexBC; // side left 1396895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi const int indexSR = hasSides ? indexSL + 1 : indexSL; // side right 1406895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi 1416895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi ALOGI(" FL FR FC LFE BL BR BC SL SR"); 1426895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi ALOGI(" %d %d %d %d %d %d %d %d %d", 1436895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi 0, 1, indexFC, indexLFE, indexBL, indexBR, indexBC, indexSL, indexSR); 1446895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi} 1456895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi#endif 1466895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi 147ee507ef9e5115a923d20f5cf840d128dd49fb00fHaynes Mathew Georgestatic bool Downmix_validChannelMask(uint32_t mask) 148ee507ef9e5115a923d20f5cf840d128dd49fb00fHaynes Mathew George{ 149ee507ef9e5115a923d20f5cf840d128dd49fb00fHaynes Mathew George if (!mask) { 150ee507ef9e5115a923d20f5cf840d128dd49fb00fHaynes Mathew George return false; 151ee507ef9e5115a923d20f5cf840d128dd49fb00fHaynes Mathew George } 152ee507ef9e5115a923d20f5cf840d128dd49fb00fHaynes Mathew George // check against unsupported channels 153ee507ef9e5115a923d20f5cf840d128dd49fb00fHaynes Mathew George if (mask & kUnsupported) { 154ee507ef9e5115a923d20f5cf840d128dd49fb00fHaynes Mathew George ALOGE("Unsupported channels (top or front left/right of center)"); 155ee507ef9e5115a923d20f5cf840d128dd49fb00fHaynes Mathew George return false; 156ee507ef9e5115a923d20f5cf840d128dd49fb00fHaynes Mathew George } 157ee507ef9e5115a923d20f5cf840d128dd49fb00fHaynes Mathew George // verify has FL/FR 158ee507ef9e5115a923d20f5cf840d128dd49fb00fHaynes Mathew George if ((mask & AUDIO_CHANNEL_OUT_STEREO) != AUDIO_CHANNEL_OUT_STEREO) { 159ee507ef9e5115a923d20f5cf840d128dd49fb00fHaynes Mathew George ALOGE("Front channels must be present"); 160ee507ef9e5115a923d20f5cf840d128dd49fb00fHaynes Mathew George return false; 161ee507ef9e5115a923d20f5cf840d128dd49fb00fHaynes Mathew George } 162ee507ef9e5115a923d20f5cf840d128dd49fb00fHaynes Mathew George // verify uses SIDE as a pair (ok if not using SIDE at all) 163ee507ef9e5115a923d20f5cf840d128dd49fb00fHaynes Mathew George if ((mask & kSides) != 0) { 164ee507ef9e5115a923d20f5cf840d128dd49fb00fHaynes Mathew George if ((mask & kSides) != kSides) { 165ee507ef9e5115a923d20f5cf840d128dd49fb00fHaynes Mathew George ALOGE("Side channels must be used as a pair"); 166ee507ef9e5115a923d20f5cf840d128dd49fb00fHaynes Mathew George return false; 167ee507ef9e5115a923d20f5cf840d128dd49fb00fHaynes Mathew George } 168ee507ef9e5115a923d20f5cf840d128dd49fb00fHaynes Mathew George } 169ee507ef9e5115a923d20f5cf840d128dd49fb00fHaynes Mathew George // verify uses BACK as a pair (ok if not using BACK at all) 170ee507ef9e5115a923d20f5cf840d128dd49fb00fHaynes Mathew George if ((mask & kBacks) != 0) { 171ee507ef9e5115a923d20f5cf840d128dd49fb00fHaynes Mathew George if ((mask & kBacks) != kBacks) { 172ee507ef9e5115a923d20f5cf840d128dd49fb00fHaynes Mathew George ALOGE("Back channels must be used as a pair"); 173ee507ef9e5115a923d20f5cf840d128dd49fb00fHaynes Mathew George return false; 174ee507ef9e5115a923d20f5cf840d128dd49fb00fHaynes Mathew George } 175ee507ef9e5115a923d20f5cf840d128dd49fb00fHaynes Mathew George } 176ee507ef9e5115a923d20f5cf840d128dd49fb00fHaynes Mathew George return true; 177ee507ef9e5115a923d20f5cf840d128dd49fb00fHaynes Mathew George} 1786895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi 1796895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi/*---------------------------------------------------------------------------- 18004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Effect API implementation 18104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *--------------------------------------------------------------------------*/ 18204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 18304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi/*--- Effect Library Interface Implementation ---*/ 18404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 18504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Triviint32_t DownmixLib_Create(const effect_uuid_t *uuid, 1860f714a464d2425afe00d6450535e763131b40844Eric Laurent int32_t sessionId __unused, 1870f714a464d2425afe00d6450535e763131b40844Eric Laurent int32_t ioId __unused, 18804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi effect_handle_t *pHandle) { 18904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi int ret; 19004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi int i; 19104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi downmix_module_t *module; 19204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi const effect_descriptor_t *desc; 19304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 19404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi ALOGV("DownmixLib_Create()"); 19504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 1966895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi#ifdef DOWNMIX_TEST_CHANNEL_INDEX 1976895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // should work (won't log an error) 1986895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi ALOGI("DOWNMIX_TEST_CHANNEL_INDEX: should work:"); 1996895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi Downmix_testIndexComputation(AUDIO_CHANNEL_OUT_FRONT_LEFT | AUDIO_CHANNEL_OUT_FRONT_RIGHT | 2006895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi AUDIO_CHANNEL_OUT_LOW_FREQUENCY | AUDIO_CHANNEL_OUT_BACK_CENTER); 2016895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi Downmix_testIndexComputation(CHANNEL_MASK_QUAD_SIDE | CHANNEL_MASK_QUAD_BACK); 2026895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi Downmix_testIndexComputation(CHANNEL_MASK_5POINT1_SIDE | AUDIO_CHANNEL_OUT_BACK_CENTER); 2036895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi Downmix_testIndexComputation(CHANNEL_MASK_5POINT1_BACK | AUDIO_CHANNEL_OUT_BACK_CENTER); 2046895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // shouldn't work (will log an error, won't display channel indices) 2056895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi ALOGI("DOWNMIX_TEST_CHANNEL_INDEX: should NOT work:"); 2066895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi Downmix_testIndexComputation(AUDIO_CHANNEL_OUT_FRONT_LEFT | AUDIO_CHANNEL_OUT_FRONT_RIGHT | 2076895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi AUDIO_CHANNEL_OUT_LOW_FREQUENCY | AUDIO_CHANNEL_OUT_BACK_LEFT); 2086895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi Downmix_testIndexComputation(AUDIO_CHANNEL_OUT_FRONT_LEFT | AUDIO_CHANNEL_OUT_FRONT_RIGHT | 2096895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi AUDIO_CHANNEL_OUT_LOW_FREQUENCY | AUDIO_CHANNEL_OUT_SIDE_LEFT); 2106895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi Downmix_testIndexComputation(AUDIO_CHANNEL_OUT_FRONT_LEFT | 2116895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi AUDIO_CHANNEL_OUT_BACK_LEFT | AUDIO_CHANNEL_OUT_BACK_RIGHT); 2126895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi Downmix_testIndexComputation(AUDIO_CHANNEL_OUT_FRONT_LEFT | 2136895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi AUDIO_CHANNEL_OUT_SIDE_LEFT | AUDIO_CHANNEL_OUT_SIDE_RIGHT); 2146895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi#endif 2156895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi 21604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (pHandle == NULL || uuid == NULL) { 21704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 21804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 21904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 22004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi for (i = 0 ; i < kNbEffects ; i++) { 22104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi desc = gDescriptors[i]; 22204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (memcmp(uuid, &desc->uuid, sizeof(effect_uuid_t)) == 0) { 22304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi break; 22404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 22504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 22604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 22704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (i == kNbEffects) { 22804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -ENOENT; 22904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 23004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 23104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi module = malloc(sizeof(downmix_module_t)); 23204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 23304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi module->itfe = &gDownmixInterface; 23404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 23504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi module->context.state = DOWNMIX_STATE_UNINITIALIZED; 23604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 23704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi ret = Downmix_Init(module); 23804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (ret < 0) { 23904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi ALOGW("DownmixLib_Create() init failed"); 24004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi free(module); 24104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return ret; 24204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 24304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 24404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *pHandle = (effect_handle_t) module; 24504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 2467cb0e733210c2ce7dd2a7c9d32f6d83c4dab9656Mark Salyzyn ALOGV("DownmixLib_Create() %p , size %zu", module, sizeof(downmix_module_t)); 24704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 24804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return 0; 24904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi} 25004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 25104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 25204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Triviint32_t DownmixLib_Release(effect_handle_t handle) { 25304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi downmix_module_t *pDwmModule = (downmix_module_t *)handle; 25404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 25504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi ALOGV("DownmixLib_Release() %p", handle); 25604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (handle == NULL) { 25704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 25804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 25904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 26004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDwmModule->context.state = DOWNMIX_STATE_UNINITIALIZED; 26104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 26204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi free(pDwmModule); 26304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return 0; 26404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi} 26504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 26604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 26704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Triviint32_t DownmixLib_GetDescriptor(const effect_uuid_t *uuid, effect_descriptor_t *pDescriptor) { 26804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi ALOGV("DownmixLib_GetDescriptor()"); 26904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi int i; 27004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 27104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (pDescriptor == NULL || uuid == NULL){ 27204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi ALOGE("DownmixLib_Create() called with NULL pointer"); 27304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 27404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 27504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi ALOGV("DownmixLib_GetDescriptor() nb effects=%d", kNbEffects); 27604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi for (i = 0; i < kNbEffects; i++) { 27704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi ALOGV("DownmixLib_GetDescriptor() i=%d", i); 27804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (memcmp(uuid, &gDescriptors[i]->uuid, sizeof(effect_uuid_t)) == 0) { 27904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi memcpy(pDescriptor, gDescriptors[i], sizeof(effect_descriptor_t)); 2807cb0e733210c2ce7dd2a7c9d32f6d83c4dab9656Mark Salyzyn ALOGV("EffectGetDescriptor - UUID matched downmix type %d, UUID = %" PRIx32, 28104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi i, gDescriptors[i]->uuid.timeLow); 28204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return 0; 28304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 28404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 28504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 28604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 28704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi} 28804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 28904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 29004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi/*--- Effect Control Interface Implementation ---*/ 29104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 29204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivistatic int Downmix_Process(effect_handle_t self, 29304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi audio_buffer_t *inBuffer, audio_buffer_t *outBuffer) { 29404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 29504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi downmix_object_t *pDownmixer; 29604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi int16_t *pSrc, *pDst; 29704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi downmix_module_t *pDwmModule = (downmix_module_t *)self; 29804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 29904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (pDwmModule == NULL) { 30004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 30104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 30204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 30304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (inBuffer == NULL || inBuffer->raw == NULL || 30404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi outBuffer == NULL || outBuffer->raw == NULL || 30504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi inBuffer->frameCount != outBuffer->frameCount) { 30604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 30704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 30804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 30904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDownmixer = (downmix_object_t*) &pDwmModule->context; 31004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 31104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (pDownmixer->state == DOWNMIX_STATE_UNINITIALIZED) { 31204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi ALOGE("Downmix_Process error: trying to use an uninitialized downmixer"); 31304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 31404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } else if (pDownmixer->state == DOWNMIX_STATE_INITIALIZED) { 31504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi ALOGE("Downmix_Process error: trying to use a non-configured downmixer"); 31604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -ENODATA; 31704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 31804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 31904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pSrc = inBuffer->s16; 32004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDst = outBuffer->s16; 32104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi size_t numFrames = outBuffer->frameCount; 32204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 32304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi const bool accumulate = 32404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi (pDwmModule->config.outputCfg.accessMode == EFFECT_BUFFER_ACCESS_ACCUMULATE); 3256895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi const uint32_t downmixInputChannelMask = pDwmModule->config.inputCfg.channels; 32604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 32704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi switch(pDownmixer->type) { 32804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 32904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi case DOWNMIX_TYPE_STRIP: 33004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (accumulate) { 33104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi while (numFrames) { 33204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDst[0] = clamp16(pDst[0] + pSrc[0]); 33304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDst[1] = clamp16(pDst[1] + pSrc[1]); 33404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pSrc += pDownmixer->input_channel_count; 33504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDst += 2; 33604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi numFrames--; 33704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 33804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } else { 33904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi while (numFrames) { 34004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDst[0] = pSrc[0]; 34104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDst[1] = pSrc[1]; 34204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pSrc += pDownmixer->input_channel_count; 34304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDst += 2; 34404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi numFrames--; 34504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 34604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 34704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi break; 34804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 34904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi case DOWNMIX_TYPE_FOLD: 3506895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi#ifdef DOWNMIX_ALWAYS_USE_GENERIC_DOWNMIXER 3516895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // bypass the optimized downmix routines for the common formats 3526895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi if (!Downmix_foldGeneric( 3536895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi downmixInputChannelMask, pSrc, pDst, numFrames, accumulate)) { 3547cb0e733210c2ce7dd2a7c9d32f6d83c4dab9656Mark Salyzyn ALOGE("Multichannel configuration 0x%" PRIx32 " is not supported", downmixInputChannelMask); 3556895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi return -EINVAL; 3566895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi } 3576895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi break; 3586895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi#endif 35904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // optimize for the common formats 3606895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi switch((downmix_input_channel_mask_t)downmixInputChannelMask) { 361db46b48d24e03f5bcb8de6d0ff852ec4153401e7Jean-Michel Trivi case CHANNEL_MASK_QUAD_BACK: 362db46b48d24e03f5bcb8de6d0ff852ec4153401e7Jean-Michel Trivi case CHANNEL_MASK_QUAD_SIDE: 36304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi Downmix_foldFromQuad(pSrc, pDst, numFrames, accumulate); 36404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi break; 365db46b48d24e03f5bcb8de6d0ff852ec4153401e7Jean-Michel Trivi case CHANNEL_MASK_5POINT1_BACK: 366db46b48d24e03f5bcb8de6d0ff852ec4153401e7Jean-Michel Trivi case CHANNEL_MASK_5POINT1_SIDE: 36704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi Downmix_foldFrom5Point1(pSrc, pDst, numFrames, accumulate); 36804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi break; 369029a64e0327ecc1215a3d17ce50f508edae1c4a6Glenn Kasten case CHANNEL_MASK_7POINT1: 37004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi Downmix_foldFrom7Point1(pSrc, pDst, numFrames, accumulate); 37104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi break; 37204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi default: 3736895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi if (!Downmix_foldGeneric( 3746895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi downmixInputChannelMask, pSrc, pDst, numFrames, accumulate)) { 3757cb0e733210c2ce7dd2a7c9d32f6d83c4dab9656Mark Salyzyn ALOGE("Multichannel configuration 0x%" PRIx32 " is not supported", downmixInputChannelMask); 3766895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi return -EINVAL; 3776895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi } 37804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi break; 37904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 38004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi break; 38104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 38204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi default: 38304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 38404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 38504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 38604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return 0; 38704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi} 38804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 38904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 39004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivistatic int Downmix_Command(effect_handle_t self, uint32_t cmdCode, uint32_t cmdSize, 39104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi void *pCmdData, uint32_t *replySize, void *pReplyData) { 39204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 39304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi downmix_module_t *pDwmModule = (downmix_module_t *) self; 39404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi downmix_object_t *pDownmixer; 39504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 39604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (pDwmModule == NULL || pDwmModule->context.state == DOWNMIX_STATE_UNINITIALIZED) { 39704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 39804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 39904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 40004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDownmixer = (downmix_object_t*) &pDwmModule->context; 40104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 4027cb0e733210c2ce7dd2a7c9d32f6d83c4dab9656Mark Salyzyn ALOGV("Downmix_Command command %" PRIu32 " cmdSize %" PRIu32, cmdCode, cmdSize); 40304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 40404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi switch (cmdCode) { 40504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi case EFFECT_CMD_INIT: 4060f714a464d2425afe00d6450535e763131b40844Eric Laurent if (pReplyData == NULL || replySize == NULL || *replySize != sizeof(int)) { 40704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 40804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 40904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *(int *) pReplyData = Downmix_Init(pDwmModule); 41004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi break; 41104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 41204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi case EFFECT_CMD_SET_CONFIG: 41304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (pCmdData == NULL || cmdSize != sizeof(effect_config_t) 4140f714a464d2425afe00d6450535e763131b40844Eric Laurent || pReplyData == NULL || replySize == NULL || *replySize != sizeof(int)) { 41504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 41604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 41704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *(int *) pReplyData = Downmix_Configure(pDwmModule, 41804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi (effect_config_t *)pCmdData, false); 41904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi break; 42004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 42104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi case EFFECT_CMD_RESET: 42204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi Downmix_Reset(pDownmixer, false); 42304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi break; 42404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 42504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi case EFFECT_CMD_GET_PARAM: 4267cb0e733210c2ce7dd2a7c9d32f6d83c4dab9656Mark Salyzyn ALOGV("Downmix_Command EFFECT_CMD_GET_PARAM pCmdData %p, *replySize %" PRIu32 ", pReplyData: %p", 42704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pCmdData, *replySize, pReplyData); 42804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (pCmdData == NULL || cmdSize < (int)(sizeof(effect_param_t) + sizeof(int32_t)) || 4290f714a464d2425afe00d6450535e763131b40844Eric Laurent pReplyData == NULL || replySize == NULL || 43004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *replySize < (int) sizeof(effect_param_t) + 2 * sizeof(int32_t)) { 43104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 43204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 43304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi effect_param_t *rep = (effect_param_t *) pReplyData; 43404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi memcpy(pReplyData, pCmdData, sizeof(effect_param_t) + sizeof(int32_t)); 4357cb0e733210c2ce7dd2a7c9d32f6d83c4dab9656Mark Salyzyn ALOGV("Downmix_Command EFFECT_CMD_GET_PARAM param %" PRId32 ", replySize %" PRIu32, 43604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *(int32_t *)rep->data, rep->vsize); 43704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi rep->status = Downmix_getParameter(pDownmixer, *(int32_t *)rep->data, &rep->vsize, 43804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi rep->data + sizeof(int32_t)); 43904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *replySize = sizeof(effect_param_t) + sizeof(int32_t) + rep->vsize; 44004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi break; 44104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 44204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi case EFFECT_CMD_SET_PARAM: 4437cb0e733210c2ce7dd2a7c9d32f6d83c4dab9656Mark Salyzyn ALOGV("Downmix_Command EFFECT_CMD_SET_PARAM cmdSize %d pCmdData %p, *replySize %" PRIu32 4447cb0e733210c2ce7dd2a7c9d32f6d83c4dab9656Mark Salyzyn ", pReplyData %p", cmdSize, pCmdData, *replySize, pReplyData); 44504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (pCmdData == NULL || (cmdSize < (int)(sizeof(effect_param_t) + sizeof(int32_t))) 4460f714a464d2425afe00d6450535e763131b40844Eric Laurent || pReplyData == NULL || replySize == NULL || *replySize != (int)sizeof(int32_t)) { 44704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 44804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 44904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi effect_param_t *cmd = (effect_param_t *) pCmdData; 45004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *(int *)pReplyData = Downmix_setParameter(pDownmixer, *(int32_t *)cmd->data, 45104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi cmd->vsize, cmd->data + sizeof(int32_t)); 45204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi break; 45304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 45404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi case EFFECT_CMD_SET_PARAM_DEFERRED: 45504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi //FIXME implement 45604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi ALOGW("Downmix_Command command EFFECT_CMD_SET_PARAM_DEFERRED not supported, FIXME"); 45704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi break; 45804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 45904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi case EFFECT_CMD_SET_PARAM_COMMIT: 46004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi //FIXME implement 46104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi ALOGW("Downmix_Command command EFFECT_CMD_SET_PARAM_COMMIT not supported, FIXME"); 46204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi break; 46304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 46404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi case EFFECT_CMD_ENABLE: 4650f714a464d2425afe00d6450535e763131b40844Eric Laurent if (pReplyData == NULL || replySize == NULL || *replySize != sizeof(int)) { 46604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 46704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 46804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (pDownmixer->state != DOWNMIX_STATE_INITIALIZED) { 46904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -ENOSYS; 47004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 47104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDownmixer->state = DOWNMIX_STATE_ACTIVE; 47204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi ALOGV("EFFECT_CMD_ENABLE() OK"); 47304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *(int *)pReplyData = 0; 47404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi break; 47504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 47604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi case EFFECT_CMD_DISABLE: 4770f714a464d2425afe00d6450535e763131b40844Eric Laurent if (pReplyData == NULL || replySize == NULL || *replySize != sizeof(int)) { 47804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 47904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 48004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (pDownmixer->state != DOWNMIX_STATE_ACTIVE) { 48104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -ENOSYS; 48204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 48304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDownmixer->state = DOWNMIX_STATE_INITIALIZED; 48404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi ALOGV("EFFECT_CMD_DISABLE() OK"); 48504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *(int *)pReplyData = 0; 48604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi break; 48704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 48804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi case EFFECT_CMD_SET_DEVICE: 48904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (pCmdData == NULL || cmdSize != (int)sizeof(uint32_t)) { 49004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 49104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 49204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // FIXME change type if playing on headset vs speaker 4937cb0e733210c2ce7dd2a7c9d32f6d83c4dab9656Mark Salyzyn ALOGV("Downmix_Command EFFECT_CMD_SET_DEVICE: 0x%08" PRIx32, *(uint32_t *)pCmdData); 49404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi break; 49504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 49604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi case EFFECT_CMD_SET_VOLUME: { 49704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // audio output is always stereo => 2 channel volumes 49804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (pCmdData == NULL || cmdSize != (int)sizeof(uint32_t) * 2) { 49904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 50004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 50104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // FIXME change volume 50204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi ALOGW("Downmix_Command command EFFECT_CMD_SET_VOLUME not supported, FIXME"); 50304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi float left = (float)(*(uint32_t *)pCmdData) / (1 << 24); 50404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi float right = (float)(*((uint32_t *)pCmdData + 1)) / (1 << 24); 50504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi ALOGV("Downmix_Command EFFECT_CMD_SET_VOLUME: left %f, right %f ", left, right); 50604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi break; 50704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 50804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 50904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi case EFFECT_CMD_SET_AUDIO_MODE: 51004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (pCmdData == NULL || cmdSize != (int)sizeof(uint32_t)) { 51104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 51204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 5137cb0e733210c2ce7dd2a7c9d32f6d83c4dab9656Mark Salyzyn ALOGV("Downmix_Command EFFECT_CMD_SET_AUDIO_MODE: %" PRIu32, *(uint32_t *)pCmdData); 51404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi break; 51504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 51604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi case EFFECT_CMD_SET_CONFIG_REVERSE: 51704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi case EFFECT_CMD_SET_INPUT_DEVICE: 51804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // these commands are ignored by a downmix effect 51904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi break; 52004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 52104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi default: 5227cb0e733210c2ce7dd2a7c9d32f6d83c4dab9656Mark Salyzyn ALOGW("Downmix_Command invalid command %" PRIu32, cmdCode); 52304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 52404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 52504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 52604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return 0; 52704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi} 52804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 52904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 53004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Triviint Downmix_GetDescriptor(effect_handle_t self, effect_descriptor_t *pDescriptor) 53104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi{ 53204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi downmix_module_t *pDwnmxModule = (downmix_module_t *) self; 53304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 53404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (pDwnmxModule == NULL || 53504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDwnmxModule->context.state == DOWNMIX_STATE_UNINITIALIZED) { 53604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 53704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 53804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 53904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi memcpy(pDescriptor, &gDownmixDescriptor, sizeof(effect_descriptor_t)); 54004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 54104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return 0; 54204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi} 54304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 54404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 54504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi/*---------------------------------------------------------------------------- 54604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Downmix internal functions 54704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *--------------------------------------------------------------------------*/ 54804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 54904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi/*---------------------------------------------------------------------------- 55004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Downmix_Init() 55104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *---------------------------------------------------------------------------- 55204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Purpose: 55304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Initialize downmix context and apply default parameters 55404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 55504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Inputs: 55604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pDwmModule pointer to downmix effect module 55704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 55804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Outputs: 55904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 56004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Returns: 56104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 0 indicates success 56204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 56304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Side Effects: 56404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * updates: 56504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pDwmModule->context.type 56604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pDwmModule->context.apply_volume_correction 56704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pDwmModule->config.inputCfg 56804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pDwmModule->config.outputCfg 56904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pDwmModule->config.inputCfg.samplingRate 57004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pDwmModule->config.outputCfg.samplingRate 57104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pDwmModule->context.state 57204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * doesn't set: 57304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pDwmModule->itfe 57404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 57504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *---------------------------------------------------------------------------- 57604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi */ 57704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 57804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Triviint Downmix_Init(downmix_module_t *pDwmModule) { 57904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 58004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi ALOGV("Downmix_Init module %p", pDwmModule); 58104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi int ret = 0; 58204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 58304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi memset(&pDwmModule->context, 0, sizeof(downmix_object_t)); 58404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 58504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDwmModule->config.inputCfg.accessMode = EFFECT_BUFFER_ACCESS_READ; 58604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDwmModule->config.inputCfg.format = AUDIO_FORMAT_PCM_16_BIT; 58704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDwmModule->config.inputCfg.channels = AUDIO_CHANNEL_OUT_7POINT1; 58804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDwmModule->config.inputCfg.bufferProvider.getBuffer = NULL; 58904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDwmModule->config.inputCfg.bufferProvider.releaseBuffer = NULL; 59004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDwmModule->config.inputCfg.bufferProvider.cookie = NULL; 59104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDwmModule->config.inputCfg.mask = EFFECT_CONFIG_ALL; 59204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 59304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDwmModule->config.inputCfg.samplingRate = 44100; 59404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDwmModule->config.outputCfg.samplingRate = pDwmModule->config.inputCfg.samplingRate; 59504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 59604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // set a default value for the access mode, but should be overwritten by caller 59704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDwmModule->config.outputCfg.accessMode = EFFECT_BUFFER_ACCESS_ACCUMULATE; 59804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDwmModule->config.outputCfg.format = AUDIO_FORMAT_PCM_16_BIT; 59904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDwmModule->config.outputCfg.channels = AUDIO_CHANNEL_OUT_STEREO; 60004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDwmModule->config.outputCfg.bufferProvider.getBuffer = NULL; 60104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDwmModule->config.outputCfg.bufferProvider.releaseBuffer = NULL; 60204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDwmModule->config.outputCfg.bufferProvider.cookie = NULL; 60304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDwmModule->config.outputCfg.mask = EFFECT_CONFIG_ALL; 60404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 60504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi ret = Downmix_Configure(pDwmModule, &pDwmModule->config, true); 60604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (ret != 0) { 60704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi ALOGV("Downmix_Init error %d on module %p", ret, pDwmModule); 60804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } else { 60904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDwmModule->context.state = DOWNMIX_STATE_INITIALIZED; 61004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 61104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 61204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return ret; 61304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi} 61404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 61504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 61604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi/*---------------------------------------------------------------------------- 61704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Downmix_Configure() 61804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *---------------------------------------------------------------------------- 61904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Purpose: 62004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Set input and output audio configuration. 62104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 62204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Inputs: 62304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pDwmModule pointer to downmix effect module 62404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pConfig pointer to effect_config_t structure containing input 62504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * and output audio parameters configuration 62604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * init true if called from init function 62704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 62804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Outputs: 62904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 63004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Returns: 63104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 0 indicates success 63204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 63304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Side Effects: 63404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 63504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *---------------------------------------------------------------------------- 63604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi */ 63704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 63804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Triviint Downmix_Configure(downmix_module_t *pDwmModule, effect_config_t *pConfig, bool init) { 63904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 64004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi downmix_object_t *pDownmixer = &pDwmModule->context; 64104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 64204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // Check configuration compatibility with build options, and effect capabilities 64304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (pConfig->inputCfg.samplingRate != pConfig->outputCfg.samplingRate 64404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi || pConfig->outputCfg.channels != DOWNMIX_OUTPUT_CHANNELS 64504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi || pConfig->inputCfg.format != AUDIO_FORMAT_PCM_16_BIT 64604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi || pConfig->outputCfg.format != AUDIO_FORMAT_PCM_16_BIT) { 64704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi ALOGE("Downmix_Configure error: invalid config"); 64804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 64904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 65004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 651a93c8c9c89ba679cf312c7d082913121bb5543c2Chih-Wei Huang if (&pDwmModule->config != pConfig) { 652a93c8c9c89ba679cf312c7d082913121bb5543c2Chih-Wei Huang memcpy(&pDwmModule->config, pConfig, sizeof(effect_config_t)); 653a93c8c9c89ba679cf312c7d082913121bb5543c2Chih-Wei Huang } 65404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 65504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (init) { 65604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDownmixer->type = DOWNMIX_TYPE_FOLD; 65704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDownmixer->apply_volume_correction = false; 65804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDownmixer->input_channel_count = 8; // matches default input of AUDIO_CHANNEL_OUT_7POINT1 65904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } else { 660ee507ef9e5115a923d20f5cf840d128dd49fb00fHaynes Mathew George // when configuring the effect, do not allow a blank or unsupported channel mask 661ee507ef9e5115a923d20f5cf840d128dd49fb00fHaynes Mathew George if (!Downmix_validChannelMask(pConfig->inputCfg.channels)) { 662ee507ef9e5115a923d20f5cf840d128dd49fb00fHaynes Mathew George ALOGE("Downmix_Configure error: input channel mask(0x%x) not supported", 663ee507ef9e5115a923d20f5cf840d128dd49fb00fHaynes Mathew George pConfig->inputCfg.channels); 66404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 66504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 666e541269be94f3a1072932d51537905b120ef4733Andy Hung pDownmixer->input_channel_count = 667e541269be94f3a1072932d51537905b120ef4733Andy Hung audio_channel_count_from_out_mask(pConfig->inputCfg.channels); 66804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 66904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 67004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi Downmix_Reset(pDownmixer, init); 67104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 67204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return 0; 67304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi} 67404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 67504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 67604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi/*---------------------------------------------------------------------------- 67704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Downmix_Reset() 67804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *---------------------------------------------------------------------------- 67904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Purpose: 68004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Reset internal states. 68104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 68204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Inputs: 68304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pDownmixer pointer to downmix context 68404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * init true if called from init function 68504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 68604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Outputs: 68704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi* 68804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Returns: 68904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 0 indicates success 69004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 69104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Side Effects: 69204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 69304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *---------------------------------------------------------------------------- 69404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi */ 69504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 6960f714a464d2425afe00d6450535e763131b40844Eric Laurentint Downmix_Reset(downmix_object_t *pDownmixer __unused, bool init __unused) { 69704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // nothing to do here 69804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return 0; 69904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi} 70004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 70104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 70204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi/*---------------------------------------------------------------------------- 70304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Downmix_setParameter() 70404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *---------------------------------------------------------------------------- 70504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Purpose: 70604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Set a Downmix parameter 70704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 70804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Inputs: 70904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pDownmixer handle to instance data 71004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * param parameter 71104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pValue pointer to parameter value 71204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * size value size 71304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 71404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Outputs: 71504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 71604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Returns: 71704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 0 indicates success 71804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 71904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Side Effects: 72004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 72104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *---------------------------------------------------------------------------- 72204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi */ 723b302bd5d288be2d3363b80053ca2392560b00b25Ashok Bhatint Downmix_setParameter(downmix_object_t *pDownmixer, int32_t param, uint32_t size, void *pValue) { 72404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 72504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi int16_t value16; 7267cb0e733210c2ce7dd2a7c9d32f6d83c4dab9656Mark Salyzyn ALOGV("Downmix_setParameter, context %p, param %" PRId32 ", value16 %" PRId16 ", value32 %" PRId32, 72704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDownmixer, param, *(int16_t *)pValue, *(int32_t *)pValue); 72804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 72904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi switch (param) { 73004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 73104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi case DOWNMIX_PARAM_TYPE: 73204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (size != sizeof(downmix_type_t)) { 7337cb0e733210c2ce7dd2a7c9d32f6d83c4dab9656Mark Salyzyn ALOGE("Downmix_setParameter(DOWNMIX_PARAM_TYPE) invalid size %" PRIu32 ", should be %zu", 73404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi size, sizeof(downmix_type_t)); 73504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 73604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 73704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi value16 = *(int16_t *)pValue; 7387cb0e733210c2ce7dd2a7c9d32f6d83c4dab9656Mark Salyzyn ALOGV("set DOWNMIX_PARAM_TYPE, type %" PRId16, value16); 7397d5b26230a179cd7bcc01f6578cd80d8c15a92a5Jean-Michel Trivi if (!((value16 > DOWNMIX_TYPE_INVALID) && (value16 <= DOWNMIX_TYPE_LAST))) { 7407cb0e733210c2ce7dd2a7c9d32f6d83c4dab9656Mark Salyzyn ALOGE("Downmix_setParameter invalid DOWNMIX_PARAM_TYPE value %" PRId16, value16); 74104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 74204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } else { 74304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDownmixer->type = (downmix_type_t) value16; 74404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi break; 74504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 74604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi default: 7477cb0e733210c2ce7dd2a7c9d32f6d83c4dab9656Mark Salyzyn ALOGE("Downmix_setParameter unknown parameter %" PRId32, param); 74804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 74904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 75004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi} 75104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 75204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return 0; 75304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi} /* end Downmix_setParameter */ 75404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 75504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 75604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi/*---------------------------------------------------------------------------- 75704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Downmix_getParameter() 75804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *---------------------------------------------------------------------------- 75904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Purpose: 76004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Get a Downmix parameter 76104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 76204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Inputs: 76304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pDownmixer handle to instance data 76404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * param parameter 76504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pValue pointer to variable to hold retrieved value 76604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pSize pointer to value size: maximum size as input 76704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 76804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Outputs: 76904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * *pValue updated with parameter value 77004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * *pSize updated with actual value size 77104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 77204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Returns: 77304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 0 indicates success 77404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 77504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Side Effects: 77604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 77704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *---------------------------------------------------------------------------- 77804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi */ 779b302bd5d288be2d3363b80053ca2392560b00b25Ashok Bhatint Downmix_getParameter(downmix_object_t *pDownmixer, int32_t param, uint32_t *pSize, void *pValue) { 78004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi int16_t *pValue16; 78104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 78204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi switch (param) { 78304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 78404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi case DOWNMIX_PARAM_TYPE: 78504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (*pSize < sizeof(int16_t)) { 7867cb0e733210c2ce7dd2a7c9d32f6d83c4dab9656Mark Salyzyn ALOGE("Downmix_getParameter invalid parameter size %" PRIu32 " for DOWNMIX_PARAM_TYPE", *pSize); 78704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 78804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 78904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pValue16 = (int16_t *)pValue; 79004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *pValue16 = (int16_t) pDownmixer->type; 79104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *pSize = sizeof(int16_t); 7927cb0e733210c2ce7dd2a7c9d32f6d83c4dab9656Mark Salyzyn ALOGV("Downmix_getParameter DOWNMIX_PARAM_TYPE is %" PRId16, *pValue16); 79304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi break; 79404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 79504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi default: 7967cb0e733210c2ce7dd2a7c9d32f6d83c4dab9656Mark Salyzyn ALOGE("Downmix_getParameter unknown parameter %" PRId16, param); 79704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return -EINVAL; 79804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 79904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 80004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi return 0; 80104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi} /* end Downmix_getParameter */ 80204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 80304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 80404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi/*---------------------------------------------------------------------------- 80504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Downmix_foldFromQuad() 80604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *---------------------------------------------------------------------------- 80704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Purpose: 80804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * downmix a quad signal to stereo 80904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 81004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Inputs: 81104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pSrc quad audio samples to downmix 81204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * numFrames the number of quad frames to downmix 8136895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * accumulate whether to mix (when true) the result of the downmix with the contents of pDst, 8146895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * or overwrite pDst (when false) 81504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 81604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Outputs: 81704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pDst downmixed stereo audio samples 81804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 81904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *---------------------------------------------------------------------------- 82004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi */ 82104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivivoid Downmix_foldFromQuad(int16_t *pSrc, int16_t*pDst, size_t numFrames, bool accumulate) { 82204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // sample at index 0 is FL 82304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // sample at index 1 is FR 82404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // sample at index 2 is RL 82504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // sample at index 3 is RR 82604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (accumulate) { 82704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi while (numFrames) { 82804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // FL + RL 829aea2715e65994e665a3732551880419ba1cecc0dJean-Michel Trivi pDst[0] = clamp16(pDst[0] + ((pSrc[0] + pSrc[2]) >> 1)); 83004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // FR + RR 831aea2715e65994e665a3732551880419ba1cecc0dJean-Michel Trivi pDst[1] = clamp16(pDst[1] + ((pSrc[1] + pSrc[3]) >> 1)); 83204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pSrc += 4; 83304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDst += 2; 83404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi numFrames--; 83504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 83604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } else { // same code as above but without adding and clamping pDst[i] to itself 83704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi while (numFrames) { 83804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // FL + RL 839aea2715e65994e665a3732551880419ba1cecc0dJean-Michel Trivi pDst[0] = clamp16((pSrc[0] + pSrc[2]) >> 1); 84004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // FR + RR 841aea2715e65994e665a3732551880419ba1cecc0dJean-Michel Trivi pDst[1] = clamp16((pSrc[1] + pSrc[3]) >> 1); 84204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pSrc += 4; 84304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDst += 2; 84404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi numFrames--; 84504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 84604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 84704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi} 84804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 84904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 85004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi/*---------------------------------------------------------------------------- 85104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Downmix_foldFrom5Point1() 85204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *---------------------------------------------------------------------------- 85304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Purpose: 85404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * downmix a 5.1 signal to stereo 85504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 85604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Inputs: 85704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pSrc 5.1 audio samples to downmix 85804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * numFrames the number of 5.1 frames to downmix 8596895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * accumulate whether to mix (when true) the result of the downmix with the contents of pDst, 8606895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * or overwrite pDst (when false) 86104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 86204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Outputs: 86304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pDst downmixed stereo audio samples 86404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 86504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *---------------------------------------------------------------------------- 86604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi */ 86704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivivoid Downmix_foldFrom5Point1(int16_t *pSrc, int16_t*pDst, size_t numFrames, bool accumulate) { 86804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi int32_t lt, rt, centerPlusLfeContrib; // samples in Q19.12 format 86904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // sample at index 0 is FL 87004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // sample at index 1 is FR 87104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // sample at index 2 is FC 87204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // sample at index 3 is LFE 87304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // sample at index 4 is RL 87404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // sample at index 5 is RR 8756895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // code is mostly duplicated between the two values of accumulate to avoid repeating the test 8766895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // for every sample 87704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (accumulate) { 87804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi while (numFrames) { 87904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // centerPlusLfeContrib = FC(-3dB) + LFE(-3dB) 88004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi centerPlusLfeContrib = (pSrc[2] * MINUS_3_DB_IN_Q19_12) 88104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi + (pSrc[3] * MINUS_3_DB_IN_Q19_12); 88204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // FL + centerPlusLfeContrib + RL 88304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi lt = (pSrc[0] << 12) + centerPlusLfeContrib + (pSrc[4] << 12); 88404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // FR + centerPlusLfeContrib + RR 88504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi rt = (pSrc[1] << 12) + centerPlusLfeContrib + (pSrc[5] << 12); 8866895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // accumulate in destination 887aea2715e65994e665a3732551880419ba1cecc0dJean-Michel Trivi pDst[0] = clamp16(pDst[0] + (lt >> 13)); 888aea2715e65994e665a3732551880419ba1cecc0dJean-Michel Trivi pDst[1] = clamp16(pDst[1] + (rt >> 13)); 88904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pSrc += 6; 89004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDst += 2; 89104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi numFrames--; 89204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 89304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } else { // same code as above but without adding and clamping pDst[i] to itself 89404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi while (numFrames) { 89504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // centerPlusLfeContrib = FC(-3dB) + LFE(-3dB) 89604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi centerPlusLfeContrib = (pSrc[2] * MINUS_3_DB_IN_Q19_12) 89704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi + (pSrc[3] * MINUS_3_DB_IN_Q19_12); 89804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // FL + centerPlusLfeContrib + RL 89904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi lt = (pSrc[0] << 12) + centerPlusLfeContrib + (pSrc[4] << 12); 90004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // FR + centerPlusLfeContrib + RR 90104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi rt = (pSrc[1] << 12) + centerPlusLfeContrib + (pSrc[5] << 12); 9026895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // store in destination 903aea2715e65994e665a3732551880419ba1cecc0dJean-Michel Trivi pDst[0] = clamp16(lt >> 13); // differs from when accumulate is true above 904aea2715e65994e665a3732551880419ba1cecc0dJean-Michel Trivi pDst[1] = clamp16(rt >> 13); // differs from when accumulate is true above 90504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pSrc += 6; 90604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDst += 2; 90704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi numFrames--; 90804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 90904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 91004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi} 91104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 91204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 91304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi/*---------------------------------------------------------------------------- 91404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Downmix_foldFrom7Point1() 91504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *---------------------------------------------------------------------------- 91604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Purpose: 91704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * downmix a 7.1 signal to stereo 91804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 91904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Inputs: 92004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pSrc 7.1 audio samples to downmix 92104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * numFrames the number of 7.1 frames to downmix 9226895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * accumulate whether to mix (when true) the result of the downmix with the contents of pDst, 9236895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * or overwrite pDst (when false) 92404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 92504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * Outputs: 92604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * pDst downmixed stereo audio samples 92704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi * 92804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi *---------------------------------------------------------------------------- 92904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi */ 93004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivivoid Downmix_foldFrom7Point1(int16_t *pSrc, int16_t*pDst, size_t numFrames, bool accumulate) { 93104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi int32_t lt, rt, centerPlusLfeContrib; // samples in Q19.12 format 93204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // sample at index 0 is FL 93304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // sample at index 1 is FR 93404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // sample at index 2 is FC 93504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // sample at index 3 is LFE 93604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // sample at index 4 is RL 93704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // sample at index 5 is RR 93804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // sample at index 6 is SL 93904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // sample at index 7 is SR 9406895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // code is mostly duplicated between the two values of accumulate to avoid repeating the test 9416895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // for every sample 94204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi if (accumulate) { 94304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi while (numFrames) { 94404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // centerPlusLfeContrib = FC(-3dB) + LFE(-3dB) 94504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi centerPlusLfeContrib = (pSrc[2] * MINUS_3_DB_IN_Q19_12) 94604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi + (pSrc[3] * MINUS_3_DB_IN_Q19_12); 94704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // FL + centerPlusLfeContrib + SL + RL 94804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi lt = (pSrc[0] << 12) + centerPlusLfeContrib + (pSrc[6] << 12) + (pSrc[4] << 12); 94904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // FR + centerPlusLfeContrib + SR + RR 95004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi rt = (pSrc[1] << 12) + centerPlusLfeContrib + (pSrc[7] << 12) + (pSrc[5] << 12); 9516895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi //accumulate in destination 952aea2715e65994e665a3732551880419ba1cecc0dJean-Michel Trivi pDst[0] = clamp16(pDst[0] + (lt >> 13)); 953aea2715e65994e665a3732551880419ba1cecc0dJean-Michel Trivi pDst[1] = clamp16(pDst[1] + (rt >> 13)); 95404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pSrc += 8; 95504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDst += 2; 95604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi numFrames--; 95704c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 95804c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } else { // same code as above but without adding and clamping pDst[i] to itself 95904c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi while (numFrames) { 96004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // centerPlusLfeContrib = FC(-3dB) + LFE(-3dB) 96104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi centerPlusLfeContrib = (pSrc[2] * MINUS_3_DB_IN_Q19_12) 96204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi + (pSrc[3] * MINUS_3_DB_IN_Q19_12); 96304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // FL + centerPlusLfeContrib + SL + RL 96404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi lt = (pSrc[0] << 12) + centerPlusLfeContrib + (pSrc[6] << 12) + (pSrc[4] << 12); 96504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi // FR + centerPlusLfeContrib + SR + RR 96604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi rt = (pSrc[1] << 12) + centerPlusLfeContrib + (pSrc[7] << 12) + (pSrc[5] << 12); 9676895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // store in destination 968aea2715e65994e665a3732551880419ba1cecc0dJean-Michel Trivi pDst[0] = clamp16(lt >> 13); // differs from when accumulate is true above 969aea2715e65994e665a3732551880419ba1cecc0dJean-Michel Trivi pDst[1] = clamp16(rt >> 13); // differs from when accumulate is true above 97004c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pSrc += 8; 97104c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi pDst += 2; 97204c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi numFrames--; 97304c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 97404c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi } 97504c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi} 97604c1e531b5913c09aa9b2e59e2b8ed9b4d8a4cbaJean-Michel Trivi 9776895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi 9786895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi/*---------------------------------------------------------------------------- 9796895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * Downmix_foldGeneric() 9806895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi *---------------------------------------------------------------------------- 9816895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * Purpose: 9826895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * downmix to stereo a multichannel signal whose format is: 9836895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * - has FL/FR 9846895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * - if using AUDIO_CHANNEL_OUT_SIDE*, it contains both left and right 9856895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * - if using AUDIO_CHANNEL_OUT_BACK*, it contains both left and right 9866895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * - doesn't use any of the AUDIO_CHANNEL_OUT_TOP* channels 9876895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * - doesn't use any of the AUDIO_CHANNEL_OUT_FRONT_*_OF_CENTER channels 9886895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * Only handles channel masks not enumerated in downmix_input_channel_mask_t 9896895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * 9906895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * Inputs: 9916895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * mask the channel mask of pSrc 9926895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * pSrc multichannel audio buffer to downmix 9936895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * numFrames the number of multichannel frames to downmix 9946895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * accumulate whether to mix (when true) the result of the downmix with the contents of pDst, 9956895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * or overwrite pDst (when false) 9966895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * 9976895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * Outputs: 9986895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * pDst downmixed stereo audio samples 9996895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * 10006895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * Returns: false if multichannel format is not supported 10016895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi * 10026895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi *---------------------------------------------------------------------------- 10036895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi */ 10046895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivibool Downmix_foldGeneric( 10056895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi uint32_t mask, int16_t *pSrc, int16_t*pDst, size_t numFrames, bool accumulate) { 1006ee507ef9e5115a923d20f5cf840d128dd49fb00fHaynes Mathew George 1007ee507ef9e5115a923d20f5cf840d128dd49fb00fHaynes Mathew George if (!Downmix_validChannelMask(mask)) { 10086895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi return false; 10096895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi } 1010ee507ef9e5115a923d20f5cf840d128dd49fb00fHaynes Mathew George 1011ee507ef9e5115a923d20f5cf840d128dd49fb00fHaynes Mathew George const bool hasSides = (mask & kSides) != 0; 1012ee507ef9e5115a923d20f5cf840d128dd49fb00fHaynes Mathew George const bool hasBacks = (mask & kBacks) != 0; 10136895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi 1014e541269be94f3a1072932d51537905b120ef4733Andy Hung const int numChan = audio_channel_count_from_out_mask(mask); 10156895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi const bool hasFC = ((mask & AUDIO_CHANNEL_OUT_FRONT_CENTER) == AUDIO_CHANNEL_OUT_FRONT_CENTER); 10166895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi const bool hasLFE = 10176895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi ((mask & AUDIO_CHANNEL_OUT_LOW_FREQUENCY) == AUDIO_CHANNEL_OUT_LOW_FREQUENCY); 10186895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi const bool hasBC = ((mask & AUDIO_CHANNEL_OUT_BACK_CENTER) == AUDIO_CHANNEL_OUT_BACK_CENTER); 10196895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // compute at what index each channel is: samples will be in the following order: 10206895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // FL FR FC LFE BL BR BC SL SR 10216895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // when a channel is not present, its index is set to the same as the index of the preceding 10226895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // channel 10236895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi const int indexFC = hasFC ? 2 : 1; // front center 10246895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi const int indexLFE = hasLFE ? indexFC + 1 : indexFC; // low frequency 10256895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi const int indexBL = hasBacks ? indexLFE + 1 : indexLFE; // back left 10266895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi const int indexBR = hasBacks ? indexBL + 1 : indexBL; // back right 10276895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi const int indexBC = hasBC ? indexBR + 1 : indexBR; // back center 10286895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi const int indexSL = hasSides ? indexBC + 1 : indexBC; // side left 10296895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi const int indexSR = hasSides ? indexSL + 1 : indexSL; // side right 10306895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi 10316895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi int32_t lt, rt, centersLfeContrib; // samples in Q19.12 format 10326895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // code is mostly duplicated between the two values of accumulate to avoid repeating the test 10336895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // for every sample 10346895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi if (accumulate) { 10356895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi while (numFrames) { 10366895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // compute contribution of FC, BC and LFE 10376895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi centersLfeContrib = 0; 10386895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi if (hasFC) { centersLfeContrib += pSrc[indexFC]; } 10396895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi if (hasLFE) { centersLfeContrib += pSrc[indexLFE]; } 10406895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi if (hasBC) { centersLfeContrib += pSrc[indexBC]; } 10416895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi centersLfeContrib *= MINUS_3_DB_IN_Q19_12; 10426895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // always has FL/FR 10436895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi lt = (pSrc[0] << 12); 10446895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi rt = (pSrc[1] << 12); 10456895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // mix in sides and backs 10466895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi if (hasSides) { 10476895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi lt += pSrc[indexSL] << 12; 10486895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi rt += pSrc[indexSR] << 12; 10496895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi } 10506895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi if (hasBacks) { 10516895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi lt += pSrc[indexBL] << 12; 10526895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi rt += pSrc[indexBR] << 12; 10536895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi } 10546895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi lt += centersLfeContrib; 10556895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi rt += centersLfeContrib; 10566895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // accumulate in destination 1057aea2715e65994e665a3732551880419ba1cecc0dJean-Michel Trivi pDst[0] = clamp16(pDst[0] + (lt >> 13)); 1058aea2715e65994e665a3732551880419ba1cecc0dJean-Michel Trivi pDst[1] = clamp16(pDst[1] + (rt >> 13)); 10596895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi pSrc += numChan; 10606895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi pDst += 2; 10616895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi numFrames--; 10626895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi } 10636895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi } else { 10646895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi while (numFrames) { 10656895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // compute contribution of FC, BC and LFE 10666895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi centersLfeContrib = 0; 10676895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi if (hasFC) { centersLfeContrib += pSrc[indexFC]; } 10686895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi if (hasLFE) { centersLfeContrib += pSrc[indexLFE]; } 10696895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi if (hasBC) { centersLfeContrib += pSrc[indexBC]; } 10706895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi centersLfeContrib *= MINUS_3_DB_IN_Q19_12; 10716895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // always has FL/FR 10726895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi lt = (pSrc[0] << 12); 10736895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi rt = (pSrc[1] << 12); 10746895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // mix in sides and backs 10756895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi if (hasSides) { 10766895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi lt += pSrc[indexSL] << 12; 10776895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi rt += pSrc[indexSR] << 12; 10786895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi } 10796895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi if (hasBacks) { 10806895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi lt += pSrc[indexBL] << 12; 10816895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi rt += pSrc[indexBR] << 12; 10826895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi } 10836895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi lt += centersLfeContrib; 10846895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi rt += centersLfeContrib; 10856895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi // store in destination 1086aea2715e65994e665a3732551880419ba1cecc0dJean-Michel Trivi pDst[0] = clamp16(lt >> 13); // differs from when accumulate is true above 1087aea2715e65994e665a3732551880419ba1cecc0dJean-Michel Trivi pDst[1] = clamp16(rt >> 13); // differs from when accumulate is true above 10886895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi pSrc += numChan; 10896895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi pDst += 2; 10906895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi numFrames--; 10916895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi } 10926895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi } 10936895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi return true; 10946895deeecc8797e6f5b28e7d07ec6bc499355c0cJean-Michel Trivi} 1095