drivers/phy/st/phy-miphy28lp.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  * Copyright (C) 2014 STMicroelectronics
   4  *
   5  * STMicroelectronics PHY driver MiPHY28lp (for SoC STiH407).
   6  *
   7  * Author: Alexandre Torgue <alexandre.torgue@st.com>
   8  */
   9
  10 #include <linux/platform_device.h>
  11 #include <linux/io.h>
  12 #include <linux/kernel.h>
  13 #include <linux/module.h>
  14 #include <linux/of.h>
  15 #include <linux/of_platform.h>
  16 #include <linux/of_address.h>
  17 #include <linux/clk.h>
  18 #include <linux/phy/phy.h>
  19 #include <linux/delay.h>
  20 #include <linux/mfd/syscon.h>
  21 #include <linux/regmap.h>
  22 #include <linux/reset.h>
  23
  24 #include <dt-bindings/phy/phy.h>
  25
  26 /* MiPHY registers */
  27 #define MIPHY_CONF_RESET                0x00
  28 #define RST_APPLI_SW            BIT(0)
  29 #define RST_CONF_SW             BIT(1)
  30 #define RST_MACRO_SW            BIT(2)
  31
  32 #define MIPHY_RESET                     0x01
  33 #define RST_PLL_SW              BIT(0)
  34 #define RST_COMP_SW             BIT(2)
  35
  36 #define MIPHY_STATUS_1                  0x02
  37 #define PHY_RDY                 BIT(0)
  38 #define HFC_RDY                 BIT(1)
  39 #define HFC_PLL                 BIT(2)
  40
  41 #define MIPHY_CONTROL                   0x04
  42 #define TERM_EN_SW              BIT(2)
  43 #define DIS_LINK_RST            BIT(3)
  44 #define AUTO_RST_RX             BIT(4)
  45 #define PX_RX_POL               BIT(5)
  46
  47 #define MIPHY_BOUNDARY_SEL              0x0a
  48 #define TX_SEL                  BIT(6)
  49 #define SSC_SEL                 BIT(4)
  50 #define GENSEL_SEL              BIT(0)
  51
  52 #define MIPHY_BOUNDARY_1                0x0b
  53 #define MIPHY_BOUNDARY_2                0x0c
  54 #define SSC_EN_SW               BIT(2)
  55
  56 #define MIPHY_PLL_CLKREF_FREQ           0x0d
  57 #define MIPHY_SPEED                     0x0e
  58 #define TX_SPDSEL_80DEC         0
  59 #define TX_SPDSEL_40DEC         1
  60 #define TX_SPDSEL_20DEC         2
  61 #define RX_SPDSEL_80DEC         0
  62 #define RX_SPDSEL_40DEC         (1 << 2)
  63 #define RX_SPDSEL_20DEC         (2 << 2)
  64
  65 #define MIPHY_CONF                      0x0f
  66 #define MIPHY_CTRL_TEST_SEL             0x20
  67 #define MIPHY_CTRL_TEST_1               0x21
  68 #define MIPHY_CTRL_TEST_2               0x22
  69 #define MIPHY_CTRL_TEST_3               0x23
  70 #define MIPHY_CTRL_TEST_4               0x24
  71 #define MIPHY_FEEDBACK_TEST             0x25
  72 #define MIPHY_DEBUG_BUS                 0x26
  73 #define MIPHY_DEBUG_STATUS_MSB          0x27
  74 #define MIPHY_DEBUG_STATUS_LSB          0x28
  75 #define MIPHY_PWR_RAIL_1                0x29
  76 #define MIPHY_PWR_RAIL_2                0x2a
  77 #define MIPHY_SYNCHAR_CONTROL           0x30
  78
  79 #define MIPHY_COMP_FSM_1                0x3a
  80 #define COMP_START              BIT(6)
  81
  82 #define MIPHY_COMP_FSM_6                0x3f
  83 #define COMP_DONE               BIT(7)
  84
  85 #define MIPHY_COMP_POSTP                0x42
  86 #define MIPHY_TX_CTRL_1                 0x49
  87 #define TX_REG_STEP_0V          0
  88 #define TX_REG_STEP_P_25MV      1
  89 #define TX_REG_STEP_P_50MV      2
  90 #define TX_REG_STEP_N_25MV      7
  91 #define TX_REG_STEP_N_50MV      6
  92 #define TX_REG_STEP_N_75MV      5
  93
  94 #define MIPHY_TX_CTRL_2                 0x4a
  95 #define TX_SLEW_SW_40_PS        0
  96 #define TX_SLEW_SW_80_PS        1
  97 #define TX_SLEW_SW_120_PS       2
  98
  99 #define MIPHY_TX_CTRL_3                 0x4b
 100 #define MIPHY_TX_CAL_MAN                0x4e
 101 #define TX_SLEW_CAL_MAN_EN      BIT(0)
 102
 103 #define MIPHY_TST_BIAS_BOOST_2          0x62
 104 #define MIPHY_BIAS_BOOST_1              0x63
 105 #define MIPHY_BIAS_BOOST_2              0x64
 106 #define MIPHY_RX_DESBUFF_FDB_2          0x67
 107 #define MIPHY_RX_DESBUFF_FDB_3          0x68
 108 #define MIPHY_SIGDET_COMPENS1           0x69
 109 #define MIPHY_SIGDET_COMPENS2           0x6a
 110 #define MIPHY_JITTER_PERIOD             0x6b
 111 #define MIPHY_JITTER_AMPLITUDE_1        0x6c
 112 #define MIPHY_JITTER_AMPLITUDE_2        0x6d
 113 #define MIPHY_JITTER_AMPLITUDE_3        0x6e
 114 #define MIPHY_RX_K_GAIN                 0x78
 115 #define MIPHY_RX_BUFFER_CTRL            0x7a
 116 #define VGA_GAIN                BIT(0)
 117 #define EQ_DC_GAIN              BIT(2)
 118 #define EQ_BOOST_GAIN           BIT(3)
 119
 120 #define MIPHY_RX_VGA_GAIN               0x7b
 121 #define MIPHY_RX_EQU_GAIN_1             0x7f
 122 #define MIPHY_RX_EQU_GAIN_2             0x80
 123 #define MIPHY_RX_EQU_GAIN_3             0x81
 124 #define MIPHY_RX_CAL_CTRL_1             0x97
 125 #define MIPHY_RX_CAL_CTRL_2             0x98
 126
 127 #define MIPHY_RX_CAL_OFFSET_CTRL        0x99
 128 #define CAL_OFFSET_VGA_64       (0x03 << 0)
 129 #define CAL_OFFSET_THRESHOLD_64 (0x03 << 2)
 130 #define VGA_OFFSET_POLARITY     BIT(4)
 131 #define OFFSET_COMPENSATION_EN  BIT(6)
 132
 133 #define MIPHY_RX_CAL_VGA_STEP           0x9a
 134 #define MIPHY_RX_CAL_EYE_MIN            0x9d
 135 #define MIPHY_RX_CAL_OPT_LENGTH         0x9f
 136 #define MIPHY_RX_LOCK_CTRL_1            0xc1
 137 #define MIPHY_RX_LOCK_SETTINGS_OPT      0xc2
 138 #define MIPHY_RX_LOCK_STEP              0xc4
 139
 140 #define MIPHY_RX_SIGDET_SLEEP_OA        0xc9
 141 #define MIPHY_RX_SIGDET_SLEEP_SEL       0xca
 142 #define MIPHY_RX_SIGDET_WAIT_SEL        0xcb
 143 #define MIPHY_RX_SIGDET_DATA_SEL        0xcc
 144 #define EN_ULTRA_LOW_POWER      BIT(0)
 145 #define EN_FIRST_HALF           BIT(1)
 146 #define EN_SECOND_HALF          BIT(2)
 147 #define EN_DIGIT_SIGNAL_CHECK   BIT(3)
 148
 149 #define MIPHY_RX_POWER_CTRL_1           0xcd
 150 #define MIPHY_RX_POWER_CTRL_2           0xce
 151 #define MIPHY_PLL_CALSET_CTRL           0xd3
 152 #define MIPHY_PLL_CALSET_1              0xd4
 153 #define MIPHY_PLL_CALSET_2              0xd5
 154 #define MIPHY_PLL_CALSET_3              0xd6
 155 #define MIPHY_PLL_CALSET_4              0xd7
 156 #define MIPHY_PLL_SBR_1                 0xe3
 157 #define SET_NEW_CHANGE          BIT(1)
 158
 159 #define MIPHY_PLL_SBR_2                 0xe4
 160 #define MIPHY_PLL_SBR_3                 0xe5
 161 #define MIPHY_PLL_SBR_4                 0xe6
 162 #define MIPHY_PLL_COMMON_MISC_2         0xe9
 163 #define START_ACT_FILT          BIT(6)
 164
 165 #define MIPHY_PLL_SPAREIN               0xeb
 166
 167 /*
 168  * On STiH407 the glue logic can be different among MiPHY devices; for example:
 169  * MiPHY0: OSC_FORCE_EXT means:
 170  *  0: 30MHz crystal clk - 1: 100MHz ext clk routed through MiPHY1
 171  * MiPHY1: OSC_FORCE_EXT means:
 172  *  1: 30MHz crystal clk - 0: 100MHz ext clk routed through MiPHY1
 173  * Some devices have not the possibility to check if the osc is ready.
 174  */
 175 #define MIPHY_OSC_FORCE_EXT     BIT(3)
 176 #define MIPHY_OSC_RDY           BIT(5)
 177
 178 #define MIPHY_CTRL_MASK         0x0f
 179 #define MIPHY_CTRL_DEFAULT      0
 180 #define MIPHY_CTRL_SYNC_D_EN    BIT(2)
 181
 182 /* SATA / PCIe defines */
 183 #define SATA_CTRL_MASK          0x07
 184 #define PCIE_CTRL_MASK          0xff
 185 #define SATA_CTRL_SELECT_SATA   1
 186 #define SATA_CTRL_SELECT_PCIE   0
 187 #define SYSCFG_PCIE_PCIE_VAL    0x80
 188 #define SATA_SPDMODE            1
 189
 190 #define MIPHY_SATA_BANK_NB      3
 191 #define MIPHY_PCIE_BANK_NB      2
 192
 193 enum {
 194         SYSCFG_CTRL,
 195         SYSCFG_STATUS,
 196         SYSCFG_PCI,
 197         SYSCFG_SATA,
 198         SYSCFG_REG_MAX,
 199 };
 200
 201 struct miphy28lp_phy {
 202         struct phy *phy;
 203         struct miphy28lp_dev *phydev;
 204         void __iomem *base;
 205         void __iomem *pipebase;
 206
 207         bool osc_force_ext;
 208         bool osc_rdy;
 209         bool px_rx_pol_inv;
 210         bool ssc;
 211         bool tx_impedance;
 212
 213         struct reset_control *miphy_rst;
 214
 215         u32 sata_gen;
 216
 217         /* Sysconfig registers offsets needed to configure the device */
 218         u32 syscfg_reg[SYSCFG_REG_MAX];
 219         u8 type;
 220 };
 221
 222 struct miphy28lp_dev {
 223         struct device *dev;
 224         struct regmap *regmap;
 225         struct mutex miphy_mutex;
 226         struct miphy28lp_phy **phys;
 227         int nphys;
 228 };
 229
 230 struct miphy_initval {
 231         u16 reg;
 232         u16 val;
 233 };
 234
 235 enum miphy_sata_gen { SATA_GEN1, SATA_GEN2, SATA_GEN3 };
 236
 237 static char *PHY_TYPE_name[] = { "sata-up", "pcie-up", "", "usb3-up" };
 238
 239 struct pll_ratio {
 240         int clk_ref;
 241         int calset_1;
 242         int calset_2;
 243         int calset_3;
 244         int calset_4;
 245         int cal_ctrl;
 246 };
 247
 248 static struct pll_ratio sata_pll_ratio = {
 249         .clk_ref = 0x1e,
 250         .calset_1 = 0xc8,
 251         .calset_2 = 0x00,
 252         .calset_3 = 0x00,
 253         .calset_4 = 0x00,
 254         .cal_ctrl = 0x00,
 255 };
 256
 257 static struct pll_ratio pcie_pll_ratio = {
 258         .clk_ref = 0x1e,
 259         .calset_1 = 0xa6,
 260         .calset_2 = 0xaa,
 261         .calset_3 = 0xaa,
 262         .calset_4 = 0x00,
 263         .cal_ctrl = 0x00,
 264 };
 265
 266 static struct pll_ratio usb3_pll_ratio = {
 267         .clk_ref = 0x1e,
 268         .calset_1 = 0xa6,
 269         .calset_2 = 0xaa,
 270         .calset_3 = 0xaa,
 271         .calset_4 = 0x04,
 272         .cal_ctrl = 0x00,
 273 };
 274
 275 struct miphy28lp_pll_gen {
 276         int bank;
 277         int speed;
 278         int bias_boost_1;
 279         int bias_boost_2;
 280         int tx_ctrl_1;
 281         int tx_ctrl_2;
 282         int tx_ctrl_3;
 283         int rx_k_gain;
 284         int rx_vga_gain;
 285         int rx_equ_gain_1;
 286         int rx_equ_gain_2;
 287         int rx_equ_gain_3;
 288         int rx_buff_ctrl;
 289 };
 290
 291 static struct miphy28lp_pll_gen sata_pll_gen[] = {
 292         {
 293                 .bank           = 0x00,
 294                 .speed          = TX_SPDSEL_80DEC | RX_SPDSEL_80DEC,
 295                 .bias_boost_1   = 0x00,
 296                 .bias_boost_2   = 0xae,
 297                 .tx_ctrl_2      = 0x53,
 298                 .tx_ctrl_3      = 0x00,
 299                 .rx_buff_ctrl   = EQ_BOOST_GAIN | EQ_DC_GAIN | VGA_GAIN,
 300                 .rx_vga_gain    = 0x00,
 301                 .rx_equ_gain_1  = 0x7d,
 302                 .rx_equ_gain_2  = 0x56,
 303                 .rx_equ_gain_3  = 0x00,
 304         },
 305         {
 306                 .bank           = 0x01,
 307                 .speed          = TX_SPDSEL_40DEC | RX_SPDSEL_40DEC,
 308                 .bias_boost_1   = 0x00,
 309                 .bias_boost_2   = 0xae,
 310                 .tx_ctrl_2      = 0x72,
 311                 .tx_ctrl_3      = 0x20,
 312                 .rx_buff_ctrl   = EQ_BOOST_GAIN | EQ_DC_GAIN | VGA_GAIN,
 313                 .rx_vga_gain    = 0x00,
 314                 .rx_equ_gain_1  = 0x7d,
 315                 .rx_equ_gain_2  = 0x56,
 316                 .rx_equ_gain_3  = 0x00,
 317         },
 318         {
 319                 .bank           = 0x02,
 320                 .speed          = TX_SPDSEL_20DEC | RX_SPDSEL_20DEC,
 321                 .bias_boost_1   = 0x00,
 322                 .bias_boost_2   = 0xae,
 323                 .tx_ctrl_2      = 0xc0,
 324                 .tx_ctrl_3      = 0x20,
 325                 .rx_buff_ctrl   = EQ_BOOST_GAIN | EQ_DC_GAIN | VGA_GAIN,
 326                 .rx_vga_gain    = 0x00,
 327                 .rx_equ_gain_1  = 0x7d,
 328                 .rx_equ_gain_2  = 0x56,
 329                 .rx_equ_gain_3  = 0x00,
 330         },
 331 };
 332
 333 static struct miphy28lp_pll_gen pcie_pll_gen[] = {
 334         {
 335                 .bank           = 0x00,
 336                 .speed          = TX_SPDSEL_40DEC | RX_SPDSEL_40DEC,
 337                 .bias_boost_1   = 0x00,
 338                 .bias_boost_2   = 0xa5,
 339                 .tx_ctrl_1      = TX_REG_STEP_N_25MV,
 340                 .tx_ctrl_2      = 0x71,
 341                 .tx_ctrl_3      = 0x60,
 342                 .rx_k_gain      = 0x98,
 343                 .rx_buff_ctrl   = EQ_BOOST_GAIN | EQ_DC_GAIN | VGA_GAIN,
 344                 .rx_vga_gain    = 0x00,
 345                 .rx_equ_gain_1  = 0x79,
 346                 .rx_equ_gain_2  = 0x56,
 347         },
 348         {
 349                 .bank           = 0x01,
 350                 .speed          = TX_SPDSEL_20DEC | RX_SPDSEL_20DEC,
 351                 .bias_boost_1   = 0x00,
 352                 .bias_boost_2   = 0xa5,
 353                 .tx_ctrl_1      = TX_REG_STEP_N_25MV,
 354                 .tx_ctrl_2      = 0x70,
 355                 .tx_ctrl_3      = 0x60,
 356                 .rx_k_gain      = 0xcc,
 357                 .rx_buff_ctrl   = EQ_BOOST_GAIN | EQ_DC_GAIN | VGA_GAIN,
 358                 .rx_vga_gain    = 0x00,
 359                 .rx_equ_gain_1  = 0x78,
 360                 .rx_equ_gain_2  = 0x07,
 361         },
 362 };
 363
 364 static inline void miphy28lp_set_reset(struct miphy28lp_phy *miphy_phy)
 365 {
 366         void __iomem *base = miphy_phy->base;
 367         u8 val;
 368
 369         /* Putting Macro in reset */
 370         writeb_relaxed(RST_APPLI_SW, base + MIPHY_CONF_RESET);
 371
 372         val = RST_APPLI_SW | RST_CONF_SW;
 373         writeb_relaxed(val, base + MIPHY_CONF_RESET);
 374
 375         writeb_relaxed(RST_APPLI_SW, base + MIPHY_CONF_RESET);
 376
 377         /* Bringing the MIPHY-CPU registers out of reset */
 378         if (miphy_phy->type == PHY_TYPE_PCIE) {
 379                 val = AUTO_RST_RX | TERM_EN_SW;
 380                 writeb_relaxed(val, base + MIPHY_CONTROL);
 381         } else {
 382                 val = AUTO_RST_RX | TERM_EN_SW | DIS_LINK_RST;
 383                 writeb_relaxed(val, base + MIPHY_CONTROL);
 384         }
 385 }
 386
 387 static inline void miphy28lp_pll_calibration(struct miphy28lp_phy *miphy_phy,
 388                 struct pll_ratio *pll_ratio)
 389 {
 390         void __iomem *base = miphy_phy->base;
 391         u8 val;
 392
 393         /* Applying PLL Settings */
 394         writeb_relaxed(0x1d, base + MIPHY_PLL_SPAREIN);
 395         writeb_relaxed(pll_ratio->clk_ref, base + MIPHY_PLL_CLKREF_FREQ);
 396
 397         /* PLL Ratio */
 398         writeb_relaxed(pll_ratio->calset_1, base + MIPHY_PLL_CALSET_1);
 399         writeb_relaxed(pll_ratio->calset_2, base + MIPHY_PLL_CALSET_2);
 400         writeb_relaxed(pll_ratio->calset_3, base + MIPHY_PLL_CALSET_3);
 401         writeb_relaxed(pll_ratio->calset_4, base + MIPHY_PLL_CALSET_4);
 402         writeb_relaxed(pll_ratio->cal_ctrl, base + MIPHY_PLL_CALSET_CTRL);
 403
 404         writeb_relaxed(TX_SEL, base + MIPHY_BOUNDARY_SEL);
 405
 406         val = (0x68 << 1) | TX_SLEW_CAL_MAN_EN;
 407         writeb_relaxed(val, base + MIPHY_TX_CAL_MAN);
 408
 409         val = VGA_OFFSET_POLARITY | CAL_OFFSET_THRESHOLD_64 | CAL_OFFSET_VGA_64;
 410
 411         if (miphy_phy->type != PHY_TYPE_SATA)
 412                 val |= OFFSET_COMPENSATION_EN;
 413
 414         writeb_relaxed(val, base + MIPHY_RX_CAL_OFFSET_CTRL);
 415
 416         if (miphy_phy->type == PHY_TYPE_USB3) {
 417                 writeb_relaxed(0x00, base + MIPHY_CONF);
 418                 writeb_relaxed(0x70, base + MIPHY_RX_LOCK_STEP);
 419                 writeb_relaxed(EN_FIRST_HALF, base + MIPHY_RX_SIGDET_SLEEP_OA);
 420                 writeb_relaxed(EN_FIRST_HALF, base + MIPHY_RX_SIGDET_SLEEP_SEL);
 421                 writeb_relaxed(EN_FIRST_HALF, base + MIPHY_RX_SIGDET_WAIT_SEL);
 422
 423                 val = EN_DIGIT_SIGNAL_CHECK | EN_FIRST_HALF;
 424                 writeb_relaxed(val, base + MIPHY_RX_SIGDET_DATA_SEL);
 425         }
 426
 427 }
 428
 429 static inline void miphy28lp_sata_config_gen(struct miphy28lp_phy *miphy_phy)
 430 {
 431         void __iomem *base = miphy_phy->base;
 432         int i;
 433
 434         for (i = 0; i < ARRAY_SIZE(sata_pll_gen); i++) {
 435                 struct miphy28lp_pll_gen *gen = &sata_pll_gen[i];
 436
 437                 /* Banked settings */
 438                 writeb_relaxed(gen->bank, base + MIPHY_CONF);
 439                 writeb_relaxed(gen->speed, base + MIPHY_SPEED);
 440                 writeb_relaxed(gen->bias_boost_1, base + MIPHY_BIAS_BOOST_1);
 441                 writeb_relaxed(gen->bias_boost_2, base + MIPHY_BIAS_BOOST_2);
 442
 443                 /* TX buffer Settings */
 444                 writeb_relaxed(gen->tx_ctrl_2, base + MIPHY_TX_CTRL_2);
 445                 writeb_relaxed(gen->tx_ctrl_3, base + MIPHY_TX_CTRL_3);
 446
 447                 /* RX Buffer Settings */
 448                 writeb_relaxed(gen->rx_buff_ctrl, base + MIPHY_RX_BUFFER_CTRL);
 449                 writeb_relaxed(gen->rx_vga_gain, base + MIPHY_RX_VGA_GAIN);
 450                 writeb_relaxed(gen->rx_equ_gain_1, base + MIPHY_RX_EQU_GAIN_1);
 451                 writeb_relaxed(gen->rx_equ_gain_2, base + MIPHY_RX_EQU_GAIN_2);
 452                 writeb_relaxed(gen->rx_equ_gain_3, base + MIPHY_RX_EQU_GAIN_3);
 453         }
 454 }
 455
 456 static inline void miphy28lp_pcie_config_gen(struct miphy28lp_phy *miphy_phy)
 457 {
 458         void __iomem *base = miphy_phy->base;
 459         int i;
 460
 461         for (i = 0; i < ARRAY_SIZE(pcie_pll_gen); i++) {
 462                 struct miphy28lp_pll_gen *gen = &pcie_pll_gen[i];
 463
 464                 /* Banked settings */
 465                 writeb_relaxed(gen->bank, base + MIPHY_CONF);
 466                 writeb_relaxed(gen->speed, base + MIPHY_SPEED);
 467                 writeb_relaxed(gen->bias_boost_1, base + MIPHY_BIAS_BOOST_1);
 468                 writeb_relaxed(gen->bias_boost_2, base + MIPHY_BIAS_BOOST_2);
 469
 470                 /* TX buffer Settings */
 471                 writeb_relaxed(gen->tx_ctrl_1, base + MIPHY_TX_CTRL_1);
 472                 writeb_relaxed(gen->tx_ctrl_2, base + MIPHY_TX_CTRL_2);
 473                 writeb_relaxed(gen->tx_ctrl_3, base + MIPHY_TX_CTRL_3);
 474
 475                 writeb_relaxed(gen->rx_k_gain, base + MIPHY_RX_K_GAIN);
 476
 477                 /* RX Buffer Settings */
 478                 writeb_relaxed(gen->rx_buff_ctrl, base + MIPHY_RX_BUFFER_CTRL);
 479                 writeb_relaxed(gen->rx_vga_gain, base + MIPHY_RX_VGA_GAIN);
 480                 writeb_relaxed(gen->rx_equ_gain_1, base + MIPHY_RX_EQU_GAIN_1);
 481                 writeb_relaxed(gen->rx_equ_gain_2, base + MIPHY_RX_EQU_GAIN_2);
 482         }
 483 }
 484
 485 static inline int miphy28lp_wait_compensation(struct miphy28lp_phy *miphy_phy)
 486 {
 487         unsigned long finish = jiffies + 5 * HZ;
 488         u8 val;
 489
 490         /* Waiting for Compensation to complete */
 491         do {
 492                 val = readb_relaxed(miphy_phy->base + MIPHY_COMP_FSM_6);
 493
 494                 if (time_after_eq(jiffies, finish))
 495                         return -EBUSY;
 496                 cpu_relax();
 497         } while (!(val & COMP_DONE));
 498
 499         return 0;
 500 }
 501
 502
 503 static inline int miphy28lp_compensation(struct miphy28lp_phy *miphy_phy,
 504                 struct pll_ratio *pll_ratio)
 505 {
 506         void __iomem *base = miphy_phy->base;
 507
 508         /* Poll for HFC ready after reset release */
 509         /* Compensation measurement */
 510         writeb_relaxed(RST_PLL_SW | RST_COMP_SW, base + MIPHY_RESET);
 511
 512         writeb_relaxed(0x00, base + MIPHY_PLL_COMMON_MISC_2);
 513         writeb_relaxed(pll_ratio->clk_ref, base + MIPHY_PLL_CLKREF_FREQ);
 514         writeb_relaxed(COMP_START, base + MIPHY_COMP_FSM_1);
 515
 516         if (miphy_phy->type == PHY_TYPE_PCIE)
 517                 writeb_relaxed(RST_PLL_SW, base + MIPHY_RESET);
 518
 519         writeb_relaxed(0x00, base + MIPHY_RESET);
 520         writeb_relaxed(START_ACT_FILT, base + MIPHY_PLL_COMMON_MISC_2);
 521         writeb_relaxed(SET_NEW_CHANGE, base + MIPHY_PLL_SBR_1);
 522
 523         /* TX compensation offset to re-center TX impedance */
 524         writeb_relaxed(0x00, base + MIPHY_COMP_POSTP);
 525
 526         if (miphy_phy->type == PHY_TYPE_PCIE)
 527                 return miphy28lp_wait_compensation(miphy_phy);
 528
 529         return 0;
 530 }
 531
 532 static inline void miphy28_usb3_miphy_reset(struct miphy28lp_phy *miphy_phy)
 533 {
 534         void __iomem *base = miphy_phy->base;
 535         u8 val;
 536
 537         /* MIPHY Reset */
 538         writeb_relaxed(RST_APPLI_SW, base + MIPHY_CONF_RESET);
 539         writeb_relaxed(0x00, base + MIPHY_CONF_RESET);
 540         writeb_relaxed(RST_COMP_SW, base + MIPHY_RESET);
 541
 542         val = RST_COMP_SW | RST_PLL_SW;
 543         writeb_relaxed(val, base + MIPHY_RESET);
 544
 545         writeb_relaxed(0x00, base + MIPHY_PLL_COMMON_MISC_2);
 546         writeb_relaxed(0x1e, base + MIPHY_PLL_CLKREF_FREQ);
 547         writeb_relaxed(COMP_START, base + MIPHY_COMP_FSM_1);
 548         writeb_relaxed(RST_PLL_SW, base + MIPHY_RESET);
 549         writeb_relaxed(0x00, base + MIPHY_RESET);
 550         writeb_relaxed(START_ACT_FILT, base + MIPHY_PLL_COMMON_MISC_2);
 551         writeb_relaxed(0x00, base + MIPHY_CONF);
 552         writeb_relaxed(0x00, base + MIPHY_BOUNDARY_1);
 553         writeb_relaxed(0x00, base + MIPHY_TST_BIAS_BOOST_2);
 554         writeb_relaxed(0x00, base + MIPHY_CONF);
 555         writeb_relaxed(SET_NEW_CHANGE, base + MIPHY_PLL_SBR_1);
 556         writeb_relaxed(0xa5, base + MIPHY_DEBUG_BUS);
 557         writeb_relaxed(0x00, base + MIPHY_CONF);
 558 }
 559
 560 static void miphy_sata_tune_ssc(struct miphy28lp_phy *miphy_phy)
 561 {
 562         void __iomem *base = miphy_phy->base;
 563         u8 val;
 564
 565         /* Compensate Tx impedance to avoid out of range values */
 566         /*
 567          * Enable the SSC on PLL for all banks
 568          * SSC Modulation @ 31 KHz and 4000 ppm modulation amp
 569          */
 570         val = readb_relaxed(base + MIPHY_BOUNDARY_2);
 571         val |= SSC_EN_SW;
 572         writeb_relaxed(val, base + MIPHY_BOUNDARY_2);
 573
 574         val = readb_relaxed(base + MIPHY_BOUNDARY_SEL);
 575         val |= SSC_SEL;
 576         writeb_relaxed(val, base + MIPHY_BOUNDARY_SEL);
 577
 578         for (val = 0; val < MIPHY_SATA_BANK_NB; val++) {
 579                 writeb_relaxed(val, base + MIPHY_CONF);
 580
 581                 /* Add value to each reference clock cycle  */
 582                 /* and define the period length of the SSC */
 583                 writeb_relaxed(0x3c, base + MIPHY_PLL_SBR_2);
 584                 writeb_relaxed(0x6c, base + MIPHY_PLL_SBR_3);
 585                 writeb_relaxed(0x81, base + MIPHY_PLL_SBR_4);
 586
 587                 /* Clear any previous request */
 588                 writeb_relaxed(0x00, base + MIPHY_PLL_SBR_1);
 589
 590                 /* requests the PLL to take in account new parameters */
 591                 writeb_relaxed(SET_NEW_CHANGE, base + MIPHY_PLL_SBR_1);
 592
 593                 /* To be sure there is no other pending requests */
 594                 writeb_relaxed(0x00, base + MIPHY_PLL_SBR_1);
 595         }
 596 }
 597
 598 static void miphy_pcie_tune_ssc(struct miphy28lp_phy *miphy_phy)
 599 {
 600         void __iomem *base = miphy_phy->base;
 601         u8 val;
 602
 603         /* Compensate Tx impedance to avoid out of range values */
 604         /*
 605          * Enable the SSC on PLL for all banks
 606          * SSC Modulation @ 31 KHz and 4000 ppm modulation amp
 607          */
 608         val = readb_relaxed(base + MIPHY_BOUNDARY_2);
 609         val |= SSC_EN_SW;
 610         writeb_relaxed(val, base + MIPHY_BOUNDARY_2);
 611
 612         val = readb_relaxed(base + MIPHY_BOUNDARY_SEL);
 613         val |= SSC_SEL;
 614         writeb_relaxed(val, base + MIPHY_BOUNDARY_SEL);
 615
 616         for (val = 0; val < MIPHY_PCIE_BANK_NB; val++) {
 617                 writeb_relaxed(val, base + MIPHY_CONF);
 618
 619                 /* Validate Step component */
 620                 writeb_relaxed(0x69, base + MIPHY_PLL_SBR_3);
 621                 writeb_relaxed(0x21, base + MIPHY_PLL_SBR_4);
 622
 623                 /* Validate Period component */
 624                 writeb_relaxed(0x3c, base + MIPHY_PLL_SBR_2);
 625                 writeb_relaxed(0x21, base + MIPHY_PLL_SBR_4);
 626
 627                 /* Clear any previous request */
 628                 writeb_relaxed(0x00, base + MIPHY_PLL_SBR_1);
 629
 630                 /* requests the PLL to take in account new parameters */
 631                 writeb_relaxed(SET_NEW_CHANGE, base + MIPHY_PLL_SBR_1);
 632
 633                 /* To be sure there is no other pending requests */
 634                 writeb_relaxed(0x00, base + MIPHY_PLL_SBR_1);
 635         }
 636 }
 637
 638 static inline void miphy_tune_tx_impedance(struct miphy28lp_phy *miphy_phy)
 639 {
 640         /* Compensate Tx impedance to avoid out of range values */
 641         writeb_relaxed(0x02, miphy_phy->base + MIPHY_COMP_POSTP);
 642 }
 643
 644 static inline int miphy28lp_configure_sata(struct miphy28lp_phy *miphy_phy)
 645 {
 646         void __iomem *base = miphy_phy->base;
 647         int err;
 648         u8 val;
 649
 650         /* Putting Macro in reset */
 651         miphy28lp_set_reset(miphy_phy);
 652
 653         /* PLL calibration */
 654         miphy28lp_pll_calibration(miphy_phy, &sata_pll_ratio);
 655
 656         /* Banked settings Gen1/Gen2/Gen3 */
 657         miphy28lp_sata_config_gen(miphy_phy);
 658
 659         /* Power control */
 660         /* Input bridge enable, manual input bridge control */
 661         writeb_relaxed(0x21, base + MIPHY_RX_POWER_CTRL_1);
 662
 663         /* Macro out of reset */
 664         writeb_relaxed(0x00, base + MIPHY_CONF_RESET);
 665
 666         /* Poll for HFC ready after reset release */
 667         /* Compensation measurement */
 668         err = miphy28lp_compensation(miphy_phy, &sata_pll_ratio);
 669         if (err)
 670                 return err;
 671
 672         if (miphy_phy->px_rx_pol_inv) {
 673                 /* Invert Rx polarity */
 674                 val = readb_relaxed(miphy_phy->base + MIPHY_CONTROL);
 675                 val |= PX_RX_POL;
 676                 writeb_relaxed(val, miphy_phy->base + MIPHY_CONTROL);
 677         }
 678
 679         if (miphy_phy->ssc)
 680                 miphy_sata_tune_ssc(miphy_phy);
 681
 682         if (miphy_phy->tx_impedance)
 683                 miphy_tune_tx_impedance(miphy_phy);
 684
 685         return 0;
 686 }
 687
 688 static inline int miphy28lp_configure_pcie(struct miphy28lp_phy *miphy_phy)
 689 {
 690         void __iomem *base = miphy_phy->base;
 691         int err;
 692
 693         /* Putting Macro in reset */
 694         miphy28lp_set_reset(miphy_phy);
 695
 696         /* PLL calibration */
 697         miphy28lp_pll_calibration(miphy_phy, &pcie_pll_ratio);
 698
 699         /* Banked settings Gen1/Gen2 */
 700         miphy28lp_pcie_config_gen(miphy_phy);
 701
 702         /* Power control */
 703         /* Input bridge enable, manual input bridge control */
 704         writeb_relaxed(0x21, base + MIPHY_RX_POWER_CTRL_1);
 705
 706         /* Macro out of reset */
 707         writeb_relaxed(0x00, base + MIPHY_CONF_RESET);
 708
 709         /* Poll for HFC ready after reset release */
 710         /* Compensation measurement */
 711         err = miphy28lp_compensation(miphy_phy, &pcie_pll_ratio);
 712         if (err)
 713                 return err;
 714
 715         if (miphy_phy->ssc)
 716                 miphy_pcie_tune_ssc(miphy_phy);
 717
 718         if (miphy_phy->tx_impedance)
 719                 miphy_tune_tx_impedance(miphy_phy);
 720
 721         return 0;
 722 }
 723
 724
 725 static inline void miphy28lp_configure_usb3(struct miphy28lp_phy *miphy_phy)
 726 {
 727         void __iomem *base = miphy_phy->base;
 728         u8 val;
 729
 730         /* Putting Macro in reset */
 731         miphy28lp_set_reset(miphy_phy);
 732
 733         /* PLL calibration */
 734         miphy28lp_pll_calibration(miphy_phy, &usb3_pll_ratio);
 735
 736         /* Writing The Speed Rate */
 737         writeb_relaxed(0x00, base + MIPHY_CONF);
 738
 739         val = RX_SPDSEL_20DEC | TX_SPDSEL_20DEC;
 740         writeb_relaxed(val, base + MIPHY_SPEED);
 741
 742         /* RX Channel compensation and calibration */
 743         writeb_relaxed(0x1c, base + MIPHY_RX_LOCK_SETTINGS_OPT);
 744         writeb_relaxed(0x51, base + MIPHY_RX_CAL_CTRL_1);
 745         writeb_relaxed(0x70, base + MIPHY_RX_CAL_CTRL_2);
 746
 747         val = OFFSET_COMPENSATION_EN | VGA_OFFSET_POLARITY |
 748               CAL_OFFSET_THRESHOLD_64 | CAL_OFFSET_VGA_64;
 749         writeb_relaxed(val, base + MIPHY_RX_CAL_OFFSET_CTRL);
 750         writeb_relaxed(0x22, base + MIPHY_RX_CAL_VGA_STEP);
 751         writeb_relaxed(0x0e, base + MIPHY_RX_CAL_OPT_LENGTH);
 752
 753         val = EQ_DC_GAIN | VGA_GAIN;
 754         writeb_relaxed(val, base + MIPHY_RX_BUFFER_CTRL);
 755         writeb_relaxed(0x78, base + MIPHY_RX_EQU_GAIN_1);
 756         writeb_relaxed(0x1b, base + MIPHY_SYNCHAR_CONTROL);
 757
 758         /* TX compensation offset to re-center TX impedance */
 759         writeb_relaxed(0x02, base + MIPHY_COMP_POSTP);
 760
 761         /* Enable GENSEL_SEL and SSC */
 762         /* TX_SEL=0 swing preemp forced by pipe registres */
 763         val = SSC_SEL | GENSEL_SEL;
 764         writeb_relaxed(val, base + MIPHY_BOUNDARY_SEL);
 765
 766         /* MIPHY Bias boost */
 767         writeb_relaxed(0x00, base + MIPHY_BIAS_BOOST_1);
 768         writeb_relaxed(0xa7, base + MIPHY_BIAS_BOOST_2);
 769
 770         /* SSC modulation */
 771         writeb_relaxed(SSC_EN_SW, base + MIPHY_BOUNDARY_2);
 772
 773         /* MIPHY TX control */
 774         writeb_relaxed(0x00, base + MIPHY_CONF);
 775
 776         /* Validate Step component */
 777         writeb_relaxed(0x5a, base + MIPHY_PLL_SBR_3);
 778         writeb_relaxed(0xa0, base + MIPHY_PLL_SBR_4);
 779
 780         /* Validate Period component */
 781         writeb_relaxed(0x3c, base + MIPHY_PLL_SBR_2);
 782         writeb_relaxed(0xa1, base + MIPHY_PLL_SBR_4);
 783
 784         /* Clear any previous request */
 785         writeb_relaxed(0x00, base + MIPHY_PLL_SBR_1);
 786
 787         /* requests the PLL to take in account new parameters */
 788         writeb_relaxed(0x02, base + MIPHY_PLL_SBR_1);
 789
 790         /* To be sure there is no other pending requests */
 791         writeb_relaxed(0x00, base + MIPHY_PLL_SBR_1);
 792
 793         /* Rx PI controller settings */
 794         writeb_relaxed(0xca, base + MIPHY_RX_K_GAIN);
 795
 796         /* MIPHY RX input bridge control */
 797         /* INPUT_BRIDGE_EN_SW=1, manual input bridge control[0]=1 */
 798         writeb_relaxed(0x21, base + MIPHY_RX_POWER_CTRL_1);
 799         writeb_relaxed(0x29, base + MIPHY_RX_POWER_CTRL_1);
 800         writeb_relaxed(0x1a, base + MIPHY_RX_POWER_CTRL_2);
 801
 802         /* MIPHY Reset for usb3 */
 803         miphy28_usb3_miphy_reset(miphy_phy);
 804 }
 805
 806 static inline int miphy_is_ready(struct miphy28lp_phy *miphy_phy)
 807 {
 808         unsigned long finish = jiffies + 5 * HZ;
 809         u8 mask = HFC_PLL | HFC_RDY;
 810         u8 val;
 811
 812         /*
 813          * For PCIe and USB3 check only that PLL and HFC are ready
 814          * For SATA check also that phy is ready!
 815          */
 816         if (miphy_phy->type == PHY_TYPE_SATA)
 817                 mask |= PHY_RDY;
 818
 819         do {
 820                 val = readb_relaxed(miphy_phy->base + MIPHY_STATUS_1);
 821                 if ((val & mask) != mask)
 822                         cpu_relax();
 823                 else
 824                         return 0;
 825         } while (!time_after_eq(jiffies, finish));
 826
 827         return -EBUSY;
 828 }
 829
 830 static int miphy_osc_is_ready(struct miphy28lp_phy *miphy_phy)
 831 {
 832         struct miphy28lp_dev *miphy_dev = miphy_phy->phydev;
 833         unsigned long finish = jiffies + 5 * HZ;
 834         u32 val;
 835
 836         if (!miphy_phy->osc_rdy)
 837                 return 0;
 838
 839         if (!miphy_phy->syscfg_reg[SYSCFG_STATUS])
 840                 return -EINVAL;
 841
 842         do {
 843                 regmap_read(miphy_dev->regmap,
 844                                 miphy_phy->syscfg_reg[SYSCFG_STATUS], &val);
 845
 846                 if ((val & MIPHY_OSC_RDY) != MIPHY_OSC_RDY)
 847                         cpu_relax();
 848                 else
 849                         return 0;
 850         } while (!time_after_eq(jiffies, finish));
 851
 852         return -EBUSY;
 853 }
 854
 855 static int miphy28lp_get_resource_byname(struct device_node *child,
 856                                           char *rname, struct resource *res)
 857 {
 858         int index;
 859
 860         index = of_property_match_string(child, "reg-names", rname);
 861         if (index < 0)
 862                 return -ENODEV;
 863
 864         return of_address_to_resource(child, index, res);
 865 }
 866
 867 static int miphy28lp_get_one_addr(struct device *dev,
 868                                   struct device_node *child, char *rname,
 869                                   void __iomem **base)
 870 {
 871         struct resource res;
 872         int ret;
 873
 874         ret = miphy28lp_get_resource_byname(child, rname, &res);
 875         if (!ret) {
 876                 *base = devm_ioremap(dev, res.start, resource_size(&res));
 877                 if (!*base) {
 878                         dev_err(dev, "failed to ioremap %s address region\n"
 879                                         , rname);
 880                         return -ENOENT;
 881                 }
 882         }
 883
 884         return 0;
 885 }
 886
 887 /* MiPHY reset and sysconf setup */
 888 static int miphy28lp_setup(struct miphy28lp_phy *miphy_phy, u32 miphy_val)
 889 {
 890         int err;
 891         struct miphy28lp_dev *miphy_dev = miphy_phy->phydev;
 892
 893         if (!miphy_phy->syscfg_reg[SYSCFG_CTRL])
 894                 return -EINVAL;
 895
 896         err = reset_control_assert(miphy_phy->miphy_rst);
 897         if (err) {
 898                 dev_err(miphy_dev->dev, "unable to bring out of miphy reset\n");
 899                 return err;
 900         }
 901
 902         if (miphy_phy->osc_force_ext)
 903                 miphy_val |= MIPHY_OSC_FORCE_EXT;
 904
 905         regmap_update_bits(miphy_dev->regmap,
 906                            miphy_phy->syscfg_reg[SYSCFG_CTRL],
 907                            MIPHY_CTRL_MASK, miphy_val);
 908
 909         err = reset_control_deassert(miphy_phy->miphy_rst);
 910         if (err) {
 911                 dev_err(miphy_dev->dev, "unable to bring out of miphy reset\n");
 912                 return err;
 913         }
 914
 915         return miphy_osc_is_ready(miphy_phy);
 916 }
 917
 918 static int miphy28lp_init_sata(struct miphy28lp_phy *miphy_phy)
 919 {
 920         struct miphy28lp_dev *miphy_dev = miphy_phy->phydev;
 921         int err, sata_conf = SATA_CTRL_SELECT_SATA;
 922
 923         if ((!miphy_phy->syscfg_reg[SYSCFG_SATA]) ||
 924                         (!miphy_phy->syscfg_reg[SYSCFG_PCI]) ||
 925                         (!miphy_phy->base))
 926                 return -EINVAL;
 927
 928         dev_info(miphy_dev->dev, "sata-up mode, addr 0x%p\n", miphy_phy->base);
 929
 930         /* Configure the glue-logic */
 931         sata_conf |= ((miphy_phy->sata_gen - SATA_GEN1) << SATA_SPDMODE);
 932
 933         regmap_update_bits(miphy_dev->regmap,
 934                            miphy_phy->syscfg_reg[SYSCFG_SATA],
 935                            SATA_CTRL_MASK, sata_conf);
 936
 937         regmap_update_bits(miphy_dev->regmap, miphy_phy->syscfg_reg[SYSCFG_PCI],
 938                            PCIE_CTRL_MASK, SATA_CTRL_SELECT_PCIE);
 939
 940         /* MiPHY path and clocking init */
 941         err = miphy28lp_setup(miphy_phy, MIPHY_CTRL_DEFAULT);
 942
 943         if (err) {
 944                 dev_err(miphy_dev->dev, "SATA phy setup failed\n");
 945                 return err;
 946         }
 947
 948         /* initialize miphy */
 949         miphy28lp_configure_sata(miphy_phy);
 950
 951         return miphy_is_ready(miphy_phy);
 952 }
 953
 954 static int miphy28lp_init_pcie(struct miphy28lp_phy *miphy_phy)
 955 {
 956         struct miphy28lp_dev *miphy_dev = miphy_phy->phydev;
 957         int err;
 958
 959         if ((!miphy_phy->syscfg_reg[SYSCFG_SATA]) ||
 960                         (!miphy_phy->syscfg_reg[SYSCFG_PCI])
 961                 || (!miphy_phy->base) || (!miphy_phy->pipebase))
 962                 return -EINVAL;
 963
 964         dev_info(miphy_dev->dev, "pcie-up mode, addr 0x%p\n", miphy_phy->base);
 965
 966         /* Configure the glue-logic */
 967         regmap_update_bits(miphy_dev->regmap,
 968                            miphy_phy->syscfg_reg[SYSCFG_SATA],
 969                            SATA_CTRL_MASK, SATA_CTRL_SELECT_PCIE);
 970
 971         regmap_update_bits(miphy_dev->regmap, miphy_phy->syscfg_reg[SYSCFG_PCI],
 972                            PCIE_CTRL_MASK, SYSCFG_PCIE_PCIE_VAL);
 973
 974         /* MiPHY path and clocking init */
 975         err = miphy28lp_setup(miphy_phy, MIPHY_CTRL_DEFAULT);
 976
 977         if (err) {
 978                 dev_err(miphy_dev->dev, "PCIe phy setup failed\n");
 979                 return err;
 980         }
 981
 982         /* initialize miphy */
 983         err = miphy28lp_configure_pcie(miphy_phy);
 984         if (err)
 985                 return err;
 986
 987         /* PIPE Wrapper Configuration */
 988         writeb_relaxed(0x68, miphy_phy->pipebase + 0x104); /* Rise_0 */
 989         writeb_relaxed(0x61, miphy_phy->pipebase + 0x105); /* Rise_1 */
 990         writeb_relaxed(0x68, miphy_phy->pipebase + 0x108); /* Fall_0 */
 991         writeb_relaxed(0x61, miphy_phy->pipebase + 0x109); /* Fall-1 */
 992         writeb_relaxed(0x68, miphy_phy->pipebase + 0x10c); /* Threshold_0 */
 993         writeb_relaxed(0x60, miphy_phy->pipebase + 0x10d); /* Threshold_1 */
 994
 995         /* Wait for phy_ready */
 996         return miphy_is_ready(miphy_phy);
 997 }
 998
 999 static int miphy28lp_init_usb3(struct miphy28lp_phy *miphy_phy)
1000 {
1001         struct miphy28lp_dev *miphy_dev = miphy_phy->phydev;
1002         int err;
1003
1004         if ((!miphy_phy->base) || (!miphy_phy->pipebase))
1005                 return -EINVAL;
1006
1007         dev_info(miphy_dev->dev, "usb3-up mode, addr 0x%p\n", miphy_phy->base);
1008
1009         /* MiPHY path and clocking init */
1010         err = miphy28lp_setup(miphy_phy, MIPHY_CTRL_SYNC_D_EN);
1011         if (err) {
1012                 dev_err(miphy_dev->dev, "USB3 phy setup failed\n");
1013                 return err;
1014         }
1015
1016         /* initialize miphy */
1017         miphy28lp_configure_usb3(miphy_phy);
1018
1019         /* PIPE Wrapper Configuration */
1020         writeb_relaxed(0x68, miphy_phy->pipebase + 0x23);
1021         writeb_relaxed(0x61, miphy_phy->pipebase + 0x24);
1022         writeb_relaxed(0x68, miphy_phy->pipebase + 0x26);
1023         writeb_relaxed(0x61, miphy_phy->pipebase + 0x27);
1024         writeb_relaxed(0x18, miphy_phy->pipebase + 0x29);
1025         writeb_relaxed(0x61, miphy_phy->pipebase + 0x2a);
1026
1027         /* pipe Wrapper usb3 TX swing de-emph margin PREEMPH[7:4], SWING[3:0] */
1028         writeb_relaxed(0X67, miphy_phy->pipebase + 0x68);
1029         writeb_relaxed(0x0d, miphy_phy->pipebase + 0x69);
1030         writeb_relaxed(0X67, miphy_phy->pipebase + 0x6a);
1031         writeb_relaxed(0X0d, miphy_phy->pipebase + 0x6b);
1032         writeb_relaxed(0X67, miphy_phy->pipebase + 0x6c);
1033         writeb_relaxed(0X0d, miphy_phy->pipebase + 0x6d);
1034         writeb_relaxed(0X67, miphy_phy->pipebase + 0x6e);
1035         writeb_relaxed(0X0d, miphy_phy->pipebase + 0x6f);
1036
1037         return miphy_is_ready(miphy_phy);
1038 }
1039
1040 static int miphy28lp_init(struct phy *phy)
1041 {
1042         struct miphy28lp_phy *miphy_phy = phy_get_drvdata(phy);
1043         struct miphy28lp_dev *miphy_dev = miphy_phy->phydev;
1044         int ret;
1045
1046         mutex_lock(&miphy_dev->miphy_mutex);
1047
1048         switch (miphy_phy->type) {
1049
1050         case PHY_TYPE_SATA:
1051                 ret = miphy28lp_init_sata(miphy_phy);
1052                 break;
1053         case PHY_TYPE_PCIE:
1054                 ret = miphy28lp_init_pcie(miphy_phy);
1055                 break;
1056         case PHY_TYPE_USB3:
1057                 ret = miphy28lp_init_usb3(miphy_phy);
1058                 break;
1059         default:
1060                 ret = -EINVAL;
1061                 break;
1062         }
1063
1064         mutex_unlock(&miphy_dev->miphy_mutex);
1065
1066         return ret;
1067 }
1068
1069 static int miphy28lp_get_addr(struct miphy28lp_phy *miphy_phy)
1070 {
1071         struct miphy28lp_dev *miphy_dev = miphy_phy->phydev;
1072         struct device_node *phynode = miphy_phy->phy->dev.of_node;
1073         int err;
1074
1075         if ((miphy_phy->type != PHY_TYPE_SATA) &&
1076             (miphy_phy->type != PHY_TYPE_PCIE) &&
1077             (miphy_phy->type != PHY_TYPE_USB3)) {
1078                 return -EINVAL;
1079         }
1080
1081         err = miphy28lp_get_one_addr(miphy_dev->dev, phynode,
1082                         PHY_TYPE_name[miphy_phy->type - PHY_TYPE_SATA],
1083                         &miphy_phy->base);
1084         if (err)
1085                 return err;
1086
1087         if ((miphy_phy->type == PHY_TYPE_PCIE) ||
1088             (miphy_phy->type == PHY_TYPE_USB3)) {
1089                 err = miphy28lp_get_one_addr(miphy_dev->dev, phynode, "pipew",
1090                                              &miphy_phy->pipebase);
1091                 if (err)
1092                         return err;
1093         }
1094
1095         return 0;
1096 }
1097
1098 static struct phy *miphy28lp_xlate(struct device *dev,
1099                                    struct of_phandle_args *args)
1100 {
1101         struct miphy28lp_dev *miphy_dev = dev_get_drvdata(dev);
1102         struct miphy28lp_phy *miphy_phy = NULL;
1103         struct device_node *phynode = args->np;
1104         int ret, index = 0;
1105
1106         if (args->args_count != 1) {
1107                 dev_err(dev, "Invalid number of cells in 'phy' property\n");
1108                 return ERR_PTR(-EINVAL);
1109         }
1110
1111         for (index = 0; index < miphy_dev->nphys; index++)
1112                 if (phynode == miphy_dev->phys[index]->phy->dev.of_node) {
1113                         miphy_phy = miphy_dev->phys[index];
1114                         break;
1115                 }
1116
1117         if (!miphy_phy) {
1118                 dev_err(dev, "Failed to find appropriate phy\n");
1119                 return ERR_PTR(-EINVAL);
1120         }
1121
1122         miphy_phy->type = args->args[0];
1123
1124         ret = miphy28lp_get_addr(miphy_phy);
1125         if (ret < 0)
1126                 return ERR_PTR(ret);
1127
1128         return miphy_phy->phy;
1129 }
1130
1131 static const struct phy_ops miphy28lp_ops = {
1132         .init = miphy28lp_init,
1133         .owner = THIS_MODULE,
1134 };
1135
1136 static int miphy28lp_probe_resets(struct device_node *node,
1137                                   struct miphy28lp_phy *miphy_phy)
1138 {
1139         struct miphy28lp_dev *miphy_dev = miphy_phy->phydev;
1140         int err;
1141
1142         miphy_phy->miphy_rst =
1143                 of_reset_control_get_shared(node, "miphy-sw-rst");
1144
1145         if (IS_ERR(miphy_phy->miphy_rst)) {
1146                 dev_err(miphy_dev->dev,
1147                                 "miphy soft reset control not defined\n");
1148                 return PTR_ERR(miphy_phy->miphy_rst);
1149         }
1150
1151         err = reset_control_deassert(miphy_phy->miphy_rst);
1152         if (err) {
1153                 dev_err(miphy_dev->dev, "unable to bring out of miphy reset\n");
1154                 return err;
1155         }
1156
1157         return 0;
1158 }
1159
1160 static int miphy28lp_of_probe(struct device_node *np,
1161                               struct miphy28lp_phy *miphy_phy)
1162 {
1163         int i;
1164         u32 ctrlreg;
1165
1166         miphy_phy->osc_force_ext =
1167                 of_property_read_bool(np, "st,osc-force-ext");
1168
1169         miphy_phy->osc_rdy = of_property_read_bool(np, "st,osc-rdy");
1170
1171         miphy_phy->px_rx_pol_inv =
1172                 of_property_read_bool(np, "st,px_rx_pol_inv");
1173
1174         miphy_phy->ssc = of_property_read_bool(np, "st,ssc-on");
1175
1176         miphy_phy->tx_impedance =
1177                 of_property_read_bool(np, "st,tx-impedance-comp");
1178
1179         of_property_read_u32(np, "st,sata-gen", &miphy_phy->sata_gen);
1180         if (!miphy_phy->sata_gen)
1181                 miphy_phy->sata_gen = SATA_GEN1;
1182
1183         for (i = 0; i < SYSCFG_REG_MAX; i++) {
1184                 if (!of_property_read_u32_index(np, "st,syscfg", i, &ctrlreg))
1185                         miphy_phy->syscfg_reg[i] = ctrlreg;
1186         }
1187
1188         return 0;
1189 }
1190
1191 static int miphy28lp_probe(struct platform_device *pdev)
1192 {
1193         struct device_node *child, *np = pdev->dev.of_node;
1194         struct miphy28lp_dev *miphy_dev;
1195         struct phy_provider *provider;
1196         struct phy *phy;
1197         int ret, port = 0;
1198
1199         miphy_dev = devm_kzalloc(&pdev->dev, sizeof(*miphy_dev), GFP_KERNEL);
1200         if (!miphy_dev)
1201                 return -ENOMEM;
1202
1203         miphy_dev->nphys = of_get_child_count(np);
1204         miphy_dev->phys = devm_kcalloc(&pdev->dev, miphy_dev->nphys,
1205                                        sizeof(*miphy_dev->phys), GFP_KERNEL);
1206         if (!miphy_dev->phys)
1207                 return -ENOMEM;
1208
1209         miphy_dev->regmap = syscon_regmap_lookup_by_phandle(np, "st,syscfg");
1210         if (IS_ERR(miphy_dev->regmap)) {
1211                 dev_err(miphy_dev->dev, "No syscfg phandle specified\n");
1212                 return PTR_ERR(miphy_dev->regmap);
1213         }
1214
1215         miphy_dev->dev = &pdev->dev;
1216
1217         dev_set_drvdata(&pdev->dev, miphy_dev);
1218
1219         mutex_init(&miphy_dev->miphy_mutex);
1220
1221         for_each_child_of_node(np, child) {
1222                 struct miphy28lp_phy *miphy_phy;
1223
1224                 miphy_phy = devm_kzalloc(&pdev->dev, sizeof(*miphy_phy),
1225                                          GFP_KERNEL);
1226                 if (!miphy_phy) {
1227                         ret = -ENOMEM;
1228                         goto put_child;
1229                 }
1230
1231                 miphy_dev->phys[port] = miphy_phy;
1232
1233                 phy = devm_phy_create(&pdev->dev, child, &miphy28lp_ops);
1234                 if (IS_ERR(phy)) {
1235                         dev_err(&pdev->dev, "failed to create PHY\n");
1236                         ret = PTR_ERR(phy);
1237                         goto put_child;
1238                 }
1239
1240                 miphy_dev->phys[port]->phy = phy;
1241                 miphy_dev->phys[port]->phydev = miphy_dev;
1242
1243                 ret = miphy28lp_of_probe(child, miphy_phy);
1244                 if (ret)
1245                         goto put_child;
1246
1247                 ret = miphy28lp_probe_resets(child, miphy_dev->phys[port]);
1248                 if (ret)
1249                         goto put_child;
1250
1251                 phy_set_drvdata(phy, miphy_dev->phys[port]);
1252                 port++;
1253
1254         }
1255
1256         provider = devm_of_phy_provider_register(&pdev->dev, miphy28lp_xlate);
1257         return PTR_ERR_OR_ZERO(provider);
1258 put_child:
1259         of_node_put(child);
1260         return ret;
1261 }
1262
1263 static const struct of_device_id miphy28lp_of_match[] = {
1264         {.compatible = "st,miphy28lp-phy", },
1265         {},
1266 };
1267
1268 MODULE_DEVICE_TABLE(of, miphy28lp_of_match);
1269
1270 static struct platform_driver miphy28lp_driver = {
1271         .probe = miphy28lp_probe,
1272         .driver = {
1273                 .name = "miphy28lp-phy",
1274                 .of_match_table = miphy28lp_of_match,
1275         }
1276 };
1277
1278 module_platform_driver(miphy28lp_driver);
1279
1280 MODULE_AUTHOR("Alexandre Torgue <alexandre.torgue@st.com>");
1281 MODULE_DESCRIPTION("STMicroelectronics miphy28lp driver");
1282 MODULE_LICENSE("GPL v2");