Mikhail Naganov | df5adfd | 2021-11-11 22:09:22 +0000 | [diff] [blame] | 1 | /* |
| 2 | * Copyright (C) 2022 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 | #define LOG_TAG "AHAL_Stream" |
Mikhail Naganov | df5adfd | 2021-11-11 22:09:22 +0000 | [diff] [blame] | 18 | #include <android-base/logging.h> |
Mikhail Naganov | e9f10fc | 2022-10-14 23:31:52 +0000 | [diff] [blame] | 19 | #include <android/binder_ibinder_platform.h> |
Mikhail Naganov | 4f5d3f1 | 2022-07-22 23:23:25 +0000 | [diff] [blame] | 20 | #include <utils/SystemClock.h> |
Mikhail Naganov | df5adfd | 2021-11-11 22:09:22 +0000 | [diff] [blame] | 21 | |
Mikhail Naganov | ef6bc74 | 2022-10-06 00:14:19 +0000 | [diff] [blame] | 22 | #include <Utils.h> |
| 23 | |
Mikhail Naganov | 4f5d3f1 | 2022-07-22 23:23:25 +0000 | [diff] [blame] | 24 | #include "core-impl/Module.h" |
Mikhail Naganov | df5adfd | 2021-11-11 22:09:22 +0000 | [diff] [blame] | 25 | #include "core-impl/Stream.h" |
| 26 | |
| 27 | using aidl::android::hardware::audio::common::SinkMetadata; |
| 28 | using aidl::android::hardware::audio::common::SourceMetadata; |
Mikhail Naganov | ef6bc74 | 2022-10-06 00:14:19 +0000 | [diff] [blame] | 29 | using aidl::android::media::audio::common::AudioDevice; |
Mikhail Naganov | 7492720 | 2022-12-19 16:37:14 +0000 | [diff] [blame] | 30 | using aidl::android::media::audio::common::AudioDualMonoMode; |
| 31 | using aidl::android::media::audio::common::AudioLatencyMode; |
Mikhail Naganov | df5adfd | 2021-11-11 22:09:22 +0000 | [diff] [blame] | 32 | using aidl::android::media::audio::common::AudioOffloadInfo; |
Mikhail Naganov | 7492720 | 2022-12-19 16:37:14 +0000 | [diff] [blame] | 33 | using aidl::android::media::audio::common::AudioPlaybackRate; |
Mikhail Naganov | ef6bc74 | 2022-10-06 00:14:19 +0000 | [diff] [blame] | 34 | using android::hardware::audio::common::getChannelCount; |
| 35 | using android::hardware::audio::common::getFrameSizeInBytes; |
Mikhail Naganov | df5adfd | 2021-11-11 22:09:22 +0000 | [diff] [blame] | 36 | |
| 37 | namespace aidl::android::hardware::audio::core { |
| 38 | |
Mikhail Naganov | 4f5d3f1 | 2022-07-22 23:23:25 +0000 | [diff] [blame] | 39 | void StreamContext::fillDescriptor(StreamDescriptor* desc) { |
| 40 | if (mCommandMQ) { |
| 41 | desc->command = mCommandMQ->dupeDesc(); |
| 42 | } |
| 43 | if (mReplyMQ) { |
| 44 | desc->reply = mReplyMQ->dupeDesc(); |
| 45 | } |
| 46 | if (mDataMQ) { |
Mikhail Naganov | ef6bc74 | 2022-10-06 00:14:19 +0000 | [diff] [blame] | 47 | const size_t frameSize = getFrameSize(); |
| 48 | desc->frameSizeBytes = frameSize; |
| 49 | desc->bufferSizeFrames = mDataMQ->getQuantumCount() * mDataMQ->getQuantumSize() / frameSize; |
Mikhail Naganov | 4f5d3f1 | 2022-07-22 23:23:25 +0000 | [diff] [blame] | 50 | desc->audio.set<StreamDescriptor::AudioBuffer::Tag::fmq>(mDataMQ->dupeDesc()); |
| 51 | } |
Mikhail Naganov | 6a4872d | 2022-06-15 21:39:04 +0000 | [diff] [blame] | 52 | } |
Mikhail Naganov | df5adfd | 2021-11-11 22:09:22 +0000 | [diff] [blame] | 53 | |
Mikhail Naganov | ef6bc74 | 2022-10-06 00:14:19 +0000 | [diff] [blame] | 54 | size_t StreamContext::getFrameSize() const { |
| 55 | return getFrameSizeInBytes(mFormat, mChannelLayout); |
| 56 | } |
| 57 | |
Mikhail Naganov | 4f5d3f1 | 2022-07-22 23:23:25 +0000 | [diff] [blame] | 58 | bool StreamContext::isValid() const { |
| 59 | if (mCommandMQ && !mCommandMQ->isValid()) { |
| 60 | LOG(ERROR) << "command FMQ is invalid"; |
| 61 | return false; |
| 62 | } |
| 63 | if (mReplyMQ && !mReplyMQ->isValid()) { |
| 64 | LOG(ERROR) << "reply FMQ is invalid"; |
| 65 | return false; |
| 66 | } |
Mikhail Naganov | ef6bc74 | 2022-10-06 00:14:19 +0000 | [diff] [blame] | 67 | if (getFrameSize() == 0) { |
| 68 | LOG(ERROR) << "frame size is invalid"; |
Mikhail Naganov | 4f5d3f1 | 2022-07-22 23:23:25 +0000 | [diff] [blame] | 69 | return false; |
| 70 | } |
| 71 | if (mDataMQ && !mDataMQ->isValid()) { |
| 72 | LOG(ERROR) << "data FMQ is invalid"; |
| 73 | return false; |
| 74 | } |
| 75 | return true; |
| 76 | } |
| 77 | |
| 78 | void StreamContext::reset() { |
| 79 | mCommandMQ.reset(); |
| 80 | mReplyMQ.reset(); |
| 81 | mDataMQ.reset(); |
| 82 | } |
| 83 | |
| 84 | std::string StreamWorkerCommonLogic::init() { |
| 85 | if (mCommandMQ == nullptr) return "Command MQ is null"; |
| 86 | if (mReplyMQ == nullptr) return "Reply MQ is null"; |
| 87 | if (mDataMQ == nullptr) return "Data MQ is null"; |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 88 | if (sizeof(DataBufferElement) != mDataMQ->getQuantumSize()) { |
Mikhail Naganov | 4f5d3f1 | 2022-07-22 23:23:25 +0000 | [diff] [blame] | 89 | return "Unexpected Data MQ quantum size: " + std::to_string(mDataMQ->getQuantumSize()); |
| 90 | } |
| 91 | mDataBufferSize = mDataMQ->getQuantumCount() * mDataMQ->getQuantumSize(); |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 92 | mDataBuffer.reset(new (std::nothrow) DataBufferElement[mDataBufferSize]); |
Mikhail Naganov | 4f5d3f1 | 2022-07-22 23:23:25 +0000 | [diff] [blame] | 93 | if (mDataBuffer == nullptr) { |
| 94 | return "Failed to allocate data buffer for element count " + |
| 95 | std::to_string(mDataMQ->getQuantumCount()) + |
| 96 | ", size in bytes: " + std::to_string(mDataBufferSize); |
| 97 | } |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 98 | if (::android::status_t status = mDriver->init(); status != STATUS_OK) { |
| 99 | return "Failed to initialize the driver: " + std::to_string(status); |
| 100 | } |
Mikhail Naganov | 4f5d3f1 | 2022-07-22 23:23:25 +0000 | [diff] [blame] | 101 | return ""; |
| 102 | } |
| 103 | |
Mikhail Naganov | cce8e5f | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 104 | void StreamWorkerCommonLogic::populateReply(StreamDescriptor::Reply* reply, |
| 105 | bool isConnected) const { |
Mikhail Naganov | 549a822 | 2022-11-23 18:30:07 +0000 | [diff] [blame] | 106 | reply->status = STATUS_OK; |
Mikhail Naganov | cce8e5f | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 107 | if (isConnected) { |
Mikhail Naganov | cce8e5f | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 108 | reply->observable.frames = mFrameCount; |
| 109 | reply->observable.timeNs = ::android::elapsedRealtimeNano(); |
| 110 | } else { |
Mikhail Naganov | 549a822 | 2022-11-23 18:30:07 +0000 | [diff] [blame] | 111 | reply->observable.frames = StreamDescriptor::Position::UNKNOWN; |
| 112 | reply->observable.timeNs = StreamDescriptor::Position::UNKNOWN; |
Mikhail Naganov | cce8e5f | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 113 | } |
| 114 | } |
| 115 | |
Mikhail Naganov | bd483c0 | 2022-11-17 20:33:39 +0000 | [diff] [blame] | 116 | void StreamWorkerCommonLogic::populateReplyWrongState( |
| 117 | StreamDescriptor::Reply* reply, const StreamDescriptor::Command& command) const { |
| 118 | LOG(WARNING) << "command '" << toString(command.getTag()) |
| 119 | << "' can not be handled in the state " << toString(mState); |
| 120 | reply->status = STATUS_INVALID_OPERATION; |
| 121 | } |
| 122 | |
Mikhail Naganov | 4f5d3f1 | 2022-07-22 23:23:25 +0000 | [diff] [blame] | 123 | const std::string StreamInWorkerLogic::kThreadName = "reader"; |
| 124 | |
| 125 | StreamInWorkerLogic::Status StreamInWorkerLogic::cycle() { |
Mikhail Naganov | bd483c0 | 2022-11-17 20:33:39 +0000 | [diff] [blame] | 126 | // Note: for input streams, draining is driven by the client, thus |
| 127 | // "empty buffer" condition can only happen while handling the 'burst' |
| 128 | // command. Thus, unlike for output streams, it does not make sense to |
| 129 | // delay the 'DRAINING' state here by 'mTransientStateDelayMs'. |
| 130 | // TODO: Add a delay for transitions of async operations when/if they added. |
| 131 | |
Mikhail Naganov | 4f5d3f1 | 2022-07-22 23:23:25 +0000 | [diff] [blame] | 132 | StreamDescriptor::Command command{}; |
| 133 | if (!mCommandMQ->readBlocking(&command, 1)) { |
| 134 | LOG(ERROR) << __func__ << ": reading of command from MQ failed"; |
Mikhail Naganov | cce8e5f | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 135 | mState = StreamDescriptor::State::ERROR; |
Mikhail Naganov | 4f5d3f1 | 2022-07-22 23:23:25 +0000 | [diff] [blame] | 136 | return Status::ABORT; |
| 137 | } |
Mikhail Naganov | bd483c0 | 2022-11-17 20:33:39 +0000 | [diff] [blame] | 138 | LOG(DEBUG) << __func__ << ": received command " << command.toString() << " in " << kThreadName; |
Mikhail Naganov | 4f5d3f1 | 2022-07-22 23:23:25 +0000 | [diff] [blame] | 139 | StreamDescriptor::Reply reply{}; |
Mikhail Naganov | 9833443 | 2022-11-09 02:44:32 +0000 | [diff] [blame] | 140 | reply.status = STATUS_BAD_VALUE; |
| 141 | using Tag = StreamDescriptor::Command::Tag; |
| 142 | switch (command.getTag()) { |
Mikhail Naganov | bd483c0 | 2022-11-17 20:33:39 +0000 | [diff] [blame] | 143 | case Tag::halReservedExit: |
| 144 | if (const int32_t cookie = command.get<Tag::halReservedExit>(); |
Mikhail Naganov | 9833443 | 2022-11-09 02:44:32 +0000 | [diff] [blame] | 145 | cookie == mInternalCommandCookie) { |
Mikhail Naganov | 9833443 | 2022-11-09 02:44:32 +0000 | [diff] [blame] | 146 | setClosed(); |
| 147 | // This is an internal command, no need to reply. |
| 148 | return Status::EXIT; |
| 149 | } else { |
| 150 | LOG(WARNING) << __func__ << ": EXIT command has a bad cookie: " << cookie; |
Mikhail Naganov | cce8e5f | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 151 | } |
Mikhail Naganov | 9833443 | 2022-11-09 02:44:32 +0000 | [diff] [blame] | 152 | break; |
Mikhail Naganov | bd483c0 | 2022-11-17 20:33:39 +0000 | [diff] [blame] | 153 | case Tag::getStatus: |
| 154 | populateReply(&reply, mIsConnected); |
| 155 | break; |
Mikhail Naganov | 9833443 | 2022-11-09 02:44:32 +0000 | [diff] [blame] | 156 | case Tag::start: |
Mikhail Naganov | 9833443 | 2022-11-09 02:44:32 +0000 | [diff] [blame] | 157 | if (mState == StreamDescriptor::State::STANDBY || |
| 158 | mState == StreamDescriptor::State::DRAINING) { |
| 159 | populateReply(&reply, mIsConnected); |
| 160 | mState = mState == StreamDescriptor::State::STANDBY |
| 161 | ? StreamDescriptor::State::IDLE |
| 162 | : StreamDescriptor::State::ACTIVE; |
| 163 | } else { |
Mikhail Naganov | bd483c0 | 2022-11-17 20:33:39 +0000 | [diff] [blame] | 164 | populateReplyWrongState(&reply, command); |
Mikhail Naganov | 9833443 | 2022-11-09 02:44:32 +0000 | [diff] [blame] | 165 | } |
| 166 | break; |
| 167 | case Tag::burst: |
| 168 | if (const int32_t fmqByteCount = command.get<Tag::burst>(); fmqByteCount >= 0) { |
Mikhail Naganov | bd483c0 | 2022-11-17 20:33:39 +0000 | [diff] [blame] | 169 | LOG(DEBUG) << __func__ << ": '" << toString(command.getTag()) << "' command for " |
| 170 | << fmqByteCount << " bytes"; |
Mikhail Naganov | 9833443 | 2022-11-09 02:44:32 +0000 | [diff] [blame] | 171 | if (mState == StreamDescriptor::State::IDLE || |
| 172 | mState == StreamDescriptor::State::ACTIVE || |
| 173 | mState == StreamDescriptor::State::PAUSED || |
| 174 | mState == StreamDescriptor::State::DRAINING) { |
| 175 | if (!read(fmqByteCount, &reply)) { |
| 176 | mState = StreamDescriptor::State::ERROR; |
| 177 | } |
| 178 | if (mState == StreamDescriptor::State::IDLE || |
| 179 | mState == StreamDescriptor::State::PAUSED) { |
| 180 | mState = StreamDescriptor::State::ACTIVE; |
| 181 | } else if (mState == StreamDescriptor::State::DRAINING) { |
| 182 | // To simplify the reference code, we assume that the read operation |
| 183 | // has consumed all the data remaining in the hardware buffer. |
Mikhail Naganov | bd483c0 | 2022-11-17 20:33:39 +0000 | [diff] [blame] | 184 | // In a real implementation, here we would either remain in |
| 185 | // the 'DRAINING' state, or transfer to 'STANDBY' depending on the |
| 186 | // buffer state. |
Mikhail Naganov | 9833443 | 2022-11-09 02:44:32 +0000 | [diff] [blame] | 187 | mState = StreamDescriptor::State::STANDBY; |
| 188 | } |
| 189 | } else { |
Mikhail Naganov | bd483c0 | 2022-11-17 20:33:39 +0000 | [diff] [blame] | 190 | populateReplyWrongState(&reply, command); |
Mikhail Naganov | 9833443 | 2022-11-09 02:44:32 +0000 | [diff] [blame] | 191 | } |
| 192 | } else { |
| 193 | LOG(WARNING) << __func__ << ": invalid burst byte count: " << fmqByteCount; |
| 194 | } |
| 195 | break; |
| 196 | case Tag::drain: |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 197 | if (const auto mode = command.get<Tag::drain>(); |
| 198 | mode == StreamDescriptor::DrainMode::DRAIN_UNSPECIFIED) { |
Mikhail Naganov | 30301a4 | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 199 | if (mState == StreamDescriptor::State::ACTIVE) { |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 200 | if (::android::status_t status = mDriver->drain(mode); |
| 201 | status == ::android::OK) { |
| 202 | populateReply(&reply, mIsConnected); |
| 203 | mState = StreamDescriptor::State::DRAINING; |
| 204 | } else { |
| 205 | LOG(ERROR) << __func__ << ": drain failed: " << status; |
| 206 | mState = StreamDescriptor::State::ERROR; |
| 207 | } |
Mikhail Naganov | 30301a4 | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 208 | } else { |
| 209 | populateReplyWrongState(&reply, command); |
| 210 | } |
Mikhail Naganov | 9833443 | 2022-11-09 02:44:32 +0000 | [diff] [blame] | 211 | } else { |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 212 | LOG(WARNING) << __func__ << ": invalid drain mode: " << toString(mode); |
Mikhail Naganov | 9833443 | 2022-11-09 02:44:32 +0000 | [diff] [blame] | 213 | } |
| 214 | break; |
| 215 | case Tag::standby: |
Mikhail Naganov | 9833443 | 2022-11-09 02:44:32 +0000 | [diff] [blame] | 216 | if (mState == StreamDescriptor::State::IDLE) { |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 217 | if (::android::status_t status = mDriver->standby(); status == ::android::OK) { |
| 218 | populateReply(&reply, mIsConnected); |
| 219 | mState = StreamDescriptor::State::STANDBY; |
| 220 | } else { |
| 221 | LOG(ERROR) << __func__ << ": standby failed: " << status; |
| 222 | mState = StreamDescriptor::State::ERROR; |
| 223 | } |
Mikhail Naganov | 9833443 | 2022-11-09 02:44:32 +0000 | [diff] [blame] | 224 | } else { |
Mikhail Naganov | bd483c0 | 2022-11-17 20:33:39 +0000 | [diff] [blame] | 225 | populateReplyWrongState(&reply, command); |
Mikhail Naganov | 4f5d3f1 | 2022-07-22 23:23:25 +0000 | [diff] [blame] | 226 | } |
Mikhail Naganov | 9833443 | 2022-11-09 02:44:32 +0000 | [diff] [blame] | 227 | break; |
| 228 | case Tag::pause: |
Mikhail Naganov | 9833443 | 2022-11-09 02:44:32 +0000 | [diff] [blame] | 229 | if (mState == StreamDescriptor::State::ACTIVE) { |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 230 | if (::android::status_t status = mDriver->pause(); status == ::android::OK) { |
| 231 | populateReply(&reply, mIsConnected); |
| 232 | mState = StreamDescriptor::State::PAUSED; |
| 233 | } else { |
| 234 | LOG(ERROR) << __func__ << ": pause failed: " << status; |
| 235 | mState = StreamDescriptor::State::ERROR; |
| 236 | } |
Mikhail Naganov | 9833443 | 2022-11-09 02:44:32 +0000 | [diff] [blame] | 237 | } else { |
Mikhail Naganov | bd483c0 | 2022-11-17 20:33:39 +0000 | [diff] [blame] | 238 | populateReplyWrongState(&reply, command); |
Mikhail Naganov | 9833443 | 2022-11-09 02:44:32 +0000 | [diff] [blame] | 239 | } |
| 240 | break; |
| 241 | case Tag::flush: |
Mikhail Naganov | 9833443 | 2022-11-09 02:44:32 +0000 | [diff] [blame] | 242 | if (mState == StreamDescriptor::State::PAUSED) { |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 243 | if (::android::status_t status = mDriver->flush(); status == ::android::OK) { |
| 244 | populateReply(&reply, mIsConnected); |
| 245 | mState = StreamDescriptor::State::STANDBY; |
| 246 | } else { |
| 247 | LOG(ERROR) << __func__ << ": flush failed: " << status; |
| 248 | mState = StreamDescriptor::State::ERROR; |
| 249 | } |
Mikhail Naganov | 9833443 | 2022-11-09 02:44:32 +0000 | [diff] [blame] | 250 | } else { |
Mikhail Naganov | bd483c0 | 2022-11-17 20:33:39 +0000 | [diff] [blame] | 251 | populateReplyWrongState(&reply, command); |
Mikhail Naganov | 9833443 | 2022-11-09 02:44:32 +0000 | [diff] [blame] | 252 | } |
| 253 | break; |
Mikhail Naganov | 4f5d3f1 | 2022-07-22 23:23:25 +0000 | [diff] [blame] | 254 | } |
Mikhail Naganov | cce8e5f | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 255 | reply.state = mState; |
Mikhail Naganov | 4f5d3f1 | 2022-07-22 23:23:25 +0000 | [diff] [blame] | 256 | LOG(DEBUG) << __func__ << ": writing reply " << reply.toString(); |
| 257 | if (!mReplyMQ->writeBlocking(&reply, 1)) { |
| 258 | LOG(ERROR) << __func__ << ": writing of reply " << reply.toString() << " to MQ failed"; |
Mikhail Naganov | cce8e5f | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 259 | mState = StreamDescriptor::State::ERROR; |
Mikhail Naganov | 4f5d3f1 | 2022-07-22 23:23:25 +0000 | [diff] [blame] | 260 | return Status::ABORT; |
| 261 | } |
| 262 | return Status::CONTINUE; |
| 263 | } |
| 264 | |
Mikhail Naganov | cce8e5f | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 265 | bool StreamInWorkerLogic::read(size_t clientSize, StreamDescriptor::Reply* reply) { |
Mikhail Naganov | cce8e5f | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 266 | const size_t byteCount = std::min({clientSize, mDataMQ->availableToWrite(), mDataBufferSize}); |
| 267 | const bool isConnected = mIsConnected; |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 268 | size_t actualFrameCount = 0; |
Mikhail Naganov | cce8e5f | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 269 | bool fatal = false; |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 270 | int32_t latency = Module::kLatencyMs; |
| 271 | if (isConnected) { |
| 272 | if (::android::status_t status = mDriver->transfer( |
| 273 | mDataBuffer.get(), byteCount / mFrameSize, &actualFrameCount, &latency); |
| 274 | status != ::android::OK) { |
| 275 | fatal = true; |
| 276 | LOG(ERROR) << __func__ << ": read failed: " << status; |
| 277 | } |
| 278 | } else { |
| 279 | usleep(3000); // Simulate blocking transfer delay. |
| 280 | for (size_t i = 0; i < byteCount; ++i) mDataBuffer[i] = 0; |
| 281 | actualFrameCount = byteCount / mFrameSize; |
Mikhail Naganov | cce8e5f | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 282 | } |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 283 | const size_t actualByteCount = actualFrameCount * mFrameSize; |
| 284 | if (bool success = |
| 285 | actualByteCount > 0 ? mDataMQ->write(&mDataBuffer[0], actualByteCount) : true; |
| 286 | success) { |
| 287 | LOG(DEBUG) << __func__ << ": writing of " << actualByteCount << " bytes into data MQ" |
Mikhail Naganov | cce8e5f | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 288 | << " succeeded; connected? " << isConnected; |
| 289 | // Frames are provided and counted regardless of connection status. |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 290 | reply->fmqByteCount += actualByteCount; |
| 291 | mFrameCount += actualFrameCount; |
Mikhail Naganov | cce8e5f | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 292 | populateReply(reply, isConnected); |
| 293 | } else { |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 294 | LOG(WARNING) << __func__ << ": writing of " << actualByteCount |
| 295 | << " bytes of data to MQ failed"; |
Mikhail Naganov | cce8e5f | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 296 | reply->status = STATUS_NOT_ENOUGH_DATA; |
| 297 | } |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 298 | reply->latencyMs = latency; |
Mikhail Naganov | cce8e5f | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 299 | return !fatal; |
| 300 | } |
| 301 | |
Mikhail Naganov | 4f5d3f1 | 2022-07-22 23:23:25 +0000 | [diff] [blame] | 302 | const std::string StreamOutWorkerLogic::kThreadName = "writer"; |
| 303 | |
| 304 | StreamOutWorkerLogic::Status StreamOutWorkerLogic::cycle() { |
Mikhail Naganov | 30301a4 | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 305 | if (mState == StreamDescriptor::State::DRAINING || |
| 306 | mState == StreamDescriptor::State::TRANSFERRING) { |
Mikhail Naganov | bd483c0 | 2022-11-17 20:33:39 +0000 | [diff] [blame] | 307 | if (auto stateDurationMs = std::chrono::duration_cast<std::chrono::milliseconds>( |
| 308 | std::chrono::steady_clock::now() - mTransientStateStart); |
| 309 | stateDurationMs >= mTransientStateDelayMs) { |
Mikhail Naganov | 30301a4 | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 310 | if (mAsyncCallback == nullptr) { |
| 311 | // In blocking mode, mState can only be DRAINING. |
| 312 | mState = StreamDescriptor::State::IDLE; |
| 313 | } else { |
| 314 | // In a real implementation, the driver should notify the HAL about |
| 315 | // drain or transfer completion. In the stub, we switch unconditionally. |
| 316 | if (mState == StreamDescriptor::State::DRAINING) { |
| 317 | mState = StreamDescriptor::State::IDLE; |
| 318 | ndk::ScopedAStatus status = mAsyncCallback->onDrainReady(); |
| 319 | if (!status.isOk()) { |
| 320 | LOG(ERROR) << __func__ << ": error from onDrainReady: " << status; |
| 321 | } |
| 322 | } else { |
| 323 | mState = StreamDescriptor::State::ACTIVE; |
| 324 | ndk::ScopedAStatus status = mAsyncCallback->onTransferReady(); |
| 325 | if (!status.isOk()) { |
| 326 | LOG(ERROR) << __func__ << ": error from onTransferReady: " << status; |
| 327 | } |
| 328 | } |
| 329 | } |
Mikhail Naganov | bd483c0 | 2022-11-17 20:33:39 +0000 | [diff] [blame] | 330 | if (mTransientStateDelayMs.count() != 0) { |
| 331 | LOG(DEBUG) << __func__ << ": switched to state " << toString(mState) |
| 332 | << " after a timeout"; |
| 333 | } |
| 334 | } |
| 335 | } |
| 336 | |
Mikhail Naganov | 4f5d3f1 | 2022-07-22 23:23:25 +0000 | [diff] [blame] | 337 | StreamDescriptor::Command command{}; |
| 338 | if (!mCommandMQ->readBlocking(&command, 1)) { |
| 339 | LOG(ERROR) << __func__ << ": reading of command from MQ failed"; |
Mikhail Naganov | cce8e5f | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 340 | mState = StreamDescriptor::State::ERROR; |
Mikhail Naganov | 4f5d3f1 | 2022-07-22 23:23:25 +0000 | [diff] [blame] | 341 | return Status::ABORT; |
| 342 | } |
Mikhail Naganov | bd483c0 | 2022-11-17 20:33:39 +0000 | [diff] [blame] | 343 | LOG(DEBUG) << __func__ << ": received command " << command.toString() << " in " << kThreadName; |
Mikhail Naganov | 4f5d3f1 | 2022-07-22 23:23:25 +0000 | [diff] [blame] | 344 | StreamDescriptor::Reply reply{}; |
Mikhail Naganov | 9833443 | 2022-11-09 02:44:32 +0000 | [diff] [blame] | 345 | reply.status = STATUS_BAD_VALUE; |
| 346 | using Tag = StreamDescriptor::Command::Tag; |
| 347 | switch (command.getTag()) { |
Mikhail Naganov | bd483c0 | 2022-11-17 20:33:39 +0000 | [diff] [blame] | 348 | case Tag::halReservedExit: |
| 349 | if (const int32_t cookie = command.get<Tag::halReservedExit>(); |
Mikhail Naganov | 9833443 | 2022-11-09 02:44:32 +0000 | [diff] [blame] | 350 | cookie == mInternalCommandCookie) { |
Mikhail Naganov | 9833443 | 2022-11-09 02:44:32 +0000 | [diff] [blame] | 351 | setClosed(); |
| 352 | // This is an internal command, no need to reply. |
| 353 | return Status::EXIT; |
| 354 | } else { |
| 355 | LOG(WARNING) << __func__ << ": EXIT command has a bad cookie: " << cookie; |
| 356 | } |
| 357 | break; |
Mikhail Naganov | bd483c0 | 2022-11-17 20:33:39 +0000 | [diff] [blame] | 358 | case Tag::getStatus: |
| 359 | populateReply(&reply, mIsConnected); |
| 360 | break; |
Mikhail Naganov | 30301a4 | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 361 | case Tag::start: { |
| 362 | bool commandAccepted = true; |
Mikhail Naganov | 9833443 | 2022-11-09 02:44:32 +0000 | [diff] [blame] | 363 | switch (mState) { |
| 364 | case StreamDescriptor::State::STANDBY: |
| 365 | mState = StreamDescriptor::State::IDLE; |
| 366 | break; |
| 367 | case StreamDescriptor::State::PAUSED: |
| 368 | mState = StreamDescriptor::State::ACTIVE; |
| 369 | break; |
| 370 | case StreamDescriptor::State::DRAIN_PAUSED: |
Mikhail Naganov | bd483c0 | 2022-11-17 20:33:39 +0000 | [diff] [blame] | 371 | switchToTransientState(StreamDescriptor::State::DRAINING); |
Mikhail Naganov | 30301a4 | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 372 | break; |
| 373 | case StreamDescriptor::State::TRANSFER_PAUSED: |
| 374 | switchToTransientState(StreamDescriptor::State::TRANSFERRING); |
Mikhail Naganov | 9833443 | 2022-11-09 02:44:32 +0000 | [diff] [blame] | 375 | break; |
| 376 | default: |
Mikhail Naganov | bd483c0 | 2022-11-17 20:33:39 +0000 | [diff] [blame] | 377 | populateReplyWrongState(&reply, command); |
Mikhail Naganov | 30301a4 | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 378 | commandAccepted = false; |
Mikhail Naganov | 9833443 | 2022-11-09 02:44:32 +0000 | [diff] [blame] | 379 | } |
Mikhail Naganov | 30301a4 | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 380 | if (commandAccepted) { |
| 381 | populateReply(&reply, mIsConnected); |
| 382 | } |
| 383 | } break; |
Mikhail Naganov | 9833443 | 2022-11-09 02:44:32 +0000 | [diff] [blame] | 384 | case Tag::burst: |
| 385 | if (const int32_t fmqByteCount = command.get<Tag::burst>(); fmqByteCount >= 0) { |
Mikhail Naganov | bd483c0 | 2022-11-17 20:33:39 +0000 | [diff] [blame] | 386 | LOG(DEBUG) << __func__ << ": '" << toString(command.getTag()) << "' command for " |
| 387 | << fmqByteCount << " bytes"; |
Mikhail Naganov | 30301a4 | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 388 | if (mState != StreamDescriptor::State::ERROR && |
| 389 | mState != StreamDescriptor::State::TRANSFERRING && |
| 390 | mState != StreamDescriptor::State::TRANSFER_PAUSED) { |
Mikhail Naganov | 9833443 | 2022-11-09 02:44:32 +0000 | [diff] [blame] | 391 | if (!write(fmqByteCount, &reply)) { |
| 392 | mState = StreamDescriptor::State::ERROR; |
| 393 | } |
| 394 | if (mState == StreamDescriptor::State::STANDBY || |
Mikhail Naganov | 30301a4 | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 395 | mState == StreamDescriptor::State::DRAIN_PAUSED || |
| 396 | mState == StreamDescriptor::State::PAUSED) { |
| 397 | if (mAsyncCallback == nullptr || |
| 398 | mState != StreamDescriptor::State::DRAIN_PAUSED) { |
| 399 | mState = StreamDescriptor::State::PAUSED; |
| 400 | } else { |
| 401 | mState = StreamDescriptor::State::TRANSFER_PAUSED; |
| 402 | } |
Mikhail Naganov | 9833443 | 2022-11-09 02:44:32 +0000 | [diff] [blame] | 403 | } else if (mState == StreamDescriptor::State::IDLE || |
Mikhail Naganov | 30301a4 | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 404 | mState == StreamDescriptor::State::DRAINING || |
| 405 | mState == StreamDescriptor::State::ACTIVE) { |
| 406 | if (mAsyncCallback == nullptr || reply.fmqByteCount == fmqByteCount) { |
| 407 | mState = StreamDescriptor::State::ACTIVE; |
| 408 | } else { |
| 409 | switchToTransientState(StreamDescriptor::State::TRANSFERRING); |
| 410 | } |
| 411 | } |
Mikhail Naganov | 9833443 | 2022-11-09 02:44:32 +0000 | [diff] [blame] | 412 | } else { |
Mikhail Naganov | bd483c0 | 2022-11-17 20:33:39 +0000 | [diff] [blame] | 413 | populateReplyWrongState(&reply, command); |
Mikhail Naganov | 9833443 | 2022-11-09 02:44:32 +0000 | [diff] [blame] | 414 | } |
| 415 | } else { |
| 416 | LOG(WARNING) << __func__ << ": invalid burst byte count: " << fmqByteCount; |
| 417 | } |
| 418 | break; |
| 419 | case Tag::drain: |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 420 | if (const auto mode = command.get<Tag::drain>(); |
| 421 | mode == StreamDescriptor::DrainMode::DRAIN_ALL || |
| 422 | mode == StreamDescriptor::DrainMode::DRAIN_EARLY_NOTIFY) { |
Mikhail Naganov | 30301a4 | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 423 | if (mState == StreamDescriptor::State::ACTIVE || |
| 424 | mState == StreamDescriptor::State::TRANSFERRING) { |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 425 | if (::android::status_t status = mDriver->drain(mode); |
| 426 | status == ::android::OK) { |
| 427 | populateReply(&reply, mIsConnected); |
| 428 | if (mState == StreamDescriptor::State::ACTIVE && mForceSynchronousDrain) { |
| 429 | mState = StreamDescriptor::State::IDLE; |
| 430 | } else { |
| 431 | switchToTransientState(StreamDescriptor::State::DRAINING); |
| 432 | } |
Mikhail Naganov | 194daaa | 2023-01-05 22:34:20 +0000 | [diff] [blame] | 433 | } else { |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 434 | LOG(ERROR) << __func__ << ": drain failed: " << status; |
| 435 | mState = StreamDescriptor::State::ERROR; |
Mikhail Naganov | 194daaa | 2023-01-05 22:34:20 +0000 | [diff] [blame] | 436 | } |
Mikhail Naganov | 30301a4 | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 437 | } else if (mState == StreamDescriptor::State::TRANSFER_PAUSED) { |
| 438 | mState = StreamDescriptor::State::DRAIN_PAUSED; |
| 439 | populateReply(&reply, mIsConnected); |
| 440 | } else { |
| 441 | populateReplyWrongState(&reply, command); |
| 442 | } |
Mikhail Naganov | 9833443 | 2022-11-09 02:44:32 +0000 | [diff] [blame] | 443 | } else { |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 444 | LOG(WARNING) << __func__ << ": invalid drain mode: " << toString(mode); |
Mikhail Naganov | 4f5d3f1 | 2022-07-22 23:23:25 +0000 | [diff] [blame] | 445 | } |
Mikhail Naganov | 9833443 | 2022-11-09 02:44:32 +0000 | [diff] [blame] | 446 | break; |
| 447 | case Tag::standby: |
Mikhail Naganov | 9833443 | 2022-11-09 02:44:32 +0000 | [diff] [blame] | 448 | if (mState == StreamDescriptor::State::IDLE) { |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 449 | if (::android::status_t status = mDriver->standby(); status == ::android::OK) { |
| 450 | populateReply(&reply, mIsConnected); |
| 451 | mState = StreamDescriptor::State::STANDBY; |
| 452 | } else { |
| 453 | LOG(ERROR) << __func__ << ": standby failed: " << status; |
| 454 | mState = StreamDescriptor::State::ERROR; |
| 455 | } |
Mikhail Naganov | 9833443 | 2022-11-09 02:44:32 +0000 | [diff] [blame] | 456 | } else { |
Mikhail Naganov | bd483c0 | 2022-11-17 20:33:39 +0000 | [diff] [blame] | 457 | populateReplyWrongState(&reply, command); |
Mikhail Naganov | 9833443 | 2022-11-09 02:44:32 +0000 | [diff] [blame] | 458 | } |
| 459 | break; |
Mikhail Naganov | 30301a4 | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 460 | case Tag::pause: { |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 461 | std::optional<StreamDescriptor::State> nextState; |
Mikhail Naganov | 30301a4 | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 462 | switch (mState) { |
| 463 | case StreamDescriptor::State::ACTIVE: |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 464 | nextState = StreamDescriptor::State::PAUSED; |
Mikhail Naganov | 30301a4 | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 465 | break; |
| 466 | case StreamDescriptor::State::DRAINING: |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 467 | nextState = StreamDescriptor::State::DRAIN_PAUSED; |
Mikhail Naganov | 30301a4 | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 468 | break; |
| 469 | case StreamDescriptor::State::TRANSFERRING: |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 470 | nextState = StreamDescriptor::State::TRANSFER_PAUSED; |
Mikhail Naganov | 30301a4 | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 471 | break; |
| 472 | default: |
| 473 | populateReplyWrongState(&reply, command); |
Mikhail Naganov | 9833443 | 2022-11-09 02:44:32 +0000 | [diff] [blame] | 474 | } |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 475 | if (nextState.has_value()) { |
| 476 | if (::android::status_t status = mDriver->pause(); status == ::android::OK) { |
| 477 | populateReply(&reply, mIsConnected); |
| 478 | mState = nextState.value(); |
| 479 | } else { |
| 480 | LOG(ERROR) << __func__ << ": pause failed: " << status; |
| 481 | mState = StreamDescriptor::State::ERROR; |
| 482 | } |
Mikhail Naganov | 30301a4 | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 483 | } |
| 484 | } break; |
Mikhail Naganov | 9833443 | 2022-11-09 02:44:32 +0000 | [diff] [blame] | 485 | case Tag::flush: |
Mikhail Naganov | 9833443 | 2022-11-09 02:44:32 +0000 | [diff] [blame] | 486 | if (mState == StreamDescriptor::State::PAUSED || |
Mikhail Naganov | 30301a4 | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 487 | mState == StreamDescriptor::State::DRAIN_PAUSED || |
| 488 | mState == StreamDescriptor::State::TRANSFER_PAUSED) { |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 489 | if (::android::status_t status = mDriver->flush(); status == ::android::OK) { |
| 490 | populateReply(&reply, mIsConnected); |
| 491 | mState = StreamDescriptor::State::IDLE; |
| 492 | } else { |
| 493 | LOG(ERROR) << __func__ << ": flush failed: " << status; |
| 494 | mState = StreamDescriptor::State::ERROR; |
| 495 | } |
Mikhail Naganov | 9833443 | 2022-11-09 02:44:32 +0000 | [diff] [blame] | 496 | } else { |
Mikhail Naganov | bd483c0 | 2022-11-17 20:33:39 +0000 | [diff] [blame] | 497 | populateReplyWrongState(&reply, command); |
Mikhail Naganov | 9833443 | 2022-11-09 02:44:32 +0000 | [diff] [blame] | 498 | } |
| 499 | break; |
Mikhail Naganov | 4f5d3f1 | 2022-07-22 23:23:25 +0000 | [diff] [blame] | 500 | } |
Mikhail Naganov | cce8e5f | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 501 | reply.state = mState; |
Mikhail Naganov | 4f5d3f1 | 2022-07-22 23:23:25 +0000 | [diff] [blame] | 502 | LOG(DEBUG) << __func__ << ": writing reply " << reply.toString(); |
| 503 | if (!mReplyMQ->writeBlocking(&reply, 1)) { |
| 504 | LOG(ERROR) << __func__ << ": writing of reply " << reply.toString() << " to MQ failed"; |
Mikhail Naganov | cce8e5f | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 505 | mState = StreamDescriptor::State::ERROR; |
Mikhail Naganov | 4f5d3f1 | 2022-07-22 23:23:25 +0000 | [diff] [blame] | 506 | return Status::ABORT; |
| 507 | } |
| 508 | return Status::CONTINUE; |
| 509 | } |
| 510 | |
Mikhail Naganov | cce8e5f | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 511 | bool StreamOutWorkerLogic::write(size_t clientSize, StreamDescriptor::Reply* reply) { |
| 512 | const size_t readByteCount = mDataMQ->availableToRead(); |
Mikhail Naganov | cce8e5f | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 513 | bool fatal = false; |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 514 | int32_t latency = Module::kLatencyMs; |
Mikhail Naganov | cce8e5f | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 515 | if (bool success = readByteCount > 0 ? mDataMQ->read(&mDataBuffer[0], readByteCount) : true) { |
| 516 | const bool isConnected = mIsConnected; |
| 517 | LOG(DEBUG) << __func__ << ": reading of " << readByteCount << " bytes from data MQ" |
| 518 | << " succeeded; connected? " << isConnected; |
Mikhail Naganov | 20047bc | 2023-01-05 20:16:07 +0000 | [diff] [blame] | 519 | // Amount of data that the HAL module is going to actually use. |
| 520 | size_t byteCount = std::min({clientSize, readByteCount, mDataBufferSize}); |
| 521 | if (byteCount >= mFrameSize && mForceTransientBurst) { |
| 522 | // In order to prevent the state machine from going to ACTIVE state, |
| 523 | // simulate partial write. |
| 524 | byteCount -= mFrameSize; |
| 525 | } |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 526 | size_t actualFrameCount = 0; |
| 527 | if (isConnected) { |
| 528 | if (::android::status_t status = mDriver->transfer( |
| 529 | mDataBuffer.get(), byteCount / mFrameSize, &actualFrameCount, &latency); |
| 530 | status != ::android::OK) { |
| 531 | fatal = true; |
| 532 | LOG(ERROR) << __func__ << ": write failed: " << status; |
| 533 | } |
| 534 | } else { |
| 535 | if (mAsyncCallback == nullptr) { |
| 536 | usleep(3000); // Simulate blocking transfer delay. |
| 537 | } |
| 538 | actualFrameCount = byteCount / mFrameSize; |
| 539 | } |
| 540 | const size_t actualByteCount = actualFrameCount * mFrameSize; |
Mikhail Naganov | 20047bc | 2023-01-05 20:16:07 +0000 | [diff] [blame] | 541 | // Frames are consumed and counted regardless of the connection status. |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 542 | reply->fmqByteCount += actualByteCount; |
| 543 | mFrameCount += actualFrameCount; |
Mikhail Naganov | cce8e5f | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 544 | populateReply(reply, isConnected); |
Mikhail Naganov | cce8e5f | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 545 | } else { |
| 546 | LOG(WARNING) << __func__ << ": reading of " << readByteCount |
| 547 | << " bytes of data from MQ failed"; |
| 548 | reply->status = STATUS_NOT_ENOUGH_DATA; |
| 549 | } |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 550 | reply->latencyMs = latency; |
Mikhail Naganov | cce8e5f | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 551 | return !fatal; |
| 552 | } |
| 553 | |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 554 | template <class Metadata> |
| 555 | StreamCommonImpl<Metadata>::~StreamCommonImpl() { |
Mikhail Naganov | cce8e5f | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 556 | if (!isClosed()) { |
Mikhail Naganov | 4f5d3f1 | 2022-07-22 23:23:25 +0000 | [diff] [blame] | 557 | LOG(ERROR) << __func__ << ": stream was not closed prior to destruction, resource leak"; |
| 558 | stopWorker(); |
| 559 | // The worker and the context should clean up by themselves via destructors. |
| 560 | } |
| 561 | } |
| 562 | |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 563 | template <class Metadata> |
| 564 | void StreamCommonImpl<Metadata>::createStreamCommon( |
Mikhail Naganov | e9f10fc | 2022-10-14 23:31:52 +0000 | [diff] [blame] | 565 | const std::shared_ptr<StreamCommonInterface>& delegate) { |
| 566 | if (mCommon != nullptr) { |
| 567 | LOG(FATAL) << __func__ << ": attempting to create the common interface twice"; |
| 568 | } |
| 569 | mCommon = ndk::SharedRefBase::make<StreamCommon>(delegate); |
| 570 | mCommonBinder = mCommon->asBinder(); |
| 571 | AIBinder_setMinSchedulerPolicy(mCommonBinder.get(), SCHED_NORMAL, ANDROID_PRIORITY_AUDIO); |
| 572 | } |
| 573 | |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 574 | template <class Metadata> |
| 575 | ndk::ScopedAStatus StreamCommonImpl<Metadata>::getStreamCommon( |
Mikhail Naganov | e9f10fc | 2022-10-14 23:31:52 +0000 | [diff] [blame] | 576 | std::shared_ptr<IStreamCommon>* _aidl_return) { |
| 577 | if (mCommon == nullptr) { |
| 578 | LOG(FATAL) << __func__ << ": the common interface was not created"; |
| 579 | } |
| 580 | *_aidl_return = mCommon; |
| 581 | LOG(DEBUG) << __func__ << ": returning " << _aidl_return->get()->asBinder().get(); |
| 582 | return ndk::ScopedAStatus::ok(); |
| 583 | } |
| 584 | |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 585 | template <class Metadata> |
| 586 | ndk::ScopedAStatus StreamCommonImpl<Metadata>::updateHwAvSyncId(int32_t in_hwAvSyncId) { |
Mikhail Naganov | e9f10fc | 2022-10-14 23:31:52 +0000 | [diff] [blame] | 587 | LOG(DEBUG) << __func__ << ": id " << in_hwAvSyncId; |
| 588 | return ndk::ScopedAStatus::fromExceptionCode(EX_UNSUPPORTED_OPERATION); |
| 589 | } |
| 590 | |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 591 | template <class Metadata> |
| 592 | ndk::ScopedAStatus StreamCommonImpl<Metadata>::getVendorParameters( |
Mikhail Naganov | e9f10fc | 2022-10-14 23:31:52 +0000 | [diff] [blame] | 593 | const std::vector<std::string>& in_ids, std::vector<VendorParameter>* _aidl_return) { |
| 594 | LOG(DEBUG) << __func__ << ": id count: " << in_ids.size(); |
| 595 | (void)_aidl_return; |
| 596 | return ndk::ScopedAStatus::fromExceptionCode(EX_UNSUPPORTED_OPERATION); |
| 597 | } |
| 598 | |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 599 | template <class Metadata> |
| 600 | ndk::ScopedAStatus StreamCommonImpl<Metadata>::setVendorParameters( |
Mikhail Naganov | e9f10fc | 2022-10-14 23:31:52 +0000 | [diff] [blame] | 601 | const std::vector<VendorParameter>& in_parameters, bool in_async) { |
| 602 | LOG(DEBUG) << __func__ << ": parameters count " << in_parameters.size() |
| 603 | << ", async: " << in_async; |
| 604 | return ndk::ScopedAStatus::fromExceptionCode(EX_UNSUPPORTED_OPERATION); |
| 605 | } |
| 606 | |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 607 | template <class Metadata> |
| 608 | ndk::ScopedAStatus StreamCommonImpl<Metadata>::addEffect( |
Mikhail Naganov | fb1acde | 2022-12-12 18:57:36 +0000 | [diff] [blame] | 609 | const std::shared_ptr<::aidl::android::hardware::audio::effect::IEffect>& in_effect) { |
| 610 | if (in_effect == nullptr) { |
| 611 | LOG(DEBUG) << __func__ << ": null effect"; |
| 612 | } else { |
| 613 | LOG(DEBUG) << __func__ << ": effect Binder" << in_effect->asBinder().get(); |
| 614 | } |
| 615 | return ndk::ScopedAStatus::fromExceptionCode(EX_UNSUPPORTED_OPERATION); |
| 616 | } |
| 617 | |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 618 | template <class Metadata> |
| 619 | ndk::ScopedAStatus StreamCommonImpl<Metadata>::removeEffect( |
Mikhail Naganov | fb1acde | 2022-12-12 18:57:36 +0000 | [diff] [blame] | 620 | const std::shared_ptr<::aidl::android::hardware::audio::effect::IEffect>& in_effect) { |
| 621 | if (in_effect == nullptr) { |
| 622 | LOG(DEBUG) << __func__ << ": null effect"; |
| 623 | } else { |
| 624 | LOG(DEBUG) << __func__ << ": effect Binder" << in_effect->asBinder().get(); |
| 625 | } |
| 626 | return ndk::ScopedAStatus::fromExceptionCode(EX_UNSUPPORTED_OPERATION); |
| 627 | } |
| 628 | |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 629 | template <class Metadata> |
| 630 | ndk::ScopedAStatus StreamCommonImpl<Metadata>::close() { |
Mikhail Naganov | df5adfd | 2021-11-11 22:09:22 +0000 | [diff] [blame] | 631 | LOG(DEBUG) << __func__; |
Mikhail Naganov | cce8e5f | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 632 | if (!isClosed()) { |
Mikhail Naganov | 4f5d3f1 | 2022-07-22 23:23:25 +0000 | [diff] [blame] | 633 | stopWorker(); |
| 634 | LOG(DEBUG) << __func__ << ": joining the worker thread..."; |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 635 | mWorker->stop(); |
Mikhail Naganov | 4f5d3f1 | 2022-07-22 23:23:25 +0000 | [diff] [blame] | 636 | LOG(DEBUG) << __func__ << ": worker thread joined"; |
| 637 | mContext.reset(); |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 638 | mWorker->setClosed(); |
Mikhail Naganov | df5adfd | 2021-11-11 22:09:22 +0000 | [diff] [blame] | 639 | return ndk::ScopedAStatus::ok(); |
| 640 | } else { |
| 641 | LOG(ERROR) << __func__ << ": stream was already closed"; |
| 642 | return ndk::ScopedAStatus::fromExceptionCode(EX_ILLEGAL_STATE); |
| 643 | } |
| 644 | } |
| 645 | |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 646 | template <class Metadata> |
| 647 | void StreamCommonImpl<Metadata>::stopWorker() { |
Mikhail Naganov | 4f5d3f1 | 2022-07-22 23:23:25 +0000 | [diff] [blame] | 648 | if (auto commandMQ = mContext.getCommandMQ(); commandMQ != nullptr) { |
Mikhail Naganov | cce8e5f | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 649 | LOG(DEBUG) << __func__ << ": asking the worker to exit..."; |
Mikhail Naganov | bd483c0 | 2022-11-17 20:33:39 +0000 | [diff] [blame] | 650 | auto cmd = StreamDescriptor::Command::make<StreamDescriptor::Command::Tag::halReservedExit>( |
| 651 | mContext.getInternalCommandCookie()); |
Mikhail Naganov | cce8e5f | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 652 | // Note: never call 'pause' and 'resume' methods of StreamWorker |
| 653 | // in the HAL implementation. These methods are to be used by |
| 654 | // the client side only. Preventing the worker loop from running |
| 655 | // on the HAL side can cause a deadlock. |
Mikhail Naganov | 4f5d3f1 | 2022-07-22 23:23:25 +0000 | [diff] [blame] | 656 | if (!commandMQ->writeBlocking(&cmd, 1)) { |
| 657 | LOG(ERROR) << __func__ << ": failed to write exit command to the MQ"; |
| 658 | } |
| 659 | LOG(DEBUG) << __func__ << ": done"; |
| 660 | } |
| 661 | } |
| 662 | |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 663 | template <class Metadata> |
| 664 | ndk::ScopedAStatus StreamCommonImpl<Metadata>::updateMetadata(const Metadata& metadata) { |
Mikhail Naganov | df5adfd | 2021-11-11 22:09:22 +0000 | [diff] [blame] | 665 | LOG(DEBUG) << __func__; |
Mikhail Naganov | cce8e5f | 2022-09-13 01:20:45 +0000 | [diff] [blame] | 666 | if (!isClosed()) { |
Mikhail Naganov | 4f5d3f1 | 2022-07-22 23:23:25 +0000 | [diff] [blame] | 667 | mMetadata = metadata; |
Mikhail Naganov | df5adfd | 2021-11-11 22:09:22 +0000 | [diff] [blame] | 668 | return ndk::ScopedAStatus::ok(); |
| 669 | } |
| 670 | LOG(ERROR) << __func__ << ": stream was closed"; |
| 671 | return ndk::ScopedAStatus::fromExceptionCode(EX_ILLEGAL_STATE); |
| 672 | } |
| 673 | |
Mikhail Naganov | e9f10fc | 2022-10-14 23:31:52 +0000 | [diff] [blame] | 674 | // static |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 675 | ndk::ScopedAStatus StreamIn::initInstance(const std::shared_ptr<StreamIn>& stream) { |
Mikhail Naganov | e9f10fc | 2022-10-14 23:31:52 +0000 | [diff] [blame] | 676 | if (auto status = stream->init(); !status.isOk()) { |
| 677 | return status; |
| 678 | } |
| 679 | stream->createStreamCommon(stream); |
Mikhail Naganov | e9f10fc | 2022-10-14 23:31:52 +0000 | [diff] [blame] | 680 | return ndk::ScopedAStatus::ok(); |
| 681 | } |
| 682 | |
Mikhail Naganov | ef6bc74 | 2022-10-06 00:14:19 +0000 | [diff] [blame] | 683 | namespace { |
| 684 | static std::map<AudioDevice, std::string> transformMicrophones( |
| 685 | const std::vector<MicrophoneInfo>& microphones) { |
| 686 | std::map<AudioDevice, std::string> result; |
| 687 | std::transform(microphones.begin(), microphones.end(), std::inserter(result, result.begin()), |
| 688 | [](const auto& mic) { return std::make_pair(mic.device, mic.id); }); |
| 689 | return result; |
| 690 | } |
| 691 | } // namespace |
| 692 | |
Mikhail Naganov | e9f10fc | 2022-10-14 23:31:52 +0000 | [diff] [blame] | 693 | StreamIn::StreamIn(const SinkMetadata& sinkMetadata, StreamContext&& context, |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 694 | const DriverInterface::CreateInstance& createDriver, |
| 695 | const StreamWorkerInterface::CreateInstance& createWorker, |
Mikhail Naganov | ef6bc74 | 2022-10-06 00:14:19 +0000 | [diff] [blame] | 696 | const std::vector<MicrophoneInfo>& microphones) |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 697 | : StreamCommonImpl<SinkMetadata>(sinkMetadata, std::move(context), createDriver, createWorker), |
Mikhail Naganov | ef6bc74 | 2022-10-06 00:14:19 +0000 | [diff] [blame] | 698 | mMicrophones(transformMicrophones(microphones)) { |
Mikhail Naganov | 4f5d3f1 | 2022-07-22 23:23:25 +0000 | [diff] [blame] | 699 | LOG(DEBUG) << __func__; |
| 700 | } |
| 701 | |
Mikhail Naganov | ef6bc74 | 2022-10-06 00:14:19 +0000 | [diff] [blame] | 702 | ndk::ScopedAStatus StreamIn::getActiveMicrophones( |
| 703 | std::vector<MicrophoneDynamicInfo>* _aidl_return) { |
| 704 | std::vector<MicrophoneDynamicInfo> result; |
| 705 | std::vector<MicrophoneDynamicInfo::ChannelMapping> channelMapping{ |
| 706 | getChannelCount(mContext.getChannelLayout()), |
| 707 | MicrophoneDynamicInfo::ChannelMapping::DIRECT}; |
| 708 | for (auto it = mConnectedDevices.begin(); it != mConnectedDevices.end(); ++it) { |
| 709 | if (auto micIt = mMicrophones.find(*it); micIt != mMicrophones.end()) { |
| 710 | MicrophoneDynamicInfo dynMic; |
| 711 | dynMic.id = micIt->second; |
| 712 | dynMic.channelMapping = channelMapping; |
| 713 | result.push_back(std::move(dynMic)); |
| 714 | } |
| 715 | } |
| 716 | *_aidl_return = std::move(result); |
| 717 | LOG(DEBUG) << __func__ << ": returning " << ::android::internal::ToString(*_aidl_return); |
| 718 | return ndk::ScopedAStatus::ok(); |
| 719 | } |
| 720 | |
| 721 | ndk::ScopedAStatus StreamIn::getMicrophoneDirection(MicrophoneDirection* _aidl_return) { |
| 722 | LOG(DEBUG) << __func__; |
| 723 | (void)_aidl_return; |
| 724 | return ndk::ScopedAStatus::fromExceptionCode(EX_UNSUPPORTED_OPERATION); |
| 725 | } |
| 726 | |
| 727 | ndk::ScopedAStatus StreamIn::setMicrophoneDirection(MicrophoneDirection in_direction) { |
| 728 | LOG(DEBUG) << __func__ << ": direction " << toString(in_direction); |
| 729 | return ndk::ScopedAStatus::fromExceptionCode(EX_UNSUPPORTED_OPERATION); |
| 730 | } |
| 731 | |
| 732 | ndk::ScopedAStatus StreamIn::getMicrophoneFieldDimension(float* _aidl_return) { |
| 733 | LOG(DEBUG) << __func__; |
| 734 | (void)_aidl_return; |
| 735 | return ndk::ScopedAStatus::fromExceptionCode(EX_UNSUPPORTED_OPERATION); |
| 736 | } |
| 737 | |
| 738 | ndk::ScopedAStatus StreamIn::setMicrophoneFieldDimension(float in_zoom) { |
| 739 | LOG(DEBUG) << __func__ << ": zoom " << in_zoom; |
| 740 | return ndk::ScopedAStatus::fromExceptionCode(EX_UNSUPPORTED_OPERATION); |
| 741 | } |
| 742 | |
Mikhail Naganov | 383cd42 | 2022-10-15 00:25:45 +0000 | [diff] [blame] | 743 | ndk::ScopedAStatus StreamIn::getHwGain(std::vector<float>* _aidl_return) { |
| 744 | LOG(DEBUG) << __func__; |
| 745 | (void)_aidl_return; |
| 746 | return ndk::ScopedAStatus::fromExceptionCode(EX_UNSUPPORTED_OPERATION); |
| 747 | } |
| 748 | |
| 749 | ndk::ScopedAStatus StreamIn::setHwGain(const std::vector<float>& in_channelGains) { |
| 750 | LOG(DEBUG) << __func__ << ": gains " << ::android::internal::ToString(in_channelGains); |
| 751 | return ndk::ScopedAStatus::fromExceptionCode(EX_UNSUPPORTED_OPERATION); |
| 752 | } |
| 753 | |
Mikhail Naganov | e9f10fc | 2022-10-14 23:31:52 +0000 | [diff] [blame] | 754 | // static |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 755 | ndk::ScopedAStatus StreamOut::initInstance(const std::shared_ptr<StreamOut>& stream) { |
Mikhail Naganov | e9f10fc | 2022-10-14 23:31:52 +0000 | [diff] [blame] | 756 | if (auto status = stream->init(); !status.isOk()) { |
| 757 | return status; |
| 758 | } |
| 759 | stream->createStreamCommon(stream); |
Mikhail Naganov | e9f10fc | 2022-10-14 23:31:52 +0000 | [diff] [blame] | 760 | return ndk::ScopedAStatus::ok(); |
| 761 | } |
| 762 | |
| 763 | StreamOut::StreamOut(const SourceMetadata& sourceMetadata, StreamContext&& context, |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 764 | const DriverInterface::CreateInstance& createDriver, |
| 765 | const StreamWorkerInterface::CreateInstance& createWorker, |
Mikhail Naganov | df5adfd | 2021-11-11 22:09:22 +0000 | [diff] [blame] | 766 | const std::optional<AudioOffloadInfo>& offloadInfo) |
Mikhail Naganov | f429c03 | 2023-01-07 00:24:50 +0000 | [diff] [blame] | 767 | : StreamCommonImpl<SourceMetadata>(sourceMetadata, std::move(context), createDriver, |
| 768 | createWorker), |
Mikhail Naganov | 4f5d3f1 | 2022-07-22 23:23:25 +0000 | [diff] [blame] | 769 | mOffloadInfo(offloadInfo) { |
Mikhail Naganov | 6a4872d | 2022-06-15 21:39:04 +0000 | [diff] [blame] | 770 | LOG(DEBUG) << __func__; |
| 771 | } |
Mikhail Naganov | df5adfd | 2021-11-11 22:09:22 +0000 | [diff] [blame] | 772 | |
Mikhail Naganov | 383cd42 | 2022-10-15 00:25:45 +0000 | [diff] [blame] | 773 | ndk::ScopedAStatus StreamOut::getHwVolume(std::vector<float>* _aidl_return) { |
| 774 | LOG(DEBUG) << __func__; |
| 775 | (void)_aidl_return; |
| 776 | return ndk::ScopedAStatus::fromExceptionCode(EX_UNSUPPORTED_OPERATION); |
| 777 | } |
| 778 | |
| 779 | ndk::ScopedAStatus StreamOut::setHwVolume(const std::vector<float>& in_channelVolumes) { |
| 780 | LOG(DEBUG) << __func__ << ": gains " << ::android::internal::ToString(in_channelVolumes); |
| 781 | return ndk::ScopedAStatus::fromExceptionCode(EX_UNSUPPORTED_OPERATION); |
| 782 | } |
| 783 | |
Mikhail Naganov | 7492720 | 2022-12-19 16:37:14 +0000 | [diff] [blame] | 784 | ndk::ScopedAStatus StreamOut::getAudioDescriptionMixLevel(float* _aidl_return) { |
| 785 | LOG(DEBUG) << __func__; |
| 786 | (void)_aidl_return; |
| 787 | return ndk::ScopedAStatus::fromExceptionCode(EX_UNSUPPORTED_OPERATION); |
| 788 | } |
| 789 | |
| 790 | ndk::ScopedAStatus StreamOut::setAudioDescriptionMixLevel(float in_leveldB) { |
| 791 | LOG(DEBUG) << __func__ << ": description mix level " << in_leveldB; |
| 792 | return ndk::ScopedAStatus::fromExceptionCode(EX_UNSUPPORTED_OPERATION); |
| 793 | } |
| 794 | |
| 795 | ndk::ScopedAStatus StreamOut::getDualMonoMode(AudioDualMonoMode* _aidl_return) { |
| 796 | LOG(DEBUG) << __func__; |
| 797 | (void)_aidl_return; |
| 798 | return ndk::ScopedAStatus::fromExceptionCode(EX_UNSUPPORTED_OPERATION); |
| 799 | } |
| 800 | |
| 801 | ndk::ScopedAStatus StreamOut::setDualMonoMode(AudioDualMonoMode in_mode) { |
| 802 | LOG(DEBUG) << __func__ << ": dual mono mode " << toString(in_mode); |
| 803 | return ndk::ScopedAStatus::fromExceptionCode(EX_UNSUPPORTED_OPERATION); |
| 804 | } |
| 805 | |
| 806 | ndk::ScopedAStatus StreamOut::getRecommendedLatencyModes( |
| 807 | std::vector<AudioLatencyMode>* _aidl_return) { |
| 808 | LOG(DEBUG) << __func__; |
| 809 | (void)_aidl_return; |
| 810 | return ndk::ScopedAStatus::fromExceptionCode(EX_UNSUPPORTED_OPERATION); |
| 811 | } |
| 812 | |
| 813 | ndk::ScopedAStatus StreamOut::setLatencyMode(AudioLatencyMode in_mode) { |
| 814 | LOG(DEBUG) << __func__ << ": latency mode " << toString(in_mode); |
| 815 | return ndk::ScopedAStatus::fromExceptionCode(EX_UNSUPPORTED_OPERATION); |
| 816 | } |
| 817 | |
| 818 | ndk::ScopedAStatus StreamOut::getPlaybackRateParameters(AudioPlaybackRate* _aidl_return) { |
| 819 | LOG(DEBUG) << __func__; |
| 820 | (void)_aidl_return; |
| 821 | return ndk::ScopedAStatus::fromExceptionCode(EX_UNSUPPORTED_OPERATION); |
| 822 | } |
| 823 | |
| 824 | ndk::ScopedAStatus StreamOut::setPlaybackRateParameters(const AudioPlaybackRate& in_playbackRate) { |
| 825 | LOG(DEBUG) << __func__ << ": " << in_playbackRate.toString(); |
| 826 | return ndk::ScopedAStatus::fromExceptionCode(EX_UNSUPPORTED_OPERATION); |
| 827 | } |
| 828 | |
| 829 | ndk::ScopedAStatus StreamOut::selectPresentation(int32_t in_presentationId, int32_t in_programId) { |
| 830 | LOG(DEBUG) << __func__ << ": presentationId " << in_presentationId << ", programId " |
| 831 | << in_programId; |
| 832 | return ndk::ScopedAStatus::fromExceptionCode(EX_UNSUPPORTED_OPERATION); |
| 833 | } |
| 834 | |
Mikhail Naganov | df5adfd | 2021-11-11 22:09:22 +0000 | [diff] [blame] | 835 | } // namespace aidl::android::hardware::audio::core |