|
| 1 | +#ifndef EZ_FIXPOINT_MAPRANGE_H |
| 2 | +#define EZ_FIXPOINT_MAPRANGE_H |
| 3 | + |
| 4 | +#include <cstdint> |
| 5 | + |
| 6 | +namespace { |
| 7 | + |
| 8 | +template <uint32_t Value> |
| 9 | +constexpr uint32_t max_shift() { |
| 10 | + static_assert((Value & 0xFF000000) == 0, "Not enough free leading bits"); |
| 11 | + if constexpr (((Value << 4) & 0x80000000) != 0) |
| 12 | + return 4; |
| 13 | + if constexpr (((Value << 5) & 0x80000000) != 0) |
| 14 | + return 5; |
| 15 | + if constexpr (((Value << 6) & 0x80000000) != 0) |
| 16 | + return 6; |
| 17 | + if constexpr (((Value << 7) & 0x80000000) != 0) |
| 18 | + return 7; |
| 19 | + if constexpr (((Value << 8) & 0x80000000) != 0) |
| 20 | + return 8; |
| 21 | + if constexpr (((Value << 9) & 0x80000000) != 0) |
| 22 | + return 9; |
| 23 | + if constexpr (((Value << 10) & 0x80000000) != 0) |
| 24 | + return 10; |
| 25 | + if constexpr (((Value << 11) & 0x80000000) != 0) |
| 26 | + return 11; |
| 27 | + if constexpr (((Value << 12) & 0x80000000) != 0) |
| 28 | + return 12; |
| 29 | + if constexpr (((Value << 13) & 0x80000000) != 0) |
| 30 | + return 13; |
| 31 | + if constexpr (((Value << 14) & 0x80000000) != 0) |
| 32 | + return 14; |
| 33 | + if constexpr (((Value << 15) & 0x80000000) != 0) |
| 34 | + return 15; |
| 35 | + if constexpr (((Value << 16) & 0x80000000) != 0) |
| 36 | + return 16; |
| 37 | + if constexpr (((Value << 17) & 0x80000000) != 0) |
| 38 | + return 17; |
| 39 | + if constexpr (((Value << 18) & 0x80000000) != 0) |
| 40 | + return 18; |
| 41 | + if constexpr (((Value << 19) & 0x80000000) != 0) |
| 42 | + return 19; |
| 43 | + if constexpr (((Value << 20) & 0x80000000) != 0) |
| 44 | + return 20; |
| 45 | + if constexpr (((Value << 21) & 0x80000000) != 0) |
| 46 | + return 21; |
| 47 | + if constexpr (((Value << 22) & 0x80000000) != 0) |
| 48 | + return 22; |
| 49 | + if constexpr (((Value << 23) & 0x80000000) != 0) |
| 50 | + return 23; |
| 51 | + if constexpr (((Value << 24) & 0x80000000) != 0) |
| 52 | + return 24; |
| 53 | + if constexpr (((Value << 25) & 0x80000000) != 0) |
| 54 | + return 25; |
| 55 | + if constexpr (((Value << 26) & 0x80000000) != 0) |
| 56 | + return 26; |
| 57 | + if constexpr (((Value << 27) & 0x80000000) != 0) |
| 58 | + return 27; |
| 59 | + if constexpr (((Value << 28) & 0x80000000) != 0) |
| 60 | + return 28; |
| 61 | + if constexpr (((Value << 29) & 0x80000000) != 0) |
| 62 | + return 29; |
| 63 | + if constexpr (((Value << 30) & 0x80000000) != 0) |
| 64 | + return 30; |
| 65 | + if constexpr (((Value << 31) & 0x80000000) != 0) |
| 66 | + return 31; |
| 67 | + static_assert(Value > 0, "Zero is not a valid max value"); |
| 68 | +} |
| 69 | + |
| 70 | +template <uint32_t Value1, uint32_t Value2> |
| 71 | +constexpr uint32_t min_value() { |
| 72 | + return Value1 < Value2 ? Value1 : Value2; |
| 73 | +} |
| 74 | + |
| 75 | +} |
| 76 | + |
| 77 | +namespace ez { |
| 78 | + |
| 79 | +template <uint32_t in_min, uint32_t in_max, uint32_t out_min, uint32_t out_max> |
| 80 | +uint32_t mapRange(uint32_t x) { |
| 81 | + constexpr uint32_t shift = min_value<max_shift<in_max + 1>(), |
| 82 | + max_shift<out_max + 1>()>(); |
| 83 | + constexpr uint32_t factor = |
| 84 | + ((out_max - out_min + 1) << shift) / (in_max - in_min + 1); |
| 85 | + return (((x - in_min) * factor) >> shift) + out_min; |
| 86 | +} |
| 87 | + |
| 88 | +} |
| 89 | + |
| 90 | +#endif // EZ_FIXPOINT_MAPRANGE_H |
0 commit comments