Function OD_getSub

301/CO_ODinterface.c:176–269

}

ODR_t
OD_getSub(const OD_entry_t* entry, uint8_t subIndex, OD_IO_t* io, bool_t odOrig) {
    if ((entry == NULL) || (entry->odObject == NULL)) {
        return ODR_IDX_NOT_EXIST;
    }
    if (io == NULL) {
        return ODR_DEV_INCOMPAT;
    }

    ODR_t ret = ODR_OK;
    OD_stream_t* stream = &io->stream;

    /* attribute, dataOrig and dataLength, depends on object type */
    switch (entry->odObjectType & (uint8_t)ODT_TYPE_MASK) {
        case ODT_VAR: {
            if (subIndex > 0U) {
                ret = ODR_SUB_NOT_EXIST;
                break;
            }
            CO_PROGMEM OD_obj_var_t* odo = entry->odObject;

            stream->attribute = odo->attribute;
            stream->dataOrig = odo->dataOrig;
            stream->dataLength = odo->dataLength;
            break;
        }
        case ODT_ARR: {
            if (subIndex >= entry->subEntriesCount) {
                ret = ODR_SUB_NOT_EXIST;
                break;
            }
            CO_PROGMEM OD_obj_array_t* odo = entry->odObject;

            if (subIndex == 0U) {
                stream->attribute = odo->attribute0;
                stream->dataOrig = odo->dataOrig0;
                stream->dataLength = 1;
            } else {
                stream->attribute = odo->attribute;
                uint8_t* ptr = odo->dataOrig;
                stream->dataOrig = (ptr == NULL) ? ptr : (ptr + (odo->dataElementSizeof * (uint8_t)(subIndex - 1U)));
                stream->dataLength = odo->dataElementLength;
            }
            break;
        }
        case ODT_REC: {
            CO_PROGMEM OD_obj_record_t* odoArr = entry->odObject;
            CO_PROGMEM OD_obj_record_t* odo = NULL;
            for (uint8_t i = 0; i < entry->subEntriesCount; i++) {
                if (odoArr[i].subIndex == subIndex) {
                    odo = &odoArr[i];
                    break;
                }
            }
            if (odo == NULL) {
                ret = ODR_SUB_NOT_EXIST;
                break;
            }