Function OD_read_1003

301/CO_Emergency.c:158–192

* Custom functions for read/write OD object _OD_statusBits_, optional * * For more information see file CO_ODinterface.h, OD_IO_t. */

 * For more information see file CO_ODinterface.h, OD_IO_t.
 */
static ODR_t
OD_read_1003(OD_stream_t* stream, void* buf, OD_size_t count, OD_size_t* countRead) {
    if ((stream == NULL) || (buf == NULL) || (countRead == NULL) || ((count < 4U) && (stream->subIndex > 0U))
        || (count < 1U)) {
        return ODR_DEV_INCOMPAT;
    }

    CO_EM_t* em = (CO_EM_t*)stream->object;

    if (em->fifoSize < 2U) {
        return ODR_DEV_INCOMPAT;
    }
    if (stream->subIndex == 0U) {
        (void)CO_setUint8(buf, em->fifoCount);

        *countRead = sizeof(uint8_t);
        return ODR_OK;
    } else if (stream->subIndex <= em->fifoCount) {
        /* newest error is reported on subIndex 1 and is stored just behind
         * fifoWrPtr. Get correct index in FIFO buffer. */
        int16_t index = (int16_t)em->fifoWrPtr - (int16_t)stream->subIndex;
        if (index < 0) {
            index += (int16_t)em->fifoSize;
        } else if (index >= (int16_t)(em->fifoSize)) {
            return ODR_DEV_INCOMPAT;
        } else { /* MISRA C 2004 14.10 */
        }
        (void)CO_setUint32(buf, em->fifo[index].msg);

        *countRead = sizeof(uint32_t);
        return ODR_OK;
    } else {
        return ODR_NO_DATA;
    }
}

static ODR_t
OD_write_1003(OD_stream_t* stream, const void* buf, OD_size_t count, OD_size_t* countWritten) {