280 lines
8.7 KiB
C
280 lines
8.7 KiB
C
/****************************************************************************
|
|
** Copyright (c) 2016, Fougue Ltd. <http://www.fougue.pro>
|
|
** All rights reserved.
|
|
**
|
|
** Redistribution and use in source and binary forms, with or without
|
|
** modification, are permitted provided that the following conditions
|
|
** are met:
|
|
**
|
|
** 1. Redistributions of source code must retain the above copyright
|
|
** notice, this list of conditions and the following disclaimer.
|
|
**
|
|
** 2. Redistributions in binary form must reproduce the above
|
|
** copyright notice, this list of conditions and the following
|
|
** disclaimer in the documentation and/or other materials provided
|
|
** with the distribution.
|
|
**
|
|
** THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
|
** "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
|
** LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
|
|
** A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
|
|
** OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
|
|
** SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
|
|
** LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
|
** DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
|
** THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
|
** (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
|
|
** OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
****************************************************************************/
|
|
|
|
#ifndef GMIO_INTERNAL_BYTE_CODEC_H
|
|
#define GMIO_INTERNAL_BYTE_CODEC_H
|
|
|
|
#include "../global.h"
|
|
|
|
/* Functions that read NNbit uint from memory (little-endian)
|
|
* uintNN_t gmio_decode_uintNN_le(const uint8_t* bytes)
|
|
*
|
|
* Functions that read NNbit uint from memory (big-endian)
|
|
* uintNN_t gmio_decode_uintNN_be(const uint8_t* bytes)
|
|
*
|
|
* Functions that writes NNbit uint to memory in little-endian
|
|
* void gmio_encode_uintNN_le(uintNN_t val, uint8_t* bytes);
|
|
*
|
|
* Functions that writes NNbit uint to memory in big-endian
|
|
* void gmio_encode_uintNN_be(uintNN_t val, uint8_t* bytes);
|
|
*/
|
|
|
|
GMIO_INLINE uint16_t gmio_decode_uint16_le(const uint8_t* bytes);
|
|
GMIO_INLINE uint16_t gmio_decode_uint16_be(const uint8_t* bytes);
|
|
GMIO_INLINE uint32_t gmio_decode_uint32_le(const uint8_t* bytes);
|
|
GMIO_INLINE uint32_t gmio_decode_uint32_be(const uint8_t* bytes);
|
|
GMIO_INLINE void gmio_encode_uint16_le(uint16_t val, uint8_t* bytes);
|
|
GMIO_INLINE void gmio_encode_uint16_be(uint16_t val, uint8_t* bytes);
|
|
GMIO_INLINE void gmio_encode_uint32_le(uint32_t val, uint8_t* bytes);
|
|
GMIO_INLINE void gmio_encode_uint32_be(uint32_t val, uint8_t* bytes);
|
|
|
|
#ifdef GMIO_HAVE_INT64_TYPE
|
|
GMIO_INLINE uint64_t gmio_decode_uint64_le(const uint8_t* bytes);
|
|
GMIO_INLINE uint64_t gmio_decode_uint64_be(const uint8_t* bytes);
|
|
GMIO_INLINE void gmio_encode_uint64_le(uint64_t val, uint8_t* bytes);
|
|
GMIO_INLINE void gmio_encode_uint64_be(uint64_t val, uint8_t* bytes);
|
|
#endif /* GMIO_HAVE_INT64_TYPE */
|
|
|
|
/* Functions that reads NNbit uint from memory (little-endian) and advances
|
|
* buffer pos
|
|
* uintNN_t gmio_adv_decode_uintNN_le(const uint8_t** bytes)
|
|
*
|
|
* Functions that reads NNbit uint from memory (big-endian) and advances
|
|
* buffer pos
|
|
* uintNN_t gmio_adv_decode_uintNN_be(const uint8_t** bytes)
|
|
*
|
|
* Functions that writes NNbit uint to memory in little-endian and returns
|
|
* advanced buffer pos
|
|
* uint8_t* gmio_adv_encode_uintNN_le(uintNN_t val, uint8_t* bytes)
|
|
*
|
|
* Functions that writes NNbit uint to memory in big-endian and returns
|
|
* advanced buffer pos
|
|
* uint8_t* gmio_adv_encode_uintNN_be(uintNN_t val, uint8_t* bytes)
|
|
*/
|
|
|
|
GMIO_INLINE uint16_t gmio_adv_decode_uint16_le(const uint8_t** bytes);
|
|
GMIO_INLINE uint16_t gmio_adv_decode_uint16_be(const uint8_t** bytes);
|
|
GMIO_INLINE uint32_t gmio_adv_decode_uint32_le(const uint8_t** bytes);
|
|
GMIO_INLINE uint32_t gmio_adv_decode_uint32_be(const uint8_t** bytes);
|
|
GMIO_INLINE uint8_t* gmio_adv_encode_uint16_le(uint16_t val, uint8_t* bytes);
|
|
GMIO_INLINE uint8_t* gmio_adv_encode_uint16_be(uint16_t val, uint8_t* bytes);
|
|
GMIO_INLINE uint8_t* gmio_adv_encode_uint32_le(uint32_t val, uint8_t* bytes);
|
|
GMIO_INLINE uint8_t* gmio_adv_encode_uint32_be(uint32_t val, uint8_t* bytes);
|
|
|
|
#ifdef GMIO_HAVE_INT64_TYPE
|
|
GMIO_INLINE uint64_t gmio_adv_decode_uint64_le(const uint8_t** bytes);
|
|
GMIO_INLINE uint64_t gmio_adv_decode_uint64_be(const uint8_t** bytes);
|
|
GMIO_INLINE uint8_t* gmio_adv_encode_uint64_le(uint64_t val, uint8_t* bytes);
|
|
GMIO_INLINE uint8_t* gmio_adv_encode_uint64_be(uint64_t val, uint8_t* bytes);
|
|
#endif /* GMIO_HAVE_INT64_TYPE */
|
|
|
|
|
|
|
|
/*
|
|
* Implementation
|
|
*/
|
|
|
|
uint16_t gmio_decode_uint16_le(const uint8_t* bytes)
|
|
{
|
|
/* |0 |1 | */
|
|
/* |BB|AA| -> 0xAABB */
|
|
return (bytes[1] << 8) | bytes[0];
|
|
}
|
|
|
|
uint16_t gmio_decode_uint16_be(const uint8_t* bytes)
|
|
{
|
|
/* |0 |1 | */
|
|
/* |AA|BB| -> 0xAABB */
|
|
return (bytes[0] << 8) | bytes[1];
|
|
}
|
|
|
|
void gmio_encode_uint16_le(uint16_t val, uint8_t* bytes)
|
|
{
|
|
bytes[0] = val & 0xFF;
|
|
bytes[1] = (val >> 8) & 0xFF;
|
|
}
|
|
|
|
void gmio_encode_uint16_be(uint16_t val, uint8_t* bytes)
|
|
{
|
|
bytes[0] = (val >> 8) & 0xFF;
|
|
bytes[1] = val & 0xFF;
|
|
}
|
|
|
|
uint32_t gmio_decode_uint32_le(const uint8_t* bytes)
|
|
{
|
|
/* |DD|CC|BB|AA| -> 0xAABBCCDD */
|
|
return bytes[0] | (bytes[1] << 8) | (bytes[2] << 16) | (bytes[3] << 24);
|
|
}
|
|
|
|
uint32_t gmio_decode_uint32_be(const uint8_t* bytes)
|
|
{
|
|
/* |DD|CC|BB|AA| -> 0xDDCCBBAA */
|
|
return bytes[3] | (bytes[2] << 8) | (bytes[1] << 16) | (bytes[0] << 24);
|
|
}
|
|
|
|
void gmio_encode_uint32_le(uint32_t val, uint8_t* bytes)
|
|
{
|
|
bytes[0] = val & 0xFF;
|
|
bytes[1] = (val >> 8) & 0xFF;
|
|
bytes[2] = (val >> 16) & 0xFF;
|
|
bytes[3] = (val >> 24) & 0xFF;
|
|
}
|
|
|
|
void gmio_encode_uint32_be(uint32_t val, uint8_t* bytes)
|
|
{
|
|
bytes[0] = (val >> 24) & 0xFF;
|
|
bytes[1] = (val >> 16) & 0xFF;
|
|
bytes[2] = (val >> 8) & 0xFF;
|
|
bytes[3] = val & 0xFF;
|
|
}
|
|
|
|
#ifdef GMIO_HAVE_INT64_TYPE
|
|
|
|
uint64_t gmio_decode_uint64_le(const uint8_t* bytes)
|
|
{
|
|
const uint64_t h32 = gmio_decode_uint32_le(bytes + 4); /* Decode high 32b */
|
|
return (h32 << 32) | gmio_decode_uint32_le(bytes);
|
|
}
|
|
|
|
uint64_t gmio_decode_uint64_be(const uint8_t* bytes)
|
|
{
|
|
const uint64_t l32 = gmio_decode_uint32_be(bytes); /* Decode low 32b */
|
|
return (l32 << 32) | gmio_decode_uint32_be(bytes + 4);
|
|
}
|
|
|
|
void gmio_encode_uint64_le(uint64_t val, uint8_t* bytes)
|
|
{
|
|
bytes[0] = val & 0xFF;
|
|
bytes[1] = (val >> 8) & 0xFF;
|
|
bytes[2] = (val >> 16) & 0xFF;
|
|
bytes[3] = (val >> 24) & 0xFF;
|
|
bytes[4] = (val >> 32) & 0xFF;
|
|
bytes[5] = (val >> 40) & 0xFF;
|
|
bytes[6] = (val >> 48) & 0xFF;
|
|
bytes[7] = (val >> 56) & 0xFF;
|
|
}
|
|
|
|
void gmio_encode_uint64_be(uint64_t val, uint8_t* bytes)
|
|
{
|
|
bytes[0] = (val >> 56) & 0xFF;
|
|
bytes[1] = (val >> 48) & 0xFF;
|
|
bytes[2] = (val >> 40) & 0xFF;
|
|
bytes[3] = (val >> 32) & 0xFF;
|
|
bytes[4] = (val >> 24) & 0xFF;
|
|
bytes[5] = (val >> 16) & 0xFF;
|
|
bytes[6] = (val >> 8) & 0xFF;
|
|
bytes[7] = val & 0xFF;
|
|
}
|
|
|
|
#endif /* GMIO_HAVE_INT64_TYPE */
|
|
|
|
uint16_t gmio_adv_decode_uint16_le(const uint8_t** bytes)
|
|
{
|
|
const uint16_t val = gmio_decode_uint16_le(*bytes);
|
|
*bytes += 2;
|
|
return val;
|
|
}
|
|
|
|
uint16_t gmio_adv_decode_uint16_be(const uint8_t** bytes)
|
|
{
|
|
const uint16_t val = gmio_decode_uint16_be(*bytes);
|
|
*bytes += 2;
|
|
return val;
|
|
}
|
|
|
|
uint32_t gmio_adv_decode_uint32_le(const uint8_t** bytes)
|
|
{
|
|
const uint32_t val = gmio_decode_uint32_le(*bytes);
|
|
*bytes += 4;
|
|
return val;
|
|
}
|
|
|
|
uint32_t gmio_adv_decode_uint32_be(const uint8_t** bytes)
|
|
{
|
|
const uint32_t val = gmio_decode_uint32_be(*bytes);
|
|
*bytes += 4;
|
|
return val;
|
|
}
|
|
|
|
uint8_t* gmio_adv_encode_uint16_le(uint16_t val, uint8_t* bytes)
|
|
{
|
|
gmio_encode_uint16_le(val, bytes);
|
|
return bytes + 2;
|
|
}
|
|
|
|
uint8_t* gmio_adv_encode_uint16_be(uint16_t val, uint8_t* bytes)
|
|
{
|
|
gmio_encode_uint16_be(val, bytes);
|
|
return bytes + 2;
|
|
}
|
|
|
|
uint8_t* gmio_adv_encode_uint32_le(uint32_t val, uint8_t* bytes)
|
|
{
|
|
gmio_encode_uint32_le(val, bytes);
|
|
return bytes + 4;
|
|
}
|
|
|
|
uint8_t* gmio_adv_encode_uint32_be(uint32_t val, uint8_t* bytes)
|
|
{
|
|
gmio_encode_uint32_be(val, bytes);
|
|
return bytes + 4;
|
|
}
|
|
|
|
#ifdef GMIO_HAVE_INT64_TYPE
|
|
|
|
uint64_t gmio_adv_decode_uint64_le(const uint8_t** bytes)
|
|
{
|
|
const uint64_t val = gmio_decode_uint64_le(*bytes);
|
|
*bytes += 8;
|
|
return val;
|
|
}
|
|
|
|
uint64_t gmio_adv_decode_uint64_be(const uint8_t** bytes)
|
|
{
|
|
const uint64_t val = gmio_decode_uint64_be(*bytes);
|
|
*bytes += 8;
|
|
return val;
|
|
}
|
|
|
|
uint8_t* gmio_adv_encode_uint64_le(uint64_t val, uint8_t* bytes)
|
|
{
|
|
gmio_encode_uint64_le(val, bytes);
|
|
return bytes + 8;
|
|
}
|
|
|
|
uint8_t* gmio_adv_encode_uint64_be(uint64_t val, uint8_t* bytes)
|
|
{
|
|
gmio_encode_uint64_be(val, bytes);
|
|
return bytes + 8;
|
|
}
|
|
|
|
#endif /* GMIO_HAVE_INT64_TYPE */
|
|
|
|
#endif /* GMIO_INTERNAL_BYTE_CODEC_H */
|