Lines Matching refs:fifo
22 #include <audio_utils/fifo.h>
27 void audio_utils_fifo_init(struct audio_utils_fifo *fifo, size_t frameCount, size_t frameSize,
31 ALOG_ASSERT(fifo != NULL && frameCount > 0 && frameSize > 0 && buffer != NULL);
32 fifo->mFrameCount = frameCount;
33 fifo->mFrameCountP2 = roundup(frameCount);
34 fifo->mFudgeFactor = fifo->mFrameCountP2 - fifo->mFrameCount;
35 fifo->mFrameSize = frameSize;
36 fifo->mBuffer = buffer;
37 fifo->mFront = 0;
38 fifo->mRear = 0;
41 void audio_utils_fifo_deinit(struct audio_utils_fifo *fifo __unused)
46 static inline int32_t audio_utils_fifo_sum(struct audio_utils_fifo *fifo, int32_t index,
49 if (fifo->mFudgeFactor) {
50 uint32_t mask = fifo->mFrameCountP2 - 1;
51 ALOG_ASSERT((index & mask) < fifo->mFrameCount);
52 ALOG_ASSERT(/*0 <= increment &&*/ increment <= fifo->mFrameCountP2);
53 if ((index & mask) + increment >= fifo->mFrameCount) {
54 increment += fifo->mFudgeFactor;
57 ALOG_ASSERT((index & mask) < fifo->mFrameCount);
65 static inline size_t audio_utils_fifo_diff(struct audio_utils_fifo *fifo, int32_t rear,
69 if (fifo->mFudgeFactor) {
70 uint32_t mask = ~(fifo->mFrameCountP2 - 1);
73 ALOG_ASSERT(genDiff == (int32_t) fifo->mFrameCountP2);
74 diff -= fifo->mFudgeFactor;
77 // FIFO should not be overfull
78 ALOG_ASSERT(0 <= diff && diff <= (int32_t) fifo->mFrameCount);
82 ssize_t audio_utils_fifo_write(struct audio_utils_fifo *fifo, const void *buffer, size_t count)
84 int32_t front = android_atomic_acquire_load(&fifo->mFront);
85 int32_t rear = fifo->mRear;
86 size_t availToWrite = fifo->mFrameCount - audio_utils_fifo_diff(fifo, rear, front);
90 rear &= fifo->mFrameCountP2 - 1;
91 size_t part1 = fifo->mFrameCount - rear;
96 memcpy((char *) fifo->mBuffer + (rear * fifo->mFrameSize), buffer,
97 part1 * fifo->mFrameSize);
100 memcpy(fifo->mBuffer, (char *) buffer + (part1 * fifo->mFrameSize),
101 part2 * fifo->mFrameSize);
103 android_atomic_release_store(audio_utils_fifo_sum(fifo, fifo->mRear, availToWrite),
104 &fifo->mRear);
109 ssize_t audio_utils_fifo_read(struct audio_utils_fifo *fifo, void *buffer, size_t count)
111 int32_t rear = android_atomic_acquire_load(&fifo->mRear);
112 int32_t front = fifo->mFront;
113 size_t availToRead = audio_utils_fifo_diff(fifo, rear, front);
117 front &= fifo->mFrameCountP2 - 1;
118 size_t part1 = fifo->mFrameCount - front;
123 memcpy(buffer, (char *) fifo->mBuffer + (front * fifo->mFrameSize),
124 part1 * fifo->mFrameSize);
127 memcpy((char *) buffer + (part1 * fifo->mFrameSize), fifo->mBuffer,
128 part2 * fifo->mFrameSize);
130 android_atomic_release_store(audio_utils_fifo_sum(fifo, fifo->mFront, availToRead),
131 &fifo->mFront);
