Fix fifo length (issue #66)

Jan Breuer

2016-02-14 fbd16b32739a35ed3d3cf7e9aa4cfb6a75758e46

 libscpi/src/fifo.c

@@ -8,6 +8,7 @@
void fifo_init(scpi_fifo_t * fifo, int16_t * data, int16_t size) {
    fifo->wr = 0;
    fifo->rd = 0;
    fifo->count = 0;
    fifo->data = data;
    fifo->size = size;
}
@@ -19,6 +20,7 @@
void fifo_clear(scpi_fifo_t * fifo) {
    fifo->wr = 0;
    fifo->rd = 0;
    fifo->count = 0;
}

/**
@@ -27,7 +29,7 @@
 * @return
 */
scpi_bool_t fifo_is_empty(scpi_fifo_t * fifo) {
    return fifo->wr == fifo->rd;
    return fifo->count == 0;
}

/**
@@ -36,7 +38,7 @@
 * @return
 */
scpi_bool_t fifo_is_full(scpi_fifo_t * fifo) {
    return fifo->wr == ((fifo->rd + fifo->size - 1) % (fifo->size));
    return fifo->count == fifo->size;
}

/**
@@ -53,7 +55,7 @@

    fifo->data[fifo->wr] = value;
    fifo->wr = (fifo->wr + 1) % (fifo->size);

    fifo->count += 1;
    return TRUE;
}

@@ -74,6 +76,7 @@
    }

    fifo->rd = (fifo->rd + 1) % (fifo->size);
    fifo->count -= 1;

    return TRUE;
}
@@ -95,6 +98,7 @@
    if (value) {
        *value = fifo->data[fifo->wr];
    }
    fifo->count -= 1;

    return TRUE;
}
@@ -106,9 +110,6 @@
 * @return
 */
scpi_bool_t fifo_count(scpi_fifo_t * fifo, int16_t * value) {
    *value = fifo->wr - fifo->rd;
    if (*value < 0) {
        *value += (fifo->size);
    }
    *value = fifo->count;
    return TRUE;
}