drivers/net/phy/rockchip.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /**
   3  * drivers/net/phy/rockchip.c
   4  *
   5  * Driver for ROCKCHIP Ethernet PHYs
   6  *
   7  * Copyright (c) 2017, Fuzhou Rockchip Electronics Co., Ltd
   8  *
   9  * David Wu <david.wu@rock-chips.com>
  10  */
  11
  12 #include <linux/ethtool.h>
  13 #include <linux/kernel.h>
  14 #include <linux/module.h>
  15 #include <linux/mii.h>
  16 #include <linux/netdevice.h>
  17 #include <linux/phy.h>
  18
  19 #define INTERNAL_EPHY_ID                        0x1234d400
  20
  21 #define MII_INTERNAL_CTRL_STATUS                17
  22 #define SMI_ADDR_TSTCNTL                        20
  23 #define SMI_ADDR_TSTREAD1                       21
  24 #define SMI_ADDR_TSTREAD2                       22
  25 #define SMI_ADDR_TSTWRITE                       23
  26 #define MII_SPECIAL_CONTROL_STATUS              31
  27
  28 #define MII_AUTO_MDIX_EN                        BIT(7)
  29 #define MII_MDIX_EN                             BIT(6)
  30
  31 #define MII_SPEED_10                            BIT(2)
  32 #define MII_SPEED_100                           BIT(3)
  33
  34 #define TSTCNTL_RD                              (BIT(15) | BIT(10))
  35 #define TSTCNTL_WR                              (BIT(14) | BIT(10))
  36
  37 #define TSTMODE_ENABLE                          0x400
  38 #define TSTMODE_DISABLE                         0x0
  39
  40 #define WR_ADDR_A7CFG                           0x18
  41
  42 static int rockchip_init_tstmode(struct phy_device *phydev)
  43 {
  44         int ret;
  45
  46         /* Enable access to Analog and DSP register banks */
  47         ret = phy_write(phydev, SMI_ADDR_TSTCNTL, TSTMODE_ENABLE);
  48         if (ret)
  49                 return ret;
  50
  51         ret = phy_write(phydev, SMI_ADDR_TSTCNTL, TSTMODE_DISABLE);
  52         if (ret)
  53                 return ret;
  54
  55         return phy_write(phydev, SMI_ADDR_TSTCNTL, TSTMODE_ENABLE);
  56 }
  57
  58 static int rockchip_close_tstmode(struct phy_device *phydev)
  59 {
  60         /* Back to basic register bank */
  61         return phy_write(phydev, SMI_ADDR_TSTCNTL, TSTMODE_DISABLE);
  62 }
  63
  64 static int rockchip_integrated_phy_analog_init(struct phy_device *phydev)
  65 {
  66         int ret;
  67
  68         ret = rockchip_init_tstmode(phydev);
  69         if (ret)
  70                 return ret;
  71
  72         /*
  73          * Adjust tx amplitude to make sginal better,
  74          * the default value is 0x8.
  75          */
  76         ret = phy_write(phydev, SMI_ADDR_TSTWRITE, 0xB);
  77         if (ret)
  78                 return ret;
  79         ret = phy_write(phydev, SMI_ADDR_TSTCNTL, TSTCNTL_WR | WR_ADDR_A7CFG);
  80         if (ret)
  81                 return ret;
  82
  83         return rockchip_close_tstmode(phydev);
  84 }
  85
  86 static int rockchip_integrated_phy_config_init(struct phy_device *phydev)
  87 {
  88         int val, ret;
  89
  90         /*
  91          * The auto MIDX has linked problem on some board,
  92          * workround to disable auto MDIX.
  93          */
  94         val = phy_read(phydev, MII_INTERNAL_CTRL_STATUS);
  95         if (val < 0)
  96                 return val;
  97         val &= ~MII_AUTO_MDIX_EN;
  98         ret = phy_write(phydev, MII_INTERNAL_CTRL_STATUS, val);
  99         if (ret)
 100                 return ret;
 101
 102         return rockchip_integrated_phy_analog_init(phydev);
 103 }
 104
 105 static void rockchip_link_change_notify(struct phy_device *phydev)
 106 {
 107         /*
 108          * If mode switch happens from 10BT to 100BT, all DSP/AFE
 109          * registers are set to default values. So any AFE/DSP
 110          * registers have to be re-initialized in this case.
 111          */
 112         if (phydev->state == PHY_RUNNING && phydev->speed == SPEED_100) {
 113                 int ret = rockchip_integrated_phy_analog_init(phydev);
 114
 115                 if (ret)
 116                         phydev_err(phydev, "rockchip_integrated_phy_analog_init err: %d.\n",
 117                                    ret);
 118         }
 119 }
 120
 121 static int rockchip_set_polarity(struct phy_device *phydev, int polarity)
 122 {
 123         int reg, err, val;
 124
 125         /* get the current settings */
 126         reg = phy_read(phydev, MII_INTERNAL_CTRL_STATUS);
 127         if (reg < 0)
 128                 return reg;
 129
 130         reg &= ~MII_AUTO_MDIX_EN;
 131         val = reg;
 132         switch (polarity) {
 133         case ETH_TP_MDI:
 134                 val &= ~MII_MDIX_EN;
 135                 break;
 136         case ETH_TP_MDI_X:
 137                 val |= MII_MDIX_EN;
 138                 break;
 139         case ETH_TP_MDI_AUTO:
 140         case ETH_TP_MDI_INVALID:
 141         default:
 142                 return 0;
 143         }
 144
 145         if (val != reg) {
 146                 /* Set the new polarity value in the register */
 147                 err = phy_write(phydev, MII_INTERNAL_CTRL_STATUS, val);
 148                 if (err)
 149                         return err;
 150         }
 151
 152         return 0;
 153 }
 154
 155 static int rockchip_config_aneg(struct phy_device *phydev)
 156 {
 157         int err;
 158
 159         err = rockchip_set_polarity(phydev, phydev->mdix);
 160         if (err < 0)
 161                 return err;
 162
 163         return genphy_config_aneg(phydev);
 164 }
 165
 166 static int rockchip_phy_resume(struct phy_device *phydev)
 167 {
 168         genphy_resume(phydev);
 169
 170         return rockchip_integrated_phy_config_init(phydev);
 171 }
 172
 173 static struct phy_driver rockchip_phy_driver[] = {
 174 {
 175         .phy_id                 = INTERNAL_EPHY_ID,
 176         .phy_id_mask            = 0xfffffff0,
 177         .name                   = "Rockchip integrated EPHY",
 178         /* PHY_BASIC_FEATURES */
 179         .flags                  = 0,
 180         .link_change_notify     = rockchip_link_change_notify,
 181         .soft_reset             = genphy_soft_reset,
 182         .config_init            = rockchip_integrated_phy_config_init,
 183         .config_aneg            = rockchip_config_aneg,
 184         .suspend                = genphy_suspend,
 185         .resume                 = rockchip_phy_resume,
 186 },
 187 };
 188
 189 module_phy_driver(rockchip_phy_driver);
 190
 191 static struct mdio_device_id __maybe_unused rockchip_phy_tbl[] = {
 192         { INTERNAL_EPHY_ID, 0xfffffff0 },
 193         { }
 194 };
 195
 196 MODULE_DEVICE_TABLE(mdio, rockchip_phy_tbl);
 197
 198 MODULE_AUTHOR("David Wu <david.wu@rock-chips.com>");
 199 MODULE_DESCRIPTION("Rockchip Ethernet PHY driver");
 200 MODULE_LICENSE("GPL");