1 // SPDX-License-Identifier: GPL-2.0 2 /* 3 * MediaTek USB3.1 gen2 xsphy Driver 4 * 5 * Copyright (c) 2018 MediaTek Inc. 6 * Author: Chunfeng Yun <chunfeng.yun@mediatek.com> 7 * 8 */ 9 10 #include <dt-bindings/phy/phy.h> 11 #include <linux/clk.h> 12 #include <linux/delay.h> 13 #include <linux/io.h> 14 #include <linux/iopoll.h> 15 #include <linux/module.h> 16 #include <linux/of_address.h> 17 #include <linux/phy/phy.h> 18 #include <linux/platform_device.h> 19 20 /* u2 phy banks */ 21 #define SSUSB_SIFSLV_MISC 0x000 22 #define SSUSB_SIFSLV_U2FREQ 0x100 23 #define SSUSB_SIFSLV_U2PHY_COM 0x300 24 25 /* u3 phy shared banks */ 26 #define SSPXTP_SIFSLV_DIG_GLB 0x000 27 #define SSPXTP_SIFSLV_PHYA_GLB 0x100 28 29 /* u3 phy banks */ 30 #define SSPXTP_SIFSLV_DIG_LN_TOP 0x000 31 #define SSPXTP_SIFSLV_DIG_LN_TX0 0x100 32 #define SSPXTP_SIFSLV_DIG_LN_RX0 0x200 33 #define SSPXTP_SIFSLV_DIG_LN_DAIF 0x300 34 #define SSPXTP_SIFSLV_PHYA_LN 0x400 35 36 #define XSP_U2FREQ_FMCR0 ((SSUSB_SIFSLV_U2FREQ) + 0x00) 37 #define P2F_RG_FREQDET_EN BIT(24) 38 #define P2F_RG_CYCLECNT GENMASK(23, 0) 39 #define P2F_RG_CYCLECNT_VAL(x) ((P2F_RG_CYCLECNT) & (x)) 40 41 #define XSP_U2FREQ_MMONR0 ((SSUSB_SIFSLV_U2FREQ) + 0x0c) 42 43 #define XSP_U2FREQ_FMMONR1 ((SSUSB_SIFSLV_U2FREQ) + 0x10) 44 #define P2F_RG_FRCK_EN BIT(8) 45 #define P2F_USB_FM_VALID BIT(0) 46 47 #define XSP_USBPHYACR0 ((SSUSB_SIFSLV_U2PHY_COM) + 0x00) 48 #define P2A0_RG_INTR_EN BIT(5) 49 50 #define XSP_USBPHYACR1 ((SSUSB_SIFSLV_U2PHY_COM) + 0x04) 51 #define P2A1_RG_INTR_CAL GENMASK(23, 19) 52 #define P2A1_RG_INTR_CAL_VAL(x) ((0x1f & (x)) << 19) 53 #define P2A1_RG_VRT_SEL GENMASK(14, 12) 54 #define P2A1_RG_VRT_SEL_VAL(x) ((0x7 & (x)) << 12) 55 #define P2A1_RG_TERM_SEL GENMASK(10, 8) 56 #define P2A1_RG_TERM_SEL_VAL(x) ((0x7 & (x)) << 8) 57 58 #define XSP_USBPHYACR5 ((SSUSB_SIFSLV_U2PHY_COM) + 0x014) 59 #define P2A5_RG_HSTX_SRCAL_EN BIT(15) 60 #define P2A5_RG_HSTX_SRCTRL GENMASK(14, 12) 61 #define P2A5_RG_HSTX_SRCTRL_VAL(x) ((0x7 & (x)) << 12) 62 63 #define XSP_USBPHYACR6 ((SSUSB_SIFSLV_U2PHY_COM) + 0x018) 64 #define P2A6_RG_BC11_SW_EN BIT(23) 65 #define P2A6_RG_OTG_VBUSCMP_EN BIT(20) 66 67 #define XSP_U2PHYDTM1 ((SSUSB_SIFSLV_U2PHY_COM) + 0x06C) 68 #define P2D_FORCE_IDDIG BIT(9) 69 #define P2D_RG_VBUSVALID BIT(5) 70 #define P2D_RG_SESSEND BIT(4) 71 #define P2D_RG_AVALID BIT(2) 72 #define P2D_RG_IDDIG BIT(1) 73 74 #define SSPXTP_PHYA_GLB_00 ((SSPXTP_SIFSLV_PHYA_GLB) + 0x00) 75 #define RG_XTP_GLB_BIAS_INTR_CTRL GENMASK(21, 16) 76 #define RG_XTP_GLB_BIAS_INTR_CTRL_VAL(x) ((0x3f & (x)) << 16) 77 78 #define SSPXTP_PHYA_LN_04 ((SSPXTP_SIFSLV_PHYA_LN) + 0x04) 79 #define RG_XTP_LN0_TX_IMPSEL GENMASK(4, 0) 80 #define RG_XTP_LN0_TX_IMPSEL_VAL(x) (0x1f & (x)) 81 82 #define SSPXTP_PHYA_LN_14 ((SSPXTP_SIFSLV_PHYA_LN) + 0x014) 83 #define RG_XTP_LN0_RX_IMPSEL GENMASK(4, 0) 84 #define RG_XTP_LN0_RX_IMPSEL_VAL(x) (0x1f & (x)) 85 86 #define XSP_REF_CLK 26 /* MHZ */ 87 #define XSP_SLEW_RATE_COEF 17 88 #define XSP_SR_COEF_DIVISOR 1000 89 #define XSP_FM_DET_CYCLE_CNT 1024 90 91 struct xsphy_instance { 92 struct phy *phy; 93 void __iomem *port_base; 94 struct clk *ref_clk; /* reference clock of anolog phy */ 95 u32 index; 96 u32 type; 97 /* only for HQA test */ 98 int efuse_intr; 99 int efuse_tx_imp; 100 int efuse_rx_imp; 101 /* u2 eye diagram */ 102 int eye_src; 103 int eye_vrt; 104 int eye_term; 105 }; 106 107 struct mtk_xsphy { 108 struct device *dev; 109 void __iomem *glb_base; /* only shared u3 sif */ 110 struct xsphy_instance **phys; 111 int nphys; 112 int src_ref_clk; /* MHZ, reference clock for slew rate calibrate */ 113 int src_coef; /* coefficient for slew rate calibrate */ 114 }; 115 116 static void u2_phy_slew_rate_calibrate(struct mtk_xsphy *xsphy, 117 struct xsphy_instance *inst) 118 { 119 void __iomem *pbase = inst->port_base; 120 int calib_val; 121 int fm_out; 122 u32 tmp; 123 124 /* use force value */ 125 if (inst->eye_src) 126 return; 127 128 /* enable USB ring oscillator */ 129 tmp = readl(pbase + XSP_USBPHYACR5); 130 tmp |= P2A5_RG_HSTX_SRCAL_EN; 131 writel(tmp, pbase + XSP_USBPHYACR5); 132 udelay(1); /* wait clock stable */ 133 134 /* enable free run clock */ 135 tmp = readl(pbase + XSP_U2FREQ_FMMONR1); 136 tmp |= P2F_RG_FRCK_EN; 137 writel(tmp, pbase + XSP_U2FREQ_FMMONR1); 138 139 /* set cycle count as 1024 */ 140 tmp = readl(pbase + XSP_U2FREQ_FMCR0); 141 tmp &= ~(P2F_RG_CYCLECNT); 142 tmp |= P2F_RG_CYCLECNT_VAL(XSP_FM_DET_CYCLE_CNT); 143 writel(tmp, pbase + XSP_U2FREQ_FMCR0); 144 145 /* enable frequency meter */ 146 tmp = readl(pbase + XSP_U2FREQ_FMCR0); 147 tmp |= P2F_RG_FREQDET_EN; 148 writel(tmp, pbase + XSP_U2FREQ_FMCR0); 149 150 /* ignore return value */ 151 readl_poll_timeout(pbase + XSP_U2FREQ_FMMONR1, tmp, 152 (tmp & P2F_USB_FM_VALID), 10, 200); 153 154 fm_out = readl(pbase + XSP_U2FREQ_MMONR0); 155 156 /* disable frequency meter */ 157 tmp = readl(pbase + XSP_U2FREQ_FMCR0); 158 tmp &= ~P2F_RG_FREQDET_EN; 159 writel(tmp, pbase + XSP_U2FREQ_FMCR0); 160 161 /* disable free run clock */ 162 tmp = readl(pbase + XSP_U2FREQ_FMMONR1); 163 tmp &= ~P2F_RG_FRCK_EN; 164 writel(tmp, pbase + XSP_U2FREQ_FMMONR1); 165 166 if (fm_out) { 167 /* (1024 / FM_OUT) x reference clock frequency x coefficient */ 168 tmp = xsphy->src_ref_clk * xsphy->src_coef; 169 tmp = (tmp * XSP_FM_DET_CYCLE_CNT) / fm_out; 170 calib_val = DIV_ROUND_CLOSEST(tmp, XSP_SR_COEF_DIVISOR); 171 } else { 172 /* if FM detection fail, set default value */ 173 calib_val = 3; 174 } 175 dev_dbg(xsphy->dev, "phy.%d, fm_out:%d, calib:%d (clk:%d, coef:%d)\n", 176 inst->index, fm_out, calib_val, 177 xsphy->src_ref_clk, xsphy->src_coef); 178 179 /* set HS slew rate */ 180 tmp = readl(pbase + XSP_USBPHYACR5); 181 tmp &= ~P2A5_RG_HSTX_SRCTRL; 182 tmp |= P2A5_RG_HSTX_SRCTRL_VAL(calib_val); 183 writel(tmp, pbase + XSP_USBPHYACR5); 184 185 /* disable USB ring oscillator */ 186 tmp = readl(pbase + XSP_USBPHYACR5); 187 tmp &= ~P2A5_RG_HSTX_SRCAL_EN; 188 writel(tmp, pbase + XSP_USBPHYACR5); 189 } 190 191 static void u2_phy_instance_init(struct mtk_xsphy *xsphy, 192 struct xsphy_instance *inst) 193 { 194 void __iomem *pbase = inst->port_base; 195 u32 tmp; 196 197 /* DP/DM BC1.1 path Disable */ 198 tmp = readl(pbase + XSP_USBPHYACR6); 199 tmp &= ~P2A6_RG_BC11_SW_EN; 200 writel(tmp, pbase + XSP_USBPHYACR6); 201 202 tmp = readl(pbase + XSP_USBPHYACR0); 203 tmp |= P2A0_RG_INTR_EN; 204 writel(tmp, pbase + XSP_USBPHYACR0); 205 } 206 207 static void u2_phy_instance_power_on(struct mtk_xsphy *xsphy, 208 struct xsphy_instance *inst) 209 { 210 void __iomem *pbase = inst->port_base; 211 u32 index = inst->index; 212 u32 tmp; 213 214 tmp = readl(pbase + XSP_USBPHYACR6); 215 tmp |= P2A6_RG_OTG_VBUSCMP_EN; 216 writel(tmp, pbase + XSP_USBPHYACR6); 217 218 tmp = readl(pbase + XSP_U2PHYDTM1); 219 tmp |= P2D_RG_VBUSVALID | P2D_RG_AVALID; 220 tmp &= ~P2D_RG_SESSEND; 221 writel(tmp, pbase + XSP_U2PHYDTM1); 222 223 dev_dbg(xsphy->dev, "%s(%d)\n", __func__, index); 224 } 225 226 static void u2_phy_instance_power_off(struct mtk_xsphy *xsphy, 227 struct xsphy_instance *inst) 228 { 229 void __iomem *pbase = inst->port_base; 230 u32 index = inst->index; 231 u32 tmp; 232 233 tmp = readl(pbase + XSP_USBPHYACR6); 234 tmp &= ~P2A6_RG_OTG_VBUSCMP_EN; 235 writel(tmp, pbase + XSP_USBPHYACR6); 236 237 tmp = readl(pbase + XSP_U2PHYDTM1); 238 tmp &= ~(P2D_RG_VBUSVALID | P2D_RG_AVALID); 239 tmp |= P2D_RG_SESSEND; 240 writel(tmp, pbase + XSP_U2PHYDTM1); 241 242 dev_dbg(xsphy->dev, "%s(%d)\n", __func__, index); 243 } 244 245 static void u2_phy_instance_set_mode(struct mtk_xsphy *xsphy, 246 struct xsphy_instance *inst, 247 enum phy_mode mode) 248 { 249 u32 tmp; 250 251 tmp = readl(inst->port_base + XSP_U2PHYDTM1); 252 switch (mode) { 253 case PHY_MODE_USB_DEVICE: 254 tmp |= P2D_FORCE_IDDIG | P2D_RG_IDDIG; 255 break; 256 case PHY_MODE_USB_HOST: 257 tmp |= P2D_FORCE_IDDIG; 258 tmp &= ~P2D_RG_IDDIG; 259 break; 260 case PHY_MODE_USB_OTG: 261 tmp &= ~(P2D_FORCE_IDDIG | P2D_RG_IDDIG); 262 break; 263 default: 264 return; 265 } 266 writel(tmp, inst->port_base + XSP_U2PHYDTM1); 267 } 268 269 static void phy_parse_property(struct mtk_xsphy *xsphy, 270 struct xsphy_instance *inst) 271 { 272 struct device *dev = &inst->phy->dev; 273 274 switch (inst->type) { 275 case PHY_TYPE_USB2: 276 device_property_read_u32(dev, "mediatek,efuse-intr", 277 &inst->efuse_intr); 278 device_property_read_u32(dev, "mediatek,eye-src", 279 &inst->eye_src); 280 device_property_read_u32(dev, "mediatek,eye-vrt", 281 &inst->eye_vrt); 282 device_property_read_u32(dev, "mediatek,eye-term", 283 &inst->eye_term); 284 dev_dbg(dev, "intr:%d, src:%d, vrt:%d, term:%d\n", 285 inst->efuse_intr, inst->eye_src, 286 inst->eye_vrt, inst->eye_term); 287 break; 288 case PHY_TYPE_USB3: 289 device_property_read_u32(dev, "mediatek,efuse-intr", 290 &inst->efuse_intr); 291 device_property_read_u32(dev, "mediatek,efuse-tx-imp", 292 &inst->efuse_tx_imp); 293 device_property_read_u32(dev, "mediatek,efuse-rx-imp", 294 &inst->efuse_rx_imp); 295 dev_dbg(dev, "intr:%d, tx-imp:%d, rx-imp:%d\n", 296 inst->efuse_intr, inst->efuse_tx_imp, 297 inst->efuse_rx_imp); 298 break; 299 default: 300 dev_err(xsphy->dev, "incompatible phy type\n"); 301 return; 302 } 303 } 304 305 static void u2_phy_props_set(struct mtk_xsphy *xsphy, 306 struct xsphy_instance *inst) 307 { 308 void __iomem *pbase = inst->port_base; 309 u32 tmp; 310 311 if (inst->efuse_intr) { 312 tmp = readl(pbase + XSP_USBPHYACR1); 313 tmp &= ~P2A1_RG_INTR_CAL; 314 tmp |= P2A1_RG_INTR_CAL_VAL(inst->efuse_intr); 315 writel(tmp, pbase + XSP_USBPHYACR1); 316 } 317 318 if (inst->eye_src) { 319 tmp = readl(pbase + XSP_USBPHYACR5); 320 tmp &= ~P2A5_RG_HSTX_SRCTRL; 321 tmp |= P2A5_RG_HSTX_SRCTRL_VAL(inst->eye_src); 322 writel(tmp, pbase + XSP_USBPHYACR5); 323 } 324 325 if (inst->eye_vrt) { 326 tmp = readl(pbase + XSP_USBPHYACR1); 327 tmp &= ~P2A1_RG_VRT_SEL; 328 tmp |= P2A1_RG_VRT_SEL_VAL(inst->eye_vrt); 329 writel(tmp, pbase + XSP_USBPHYACR1); 330 } 331 332 if (inst->eye_term) { 333 tmp = readl(pbase + XSP_USBPHYACR1); 334 tmp &= ~P2A1_RG_TERM_SEL; 335 tmp |= P2A1_RG_TERM_SEL_VAL(inst->eye_term); 336 writel(tmp, pbase + XSP_USBPHYACR1); 337 } 338 } 339 340 static void u3_phy_props_set(struct mtk_xsphy *xsphy, 341 struct xsphy_instance *inst) 342 { 343 void __iomem *pbase = inst->port_base; 344 u32 tmp; 345 346 if (inst->efuse_intr) { 347 tmp = readl(xsphy->glb_base + SSPXTP_PHYA_GLB_00); 348 tmp &= ~RG_XTP_GLB_BIAS_INTR_CTRL; 349 tmp |= RG_XTP_GLB_BIAS_INTR_CTRL_VAL(inst->efuse_intr); 350 writel(tmp, xsphy->glb_base + SSPXTP_PHYA_GLB_00); 351 } 352 353 if (inst->efuse_tx_imp) { 354 tmp = readl(pbase + SSPXTP_PHYA_LN_04); 355 tmp &= ~RG_XTP_LN0_TX_IMPSEL; 356 tmp |= RG_XTP_LN0_TX_IMPSEL_VAL(inst->efuse_tx_imp); 357 writel(tmp, pbase + SSPXTP_PHYA_LN_04); 358 } 359 360 if (inst->efuse_rx_imp) { 361 tmp = readl(pbase + SSPXTP_PHYA_LN_14); 362 tmp &= ~RG_XTP_LN0_RX_IMPSEL; 363 tmp |= RG_XTP_LN0_RX_IMPSEL_VAL(inst->efuse_rx_imp); 364 writel(tmp, pbase + SSPXTP_PHYA_LN_14); 365 } 366 } 367 368 static int mtk_phy_init(struct phy *phy) 369 { 370 struct xsphy_instance *inst = phy_get_drvdata(phy); 371 struct mtk_xsphy *xsphy = dev_get_drvdata(phy->dev.parent); 372 int ret; 373 374 ret = clk_prepare_enable(inst->ref_clk); 375 if (ret) { 376 dev_err(xsphy->dev, "failed to enable ref_clk\n"); 377 return ret; 378 } 379 380 switch (inst->type) { 381 case PHY_TYPE_USB2: 382 u2_phy_instance_init(xsphy, inst); 383 u2_phy_props_set(xsphy, inst); 384 break; 385 case PHY_TYPE_USB3: 386 u3_phy_props_set(xsphy, inst); 387 break; 388 default: 389 dev_err(xsphy->dev, "incompatible phy type\n"); 390 clk_disable_unprepare(inst->ref_clk); 391 return -EINVAL; 392 } 393 394 return 0; 395 } 396 397 static int mtk_phy_power_on(struct phy *phy) 398 { 399 struct xsphy_instance *inst = phy_get_drvdata(phy); 400 struct mtk_xsphy *xsphy = dev_get_drvdata(phy->dev.parent); 401 402 if (inst->type == PHY_TYPE_USB2) { 403 u2_phy_instance_power_on(xsphy, inst); 404 u2_phy_slew_rate_calibrate(xsphy, inst); 405 } 406 407 return 0; 408 } 409 410 static int mtk_phy_power_off(struct phy *phy) 411 { 412 struct xsphy_instance *inst = phy_get_drvdata(phy); 413 struct mtk_xsphy *xsphy = dev_get_drvdata(phy->dev.parent); 414 415 if (inst->type == PHY_TYPE_USB2) 416 u2_phy_instance_power_off(xsphy, inst); 417 418 return 0; 419 } 420 421 static int mtk_phy_exit(struct phy *phy) 422 { 423 struct xsphy_instance *inst = phy_get_drvdata(phy); 424 425 clk_disable_unprepare(inst->ref_clk); 426 return 0; 427 } 428 429 static int mtk_phy_set_mode(struct phy *phy, enum phy_mode mode, int submode) 430 { 431 struct xsphy_instance *inst = phy_get_drvdata(phy); 432 struct mtk_xsphy *xsphy = dev_get_drvdata(phy->dev.parent); 433 434 if (inst->type == PHY_TYPE_USB2) 435 u2_phy_instance_set_mode(xsphy, inst, mode); 436 437 return 0; 438 } 439 440 static struct phy *mtk_phy_xlate(struct device *dev, 441 struct of_phandle_args *args) 442 { 443 struct mtk_xsphy *xsphy = dev_get_drvdata(dev); 444 struct xsphy_instance *inst = NULL; 445 struct device_node *phy_np = args->np; 446 int index; 447 448 if (args->args_count != 1) { 449 dev_err(dev, "invalid number of cells in 'phy' property\n"); 450 return ERR_PTR(-EINVAL); 451 } 452 453 for (index = 0; index < xsphy->nphys; index++) 454 if (phy_np == xsphy->phys[index]->phy->dev.of_node) { 455 inst = xsphy->phys[index]; 456 break; 457 } 458 459 if (!inst) { 460 dev_err(dev, "failed to find appropriate phy\n"); 461 return ERR_PTR(-EINVAL); 462 } 463 464 inst->type = args->args[0]; 465 if (!(inst->type == PHY_TYPE_USB2 || 466 inst->type == PHY_TYPE_USB3)) { 467 dev_err(dev, "unsupported phy type: %d\n", inst->type); 468 return ERR_PTR(-EINVAL); 469 } 470 471 phy_parse_property(xsphy, inst); 472 473 return inst->phy; 474 } 475 476 static const struct phy_ops mtk_xsphy_ops = { 477 .init = mtk_phy_init, 478 .exit = mtk_phy_exit, 479 .power_on = mtk_phy_power_on, 480 .power_off = mtk_phy_power_off, 481 .set_mode = mtk_phy_set_mode, 482 .owner = THIS_MODULE, 483 }; 484 485 static const struct of_device_id mtk_xsphy_id_table[] = { 486 { .compatible = "mediatek,xsphy", }, 487 { }, 488 }; 489 MODULE_DEVICE_TABLE(of, mtk_xsphy_id_table); 490 491 static int mtk_xsphy_probe(struct platform_device *pdev) 492 { 493 struct device *dev = &pdev->dev; 494 struct device_node *np = dev->of_node; 495 struct device_node *child_np; 496 struct phy_provider *provider; 497 struct resource *glb_res; 498 struct mtk_xsphy *xsphy; 499 struct resource res; 500 int port, retval; 501 502 xsphy = devm_kzalloc(dev, sizeof(*xsphy), GFP_KERNEL); 503 if (!xsphy) 504 return -ENOMEM; 505 506 xsphy->nphys = of_get_child_count(np); 507 xsphy->phys = devm_kcalloc(dev, xsphy->nphys, 508 sizeof(*xsphy->phys), GFP_KERNEL); 509 if (!xsphy->phys) 510 return -ENOMEM; 511 512 xsphy->dev = dev; 513 platform_set_drvdata(pdev, xsphy); 514 515 glb_res = platform_get_resource(pdev, IORESOURCE_MEM, 0); 516 /* optional, may not exist if no u3 phys */ 517 if (glb_res) { 518 /* get banks shared by multiple u3 phys */ 519 xsphy->glb_base = devm_ioremap_resource(dev, glb_res); 520 if (IS_ERR(xsphy->glb_base)) { 521 dev_err(dev, "failed to remap glb regs\n"); 522 return PTR_ERR(xsphy->glb_base); 523 } 524 } 525 526 xsphy->src_ref_clk = XSP_REF_CLK; 527 xsphy->src_coef = XSP_SLEW_RATE_COEF; 528 /* update parameters of slew rate calibrate if exist */ 529 device_property_read_u32(dev, "mediatek,src-ref-clk-mhz", 530 &xsphy->src_ref_clk); 531 device_property_read_u32(dev, "mediatek,src-coef", &xsphy->src_coef); 532 533 port = 0; 534 for_each_child_of_node(np, child_np) { 535 struct xsphy_instance *inst; 536 struct phy *phy; 537 538 inst = devm_kzalloc(dev, sizeof(*inst), GFP_KERNEL); 539 if (!inst) { 540 retval = -ENOMEM; 541 goto put_child; 542 } 543 544 xsphy->phys[port] = inst; 545 546 phy = devm_phy_create(dev, child_np, &mtk_xsphy_ops); 547 if (IS_ERR(phy)) { 548 dev_err(dev, "failed to create phy\n"); 549 retval = PTR_ERR(phy); 550 goto put_child; 551 } 552 553 retval = of_address_to_resource(child_np, 0, &res); 554 if (retval) { 555 dev_err(dev, "failed to get address resource(id-%d)\n", 556 port); 557 goto put_child; 558 } 559 560 inst->port_base = devm_ioremap_resource(&phy->dev, &res); 561 if (IS_ERR(inst->port_base)) { 562 dev_err(dev, "failed to remap phy regs\n"); 563 retval = PTR_ERR(inst->port_base); 564 goto put_child; 565 } 566 567 inst->phy = phy; 568 inst->index = port; 569 phy_set_drvdata(phy, inst); 570 port++; 571 572 inst->ref_clk = devm_clk_get(&phy->dev, "ref"); 573 if (IS_ERR(inst->ref_clk)) { 574 dev_err(dev, "failed to get ref_clk(id-%d)\n", port); 575 retval = PTR_ERR(inst->ref_clk); 576 goto put_child; 577 } 578 } 579 580 provider = devm_of_phy_provider_register(dev, mtk_phy_xlate); 581 return PTR_ERR_OR_ZERO(provider); 582 583 put_child: 584 of_node_put(child_np); 585 return retval; 586 } 587 588 static struct platform_driver mtk_xsphy_driver = { 589 .probe = mtk_xsphy_probe, 590 .driver = { 591 .name = "mtk-xsphy", 592 .of_match_table = mtk_xsphy_id_table, 593 }, 594 }; 595 596 module_platform_driver(mtk_xsphy_driver); 597 598 MODULE_AUTHOR("Chunfeng Yun <chunfeng.yun@mediatek.com>"); 599 MODULE_DESCRIPTION("MediaTek USB XS-PHY driver"); 600 MODULE_LICENSE("GPL v2"); 601