ble_bufops.h

Go to the documentation of this file.

 
#include <stdint.h>
#include <string.h>
 
#ifndef BLE_BUFOPS_H_
#define BLE_BUFOPS_H_
 
__STATIC_INLINE uint8_t get_u8(const uint8_t *buffer)
{
        return buffer[0];
}
 
__STATIC_INLINE uint16_t get_u16(const uint8_t *buffer)
{
        return (buffer[0]) | (buffer[1] << 8);
}
 
__STATIC_INLINE uint32_t get_u32(const uint8_t *buffer)
{
        return (buffer[0]) | (buffer[1] << 8) | (buffer[2] << 16) | (buffer[3] << 24);
}
 
__STATIC_INLINE uint8_t get_u8_inc(const uint8_t **buffer)
{
        const uint8_t *b = *buffer;
 
        (*buffer) += sizeof(uint8_t);
 
        return get_u8(b);
}
 
__STATIC_INLINE uint16_t get_u16_inc(const uint8_t **buffer)
{
        const uint8_t *b = *buffer;
 
        (*buffer) += sizeof(uint16_t);
 
        return get_u16(b);
}
 
__STATIC_INLINE uint32_t get_u32_inc(const uint8_t **buffer)
{
        const uint8_t *b = *buffer;
 
        (*buffer) += sizeof(uint32_t);
 
        return get_u32(b);
}
 
__STATIC_INLINE void put_u8(uint8_t *buffer, uint8_t value)
{
        buffer[0] = value;
}
 
__STATIC_INLINE void put_u16(uint8_t *buffer, uint16_t value)
{
        buffer[0] = value;
        buffer[1] = value >> 8;
}
 
__STATIC_INLINE void put_u32(uint8_t *buffer, uint32_t value)
{
        buffer[0] = value;
        buffer[1] = value >> 8;
        buffer[2] = value >> 16;
        buffer[3] = value >> 24;
}
 
__STATIC_INLINE void put_u8_inc(uint8_t **buffer, uint8_t value)
{
        uint8_t *b = *buffer;
 
        (*buffer) += sizeof(uint8_t);
 
        put_u8(b, value);
}
 
__STATIC_INLINE void put_u16_inc(uint8_t **buffer, uint16_t value)
{
        uint8_t *b = *buffer;
 
        (*buffer) += sizeof(uint16_t);
 
        put_u16(b, value);
}
 
__STATIC_INLINE void put_u32_inc(uint8_t **buffer, uint32_t value)
{
        uint8_t *b = *buffer;
 
        (*buffer) += sizeof(uint32_t);
 
        put_u32(b, value);
}
 
__STATIC_INLINE void put_data_inc(uint8_t **buffer, uint16_t length, const void *data)
{
        memcpy(*buffer, data, length);
 
        (*buffer) += length;
}
 
__STATIC_INLINE void put_str_inc(uint8_t **buffer, const char *str)
{
        put_data_inc(buffer, strlen(str), str);
        put_u8_inc(buffer, '\0');
}
 
#endif /* BLE_BUFOPS_H_ */