#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"
#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
#define DP83TG720S_MII_REG_10 0x10
#define DP83TG720S_STS_MII_INT BIT(7)
#define DP83TG720S_LINK_STATUS BIT(0)
#define DP83TG720S_TDR_CFG 0x1e
#define DP83TG720S_TDR_START BIT(15)
#define DP83TG720S_CFG_TDR_AUTO_RUN BIT(14)
#define DP83TG720S_TDR_DONE BIT(1)
#define DP83TG720S_TDR_FAIL BIT(0)
#define DP83TG720S_PHY_RESET 0x1f
#define DP83TG720S_HW_RESET BIT(15)
#define DP83TG720S_LPS_CFG3 0x18c
#define DP83TG720S_LPS_CFG3_PWR_MODE_0 BIT(0)
#define DP83TG720S_TDR_FAULT_STATUS 0x30f
#define DP83TG720S_TDR_CFG2 0x301
#define DP83TG720S_TDR_CFG3 0x303
#define DP83TG720S_TDR_CFG4 0x304
#define DP83TG720S_UNKNOWN_0405 0x405
#define DP83TG720S_LINK_QUAL_3 0x547
#define DP83TG720S_LINK_LOSS_CNT_MASK GENMASK(15, 10)
#define DP83TG720S_TDR_MASTER_LINK_DOWN 0x576
#define DP83TG720S_RGMII_DELAY_CTRL 0x602
#define DP83TG720S_RGMII_RX_CLK_SEL BIT(1)
#define DP83TG720S_RGMII_TX_CLK_SEL BIT(0)
#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
#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;
};
static int dp83tg720_update_stats(struct phy_device *phydev)
{
struct dp83tg720_priv *priv = phydev->priv;
u32 count;
int ret;
ret = phy_read_mmd(phydev, MDIO_MMD_VEND2, DP83TG720S_LINK_QUAL_3);
if (ret < 0)
return ret;
count = FIELD_GET(DP83TG720S_LINK_LOSS_CNT_MASK, ret);
priv->stats.link_loss_cnt += count;
ret = phy_read_mmd(phydev, MDIO_MMD_VEND2, DP83TG720S_PKT_STAT_1);
if (ret < 0)
return ret;
count = ret;
ret = phy_read_mmd(phydev, MDIO_MMD_VEND2, DP83TG720S_PKT_STAT_2);
if (ret < 0)
return ret;
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;
priv->stats.tx_err_pkt_cnt += ret;
ret = phy_read_mmd(phydev, MDIO_MMD_VEND2, DP83TG720S_PKT_STAT_4);
if (ret < 0)
return ret;
count = ret;
ret = phy_read_mmd(phydev, MDIO_MMD_VEND2, DP83TG720S_PKT_STAT_5);
if (ret < 0)
return ret;
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;
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;
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;
}
static int dp83tg720_cable_test_start(struct phy_device *phydev)
{
int ret;
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;
ret = phy_set_bits_mmd(phydev, MDIO_MMD_VEND2, DP83TG720S_TDR_CFG,
DP83TG720S_TDR_START);
if (ret)
return ret;
return 0;
}
static int dp83tg720_cable_test_get_status(struct phy_device *phydev,
bool *finished)
{
int ret, stat;
*finished = false;
ret = phy_read_mmd(phydev, MDIO_MMD_VEND2, DP83TG720S_TDR_CFG);
if (ret < 0)
return ret;
if (!(ret & DP83TG720S_TDR_DONE))
return 0;
if (!(ret & DP83TG720S_TDR_FAIL)) {
int location;
ret = phy_read_mmd(phydev, MDIO_MMD_VEND2,
DP83TG720S_TDR_FAULT_STATUS);
if (ret < 0)
return ret;
stat = oa_1000bt1_get_ethtool_cable_result_code(ret);
location = oa_1000bt1_get_tdr_distance(ret);
if (location > 0)
ethnl_cable_test_fault_length(phydev,
ETHTOOL_A_CABLE_PAIR_A,
location);
} else {
stat = ETHTOOL_A_CABLE_RESULT_CODE_UNSPEC;
}
*finished = true;
ethnl_cable_test_result(phydev, ETHTOOL_A_CABLE_PAIR_A, stat);
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;
ret = genphy_c45_pma_baset1_setup_master_slave(phydev);
if (ret)
return ret;
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;
phy_sts = phy_read(phydev, DP83TG720S_MII_REG_10);
phydev->link = !!(phy_sts & DP83TG720S_LINK_STATUS);
if (!phydev->link) {
ret = dp83tg720_update_stats(phydev);
if (ret)
return ret;
ret = phy_init_hw(phydev);
if (ret)
return ret;
ret = dp83tg720_config_aneg(phydev);
if (ret)
return ret;
phydev->speed = SPEED_UNKNOWN;
phydev->duplex = DUPLEX_UNKNOWN;
} else {
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;
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;
}
ret = phy_write_mmd(phydev, MDIO_MMD_VEND2, DP83TG720S_LPS_CFG3,
DP83TG720S_LPS_CFG3_PWR_MODE_0);
if (ret)
return ret;
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;
}
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;
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))) {
next_time_jiffies =
msecs_to_jiffies(DP83TG720S_POLL_NO_LINK);
} else {
next_time_jiffies =
msecs_to_jiffies(DP83TG720S_POLL_SLOW);
}
}
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");