1c6d9b132SKunihiko Hayashi // SPDX-License-Identifier: GPL-2.0 2c6d9b132SKunihiko Hayashi /* 3c6d9b132SKunihiko Hayashi * phy-uniphier-pcie.c - PHY driver for UniPhier PCIe controller 4c6d9b132SKunihiko Hayashi * Copyright 2018, Socionext Inc. 5c6d9b132SKunihiko Hayashi * Author: Kunihiko Hayashi <hayashi.kunihiko@socionext.com> 6c6d9b132SKunihiko Hayashi */ 7c6d9b132SKunihiko Hayashi 8c6d9b132SKunihiko Hayashi #include <linux/bitops.h> 9c6d9b132SKunihiko Hayashi #include <linux/bitfield.h> 10c6d9b132SKunihiko Hayashi #include <linux/clk.h> 11c6d9b132SKunihiko Hayashi #include <linux/iopoll.h> 12c6d9b132SKunihiko Hayashi #include <linux/mfd/syscon.h> 13c6d9b132SKunihiko Hayashi #include <linux/module.h> 14c6d9b132SKunihiko Hayashi #include <linux/of_device.h> 15c6d9b132SKunihiko Hayashi #include <linux/phy/phy.h> 16c6d9b132SKunihiko Hayashi #include <linux/platform_device.h> 17c6d9b132SKunihiko Hayashi #include <linux/regmap.h> 18c6d9b132SKunihiko Hayashi #include <linux/reset.h> 19c6d9b132SKunihiko Hayashi #include <linux/resource.h> 20c6d9b132SKunihiko Hayashi 21c6d9b132SKunihiko Hayashi /* PHY */ 2204de8fa2SKunihiko Hayashi #define PCL_PHY_CLKCTRL 0x0000 2304de8fa2SKunihiko Hayashi #define PORT_SEL_MASK GENMASK(11, 9) 2404de8fa2SKunihiko Hayashi #define PORT_SEL_1 FIELD_PREP(PORT_SEL_MASK, 1) 2504de8fa2SKunihiko Hayashi 26c6d9b132SKunihiko Hayashi #define PCL_PHY_TEST_I 0x2000 27c6d9b132SKunihiko Hayashi #define PCL_PHY_TEST_O 0x2004 28c6d9b132SKunihiko Hayashi #define TESTI_DAT_MASK GENMASK(13, 6) 29c6d9b132SKunihiko Hayashi #define TESTI_ADR_MASK GENMASK(5, 1) 30c6d9b132SKunihiko Hayashi #define TESTI_WR_EN BIT(0) 31c6d9b132SKunihiko Hayashi 32c6d9b132SKunihiko Hayashi #define PCL_PHY_RESET 0x200c 33c6d9b132SKunihiko Hayashi #define PCL_PHY_RESET_N_MNMODE BIT(8) /* =1:manual */ 34c6d9b132SKunihiko Hayashi #define PCL_PHY_RESET_N BIT(0) /* =1:deasssert */ 35c6d9b132SKunihiko Hayashi 36c6d9b132SKunihiko Hayashi /* SG */ 37c6d9b132SKunihiko Hayashi #define SG_USBPCIESEL 0x590 38c6d9b132SKunihiko Hayashi #define SG_USBPCIESEL_PCIE BIT(0) 39c6d9b132SKunihiko Hayashi 40c6d9b132SKunihiko Hayashi #define PCL_PHY_R00 0 41c6d9b132SKunihiko Hayashi #define RX_EQ_ADJ_EN BIT(3) /* enable for EQ adjustment */ 42c6d9b132SKunihiko Hayashi #define PCL_PHY_R06 6 43c6d9b132SKunihiko Hayashi #define RX_EQ_ADJ GENMASK(5, 0) /* EQ adjustment value */ 44c6d9b132SKunihiko Hayashi #define RX_EQ_ADJ_VAL 0 45c6d9b132SKunihiko Hayashi #define PCL_PHY_R26 26 46c6d9b132SKunihiko Hayashi #define VCO_CTRL GENMASK(7, 4) /* Tx VCO adjustment value */ 47c6d9b132SKunihiko Hayashi #define VCO_CTRL_INIT_VAL 5 48c6d9b132SKunihiko Hayashi 49c6d9b132SKunihiko Hayashi struct uniphier_pciephy_priv { 50c6d9b132SKunihiko Hayashi void __iomem *base; 51c6d9b132SKunihiko Hayashi struct device *dev; 5204de8fa2SKunihiko Hayashi struct clk *clk, *clk_gio; 5304de8fa2SKunihiko Hayashi struct reset_control *rst, *rst_gio; 54c6d9b132SKunihiko Hayashi const struct uniphier_pciephy_soc_data *data; 55c6d9b132SKunihiko Hayashi }; 56c6d9b132SKunihiko Hayashi 57c6d9b132SKunihiko Hayashi struct uniphier_pciephy_soc_data { 5804de8fa2SKunihiko Hayashi bool is_legacy; 59*6861781aSKunihiko Hayashi void (*set_phymode)(struct regmap *regmap); 60c6d9b132SKunihiko Hayashi }; 61c6d9b132SKunihiko Hayashi 62c6d9b132SKunihiko Hayashi static void uniphier_pciephy_testio_write(struct uniphier_pciephy_priv *priv, 63c6d9b132SKunihiko Hayashi u32 data) 64c6d9b132SKunihiko Hayashi { 65c6d9b132SKunihiko Hayashi /* need to read TESTO twice after accessing TESTI */ 66c6d9b132SKunihiko Hayashi writel(data, priv->base + PCL_PHY_TEST_I); 67c6d9b132SKunihiko Hayashi readl(priv->base + PCL_PHY_TEST_O); 68c6d9b132SKunihiko Hayashi readl(priv->base + PCL_PHY_TEST_O); 69c6d9b132SKunihiko Hayashi } 70c6d9b132SKunihiko Hayashi 71c6d9b132SKunihiko Hayashi static void uniphier_pciephy_set_param(struct uniphier_pciephy_priv *priv, 72c6d9b132SKunihiko Hayashi u32 reg, u32 mask, u32 param) 73c6d9b132SKunihiko Hayashi { 74c6d9b132SKunihiko Hayashi u32 val; 75c6d9b132SKunihiko Hayashi 76c6d9b132SKunihiko Hayashi /* read previous data */ 77c6d9b132SKunihiko Hayashi val = FIELD_PREP(TESTI_DAT_MASK, 1); 78c6d9b132SKunihiko Hayashi val |= FIELD_PREP(TESTI_ADR_MASK, reg); 79c6d9b132SKunihiko Hayashi uniphier_pciephy_testio_write(priv, val); 80c6d9b132SKunihiko Hayashi val = readl(priv->base + PCL_PHY_TEST_O); 81c6d9b132SKunihiko Hayashi 82c6d9b132SKunihiko Hayashi /* update value */ 83c6d9b132SKunihiko Hayashi val &= ~FIELD_PREP(TESTI_DAT_MASK, mask); 84c6d9b132SKunihiko Hayashi val = FIELD_PREP(TESTI_DAT_MASK, mask & param); 85c6d9b132SKunihiko Hayashi val |= FIELD_PREP(TESTI_ADR_MASK, reg); 86c6d9b132SKunihiko Hayashi uniphier_pciephy_testio_write(priv, val); 87c6d9b132SKunihiko Hayashi uniphier_pciephy_testio_write(priv, val | TESTI_WR_EN); 88c6d9b132SKunihiko Hayashi uniphier_pciephy_testio_write(priv, val); 89c6d9b132SKunihiko Hayashi 90c6d9b132SKunihiko Hayashi /* read current data as dummy */ 91c6d9b132SKunihiko Hayashi val = FIELD_PREP(TESTI_DAT_MASK, 1); 92c6d9b132SKunihiko Hayashi val |= FIELD_PREP(TESTI_ADR_MASK, reg); 93c6d9b132SKunihiko Hayashi uniphier_pciephy_testio_write(priv, val); 94c6d9b132SKunihiko Hayashi readl(priv->base + PCL_PHY_TEST_O); 95c6d9b132SKunihiko Hayashi } 96c6d9b132SKunihiko Hayashi 97c6d9b132SKunihiko Hayashi static void uniphier_pciephy_assert(struct uniphier_pciephy_priv *priv) 98c6d9b132SKunihiko Hayashi { 99c6d9b132SKunihiko Hayashi u32 val; 100c6d9b132SKunihiko Hayashi 101c6d9b132SKunihiko Hayashi val = readl(priv->base + PCL_PHY_RESET); 102c6d9b132SKunihiko Hayashi val &= ~PCL_PHY_RESET_N; 103c6d9b132SKunihiko Hayashi val |= PCL_PHY_RESET_N_MNMODE; 104c6d9b132SKunihiko Hayashi writel(val, priv->base + PCL_PHY_RESET); 105c6d9b132SKunihiko Hayashi } 106c6d9b132SKunihiko Hayashi 107c6d9b132SKunihiko Hayashi static void uniphier_pciephy_deassert(struct uniphier_pciephy_priv *priv) 108c6d9b132SKunihiko Hayashi { 109c6d9b132SKunihiko Hayashi u32 val; 110c6d9b132SKunihiko Hayashi 111c6d9b132SKunihiko Hayashi val = readl(priv->base + PCL_PHY_RESET); 112c6d9b132SKunihiko Hayashi val |= PCL_PHY_RESET_N_MNMODE | PCL_PHY_RESET_N; 113c6d9b132SKunihiko Hayashi writel(val, priv->base + PCL_PHY_RESET); 114c6d9b132SKunihiko Hayashi } 115c6d9b132SKunihiko Hayashi 116c6d9b132SKunihiko Hayashi static int uniphier_pciephy_init(struct phy *phy) 117c6d9b132SKunihiko Hayashi { 118c6d9b132SKunihiko Hayashi struct uniphier_pciephy_priv *priv = phy_get_drvdata(phy); 11904de8fa2SKunihiko Hayashi u32 val; 120c6d9b132SKunihiko Hayashi int ret; 121c6d9b132SKunihiko Hayashi 122c6d9b132SKunihiko Hayashi ret = clk_prepare_enable(priv->clk); 123c6d9b132SKunihiko Hayashi if (ret) 124c6d9b132SKunihiko Hayashi return ret; 125c6d9b132SKunihiko Hayashi 12604de8fa2SKunihiko Hayashi ret = clk_prepare_enable(priv->clk_gio); 127c6d9b132SKunihiko Hayashi if (ret) 128c6d9b132SKunihiko Hayashi goto out_clk_disable; 129c6d9b132SKunihiko Hayashi 13004de8fa2SKunihiko Hayashi ret = reset_control_deassert(priv->rst); 13104de8fa2SKunihiko Hayashi if (ret) 13204de8fa2SKunihiko Hayashi goto out_clk_gio_disable; 13304de8fa2SKunihiko Hayashi 13404de8fa2SKunihiko Hayashi ret = reset_control_deassert(priv->rst_gio); 13504de8fa2SKunihiko Hayashi if (ret) 13604de8fa2SKunihiko Hayashi goto out_rst_assert; 13704de8fa2SKunihiko Hayashi 13804de8fa2SKunihiko Hayashi /* support only 1 port */ 13904de8fa2SKunihiko Hayashi val = readl(priv->base + PCL_PHY_CLKCTRL); 14004de8fa2SKunihiko Hayashi val &= ~PORT_SEL_MASK; 14104de8fa2SKunihiko Hayashi val |= PORT_SEL_1; 14204de8fa2SKunihiko Hayashi writel(val, priv->base + PCL_PHY_CLKCTRL); 14304de8fa2SKunihiko Hayashi 14404de8fa2SKunihiko Hayashi /* legacy controller doesn't have phy_reset and parameters */ 14504de8fa2SKunihiko Hayashi if (priv->data->is_legacy) 14604de8fa2SKunihiko Hayashi return 0; 14704de8fa2SKunihiko Hayashi 148c6d9b132SKunihiko Hayashi uniphier_pciephy_set_param(priv, PCL_PHY_R00, 149c6d9b132SKunihiko Hayashi RX_EQ_ADJ_EN, RX_EQ_ADJ_EN); 150c6d9b132SKunihiko Hayashi uniphier_pciephy_set_param(priv, PCL_PHY_R06, RX_EQ_ADJ, 151c6d9b132SKunihiko Hayashi FIELD_PREP(RX_EQ_ADJ, RX_EQ_ADJ_VAL)); 152c6d9b132SKunihiko Hayashi uniphier_pciephy_set_param(priv, PCL_PHY_R26, VCO_CTRL, 153c6d9b132SKunihiko Hayashi FIELD_PREP(VCO_CTRL, VCO_CTRL_INIT_VAL)); 154c6d9b132SKunihiko Hayashi usleep_range(1, 10); 155c6d9b132SKunihiko Hayashi 156c6d9b132SKunihiko Hayashi uniphier_pciephy_deassert(priv); 157c6d9b132SKunihiko Hayashi usleep_range(1, 10); 158c6d9b132SKunihiko Hayashi 159c6d9b132SKunihiko Hayashi return 0; 160c6d9b132SKunihiko Hayashi 16104de8fa2SKunihiko Hayashi out_rst_assert: 16204de8fa2SKunihiko Hayashi reset_control_assert(priv->rst); 16304de8fa2SKunihiko Hayashi out_clk_gio_disable: 16404de8fa2SKunihiko Hayashi clk_disable_unprepare(priv->clk_gio); 165c6d9b132SKunihiko Hayashi out_clk_disable: 166c6d9b132SKunihiko Hayashi clk_disable_unprepare(priv->clk); 167c6d9b132SKunihiko Hayashi 168c6d9b132SKunihiko Hayashi return ret; 169c6d9b132SKunihiko Hayashi } 170c6d9b132SKunihiko Hayashi 171c6d9b132SKunihiko Hayashi static int uniphier_pciephy_exit(struct phy *phy) 172c6d9b132SKunihiko Hayashi { 173c6d9b132SKunihiko Hayashi struct uniphier_pciephy_priv *priv = phy_get_drvdata(phy); 174c6d9b132SKunihiko Hayashi 17504de8fa2SKunihiko Hayashi if (!priv->data->is_legacy) 176c6d9b132SKunihiko Hayashi uniphier_pciephy_assert(priv); 17704de8fa2SKunihiko Hayashi reset_control_assert(priv->rst_gio); 178c6d9b132SKunihiko Hayashi reset_control_assert(priv->rst); 17904de8fa2SKunihiko Hayashi clk_disable_unprepare(priv->clk_gio); 180c6d9b132SKunihiko Hayashi clk_disable_unprepare(priv->clk); 181c6d9b132SKunihiko Hayashi 182c6d9b132SKunihiko Hayashi return 0; 183c6d9b132SKunihiko Hayashi } 184c6d9b132SKunihiko Hayashi 185c6d9b132SKunihiko Hayashi static const struct phy_ops uniphier_pciephy_ops = { 186c6d9b132SKunihiko Hayashi .init = uniphier_pciephy_init, 187c6d9b132SKunihiko Hayashi .exit = uniphier_pciephy_exit, 188c6d9b132SKunihiko Hayashi .owner = THIS_MODULE, 189c6d9b132SKunihiko Hayashi }; 190c6d9b132SKunihiko Hayashi 191c6d9b132SKunihiko Hayashi static int uniphier_pciephy_probe(struct platform_device *pdev) 192c6d9b132SKunihiko Hayashi { 193c6d9b132SKunihiko Hayashi struct uniphier_pciephy_priv *priv; 194c6d9b132SKunihiko Hayashi struct phy_provider *phy_provider; 195c6d9b132SKunihiko Hayashi struct device *dev = &pdev->dev; 196c6d9b132SKunihiko Hayashi struct regmap *regmap; 197c6d9b132SKunihiko Hayashi struct phy *phy; 198c6d9b132SKunihiko Hayashi 199c6d9b132SKunihiko Hayashi priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL); 200c6d9b132SKunihiko Hayashi if (!priv) 201c6d9b132SKunihiko Hayashi return -ENOMEM; 202c6d9b132SKunihiko Hayashi 203c6d9b132SKunihiko Hayashi priv->data = of_device_get_match_data(dev); 204c6d9b132SKunihiko Hayashi if (WARN_ON(!priv->data)) 205c6d9b132SKunihiko Hayashi return -EINVAL; 206c6d9b132SKunihiko Hayashi 207c6d9b132SKunihiko Hayashi priv->dev = dev; 208c6d9b132SKunihiko Hayashi 20940d76346SKunihiko Hayashi priv->base = devm_platform_ioremap_resource(pdev, 0); 210c6d9b132SKunihiko Hayashi if (IS_ERR(priv->base)) 211c6d9b132SKunihiko Hayashi return PTR_ERR(priv->base); 212c6d9b132SKunihiko Hayashi 21304de8fa2SKunihiko Hayashi if (priv->data->is_legacy) { 21404de8fa2SKunihiko Hayashi priv->clk_gio = devm_clk_get(dev, "gio"); 21504de8fa2SKunihiko Hayashi if (IS_ERR(priv->clk_gio)) 21604de8fa2SKunihiko Hayashi return PTR_ERR(priv->clk_gio); 21704de8fa2SKunihiko Hayashi 21804de8fa2SKunihiko Hayashi priv->rst_gio = 21904de8fa2SKunihiko Hayashi devm_reset_control_get_shared(dev, "gio"); 22004de8fa2SKunihiko Hayashi if (IS_ERR(priv->rst_gio)) 22104de8fa2SKunihiko Hayashi return PTR_ERR(priv->rst_gio); 22204de8fa2SKunihiko Hayashi 22304de8fa2SKunihiko Hayashi priv->clk = devm_clk_get(dev, "link"); 22404de8fa2SKunihiko Hayashi if (IS_ERR(priv->clk)) 22504de8fa2SKunihiko Hayashi return PTR_ERR(priv->clk); 22604de8fa2SKunihiko Hayashi 22704de8fa2SKunihiko Hayashi priv->rst = devm_reset_control_get_shared(dev, "link"); 22804de8fa2SKunihiko Hayashi if (IS_ERR(priv->rst)) 22904de8fa2SKunihiko Hayashi return PTR_ERR(priv->rst); 23004de8fa2SKunihiko Hayashi } else { 231c6d9b132SKunihiko Hayashi priv->clk = devm_clk_get(dev, NULL); 232c6d9b132SKunihiko Hayashi if (IS_ERR(priv->clk)) 233c6d9b132SKunihiko Hayashi return PTR_ERR(priv->clk); 234c6d9b132SKunihiko Hayashi 235c6d9b132SKunihiko Hayashi priv->rst = devm_reset_control_get_shared(dev, NULL); 236c6d9b132SKunihiko Hayashi if (IS_ERR(priv->rst)) 237c6d9b132SKunihiko Hayashi return PTR_ERR(priv->rst); 23804de8fa2SKunihiko Hayashi } 239c6d9b132SKunihiko Hayashi 240c6d9b132SKunihiko Hayashi phy = devm_phy_create(dev, dev->of_node, &uniphier_pciephy_ops); 241c6d9b132SKunihiko Hayashi if (IS_ERR(phy)) 242c6d9b132SKunihiko Hayashi return PTR_ERR(phy); 243c6d9b132SKunihiko Hayashi 244c6d9b132SKunihiko Hayashi regmap = syscon_regmap_lookup_by_phandle(dev->of_node, 245c6d9b132SKunihiko Hayashi "socionext,syscon"); 246*6861781aSKunihiko Hayashi if (!IS_ERR(regmap) && priv->data->set_phymode) 247*6861781aSKunihiko Hayashi priv->data->set_phymode(regmap); 248c6d9b132SKunihiko Hayashi 249c6d9b132SKunihiko Hayashi phy_set_drvdata(phy, priv); 250c6d9b132SKunihiko Hayashi phy_provider = devm_of_phy_provider_register(dev, of_phy_simple_xlate); 251c6d9b132SKunihiko Hayashi 252c6d9b132SKunihiko Hayashi return PTR_ERR_OR_ZERO(phy_provider); 253c6d9b132SKunihiko Hayashi } 254c6d9b132SKunihiko Hayashi 255*6861781aSKunihiko Hayashi static void uniphier_pciephy_ld20_setmode(struct regmap *regmap) 256*6861781aSKunihiko Hayashi { 257*6861781aSKunihiko Hayashi regmap_update_bits(regmap, SG_USBPCIESEL, 258*6861781aSKunihiko Hayashi SG_USBPCIESEL_PCIE, SG_USBPCIESEL_PCIE); 259*6861781aSKunihiko Hayashi } 260*6861781aSKunihiko Hayashi 26104de8fa2SKunihiko Hayashi static const struct uniphier_pciephy_soc_data uniphier_pro5_data = { 26204de8fa2SKunihiko Hayashi .is_legacy = true, 26304de8fa2SKunihiko Hayashi }; 26404de8fa2SKunihiko Hayashi 265c6d9b132SKunihiko Hayashi static const struct uniphier_pciephy_soc_data uniphier_ld20_data = { 26604de8fa2SKunihiko Hayashi .is_legacy = false, 267*6861781aSKunihiko Hayashi .set_phymode = uniphier_pciephy_ld20_setmode, 268c6d9b132SKunihiko Hayashi }; 269c6d9b132SKunihiko Hayashi 270c6d9b132SKunihiko Hayashi static const struct uniphier_pciephy_soc_data uniphier_pxs3_data = { 27104de8fa2SKunihiko Hayashi .is_legacy = false, 272c6d9b132SKunihiko Hayashi }; 273c6d9b132SKunihiko Hayashi 274c6d9b132SKunihiko Hayashi static const struct of_device_id uniphier_pciephy_match[] = { 275c6d9b132SKunihiko Hayashi { 27604de8fa2SKunihiko Hayashi .compatible = "socionext,uniphier-pro5-pcie-phy", 27704de8fa2SKunihiko Hayashi .data = &uniphier_pro5_data, 27804de8fa2SKunihiko Hayashi }, 27904de8fa2SKunihiko Hayashi { 280c6d9b132SKunihiko Hayashi .compatible = "socionext,uniphier-ld20-pcie-phy", 281c6d9b132SKunihiko Hayashi .data = &uniphier_ld20_data, 282c6d9b132SKunihiko Hayashi }, 283c6d9b132SKunihiko Hayashi { 284c6d9b132SKunihiko Hayashi .compatible = "socionext,uniphier-pxs3-pcie-phy", 285c6d9b132SKunihiko Hayashi .data = &uniphier_pxs3_data, 286c6d9b132SKunihiko Hayashi }, 287c6d9b132SKunihiko Hayashi { /* sentinel */ }, 288c6d9b132SKunihiko Hayashi }; 289c6d9b132SKunihiko Hayashi MODULE_DEVICE_TABLE(of, uniphier_pciephy_match); 290c6d9b132SKunihiko Hayashi 291c6d9b132SKunihiko Hayashi static struct platform_driver uniphier_pciephy_driver = { 292c6d9b132SKunihiko Hayashi .probe = uniphier_pciephy_probe, 293c6d9b132SKunihiko Hayashi .driver = { 294c6d9b132SKunihiko Hayashi .name = "uniphier-pcie-phy", 295c6d9b132SKunihiko Hayashi .of_match_table = uniphier_pciephy_match, 296c6d9b132SKunihiko Hayashi }, 297c6d9b132SKunihiko Hayashi }; 298c6d9b132SKunihiko Hayashi module_platform_driver(uniphier_pciephy_driver); 299c6d9b132SKunihiko Hayashi 300c6d9b132SKunihiko Hayashi MODULE_AUTHOR("Kunihiko Hayashi <hayashi.kunihiko@socionext.com>"); 301c6d9b132SKunihiko Hayashi MODULE_DESCRIPTION("UniPhier PHY driver for PCIe controller"); 302c6d9b132SKunihiko Hayashi MODULE_LICENSE("GPL v2"); 303