69 lines
1.1 KiB
C++
69 lines
1.1 KiB
C++
/*
|
|
* peripherals_utility.hpp
|
|
*
|
|
* Created on: Feb 24, 2021
|
|
* Author: erki
|
|
*/
|
|
|
|
#ifndef SKULLC_PERIPHERALS_UTILITY_HPP_
|
|
#define SKULLC_PERIPHERALS_UTILITY_HPP_
|
|
|
|
#include <cstdint>
|
|
#include <cstring>
|
|
#include <type_traits>
|
|
|
|
namespace Peripherals
|
|
{
|
|
|
|
template<typename T>
|
|
constexpr const T& clamp(const T& v, const T& lo, const T& hi)
|
|
{
|
|
if (v > hi)
|
|
return hi;
|
|
else if (v < lo)
|
|
return lo;
|
|
else
|
|
return v;
|
|
}
|
|
|
|
template<typename T, std::size_t N>
|
|
T byteToTypeBE(const std::uint8_t a[N])
|
|
{
|
|
T t(0);
|
|
|
|
for (std::size_t i = 0; i < N; i++)
|
|
{
|
|
t |= a[i] << (i * 8);
|
|
}
|
|
|
|
return t;
|
|
}
|
|
|
|
template<typename T, std::size_t N>
|
|
T byteToTypeLE(const std::uint8_t a[N])
|
|
{
|
|
T t(0);
|
|
|
|
for (std::size_t i = N; i >= 0; i--)
|
|
{
|
|
t |= a[i] << ((i - 1) * 8);
|
|
}
|
|
|
|
return t;
|
|
}
|
|
|
|
template<typename T>
|
|
constexpr T zeroInitialized()
|
|
{
|
|
static_assert(std::is_trivially_default_constructible<T>::value, "Struct is not trivially default constructible.");
|
|
|
|
T t;
|
|
std::memset(&t, 0, sizeof(T));
|
|
|
|
return t;
|
|
}
|
|
|
|
}// namespace Peripherals
|
|
|
|
#endif /* SKULLC_PERIPHERALS_UTILITY_HPP_ */
|