11#ifndef DYNAMIXEL_DETAIL_HPP
12#define DYNAMIXEL_DETAIL_HPP
22namespace dynamixel::detail {
28void LiteralOutOfRange() noexcept;
31inline constexpr std::uint64_t kNotADigit = 99U;
34inline constexpr std::array<
char, 16> kLowerDigits{
'0',
'1',
'2',
'3',
'4',
'5',
'6',
'7',
35 '8',
'9',
'a',
'b',
'c',
'd',
'e',
'f'};
37inline constexpr std::array<char, 16> kUpperDigits{
'0',
'1',
'2',
'3',
'4',
'5',
'6',
'7',
38 '8',
'9',
'A',
'B',
'C',
'D',
'E',
'F'};
40inline constexpr std::array<char, 2> kHexMarks{
'x',
'X'};
42inline constexpr std::array<char, 2> kBinMarks{
'b',
'B'};
51consteval std::uint64_t LiteralDigit(
char c)
noexcept {
52 const auto*
const lower = std::find(kLowerDigits.begin(), kLowerDigits.end(), c);
53 if (lower != kLowerDigits.end()) {
54 return static_cast<std::uint64_t
>(lower - kLowerDigits.begin());
56 const auto*
const upper = std::find(kUpperDigits.begin(), kUpperDigits.end(), c);
57 if (upper != kUpperDigits.end()) {
58 return static_cast<std::uint64_t
>(upper - kUpperDigits.begin());
68consteval std::uint64_t LiteralPrefixBase(
char c)
noexcept {
69 if (std::find(kHexMarks.begin(), kHexMarks.end(), c) != kHexMarks.end()) {
72 if (std::find(kBinMarks.begin(), kBinMarks.end(), c) != kBinMarks.end()) {
85template <
char... Digits>
86consteval std::uint64_t RawLiteralValue(std::uint64_t maximum)
noexcept {
87 constexpr std::array<char,
sizeof...(Digits)> kText{Digits...};
88 std::uint64_t base = 10U;
89 std::size_t first = 0U;
90 if ((kText.size() > 1U) && (LiteralDigit(kText[0]) == 0U)) {
91 base = LiteralPrefixBase(kText[1]);
98 std::uint64_t value = 0U;
99 for (std::size_t i = first; i < kText.size(); ++i) {
100 const std::uint64_t digit = LiteralDigit(kText[i]);
101 if (digit == kNotADigit) {
105 if ((digit >= base) || (value > ((maximum - digit) / base))) {
108 value = (value * base) + digit;
115namespace dynamixel::inline literals {
125template <
char... Digits>
126consteval std::uint8_t
operator""_u8() noexcept {
127 return static_cast<std::uint8_t
>(
128 detail::RawLiteralValue<Digits...>(std::numeric_limits<std::uint8_t>::max()));
136template <
char... Digits>
137consteval std::uint16_t
operator""_u16() noexcept {
138 return static_cast<std::uint16_t
>(
139 detail::RawLiteralValue<Digits...>(std::numeric_limits<std::uint16_t>::max()));
148template <
char... Digits>
149consteval std::uint32_t
operator""_u32() noexcept {
150 return static_cast<std::uint32_t
>(
151 detail::RawLiteralValue<Digits...>(std::numeric_limits<std::uint32_t>::max()));
156namespace dynamixel::detail {
171template <
typename Port,
typename Sig>
172 requires std::is_class_v<Port> && std::is_function_v<Sig>
176template <
typename Port,
typename R,
typename... Args>
177 requires std::is_class_v<Port>
178struct ExactHook<Port, R(Args...) noexcept> {
180 static void Take(R (Port::*hook)(Args...) noexcept) noexcept;
182 static void Take(R (Port::*hook)(Args...) const noexcept) noexcept;
187concept ClassType = std::is_class_v<T>;
192inline constexpr bool kAlwaysFalse =
false;
196concept Enumeration = std::is_enum_v<E>;
202template <Enumeration E>
203[[nodiscard]]
constexpr std::underlying_type_t<E> ToUnderlying(E e)
noexcept {
204 return static_cast<std::underlying_type_t<E>
>(e);
211template <Enumeration E>
218template <Enumeration E>
219[[nodiscard]]
constexpr bool IsEnumerator(E e)
noexcept {
220 return static_cast<uint32_t
>(ToUnderlying(e)) <=
221 static_cast<uint32_t
>(ToUnderlying(EnumLast<E>::kValue));
231[[nodiscard]]
constexpr bool InRange(uint32_t value, uint32_t low, uint32_t high)
noexcept {
232 return (value >= low) && (value <= high);
240template <
typename Reg, u
int32_t Shift, u
int32_t W
idth>
241 requires std::unsigned_integral<Reg> && (Width > 0U) && (Width < 32U) &&
242 ((Shift + Width) <=
static_cast<uint32_t
>(std::numeric_limits<Reg>::digits))
245 static constexpr uint32_t kMax = (uint32_t{1} << Width) - 1U;
247 static constexpr Reg kMask =
static_cast<Reg>(kMax << Shift);
250 [[nodiscard]]
static constexpr Reg Insert(
Reg reg, uint32_t value)
noexcept {
251 return static_cast<Reg>((
static_cast<uint32_t
>(reg) & ~
static_cast<uint32_t
>(kMask)) |
252 ((value & kMax) << Shift));
255 [[nodiscard]]
static constexpr uint32_t Extract(
Reg reg)
noexcept {
256 return (
static_cast<uint32_t
>(reg) >> Shift) & kMax;
Reg
Family-neutral register names.
Definition dynamixel_tables.hpp:67