bit16gen.h

Go to the documentation of this file.

/*
 * bit16gen.h
 *
 * Copyright (C) 2014  Max <max.suraev@fairwaves.co>
 *
 * All Rights Reserved
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 */
 
#pragma once
 
#include <osmocom/core/utils.h>
 
static inline uint16_t osmo_load16le_ext(const void *p, uint8_t n)
{
        uint8_t i;
        uint16_t r = 0;
        const uint8_t *q = (uint8_t *)p;
        OSMO_ASSERT(n <= sizeof(r));
        for(i = 0; i < n; r |= ((uint16_t)q[i] << (8 * i)), i++);
        return r;
}
 
static inline uint16_t osmo_load16be_ext(const void *p, uint8_t n)
{
        uint8_t i;
        uint16_t r = 0;
        const uint8_t *q = (uint8_t *)p;
        OSMO_ASSERT(n <= sizeof(r));
        for(i = 0; i < n; r |= ((uint16_t)q[i] << (16 - 8* (1 + i))), i++);
        return r;
}
 
static inline uint16_t osmo_load16be_ext_2(const void *p, uint8_t n)
{
        uint8_t i;
        uint16_t r = 0;
        const uint8_t *q = (uint8_t *)p;
        OSMO_ASSERT(n <= sizeof(r));
        for(i = 0; i < n; r |= ((uint16_t)q[i] << (16 - 8* (1 + i + (sizeof(r) - n)))), i++);
        return r;
}
 
 
static inline void osmo_store16le_ext(uint16_t x, void *p, uint8_t n)
{
        uint8_t i;
        uint8_t *q = (uint8_t *)p;
        OSMO_ASSERT(n <= sizeof(x));
        for(i = 0; i < n; q[i] = (x >> i * 8) & 0xFF, i++);
}
 
static inline void osmo_store16be_ext(uint16_t x, void *p, uint8_t n)
{
        uint8_t i;
        uint8_t *q = (uint8_t *)p;
        OSMO_ASSERT(n <= sizeof(x));
        for(i = 0; i < n; q[i] = (x >> ((n - 1 - i) * 8)) & 0xFF, i++);
}
 
 
/* Convenience function for most-used cases */
 
 
static inline uint16_t osmo_load16le(const void *p)
{
        return osmo_load16le_ext(p, 16 / 8);
}
 
static inline uint16_t osmo_load16be(const void *p)
{
        return osmo_load16be_ext(p, 16 / 8);
}
 
 
static inline void osmo_store16le(uint16_t x, void *p)
{
        osmo_store16le_ext(x, p, 16 / 8);
}
 
static inline void osmo_store16be(uint16_t x, void *p)
{
        osmo_store16be_ext(x, p, 16 / 8);
}