drivers/net/phy/motorcomm.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * Driver for Motorcomm PHYs
   4  *
   5  * Author: Peter Geis <[email protected]>
   6  */
   7
   8 #include <linux/kernel.h>
   9 #include <linux/module.h>
  10 #include <linux/phy.h>
  11
  12 #define PHY_ID_YT8511           0x0000010a
  13
  14 #define YT8511_PAGE_SELECT      0x1e
  15 #define YT8511_PAGE             0x1f
  16 #define YT8511_EXT_CLK_GATE     0x0c
  17 #define YT8511_EXT_DELAY_DRIVE  0x0d
  18 #define YT8511_EXT_SLEEP_CTRL   0x27
  19
  20 /* 2b00 25m from pll
  21  * 2b01 25m from xtl *default*
  22  * 2b10 62.m from pll
  23  * 2b11 125m from pll
  24  */
  25 #define YT8511_CLK_125M         (BIT(2) | BIT(1))
  26 #define YT8511_PLLON_SLP        BIT(14)
  27
  28 /* RX Delay enabled = 1.8ns 1000T, 8ns 10/100T */
  29 #define YT8511_DELAY_RX         BIT(0)
  30
  31 /* TX Gig-E Delay is bits 7:4, default 0x5
  32  * TX Fast-E Delay is bits 15:12, default 0xf
  33  * Delay = 150ps * N - 250ps
  34  * On = 2000ps, off = 50ps
  35  */
  36 #define YT8511_DELAY_GE_TX_EN   (0xf << 4)
  37 #define YT8511_DELAY_GE_TX_DIS  (0x2 << 4)
  38 #define YT8511_DELAY_FE_TX_EN   (0xf << 12)
  39 #define YT8511_DELAY_FE_TX_DIS  (0x2 << 12)
  40
  41 static int yt8511_read_page(struct phy_device *phydev)
  42 {
  43         return __phy_read(phydev, YT8511_PAGE_SELECT);
  44 };
  45
  46 static int yt8511_write_page(struct phy_device *phydev, int page)
  47 {
  48         return __phy_write(phydev, YT8511_PAGE_SELECT, page);
  49 };
  50
  51 static int yt8511_config_init(struct phy_device *phydev)
  52 {
  53         int oldpage, ret = 0;
  54         unsigned int ge, fe;
  55
  56         oldpage = phy_select_page(phydev, YT8511_EXT_CLK_GATE);
  57         if (oldpage < 0)
  58                 goto err_restore_page;
  59
  60         /* set rgmii delay mode */
  61         switch (phydev->interface) {
  62         case PHY_INTERFACE_MODE_RGMII:
  63                 ge = YT8511_DELAY_GE_TX_DIS;
  64                 fe = YT8511_DELAY_FE_TX_DIS;
  65                 break;
  66         case PHY_INTERFACE_MODE_RGMII_RXID:
  67                 ge = YT8511_DELAY_RX | YT8511_DELAY_GE_TX_DIS;
  68                 fe = YT8511_DELAY_FE_TX_DIS;
  69                 break;
  70         case PHY_INTERFACE_MODE_RGMII_TXID:
  71                 ge = YT8511_DELAY_GE_TX_EN;
  72                 fe = YT8511_DELAY_FE_TX_EN;
  73                 break;
  74         case PHY_INTERFACE_MODE_RGMII_ID:
  75                 ge = YT8511_DELAY_RX | YT8511_DELAY_GE_TX_EN;
  76                 fe = YT8511_DELAY_FE_TX_EN;
  77                 break;
  78         default: /* do not support other modes */
  79                 ret = -EOPNOTSUPP;
  80                 goto err_restore_page;
  81         }
  82
  83         ret = __phy_modify(phydev, YT8511_PAGE, (YT8511_DELAY_RX | YT8511_DELAY_GE_TX_EN), ge);
  84         if (ret < 0)
  85                 goto err_restore_page;
  86
  87         /* set clock mode to 125mhz */
  88         ret = __phy_modify(phydev, YT8511_PAGE, 0, YT8511_CLK_125M);
  89         if (ret < 0)
  90                 goto err_restore_page;
  91
  92         /* fast ethernet delay is in a separate page */
  93         ret = __phy_write(phydev, YT8511_PAGE_SELECT, YT8511_EXT_DELAY_DRIVE);
  94         if (ret < 0)
  95                 goto err_restore_page;
  96
  97         ret = __phy_modify(phydev, YT8511_PAGE, YT8511_DELAY_FE_TX_EN, fe);
  98         if (ret < 0)
  99                 goto err_restore_page;
 100
 101         /* leave pll enabled in sleep */
 102         ret = __phy_write(phydev, YT8511_PAGE_SELECT, YT8511_EXT_SLEEP_CTRL);
 103         if (ret < 0)
 104                 goto err_restore_page;
 105
 106         ret = __phy_modify(phydev, YT8511_PAGE, 0, YT8511_PLLON_SLP);
 107         if (ret < 0)
 108                 goto err_restore_page;
 109
 110 err_restore_page:
 111         return phy_restore_page(phydev, oldpage, ret);
 112 }
 113
 114 static struct phy_driver motorcomm_phy_drvs[] = {
 115         {
 116                 PHY_ID_MATCH_EXACT(PHY_ID_YT8511),
 117                 .name           = "YT8511 Gigabit Ethernet",
 118                 .config_init    = yt8511_config_init,
 119                 .suspend        = genphy_suspend,
 120                 .resume         = genphy_resume,
 121                 .read_page      = yt8511_read_page,
 122                 .write_page     = yt8511_write_page,
 123         },
 124 };
 125
 126 module_phy_driver(motorcomm_phy_drvs);
 127
 128 MODULE_DESCRIPTION("Motorcomm PHY driver");
 129 MODULE_AUTHOR("Peter Geis");
 130 MODULE_LICENSE("GPL");
 131
 132 static const struct mdio_device_id __maybe_unused motorcomm_tbl[] = {
 133         { PHY_ID_MATCH_EXACT(PHY_ID_YT8511) },
 134         { /* sentinal */ }
 135 };
 136
 137 MODULE_DEVICE_TABLE(mdio, motorcomm_tbl);