hollalinux
/
linux-sg2042
mirror of https://github.com/sophgo/linux-riscv.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

scsi: ufs-cdns: Add support for UFSHCI with M31 PHY 

This patch adds an additional PHY initialization, required for M31 PHY when
used with Cadence UFS HC.  A new compatible string has been added for this
purpose.

[mkp: nuke superfluous status return]

Signed-off-by: Jan Kotas <jank@cadence.com>
Signed-off-by: Martin K. Petersen <martin.petersen@oracle.com>
This commit is contained in:
Jan Kotas 2019-03-27 14:44:05 +00:00 committed by Martin K. Petersen
parent 5328efce94
commit 4fed62bc1c
1 changed files with 64 additions and 10 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

74
drivers/scsi/ufs/cdns-pltfrm.c
View File

@ -17,7 +17,8 @@
#include "ufshcd-pltfrm.h" #include "ufshcd-pltfrm.h"
#define CDNS_UFS_REG_HCLKDIV 0xFC #define CDNS_UFS_REG_HCLKDIV 0xFC
#define CDNS_UFS_REG_PHY_XCFGD1 0x113C
/** /**
* Sets HCLKDIV register value based on the core_clk * Sets HCLKDIV register value based on the core_clk
@ -77,11 +78,66 @@ static int cdns_ufs_setup_clocks(struct ufs_hba *hba, bool on,
return cdns_ufs_set_hclkdiv(hba); return cdns_ufs_set_hclkdiv(hba);
} }
static struct ufs_hba_variant_ops cdns_pltfm_hba_vops = { /**
* cdns_ufs_init - performs additional ufs initialization
* @hba: host controller instance
*
* Returns status of initialization
*/
static int cdns_ufs_init(struct ufs_hba *hba)
{
int status = 0;
if (hba->vops && hba->vops->phy_initialization)
status = hba->vops->phy_initialization(hba);
return status;
}
/**
* cdns_ufs_m31_16nm_phy_initialization - performs m31 phy initialization
* @hba: host controller instance
*
* Always returns 0
*/
static int cdns_ufs_m31_16nm_phy_initialization(struct ufs_hba *hba)
{
u32 data;
/* Increase RX_Advanced_Min_ActivateTime_Capability */
data = ufshcd_readl(hba, CDNS_UFS_REG_PHY_XCFGD1);
data |= BIT(24);
ufshcd_writel(hba, data, CDNS_UFS_REG_PHY_XCFGD1);
return 0;
}
static const struct ufs_hba_variant_ops cdns_ufs_pltfm_hba_vops = {
.name = "cdns-ufs-pltfm", .name = "cdns-ufs-pltfm",
.setup_clocks = cdns_ufs_setup_clocks, .setup_clocks = cdns_ufs_setup_clocks,
}; };
static const struct ufs_hba_variant_ops cdns_ufs_m31_16nm_pltfm_hba_vops = {
.name = "cdns-ufs-pltfm",
.init = cdns_ufs_init,
.setup_clocks = cdns_ufs_setup_clocks,
.phy_initialization = cdns_ufs_m31_16nm_phy_initialization,
};
static const struct of_device_id cdns_ufs_of_match[] = {
{
.compatible = "cdns,ufshc",
.data = &cdns_ufs_pltfm_hba_vops,
},
{
.compatible = "cdns,ufshc-m31-16nm",
.data = &cdns_ufs_m31_16nm_pltfm_hba_vops,
},
{ },
};
MODULE_DEVICE_TABLE(of, cdns_ufs_of_match);
/** /**
* cdns_ufs_pltfrm_probe - probe routine of the driver * cdns_ufs_pltfrm_probe - probe routine of the driver
* @pdev: pointer to platform device handle * @pdev: pointer to platform device handle
@ -91,10 +147,15 @@ static struct ufs_hba_variant_ops cdns_pltfm_hba_vops = {
static int cdns_ufs_pltfrm_probe(struct platform_device *pdev) static int cdns_ufs_pltfrm_probe(struct platform_device *pdev)
{ {
int err; int err;
const struct of_device_id *of_id;
struct ufs_hba_variant_ops *vops;
struct device *dev = &pdev->dev; struct device *dev = &pdev->dev;
of_id = of_match_node(cdns_ufs_of_match, dev->of_node);
vops = (struct ufs_hba_variant_ops *)of_id->data;
/* Perform generic probe */ /* Perform generic probe */
err = ufshcd_pltfrm_init(pdev, &cdns_pltfm_hba_vops); err = ufshcd_pltfrm_init(pdev, vops);
if (err) if (err)
dev_err(dev, "ufshcd_pltfrm_init() failed %d\n", err); dev_err(dev, "ufshcd_pltfrm_init() failed %d\n", err);
@ -115,13 +176,6 @@ static int cdns_ufs_pltfrm_remove(struct platform_device *pdev)
return 0; return 0;
} }
static const struct of_device_id cdns_ufs_of_match[] = {
{ .compatible = "cdns,ufshc" },
{},
};
MODULE_DEVICE_TABLE(of, cdns_ufs_of_match);
static const struct dev_pm_ops cdns_ufs_dev_pm_ops = { static const struct dev_pm_ops cdns_ufs_dev_pm_ops = {
.suspend = ufshcd_pltfrm_suspend, .suspend = ufshcd_pltfrm_suspend,
.resume = ufshcd_pltfrm_resume, .resume = ufshcd_pltfrm_resume,