audio_hal: Move CircularBuffer to aml_amaudioutils IpcBuffer. [2/2]
PD#TV-25733
Problem:
To implement Roku low level audio capture feature,
need enhance IPC circular buffer functions.
Solution:
Move CircularBuffer to more generic IpcBuffer
API in aml_amaudioutils lib.
Verify:
Verified with Roku build on T5D.
Change-Id: Iafe1ae7cbcedcaf7e2832542fbd7c8b788a585fe
diff --git a/src/IpcBuffer/IpcBuffer.cpp b/src/IpcBuffer/IpcBuffer.cpp
new file mode 100644
index 0000000..2a23866
--- /dev/null
+++ b/src/IpcBuffer/IpcBuffer.cpp
@@ -0,0 +1,156 @@
+#include <algorithm> // for std::min
+#include <iostream>
+#include <cstring>
+
+#include <boost/interprocess/sync/scoped_lock.hpp>
+#include <boost/interprocess/managed_shared_memory.hpp>
+
+#include "audio_server_shmem.h"
+#include "IpcBuffer.h"
+#include "IpcBuffer_c.h"
+
+using namespace boost::interprocess;
+
+IpcBuffer::IpcBuffer(const char *name, size_t capacity)
+ : begin_index_(0)
+ , end_index_(0)
+ , size_(0)
+ , capacity_(capacity)
+ , name_(std::string(name))
+ , wr_position_(0)
+{
+ managed_shared_memory *segment = audio_server_shmem::getInstance();
+ void *shptr = segment->allocate(capacity);
+ handle_ = segment->get_handle_from_address(shptr);
+}
+
+IpcBuffer::~IpcBuffer()
+{
+ managed_shared_memory *segment = audio_server_shmem::getInstance();
+ uint8_t *base = static_cast<uint8_t *>(segment->get_address_from_handle(handle_));
+ segment->deallocate(base);
+}
+
+size_t IpcBuffer::write(const uint8_t *data, size_t bytes)
+{
+ if (bytes == 0) return 0;
+
+ uint8_t *ptr = static_cast<uint8_t *>(audio_server_shmem::getInstance()->get_address_from_handle(handle_));
+ size_t capacity = capacity_;
+ size_t bytes_to_write = std::min(bytes, capacity - size_);
+
+ if (bytes_to_write <= capacity - end_index_) {
+ memcpy(ptr + end_index_, data, bytes_to_write);
+ end_index_ += bytes_to_write;
+ if (end_index_ == capacity) end_index_ = 0;
+ } else {
+ size_t size_1 = capacity - end_index_;
+ memcpy(ptr + end_index_, data, size_1);
+ size_t size_2 = bytes_to_write - size_1;
+ memcpy(ptr, data + size_1, size_2);
+ end_index_ = size_2;
+ }
+
+ size_ += bytes_to_write;
+ return bytes_to_write;
+}
+
+size_t IpcBuffer::read(uint8_t *data, size_t bytes)
+{
+ if (bytes == 0) return 0;
+
+ uint8_t *ptr = static_cast<uint8_t *>(audio_server_shmem::getInstance()->get_address_from_handle(handle_));
+ size_t capacity = capacity_;
+ size_t bytes_to_read = std::min(bytes, size_);
+
+ if (bytes_to_read <= capacity - begin_index_) {
+ memcpy(data, ptr + begin_index_, bytes_to_read);
+ begin_index_ += bytes_to_read;
+ if (begin_index_ == capacity) begin_index_ = 0;
+ } else {
+ size_t size_1 = capacity - begin_index_;
+ memcpy(data, ptr + begin_index_, size_1);
+ size_t size_2 = bytes_to_read - size_1;
+ memcpy(data + size_1, ptr, size_2);
+ begin_index_ = size_2;
+ }
+
+ size_ -= bytes_to_read;
+ return bytes_to_read;
+}
+
+void IpcBuffer::write_nb(const uint8_t *data, size_t bytes)
+{
+ if (bytes == 0) return;
+
+ const uint8_t *ptr = data;
+ size_t len = bytes;
+ uint8_t *base = static_cast<uint8_t *>(audio_server_shmem::getInstance()->get_address_from_handle(handle_));
+
+ while (len > 0) {
+ size_t bytes_to_write = std::min(capacity_ - end_index_, len);
+ memcpy(base + end_index_, ptr, bytes_to_write);
+ ptr += bytes_to_write;
+ len -= bytes_to_write;
+ end_index_ += bytes_to_write;
+ if (end_index_ == capacity_) end_index_ = 0;
+ }
+
+ scoped_lock<interprocess_mutex> lock(wr_position_mutex_);
+
+ timespec ts;
+ clock_gettime(CLOCK_MONOTONIC_RAW, &ts);
+ wr_position_ += bytes;
+ wr_time_ = uint64_t(ts.tv_sec) * 1000000000 + uint64_t(ts.tv_nsec);
+}
+
+void IpcBuffer::get_write_position(uint64_t& time, uint64_t& position)
+{
+ scoped_lock<interprocess_mutex> lock(wr_position_mutex_);
+ time = wr_time_;
+ position = wr_position_;
+}
+
+uint8_t* IpcBuffer::start_ptr()
+{
+ return static_cast<uint8_t *>(audio_server_shmem::getInstance()->get_address_from_handle(handle_));
+}
+
+const char *IpcBuffer::name()
+{
+ return name_.c_str();
+}
+
+void IpcBuffer::reset()
+{
+ begin_index_ = end_index_ = size_ = wr_position_ = 0;
+}
+
+managed_shared_memory *audio_server_shmem::shm_;
+
+extern "C" {
+
+void *IpcBuffer_create(const char *name, size_t size)
+{
+ managed_shared_memory *shm = audio_server_shmem::getInstance();
+ IpcBuffer * cb = shm->find<IpcBuffer>(name).first;
+ if (cb) {
+ IpcBuffer_destroy(cb);
+ }
+ cb = shm->construct<IpcBuffer>(name)(name, size);
+ return cb;
+}
+
+void IpcBuffer_destroy(void *cb)
+{
+ managed_shared_memory *shm = audio_server_shmem::getInstance();
+ shm->destroy<IpcBuffer>(((IpcBuffer *)(cb))->name());
+}
+
+void IpcBuffer_write(void *cb, const unsigned char *buf, int size)
+{
+ ((IpcBuffer *)(cb))->write_nb(buf, size);
+}
+
+}
+