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

dp: rx: mst: Format down reply message for REMOTE_DPCD_READ down requests.

Browse source 
Signed-off-by: Andrei-Liviu Simion <andrei.simion@xilinx.com>
This commit is contained in:
Andrei-Liviu Simion 2015-04-23 13:27:00 -07:00 • committed by Nava kishore Manne
parent 5d1f504961
commit 72069d67a0
2 changed files with 85 additions and 0 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

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

@ -592,6 +592,17 @@ typedef struct {
application. */
} XDp_RxIicMapEntry;
/**
* This typedef represents the DPCD address map for a device. This is used to
* allow the user to define a DPCD map for any sink connected to one of the RX's
* ports.
*/
typedef struct {
u8 *DataPtr;
u32 NumBytes;
u32 StartAddr;
} XDp_RxDpcdMap;
/**
* This typedef contains information on the directly connected ports to the RX
* branch. Information contained in XDp_SbMsgLinkAddressReplyDeviceInfo is not
@ -606,6 +617,11 @@ typedef struct {
allows the user to define up to
XDP_RX_NUM_I2C_ENTRIES_PER_PORT
I2C addresses per port. */
XDp_RxDpcdMap DpcdMap; /**< When the RX replies to a
REMOTE_DPCD_READ sideband
message, it responds with the
associated DPCD map for the
requested port. */
u8 Exposed; /**< When set to 1, the RX branch device
will expose the port in the
LINK_ADDRESS reply. */

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

@ -150,6 +150,7 @@ typedef struct
static void XDp_RxSetClearPayloadIdReply(XDp_SidebandMsg *Msg);
static void XDp_RxSetAllocPayloadReply(XDp_SidebandMsg *Msg);
static u32 XDp_RxSetRemoteDpcdReadReply(XDp *InstancePtr, XDp_SidebandMsg *Msg);
static void XDp_TxIssueGuid(XDp *InstancePtr, u8 LinkCountTotal,
u8 *RelativeAddress, XDp_TxTopology *Topology,
u32 *Guid);
@ -2570,6 +2571,74 @@ static void XDp_RxSetAllocPayloadReply(XDp_SidebandMsg *Msg)
Msg->Body.MsgDataLength = ReplyIndex;
}
/******************************************************************************/
/**
* This function will set and format a sideband message structure for replying
* to a REMOTE_DPCD_READ down request.
*
* @param Msg is a pointer to the message to be formatted.
*
* @return None.
*
* @note None.
*
*******************************************************************************/
static u32 XDp_RxSetRemoteDpcdReadReply(XDp *InstancePtr, XDp_SidebandMsg *Msg)
{
u8 NumReadBytes;
u8 ReplyIndex = 0;
u8 Index;
u32 DpcdReadIndex;
u8 PortNum;
u32 DpcdReadAddress;
XDp_RxDpcdMap *DpcdMap;
u32 DpcdMapEndAddr;
PortNum = Msg->Body.MsgData[1] >> 4;
DpcdReadAddress = ((Msg->Body.MsgData[1] & 0xF) << 16) |
(Msg->Body.MsgData[2] << 8) | Msg->Body.MsgData[3];
NumReadBytes = Msg->Body.MsgData[4];
Msg->Header.LinkCountTotal = 1;
Msg->Header.LinkCountRemaining = 0;
Msg->Header.BroadcastMsg = 0;
Msg->Header.PathMsg = 0;
Msg->Header.MsgHeaderLength = 3;
Msg->Body.MsgData[ReplyIndex++] = XDP_TX_SBMSG_REMOTE_DPCD_READ;
Msg->Body.MsgData[ReplyIndex++] = PortNum;
Msg->Body.MsgData[ReplyIndex++] = NumReadBytes;
DpcdMap = &InstancePtr->RxInstance.Topology.Ports[PortNum].DpcdMap;
if (!DpcdMap->DataPtr) {
/* Supply garbage data if the targeted port has no associated
* DPCD map. */
memset(&Msg->Body.MsgData[ReplyIndex], 0x00, NumReadBytes);
Msg->Body.MsgDataLength = ReplyIndex + NumReadBytes;
return XST_FAILURE;
}
DpcdMapEndAddr = (DpcdMap->StartAddr + DpcdMap->NumBytes - 1);
for (Index = 0; Index < NumReadBytes; Index++) {
DpcdReadIndex = DpcdReadAddress + Index;
if ((DpcdReadIndex >= DpcdMap->StartAddr) &&
(DpcdReadIndex <= DpcdMapEndAddr)) {
Msg->Body.MsgData[ReplyIndex++] = DpcdMap->DataPtr[
DpcdReadIndex - DpcdMap->StartAddr];
}
else {
/* Supply garbage data if the read is out of range. */
Msg->Body.MsgData[ReplyIndex++] = 0x00;
}
}
Msg->Body.MsgDataLength = ReplyIndex;
return XST_SUCCESS;
}
/******************************************************************************/
/**
* This function will check whether or not a DisplayPort device has a global