1 // SPDX-License-Identifier: GPL-2.0+
2 #include <linux/bitfield.h>
3 #include <linux/module.h>
4 #include <linux/phy.h>
5
6 #define MTK_EXT_PAGE_ACCESS 0x1f
7 #define MTK_PHY_PAGE_STANDARD 0x0000
8 #define MTK_PHY_PAGE_EXTENDED 0x0001
9 #define MTK_PHY_PAGE_EXTENDED_2 0x0002
10 #define MTK_PHY_PAGE_EXTENDED_3 0x0003
11 #define MTK_PHY_PAGE_EXTENDED_2A30 0x2a30
12 #define MTK_PHY_PAGE_EXTENDED_52B5 0x52b5
13
mtk_gephy_read_page(struct phy_device * phydev)14 static int mtk_gephy_read_page(struct phy_device *phydev)
15 {
16 return __phy_read(phydev, MTK_EXT_PAGE_ACCESS);
17 }
18
mtk_gephy_write_page(struct phy_device * phydev,int page)19 static int mtk_gephy_write_page(struct phy_device *phydev, int page)
20 {
21 return __phy_write(phydev, MTK_EXT_PAGE_ACCESS, page);
22 }
23
mtk_gephy_config_init(struct phy_device * phydev)24 static void mtk_gephy_config_init(struct phy_device *phydev)
25 {
26 /* Disable EEE */
27 phy_write_mmd(phydev, MDIO_MMD_AN, MDIO_AN_EEE_ADV, 0);
28
29 /* Enable HW auto downshift */
30 phy_modify_paged(phydev, MTK_PHY_PAGE_EXTENDED, 0x14, 0, BIT(4));
31
32 /* Increase SlvDPSready time */
33 phy_select_page(phydev, MTK_PHY_PAGE_EXTENDED_52B5);
34 __phy_write(phydev, 0x10, 0xafae);
35 __phy_write(phydev, 0x12, 0x2f);
36 __phy_write(phydev, 0x10, 0x8fae);
37 phy_restore_page(phydev, MTK_PHY_PAGE_STANDARD, 0);
38
39 /* Adjust 100_mse_threshold */
40 phy_write_mmd(phydev, MDIO_MMD_VEND1, 0x123, 0xffff);
41
42 /* Disable mcc */
43 phy_write_mmd(phydev, MDIO_MMD_VEND1, 0xa6, 0x300);
44 }
45
mt7530_phy_config_init(struct phy_device * phydev)46 static int mt7530_phy_config_init(struct phy_device *phydev)
47 {
48 mtk_gephy_config_init(phydev);
49
50 /* Increase post_update_timer */
51 phy_write_paged(phydev, MTK_PHY_PAGE_EXTENDED_3, 0x11, 0x4b);
52
53 return 0;
54 }
55
mt7531_phy_config_init(struct phy_device * phydev)56 static int mt7531_phy_config_init(struct phy_device *phydev)
57 {
58 if (phydev->interface != PHY_INTERFACE_MODE_INTERNAL)
59 return -EINVAL;
60
61 mtk_gephy_config_init(phydev);
62
63 /* PHY link down power saving enable */
64 phy_set_bits(phydev, 0x17, BIT(4));
65 phy_clear_bits_mmd(phydev, MDIO_MMD_VEND1, 0xc6, 0x300);
66
67 /* Set TX Pair delay selection */
68 phy_write_mmd(phydev, MDIO_MMD_VEND1, 0x13, 0x404);
69 phy_write_mmd(phydev, MDIO_MMD_VEND1, 0x14, 0x404);
70
71 return 0;
72 }
73
74 static struct phy_driver mtk_gephy_driver[] = {
75 {
76 PHY_ID_MATCH_EXACT(0x03a29412),
77 .name = "MediaTek MT7530 PHY",
78 .config_init = mt7530_phy_config_init,
79 /* Interrupts are handled by the switch, not the PHY
80 * itself.
81 */
82 .config_intr = genphy_no_config_intr,
83 .handle_interrupt = genphy_handle_interrupt_no_ack,
84 .suspend = genphy_suspend,
85 .resume = genphy_resume,
86 .read_page = mtk_gephy_read_page,
87 .write_page = mtk_gephy_write_page,
88 },
89 {
90 PHY_ID_MATCH_EXACT(0x03a29441),
91 .name = "MediaTek MT7531 PHY",
92 .config_init = mt7531_phy_config_init,
93 /* Interrupts are handled by the switch, not the PHY
94 * itself.
95 */
96 .config_intr = genphy_no_config_intr,
97 .handle_interrupt = genphy_handle_interrupt_no_ack,
98 .suspend = genphy_suspend,
99 .resume = genphy_resume,
100 .read_page = mtk_gephy_read_page,
101 .write_page = mtk_gephy_write_page,
102 },
103 };
104
105 module_phy_driver(mtk_gephy_driver);
106
107 static struct mdio_device_id __maybe_unused mtk_gephy_tbl[] = {
108 { PHY_ID_MATCH_VENDOR(0x03a29400) },
109 { }
110 };
111
112 MODULE_DESCRIPTION("MediaTek Gigabit Ethernet PHY driver");
113 MODULE_AUTHOR("DENG, Qingfang <dqfext@gmail.com>");
114 MODULE_LICENSE("GPL");
115
116 MODULE_DEVICE_TABLE(mdio, mtk_gephy_tbl);
117