[lib][bytes] some handy byte swizzling routines
This commit is contained in:
Travis Geiselbrecht
73
include/lib/bytes.h
Normal file
73
include/lib/bytes.h
Normal file
@@ -0,0 +1,73 @@
|
||||
/*
|
||||
* Copyright (c) 2013 Travis Geiselbrecht
|
||||
*
|
||||
* Permission is hereby granted, free of charge, to any person obtaining
|
||||
* a copy of this software and associated documentation files
|
||||
* (the "Software"), to deal in the Software without restriction,
|
||||
* including without limitation the rights to use, copy, modify, merge,
|
||||
* publish, distribute, sublicense, and/or sell copies of the Software,
|
||||
* and to permit persons to whom the Software is furnished to do so,
|
||||
* subject to the following conditions:
|
||||
*
|
||||
* The above copyright notice and this permission notice shall be
|
||||
* included in all copies or substantial portions of the Software.
|
||||
*
|
||||
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
|
||||
* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
|
||||
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.
|
||||
* IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY
|
||||
* CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT,
|
||||
* TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE
|
||||
* SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
|
||||
*/
|
||||
#ifndef __BYTES_H
|
||||
#define __BYTES_H
|
||||
|
||||
#include <endian.h>
|
||||
#include <stdint.h>
|
||||
|
||||
#if BYTE_ORDER == BIG_ENDIAN
|
||||
#define bytes_read_u16(x) bytes_read_u16_be(x)
|
||||
#define bytes_read_u24(x) bytes_read_u24_be(x)
|
||||
#define bytes_read_u32(x) bytes_read_u32_be(x)
|
||||
#define bytes_write_u16(x, y) bytes_write_u16_be(x, y)
|
||||
#define bytes_write_u24(x, y) bytes_write_u24_be(x, y)
|
||||
#define bytes_write_u32(x, y) bytes_write_u32_be(x, y)
|
||||
#elif BYTE_ORDER == LITTLE_ENDIAN
|
||||
#define bytes_read_u16(x) bytes_read_u16_le(x)
|
||||
#define bytes_read_u24(x) bytes_read_u24_le(x)
|
||||
#define bytes_read_u32(x) bytes_read_u32_le(x)
|
||||
#define bytes_write_u16(x, y) bytes_write_u16_le(x, y)
|
||||
#define bytes_write_u24(x, y) bytes_write_u24_le(x, y)
|
||||
#define bytes_write_u32(x, y) bytes_write_u32_le(x, y)
|
||||
#else
|
||||
#error "Endianness not defined!"
|
||||
#endif
|
||||
|
||||
|
||||
// Big endian interfaces
|
||||
uint16_t bytes_read_u16_be(const uint8_t *buf);
|
||||
uint32_t bytes_read_u24_be(const uint8_t *buf);
|
||||
uint32_t bytes_read_u32_be(const uint8_t *buf);
|
||||
|
||||
uint8_t* bytes_write_u16_be(uint8_t *buf, uint16_t val);
|
||||
uint8_t* bytes_write_u24_be(uint8_t *buf, uint32_t val);
|
||||
uint8_t* bytes_write_u32_be(uint8_t *buf, uint32_t val);
|
||||
|
||||
// Little endian interfaces
|
||||
uint16_t bytes_read_u16_le(const uint8_t *buf);
|
||||
uint32_t bytes_read_u24_le(const uint8_t *buf);
|
||||
uint32_t bytes_read_u32_le(const uint8_t *buf);
|
||||
|
||||
uint8_t* bytes_write_u16_le(uint8_t *buf, uint16_t val);
|
||||
uint8_t* bytes_write_u24_le(uint8_t *buf, uint32_t val);
|
||||
uint8_t* bytes_write_u32_le(uint8_t *buf, uint32_t val);
|
||||
|
||||
// Bit swapping interfaces
|
||||
uint8_t bytes_swap_bits_u8(uint8_t val);
|
||||
uint16_t bytes_swap_bits_u16(uint16_t val);
|
||||
uint32_t bytes_swap_bits_u24(uint32_t val);
|
||||
uint32_t bytes_swap_bits_u32(uint32_t val);
|
||||
|
||||
#endif
|
||||
|
||||
178
lib/bytes/bytes.c
Normal file
178
lib/bytes/bytes.c
Normal file
@@ -0,0 +1,178 @@
|
||||
/*
|
||||
* Copyright (c) 2013 Travis Geiselbrecht
|
||||
*
|
||||
* Permission is hereby granted, free of charge, to any person obtaining
|
||||
* a copy of this software and associated documentation files
|
||||
* (the "Software"), to deal in the Software without restriction,
|
||||
* including without limitation the rights to use, copy, modify, merge,
|
||||
* publish, distribute, sublicense, and/or sell copies of the Software,
|
||||
* and to permit persons to whom the Software is furnished to do so,
|
||||
* subject to the following conditions:
|
||||
*
|
||||
* The above copyright notice and this permission notice shall be
|
||||
* included in all copies or substantial portions of the Software.
|
||||
*
|
||||
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
|
||||
* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
|
||||
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.
|
||||
* IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY
|
||||
* CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT,
|
||||
* TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE
|
||||
* SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
|
||||
*/
|
||||
|
||||
#include <stdint.h>
|
||||
#include <lib/bytes.h>
|
||||
|
||||
// Big endian interfaces
|
||||
uint16_t bytes_read_u16_be(const uint8_t *buf)
|
||||
{
|
||||
uint16_t val;
|
||||
|
||||
val = (buf[0] << 8) | buf[1];
|
||||
|
||||
return(val);
|
||||
}
|
||||
|
||||
uint32_t bytes_read_u24_be(const uint8_t *buf)
|
||||
{
|
||||
uint32_t val;
|
||||
|
||||
val = (buf[0] << 16) | (buf[1] << 8) | buf[2];
|
||||
|
||||
return(val);
|
||||
}
|
||||
|
||||
uint32_t bytes_read_u32_be(const uint8_t *buf)
|
||||
{
|
||||
uint32_t val;
|
||||
|
||||
val = (buf[0] << 24) | (buf[1] << 16) | (buf[2] << 8) | buf[3];
|
||||
|
||||
return(val);
|
||||
}
|
||||
|
||||
uint8_t* bytes_write_u16_be(uint8_t *buf, uint16_t val)
|
||||
{
|
||||
*buf++ = (val >> 8) & 0xFF;
|
||||
*buf++ = (val ) & 0xFF;
|
||||
|
||||
return(buf);
|
||||
}
|
||||
|
||||
uint8_t* bytes_write_u24_be(uint8_t *buf, uint32_t val)
|
||||
{
|
||||
*buf++ = (val >> 16) & 0xFF;
|
||||
*buf++ = (val >> 8) & 0xFF;
|
||||
*buf++ = (val ) & 0xFF;
|
||||
|
||||
return(buf);
|
||||
}
|
||||
|
||||
uint8_t* bytes_write_u32_be(uint8_t *buf, uint32_t val)
|
||||
{
|
||||
*buf++ = (val >> 24) & 0xFF;
|
||||
*buf++ = (val >> 16) & 0xFF;
|
||||
*buf++ = (val >> 8) & 0xFF;
|
||||
*buf++ = (val ) & 0xFF;
|
||||
|
||||
return(buf);
|
||||
}
|
||||
|
||||
|
||||
// Little endian interfaces
|
||||
uint16_t bytes_read_u16_le(const uint8_t *buf)
|
||||
{
|
||||
uint16_t val;
|
||||
|
||||
val = (buf[1] << 8) | buf[0];
|
||||
|
||||
return(val);
|
||||
}
|
||||
|
||||
uint32_t bytes_read_u24_le(const uint8_t *buf)
|
||||
{
|
||||
uint32_t val;
|
||||
|
||||
val = (buf[2] << 16) | (buf[1] << 8) | buf[0];
|
||||
|
||||
return(val);
|
||||
}
|
||||
|
||||
uint32_t bytes_read_u32_le(const uint8_t *buf)
|
||||
{
|
||||
uint32_t val;
|
||||
|
||||
val = (buf[3] << 24) | (buf[2] << 16) | (buf[1] << 8) | buf[0];
|
||||
|
||||
return(val);
|
||||
}
|
||||
|
||||
uint8_t* bytes_write_u16_le(uint8_t *buf, uint16_t val)
|
||||
{
|
||||
*buf++ = (val ) & 0xFF;
|
||||
*buf++ = (val >> 8) & 0xFF;
|
||||
|
||||
return(buf);
|
||||
}
|
||||
|
||||
uint8_t* bytes_write_u24_le(uint8_t *buf, uint32_t val)
|
||||
{
|
||||
*buf++ = (val ) & 0xFF;
|
||||
*buf++ = (val >> 8) & 0xFF;
|
||||
*buf++ = (val >> 16) & 0xFF;
|
||||
|
||||
return(buf);
|
||||
}
|
||||
|
||||
uint8_t* bytes_write_u32_le(uint8_t *buf, uint32_t val)
|
||||
{
|
||||
*buf++ = (val ) & 0xFF;
|
||||
*buf++ = (val >> 8) & 0xFF;
|
||||
*buf++ = (val >> 16) & 0xFF;
|
||||
*buf++ = (val >> 24) & 0xFF;
|
||||
|
||||
return(buf);
|
||||
}
|
||||
|
||||
uint8_t bytes_swap_bits_u8(uint8_t val)
|
||||
{
|
||||
val = ((val >> 1) & 0x55) | ((val & 0x55) << 1);
|
||||
val = ((val >> 2) & 0x33) | ((val & 0x33) << 2);
|
||||
val = ((val >> 4) & 0x0f) | ((val & 0x0f) << 4);
|
||||
|
||||
return(val);
|
||||
}
|
||||
|
||||
uint16_t bytes_swap_bits_u16(uint16_t val)
|
||||
{
|
||||
val = ((val >> 1) & 0x5555) | ((val & 0x5555) << 1);
|
||||
val = ((val >> 2) & 0x3333) | ((val & 0x3333) << 2);
|
||||
val = ((val >> 4) & 0x0f0f) | ((val & 0x0f0f) << 4);
|
||||
val = ((val >> 8) & 0x00ff) | ((val & 0x00ff) << 8);
|
||||
|
||||
return(val);
|
||||
}
|
||||
|
||||
uint32_t bytes_swap_bits_u24(uint32_t val)
|
||||
{
|
||||
val &= 0x00FFFFFF;
|
||||
val = ((val >> 1) & 0x555555) | ((val & 0x555555) << 1);
|
||||
val = ((val >> 2) & 0x333333) | ((val & 0x333333) << 2);
|
||||
val = ((val >> 4) & 0x0f0f0f) | ((val & 0x0f0f0f) << 4);
|
||||
val = ((val >> 16) & 0x0000ff) | ((val & 0x0000ff) << 16) | (val & 0x00FF00);
|
||||
|
||||
return(val);
|
||||
}
|
||||
|
||||
uint32_t bytes_swap_bits_u32(uint32_t val)
|
||||
{
|
||||
val = ((val >> 1) & 0x55555555) | ((val & 0x55555555) << 1);
|
||||
val = ((val >> 2) & 0x33333333) | ((val & 0x33333333) << 2);
|
||||
val = ((val >> 4) & 0x0f0f0f0f) | ((val & 0x0f0f0f0f) << 4);
|
||||
val = ((val >> 8) & 0x00ff00ff) | ((val & 0x00ff00ff) << 8);
|
||||
val = ((val >> 16) & 0x0000ffff) | ((val & 0x0000ffff) << 16);
|
||||
|
||||
return(val);
|
||||
}
|
||||
|
||||
8
lib/bytes/rules.mk
Normal file
8
lib/bytes/rules.mk
Normal file
@@ -0,0 +1,8 @@
|
||||
LOCAL_DIR := $(GET_LOCAL_DIR)
|
||||
|
||||
MODULE := $(LOCAL_DIR)
|
||||
|
||||
MODULE_SRCS += \
|
||||
$(LOCAL_DIR)/bytes.c
|
||||
|
||||
include make/module.mk
|
||||
Reference in New Issue
Block a user