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 14 static int mtk_gephy_read_page(struct phy_device *phydev) 15 { 16 return __phy_read(phydev, MTK_EXT_PAGE_ACCESS); 17 } 18 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 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 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 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