|  | // SPDX-License-Identifier: GPL-2.0 | 
|  | /* Driver for the Texas Instruments DP83TG720 PHY | 
|  | * Copyright (c) 2023 Pengutronix, Oleksij Rempel <kernel@pengutronix.de> | 
|  | */ | 
|  | #include <linux/bitfield.h> | 
|  | #include <linux/ethtool_netlink.h> | 
|  | #include <linux/jiffies.h> | 
|  | #include <linux/kernel.h> | 
|  | #include <linux/module.h> | 
|  | #include <linux/phy.h> | 
|  | #include <linux/random.h> | 
|  |  | 
|  | #include "open_alliance_helpers.h" | 
|  |  | 
|  | /* | 
|  | * DP83TG720 PHY Limitations and Workarounds | 
|  | * | 
|  | * The DP83TG720 1000BASE-T1 PHY has several limitations that require | 
|  | * software-side mitigations. These workarounds are implemented throughout | 
|  | * this driver. This section documents the known issues and their corresponding | 
|  | * mitigation strategies. | 
|  | * | 
|  | * 1. Unreliable Link Detection and Synchronized Reset Deadlock | 
|  | * ------------------------------------------------------------ | 
|  | * After a link loss or during link establishment, the DP83TG720 PHY may fail | 
|  | * to detect or report link status correctly. As of June 2025, no public | 
|  | * errata sheet for the DP83TG720 PHY documents this behavior. | 
|  | * The "DP83TC81x, DP83TG72x Software Implementation Guide" application note | 
|  | * (SNLA404, available at https://www.ti.com/lit/an/snla404/snla404.pdf) | 
|  | * recommends performing a soft restart if polling for a link fails to establish | 
|  | * a connection after 100ms. This procedure is adopted as the workaround for the | 
|  | * observed link detection issue. | 
|  | * | 
|  | * However, in point-to-point setups where both link partners use the same | 
|  | * driver (e.g. Linux on both sides), a synchronized reset pattern may emerge. | 
|  | * This leads to a deadlock, where both PHYs reset at the same time and | 
|  | * continuously miss each other during auto-negotiation. | 
|  | * | 
|  | * To address this, the reset procedure includes two components: | 
|  | * | 
|  | * - A **fixed minimum delay of 1ms** after a hardware reset. The datasheet | 
|  | *   "DP83TG720S-Q1 1000BASE-T1 Automotive Ethernet PHY with SGMII and RGMII" | 
|  | *   specifies this as the "Post reset stabilization-time prior to MDC preamble | 
|  | *   for register access" (T6.2), ensuring the PHY is ready for MDIO | 
|  | *   operations. | 
|  | * | 
|  | * - An **additional asymmetric delay**, empirically chosen based on | 
|  | *   master/slave role. This reduces the risk of synchronized resets on both | 
|  | *   link partners. Values are selected to avoid periodic overlap and ensure | 
|  | *   the link is re-established within a few cycles. | 
|  | * | 
|  | * The functions that implement this logic are: | 
|  | * - dp83tg720_soft_reset() | 
|  | * - dp83tg720_get_next_update_time() | 
|  | * | 
|  | * 2. Polling-Based Link Detection and IRQ Support | 
|  | * ----------------------------------------------- | 
|  | * Due to the PHY-specific limitation described in section 1, link-up events | 
|  | * cannot be reliably detected via interrupts on the DP83TG720. Therefore, | 
|  | * polling is required to detect transitions from link-down to link-up. | 
|  | * | 
|  | * While link-down events *can* be detected via IRQs on this PHY, this driver | 
|  | * currently does **not** implement interrupt support. As a result, all link | 
|  | * state changes must be detected using polling. | 
|  | * | 
|  | * Polling behavior: | 
|  | * - When the link is up: slow polling (e.g. 1s). | 
|  | * - When the link just went down: fast polling for a short time. | 
|  | * - When the link stays down: fallback to slow polling. | 
|  | * | 
|  | * This design balances responsiveness and CPU usage. It sacrifices fast link-up | 
|  | * times in cases where the link is expected to remain down for extended periods, | 
|  | * assuming that such systems do not require immediate reactivity. | 
|  | */ | 
|  |  | 
|  | /* | 
|  | * DP83TG720S_POLL_ACTIVE_LINK - Polling interval in milliseconds when the link | 
|  | *				 is active. | 
|  | * DP83TG720S_POLL_NO_LINK     - Polling interval in milliseconds when the | 
|  | *				 link is down. | 
|  | * DP83TG720S_FAST_POLL_DURATION_MS - Timeout in milliseconds for no-link | 
|  | *				 polling after which polling interval is | 
|  | *				 increased. | 
|  | * DP83TG720S_POLL_SLOW	       - Slow polling interval when there is no | 
|  | *				 link for a prolongued period. | 
|  | * DP83TG720S_RESET_DELAY_MS_MASTER - Delay after a reset before attempting | 
|  | *				 to establish a link again for master phy. | 
|  | * DP83TG720S_RESET_DELAY_MS_SLAVE  - Delay after a reset before attempting | 
|  | *				 to establish a link again for slave phy. | 
|  | * | 
|  | * These values are not documented or officially recommended by the vendor but | 
|  | * were determined through empirical testing. They achieve a good balance in | 
|  | * minimizing the number of reset retries while ensuring reliable link recovery | 
|  | * within a reasonable timeframe. | 
|  | */ | 
|  | #define DP83TG720S_POLL_ACTIVE_LINK		421 | 
|  | #define DP83TG720S_POLL_NO_LINK			149 | 
|  | #define DP83TG720S_FAST_POLL_DURATION_MS	6000 | 
|  | #define DP83TG720S_POLL_SLOW			1117 | 
|  | #define DP83TG720S_RESET_DELAY_MS_MASTER	97 | 
|  | #define DP83TG720S_RESET_DELAY_MS_SLAVE		149 | 
|  |  | 
|  | #define DP83TG720S_PHY_ID			0x2000a284 | 
|  |  | 
|  | /* MDIO_MMD_VEND2 registers */ | 
|  | #define DP83TG720S_MII_REG_10			0x10 | 
|  | #define DP83TG720S_STS_MII_INT			BIT(7) | 
|  | #define DP83TG720S_LINK_STATUS			BIT(0) | 
|  |  | 
|  | /* TDR Configuration Register (0x1E) */ | 
|  | #define DP83TG720S_TDR_CFG			0x1e | 
|  | /* 1b = TDR start, 0b = No TDR */ | 
|  | #define DP83TG720S_TDR_START			BIT(15) | 
|  | /* 1b = TDR auto on link down, 0b = Manual TDR start */ | 
|  | #define DP83TG720S_CFG_TDR_AUTO_RUN		BIT(14) | 
|  | /* 1b = TDR done, 0b = TDR in progress */ | 
|  | #define DP83TG720S_TDR_DONE			BIT(1) | 
|  | /* 1b = TDR fail, 0b = TDR success */ | 
|  | #define DP83TG720S_TDR_FAIL			BIT(0) | 
|  |  | 
|  | #define DP83TG720S_PHY_RESET			0x1f | 
|  | #define DP83TG720S_HW_RESET			BIT(15) | 
|  |  | 
|  | #define DP83TG720S_LPS_CFG3			0x18c | 
|  | /* Power modes are documented as bit fields but used as values */ | 
|  | /* Power Mode 0 is Normal mode */ | 
|  | #define DP83TG720S_LPS_CFG3_PWR_MODE_0		BIT(0) | 
|  |  | 
|  | /* Open Aliance 1000BaseT1 compatible HDD.TDR Fault Status Register */ | 
|  | #define DP83TG720S_TDR_FAULT_STATUS		0x30f | 
|  |  | 
|  | /* Register 0x0301: TDR Configuration 2 */ | 
|  | #define DP83TG720S_TDR_CFG2			0x301 | 
|  |  | 
|  | /* Register 0x0303: TDR Configuration 3 */ | 
|  | #define DP83TG720S_TDR_CFG3			0x303 | 
|  |  | 
|  | /* Register 0x0304: TDR Configuration 4 */ | 
|  | #define DP83TG720S_TDR_CFG4			0x304 | 
|  |  | 
|  | /* Register 0x0405: Unknown Register */ | 
|  | #define DP83TG720S_UNKNOWN_0405			0x405 | 
|  |  | 
|  | #define DP83TG720S_LINK_QUAL_3			0x547 | 
|  | #define DP83TG720S_LINK_LOSS_CNT_MASK		GENMASK(15, 10) | 
|  |  | 
|  | /* Register 0x0576: TDR Master Link Down Control */ | 
|  | #define DP83TG720S_TDR_MASTER_LINK_DOWN		0x576 | 
|  |  | 
|  | #define DP83TG720S_RGMII_DELAY_CTRL		0x602 | 
|  | /* In RGMII mode, Enable or disable the internal delay for RXD */ | 
|  | #define DP83TG720S_RGMII_RX_CLK_SEL		BIT(1) | 
|  | /* In RGMII mode, Enable or disable the internal delay for TXD */ | 
|  | #define DP83TG720S_RGMII_TX_CLK_SEL		BIT(0) | 
|  |  | 
|  | /* | 
|  | * DP83TG720S_PKT_STAT_x registers correspond to similarly named registers | 
|  | * in the datasheet (PKT_STAT_1 through PKT_STAT_6). These registers store | 
|  | * 32-bit or 16-bit counters for TX and RX statistics and must be read in | 
|  | * sequence to ensure the counters are cleared correctly. | 
|  | * | 
|  | * - DP83TG720S_PKT_STAT_1: Contains TX packet count bits [15:0]. | 
|  | * - DP83TG720S_PKT_STAT_2: Contains TX packet count bits [31:16]. | 
|  | * - DP83TG720S_PKT_STAT_3: Contains TX error packet count. | 
|  | * - DP83TG720S_PKT_STAT_4: Contains RX packet count bits [15:0]. | 
|  | * - DP83TG720S_PKT_STAT_5: Contains RX packet count bits [31:16]. | 
|  | * - DP83TG720S_PKT_STAT_6: Contains RX error packet count. | 
|  | * | 
|  | * Keeping the register names as defined in the datasheet helps maintain | 
|  | * clarity and alignment with the documentation. | 
|  | */ | 
|  | #define DP83TG720S_PKT_STAT_1			0x639 | 
|  | #define DP83TG720S_PKT_STAT_2			0x63a | 
|  | #define DP83TG720S_PKT_STAT_3			0x63b | 
|  | #define DP83TG720S_PKT_STAT_4			0x63c | 
|  | #define DP83TG720S_PKT_STAT_5			0x63d | 
|  | #define DP83TG720S_PKT_STAT_6			0x63e | 
|  |  | 
|  | /* Register 0x083F: Unknown Register */ | 
|  | #define DP83TG720S_UNKNOWN_083F			0x83f | 
|  |  | 
|  | #define DP83TG720S_SQI_REG_1			0x871 | 
|  | #define DP83TG720S_SQI_OUT_WORST		GENMASK(7, 5) | 
|  | #define DP83TG720S_SQI_OUT			GENMASK(3, 1) | 
|  |  | 
|  | #define DP83TG720_SQI_MAX			7 | 
|  |  | 
|  | struct dp83tg720_stats { | 
|  | u64 link_loss_cnt; | 
|  | u64 tx_pkt_cnt; | 
|  | u64 tx_err_pkt_cnt; | 
|  | u64 rx_pkt_cnt; | 
|  | u64 rx_err_pkt_cnt; | 
|  | }; | 
|  |  | 
|  | struct dp83tg720_priv { | 
|  | struct dp83tg720_stats stats; | 
|  | unsigned long last_link_down_jiffies; | 
|  | }; | 
|  |  | 
|  | /** | 
|  | * dp83tg720_update_stats - Update the PHY statistics for the DP83TD510 PHY. | 
|  | * @phydev: Pointer to the phy_device structure. | 
|  | * | 
|  | * The function reads the PHY statistics registers and updates the statistics | 
|  | * structure. | 
|  | * | 
|  | * Returns: 0 on success or a negative error code on failure. | 
|  | */ | 
|  | static int dp83tg720_update_stats(struct phy_device *phydev) | 
|  | { | 
|  | struct dp83tg720_priv *priv = phydev->priv; | 
|  | u32 count; | 
|  | int ret; | 
|  |  | 
|  | /* Read the link loss count */ | 
|  | ret = phy_read_mmd(phydev, MDIO_MMD_VEND2, DP83TG720S_LINK_QUAL_3); | 
|  | if (ret < 0) | 
|  | return ret; | 
|  | /* link_loss_cnt */ | 
|  | count = FIELD_GET(DP83TG720S_LINK_LOSS_CNT_MASK, ret); | 
|  | priv->stats.link_loss_cnt += count; | 
|  |  | 
|  | /* The DP83TG720S_PKT_STAT registers are divided into two groups: | 
|  | * - Group 1 (TX stats): DP83TG720S_PKT_STAT_1 to DP83TG720S_PKT_STAT_3 | 
|  | * - Group 2 (RX stats): DP83TG720S_PKT_STAT_4 to DP83TG720S_PKT_STAT_6 | 
|  | * | 
|  | * Registers in each group are cleared only after reading them in a | 
|  | * plain sequence (e.g., 1, 2, 3 for Group 1 or 4, 5, 6 for Group 2). | 
|  | * Any deviation from the sequence, such as reading 1, 2, 1, 2, 3, will | 
|  | * prevent the group from being cleared. Additionally, the counters | 
|  | * for a group are frozen as soon as the first register in that group | 
|  | * is accessed. | 
|  | */ | 
|  | ret = phy_read_mmd(phydev, MDIO_MMD_VEND2, DP83TG720S_PKT_STAT_1); | 
|  | if (ret < 0) | 
|  | return ret; | 
|  | /* tx_pkt_cnt_15_0 */ | 
|  | count = ret; | 
|  |  | 
|  | ret = phy_read_mmd(phydev, MDIO_MMD_VEND2, DP83TG720S_PKT_STAT_2); | 
|  | if (ret < 0) | 
|  | return ret; | 
|  | /* tx_pkt_cnt_31_16 */ | 
|  | count |= ret << 16; | 
|  | priv->stats.tx_pkt_cnt += count; | 
|  |  | 
|  | ret = phy_read_mmd(phydev, MDIO_MMD_VEND2, DP83TG720S_PKT_STAT_3); | 
|  | if (ret < 0) | 
|  | return ret; | 
|  | /* tx_err_pkt_cnt */ | 
|  | priv->stats.tx_err_pkt_cnt += ret; | 
|  |  | 
|  | ret = phy_read_mmd(phydev, MDIO_MMD_VEND2, DP83TG720S_PKT_STAT_4); | 
|  | if (ret < 0) | 
|  | return ret; | 
|  | /* rx_pkt_cnt_15_0 */ | 
|  | count = ret; | 
|  |  | 
|  | ret = phy_read_mmd(phydev, MDIO_MMD_VEND2, DP83TG720S_PKT_STAT_5); | 
|  | if (ret < 0) | 
|  | return ret; | 
|  | /* rx_pkt_cnt_31_16 */ | 
|  | count |= ret << 16; | 
|  | priv->stats.rx_pkt_cnt += count; | 
|  |  | 
|  | ret = phy_read_mmd(phydev, MDIO_MMD_VEND2, DP83TG720S_PKT_STAT_6); | 
|  | if (ret < 0) | 
|  | return ret; | 
|  | /* rx_err_pkt_cnt */ | 
|  | priv->stats.rx_err_pkt_cnt += ret; | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static int dp83tg720_soft_reset(struct phy_device *phydev) | 
|  | { | 
|  | int ret; | 
|  |  | 
|  | ret = phy_write(phydev, DP83TG720S_PHY_RESET, DP83TG720S_HW_RESET); | 
|  | if (ret) | 
|  | return ret; | 
|  |  | 
|  | /* Include mandatory MDC-access delay (1ms) + extra asymmetric delay to | 
|  | * avoid synchronized reset deadlock. See section 1 in the top-of-file | 
|  | * comment block. | 
|  | */ | 
|  | if (phydev->master_slave_state == MASTER_SLAVE_STATE_SLAVE) | 
|  | msleep(DP83TG720S_RESET_DELAY_MS_SLAVE); | 
|  | else | 
|  | msleep(DP83TG720S_RESET_DELAY_MS_MASTER); | 
|  |  | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | static void dp83tg720_get_link_stats(struct phy_device *phydev, | 
|  | struct ethtool_link_ext_stats *link_stats) | 
|  | { | 
|  | struct dp83tg720_priv *priv = phydev->priv; | 
|  |  | 
|  | link_stats->link_down_events = priv->stats.link_loss_cnt; | 
|  | } | 
|  |  | 
|  | static void dp83tg720_get_phy_stats(struct phy_device *phydev, | 
|  | struct ethtool_eth_phy_stats *eth_stats, | 
|  | struct ethtool_phy_stats *stats) | 
|  | { | 
|  | struct dp83tg720_priv *priv = phydev->priv; | 
|  |  | 
|  | stats->tx_packets = priv->stats.tx_pkt_cnt; | 
|  | stats->tx_errors = priv->stats.tx_err_pkt_cnt; | 
|  | stats->rx_packets = priv->stats.rx_pkt_cnt; | 
|  | stats->rx_errors = priv->stats.rx_err_pkt_cnt; | 
|  | } | 
|  |  | 
|  | /** | 
|  | * dp83tg720_cable_test_start - Start the cable test for the DP83TG720 PHY. | 
|  | * @phydev: Pointer to the phy_device structure. | 
|  | * | 
|  | * This sequence is based on the documented procedure for the DP83TG720 PHY. | 
|  | * | 
|  | * Returns: 0 on success, a negative error code on failure. | 
|  | */ | 
|  | static int dp83tg720_cable_test_start(struct phy_device *phydev) | 
|  | { | 
|  | int ret; | 
|  |  | 
|  | /* Initialize the PHY to run the TDR test as described in the | 
|  | * "DP83TG720S-Q1: Configuring for Open Alliance Specification | 
|  | * Compliance (Rev. B)" application note. | 
|  | * Most of the registers are not documented. Some of register names | 
|  | * are guessed by comparing the register offsets with the DP83TD510E. | 
|  | */ | 
|  |  | 
|  | /* Force master link down */ | 
|  | ret = phy_set_bits_mmd(phydev, MDIO_MMD_VEND2, | 
|  | DP83TG720S_TDR_MASTER_LINK_DOWN, 0x0400); | 
|  | if (ret) | 
|  | return ret; | 
|  |  | 
|  | ret = phy_write_mmd(phydev, MDIO_MMD_VEND2, DP83TG720S_TDR_CFG2, | 
|  | 0xa008); | 
|  | if (ret) | 
|  | return ret; | 
|  |  | 
|  | ret = phy_write_mmd(phydev, MDIO_MMD_VEND2, DP83TG720S_TDR_CFG3, | 
|  | 0x0928); | 
|  | if (ret) | 
|  | return ret; | 
|  |  | 
|  | ret = phy_write_mmd(phydev, MDIO_MMD_VEND2, DP83TG720S_TDR_CFG4, | 
|  | 0x0004); | 
|  | if (ret) | 
|  | return ret; | 
|  |  | 
|  | ret = phy_write_mmd(phydev, MDIO_MMD_VEND2, DP83TG720S_UNKNOWN_0405, | 
|  | 0x6400); | 
|  | if (ret) | 
|  | return ret; | 
|  |  | 
|  | ret = phy_write_mmd(phydev, MDIO_MMD_VEND2, DP83TG720S_UNKNOWN_083F, | 
|  | 0x3003); | 
|  | if (ret) | 
|  | return ret; | 
|  |  | 
|  | /* Start the TDR */ | 
|  | ret = phy_set_bits_mmd(phydev, MDIO_MMD_VEND2, DP83TG720S_TDR_CFG, | 
|  | DP83TG720S_TDR_START); | 
|  | if (ret) | 
|  | return ret; | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | /** | 
|  | * dp83tg720_cable_test_get_status - Get the status of the cable test for the | 
|  | *                                   DP83TG720 PHY. | 
|  | * @phydev: Pointer to the phy_device structure. | 
|  | * @finished: Pointer to a boolean that indicates whether the test is finished. | 
|  | * | 
|  | * The function sets the @finished flag to true if the test is complete. | 
|  | * | 
|  | * Returns: 0 on success or a negative error code on failure. | 
|  | */ | 
|  | static int dp83tg720_cable_test_get_status(struct phy_device *phydev, | 
|  | bool *finished) | 
|  | { | 
|  | int ret, stat; | 
|  |  | 
|  | *finished = false; | 
|  |  | 
|  | /* Read the TDR status */ | 
|  | ret = phy_read_mmd(phydev, MDIO_MMD_VEND2, DP83TG720S_TDR_CFG); | 
|  | if (ret < 0) | 
|  | return ret; | 
|  |  | 
|  | /* Check if the TDR test is done */ | 
|  | if (!(ret & DP83TG720S_TDR_DONE)) | 
|  | return 0; | 
|  |  | 
|  | /* Check for TDR test failure */ | 
|  | if (!(ret & DP83TG720S_TDR_FAIL)) { | 
|  | int location; | 
|  |  | 
|  | /* Read fault status */ | 
|  | ret = phy_read_mmd(phydev, MDIO_MMD_VEND2, | 
|  | DP83TG720S_TDR_FAULT_STATUS); | 
|  | if (ret < 0) | 
|  | return ret; | 
|  |  | 
|  | /* Get fault type */ | 
|  | stat = oa_1000bt1_get_ethtool_cable_result_code(ret); | 
|  |  | 
|  | /* Determine fault location */ | 
|  | location = oa_1000bt1_get_tdr_distance(ret); | 
|  | if (location > 0) | 
|  | ethnl_cable_test_fault_length(phydev, | 
|  | ETHTOOL_A_CABLE_PAIR_A, | 
|  | location); | 
|  | } else { | 
|  | /* Active link partner or other issues */ | 
|  | stat = ETHTOOL_A_CABLE_RESULT_CODE_UNSPEC; | 
|  | } | 
|  |  | 
|  | *finished = true; | 
|  |  | 
|  | ethnl_cable_test_result(phydev, ETHTOOL_A_CABLE_PAIR_A, stat); | 
|  |  | 
|  | /* save the current stats before resetting the PHY */ | 
|  | ret = dp83tg720_update_stats(phydev); | 
|  | if (ret) | 
|  | return ret; | 
|  |  | 
|  | return phy_init_hw(phydev); | 
|  | } | 
|  |  | 
|  | static int dp83tg720_config_aneg(struct phy_device *phydev) | 
|  | { | 
|  | int ret; | 
|  |  | 
|  | /* Autoneg is not supported and this PHY supports only one speed. | 
|  | * We need to care only about master/slave configuration if it was | 
|  | * changed by user. | 
|  | */ | 
|  | ret = genphy_c45_pma_baset1_setup_master_slave(phydev); | 
|  | if (ret) | 
|  | return ret; | 
|  |  | 
|  | /* Re-read role configuration to make changes visible even if | 
|  | * the link is in administrative down state. | 
|  | */ | 
|  | return genphy_c45_pma_baset1_read_master_slave(phydev); | 
|  | } | 
|  |  | 
|  | static int dp83tg720_read_status(struct phy_device *phydev) | 
|  | { | 
|  | u16 phy_sts; | 
|  | int ret; | 
|  |  | 
|  | phydev->pause = 0; | 
|  | phydev->asym_pause = 0; | 
|  |  | 
|  | /* Most of Clause 45 registers are not present, so we can't use | 
|  | * genphy_c45_read_status() here. | 
|  | */ | 
|  | phy_sts = phy_read(phydev, DP83TG720S_MII_REG_10); | 
|  | phydev->link = !!(phy_sts & DP83TG720S_LINK_STATUS); | 
|  | if (!phydev->link) { | 
|  | /* save the current stats before resetting the PHY */ | 
|  | ret = dp83tg720_update_stats(phydev); | 
|  | if (ret) | 
|  | return ret; | 
|  |  | 
|  | /* According to the "DP83TC81x, DP83TG72x Software | 
|  | * Implementation Guide", the PHY needs to be reset after a | 
|  | * link loss or if no link is created after at least 100ms. | 
|  | */ | 
|  | ret = phy_init_hw(phydev); | 
|  | if (ret) | 
|  | return ret; | 
|  |  | 
|  | /* After HW reset we need to restore master/slave configuration. | 
|  | * genphy_c45_pma_baset1_read_master_slave() call will be done | 
|  | * by the dp83tg720_config_aneg() function. | 
|  | */ | 
|  | ret = dp83tg720_config_aneg(phydev); | 
|  | if (ret) | 
|  | return ret; | 
|  |  | 
|  | phydev->speed = SPEED_UNKNOWN; | 
|  | phydev->duplex = DUPLEX_UNKNOWN; | 
|  | } else { | 
|  | /* PMA/PMD control 1 register (Register 1.0) is present, but it | 
|  | * doesn't contain the link speed information. | 
|  | * So genphy_c45_read_pma() can't be used here. | 
|  | */ | 
|  | ret = genphy_c45_pma_baset1_read_master_slave(phydev); | 
|  | if (ret) | 
|  | return ret; | 
|  |  | 
|  | phydev->duplex = DUPLEX_FULL; | 
|  | phydev->speed = SPEED_1000; | 
|  | } | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static int dp83tg720_get_sqi(struct phy_device *phydev) | 
|  | { | 
|  | int ret; | 
|  |  | 
|  | if (!phydev->link) | 
|  | return 0; | 
|  |  | 
|  | ret = phy_read_mmd(phydev, MDIO_MMD_VEND2, DP83TG720S_SQI_REG_1); | 
|  | if (ret < 0) | 
|  | return ret; | 
|  |  | 
|  | return FIELD_GET(DP83TG720S_SQI_OUT, ret); | 
|  | } | 
|  |  | 
|  | static int dp83tg720_get_sqi_max(struct phy_device *phydev) | 
|  | { | 
|  | return DP83TG720_SQI_MAX; | 
|  | } | 
|  |  | 
|  | static int dp83tg720_config_rgmii_delay(struct phy_device *phydev) | 
|  | { | 
|  | u16 rgmii_delay_mask; | 
|  | u16 rgmii_delay = 0; | 
|  |  | 
|  | switch (phydev->interface) { | 
|  | case PHY_INTERFACE_MODE_RGMII: | 
|  | rgmii_delay = 0; | 
|  | break; | 
|  | case PHY_INTERFACE_MODE_RGMII_ID: | 
|  | rgmii_delay = DP83TG720S_RGMII_RX_CLK_SEL | | 
|  | DP83TG720S_RGMII_TX_CLK_SEL; | 
|  | break; | 
|  | case PHY_INTERFACE_MODE_RGMII_RXID: | 
|  | rgmii_delay = DP83TG720S_RGMII_RX_CLK_SEL; | 
|  | break; | 
|  | case PHY_INTERFACE_MODE_RGMII_TXID: | 
|  | rgmii_delay = DP83TG720S_RGMII_TX_CLK_SEL; | 
|  | break; | 
|  | default: | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | rgmii_delay_mask = DP83TG720S_RGMII_RX_CLK_SEL | | 
|  | DP83TG720S_RGMII_TX_CLK_SEL; | 
|  |  | 
|  | return phy_modify_mmd(phydev, MDIO_MMD_VEND2, | 
|  | DP83TG720S_RGMII_DELAY_CTRL, rgmii_delay_mask, | 
|  | rgmii_delay); | 
|  | } | 
|  |  | 
|  | static int dp83tg720_config_init(struct phy_device *phydev) | 
|  | { | 
|  | int ret; | 
|  |  | 
|  | /* Reset the PHY to recover from a link failure */ | 
|  | ret = dp83tg720_soft_reset(phydev); | 
|  | if (ret) | 
|  | return ret; | 
|  |  | 
|  | if (phy_interface_is_rgmii(phydev)) { | 
|  | ret = dp83tg720_config_rgmii_delay(phydev); | 
|  | if (ret) | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | /* In case the PHY is bootstrapped in managed mode, we need to | 
|  | * wake it. | 
|  | */ | 
|  | ret = phy_write_mmd(phydev, MDIO_MMD_VEND2, DP83TG720S_LPS_CFG3, | 
|  | DP83TG720S_LPS_CFG3_PWR_MODE_0); | 
|  | if (ret) | 
|  | return ret; | 
|  |  | 
|  | /* Make role configuration visible for ethtool on init and after | 
|  | * rest. | 
|  | */ | 
|  | return genphy_c45_pma_baset1_read_master_slave(phydev); | 
|  | } | 
|  |  | 
|  | static int dp83tg720_probe(struct phy_device *phydev) | 
|  | { | 
|  | struct device *dev = &phydev->mdio.dev; | 
|  | struct dp83tg720_priv *priv; | 
|  |  | 
|  | priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL); | 
|  | if (!priv) | 
|  | return -ENOMEM; | 
|  |  | 
|  | phydev->priv = priv; | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | /** | 
|  | * dp83tg720_get_next_update_time - Return next polling interval for PHY state | 
|  | * @phydev: Pointer to the phy_device structure | 
|  | * | 
|  | * Implements adaptive polling interval logic depending on link state and | 
|  | * downtime duration. See the "2. Polling-Based Link Detection and IRQ Support" | 
|  | * section at the top of this file for details. | 
|  | * | 
|  | * Return: Time (in jiffies) until the next poll | 
|  | */ | 
|  | static unsigned int dp83tg720_get_next_update_time(struct phy_device *phydev) | 
|  | { | 
|  | struct dp83tg720_priv *priv = phydev->priv; | 
|  | unsigned int next_time_jiffies; | 
|  |  | 
|  | if (phydev->link) { | 
|  | priv->last_link_down_jiffies = 0; | 
|  |  | 
|  | /* When the link is up, use a slower interval (in jiffies) */ | 
|  | next_time_jiffies = | 
|  | msecs_to_jiffies(DP83TG720S_POLL_ACTIVE_LINK); | 
|  | } else { | 
|  | unsigned long now = jiffies; | 
|  |  | 
|  | if (!priv->last_link_down_jiffies) | 
|  | priv->last_link_down_jiffies = now; | 
|  |  | 
|  | if (time_before(now, priv->last_link_down_jiffies + | 
|  | msecs_to_jiffies(DP83TG720S_FAST_POLL_DURATION_MS))) { | 
|  | /* Link recently went down: fast polling */ | 
|  | next_time_jiffies = | 
|  | msecs_to_jiffies(DP83TG720S_POLL_NO_LINK); | 
|  | } else { | 
|  | /* Link has been down for a while: slow polling */ | 
|  | next_time_jiffies = | 
|  | msecs_to_jiffies(DP83TG720S_POLL_SLOW); | 
|  | } | 
|  | } | 
|  |  | 
|  | /* Ensure the polling time is at least one jiffy */ | 
|  | return max(next_time_jiffies, 1U); | 
|  | } | 
|  |  | 
|  | static struct phy_driver dp83tg720_driver[] = { | 
|  | { | 
|  | PHY_ID_MATCH_MODEL(DP83TG720S_PHY_ID), | 
|  | .name		= "TI DP83TG720S", | 
|  |  | 
|  | .flags          = PHY_POLL_CABLE_TEST, | 
|  | .probe		= dp83tg720_probe, | 
|  | .soft_reset	= dp83tg720_soft_reset, | 
|  | .config_aneg	= dp83tg720_config_aneg, | 
|  | .read_status	= dp83tg720_read_status, | 
|  | .get_features	= genphy_c45_pma_read_ext_abilities, | 
|  | .config_init	= dp83tg720_config_init, | 
|  | .get_sqi	= dp83tg720_get_sqi, | 
|  | .get_sqi_max	= dp83tg720_get_sqi_max, | 
|  | .cable_test_start = dp83tg720_cable_test_start, | 
|  | .cable_test_get_status = dp83tg720_cable_test_get_status, | 
|  | .get_link_stats	= dp83tg720_get_link_stats, | 
|  | .get_phy_stats	= dp83tg720_get_phy_stats, | 
|  | .update_stats	= dp83tg720_update_stats, | 
|  | .get_next_update_time = dp83tg720_get_next_update_time, | 
|  |  | 
|  | .suspend	= genphy_suspend, | 
|  | .resume		= genphy_resume, | 
|  | } }; | 
|  | module_phy_driver(dp83tg720_driver); | 
|  |  | 
|  | static const struct mdio_device_id __maybe_unused dp83tg720_tbl[] = { | 
|  | { PHY_ID_MATCH_MODEL(DP83TG720S_PHY_ID) }, | 
|  | { } | 
|  | }; | 
|  | MODULE_DEVICE_TABLE(mdio, dp83tg720_tbl); | 
|  |  | 
|  | MODULE_DESCRIPTION("Texas Instruments DP83TG720S PHY driver"); | 
|  | MODULE_AUTHOR("Oleksij Rempel <kernel@pengutronix.de>"); | 
|  | MODULE_LICENSE("GPL"); |