1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
|
#pragma once
#include "compat/assert.hpp"
#include "compat/reverse-index-sequence.hpp"
#include <type_traits>
#include <bit>
#include <concepts>
#include <tuple>
namespace floormat::Pack {
template<std::unsigned_integral T, size_t CAPACITY, size_t LEFT>
struct output
{
static_assert(std::is_fundamental_v<T>);
static_assert(CAPACITY > 0);
static_assert(CAPACITY <= sizeof(T)*8);
static_assert(LEFT <= CAPACITY);
static constexpr size_t Capacity = CAPACITY, Left = LEFT;
T value{0};
};
template<std::unsigned_integral T, size_t LENGTH>
struct output_field
{
static_assert(LENGTH > 0);
static constexpr size_t Length = LENGTH;
T value;
};
template<typename T> struct is_output_field : std::bool_constant<false> {};
template<std::unsigned_integral T, size_t N> struct is_output_field<output_field<T, N>> : std::bool_constant<true> { static_assert(N > 0); };
template<std::unsigned_integral T, size_t Capacity, size_t Left, size_t I, size_t... Is, typename Tuple>
constexpr CORRADE_ALWAYS_INLINE T write_(const Tuple& tuple, output<T, Capacity, Left> st, std::index_sequence<I, Is...>)
{
static_assert(Capacity > 0);
static_assert(Left > 0);
static_assert(Capacity <= sizeof(T)*8);
static_assert(Left <= Capacity);
static_assert(is_output_field<std::decay_t<decltype(std::get<I>(tuple))>>{});
constexpr size_t N = std::tuple_element_t<I, Tuple>::Length;
static_assert(N <= Left);
T x = std::get<I>(tuple).value;
fm_assert((size_t)std::bit_width(x) <= N);
T value = T(T(st.value << N) | x);
return write_(tuple, output<T, Capacity, Left - N>{value}, std::index_sequence<Is...>{});
}
template<std::unsigned_integral T, size_t Capacity, size_t Left, typename Tuple>
constexpr CORRADE_ALWAYS_INLINE T write_(const Tuple&, output<T, Capacity, Left> st, std::index_sequence<>)
{
return st.value;
}
} // namespace floormat::Pack
namespace floormat {
template<std::unsigned_integral T, size_t... Sizes>
constexpr T pack_write(const std::tuple<Pack::output_field<T, Sizes>...>& tuple)
{
constexpr size_t nbits = sizeof(T)*8;
return Pack::write_(tuple, Pack::output<T, nbits, nbits>{T{0}}, make_reverse_index_sequence<sizeof...(Sizes)>{});
}
constexpr uint8_t pack_write(const std::tuple<>&) = delete;
} // namespace floormat
|
