From: Bean Huo <beanhuo@xxxxxxxxxx>
HPB support is specified by Bit7 of bUFSFeatureSupport,
HPB version is indicated by wHPBVersion and the HPB Control
Mode is specified by bHPBControl in UFS device descriptor.
Signed-off-by: Bean Huo <beanhuo@xxxxxxxxxx>
---
drivers/scsi/ufs/ufs.h | 10 ++++++++++
drivers/scsi/ufs/ufshcd.c | 11 +++++++++++
2 files changed, 21 insertions(+)
diff --git a/drivers/scsi/ufs/ufs.h b/drivers/scsi/ufs/ufs.h
index b7fec5c73688..31011d86610b 100644
--- a/drivers/scsi/ufs/ufs.h
+++ b/drivers/scsi/ufs/ufs.h
@@ -258,6 +258,12 @@ enum device_desc_param {
DEVICE_DESC_PARAM_PSA_MAX_DATA = 0x25,
DEVICE_DESC_PARAM_PSA_TMT = 0x29,
DEVICE_DESC_PARAM_PRDCT_REV = 0x2A,
+ DEVICE_DESC_PARAM_HPB_VER = 0x40,
+ DEVICE_DESC_PARAM_HPB_CTRL_MODE = 0x42,
+ DEVICE_DESC_PARAM_EXT_UFS_FEAT = 0x4F,
+ DEVICE_DESC_PARAM_WBB_USER_SPEC_EN = 0x53,
+ DEVICE_DESC_PARAM_WBB_TYPE = 0x54,
+ DEVICE_DESC_PARAM_WBB_SHARED_NUM = 0x55,
};
/* Interconnect descriptor parameters offsets in bytes*/
@@ -537,6 +543,10 @@ struct ufs_dev_info {
u8 *model;
u16 wspecversion;
u32 clk_gating_wait_us;
+ /* HPB Version */
+ u16 hpb_ver;
+ /* bHPBControl */
+ u8 hpb_control_mode;
};
/**
diff --git a/drivers/scsi/ufs/ufshcd.c b/drivers/scsi/ufs/ufshcd.c
index 2a2a63b68a67..492e4685e587 100644
--- a/drivers/scsi/ufs/ufshcd.c
+++ b/drivers/scsi/ufs/ufshcd.c
@@ -6559,6 +6559,17 @@ static int ufs_get_device_desc(struct ufs_hba *hba)
goto out;
}
+ if (desc_buf[DEVICE_DESC_PARAM_UFS_FEAT] & 0x80) {
+ hba->dev_info.hpb_control_mode =
+ desc_buf[DEVICE_DESC_PARAM_HPB_CTRL_MODE];
+ hba->dev_info.hpb_ver =
+ (u16) (desc_buf[DEVICE_DESC_PARAM_HPB_VER] << 8) |
+ desc_buf[DEVICE_DESC_PARAM_HPB_VER + 1];
+ dev_info(hba->dev, "HPB Version: 0x%2x\n",
+ hba->dev_info.hpb_ver);
+ dev_info(hba->dev, "HPB control mode: %d\n",
+ hba->dev_info.hpb_control_mode);
+ }
/*
* getting vendor (manufacturerID) and Bank Index in big endian
* format
--
2.17.1
