snapclient/components/libbuffer/buffer.c

#include "buffer.h"

void buffer_read_init(read_buffer_t *buffer, const char *data, size_t size) {
    buffer->buffer = data;
    buffer->size = size;
    buffer->index = 0;
}

void buffer_write_init(write_buffer_t *buffer, char *data, size_t size) {
    buffer->buffer = data;
    buffer->size = size;
    buffer->index = 0;
}

int buffer_read_buffer(read_buffer_t *buffer, char *data, size_t size) {
    int i;

    if (buffer->size - buffer->index < size) {
        return 1;
    }

    for (i = 0; i < size; i++) {
        data[i] = buffer->buffer[buffer->index++];
    }

    return 0;
}

int buffer_write_buffer(write_buffer_t *buffer, const char *data, size_t size) {
    int i;

    if (buffer->size - buffer->index < size) {
        return 1;
    }

    for (i = 0; i < size; i++) {
        buffer->buffer[buffer->index++] = data[i];
    }

    return 0;
}

int buffer_read_uint32(read_buffer_t *buffer, uint32_t *data) {
    if (buffer->size - buffer->index < sizeof(uint32_t)) {
        return 1;
    }

    *data = buffer->buffer[buffer->index++] & 0xff;
    *data |= (buffer->buffer[buffer->index++] & 0xff) << 8;
    *data |= (buffer->buffer[buffer->index++] & 0xff) << 16;
    *data |= (buffer->buffer[buffer->index++] & 0xff) << 24;
    return 0;
}

int buffer_write_uint32(write_buffer_t *buffer, uint32_t data) {
    if (buffer->size - buffer->index < sizeof(uint32_t)) {
        return 1;
    }

    buffer->buffer[buffer->index++] = data & 0xff;
    buffer->buffer[buffer->index++] = (data >> 8) & 0xff;
    buffer->buffer[buffer->index++] = (data >> 16) & 0xff;
    buffer->buffer[buffer->index++] = (data >> 24) & 0xff;
    return 0;
}

int buffer_read_uint16(read_buffer_t *buffer, uint16_t *data) {
    if (buffer->size - buffer->index < sizeof(uint16_t)) {
        return 1;
    }

    *data = buffer->buffer[buffer->index++] & 0xff;
    *data |= (buffer->buffer[buffer->index++] & 0xff) << 8;
    return 0;
}

int buffer_write_uint16(write_buffer_t *buffer, uint16_t data) {
    if (buffer->size - buffer->index < sizeof(uint16_t)) {
        return 1;
    }

    buffer->buffer[buffer->index++] = data & 0xff;
    buffer->buffer[buffer->index++] = (data >> 8) & 0xff;
    return 0;
}

int buffer_read_uint8(read_buffer_t *buffer, uint8_t *data) {
    if (buffer->size - buffer->index < sizeof(uint8_t)) {
        return 1;
    }

    *data = buffer->buffer[buffer->index++] & 0xff;
    return 0;
}

int buffer_write_uint8(write_buffer_t *buffer, uint8_t data) {
    if (buffer->size - buffer->index < sizeof(uint8_t)) {
        return 1;
    }

    buffer->buffer[buffer->index++] = data & 0xff;
    return 0;
}

int buffer_read_int32(read_buffer_t *buffer, int32_t *data) {
    if (buffer->size - buffer->index < sizeof(int32_t)) {
        return 1;
    }

    *data = buffer->buffer[buffer->index++] & 0xff;
    *data |= (buffer->buffer[buffer->index++] & 0xff) << 8;
    *data |= (buffer->buffer[buffer->index++] & 0xff) << 16;
    *data |= (buffer->buffer[buffer->index++] & 0xff) << 24;
    return 0;
}

int buffer_write_int32(write_buffer_t *buffer, int32_t data) {
    if (buffer->size - buffer->index < sizeof(int32_t)) {
        return 1;
    }

    buffer->buffer[buffer->index++] = data & 0xff;
    buffer->buffer[buffer->index++] = (data >> 8) & 0xff;
    buffer->buffer[buffer->index++] = (data >> 16) & 0xff;
    buffer->buffer[buffer->index++] = (data >> 24) & 0xff;
    return 0;
}

int buffer_read_int16(read_buffer_t *buffer, int16_t *data) {
    if (buffer->size - buffer->index < sizeof(int16_t)) {
        return 1;
    }

    *data = buffer->buffer[buffer->index++] & 0xff;
    *data |= (buffer->buffer[buffer->index++] & 0xff) << 8;
    return 0;
}

int buffer_write_int16(write_buffer_t *buffer, int16_t data) {
    if (buffer->size - buffer->index < sizeof(int16_t)) {
        return 1;
    }

    buffer->buffer[buffer->index++] = data & 0xff;
    buffer->buffer[buffer->index++] = (data >> 8) & 0xff;
    return 0;
}

int buffer_read_int8(read_buffer_t *buffer, int8_t *data) {
    if (buffer->size - buffer->index < sizeof(int8_t)) {
        return 1;
    }

    *data = buffer->buffer[buffer->index++] & 0xff;
    return 0;
}

int buffer_write_int8(write_buffer_t *buffer, int8_t data) {
    if (buffer->size - buffer->index < sizeof(int8_t)) {
        return 1;
    }

    buffer->buffer[buffer->index++] = data & 0xff;
    return 0;
}