kernel/drivers/net/ethernet/stmicro/stmmac/dwmac-rk.c

   1 /**
   2  * dwmac-rk.c - Rockchip RK3288 DWMAC specific glue layer
   3  *
   4  * Copyright (C) 2014 Chen-Zhi (Roger Chen)
   5  *
   6  * Chen-Zhi (Roger Chen)  <roger.chen@rock-chips.com>
   7  *
   8  * This program is free software; you can redistribute it and/or modify
   9  * it under the terms of the GNU General Public License as published by
  10  * the Free Software Foundation; either version 2 of the License, or
  11  * (at your option) any later version.
  12  *
  13  * This program is distributed in the hope that it will be useful,
  14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16  * GNU General Public License for more details.
  17  */
  18
  19 #include <linux/stmmac.h>
  20 #include <linux/bitops.h>
  21 #include <linux/clk.h>
  22 #include <linux/phy.h>
  23 #include <linux/of_net.h>
  24 #include <linux/gpio.h>
  25 #include <linux/of_gpio.h>
  26 #include <linux/of_device.h>
  27 #include <linux/regulator/consumer.h>
  28 #include <linux/delay.h>
  29 #include <linux/mfd/syscon.h>
  30 #include <linux/regmap.h>
  31
  32 struct rk_priv_data {
  33         struct platform_device *pdev;
  34         int phy_iface;
  35         struct regulator *regulator;
  36
  37         bool clk_enabled;
  38         bool clock_input;
  39
  40         struct clk *clk_mac;
  41         struct clk *clk_mac_pll;
  42         struct clk *gmac_clkin;
  43         struct clk *mac_clk_rx;
  44         struct clk *mac_clk_tx;
  45         struct clk *clk_mac_ref;
  46         struct clk *clk_mac_refout;
  47         struct clk *aclk_mac;
  48         struct clk *pclk_mac;
  49
  50         int tx_delay;
  51         int rx_delay;
  52
  53         struct regmap *grf;
  54 };
  55
  56 #define HIWORD_UPDATE(val, mask, shift) \
  57                 ((val) << (shift) | (mask) << ((shift) + 16))
  58
  59 #define GRF_BIT(nr)     (BIT(nr) | BIT(nr+16))
  60 #define GRF_CLR_BIT(nr) (BIT(nr+16))
  61
  62 #define RK3288_GRF_SOC_CON1     0x0248
  63 #define RK3288_GRF_SOC_CON3     0x0250
  64 #define RK3288_GRF_GPIO3D_E     0x01ec
  65 #define RK3288_GRF_GPIO4A_E     0x01f0
  66 #define RK3288_GRF_GPIO4B_E     0x01f4
  67
  68 /*RK3288_GRF_SOC_CON1*/
  69 #define GMAC_PHY_INTF_SEL_RGMII (GRF_BIT(6) | GRF_CLR_BIT(7) | GRF_CLR_BIT(8))
  70 #define GMAC_PHY_INTF_SEL_RMII  (GRF_CLR_BIT(6) | GRF_CLR_BIT(7) | GRF_BIT(8))
  71 #define GMAC_FLOW_CTRL          GRF_BIT(9)
  72 #define GMAC_FLOW_CTRL_CLR      GRF_CLR_BIT(9)
  73 #define GMAC_SPEED_10M          GRF_CLR_BIT(10)
  74 #define GMAC_SPEED_100M         GRF_BIT(10)
  75 #define GMAC_RMII_CLK_25M       GRF_BIT(11)
  76 #define GMAC_RMII_CLK_2_5M      GRF_CLR_BIT(11)
  77 #define GMAC_CLK_125M           (GRF_CLR_BIT(12) | GRF_CLR_BIT(13))
  78 #define GMAC_CLK_25M            (GRF_BIT(12) | GRF_BIT(13))
  79 #define GMAC_CLK_2_5M           (GRF_CLR_BIT(12) | GRF_BIT(13))
  80 #define GMAC_RMII_MODE          GRF_BIT(14)
  81 #define GMAC_RMII_MODE_CLR      GRF_CLR_BIT(14)
  82
  83 /*RK3288_GRF_SOC_CON3*/
  84 #define GMAC_TXCLK_DLY_ENABLE   GRF_BIT(14)
  85 #define GMAC_TXCLK_DLY_DISABLE  GRF_CLR_BIT(14)
  86 #define GMAC_RXCLK_DLY_ENABLE   GRF_BIT(15)
  87 #define GMAC_RXCLK_DLY_DISABLE  GRF_CLR_BIT(15)
  88 #define GMAC_CLK_RX_DL_CFG(val) HIWORD_UPDATE(val, 0x7F, 7)
  89 #define GMAC_CLK_TX_DL_CFG(val) HIWORD_UPDATE(val, 0x7F, 0)
  90
  91 static void set_to_rgmii(struct rk_priv_data *bsp_priv,
  92                          int tx_delay, int rx_delay)
  93 {
  94         struct device *dev = &bsp_priv->pdev->dev;
  95
  96         if (IS_ERR(bsp_priv->grf)) {
  97                 dev_err(dev, "%s: Missing rockchip,grf property\n", __func__);
  98                 return;
  99         }
 100
 101         regmap_write(bsp_priv->grf, RK3288_GRF_SOC_CON1,
 102                      GMAC_PHY_INTF_SEL_RGMII | GMAC_RMII_MODE_CLR);
 103         regmap_write(bsp_priv->grf, RK3288_GRF_SOC_CON3,
 104                      GMAC_RXCLK_DLY_ENABLE | GMAC_TXCLK_DLY_ENABLE |
 105                      GMAC_CLK_RX_DL_CFG(rx_delay) |
 106                      GMAC_CLK_TX_DL_CFG(tx_delay));
 107 }
 108
 109 static void set_to_rmii(struct rk_priv_data *bsp_priv)
 110 {
 111         struct device *dev = &bsp_priv->pdev->dev;
 112
 113         if (IS_ERR(bsp_priv->grf)) {
 114                 dev_err(dev, "%s: Missing rockchip,grf property\n", __func__);
 115                 return;
 116         }
 117
 118         regmap_write(bsp_priv->grf, RK3288_GRF_SOC_CON1,
 119                      GMAC_PHY_INTF_SEL_RMII | GMAC_RMII_MODE);
 120 }
 121
 122 static void set_rgmii_speed(struct rk_priv_data *bsp_priv, int speed)
 123 {
 124         struct device *dev = &bsp_priv->pdev->dev;
 125
 126         if (IS_ERR(bsp_priv->grf)) {
 127                 dev_err(dev, "%s: Missing rockchip,grf property\n", __func__);
 128                 return;
 129         }
 130
 131         if (speed == 10)
 132                 regmap_write(bsp_priv->grf, RK3288_GRF_SOC_CON1, GMAC_CLK_2_5M);
 133         else if (speed == 100)
 134                 regmap_write(bsp_priv->grf, RK3288_GRF_SOC_CON1, GMAC_CLK_25M);
 135         else if (speed == 1000)
 136                 regmap_write(bsp_priv->grf, RK3288_GRF_SOC_CON1, GMAC_CLK_125M);
 137         else
 138                 dev_err(dev, "unknown speed value for RGMII! speed=%d", speed);
 139 }
 140
 141 static void set_rmii_speed(struct rk_priv_data *bsp_priv, int speed)
 142 {
 143         struct device *dev = &bsp_priv->pdev->dev;
 144
 145         if (IS_ERR(bsp_priv->grf)) {
 146                 dev_err(dev, "%s: Missing rockchip,grf property\n", __func__);
 147                 return;
 148         }
 149
 150         if (speed == 10) {
 151                 regmap_write(bsp_priv->grf, RK3288_GRF_SOC_CON1,
 152                              GMAC_RMII_CLK_2_5M | GMAC_SPEED_10M);
 153         } else if (speed == 100) {
 154                 regmap_write(bsp_priv->grf, RK3288_GRF_SOC_CON1,
 155                              GMAC_RMII_CLK_25M | GMAC_SPEED_100M);
 156         } else {
 157                 dev_err(dev, "unknown speed value for RMII! speed=%d", speed);
 158         }
 159 }
 160
 161 static int gmac_clk_init(struct rk_priv_data *bsp_priv)
 162 {
 163         struct device *dev = &bsp_priv->pdev->dev;
 164
 165         bsp_priv->clk_enabled = false;
 166
 167         bsp_priv->mac_clk_rx = devm_clk_get(dev, "mac_clk_rx");
 168         if (IS_ERR(bsp_priv->mac_clk_rx))
 169                 dev_err(dev, "%s: cannot get clock %s\n",
 170                         __func__, "mac_clk_rx");
 171
 172         bsp_priv->mac_clk_tx = devm_clk_get(dev, "mac_clk_tx");
 173         if (IS_ERR(bsp_priv->mac_clk_tx))
 174                 dev_err(dev, "%s: cannot get clock %s\n",
 175                         __func__, "mac_clk_tx");
 176
 177         bsp_priv->aclk_mac = devm_clk_get(dev, "aclk_mac");
 178         if (IS_ERR(bsp_priv->aclk_mac))
 179                 dev_err(dev, "%s: cannot get clock %s\n",
 180                         __func__, "aclk_mac");
 181
 182         bsp_priv->pclk_mac = devm_clk_get(dev, "pclk_mac");
 183         if (IS_ERR(bsp_priv->pclk_mac))
 184                 dev_err(dev, "%s: cannot get clock %s\n",
 185                         __func__, "pclk_mac");
 186
 187         bsp_priv->clk_mac = devm_clk_get(dev, "stmmaceth");
 188         if (IS_ERR(bsp_priv->clk_mac))
 189                 dev_err(dev, "%s: cannot get clock %s\n",
 190                         __func__, "stmmaceth");
 191
 192         if (bsp_priv->phy_iface == PHY_INTERFACE_MODE_RMII) {
 193                 bsp_priv->clk_mac_ref = devm_clk_get(dev, "clk_mac_ref");
 194                 if (IS_ERR(bsp_priv->clk_mac_ref))
 195                         dev_err(dev, "%s: cannot get clock %s\n",
 196                                 __func__, "clk_mac_ref");
 197
 198                 if (!bsp_priv->clock_input) {
 199                         bsp_priv->clk_mac_refout =
 200                                 devm_clk_get(dev, "clk_mac_refout");
 201                         if (IS_ERR(bsp_priv->clk_mac_refout))
 202                                 dev_err(dev, "%s: cannot get clock %s\n",
 203                                         __func__, "clk_mac_refout");
 204                 }
 205         }
 206
 207         if (bsp_priv->clock_input) {
 208                 dev_info(dev, "%s: clock input from PHY\n", __func__);
 209         } else {
 210                 if (bsp_priv->phy_iface == PHY_INTERFACE_MODE_RMII)
 211                         clk_set_rate(bsp_priv->clk_mac_pll, 50000000);
 212         }
 213
 214         return 0;
 215 }
 216
 217 static int gmac_clk_enable(struct rk_priv_data *bsp_priv, bool enable)
 218 {
 219         int phy_iface = phy_iface = bsp_priv->phy_iface;
 220
 221         if (enable) {
 222                 if (!bsp_priv->clk_enabled) {
 223                         if (phy_iface == PHY_INTERFACE_MODE_RMII) {
 224                                 if (!IS_ERR(bsp_priv->mac_clk_rx))
 225                                         clk_prepare_enable(
 226                                                 bsp_priv->mac_clk_rx);
 227
 228                                 if (!IS_ERR(bsp_priv->clk_mac_ref))
 229                                         clk_prepare_enable(
 230                                                 bsp_priv->clk_mac_ref);
 231
 232                                 if (!IS_ERR(bsp_priv->clk_mac_refout))
 233                                         clk_prepare_enable(
 234                                                 bsp_priv->clk_mac_refout);
 235                         }
 236
 237                         if (!IS_ERR(bsp_priv->aclk_mac))
 238                                 clk_prepare_enable(bsp_priv->aclk_mac);
 239
 240                         if (!IS_ERR(bsp_priv->pclk_mac))
 241                                 clk_prepare_enable(bsp_priv->pclk_mac);
 242
 243                         if (!IS_ERR(bsp_priv->mac_clk_tx))
 244                                 clk_prepare_enable(bsp_priv->mac_clk_tx);
 245
 246                         /**
 247                          * if (!IS_ERR(bsp_priv->clk_mac))
 248                          *      clk_prepare_enable(bsp_priv->clk_mac);
 249                          */
 250                         mdelay(5);
 251                         bsp_priv->clk_enabled = true;
 252                 }
 253         } else {
 254                 if (bsp_priv->clk_enabled) {
 255                         if (phy_iface == PHY_INTERFACE_MODE_RMII) {
 256                                 if (!IS_ERR(bsp_priv->mac_clk_rx))
 257                                         clk_disable_unprepare(
 258                                                 bsp_priv->mac_clk_rx);
 259
 260                                 if (!IS_ERR(bsp_priv->clk_mac_ref))
 261                                         clk_disable_unprepare(
 262                                                 bsp_priv->clk_mac_ref);
 263
 264                                 if (!IS_ERR(bsp_priv->clk_mac_refout))
 265                                         clk_disable_unprepare(
 266                                                 bsp_priv->clk_mac_refout);
 267                         }
 268
 269                         if (!IS_ERR(bsp_priv->aclk_mac))
 270                                 clk_disable_unprepare(bsp_priv->aclk_mac);
 271
 272                         if (!IS_ERR(bsp_priv->pclk_mac))
 273                                 clk_disable_unprepare(bsp_priv->pclk_mac);
 274
 275                         if (!IS_ERR(bsp_priv->mac_clk_tx))
 276                                 clk_disable_unprepare(bsp_priv->mac_clk_tx);
 277                         /**
 278                          * if (!IS_ERR(bsp_priv->clk_mac))
 279                          *      clk_disable_unprepare(bsp_priv->clk_mac);
 280                          */
 281                         bsp_priv->clk_enabled = false;
 282                 }
 283         }
 284
 285         return 0;
 286 }
 287
 288 static int phy_power_on(struct rk_priv_data *bsp_priv, bool enable)
 289 {
 290         struct regulator *ldo = bsp_priv->regulator;
 291         int ret;
 292         struct device *dev = &bsp_priv->pdev->dev;
 293
 294         if (!ldo) {
 295                 dev_err(dev, "%s: no regulator found\n", __func__);
 296                 return -1;
 297         }
 298
 299         if (enable) {
 300                 ret = regulator_enable(ldo);
 301                 if (ret)
 302                         dev_err(dev, "%s: fail to enable phy-supply\n",
 303                                 __func__);
 304         } else {
 305                 ret = regulator_disable(ldo);
 306                 if (ret)
 307                         dev_err(dev, "%s: fail to disable phy-supply\n",
 308                                 __func__);
 309         }
 310
 311         return 0;
 312 }
 313
 314 static void *rk_gmac_setup(struct platform_device *pdev)
 315 {
 316         struct rk_priv_data *bsp_priv;
 317         struct device *dev = &pdev->dev;
 318         int ret;
 319         const char *strings = NULL;
 320         int value;
 321
 322         bsp_priv = devm_kzalloc(dev, sizeof(*bsp_priv), GFP_KERNEL);
 323         if (!bsp_priv)
 324                 return ERR_PTR(-ENOMEM);
 325
 326         bsp_priv->phy_iface = of_get_phy_mode(dev->of_node);
 327
 328         bsp_priv->regulator = devm_regulator_get_optional(dev, "phy");
 329         if (IS_ERR(bsp_priv->regulator)) {
 330                 if (PTR_ERR(bsp_priv->regulator) == -EPROBE_DEFER) {
 331                         dev_err(dev, "phy regulator is not available yet, deferred probing\n");
 332                         return ERR_PTR(-EPROBE_DEFER);
 333                 }
 334                 dev_err(dev, "no regulator found\n");
 335                 bsp_priv->regulator = NULL;
 336         }
 337
 338         ret = of_property_read_string(dev->of_node, "clock_in_out", &strings);
 339         if (ret) {
 340                 dev_err(dev, "%s: Can not read property: clock_in_out.\n",
 341                         __func__);
 342                 bsp_priv->clock_input = true;
 343         } else {
 344                 dev_info(dev, "%s: clock input or output? (%s).\n",
 345                          __func__, strings);
 346                 if (!strcmp(strings, "input"))
 347                         bsp_priv->clock_input = true;
 348                 else
 349                         bsp_priv->clock_input = false;
 350         }
 351
 352         ret = of_property_read_u32(dev->of_node, "tx_delay", &value);
 353         if (ret) {
 354                 bsp_priv->tx_delay = 0x30;
 355                 dev_err(dev, "%s: Can not read property: tx_delay.", __func__);
 356                 dev_err(dev, "%s: set tx_delay to 0x%x\n",
 357                         __func__, bsp_priv->tx_delay);
 358         } else {
 359                 dev_info(dev, "%s: TX delay(0x%x).\n", __func__, value);
 360                 bsp_priv->tx_delay = value;
 361         }
 362
 363         ret = of_property_read_u32(dev->of_node, "rx_delay", &value);
 364         if (ret) {
 365                 bsp_priv->rx_delay = 0x10;
 366                 dev_err(dev, "%s: Can not read property: rx_delay.", __func__);
 367                 dev_err(dev, "%s: set rx_delay to 0x%x\n",
 368                         __func__, bsp_priv->rx_delay);
 369         } else {
 370                 dev_info(dev, "%s: RX delay(0x%x).\n", __func__, value);
 371                 bsp_priv->rx_delay = value;
 372         }
 373
 374         bsp_priv->grf = syscon_regmap_lookup_by_phandle(dev->of_node,
 375                                                         "rockchip,grf");
 376         bsp_priv->pdev = pdev;
 377
 378         /*rmii or rgmii*/
 379         if (bsp_priv->phy_iface == PHY_INTERFACE_MODE_RGMII) {
 380                 dev_info(dev, "%s: init for RGMII\n", __func__);
 381                 set_to_rgmii(bsp_priv, bsp_priv->tx_delay, bsp_priv->rx_delay);
 382         } else if (bsp_priv->phy_iface == PHY_INTERFACE_MODE_RMII) {
 383                 dev_info(dev, "%s: init for RMII\n", __func__);
 384                 set_to_rmii(bsp_priv);
 385         } else {
 386                 dev_err(dev, "%s: NO interface defined!\n", __func__);
 387         }
 388
 389         gmac_clk_init(bsp_priv);
 390
 391         return bsp_priv;
 392 }
 393
 394 static int rk_gmac_init(struct platform_device *pdev, void *priv)
 395 {
 396         struct rk_priv_data *bsp_priv = priv;
 397         int ret;
 398
 399         ret = phy_power_on(bsp_priv, true);
 400         if (ret)
 401                 return ret;
 402
 403         ret = gmac_clk_enable(bsp_priv, true);
 404         if (ret)
 405                 return ret;
 406
 407         return 0;
 408 }
 409
 410 static void rk_gmac_exit(struct platform_device *pdev, void *priv)
 411 {
 412         struct rk_priv_data *gmac = priv;
 413
 414         phy_power_on(gmac, false);
 415         gmac_clk_enable(gmac, false);
 416 }
 417
 418 static void rk_fix_speed(void *priv, unsigned int speed)
 419 {
 420         struct rk_priv_data *bsp_priv = priv;
 421         struct device *dev = &bsp_priv->pdev->dev;
 422
 423         if (bsp_priv->phy_iface == PHY_INTERFACE_MODE_RGMII)
 424                 set_rgmii_speed(bsp_priv, speed);
 425         else if (bsp_priv->phy_iface == PHY_INTERFACE_MODE_RMII)
 426                 set_rmii_speed(bsp_priv, speed);
 427         else
 428                 dev_err(dev, "unsupported interface %d", bsp_priv->phy_iface);
 429 }
 430
 431 const struct stmmac_of_data rk3288_gmac_data = {
 432         .has_gmac = 1,
 433         .fix_mac_speed = rk_fix_speed,
 434         .setup = rk_gmac_setup,
 435         .init = rk_gmac_init,
 436         .exit = rk_gmac_exit,
 437 };