utils.hpp

Go to the documentation of this file.

 
#ifndef UMRT_ARM_FIRMWARE_LIB_UTILS_HPP
#define UMRT_ARM_FIRMWARE_LIB_UTILS_HPP
 
#include <cstdint>
#include <string>
#include <vector>
 
inline std::vector<uint8_t> pack_32(const uint32_t integer) {
    return {
        static_cast<uint8_t>(integer & 0xFF),       // bits [7, 0]
        static_cast<uint8_t>(integer >> 8 & 0xFF),  // bits [15, 8]
        static_cast<uint8_t>(integer >> 16 & 0xFF), // bits [23, 16]
        static_cast<uint8_t>(integer >> 24 & 0xFF)  // bits [31, 24]
    };
}
 
inline std::vector<uint8_t> pack_32_big(const uint32_t integer) {
    return {
        static_cast<uint8_t>(integer >> 24 & 0xFF), // bits [31, 24]
        static_cast<uint8_t>(integer >> 16 & 0xFF), // bits [23, 16]
        static_cast<uint8_t>(integer >> 8 & 0xFF),  // bits [15, 8]
        static_cast<uint8_t>(integer & 0xFF)        // bits [7, 0]
    };
}
 
inline std::vector<uint8_t> pack_24_big(const uint32_t integer) {
    return {
        static_cast<uint8_t>(integer >> 16 & 0xFF), // bits [23, 16]
        static_cast<uint8_t>(integer >> 8 & 0xFF),  // bits [15, 8]
        static_cast<uint8_t>(integer & 0xFF)        // bits [7, 0]
    };
}
 
inline std::vector<uint8_t> pack_16(const uint16_t integer) {
    return {
        static_cast<uint8_t>(integer & 0xFF),     // bits [7, 0]
        static_cast<uint8_t>(integer >> 8 & 0xFF) // bits [15, 8]
    };
}
 
inline std::vector<uint8_t> pack_16_big(const uint16_t integer) {
    return {
        static_cast<uint8_t>(integer >> 8 & 0xFF), // bits [15, 8]
        static_cast<uint8_t>(integer & 0xFF)       // bits [7, 0]
    };
}
 
inline std::vector<uint8_t> firmatify_32(const std::vector<uint8_t>::const_iterator& pack) {
    return {
        static_cast<uint8_t>(pack[0] & 0x7F),
        static_cast<uint8_t>((pack[0] & 0x80) >> 7),
        static_cast<uint8_t>(pack[1] & 0x7F),
        static_cast<uint8_t>((pack[1] & 0x80) >> 7),
        static_cast<uint8_t>(pack[2] & 0x7F),
        static_cast<uint8_t>((pack[2] & 0x80) >> 7),
        static_cast<uint8_t>(pack[3] & 0x7F),
        static_cast<uint8_t>((pack[3] & 0x80) >> 7),
    };
}
 
inline std::vector<uint8_t> firmatify_32(const std::vector<uint8_t>& pack) { return firmatify_32(pack.cbegin()); }
 
inline std::vector<uint8_t> firmatify_16(const std::vector<uint8_t>::const_iterator& pack) {
    return {
        static_cast<uint8_t>(pack[0] & 0x7F),
        static_cast<uint8_t>((pack[0] & 0x80) >> 7),
        static_cast<uint8_t>(pack[1] & 0x7F),
        static_cast<uint8_t>((pack[1] & 0x80) >> 7),
        static_cast<uint8_t>(pack[2] & 0x7F),
        static_cast<uint8_t>((pack[2] & 0x80) >> 7),
        static_cast<uint8_t>(pack[3] & 0x7F),
        static_cast<uint8_t>((pack[3] & 0x80) >> 7),
    };
}
 
inline std::vector<uint8_t> firmatify_16(const std::vector<uint8_t>& pack) { return firmatify_16(pack.cbegin()); }
 
inline std::vector<uint8_t> firmatify_8(const uint8_t val) {
    return { static_cast<uint8_t>(val & 0x7F), static_cast<uint8_t>((val & 0x80) >> 7) };
}
 
inline uint32_t decode_32(const std::vector<uint8_t>::const_iterator& data) {
    return data[0] | data[1] << 8 | data[2] << 16 | data[3] << 24;
}
 
inline uint32_t decode_32(const std::vector<uint8_t>& data) { return decode_32(data.cbegin()); }
 
inline uint32_t decode_32_big(const std::vector<uint8_t>::const_iterator& data) {
    return data[3] | data[2] << 8 | data[1] << 16 | data[0] << 24;
}
 
inline uint32_t decode_32_big(const std::vector<uint8_t>& data) { return decode_32_big(data.cbegin()); }
 
inline uint16_t decode_16(const std::vector<uint8_t>::const_iterator& data) {
    return static_cast<uint16_t>(data[0]) | static_cast<uint16_t>(data[1] << 8);
}
 
inline uint16_t decode_16(const std::vector<uint8_t>& data) { return decode_16(data.cbegin()); }
 
inline uint16_t decode_16_big(const std::vector<uint8_t>::const_iterator& data) {
    return static_cast<uint16_t>(data[1]) | static_cast<uint16_t>(data[0] << 8);
}
 
inline uint16_t decode_16_big(const std::vector<uint8_t>& data) { return decode_16_big(data.cbegin()); }
 
inline std::vector<uint8_t> encode_string(const std::string& str) {
    return { str.cbegin(), str.cend() };
}
 
inline std::string decode_string(const std::vector<uint8_t>& data) {
    return { data.cbegin(), data.cend() };
}
 
#endif //UMRT_ARM_FIRMWARE_LIB_UTILS_HPP