| 1 |
/* SPDX-License-Identifier: BSL-1.0 OR BSD-3-Clause */ |
| 2 |
|
| 3 |
#ifndef MPT_BASE_ALIGNED_ARRAY_HPP |
| 4 |
#define MPT_BASE_ALIGNED_ARRAY_HPP |
| 5 |
|
| 6 |
|
| 7 |
|
| 8 |
#include "mpt/base/bit.hpp" |
| 9 |
#include "mpt/base/namespace.hpp" |
| 10 |
|
| 11 |
#include <array> |
| 12 |
#include <memory> |
| 13 |
#include <new> |
| 14 |
|
| 15 |
#include <cassert> |
| 16 |
#include <cstddef> |
| 17 |
|
| 18 |
|
| 19 |
|
| 20 |
namespace mpt { |
| 21 |
inline namespace MPT_INLINE_NS { |
| 22 |
|
| 23 |
|
| 24 |
template <typename T, std::size_t count, std::align_val_t alignment> |
| 25 |
struct alignas(static_cast<std::size_t>(alignment)) aligned_array |
| 26 |
: std::array<T, count> { |
| 27 |
static_assert(static_cast<std::size_t>(alignment) >= alignof(T)); |
| 28 |
static_assert(((count * sizeof(T)) % static_cast<std::size_t>(alignment)) == 0); |
| 29 |
static_assert(sizeof(std::array<T, count>) == (sizeof(T) * count)); |
| 30 |
}; |
| 31 |
|
| 32 |
static_assert(sizeof(mpt::aligned_array<float, 4, std::align_val_t{sizeof(float) * 4}>) == sizeof(std::array<float, 4>)); |
| 33 |
|
| 34 |
|
| 35 |
|
| 36 |
template <std::size_t alignment_elements, std::size_t expected_elements, typename T, std::size_t N> |
| 37 |
T * align_elements(std::array<T, N> & a) { |
| 38 |
static_assert(mpt::has_single_bit(alignof(T))); |
| 39 |
static_assert(mpt::has_single_bit(sizeof(T))); |
| 40 |
static_assert(mpt::has_single_bit(alignment_elements)); |
| 41 |
static_assert((expected_elements + alignment_elements - 1) <= N); |
| 42 |
void * buf = a.data(); |
| 43 |
std::size_t size = N * sizeof(T); |
| 44 |
void * result = std::align(alignment_elements * sizeof(T), expected_elements * sizeof(T), buf, size); |
| 45 |
assert(result); |
| 46 |
return reinterpret_cast<T *>(result); |
| 47 |
} |
| 48 |
|
| 49 |
template <std::size_t alignment_elements, std::size_t expected_elements, typename T, std::size_t N> |
| 50 |
T * align_elements(T (&a)[N]) { |
| 51 |
static_assert(mpt::has_single_bit(alignof(T))); |
| 52 |
static_assert(mpt::has_single_bit(sizeof(T))); |
| 53 |
static_assert(mpt::has_single_bit(alignment_elements)); |
| 54 |
static_assert((expected_elements + alignment_elements - 1) <= N); |
| 55 |
void * buf = a; |
| 56 |
std::size_t size = N * sizeof(T); |
| 57 |
void * result = std::align(alignment_elements * sizeof(T), expected_elements * sizeof(T), buf, size); |
| 58 |
assert(result); |
| 59 |
return reinterpret_cast<T *>(result); |
| 60 |
} |
| 61 |
|
| 62 |
|
| 63 |
|
| 64 |
template <std::size_t alignment_bytes, std::size_t expected_elements, typename T, std::size_t N> |
| 65 |
T * align_bytes(std::array<T, N> & a) { |
| 66 |
static_assert(mpt::has_single_bit(alignof(T))); |
| 67 |
static_assert(mpt::has_single_bit(sizeof(T))); |
| 68 |
static_assert(mpt::has_single_bit(alignment_bytes)); |
| 69 |
static_assert((alignment_bytes % alignof(T)) == 0); |
| 70 |
static_assert(((expected_elements * sizeof(T)) + alignment_bytes - 1) <= (N * sizeof(T))); |
| 71 |
void * buf = a.data(); |
| 72 |
std::size_t size = N * sizeof(T); |
| 73 |
void * result = std::align(alignment_bytes, expected_elements * sizeof(T), buf, size); |
| 74 |
assert(result); |
| 75 |
return reinterpret_cast<T *>(result); |
| 76 |
} |
| 77 |
|
| 78 |
template <std::size_t alignment_bytes, std::size_t expected_elements, typename T, std::size_t N> |
| 79 |
T * align_bytes(T (&a)[N]) { |
| 80 |
static_assert(mpt::has_single_bit(alignof(T))); |
| 81 |
static_assert(mpt::has_single_bit(sizeof(T))); |
| 82 |
static_assert(mpt::has_single_bit(alignment_bytes)); |
| 83 |
static_assert((alignment_bytes % alignof(T)) == 0); |
| 84 |
static_assert(((expected_elements * sizeof(T)) + alignment_bytes - 1) <= (N * sizeof(T))); |
| 85 |
void * buf = a; |
| 86 |
std::size_t size = N * sizeof(T); |
| 87 |
void * result = std::align(alignment_bytes, expected_elements * sizeof(T), buf, size); |
| 88 |
assert(result); |
| 89 |
return reinterpret_cast<T *>(result); |
| 90 |
} |
| 91 |
|
| 92 |
|
| 93 |
|
| 94 |
} // namespace MPT_INLINE_NS |
| 95 |
} // namespace mpt |
| 96 |
|
| 97 |
|
| 98 |
|
| 99 |
#endif // MPT_BASE_ALIGNED_ARRAY_HPP |