/*
 * Copyright (C) 2017 The Android Open Source Project
 *
 * Licensed under the Apache License, Version 2.0 (the "License");
 * you may not use this file except in compliance with the License.
 * You may obtain a copy of the License at
 *
 *      http://www.apache.org/licenses/LICENSE-2.0
 *
 * Unless required by applicable law or agreed to in writing, software
 * distributed under the License is distributed on an "AS IS" BASIS,
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 * See the License for the specific language governing permissions and
 * limitations under the License.
 */

#include <atomic>
#include <stdlib.h>
#include <string.h>

// TODO templatize int32_t

#include <audio_utils/fifo_writer32.h>

static inline void memcpyWords(int32_t *dst, const int32_t *src, uint32_t count)
{
    switch (count) {
    case 0: break;
// TODO templatize here also, but first confirm no performance regression compared to current
#define _(n) \
    case n: { \
        struct s##n { int32_t a[n]; }; \
        *(struct s##n *)dst = *(const struct s##n *)src; \
        break; \
    }
    _(1) _(2) _(3) _(4) _(5) _(6) _(7) _(8) _(9) _(10) _(11) _(12) _(13) _(14) _(15) _(16)
#undef _
    default:
        memcpy(dst, src, count * sizeof(int32_t));
        break;
    }
}

audio_utils_fifo_writer32::audio_utils_fifo_writer32(audio_utils_fifo& fifo) :
    mLocalRear(0), mFrameCountP2(fifo.mFrameCountP2), mBuffer((int32_t *) fifo.mBuffer),
    mWriterRear(fifo.mWriterRear)
{
    if (fifo.mFrameSize != sizeof(int32_t) || fifo.mFudgeFactor != 0 ||
            ((size_t) mBuffer & ((sizeof(int32_t) - 1))) != 0) {
        abort();
    }
}

audio_utils_fifo_writer32::~audio_utils_fifo_writer32()
{
}

void audio_utils_fifo_writer32::write(const int32_t *buffer, uint32_t count)
        __attribute__((no_sanitize("integer")))     // mLocalRear += can wrap
{
    uint32_t availToWrite = mFrameCountP2;
    if (availToWrite > count) {
        availToWrite = count;
    }
    uint32_t rearOffset = mLocalRear & (mFrameCountP2 - 1);
    uint32_t part1 = mFrameCountP2 - rearOffset;
    if (part1 >  availToWrite) {
        part1 = availToWrite;
    }
    memcpyWords(&mBuffer[rearOffset], buffer, part1);
    // TODO apply this simplification to other copies of the code
    uint32_t part2 = availToWrite - part1;
    memcpyWords(&mBuffer[0], &buffer[part1], part2);
    mLocalRear += availToWrite;
}