23 #include "phy-qcom-qmp.h"
24 #include "phy-qcom-qmp-pcs-ufs-v2.h"
25 #include "phy-qcom-qmp-pcs-ufs-v3.h"
26 #include "phy-qcom-qmp-pcs-ufs-v4.h"
27 #include "phy-qcom-qmp-pcs-ufs-v5.h"
28 #include "phy-qcom-qmp-pcs-ufs-v6.h"
30 #include "phy-qcom-qmp-qserdes-txrx-ufs-v6.h"
1425 static void qmp_ufs_serdes_init(struct qmp_ufs *qmp, const struct qmp_phy_cfg_tbls *tbls)  in qmp_ufs_serdes_init()  argument
1427 	void __iomem *serdes = qmp->serdes;  in qmp_ufs_serdes_init()
1432 static void qmp_ufs_lanes_init(struct qmp_ufs *qmp, const struct qmp_phy_cfg_tbls *tbls)  in qmp_ufs_lanes_init()  argument
1434 	const struct qmp_phy_cfg *cfg = qmp->cfg;  in qmp_ufs_lanes_init()
1435 	void __iomem *tx = qmp->tx;  in qmp_ufs_lanes_init()
1436 	void __iomem *rx = qmp->rx;  in qmp_ufs_lanes_init()
1442 		qmp_ufs_configure_lane(qmp->tx2, tbls->tx, tbls->tx_num, 2);  in qmp_ufs_lanes_init()
1443 		qmp_ufs_configure_lane(qmp->rx2, tbls->rx, tbls->rx_num, 2);  in qmp_ufs_lanes_init()
1447 static void qmp_ufs_pcs_init(struct qmp_ufs *qmp, const struct qmp_phy_cfg_tbls *tbls)  in qmp_ufs_pcs_init()  argument
1449 	void __iomem *pcs = qmp->pcs;  in qmp_ufs_pcs_init()
1454 static void qmp_ufs_init_registers(struct qmp_ufs *qmp, const struct qmp_phy_cfg *cfg)  in qmp_ufs_init_registers()  argument
1456 	qmp_ufs_serdes_init(qmp, &cfg->tbls);  in qmp_ufs_init_registers()
1457 	if (qmp->mode == PHY_MODE_UFS_HS_B)  in qmp_ufs_init_registers()
1458 		qmp_ufs_serdes_init(qmp, &cfg->tbls_hs_b);  in qmp_ufs_init_registers()
1459 	qmp_ufs_lanes_init(qmp, &cfg->tbls);  in qmp_ufs_init_registers()
1460 	if (qmp->submode == UFS_HS_G4)  in qmp_ufs_init_registers()
1461 		qmp_ufs_lanes_init(qmp, &cfg->tbls_hs_g4);  in qmp_ufs_init_registers()
1462 	qmp_ufs_pcs_init(qmp, &cfg->tbls);  in qmp_ufs_init_registers()
1463 	if (qmp->submode == UFS_HS_G4)  in qmp_ufs_init_registers()
1464 		qmp_ufs_pcs_init(qmp, &cfg->tbls_hs_g4);  in qmp_ufs_init_registers()
1467 static int qmp_ufs_com_init(struct qmp_ufs *qmp)  in qmp_ufs_com_init()  argument
1469 	const struct qmp_phy_cfg *cfg = qmp->cfg;  in qmp_ufs_com_init()
1470 	void __iomem *pcs = qmp->pcs;  in qmp_ufs_com_init()
1473 	ret = regulator_bulk_enable(cfg->num_vregs, qmp->vregs);  in qmp_ufs_com_init()
1475 		dev_err(qmp->dev, "failed to enable regulators, err=%d\n", ret);  in qmp_ufs_com_init()
1479 	ret = clk_bulk_prepare_enable(cfg->num_clks, qmp->clks);  in qmp_ufs_com_init()
1488 	regulator_bulk_disable(cfg->num_vregs, qmp->vregs);  in qmp_ufs_com_init()
1493 static int qmp_ufs_com_exit(struct qmp_ufs *qmp)  in qmp_ufs_com_exit()  argument
1495 	const struct qmp_phy_cfg *cfg = qmp->cfg;  in qmp_ufs_com_exit()
1497 	reset_control_assert(qmp->ufs_reset);  in qmp_ufs_com_exit()
1499 	clk_bulk_disable_unprepare(cfg->num_clks, qmp->clks);  in qmp_ufs_com_exit()
1501 	regulator_bulk_disable(cfg->num_vregs, qmp->vregs);  in qmp_ufs_com_exit()
1508 	struct qmp_ufs *qmp = phy_get_drvdata(phy);  in qmp_ufs_init()  local
1509 	const struct qmp_phy_cfg *cfg = qmp->cfg;  in qmp_ufs_init()
1511 	dev_vdbg(qmp->dev, "Initializing QMP phy\n");  in qmp_ufs_init()
1519 		if (!qmp->ufs_reset) {  in qmp_ufs_init()
1520 			qmp->ufs_reset =  in qmp_ufs_init()
1521 				devm_reset_control_get_exclusive(qmp->dev,  in qmp_ufs_init()
1524 			if (IS_ERR(qmp->ufs_reset)) {  in qmp_ufs_init()
1525 				ret = PTR_ERR(qmp->ufs_reset);  in qmp_ufs_init()
1526 				dev_err(qmp->dev,  in qmp_ufs_init()
1530 				qmp->ufs_reset = NULL;  in qmp_ufs_init()
1535 		ret = reset_control_assert(qmp->ufs_reset);  in qmp_ufs_init()
1540 	ret = qmp_ufs_com_init(qmp);  in qmp_ufs_init()
1549 	struct qmp_ufs *qmp = phy_get_drvdata(phy);  in qmp_ufs_power_on()  local
1550 	const struct qmp_phy_cfg *cfg = qmp->cfg;  in qmp_ufs_power_on()
1551 	void __iomem *pcs = qmp->pcs;  in qmp_ufs_power_on()
1556 	qmp_ufs_init_registers(qmp, cfg);  in qmp_ufs_power_on()
1558 	ret = reset_control_deassert(qmp->ufs_reset);  in qmp_ufs_power_on()
1573 		dev_err(qmp->dev, "phy initialization timed-out\n");  in qmp_ufs_power_on()
1582 	struct qmp_ufs *qmp = phy_get_drvdata(phy);  in qmp_ufs_power_off()  local
1583 	const struct qmp_phy_cfg *cfg = qmp->cfg;  in qmp_ufs_power_off()
1587 		qphy_setbits(qmp->pcs, cfg->regs[QPHY_SW_RESET], SW_RESET);  in qmp_ufs_power_off()
1590 	qphy_clrbits(qmp->pcs, cfg->regs[QPHY_START_CTRL], SERDES_START);  in qmp_ufs_power_off()
1593 	qphy_clrbits(qmp->pcs, cfg->regs[QPHY_PCS_POWER_DOWN_CONTROL],  in qmp_ufs_power_off()
1601 	struct qmp_ufs *qmp = phy_get_drvdata(phy);  in qmp_ufs_exit()  local
1603 	qmp_ufs_com_exit(qmp);  in qmp_ufs_exit()
1635 	struct qmp_ufs *qmp = phy_get_drvdata(phy);  in qmp_ufs_set_mode()  local
1637 	qmp->mode = mode;  in qmp_ufs_set_mode()
1638 	qmp->submode = submode;  in qmp_ufs_set_mode()
1650 static int qmp_ufs_vreg_init(struct qmp_ufs *qmp)  in qmp_ufs_vreg_init()  argument
1652 	const struct qmp_phy_cfg *cfg = qmp->cfg;  in qmp_ufs_vreg_init()
1653 	struct device *dev = qmp->dev;  in qmp_ufs_vreg_init()
1657 	qmp->vregs = devm_kcalloc(dev, num, sizeof(*qmp->vregs), GFP_KERNEL);  in qmp_ufs_vreg_init()
1658 	if (!qmp->vregs)  in qmp_ufs_vreg_init()
1662 		qmp->vregs[i].supply = cfg->vreg_list[i];  in qmp_ufs_vreg_init()
1664 	return devm_regulator_bulk_get(dev, num, qmp->vregs);  in qmp_ufs_vreg_init()
1667 static int qmp_ufs_clk_init(struct qmp_ufs *qmp)  in qmp_ufs_clk_init()  argument
1669 	const struct qmp_phy_cfg *cfg = qmp->cfg;  in qmp_ufs_clk_init()
1670 	struct device *dev = qmp->dev;  in qmp_ufs_clk_init()
1674 	qmp->clks = devm_kcalloc(dev, num, sizeof(*qmp->clks), GFP_KERNEL);  in qmp_ufs_clk_init()
1675 	if (!qmp->clks)  in qmp_ufs_clk_init()
1679 		qmp->clks[i].id = cfg->clk_list[i];  in qmp_ufs_clk_init()
1681 	return devm_clk_bulk_get(dev, num, qmp->clks);  in qmp_ufs_clk_init()
1691 static int qmp_ufs_register_clocks(struct qmp_ufs *qmp, struct device_node *np)  in qmp_ufs_register_clocks()  argument
1698 	clk_data = devm_kzalloc(qmp->dev,  in qmp_ufs_register_clocks()
1706 	snprintf(name, sizeof(name), "%s::rx_symbol_0", dev_name(qmp->dev));  in qmp_ufs_register_clocks()
1707 	hw = devm_clk_hw_register_fixed_rate(qmp->dev, name, NULL, 0, 0);  in qmp_ufs_register_clocks()
1713 	snprintf(name, sizeof(name), "%s::rx_symbol_1", dev_name(qmp->dev));  in qmp_ufs_register_clocks()
1714 	hw = devm_clk_hw_register_fixed_rate(qmp->dev, name, NULL, 0, 0);  in qmp_ufs_register_clocks()
1720 	snprintf(name, sizeof(name), "%s::tx_symbol_0", dev_name(qmp->dev));  in qmp_ufs_register_clocks()
1721 	hw = devm_clk_hw_register_fixed_rate(qmp->dev, name, NULL, 0, 0);  in qmp_ufs_register_clocks()
1734 	return devm_add_action_or_reset(qmp->dev, qmp_ufs_clk_release_provider, np);  in qmp_ufs_register_clocks()
1737 static int qmp_ufs_parse_dt_legacy(struct qmp_ufs *qmp, struct device_node *np)  in qmp_ufs_parse_dt_legacy()  argument
1739 	struct platform_device *pdev = to_platform_device(qmp->dev);  in qmp_ufs_parse_dt_legacy()
1740 	const struct qmp_phy_cfg *cfg = qmp->cfg;  in qmp_ufs_parse_dt_legacy()
1741 	struct device *dev = qmp->dev;  in qmp_ufs_parse_dt_legacy()
1743 	qmp->serdes = devm_platform_ioremap_resource(pdev, 0);  in qmp_ufs_parse_dt_legacy()
1744 	if (IS_ERR(qmp->serdes))  in qmp_ufs_parse_dt_legacy()
1745 		return PTR_ERR(qmp->serdes);  in qmp_ufs_parse_dt_legacy()
1753 	qmp->tx = devm_of_iomap(dev, np, 0, NULL);  in qmp_ufs_parse_dt_legacy()
1754 	if (IS_ERR(qmp->tx))  in qmp_ufs_parse_dt_legacy()
1755 		return PTR_ERR(qmp->tx);  in qmp_ufs_parse_dt_legacy()
1757 	qmp->rx = devm_of_iomap(dev, np, 1, NULL);  in qmp_ufs_parse_dt_legacy()
1758 	if (IS_ERR(qmp->rx))  in qmp_ufs_parse_dt_legacy()
1759 		return PTR_ERR(qmp->rx);  in qmp_ufs_parse_dt_legacy()
1761 	qmp->pcs = devm_of_iomap(dev, np, 2, NULL);  in qmp_ufs_parse_dt_legacy()
1762 	if (IS_ERR(qmp->pcs))  in qmp_ufs_parse_dt_legacy()
1763 		return PTR_ERR(qmp->pcs);  in qmp_ufs_parse_dt_legacy()
1766 		qmp->tx2 = devm_of_iomap(dev, np, 3, NULL);  in qmp_ufs_parse_dt_legacy()
1767 		if (IS_ERR(qmp->tx2))  in qmp_ufs_parse_dt_legacy()
1768 			return PTR_ERR(qmp->tx2);  in qmp_ufs_parse_dt_legacy()
1770 		qmp->rx2 = devm_of_iomap(dev, np, 4, NULL);  in qmp_ufs_parse_dt_legacy()
1771 		if (IS_ERR(qmp->rx2))  in qmp_ufs_parse_dt_legacy()
1772 			return PTR_ERR(qmp->rx2);  in qmp_ufs_parse_dt_legacy()
1774 		qmp->pcs_misc = devm_of_iomap(dev, np, 5, NULL);  in qmp_ufs_parse_dt_legacy()
1776 		qmp->pcs_misc = devm_of_iomap(dev, np, 3, NULL);  in qmp_ufs_parse_dt_legacy()
1779 	if (IS_ERR(qmp->pcs_misc))  in qmp_ufs_parse_dt_legacy()
1785 static int qmp_ufs_parse_dt(struct qmp_ufs *qmp)  in qmp_ufs_parse_dt()  argument
1787 	struct platform_device *pdev = to_platform_device(qmp->dev);  in qmp_ufs_parse_dt()
1788 	const struct qmp_phy_cfg *cfg = qmp->cfg;  in qmp_ufs_parse_dt()
1799 	qmp->serdes = base + offs->serdes;  in qmp_ufs_parse_dt()
1800 	qmp->pcs = base + offs->pcs;  in qmp_ufs_parse_dt()
1801 	qmp->tx = base + offs->tx;  in qmp_ufs_parse_dt()
1802 	qmp->rx = base + offs->rx;  in qmp_ufs_parse_dt()
1805 		qmp->tx2 = base + offs->tx2;  in qmp_ufs_parse_dt()
1806 		qmp->rx2 = base + offs->rx2;  in qmp_ufs_parse_dt()
1817 	struct qmp_ufs *qmp;  in qmp_ufs_probe()  local
1820 	qmp = devm_kzalloc(dev, sizeof(*qmp), GFP_KERNEL);  in qmp_ufs_probe()
1821 	if (!qmp)  in qmp_ufs_probe()
1824 	qmp->dev = dev;  in qmp_ufs_probe()
1826 	qmp->cfg = of_device_get_match_data(dev);  in qmp_ufs_probe()
1827 	if (!qmp->cfg)  in qmp_ufs_probe()
1830 	ret = qmp_ufs_clk_init(qmp);  in qmp_ufs_probe()
1834 	ret = qmp_ufs_vreg_init(qmp);  in qmp_ufs_probe()
1841 		ret = qmp_ufs_parse_dt_legacy(qmp, np);  in qmp_ufs_probe()
1844 		ret = qmp_ufs_parse_dt(qmp);  in qmp_ufs_probe()
1849 	ret = qmp_ufs_register_clocks(qmp, np);  in qmp_ufs_probe()
1853 	qmp->phy = devm_phy_create(dev, np, &qcom_qmp_ufs_phy_ops);  in qmp_ufs_probe()
1854 	if (IS_ERR(qmp->phy)) {  in qmp_ufs_probe()
1855 		ret = PTR_ERR(qmp->phy);  in qmp_ufs_probe()
1860 	phy_set_drvdata(qmp->phy, qmp);  in qmp_ufs_probe()
1875 		.compatible = "qcom,msm8996-qmp-ufs-phy",
1878 		.compatible = "qcom,msm8998-qmp-ufs-phy",
1881 		.compatible = "qcom,sa8775p-qmp-ufs-phy",
1884 		.compatible = "qcom,sc7280-qmp-ufs-phy",
1887 		.compatible = "qcom,sc8180x-qmp-ufs-phy",
1890 		.compatible = "qcom,sc8280xp-qmp-ufs-phy",
1893 		.compatible = "qcom,sdm845-qmp-ufs-phy",
1896 		.compatible = "qcom,sm6115-qmp-ufs-phy",
1899 		.compatible = "qcom,sm6125-qmp-ufs-phy",
1902 		.compatible = "qcom,sm6350-qmp-ufs-phy",
1905 		.compatible = "qcom,sm7150-qmp-ufs-phy",
1908 		.compatible = "qcom,sm8150-qmp-ufs-phy",
1911 		.compatible = "qcom,sm8250-qmp-ufs-phy",
1914 		.compatible = "qcom,sm8350-qmp-ufs-phy",
1917 		.compatible = "qcom,sm8450-qmp-ufs-phy",
1920 		.compatible = "qcom,sm8550-qmp-ufs-phy",
1923 		.compatible = "qcom,sm8650-qmp-ufs-phy",
1933 		.name	= "qcom-qmp-ufs-phy",
1941 MODULE_DESCRIPTION("Qualcomm QMP UFS PHY driver");