1 /*
2  * Copyright (C) 2018 The Android Open Source Project
3  *
4  * Licensed under the Apache License, Version 2.0 (the "License");
5  * you may not use this file except in compliance with the License.
6  * You may obtain a copy of the License at
7  *
8  *      http://www.apache.org/licenses/LICENSE-2.0
9  *
10  * Unless required by applicable law or agreed to in writing, software
11  * distributed under the License is distributed on an "AS IS" BASIS,
12  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
13  * See the License for the specific language governing permissions and
14  * limitations under the License.
15  */
16 
17 #include <memory.h>
18 
19 #define LOG_TAG "EffectHAL"
20 #define ATRACE_TAG ATRACE_TAG_AUDIO
21 
22 #include "Effect.h"
23 #include "common/all-versions/default/EffectMap.h"
24 
25 #include <memory.h>
26 
27 #define ATRACE_TAG ATRACE_TAG_AUDIO
28 
29 #include <HidlUtils.h>
30 #include <android/log.h>
31 #include <media/EffectsFactoryApi.h>
32 #include <util/EffectUtils.h>
33 #include <utils/Trace.h>
34 
35 #include "VersionUtils.h"
36 
37 namespace android {
38 namespace hardware {
39 namespace audio {
40 namespace effect {
41 namespace CPP_VERSION {
42 namespace implementation {
43 
44 #if MAJOR_VERSION <= 6
45 using ::android::hardware::audio::common::CPP_VERSION::implementation::AudioChannelBitfield;
46 #endif
47 using ::android::hardware::audio::common::CPP_VERSION::implementation::HidlUtils;
48 
49 namespace {
50 
51 class ProcessThread : public Thread {
52    public:
53     // 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)54     ProcessThread(std::atomic<bool>* stop, effect_handle_t effect,
55                   std::atomic<audio_buffer_t*>* inBuffer, std::atomic<audio_buffer_t*>* outBuffer,
56                   Effect::StatusMQ* statusMQ, EventFlag* efGroup)
57         : Thread(false /*canCallJava*/),
58           mStop(stop),
59           mEffect(effect),
60           mHasProcessReverse((*mEffect)->process_reverse != NULL),
61           mInBuffer(inBuffer),
62           mOutBuffer(outBuffer),
63           mStatusMQ(statusMQ),
64           mEfGroup(efGroup) {}
~ProcessThread()65     virtual ~ProcessThread() {}
66 
67    private:
68     std::atomic<bool>* mStop;
69     effect_handle_t mEffect;
70     bool mHasProcessReverse;
71     std::atomic<audio_buffer_t*>* mInBuffer;
72     std::atomic<audio_buffer_t*>* mOutBuffer;
73     Effect::StatusMQ* mStatusMQ;
74     EventFlag* mEfGroup;
75 
76     bool threadLoop() override;
77 };
78 
threadLoop()79 bool ProcessThread::threadLoop() {
80     // This implementation doesn't return control back to the Thread until it decides to stop,
81     // as the Thread uses mutexes, and this can lead to priority inversion.
82     while (!std::atomic_load_explicit(mStop, std::memory_order_acquire)) {
83         uint32_t efState = 0;
84         mEfGroup->wait(static_cast<uint32_t>(MessageQueueFlagBits::REQUEST_PROCESS_ALL), &efState);
85         if (!(efState & static_cast<uint32_t>(MessageQueueFlagBits::REQUEST_PROCESS_ALL)) ||
86             (efState & static_cast<uint32_t>(MessageQueueFlagBits::REQUEST_QUIT))) {
87             continue;  // Nothing to do or time to quit.
88         }
89         Result retval = Result::OK;
90         if (efState & static_cast<uint32_t>(MessageQueueFlagBits::REQUEST_PROCESS_REVERSE) &&
91             !mHasProcessReverse) {
92             retval = Result::NOT_SUPPORTED;
93         }
94 
95         if (retval == Result::OK) {
96             // affects both buffer pointers and their contents.
97             std::atomic_thread_fence(std::memory_order_acquire);
98             int32_t processResult;
99             audio_buffer_t* inBuffer =
100                 std::atomic_load_explicit(mInBuffer, std::memory_order_relaxed);
101             audio_buffer_t* outBuffer =
102                 std::atomic_load_explicit(mOutBuffer, std::memory_order_relaxed);
103             if (inBuffer != nullptr && outBuffer != nullptr) {
104                 if (efState & static_cast<uint32_t>(MessageQueueFlagBits::REQUEST_PROCESS)) {
105                     processResult = (*mEffect)->process(mEffect, inBuffer, outBuffer);
106                 } else {
107                     processResult = (*mEffect)->process_reverse(mEffect, inBuffer, outBuffer);
108                 }
109                 std::atomic_thread_fence(std::memory_order_release);
110             } else {
111                 ALOGE("processing buffers were not set before calling 'process'");
112                 processResult = -ENODEV;
113             }
114             switch (processResult) {
115                 case 0:
116                     retval = Result::OK;
117                     break;
118                 case -ENODATA:
119                     retval = Result::INVALID_STATE;
120                     break;
121                 case -EINVAL:
122                     retval = Result::INVALID_ARGUMENTS;
123                     break;
124                 default:
125                     retval = Result::NOT_INITIALIZED;
126             }
127         }
128         if (!mStatusMQ->write(&retval)) {
129             ALOGW("status message queue write failed");
130         }
131         mEfGroup->wake(static_cast<uint32_t>(MessageQueueFlagBits::DONE_PROCESSING));
132     }
133 
134     return false;
135 }
136 
137 }  // namespace
138 
139 // static
140 const char* Effect::sContextResultOfCommand = "returned status";
141 const char* Effect::sContextCallToCommand = "error";
142 const char* Effect::sContextCallFunction = sContextCallToCommand;
143 const char* Effect::sContextConversion = "conversion";
144 
Effect(bool isInput,effect_handle_t handle)145 Effect::Effect(bool isInput, effect_handle_t handle)
146     : mIsInput(isInput), mHandle(handle), mEfGroup(nullptr), mStopProcessThread(false) {
147     (void)mIsInput;  // prevent 'unused field' warnings in pre-V7 versions.
148 }
149 
~Effect()150 Effect::~Effect() {
151     ATRACE_CALL();
152     (void)close();
153     if (mProcessThread.get()) {
154         ATRACE_NAME("mProcessThread->join");
155         status_t status = mProcessThread->join();
156         ALOGE_IF(status, "processing thread exit error: %s", strerror(-status));
157     }
158     if (mEfGroup) {
159         status_t status = EventFlag::deleteEventFlag(&mEfGroup);
160         ALOGE_IF(status, "processing MQ event flag deletion error: %s", strerror(-status));
161     }
162     mInBuffer.clear();
163     mOutBuffer.clear();
164 #if MAJOR_VERSION <= 5
165     int status = EffectRelease(mHandle);
166     ALOGW_IF(status, "Error releasing effect %p: %s", mHandle, strerror(-status));
167 #endif
168     EffectMap::getInstance().remove(mHandle);
169     mHandle = 0;
170 }
171 
172 // static
173 template <typename T>
alignedSizeIn(size_t s)174 size_t Effect::alignedSizeIn(size_t s) {
175     return (s + sizeof(T) - 1) / sizeof(T);
176 }
177 
178 // static
179 template <typename T>
hidlVecToHal(const hidl_vec<T> & vec,uint32_t * halDataSize)180 std::unique_ptr<uint8_t[]> Effect::hidlVecToHal(const hidl_vec<T>& vec, uint32_t* halDataSize) {
181     // Due to bugs in HAL, they may attempt to write into the provided
182     // input buffer. The original binder buffer is r/o, thus it is needed
183     // to create a r/w version.
184     *halDataSize = vec.size() * sizeof(T);
185     std::unique_ptr<uint8_t[]> halData(new uint8_t[*halDataSize]);
186     memcpy(&halData[0], &vec[0], *halDataSize);
187     return halData;
188 }
189 
190 #if MAJOR_VERSION <= 6
191 
effectAuxChannelsConfigFromHal(const channel_config_t & halConfig,EffectAuxChannelsConfig * config)192 void Effect::effectAuxChannelsConfigFromHal(const channel_config_t& halConfig,
193                                             EffectAuxChannelsConfig* config) {
194     config->mainChannels = AudioChannelBitfield(halConfig.main_channels);
195     config->auxChannels = AudioChannelBitfield(halConfig.aux_channels);
196 }
197 
198 // static
effectAuxChannelsConfigToHal(const EffectAuxChannelsConfig & config,channel_config_t * halConfig)199 void Effect::effectAuxChannelsConfigToHal(const EffectAuxChannelsConfig& config,
200                                           channel_config_t* halConfig) {
201     halConfig->main_channels = static_cast<audio_channel_mask_t>(config.mainChannels);
202     halConfig->aux_channels = static_cast<audio_channel_mask_t>(config.auxChannels);
203 }
204 
205 #else  // MAJOR_VERSION <= 6
206 
effectAuxChannelsConfigFromHal(const channel_config_t & halConfig,EffectAuxChannelsConfig * config)207 void Effect::effectAuxChannelsConfigFromHal(const channel_config_t& halConfig,
208                                             EffectAuxChannelsConfig* config) {
209     (void)HidlUtils::audioChannelMaskFromHal(halConfig.main_channels, mIsInput,
210                                              &config->mainChannels);
211     (void)HidlUtils::audioChannelMaskFromHal(halConfig.aux_channels, mIsInput,
212                                              &config->auxChannels);
213 }
214 
215 // static
effectAuxChannelsConfigToHal(const EffectAuxChannelsConfig & config,channel_config_t * halConfig)216 void Effect::effectAuxChannelsConfigToHal(const EffectAuxChannelsConfig& config,
217                                           channel_config_t* halConfig) {
218     (void)HidlUtils::audioChannelMaskToHal(config.mainChannels, &halConfig->main_channels);
219     (void)HidlUtils::audioChannelMaskToHal(config.auxChannels, &halConfig->aux_channels);
220 }
221 
222 #endif  // MAJOR_VERSION <= 6
223 
224 // static
effectOffloadParamToHal(const EffectOffloadParameter & offload,effect_offload_param_t * halOffload)225 void Effect::effectOffloadParamToHal(const EffectOffloadParameter& offload,
226                                      effect_offload_param_t* halOffload) {
227     halOffload->isOffload = offload.isOffload;
228     halOffload->ioHandle = offload.ioHandle;
229 }
230 
231 // static
parameterToHal(uint32_t paramSize,const void * paramData,uint32_t valueSize,const void ** valueData)232 std::vector<uint8_t> Effect::parameterToHal(uint32_t paramSize, const void* paramData,
233                                             uint32_t valueSize, const void** valueData) {
234     size_t valueOffsetFromData = alignedSizeIn<uint32_t>(paramSize) * sizeof(uint32_t);
235     size_t halParamBufferSize = sizeof(effect_param_t) + valueOffsetFromData + valueSize;
236     std::vector<uint8_t> halParamBuffer(halParamBufferSize, 0);
237     effect_param_t* halParam = reinterpret_cast<effect_param_t*>(&halParamBuffer[0]);
238     halParam->psize = paramSize;
239     halParam->vsize = valueSize;
240     memcpy(halParam->data, paramData, paramSize);
241     if (valueData) {
242         if (*valueData) {
243             // Value data is provided.
244             memcpy(halParam->data + valueOffsetFromData, *valueData, valueSize);
245         } else {
246             // The caller needs the pointer to the value data location.
247             *valueData = halParam->data + valueOffsetFromData;
248         }
249     }
250     return halParamBuffer;
251 }
252 
analyzeCommandStatus(const char * commandName,const char * context,status_t status)253 Result Effect::analyzeCommandStatus(const char* commandName, const char* context, status_t status) {
254     return analyzeStatus("command", commandName, context, status);
255 }
256 
analyzeStatus(const char * funcName,const char * subFuncName,const char * contextDescription,status_t status)257 Result Effect::analyzeStatus(const char* funcName, const char* subFuncName,
258                              const char* contextDescription, status_t status) {
259     if (status != OK) {
260         ALOGW("Effect %p %s %s %s: %s", mHandle, funcName, subFuncName, contextDescription,
261               strerror(-status));
262     }
263     switch (status) {
264         case OK:
265             return Result::OK;
266         case -EINVAL:
267             return Result::INVALID_ARGUMENTS;
268         case -ENODATA:
269             return Result::INVALID_STATE;
270         case -ENODEV:
271             return Result::NOT_INITIALIZED;
272         case -ENOMEM:
273             return Result::RESULT_TOO_BIG;
274         case -ENOSYS:
275             return Result::NOT_SUPPORTED;
276         default:
277             return Result::INVALID_STATE;
278     }
279 }
280 
getConfigImpl(int commandCode,const char * commandName,GetConfigCallback cb)281 void Effect::getConfigImpl(int commandCode, const char* commandName, GetConfigCallback cb) {
282     uint32_t halResultSize = sizeof(effect_config_t);
283     effect_config_t halConfig{};
284     status_t status =
285         (*mHandle)->command(mHandle, commandCode, 0, NULL, &halResultSize, &halConfig);
286     EffectConfig config;
287     if (status == OK) {
288         status = EffectUtils::effectConfigFromHal(halConfig, mIsInput, &config);
289     }
290     cb(analyzeCommandStatus(commandName, sContextCallToCommand, status), config);
291 }
292 
getCurrentConfigImpl(uint32_t featureId,uint32_t configSize,GetCurrentConfigSuccessCallback onSuccess)293 Result Effect::getCurrentConfigImpl(uint32_t featureId, uint32_t configSize,
294                                     GetCurrentConfigSuccessCallback onSuccess) {
295     uint32_t halCmd = featureId;
296     std::vector<uint32_t> halResult(alignedSizeIn<uint32_t>(sizeof(uint32_t) + configSize), 0);
297     uint32_t halResultSize = 0;
298     return sendCommandReturningStatusAndData(
299             EFFECT_CMD_GET_FEATURE_CONFIG, "GET_FEATURE_CONFIG", sizeof(uint32_t), &halCmd,
300             &halResultSize, &halResult[0], sizeof(uint32_t), [&] { onSuccess(&halResult[1]); });
301 }
302 
getParameterImpl(uint32_t paramSize,const void * paramData,uint32_t requestValueSize,uint32_t replyValueSize,GetParameterSuccessCallback onSuccess)303 Result Effect::getParameterImpl(uint32_t paramSize, const void* paramData,
304                                 uint32_t requestValueSize, uint32_t replyValueSize,
305                                 GetParameterSuccessCallback onSuccess) {
306     // As it is unknown what method HAL uses for copying the provided parameter data,
307     // it is safer to make sure that input and output buffers do not overlap.
308     std::vector<uint8_t> halCmdBuffer =
309         parameterToHal(paramSize, paramData, requestValueSize, nullptr);
310     const void* valueData = nullptr;
311     std::vector<uint8_t> halParamBuffer =
312         parameterToHal(paramSize, paramData, replyValueSize, &valueData);
313     uint32_t halParamBufferSize = halParamBuffer.size();
314 
315     return sendCommandReturningStatusAndData(
316         EFFECT_CMD_GET_PARAM, "GET_PARAM", halCmdBuffer.size(), &halCmdBuffer[0],
317         &halParamBufferSize, &halParamBuffer[0], sizeof(effect_param_t), [&] {
318             effect_param_t* halParam = reinterpret_cast<effect_param_t*>(&halParamBuffer[0]);
319             onSuccess(halParam->vsize, valueData);
320         });
321 }
322 
getSupportedConfigsImpl(uint32_t featureId,uint32_t maxConfigs,uint32_t configSize,GetSupportedConfigsSuccessCallback onSuccess)323 Result Effect::getSupportedConfigsImpl(uint32_t featureId, uint32_t maxConfigs, uint32_t configSize,
324                                        GetSupportedConfigsSuccessCallback onSuccess) {
325     uint32_t halCmd[2] = {featureId, maxConfigs};
326     uint32_t halResultSize = 2 * sizeof(uint32_t) + maxConfigs * sizeof(configSize);
327     std::vector<uint8_t> halResult(static_cast<size_t>(halResultSize), 0);
328     return sendCommandReturningStatusAndData(
329         EFFECT_CMD_GET_FEATURE_SUPPORTED_CONFIGS, "GET_FEATURE_SUPPORTED_CONFIGS", sizeof(halCmd),
330         halCmd, &halResultSize, &halResult[0], 2 * sizeof(uint32_t), [&] {
331             uint32_t* halResult32 = reinterpret_cast<uint32_t*>(&halResult[0]);
332             uint32_t supportedConfigs = *(++halResult32);  // skip status field
333             if (supportedConfigs > maxConfigs) supportedConfigs = maxConfigs;
334             onSuccess(supportedConfigs, ++halResult32);
335         });
336 }
337 
prepareForProcessing(prepareForProcessing_cb _hidl_cb)338 Return<void> Effect::prepareForProcessing(prepareForProcessing_cb _hidl_cb) {
339     status_t status;
340     // Create message queue.
341     if (mStatusMQ) {
342         ALOGE("the client attempts to call prepareForProcessing_cb twice");
343         _hidl_cb(Result::INVALID_STATE, StatusMQ::Descriptor());
344         return Void();
345     }
346     std::unique_ptr<StatusMQ> tempStatusMQ(new StatusMQ(1, true /*EventFlag*/));
347     if (!tempStatusMQ->isValid()) {
348         ALOGE_IF(!tempStatusMQ->isValid(), "status MQ is invalid");
349         _hidl_cb(Result::INVALID_ARGUMENTS, StatusMQ::Descriptor());
350         return Void();
351     }
352     status = EventFlag::createEventFlag(tempStatusMQ->getEventFlagWord(), &mEfGroup);
353     if (status != OK || !mEfGroup) {
354         ALOGE("failed creating event flag for status MQ: %s", strerror(-status));
355         _hidl_cb(Result::INVALID_ARGUMENTS, StatusMQ::Descriptor());
356         return Void();
357     }
358 
359     // Create and launch the thread.
360     mProcessThread = new ProcessThread(&mStopProcessThread, mHandle, &mHalInBufferPtr,
361                                        &mHalOutBufferPtr, tempStatusMQ.get(), mEfGroup);
362     status = mProcessThread->run("effect", PRIORITY_URGENT_AUDIO);
363     if (status != OK) {
364         ALOGW("failed to start effect processing thread: %s", strerror(-status));
365         _hidl_cb(Result::INVALID_ARGUMENTS, MQDescriptorSync<Result>());
366         return Void();
367     }
368 
369     mStatusMQ = std::move(tempStatusMQ);
370     _hidl_cb(Result::OK, *mStatusMQ->getDesc());
371     return Void();
372 }
373 
setProcessBuffers(const AudioBuffer & inBuffer,const AudioBuffer & outBuffer)374 Return<Result> Effect::setProcessBuffers(const AudioBuffer& inBuffer,
375                                          const AudioBuffer& outBuffer) {
376     AudioBufferManager& manager = AudioBufferManager::getInstance();
377     sp<AudioBufferWrapper> tempInBuffer, tempOutBuffer;
378     if (!manager.wrap(inBuffer, &tempInBuffer)) {
379         ALOGE("Could not map memory of the input buffer");
380         return Result::INVALID_ARGUMENTS;
381     }
382     if (!manager.wrap(outBuffer, &tempOutBuffer)) {
383         ALOGE("Could not map memory of the output buffer");
384         return Result::INVALID_ARGUMENTS;
385     }
386     mInBuffer = tempInBuffer;
387     mOutBuffer = tempOutBuffer;
388     // The processing thread only reads these pointers after waking up by an event flag,
389     // so it's OK to update the pair non-atomically.
390     mHalInBufferPtr.store(mInBuffer->getHalBuffer(), std::memory_order_release);
391     mHalOutBufferPtr.store(mOutBuffer->getHalBuffer(), std::memory_order_release);
392     return Result::OK;
393 }
394 
sendCommand(int commandCode,const char * commandName)395 Result Effect::sendCommand(int commandCode, const char* commandName) {
396     return sendCommand(commandCode, commandName, 0, NULL);
397 }
398 
sendCommand(int commandCode,const char * commandName,uint32_t size,void * data)399 Result Effect::sendCommand(int commandCode, const char* commandName, uint32_t size, void* data) {
400     status_t status = (*mHandle)->command(mHandle, commandCode, size, data, 0, NULL);
401     return analyzeCommandStatus(commandName, sContextCallToCommand, status);
402 }
403 
sendCommandReturningData(int commandCode,const char * commandName,uint32_t * replySize,void * replyData)404 Result Effect::sendCommandReturningData(int commandCode, const char* commandName,
405                                         uint32_t* replySize, void* replyData) {
406     return sendCommandReturningData(commandCode, commandName, 0, NULL, replySize, replyData);
407 }
408 
sendCommandReturningData(int commandCode,const char * commandName,uint32_t size,void * data,uint32_t * replySize,void * replyData)409 Result Effect::sendCommandReturningData(int commandCode, const char* commandName, uint32_t size,
410                                         void* data, uint32_t* replySize, void* replyData) {
411     uint32_t expectedReplySize = *replySize;
412     status_t status = (*mHandle)->command(mHandle, commandCode, size, data, replySize, replyData);
413     if (status == OK && *replySize != expectedReplySize) {
414         status = -ENODATA;
415     }
416     return analyzeCommandStatus(commandName, sContextCallToCommand, status);
417 }
418 
sendCommandReturningStatus(int commandCode,const char * commandName)419 Result Effect::sendCommandReturningStatus(int commandCode, const char* commandName) {
420     return sendCommandReturningStatus(commandCode, commandName, 0, NULL);
421 }
422 
sendCommandReturningStatus(int commandCode,const char * commandName,uint32_t size,void * data)423 Result Effect::sendCommandReturningStatus(int commandCode, const char* commandName, uint32_t size,
424                                           void* data) {
425     uint32_t replyCmdStatus;
426     uint32_t replySize = sizeof(uint32_t);
427     return sendCommandReturningStatusAndData(commandCode, commandName, size, data, &replySize,
428                                              &replyCmdStatus, replySize, [] {});
429 }
430 
sendCommandReturningStatusAndData(int commandCode,const char * commandName,uint32_t size,void * data,uint32_t * replySize,void * replyData,uint32_t minReplySize,CommandSuccessCallback onSuccess)431 Result Effect::sendCommandReturningStatusAndData(int commandCode, const char* commandName,
432                                                  uint32_t size, void* data, uint32_t* replySize,
433                                                  void* replyData, uint32_t minReplySize,
434                                                  CommandSuccessCallback onSuccess) {
435     status_t status = (*mHandle)->command(mHandle, commandCode, size, data, replySize, replyData);
436     Result retval;
437     if (status == OK && minReplySize >= sizeof(uint32_t) && *replySize >= minReplySize) {
438         uint32_t commandStatus = *reinterpret_cast<uint32_t*>(replyData);
439         retval = analyzeCommandStatus(commandName, sContextResultOfCommand, commandStatus);
440         if (commandStatus == OK) {
441             onSuccess();
442         }
443     } else {
444         retval = analyzeCommandStatus(commandName, sContextCallToCommand, status);
445     }
446     return retval;
447 }
448 
setConfigImpl(int commandCode,const char * commandName,const EffectConfig & config,const sp<IEffectBufferProviderCallback> & inputBufferProvider,const sp<IEffectBufferProviderCallback> & outputBufferProvider)449 Result Effect::setConfigImpl(int commandCode, const char* commandName, const EffectConfig& config,
450                              const sp<IEffectBufferProviderCallback>& inputBufferProvider,
451                              const sp<IEffectBufferProviderCallback>& outputBufferProvider) {
452     effect_config_t halConfig;
453     EffectUtils::effectConfigToHal(config, &halConfig);
454     if (inputBufferProvider != 0) {
455         LOG_FATAL("Using input buffer provider is not supported");
456     }
457     if (outputBufferProvider != 0) {
458         LOG_FATAL("Using output buffer provider is not supported");
459     }
460     return sendCommandReturningStatus(commandCode, commandName, sizeof(effect_config_t),
461                                       &halConfig);
462 }
463 
setParameterImpl(uint32_t paramSize,const void * paramData,uint32_t valueSize,const void * valueData)464 Result Effect::setParameterImpl(uint32_t paramSize, const void* paramData, uint32_t valueSize,
465                                 const void* valueData) {
466     std::vector<uint8_t> halParamBuffer =
467         parameterToHal(paramSize, paramData, valueSize, &valueData);
468     return sendCommandReturningStatus(EFFECT_CMD_SET_PARAM, "SET_PARAM", halParamBuffer.size(),
469                                       &halParamBuffer[0]);
470 }
471 
472 // Methods from ::android::hardware::audio::effect::CPP_VERSION::IEffect follow.
init()473 Return<Result> Effect::init() {
474     return sendCommandReturningStatus(EFFECT_CMD_INIT, "INIT");
475 }
476 
setConfig(const EffectConfig & config,const sp<IEffectBufferProviderCallback> & inputBufferProvider,const sp<IEffectBufferProviderCallback> & outputBufferProvider)477 Return<Result> Effect::setConfig(const EffectConfig& config,
478                                  const sp<IEffectBufferProviderCallback>& inputBufferProvider,
479                                  const sp<IEffectBufferProviderCallback>& outputBufferProvider) {
480     return setConfigImpl(EFFECT_CMD_SET_CONFIG, "SET_CONFIG", config, inputBufferProvider,
481                          outputBufferProvider);
482 }
483 
reset()484 Return<Result> Effect::reset() {
485     return sendCommand(EFFECT_CMD_RESET, "RESET");
486 }
487 
enable()488 Return<Result> Effect::enable() {
489     return sendCommandReturningStatus(EFFECT_CMD_ENABLE, "ENABLE");
490 }
491 
disable()492 Return<Result> Effect::disable() {
493     return sendCommandReturningStatus(EFFECT_CMD_DISABLE, "DISABLE");
494 }
495 
setAudioSource(AudioSource source)496 Return<Result> Effect::setAudioSource(
497 #if MAJOR_VERSION <= 6
498         AudioSource source
499 #else
500         const AudioSource& source
501 #endif
502 ) {
503     audio_source_t halSource;
504     if (status_t status = HidlUtils::audioSourceToHal(source, &halSource); status == NO_ERROR) {
505         uint32_t halSourceParam = static_cast<uint32_t>(halSource);
506         return sendCommand(EFFECT_CMD_SET_AUDIO_SOURCE, "SET_AUDIO_SOURCE", sizeof(uint32_t),
507                            &halSourceParam);
508     } else {
509         return analyzeStatus(__func__, "audioSourceToHal", sContextConversion, status);
510     }
511 }
512 
513 #if MAJOR_VERSION <= 6
514 
setDevice(AudioDeviceBitfield device)515 Return<Result> Effect::setDevice(AudioDeviceBitfield device) {
516     uint32_t halDevice = static_cast<uint32_t>(device);
517     return sendCommand(EFFECT_CMD_SET_DEVICE, "SET_DEVICE", sizeof(uint32_t), &halDevice);
518 }
519 
setInputDevice(AudioDeviceBitfield device)520 Return<Result> Effect::setInputDevice(AudioDeviceBitfield device) {
521     uint32_t halDevice = static_cast<uint32_t>(device);
522     return sendCommand(EFFECT_CMD_SET_INPUT_DEVICE, "SET_INPUT_DEVICE", sizeof(uint32_t),
523                        &halDevice);
524 }
525 
526 #else  // MAJOR_VERSION <= 6
527 
setDevice(const DeviceAddress & device)528 Return<Result> Effect::setDevice(const DeviceAddress& device) {
529     audio_devices_t halDevice;
530     char halDeviceAddress[AUDIO_DEVICE_MAX_ADDRESS_LEN];
531     if (status_t status = HidlUtils::deviceAddressToHal(device, &halDevice, halDeviceAddress);
532         status == NO_ERROR) {
533         uint32_t halDeviceParam = static_cast<uint32_t>(halDevice);
534         return sendCommand(EFFECT_CMD_SET_DEVICE, "SET_DEVICE", sizeof(uint32_t), &halDeviceParam);
535     } else {
536         return analyzeStatus(__func__, "deviceAddressToHal", sContextConversion, status);
537     }
538 }
539 
setInputDevice(const DeviceAddress & device)540 Return<Result> Effect::setInputDevice(const DeviceAddress& device) {
541     audio_devices_t halDevice;
542     char halDeviceAddress[AUDIO_DEVICE_MAX_ADDRESS_LEN];
543     if (status_t status = HidlUtils::deviceAddressToHal(device, &halDevice, halDeviceAddress);
544         status == NO_ERROR) {
545         uint32_t halDeviceParam = static_cast<uint32_t>(halDevice);
546         return sendCommand(EFFECT_CMD_SET_INPUT_DEVICE, "SET_INPUT_DEVICE", sizeof(uint32_t),
547                            &halDeviceParam);
548     } else {
549         return analyzeStatus(__func__, "deviceAddressToHal", sContextConversion, status);
550     }
551 }
552 
553 #endif  // MAJOR_VERSION <= 6
554 
setAndGetVolume(const hidl_vec<uint32_t> & volumes,setAndGetVolume_cb _hidl_cb)555 Return<void> Effect::setAndGetVolume(const hidl_vec<uint32_t>& volumes,
556                                      setAndGetVolume_cb _hidl_cb) {
557     uint32_t halDataSize;
558     std::unique_ptr<uint8_t[]> halData = hidlVecToHal(volumes, &halDataSize);
559     uint32_t halResultSize = halDataSize;
560     std::vector<uint32_t> halResult(volumes.size(), 0);
561     Result retval = sendCommandReturningData(EFFECT_CMD_SET_VOLUME, "SET_VOLUME", halDataSize,
562                                              &halData[0], &halResultSize, &halResult[0]);
563     hidl_vec<uint32_t> result;
564     if (retval == Result::OK) {
565         result.setToExternal(&halResult[0], halResultSize);
566     }
567     _hidl_cb(retval, result);
568     return Void();
569 }
570 
volumeChangeNotification(const hidl_vec<uint32_t> & volumes)571 Return<Result> Effect::volumeChangeNotification(const hidl_vec<uint32_t>& volumes) {
572     uint32_t halDataSize;
573     std::unique_ptr<uint8_t[]> halData = hidlVecToHal(volumes, &halDataSize);
574     return sendCommand(EFFECT_CMD_SET_VOLUME, "SET_VOLUME", halDataSize, &halData[0]);
575 }
576 
setAudioMode(AudioMode mode)577 Return<Result> Effect::setAudioMode(AudioMode mode) {
578     uint32_t halMode = static_cast<uint32_t>(mode);
579     return sendCommand(EFFECT_CMD_SET_AUDIO_MODE, "SET_AUDIO_MODE", sizeof(uint32_t), &halMode);
580 }
581 
setConfigReverse(const EffectConfig & config,const sp<IEffectBufferProviderCallback> & inputBufferProvider,const sp<IEffectBufferProviderCallback> & outputBufferProvider)582 Return<Result> Effect::setConfigReverse(
583     const EffectConfig& config, const sp<IEffectBufferProviderCallback>& inputBufferProvider,
584     const sp<IEffectBufferProviderCallback>& outputBufferProvider) {
585     return setConfigImpl(EFFECT_CMD_SET_CONFIG_REVERSE, "SET_CONFIG_REVERSE", config,
586                          inputBufferProvider, outputBufferProvider);
587 }
588 
getConfig(getConfig_cb _hidl_cb)589 Return<void> Effect::getConfig(getConfig_cb _hidl_cb) {
590     getConfigImpl(EFFECT_CMD_GET_CONFIG, "GET_CONFIG", _hidl_cb);
591     return Void();
592 }
593 
getConfigReverse(getConfigReverse_cb _hidl_cb)594 Return<void> Effect::getConfigReverse(getConfigReverse_cb _hidl_cb) {
595     getConfigImpl(EFFECT_CMD_GET_CONFIG_REVERSE, "GET_CONFIG_REVERSE", _hidl_cb);
596     return Void();
597 }
598 
getSupportedAuxChannelsConfigs(uint32_t maxConfigs,getSupportedAuxChannelsConfigs_cb _hidl_cb)599 Return<void> Effect::getSupportedAuxChannelsConfigs(uint32_t maxConfigs,
600                                                     getSupportedAuxChannelsConfigs_cb _hidl_cb) {
601     hidl_vec<EffectAuxChannelsConfig> result;
602     Result retval = getSupportedConfigsImpl(
603         EFFECT_FEATURE_AUX_CHANNELS, maxConfigs, sizeof(channel_config_t),
604         [&](uint32_t supportedConfigs, void* configsData) {
605             result.resize(supportedConfigs);
606             channel_config_t* config = reinterpret_cast<channel_config_t*>(configsData);
607             for (size_t i = 0; i < result.size(); ++i) {
608                 effectAuxChannelsConfigFromHal(*config++, &result[i]);
609             }
610         });
611     _hidl_cb(retval, result);
612     return Void();
613 }
614 
getAuxChannelsConfig(getAuxChannelsConfig_cb _hidl_cb)615 Return<void> Effect::getAuxChannelsConfig(getAuxChannelsConfig_cb _hidl_cb) {
616     EffectAuxChannelsConfig result;
617     Result retval = getCurrentConfigImpl(
618         EFFECT_FEATURE_AUX_CHANNELS, sizeof(channel_config_t), [&](void* configData) {
619             effectAuxChannelsConfigFromHal(*reinterpret_cast<channel_config_t*>(configData),
620                                            &result);
621         });
622     _hidl_cb(retval, result);
623     return Void();
624 }
625 
setAuxChannelsConfig(const EffectAuxChannelsConfig & config)626 Return<Result> Effect::setAuxChannelsConfig(const EffectAuxChannelsConfig& config) {
627     std::vector<uint32_t> halCmd(
628             alignedSizeIn<uint32_t>(sizeof(uint32_t) + sizeof(channel_config_t)), 0);
629     halCmd[0] = EFFECT_FEATURE_AUX_CHANNELS;
630     effectAuxChannelsConfigToHal(config, reinterpret_cast<channel_config_t*>(&halCmd[1]));
631     return sendCommandReturningStatus(EFFECT_CMD_SET_FEATURE_CONFIG,
632                                       "SET_FEATURE_CONFIG AUX_CHANNELS", halCmd.size(), &halCmd[0]);
633 }
634 
offload(const EffectOffloadParameter & param)635 Return<Result> Effect::offload(const EffectOffloadParameter& param) {
636     effect_offload_param_t halParam;
637     effectOffloadParamToHal(param, &halParam);
638     return sendCommandReturningStatus(EFFECT_CMD_OFFLOAD, "OFFLOAD", sizeof(effect_offload_param_t),
639                                       &halParam);
640 }
641 
getDescriptor(getDescriptor_cb _hidl_cb)642 Return<void> Effect::getDescriptor(getDescriptor_cb _hidl_cb) {
643     effect_descriptor_t halDescriptor;
644     memset(&halDescriptor, 0, sizeof(effect_descriptor_t));
645     status_t status = (*mHandle)->get_descriptor(mHandle, &halDescriptor);
646     EffectDescriptor descriptor;
647     if (status == OK) {
648         status = EffectUtils::effectDescriptorFromHal(halDescriptor, &descriptor);
649     }
650     _hidl_cb(analyzeStatus("get_descriptor", "", sContextCallFunction, status), descriptor);
651     return Void();
652 }
653 
command(uint32_t commandId,const hidl_vec<uint8_t> & data,uint32_t resultMaxSize,command_cb _hidl_cb)654 Return<void> Effect::command(uint32_t commandId, const hidl_vec<uint8_t>& data,
655                              uint32_t resultMaxSize, command_cb _hidl_cb) {
656     uint32_t halDataSize;
657     std::unique_ptr<uint8_t[]> halData = hidlVecToHal(data, &halDataSize);
658     uint32_t halResultSize = resultMaxSize;
659     std::unique_ptr<uint8_t[]> halResult(new uint8_t[halResultSize]);
660     memset(&halResult[0], 0, halResultSize);
661 
662     void* dataPtr = halDataSize > 0 ? &halData[0] : NULL;
663     void* resultPtr = halResultSize > 0 ? &halResult[0] : NULL;
664     status_t status =
665         (*mHandle)->command(mHandle, commandId, halDataSize, dataPtr, &halResultSize, resultPtr);
666     hidl_vec<uint8_t> result;
667     if (status == OK && resultPtr != NULL) {
668         result.setToExternal(&halResult[0], halResultSize);
669     }
670     _hidl_cb(status, result);
671     return Void();
672 }
673 
setParameter(const hidl_vec<uint8_t> & parameter,const hidl_vec<uint8_t> & value)674 Return<Result> Effect::setParameter(const hidl_vec<uint8_t>& parameter,
675                                     const hidl_vec<uint8_t>& value) {
676     return setParameterImpl(parameter.size(), &parameter[0], value.size(), &value[0]);
677 }
678 
getParameter(const hidl_vec<uint8_t> & parameter,uint32_t valueMaxSize,getParameter_cb _hidl_cb)679 Return<void> Effect::getParameter(const hidl_vec<uint8_t>& parameter, uint32_t valueMaxSize,
680                                   getParameter_cb _hidl_cb) {
681     hidl_vec<uint8_t> value;
682     Result retval = getParameterImpl(
683         parameter.size(), &parameter[0], valueMaxSize,
684         [&](uint32_t valueSize, const void* valueData) {
685             value.setToExternal(reinterpret_cast<uint8_t*>(const_cast<void*>(valueData)),
686                                 valueSize);
687         });
688     _hidl_cb(retval, value);
689     return Void();
690 }
691 
getSupportedConfigsForFeature(uint32_t featureId,uint32_t maxConfigs,uint32_t configSize,getSupportedConfigsForFeature_cb _hidl_cb)692 Return<void> Effect::getSupportedConfigsForFeature(uint32_t featureId, uint32_t maxConfigs,
693                                                    uint32_t configSize,
694                                                    getSupportedConfigsForFeature_cb _hidl_cb) {
695     uint32_t configCount = 0;
696     hidl_vec<uint8_t> result;
697     Result retval = getSupportedConfigsImpl(featureId, maxConfigs, configSize,
698                                             [&](uint32_t supportedConfigs, void* configsData) {
699                                                 configCount = supportedConfigs;
700                                                 result.resize(configCount * configSize);
701                                                 memcpy(&result[0], configsData, result.size());
702                                             });
703     _hidl_cb(retval, configCount, result);
704     return Void();
705 }
706 
getCurrentConfigForFeature(uint32_t featureId,uint32_t configSize,getCurrentConfigForFeature_cb _hidl_cb)707 Return<void> Effect::getCurrentConfigForFeature(uint32_t featureId, uint32_t configSize,
708                                                 getCurrentConfigForFeature_cb _hidl_cb) {
709     hidl_vec<uint8_t> result;
710     Result retval = getCurrentConfigImpl(featureId, configSize, [&](void* configData) {
711         result.resize(configSize);
712         memcpy(&result[0], configData, result.size());
713     });
714     _hidl_cb(retval, result);
715     return Void();
716 }
717 
setCurrentConfigForFeature(uint32_t featureId,const hidl_vec<uint8_t> & configData)718 Return<Result> Effect::setCurrentConfigForFeature(uint32_t featureId,
719                                                   const hidl_vec<uint8_t>& configData) {
720     std::vector<uint32_t> halCmd(alignedSizeIn<uint32_t>(sizeof(uint32_t) + configData.size()), 0);
721     halCmd[0] = featureId;
722     memcpy(&halCmd[1], &configData[0], configData.size());
723     return sendCommandReturningStatus(EFFECT_CMD_SET_FEATURE_CONFIG, "SET_FEATURE_CONFIG",
724                                       halCmd.size(), &halCmd[0]);
725 }
726 
close()727 Return<Result> Effect::close() {
728     if (mStopProcessThread.load(std::memory_order_relaxed)) {  // only this thread modifies
729         return Result::INVALID_STATE;
730     }
731     mStopProcessThread.store(true, std::memory_order_release);
732     if (mEfGroup) {
733         mEfGroup->wake(static_cast<uint32_t>(MessageQueueFlagBits::REQUEST_QUIT));
734     }
735 #if MAJOR_VERSION <= 5
736     return Result::OK;
737 #elif MAJOR_VERSION >= 6
738     // No need to join the processing thread, it is part of the API contract that the client
739     // must finish processing before closing the effect.
740     Result retval =
741             analyzeStatus("EffectRelease", "", sContextCallFunction, EffectRelease(mHandle));
742     EffectMap::getInstance().remove(mHandle);
743     return retval;
744 #endif
745 }
746 
debug(const hidl_handle & fd,const hidl_vec<hidl_string> &)747 Return<void> Effect::debug(const hidl_handle& fd, const hidl_vec<hidl_string>& /* options */) {
748     if (fd.getNativeHandle() != nullptr && fd->numFds == 1) {
749         uint32_t cmdData = fd->data[0];
750         (void)sendCommand(EFFECT_CMD_DUMP, "DUMP", sizeof(cmdData), &cmdData);
751     }
752     return Void();
753 }
754 
755 }  // namespace implementation
756 }  // namespace CPP_VERSION
757 }  // namespace effect
758 }  // namespace audio
759 }  // namespace hardware
760 }  // namespace android
761