target/linux/mediatek/files-6.6/drivers/net/phy/mediatek-2p5ge.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 #include <linux/bitfield.h>
   3 #include <linux/firmware.h>
   4 #include <linux/module.h>
   5 #include <linux/nvmem-consumer.h>
   6 #include <linux/of_address.h>
   7 #include <linux/of_platform.h>
   8 #include <linux/pinctrl/consumer.h>
   9 #include <linux/phy.h>
  10 #include <linux/pm_domain.h>
  11 #include <linux/pm_runtime.h>
  12
  13 #define MT7988_2P5GE_PMB "mediatek/mt7988/i2p5ge-phy-pmb.bin"
  14
  15 #define MD32_EN                                 BIT(0)
  16 #define PMEM_PRIORITY                           BIT(8)
  17 #define DMEM_PRIORITY                           BIT(16)
  18
  19 #define BASE100T_STATUS_EXTEND                  0x10
  20 #define BASE1000T_STATUS_EXTEND                 0x11
  21 #define EXTEND_CTRL_AND_STATUS                  0x16
  22
  23 #define PHY_AUX_CTRL_STATUS                     0x1d
  24 #define   PHY_AUX_DPX_MASK                      GENMASK(5, 5)
  25 #define   PHY_AUX_SPEED_MASK                    GENMASK(4, 2)
  26
  27 /* Registers on MDIO_MMD_VEND1 */
  28 #define MTK_PHY_LINK_STATUS_MISC                0xa2
  29 #define   MTK_PHY_FDX_ENABLE                    BIT(5)
  30
  31 #define MTK_PHY_LPI_PCS_DSP_CTRL                0x121
  32 #define   MTK_PHY_LPI_SIG_EN_LO_THRESH100_MASK  GENMASK(12, 8)
  33
  34 /* Registers on MDIO_MMD_VEND2 */
  35 #define MTK_PHY_LED0_ON_CTRL                    0x24
  36 #define   MTK_PHY_LED0_ON_LINK1000              BIT(0)
  37 #define   MTK_PHY_LED0_ON_LINK100               BIT(1)
  38 #define   MTK_PHY_LED0_ON_LINK10                BIT(2)
  39 #define   MTK_PHY_LED0_ON_LINK2500              BIT(7)
  40 #define   MTK_PHY_LED0_POLARITY                 BIT(14)
  41
  42 #define MTK_PHY_LED1_ON_CTRL                    0x26
  43 #define   MTK_PHY_LED1_ON_FDX                   BIT(4)
  44 #define   MTK_PHY_LED1_ON_HDX                   BIT(5)
  45 #define   MTK_PHY_LED1_POLARITY                 BIT(14)
  46
  47 #define MTK_EXT_PAGE_ACCESS                     0x1f
  48 #define MTK_PHY_PAGE_STANDARD                   0x0000
  49 #define MTK_PHY_PAGE_EXTENDED_52B5              0x52b5
  50
  51 struct mtk_i2p5ge_phy_priv {
  52         bool fw_loaded;
  53 };
  54
  55 enum {
  56         PHY_AUX_SPD_10 = 0,
  57         PHY_AUX_SPD_100,
  58         PHY_AUX_SPD_1000,
  59         PHY_AUX_SPD_2500,
  60 };
  61
  62 static int mtk_2p5ge_phy_read_page(struct phy_device *phydev)
  63 {
  64         return __phy_read(phydev, MTK_EXT_PAGE_ACCESS);
  65 }
  66
  67 static int mtk_2p5ge_phy_write_page(struct phy_device *phydev, int page)
  68 {
  69         return __phy_write(phydev, MTK_EXT_PAGE_ACCESS, page);
  70 }
  71
  72 static int mt7988_2p5ge_phy_probe(struct phy_device *phydev)
  73 {
  74         struct mtk_i2p5ge_phy_priv *phy_priv;
  75
  76         phy_priv = devm_kzalloc(&phydev->mdio.dev,
  77                                 sizeof(struct mtk_i2p5ge_phy_priv), GFP_KERNEL);
  78         if (!phy_priv)
  79                 return -ENOMEM;
  80
  81         phydev->priv = phy_priv;
  82
  83         return 0;
  84 }
  85
  86 static int mt7988_2p5ge_phy_config_init(struct phy_device *phydev)
  87 {
  88         int ret, i;
  89         const struct firmware *fw;
  90         struct device *dev = &phydev->mdio.dev;
  91         struct device_node *np;
  92         void __iomem *pmb_addr;
  93         void __iomem *md32_en_cfg_base;
  94         struct mtk_i2p5ge_phy_priv *phy_priv = phydev->priv;
  95         u16 reg;
  96         struct pinctrl *pinctrl;
  97
  98         if (!phy_priv->fw_loaded) {
  99                 np = of_find_compatible_node(NULL, NULL, "mediatek,2p5gphy-fw");
 100                 if (!np)
 101                         return -ENOENT;
 102                 pmb_addr = of_iomap(np, 0);
 103                 if (!pmb_addr)
 104                         return -ENOMEM;
 105                 md32_en_cfg_base = of_iomap(np, 1);
 106                 if (!md32_en_cfg_base)
 107                         return -ENOMEM;
 108
 109                 ret = request_firmware(&fw, MT7988_2P5GE_PMB, dev);
 110                 if (ret) {
 111                         dev_err(dev, "failed to load firmware: %s, ret: %d\n",
 112                                 MT7988_2P5GE_PMB, ret);
 113                         return ret;
 114                 }
 115
 116                 reg = readw(md32_en_cfg_base);
 117                 if (reg & MD32_EN) {
 118                         phy_set_bits(phydev, 0, BIT(15));
 119                         usleep_range(10000, 11000);
 120                 }
 121                 phy_set_bits(phydev, 0, BIT(11));
 122
 123                 /* Write magic number to safely stall MCU */
 124                 phy_write_mmd(phydev, MDIO_MMD_VEND1, 0x800e, 0x1100);
 125                 phy_write_mmd(phydev, MDIO_MMD_VEND1, 0x800f, 0x00df);
 126
 127                 for (i = 0; i < fw->size - 1; i += 4)
 128                         writel(*((uint32_t *)(fw->data + i)), pmb_addr + i);
 129                 release_firmware(fw);
 130
 131                 writew(reg & ~MD32_EN, md32_en_cfg_base);
 132                 writew(reg | MD32_EN, md32_en_cfg_base);
 133                 phy_set_bits(phydev, 0, BIT(15));
 134                 dev_info(dev, "Firmware loading/trigger ok.\n");
 135
 136                 phy_priv->fw_loaded = true;
 137         }
 138
 139         /* Setup LED */
 140
 141         /* Set polarity of led0 to active-high for BPI-R4 */
 142         phy_set_bits_mmd(phydev, MDIO_MMD_VEND2, MTK_PHY_LED0_ON_CTRL,
 143                          MTK_PHY_LED0_POLARITY);
 144
 145         phy_set_bits_mmd(phydev, MDIO_MMD_VEND2, MTK_PHY_LED0_ON_CTRL,
 146                          MTK_PHY_LED0_ON_LINK10 |
 147                          MTK_PHY_LED0_ON_LINK100 |
 148                          MTK_PHY_LED0_ON_LINK1000 |
 149                          MTK_PHY_LED0_ON_LINK2500);
 150         phy_set_bits_mmd(phydev, MDIO_MMD_VEND2, MTK_PHY_LED1_ON_CTRL,
 151                          MTK_PHY_LED1_ON_FDX | MTK_PHY_LED1_ON_HDX);
 152
 153         pinctrl = devm_pinctrl_get_select(&phydev->mdio.dev, "i2p5gbe-led");
 154         if (IS_ERR(pinctrl)) {
 155                 dev_err(&phydev->mdio.dev, "Fail to set LED pins!\n");
 156                 return PTR_ERR(pinctrl);
 157         }
 158
 159         phy_modify_mmd(phydev, MDIO_MMD_VEND1, MTK_PHY_LPI_PCS_DSP_CTRL,
 160                        MTK_PHY_LPI_SIG_EN_LO_THRESH100_MASK, 0);
 161
 162         /* Enable 16-bit next page exchange bit if 1000-BT isn't advertizing */
 163         phy_select_page(phydev, MTK_PHY_PAGE_EXTENDED_52B5);
 164         __phy_write(phydev, 0x11, 0xfbfa);
 165         __phy_write(phydev, 0x12, 0xc3);
 166         __phy_write(phydev, 0x10, 0x87f8);
 167         phy_restore_page(phydev, MTK_PHY_PAGE_STANDARD, 0);
 168
 169         return 0;
 170 }
 171
 172 static int mt7988_2p5ge_phy_config_aneg(struct phy_device *phydev)
 173 {
 174         bool changed = false;
 175         u32 adv;
 176         int ret;
 177
 178         if (phydev->autoneg == AUTONEG_DISABLE) {
 179                 /* Configure half duplex with genphy_setup_forced,
 180                  * because genphy_c45_pma_setup_forced does not support.
 181                  */
 182                 return phydev->duplex != DUPLEX_FULL
 183                         ? genphy_setup_forced(phydev)
 184                         : genphy_c45_pma_setup_forced(phydev);
 185         }
 186
 187         ret = genphy_c45_an_config_aneg(phydev);
 188         if (ret < 0)
 189                 return ret;
 190         if (ret > 0)
 191                 changed = true;
 192
 193         adv = linkmode_adv_to_mii_ctrl1000_t(phydev->advertising);
 194         ret = phy_modify_changed(phydev, MII_CTRL1000,
 195                                  ADVERTISE_1000FULL | ADVERTISE_1000HALF,
 196                                  adv);
 197         if (ret < 0)
 198                 return ret;
 199         if (ret > 0)
 200                 changed = true;
 201
 202         return genphy_c45_check_and_restart_aneg(phydev, changed);
 203 }
 204
 205 static int mt7988_2p5ge_phy_get_features(struct phy_device *phydev)
 206 {
 207         int ret;
 208
 209         ret = genphy_read_abilities(phydev);
 210         if (ret)
 211                 return ret;
 212
 213         /* We don't support HDX at MAC layer on mt7988.
 214          * So mask phy's HDX capabilities, too.
 215          */
 216         linkmode_set_bit(ETHTOOL_LINK_MODE_10baseT_Full_BIT,
 217                          phydev->supported);
 218         linkmode_set_bit(ETHTOOL_LINK_MODE_100baseT_Full_BIT,
 219                          phydev->supported);
 220         linkmode_set_bit(ETHTOOL_LINK_MODE_1000baseT_Full_BIT,
 221                          phydev->supported);
 222         linkmode_set_bit(ETHTOOL_LINK_MODE_2500baseT_Full_BIT,
 223                          phydev->supported);
 224         linkmode_set_bit(ETHTOOL_LINK_MODE_Autoneg_BIT, phydev->supported);
 225
 226         return 0;
 227 }
 228
 229 static int mt7988_2p5ge_phy_read_status(struct phy_device *phydev)
 230 {
 231         int ret;
 232
 233         ret = genphy_update_link(phydev);
 234         if (ret)
 235                 return ret;
 236
 237         phydev->speed = SPEED_UNKNOWN;
 238         phydev->duplex = DUPLEX_UNKNOWN;
 239         phydev->pause = 0;
 240         phydev->asym_pause = 0;
 241
 242         if (phydev->autoneg == AUTONEG_ENABLE && phydev->autoneg_complete) {
 243                 ret = genphy_c45_read_lpa(phydev);
 244                 if (ret < 0)
 245                         return ret;
 246
 247                 /* Read the link partner's 1G advertisement */
 248                 ret = phy_read(phydev, MII_STAT1000);
 249                 if (ret < 0)
 250                         return ret;
 251                 mii_stat1000_mod_linkmode_lpa_t(phydev->lp_advertising, ret);
 252         } else if (phydev->autoneg == AUTONEG_DISABLE) {
 253                 linkmode_zero(phydev->lp_advertising);
 254         }
 255
 256         ret = phy_read(phydev, PHY_AUX_CTRL_STATUS);
 257         if (ret < 0)
 258                 return ret;
 259
 260         switch (FIELD_GET(PHY_AUX_SPEED_MASK, ret)) {
 261         case PHY_AUX_SPD_10:
 262                 phydev->speed = SPEED_10;
 263                 break;
 264         case PHY_AUX_SPD_100:
 265                 phydev->speed = SPEED_100;
 266                 break;
 267         case PHY_AUX_SPD_1000:
 268                 phydev->speed = SPEED_1000;
 269                 break;
 270         case PHY_AUX_SPD_2500:
 271                 phydev->speed = SPEED_2500;
 272                 break;
 273         }
 274
 275         ret = phy_read_mmd(phydev, MDIO_MMD_VEND1, MTK_PHY_LINK_STATUS_MISC);
 276         if (ret < 0)
 277                 return ret;
 278
 279         phydev->duplex = (ret & MTK_PHY_FDX_ENABLE) ? DUPLEX_FULL : DUPLEX_HALF;
 280         /* FIXME: The current firmware always enables rate adaptation mode. */
 281         phydev->rate_matching = RATE_MATCH_PAUSE;
 282
 283         return 0;
 284 }
 285
 286 static int mt7988_2p5ge_phy_get_rate_matching(struct phy_device *phydev,
 287                                               phy_interface_t iface)
 288 {
 289         return RATE_MATCH_PAUSE;
 290 }
 291
 292 static struct phy_driver mtk_gephy_driver[] = {
 293         {
 294                 PHY_ID_MATCH_MODEL(0x00339c11),
 295                 .name           = "MediaTek MT798x 2.5GbE PHY",
 296                 .probe          = mt7988_2p5ge_phy_probe,
 297                 .config_init    = mt7988_2p5ge_phy_config_init,
 298                 .config_aneg    = mt7988_2p5ge_phy_config_aneg,
 299                 .get_features   = mt7988_2p5ge_phy_get_features,
 300                 .read_status    = mt7988_2p5ge_phy_read_status,
 301                 .get_rate_matching      = mt7988_2p5ge_phy_get_rate_matching,
 302                 .suspend        = genphy_suspend,
 303                 .resume         = genphy_resume,
 304                 .read_page      = mtk_2p5ge_phy_read_page,
 305                 .write_page     = mtk_2p5ge_phy_write_page,
 306         },
 307 };
 308
 309 module_phy_driver(mtk_gephy_driver);
 310
 311 static struct mdio_device_id __maybe_unused mtk_2p5ge_phy_tbl[] = {
 312         { PHY_ID_MATCH_VENDOR(0x00339c00) },
 313         { }
 314 };
 315
 316 MODULE_DESCRIPTION("MediaTek 2.5Gb Ethernet PHY driver");
 317 MODULE_AUTHOR("SkyLake Huang <SkyLake.Huang@mediatek.com>");
 318 MODULE_LICENSE("GPL");
 319
 320 MODULE_DEVICE_TABLE(mdio, mtk_2p5ge_phy_tbl);
 321 MODULE_FIRMWARE(MT7988_2P5GE_PMB);