Subversion Repositories Code-Repo

#include "buffer.h"
#include "maindefs.h"

#pragma udata buffer1
static unsigned char buffer1[256];
#pragma udata

static BUFFER_DATA *buffer_data;

void buffer_init() {
    buffer_data->index_read = 0;
    buffer_data->index_write = 0;
    buffer_data->stored_length = 0;
}

char buffer_insert(unsigned char length, unsigned char *msg) {
    unsigned char i;

    // Make sure we have enough space to store message
    if (length > BUFFER_SIZE - buffer_data->stored_length) {
        DBG_PRINT_BUFFER("Buffer: (ERROR) Not enough free space for insert\r\n");
        return -1;
    }

    // Update the amount of used space in the buffer
    buffer_data->stored_length += length;

    // Copy data from msg to buffer
    for (i = 0; i < length; i++) {
        buffer1[buffer_data->index_write] = *(msg + i);
        buffer_data->index_write++; // Will automatically overflow to 0
    }

    return 0;
}

char buffer_read(unsigned char length, unsigned char *dest) {
    unsigned char i;

    // Make sure requested data is less than size of stored data
    if (length > buffer_data->stored_length) {
        DBG_PRINT_BUFFER("Buffer: (ERROR) Read length exceedes stored length\r\n");
        return -1;
    }

    // Update the amount of used space in the buffer
    buffer_data->stored_length -= length;

    // Copy data from buffer to dest
    for (i = 0; i < length; i++) {
        *(dest + i) = buffer1[buffer_data->index_read];
        buffer_data->index_read++;  // Will automatically overflow to 0
    }

    return 0;
}