Function CO_LSSslave_process

305/CO_LSSslave.c:259–427

}

bool_t
CO_LSSslave_process(CO_LSSslave_t* LSSslave) {
    bool_t resetCommunication = false;

    if (CO_FLAG_READ(LSSslave->sendResponse)) {
        uint8_t nid;
        uint8_t errorCode;
        uint8_t errorCodeManuf;
        uint8_t tableSelector;
        uint8_t tableIndex;
        bool_t CANsend = false;
        uint32_t valSw;

        (void)memset(&LSSslave->TXbuff->data[0], 0, sizeof(LSSslave->TXbuff->data));

        switch (LSSslave->service) {
            case CO_LSS_SWITCH_STATE_GLOBAL: {
                /* Node-Id was unconfigured before, now it is configured,
                 * enter the NMT Reset communication autonomously. */
                resetCommunication = true;
                break;
            }
            case CO_LSS_SWITCH_STATE_SEL_SERIAL: {
                LSSslave->TXbuff->data[0] = CO_LSS_SWITCH_STATE_SEL;
                CANsend = true;
                break;
            }
            case CO_LSS_CFG_NODE_ID: {
                nid = LSSslave->CANdata[1];
                errorCode = CO_LSS_CFG_NODE_ID_OK;

                if (CO_LSS_NODE_ID_VALID(nid)) {
                    *LSSslave->pendingNodeID = nid;
                } else {
                    errorCode = CO_LSS_CFG_NODE_ID_OUT_OF_RANGE;
                }

                /* send confirmation */
                LSSslave->TXbuff->data[0] = LSSslave->service;
                LSSslave->TXbuff->data[1] = errorCode;
                /* we do not use spec-error, always 0 */
                CANsend = true;
                break;
            }
            case CO_LSS_CFG_BIT_TIMING: {
                if (LSSslave->pFunctLSScheckBitRate == NULL) {
                    /* setting bit timing is not supported. Drop request */
                    break;
                }

                tableSelector = LSSslave->CANdata[1];
                tableIndex = LSSslave->CANdata[2];
                errorCode = CO_LSS_CFG_BIT_TIMING_OK;
                errorCodeManuf = CO_LSS_CFG_BIT_TIMING_OK;

                if ((tableSelector == 0U) && CO_LSS_BIT_TIMING_VALID(tableIndex)) {
                    uint16_t bit = CO_LSS_bitTimingTableLookup[tableIndex];
                    bool_t bit_rate_supported = LSSslave->pFunctLSScheckBitRate(LSSslave->functLSScheckBitRateObject,