Function CO_fifo_write

301/CO_fifo.c:78–116

Circular FIFO buffer example for fifo->bufSize = 7 (usable size = 6): ****** * * * 0 * * * * * * 1 rp==wp readPtr writePtr * * * 2 * * * * * *

 *        buffer      in buff       in buff       full                        *
 ******************************************************************************/
size_t
CO_fifo_write(CO_fifo_t* fifo, const uint8_t* buf, size_t count, uint16_t* crc) {
    size_t i;
    uint8_t* bufDest;

    if ((fifo == NULL) || (fifo->buf == NULL) || (buf == NULL)) {
        return 0;
    }

    bufDest = &fifo->buf[fifo->writePtr];
    for (i = count; i > 0U; i--) {
        size_t writePtrNext = fifo->writePtr + 1U;

        /* is circular buffer full */
        if ((writePtrNext == fifo->readPtr) || ((writePtrNext == fifo->bufSize) && (fifo->readPtr == 0U))) {
            break;
        }

        *bufDest = *buf;

#if ((CO_CONFIG_FIFO)&CO_CONFIG_FIFO_CRC16_CCITT) != 0
        if (crc != NULL) {
            crc16_ccitt_single(crc, *buf);
        }
#endif

        /* increment variables */
        if (writePtrNext == fifo->bufSize) {
            fifo->writePtr = 0;
            bufDest = &fifo->buf[0];
        } else {
            fifo->writePtr++;
            bufDest++;
        }
        buf++;
    }

    return count - i;
}

size_t
CO_fifo_read(CO_fifo_t* fifo, uint8_t* buf, size_t count, bool_t* eof) {