/* * Copyright (C) 2020 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 #include #include #include #include #include "stream_in.h" #include "device_port_source.h" #include "deleters.h" #include "util.h" #include "debug.h" #include #include #include #include #include #include namespace android { namespace hardware { namespace audio { namespace V6_0 { namespace implementation { using ::android::hardware::Void; namespace { struct ReadThread : public IOThread { typedef MessageQueue CommandMQ; typedef MessageQueue StatusMQ; typedef MessageQueue DataMQ; ReadThread(StreamIn *stream, const size_t bufferSize) : mStream(stream) , mCommandMQ(1) , mStatusMQ(1) , mDataMQ(bufferSize, true /* EventFlag */) { if (!mCommandMQ.isValid()) { ALOGE("ReadThread::%s:%d: mCommandMQ is invalid", __func__, __LINE__); return; } if (!mDataMQ.isValid()) { ALOGE("ReadThread::%s:%d: mDataMQ is invalid", __func__, __LINE__); return; } if (!mStatusMQ.isValid()) { ALOGE("ReadThread::%s:%d: mStatusMQ is invalid", __func__, __LINE__); return; } status_t status; EventFlag* rawEfGroup = nullptr; status = EventFlag::createEventFlag(mDataMQ.getEventFlagWord(), &rawEfGroup); if (status != OK || !rawEfGroup) { ALOGE("ReadThread::%s:%d: rawEfGroup is invalid", __func__, __LINE__); return; } else { mEfGroup.reset(rawEfGroup); } mThread = std::thread(&ReadThread::threadLoop, this); } ~ReadThread() { if (mThread.joinable()) { requestExit(); mThread.join(); } } EventFlag *getEventFlag() override { return mEfGroup.get(); } bool isRunning() const { return mThread.joinable(); } std::future getTid() { return mTid.get_future(); } void threadLoop() { setpriority(PRIO_PROCESS, 0, PRIORITY_URGENT_AUDIO); set_sched_policy(0, SP_FOREGROUND); mTid.set_value(pthread_self()); while (true) { uint32_t efState = 0; mEfGroup->wait(MessageQueueFlagBits::NOT_FULL | EXIT_REQUEST | STAND_BY_REQUEST, &efState); if (efState & EXIT_REQUEST) { return; } if (efState & STAND_BY_REQUEST) { mSource.reset(); mBuffer.reset(); } if (efState & (MessageQueueFlagBits::NOT_FULL | 0)) { if (!mSource) { mBuffer.reset(new uint8_t[mDataMQ.getQuantumCount()]); LOG_ALWAYS_FATAL_IF(!mBuffer); mSource = DevicePortSource::create(mStream->getDeviceAddress(), mStream->getAudioConfig(), mStream->getAudioOutputFlags(), mStream->getFrameCounter()); LOG_ALWAYS_FATAL_IF(!mSource); } processCommand(); } } } void processCommand() { IStreamIn::ReadParameters rParameters; if (!mCommandMQ.read(&rParameters)) { return; // Nothing to do. } IStreamIn::ReadStatus rStatus; switch (rParameters.command) { case IStreamIn::ReadCommand::READ: rStatus = doRead(rParameters); break; case IStreamIn::ReadCommand::GET_CAPTURE_POSITION: rStatus = doGetCapturePosition(); break; default: ALOGE("ReadThread::%s:%d: Unknown read thread command code %d", __func__, __LINE__, rParameters.command); rStatus.retval = FAILURE(Result::NOT_SUPPORTED); break; } rStatus.replyTo = rParameters.command; if (!mStatusMQ.write(&rStatus)) { ALOGE("ReadThread::%s:%d: status message queue write failed", __func__, __LINE__); } mEfGroup->wake(MessageQueueFlagBits::NOT_EMPTY | 0); } IStreamIn::ReadStatus doRead(const IStreamIn::ReadParameters &rParameters) { const size_t bytesToRead = std::min(mDataMQ.availableToWrite(), static_cast(rParameters.params.read)); IStreamIn::ReadStatus status; size_t read = 0; status.retval = doReadImpl(&mBuffer[0], bytesToRead, read); if (status.retval == Result::OK) { if (!mDataMQ.write(&mBuffer[0], read)) { ALOGE("ReadThread::%s:%d: mDataMQ.write failed", __func__, __LINE__); } status.reply.read = read; } return status; } Result doReadImpl(uint8_t *const data, const size_t toRead, size_t &read) { const int res = mSource->read(data, toRead); if (res < 0) { memset(data, 0, toRead); read = toRead; ALOGE("StreamInReadThread::%s:%d pcm_read failed with %s", __func__, __LINE__, strerror(-res)); } else { read = res; } return Result::OK; } IStreamIn::ReadStatus doGetCapturePosition() { IStreamIn::ReadStatus status; status.retval = mSource->getCapturePosition( status.reply.capturePosition.frames, status.reply.capturePosition.time); return status; } StreamIn *const mStream; CommandMQ mCommandMQ; StatusMQ mStatusMQ; DataMQ mDataMQ; std::unique_ptr mEfGroup; std::unique_ptr mBuffer; std::unique_ptr mSource; std::thread mThread; std::promise mTid; }; } // namespace StreamIn::StreamIn(sp dev, void (*unrefDevice)(IDevice*), int32_t ioHandle, const DeviceAddress& device, const AudioConfig& config, hidl_bitfield flags, const SinkMetadata& sinkMetadata) : mDev(std::move(dev)) , mUnrefDevice(unrefDevice) , mCommon(ioHandle, device, config, flags) , mSinkMetadata(sinkMetadata) { } StreamIn::~StreamIn() { closeImpl(true); } Return StreamIn::getFrameSize() { return mCommon.getFrameSize(); } Return StreamIn::getFrameCount() { return mCommon.getFrameCount(); } Return StreamIn::getBufferSize() { return mCommon.getBufferSize(); } Return StreamIn::getSampleRate() { return mCommon.getSampleRate(); } Return StreamIn::getSupportedSampleRates(AudioFormat format, getSupportedSampleRates_cb _hidl_cb) { mCommon.getSupportedSampleRates(format, _hidl_cb); return Void(); } Return StreamIn::setSampleRate(uint32_t sampleRateHz) { return mCommon.setSampleRate(sampleRateHz); } Return> StreamIn::getChannelMask() { return mCommon.getChannelMask(); } Return StreamIn::getSupportedChannelMasks(AudioFormat format, IStream::getSupportedChannelMasks_cb _hidl_cb) { mCommon.getSupportedChannelMasks(format, _hidl_cb); return Void(); } Return StreamIn::setChannelMask(hidl_bitfield mask) { return mCommon.setChannelMask(mask); } Return StreamIn::getFormat() { return mCommon.getFormat(); } Return StreamIn::getSupportedFormats(getSupportedFormats_cb _hidl_cb) { mCommon.getSupportedFormats(_hidl_cb); return Void(); } Return StreamIn::setFormat(AudioFormat format) { return mCommon.setFormat(format); } Return StreamIn::getAudioProperties(getAudioProperties_cb _hidl_cb) { mCommon.getAudioProperties(_hidl_cb); return Void(); } Return StreamIn::addEffect(uint64_t effectId) { (void)effectId; return FAILURE(Result::INVALID_ARGUMENTS); } Return StreamIn::removeEffect(uint64_t effectId) { (void)effectId; return FAILURE(Result::INVALID_ARGUMENTS); } Return StreamIn::standby() { if (mReadThread) { LOG_ALWAYS_FATAL_IF(!mReadThread->standby()); } return Result::OK; } Return StreamIn::getDevices(getDevices_cb _hidl_cb) { mCommon.getDevices(_hidl_cb); return Void(); } Return StreamIn::setDevices(const hidl_vec& devices) { return mCommon.setDevices(devices); } Return StreamIn::getParameters(const hidl_vec& context, const hidl_vec& keys, getParameters_cb _hidl_cb) { (void)context; _hidl_cb((keys.size() > 0) ? FAILURE(Result::NOT_SUPPORTED) : Result::OK, {}); return Void(); } Return StreamIn::setParameters(const hidl_vec& context, const hidl_vec& parameters) { (void)context; (void)parameters; return Result::OK; } Return StreamIn::setHwAvSync(uint32_t hwAvSync) { (void)hwAvSync; return FAILURE(Result::NOT_SUPPORTED); } Return StreamIn::start() { return FAILURE(Result::NOT_SUPPORTED); } Return StreamIn::stop() { return FAILURE(Result::NOT_SUPPORTED); } Return StreamIn::createMmapBuffer(int32_t minSizeFrames, createMmapBuffer_cb _hidl_cb) { (void)minSizeFrames; _hidl_cb(FAILURE(Result::NOT_SUPPORTED), {}); return Void(); } Return StreamIn::getMmapPosition(getMmapPosition_cb _hidl_cb) { _hidl_cb(FAILURE(Result::NOT_SUPPORTED), {}); return Void(); } Result StreamIn::closeImpl(const bool fromDctor) { if (mDev) { mReadThread.reset(); mUnrefDevice(mDev.get()); mDev = nullptr; return Result::OK; } else if (fromDctor) { // closeImpl is always called from the dctor, it is ok if mDev is null, // we don't want to log the error in this case. return Result::OK; } else { return FAILURE(Result::INVALID_STATE); } } Return StreamIn::close() { return closeImpl(false); } Return StreamIn::getAudioSource(getAudioSource_cb _hidl_cb) { _hidl_cb(FAILURE(Result::NOT_SUPPORTED), {}); return Void(); } Return StreamIn::setGain(float gain) { (void)gain; return FAILURE(Result::NOT_SUPPORTED); } Return StreamIn::updateSinkMetadata(const SinkMetadata& sinkMetadata) { (void)sinkMetadata; return Void(); } Return StreamIn::prepareForReading(uint32_t frameSize, uint32_t framesCount, prepareForReading_cb _hidl_cb) { if (!frameSize || !framesCount || frameSize > 256 || framesCount > (1u << 20)) { _hidl_cb(FAILURE(Result::INVALID_ARGUMENTS), {}, {}, {}, {}); return Void(); } if (mReadThread) { // INVALID_STATE if the method was already called. _hidl_cb(FAILURE(Result::INVALID_STATE), {}, {}, {}, {}); return Void(); } auto t = std::make_unique(this, frameSize * framesCount); if (t->isRunning()) { _hidl_cb(Result::OK, *(t->mCommandMQ.getDesc()), *(t->mDataMQ.getDesc()), *(t->mStatusMQ.getDesc()), {.pid = getpid(), .tid = t->getTid().get()}); mReadThread = std::move(t); } else { _hidl_cb(FAILURE(Result::INVALID_ARGUMENTS), {}, {}, {}, {}); } return Void(); } Return StreamIn::getInputFramesLost() { return 0; } Return StreamIn::getCapturePosition(getCapturePosition_cb _hidl_cb) { _hidl_cb(FAILURE(Result::NOT_SUPPORTED), 0, 0); // see ReadThread::doGetCapturePosition return Void(); } Return StreamIn::getActiveMicrophones(getActiveMicrophones_cb _hidl_cb) { _hidl_cb(Result::OK, {util::getMicrophoneInfo()}); return Void(); } Return StreamIn::setMicrophoneDirection(MicrophoneDirection direction) { (void)direction; return FAILURE(Result::NOT_SUPPORTED); } Return StreamIn::setMicrophoneFieldDimension(float zoom) { (void)zoom; return FAILURE(Result::NOT_SUPPORTED); } } // namespace implementation } // namespace V6_0 } // namespace audio } // namespace hardware } // namespace android