1// SPDX-License-Identifier: GPL-2.0
2/*
3 * phy-uniphier-usb2.c - PHY driver for UniPhier USB2 controller
4 * Copyright 2015-2018 Socionext Inc.
5 * Author:
6 * Kunihiko Hayashi <hayashi.kunihiko@socionext.com>
7 */
8
9#include <linux/mfd/syscon.h>
10#include <linux/module.h>
11#include <linux/of.h>
12#include <linux/of_platform.h>
13#include <linux/phy/phy.h>
14#include <linux/platform_device.h>
15#include <linux/regmap.h>
16#include <linux/regulator/consumer.h>
17
18#define SG_USBPHY1CTRL 0x500
19#define SG_USBPHY1CTRL2 0x504
20#define SG_USBPHY2CTRL 0x508
21#define SG_USBPHY2CTRL2 0x50c /* LD11 */
22#define SG_USBPHY12PLL 0x50c /* Pro4 */
23#define SG_USBPHY3CTRL 0x510
24#define SG_USBPHY3CTRL2 0x514
25#define SG_USBPHY4CTRL 0x518 /* Pro4 */
26#define SG_USBPHY4CTRL2 0x51c /* Pro4 */
27#define SG_USBPHY34PLL 0x51c /* Pro4 */
28
29struct uniphier_u2phy_param {
30 u32 offset;
31 u32 value;
32};
33
34struct uniphier_u2phy_soc_data {
35 struct uniphier_u2phy_param config0;
36 struct uniphier_u2phy_param config1;
37};
38
39struct uniphier_u2phy_priv {
40 struct regmap *regmap;
41 struct phy *phy;
42 struct regulator *vbus;
43 const struct uniphier_u2phy_soc_data *data;
44 struct uniphier_u2phy_priv *next;
45};
46
47static int uniphier_u2phy_power_on(struct phy *phy)
48{
49 struct uniphier_u2phy_priv *priv = phy_get_drvdata(phy);
50 int ret = 0;
51
52 if (priv->vbus)
53 ret = regulator_enable(regulator: priv->vbus);
54
55 return ret;
56}
57
58static int uniphier_u2phy_power_off(struct phy *phy)
59{
60 struct uniphier_u2phy_priv *priv = phy_get_drvdata(phy);
61
62 if (priv->vbus)
63 regulator_disable(regulator: priv->vbus);
64
65 return 0;
66}
67
68static int uniphier_u2phy_init(struct phy *phy)
69{
70 struct uniphier_u2phy_priv *priv = phy_get_drvdata(phy);
71
72 if (!priv->data)
73 return 0;
74
75 regmap_write(map: priv->regmap, reg: priv->data->config0.offset,
76 val: priv->data->config0.value);
77 regmap_write(map: priv->regmap, reg: priv->data->config1.offset,
78 val: priv->data->config1.value);
79
80 return 0;
81}
82
83static struct phy *uniphier_u2phy_xlate(struct device *dev,
84 const struct of_phandle_args *args)
85{
86 struct uniphier_u2phy_priv *priv = dev_get_drvdata(dev);
87
88 while (priv && args->np != priv->phy->dev.of_node)
89 priv = priv->next;
90
91 if (!priv) {
92 dev_err(dev, "Failed to find appropriate phy\n");
93 return ERR_PTR(error: -EINVAL);
94 }
95
96 return priv->phy;
97}
98
99static const struct phy_ops uniphier_u2phy_ops = {
100 .init = uniphier_u2phy_init,
101 .power_on = uniphier_u2phy_power_on,
102 .power_off = uniphier_u2phy_power_off,
103 .owner = THIS_MODULE,
104};
105
106static int uniphier_u2phy_probe(struct platform_device *pdev)
107{
108 struct device *dev = &pdev->dev;
109 struct device_node *parent, *child;
110 struct uniphier_u2phy_priv *priv = NULL, *next = NULL;
111 struct phy_provider *phy_provider;
112 struct regmap *regmap;
113 const struct uniphier_u2phy_soc_data *data;
114 int ret, data_idx, ndatas;
115
116 data = of_device_get_match_data(dev);
117 if (WARN_ON(!data))
118 return -EINVAL;
119
120 /* get number of data */
121 for (ndatas = 0; data[ndatas].config0.offset; ndatas++)
122 ;
123
124 parent = of_get_parent(node: dev->of_node);
125 regmap = syscon_node_to_regmap(np: parent);
126 of_node_put(node: parent);
127 if (IS_ERR(ptr: regmap)) {
128 dev_err(dev, "Failed to get regmap\n");
129 return PTR_ERR(ptr: regmap);
130 }
131
132 for_each_child_of_node(dev->of_node, child) {
133 priv = devm_kzalloc(dev, size: sizeof(*priv), GFP_KERNEL);
134 if (!priv) {
135 ret = -ENOMEM;
136 goto out_put_child;
137 }
138 priv->regmap = regmap;
139
140 priv->vbus = devm_regulator_get_optional(dev, id: "vbus");
141 if (IS_ERR(ptr: priv->vbus)) {
142 if (PTR_ERR(ptr: priv->vbus) == -EPROBE_DEFER) {
143 ret = PTR_ERR(ptr: priv->vbus);
144 goto out_put_child;
145 }
146 priv->vbus = NULL;
147 }
148
149 priv->phy = devm_phy_create(dev, node: child, ops: &uniphier_u2phy_ops);
150 if (IS_ERR(ptr: priv->phy)) {
151 dev_err(dev, "Failed to create phy\n");
152 ret = PTR_ERR(ptr: priv->phy);
153 goto out_put_child;
154 }
155
156 ret = of_property_read_u32(np: child, propname: "reg", out_value: &data_idx);
157 if (ret) {
158 dev_err(dev, "Failed to get reg property\n");
159 goto out_put_child;
160 }
161
162 if (data_idx < ndatas)
163 priv->data = &data[data_idx];
164 else
165 dev_warn(dev, "No phy configuration: %s\n",
166 child->full_name);
167
168 phy_set_drvdata(phy: priv->phy, data: priv);
169 priv->next = next;
170 next = priv;
171 }
172
173 dev_set_drvdata(dev, data: priv);
174 phy_provider = devm_of_phy_provider_register(dev,
175 uniphier_u2phy_xlate);
176 return PTR_ERR_OR_ZERO(ptr: phy_provider);
177
178out_put_child:
179 of_node_put(node: child);
180
181 return ret;
182}
183
184static const struct uniphier_u2phy_soc_data uniphier_pro4_data[] = {
185 {
186 .config0 = { SG_USBPHY1CTRL, 0x05142400 },
187 .config1 = { SG_USBPHY12PLL, 0x00010010 },
188 },
189 {
190 .config0 = { SG_USBPHY2CTRL, 0x05142400 },
191 .config1 = { SG_USBPHY12PLL, 0x00010010 },
192 },
193 {
194 .config0 = { SG_USBPHY3CTRL, 0x05142400 },
195 .config1 = { SG_USBPHY34PLL, 0x00010010 },
196 },
197 {
198 .config0 = { SG_USBPHY4CTRL, 0x05142400 },
199 .config1 = { SG_USBPHY34PLL, 0x00010010 },
200 },
201 { /* sentinel */ }
202};
203
204static const struct uniphier_u2phy_soc_data uniphier_ld11_data[] = {
205 {
206 .config0 = { SG_USBPHY1CTRL, 0x82280000 },
207 .config1 = { SG_USBPHY1CTRL2, 0x00000106 },
208 },
209 {
210 .config0 = { SG_USBPHY2CTRL, 0x82280000 },
211 .config1 = { SG_USBPHY2CTRL2, 0x00000106 },
212 },
213 {
214 .config0 = { SG_USBPHY3CTRL, 0x82280000 },
215 .config1 = { SG_USBPHY3CTRL2, 0x00000106 },
216 },
217 { /* sentinel */ }
218};
219
220static const struct of_device_id uniphier_u2phy_match[] = {
221 {
222 .compatible = "socionext,uniphier-pro4-usb2-phy",
223 .data = &uniphier_pro4_data,
224 },
225 {
226 .compatible = "socionext,uniphier-ld11-usb2-phy",
227 .data = &uniphier_ld11_data,
228 },
229 { /* sentinel */ }
230};
231MODULE_DEVICE_TABLE(of, uniphier_u2phy_match);
232
233static struct platform_driver uniphier_u2phy_driver = {
234 .probe = uniphier_u2phy_probe,
235 .driver = {
236 .name = "uniphier-usb2-phy",
237 .of_match_table = uniphier_u2phy_match,
238 },
239};
240module_platform_driver(uniphier_u2phy_driver);
241
242MODULE_AUTHOR("Kunihiko Hayashi <hayashi.kunihiko@socionext.com>");
243MODULE_DESCRIPTION("UniPhier PHY driver for USB2 controller");
244MODULE_LICENSE("GPL v2");
245

source code of linux/drivers/phy/socionext/phy-uniphier-usb2.c