drivers/usb/dwc3/dwc3-meson-g12a.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /*
   3  * USB Glue for Amlogic G12A SoCs
   4  *
   5  * Copyright (c) 2019 BayLibre, SAS
   6  * Author: Neil Armstrong <narmstrong@baylibre.com>
   7  */
   8
   9 /*
  10  * The USB is organized with a glue around the DWC3 Controller IP as :
  11  * - Control registers for each USB2 Ports
  12  * - Control registers for the USB PHY layer
  13  * - SuperSpeed PHY can be enabled only if port is used
  14  * - Dynamic OTG switching with ID change interrupt
  15  */
  16
  17 #include <linux/module.h>
  18 #include <linux/kernel.h>
  19 #include <linux/platform_device.h>
  20 #include <linux/clk.h>
  21 #include <linux/of.h>
  22 #include <linux/of_platform.h>
  23 #include <linux/pm_runtime.h>
  24 #include <linux/regmap.h>
  25 #include <linux/bitfield.h>
  26 #include <linux/bitops.h>
  27 #include <linux/reset.h>
  28 #include <linux/phy/phy.h>
  29 #include <linux/usb/otg.h>
  30 #include <linux/usb/role.h>
  31 #include <linux/regulator/consumer.h>
  32
  33 /* USB2 Ports Control Registers, offsets are per-port */
  34
  35 #define U2P_REG_SIZE                                            0x20
  36
  37 #define U2P_R0                                                  0x0
  38         #define U2P_R0_HOST_DEVICE                              BIT(0)
  39         #define U2P_R0_POWER_OK                                 BIT(1)
  40         #define U2P_R0_HAST_MODE                                BIT(2)
  41         #define U2P_R0_POWER_ON_RESET                           BIT(3)
  42         #define U2P_R0_ID_PULLUP                                BIT(4)
  43         #define U2P_R0_DRV_VBUS                                 BIT(5)
  44
  45 #define U2P_R1                                                  0x4
  46         #define U2P_R1_PHY_READY                                BIT(0)
  47         #define U2P_R1_ID_DIG                                   BIT(1)
  48         #define U2P_R1_OTG_SESSION_VALID                        BIT(2)
  49         #define U2P_R1_VBUS_VALID                               BIT(3)
  50
  51 /* USB Glue Control Registers */
  52
  53 #define G12A_GLUE_OFFSET                                        0x80
  54
  55 #define USB_R0                                                  0x00
  56         #define USB_R0_P30_LANE0_TX2RX_LOOPBACK                 BIT(17)
  57         #define USB_R0_P30_LANE0_EXT_PCLK_REQ                   BIT(18)
  58         #define USB_R0_P30_PCS_RX_LOS_MASK_VAL_MASK             GENMASK(28, 19)
  59         #define USB_R0_U2D_SS_SCALEDOWN_MODE_MASK               GENMASK(30, 29)
  60         #define USB_R0_U2D_ACT                                  BIT(31)
  61
  62 #define USB_R1                                                  0x04
  63         #define USB_R1_U3H_BIGENDIAN_GS                         BIT(0)
  64         #define USB_R1_U3H_PME_ENABLE                           BIT(1)
  65         #define USB_R1_U3H_HUB_PORT_OVERCURRENT_MASK            GENMASK(4, 2)
  66         #define USB_R1_U3H_HUB_PORT_PERM_ATTACH_MASK            GENMASK(9, 7)
  67         #define USB_R1_U3H_HOST_U2_PORT_DISABLE_MASK            GENMASK(13, 12)
  68         #define USB_R1_U3H_HOST_U3_PORT_DISABLE                 BIT(16)
  69         #define USB_R1_U3H_HOST_PORT_POWER_CONTROL_PRESENT      BIT(17)
  70         #define USB_R1_U3H_HOST_MSI_ENABLE                      BIT(18)
  71         #define USB_R1_U3H_FLADJ_30MHZ_REG_MASK                 GENMASK(24, 19)
  72         #define USB_R1_P30_PCS_TX_SWING_FULL_MASK               GENMASK(31, 25)
  73
  74 #define USB_R2                                                  0x08
  75         #define USB_R2_P30_PCS_TX_DEEMPH_3P5DB_MASK             GENMASK(25, 20)
  76         #define USB_R2_P30_PCS_TX_DEEMPH_6DB_MASK               GENMASK(31, 26)
  77
  78 #define USB_R3                                                  0x0c
  79         #define USB_R3_P30_SSC_ENABLE                           BIT(0)
  80         #define USB_R3_P30_SSC_RANGE_MASK                       GENMASK(3, 1)
  81         #define USB_R3_P30_SSC_REF_CLK_SEL_MASK                 GENMASK(12, 4)
  82         #define USB_R3_P30_REF_SSP_EN                           BIT(13)
  83
  84 #define USB_R4                                                  0x10
  85         #define USB_R4_P21_PORT_RESET_0                         BIT(0)
  86         #define USB_R4_P21_SLEEP_M0                             BIT(1)
  87         #define USB_R4_MEM_PD_MASK                              GENMASK(3, 2)
  88         #define USB_R4_P21_ONLY                                 BIT(4)
  89
  90 #define USB_R5                                                  0x14
  91         #define USB_R5_ID_DIG_SYNC                              BIT(0)
  92         #define USB_R5_ID_DIG_REG                               BIT(1)
  93         #define USB_R5_ID_DIG_CFG_MASK                          GENMASK(3, 2)
  94         #define USB_R5_ID_DIG_EN_0                              BIT(4)
  95         #define USB_R5_ID_DIG_EN_1                              BIT(5)
  96         #define USB_R5_ID_DIG_CURR                              BIT(6)
  97         #define USB_R5_ID_DIG_IRQ                               BIT(7)
  98         #define USB_R5_ID_DIG_TH_MASK                           GENMASK(15, 8)
  99         #define USB_R5_ID_DIG_CNT_MASK                          GENMASK(23, 16)
 100
 101 #define PHY_COUNT                                               3
 102 #define USB2_OTG_PHY                                            1
 103
 104 static struct clk_bulk_data meson_gxl_clocks[] = {
 105         { .id = "usb_ctrl" },
 106         { .id = "ddr" },
 107 };
 108
 109 static struct clk_bulk_data meson_g12a_clocks[] = {
 110         { .id = NULL },
 111 };
 112
 113 static struct clk_bulk_data meson_a1_clocks[] = {
 114         { .id = "usb_ctrl" },
 115         { .id = "usb_bus" },
 116         { .id = "xtal_usb_ctrl" },
 117 };
 118
 119 static const char * const meson_gxm_phy_names[] = {
 120         "usb2-phy0", "usb2-phy1", "usb2-phy2",
 121 };
 122
 123 static const char * const meson_g12a_phy_names[] = {
 124         "usb2-phy0", "usb2-phy1", "usb3-phy0",
 125 };
 126
 127 /*
 128  * Amlogic A1 has a single physical PHY, in slot 1, but still has the
 129  * two U2 PHY controls register blocks like G12A.
 130  * AXG has the similar scheme, thus needs the same tweak.
 131  * Handling the first PHY on slot 1 would need a large amount of code
 132  * changes, and the current management is generic enough to handle it
 133  * correctly when only the "usb2-phy1" phy is specified on-par with the
 134  * DT bindings.
 135  */
 136 static const char * const meson_a1_phy_names[] = {
 137         "usb2-phy0", "usb2-phy1"
 138 };
 139
 140 struct dwc3_meson_g12a;
 141
 142 struct dwc3_meson_g12a_drvdata {
 143         bool otg_switch_supported;
 144         bool otg_phy_host_port_disable;
 145         struct clk_bulk_data *clks;
 146         int num_clks;
 147         const char * const *phy_names;
 148         int num_phys;
 149         int (*setup_regmaps)(struct dwc3_meson_g12a *priv, void __iomem *base);
 150         int (*usb2_init_phy)(struct dwc3_meson_g12a *priv, int i,
 151                              enum phy_mode mode);
 152         int (*set_phy_mode)(struct dwc3_meson_g12a *priv, int i,
 153                             enum phy_mode mode);
 154         int (*usb_init)(struct dwc3_meson_g12a *priv);
 155         int (*usb_post_init)(struct dwc3_meson_g12a *priv);
 156 };
 157
 158 static int dwc3_meson_gxl_setup_regmaps(struct dwc3_meson_g12a *priv,
 159                                         void __iomem *base);
 160 static int dwc3_meson_g12a_setup_regmaps(struct dwc3_meson_g12a *priv,
 161                                          void __iomem *base);
 162
 163 static int dwc3_meson_g12a_usb2_init_phy(struct dwc3_meson_g12a *priv, int i,
 164                                          enum phy_mode mode);
 165 static int dwc3_meson_gxl_usb2_init_phy(struct dwc3_meson_g12a *priv, int i,
 166                                         enum phy_mode mode);
 167
 168 static int dwc3_meson_g12a_set_phy_mode(struct dwc3_meson_g12a *priv,
 169                                         int i, enum phy_mode mode);
 170 static int dwc3_meson_gxl_set_phy_mode(struct dwc3_meson_g12a *priv,
 171                                        int i, enum phy_mode mode);
 172
 173 static int dwc3_meson_g12a_usb_init(struct dwc3_meson_g12a *priv);
 174 static int dwc3_meson_gxl_usb_init(struct dwc3_meson_g12a *priv);
 175
 176 static int dwc3_meson_gxl_usb_post_init(struct dwc3_meson_g12a *priv);
 177
 178 /*
 179  * For GXL and GXM SoCs:
 180  * USB Phy muxing between the DWC2 Device controller and the DWC3 Host
 181  * controller is buggy when switching from Device to Host when USB port
 182  * is unpopulated, it causes the DWC3 to hard crash.
 183  * When populated (including OTG switching with ID pin), the switch works
 184  * like a charm like on the G12A platforms.
 185  * In order to still switch from Host to Device on an USB Type-A port,
 186  * an U2_PORT_DISABLE bit has been added to disconnect the DWC3 Host
 187  * controller from the port, but when used the DWC3 controller must be
 188  * reset to recover usage of the port.
 189  */
 190
 191 static struct dwc3_meson_g12a_drvdata gxl_drvdata = {
 192         .otg_switch_supported = true,
 193         .otg_phy_host_port_disable = true,
 194         .clks = meson_gxl_clocks,
 195         .num_clks = ARRAY_SIZE(meson_g12a_clocks),
 196         .phy_names = meson_a1_phy_names,
 197         .num_phys = ARRAY_SIZE(meson_a1_phy_names),
 198         .setup_regmaps = dwc3_meson_gxl_setup_regmaps,
 199         .usb2_init_phy = dwc3_meson_gxl_usb2_init_phy,
 200         .set_phy_mode = dwc3_meson_gxl_set_phy_mode,
 201         .usb_init = dwc3_meson_gxl_usb_init,
 202         .usb_post_init = dwc3_meson_gxl_usb_post_init,
 203 };
 204
 205 static struct dwc3_meson_g12a_drvdata gxm_drvdata = {
 206         .otg_switch_supported = true,
 207         .otg_phy_host_port_disable = true,
 208         .clks = meson_gxl_clocks,
 209         .num_clks = ARRAY_SIZE(meson_g12a_clocks),
 210         .phy_names = meson_gxm_phy_names,
 211         .num_phys = ARRAY_SIZE(meson_gxm_phy_names),
 212         .setup_regmaps = dwc3_meson_gxl_setup_regmaps,
 213         .usb2_init_phy = dwc3_meson_gxl_usb2_init_phy,
 214         .set_phy_mode = dwc3_meson_gxl_set_phy_mode,
 215         .usb_init = dwc3_meson_gxl_usb_init,
 216         .usb_post_init = dwc3_meson_gxl_usb_post_init,
 217 };
 218
 219 static struct dwc3_meson_g12a_drvdata axg_drvdata = {
 220         .otg_switch_supported = true,
 221         .clks = meson_gxl_clocks,
 222         .num_clks = ARRAY_SIZE(meson_gxl_clocks),
 223         .phy_names = meson_a1_phy_names,
 224         .num_phys = ARRAY_SIZE(meson_a1_phy_names),
 225         .setup_regmaps = dwc3_meson_gxl_setup_regmaps,
 226         .usb2_init_phy = dwc3_meson_gxl_usb2_init_phy,
 227         .set_phy_mode = dwc3_meson_gxl_set_phy_mode,
 228         .usb_init = dwc3_meson_g12a_usb_init,
 229         .usb_post_init = dwc3_meson_gxl_usb_post_init,
 230 };
 231
 232 static struct dwc3_meson_g12a_drvdata g12a_drvdata = {
 233         .otg_switch_supported = true,
 234         .clks = meson_g12a_clocks,
 235         .num_clks = ARRAY_SIZE(meson_g12a_clocks),
 236         .phy_names = meson_g12a_phy_names,
 237         .num_phys = ARRAY_SIZE(meson_g12a_phy_names),
 238         .setup_regmaps = dwc3_meson_g12a_setup_regmaps,
 239         .usb2_init_phy = dwc3_meson_g12a_usb2_init_phy,
 240         .set_phy_mode = dwc3_meson_g12a_set_phy_mode,
 241         .usb_init = dwc3_meson_g12a_usb_init,
 242 };
 243
 244 static struct dwc3_meson_g12a_drvdata a1_drvdata = {
 245         .otg_switch_supported = false,
 246         .clks = meson_a1_clocks,
 247         .num_clks = ARRAY_SIZE(meson_a1_clocks),
 248         .phy_names = meson_a1_phy_names,
 249         .num_phys = ARRAY_SIZE(meson_a1_phy_names),
 250         .setup_regmaps = dwc3_meson_g12a_setup_regmaps,
 251         .usb2_init_phy = dwc3_meson_g12a_usb2_init_phy,
 252         .set_phy_mode = dwc3_meson_g12a_set_phy_mode,
 253         .usb_init = dwc3_meson_g12a_usb_init,
 254 };
 255
 256 struct dwc3_meson_g12a {
 257         struct device           *dev;
 258         struct regmap           *u2p_regmap[PHY_COUNT];
 259         struct regmap           *usb_glue_regmap;
 260         struct reset_control    *reset;
 261         struct phy              *phys[PHY_COUNT];
 262         enum usb_dr_mode        otg_mode;
 263         enum phy_mode           otg_phy_mode;
 264         unsigned int            usb2_ports;
 265         unsigned int            usb3_ports;
 266         struct regulator        *vbus;
 267         struct usb_role_switch_desc switch_desc;
 268         struct usb_role_switch  *role_switch;
 269         const struct dwc3_meson_g12a_drvdata *drvdata;
 270 };
 271
 272 static int dwc3_meson_gxl_set_phy_mode(struct dwc3_meson_g12a *priv,
 273                                          int i, enum phy_mode mode)
 274 {
 275         return phy_set_mode(priv->phys[i], mode);
 276 }
 277
 278 static int dwc3_meson_gxl_usb2_init_phy(struct dwc3_meson_g12a *priv, int i,
 279                                         enum phy_mode mode)
 280 {
 281         /* On GXL PHY must be started in device mode for DWC2 init */
 282         return priv->drvdata->set_phy_mode(priv, i,
 283                                 (i == USB2_OTG_PHY) ? PHY_MODE_USB_DEVICE
 284                                                     : PHY_MODE_USB_HOST);
 285 }
 286
 287 static int dwc3_meson_g12a_set_phy_mode(struct dwc3_meson_g12a *priv,
 288                                          int i, enum phy_mode mode)
 289 {
 290         if (mode == PHY_MODE_USB_HOST)
 291                 regmap_update_bits(priv->u2p_regmap[i], U2P_R0,
 292                                 U2P_R0_HOST_DEVICE,
 293                                 U2P_R0_HOST_DEVICE);
 294         else
 295                 regmap_update_bits(priv->u2p_regmap[i], U2P_R0,
 296                                 U2P_R0_HOST_DEVICE, 0);
 297
 298         return 0;
 299 }
 300
 301 static int dwc3_meson_g12a_usb2_init_phy(struct dwc3_meson_g12a *priv, int i,
 302                                          enum phy_mode mode)
 303 {
 304         int ret;
 305
 306         regmap_update_bits(priv->u2p_regmap[i], U2P_R0,
 307                         U2P_R0_POWER_ON_RESET,
 308                         U2P_R0_POWER_ON_RESET);
 309
 310         if (priv->drvdata->otg_switch_supported && i == USB2_OTG_PHY) {
 311                 regmap_update_bits(priv->u2p_regmap[i], U2P_R0,
 312                                    U2P_R0_ID_PULLUP | U2P_R0_DRV_VBUS,
 313                                    U2P_R0_ID_PULLUP | U2P_R0_DRV_VBUS);
 314
 315                 ret = priv->drvdata->set_phy_mode(priv, i, mode);
 316         } else
 317                 ret = priv->drvdata->set_phy_mode(priv, i,
 318                                                   PHY_MODE_USB_HOST);
 319
 320         if (ret)
 321                 return ret;
 322
 323         regmap_update_bits(priv->u2p_regmap[i], U2P_R0,
 324                         U2P_R0_POWER_ON_RESET, 0);
 325
 326         return 0;
 327 }
 328
 329 static int dwc3_meson_g12a_usb2_init(struct dwc3_meson_g12a *priv,
 330                                      enum phy_mode mode)
 331 {
 332         int i, ret;
 333
 334         for (i = 0; i < priv->drvdata->num_phys; ++i) {
 335                 if (!priv->phys[i])
 336                         continue;
 337
 338                 if (!strstr(priv->drvdata->phy_names[i], "usb2"))
 339                         continue;
 340
 341                 ret = priv->drvdata->usb2_init_phy(priv, i, mode);
 342                 if (ret)
 343                         return ret;
 344         }
 345
 346         return 0;
 347 }
 348
 349 static void dwc3_meson_g12a_usb3_init(struct dwc3_meson_g12a *priv)
 350 {
 351         regmap_update_bits(priv->usb_glue_regmap, USB_R3,
 352                         USB_R3_P30_SSC_RANGE_MASK |
 353                         USB_R3_P30_REF_SSP_EN,
 354                         USB_R3_P30_SSC_ENABLE |
 355                         FIELD_PREP(USB_R3_P30_SSC_RANGE_MASK, 2) |
 356                         USB_R3_P30_REF_SSP_EN);
 357         udelay(2);
 358
 359         regmap_update_bits(priv->usb_glue_regmap, USB_R2,
 360                         USB_R2_P30_PCS_TX_DEEMPH_3P5DB_MASK,
 361                         FIELD_PREP(USB_R2_P30_PCS_TX_DEEMPH_3P5DB_MASK, 0x15));
 362
 363         regmap_update_bits(priv->usb_glue_regmap, USB_R2,
 364                         USB_R2_P30_PCS_TX_DEEMPH_6DB_MASK,
 365                         FIELD_PREP(USB_R2_P30_PCS_TX_DEEMPH_6DB_MASK, 0x20));
 366
 367         udelay(2);
 368
 369         regmap_update_bits(priv->usb_glue_regmap, USB_R1,
 370                         USB_R1_U3H_HOST_PORT_POWER_CONTROL_PRESENT,
 371                         USB_R1_U3H_HOST_PORT_POWER_CONTROL_PRESENT);
 372
 373         regmap_update_bits(priv->usb_glue_regmap, USB_R1,
 374                         USB_R1_P30_PCS_TX_SWING_FULL_MASK,
 375                         FIELD_PREP(USB_R1_P30_PCS_TX_SWING_FULL_MASK, 127));
 376 }
 377
 378 static void dwc3_meson_g12a_usb_otg_apply_mode(struct dwc3_meson_g12a *priv,
 379                                                enum phy_mode mode)
 380 {
 381         if (mode == PHY_MODE_USB_DEVICE) {
 382                 if (priv->otg_mode != USB_DR_MODE_OTG &&
 383                     priv->drvdata->otg_phy_host_port_disable)
 384                         /* Isolate the OTG PHY port from the Host Controller */
 385                         regmap_update_bits(priv->usb_glue_regmap, USB_R1,
 386                                 USB_R1_U3H_HOST_U2_PORT_DISABLE_MASK,
 387                                 FIELD_PREP(USB_R1_U3H_HOST_U2_PORT_DISABLE_MASK,
 388                                            BIT(USB2_OTG_PHY)));
 389
 390                 regmap_update_bits(priv->usb_glue_regmap, USB_R0,
 391                                 USB_R0_U2D_ACT, USB_R0_U2D_ACT);
 392                 regmap_update_bits(priv->usb_glue_regmap, USB_R0,
 393                                 USB_R0_U2D_SS_SCALEDOWN_MODE_MASK, 0);
 394                 regmap_update_bits(priv->usb_glue_regmap, USB_R4,
 395                                 USB_R4_P21_SLEEP_M0, USB_R4_P21_SLEEP_M0);
 396         } else {
 397                 if (priv->otg_mode != USB_DR_MODE_OTG &&
 398                     priv->drvdata->otg_phy_host_port_disable) {
 399                         regmap_update_bits(priv->usb_glue_regmap, USB_R1,
 400                                 USB_R1_U3H_HOST_U2_PORT_DISABLE_MASK, 0);
 401                         msleep(500);
 402                 }
 403                 regmap_update_bits(priv->usb_glue_regmap, USB_R0,
 404                                 USB_R0_U2D_ACT, 0);
 405                 regmap_update_bits(priv->usb_glue_regmap, USB_R4,
 406                                 USB_R4_P21_SLEEP_M0, 0);
 407         }
 408 }
 409
 410 static int dwc3_meson_g12a_usb_init_glue(struct dwc3_meson_g12a *priv,
 411                                          enum phy_mode mode)
 412 {
 413         int ret;
 414
 415         ret = dwc3_meson_g12a_usb2_init(priv, mode);
 416         if (ret)
 417                 return ret;
 418
 419         regmap_update_bits(priv->usb_glue_regmap, USB_R1,
 420                         USB_R1_U3H_FLADJ_30MHZ_REG_MASK,
 421                         FIELD_PREP(USB_R1_U3H_FLADJ_30MHZ_REG_MASK, 0x20));
 422
 423         regmap_update_bits(priv->usb_glue_regmap, USB_R5,
 424                         USB_R5_ID_DIG_EN_0,
 425                         USB_R5_ID_DIG_EN_0);
 426         regmap_update_bits(priv->usb_glue_regmap, USB_R5,
 427                         USB_R5_ID_DIG_EN_1,
 428                         USB_R5_ID_DIG_EN_1);
 429         regmap_update_bits(priv->usb_glue_regmap, USB_R5,
 430                         USB_R5_ID_DIG_TH_MASK,
 431                         FIELD_PREP(USB_R5_ID_DIG_TH_MASK, 0xff));
 432
 433         /* If we have an actual SuperSpeed port, initialize it */
 434         if (priv->usb3_ports)
 435                 dwc3_meson_g12a_usb3_init(priv);
 436
 437         dwc3_meson_g12a_usb_otg_apply_mode(priv, mode);
 438
 439         return 0;
 440 }
 441
 442 static const struct regmap_config phy_meson_g12a_usb_glue_regmap_conf = {
 443         .name = "usb-glue",
 444         .reg_bits = 8,
 445         .val_bits = 32,
 446         .reg_stride = 4,
 447         .max_register = USB_R5,
 448 };
 449
 450 static int dwc3_meson_g12a_get_phys(struct dwc3_meson_g12a *priv)
 451 {
 452         const char *phy_name;
 453         int i;
 454
 455         for (i = 0 ; i < priv->drvdata->num_phys ; ++i) {
 456                 phy_name = priv->drvdata->phy_names[i];
 457                 priv->phys[i] = devm_phy_optional_get(priv->dev, phy_name);
 458                 if (!priv->phys[i])
 459                         continue;
 460
 461                 if (IS_ERR(priv->phys[i]))
 462                         return PTR_ERR(priv->phys[i]);
 463
 464                 if (strstr(phy_name, "usb3"))
 465                         priv->usb3_ports++;
 466                 else
 467                         priv->usb2_ports++;
 468         }
 469
 470         dev_info(priv->dev, "USB2 ports: %d\n", priv->usb2_ports);
 471         dev_info(priv->dev, "USB3 ports: %d\n", priv->usb3_ports);
 472
 473         return 0;
 474 }
 475
 476 static enum phy_mode dwc3_meson_g12a_get_id(struct dwc3_meson_g12a *priv)
 477 {
 478         u32 reg;
 479
 480         regmap_read(priv->usb_glue_regmap, USB_R5, &reg);
 481
 482         if (reg & (USB_R5_ID_DIG_SYNC | USB_R5_ID_DIG_REG))
 483                 return PHY_MODE_USB_DEVICE;
 484
 485         return PHY_MODE_USB_HOST;
 486 }
 487
 488 static int dwc3_meson_g12a_otg_mode_set(struct dwc3_meson_g12a *priv,
 489                                         enum phy_mode mode)
 490 {
 491         int ret;
 492
 493         if (!priv->drvdata->otg_switch_supported || !priv->phys[USB2_OTG_PHY])
 494                 return -EINVAL;
 495
 496         if (mode == PHY_MODE_USB_HOST)
 497                 dev_info(priv->dev, "switching to Host Mode\n");
 498         else
 499                 dev_info(priv->dev, "switching to Device Mode\n");
 500
 501         if (priv->vbus) {
 502                 if (mode == PHY_MODE_USB_DEVICE)
 503                         ret = regulator_disable(priv->vbus);
 504                 else
 505                         ret = regulator_enable(priv->vbus);
 506                 if (ret)
 507                         return ret;
 508         }
 509
 510         priv->otg_phy_mode = mode;
 511
 512         ret = priv->drvdata->set_phy_mode(priv, USB2_OTG_PHY, mode);
 513         if (ret)
 514                 return ret;
 515
 516         dwc3_meson_g12a_usb_otg_apply_mode(priv, mode);
 517
 518         return 0;
 519 }
 520
 521 static int dwc3_meson_g12a_role_set(struct usb_role_switch *sw,
 522                                     enum usb_role role)
 523 {
 524         struct dwc3_meson_g12a *priv = usb_role_switch_get_drvdata(sw);
 525         enum phy_mode mode;
 526
 527         if (role == USB_ROLE_NONE)
 528                 return 0;
 529
 530         mode = (role == USB_ROLE_HOST) ? PHY_MODE_USB_HOST
 531                                        : PHY_MODE_USB_DEVICE;
 532
 533         if (mode == priv->otg_phy_mode)
 534                 return 0;
 535
 536         if (priv->drvdata->otg_phy_host_port_disable)
 537                 dev_warn_once(priv->dev, "Broken manual OTG switch\n");
 538
 539         return dwc3_meson_g12a_otg_mode_set(priv, mode);
 540 }
 541
 542 static enum usb_role dwc3_meson_g12a_role_get(struct usb_role_switch *sw)
 543 {
 544         struct dwc3_meson_g12a *priv = usb_role_switch_get_drvdata(sw);
 545
 546         return priv->otg_phy_mode == PHY_MODE_USB_HOST ?
 547                 USB_ROLE_HOST : USB_ROLE_DEVICE;
 548 }
 549
 550 static irqreturn_t dwc3_meson_g12a_irq_thread(int irq, void *data)
 551 {
 552         struct dwc3_meson_g12a *priv = data;
 553         enum phy_mode otg_id;
 554
 555         otg_id = dwc3_meson_g12a_get_id(priv);
 556         if (otg_id != priv->otg_phy_mode) {
 557                 if (dwc3_meson_g12a_otg_mode_set(priv, otg_id))
 558                         dev_warn(priv->dev, "Failed to switch OTG mode\n");
 559         }
 560
 561         regmap_update_bits(priv->usb_glue_regmap, USB_R5,
 562                            USB_R5_ID_DIG_IRQ, 0);
 563
 564         return IRQ_HANDLED;
 565 }
 566
 567 static struct device *dwc3_meson_g12_find_child(struct device *dev,
 568                                                 const char *compatible)
 569 {
 570         struct platform_device *pdev;
 571         struct device_node *np;
 572
 573         np = of_get_compatible_child(dev->of_node, compatible);
 574         if (!np)
 575                 return NULL;
 576
 577         pdev = of_find_device_by_node(np);
 578         of_node_put(np);
 579         if (!pdev)
 580                 return NULL;
 581
 582         return &pdev->dev;
 583 }
 584
 585 static int dwc3_meson_g12a_otg_init(struct platform_device *pdev,
 586                                     struct dwc3_meson_g12a *priv)
 587 {
 588         enum phy_mode otg_id;
 589         int ret, irq;
 590         struct device *dev = &pdev->dev;
 591
 592         if (!priv->drvdata->otg_switch_supported)
 593                 return 0;
 594
 595         if (priv->otg_mode == USB_DR_MODE_OTG) {
 596                 /* Ack irq before registering */
 597                 regmap_update_bits(priv->usb_glue_regmap, USB_R5,
 598                                    USB_R5_ID_DIG_IRQ, 0);
 599
 600                 irq = platform_get_irq(pdev, 0);
 601                 if (irq < 0)
 602                         return irq;
 603                 ret = devm_request_threaded_irq(&pdev->dev, irq, NULL,
 604                                                 dwc3_meson_g12a_irq_thread,
 605                                                 IRQF_ONESHOT, pdev->name, priv);
 606                 if (ret)
 607                         return ret;
 608         }
 609
 610         /* Setup OTG mode corresponding to the ID pin */
 611         if (priv->otg_mode == USB_DR_MODE_OTG) {
 612                 otg_id = dwc3_meson_g12a_get_id(priv);
 613                 if (otg_id != priv->otg_phy_mode) {
 614                         if (dwc3_meson_g12a_otg_mode_set(priv, otg_id))
 615                                 dev_warn(dev, "Failed to switch OTG mode\n");
 616                 }
 617         }
 618
 619         /* Setup role switcher */
 620         priv->switch_desc.usb2_port = dwc3_meson_g12_find_child(dev,
 621                                                                 "snps,dwc3");
 622         priv->switch_desc.udc = dwc3_meson_g12_find_child(dev, "snps,dwc2");
 623         priv->switch_desc.allow_userspace_control = true;
 624         priv->switch_desc.set = dwc3_meson_g12a_role_set;
 625         priv->switch_desc.get = dwc3_meson_g12a_role_get;
 626         priv->switch_desc.driver_data = priv;
 627
 628         priv->role_switch = usb_role_switch_register(dev, &priv->switch_desc);
 629         if (IS_ERR(priv->role_switch))
 630                 dev_warn(dev, "Unable to register Role Switch\n");
 631
 632         return 0;
 633 }
 634
 635 static int dwc3_meson_gxl_setup_regmaps(struct dwc3_meson_g12a *priv,
 636                                         void __iomem *base)
 637 {
 638         /* GXL controls the PHY mode in the PHY registers unlike G12A */
 639         priv->usb_glue_regmap = devm_regmap_init_mmio(priv->dev, base,
 640                                         &phy_meson_g12a_usb_glue_regmap_conf);
 641         return PTR_ERR_OR_ZERO(priv->usb_glue_regmap);
 642 }
 643
 644 static int dwc3_meson_g12a_setup_regmaps(struct dwc3_meson_g12a *priv,
 645                                          void __iomem *base)
 646 {
 647         int i;
 648
 649         priv->usb_glue_regmap = devm_regmap_init_mmio(priv->dev,
 650                                         base + G12A_GLUE_OFFSET,
 651                                         &phy_meson_g12a_usb_glue_regmap_conf);
 652         if (IS_ERR(priv->usb_glue_regmap))
 653                 return PTR_ERR(priv->usb_glue_regmap);
 654
 655         /* Create a regmap for each USB2 PHY control register set */
 656         for (i = 0; i < priv->drvdata->num_phys; i++) {
 657                 struct regmap_config u2p_regmap_config = {
 658                         .reg_bits = 8,
 659                         .val_bits = 32,
 660                         .reg_stride = 4,
 661                         .max_register = U2P_R1,
 662                 };
 663
 664                 if (!strstr(priv->drvdata->phy_names[i], "usb2"))
 665                         continue;
 666
 667                 u2p_regmap_config.name = devm_kasprintf(priv->dev, GFP_KERNEL,
 668                                                         "u2p-%d", i);
 669                 if (!u2p_regmap_config.name)
 670                         return -ENOMEM;
 671
 672                 priv->u2p_regmap[i] = devm_regmap_init_mmio(priv->dev,
 673                                                 base + (i * U2P_REG_SIZE),
 674                                                 &u2p_regmap_config);
 675                 if (IS_ERR(priv->u2p_regmap[i]))
 676                         return PTR_ERR(priv->u2p_regmap[i]);
 677         }
 678
 679         return 0;
 680 }
 681
 682 static int dwc3_meson_g12a_usb_init(struct dwc3_meson_g12a *priv)
 683 {
 684         return dwc3_meson_g12a_usb_init_glue(priv, priv->otg_phy_mode);
 685 }
 686
 687 static int dwc3_meson_gxl_usb_init(struct dwc3_meson_g12a *priv)
 688 {
 689         return dwc3_meson_g12a_usb_init_glue(priv, PHY_MODE_USB_DEVICE);
 690 }
 691
 692 static int dwc3_meson_gxl_usb_post_init(struct dwc3_meson_g12a *priv)
 693 {
 694         int ret;
 695
 696         ret = priv->drvdata->set_phy_mode(priv, USB2_OTG_PHY,
 697                                           priv->otg_phy_mode);
 698         if (ret)
 699                 return ret;
 700
 701         dwc3_meson_g12a_usb_otg_apply_mode(priv, priv->otg_phy_mode);
 702
 703         return 0;
 704 }
 705
 706 static int dwc3_meson_g12a_probe(struct platform_device *pdev)
 707 {
 708         struct dwc3_meson_g12a  *priv;
 709         struct device           *dev = &pdev->dev;
 710         struct device_node      *np = dev->of_node;
 711         void __iomem *base;
 712         int ret, i;
 713
 714         priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
 715         if (!priv)
 716                 return -ENOMEM;
 717
 718         base = devm_platform_ioremap_resource(pdev, 0);
 719         if (IS_ERR(base))
 720                 return PTR_ERR(base);
 721
 722         priv->drvdata = of_device_get_match_data(&pdev->dev);
 723         priv->dev = dev;
 724
 725         priv->vbus = devm_regulator_get_optional(dev, "vbus");
 726         if (IS_ERR(priv->vbus)) {
 727                 if (PTR_ERR(priv->vbus) == -EPROBE_DEFER)
 728                         return PTR_ERR(priv->vbus);
 729                 priv->vbus = NULL;
 730         }
 731
 732         ret = devm_clk_bulk_get(dev,
 733                                 priv->drvdata->num_clks,
 734                                 priv->drvdata->clks);
 735         if (ret)
 736                 return ret;
 737
 738         ret = clk_bulk_prepare_enable(priv->drvdata->num_clks,
 739                                       priv->drvdata->clks);
 740         if (ret)
 741                 return ret;
 742
 743         platform_set_drvdata(pdev, priv);
 744
 745         priv->reset = devm_reset_control_get_shared(dev, NULL);
 746         if (IS_ERR(priv->reset)) {
 747                 ret = PTR_ERR(priv->reset);
 748                 dev_err(dev, "failed to get device reset, err=%d\n", ret);
 749                 goto err_disable_clks;
 750         }
 751
 752         ret = reset_control_reset(priv->reset);
 753         if (ret)
 754                 goto err_disable_clks;
 755
 756         ret = dwc3_meson_g12a_get_phys(priv);
 757         if (ret)
 758                 goto err_rearm;
 759
 760         ret = priv->drvdata->setup_regmaps(priv, base);
 761         if (ret)
 762                 goto err_rearm;
 763
 764         if (priv->vbus) {
 765                 ret = regulator_enable(priv->vbus);
 766                 if (ret)
 767                         goto err_rearm;
 768         }
 769
 770         /* Get dr_mode */
 771         priv->otg_mode = usb_get_dr_mode(dev);
 772
 773         if (priv->otg_mode == USB_DR_MODE_PERIPHERAL)
 774                 priv->otg_phy_mode = PHY_MODE_USB_DEVICE;
 775         else
 776                 priv->otg_phy_mode = PHY_MODE_USB_HOST;
 777
 778         ret = priv->drvdata->usb_init(priv);
 779         if (ret)
 780                 goto err_disable_regulator;
 781
 782         /* Init PHYs */
 783         for (i = 0 ; i < PHY_COUNT ; ++i) {
 784                 ret = phy_init(priv->phys[i]);
 785                 if (ret)
 786                         goto err_disable_regulator;
 787         }
 788
 789         /* Set PHY Power */
 790         for (i = 0 ; i < PHY_COUNT ; ++i) {
 791                 ret = phy_power_on(priv->phys[i]);
 792                 if (ret)
 793                         goto err_phys_exit;
 794         }
 795
 796         if (priv->drvdata->usb_post_init) {
 797                 ret = priv->drvdata->usb_post_init(priv);
 798                 if (ret)
 799                         goto err_phys_power;
 800         }
 801
 802         ret = of_platform_populate(np, NULL, NULL, dev);
 803         if (ret)
 804                 goto err_phys_power;
 805
 806         ret = dwc3_meson_g12a_otg_init(pdev, priv);
 807         if (ret)
 808                 goto err_phys_power;
 809
 810         pm_runtime_set_active(dev);
 811         pm_runtime_enable(dev);
 812         pm_runtime_get_sync(dev);
 813
 814         return 0;
 815
 816 err_phys_power:
 817         for (i = 0 ; i < PHY_COUNT ; ++i)
 818                 phy_power_off(priv->phys[i]);
 819
 820 err_phys_exit:
 821         for (i = 0 ; i < PHY_COUNT ; ++i)
 822                 phy_exit(priv->phys[i]);
 823
 824 err_disable_regulator:
 825         if (priv->vbus)
 826                 regulator_disable(priv->vbus);
 827
 828 err_rearm:
 829         reset_control_rearm(priv->reset);
 830
 831 err_disable_clks:
 832         clk_bulk_disable_unprepare(priv->drvdata->num_clks,
 833                                    priv->drvdata->clks);
 834
 835         return ret;
 836 }
 837
 838 static int dwc3_meson_g12a_remove(struct platform_device *pdev)
 839 {
 840         struct dwc3_meson_g12a *priv = platform_get_drvdata(pdev);
 841         struct device *dev = &pdev->dev;
 842         int i;
 843
 844         if (priv->drvdata->otg_switch_supported)
 845                 usb_role_switch_unregister(priv->role_switch);
 846
 847         of_platform_depopulate(dev);
 848
 849         for (i = 0 ; i < PHY_COUNT ; ++i) {
 850                 phy_power_off(priv->phys[i]);
 851                 phy_exit(priv->phys[i]);
 852         }
 853
 854         pm_runtime_disable(dev);
 855         pm_runtime_put_noidle(dev);
 856         pm_runtime_set_suspended(dev);
 857
 858         reset_control_rearm(priv->reset);
 859
 860         clk_bulk_disable_unprepare(priv->drvdata->num_clks,
 861                                    priv->drvdata->clks);
 862
 863         return 0;
 864 }
 865
 866 static int __maybe_unused dwc3_meson_g12a_runtime_suspend(struct device *dev)
 867 {
 868         struct dwc3_meson_g12a  *priv = dev_get_drvdata(dev);
 869
 870         clk_bulk_disable_unprepare(priv->drvdata->num_clks,
 871                                    priv->drvdata->clks);
 872
 873         return 0;
 874 }
 875
 876 static int __maybe_unused dwc3_meson_g12a_runtime_resume(struct device *dev)
 877 {
 878         struct dwc3_meson_g12a  *priv = dev_get_drvdata(dev);
 879
 880         return clk_bulk_prepare_enable(priv->drvdata->num_clks,
 881                                        priv->drvdata->clks);
 882 }
 883
 884 static int __maybe_unused dwc3_meson_g12a_suspend(struct device *dev)
 885 {
 886         struct dwc3_meson_g12a *priv = dev_get_drvdata(dev);
 887         int i, ret;
 888
 889         if (priv->vbus && priv->otg_phy_mode == PHY_MODE_USB_HOST) {
 890                 ret = regulator_disable(priv->vbus);
 891                 if (ret)
 892                         return ret;
 893         }
 894
 895         for (i = 0 ; i < PHY_COUNT ; ++i) {
 896                 phy_power_off(priv->phys[i]);
 897                 phy_exit(priv->phys[i]);
 898         }
 899
 900         reset_control_rearm(priv->reset);
 901
 902         return 0;
 903 }
 904
 905 static int __maybe_unused dwc3_meson_g12a_resume(struct device *dev)
 906 {
 907         struct dwc3_meson_g12a *priv = dev_get_drvdata(dev);
 908         int i, ret;
 909
 910         ret = reset_control_reset(priv->reset);
 911         if (ret)
 912                 return ret;
 913
 914         ret = priv->drvdata->usb_init(priv);
 915         if (ret)
 916                 return ret;
 917
 918         /* Init PHYs */
 919         for (i = 0 ; i < PHY_COUNT ; ++i) {
 920                 ret = phy_init(priv->phys[i]);
 921                 if (ret)
 922                         return ret;
 923         }
 924
 925         /* Set PHY Power */
 926         for (i = 0 ; i < PHY_COUNT ; ++i) {
 927                 ret = phy_power_on(priv->phys[i]);
 928                 if (ret)
 929                         return ret;
 930         }
 931
 932         if (priv->vbus && priv->otg_phy_mode == PHY_MODE_USB_HOST) {
 933                 ret = regulator_enable(priv->vbus);
 934                 if (ret)
 935                         return ret;
 936         }
 937
 938         return 0;
 939 }
 940
 941 static const struct dev_pm_ops dwc3_meson_g12a_dev_pm_ops = {
 942         SET_SYSTEM_SLEEP_PM_OPS(dwc3_meson_g12a_suspend, dwc3_meson_g12a_resume)
 943         SET_RUNTIME_PM_OPS(dwc3_meson_g12a_runtime_suspend,
 944                            dwc3_meson_g12a_runtime_resume, NULL)
 945 };
 946
 947 static const struct of_device_id dwc3_meson_g12a_match[] = {
 948         {
 949                 .compatible = "amlogic,meson-gxl-usb-ctrl",
 950                 .data = &gxl_drvdata,
 951         },
 952         {
 953                 .compatible = "amlogic,meson-gxm-usb-ctrl",
 954                 .data = &gxm_drvdata,
 955         },
 956         {
 957                 .compatible = "amlogic,meson-axg-usb-ctrl",
 958                 .data = &axg_drvdata,
 959         },
 960         {
 961                 .compatible = "amlogic,meson-g12a-usb-ctrl",
 962                 .data = &g12a_drvdata,
 963         },
 964         {
 965                 .compatible = "amlogic,meson-a1-usb-ctrl",
 966                 .data = &a1_drvdata,
 967         },
 968         { /* Sentinel */ }
 969 };
 970 MODULE_DEVICE_TABLE(of, dwc3_meson_g12a_match);
 971
 972 static struct platform_driver dwc3_meson_g12a_driver = {
 973         .probe          = dwc3_meson_g12a_probe,
 974         .remove         = dwc3_meson_g12a_remove,
 975         .driver         = {
 976                 .name   = "dwc3-meson-g12a",
 977                 .of_match_table = dwc3_meson_g12a_match,
 978                 .pm     = &dwc3_meson_g12a_dev_pm_ops,
 979         },
 980 };
 981
 982 module_platform_driver(dwc3_meson_g12a_driver);
 983 MODULE_LICENSE("GPL v2");
 984 MODULE_DESCRIPTION("Amlogic Meson G12A USB Glue Layer");
 985 MODULE_AUTHOR("Neil Armstrong <narmstrong@baylibre.com>");