HRESULT avcCreateResponsePacket(PB *packetBlock, PB **respPacket, BOOL bNewPayloadSize, uint32 payloadSize)
{
HRESULT hResult = NO_ERROR;
if (bNewPayloadSize)
{
hResult = pbCreateDuplicatePacketWithSize(packetBlock, respPacket, (uint16) payloadSize, NULL, PB_CREATE_AVC_SEND_RSP);
if (hResult != NO_ERROR) return hResult;
}
else
{
hResult = pbCreateDuplicatePacket(packetBlock, respPacket, NULL, PB_CREATE_AVC_SEND_RSP);
if (hResult != NO_ERROR) return hResult;
}
#if 1
pbSwapSrcDstNodeAddr(*respPacket);
#endif
return hResult;
}
/*********************************************************
The tx thread calls this when any transmit queue has one or more packets to transmit.
the priority queue is always checked first and serviced until empty, the
general queue is ignored during bus reset. this allows node handles to be
fixed up after a bus reset, making them transparent to the upper layers,
unless a node has left the bus of course. this routine will call the appropriate
send routine for request or response.
*/
static HRESULT lhlTxSndPacketPend(void)
{
HRESULT hResult = NO_ERROR;
PB* packetBlock = NULL;
PB_HEADER *pHeader = NULL;
uint32 tLabel = 0;
uint32 tCode = 0;
uint32 nodeAddr = 0;
uint32 busGenCurrent = 0;
uint32 busGenPacket = 0;
DO_FOREVER
{
// look for priority packets (non-blocking)
hResult = lhlMsgQueueGetPacketBlock(LHL_QUEUE_PRIORITY, &packetBlock, TC_NO_WAIT);
if (hResult != NO_ERROR) return hResult;
if (pbIsValid(packetBlock))
{
// if bus reset happened, queued requests must be thrown out
briGetCurrentBusGeneration(&busGenCurrent);
pbGetBusGeneration (packetBlock, &busGenPacket);
if (busGenCurrent != busGenPacket)
{
pbSwapSrcDstNodeAddr(packetBlock);
pbSetFinalStatus(packetBlock, E_LHL_BUS_RESET_IN_PROGRESS);
pbPacketDone(packetBlock, PB_DONE_LHL_ATX_SND_PEND_1);
hResult = E_BRI_NEW_BUS_RESET;
sysLogError(hResult, __LINE__, moduleName);
return hResult;
}
}
else
{
if (briInBusReset() == FALSE)
{
// if not in bus reset processing, look for general packets (non-blocking)
hResult = lhlMsgQueueGetPacketBlock(LHL_QUEUE_GENERAL, &packetBlock, TC_NO_WAIT);
if (hResult != NO_ERROR) return hResult;
}
else
{
DO_FOREVER
{
// if in bus reset processing, free for general packets (non-blocking)
hResult = lhlMsgQueueGetPacketBlock(LHL_QUEUE_GENERAL, &packetBlock, TC_NO_WAIT);
if (hResult != NO_ERROR) return hResult;
if (pbIsValid(packetBlock))
{
#if 1
pbSwapSrcDstNodeAddr(packetBlock);
#endif
pbSetFinalStatus(packetBlock, E_LHL_BUS_RESET_IN_PROGRESS);
pbPacketDone(packetBlock, PB_DONE_LHL_ATX_SND_PEND_2);
}
else
{
break; // no more packetBlocks to free
}
}
}
}
if (pbIsValid(packetBlock))
{
briGetCurrentBusGeneration(&busGenCurrent);
pbGetBusGeneration (packetBlock, &busGenPacket);
if (busGenCurrent != busGenPacket)
{
pbSwapSrcDstNodeAddr(packetBlock);
pbSetFinalStatus(packetBlock, E_LHL_BUS_RESET_IN_PROGRESS);
pbPacketDone(packetBlock, PB_DONE_LHL_ATX_SND_PEND_1);
hResult = E_BRI_NEW_BUS_RESET;
sysLogError(hResult, __LINE__, moduleName);
return hResult;
}
hResult = pbGetPacketHeader (packetBlock, &pHeader);
if (hResult != NO_ERROR) return hResult;
hResult = pbGetPacketTLabel (packetBlock, &tLabel);
if (hResult != NO_ERROR) return hResult;
hResult = pbGetPacketDstNodeAddr (packetBlock, &nodeAddr);
if (hResult != NO_ERROR) return hResult;
hResult = lhlPendingTxAdd(tLabel, nodeAddr, packetBlock); // insert before send and remove if send error
if (hResult != NO_ERROR) return hResult;
hResult = context1PostPacket(packetBlock,lhlTxDoneSemID);
if (hResult != NO_ERROR)
{
#if 1
pbSwapSrcDstNodeAddr(packetBlock);
#endif
pbSetFinalStatus(packetBlock, hResult);
pbPacketDone(packetBlock, PB_DONE_LHL_ATX_SND_PEND_3);
}
else
{
// We have now posted the write, the semaphore will be signaled
uint8 matchResponse = FALSE; // error in sending req/rsp - match corresponding type in PendingTx
pbIsResponsePacket(packetBlock, &matchResponse);
hResult = TCSemaphoreWait(lhlTxDoneSemID);
tCode = (pHeader->quadlets[0] & MASK_TCODE) >> SHIFT_TCODE;
lhlTxPacketDoneLLC(tLabel, tCode, nodeAddr, matchResponse);
}
}
else
{
break; // no more packets to send
}
}
/***************************************************************************
Handling of the acknowledge transmitted packet request/response done
*/
static void lhlTxPacketDoneLLC(uint32 tLabel, uint16 tCode, uint32 nodeAddr, uint8 response)
{
HRESULT hResult = NO_ERROR;
PB *pMatchPB = NULL;
uint16 conf;
BOOL bRemoveEntry = TRUE;
uint8 pendingTxType; // ack for sending req/rsp/stm match corresponding type in PendingTx
volatile POSTED_TX_CONTEXT * pContext = &postedTxState.contexts[1];
if ((pContext->txStat & LLC_ASY_TX_CMPLT) == 0)
{
sysLogError(E_LLC_TX_NEVER_COMPLETED, __LINE__, moduleName);
}
conf = (pContext->txStat & LLC_ASY_TX_EVENT_MASK) >> LLC_ASY_TX_EVENT_SHIFT;
// Handling of packet
hResult = lhlPendingTxGetType((PB_PACKETTYPE) tCode, &pendingTxType);
if (hResult != NO_ERROR) return;
if (response)
{
// response acked by destination
bRemoveEntry = TRUE;
}
else
{
// OHCI_ACK_PENDING: succes, leave the packet in the pending list to be matched with the response packet
// o.w. the transaction failed at the link layer, this status will be passed to the callback
bRemoveEntry = (conf != ACK_1394_PENDING);
}
if (bRemoveEntry)
{
hResult = lhlPendingTxMatch(tLabel, nodeAddr, pendingTxType, &pMatchPB, bRemoveEntry);
if (hResult == NO_ERROR)
{
// either packet acked by destination, or error returned, or request expects no response
if (pbIsValid(pMatchPB))
{
HRESULT hResultFinal = NO_ERROR;
if (conf != ACK_1394_COMPLETE &&
conf != LLC_EVENT_INIT) // Termination of async packet with no ack (e.g. bcast, phy, async stream)
{
hResultFinal = (HRESULT) (E_LHL_CONF_BASE + conf);
SYS_DEBUG(SYSDEBUG_TRACE_PACKETS, "lhlATx SndPacketDone: ack error for %s call CB (conf: %i)\n\r", (response) ? "rsp" : "req", conf);
}
else
{
SYS_DEBUG(SYSDEBUG_TRACE_PACKETS, "lhlATx SndPacketDone: ack complete for %s call CB\n\r", (response) ? "rsp" : "req" );
}
pbSwapSrcDstNodeAddr(pMatchPB);
pbSetFinalStatus(pMatchPB, hResultFinal);
pbPacketDone(pMatchPB, PB_DONE_LHL_ATX_SND_DONE);
}
else
{
hResult = E_LHL_INVALID_PB;
sysLogError(hResult, __LINE__, moduleName);
}
}
else
{
SYS_DEBUG(SYSDEBUG_TRACE_PACKETS, "lhlATx SndPacketDone: match not found for %s\n\r", (response) ? "rsp" : "req" );
}
}
}
