IntegerInfo

2026-10-19 06:33:33 +08:00 · 2014-02-21 22:03:17 +04:00
parent aee9ce238e
commit 0e28a0826c
3 changed files with 236 additions and 0 deletions
@@ -0,0 +1,103 @@
+/*
+ * Copyright (C) 2014 Pavel Kirienko <pavel.kirienko@gmail.com>
+ */
+
+#pragma once
+
+#include <stdint.h>
+#include <limits>
+#include <uavcan/internal/util.hpp>
+#include <uavcan/internal/marshalling/scalar_codec.hpp>
+#include <uavcan/internal/marshalling/types.hpp>
+
+namespace uavcan
+{
+
+enum Signedness { SignednessUnsigned, SignednessSigned };
+
+template <unsigned int BitLen_, Signedness Signedness, CastMode CastMode>
+class IntegerInfo
+{
+    enum { IsSigned = Signedness == SignednessSigned };
+
+    struct ErrorNoSuchInteger;
+
+public:
+    enum { BitLen = BitLen_ };
+
+    typedef typename StaticIf<(BitLen <= 8),  typename StaticIf<IsSigned, int8_t,  uint8_t>::Result,
+            typename StaticIf<(BitLen <= 16), typename StaticIf<IsSigned, int16_t, uint16_t>::Result,
+            typename StaticIf<(BitLen <= 32), typename StaticIf<IsSigned, int32_t, uint32_t>::Result,
+            typename StaticIf<(BitLen <= 64), typename StaticIf<IsSigned, int64_t, uint64_t>::Result,
+                              ErrorNoSuchInteger>::Result>::Result>::Result>::Result StorageType;
+
+private:
+    typedef typename IntegerInfo<BitLen, SignednessUnsigned, CastMode>::StorageType UnsignedStorageType;
+
+    IntegerInfo() { }
+
+    struct ExactSizeLimits
+    {
+        static StorageType max() { return std::numeric_limits<StorageType>::max(); }
+        static StorageType min() { return std::numeric_limits<StorageType>::min(); }
+        static UnsignedStorageType mask() { return ~UnsignedStorageType(0); }
+    };
+
+    struct NonExactSizeLimits
+    {
+        static StorageType max()
+        {
+            return IsSigned ? ((StorageType(1) << (BitLen - 1)) - 1) : ((StorageType(1) << BitLen) - 1);
+        }
+        static StorageType min() { return IsSigned ? -(StorageType(1) << (BitLen - 1)) : 0; }
+        static UnsignedStorageType mask() { return (UnsignedStorageType(1) << BitLen) - 1; }
+    };
+
+    enum { IsExactSize = (BitLen == 8) || (BitLen == 16) || (BitLen == 32) || (BitLen == 64) };
+
+    typedef typename StaticIf<IsExactSize, ExactSizeLimits, NonExactSizeLimits>::Result Limits;
+
+    static void saturate(StorageType& value)
+    {
+        if (value > max())
+            value = max();
+        else if (value <= min()) // 'Less or Equal' allows to suppress compiler warning on unsigned types
+            value = min();
+    }
+
+    static void truncate(StorageType& value)
+    {
+        // cppcheck-suppress duplicateExpression
+        value &= Limits::mask();
+    }
+
+public:
+    // cppcheck-suppress duplicateExpression
+    static StorageType max() { return Limits::max(); }
+    // cppcheck-suppress duplicateExpression
+    static StorageType min() { return Limits::min(); }
+
+    static StorageType init() { return 0; }
+
+    static int encode(StorageType value, ScalarCodec& codec, bool enable_tail_array_optimization = false)
+    {
+        (void)enable_tail_array_optimization;
+        // cppcheck-suppress duplicateExpression
+        if (CastMode == CastModeSaturate)
+            saturate(value);
+        else
+            truncate(value);
+        return codec.encode<BitLen>(value);
+    }
+
+    static int decode(StorageType& out_value, ScalarCodec& codec, bool enable_tail_array_optimization = false)
+    {
+        (void)enable_tail_array_optimization;
+        return codec.decode<BitLen>(out_value);
+    }
+};
+
+template <CastMode CastMode>
+class IntegerInfo<1, SignednessSigned, CastMode>;   // Invalid instantiation
+
+}
@@ -0,0 +1,24 @@
+/*
+ * Copyright (C) 2014 Pavel Kirienko <pavel.kirienko@gmail.com>
+ */
+
+#pragma once
+
+#include <uavcan/internal/util.hpp>
+#include <uavcan/internal/marshalling/scalar_codec.hpp>
+
+namespace uavcan
+{
+
+enum CastMode { CastModeSaturate, CastModeTruncate };
+
+template <typename T, typename Enable = void>
+struct AddStorageTypeImpl { typedef T StorageType; };
+
+template <typename T>
+struct AddStorageTypeImpl<T, typename EnableIfType<typename T::StorageType>::Type> { };
+
+template <typename T>
+struct AddStorageType : public T, public AddStorageTypeImpl<T> { };
+
+}