2023-12-12 06:41:44 +01:00
|
|
|
// 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>
|
2024-08-12 09:30:46 +02:00
|
|
|
#include <linux/ethtool_netlink.h>
|
2025-02-10 09:23:58 +01:00
|
|
|
#include <linux/jiffies.h>
|
2023-12-12 06:41:44 +01:00
|
|
|
#include <linux/kernel.h>
|
|
|
|
#include <linux/module.h>
|
|
|
|
#include <linux/phy.h>
|
2025-02-10 09:23:58 +01:00
|
|
|
#include <linux/random.h>
|
2023-12-12 06:41:44 +01:00
|
|
|
|
2024-08-12 09:30:46 +02:00
|
|
|
#include "open_alliance_helpers.h"
|
|
|
|
|
2025-06-12 12:41:55 +02:00
|
|
|
/*
|
|
|
|
* 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()
|
2025-06-12 12:41:57 +02:00
|
|
|
*
|
|
|
|
* 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.
|
2025-06-12 12:41:55 +02:00
|
|
|
*/
|
|
|
|
|
2025-02-10 09:23:58 +01:00
|
|
|
/*
|
|
|
|
* DP83TG720S_POLL_ACTIVE_LINK - Polling interval in milliseconds when the link
|
|
|
|
* is active.
|
2025-06-12 12:41:57 +02:00
|
|
|
* 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.
|
2025-06-12 12:41:55 +02:00
|
|
|
* 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.
|
2025-02-10 09:23:58 +01:00
|
|
|
*
|
|
|
|
* 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.
|
|
|
|
*/
|
2025-06-12 12:41:57 +02:00
|
|
|
#define DP83TG720S_POLL_ACTIVE_LINK 421
|
|
|
|
#define DP83TG720S_POLL_NO_LINK 149
|
|
|
|
#define DP83TG720S_FAST_POLL_DURATION_MS 6000
|
|
|
|
#define DP83TG720S_POLL_SLOW 1117
|
2025-06-12 12:41:55 +02:00
|
|
|
#define DP83TG720S_RESET_DELAY_MS_MASTER 97
|
|
|
|
#define DP83TG720S_RESET_DELAY_MS_SLAVE 149
|
2025-02-10 09:23:58 +01:00
|
|
|
|
2023-12-12 06:41:44 +01:00
|
|
|
#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)
|
|
|
|
|
2024-08-12 09:30:46 +02:00
|
|
|
/* 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)
|
|
|
|
|
2023-12-12 06:41:44 +01:00
|
|
|
#define DP83TG720S_PHY_RESET 0x1f
|
|
|
|
#define DP83TG720S_HW_RESET BIT(15)
|
|
|
|
|
2024-06-14 11:45:15 +02:00
|
|
|
#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)
|
|
|
|
|
2024-08-12 09:30:46 +02:00
|
|
|
/* 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
|
|
|
|
|
2025-01-10 07:05:17 +01:00
|
|
|
#define DP83TG720S_LINK_QUAL_3 0x547
|
|
|
|
#define DP83TG720S_LINK_LOSS_CNT_MASK GENMASK(15, 10)
|
|
|
|
|
2024-08-12 09:30:46 +02:00
|
|
|
/* Register 0x0576: TDR Master Link Down Control */
|
|
|
|
#define DP83TG720S_TDR_MASTER_LINK_DOWN 0x576
|
|
|
|
|
2023-12-12 06:41:44 +01:00
|
|
|
#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)
|
|
|
|
|
2025-01-10 07:05:17 +01:00
|
|
|
/*
|
|
|
|
* 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
|
|
|
|
|
2024-08-12 09:30:46 +02:00
|
|
|
/* Register 0x083F: Unknown Register */
|
|
|
|
#define DP83TG720S_UNKNOWN_083F 0x83f
|
|
|
|
|
2023-12-12 06:41:44 +01:00
|
|
|
#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
|
|
|
|
|
2025-01-10 07:05:17 +01:00
|
|
|
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;
|
2025-06-12 12:41:57 +02:00
|
|
|
unsigned long last_link_down_jiffies;
|
2025-01-10 07:05:17 +01:00
|
|
|
};
|
|
|
|
|
|
|
|
/**
|
|
|
|
* 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;
|
|
|
|
}
|
|
|
|
|
2025-06-12 12:41:55 +02:00
|
|
|
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;
|
|
|
|
}
|
|
|
|
|
2025-01-10 07:05:17 +01:00
|
|
|
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;
|
|
|
|
}
|
|
|
|
|
2024-08-12 09:30:46 +02:00
|
|
|
/**
|
|
|
|
* 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);
|
|
|
|
|
2025-01-10 07:05:17 +01:00
|
|
|
/* save the current stats before resetting the PHY */
|
|
|
|
ret = dp83tg720_update_stats(phydev);
|
|
|
|
if (ret)
|
|
|
|
return ret;
|
|
|
|
|
2024-08-12 09:30:46 +02:00
|
|
|
return phy_init_hw(phydev);
|
|
|
|
}
|
|
|
|
|
2023-12-12 06:41:44 +01:00
|
|
|
static int dp83tg720_config_aneg(struct phy_device *phydev)
|
|
|
|
{
|
2024-06-14 11:45:16 +02:00
|
|
|
int ret;
|
|
|
|
|
2023-12-12 06:41:44 +01:00
|
|
|
/* 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.
|
|
|
|
*/
|
2024-06-14 11:45:16 +02:00
|
|
|
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);
|
2023-12-12 06:41:44 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
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) {
|
2025-01-10 07:05:17 +01:00
|
|
|
/* save the current stats before resetting the PHY */
|
|
|
|
ret = dp83tg720_update_stats(phydev);
|
|
|
|
if (ret)
|
|
|
|
return ret;
|
|
|
|
|
2023-12-12 06:41:44 +01:00
|
|
|
/* 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.
|
2024-06-14 11:45:16 +02:00
|
|
|
* genphy_c45_pma_baset1_read_master_slave() call will be done
|
|
|
|
* by the dp83tg720_config_aneg() function.
|
2023-12-12 06:41:44 +01:00
|
|
|
*/
|
|
|
|
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;
|
|
|
|
|
2025-06-12 12:41:55 +02:00
|
|
|
/* Reset the PHY to recover from a link failure */
|
|
|
|
ret = dp83tg720_soft_reset(phydev);
|
2023-12-12 06:41:44 +01:00
|
|
|
if (ret)
|
|
|
|
return ret;
|
|
|
|
|
2024-06-14 11:45:15 +02:00
|
|
|
if (phy_interface_is_rgmii(phydev)) {
|
|
|
|
ret = dp83tg720_config_rgmii_delay(phydev);
|
|
|
|
if (ret)
|
|
|
|
return ret;
|
|
|
|
}
|
2023-12-12 06:41:44 +01:00
|
|
|
|
2024-06-14 11:45:15 +02:00
|
|
|
/* In case the PHY is bootstrapped in managed mode, we need to
|
|
|
|
* wake it.
|
|
|
|
*/
|
2024-06-14 11:45:16 +02:00
|
|
|
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);
|
2023-12-12 06:41:44 +01:00
|
|
|
}
|
|
|
|
|
2025-01-10 07:05:17 +01:00
|
|
|
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;
|
|
|
|
}
|
|
|
|
|
2025-02-10 09:23:58 +01:00
|
|
|
/**
|
2025-06-12 12:41:57 +02:00
|
|
|
* dp83tg720_get_next_update_time - Return next polling interval for PHY state
|
2025-02-10 09:23:58 +01:00
|
|
|
* @phydev: Pointer to the phy_device structure
|
|
|
|
*
|
2025-06-12 12:41:57 +02:00
|
|
|
* 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.
|
2025-02-10 09:23:58 +01:00
|
|
|
*
|
2025-06-12 12:41:57 +02:00
|
|
|
* Return: Time (in jiffies) until the next poll
|
2025-02-10 09:23:58 +01:00
|
|
|
*/
|
|
|
|
static unsigned int dp83tg720_get_next_update_time(struct phy_device *phydev)
|
|
|
|
{
|
2025-06-12 12:41:57 +02:00
|
|
|
struct dp83tg720_priv *priv = phydev->priv;
|
2025-02-10 09:23:58 +01:00
|
|
|
unsigned int next_time_jiffies;
|
|
|
|
|
|
|
|
if (phydev->link) {
|
2025-06-12 12:41:57 +02:00
|
|
|
priv->last_link_down_jiffies = 0;
|
|
|
|
|
|
|
|
/* When the link is up, use a slower interval (in jiffies) */
|
2025-02-10 09:23:58 +01:00
|
|
|
next_time_jiffies =
|
|
|
|
msecs_to_jiffies(DP83TG720S_POLL_ACTIVE_LINK);
|
|
|
|
} else {
|
2025-06-12 12:41:57 +02:00
|
|
|
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);
|
|
|
|
}
|
2025-02-10 09:23:58 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
/* Ensure the polling time is at least one jiffy */
|
|
|
|
return max(next_time_jiffies, 1U);
|
|
|
|
}
|
|
|
|
|
2023-12-12 06:41:44 +01:00
|
|
|
static struct phy_driver dp83tg720_driver[] = {
|
|
|
|
{
|
|
|
|
PHY_ID_MATCH_MODEL(DP83TG720S_PHY_ID),
|
|
|
|
.name = "TI DP83TG720S",
|
|
|
|
|
2024-08-12 09:30:46 +02:00
|
|
|
.flags = PHY_POLL_CABLE_TEST,
|
2025-01-10 07:05:17 +01:00
|
|
|
.probe = dp83tg720_probe,
|
2025-06-12 12:41:55 +02:00
|
|
|
.soft_reset = dp83tg720_soft_reset,
|
2023-12-12 06:41:44 +01:00
|
|
|
.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,
|
2024-08-12 09:30:46 +02:00
|
|
|
.cable_test_start = dp83tg720_cable_test_start,
|
|
|
|
.cable_test_get_status = dp83tg720_cable_test_get_status,
|
2025-01-10 07:05:17 +01:00
|
|
|
.get_link_stats = dp83tg720_get_link_stats,
|
|
|
|
.get_phy_stats = dp83tg720_get_phy_stats,
|
|
|
|
.update_stats = dp83tg720_update_stats,
|
2025-02-10 09:23:58 +01:00
|
|
|
.get_next_update_time = dp83tg720_get_next_update_time,
|
2023-12-12 06:41:44 +01:00
|
|
|
|
|
|
|
.suspend = genphy_suspend,
|
|
|
|
.resume = genphy_resume,
|
|
|
|
} };
|
|
|
|
module_phy_driver(dp83tg720_driver);
|
|
|
|
|
2025-01-12 15:14:50 +01:00
|
|
|
static const struct mdio_device_id __maybe_unused dp83tg720_tbl[] = {
|
2023-12-12 06:41:44 +01:00
|
|
|
{ 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");
|