#include <isotp.h>

Inheritance diagram for CanStreamerState:

Collaboration diagram for CanStreamerState:

[legend]

Public Member Functions
	CanStreamerState (ICanTransmitter p_txTransport, ICanReceiver p_rxTransport, size_t p_busIndex, uint32_t p_rxFrameId, uint32_t p_txFrameId)

void	reset ()

int	sendFrame (const IsoTpFrameHeader &header, const uint8_t *data, int num, can_sysinterval_t timeout)

int	receiveFrame (const CANRxFrame &rxmsg, uint8_t *buf, int num, can_sysinterval_t timeout)

int	getDataFromFifo (uint8_t *rxbuf, size_t &numBytes)

int	sendDataTimeout (const uint8_t *txbuf, int numBytes, can_sysinterval_t timeout)

can_msg_t	streamAddToTxTimeout (size_t np, const uint8_t txbuf, can_sysinterval_t timeout)

can_msg_t	streamFlushTx (can_sysinterval_t timeout)

can_msg_t	streamReceiveTimeout (size_t np, uint8_t rxbuf, can_sysinterval_t timeout)

Public Member Functions inherited from IsoTpBase
	IsoTpBase (ICanTransmitter *p_txTransport, size_t p_busIndex, uint32_t p_rxFrameId, uint32_t p_txFrameId)

int	sendFrame (const IsoTpFrameHeader &header, const uint8_t *data, int num, can_sysinterval_t timeout)

can_msg_t	transmit (CanTxMessage &ctfp, can_sysinterval_t timeout)

Data Fields
fifo_buffer< uint8_t, CAN_FIFO_BUF_SIZE >	rxFifoBuf

fifo_buffer< uint8_t, CAN_FIFO_BUF_SIZE >	txFifoBuf

int	waitingForNumBytes = 0

int	waitingForFrameIndex = 0

ICanReceiver *	rxTransport

bool	isComplete {}

Data Fields inherited from IsoTpBase
size_t	isoHeaderByteIndex = 0

ICanTransmitter *	txTransport

size_t	busIndex

uint32_t	rxFrameId

uint32_t	txFrameId

Detailed Description

Definition at line 133 of file isotp.h.

Constructor & Destructor Documentation

◆ CanStreamerState()

CanStreamerState::CanStreamerState	(	ICanTransmitter *	p_txTransport,
		ICanReceiver *	p_rxTransport,
		size_t	p_busIndex,
		uint32_t	p_rxFrameId,
		uint32_t	p_txFrameId
	)

inline

Definition at line 152 of file isotp.h.

        :
        IsoTpBase(p_txTransport, p_busIndex, p_rxFrameId, p_txFrameId),
        rxTransport(p_rxTransport)
    {}

Member Function Documentation

◆ getDataFromFifo()

int CanStreamerState::getDataFromFifo	(	uint8_t *	rxbuf,
		size_t &	numBytes
	)

Definition at line 253 of file isotp.cpp.

                                                                      {
    if (rxFifoBuf.isEmpty())
        return 0;
    int numReadFromFifo = minI(numBytes, rxFifoBuf.getCount());
    // move bytes from the FIFO buffer
    int i;
    for (i = 0; !rxFifoBuf.isEmpty() && i < numReadFromFifo; i++) {
        rxbuf[i] = rxFifoBuf.get();
        numBytes--;
    }
    return i;
}

Referenced by streamReceiveTimeout().

Here is the caller graph for this function:

◆ receiveFrame()

int CanStreamerState::receiveFrame	(	const CANRxFrame &	rxmsg,
		uint8_t *	buf,
		int	num,
		can_sysinterval_t	timeout
	)

performance optimization specific to TS over CAN tunnelling TODO: refactor into child class if we ever choose to revive this logic #if defined(TS_CAN_DEVICE_SHORT_PACKETS_IN_ONE_FRAME) if (frameType == ISO_TP_FRAME_SINGLE) { restore the CRC on the whole packet uint32_t crc = crc32((void *) srcBuf, numBytesAvailable); we need a separate buffer for crc because srcBuf may not be word-aligned for direct copy uint8_t crcBuffer[sizeof(uint32_t)]; (uint32_t *) (crcBuffer) = SWAP_UINT32(crc);

now set the packet size (uint16_t *) shortCrcPacketStagingArea = SWAP_UINT16(numBytesAvailable); copy the data if (numBytesAvailable > 0) memcpy(shortCrcPacketStagingArea + sizeof(uint16_t), srcBuf, numBytesAvailable); copy the crc to the end memcpy(shortCrcPacketStagingArea + sizeof(uint16_t) + numBytesAvailable, crcBuffer, sizeof(crcBuffer));

use the reconstructed tmp buffer as a source buffer srcBuf = shortCrcPacketStagingArea; we added the 16-bit size & 32-bit crc bytes numBytesAvailable += sizeof(uint16_t) + sizeof(crcBuffer); } #endif

Definition at line 64 of file isotp.cpp.

                                                                                                                                      {
    if (rxmsg.DLC < 1 + isoHeaderByteIndex)
        return 0;
    engine->pauseCANdueToSerial = true;
    int frameType = (rxmsg.data8[isoHeaderByteIndex] >> 4) & 0xf;
    if (engineConfiguration->verboseIsoTp) {
      efiPrintf("receiveFrame frameType=%d", frameType);
#if EFI_PROD_CODE
      printCANRxFrame(-1, rxmsg);
#endif // EFI_PROD_CODE
    }
    int numBytesAvailable, frameIdx;
    const uint8_t *srcBuf;
    switch (frameType) {
    case ISO_TP_FRAME_SINGLE:
        numBytesAvailable = rxmsg.data8[isoHeaderByteIndex] & 0xf;
        this->waitingForNumBytes = numBytesAvailable;
        srcBuf = rxmsg.data8 + 1 + isoHeaderByteIndex;
        break;
    case ISO_TP_FRAME_FIRST:
        this->waitingForNumBytes = ((rxmsg.data8[isoHeaderByteIndex] & 0xf) << 8) | rxmsg.data8[isoHeaderByteIndex + 1];
        this->waitingForFrameIndex = 1;
        numBytesAvailable = minI(this->waitingForNumBytes, 6 - isoHeaderByteIndex);
        srcBuf = rxmsg.data8 + 2 + isoHeaderByteIndex;
        if (rxTransport) {
            rxTransport->onTpFirstFrame(); // used to send flow control message
        }
        break;
    case ISO_TP_FRAME_CONSECUTIVE:
        frameIdx = rxmsg.data8[isoHeaderByteIndex] & 0xf;
        if (this->waitingForNumBytes < 0 || this->waitingForFrameIndex != frameIdx) {
            // todo: that's an abnormal situation, and we probably should react?
            return 0;
        }
        numBytesAvailable = minI(this->waitingForNumBytes, 7 - isoHeaderByteIndex);
        srcBuf = rxmsg.data8 + 1 + isoHeaderByteIndex;
        this->waitingForFrameIndex = (this->waitingForFrameIndex + 1) & 0xf;
        break;
    case ISO_TP_FRAME_FLOW_CONTROL:
        // todo: currently we just ignore the FC frame
        return 0;
    default:
        // bad frame type
        return 0;
    }
 
/** performance optimization specific to TS over CAN tunnelling
TODO: refactor into child class if we ever choose to revive this logic
#if defined(TS_CAN_DEVICE_SHORT_PACKETS_IN_ONE_FRAME)
    if (frameType == ISO_TP_FRAME_SINGLE) {
        // restore the CRC on the whole packet
        uint32_t crc = crc32((void *) srcBuf, numBytesAvailable);
        // we need a separate buffer for crc because srcBuf may not be word-aligned for direct copy
        uint8_t crcBuffer[sizeof(uint32_t)];
        *(uint32_t *) (crcBuffer) = SWAP_UINT32(crc);
 
        // now set the packet size
        *(uint16_t *) shortCrcPacketStagingArea = SWAP_UINT16(numBytesAvailable);
        // copy the data
        if (numBytesAvailable > 0)
            memcpy(shortCrcPacketStagingArea + sizeof(uint16_t), srcBuf, numBytesAvailable);
        // copy the crc to the end
        memcpy(shortCrcPacketStagingArea + sizeof(uint16_t) + numBytesAvailable, crcBuffer, sizeof(crcBuffer));
 
        // use the reconstructed tmp buffer as a source buffer
        srcBuf = shortCrcPacketStagingArea;
        // we added the 16-bit size & 32-bit crc bytes
        numBytesAvailable += sizeof(uint16_t) + sizeof(crcBuffer);
    }
#endif *//* TS_CAN_DEVICE_SHORT_PACKETS_IN_ONE_FRAME */
 
    int numBytesToCopy = minI(availableAtBuffer, numBytesAvailable);
    if (destinationBuff != nullptr) {
        memcpy(destinationBuff, srcBuf, numBytesToCopy);
    }
    srcBuf += numBytesToCopy;
    waitingForNumBytes -= numBytesAvailable;
    isComplete = (waitingForNumBytes == 0);
    numBytesAvailable -= numBytesToCopy;
    // if there are some more bytes left, we save them for the next time
    for (int i = 0; i < numBytesAvailable; i++) {
        rxFifoBuf.put(srcBuf[i]);
    }
 
    // according to the specs, we need to acknowledge the received multi-frame start frame
    if (frameType == ISO_TP_FRAME_FIRST) {
        IsoTpFrameHeader header;
        header.frameType = ISO_TP_FRAME_FLOW_CONTROL;
        header.fcFlag = 0;          // = "continue to send"
        header.blockSize = 0;       // = the remaining "frames" to be sent without flow control or delay
        header.separationTime = 0;  // = wait 0 milliseconds, send immediately
        IsoTpBase::sendFrame(header, nullptr, 0, timeout);
    }
 
    return numBytesToCopy;
}

Referenced by sendDataTimeout(), and streamReceiveTimeout().

Here is the call graph for this function:

Here is the caller graph for this function:

◆ reset()

void CanStreamerState::reset ( )

Definition at line 161 of file isotp.cpp.

                             {
  waitingForNumBytes = 0;
  waitingForFrameIndex = 0;
  isComplete = false;
}

◆ sendDataTimeout()

int CanStreamerState::sendDataTimeout	(	const uint8_t *	txbuf,
		int	numBytes,
		can_sysinterval_t	timeout
	)

Definition at line 167 of file isotp.cpp.

                                                                                                   {
    int offset = 0;
 
    if (engineConfiguration->verboseIsoTp) {
        PRINT("*** INFO: sendDataTimeout %d" PRINT_EOL, numBytes);
    }
 
    if (numBytes < 1)
        return 0;
 
    // 1 frame
    if (numBytes <= 7 - isoHeaderByteIndex) {
        IsoTpFrameHeader header;
        header.frameType = ISO_TP_FRAME_SINGLE;
        header.numBytes = numBytes;
        return IsoTpBase::sendFrame(header, txbuf, numBytes, timeout);
    }
 
    // multiple frames
 
    // send the first header frame (FF)
    IsoTpFrameHeader header;
    header.frameType = ISO_TP_FRAME_FIRST;
    header.numBytes = numBytes;
    int numSent = IsoTpBase::sendFrame(header, txbuf + offset, numBytes, timeout);
    offset += numSent;
    numBytes -= numSent;
    int totalNumSent = numSent;
 
    // get a flow control (FC) frame
#if !EFI_UNIT_TEST // todo: add FC to unit-tests?
    CANRxFrame rxmsg;
    for (size_t numFcReceived = 0; ; numFcReceived++) {
        if (rxTransport->receive(&rxmsg, timeout) != CAN_MSG_OK) {
#ifdef SERIAL_CAN_DEBUG
            PRINT("*** ERROR: CAN Flow Control frame not received" PRINT_EOL);
#endif /* SERIAL_CAN_DEBUG */
            //warning(ObdCode::CUSTOM_ERR_CAN_COMMUNICATION, "CAN Flow Control frame not received");
            return 0;
        }
        receiveFrame(rxmsg, nullptr, 0, timeout);
        uint8_t frameType = (rxmsg.data8[isoHeaderByteIndex] >> 4) & 0xf;
        uint8_t flowStatus = rxmsg.data8[isoHeaderByteIndex] & 0xf;
        // if something is not ok
        if ((frameType != ISO_TP_FRAME_FLOW_CONTROL) || (flowStatus != CAN_FLOW_STATUS_OK)) {
            // if the receiver is not ready yet and asks to wait for the next FC frame (give it 3 attempts)
            if ((frameType == ISO_TP_FRAME_FLOW_CONTROL) && (flowStatus == CAN_FLOW_STATUS_WAIT_MORE) && (numFcReceived < 3)) {
                continue;
            }
#ifdef SERIAL_CAN_DEBUG
            efiPrintf("*** ERROR: CAN Flow Control mode not supported");
#endif /* SERIAL_CAN_DEBUG */
            //warning(ObdCode::CUSTOM_ERR_CAN_COMMUNICATION, "CAN Flow Control mode not supported");
            return 0;
        }
        uint8_t blockSize = rxmsg.data8[isoHeaderByteIndex + 1];
        uint8_t minSeparationTime = rxmsg.data8[isoHeaderByteIndex + 2];
        if (blockSize != 0 || minSeparationTime != 0) {
            // todo: process other Flow Control fields (see ISO 15765-2)
#ifdef SERIAL_CAN_DEBUG
            efiPrintf("*** ERROR: CAN Flow Control fields not supported");
#endif /* SERIAL_CAN_DEBUG */
            //warning(ObdCode::CUSTOM_ERR_CAN_COMMUNICATION, "CAN Flow Control fields not supported");
        }
        break;
    }
#endif /* EFI_UNIT_TEST */
 
    // send the rest of the data
    int idx = 1;
    while (numBytes > 0) {
        int len = minI(numBytes, 7 - isoHeaderByteIndex);
        // send the consecutive frames
        header.frameType = ISO_TP_FRAME_CONSECUTIVE;
        header.index = ((idx++) & 0x0f);
        header.numBytes = len;
        numSent = IsoTpBase::sendFrame(header, txbuf + offset, len, timeout);
        if (numSent < 1)
            break;
        totalNumSent += numSent;
        offset += numSent;
        numBytes -= numSent;
    }
    return totalNumSent;
}

Referenced by streamAddToTxTimeout(), and streamFlushTx().

Here is the call graph for this function:

Here is the caller graph for this function:

◆ sendFrame()

int CanStreamerState::sendFrame	(	const IsoTpFrameHeader &	header,
		const uint8_t *	data,
		int	num,
		can_sysinterval_t	timeout
	)

◆ streamAddToTxTimeout()

can_msg_t CanStreamerState::streamAddToTxTimeout	(	size_t *	np,
		const uint8_t *	txbuf,
		can_sysinterval_t	timeout
	)

Definition at line 266 of file isotp.cpp.

                                                                                                            {
    int numBytes = *np;
    int offset = 0;
 
    if (engineConfiguration->verboseIsoTp) {
        PRINT("*** INFO: streamAddToTxTimeout adding %d, in buffer %d" PRINT_EOL, numBytes, txFifoBuf.getCount());
    }
 
    // we send here only if the TX FIFO buffer is getting overflowed
    while (numBytes >= txFifoBuf.getSize() - txFifoBuf.getCount()) {
        int numBytesToAdd = txFifoBuf.getSize() - txFifoBuf.getCount();
        txFifoBuf.put(txbuf + offset, numBytesToAdd);
        int numSent = sendDataTimeout((const uint8_t *)txFifoBuf.getElements(), txFifoBuf.getCount(), timeout);
 
        if (engineConfiguration->verboseIsoTp) {
            PRINT("*** INFO: streamAddToTxTimeout numBytesToAdd %d / numSent %d / numBytes %d" PRINT_EOL, numBytesToAdd, numSent, numBytes);
        }
 
        if (numSent < 1)
            break;
        txFifoBuf.clear();
        offset += numBytesToAdd;
        numBytes -= numBytesToAdd;
    }
 
    if (engineConfiguration->verboseIsoTp) {
        PRINT("*** INFO: streamAddToTxTimeout remaining goes to buffer %d" PRINT_EOL, numBytes);
    }
 
    // now we put the rest on hold
    txFifoBuf.put(txbuf + offset, numBytes);
 
 
    if (engineConfiguration->verboseIsoTp) {
        PRINT("*** INFO: in buffer %d" PRINT_EOL, txFifoBuf.getCount());
    }
 
    return CAN_MSG_OK;
}

Referenced by canStreamAddToTxTimeout().

Here is the call graph for this function:

Here is the caller graph for this function:

◆ streamFlushTx()

can_msg_t CanStreamerState::streamFlushTx ( can_sysinterval_t timeout )

Definition at line 306 of file isotp.cpp.

                                                                   {
    int numSent = sendDataTimeout((const uint8_t *)txFifoBuf.getElements(), txFifoBuf.getCount(), timeout);
    if (numSent != txFifoBuf.getCount()) {
        //warning(ObdCode::CUSTOM_ERR_CAN_COMMUNICATION, "CAN sendDataTimeout() problems");
    }
    txFifoBuf.clear();
 
    return CAN_MSG_OK;
}

Here is the call graph for this function:

◆ streamReceiveTimeout()

can_msg_t CanStreamerState::streamReceiveTimeout	(	size_t *	np,
		uint8_t *	rxbuf,
		can_sysinterval_t	timeout
	)

Definition at line 316 of file isotp.cpp.

                                                                                                      {
    size_t availableBufferSpace = *np;
 
    // first, fill the data from the stored buffer (saved from the previous CAN frame)
    int receivedSoFar = getDataFromFifo(rxbuf, availableBufferSpace);
 
    // if even more data is needed, then we receive more CAN frames
    while (availableBufferSpace > 0) {
        CANRxFrame rxmsg;
        if (rxTransport->receive(&rxmsg, timeout) == CAN_MSG_OK) {
            int numReceived = receiveFrame(rxmsg, rxbuf + receivedSoFar, availableBufferSpace, timeout);
 
            if (numReceived < 1)
                break;
            availableBufferSpace -= numReceived;
            receivedSoFar += numReceived;
        } else {
            break;
        }
    }
    *np -= availableBufferSpace;
 
#ifdef SERIAL_CAN_DEBUG
    efiPrintf("* ret: %d %d (%d)", i, *np, availableBufferSpace);
    for (int j = 0; j < receivedSoFar; j++) {
        efiPrintf("* [%d]: %02x", j, rxbuf[j]);
    }
#endif /* SERIAL_CAN_DEBUG */
 
    return CAN_MSG_OK;
}

Here is the call graph for this function:

Field Documentation

◆ isComplete

bool CanStreamerState::isComplete {}

Definition at line 158 of file isotp.h.

158{};

Referenced by receiveFrame(), and reset().

◆ rxFifoBuf

fifo_buffer<uint8_t, CAN_FIFO_BUF_SIZE> CanStreamerState::rxFifoBuf

Definition at line 136 of file isotp.h.

Referenced by getDataFromFifo(), and receiveFrame().

◆ rxTransport

ICanReceiver* CanStreamerState::rxTransport

Definition at line 149 of file isotp.h.

Referenced by receiveFrame(), sendDataTimeout(), and streamReceiveTimeout().

◆ txFifoBuf

fifo_buffer<uint8_t, CAN_FIFO_BUF_SIZE> CanStreamerState::txFifoBuf

Definition at line 137 of file isotp.h.

Referenced by streamAddToTxTimeout(), and streamFlushTx().

◆ waitingForFrameIndex

int CanStreamerState::waitingForFrameIndex = 0

Definition at line 147 of file isotp.h.

Referenced by receiveFrame(), and reset().

◆ waitingForNumBytes

int CanStreamerState::waitingForNumBytes = 0

Definition at line 146 of file isotp.h.

Referenced by receiveFrame(), and reset().

The documentation for this class was generated from the following files:

controllers/can/isotp/isotp.h
controllers/can/isotp/isotp.cpp

Public Member Functions

Data Fields

Detailed Description

Constructor & Destructor Documentation

◆ CanStreamerState()

Member Function Documentation

◆ getDataFromFifo()

◆ receiveFrame()

◆ reset()

◆ sendDataTimeout()

◆ sendFrame()

◆ streamAddToTxTimeout()

◆ streamFlushTx()

◆ streamReceiveTimeout()

Field Documentation

◆ isComplete

◆ rxFifoBuf

◆ rxTransport

◆ txFifoBuf

◆ waitingForFrameIndex

◆ waitingForNumBytes