1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3 * HiSilicon INNO USB2 PHY Driver.
4 *
5 * Copyright (c) 2016-2017 HiSilicon Technologies Co., Ltd.
6 */
7
8 #include <linux/clk.h>
9 #include <linux/delay.h>
10 #include <linux/io.h>
11 #include <linux/module.h>
12 #include <linux/of.h>
13 #include <linux/phy/phy.h>
14 #include <linux/platform_device.h>
15 #include <linux/reset.h>
16
17 #define INNO_PHY_PORT_NUM 2
18 #define REF_CLK_STABLE_TIME 100 /* unit:us */
19 #define UTMI_CLK_STABLE_TIME 200 /* unit:us */
20 #define TEST_CLK_STABLE_TIME 2 /* unit:ms */
21 #define PHY_CLK_STABLE_TIME 2 /* unit:ms */
22 #define UTMI_RST_COMPLETE_TIME 2 /* unit:ms */
23 #define POR_RST_COMPLETE_TIME 300 /* unit:us */
24
25 #define PHY_TYPE_0 0
26 #define PHY_TYPE_1 1
27
28 #define PHY_TEST_DATA GENMASK(7, 0)
29 #define PHY_TEST_ADDR_OFFSET 8
30 #define PHY0_TEST_ADDR GENMASK(15, 8)
31 #define PHY0_TEST_PORT_OFFSET 16
32 #define PHY0_TEST_PORT GENMASK(18, 16)
33 #define PHY0_TEST_WREN BIT(21)
34 #define PHY0_TEST_CLK BIT(22) /* rising edge active */
35 #define PHY0_TEST_RST BIT(23) /* low active */
36 #define PHY1_TEST_ADDR GENMASK(11, 8)
37 #define PHY1_TEST_PORT_OFFSET 12
38 #define PHY1_TEST_PORT BIT(12)
39 #define PHY1_TEST_WREN BIT(13)
40 #define PHY1_TEST_CLK BIT(14) /* rising edge active */
41 #define PHY1_TEST_RST BIT(15) /* low active */
42
43 #define PHY_CLK_ENABLE BIT(2)
44
45 struct hisi_inno_phy_port {
46 struct reset_control *utmi_rst;
47 struct hisi_inno_phy_priv *priv;
48 };
49
50 struct hisi_inno_phy_priv {
51 void __iomem *mmio;
52 struct clk *ref_clk;
53 struct reset_control *por_rst;
54 unsigned int type;
55 struct hisi_inno_phy_port ports[INNO_PHY_PORT_NUM];
56 };
57
hisi_inno_phy_write_reg(struct hisi_inno_phy_priv * priv,u8 port,u32 addr,u32 data)58 static void hisi_inno_phy_write_reg(struct hisi_inno_phy_priv *priv,
59 u8 port, u32 addr, u32 data)
60 {
61 void __iomem *reg = priv->mmio;
62 u32 val;
63 u32 value;
64
65 if (priv->type == PHY_TYPE_0)
66 val = (data & PHY_TEST_DATA) |
67 ((addr << PHY_TEST_ADDR_OFFSET) & PHY0_TEST_ADDR) |
68 ((port << PHY0_TEST_PORT_OFFSET) & PHY0_TEST_PORT) |
69 PHY0_TEST_WREN | PHY0_TEST_RST;
70 else
71 val = (data & PHY_TEST_DATA) |
72 ((addr << PHY_TEST_ADDR_OFFSET) & PHY1_TEST_ADDR) |
73 ((port << PHY1_TEST_PORT_OFFSET) & PHY1_TEST_PORT) |
74 PHY1_TEST_WREN | PHY1_TEST_RST;
75 writel(val, reg);
76
77 value = val;
78 if (priv->type == PHY_TYPE_0)
79 value |= PHY0_TEST_CLK;
80 else
81 value |= PHY1_TEST_CLK;
82 writel(value, reg);
83
84 writel(val, reg);
85 }
86
hisi_inno_phy_setup(struct hisi_inno_phy_priv * priv)87 static void hisi_inno_phy_setup(struct hisi_inno_phy_priv *priv)
88 {
89 /* The phy clk is controlled by the port0 register 0x06. */
90 hisi_inno_phy_write_reg(priv, 0, 0x06, PHY_CLK_ENABLE);
91 msleep(PHY_CLK_STABLE_TIME);
92 }
93
hisi_inno_phy_init(struct phy * phy)94 static int hisi_inno_phy_init(struct phy *phy)
95 {
96 struct hisi_inno_phy_port *port = phy_get_drvdata(phy);
97 struct hisi_inno_phy_priv *priv = port->priv;
98 int ret;
99
100 ret = clk_prepare_enable(priv->ref_clk);
101 if (ret)
102 return ret;
103 udelay(REF_CLK_STABLE_TIME);
104
105 reset_control_deassert(priv->por_rst);
106 udelay(POR_RST_COMPLETE_TIME);
107
108 /* Set up phy registers */
109 hisi_inno_phy_setup(priv);
110
111 reset_control_deassert(port->utmi_rst);
112 udelay(UTMI_RST_COMPLETE_TIME);
113
114 return 0;
115 }
116
hisi_inno_phy_exit(struct phy * phy)117 static int hisi_inno_phy_exit(struct phy *phy)
118 {
119 struct hisi_inno_phy_port *port = phy_get_drvdata(phy);
120 struct hisi_inno_phy_priv *priv = port->priv;
121
122 reset_control_assert(port->utmi_rst);
123 reset_control_assert(priv->por_rst);
124 clk_disable_unprepare(priv->ref_clk);
125
126 return 0;
127 }
128
129 static const struct phy_ops hisi_inno_phy_ops = {
130 .init = hisi_inno_phy_init,
131 .exit = hisi_inno_phy_exit,
132 .owner = THIS_MODULE,
133 };
134
hisi_inno_phy_probe(struct platform_device * pdev)135 static int hisi_inno_phy_probe(struct platform_device *pdev)
136 {
137 struct device *dev = &pdev->dev;
138 struct device_node *np = dev->of_node;
139 struct hisi_inno_phy_priv *priv;
140 struct phy_provider *provider;
141 struct device_node *child;
142 int i = 0;
143 int ret;
144
145 priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
146 if (!priv)
147 return -ENOMEM;
148
149 priv->mmio = devm_platform_ioremap_resource(pdev, 0);
150 if (IS_ERR(priv->mmio)) {
151 ret = PTR_ERR(priv->mmio);
152 return ret;
153 }
154
155 priv->ref_clk = devm_clk_get(dev, NULL);
156 if (IS_ERR(priv->ref_clk))
157 return PTR_ERR(priv->ref_clk);
158
159 priv->por_rst = devm_reset_control_get_exclusive(dev, NULL);
160 if (IS_ERR(priv->por_rst))
161 return PTR_ERR(priv->por_rst);
162
163 priv->type = (uintptr_t) of_device_get_match_data(dev);
164
165 for_each_child_of_node(np, child) {
166 struct reset_control *rst;
167 struct phy *phy;
168
169 rst = of_reset_control_get_exclusive(child, NULL);
170 if (IS_ERR(rst)) {
171 of_node_put(child);
172 return PTR_ERR(rst);
173 }
174
175 priv->ports[i].utmi_rst = rst;
176 priv->ports[i].priv = priv;
177
178 phy = devm_phy_create(dev, child, &hisi_inno_phy_ops);
179 if (IS_ERR(phy)) {
180 of_node_put(child);
181 return PTR_ERR(phy);
182 }
183
184 phy_set_bus_width(phy, 8);
185 phy_set_drvdata(phy, &priv->ports[i]);
186 i++;
187
188 if (i >= INNO_PHY_PORT_NUM) {
189 dev_warn(dev, "Support %d ports in maximum\n", i);
190 of_node_put(child);
191 break;
192 }
193 }
194
195 provider = devm_of_phy_provider_register(dev, of_phy_simple_xlate);
196 return PTR_ERR_OR_ZERO(provider);
197 }
198
199 static const struct of_device_id hisi_inno_phy_of_match[] = {
200 { .compatible = "hisilicon,inno-usb2-phy",
201 .data = (void *) PHY_TYPE_0 },
202 { .compatible = "hisilicon,hi3798cv200-usb2-phy",
203 .data = (void *) PHY_TYPE_0 },
204 { .compatible = "hisilicon,hi3798mv100-usb2-phy",
205 .data = (void *) PHY_TYPE_1 },
206 { },
207 };
208 MODULE_DEVICE_TABLE(of, hisi_inno_phy_of_match);
209
210 static struct platform_driver hisi_inno_phy_driver = {
211 .probe = hisi_inno_phy_probe,
212 .driver = {
213 .name = "hisi-inno-phy",
214 .of_match_table = hisi_inno_phy_of_match,
215 }
216 };
217 module_platform_driver(hisi_inno_phy_driver);
218
219 MODULE_DESCRIPTION("HiSilicon INNO USB2 PHY Driver");
220 MODULE_LICENSE("GPL v2");
221