diff options
author | Kevin Rocard <krocard@google.com> | 2018-11-14 16:22:07 -0800 |
---|---|---|
committer | Kevin Rocard <krocard@google.com> | 2018-11-28 20:29:52 -0800 |
commit | 96d2cd9d5c87d8bf9766a7190cf358adccab349a (patch) | |
tree | eb67244d62b8278f994da71e40a4e49cfc2b2788 /audio/effect/all-versions/default/Effect.cpp | |
parent | 6166ef40f9e24436e1d727050c99fc5b185a9e17 (diff) |
Audio HAL: Factorize V2 and V4 like libaudiohal
Use the same technique developed for the simpler libaudiohal to
factorize the audio HAL impl.
Generated with script:
set -euo pipefail
cd hardware/interfaces/audio
# Make 2.0 and 4.0 files mostly identical by removing all 2.0, V4.0...
# and replacing it by CPP_VERSION and FILE_VERSION
# This allow both implementation to be mostly identical, except for code difference
# Also remove IncludeGuard.h as it will be included from compiler flag
# Also update license to 2018
find -name *.cpp -o -name *h |
grep -v -e service.cpp |
xargs sed -Ei \
-e 's/(#.*)V[42]_0_(.*_H_?)$/\1\2/' \
-e 's/(LOG_TAG.*)[24]_0/\1/' \
-e '/#ifndef AUDIO_HAL_VERSION/,/#endif/d' \
-e '/^#.*def.*AUDIO_HAL_VERSION\b/d' \
-e's/V[42]_0/CPP_VERSION/' \
-e 's/(#include ).(android.*)[24].0(.*).$/\1PATH(\2FILE_VERSION\3)/' \
-e 's|(#include) .(.*)[24].0/(default/.*).$|\1 "\2\3"|' \
-e 's/\bAUDIO_HAL_VERSION\b/CPP_VERSION/' \
-e '/IncludeGuard.h/d' \
-e 's/(Copyright .C. 201)./\18/'
# set MAJOR_VERSION instead of having a different macro for each version
# this allow to do preprocessor arithmetic (eg: MAJOR_VERSION >= 4)
for v in 2 4; do
find -ipath '*/'$v'.0/*/Android.bp' |
xargs sed -i -e '/cflags:/,/^$/d' -e '/vndk/{:a;/}/!{N;ba};d}' -e '$i\
cflags: [\
"-DMAJOR_VERSION='$v'",\
"-DMINOR_VERSION=0",\
"-include common/all-versions/VersionMacro.h",\
]'; done
# replace# ifdef VERSION_X by #if MAJOR_VERSION == X
find -path *all-versions/*.h |
xargs sed -Ei -e 's/def.*AUDIO_HAL_VERSION_([24])_0.*/ MAJOR_VERSION == \1/' \
-e 'T;s/ +/ /'
# copy all-versions impl in each version impl
find -path '*/[24].0/*.[hc]*' |
grep -ve all-versions -e test |
xargs -P99 -n4 sed -i -Ee '/include <.*all-versions.default/!b' \
-e 's#.*<#find -path */#' -e 's/>$/|xargs tail -n +16/' -e e
# remove all-versions impl
rm -r {core,effect}/all-versions/
# merge version impl into a single all-version
for dir in core/*.0/vts/functional/*.0/ ;do
dest=$(echo $dir | sed 's#/..0/#/all-versions/#')
mkdir -p $dest
mv -T $dir $dest
done
find -mindepth 3 -path '*/2.0/*' -a \( -name '*cpp' -o -name '*h' \) |
grep -v 'all-versions' |
sed -E 'h;s/2/4/g;H;s/4.0/all-versions/;s/4.0//;H;g;s/\n/ /g;'|
xargs -P99 -L1 sh -c '
set -euo pipefail
mkdir -p $(dirname $2);
diff --old-group-format="#if MAJOR_VERSION == 2
%<#endif
" \
--new-group-format="#if MAJOR_VERSION == 4
%>#endif
" $0 $1 > $2 || true;
rm $0 $1'
# merge the X.0 Android.bp & OWNERS in the all-versions
for dir in common effect core; do
for sub in default vts/functional; do
test -f $dir/2.0/$sub/Android.bp || continue
awk 1 $dir/*.0/$sub/Android.bp >> $dir/all-versions/$sub/Android.bp
# delete licenses except for the first one and add whitelines
sed -i -e '/^}$/{N;/^}\n$/!s/\n/&\n/}' $dir/all-versions/$sub/Android.bp
sed -i -e '1,17b;/^\/\//,/^$/{d}' $dir/all-versions/$sub/Android.bp
done
for sub in default vts; do
test -d $dir/2.0/$sub || continue
test -f $dir/2.0/$sub/OWNERS &&
awk 1 $dir/*.0/$sub/OWNERS | sort -u > $dir/all-versions/$sub/OWNERS ||
true
rm -r $dir/*.0/$sub
done
done
# delete all-versions-impl dependencies
find -name 'Android.bp' | xargs sed -i -e '/all-versions-impl/d'
# cleanup unused files
rm common/all-versions/default/include/common/all-versions/default/HidlUtils*
rm common/all-versions/util/include/common/all-versions/IncludeGuard.h
find -depth -type d -empty -delete
# Clamp consecutive number of empty lines to 2
find -name *.cpp -o -name *h | xargs sed -Ei ':a;/^\n*$/{N;ba};s/\n\n+/\n\n/'
# transform #endif\n#if to #elif
find -name *.cpp -o -name *h | xargs sed -i '/^#endif/{N;s/.*\n#if/#elif/}'
# remove leftover include guard in cpp
find -name *.cpp |xargs sed -Ei '/^#.*_H_?$/d'
# apply clang-format
find -name *cpp -o -name *h |
xargs ../../../prebuilts/clang/host/linux-x86/clang-stable/bin/clang-format --style file -i
# clang format breaks PATH(a/b) to PATH(a / b), remove the space surrounding /
find -name *cpp -o -name *h | xargs sed -i "/#include PATH/s# / #/#g"
Test: compile
Bug: 118203066
Change-Id: I3692a444307afc5f71064fe0b9e6b8af3c9ff1dd
Signed-off-by: Kevin Rocard <krocard@google.com>
Diffstat (limited to 'audio/effect/all-versions/default/Effect.cpp')
-rw-r--r-- | audio/effect/all-versions/default/Effect.cpp | 721 |
1 files changed, 721 insertions, 0 deletions
diff --git a/audio/effect/all-versions/default/Effect.cpp b/audio/effect/all-versions/default/Effect.cpp new file mode 100644 index 0000000000..3e5148fabb --- /dev/null +++ b/audio/effect/all-versions/default/Effect.cpp @@ -0,0 +1,721 @@ +/* + * Copyright (C) 2018 The Android Open Source Project + * + * Licensed under the Apache License, Version 2.0 (the "License"); + * you may not use this file except in compliance with the License. + * You may obtain a copy of the License at + * + * http://www.apache.org/licenses/LICENSE-2.0 + * + * Unless required by applicable law or agreed to in writing, software + * distributed under the License is distributed on an "AS IS" BASIS, + * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. + * See the License for the specific language governing permissions and + * limitations under the License. + */ + +#include <memory.h> + +#define LOG_TAG "EffectHAL" +#define ATRACE_TAG ATRACE_TAG_AUDIO + +#include "Conversions.h" +#include "Effect.h" +#include "common/all-versions/default/EffectMap.h" + +#include <memory.h> + +#define ATRACE_TAG ATRACE_TAG_AUDIO + +#include <android/log.h> +#include <media/EffectsFactoryApi.h> +#include <utils/Trace.h> + +#include "VersionUtils.h" + +namespace android { +namespace hardware { +namespace audio { +namespace effect { +namespace CPP_VERSION { +namespace implementation { + +using ::android::hardware::audio::common::CPP_VERSION::AudioChannelMask; +using ::android::hardware::audio::common::CPP_VERSION::AudioFormat; +using ::android::hardware::audio::common::CPP_VERSION::implementation::AudioChannelBitfield; +using ::android::hardware::audio::effect::CPP_VERSION::MessageQueueFlagBits; + +namespace { + +class ProcessThread : public Thread { + public: + // ProcessThread's lifespan never exceeds Effect's lifespan. + ProcessThread(std::atomic<bool>* stop, effect_handle_t effect, + std::atomic<audio_buffer_t*>* inBuffer, std::atomic<audio_buffer_t*>* outBuffer, + Effect::StatusMQ* statusMQ, EventFlag* efGroup) + : Thread(false /*canCallJava*/), + mStop(stop), + mEffect(effect), + mHasProcessReverse((*mEffect)->process_reverse != NULL), + mInBuffer(inBuffer), + mOutBuffer(outBuffer), + mStatusMQ(statusMQ), + mEfGroup(efGroup) {} + virtual ~ProcessThread() {} + + private: + std::atomic<bool>* mStop; + effect_handle_t mEffect; + bool mHasProcessReverse; + std::atomic<audio_buffer_t*>* mInBuffer; + std::atomic<audio_buffer_t*>* mOutBuffer; + Effect::StatusMQ* mStatusMQ; + EventFlag* mEfGroup; + + bool threadLoop() override; +}; + +bool ProcessThread::threadLoop() { + // This implementation doesn't return control back to the Thread until it decides to stop, + // as the Thread uses mutexes, and this can lead to priority inversion. + while (!std::atomic_load_explicit(mStop, std::memory_order_acquire)) { + uint32_t efState = 0; + mEfGroup->wait(static_cast<uint32_t>(MessageQueueFlagBits::REQUEST_PROCESS_ALL), &efState); + if (!(efState & static_cast<uint32_t>(MessageQueueFlagBits::REQUEST_PROCESS_ALL)) || + (efState & static_cast<uint32_t>(MessageQueueFlagBits::REQUEST_QUIT))) { + continue; // Nothing to do or time to quit. + } + Result retval = Result::OK; + if (efState & static_cast<uint32_t>(MessageQueueFlagBits::REQUEST_PROCESS_REVERSE) && + !mHasProcessReverse) { + retval = Result::NOT_SUPPORTED; + } + + if (retval == Result::OK) { + // affects both buffer pointers and their contents. + std::atomic_thread_fence(std::memory_order_acquire); + int32_t processResult; + audio_buffer_t* inBuffer = + std::atomic_load_explicit(mInBuffer, std::memory_order_relaxed); + audio_buffer_t* outBuffer = + std::atomic_load_explicit(mOutBuffer, std::memory_order_relaxed); + if (inBuffer != nullptr && outBuffer != nullptr) { + if (efState & static_cast<uint32_t>(MessageQueueFlagBits::REQUEST_PROCESS)) { + processResult = (*mEffect)->process(mEffect, inBuffer, outBuffer); + } else { + processResult = (*mEffect)->process_reverse(mEffect, inBuffer, outBuffer); + } + std::atomic_thread_fence(std::memory_order_release); + } else { + ALOGE("processing buffers were not set before calling 'process'"); + processResult = -ENODEV; + } + switch (processResult) { + case 0: + retval = Result::OK; + break; + case -ENODATA: + retval = Result::INVALID_STATE; + break; + case -EINVAL: + retval = Result::INVALID_ARGUMENTS; + break; + default: + retval = Result::NOT_INITIALIZED; + } + } + if (!mStatusMQ->write(&retval)) { + ALOGW("status message queue write failed"); + } + mEfGroup->wake(static_cast<uint32_t>(MessageQueueFlagBits::DONE_PROCESSING)); + } + + return false; +} + +} // namespace + +// static +const char* Effect::sContextResultOfCommand = "returned status"; +const char* Effect::sContextCallToCommand = "error"; +const char* Effect::sContextCallFunction = sContextCallToCommand; + +Effect::Effect(effect_handle_t handle) + : mIsClosed(false), mHandle(handle), mEfGroup(nullptr), mStopProcessThread(false) {} + +Effect::~Effect() { + ATRACE_CALL(); + close(); + if (mProcessThread.get()) { + ATRACE_NAME("mProcessThread->join"); + status_t status = mProcessThread->join(); + ALOGE_IF(status, "processing thread exit error: %s", strerror(-status)); + } + if (mEfGroup) { + status_t status = EventFlag::deleteEventFlag(&mEfGroup); + ALOGE_IF(status, "processing MQ event flag deletion error: %s", strerror(-status)); + } + mInBuffer.clear(); + mOutBuffer.clear(); + int status = EffectRelease(mHandle); + ALOGW_IF(status, "Error releasing effect %p: %s", mHandle, strerror(-status)); + EffectMap::getInstance().remove(mHandle); + mHandle = 0; +} + +// static +template <typename T> +size_t Effect::alignedSizeIn(size_t s) { + return (s + sizeof(T) - 1) / sizeof(T); +} + +// static +template <typename T> +std::unique_ptr<uint8_t[]> Effect::hidlVecToHal(const hidl_vec<T>& vec, uint32_t* halDataSize) { + // Due to bugs in HAL, they may attempt to write into the provided + // input buffer. The original binder buffer is r/o, thus it is needed + // to create a r/w version. + *halDataSize = vec.size() * sizeof(T); + std::unique_ptr<uint8_t[]> halData(new uint8_t[*halDataSize]); + memcpy(&halData[0], &vec[0], *halDataSize); + return halData; +} + +// static +void Effect::effectAuxChannelsConfigFromHal(const channel_config_t& halConfig, + EffectAuxChannelsConfig* config) { + config->mainChannels = AudioChannelBitfield(halConfig.main_channels); + config->auxChannels = AudioChannelBitfield(halConfig.aux_channels); +} + +// static +void Effect::effectAuxChannelsConfigToHal(const EffectAuxChannelsConfig& config, + channel_config_t* halConfig) { + halConfig->main_channels = static_cast<audio_channel_mask_t>(config.mainChannels); + halConfig->aux_channels = static_cast<audio_channel_mask_t>(config.auxChannels); +} + +// static +void Effect::effectBufferConfigFromHal(const buffer_config_t& halConfig, + EffectBufferConfig* config) { + config->buffer.id = 0; + config->buffer.frameCount = 0; + config->samplingRateHz = halConfig.samplingRate; + config->channels = AudioChannelBitfield(halConfig.channels); + config->format = AudioFormat(halConfig.format); + config->accessMode = EffectBufferAccess(halConfig.accessMode); + config->mask = static_cast<decltype(config->mask)>(halConfig.mask); +} + +// static +void Effect::effectBufferConfigToHal(const EffectBufferConfig& config, buffer_config_t* halConfig) { + // Note: setting the buffers directly is considered obsolete. They need to be set + // using 'setProcessBuffers'. + halConfig->buffer.frameCount = 0; + halConfig->buffer.raw = NULL; + halConfig->samplingRate = config.samplingRateHz; + halConfig->channels = static_cast<uint32_t>(config.channels); + // Note: The framework code does not use BP. + halConfig->bufferProvider.cookie = NULL; + halConfig->bufferProvider.getBuffer = NULL; + halConfig->bufferProvider.releaseBuffer = NULL; + halConfig->format = static_cast<uint8_t>(config.format); + halConfig->accessMode = static_cast<uint8_t>(config.accessMode); + halConfig->mask = static_cast<uint8_t>(config.mask); +} + +// static +void Effect::effectConfigFromHal(const effect_config_t& halConfig, EffectConfig* config) { + effectBufferConfigFromHal(halConfig.inputCfg, &config->inputCfg); + effectBufferConfigFromHal(halConfig.outputCfg, &config->outputCfg); +} + +// static +void Effect::effectConfigToHal(const EffectConfig& config, effect_config_t* halConfig) { + effectBufferConfigToHal(config.inputCfg, &halConfig->inputCfg); + effectBufferConfigToHal(config.outputCfg, &halConfig->outputCfg); +} + +// static +void Effect::effectOffloadParamToHal(const EffectOffloadParameter& offload, + effect_offload_param_t* halOffload) { + halOffload->isOffload = offload.isOffload; + halOffload->ioHandle = offload.ioHandle; +} + +// static +std::vector<uint8_t> Effect::parameterToHal(uint32_t paramSize, const void* paramData, + uint32_t valueSize, const void** valueData) { + size_t valueOffsetFromData = alignedSizeIn<uint32_t>(paramSize) * sizeof(uint32_t); + size_t halParamBufferSize = sizeof(effect_param_t) + valueOffsetFromData + valueSize; + std::vector<uint8_t> halParamBuffer(halParamBufferSize, 0); + effect_param_t* halParam = reinterpret_cast<effect_param_t*>(&halParamBuffer[0]); + halParam->psize = paramSize; + halParam->vsize = valueSize; + memcpy(halParam->data, paramData, paramSize); + if (valueData) { + if (*valueData) { + // Value data is provided. + memcpy(halParam->data + valueOffsetFromData, *valueData, valueSize); + } else { + // The caller needs the pointer to the value data location. + *valueData = halParam->data + valueOffsetFromData; + } + } + return halParamBuffer; +} + +Result Effect::analyzeCommandStatus(const char* commandName, const char* context, status_t status) { + return analyzeStatus("command", commandName, context, status); +} + +Result Effect::analyzeStatus(const char* funcName, const char* subFuncName, + const char* contextDescription, status_t status) { + if (status != OK) { + ALOGW("Effect %p %s %s %s: %s", mHandle, funcName, subFuncName, contextDescription, + strerror(-status)); + } + switch (status) { + case OK: + return Result::OK; + case -EINVAL: + return Result::INVALID_ARGUMENTS; + case -ENODATA: + return Result::INVALID_STATE; + case -ENODEV: + return Result::NOT_INITIALIZED; + case -ENOMEM: + return Result::RESULT_TOO_BIG; + case -ENOSYS: + return Result::NOT_SUPPORTED; + default: + return Result::INVALID_STATE; + } +} + +void Effect::getConfigImpl(int commandCode, const char* commandName, GetConfigCallback cb) { + uint32_t halResultSize = sizeof(effect_config_t); + effect_config_t halConfig{}; + status_t status = + (*mHandle)->command(mHandle, commandCode, 0, NULL, &halResultSize, &halConfig); + EffectConfig config; + if (status == OK) { + effectConfigFromHal(halConfig, &config); + } + cb(analyzeCommandStatus(commandName, sContextCallToCommand, status), config); +} + +Result Effect::getCurrentConfigImpl(uint32_t featureId, uint32_t configSize, + GetCurrentConfigSuccessCallback onSuccess) { + uint32_t halCmd = featureId; + uint32_t halResult[alignedSizeIn<uint32_t>(sizeof(uint32_t) + configSize)]; + memset(halResult, 0, sizeof(halResult)); + uint32_t halResultSize = 0; + return sendCommandReturningStatusAndData(EFFECT_CMD_GET_FEATURE_CONFIG, "GET_FEATURE_CONFIG", + sizeof(uint32_t), &halCmd, &halResultSize, halResult, + sizeof(uint32_t), [&] { onSuccess(&halResult[1]); }); +} + +Result Effect::getParameterImpl(uint32_t paramSize, const void* paramData, + uint32_t requestValueSize, uint32_t replyValueSize, + GetParameterSuccessCallback onSuccess) { + // As it is unknown what method HAL uses for copying the provided parameter data, + // it is safer to make sure that input and output buffers do not overlap. + std::vector<uint8_t> halCmdBuffer = + parameterToHal(paramSize, paramData, requestValueSize, nullptr); + const void* valueData = nullptr; + std::vector<uint8_t> halParamBuffer = + parameterToHal(paramSize, paramData, replyValueSize, &valueData); + uint32_t halParamBufferSize = halParamBuffer.size(); + + return sendCommandReturningStatusAndData( + EFFECT_CMD_GET_PARAM, "GET_PARAM", halCmdBuffer.size(), &halCmdBuffer[0], + &halParamBufferSize, &halParamBuffer[0], sizeof(effect_param_t), [&] { + effect_param_t* halParam = reinterpret_cast<effect_param_t*>(&halParamBuffer[0]); + onSuccess(halParam->vsize, valueData); + }); +} + +Result Effect::getSupportedConfigsImpl(uint32_t featureId, uint32_t maxConfigs, uint32_t configSize, + GetSupportedConfigsSuccessCallback onSuccess) { + uint32_t halCmd[2] = {featureId, maxConfigs}; + uint32_t halResultSize = 2 * sizeof(uint32_t) + maxConfigs * sizeof(configSize); + uint8_t halResult[halResultSize]; + memset(&halResult[0], 0, halResultSize); + return sendCommandReturningStatusAndData( + EFFECT_CMD_GET_FEATURE_SUPPORTED_CONFIGS, "GET_FEATURE_SUPPORTED_CONFIGS", sizeof(halCmd), + halCmd, &halResultSize, &halResult[0], 2 * sizeof(uint32_t), [&] { + uint32_t* halResult32 = reinterpret_cast<uint32_t*>(&halResult[0]); + uint32_t supportedConfigs = *(++halResult32); // skip status field + if (supportedConfigs > maxConfigs) supportedConfigs = maxConfigs; + onSuccess(supportedConfigs, ++halResult32); + }); +} + +Return<void> Effect::prepareForProcessing(prepareForProcessing_cb _hidl_cb) { + status_t status; + // Create message queue. + if (mStatusMQ) { + ALOGE("the client attempts to call prepareForProcessing_cb twice"); + _hidl_cb(Result::INVALID_STATE, StatusMQ::Descriptor()); + return Void(); + } + std::unique_ptr<StatusMQ> tempStatusMQ(new StatusMQ(1, true /*EventFlag*/)); + if (!tempStatusMQ->isValid()) { + ALOGE_IF(!tempStatusMQ->isValid(), "status MQ is invalid"); + _hidl_cb(Result::INVALID_ARGUMENTS, StatusMQ::Descriptor()); + return Void(); + } + status = EventFlag::createEventFlag(tempStatusMQ->getEventFlagWord(), &mEfGroup); + if (status != OK || !mEfGroup) { + ALOGE("failed creating event flag for status MQ: %s", strerror(-status)); + _hidl_cb(Result::INVALID_ARGUMENTS, StatusMQ::Descriptor()); + return Void(); + } + + // Create and launch the thread. + mProcessThread = new ProcessThread(&mStopProcessThread, mHandle, &mHalInBufferPtr, + &mHalOutBufferPtr, tempStatusMQ.get(), mEfGroup); + status = mProcessThread->run("effect", PRIORITY_URGENT_AUDIO); + if (status != OK) { + ALOGW("failed to start effect processing thread: %s", strerror(-status)); + _hidl_cb(Result::INVALID_ARGUMENTS, MQDescriptorSync<Result>()); + return Void(); + } + + mStatusMQ = std::move(tempStatusMQ); + _hidl_cb(Result::OK, *mStatusMQ->getDesc()); + return Void(); +} + +Return<Result> Effect::setProcessBuffers(const AudioBuffer& inBuffer, + const AudioBuffer& outBuffer) { + AudioBufferManager& manager = AudioBufferManager::getInstance(); + sp<AudioBufferWrapper> tempInBuffer, tempOutBuffer; + if (!manager.wrap(inBuffer, &tempInBuffer)) { + ALOGE("Could not map memory of the input buffer"); + return Result::INVALID_ARGUMENTS; + } + if (!manager.wrap(outBuffer, &tempOutBuffer)) { + ALOGE("Could not map memory of the output buffer"); + return Result::INVALID_ARGUMENTS; + } + mInBuffer = tempInBuffer; + mOutBuffer = tempOutBuffer; + // The processing thread only reads these pointers after waking up by an event flag, + // so it's OK to update the pair non-atomically. + mHalInBufferPtr.store(mInBuffer->getHalBuffer(), std::memory_order_release); + mHalOutBufferPtr.store(mOutBuffer->getHalBuffer(), std::memory_order_release); + return Result::OK; +} + +Result Effect::sendCommand(int commandCode, const char* commandName) { + return sendCommand(commandCode, commandName, 0, NULL); +} + +Result Effect::sendCommand(int commandCode, const char* commandName, uint32_t size, void* data) { + status_t status = (*mHandle)->command(mHandle, commandCode, size, data, 0, NULL); + return analyzeCommandStatus(commandName, sContextCallToCommand, status); +} + +Result Effect::sendCommandReturningData(int commandCode, const char* commandName, + uint32_t* replySize, void* replyData) { + return sendCommandReturningData(commandCode, commandName, 0, NULL, replySize, replyData); +} + +Result Effect::sendCommandReturningData(int commandCode, const char* commandName, uint32_t size, + void* data, uint32_t* replySize, void* replyData) { + uint32_t expectedReplySize = *replySize; + status_t status = (*mHandle)->command(mHandle, commandCode, size, data, replySize, replyData); + if (status == OK && *replySize != expectedReplySize) { + status = -ENODATA; + } + return analyzeCommandStatus(commandName, sContextCallToCommand, status); +} + +Result Effect::sendCommandReturningStatus(int commandCode, const char* commandName) { + return sendCommandReturningStatus(commandCode, commandName, 0, NULL); +} + +Result Effect::sendCommandReturningStatus(int commandCode, const char* commandName, uint32_t size, + void* data) { + uint32_t replyCmdStatus; + uint32_t replySize = sizeof(uint32_t); + return sendCommandReturningStatusAndData(commandCode, commandName, size, data, &replySize, + &replyCmdStatus, replySize, [] {}); +} + +Result Effect::sendCommandReturningStatusAndData(int commandCode, const char* commandName, + uint32_t size, void* data, uint32_t* replySize, + void* replyData, uint32_t minReplySize, + CommandSuccessCallback onSuccess) { + status_t status = (*mHandle)->command(mHandle, commandCode, size, data, replySize, replyData); + Result retval; + if (status == OK && minReplySize >= sizeof(uint32_t) && *replySize >= minReplySize) { + uint32_t commandStatus = *reinterpret_cast<uint32_t*>(replyData); + retval = analyzeCommandStatus(commandName, sContextResultOfCommand, commandStatus); + if (commandStatus == OK) { + onSuccess(); + } + } else { + retval = analyzeCommandStatus(commandName, sContextCallToCommand, status); + } + return retval; +} + +Result Effect::setConfigImpl(int commandCode, const char* commandName, const EffectConfig& config, + const sp<IEffectBufferProviderCallback>& inputBufferProvider, + const sp<IEffectBufferProviderCallback>& outputBufferProvider) { + effect_config_t halConfig; + effectConfigToHal(config, &halConfig); + if (inputBufferProvider != 0) { + LOG_FATAL("Using input buffer provider is not supported"); + } + if (outputBufferProvider != 0) { + LOG_FATAL("Using output buffer provider is not supported"); + } + return sendCommandReturningStatus(commandCode, commandName, sizeof(effect_config_t), + &halConfig); +} + +Result Effect::setParameterImpl(uint32_t paramSize, const void* paramData, uint32_t valueSize, + const void* valueData) { + std::vector<uint8_t> halParamBuffer = + parameterToHal(paramSize, paramData, valueSize, &valueData); + return sendCommandReturningStatus(EFFECT_CMD_SET_PARAM, "SET_PARAM", halParamBuffer.size(), + &halParamBuffer[0]); +} + +// Methods from ::android::hardware::audio::effect::CPP_VERSION::IEffect follow. +Return<Result> Effect::init() { + return sendCommandReturningStatus(EFFECT_CMD_INIT, "INIT"); +} + +Return<Result> Effect::setConfig(const EffectConfig& config, + const sp<IEffectBufferProviderCallback>& inputBufferProvider, + const sp<IEffectBufferProviderCallback>& outputBufferProvider) { + return setConfigImpl(EFFECT_CMD_SET_CONFIG, "SET_CONFIG", config, inputBufferProvider, + outputBufferProvider); +} + +Return<Result> Effect::reset() { + return sendCommand(EFFECT_CMD_RESET, "RESET"); +} + +Return<Result> Effect::enable() { + return sendCommandReturningStatus(EFFECT_CMD_ENABLE, "ENABLE"); +} + +Return<Result> Effect::disable() { + return sendCommandReturningStatus(EFFECT_CMD_DISABLE, "DISABLE"); +} + +Return<Result> Effect::setDevice(AudioDeviceBitfield device) { + uint32_t halDevice = static_cast<uint32_t>(device); + return sendCommand(EFFECT_CMD_SET_DEVICE, "SET_DEVICE", sizeof(uint32_t), &halDevice); +} + +Return<void> Effect::setAndGetVolume(const hidl_vec<uint32_t>& volumes, + setAndGetVolume_cb _hidl_cb) { + uint32_t halDataSize; + std::unique_ptr<uint8_t[]> halData = hidlVecToHal(volumes, &halDataSize); + uint32_t halResultSize = halDataSize; + uint32_t halResult[volumes.size()]; + Result retval = sendCommandReturningData(EFFECT_CMD_SET_VOLUME, "SET_VOLUME", halDataSize, + &halData[0], &halResultSize, halResult); + hidl_vec<uint32_t> result; + if (retval == Result::OK) { + result.setToExternal(&halResult[0], halResultSize); + } + _hidl_cb(retval, result); + return Void(); +} + +Return<Result> Effect::volumeChangeNotification(const hidl_vec<uint32_t>& volumes) { + uint32_t halDataSize; + std::unique_ptr<uint8_t[]> halData = hidlVecToHal(volumes, &halDataSize); + return sendCommand(EFFECT_CMD_SET_VOLUME, "SET_VOLUME", halDataSize, &halData[0]); +} + +Return<Result> Effect::setAudioMode(AudioMode mode) { + uint32_t halMode = static_cast<uint32_t>(mode); + return sendCommand(EFFECT_CMD_SET_AUDIO_MODE, "SET_AUDIO_MODE", sizeof(uint32_t), &halMode); +} + +Return<Result> Effect::setConfigReverse( + const EffectConfig& config, const sp<IEffectBufferProviderCallback>& inputBufferProvider, + const sp<IEffectBufferProviderCallback>& outputBufferProvider) { + return setConfigImpl(EFFECT_CMD_SET_CONFIG_REVERSE, "SET_CONFIG_REVERSE", config, + inputBufferProvider, outputBufferProvider); +} + +Return<Result> Effect::setInputDevice(AudioDeviceBitfield device) { + uint32_t halDevice = static_cast<uint32_t>(device); + return sendCommand(EFFECT_CMD_SET_INPUT_DEVICE, "SET_INPUT_DEVICE", sizeof(uint32_t), + &halDevice); +} + +Return<void> Effect::getConfig(getConfig_cb _hidl_cb) { + getConfigImpl(EFFECT_CMD_GET_CONFIG, "GET_CONFIG", _hidl_cb); + return Void(); +} + +Return<void> Effect::getConfigReverse(getConfigReverse_cb _hidl_cb) { + getConfigImpl(EFFECT_CMD_GET_CONFIG_REVERSE, "GET_CONFIG_REVERSE", _hidl_cb); + return Void(); +} + +Return<void> Effect::getSupportedAuxChannelsConfigs(uint32_t maxConfigs, + getSupportedAuxChannelsConfigs_cb _hidl_cb) { + hidl_vec<EffectAuxChannelsConfig> result; + Result retval = getSupportedConfigsImpl( + EFFECT_FEATURE_AUX_CHANNELS, maxConfigs, sizeof(channel_config_t), + [&](uint32_t supportedConfigs, void* configsData) { + result.resize(supportedConfigs); + channel_config_t* config = reinterpret_cast<channel_config_t*>(configsData); + for (size_t i = 0; i < result.size(); ++i) { + effectAuxChannelsConfigFromHal(*config++, &result[i]); + } + }); + _hidl_cb(retval, result); + return Void(); +} + +Return<void> Effect::getAuxChannelsConfig(getAuxChannelsConfig_cb _hidl_cb) { + uint32_t halResult[alignedSizeIn<uint32_t>(sizeof(uint32_t) + sizeof(channel_config_t))]; + memset(halResult, 0, sizeof(halResult)); + EffectAuxChannelsConfig result; + Result retval = getCurrentConfigImpl( + EFFECT_FEATURE_AUX_CHANNELS, sizeof(channel_config_t), [&](void* configData) { + effectAuxChannelsConfigFromHal(*reinterpret_cast<channel_config_t*>(configData), + &result); + }); + _hidl_cb(retval, result); + return Void(); +} + +Return<Result> Effect::setAuxChannelsConfig(const EffectAuxChannelsConfig& config) { + uint32_t halCmd[alignedSizeIn<uint32_t>(sizeof(uint32_t) + sizeof(channel_config_t))]; + halCmd[0] = EFFECT_FEATURE_AUX_CHANNELS; + effectAuxChannelsConfigToHal(config, reinterpret_cast<channel_config_t*>(&halCmd[1])); + return sendCommandReturningStatus(EFFECT_CMD_SET_FEATURE_CONFIG, + "SET_FEATURE_CONFIG AUX_CHANNELS", sizeof(halCmd), halCmd); +} + +Return<Result> Effect::setAudioSource(AudioSource source) { + uint32_t halSource = static_cast<uint32_t>(source); + return sendCommand(EFFECT_CMD_SET_AUDIO_SOURCE, "SET_AUDIO_SOURCE", sizeof(uint32_t), + &halSource); +} + +Return<Result> Effect::offload(const EffectOffloadParameter& param) { + effect_offload_param_t halParam; + effectOffloadParamToHal(param, &halParam); + return sendCommandReturningStatus(EFFECT_CMD_OFFLOAD, "OFFLOAD", sizeof(effect_offload_param_t), + &halParam); +} + +Return<void> Effect::getDescriptor(getDescriptor_cb _hidl_cb) { + effect_descriptor_t halDescriptor; + memset(&halDescriptor, 0, sizeof(effect_descriptor_t)); + status_t status = (*mHandle)->get_descriptor(mHandle, &halDescriptor); + EffectDescriptor descriptor; + if (status == OK) { + effectDescriptorFromHal(halDescriptor, &descriptor); + } + _hidl_cb(analyzeStatus("get_descriptor", "", sContextCallFunction, status), descriptor); + return Void(); +} + +Return<void> Effect::command(uint32_t commandId, const hidl_vec<uint8_t>& data, + uint32_t resultMaxSize, command_cb _hidl_cb) { + uint32_t halDataSize; + std::unique_ptr<uint8_t[]> halData = hidlVecToHal(data, &halDataSize); + uint32_t halResultSize = resultMaxSize; + std::unique_ptr<uint8_t[]> halResult(new uint8_t[halResultSize]); + memset(&halResult[0], 0, halResultSize); + + void* dataPtr = halDataSize > 0 ? &halData[0] : NULL; + void* resultPtr = halResultSize > 0 ? &halResult[0] : NULL; + status_t status = + (*mHandle)->command(mHandle, commandId, halDataSize, dataPtr, &halResultSize, resultPtr); + hidl_vec<uint8_t> result; + if (status == OK && resultPtr != NULL) { + result.setToExternal(&halResult[0], halResultSize); + } + _hidl_cb(status, result); + return Void(); +} + +Return<Result> Effect::setParameter(const hidl_vec<uint8_t>& parameter, + const hidl_vec<uint8_t>& value) { + return setParameterImpl(parameter.size(), ¶meter[0], value.size(), &value[0]); +} + +Return<void> Effect::getParameter(const hidl_vec<uint8_t>& parameter, uint32_t valueMaxSize, + getParameter_cb _hidl_cb) { + hidl_vec<uint8_t> value; + Result retval = getParameterImpl( + parameter.size(), ¶meter[0], valueMaxSize, + [&](uint32_t valueSize, const void* valueData) { + value.setToExternal(reinterpret_cast<uint8_t*>(const_cast<void*>(valueData)), + valueSize); + }); + _hidl_cb(retval, value); + return Void(); +} + +Return<void> Effect::getSupportedConfigsForFeature(uint32_t featureId, uint32_t maxConfigs, + uint32_t configSize, + getSupportedConfigsForFeature_cb _hidl_cb) { + uint32_t configCount = 0; + hidl_vec<uint8_t> result; + Result retval = getSupportedConfigsImpl(featureId, maxConfigs, configSize, + [&](uint32_t supportedConfigs, void* configsData) { + configCount = supportedConfigs; + result.resize(configCount * configSize); + memcpy(&result[0], configsData, result.size()); + }); + _hidl_cb(retval, configCount, result); + return Void(); +} + +Return<void> Effect::getCurrentConfigForFeature(uint32_t featureId, uint32_t configSize, + getCurrentConfigForFeature_cb _hidl_cb) { + hidl_vec<uint8_t> result; + Result retval = getCurrentConfigImpl(featureId, configSize, [&](void* configData) { + result.resize(configSize); + memcpy(&result[0], configData, result.size()); + }); + _hidl_cb(retval, result); + return Void(); +} + +Return<Result> Effect::setCurrentConfigForFeature(uint32_t featureId, + const hidl_vec<uint8_t>& configData) { + uint32_t halCmd[alignedSizeIn<uint32_t>(sizeof(uint32_t) + configData.size())]; + memset(halCmd, 0, sizeof(halCmd)); + halCmd[0] = featureId; + memcpy(&halCmd[1], &configData[0], configData.size()); + return sendCommandReturningStatus(EFFECT_CMD_SET_FEATURE_CONFIG, "SET_FEATURE_CONFIG", + sizeof(halCmd), halCmd); +} + +Return<Result> Effect::close() { + if (mIsClosed) return Result::INVALID_STATE; + mIsClosed = true; + if (mProcessThread.get()) { + mStopProcessThread.store(true, std::memory_order_release); + } + if (mEfGroup) { + mEfGroup->wake(static_cast<uint32_t>(MessageQueueFlagBits::REQUEST_QUIT)); + } + return Result::OK; +} + +} // namespace implementation +} // namespace CPP_VERSION +} // namespace effect +} // namespace audio +} // namespace hardware +} // namespace android |