| // SPDX-License-Identifier: GPL-2.0 |
| /* |
| * Driver for Aquantia PHY |
| * |
| * Author: Shaohui Xie <Shaohui.Xie@freescale.com> |
| * |
| * Copyright 2015 Freescale Semiconductor, Inc. |
| */ |
| |
| #include <linux/kernel.h> |
| #include <linux/module.h> |
| #include <linux/delay.h> |
| #include <linux/mii.h> |
| #include <linux/ethtool.h> |
| #include <linux/phy.h> |
| #include <linux/mdio.h> |
| |
| #define PHY_ID_AQ1202 0x03a1b445 |
| #define PHY_ID_AQ2104 0x03a1b460 |
| #define PHY_ID_AQR105 0x03a1b4a2 |
| #define PHY_ID_AQR106 0x03a1b4d0 |
| #define PHY_ID_AQR107 0x03a1b4e0 |
| #define PHY_ID_AQR405 0x03a1b4b0 |
| |
| static int aquantia_config_aneg(struct phy_device *phydev) |
| { |
| linkmode_copy(phydev->supported, phy_10gbit_features); |
| linkmode_copy(phydev->advertising, phydev->supported); |
| |
| return 0; |
| } |
| |
| static int aquantia_config_intr(struct phy_device *phydev) |
| { |
| int err; |
| |
| if (phydev->interrupts == PHY_INTERRUPT_ENABLED) { |
| err = phy_write_mmd(phydev, MDIO_MMD_AN, 0xd401, 1); |
| if (err < 0) |
| return err; |
| |
| err = phy_write_mmd(phydev, MDIO_MMD_VEND1, 0xff00, 1); |
| if (err < 0) |
| return err; |
| |
| err = phy_write_mmd(phydev, MDIO_MMD_VEND1, 0xff01, 0x1001); |
| } else { |
| err = phy_write_mmd(phydev, MDIO_MMD_AN, 0xd401, 0); |
| if (err < 0) |
| return err; |
| |
| err = phy_write_mmd(phydev, MDIO_MMD_VEND1, 0xff00, 0); |
| if (err < 0) |
| return err; |
| |
| err = phy_write_mmd(phydev, MDIO_MMD_VEND1, 0xff01, 0); |
| } |
| |
| return err; |
| } |
| |
| static int aquantia_ack_interrupt(struct phy_device *phydev) |
| { |
| int reg; |
| |
| reg = phy_read_mmd(phydev, MDIO_MMD_AN, 0xcc01); |
| return (reg < 0) ? reg : 0; |
| } |
| |
| static int aquantia_read_status(struct phy_device *phydev) |
| { |
| int reg; |
| |
| reg = phy_read_mmd(phydev, MDIO_MMD_AN, MDIO_STAT1); |
| reg = phy_read_mmd(phydev, MDIO_MMD_AN, MDIO_STAT1); |
| if (reg & MDIO_STAT1_LSTATUS) |
| phydev->link = 1; |
| else |
| phydev->link = 0; |
| |
| reg = phy_read_mmd(phydev, MDIO_MMD_AN, 0xc800); |
| mdelay(10); |
| reg = phy_read_mmd(phydev, MDIO_MMD_AN, 0xc800); |
| |
| switch (reg) { |
| case 0x9: |
| phydev->speed = SPEED_2500; |
| break; |
| case 0x5: |
| phydev->speed = SPEED_1000; |
| break; |
| case 0x3: |
| phydev->speed = SPEED_100; |
| break; |
| case 0x7: |
| default: |
| phydev->speed = SPEED_10000; |
| break; |
| } |
| phydev->duplex = DUPLEX_FULL; |
| |
| return 0; |
| } |
| |
| static struct phy_driver aquantia_driver[] = { |
| { |
| .phy_id = PHY_ID_AQ1202, |
| .phy_id_mask = 0xfffffff0, |
| .name = "Aquantia AQ1202", |
| .features = PHY_10GBIT_FULL_FEATURES, |
| .aneg_done = genphy_c45_aneg_done, |
| .config_aneg = aquantia_config_aneg, |
| .config_intr = aquantia_config_intr, |
| .ack_interrupt = aquantia_ack_interrupt, |
| .read_status = aquantia_read_status, |
| }, |
| { |
| .phy_id = PHY_ID_AQ2104, |
| .phy_id_mask = 0xfffffff0, |
| .name = "Aquantia AQ2104", |
| .features = PHY_10GBIT_FULL_FEATURES, |
| .aneg_done = genphy_c45_aneg_done, |
| .config_aneg = aquantia_config_aneg, |
| .config_intr = aquantia_config_intr, |
| .ack_interrupt = aquantia_ack_interrupt, |
| .read_status = aquantia_read_status, |
| }, |
| { |
| .phy_id = PHY_ID_AQR105, |
| .phy_id_mask = 0xfffffff0, |
| .name = "Aquantia AQR105", |
| .features = PHY_10GBIT_FULL_FEATURES, |
| .aneg_done = genphy_c45_aneg_done, |
| .config_aneg = aquantia_config_aneg, |
| .config_intr = aquantia_config_intr, |
| .ack_interrupt = aquantia_ack_interrupt, |
| .read_status = aquantia_read_status, |
| }, |
| { |
| .phy_id = PHY_ID_AQR106, |
| .phy_id_mask = 0xfffffff0, |
| .name = "Aquantia AQR106", |
| .features = PHY_10GBIT_FULL_FEATURES, |
| .aneg_done = genphy_c45_aneg_done, |
| .config_aneg = aquantia_config_aneg, |
| .config_intr = aquantia_config_intr, |
| .ack_interrupt = aquantia_ack_interrupt, |
| .read_status = aquantia_read_status, |
| }, |
| { |
| .phy_id = PHY_ID_AQR107, |
| .phy_id_mask = 0xfffffff0, |
| .name = "Aquantia AQR107", |
| .features = PHY_10GBIT_FULL_FEATURES, |
| .aneg_done = genphy_c45_aneg_done, |
| .config_aneg = aquantia_config_aneg, |
| .config_intr = aquantia_config_intr, |
| .ack_interrupt = aquantia_ack_interrupt, |
| .read_status = aquantia_read_status, |
| }, |
| { |
| .phy_id = PHY_ID_AQR405, |
| .phy_id_mask = 0xfffffff0, |
| .name = "Aquantia AQR405", |
| .features = PHY_10GBIT_FULL_FEATURES, |
| .aneg_done = genphy_c45_aneg_done, |
| .config_aneg = aquantia_config_aneg, |
| .config_intr = aquantia_config_intr, |
| .ack_interrupt = aquantia_ack_interrupt, |
| .read_status = aquantia_read_status, |
| }, |
| }; |
| |
| module_phy_driver(aquantia_driver); |
| |
| static struct mdio_device_id __maybe_unused aquantia_tbl[] = { |
| { PHY_ID_AQ1202, 0xfffffff0 }, |
| { PHY_ID_AQ2104, 0xfffffff0 }, |
| { PHY_ID_AQR105, 0xfffffff0 }, |
| { PHY_ID_AQR106, 0xfffffff0 }, |
| { PHY_ID_AQR107, 0xfffffff0 }, |
| { PHY_ID_AQR405, 0xfffffff0 }, |
| { } |
| }; |
| |
| MODULE_DEVICE_TABLE(mdio, aquantia_tbl); |
| |
| MODULE_DESCRIPTION("Aquantia PHY driver"); |
| MODULE_AUTHOR("Shaohui Xie <Shaohui.Xie@freescale.com>"); |
| MODULE_LICENSE("GPL v2"); |