drivers/phy/phy-miphy365x.c

   1 /*
   2  * Copyright (C) 2014 STMicroelectronics – All Rights Reserved
   3  *
   4  * STMicroelectronics PHY driver MiPHY365 (for SoC STiH416).
   5  *
   6  * Authors: Alexandre Torgue <alexandre.torgue@st.com>
   7  *          Lee Jones <lee.jones@linaro.org>
   8  *
   9  * This program is free software; you can redistribute it and/or modify
  10  * it under the terms of the GNU General Public License version 2, as
  11  * published by the Free Software Foundation.
  12  *
  13  */
  14
  15 #include <linux/platform_device.h>
  16 #include <linux/io.h>
  17 #include <linux/kernel.h>
  18 #include <linux/module.h>
  19 #include <linux/of.h>
  20 #include <linux/of_platform.h>
  21 #include <linux/of_address.h>
  22 #include <linux/clk.h>
  23 #include <linux/phy/phy.h>
  24 #include <linux/delay.h>
  25 #include <linux/mfd/syscon.h>
  26 #include <linux/regmap.h>
  27
  28 #include <dt-bindings/phy/phy.h>
  29
  30 #define HFC_TIMEOUT             100
  31
  32 #define SYSCFG_SELECT_SATA_MASK BIT(1)
  33 #define SYSCFG_SELECT_SATA_POS  1
  34
  35 /* MiPHY365x register definitions */
  36 #define RESET_REG               0x00
  37 #define RST_PLL                 BIT(1)
  38 #define RST_PLL_CAL             BIT(2)
  39 #define RST_RX                  BIT(4)
  40 #define RST_MACRO               BIT(7)
  41
  42 #define STATUS_REG              0x01
  43 #define IDLL_RDY                BIT(0)
  44 #define PLL_RDY                 BIT(1)
  45 #define DES_BIT_LOCK            BIT(2)
  46 #define DES_SYMBOL_LOCK         BIT(3)
  47
  48 #define CTRL_REG                0x02
  49 #define TERM_EN                 BIT(0)
  50 #define PCI_EN                  BIT(2)
  51 #define DES_BIT_LOCK_EN         BIT(3)
  52 #define TX_POL                  BIT(5)
  53
  54 #define INT_CTRL_REG            0x03
  55
  56 #define BOUNDARY1_REG           0x10
  57 #define SPDSEL_SEL              BIT(0)
  58
  59 #define BOUNDARY3_REG           0x12
  60 #define TX_SPDSEL_GEN1_VAL      0
  61 #define TX_SPDSEL_GEN2_VAL      0x01
  62 #define TX_SPDSEL_GEN3_VAL      0x02
  63 #define RX_SPDSEL_GEN1_VAL      0
  64 #define RX_SPDSEL_GEN2_VAL      (0x01 << 3)
  65 #define RX_SPDSEL_GEN3_VAL      (0x02 << 3)
  66
  67 #define PCIE_REG                0x16
  68
  69 #define BUF_SEL_REG             0x20
  70 #define CONF_GEN_SEL_GEN3       0x02
  71 #define CONF_GEN_SEL_GEN2       0x01
  72 #define PD_VDDTFILTER           BIT(4)
  73
  74 #define TXBUF1_REG              0x21
  75 #define SWING_VAL               0x04
  76 #define SWING_VAL_GEN1          0x03
  77 #define PREEMPH_VAL             (0x3 << 5)
  78
  79 #define TXBUF2_REG              0x22
  80 #define TXSLEW_VAL              0x2
  81 #define TXSLEW_VAL_GEN1         0x4
  82
  83 #define RXBUF_OFFSET_CTRL_REG   0x23
  84
  85 #define RXBUF_REG               0x25
  86 #define SDTHRES_VAL             0x01
  87 #define EQ_ON3                  (0x03 << 4)
  88 #define EQ_ON1                  (0x01 << 4)
  89
  90 #define COMP_CTRL1_REG          0x40
  91 #define START_COMSR             BIT(0)
  92 #define START_COMZC             BIT(1)
  93 #define COMSR_DONE              BIT(2)
  94 #define COMZC_DONE              BIT(3)
  95 #define COMP_AUTO_LOAD          BIT(4)
  96
  97 #define COMP_CTRL2_REG          0x41
  98 #define COMP_2MHZ_RAT_GEN1      0x1e
  99 #define COMP_2MHZ_RAT           0xf
 100
 101 #define COMP_CTRL3_REG          0x42
 102 #define COMSR_COMP_REF          0x33
 103
 104 #define COMP_IDLL_REG           0x47
 105 #define COMZC_IDLL              0x2a
 106
 107 #define PLL_CTRL1_REG           0x50
 108 #define PLL_START_CAL           BIT(0)
 109 #define BUF_EN                  BIT(2)
 110 #define SYNCHRO_TX              BIT(3)
 111 #define SSC_EN                  BIT(6)
 112 #define CONFIG_PLL              BIT(7)
 113
 114 #define PLL_CTRL2_REG           0x51
 115 #define BYPASS_PLL_CAL          BIT(1)
 116
 117 #define PLL_RAT_REG             0x52
 118
 119 #define PLL_SSC_STEP_MSB_REG    0x56
 120 #define PLL_SSC_STEP_MSB_VAL    0x03
 121
 122 #define PLL_SSC_STEP_LSB_REG    0x57
 123 #define PLL_SSC_STEP_LSB_VAL    0x63
 124
 125 #define PLL_SSC_PER_MSB_REG     0x58
 126 #define PLL_SSC_PER_MSB_VAL     0
 127
 128 #define PLL_SSC_PER_LSB_REG     0x59
 129 #define PLL_SSC_PER_LSB_VAL     0xf1
 130
 131 #define IDLL_TEST_REG           0x72
 132 #define START_CLK_HF            BIT(6)
 133
 134 #define DES_BITLOCK_REG         0x86
 135 #define BIT_LOCK_LEVEL          0x01
 136 #define BIT_LOCK_CNT_512        (0x03 << 5)
 137
 138 struct miphy365x_phy {
 139         struct phy *phy;
 140         void __iomem *base;
 141         bool pcie_tx_pol_inv;
 142         bool sata_tx_pol_inv;
 143         u32 sata_gen;
 144         u32 ctrlreg;
 145         u8 type;
 146 };
 147
 148 struct miphy365x_dev {
 149         struct device *dev;
 150         struct regmap *regmap;
 151         struct mutex miphy_mutex;
 152         struct miphy365x_phy **phys;
 153         int nphys;
 154 };
 155
 156 /*
 157  * These values are represented in Device tree. They are considered to be ABI
 158  * and although they can be extended any existing values must not change.
 159  */
 160 enum miphy_sata_gen {
 161         SATA_GEN1 = 1,
 162         SATA_GEN2,
 163         SATA_GEN3
 164 };
 165
 166 static u8 rx_tx_spd[] = {
 167         0, /* GEN0 doesn't exist. */
 168         TX_SPDSEL_GEN1_VAL | RX_SPDSEL_GEN1_VAL,
 169         TX_SPDSEL_GEN2_VAL | RX_SPDSEL_GEN2_VAL,
 170         TX_SPDSEL_GEN3_VAL | RX_SPDSEL_GEN3_VAL
 171 };
 172
 173 /*
 174  * This function selects the system configuration,
 175  * either two SATA, one SATA and one PCIe, or two PCIe lanes.
 176  */
 177 static int miphy365x_set_path(struct miphy365x_phy *miphy_phy,
 178                               struct miphy365x_dev *miphy_dev)
 179 {
 180         bool sata = (miphy_phy->type == PHY_TYPE_SATA);
 181
 182         return regmap_update_bits(miphy_dev->regmap,
 183                                   miphy_phy->ctrlreg,
 184                                   SYSCFG_SELECT_SATA_MASK,
 185                                   sata << SYSCFG_SELECT_SATA_POS);
 186 }
 187
 188 static int miphy365x_init_pcie_port(struct miphy365x_phy *miphy_phy,
 189                                     struct miphy365x_dev *miphy_dev)
 190 {
 191         u8 val;
 192
 193         if (miphy_phy->pcie_tx_pol_inv) {
 194                 /* Invert Tx polarity and clear pci_txdetect_pol bit */
 195                 val = TERM_EN | PCI_EN | DES_BIT_LOCK_EN | TX_POL;
 196                 writeb_relaxed(val, miphy_phy->base + CTRL_REG);
 197                 writeb_relaxed(0x00, miphy_phy->base + PCIE_REG);
 198         }
 199
 200         return 0;
 201 }
 202
 203 static inline int miphy365x_hfc_not_rdy(struct miphy365x_phy *miphy_phy,
 204                                         struct miphy365x_dev *miphy_dev)
 205 {
 206         unsigned long timeout = jiffies + msecs_to_jiffies(HFC_TIMEOUT);
 207         u8 mask = IDLL_RDY | PLL_RDY;
 208         u8 regval;
 209
 210         do {
 211                 regval = readb_relaxed(miphy_phy->base + STATUS_REG);
 212                 if (!(regval & mask))
 213                         return 0;
 214
 215                 usleep_range(2000, 2500);
 216         } while (time_before(jiffies, timeout));
 217
 218         dev_err(miphy_dev->dev, "HFC ready timeout!\n");
 219         return -EBUSY;
 220 }
 221
 222 static inline int miphy365x_rdy(struct miphy365x_phy *miphy_phy,
 223                                 struct miphy365x_dev *miphy_dev)
 224 {
 225         unsigned long timeout = jiffies + msecs_to_jiffies(HFC_TIMEOUT);
 226         u8 mask = IDLL_RDY | PLL_RDY;
 227         u8 regval;
 228
 229         do {
 230                 regval = readb_relaxed(miphy_phy->base + STATUS_REG);
 231                 if ((regval & mask) == mask)
 232                         return 0;
 233
 234                 usleep_range(2000, 2500);
 235         } while (time_before(jiffies, timeout));
 236
 237         dev_err(miphy_dev->dev, "PHY not ready timeout!\n");
 238         return -EBUSY;
 239 }
 240
 241 static inline void miphy365x_set_comp(struct miphy365x_phy *miphy_phy,
 242                                       struct miphy365x_dev *miphy_dev)
 243 {
 244         u8 val, mask;
 245
 246         if (miphy_phy->sata_gen == SATA_GEN1)
 247                 writeb_relaxed(COMP_2MHZ_RAT_GEN1,
 248                                miphy_phy->base + COMP_CTRL2_REG);
 249         else
 250                 writeb_relaxed(COMP_2MHZ_RAT,
 251                                miphy_phy->base + COMP_CTRL2_REG);
 252
 253         if (miphy_phy->sata_gen != SATA_GEN3) {
 254                 writeb_relaxed(COMSR_COMP_REF,
 255                                miphy_phy->base + COMP_CTRL3_REG);
 256                 /*
 257                  * Force VCO current to value defined by address 0x5A
 258                  * and disable PCIe100Mref bit
 259                  * Enable auto load compensation for pll_i_bias
 260                  */
 261                 writeb_relaxed(BYPASS_PLL_CAL, miphy_phy->base + PLL_CTRL2_REG);
 262                 writeb_relaxed(COMZC_IDLL, miphy_phy->base + COMP_IDLL_REG);
 263         }
 264
 265         /*
 266          * Force restart compensation and enable auto load
 267          * for Comzc_Tx, Comzc_Rx and Comsr on macro
 268          */
 269         val = START_COMSR | START_COMZC | COMP_AUTO_LOAD;
 270         writeb_relaxed(val, miphy_phy->base + COMP_CTRL1_REG);
 271
 272         mask = COMSR_DONE | COMZC_DONE;
 273         while ((readb_relaxed(miphy_phy->base + COMP_CTRL1_REG) & mask) != mask)
 274                 cpu_relax();
 275 }
 276
 277 static inline void miphy365x_set_ssc(struct miphy365x_phy *miphy_phy,
 278                                      struct miphy365x_dev *miphy_dev)
 279 {
 280         u8 val;
 281
 282         /*
 283          * SSC Settings. SSC will be enabled through Link
 284          * SSC Ampl. = 0.4%
 285          * SSC Freq = 31KHz
 286          */
 287         writeb_relaxed(PLL_SSC_STEP_MSB_VAL,
 288                        miphy_phy->base + PLL_SSC_STEP_MSB_REG);
 289         writeb_relaxed(PLL_SSC_STEP_LSB_VAL,
 290                        miphy_phy->base + PLL_SSC_STEP_LSB_REG);
 291         writeb_relaxed(PLL_SSC_PER_MSB_VAL,
 292                        miphy_phy->base + PLL_SSC_PER_MSB_REG);
 293         writeb_relaxed(PLL_SSC_PER_LSB_VAL,
 294                        miphy_phy->base + PLL_SSC_PER_LSB_REG);
 295
 296         /* SSC Settings complete */
 297         if (miphy_phy->sata_gen == SATA_GEN1) {
 298                 val = PLL_START_CAL | BUF_EN | SYNCHRO_TX | CONFIG_PLL;
 299                 writeb_relaxed(val, miphy_phy->base + PLL_CTRL1_REG);
 300         } else {
 301                 val = SSC_EN | PLL_START_CAL | BUF_EN | SYNCHRO_TX | CONFIG_PLL;
 302                 writeb_relaxed(val, miphy_phy->base + PLL_CTRL1_REG);
 303         }
 304 }
 305
 306 static int miphy365x_init_sata_port(struct miphy365x_phy *miphy_phy,
 307                                     struct miphy365x_dev *miphy_dev)
 308 {
 309         int ret;
 310         u8 val;
 311
 312         /*
 313          * Force PHY macro reset, PLL calibration reset, PLL reset
 314          * and assert Deserializer Reset
 315          */
 316         val = RST_PLL | RST_PLL_CAL | RST_RX | RST_MACRO;
 317         writeb_relaxed(val, miphy_phy->base + RESET_REG);
 318
 319         if (miphy_phy->sata_tx_pol_inv)
 320                 writeb_relaxed(TX_POL, miphy_phy->base + CTRL_REG);
 321
 322         /*
 323          * Force macro1 to use rx_lspd, tx_lspd
 324          * Force Rx_Clock on first I-DLL phase
 325          * Force Des in HP mode on macro, rx_lspd, tx_lspd for Gen2/3
 326          */
 327         writeb_relaxed(SPDSEL_SEL, miphy_phy->base + BOUNDARY1_REG);
 328         writeb_relaxed(START_CLK_HF, miphy_phy->base + IDLL_TEST_REG);
 329         val = rx_tx_spd[miphy_phy->sata_gen];
 330         writeb_relaxed(val, miphy_phy->base + BOUNDARY3_REG);
 331
 332         /* Wait for HFC_READY = 0 */
 333         ret = miphy365x_hfc_not_rdy(miphy_phy, miphy_dev);
 334         if (ret)
 335                 return ret;
 336
 337         /* Compensation Recalibration */
 338         miphy365x_set_comp(miphy_phy, miphy_dev);
 339
 340         switch (miphy_phy->sata_gen) {
 341         case SATA_GEN3:
 342                 /*
 343                  * TX Swing target 550-600mv peak to peak diff
 344                  * Tx Slew target 90-110ps rising/falling time
 345                  * Rx Eq ON3, Sigdet threshold SDTH1
 346                  */
 347                 val = PD_VDDTFILTER | CONF_GEN_SEL_GEN3;
 348                 writeb_relaxed(val, miphy_phy->base + BUF_SEL_REG);
 349                 val = SWING_VAL | PREEMPH_VAL;
 350                 writeb_relaxed(val, miphy_phy->base + TXBUF1_REG);
 351                 writeb_relaxed(TXSLEW_VAL, miphy_phy->base + TXBUF2_REG);
 352                 writeb_relaxed(0x00, miphy_phy->base + RXBUF_OFFSET_CTRL_REG);
 353                 val = SDTHRES_VAL | EQ_ON3;
 354                 writeb_relaxed(val, miphy_phy->base + RXBUF_REG);
 355                 break;
 356         case SATA_GEN2:
 357                 /*
 358                  * conf gen sel=0x1 to program Gen2 banked registers
 359                  * VDDT filter ON
 360                  * Tx Swing target 550-600mV peak-to-peak diff
 361                  * Tx Slew target 90-110 ps rising/falling time
 362                  * RX Equalization ON1, Sigdet threshold SDTH1
 363                  */
 364                 writeb_relaxed(CONF_GEN_SEL_GEN2,
 365                                miphy_phy->base + BUF_SEL_REG);
 366                 writeb_relaxed(SWING_VAL, miphy_phy->base + TXBUF1_REG);
 367                 writeb_relaxed(TXSLEW_VAL, miphy_phy->base + TXBUF2_REG);
 368                 val = SDTHRES_VAL | EQ_ON1;
 369                 writeb_relaxed(val, miphy_phy->base + RXBUF_REG);
 370                 break;
 371         case SATA_GEN1:
 372                 /*
 373                  * conf gen sel = 00b to program Gen1 banked registers
 374                  * VDDT filter ON
 375                  * Tx Swing target 500-550mV peak-to-peak diff
 376                  * Tx Slew target120-140 ps rising/falling time
 377                  */
 378                 writeb_relaxed(PD_VDDTFILTER, miphy_phy->base + BUF_SEL_REG);
 379                 writeb_relaxed(SWING_VAL_GEN1, miphy_phy->base + TXBUF1_REG);
 380                 writeb_relaxed(TXSLEW_VAL_GEN1, miphy_phy->base + TXBUF2_REG);
 381                 break;
 382         default:
 383                 break;
 384         }
 385
 386         /* Force Macro1 in partial mode & release pll cal reset */
 387         writeb_relaxed(RST_RX, miphy_phy->base + RESET_REG);
 388         usleep_range(100, 150);
 389
 390         miphy365x_set_ssc(miphy_phy, miphy_dev);
 391
 392         /* Wait for phy_ready */
 393         ret = miphy365x_rdy(miphy_phy, miphy_dev);
 394         if (ret)
 395                 return ret;
 396
 397         /*
 398          * Enable macro1 to use rx_lspd & tx_lspd
 399          * Release Rx_Clock on first I-DLL phase on macro1
 400          * Assert deserializer reset
 401          * des_bit_lock_en is set
 402          * bit lock detection strength
 403          * Deassert deserializer reset
 404          */
 405         writeb_relaxed(0x00, miphy_phy->base + BOUNDARY1_REG);
 406         writeb_relaxed(0x00, miphy_phy->base + IDLL_TEST_REG);
 407         writeb_relaxed(RST_RX, miphy_phy->base + RESET_REG);
 408         val = miphy_phy->sata_tx_pol_inv ?
 409                 (TX_POL | DES_BIT_LOCK_EN) : DES_BIT_LOCK_EN;
 410         writeb_relaxed(val, miphy_phy->base + CTRL_REG);
 411
 412         val = BIT_LOCK_CNT_512 | BIT_LOCK_LEVEL;
 413         writeb_relaxed(val, miphy_phy->base + DES_BITLOCK_REG);
 414         writeb_relaxed(0x00, miphy_phy->base + RESET_REG);
 415
 416         return 0;
 417 }
 418
 419 static int miphy365x_init(struct phy *phy)
 420 {
 421         struct miphy365x_phy *miphy_phy = phy_get_drvdata(phy);
 422         struct miphy365x_dev *miphy_dev = dev_get_drvdata(phy->dev.parent);
 423         int ret = 0;
 424
 425         mutex_lock(&miphy_dev->miphy_mutex);
 426
 427         ret = miphy365x_set_path(miphy_phy, miphy_dev);
 428         if (ret) {
 429                 mutex_unlock(&miphy_dev->miphy_mutex);
 430                 return ret;
 431         }
 432
 433         /* Initialise Miphy for PCIe or SATA */
 434         if (miphy_phy->type == PHY_TYPE_PCIE)
 435                 ret = miphy365x_init_pcie_port(miphy_phy, miphy_dev);
 436         else
 437                 ret = miphy365x_init_sata_port(miphy_phy, miphy_dev);
 438
 439         mutex_unlock(&miphy_dev->miphy_mutex);
 440
 441         return ret;
 442 }
 443
 444 static int miphy365x_get_addr(struct device *dev,
 445                 struct miphy365x_phy *miphy_phy, int index)
 446 {
 447         struct device_node *phynode = miphy_phy->phy->dev.of_node;
 448         const char *name;
 449         int type = miphy_phy->type;
 450         int ret;
 451
 452         ret = of_property_read_string_index(phynode, "reg-names", index, &name);
 453         if (ret) {
 454                 dev_err(dev, "no reg-names property not found\n");
 455                 return ret;
 456         }
 457
 458         if (!((!strncmp(name, "sata", 4) && type == PHY_TYPE_SATA) ||
 459               (!strncmp(name, "pcie", 4) && type == PHY_TYPE_PCIE)))
 460                 return 0;
 461
 462         miphy_phy->base = of_iomap(phynode, index);
 463         if (!miphy_phy->base) {
 464                 dev_err(dev, "Failed to map %s\n", phynode->full_name);
 465                 return -EINVAL;
 466         }
 467
 468         return 0;
 469 }
 470
 471 static struct phy *miphy365x_xlate(struct device *dev,
 472                                    struct of_phandle_args *args)
 473 {
 474         struct miphy365x_dev *miphy_dev = dev_get_drvdata(dev);
 475         struct miphy365x_phy *miphy_phy = NULL;
 476         struct device_node *phynode = args->np;
 477         int ret, index;
 478
 479         if (args->args_count != 1) {
 480                 dev_err(dev, "Invalid number of cells in 'phy' property\n");
 481                 return ERR_PTR(-EINVAL);
 482         }
 483
 484         for (index = 0; index < miphy_dev->nphys; index++)
 485                 if (phynode == miphy_dev->phys[index]->phy->dev.of_node) {
 486                         miphy_phy = miphy_dev->phys[index];
 487                         break;
 488                 }
 489
 490         if (!miphy_phy) {
 491                 dev_err(dev, "Failed to find appropriate phy\n");
 492                 return ERR_PTR(-EINVAL);
 493         }
 494
 495         miphy_phy->type = args->args[0];
 496
 497         if (!(miphy_phy->type == PHY_TYPE_SATA ||
 498               miphy_phy->type == PHY_TYPE_PCIE)) {
 499                 dev_err(dev, "Unsupported device type: %d\n", miphy_phy->type);
 500                 return ERR_PTR(-EINVAL);
 501         }
 502
 503         /* Each port handles SATA and PCIE - third entry is always sysconf. */
 504         for (index = 0; index < 3; index++) {
 505                 ret = miphy365x_get_addr(dev, miphy_phy, index);
 506                 if (ret < 0)
 507                         return ERR_PTR(ret);
 508         }
 509
 510         return miphy_phy->phy;
 511 }
 512
 513 static const struct phy_ops miphy365x_ops = {
 514         .init           = miphy365x_init,
 515         .owner          = THIS_MODULE,
 516 };
 517
 518 static int miphy365x_of_probe(struct device_node *phynode,
 519                               struct miphy365x_phy *miphy_phy)
 520 {
 521         of_property_read_u32(phynode, "st,sata-gen", &miphy_phy->sata_gen);
 522         if (!miphy_phy->sata_gen)
 523                 miphy_phy->sata_gen = SATA_GEN1;
 524
 525         miphy_phy->pcie_tx_pol_inv =
 526                 of_property_read_bool(phynode, "st,pcie-tx-pol-inv");
 527
 528         miphy_phy->sata_tx_pol_inv =
 529                 of_property_read_bool(phynode, "st,sata-tx-pol-inv");
 530
 531         return 0;
 532 }
 533
 534 static int miphy365x_probe(struct platform_device *pdev)
 535 {
 536         struct device_node *child, *np = pdev->dev.of_node;
 537         struct miphy365x_dev *miphy_dev;
 538         struct phy_provider *provider;
 539         struct phy *phy;
 540         int ret, port = 0;
 541
 542         miphy_dev = devm_kzalloc(&pdev->dev, sizeof(*miphy_dev), GFP_KERNEL);
 543         if (!miphy_dev)
 544                 return -ENOMEM;
 545
 546         miphy_dev->nphys = of_get_child_count(np);
 547         miphy_dev->phys = devm_kcalloc(&pdev->dev, miphy_dev->nphys,
 548                                        sizeof(*miphy_dev->phys), GFP_KERNEL);
 549         if (!miphy_dev->phys)
 550                 return -ENOMEM;
 551
 552         miphy_dev->regmap = syscon_regmap_lookup_by_phandle(np, "st,syscfg");
 553         if (IS_ERR(miphy_dev->regmap)) {
 554                 dev_err(miphy_dev->dev, "No syscfg phandle specified\n");
 555                 return PTR_ERR(miphy_dev->regmap);
 556         }
 557
 558         miphy_dev->dev = &pdev->dev;
 559
 560         dev_set_drvdata(&pdev->dev, miphy_dev);
 561
 562         mutex_init(&miphy_dev->miphy_mutex);
 563
 564         for_each_child_of_node(np, child) {
 565                 struct miphy365x_phy *miphy_phy;
 566
 567                 miphy_phy = devm_kzalloc(&pdev->dev, sizeof(*miphy_phy),
 568                                          GFP_KERNEL);
 569                 if (!miphy_phy) {
 570                         ret = -ENOMEM;
 571                         goto put_child;
 572                 }
 573
 574                 miphy_dev->phys[port] = miphy_phy;
 575
 576                 phy = devm_phy_create(&pdev->dev, child, &miphy365x_ops);
 577                 if (IS_ERR(phy)) {
 578                         dev_err(&pdev->dev, "failed to create PHY\n");
 579                         ret = PTR_ERR(phy);
 580                         goto put_child;
 581                 }
 582
 583                 miphy_dev->phys[port]->phy = phy;
 584
 585                 ret = miphy365x_of_probe(child, miphy_phy);
 586                 if (ret)
 587                         goto put_child;
 588
 589                 phy_set_drvdata(phy, miphy_dev->phys[port]);
 590
 591                 port++;
 592                 /* sysconfig offsets are indexed from 1 */
 593                 ret = of_property_read_u32_index(np, "st,syscfg", port,
 594                                         &miphy_phy->ctrlreg);
 595                 if (ret) {
 596                         dev_err(&pdev->dev, "No sysconfig offset found\n");
 597                         goto put_child;
 598                 }
 599         }
 600
 601         provider = devm_of_phy_provider_register(&pdev->dev, miphy365x_xlate);
 602         return PTR_ERR_OR_ZERO(provider);
 603 put_child:
 604         of_node_put(child);
 605         return ret;
 606 }
 607
 608 static const struct of_device_id miphy365x_of_match[] = {
 609         { .compatible = "st,miphy365x-phy", },
 610         { },
 611 };
 612 MODULE_DEVICE_TABLE(of, miphy365x_of_match);
 613
 614 static struct platform_driver miphy365x_driver = {
 615         .probe  = miphy365x_probe,
 616         .driver = {
 617                 .name   = "miphy365x-phy",
 618                 .of_match_table = miphy365x_of_match,
 619         }
 620 };
 621 module_platform_driver(miphy365x_driver);
 622
 623 MODULE_AUTHOR("Alexandre Torgue <alexandre.torgue@st.com>");
 624 MODULE_DESCRIPTION("STMicroelectronics miphy365x driver");
 625 MODULE_LICENSE("GPL v2");