57 	int (*phy_write)(struct bcm_ns_usb3 *usb3, u16 reg, u16 value);
73 static int bcm_ns_usb3_mdio_phy_write(struct bcm_ns_usb3 *usb3, u16 reg,  in bcm_ns_usb3_mdio_phy_write()  argument
76 	return usb3->phy_write(usb3, reg, value);  in bcm_ns_usb3_mdio_phy_write()
79 static int bcm_ns_usb3_phy_init_ns_bx(struct bcm_ns_usb3 *usb3)  in bcm_ns_usb3_phy_init_ns_bx()  argument
84 	err = bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PHY_BASE_ADDR_REG,  in bcm_ns_usb3_phy_init_ns_bx()
90 	bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PLL_CONTROL, 0x1000);  in bcm_ns_usb3_phy_init_ns_bx()
93 	bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PLLA_CONTROL0, 0x6400);  in bcm_ns_usb3_phy_init_ns_bx()
96 	bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PLLA_CONTROL1, 0xc000);  in bcm_ns_usb3_phy_init_ns_bx()
99 	bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PLLA_CONTROL1, 0x8000);  in bcm_ns_usb3_phy_init_ns_bx()
102 	writel(0, usb3->dmp + BCMA_RESET_CTL);  in bcm_ns_usb3_phy_init_ns_bx()
105 	bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PLL_CONTROL, 0x9000);  in bcm_ns_usb3_phy_init_ns_bx()
108 	bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PHY_BASE_ADDR_REG,  in bcm_ns_usb3_phy_init_ns_bx()
112 	bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_LFPS_CMP, 0xf30d);  in bcm_ns_usb3_phy_init_ns_bx()
115 	bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_LFPS_DEGLITCH, 0x6302);  in bcm_ns_usb3_phy_init_ns_bx()
118 	bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PHY_BASE_ADDR_REG,  in bcm_ns_usb3_phy_init_ns_bx()
122 	bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_TX_PMD_CONTROL1, 0x1003);  in bcm_ns_usb3_phy_init_ns_bx()
127 static int bcm_ns_usb3_phy_init_ns_ax(struct bcm_ns_usb3 *usb3)  in bcm_ns_usb3_phy_init_ns_ax()  argument
132 	err = bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PHY_BASE_ADDR_REG,  in bcm_ns_usb3_phy_init_ns_ax()
137 	bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PLLA_CONTROL0, 0x6400);  in bcm_ns_usb3_phy_init_ns_ax()
139 	bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PHY_BASE_ADDR_REG, 0x80e0);  in bcm_ns_usb3_phy_init_ns_ax()
141 	bcm_ns_usb3_mdio_phy_write(usb3, 0x02, 0x009c);  in bcm_ns_usb3_phy_init_ns_ax()
144 	bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_PHY_BASE_ADDR_REG,  in bcm_ns_usb3_phy_init_ns_ax()
147 	bcm_ns_usb3_mdio_phy_write(usb3, 0x02, 0x21d3);  in bcm_ns_usb3_phy_init_ns_ax()
149 	bcm_ns_usb3_mdio_phy_write(usb3, BCM_NS_USB3_TX_PMD_CONTROL1, 0x1003);  in bcm_ns_usb3_phy_init_ns_ax()
152 	writel(0, usb3->dmp + BCMA_RESET_CTL);  in bcm_ns_usb3_phy_init_ns_ax()
159 	struct bcm_ns_usb3 *usb3 = phy_get_drvdata(phy);  in bcm_ns_usb3_phy_init()  local
163 	writel(BCMA_RESET_CTL_RESET, usb3->dmp + BCMA_RESET_CTL);  in bcm_ns_usb3_phy_init()
165 	switch (usb3->family) {  in bcm_ns_usb3_phy_init()
167 		err = bcm_ns_usb3_phy_init_ns_ax(usb3);  in bcm_ns_usb3_phy_init()
170 		err = bcm_ns_usb3_phy_init_ns_bx(usb3);  in bcm_ns_usb3_phy_init()
189 static int bcm_ns_usb3_mdiodev_phy_write(struct bcm_ns_usb3 *usb3, u16 reg,  in bcm_ns_usb3_mdiodev_phy_write()  argument
192 	struct mdio_device *mdiodev = usb3->mdiodev;  in bcm_ns_usb3_mdiodev_phy_write()
203 	struct bcm_ns_usb3 *usb3;  in bcm_ns_usb3_mdio_probe()  local
207 	usb3 = devm_kzalloc(dev, sizeof(*usb3), GFP_KERNEL);  in bcm_ns_usb3_mdio_probe()
208 	if (!usb3)  in bcm_ns_usb3_mdio_probe()
211 	usb3->dev = dev;  in bcm_ns_usb3_mdio_probe()
212 	usb3->mdiodev = mdiodev;  in bcm_ns_usb3_mdio_probe()
217 	usb3->family = (enum bcm_ns_family)of_id->data;  in bcm_ns_usb3_mdio_probe()
225 	usb3->dmp = devm_ioremap_resource(dev, &res);  in bcm_ns_usb3_mdio_probe()
226 	if (IS_ERR(usb3->dmp)) {  in bcm_ns_usb3_mdio_probe()
228 		return PTR_ERR(usb3->dmp);  in bcm_ns_usb3_mdio_probe()
231 	usb3->phy_write = bcm_ns_usb3_mdiodev_phy_write;  in bcm_ns_usb3_mdio_probe()
233 	usb3->phy = devm_phy_create(dev, NULL, &ops);  in bcm_ns_usb3_mdio_probe()
234 	if (IS_ERR(usb3->phy)) {  in bcm_ns_usb3_mdio_probe()
236 		return PTR_ERR(usb3->phy);  in bcm_ns_usb3_mdio_probe()
239 	phy_set_drvdata(usb3->phy, usb3);  in bcm_ns_usb3_mdio_probe()
260 static int bcm_ns_usb3_wait_reg(struct bcm_ns_usb3 *usb3, void __iomem *addr,  in bcm_ns_usb3_wait_reg()  argument
274 	dev_err(usb3->dev, "Timeout waiting for register %p\n", addr);  in bcm_ns_usb3_wait_reg()
279 static inline int bcm_ns_usb3_mii_mng_wait_idle(struct bcm_ns_usb3 *usb3)  in bcm_ns_usb3_mii_mng_wait_idle()  argument
281 	return bcm_ns_usb3_wait_reg(usb3, usb3->ccb_mii + BCMA_CCB_MII_MNG_CTL,  in bcm_ns_usb3_mii_mng_wait_idle()
286 static int bcm_ns_usb3_platform_phy_write(struct bcm_ns_usb3 *usb3, u16 reg,  in bcm_ns_usb3_platform_phy_write()  argument
292 	err = bcm_ns_usb3_mii_mng_wait_idle(usb3);  in bcm_ns_usb3_platform_phy_write()
294 		dev_err(usb3->dev, "Couldn't write 0x%08x value\n", value);  in bcm_ns_usb3_platform_phy_write()
302 	writel(tmp, usb3->ccb_mii + BCMA_CCB_MII_MNG_CMD_DATA);  in bcm_ns_usb3_platform_phy_write()
304 	return bcm_ns_usb3_mii_mng_wait_idle(usb3);  in bcm_ns_usb3_platform_phy_write()
311 	struct bcm_ns_usb3 *usb3;  in bcm_ns_usb3_probe()  local
315 	usb3 = devm_kzalloc(dev, sizeof(*usb3), GFP_KERNEL);  in bcm_ns_usb3_probe()
316 	if (!usb3)  in bcm_ns_usb3_probe()
319 	usb3->dev = dev;  in bcm_ns_usb3_probe()
324 	usb3->family = (enum bcm_ns_family)of_id->data;  in bcm_ns_usb3_probe()
327 	usb3->dmp = devm_ioremap_resource(dev, res);  in bcm_ns_usb3_probe()
328 	if (IS_ERR(usb3->dmp)) {  in bcm_ns_usb3_probe()
330 		return PTR_ERR(usb3->dmp);  in bcm_ns_usb3_probe()
334 	usb3->ccb_mii = devm_ioremap_resource(dev, res);  in bcm_ns_usb3_probe()
335 	if (IS_ERR(usb3->ccb_mii)) {  in bcm_ns_usb3_probe()
337 		return PTR_ERR(usb3->ccb_mii);  in bcm_ns_usb3_probe()
341 	writel(0x0000009a, usb3->ccb_mii + BCMA_CCB_MII_MNG_CTL);  in bcm_ns_usb3_probe()
346 	usb3->phy_write = bcm_ns_usb3_platform_phy_write;  in bcm_ns_usb3_probe()
348 	usb3->phy = devm_phy_create(dev, NULL, &ops);  in bcm_ns_usb3_probe()
349 	if (IS_ERR(usb3->phy)) {  in bcm_ns_usb3_probe()
351 		return PTR_ERR(usb3->phy);  in bcm_ns_usb3_probe()
354 	phy_set_drvdata(usb3->phy, usb3);  in bcm_ns_usb3_probe()
355 	platform_set_drvdata(pdev, usb3);  in bcm_ns_usb3_probe()