From fcdf9bdb3fc3d942a7e43d76aa372c83f152e44a Mon Sep 17 00:00:00 2001 From: Subhash Jadavani Date: Thu, 18 Jun 2015 16:35:11 -0700 Subject: [PATCH] scsi: ufs-debugfs: fix reading the M-PHY RX attributes DME attributes read/write commands need GenSelectorIndex argument and according to UFS host controller specification, it should specify the targeted M-PHY data lane. This is the valid range of GenSelectorIndex for M-PHY attributes: 0 to (2 * PA_MaxDataLanes - 1) Example (Note: PA_MaxDataLanes is UniPro protocol constant set to 4): ----------------------------------------- MPHY Access target | GenSelectorIndex ----------------------------------------- TX Lane0 | 0 TX Lane1 | 1 RX Lane0 | 4 RX Lane1 | 5 ----------------------------------------- This change makes sure that correct GenSelectorIndex is passed for M-PHY attributes while it reading via debugfs. Change-Id: If09e4271958e4bb18d315446cef253caec75584a Signed-off-by: Subhash Jadavani --- drivers/scsi/ufs/ufs-debugfs.c | 13 +++++++++++-- drivers/scsi/ufs/unipro.h | 3 +++ 2 files changed, 14 insertions(+), 2 deletions(-) diff --git a/drivers/scsi/ufs/ufs-debugfs.c b/drivers/scsi/ufs/ufs-debugfs.c index 7eac503f157c..786985df1abf 100644 --- a/drivers/scsi/ufs/ufs-debugfs.c +++ b/drivers/scsi/ufs/ufs-debugfs.c @@ -1303,6 +1303,7 @@ static int ufsdbg_dme_read(void *data, u64 *attr_val, bool peer) struct ufs_hba *hba = data; u32 attr_id, read_val = 0; int (*read_func)(struct ufs_hba *, u32, u32 *); + u32 attr_sel; if (!hba) return -EINVAL; @@ -1313,8 +1314,16 @@ static int ufsdbg_dme_read(void *data, u64 *attr_val, bool peer) pm_runtime_get_sync(hba->dev); scsi_block_requests(hba->host); ret = ufshcd_wait_for_doorbell_clr(hba, DOORBELL_CLR_TOUT_US); - if (!ret) - ret = read_func(hba, UIC_ARG_MIB(attr_id), &read_val); + if (!ret) { + if ((attr_id >= MPHY_RX_ATTR_ADDR_START) + && (attr_id <= MPHY_RX_ATTR_ADDR_END)) + attr_sel = UIC_ARG_MIB_SEL(attr_id, + UIC_ARG_MPHY_RX_GEN_SEL_INDEX(0)); + else + attr_sel = UIC_ARG_MIB(attr_id); + + ret = read_func(hba, attr_sel, &read_val); + } scsi_unblock_requests(hba->host); pm_runtime_put_sync(hba->dev); diff --git a/drivers/scsi/ufs/unipro.h b/drivers/scsi/ufs/unipro.h index a484dd374e4c..80e9170ca83b 100644 --- a/drivers/scsi/ufs/unipro.h +++ b/drivers/scsi/ufs/unipro.h @@ -50,6 +50,9 @@ #define RX_MIN_ACTIVATETIME_CAPABILITY 0x008F #define RX_HIBERN8TIME_CAPABILITY 0x0092 +#define MPHY_RX_ATTR_ADDR_START 0x81 +#define MPHY_RX_ATTR_ADDR_END 0xC1 + #define is_mphy_tx_attr(attr) (attr < RX_MODE) #define RX_MIN_ACTIVATETIME_UNIT_US 100 #define HIBERN8TIME_UNIT_US 100