Function CO_ODF_traceConfig

extra/CO_trace.c:174–240

OD function for accessing _OD_traceConfig_ (index 0x2300+) from SDO server. * For more information see file CO_SDOserver.h. */

/* OD function for accessing _OD_traceConfig_ (index 0x2300+) from SDO server.
 * For more information see file CO_SDOserver.h. */
static CO_SDO_abortCode_t CO_ODF_traceConfig(CO_ODF_arg_t *ODF_arg) {
    CO_trace_t *trace;
    CO_SDO_abortCode_t ret = CO_SDO_AB_NONE;

    trace = (CO_trace_t*) ODF_arg->object;

    switch(ODF_arg->subIndex) {
    case 1:     /* size */
        if(ODF_arg->reading) {
            CO_setUint32(ODF_arg->data, trace->bufferSize);
        }
        break;

    case 2:     /* axisNo (trace enabled if nonzero) */
        if(ODF_arg->reading) {
            uint8_t *value = (uint8_t*) ODF_arg->data;
            if(!trace->enabled) {
                *value = 0;
            }
        }
        else {
            uint8_t *value = (uint8_t*) ODF_arg->data;

            if(*value == 0) {
                trace->enabled = false;
            }
            else if(!trace->enabled) {
                if(trace->bufferSize == 0) {
                    ret = CO_SDO_AB_OUT_OF_MEM;
                }
                else {
                    /* set trace->OD_variable and trace->dt, based on 'map' and 'format' */
                    findVariable(trace);

                    if(trace->OD_variable != NULL) {
                        *trace->value = 0;
                        *trace->minValue = 0;
                        *trace->maxValue = 0;
                        *trace->triggerTime = 0;
                        trace->valuePrev = 0;
                        trace->readPtr = 0;
                        trace->writePtr = 0;
                        trace->enabled = true;
                    }
                    else {
                        ret = CO_SDO_AB_NO_MAP;
                    }
                }
            }
        }
        break;

    case 5:     /* map */
    case 6:     /* format */
        if(!ODF_arg->reading) {
            if(trace->enabled) {
                ret = CO_SDO_AB_INVALID_VALUE;
            }