darray_impl.h

#pragma once
#include "gaia/config/config.h"
 
#include <cstddef>
#include <initializer_list>
#include <type_traits>
#include <utility>
 
#include "gaia/core/iterator.h"
#include "gaia/core/utility.h"
#include "gaia/mem/data_layout_policy.h"
#include "gaia/mem/mem_sani.h"
#include "gaia/mem/mem_utils.h"
 
namespace gaia {
  namespace cnt {
    namespace darr_detail {
      using difference_type = uint32_t;
      using size_type = uint32_t;
    } // namespace darr_detail
 
    template <typename T, typename Allocator = mem::DefaultAllocatorAdaptor>
    class darr {
    public:
      using value_type = T;
      using reference = T&;
      using const_reference = const T&;
      using pointer = T*;
      using const_pointer = const T*;
      using view_policy = mem::data_view_policy_aos<T>;
      using difference_type = darr_detail::difference_type;
      using size_type = darr_detail::size_type;
 
      using iterator = pointer;
      using const_iterator = const_pointer;
      using iterator_category = core::random_access_iterator_tag;
 
      static constexpr size_t value_size = sizeof(T);
 
    private:
      uint8_t* m_pData = nullptr;
      size_type m_cnt = size_type(0);
      size_type m_cap = size_type(0);
 
      void try_grow() {
        const auto cnt = size();
        const auto cap = capacity();
 
        // Unless we reached the capacity don't do anything
        if GAIA_LIKELY (cap != 0 && cnt < cap)
          return;
 
        // If no data is allocated go with at least 4 elements
        if GAIA_UNLIKELY (m_pData == nullptr) {
          m_pData = view_policy::template alloc<Allocator>(m_cap = 4);
          return;
        }
 
        // We increase the capacity in multiples of 1.5 which is about the golden ratio (1.618).
        // This effectively means we prefer more frequent allocations over memory fragmentation.
        m_cap = (cap * 3 + 1) / 2;
 
        auto* pDataOld = m_pData;
        m_pData = view_policy::template alloc<Allocator>(m_cap);
        GAIA_MEM_SANI_ADD_BLOCK(value_size, m_pData, m_cap, cnt);
        mem::move_elements<T, false>(m_pData, pDataOld, cnt, 0, m_cap, cap);
        view_policy::template free<Allocator>(pDataOld, cap, cnt);
      }
 
    public:
      darr() noexcept = default;
      darr(core::zero_t) noexcept {}
 
      darr(size_type count, const_reference value) {
        resize(count, value);
      }
 
      darr(size_type count) {
        resize(count);
      }
 
      template <typename InputIt>
      darr(InputIt first, InputIt last) {
        const auto count = (size_type)core::distance(first, last);
        resize(count);
 
        if constexpr (std::is_pointer_v<InputIt>) {
          for (size_type i = 0; i < count; ++i)
            operator[](i) = first[i];
        } else if constexpr (std::is_same_v<typename InputIt::iterator_category, core::random_access_iterator_tag>) {
          for (size_type i = 0; i < count; ++i)
            operator[](i) = *(first[i]);
        } else {
          size_type i = 0;
          for (auto it = first; it != last; ++it)
            operator[](++i) = *it;
        }
      }
 
      darr(std::initializer_list<T> il): darr(il.begin(), il.end()) {}
 
      darr(const darr& other): darr(other.begin(), other.end()) {}
 
      darr(darr&& other) noexcept: m_pData(other.m_pData), m_cnt(other.m_cnt), m_cap(other.m_cap) {
        other.m_pData = nullptr;
        other.m_cnt = size_type(0);
        other.m_cap = size_type(0);
      }
 
      darr& operator=(std::initializer_list<T> il) {
        *this = darr(il.begin(), il.end());
        return *this;
      }
 
      darr& operator=(const darr& other) {
        GAIA_ASSERT(core::addressof(other) != this);
 
        resize(other.size());
        mem::copy_elements<T, false>(
            m_pData, (const uint8_t*)other.m_pData, other.size(), 0, capacity(), other.capacity());
 
        return *this;
      }
 
      darr& operator=(darr&& other) noexcept {
        GAIA_ASSERT(core::addressof(other) != this);
 
        // Release previously allocated memory if there was anything
        view_policy::template free<Allocator>(m_pData, m_cap, m_cnt);
 
        m_pData = other.m_pData;
        m_cnt = other.m_cnt;
        m_cap = other.m_cap;
 
        other.m_pData = nullptr;
        other.m_cnt = size_type(0);
        other.m_cap = size_type(0);
 
        return *this;
      }
 
      ~darr() {
        view_policy::template free<Allocator>(m_pData, m_cap, m_cnt);
      }
 
      GAIA_CLANG_WARNING_PUSH()
      // Memory is aligned so we can silence this warning
      GAIA_CLANG_WARNING_DISABLE("-Wcast-align")
 
      GAIA_NODISCARD pointer data() noexcept {
        return reinterpret_cast<pointer>(m_pData);
      }
 
      GAIA_NODISCARD const_pointer data() const noexcept {
        return reinterpret_cast<const_pointer>(m_pData);
      }
 
      GAIA_NODISCARD decltype(auto) operator[](size_type pos) noexcept {
        GAIA_ASSERT(pos < size());
        return view_policy::set({(typename view_policy::TargetCastType)m_pData, capacity()}, pos);
      }
 
      GAIA_NODISCARD decltype(auto) operator[](size_type pos) const noexcept {
        GAIA_ASSERT(pos < size());
        return view_policy::get({(typename view_policy::TargetCastType)m_pData, capacity()}, pos);
      }
 
      GAIA_CLANG_WARNING_POP()
 
      
      void reserve(size_type cap) {
        if (cap <= m_cap)
          return;
 
        auto* pDataOld = m_pData;
        m_pData = view_policy::template alloc<Allocator>(cap);
        if (pDataOld != nullptr) {
          GAIA_MEM_SANI_ADD_BLOCK(value_size, m_pData, cap, m_cnt);
          mem::move_elements<T, false>(m_pData, pDataOld, m_cnt, 0, cap, m_cap);
          view_policy::template free<Allocator>(pDataOld, m_cap, m_cnt);
        }
 
        m_cap = cap;
      }
 
      void resize(size_type count) {
        if (count == m_cnt)
          return;
 
        // Fresh allocation
        if (m_pData == nullptr) {
          if (count > 0) {
            m_pData = view_policy::template alloc<Allocator>(count);
            GAIA_MEM_SANI_ADD_BLOCK(value_size, m_pData, count, count);
            core::call_ctor_n(m_pData, count);
            m_cap = count;
            m_cnt = count;
          }
          return;
        }
 
        // Resizing to a smaller size
        if (count < m_cnt) {
          // Destroy elements at the end
          core::call_dtor_n(&data()[count], m_cnt - count);
          GAIA_MEM_SANI_POP_N(value_size, m_pData, m_cap, m_cnt, m_cnt - count);
 
          m_cnt = count;
          return;
        }
 
        // Resizing to a bigger size but still within allocated capacity
        if (count <= m_cap) {
          // Construct new elements
          GAIA_MEM_SANI_PUSH_N(value_size, m_pData, m_cap, m_cnt, count - m_cnt);
          core::call_ctor_n(&data()[m_cnt], count - m_cnt);
 
          m_cnt = count;
          return;
        }
 
        auto* pDataOld = m_pData;
        m_pData = view_policy::template alloc<Allocator>(count);
        GAIA_MEM_SANI_ADD_BLOCK(value_size, m_pData, count, count);
        // Move old data to the new location
        mem::move_elements<T, false>(m_pData, pDataOld, m_cnt, 0, count, m_cap);
        // Default-construct new items
        core::call_ctor_n(&data()[m_cnt], count - m_cnt);
        // Release old memory
        view_policy::template free<Allocator>(pDataOld, m_cap, m_cnt);
 
        m_cap = count;
        m_cnt = count;
      }
 
      void resize(size_type count, const_reference value) {
        const auto oldCount = m_cnt;
        resize(count);
 
        if constexpr (std::is_copy_constructible_v<value_type>) {
          const value_type valueCopy = value;
          for (size_type i = oldCount; i < m_cnt; ++i)
            operator[](i) = valueCopy;
        } else {
          for (size_type i = oldCount; i < m_cnt; ++i)
            operator[](i) = value;
        }
      }
 
      void push_back(const T& arg) {
        try_grow();
 
        GAIA_MEM_SANI_PUSH(value_size, m_pData, m_cap, m_cnt);
        auto* ptr = &data()[m_cnt++];
        core::call_ctor(ptr, arg);
      }
 
      void push_back(T&& arg) {
        try_grow();
 
        GAIA_MEM_SANI_PUSH(value_size, m_pData, m_cap, m_cnt);
        auto* ptr = &data()[m_cnt++];
        core::call_ctor(ptr, GAIA_MOV(arg));
      }
 
      template <typename... Args>
      decltype(auto) emplace_back(Args&&... args) {
        try_grow();
 
        GAIA_MEM_SANI_PUSH(value_size, m_pData, m_cap, m_cnt);
        auto* ptr = &data()[m_cnt++];
        core::call_ctor(ptr, GAIA_FWD(args)...);
        return (reference)*ptr;
      }
 
      void pop_back() noexcept {
        GAIA_ASSERT(!empty());
 
        auto* ptr = &data()[m_cnt - 1];
        core::call_dtor(ptr);
        GAIA_MEM_SANI_POP(value_size, m_pData, m_cap, m_cnt);
 
        --m_cnt;
      }
 
      iterator insert(iterator pos, const T& arg) {
        GAIA_ASSERT(pos >= data());
        GAIA_ASSERT(empty() || (pos < iterator(data() + size())));
 
        const auto idxSrc = (size_type)core::distance(begin(), pos);
        try_grow();
        const auto idxDst = (size_type)core::distance(begin(), end()) + 1;
 
        GAIA_MEM_SANI_PUSH(value_size, m_pData, m_cap, m_cnt);
        mem::shift_elements_right<T, false>(m_pData, idxDst, idxSrc, m_cap);
        auto* ptr = &data()[m_cnt];
        core::call_ctor(ptr, arg);
 
        ++m_cnt;
 
        return iterator(&data()[idxSrc]);
      }
 
      iterator insert(iterator pos, T&& arg) {
        GAIA_ASSERT(pos >= data());
        GAIA_ASSERT(empty() || (pos < iterator(data() + size())));
 
        const auto idxSrc = (size_type)core::distance(begin(), pos);
        try_grow();
        const auto idxDst = (size_type)core::distance(begin(), end());
 
        GAIA_MEM_SANI_PUSH(value_size, m_pData, m_cap, m_cnt);
        mem::shift_elements_right<T, false>(m_pData, idxDst, idxSrc, m_cap);
        auto* ptr = &data()[idxSrc];
        core::call_ctor(ptr, GAIA_MOV(arg));
 
        ++m_cnt;
 
        return iterator(&data()[idxSrc]);
      }
 
      iterator erase(iterator pos) noexcept {
        GAIA_ASSERT(pos >= data());
        GAIA_ASSERT(empty() || (pos < iterator(data() + size())));
 
        if (empty())
          return end();
 
        const auto idxSrc = (size_type)core::distance(begin(), pos);
        const auto idxDst = (size_type)core::distance(begin(), end()) - 1;
 
        mem::shift_elements_left<T, false>(m_pData, idxDst, idxSrc, m_cap);
        // Destroy if it's the last element
        auto* ptr = &data()[m_cnt - 1];
        core::call_dtor(ptr);
        GAIA_MEM_SANI_POP(value_size, m_pData, m_cap, m_cnt);
 
        --m_cnt;
 
        return iterator(&data()[idxSrc]);
      }
 
      iterator erase(iterator first, iterator last) noexcept {
        GAIA_ASSERT(first >= data())
        GAIA_ASSERT(empty() || (first < iterator(data() + size())));
        GAIA_ASSERT(last > first);
        GAIA_ASSERT(last <= iterator(data() + size()));
 
        if (empty())
          return end();
 
        const auto idxSrc = (size_type)core::distance(begin(), first);
        const auto idxDst = size();
        const auto cnt = (size_type)(last - first);
 
        mem::shift_elements_left_fast<T, false>(m_pData, idxDst, idxSrc, cnt, m_cap);
        // Destroy if it's the last element
        auto* ptr = &data()[m_cnt - cnt];
        core::call_dtor_n(ptr, cnt);
        GAIA_MEM_SANI_POP_N(value_size, data(), m_cap, m_cnt, cnt);
 
        m_cnt -= cnt;
 
        return iterator(&data()[idxSrc]);
      }
 
      void clear() noexcept {
        resize(0);
      }
 
      void shrink_to_fit() {
        const auto cap = capacity();
        const auto cnt = size();
 
        if (cap == cnt)
          return;
 
        auto* pDataOld = m_pData;
        m_pData = view_policy::template alloc<Allocator>(m_cap = cnt);
        GAIA_MEM_SANI_ADD_BLOCK(value_size, m_pData, m_cap, m_cnt);
        mem::move_elements<T, false>(m_pData, pDataOld, cnt, 0);
        GAIA_MEM_SANI_DEL_BLOCK(value_size, pDataOld, cap, cnt);
        view_policy::template free<Allocator>(pDataOld);
      }
 
      template <typename Func>
      auto retain(Func&& func) {
        size_type erased = 0;
        size_type idxDst = 0;
        size_type idxSrc = 0;
 
        while (idxSrc < m_cnt) {
          if (func(operator[](idxSrc))) {
            if (idxDst < idxSrc) {
              mem::move_element<T, false>(m_pData, m_pData, idxDst, idxSrc, m_cap, m_cap);
              auto* ptr = &data()[idxSrc];
              core::call_dtor(ptr);
            }
            ++idxDst;
          } else {
            auto* ptr = &data()[idxSrc];
            core::call_dtor(ptr);
            ++erased;
          }
 
          ++idxSrc;
        }
 
        GAIA_MEM_SANI_POP_N(value_size, data(), m_cap, m_cnt, erased);
 
        m_cnt -= erased;
        return idxDst;
      }
 
      GAIA_NODISCARD size_type size() const noexcept {
        return m_cnt;
      }
 
      GAIA_NODISCARD bool empty() const noexcept {
        return size() == 0;
      }
 
      GAIA_NODISCARD size_type capacity() const noexcept {
        return m_cap;
      }
 
      GAIA_NODISCARD size_type max_size() const noexcept {
        return static_cast<size_type>(-1);
      }
 
      GAIA_NODISCARD decltype(auto) front() noexcept {
        GAIA_ASSERT(!empty());
        return (reference)*begin();
      }
 
      GAIA_NODISCARD decltype(auto) front() const noexcept {
        GAIA_ASSERT(!empty());
        return (const_reference)*begin();
      }
 
      GAIA_NODISCARD decltype(auto) back() noexcept {
        GAIA_ASSERT(!empty());
        return (reference)(operator[](m_cnt - 1));
      }
 
      GAIA_NODISCARD decltype(auto) back() const noexcept {
        GAIA_ASSERT(!empty());
        return (const_reference) operator[](m_cnt - 1);
      }
 
      GAIA_NODISCARD auto begin() noexcept {
        return iterator(data());
      }
 
      GAIA_NODISCARD auto begin() const noexcept {
        return cbegin();
      }
 
      GAIA_NODISCARD auto cbegin() const noexcept {
        return const_iterator(data());
      }
 
      GAIA_NODISCARD auto rbegin() noexcept {
        return iterator((pointer)&back());
      }
 
      GAIA_NODISCARD auto rbegin() const noexcept {
        return const_iterator((const_pointer)&back());
      }
 
      GAIA_NODISCARD auto crbegin() const noexcept {
        return const_iterator((const_pointer)&back());
      }
 
      GAIA_NODISCARD auto end() noexcept {
        return iterator(data() + size());
      }
 
      GAIA_NODISCARD auto end() const noexcept {
        return const_iterator(data() + size());
      }
 
      GAIA_NODISCARD auto cend() const noexcept {
        return const_iterator(data() + size());
      }
 
      GAIA_NODISCARD auto rend() noexcept {
        return iterator(data() - 1);
      }
 
      GAIA_NODISCARD auto rend() const noexcept {
        return const_iterator(data() - 1);
      }
 
      GAIA_NODISCARD auto crend() const noexcept {
        return const_iterator(data() - 1);
      }
 
      GAIA_NODISCARD bool operator==(const darr& other) const noexcept {
        if (m_cnt != other.m_cnt)
          return false;
        const size_type n = size();
        for (size_type i = 0; i < n; ++i)
          if (!(operator[](i) == other[i]))
            return false;
        return true;
      }
 
      GAIA_NODISCARD constexpr bool operator!=(const darr& other) const noexcept {
        return !operator==(other);
      }
    };
  } // namespace cnt
 
} // namespace gaia