net/phy/motorcomm.c

0001 // SPDX-License-Identifier: GPL-2.0+
0002 /*
0003  * Driver for Motorcomm PHYs
0004  *
0005  * Author: Peter Geis <pgwipeout@gmail.com>
0006  */
0007
0008 #include <linux/kernel.h>
0009 #include <linux/module.h>
0010 #include <linux/phy.h>
0011
0012 #define PHY_ID_YT8511       0x0000010a
0013
0014 #define YT8511_PAGE_SELECT  0x1e
0015 #define YT8511_PAGE     0x1f
0016 #define YT8511_EXT_CLK_GATE 0x0c
0017 #define YT8511_EXT_DELAY_DRIVE  0x0d
0018 #define YT8511_EXT_SLEEP_CTRL   0x27
0019
0020 /* 2b00 25m from pll
0021  * 2b01 25m from xtl *default*
0022  * 2b10 62.m from pll
0023  * 2b11 125m from pll
0024  */
0025 #define YT8511_CLK_125M     (BIT(2) | BIT(1))
0026 #define YT8511_PLLON_SLP    BIT(14)
0027
0028 /* RX Delay enabled = 1.8ns 1000T, 8ns 10/100T */
0029 #define YT8511_DELAY_RX     BIT(0)
0030
0031 /* TX Gig-E Delay is bits 7:4, default 0x5
0032  * TX Fast-E Delay is bits 15:12, default 0xf
0033  * Delay = 150ps * N - 250ps
0034  * On = 2000ps, off = 50ps
0035  */
0036 #define YT8511_DELAY_GE_TX_EN   (0xf << 4)
0037 #define YT8511_DELAY_GE_TX_DIS  (0x2 << 4)
0038 #define YT8511_DELAY_FE_TX_EN   (0xf << 12)
0039 #define YT8511_DELAY_FE_TX_DIS  (0x2 << 12)
0040
0041 static int yt8511_read_page(struct phy_device *phydev)
0042 {
0043     return __phy_read(phydev, YT8511_PAGE_SELECT);
0044 };
0045
0046 static int yt8511_write_page(struct phy_device *phydev, int page)
0047 {
0048     return __phy_write(phydev, YT8511_PAGE_SELECT, page);
0049 };
0050
0051 static int yt8511_config_init(struct phy_device *phydev)
0052 {
0053     int oldpage, ret = 0;
0054     unsigned int ge, fe;
0055
0056     oldpage = phy_select_page(phydev, YT8511_EXT_CLK_GATE);
0057     if (oldpage < 0)
0058         goto err_restore_page;
0059
0060     /* set rgmii delay mode */
0061     switch (phydev->interface) {
0062     case PHY_INTERFACE_MODE_RGMII:
0063         ge = YT8511_DELAY_GE_TX_DIS;
0064         fe = YT8511_DELAY_FE_TX_DIS;
0065         break;
0066     case PHY_INTERFACE_MODE_RGMII_RXID:
0067         ge = YT8511_DELAY_RX | YT8511_DELAY_GE_TX_DIS;
0068         fe = YT8511_DELAY_FE_TX_DIS;
0069         break;
0070     case PHY_INTERFACE_MODE_RGMII_TXID:
0071         ge = YT8511_DELAY_GE_TX_EN;
0072         fe = YT8511_DELAY_FE_TX_EN;
0073         break;
0074     case PHY_INTERFACE_MODE_RGMII_ID:
0075         ge = YT8511_DELAY_RX | YT8511_DELAY_GE_TX_EN;
0076         fe = YT8511_DELAY_FE_TX_EN;
0077         break;
0078     default: /* do not support other modes */
0079         ret = -EOPNOTSUPP;
0080         goto err_restore_page;
0081     }
0082
0083     ret = __phy_modify(phydev, YT8511_PAGE, (YT8511_DELAY_RX | YT8511_DELAY_GE_TX_EN), ge);
0084     if (ret < 0)
0085         goto err_restore_page;
0086
0087     /* set clock mode to 125mhz */
0088     ret = __phy_modify(phydev, YT8511_PAGE, 0, YT8511_CLK_125M);
0089     if (ret < 0)
0090         goto err_restore_page;
0091
0092     /* fast ethernet delay is in a separate page */
0093     ret = __phy_write(phydev, YT8511_PAGE_SELECT, YT8511_EXT_DELAY_DRIVE);
0094     if (ret < 0)
0095         goto err_restore_page;
0096
0097     ret = __phy_modify(phydev, YT8511_PAGE, YT8511_DELAY_FE_TX_EN, fe);
0098     if (ret < 0)
0099         goto err_restore_page;
0100
0101     /* leave pll enabled in sleep */
0102     ret = __phy_write(phydev, YT8511_PAGE_SELECT, YT8511_EXT_SLEEP_CTRL);
0103     if (ret < 0)
0104         goto err_restore_page;
0105
0106     ret = __phy_modify(phydev, YT8511_PAGE, 0, YT8511_PLLON_SLP);
0107     if (ret < 0)
0108         goto err_restore_page;
0109
0110 err_restore_page:
0111     return phy_restore_page(phydev, oldpage, ret);
0112 }
0113
0114 static struct phy_driver motorcomm_phy_drvs[] = {
0115     {
0116         PHY_ID_MATCH_EXACT(PHY_ID_YT8511),
0117         .name       = "YT8511 Gigabit Ethernet",
0118         .config_init    = yt8511_config_init,
0119         .suspend    = genphy_suspend,
0120         .resume     = genphy_resume,
0121         .read_page  = yt8511_read_page,
0122         .write_page = yt8511_write_page,
0123     },
0124 };
0125
0126 module_phy_driver(motorcomm_phy_drvs);
0127
0128 MODULE_DESCRIPTION("Motorcomm PHY driver");
0129 MODULE_AUTHOR("Peter Geis");
0130 MODULE_LICENSE("GPL");
0131
0132 static const struct mdio_device_id __maybe_unused motorcomm_tbl[] = {
0133     { PHY_ID_MATCH_EXACT(PHY_ID_YT8511) },
0134     { /* sentinal */ }
0135 };
0136
0137 MODULE_DEVICE_TABLE(mdio, motorcomm_tbl);