drivers/phy/ti/phy-am654-serdes.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /**
   3  * PCIe SERDES driver for AM654x SoC
   4  *
   5  * Copyright (C) 2018 - 2019 Texas Instruments Incorporated - http://www.ti.com/
   6  * Author: Kishon Vijay Abraham I <kishon@ti.com>
   7  */
   8
   9 #include <dt-bindings/phy/phy.h>
  10 #include <linux/clk.h>
  11 #include <linux/clk-provider.h>
  12 #include <linux/delay.h>
  13 #include <linux/module.h>
  14 #include <linux/mfd/syscon.h>
  15 #include <linux/mux/consumer.h>
  16 #include <linux/of_address.h>
  17 #include <linux/phy/phy.h>
  18 #include <linux/platform_device.h>
  19 #include <linux/pm_runtime.h>
  20 #include <linux/regmap.h>
  21
  22 #define CMU_R004                0x4
  23 #define CMU_R060                0x60
  24 #define CMU_R07C                0x7c
  25 #define CMU_R088                0x88
  26 #define CMU_R0D0                0xd0
  27 #define CMU_R0E8                0xe8
  28
  29 #define LANE_R048               0x248
  30 #define LANE_R058               0x258
  31 #define LANE_R06c               0x26c
  32 #define LANE_R070               0x270
  33 #define LANE_R070               0x270
  34 #define LANE_R19C               0x39c
  35
  36 #define COMLANE_R004            0xa04
  37 #define COMLANE_R138            0xb38
  38 #define VERSION_VAL             0x70
  39
  40 #define COMLANE_R190            0xb90
  41 #define COMLANE_R194            0xb94
  42
  43 #define COMRXEQ_R004            0x1404
  44 #define COMRXEQ_R008            0x1408
  45 #define COMRXEQ_R00C            0x140c
  46 #define COMRXEQ_R014            0x1414
  47 #define COMRXEQ_R018            0x1418
  48 #define COMRXEQ_R01C            0x141c
  49 #define COMRXEQ_R04C            0x144c
  50 #define COMRXEQ_R088            0x1488
  51 #define COMRXEQ_R094            0x1494
  52 #define COMRXEQ_R098            0x1498
  53
  54 #define SERDES_CTRL             0x1fd0
  55
  56 #define WIZ_LANEXCTL_STS        0x1fe0
  57 #define TX0_DISABLE_STATE       0x4
  58 #define TX0_SLEEP_STATE         0x5
  59 #define TX0_SNOOZE_STATE        0x6
  60 #define TX0_ENABLE_STATE        0x7
  61
  62 #define RX0_DISABLE_STATE       0x4
  63 #define RX0_SLEEP_STATE         0x5
  64 #define RX0_SNOOZE_STATE        0x6
  65 #define RX0_ENABLE_STATE        0x7
  66
  67 #define WIZ_PLL_CTRL            0x1ff4
  68 #define PLL_DISABLE_STATE       0x4
  69 #define PLL_SLEEP_STATE         0x5
  70 #define PLL_SNOOZE_STATE        0x6
  71 #define PLL_ENABLE_STATE        0x7
  72
  73 #define PLL_LOCK_TIME           100000  /* in microseconds */
  74 #define SLEEP_TIME              100     /* in microseconds */
  75
  76 #define LANE_USB3               0x0
  77 #define LANE_PCIE0_LANE0        0x1
  78
  79 #define LANE_PCIE1_LANE0        0x0
  80 #define LANE_PCIE0_LANE1        0x1
  81
  82 #define SERDES_NUM_CLOCKS       3
  83
  84 #define AM654_SERDES_CTRL_CLKSEL_MASK   GENMASK(7, 4)
  85 #define AM654_SERDES_CTRL_CLKSEL_SHIFT  4
  86
  87 struct serdes_am654_clk_mux {
  88         struct clk_hw   hw;
  89         struct regmap   *regmap;
  90         unsigned int    reg;
  91         int             clk_id;
  92         struct clk_init_data clk_data;
  93 };
  94
  95 #define to_serdes_am654_clk_mux(_hw)    \
  96                 container_of(_hw, struct serdes_am654_clk_mux, hw)
  97
  98 static const struct regmap_config serdes_am654_regmap_config = {
  99         .reg_bits = 32,
 100         .val_bits = 32,
 101         .reg_stride = 4,
 102         .fast_io = true,
 103         .max_register = 0x1ffc,
 104 };
 105
 106 enum serdes_am654_fields {
 107         /* CMU PLL Control */
 108         CMU_PLL_CTRL,
 109
 110         LANE_PLL_CTRL_RXEQ_RXIDLE,
 111
 112         /* CMU VCO bias current and VREG setting */
 113         AHB_PMA_CM_VCO_VBIAS_VREG,
 114         AHB_PMA_CM_VCO_BIAS_VREG,
 115
 116         AHB_PMA_CM_SR,
 117         AHB_SSC_GEN_Z_O_20_13,
 118
 119         /* AHB PMA Lane Configuration */
 120         AHB_PMA_LN_AGC_THSEL_VREGH,
 121
 122         /* AGC and Signal detect threshold for Gen3 */
 123         AHB_PMA_LN_GEN3_AGC_SD_THSEL,
 124
 125         AHB_PMA_LN_RX_SELR_GEN3,
 126         AHB_PMA_LN_TX_DRV,
 127
 128         /* CMU Master Reset */
 129         CMU_MASTER_CDN,
 130
 131         /* P2S ring buffer initial startup pointer difference */
 132         P2S_RBUF_PTR_DIFF,
 133
 134         CONFIG_VERSION,
 135
 136         /* Lane 1 Master Reset */
 137         L1_MASTER_CDN,
 138
 139         /* CMU OK Status */
 140         CMU_OK_I_0,
 141
 142         /* Mid-speed initial calibration control */
 143         COMRXEQ_MS_INIT_CTRL_7_0,
 144
 145         /* High-speed initial calibration control */
 146         COMRXEQ_HS_INIT_CAL_7_0,
 147
 148         /* Mid-speed recalibration control */
 149         COMRXEQ_MS_RECAL_CTRL_7_0,
 150
 151         /* High-speed recalibration control */
 152         COMRXEQ_HS_RECAL_CTRL_7_0,
 153
 154         /* ATT configuration */
 155         COMRXEQ_CSR_ATT_CONFIG,
 156
 157         /* Edge based boost adaptation window length */
 158         COMRXEQ_CSR_EBSTADAPT_WIN_LEN,
 159
 160         /* COMRXEQ control 3 & 4 */
 161         COMRXEQ_CTRL_3_4,
 162
 163         /* COMRXEQ control 14, 15 and 16*/
 164         COMRXEQ_CTRL_14_15_16,
 165
 166         /* Threshold for errors in pattern data  */
 167         COMRXEQ_CSR_DLEV_ERR_THRESH,
 168
 169         /* COMRXEQ control 25 */
 170         COMRXEQ_CTRL_25,
 171
 172         /* Mid-speed rate change calibration control */
 173         CSR_RXEQ_RATE_CHANGE_CAL_RUN_RATE2_O,
 174
 175         /* High-speed rate change calibration control */
 176         COMRXEQ_HS_RCHANGE_CTRL_7_0,
 177
 178         /* Serdes reset */
 179         POR_EN,
 180
 181         /* Tx Enable Value */
 182         TX0_ENABLE,
 183
 184         /* Rx Enable Value */
 185         RX0_ENABLE,
 186
 187         /* PLL Enable Value */
 188         PLL_ENABLE,
 189
 190         /* PLL ready for use */
 191         PLL_OK,
 192
 193         /* sentinel */
 194         MAX_FIELDS
 195
 196 };
 197
 198 static const struct reg_field serdes_am654_reg_fields[] = {
 199         [CMU_PLL_CTRL]                  = REG_FIELD(CMU_R004, 8, 15),
 200         [AHB_PMA_CM_VCO_VBIAS_VREG]     = REG_FIELD(CMU_R060, 8, 15),
 201         [CMU_MASTER_CDN]                = REG_FIELD(CMU_R07C, 24, 31),
 202         [AHB_PMA_CM_VCO_BIAS_VREG]      = REG_FIELD(CMU_R088, 24, 31),
 203         [AHB_PMA_CM_SR]                 = REG_FIELD(CMU_R0D0, 24, 31),
 204         [AHB_SSC_GEN_Z_O_20_13]         = REG_FIELD(CMU_R0E8, 8, 15),
 205         [LANE_PLL_CTRL_RXEQ_RXIDLE]     = REG_FIELD(LANE_R048, 8, 15),
 206         [AHB_PMA_LN_AGC_THSEL_VREGH]    = REG_FIELD(LANE_R058, 16, 23),
 207         [AHB_PMA_LN_GEN3_AGC_SD_THSEL]  = REG_FIELD(LANE_R06c, 0, 7),
 208         [AHB_PMA_LN_RX_SELR_GEN3]       = REG_FIELD(LANE_R070, 16, 23),
 209         [AHB_PMA_LN_TX_DRV]             = REG_FIELD(LANE_R19C, 16, 23),
 210         [P2S_RBUF_PTR_DIFF]             = REG_FIELD(COMLANE_R004, 0, 7),
 211         [CONFIG_VERSION]                = REG_FIELD(COMLANE_R138, 16, 23),
 212         [L1_MASTER_CDN]                 = REG_FIELD(COMLANE_R190, 8, 15),
 213         [CMU_OK_I_0]                    = REG_FIELD(COMLANE_R194, 19, 19),
 214         [COMRXEQ_MS_INIT_CTRL_7_0]      = REG_FIELD(COMRXEQ_R004, 24, 31),
 215         [COMRXEQ_HS_INIT_CAL_7_0]       = REG_FIELD(COMRXEQ_R008, 0, 7),
 216         [COMRXEQ_MS_RECAL_CTRL_7_0]     = REG_FIELD(COMRXEQ_R00C, 8, 15),
 217         [COMRXEQ_HS_RECAL_CTRL_7_0]     = REG_FIELD(COMRXEQ_R00C, 16, 23),
 218         [COMRXEQ_CSR_ATT_CONFIG]        = REG_FIELD(COMRXEQ_R014, 16, 23),
 219         [COMRXEQ_CSR_EBSTADAPT_WIN_LEN] = REG_FIELD(COMRXEQ_R018, 16, 23),
 220         [COMRXEQ_CTRL_3_4]              = REG_FIELD(COMRXEQ_R01C, 8, 15),
 221         [COMRXEQ_CTRL_14_15_16]         = REG_FIELD(COMRXEQ_R04C, 0, 7),
 222         [COMRXEQ_CSR_DLEV_ERR_THRESH]   = REG_FIELD(COMRXEQ_R088, 16, 23),
 223         [COMRXEQ_CTRL_25]               = REG_FIELD(COMRXEQ_R094, 24, 31),
 224         [CSR_RXEQ_RATE_CHANGE_CAL_RUN_RATE2_O] = REG_FIELD(COMRXEQ_R098, 8, 15),
 225         [COMRXEQ_HS_RCHANGE_CTRL_7_0]   = REG_FIELD(COMRXEQ_R098, 16, 23),
 226         [POR_EN]                        = REG_FIELD(SERDES_CTRL, 29, 29),
 227         [TX0_ENABLE]                    = REG_FIELD(WIZ_LANEXCTL_STS, 29, 31),
 228         [RX0_ENABLE]                    = REG_FIELD(WIZ_LANEXCTL_STS, 13, 15),
 229         [PLL_ENABLE]                    = REG_FIELD(WIZ_PLL_CTRL, 29, 31),
 230         [PLL_OK]                        = REG_FIELD(WIZ_PLL_CTRL, 28, 28),
 231 };
 232
 233 struct serdes_am654 {
 234         struct regmap           *regmap;
 235         struct regmap_field     *fields[MAX_FIELDS];
 236
 237         struct device           *dev;
 238         struct mux_control      *control;
 239         bool                    busy;
 240         u32                     type;
 241         struct device_node      *of_node;
 242         struct clk_onecell_data clk_data;
 243         struct clk              *clks[SERDES_NUM_CLOCKS];
 244 };
 245
 246 static int serdes_am654_enable_pll(struct serdes_am654 *phy)
 247 {
 248         int ret;
 249         u32 val;
 250
 251         ret = regmap_field_write(phy->fields[PLL_ENABLE], PLL_ENABLE_STATE);
 252         if (ret)
 253                 return ret;
 254
 255         return regmap_field_read_poll_timeout(phy->fields[PLL_OK], val, val,
 256                                               1000, PLL_LOCK_TIME);
 257 }
 258
 259 static void serdes_am654_disable_pll(struct serdes_am654 *phy)
 260 {
 261         struct device *dev = phy->dev;
 262         int ret;
 263
 264         ret = regmap_field_write(phy->fields[PLL_ENABLE], PLL_DISABLE_STATE);
 265         if (ret)
 266                 dev_err(dev, "Failed to disable PLL\n");
 267 }
 268
 269 static int serdes_am654_enable_txrx(struct serdes_am654 *phy)
 270 {
 271         int ret = 0;
 272
 273         /* Enable TX */
 274         ret |= regmap_field_write(phy->fields[TX0_ENABLE], TX0_ENABLE_STATE);
 275
 276         /* Enable RX */
 277         ret |= regmap_field_write(phy->fields[RX0_ENABLE], RX0_ENABLE_STATE);
 278
 279         if (ret)
 280                 return -EIO;
 281
 282         return 0;
 283 }
 284
 285 static int serdes_am654_disable_txrx(struct serdes_am654 *phy)
 286 {
 287         int ret = 0;
 288
 289         /* Disable TX */
 290         ret |= regmap_field_write(phy->fields[TX0_ENABLE], TX0_DISABLE_STATE);
 291
 292         /* Disable RX */
 293         ret |= regmap_field_write(phy->fields[RX0_ENABLE], RX0_DISABLE_STATE);
 294
 295         if (ret)
 296                 return -EIO;
 297
 298         return 0;
 299 }
 300
 301 static int serdes_am654_power_on(struct phy *x)
 302 {
 303         struct serdes_am654 *phy = phy_get_drvdata(x);
 304         struct device *dev = phy->dev;
 305         int ret;
 306         u32 val;
 307
 308         ret = serdes_am654_enable_pll(phy);
 309         if (ret) {
 310                 dev_err(dev, "Failed to enable PLL\n");
 311                 return ret;
 312         }
 313
 314         ret = serdes_am654_enable_txrx(phy);
 315         if (ret) {
 316                 dev_err(dev, "Failed to enable TX RX\n");
 317                 return ret;
 318         }
 319
 320         return regmap_field_read_poll_timeout(phy->fields[CMU_OK_I_0], val,
 321                                               val, SLEEP_TIME, PLL_LOCK_TIME);
 322 }
 323
 324 static int serdes_am654_power_off(struct phy *x)
 325 {
 326         struct serdes_am654 *phy = phy_get_drvdata(x);
 327
 328         serdes_am654_disable_txrx(phy);
 329         serdes_am654_disable_pll(phy);
 330
 331         return 0;
 332 }
 333
 334 #define SERDES_AM654_CFG(offset, a, b, val) \
 335         regmap_update_bits(phy->regmap, (offset),\
 336                            GENMASK((a), (b)), (val) << (b))
 337
 338 static int serdes_am654_usb3_init(struct serdes_am654 *phy)
 339 {
 340         SERDES_AM654_CFG(0x0000, 31, 24, 0x17);
 341         SERDES_AM654_CFG(0x0004, 15, 8, 0x02);
 342         SERDES_AM654_CFG(0x0004, 7, 0, 0x0e);
 343         SERDES_AM654_CFG(0x0008, 23, 16, 0x2e);
 344         SERDES_AM654_CFG(0x0008, 31, 24, 0x2e);
 345         SERDES_AM654_CFG(0x0060, 7, 0, 0x4b);
 346         SERDES_AM654_CFG(0x0060, 15, 8, 0x98);
 347         SERDES_AM654_CFG(0x0060, 23, 16, 0x60);
 348         SERDES_AM654_CFG(0x00d0, 31, 24, 0x45);
 349         SERDES_AM654_CFG(0x00e8, 15, 8, 0x0e);
 350         SERDES_AM654_CFG(0x0220, 7, 0, 0x34);
 351         SERDES_AM654_CFG(0x0220, 15, 8, 0x34);
 352         SERDES_AM654_CFG(0x0220, 31, 24, 0x37);
 353         SERDES_AM654_CFG(0x0224, 7, 0, 0x37);
 354         SERDES_AM654_CFG(0x0224, 15, 8, 0x37);
 355         SERDES_AM654_CFG(0x0228, 23, 16, 0x37);
 356         SERDES_AM654_CFG(0x0228, 31, 24, 0x37);
 357         SERDES_AM654_CFG(0x022c, 7, 0, 0x37);
 358         SERDES_AM654_CFG(0x022c, 15, 8, 0x37);
 359         SERDES_AM654_CFG(0x0230, 15, 8, 0x2a);
 360         SERDES_AM654_CFG(0x0230, 23, 16, 0x2a);
 361         SERDES_AM654_CFG(0x0240, 23, 16, 0x10);
 362         SERDES_AM654_CFG(0x0240, 31, 24, 0x34);
 363         SERDES_AM654_CFG(0x0244, 7, 0, 0x40);
 364         SERDES_AM654_CFG(0x0244, 23, 16, 0x34);
 365         SERDES_AM654_CFG(0x0248, 15, 8, 0x0d);
 366         SERDES_AM654_CFG(0x0258, 15, 8, 0x16);
 367         SERDES_AM654_CFG(0x0258, 23, 16, 0x84);
 368         SERDES_AM654_CFG(0x0258, 31, 24, 0xf2);
 369         SERDES_AM654_CFG(0x025c, 7, 0, 0x21);
 370         SERDES_AM654_CFG(0x0260, 7, 0, 0x27);
 371         SERDES_AM654_CFG(0x0260, 15, 8, 0x04);
 372         SERDES_AM654_CFG(0x0268, 15, 8, 0x04);
 373         SERDES_AM654_CFG(0x0288, 15, 8, 0x2c);
 374         SERDES_AM654_CFG(0x0330, 31, 24, 0xa0);
 375         SERDES_AM654_CFG(0x0338, 23, 16, 0x03);
 376         SERDES_AM654_CFG(0x0338, 31, 24, 0x00);
 377         SERDES_AM654_CFG(0x033c, 7, 0, 0x00);
 378         SERDES_AM654_CFG(0x0344, 31, 24, 0x18);
 379         SERDES_AM654_CFG(0x034c, 7, 0, 0x18);
 380         SERDES_AM654_CFG(0x039c, 23, 16, 0x3b);
 381         SERDES_AM654_CFG(0x0a04, 7, 0, 0x03);
 382         SERDES_AM654_CFG(0x0a14, 31, 24, 0x3c);
 383         SERDES_AM654_CFG(0x0a18, 15, 8, 0x3c);
 384         SERDES_AM654_CFG(0x0a38, 7, 0, 0x3e);
 385         SERDES_AM654_CFG(0x0a38, 15, 8, 0x3e);
 386         SERDES_AM654_CFG(0x0ae0, 7, 0, 0x07);
 387         SERDES_AM654_CFG(0x0b6c, 23, 16, 0xcd);
 388         SERDES_AM654_CFG(0x0b6c, 31, 24, 0x04);
 389         SERDES_AM654_CFG(0x0b98, 23, 16, 0x03);
 390         SERDES_AM654_CFG(0x1400, 7, 0, 0x3f);
 391         SERDES_AM654_CFG(0x1404, 23, 16, 0x6f);
 392         SERDES_AM654_CFG(0x1404, 31, 24, 0x6f);
 393         SERDES_AM654_CFG(0x140c, 7, 0, 0x6f);
 394         SERDES_AM654_CFG(0x140c, 15, 8, 0x6f);
 395         SERDES_AM654_CFG(0x1410, 15, 8, 0x27);
 396         SERDES_AM654_CFG(0x1414, 7, 0, 0x0c);
 397         SERDES_AM654_CFG(0x1414, 23, 16, 0x07);
 398         SERDES_AM654_CFG(0x1418, 23, 16, 0x40);
 399         SERDES_AM654_CFG(0x141c, 7, 0, 0x00);
 400         SERDES_AM654_CFG(0x141c, 15, 8, 0x1f);
 401         SERDES_AM654_CFG(0x1428, 31, 24, 0x08);
 402         SERDES_AM654_CFG(0x1434, 31, 24, 0x00);
 403         SERDES_AM654_CFG(0x1444, 7, 0, 0x94);
 404         SERDES_AM654_CFG(0x1460, 31, 24, 0x7f);
 405         SERDES_AM654_CFG(0x1464, 7, 0, 0x43);
 406         SERDES_AM654_CFG(0x1464, 23, 16, 0x6f);
 407         SERDES_AM654_CFG(0x1464, 31, 24, 0x43);
 408         SERDES_AM654_CFG(0x1484, 23, 16, 0x8f);
 409         SERDES_AM654_CFG(0x1498, 7, 0, 0x4f);
 410         SERDES_AM654_CFG(0x1498, 23, 16, 0x4f);
 411         SERDES_AM654_CFG(0x007c, 31, 24, 0x0d);
 412         SERDES_AM654_CFG(0x0b90, 15, 8, 0x0f);
 413
 414         return 0;
 415 }
 416
 417 static int serdes_am654_pcie_init(struct serdes_am654 *phy)
 418 {
 419         int ret = 0;
 420
 421         ret |= regmap_field_write(phy->fields[CMU_PLL_CTRL], 0x2);
 422         ret |= regmap_field_write(phy->fields[AHB_PMA_CM_VCO_VBIAS_VREG], 0x98);
 423         ret |= regmap_field_write(phy->fields[AHB_PMA_CM_VCO_BIAS_VREG], 0x98);
 424         ret |= regmap_field_write(phy->fields[AHB_PMA_CM_SR], 0x45);
 425         ret |= regmap_field_write(phy->fields[AHB_SSC_GEN_Z_O_20_13], 0xe);
 426         ret |= regmap_field_write(phy->fields[LANE_PLL_CTRL_RXEQ_RXIDLE], 0x5);
 427         ret |= regmap_field_write(phy->fields[AHB_PMA_LN_AGC_THSEL_VREGH], 0x83);
 428         ret |= regmap_field_write(phy->fields[AHB_PMA_LN_GEN3_AGC_SD_THSEL], 0x83);
 429         ret |= regmap_field_write(phy->fields[AHB_PMA_LN_RX_SELR_GEN3], 0x81);
 430         ret |= regmap_field_write(phy->fields[AHB_PMA_LN_TX_DRV], 0x3b);
 431         ret |= regmap_field_write(phy->fields[P2S_RBUF_PTR_DIFF], 0x3);
 432         ret |= regmap_field_write(phy->fields[CONFIG_VERSION], VERSION_VAL);
 433         ret |= regmap_field_write(phy->fields[COMRXEQ_MS_INIT_CTRL_7_0], 0xf);
 434         ret |= regmap_field_write(phy->fields[COMRXEQ_HS_INIT_CAL_7_0], 0x4f);
 435         ret |= regmap_field_write(phy->fields[COMRXEQ_MS_RECAL_CTRL_7_0], 0xf);
 436         ret |= regmap_field_write(phy->fields[COMRXEQ_HS_RECAL_CTRL_7_0], 0x4f);
 437         ret |= regmap_field_write(phy->fields[COMRXEQ_CSR_ATT_CONFIG], 0x7);
 438         ret |= regmap_field_write(phy->fields[COMRXEQ_CSR_EBSTADAPT_WIN_LEN], 0x7f);
 439         ret |= regmap_field_write(phy->fields[COMRXEQ_CTRL_3_4], 0xf);
 440         ret |= regmap_field_write(phy->fields[COMRXEQ_CTRL_14_15_16], 0x9a);
 441         ret |= regmap_field_write(phy->fields[COMRXEQ_CSR_DLEV_ERR_THRESH], 0x32);
 442         ret |= regmap_field_write(phy->fields[COMRXEQ_CTRL_25], 0x80);
 443         ret |= regmap_field_write(phy->fields[CSR_RXEQ_RATE_CHANGE_CAL_RUN_RATE2_O], 0xf);
 444         ret |= regmap_field_write(phy->fields[COMRXEQ_HS_RCHANGE_CTRL_7_0], 0x4f);
 445         ret |= regmap_field_write(phy->fields[CMU_MASTER_CDN], 0x1);
 446         ret |= regmap_field_write(phy->fields[L1_MASTER_CDN], 0x2);
 447
 448         if (ret)
 449                 return -EIO;
 450
 451         return 0;
 452 }
 453
 454 static int serdes_am654_init(struct phy *x)
 455 {
 456         struct serdes_am654 *phy = phy_get_drvdata(x);
 457
 458         switch (phy->type) {
 459         case PHY_TYPE_PCIE:
 460                 return serdes_am654_pcie_init(phy);
 461         case PHY_TYPE_USB3:
 462                 return serdes_am654_usb3_init(phy);
 463         default:
 464                 return -EINVAL;
 465         }
 466 }
 467
 468 static int serdes_am654_reset(struct phy *x)
 469 {
 470         struct serdes_am654 *phy = phy_get_drvdata(x);
 471         int ret = 0;
 472
 473         serdes_am654_disable_pll(phy);
 474         serdes_am654_disable_txrx(phy);
 475
 476         ret |= regmap_field_write(phy->fields[POR_EN], 0x1);
 477
 478         mdelay(1);
 479
 480         ret |= regmap_field_write(phy->fields[POR_EN], 0x0);
 481
 482         if (ret)
 483                 return -EIO;
 484
 485         return 0;
 486 }
 487
 488 static void serdes_am654_release(struct phy *x)
 489 {
 490         struct serdes_am654 *phy = phy_get_drvdata(x);
 491
 492         phy->type = PHY_NONE;
 493         phy->busy = false;
 494         mux_control_deselect(phy->control);
 495 }
 496
 497 static struct phy *serdes_am654_xlate(struct device *dev,
 498                                       struct of_phandle_args *args)
 499 {
 500         struct serdes_am654 *am654_phy;
 501         struct phy *phy;
 502         int ret;
 503
 504         phy = of_phy_simple_xlate(dev, args);
 505         if (IS_ERR(phy))
 506                 return phy;
 507
 508         am654_phy = phy_get_drvdata(phy);
 509         if (am654_phy->busy)
 510                 return ERR_PTR(-EBUSY);
 511
 512         ret = mux_control_select(am654_phy->control, args->args[1]);
 513         if (ret) {
 514                 dev_err(dev, "Failed to select SERDES Lane Function\n");
 515                 return ERR_PTR(ret);
 516         }
 517
 518         am654_phy->busy = true;
 519         am654_phy->type = args->args[0];
 520
 521         return phy;
 522 }
 523
 524 static const struct phy_ops ops = {
 525         .reset          = serdes_am654_reset,
 526         .init           = serdes_am654_init,
 527         .power_on       = serdes_am654_power_on,
 528         .power_off      = serdes_am654_power_off,
 529         .release        = serdes_am654_release,
 530         .owner          = THIS_MODULE,
 531 };
 532
 533 #define SERDES_NUM_MUX_COMBINATIONS 16
 534
 535 #define LICLK 0
 536 #define EXT_REFCLK 1
 537 #define RICLK 2
 538
 539 static const int
 540 serdes_am654_mux_table[SERDES_NUM_MUX_COMBINATIONS][SERDES_NUM_CLOCKS] = {
 541         /*
 542          * Each combination maps to one of
 543          * "Figure 12-1986. SerDes Reference Clock Distribution"
 544          * in TRM.
 545          */
 546          /* Parent of CMU refclk, Left output, Right output
 547           * either of EXT_REFCLK, LICLK, RICLK
 548           */
 549         { EXT_REFCLK, EXT_REFCLK, EXT_REFCLK }, /* 0000 */
 550         { RICLK, EXT_REFCLK, EXT_REFCLK },      /* 0001 */
 551         { EXT_REFCLK, RICLK, LICLK },           /* 0010 */
 552         { RICLK, RICLK, EXT_REFCLK },           /* 0011 */
 553         { LICLK, EXT_REFCLK, EXT_REFCLK },      /* 0100 */
 554         { EXT_REFCLK, EXT_REFCLK, EXT_REFCLK }, /* 0101 */
 555         { LICLK, RICLK, LICLK },                /* 0110 */
 556         { EXT_REFCLK, RICLK, LICLK },           /* 0111 */
 557         { EXT_REFCLK, EXT_REFCLK, LICLK },      /* 1000 */
 558         { RICLK, EXT_REFCLK, LICLK },           /* 1001 */
 559         { EXT_REFCLK, RICLK, EXT_REFCLK },      /* 1010 */
 560         { RICLK, RICLK, EXT_REFCLK },           /* 1011 */
 561         { LICLK, EXT_REFCLK, LICLK },           /* 1100 */
 562         { EXT_REFCLK, EXT_REFCLK, LICLK },      /* 1101 */
 563         { LICLK, RICLK, EXT_REFCLK },           /* 1110 */
 564         { EXT_REFCLK, RICLK, EXT_REFCLK },      /* 1111 */
 565 };
 566
 567 static u8 serdes_am654_clk_mux_get_parent(struct clk_hw *hw)
 568 {
 569         struct serdes_am654_clk_mux *mux = to_serdes_am654_clk_mux(hw);
 570         struct regmap *regmap = mux->regmap;
 571         unsigned int reg = mux->reg;
 572         unsigned int val;
 573
 574         regmap_read(regmap, reg, &val);
 575         val &= AM654_SERDES_CTRL_CLKSEL_MASK;
 576         val >>= AM654_SERDES_CTRL_CLKSEL_SHIFT;
 577
 578         return serdes_am654_mux_table[val][mux->clk_id];
 579 }
 580
 581 static int serdes_am654_clk_mux_set_parent(struct clk_hw *hw, u8 index)
 582 {
 583         struct serdes_am654_clk_mux *mux = to_serdes_am654_clk_mux(hw);
 584         struct regmap *regmap = mux->regmap;
 585         const char *name = clk_hw_get_name(hw);
 586         unsigned int reg = mux->reg;
 587         int clk_id = mux->clk_id;
 588         int parents[SERDES_NUM_CLOCKS];
 589         const int *p;
 590         u32 val;
 591         int found, i;
 592         int ret;
 593
 594         /* get existing setting */
 595         regmap_read(regmap, reg, &val);
 596         val &= AM654_SERDES_CTRL_CLKSEL_MASK;
 597         val >>= AM654_SERDES_CTRL_CLKSEL_SHIFT;
 598
 599         for (i = 0; i < SERDES_NUM_CLOCKS; i++)
 600                 parents[i] = serdes_am654_mux_table[val][i];
 601
 602         /* change parent of this clock. others left intact */
 603         parents[clk_id] = index;
 604
 605         /* Find the match */
 606         for (val = 0; val < SERDES_NUM_MUX_COMBINATIONS; val++) {
 607                 p = serdes_am654_mux_table[val];
 608                 found = 1;
 609                 for (i = 0; i < SERDES_NUM_CLOCKS; i++) {
 610                         if (parents[i] != p[i]) {
 611                                 found = 0;
 612                                 break;
 613                         }
 614                 }
 615
 616                 if (found)
 617                         break;
 618         }
 619
 620         if (!found) {
 621                 /*
 622                  * This can never happen, unless we missed
 623                  * a valid combination in serdes_am654_mux_table.
 624                  */
 625                 WARN(1, "Failed to find the parent of %s clock\n", name);
 626                 return -EINVAL;
 627         }
 628
 629         val <<= AM654_SERDES_CTRL_CLKSEL_SHIFT;
 630         ret = regmap_update_bits(regmap, reg, AM654_SERDES_CTRL_CLKSEL_MASK,
 631                                  val);
 632
 633         return ret;
 634 }
 635
 636 static const struct clk_ops serdes_am654_clk_mux_ops = {
 637         .set_parent = serdes_am654_clk_mux_set_parent,
 638         .get_parent = serdes_am654_clk_mux_get_parent,
 639 };
 640
 641 static int serdes_am654_clk_register(struct serdes_am654 *am654_phy,
 642                                      const char *clock_name, int clock_num)
 643 {
 644         struct device_node *node = am654_phy->of_node;
 645         struct device *dev = am654_phy->dev;
 646         struct serdes_am654_clk_mux *mux;
 647         struct device_node *regmap_node;
 648         const char **parent_names;
 649         struct clk_init_data *init;
 650         unsigned int num_parents;
 651         struct regmap *regmap;
 652         const __be32 *addr;
 653         unsigned int reg;
 654         struct clk *clk;
 655         int ret = 0;
 656
 657         mux = devm_kzalloc(dev, sizeof(*mux), GFP_KERNEL);
 658         if (!mux)
 659                 return -ENOMEM;
 660
 661         init = &mux->clk_data;
 662
 663         regmap_node = of_parse_phandle(node, "ti,serdes-clk", 0);
 664         if (!regmap_node) {
 665                 dev_err(dev, "Fail to get serdes-clk node\n");
 666                 ret = -ENODEV;
 667                 goto out_put_node;
 668         }
 669
 670         regmap = syscon_node_to_regmap(regmap_node->parent);
 671         if (IS_ERR(regmap)) {
 672                 dev_err(dev, "Fail to get Syscon regmap\n");
 673                 ret = PTR_ERR(regmap);
 674                 goto out_put_node;
 675         }
 676
 677         num_parents = of_clk_get_parent_count(node);
 678         if (num_parents < 2) {
 679                 dev_err(dev, "SERDES clock must have parents\n");
 680                 ret = -EINVAL;
 681                 goto out_put_node;
 682         }
 683
 684         parent_names = devm_kzalloc(dev, (sizeof(char *) * num_parents),
 685                                     GFP_KERNEL);
 686         if (!parent_names) {
 687                 ret = -ENOMEM;
 688                 goto out_put_node;
 689         }
 690
 691         of_clk_parent_fill(node, parent_names, num_parents);
 692
 693         addr = of_get_address(regmap_node, 0, NULL, NULL);
 694         if (!addr) {
 695                 ret = -EINVAL;
 696                 goto out_put_node;
 697         }
 698
 699         reg = be32_to_cpu(*addr);
 700
 701         init->ops = &serdes_am654_clk_mux_ops;
 702         init->flags = CLK_SET_RATE_NO_REPARENT;
 703         init->parent_names = parent_names;
 704         init->num_parents = num_parents;
 705         init->name = clock_name;
 706
 707         mux->regmap = regmap;
 708         mux->reg = reg;
 709         mux->clk_id = clock_num;
 710         mux->hw.init = init;
 711
 712         clk = devm_clk_register(dev, &mux->hw);
 713         if (IS_ERR(clk)) {
 714                 ret = PTR_ERR(clk);
 715                 goto out_put_node;
 716         }
 717
 718         am654_phy->clks[clock_num] = clk;
 719
 720 out_put_node:
 721         of_node_put(regmap_node);
 722         return ret;
 723 }
 724
 725 static const struct of_device_id serdes_am654_id_table[] = {
 726         {
 727                 .compatible = "ti,phy-am654-serdes",
 728         },
 729         {}
 730 };
 731 MODULE_DEVICE_TABLE(of, serdes_am654_id_table);
 732
 733 static int serdes_am654_regfield_init(struct serdes_am654 *am654_phy)
 734 {
 735         struct regmap *regmap = am654_phy->regmap;
 736         struct device *dev = am654_phy->dev;
 737         int i;
 738
 739         for (i = 0; i < MAX_FIELDS; i++) {
 740                 am654_phy->fields[i] = devm_regmap_field_alloc(dev,
 741                                                                regmap,
 742                                                                serdes_am654_reg_fields[i]);
 743                 if (IS_ERR(am654_phy->fields[i])) {
 744                         dev_err(dev, "Unable to allocate regmap field %d\n", i);
 745                         return PTR_ERR(am654_phy->fields[i]);
 746                 }
 747         }
 748
 749         return 0;
 750 }
 751
 752 static int serdes_am654_probe(struct platform_device *pdev)
 753 {
 754         struct phy_provider *phy_provider;
 755         struct device *dev = &pdev->dev;
 756         struct device_node *node = dev->of_node;
 757         struct clk_onecell_data *clk_data;
 758         struct serdes_am654 *am654_phy;
 759         struct mux_control *control;
 760         const char *clock_name;
 761         struct regmap *regmap;
 762         void __iomem *base;
 763         struct phy *phy;
 764         int ret;
 765         int i;
 766
 767         am654_phy = devm_kzalloc(dev, sizeof(*am654_phy), GFP_KERNEL);
 768         if (!am654_phy)
 769                 return -ENOMEM;
 770
 771         base = devm_platform_ioremap_resource(pdev, 0);
 772         if (IS_ERR(base))
 773                 return PTR_ERR(base);
 774
 775         regmap = devm_regmap_init_mmio(dev, base, &serdes_am654_regmap_config);
 776         if (IS_ERR(regmap)) {
 777                 dev_err(dev, "Failed to initialize regmap\n");
 778                 return PTR_ERR(regmap);
 779         }
 780
 781         control = devm_mux_control_get(dev, NULL);
 782         if (IS_ERR(control))
 783                 return PTR_ERR(control);
 784
 785         am654_phy->dev = dev;
 786         am654_phy->of_node = node;
 787         am654_phy->regmap = regmap;
 788         am654_phy->control = control;
 789         am654_phy->type = PHY_NONE;
 790
 791         ret = serdes_am654_regfield_init(am654_phy);
 792         if (ret) {
 793                 dev_err(dev, "Failed to initialize regfields\n");
 794                 return ret;
 795         }
 796
 797         platform_set_drvdata(pdev, am654_phy);
 798
 799         for (i = 0; i < SERDES_NUM_CLOCKS; i++) {
 800                 ret = of_property_read_string_index(node, "clock-output-names",
 801                                                     i, &clock_name);
 802                 if (ret) {
 803                         dev_err(dev, "Failed to get clock name\n");
 804                         return ret;
 805                 }
 806
 807                 ret = serdes_am654_clk_register(am654_phy, clock_name, i);
 808                 if (ret) {
 809                         dev_err(dev, "Failed to initialize clock %s\n",
 810                                 clock_name);
 811                         return ret;
 812                 }
 813         }
 814
 815         clk_data = &am654_phy->clk_data;
 816         clk_data->clks = am654_phy->clks;
 817         clk_data->clk_num = SERDES_NUM_CLOCKS;
 818         ret = of_clk_add_provider(node, of_clk_src_onecell_get, clk_data);
 819         if (ret)
 820                 return ret;
 821
 822         pm_runtime_enable(dev);
 823
 824         phy = devm_phy_create(dev, NULL, &ops);
 825         if (IS_ERR(phy)) {
 826                 ret = PTR_ERR(phy);
 827                 goto clk_err;
 828         }
 829
 830         phy_set_drvdata(phy, am654_phy);
 831         phy_provider = devm_of_phy_provider_register(dev, serdes_am654_xlate);
 832         if (IS_ERR(phy_provider)) {
 833                 ret = PTR_ERR(phy_provider);
 834                 goto clk_err;
 835         }
 836
 837         return 0;
 838
 839 clk_err:
 840         of_clk_del_provider(node);
 841
 842         return ret;
 843 }
 844
 845 static int serdes_am654_remove(struct platform_device *pdev)
 846 {
 847         struct serdes_am654 *am654_phy = platform_get_drvdata(pdev);
 848         struct device_node *node = am654_phy->of_node;
 849
 850         pm_runtime_disable(&pdev->dev);
 851         of_clk_del_provider(node);
 852
 853         return 0;
 854 }
 855
 856 static struct platform_driver serdes_am654_driver = {
 857         .probe          = serdes_am654_probe,
 858         .remove         = serdes_am654_remove,
 859         .driver         = {
 860                 .name   = "phy-am654",
 861                 .of_match_table = serdes_am654_id_table,
 862         },
 863 };
 864 module_platform_driver(serdes_am654_driver);
 865
 866 MODULE_AUTHOR("Texas Instruments Inc.");
 867 MODULE_DESCRIPTION("TI AM654x SERDES driver");
 868 MODULE_LICENSE("GPL v2");