1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * Broadcom Northstar USB 3.0 PHY Driver
4  *
5  * Copyright (C) 2016 Rafał Miłecki <rafal@milecki.pl>
6  * Copyright (C) 2016 Broadcom
7  *
8  * All magic values used for initialization (and related comments) were obtained
9  * from Broadcom's SDK:
10  * Copyright (c) Broadcom Corp, 2012
11  */
12 
13 #include <linux/bcma/bcma.h>
14 #include <linux/delay.h>
15 #include <linux/err.h>
16 #include <linux/iopoll.h>
17 #include <linux/mdio.h>
18 #include <linux/module.h>
19 #include <linux/of_address.h>
20 #include <linux/of_platform.h>
21 #include <linux/platform_device.h>
22 #include <linux/phy/phy.h>
23 #include <linux/slab.h>
24 
25 #define BCM_NS_USB3_PHY_BASE_ADDR_REG	0x1f
26 #define BCM_NS_USB3_PHY_PLL30_BLOCK	0x8000
27 #define BCM_NS_USB3_PHY_TX_PMD_BLOCK	0x8040
28 #define BCM_NS_USB3_PHY_PIPE_BLOCK	0x8060
29 
30 /* Registers of PLL30 block */
31 #define BCM_NS_USB3_PLL_CONTROL		0x01
32 #define BCM_NS_USB3_PLLA_CONTROL0	0x0a
33 #define BCM_NS_USB3_PLLA_CONTROL1	0x0b
34 
35 /* Registers of TX PMD block */
36 #define BCM_NS_USB3_TX_PMD_CONTROL1	0x01
37 
38 /* Registers of PIPE block */
39 #define BCM_NS_USB3_LFPS_CMP		0x02
40 #define BCM_NS_USB3_LFPS_DEGLITCH	0x03
41 
42 enum bcm_ns_family {
43 	BCM_NS_UNKNOWN,
44 	BCM_NS_AX,
45 	BCM_NS_BX,
46 };
47 
48 struct bcm_ns_usb3 {
49 	struct device *dev;
50 	enum bcm_ns_family family;
51 	void __iomem *dmp;
52 	struct mdio_device *mdiodev;
53 	struct phy *phy;
54 };
55 
56 static const struct of_device_id bcm_ns_usb3_id_table[] = {
57 	{
58 		.compatible = "brcm,ns-ax-usb3-phy",
59 		.data = (int *)BCM_NS_AX,
60 	},
61 	{
62 		.compatible = "brcm,ns-bx-usb3-phy",
63 		.data = (int *)BCM_NS_BX,
64 	},
65 	{},
66 };
67 
68 static int bcm_ns_usb3_mdio_phy_write(struct bcm_ns_usb3 *usb3, u16 reg,
69 				      u16 value);
70 
bcm_ns_usb3_phy_init_ns_bx(struct bcm_ns_usb3 * usb3)71 static int bcm_ns_usb3_phy_init_ns_bx(struct bcm_ns_usb3 *usb3)
72 {
73 	int err;
74 
75 	/* USB3 PLL Block */
76 	err = bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PHY_BASE_ADDR_REG,
77 					 BCM_NS_USB3_PHY_PLL30_BLOCK);
78 	if (err < 0)
79 		return err;
80 
81 	/* Assert Ana_Pllseq start */
82 	bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PLL_CONTROL, 0x1000);
83 
84 	/* Assert CML Divider ratio to 26 */
85 	bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PLLA_CONTROL0, 0x6400);
86 
87 	/* Asserting PLL Reset */
88 	bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PLLA_CONTROL1, 0xc000);
89 
90 	/* Deaaserting PLL Reset */
91 	bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PLLA_CONTROL1, 0x8000);
92 
93 	/* Deasserting USB3 system reset */
94 	writel(0, usb3->dmp + BCMA_RESET_CTL);
95 
96 	/* PLL frequency monitor enable */
97 	bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PLL_CONTROL, 0x9000);
98 
99 	/* PIPE Block */
100 	bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PHY_BASE_ADDR_REG,
101 				   BCM_NS_USB3_PHY_PIPE_BLOCK);
102 
103 	/* CMPMAX & CMPMINTH setting */
104 	bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_LFPS_CMP, 0xf30d);
105 
106 	/* DEGLITCH MIN & MAX setting */
107 	bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_LFPS_DEGLITCH, 0x6302);
108 
109 	/* TXPMD block */
110 	bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PHY_BASE_ADDR_REG,
111 				   BCM_NS_USB3_PHY_TX_PMD_BLOCK);
112 
113 	/* Enabling SSC */
114 	bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_TX_PMD_CONTROL1, 0x1003);
115 
116 	return 0;
117 }
118 
bcm_ns_usb3_phy_init_ns_ax(struct bcm_ns_usb3 * usb3)119 static int bcm_ns_usb3_phy_init_ns_ax(struct bcm_ns_usb3 *usb3)
120 {
121 	int err;
122 
123 	/* PLL30 block */
124 	err = bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PHY_BASE_ADDR_REG,
125 					 BCM_NS_USB3_PHY_PLL30_BLOCK);
126 	if (err < 0)
127 		return err;
128 
129 	bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PLLA_CONTROL0, 0x6400);
130 
131 	bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PHY_BASE_ADDR_REG, 0x80e0);
132 
133 	bcm_ns_usb3_mdio_phy_write(usb3, 0x02, 0x009c);
134 
135 	/* Enable SSC */
136 	bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PHY_BASE_ADDR_REG,
137 				   BCM_NS_USB3_PHY_TX_PMD_BLOCK);
138 
139 	bcm_ns_usb3_mdio_phy_write(usb3, 0x02, 0x21d3);
140 
141 	bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_TX_PMD_CONTROL1, 0x1003);
142 
143 	/* Deasserting USB3 system reset */
144 	writel(0, usb3->dmp + BCMA_RESET_CTL);
145 
146 	return 0;
147 }
148 
bcm_ns_usb3_phy_init(struct phy * phy)149 static int bcm_ns_usb3_phy_init(struct phy *phy)
150 {
151 	struct bcm_ns_usb3 *usb3 = phy_get_drvdata(phy);
152 	int err;
153 
154 	/* Perform USB3 system soft reset */
155 	writel(BCMA_RESET_CTL_RESET, usb3->dmp + BCMA_RESET_CTL);
156 
157 	switch (usb3->family) {
158 	case BCM_NS_AX:
159 		err = bcm_ns_usb3_phy_init_ns_ax(usb3);
160 		break;
161 	case BCM_NS_BX:
162 		err = bcm_ns_usb3_phy_init_ns_bx(usb3);
163 		break;
164 	default:
165 		WARN_ON(1);
166 		err = -ENOTSUPP;
167 	}
168 
169 	return err;
170 }
171 
172 static const struct phy_ops ops = {
173 	.init		= bcm_ns_usb3_phy_init,
174 	.owner		= THIS_MODULE,
175 };
176 
177 /**************************************************
178  * MDIO driver code
179  **************************************************/
180 
bcm_ns_usb3_mdio_phy_write(struct bcm_ns_usb3 * usb3,u16 reg,u16 value)181 static int bcm_ns_usb3_mdio_phy_write(struct bcm_ns_usb3 *usb3, u16 reg,
182 				      u16 value)
183 {
184 	struct mdio_device *mdiodev = usb3->mdiodev;
185 
186 	return mdiodev_write(mdiodev, reg, value);
187 }
188 
bcm_ns_usb3_mdio_probe(struct mdio_device * mdiodev)189 static int bcm_ns_usb3_mdio_probe(struct mdio_device *mdiodev)
190 {
191 	struct device *dev = &mdiodev->dev;
192 	const struct of_device_id *of_id;
193 	struct phy_provider *phy_provider;
194 	struct device_node *syscon_np;
195 	struct bcm_ns_usb3 *usb3;
196 	struct resource res;
197 	int err;
198 
199 	usb3 = devm_kzalloc(dev, sizeof(*usb3), GFP_KERNEL);
200 	if (!usb3)
201 		return -ENOMEM;
202 
203 	usb3->dev = dev;
204 	usb3->mdiodev = mdiodev;
205 
206 	of_id = of_match_device(bcm_ns_usb3_id_table, dev);
207 	if (!of_id)
208 		return -EINVAL;
209 	usb3->family = (enum bcm_ns_family)of_id->data;
210 
211 	syscon_np = of_parse_phandle(dev->of_node, "usb3-dmp-syscon", 0);
212 	err = of_address_to_resource(syscon_np, 0, &res);
213 	of_node_put(syscon_np);
214 	if (err)
215 		return err;
216 
217 	usb3->dmp = devm_ioremap_resource(dev, &res);
218 	if (IS_ERR(usb3->dmp))
219 		return PTR_ERR(usb3->dmp);
220 
221 	usb3->phy = devm_phy_create(dev, NULL, &ops);
222 	if (IS_ERR(usb3->phy)) {
223 		dev_err(dev, "Failed to create PHY\n");
224 		return PTR_ERR(usb3->phy);
225 	}
226 
227 	phy_set_drvdata(usb3->phy, usb3);
228 
229 	phy_provider = devm_of_phy_provider_register(dev, of_phy_simple_xlate);
230 
231 	return PTR_ERR_OR_ZERO(phy_provider);
232 }
233 
234 static struct mdio_driver bcm_ns_usb3_mdio_driver = {
235 	.mdiodrv = {
236 		.driver = {
237 			.name = "bcm_ns_mdio_usb3",
238 			.of_match_table = bcm_ns_usb3_id_table,
239 		},
240 	},
241 	.probe = bcm_ns_usb3_mdio_probe,
242 };
243 
244 mdio_module_driver(bcm_ns_usb3_mdio_driver);
245 
246 MODULE_LICENSE("GPL v2");
247 MODULE_DEVICE_TABLE(of, bcm_ns_usb3_id_table);
248