58 	int (*phy_write)(struct bcm_ns_usb3 *usb3, u16 reg, u16 value);
63 		.compatible = "brcm,ns-ax-usb3-phy",
67 		.compatible = "brcm,ns-bx-usb3-phy",
74 static int bcm_ns_usb3_mdio_phy_write(struct bcm_ns_usb3 *usb3, u16 reg,  in bcm_ns_usb3_mdio_phy_write()  argument
77 	return usb3->phy_write(usb3, reg, value);  in bcm_ns_usb3_mdio_phy_write()
80 static int bcm_ns_usb3_phy_init_ns_bx(struct bcm_ns_usb3 *usb3)  in bcm_ns_usb3_phy_init_ns_bx()  argument
84 	/* USB3 PLL Block */  in bcm_ns_usb3_phy_init_ns_bx()
85 	err = bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PHY_BASE_ADDR_REG,  in bcm_ns_usb3_phy_init_ns_bx()
91 	bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PLL_CONTROL, 0x1000);  in bcm_ns_usb3_phy_init_ns_bx()
94 	bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PLLA_CONTROL0, 0x6400);  in bcm_ns_usb3_phy_init_ns_bx()
97 	bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PLLA_CONTROL1, 0xc000);  in bcm_ns_usb3_phy_init_ns_bx()
100 	bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PLLA_CONTROL1, 0x8000);  in bcm_ns_usb3_phy_init_ns_bx()
102 	/* Deasserting USB3 system reset */  in bcm_ns_usb3_phy_init_ns_bx()
103 	writel(0, usb3->dmp + BCMA_RESET_CTL);  in bcm_ns_usb3_phy_init_ns_bx()
106 	bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PLL_CONTROL, 0x9000);  in bcm_ns_usb3_phy_init_ns_bx()
109 	bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PHY_BASE_ADDR_REG,  in bcm_ns_usb3_phy_init_ns_bx()
113 	bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_LFPS_CMP, 0xf30d);  in bcm_ns_usb3_phy_init_ns_bx()
116 	bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_LFPS_DEGLITCH, 0x6302);  in bcm_ns_usb3_phy_init_ns_bx()
119 	bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PHY_BASE_ADDR_REG,  in bcm_ns_usb3_phy_init_ns_bx()
123 	bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_TX_PMD_CONTROL1, 0x1003);  in bcm_ns_usb3_phy_init_ns_bx()
128 static int bcm_ns_usb3_phy_init_ns_ax(struct bcm_ns_usb3 *usb3)  in bcm_ns_usb3_phy_init_ns_ax()  argument
133 	err = bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PHY_BASE_ADDR_REG,  in bcm_ns_usb3_phy_init_ns_ax()
138 	bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PLLA_CONTROL0, 0x6400);  in bcm_ns_usb3_phy_init_ns_ax()
140 	bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PHY_BASE_ADDR_REG, 0x80e0);  in bcm_ns_usb3_phy_init_ns_ax()
142 	bcm_ns_usb3_mdio_phy_write(usb3, 0x02, 0x009c);  in bcm_ns_usb3_phy_init_ns_ax()
145 	bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PHY_BASE_ADDR_REG,  in bcm_ns_usb3_phy_init_ns_ax()
148 	bcm_ns_usb3_mdio_phy_write(usb3, 0x02, 0x21d3);  in bcm_ns_usb3_phy_init_ns_ax()
150 	bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_TX_PMD_CONTROL1, 0x1003);  in bcm_ns_usb3_phy_init_ns_ax()
152 	/* Deasserting USB3 system reset */  in bcm_ns_usb3_phy_init_ns_ax()
153 	writel(0, usb3->dmp + BCMA_RESET_CTL);  in bcm_ns_usb3_phy_init_ns_ax()
160 	struct bcm_ns_usb3 *usb3 = phy_get_drvdata(phy);  in bcm_ns_usb3_phy_init()  local
163 	/* Perform USB3 system soft reset */  in bcm_ns_usb3_phy_init()
164 	writel(BCMA_RESET_CTL_RESET, usb3->dmp + BCMA_RESET_CTL);  in bcm_ns_usb3_phy_init()
166 	switch (usb3->family) {  in bcm_ns_usb3_phy_init()
168 		err = bcm_ns_usb3_phy_init_ns_ax(usb3);  in bcm_ns_usb3_phy_init()
171 		err = bcm_ns_usb3_phy_init_ns_bx(usb3);  in bcm_ns_usb3_phy_init()
190 static int bcm_ns_usb3_mdiodev_phy_write(struct bcm_ns_usb3 *usb3, u16 reg,  in bcm_ns_usb3_mdiodev_phy_write()  argument
193 	struct mdio_device *mdiodev = usb3->mdiodev;  in bcm_ns_usb3_mdiodev_phy_write()
204 	struct bcm_ns_usb3 *usb3;  in bcm_ns_usb3_mdio_probe()  local
208 	usb3 = devm_kzalloc(dev, sizeof(*usb3), GFP_KERNEL);  in bcm_ns_usb3_mdio_probe()
209 	if (!usb3)  in bcm_ns_usb3_mdio_probe()
212 	usb3->dev = dev;  in bcm_ns_usb3_mdio_probe()
213 	usb3->mdiodev = mdiodev;  in bcm_ns_usb3_mdio_probe()
218 	usb3->family = (enum bcm_ns_family)of_id->data;  in bcm_ns_usb3_mdio_probe()
220 	syscon_np = of_parse_phandle(dev->of_node, "usb3-dmp-syscon", 0);  in bcm_ns_usb3_mdio_probe()
226 	usb3->dmp = devm_ioremap_resource(dev, &res);  in bcm_ns_usb3_mdio_probe()
227 	if (IS_ERR(usb3->dmp)) {  in bcm_ns_usb3_mdio_probe()
229 		return PTR_ERR(usb3->dmp);  in bcm_ns_usb3_mdio_probe()
232 	usb3->phy_write = bcm_ns_usb3_mdiodev_phy_write;  in bcm_ns_usb3_mdio_probe()
234 	usb3->phy = devm_phy_create(dev, NULL, &ops);  in bcm_ns_usb3_mdio_probe()
235 	if (IS_ERR(usb3->phy)) {  in bcm_ns_usb3_mdio_probe()
237 		return PTR_ERR(usb3->phy);  in bcm_ns_usb3_mdio_probe()
240 	phy_set_drvdata(usb3->phy, usb3);  in bcm_ns_usb3_mdio_probe()
261 static int bcm_ns_usb3_wait_reg(struct bcm_ns_usb3 *usb3, void __iomem *addr,  in bcm_ns_usb3_wait_reg()  argument
270 		dev_err(usb3->dev, "Timeout waiting for register %p\n", addr);  in bcm_ns_usb3_wait_reg()
275 static inline int bcm_ns_usb3_mii_mng_wait_idle(struct bcm_ns_usb3 *usb3)  in bcm_ns_usb3_mii_mng_wait_idle()  argument
277 	return bcm_ns_usb3_wait_reg(usb3, usb3->ccb_mii + BCMA_CCB_MII_MNG_CTL,  in bcm_ns_usb3_mii_mng_wait_idle()
282 static int bcm_ns_usb3_platform_phy_write(struct bcm_ns_usb3 *usb3, u16 reg,  in bcm_ns_usb3_platform_phy_write()  argument
288 	err = bcm_ns_usb3_mii_mng_wait_idle(usb3);  in bcm_ns_usb3_platform_phy_write()
290 		dev_err(usb3->dev, "Couldn't write 0x%08x value\n", value);  in bcm_ns_usb3_platform_phy_write()
298 	writel(tmp, usb3->ccb_mii + BCMA_CCB_MII_MNG_CMD_DATA);  in bcm_ns_usb3_platform_phy_write()
300 	return bcm_ns_usb3_mii_mng_wait_idle(usb3);  in bcm_ns_usb3_platform_phy_write()
307 	struct bcm_ns_usb3 *usb3;  in bcm_ns_usb3_probe()  local
311 	usb3 = devm_kzalloc(dev, sizeof(*usb3), GFP_KERNEL);  in bcm_ns_usb3_probe()
312 	if (!usb3)  in bcm_ns_usb3_probe()
315 	usb3->dev = dev;  in bcm_ns_usb3_probe()
320 	usb3->family = (enum bcm_ns_family)of_id->data;  in bcm_ns_usb3_probe()
323 	usb3->dmp = devm_ioremap_resource(dev, res);  in bcm_ns_usb3_probe()
324 	if (IS_ERR(usb3->dmp)) {  in bcm_ns_usb3_probe()
326 		return PTR_ERR(usb3->dmp);  in bcm_ns_usb3_probe()
330 	usb3->ccb_mii = devm_ioremap_resource(dev, res);  in bcm_ns_usb3_probe()
331 	if (IS_ERR(usb3->ccb_mii)) {  in bcm_ns_usb3_probe()
333 		return PTR_ERR(usb3->ccb_mii);  in bcm_ns_usb3_probe()
337 	writel(0x0000009a, usb3->ccb_mii + BCMA_CCB_MII_MNG_CTL);  in bcm_ns_usb3_probe()
342 	usb3->phy_write = bcm_ns_usb3_platform_phy_write;  in bcm_ns_usb3_probe()
344 	usb3->phy = devm_phy_create(dev, NULL, &ops);  in bcm_ns_usb3_probe()
345 	if (IS_ERR(usb3->phy)) {  in bcm_ns_usb3_probe()
347 		return PTR_ERR(usb3->phy);  in bcm_ns_usb3_probe()
350 	phy_set_drvdata(usb3->phy, usb3);  in bcm_ns_usb3_probe()
351 	platform_set_drvdata(pdev, usb3);  in bcm_ns_usb3_probe()