Glenn Kasten | 9b4c805 | 2015-01-06 14:13:13 -0800 | [diff] [blame] | 1 | /* |
| 2 | * Copyright (C) 2015 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_NDEBUG 0 |
| 18 | #define LOG_TAG "audio_utils_fifo" |
| 19 | |
Glenn Kasten | 9052f3b | 2016-07-08 16:24:41 -0700 | [diff] [blame] | 20 | #include <errno.h> |
Glenn Kasten | 0ab1d86 | 2016-06-20 12:04:56 -0700 | [diff] [blame] | 21 | #include <limits.h> |
Glenn Kasten | 9b4c805 | 2015-01-06 14:13:13 -0800 | [diff] [blame] | 22 | #include <stdlib.h> |
| 23 | #include <string.h> |
Glenn Kasten | 9052f3b | 2016-07-08 16:24:41 -0700 | [diff] [blame] | 24 | |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 25 | // FIXME futex portion is not supported on macOS, should use the macOS alternative |
Glenn Kasten | 9052f3b | 2016-07-08 16:24:41 -0700 | [diff] [blame] | 26 | #ifdef __linux__ |
| 27 | #include <linux/futex.h> |
Glenn Kasten | 3ddacbb | 2016-06-20 14:41:03 -0700 | [diff] [blame] | 28 | #include <sys/syscall.h> |
Glenn Kasten | 9052f3b | 2016-07-08 16:24:41 -0700 | [diff] [blame] | 29 | #else |
| 30 | #define FUTEX_WAIT 0 |
| 31 | #define FUTEX_WAIT_PRIVATE 0 |
| 32 | #define FUTEX_WAKE 0 |
| 33 | #define FUTEX_WAKE_PRIVATE 0 |
| 34 | #endif |
Glenn Kasten | 3ddacbb | 2016-06-20 14:41:03 -0700 | [diff] [blame] | 35 | |
Glenn Kasten | 9b4c805 | 2015-01-06 14:13:13 -0800 | [diff] [blame] | 36 | #include <audio_utils/fifo.h> |
| 37 | #include <audio_utils/roundup.h> |
Glenn Kasten | 9b4c805 | 2015-01-06 14:13:13 -0800 | [diff] [blame] | 38 | #include <cutils/log.h> |
Glenn Kasten | 9b4fe47 | 2016-06-13 09:34:57 -0700 | [diff] [blame] | 39 | #include <utils/Errors.h> |
Glenn Kasten | 9b4c805 | 2015-01-06 14:13:13 -0800 | [diff] [blame] | 40 | |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 41 | #ifdef __linux__ |
| 42 | #ifdef __ANDROID__ |
| 43 | // bionic for Android provides clock_nanosleep |
| 44 | #else |
| 45 | // bionic for desktop Linux omits clock_nanosleep |
| 46 | int clock_nanosleep(clockid_t clock_id, int flags, const struct timespec *request, |
| 47 | struct timespec *remain) |
| 48 | { |
| 49 | return syscall(SYS_clock_nanosleep, clock_id, flags, request, remain); |
| 50 | } |
| 51 | #endif // __ANDROID__ |
| 52 | #else // __linux__ |
Dan Willemsen | 23f5bc2 | 2016-11-03 13:55:28 -0700 | [diff] [blame] | 53 | // macOS <10.12 doesn't have clockid_t / CLOCK_MONOTONIC |
| 54 | #ifndef CLOCK_MONOTONIC |
Glenn Kasten | c16f93d | 2016-10-14 10:05:26 -0700 | [diff] [blame] | 55 | typedef int clockid_t; |
| 56 | #define CLOCK_MONOTONIC 0 |
Dan Willemsen | 23f5bc2 | 2016-11-03 13:55:28 -0700 | [diff] [blame] | 57 | #endif |
| 58 | // macOS doesn't have clock_nanosleep |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 59 | int clock_nanosleep(clockid_t clock_id, int flags, const struct timespec *request, |
| 60 | struct timespec *remain) |
| 61 | { |
Glenn Kasten | c16f93d | 2016-10-14 10:05:26 -0700 | [diff] [blame] | 62 | (void) clock_id; |
| 63 | (void) flags; |
| 64 | (void) request; |
| 65 | (void) remain; |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 66 | errno = ENOSYS; |
| 67 | return -1; |
| 68 | } |
| 69 | #endif // __linux__ |
| 70 | |
Glenn Kasten | d9942f7 | 2016-10-16 14:51:15 -0700 | [diff] [blame] | 71 | static int sys_futex(void *addr1, int op, int val1, const struct timespec *timeout, void *addr2, |
| 72 | int val3) |
Glenn Kasten | 3ddacbb | 2016-06-20 14:41:03 -0700 | [diff] [blame] | 73 | { |
Glenn Kasten | 9052f3b | 2016-07-08 16:24:41 -0700 | [diff] [blame] | 74 | #ifdef __linux__ |
Glenn Kasten | 3ddacbb | 2016-06-20 14:41:03 -0700 | [diff] [blame] | 75 | return syscall(SYS_futex, addr1, op, val1, timeout, addr2, val3); |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 76 | #else // __linux__ |
| 77 | // macOS doesn't have futex |
Glenn Kasten | 86c4a6d | 2016-07-09 10:37:17 -0700 | [diff] [blame] | 78 | (void) addr1; |
| 79 | (void) op; |
| 80 | (void) val1; |
| 81 | (void) timeout; |
| 82 | (void) addr2; |
| 83 | (void) val3; |
Glenn Kasten | 9052f3b | 2016-07-08 16:24:41 -0700 | [diff] [blame] | 84 | errno = ENOSYS; |
| 85 | return -1; |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 86 | #endif // __linux__ |
Glenn Kasten | 3ddacbb | 2016-06-20 14:41:03 -0700 | [diff] [blame] | 87 | } |
| 88 | |
Glenn Kasten | dc1ff1f | 2016-09-02 13:54:59 -0700 | [diff] [blame] | 89 | audio_utils_fifo_base::audio_utils_fifo_base(uint32_t frameCount, |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 90 | audio_utils_fifo_index& writerRear, audio_utils_fifo_index *throttleFront) |
Glenn Kasten | 6d7ad76 | 2016-06-15 17:05:54 -0700 | [diff] [blame] | 91 | __attribute__((no_sanitize("integer"))) : |
Glenn Kasten | 9b4fe47 | 2016-06-13 09:34:57 -0700 | [diff] [blame] | 92 | mFrameCount(frameCount), mFrameCountP2(roundup(frameCount)), |
Glenn Kasten | 09acf78 | 2016-06-17 10:28:05 -0700 | [diff] [blame] | 93 | mFudgeFactor(mFrameCountP2 - mFrameCount), |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 94 | // FIXME need an API to configure the sync types |
| 95 | mWriterRear(writerRear), mWriterRearSync(AUDIO_UTILS_FIFO_SYNC_SHARED), |
Glenn Kasten | 0b2947b | 2016-11-22 14:00:23 -0800 | [diff] [blame^] | 96 | mThrottleFront(throttleFront), mThrottleFrontSync(AUDIO_UTILS_FIFO_SYNC_SHARED), |
| 97 | mIsShutdown(false) |
Glenn Kasten | 9b4c805 | 2015-01-06 14:13:13 -0800 | [diff] [blame] | 98 | { |
Glenn Kasten | 09acf78 | 2016-06-17 10:28:05 -0700 | [diff] [blame] | 99 | // actual upper bound on frameCount will depend on the frame size |
Glenn Kasten | 9ddeb2c | 2016-10-14 08:49:02 -0700 | [diff] [blame] | 100 | LOG_ALWAYS_FATAL_IF(frameCount == 0 || frameCount > ((uint32_t) INT32_MAX)); |
Glenn Kasten | 9b4c805 | 2015-01-06 14:13:13 -0800 | [diff] [blame] | 101 | } |
| 102 | |
Glenn Kasten | 09acf78 | 2016-06-17 10:28:05 -0700 | [diff] [blame] | 103 | audio_utils_fifo_base::~audio_utils_fifo_base() |
Glenn Kasten | 9b4c805 | 2015-01-06 14:13:13 -0800 | [diff] [blame] | 104 | { |
| 105 | } |
| 106 | |
Glenn Kasten | 3f115ba | 2016-11-22 14:00:53 -0800 | [diff] [blame] | 107 | uint32_t audio_utils_fifo_base::sum(uint32_t index, uint32_t increment) const |
Glenn Kasten | 9b4fe47 | 2016-06-13 09:34:57 -0700 | [diff] [blame] | 108 | __attribute__((no_sanitize("integer"))) |
Glenn Kasten | 9b4c805 | 2015-01-06 14:13:13 -0800 | [diff] [blame] | 109 | { |
Glenn Kasten | 9b4fe47 | 2016-06-13 09:34:57 -0700 | [diff] [blame] | 110 | if (mFudgeFactor) { |
| 111 | uint32_t mask = mFrameCountP2 - 1; |
| 112 | ALOG_ASSERT((index & mask) < mFrameCount); |
| 113 | ALOG_ASSERT(increment <= mFrameCountP2); |
| 114 | if ((index & mask) + increment >= mFrameCount) { |
| 115 | increment += mFudgeFactor; |
Glenn Kasten | 9b4c805 | 2015-01-06 14:13:13 -0800 | [diff] [blame] | 116 | } |
| 117 | index += increment; |
Glenn Kasten | 9b4fe47 | 2016-06-13 09:34:57 -0700 | [diff] [blame] | 118 | ALOG_ASSERT((index & mask) < mFrameCount); |
Glenn Kasten | 9b4c805 | 2015-01-06 14:13:13 -0800 | [diff] [blame] | 119 | return index; |
| 120 | } else { |
| 121 | return index + increment; |
| 122 | } |
| 123 | } |
| 124 | |
Glenn Kasten | 3f115ba | 2016-11-22 14:00:53 -0800 | [diff] [blame] | 125 | int32_t audio_utils_fifo_base::diff(uint32_t rear, uint32_t front, size_t *lost) const |
Glenn Kasten | 9b4fe47 | 2016-06-13 09:34:57 -0700 | [diff] [blame] | 126 | __attribute__((no_sanitize("integer"))) |
Glenn Kasten | 9b4c805 | 2015-01-06 14:13:13 -0800 | [diff] [blame] | 127 | { |
Glenn Kasten | 44001d4 | 2016-10-19 15:46:02 -0700 | [diff] [blame] | 128 | // TODO replace multiple returns by a single return point so this isn't needed |
| 129 | if (lost != NULL) { |
| 130 | *lost = 0; |
| 131 | } |
Glenn Kasten | 0b2947b | 2016-11-22 14:00:23 -0800 | [diff] [blame^] | 132 | if (mIsShutdown) { |
| 133 | return -EIO; |
| 134 | } |
Glenn Kasten | 9b4fe47 | 2016-06-13 09:34:57 -0700 | [diff] [blame] | 135 | uint32_t diff = rear - front; |
| 136 | if (mFudgeFactor) { |
| 137 | uint32_t mask = mFrameCountP2 - 1; |
Glenn Kasten | 9ddeb2c | 2016-10-14 08:49:02 -0700 | [diff] [blame] | 138 | uint32_t rearOffset = rear & mask; |
| 139 | uint32_t frontOffset = front & mask; |
| 140 | if (rearOffset >= mFrameCount || frontOffset >= mFrameCount) { |
Glenn Kasten | 0b2947b | 2016-11-22 14:00:23 -0800 | [diff] [blame^] | 141 | ALOGE("%s frontOffset=%u rearOffset=%u mFrameCount=%u", |
| 142 | __func__, frontOffset, rearOffset, mFrameCount); |
| 143 | shutdown(); |
Glenn Kasten | 6d7ad76 | 2016-06-15 17:05:54 -0700 | [diff] [blame] | 144 | return -EIO; |
Glenn Kasten | 9b4fe47 | 2016-06-13 09:34:57 -0700 | [diff] [blame] | 145 | } |
| 146 | uint32_t genDiff = (rear & ~mask) - (front & ~mask); |
Glenn Kasten | 9b4c805 | 2015-01-06 14:13:13 -0800 | [diff] [blame] | 147 | if (genDiff != 0) { |
Glenn Kasten | 9b4fe47 | 2016-06-13 09:34:57 -0700 | [diff] [blame] | 148 | if (genDiff > mFrameCountP2) { |
Glenn Kasten | 6d7ad76 | 2016-06-15 17:05:54 -0700 | [diff] [blame] | 149 | if (lost != NULL) { |
| 150 | // TODO provide a more accurate estimate |
| 151 | *lost = (genDiff / mFrameCountP2) * mFrameCount; |
| 152 | } |
| 153 | return -EOVERFLOW; |
Glenn Kasten | 9b4fe47 | 2016-06-13 09:34:57 -0700 | [diff] [blame] | 154 | } |
| 155 | diff -= mFudgeFactor; |
Glenn Kasten | 9b4c805 | 2015-01-06 14:13:13 -0800 | [diff] [blame] | 156 | } |
| 157 | } |
| 158 | // FIFO should not be overfull |
Glenn Kasten | 9b4fe47 | 2016-06-13 09:34:57 -0700 | [diff] [blame] | 159 | if (diff > mFrameCount) { |
Glenn Kasten | 6d7ad76 | 2016-06-15 17:05:54 -0700 | [diff] [blame] | 160 | if (lost != NULL) { |
Glenn Kasten | 44001d4 | 2016-10-19 15:46:02 -0700 | [diff] [blame] | 161 | *lost = diff; |
Glenn Kasten | 6d7ad76 | 2016-06-15 17:05:54 -0700 | [diff] [blame] | 162 | } |
| 163 | return -EOVERFLOW; |
Glenn Kasten | 9b4fe47 | 2016-06-13 09:34:57 -0700 | [diff] [blame] | 164 | } |
| 165 | return (int32_t) diff; |
Glenn Kasten | 9b4c805 | 2015-01-06 14:13:13 -0800 | [diff] [blame] | 166 | } |
| 167 | |
Glenn Kasten | 0b2947b | 2016-11-22 14:00:23 -0800 | [diff] [blame^] | 168 | void audio_utils_fifo_base::shutdown() const |
| 169 | { |
| 170 | ALOGE("%s", __func__); |
| 171 | mIsShutdown = true; |
| 172 | } |
| 173 | |
Glenn Kasten | 6d7ad76 | 2016-06-15 17:05:54 -0700 | [diff] [blame] | 174 | //////////////////////////////////////////////////////////////////////////////// |
| 175 | |
Glenn Kasten | dc1ff1f | 2016-09-02 13:54:59 -0700 | [diff] [blame] | 176 | audio_utils_fifo::audio_utils_fifo(uint32_t frameCount, uint32_t frameSize, void *buffer, |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 177 | audio_utils_fifo_index& writerRear, audio_utils_fifo_index *throttleFront) |
Glenn Kasten | 09acf78 | 2016-06-17 10:28:05 -0700 | [diff] [blame] | 178 | __attribute__((no_sanitize("integer"))) : |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 179 | audio_utils_fifo_base(frameCount, writerRear, throttleFront), |
Glenn Kasten | dc1ff1f | 2016-09-02 13:54:59 -0700 | [diff] [blame] | 180 | mFrameSize(frameSize), mBuffer(buffer) |
Glenn Kasten | 09acf78 | 2016-06-17 10:28:05 -0700 | [diff] [blame] | 181 | { |
Glenn Kasten | 9ddeb2c | 2016-10-14 08:49:02 -0700 | [diff] [blame] | 182 | // maximum value of frameCount * frameSize is INT32_MAX (2^31 - 1), not 2^31, because we need to |
Glenn Kasten | 09acf78 | 2016-06-17 10:28:05 -0700 | [diff] [blame] | 183 | // be able to distinguish successful and error return values from read and write. |
Glenn Kasten | 0ab1d86 | 2016-06-20 12:04:56 -0700 | [diff] [blame] | 184 | LOG_ALWAYS_FATAL_IF(frameCount == 0 || frameSize == 0 || buffer == NULL || |
Glenn Kasten | 9ddeb2c | 2016-10-14 08:49:02 -0700 | [diff] [blame] | 185 | frameCount > ((uint32_t) INT32_MAX) / frameSize); |
Glenn Kasten | 09acf78 | 2016-06-17 10:28:05 -0700 | [diff] [blame] | 186 | } |
| 187 | |
Glenn Kasten | dc1ff1f | 2016-09-02 13:54:59 -0700 | [diff] [blame] | 188 | audio_utils_fifo::audio_utils_fifo(uint32_t frameCount, uint32_t frameSize, void *buffer, |
| 189 | bool throttlesWriter) : |
| 190 | audio_utils_fifo(frameCount, frameSize, buffer, mSingleProcessSharedRear, |
| 191 | throttlesWriter ? &mSingleProcessSharedFront : NULL) |
| 192 | { |
| 193 | } |
| 194 | |
Glenn Kasten | 09acf78 | 2016-06-17 10:28:05 -0700 | [diff] [blame] | 195 | audio_utils_fifo::~audio_utils_fifo() |
| 196 | { |
| 197 | } |
| 198 | |
| 199 | //////////////////////////////////////////////////////////////////////////////// |
| 200 | |
Glenn Kasten | 0f85039 | 2016-10-19 12:14:46 -0700 | [diff] [blame] | 201 | audio_utils_fifo_provider::audio_utils_fifo_provider(audio_utils_fifo& fifo) : |
| 202 | mFifo(fifo), mObtained(0), mTotalReleased(0) |
Glenn Kasten | 6d7ad76 | 2016-06-15 17:05:54 -0700 | [diff] [blame] | 203 | { |
| 204 | } |
| 205 | |
| 206 | audio_utils_fifo_provider::~audio_utils_fifo_provider() |
| 207 | { |
| 208 | } |
| 209 | |
| 210 | //////////////////////////////////////////////////////////////////////////////// |
| 211 | |
| 212 | audio_utils_fifo_writer::audio_utils_fifo_writer(audio_utils_fifo& fifo) : |
Glenn Kasten | 0f85039 | 2016-10-19 12:14:46 -0700 | [diff] [blame] | 213 | audio_utils_fifo_provider(fifo), mLocalRear(0), |
Glenn Kasten | b9652ab | 2016-11-18 13:34:01 -0800 | [diff] [blame] | 214 | mArmLevel(fifo.mFrameCount), mTriggerLevel(0), |
| 215 | mIsArmed(true), // because initial fill level of zero is < mArmLevel |
Glenn Kasten | 3ddacbb | 2016-06-20 14:41:03 -0700 | [diff] [blame] | 216 | mEffectiveFrames(fifo.mFrameCount) |
Glenn Kasten | 6d7ad76 | 2016-06-15 17:05:54 -0700 | [diff] [blame] | 217 | { |
| 218 | } |
| 219 | |
| 220 | audio_utils_fifo_writer::~audio_utils_fifo_writer() |
| 221 | { |
| 222 | } |
| 223 | |
Glenn Kasten | d9942f7 | 2016-10-16 14:51:15 -0700 | [diff] [blame] | 224 | ssize_t audio_utils_fifo_writer::write(const void *buffer, size_t count, |
| 225 | const struct timespec *timeout) |
Glenn Kasten | 9b4fe47 | 2016-06-13 09:34:57 -0700 | [diff] [blame] | 226 | __attribute__((no_sanitize("integer"))) |
Glenn Kasten | 9b4c805 | 2015-01-06 14:13:13 -0800 | [diff] [blame] | 227 | { |
Glenn Kasten | 547a992 | 2016-06-15 13:07:31 -0700 | [diff] [blame] | 228 | audio_utils_iovec iovec[2]; |
Glenn Kasten | 3ddacbb | 2016-06-20 14:41:03 -0700 | [diff] [blame] | 229 | ssize_t availToWrite = obtain(iovec, count, timeout); |
Glenn Kasten | 547a992 | 2016-06-15 13:07:31 -0700 | [diff] [blame] | 230 | if (availToWrite > 0) { |
Glenn Kasten | 169f3a2 | 2016-06-17 10:43:34 -0700 | [diff] [blame] | 231 | memcpy((char *) mFifo.mBuffer + iovec[0].mOffset * mFifo.mFrameSize, buffer, |
| 232 | iovec[0].mLength * mFifo.mFrameSize); |
| 233 | if (iovec[1].mLength > 0) { |
| 234 | memcpy((char *) mFifo.mBuffer + iovec[1].mOffset * mFifo.mFrameSize, |
| 235 | (char *) buffer + (iovec[0].mLength * mFifo.mFrameSize), |
| 236 | iovec[1].mLength * mFifo.mFrameSize); |
Glenn Kasten | 547a992 | 2016-06-15 13:07:31 -0700 | [diff] [blame] | 237 | } |
Glenn Kasten | 6d7ad76 | 2016-06-15 17:05:54 -0700 | [diff] [blame] | 238 | release(availToWrite); |
Glenn Kasten | 547a992 | 2016-06-15 13:07:31 -0700 | [diff] [blame] | 239 | } |
| 240 | return availToWrite; |
| 241 | } |
| 242 | |
Glenn Kasten | 9ddeb2c | 2016-10-14 08:49:02 -0700 | [diff] [blame] | 243 | // iovec == NULL is not part of the public API, but internally it means don't set mObtained |
Glenn Kasten | 3ddacbb | 2016-06-20 14:41:03 -0700 | [diff] [blame] | 244 | ssize_t audio_utils_fifo_writer::obtain(audio_utils_iovec iovec[2], size_t count, |
Glenn Kasten | d9942f7 | 2016-10-16 14:51:15 -0700 | [diff] [blame] | 245 | const struct timespec *timeout) |
Glenn Kasten | 547a992 | 2016-06-15 13:07:31 -0700 | [diff] [blame] | 246 | __attribute__((no_sanitize("integer"))) |
| 247 | { |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 248 | int err = 0; |
Glenn Kasten | 6d7ad76 | 2016-06-15 17:05:54 -0700 | [diff] [blame] | 249 | size_t availToWrite; |
| 250 | if (mFifo.mThrottleFront != NULL) { |
Glenn Kasten | f277a7c | 2016-10-14 08:51:20 -0700 | [diff] [blame] | 251 | int retries = kRetries; |
Glenn Kasten | 3ddacbb | 2016-06-20 14:41:03 -0700 | [diff] [blame] | 252 | uint32_t front; |
| 253 | for (;;) { |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 254 | front = atomic_load_explicit(&mFifo.mThrottleFront->mIndex, std::memory_order_acquire); |
Glenn Kasten | 0b2947b | 2016-11-22 14:00:23 -0800 | [diff] [blame^] | 255 | // returns -EIO if mIsShutdown |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 256 | int32_t filled = mFifo.diff(mLocalRear, front); |
Glenn Kasten | 3ddacbb | 2016-06-20 14:41:03 -0700 | [diff] [blame] | 257 | if (filled < 0) { |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 258 | // on error, return an empty slice |
Glenn Kasten | 9ddeb2c | 2016-10-14 08:49:02 -0700 | [diff] [blame] | 259 | err = filled; |
| 260 | availToWrite = 0; |
| 261 | break; |
Glenn Kasten | 3ddacbb | 2016-06-20 14:41:03 -0700 | [diff] [blame] | 262 | } |
| 263 | availToWrite = mEffectiveFrames > (uint32_t) filled ? |
| 264 | mEffectiveFrames - (uint32_t) filled : 0; |
| 265 | // TODO pull out "count == 0" |
| 266 | if (count == 0 || availToWrite > 0 || timeout == NULL || |
| 267 | (timeout->tv_sec == 0 && timeout->tv_nsec == 0)) { |
| 268 | break; |
| 269 | } |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 270 | // TODO add comments |
| 271 | // TODO abstract out switch and replace by general sync object |
Glenn Kasten | 9ddeb2c | 2016-10-14 08:49:02 -0700 | [diff] [blame] | 272 | // the high level code (synchronization, sleep, futex, iovec) should be completely |
| 273 | // separate from the low level code (indexes, available, masking). |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 274 | int op = FUTEX_WAIT; |
| 275 | switch (mFifo.mThrottleFrontSync) { |
| 276 | case AUDIO_UTILS_FIFO_SYNC_SLEEP: |
| 277 | err = clock_nanosleep(CLOCK_MONOTONIC, 0 /*flags*/, timeout, NULL /*remain*/); |
| 278 | if (err < 0) { |
| 279 | LOG_ALWAYS_FATAL_IF(errno != EINTR, "unexpected err=%d errno=%d", err, errno); |
| 280 | err = -errno; |
| 281 | } else { |
| 282 | err = -ETIMEDOUT; |
Glenn Kasten | 3ddacbb | 2016-06-20 14:41:03 -0700 | [diff] [blame] | 283 | } |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 284 | break; |
| 285 | case AUDIO_UTILS_FIFO_SYNC_PRIVATE: |
| 286 | op = FUTEX_WAIT_PRIVATE; |
| 287 | // fall through |
| 288 | case AUDIO_UTILS_FIFO_SYNC_SHARED: |
| 289 | if (timeout->tv_sec == LONG_MAX) { |
| 290 | timeout = NULL; |
| 291 | } |
| 292 | err = sys_futex(&mFifo.mThrottleFront->mIndex, op, front, timeout, NULL, 0); |
| 293 | if (err < 0) { |
| 294 | switch (errno) { |
Glenn Kasten | f277a7c | 2016-10-14 08:51:20 -0700 | [diff] [blame] | 295 | case EWOULDBLOCK: |
Glenn Kasten | 7cabff9 | 2016-10-19 11:13:55 -0700 | [diff] [blame] | 296 | // Benign race condition with partner: mFifo.mThrottleFront->mIndex |
| 297 | // changed value between the earlier atomic_load_explicit() and sys_futex(). |
| 298 | // Try to load index again, but give up if we are unable to converge. |
Glenn Kasten | f277a7c | 2016-10-14 08:51:20 -0700 | [diff] [blame] | 299 | if (retries-- > 0) { |
| 300 | // bypass the "timeout = NULL;" below |
| 301 | continue; |
| 302 | } |
| 303 | // fall through |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 304 | case EINTR: |
| 305 | case ETIMEDOUT: |
| 306 | err = -errno; |
| 307 | break; |
| 308 | default: |
| 309 | LOG_ALWAYS_FATAL("unexpected err=%d errno=%d", err, errno); |
| 310 | break; |
| 311 | } |
| 312 | } |
| 313 | break; |
| 314 | default: |
| 315 | LOG_ALWAYS_FATAL("mFifo.mThrottleFrontSync=%d", mFifo.mThrottleFrontSync); |
| 316 | break; |
Glenn Kasten | 3ddacbb | 2016-06-20 14:41:03 -0700 | [diff] [blame] | 317 | } |
| 318 | timeout = NULL; |
Glenn Kasten | 6d7ad76 | 2016-06-15 17:05:54 -0700 | [diff] [blame] | 319 | } |
Glenn Kasten | 6d7ad76 | 2016-06-15 17:05:54 -0700 | [diff] [blame] | 320 | } else { |
Glenn Kasten | 0b2947b | 2016-11-22 14:00:23 -0800 | [diff] [blame^] | 321 | if (mFifo.mIsShutdown) { |
| 322 | err = -EIO; |
| 323 | availToWrite = 0; |
| 324 | } else { |
| 325 | availToWrite = mEffectiveFrames; |
| 326 | } |
Glenn Kasten | 9b4fe47 | 2016-06-13 09:34:57 -0700 | [diff] [blame] | 327 | } |
Glenn Kasten | 9b4c805 | 2015-01-06 14:13:13 -0800 | [diff] [blame] | 328 | if (availToWrite > count) { |
| 329 | availToWrite = count; |
| 330 | } |
Glenn Kasten | 9ddeb2c | 2016-10-14 08:49:02 -0700 | [diff] [blame] | 331 | uint32_t rearOffset = mLocalRear & (mFifo.mFrameCountP2 - 1); |
| 332 | size_t part1 = mFifo.mFrameCount - rearOffset; |
Glenn Kasten | 9b4c805 | 2015-01-06 14:13:13 -0800 | [diff] [blame] | 333 | if (part1 > availToWrite) { |
| 334 | part1 = availToWrite; |
| 335 | } |
Glenn Kasten | 547a992 | 2016-06-15 13:07:31 -0700 | [diff] [blame] | 336 | size_t part2 = part1 > 0 ? availToWrite - part1 : 0; |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 337 | // return slice |
| 338 | if (iovec != NULL) { |
Glenn Kasten | 9ddeb2c | 2016-10-14 08:49:02 -0700 | [diff] [blame] | 339 | iovec[0].mOffset = rearOffset; |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 340 | iovec[0].mLength = part1; |
| 341 | iovec[1].mOffset = 0; |
| 342 | iovec[1].mLength = part2; |
| 343 | mObtained = availToWrite; |
| 344 | } |
| 345 | return availToWrite > 0 ? availToWrite : err; |
Glenn Kasten | 9b4c805 | 2015-01-06 14:13:13 -0800 | [diff] [blame] | 346 | } |
| 347 | |
Glenn Kasten | 6d7ad76 | 2016-06-15 17:05:54 -0700 | [diff] [blame] | 348 | void audio_utils_fifo_writer::release(size_t count) |
| 349 | __attribute__((no_sanitize("integer"))) |
Glenn Kasten | 547a992 | 2016-06-15 13:07:31 -0700 | [diff] [blame] | 350 | { |
Glenn Kasten | 0b2947b | 2016-11-22 14:00:23 -0800 | [diff] [blame^] | 351 | // no need to do an early check for mIsShutdown, because the extra code executed is harmless |
Glenn Kasten | 547a992 | 2016-06-15 13:07:31 -0700 | [diff] [blame] | 352 | if (count > 0) { |
Glenn Kasten | 0b2947b | 2016-11-22 14:00:23 -0800 | [diff] [blame^] | 353 | if (count > mObtained) { |
| 354 | ALOGE("%s(count=%zu) > mObtained=%u", __func__, count, mObtained); |
| 355 | mFifo.shutdown(); |
| 356 | return; |
| 357 | } |
Glenn Kasten | 3ddacbb | 2016-06-20 14:41:03 -0700 | [diff] [blame] | 358 | if (mFifo.mThrottleFront != NULL) { |
Glenn Kasten | dc1ff1f | 2016-09-02 13:54:59 -0700 | [diff] [blame] | 359 | uint32_t front = atomic_load_explicit(&mFifo.mThrottleFront->mIndex, |
Glenn Kasten | 3ddacbb | 2016-06-20 14:41:03 -0700 | [diff] [blame] | 360 | std::memory_order_acquire); |
Glenn Kasten | 0b2947b | 2016-11-22 14:00:23 -0800 | [diff] [blame^] | 361 | // returns -EIO if mIsShutdown |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 362 | int32_t filled = mFifo.diff(mLocalRear, front); |
Glenn Kasten | 3ddacbb | 2016-06-20 14:41:03 -0700 | [diff] [blame] | 363 | mLocalRear = mFifo.sum(mLocalRear, count); |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 364 | atomic_store_explicit(&mFifo.mWriterRear.mIndex, mLocalRear, |
Glenn Kasten | 3ddacbb | 2016-06-20 14:41:03 -0700 | [diff] [blame] | 365 | std::memory_order_release); |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 366 | // TODO add comments |
| 367 | int op = FUTEX_WAKE; |
| 368 | switch (mFifo.mWriterRearSync) { |
| 369 | case AUDIO_UTILS_FIFO_SYNC_SLEEP: |
| 370 | break; |
| 371 | case AUDIO_UTILS_FIFO_SYNC_PRIVATE: |
| 372 | op = FUTEX_WAKE_PRIVATE; |
| 373 | // fall through |
| 374 | case AUDIO_UTILS_FIFO_SYNC_SHARED: |
| 375 | if (filled >= 0) { |
Glenn Kasten | b9652ab | 2016-11-18 13:34:01 -0800 | [diff] [blame] | 376 | if ((uint32_t) filled < mArmLevel) { |
| 377 | mIsArmed = true; |
Glenn Kasten | 3ddacbb | 2016-06-20 14:41:03 -0700 | [diff] [blame] | 378 | } |
Glenn Kasten | b9652ab | 2016-11-18 13:34:01 -0800 | [diff] [blame] | 379 | if (mIsArmed && filled + count > mTriggerLevel) { |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 380 | int err = sys_futex(&mFifo.mWriterRear.mIndex, |
Glenn Kasten | 9ddeb2c | 2016-10-14 08:49:02 -0700 | [diff] [blame] | 381 | op, INT32_MAX /*waiters*/, NULL, NULL, 0); |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 382 | // err is number of processes woken up |
| 383 | if (err < 0) { |
| 384 | LOG_ALWAYS_FATAL("%s: unexpected err=%d errno=%d", |
| 385 | __func__, err, errno); |
| 386 | } |
Glenn Kasten | b9652ab | 2016-11-18 13:34:01 -0800 | [diff] [blame] | 387 | mIsArmed = false; |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 388 | } |
Glenn Kasten | 3ddacbb | 2016-06-20 14:41:03 -0700 | [diff] [blame] | 389 | } |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 390 | break; |
| 391 | default: |
| 392 | LOG_ALWAYS_FATAL("mFifo.mWriterRearSync=%d", mFifo.mWriterRearSync); |
| 393 | break; |
Glenn Kasten | 3ddacbb | 2016-06-20 14:41:03 -0700 | [diff] [blame] | 394 | } |
| 395 | } else { |
| 396 | mLocalRear = mFifo.sum(mLocalRear, count); |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 397 | atomic_store_explicit(&mFifo.mWriterRear.mIndex, mLocalRear, |
Glenn Kasten | 3ddacbb | 2016-06-20 14:41:03 -0700 | [diff] [blame] | 398 | std::memory_order_release); |
| 399 | } |
Glenn Kasten | 6d7ad76 | 2016-06-15 17:05:54 -0700 | [diff] [blame] | 400 | mObtained -= count; |
Glenn Kasten | 0f85039 | 2016-10-19 12:14:46 -0700 | [diff] [blame] | 401 | mTotalReleased += count; |
Glenn Kasten | 547a992 | 2016-06-15 13:07:31 -0700 | [diff] [blame] | 402 | } |
| 403 | } |
| 404 | |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 405 | ssize_t audio_utils_fifo_writer::available() |
| 406 | { |
Glenn Kasten | 9ddeb2c | 2016-10-14 08:49:02 -0700 | [diff] [blame] | 407 | // iovec == NULL is not part of the public API, but internally it means don't set mObtained |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 408 | return obtain(NULL /*iovec*/, SIZE_MAX /*count*/, NULL /*timeout*/); |
| 409 | } |
| 410 | |
| 411 | void audio_utils_fifo_writer::resize(uint32_t frameCount) |
| 412 | { |
| 413 | // cap to range [0, mFifo.mFrameCount] |
| 414 | if (frameCount > mFifo.mFrameCount) { |
| 415 | frameCount = mFifo.mFrameCount; |
| 416 | } |
| 417 | // if we reduce the effective frame count, update hysteresis points to be within the new range |
| 418 | if (frameCount < mEffectiveFrames) { |
Glenn Kasten | b9652ab | 2016-11-18 13:34:01 -0800 | [diff] [blame] | 419 | if (mArmLevel > frameCount) { |
| 420 | mArmLevel = frameCount; |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 421 | } |
Glenn Kasten | b9652ab | 2016-11-18 13:34:01 -0800 | [diff] [blame] | 422 | if (mTriggerLevel > frameCount) { |
| 423 | mTriggerLevel = frameCount; |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 424 | } |
| 425 | } |
| 426 | mEffectiveFrames = frameCount; |
| 427 | } |
| 428 | |
Glenn Kasten | 9ddeb2c | 2016-10-14 08:49:02 -0700 | [diff] [blame] | 429 | uint32_t audio_utils_fifo_writer::size() const |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 430 | { |
| 431 | return mEffectiveFrames; |
| 432 | } |
| 433 | |
| 434 | void audio_utils_fifo_writer::setHysteresis(uint32_t lowLevelArm, uint32_t highLevelTrigger) |
| 435 | { |
| 436 | // cap to range [0, mEffectiveFrames] |
| 437 | if (lowLevelArm > mEffectiveFrames) { |
| 438 | lowLevelArm = mEffectiveFrames; |
| 439 | } |
| 440 | if (highLevelTrigger > mEffectiveFrames) { |
| 441 | highLevelTrigger = mEffectiveFrames; |
| 442 | } |
| 443 | // TODO this is overly conservative; it would be better to arm based on actual fill level |
Glenn Kasten | b9652ab | 2016-11-18 13:34:01 -0800 | [diff] [blame] | 444 | if (lowLevelArm > mArmLevel) { |
| 445 | mIsArmed = true; |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 446 | } |
Glenn Kasten | b9652ab | 2016-11-18 13:34:01 -0800 | [diff] [blame] | 447 | mArmLevel = lowLevelArm; |
| 448 | mTriggerLevel = highLevelTrigger; |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 449 | } |
| 450 | |
Glenn Kasten | b9652ab | 2016-11-18 13:34:01 -0800 | [diff] [blame] | 451 | void audio_utils_fifo_writer::getHysteresis(uint32_t *armLevel, uint32_t *triggerLevel) const |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 452 | { |
Glenn Kasten | b9652ab | 2016-11-18 13:34:01 -0800 | [diff] [blame] | 453 | *armLevel = mArmLevel; |
| 454 | *triggerLevel = mTriggerLevel; |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 455 | } |
| 456 | |
Glenn Kasten | 6d7ad76 | 2016-06-15 17:05:54 -0700 | [diff] [blame] | 457 | //////////////////////////////////////////////////////////////////////////////// |
| 458 | |
| 459 | audio_utils_fifo_reader::audio_utils_fifo_reader(audio_utils_fifo& fifo, bool throttlesWriter) : |
Glenn Kasten | 0f85039 | 2016-10-19 12:14:46 -0700 | [diff] [blame] | 460 | audio_utils_fifo_provider(fifo), mLocalFront(0), |
Glenn Kasten | dc1ff1f | 2016-09-02 13:54:59 -0700 | [diff] [blame] | 461 | mThrottleFront(throttlesWriter ? mFifo.mThrottleFront : NULL), |
Glenn Kasten | b9652ab | 2016-11-18 13:34:01 -0800 | [diff] [blame] | 462 | mArmLevel(-1), mTriggerLevel(mFifo.mFrameCount), |
| 463 | mIsArmed(true), // because initial fill level of zero is > mArmLevel |
Glenn Kasten | 0f85039 | 2016-10-19 12:14:46 -0700 | [diff] [blame] | 464 | mTotalLost(0), mTotalFlushed(0) |
Glenn Kasten | 6d7ad76 | 2016-06-15 17:05:54 -0700 | [diff] [blame] | 465 | { |
Glenn Kasten | 6d7ad76 | 2016-06-15 17:05:54 -0700 | [diff] [blame] | 466 | } |
| 467 | |
| 468 | audio_utils_fifo_reader::~audio_utils_fifo_reader() |
| 469 | { |
Glenn Kasten | 0ab1d86 | 2016-06-20 12:04:56 -0700 | [diff] [blame] | 470 | // TODO Need a way to pass throttle capability to the another reader, should one reader exit. |
Glenn Kasten | 6d7ad76 | 2016-06-15 17:05:54 -0700 | [diff] [blame] | 471 | } |
| 472 | |
Glenn Kasten | d9942f7 | 2016-10-16 14:51:15 -0700 | [diff] [blame] | 473 | ssize_t audio_utils_fifo_reader::read(void *buffer, size_t count, const struct timespec *timeout, |
Glenn Kasten | 3ddacbb | 2016-06-20 14:41:03 -0700 | [diff] [blame] | 474 | size_t *lost) |
Glenn Kasten | 9b4fe47 | 2016-06-13 09:34:57 -0700 | [diff] [blame] | 475 | __attribute__((no_sanitize("integer"))) |
Glenn Kasten | 9b4c805 | 2015-01-06 14:13:13 -0800 | [diff] [blame] | 476 | { |
Glenn Kasten | 547a992 | 2016-06-15 13:07:31 -0700 | [diff] [blame] | 477 | audio_utils_iovec iovec[2]; |
Glenn Kasten | 3ddacbb | 2016-06-20 14:41:03 -0700 | [diff] [blame] | 478 | ssize_t availToRead = obtain(iovec, count, timeout, lost); |
Glenn Kasten | 547a992 | 2016-06-15 13:07:31 -0700 | [diff] [blame] | 479 | if (availToRead > 0) { |
Glenn Kasten | 169f3a2 | 2016-06-17 10:43:34 -0700 | [diff] [blame] | 480 | memcpy(buffer, (char *) mFifo.mBuffer + iovec[0].mOffset * mFifo.mFrameSize, |
| 481 | iovec[0].mLength * mFifo.mFrameSize); |
| 482 | if (iovec[1].mLength > 0) { |
| 483 | memcpy((char *) buffer + (iovec[0].mLength * mFifo.mFrameSize), |
| 484 | (char *) mFifo.mBuffer + iovec[1].mOffset * mFifo.mFrameSize, |
| 485 | iovec[1].mLength * mFifo.mFrameSize); |
Glenn Kasten | 547a992 | 2016-06-15 13:07:31 -0700 | [diff] [blame] | 486 | } |
Glenn Kasten | 6d7ad76 | 2016-06-15 17:05:54 -0700 | [diff] [blame] | 487 | release(availToRead); |
Glenn Kasten | 547a992 | 2016-06-15 13:07:31 -0700 | [diff] [blame] | 488 | } |
| 489 | return availToRead; |
| 490 | } |
| 491 | |
Glenn Kasten | 3ddacbb | 2016-06-20 14:41:03 -0700 | [diff] [blame] | 492 | ssize_t audio_utils_fifo_reader::obtain(audio_utils_iovec iovec[2], size_t count, |
Glenn Kasten | d9942f7 | 2016-10-16 14:51:15 -0700 | [diff] [blame] | 493 | const struct timespec *timeout) |
Glenn Kasten | 547a992 | 2016-06-15 13:07:31 -0700 | [diff] [blame] | 494 | __attribute__((no_sanitize("integer"))) |
| 495 | { |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 496 | return obtain(iovec, count, timeout, NULL /*lost*/); |
Glenn Kasten | 6d7ad76 | 2016-06-15 17:05:54 -0700 | [diff] [blame] | 497 | } |
| 498 | |
| 499 | void audio_utils_fifo_reader::release(size_t count) |
| 500 | __attribute__((no_sanitize("integer"))) |
| 501 | { |
Glenn Kasten | 0b2947b | 2016-11-22 14:00:23 -0800 | [diff] [blame^] | 502 | // no need to do an early check for mIsShutdown, because the extra code executed is harmless |
Glenn Kasten | 6d7ad76 | 2016-06-15 17:05:54 -0700 | [diff] [blame] | 503 | if (count > 0) { |
Glenn Kasten | 0b2947b | 2016-11-22 14:00:23 -0800 | [diff] [blame^] | 504 | if (count > mObtained) { |
| 505 | ALOGE("%s(count=%zu) > mObtained=%u", __func__, count, mObtained); |
| 506 | mFifo.shutdown(); |
| 507 | return; |
| 508 | } |
Glenn Kasten | dc1ff1f | 2016-09-02 13:54:59 -0700 | [diff] [blame] | 509 | if (mThrottleFront != NULL) { |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 510 | uint32_t rear = atomic_load_explicit(&mFifo.mWriterRear.mIndex, |
Glenn Kasten | 3ddacbb | 2016-06-20 14:41:03 -0700 | [diff] [blame] | 511 | std::memory_order_acquire); |
Glenn Kasten | 0b2947b | 2016-11-22 14:00:23 -0800 | [diff] [blame^] | 512 | // returns -EIO if mIsShutdown |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 513 | int32_t filled = mFifo.diff(rear, mLocalFront); |
Glenn Kasten | 3ddacbb | 2016-06-20 14:41:03 -0700 | [diff] [blame] | 514 | mLocalFront = mFifo.sum(mLocalFront, count); |
Glenn Kasten | dc1ff1f | 2016-09-02 13:54:59 -0700 | [diff] [blame] | 515 | atomic_store_explicit(&mThrottleFront->mIndex, mLocalFront, |
Glenn Kasten | 6d7ad76 | 2016-06-15 17:05:54 -0700 | [diff] [blame] | 516 | std::memory_order_release); |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 517 | // TODO add comments |
| 518 | int op = FUTEX_WAKE; |
| 519 | switch (mFifo.mThrottleFrontSync) { |
| 520 | case AUDIO_UTILS_FIFO_SYNC_SLEEP: |
| 521 | break; |
| 522 | case AUDIO_UTILS_FIFO_SYNC_PRIVATE: |
| 523 | op = FUTEX_WAKE_PRIVATE; |
| 524 | // fall through |
| 525 | case AUDIO_UTILS_FIFO_SYNC_SHARED: |
| 526 | if (filled >= 0) { |
Glenn Kasten | b9652ab | 2016-11-18 13:34:01 -0800 | [diff] [blame] | 527 | if (filled > mArmLevel) { |
| 528 | mIsArmed = true; |
Glenn Kasten | 3ddacbb | 2016-06-20 14:41:03 -0700 | [diff] [blame] | 529 | } |
Glenn Kasten | b9652ab | 2016-11-18 13:34:01 -0800 | [diff] [blame] | 530 | if (mIsArmed && filled - count < mTriggerLevel) { |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 531 | int err = sys_futex(&mThrottleFront->mIndex, |
| 532 | op, 1 /*waiters*/, NULL, NULL, 0); |
| 533 | // err is number of processes woken up |
| 534 | if (err < 0 || err > 1) { |
| 535 | LOG_ALWAYS_FATAL("%s: unexpected err=%d errno=%d", |
| 536 | __func__, err, errno); |
| 537 | } |
Glenn Kasten | b9652ab | 2016-11-18 13:34:01 -0800 | [diff] [blame] | 538 | mIsArmed = false; |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 539 | } |
Glenn Kasten | 3ddacbb | 2016-06-20 14:41:03 -0700 | [diff] [blame] | 540 | } |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 541 | break; |
| 542 | default: |
| 543 | LOG_ALWAYS_FATAL("mFifo.mThrottleFrontSync=%d", mFifo.mThrottleFrontSync); |
| 544 | break; |
Glenn Kasten | 3ddacbb | 2016-06-20 14:41:03 -0700 | [diff] [blame] | 545 | } |
| 546 | } else { |
| 547 | mLocalFront = mFifo.sum(mLocalFront, count); |
Glenn Kasten | 6d7ad76 | 2016-06-15 17:05:54 -0700 | [diff] [blame] | 548 | } |
| 549 | mObtained -= count; |
Glenn Kasten | 0f85039 | 2016-10-19 12:14:46 -0700 | [diff] [blame] | 550 | mTotalReleased += count; |
Glenn Kasten | 6d7ad76 | 2016-06-15 17:05:54 -0700 | [diff] [blame] | 551 | } |
| 552 | } |
| 553 | |
Glenn Kasten | 9ddeb2c | 2016-10-14 08:49:02 -0700 | [diff] [blame] | 554 | // iovec == NULL is not part of the public API, but internally it means don't set mObtained |
Glenn Kasten | 3ddacbb | 2016-06-20 14:41:03 -0700 | [diff] [blame] | 555 | ssize_t audio_utils_fifo_reader::obtain(audio_utils_iovec iovec[2], size_t count, |
Glenn Kasten | d9942f7 | 2016-10-16 14:51:15 -0700 | [diff] [blame] | 556 | const struct timespec *timeout, size_t *lost) |
Glenn Kasten | 6d7ad76 | 2016-06-15 17:05:54 -0700 | [diff] [blame] | 557 | __attribute__((no_sanitize("integer"))) |
| 558 | { |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 559 | int err = 0; |
Glenn Kasten | f277a7c | 2016-10-14 08:51:20 -0700 | [diff] [blame] | 560 | int retries = kRetries; |
Glenn Kasten | 3ddacbb | 2016-06-20 14:41:03 -0700 | [diff] [blame] | 561 | uint32_t rear; |
| 562 | for (;;) { |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 563 | rear = atomic_load_explicit(&mFifo.mWriterRear.mIndex, |
Glenn Kasten | 3ddacbb | 2016-06-20 14:41:03 -0700 | [diff] [blame] | 564 | std::memory_order_acquire); |
| 565 | // TODO pull out "count == 0" |
| 566 | if (count == 0 || rear != mLocalFront || timeout == NULL || |
| 567 | (timeout->tv_sec == 0 && timeout->tv_nsec == 0)) { |
| 568 | break; |
| 569 | } |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 570 | // TODO add comments |
| 571 | int op = FUTEX_WAIT; |
| 572 | switch (mFifo.mWriterRearSync) { |
| 573 | case AUDIO_UTILS_FIFO_SYNC_SLEEP: |
| 574 | err = clock_nanosleep(CLOCK_MONOTONIC, 0 /*flags*/, timeout, NULL /*remain*/); |
| 575 | if (err < 0) { |
| 576 | LOG_ALWAYS_FATAL_IF(errno != EINTR, "unexpected err=%d errno=%d", err, errno); |
| 577 | err = -errno; |
| 578 | } else { |
| 579 | err = -ETIMEDOUT; |
Glenn Kasten | 3ddacbb | 2016-06-20 14:41:03 -0700 | [diff] [blame] | 580 | } |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 581 | break; |
| 582 | case AUDIO_UTILS_FIFO_SYNC_PRIVATE: |
| 583 | op = FUTEX_WAIT_PRIVATE; |
| 584 | // fall through |
| 585 | case AUDIO_UTILS_FIFO_SYNC_SHARED: |
| 586 | if (timeout->tv_sec == LONG_MAX) { |
| 587 | timeout = NULL; |
| 588 | } |
| 589 | err = sys_futex(&mFifo.mWriterRear.mIndex, op, rear, timeout, NULL, 0); |
| 590 | if (err < 0) { |
| 591 | switch (errno) { |
Glenn Kasten | f277a7c | 2016-10-14 08:51:20 -0700 | [diff] [blame] | 592 | case EWOULDBLOCK: |
Glenn Kasten | 7cabff9 | 2016-10-19 11:13:55 -0700 | [diff] [blame] | 593 | // Benign race condition with partner: mFifo.mWriterRear->mIndex |
| 594 | // changed value between the earlier atomic_load_explicit() and sys_futex(). |
| 595 | // Try to load index again, but give up if we are unable to converge. |
Glenn Kasten | f277a7c | 2016-10-14 08:51:20 -0700 | [diff] [blame] | 596 | if (retries-- > 0) { |
| 597 | // bypass the "timeout = NULL;" below |
| 598 | continue; |
| 599 | } |
| 600 | // fall through |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 601 | case EINTR: |
| 602 | case ETIMEDOUT: |
| 603 | err = -errno; |
| 604 | break; |
| 605 | default: |
| 606 | LOG_ALWAYS_FATAL("unexpected err=%d errno=%d", err, errno); |
| 607 | break; |
| 608 | } |
| 609 | } |
| 610 | break; |
| 611 | default: |
| 612 | LOG_ALWAYS_FATAL("mFifo.mWriterRearSync=%d", mFifo.mWriterRearSync); |
| 613 | break; |
Glenn Kasten | 3ddacbb | 2016-06-20 14:41:03 -0700 | [diff] [blame] | 614 | } |
| 615 | timeout = NULL; |
| 616 | } |
Glenn Kasten | 0f85039 | 2016-10-19 12:14:46 -0700 | [diff] [blame] | 617 | size_t ourLost; |
| 618 | if (lost == NULL) { |
| 619 | lost = &ourLost; |
| 620 | } |
Glenn Kasten | 0b2947b | 2016-11-22 14:00:23 -0800 | [diff] [blame^] | 621 | // returns -EIO if mIsShutdown |
Glenn Kasten | 6d7ad76 | 2016-06-15 17:05:54 -0700 | [diff] [blame] | 622 | int32_t filled = mFifo.diff(rear, mLocalFront, lost); |
Glenn Kasten | 0f85039 | 2016-10-19 12:14:46 -0700 | [diff] [blame] | 623 | mTotalLost += *lost; |
| 624 | mTotalReleased += *lost; |
Glenn Kasten | 9b4fe47 | 2016-06-13 09:34:57 -0700 | [diff] [blame] | 625 | if (filled < 0) { |
Glenn Kasten | 3ddacbb | 2016-06-20 14:41:03 -0700 | [diff] [blame] | 626 | if (filled == -EOVERFLOW) { |
Glenn Kasten | 6d7ad76 | 2016-06-15 17:05:54 -0700 | [diff] [blame] | 627 | mLocalFront = rear; |
| 628 | } |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 629 | // on error, return an empty slice |
Glenn Kasten | 9ddeb2c | 2016-10-14 08:49:02 -0700 | [diff] [blame] | 630 | err = filled; |
| 631 | filled = 0; |
Glenn Kasten | 9b4fe47 | 2016-06-13 09:34:57 -0700 | [diff] [blame] | 632 | } |
| 633 | size_t availToRead = (size_t) filled; |
Glenn Kasten | 9b4c805 | 2015-01-06 14:13:13 -0800 | [diff] [blame] | 634 | if (availToRead > count) { |
| 635 | availToRead = count; |
| 636 | } |
Glenn Kasten | 9ddeb2c | 2016-10-14 08:49:02 -0700 | [diff] [blame] | 637 | uint32_t frontOffset = mLocalFront & (mFifo.mFrameCountP2 - 1); |
| 638 | size_t part1 = mFifo.mFrameCount - frontOffset; |
Glenn Kasten | 9b4c805 | 2015-01-06 14:13:13 -0800 | [diff] [blame] | 639 | if (part1 > availToRead) { |
| 640 | part1 = availToRead; |
| 641 | } |
Glenn Kasten | 547a992 | 2016-06-15 13:07:31 -0700 | [diff] [blame] | 642 | size_t part2 = part1 > 0 ? availToRead - part1 : 0; |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 643 | // return slice |
| 644 | if (iovec != NULL) { |
Glenn Kasten | 9ddeb2c | 2016-10-14 08:49:02 -0700 | [diff] [blame] | 645 | iovec[0].mOffset = frontOffset; |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 646 | iovec[0].mLength = part1; |
| 647 | iovec[1].mOffset = 0; |
| 648 | iovec[1].mLength = part2; |
| 649 | mObtained = availToRead; |
| 650 | } |
| 651 | return availToRead > 0 ? availToRead : err; |
| 652 | } |
| 653 | |
| 654 | ssize_t audio_utils_fifo_reader::available() |
| 655 | { |
| 656 | return available(NULL /*lost*/); |
| 657 | } |
| 658 | |
| 659 | ssize_t audio_utils_fifo_reader::available(size_t *lost) |
| 660 | { |
Glenn Kasten | 9ddeb2c | 2016-10-14 08:49:02 -0700 | [diff] [blame] | 661 | // iovec == NULL is not part of the public API, but internally it means don't set mObtained |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 662 | return obtain(NULL /*iovec*/, SIZE_MAX /*count*/, NULL /*timeout*/, lost); |
| 663 | } |
| 664 | |
Glenn Kasten | 0f85039 | 2016-10-19 12:14:46 -0700 | [diff] [blame] | 665 | ssize_t audio_utils_fifo_reader::flush(size_t *lost) |
| 666 | { |
| 667 | audio_utils_iovec iovec[2]; |
| 668 | ssize_t ret = obtain(iovec, SIZE_MAX /*count*/, NULL /*timeout*/, lost); |
| 669 | if (ret > 0) { |
| 670 | size_t flushed = (size_t) ret; |
| 671 | release(flushed); |
| 672 | mTotalFlushed += flushed; |
| 673 | ret = flushed; |
| 674 | } |
| 675 | return ret; |
| 676 | } |
| 677 | |
Glenn Kasten | b9652ab | 2016-11-18 13:34:01 -0800 | [diff] [blame] | 678 | void audio_utils_fifo_reader::setHysteresis(int32_t armLevel, uint32_t triggerLevel) |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 679 | { |
| 680 | // cap to range [0, mFifo.mFrameCount] |
Glenn Kasten | b9652ab | 2016-11-18 13:34:01 -0800 | [diff] [blame] | 681 | if (armLevel < 0) { |
| 682 | armLevel = -1; |
| 683 | } else if ((uint32_t) armLevel > mFifo.mFrameCount) { |
| 684 | armLevel = mFifo.mFrameCount; |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 685 | } |
Glenn Kasten | b9652ab | 2016-11-18 13:34:01 -0800 | [diff] [blame] | 686 | if (triggerLevel > mFifo.mFrameCount) { |
| 687 | triggerLevel = mFifo.mFrameCount; |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 688 | } |
| 689 | // TODO this is overly conservative; it would be better to arm based on actual fill level |
Glenn Kasten | b9652ab | 2016-11-18 13:34:01 -0800 | [diff] [blame] | 690 | if (armLevel < mArmLevel) { |
| 691 | mIsArmed = true; |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 692 | } |
Glenn Kasten | b9652ab | 2016-11-18 13:34:01 -0800 | [diff] [blame] | 693 | mArmLevel = armLevel; |
| 694 | mTriggerLevel = triggerLevel; |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 695 | } |
| 696 | |
Glenn Kasten | b9652ab | 2016-11-18 13:34:01 -0800 | [diff] [blame] | 697 | void audio_utils_fifo_reader::getHysteresis(int32_t *armLevel, uint32_t *triggerLevel) const |
Glenn Kasten | c0924bc | 2016-10-02 13:00:19 -0700 | [diff] [blame] | 698 | { |
Glenn Kasten | b9652ab | 2016-11-18 13:34:01 -0800 | [diff] [blame] | 699 | *armLevel = mArmLevel; |
| 700 | *triggerLevel = mTriggerLevel; |
Glenn Kasten | 547a992 | 2016-06-15 13:07:31 -0700 | [diff] [blame] | 701 | } |