Function OD_write_1016

301/CO_HBconsumer.c:76–101

* Custom function for writing OD object "Consumer heartbeat time" * * 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_write_1016(OD_stream_t* stream, const void* buf, OD_size_t count, OD_size_t* countWritten) {
    CO_HBconsumer_t* HBcons;

    if (stream == NULL) {
        return ODR_DEV_INCOMPAT;
    }
    HBcons = stream->object;

    if ((buf == NULL) || (stream->subIndex < 1U)
        || (stream->subIndex > HBcons->numberOfMonitoredNodes) || (count != sizeof(uint32_t))
        || (countWritten == NULL)) {
        return ODR_DEV_INCOMPAT;
    }

    uint32_t val = CO_getUint32(buf);
    uint8_t nodeId = (uint8_t)((val >> 16) & 0xFFU);
    uint16_t consumer_time = (uint16_t)(val & 0xFFFFU);
    CO_ReturnError_t ret = CO_HBconsumer_initEntry(HBcons, stream->subIndex - 1U, nodeId, consumer_time);
    if (ret != CO_ERROR_NO) {
        return ODR_PAR_INCOMPAT;
    }

    /* write value to the original location in the Object Dictionary */
    return OD_writeOriginal(stream, buf, count, countWritten);
}
#endif

CO_ReturnError_t