stv0g/embeddedsw
1
0
Fork 0
Code Issues Pull requests Releases Wiki Activity

dp: rx: mst: Added function to handle MST sideband message requests.

Browse source 
Signed-off-by: Andrei-Liviu Simion <andrei.simion@xilinx.com>
This commit is contained in:
Andrei-Liviu Simion 2015-04-30 18:23:18 -07:00 • committed by Nava kishore Manne
parent 7e11d30a1a
commit 2ff38d18fb
2 changed files with 91 additions and 0 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

1
XilinxProcessorIPLib/drivers/dp/src/xdp.h
View file

@ -1046,6 +1046,7 @@ void XDp_TxWriteGuid(XDp *InstancePtr, u8 LinkCountTotal, u8 *RelativeAddress,
u32 Guid[4]);
void XDp_TxGetGuid(XDp *InstancePtr, u8 LinkCountTotal, u8 *RelativeAddress,
u32 *Guid);
u32 XDp_RxHandleDownReq(XDp *InstancePtr);
XDp_RxIicMapEntry *XDp_RxGetIicMapEntry(XDp *InstancePtr, u8 PortNum,
u8 IicAddress);
u32 XDp_RxSetIicMapEntry(XDp *InstancePtr, u8 PortNum, u8 IicAddress,

90
XilinxProcessorIPLib/drivers/dp/src/xdp_mst.c
View file

@ -172,6 +172,7 @@ static void XDp_TxGetDeviceInfoFromSbMsgLinkAddress(
static u32 XDp_TxGetFirstAvailableTs(XDp *InstancePtr, u8 *FirstTs);
static u32 XDp_TxSendActTrigger(XDp *InstancePtr);
static u32 XDp_SendSbMsgFragment(XDp *InstancePtr, XDp_SidebandMsg *Msg);
static void XDp_RxReadDownReq(XDp *InstancePtr, XDp_SidebandMsg *Msg);
static u32 XDp_TxReceiveSbMsg(XDp *InstancePtr, XDp_SidebandReply *SbReply);
static u32 XDp_TxWaitSbReply(XDp *InstancePtr);
static u32 XDp_Transaction2MsgFormat(u8 *Transaction, XDp_SidebandMsg *Msg);
@ -2304,6 +2305,67 @@ void XDp_TxGetGuid(XDp *InstancePtr, u8 LinkCountTotal, u8 *RelativeAddress,
}
}
/******************************************************************************/
/**
* This function will handle incoming sideband messages. It will
* 1) Read the contents of the down request registers,
* 2) Delegate control depending on the request type, and
* 3) Send a down reply.
*
* @param InstancePtr is a pointer to the XDp instance.
*
* @return
* - XST_SUCCESS if the entire message was sent successfully.
* - XST_DEVICE_NOT_FOUND if no device is connected.
* - XST_ERROR_COUNT_MAX if sending one of the message fragments
* timed out.
* - XST_FAILURE otherwise.
*
* @note None.
*
*******************************************************************************/
u32 XDp_RxHandleDownReq(XDp *InstancePtr)
{
XDp_SidebandMsg Msg;
XDp_RxReadDownReq(InstancePtr, &Msg);
switch (Msg.Body.MsgData[0]) {
case XDP_TX_SBMSG_CLEAR_PAYLOAD_ID_TABLE:
XDp_RxAllocatePayload(InstancePtr, &Msg);
XDp_RxSetClearPayloadIdReply(&Msg);
XDp_RxSetAvailPbn(InstancePtr, &Msg);
break;
case XDP_TX_SBMSG_LINK_ADDRESS:
XDp_RxSetLinkAddressReply(InstancePtr, &Msg);
break;
case XDP_TX_SBMSG_REMOTE_I2C_READ:
XDp_RxSetRemoteIicReadReply(InstancePtr, &Msg);
break;
case XDP_TX_SBMSG_REMOTE_DPCD_READ:
XDp_RxSetRemoteDpcdReadReply(InstancePtr, &Msg);
break;
case XDP_TX_SBMSG_ENUM_PATH_RESOURCES:
XDp_RxSetEnumPathResReply(InstancePtr, &Msg);
break;
case XDP_TX_SBMSG_ALLOCATE_PAYLOAD:
XDp_RxAllocatePayload(InstancePtr, &Msg);
XDp_RxSetAllocPayloadReply(&Msg);
XDp_RxSetAvailPbn(InstancePtr, &Msg);
break;
default:
break;
}
return XDp_RxSendSbMsg(InstancePtr, &Msg);
}
/******************************************************************************/
/**
* This function returns a pointer to the I2C map entry at the supplied I2C
@ -3401,6 +3463,34 @@ static u32 XDp_SendSbMsgFragment(XDp *InstancePtr, XDp_SidebandMsg *Msg)
return Status;
}
/******************************************************************************/
/**
* This function will read the raw sideband message down request and format it
* into the message structure.
*
* @param InstancePtr is a pointer to the XDp instance.
* @param Msg is a pointer to the message structure to be filled with the
* read data.
*
* @return None.
*
* @note None.
*
*******************************************************************************/
static void XDp_RxReadDownReq(XDp *InstancePtr, XDp_SidebandMsg *Msg)
{
u8 Data[XDP_MAX_LENGTH_SBMSG];
u8 Index;
for (Index = 0; Index < XDP_MAX_LENGTH_SBMSG; Index++) {
Data[Index] = XDp_ReadReg(InstancePtr->Config.BaseAddr,
XDP_RX_DOWN_REQ + (Index * 4));
}
Msg->FragmentNum = 0;
XDp_Transaction2MsgFormat(Data, Msg);
}
/******************************************************************************/
/**
* This function will wait for a sideband message reply and fill in the SbReply