123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014 |
- From 249d2b80e4db0e38503ed0ec2af6c7401bc099b9 Mon Sep 17 00:00:00 2001
- From: Christian Marangi <[email protected]>
- Date: Mon, 29 Jan 2024 15:15:22 +0100
- Subject: [PATCH 4/5] net: phy: qcom: move additional functions to shared
- library
- Move additional functions to shared library in preparation for qca808x
- PHY Family to be detached from at803x driver.
- Only the shared defines are moved to the shared qcom.h header.
- Signed-off-by: Christian Marangi <[email protected]>
- Reviewed-by: Andrew Lunn <[email protected]>
- Link: https://lore.kernel.org/r/[email protected]
- Signed-off-by: Jakub Kicinski <[email protected]>
- ---
- drivers/net/phy/qcom/at803x.c | 426 +---------------------------
- drivers/net/phy/qcom/qcom-phy-lib.c | 376 ++++++++++++++++++++++++
- drivers/net/phy/qcom/qcom.h | 86 ++++++
- 3 files changed, 463 insertions(+), 425 deletions(-)
- --- a/drivers/net/phy/qcom/at803x.c
- +++ b/drivers/net/phy/qcom/at803x.c
- @@ -24,65 +24,11 @@
-
- #include "qcom.h"
-
- -#define AT803X_SPECIFIC_FUNCTION_CONTROL 0x10
- -#define AT803X_SFC_ASSERT_CRS BIT(11)
- -#define AT803X_SFC_FORCE_LINK BIT(10)
- -#define AT803X_SFC_MDI_CROSSOVER_MODE_M GENMASK(6, 5)
- -#define AT803X_SFC_AUTOMATIC_CROSSOVER 0x3
- -#define AT803X_SFC_MANUAL_MDIX 0x1
- -#define AT803X_SFC_MANUAL_MDI 0x0
- -#define AT803X_SFC_SQE_TEST BIT(2)
- -#define AT803X_SFC_POLARITY_REVERSAL BIT(1)
- -#define AT803X_SFC_DISABLE_JABBER BIT(0)
- -
- -#define AT803X_SPECIFIC_STATUS 0x11
- -#define AT803X_SS_SPEED_MASK GENMASK(15, 14)
- -#define AT803X_SS_SPEED_1000 2
- -#define AT803X_SS_SPEED_100 1
- -#define AT803X_SS_SPEED_10 0
- -#define AT803X_SS_DUPLEX BIT(13)
- -#define AT803X_SS_SPEED_DUPLEX_RESOLVED BIT(11)
- -#define AT803X_SS_MDIX BIT(6)
- -
- -#define QCA808X_SS_SPEED_MASK GENMASK(9, 7)
- -#define QCA808X_SS_SPEED_2500 4
- -
- -#define AT803X_INTR_ENABLE 0x12
- -#define AT803X_INTR_ENABLE_AUTONEG_ERR BIT(15)
- -#define AT803X_INTR_ENABLE_SPEED_CHANGED BIT(14)
- -#define AT803X_INTR_ENABLE_DUPLEX_CHANGED BIT(13)
- -#define AT803X_INTR_ENABLE_PAGE_RECEIVED BIT(12)
- -#define AT803X_INTR_ENABLE_LINK_FAIL BIT(11)
- -#define AT803X_INTR_ENABLE_LINK_SUCCESS BIT(10)
- -#define AT803X_INTR_ENABLE_LINK_FAIL_BX BIT(8)
- -#define AT803X_INTR_ENABLE_LINK_SUCCESS_BX BIT(7)
- -#define AT803X_INTR_ENABLE_WIRESPEED_DOWNGRADE BIT(5)
- -#define AT803X_INTR_ENABLE_POLARITY_CHANGED BIT(1)
- -#define AT803X_INTR_ENABLE_WOL BIT(0)
- -
- -#define AT803X_INTR_STATUS 0x13
- -
- -#define AT803X_SMART_SPEED 0x14
- -#define AT803X_SMART_SPEED_ENABLE BIT(5)
- -#define AT803X_SMART_SPEED_RETRY_LIMIT_MASK GENMASK(4, 2)
- -#define AT803X_SMART_SPEED_BYPASS_TIMER BIT(1)
- -#define AT803X_CDT 0x16
- -#define AT803X_CDT_MDI_PAIR_MASK GENMASK(9, 8)
- -#define AT803X_CDT_ENABLE_TEST BIT(0)
- -#define AT803X_CDT_STATUS 0x1c
- -#define AT803X_CDT_STATUS_STAT_NORMAL 0
- -#define AT803X_CDT_STATUS_STAT_SHORT 1
- -#define AT803X_CDT_STATUS_STAT_OPEN 2
- -#define AT803X_CDT_STATUS_STAT_FAIL 3
- -#define AT803X_CDT_STATUS_STAT_MASK GENMASK(9, 8)
- -#define AT803X_CDT_STATUS_DELTA_TIME_MASK GENMASK(7, 0)
- #define AT803X_LED_CONTROL 0x18
-
- #define AT803X_PHY_MMD3_WOL_CTRL 0x8012
- #define AT803X_WOL_EN BIT(5)
- -#define AT803X_LOC_MAC_ADDR_0_15_OFFSET 0x804C
- -#define AT803X_LOC_MAC_ADDR_16_31_OFFSET 0x804B
- -#define AT803X_LOC_MAC_ADDR_32_47_OFFSET 0x804A
- +
- #define AT803X_REG_CHIP_CONFIG 0x1f
- #define AT803X_BT_BX_REG_SEL 0x8000
-
- @@ -138,10 +84,6 @@
- #define AT803X_CLK_OUT_STRENGTH_HALF 1
- #define AT803X_CLK_OUT_STRENGTH_QUARTER 2
-
- -#define AT803X_DEFAULT_DOWNSHIFT 5
- -#define AT803X_MIN_DOWNSHIFT 2
- -#define AT803X_MAX_DOWNSHIFT 9
- -
- #define AT803X_MMD3_SMARTEEE_CTL1 0x805b
- #define AT803X_MMD3_SMARTEEE_CTL2 0x805c
- #define AT803X_MMD3_SMARTEEE_CTL3 0x805d
- @@ -366,11 +308,6 @@ MODULE_DESCRIPTION("Qualcomm Atheros AR8
- MODULE_AUTHOR("Matus Ujhelyi");
- MODULE_LICENSE("GPL");
-
- -struct at803x_ss_mask {
- - u16 speed_mask;
- - u8 speed_shift;
- -};
- -
- struct at803x_priv {
- int flags;
- u16 clk_25m_reg;
- @@ -470,80 +407,6 @@ static void at803x_context_restore(struc
- phy_write(phydev, AT803X_LED_CONTROL, context->led_control);
- }
-
- -static int at803x_set_wol(struct phy_device *phydev,
- - struct ethtool_wolinfo *wol)
- -{
- - int ret, irq_enabled;
- -
- - if (wol->wolopts & WAKE_MAGIC) {
- - struct net_device *ndev = phydev->attached_dev;
- - const u8 *mac;
- - unsigned int i;
- - static const unsigned int offsets[] = {
- - AT803X_LOC_MAC_ADDR_32_47_OFFSET,
- - AT803X_LOC_MAC_ADDR_16_31_OFFSET,
- - AT803X_LOC_MAC_ADDR_0_15_OFFSET,
- - };
- -
- - if (!ndev)
- - return -ENODEV;
- -
- - mac = (const u8 *)ndev->dev_addr;
- -
- - if (!is_valid_ether_addr(mac))
- - return -EINVAL;
- -
- - for (i = 0; i < 3; i++)
- - phy_write_mmd(phydev, MDIO_MMD_PCS, offsets[i],
- - mac[(i * 2) + 1] | (mac[(i * 2)] << 8));
- -
- - /* Enable WOL interrupt */
- - ret = phy_modify(phydev, AT803X_INTR_ENABLE, 0, AT803X_INTR_ENABLE_WOL);
- - if (ret)
- - return ret;
- - } else {
- - /* Disable WOL interrupt */
- - ret = phy_modify(phydev, AT803X_INTR_ENABLE, AT803X_INTR_ENABLE_WOL, 0);
- - if (ret)
- - return ret;
- - }
- -
- - /* Clear WOL status */
- - ret = phy_read(phydev, AT803X_INTR_STATUS);
- - if (ret < 0)
- - return ret;
- -
- - /* Check if there are other interrupts except for WOL triggered when PHY is
- - * in interrupt mode, only the interrupts enabled by AT803X_INTR_ENABLE can
- - * be passed up to the interrupt PIN.
- - */
- - irq_enabled = phy_read(phydev, AT803X_INTR_ENABLE);
- - if (irq_enabled < 0)
- - return irq_enabled;
- -
- - irq_enabled &= ~AT803X_INTR_ENABLE_WOL;
- - if (ret & irq_enabled && !phy_polling_mode(phydev))
- - phy_trigger_machine(phydev);
- -
- - return 0;
- -}
- -
- -static void at803x_get_wol(struct phy_device *phydev,
- - struct ethtool_wolinfo *wol)
- -{
- - int value;
- -
- - wol->supported = WAKE_MAGIC;
- - wol->wolopts = 0;
- -
- - value = phy_read(phydev, AT803X_INTR_ENABLE);
- - if (value < 0)
- - return;
- -
- - if (value & AT803X_INTR_ENABLE_WOL)
- - wol->wolopts |= WAKE_MAGIC;
- -}
- -
- static int at803x_suspend(struct phy_device *phydev)
- {
- int value;
- @@ -816,73 +679,6 @@ static int at803x_config_init(struct phy
- return phy_modify(phydev, MII_ADVERTISE, MDIO_AN_CTRL1_XNP, 0);
- }
-
- -static int at803x_ack_interrupt(struct phy_device *phydev)
- -{
- - int err;
- -
- - err = phy_read(phydev, AT803X_INTR_STATUS);
- -
- - return (err < 0) ? err : 0;
- -}
- -
- -static int at803x_config_intr(struct phy_device *phydev)
- -{
- - int err;
- - int value;
- -
- - value = phy_read(phydev, AT803X_INTR_ENABLE);
- -
- - if (phydev->interrupts == PHY_INTERRUPT_ENABLED) {
- - /* Clear any pending interrupts */
- - err = at803x_ack_interrupt(phydev);
- - if (err)
- - return err;
- -
- - value |= AT803X_INTR_ENABLE_AUTONEG_ERR;
- - value |= AT803X_INTR_ENABLE_SPEED_CHANGED;
- - value |= AT803X_INTR_ENABLE_DUPLEX_CHANGED;
- - value |= AT803X_INTR_ENABLE_LINK_FAIL;
- - value |= AT803X_INTR_ENABLE_LINK_SUCCESS;
- -
- - err = phy_write(phydev, AT803X_INTR_ENABLE, value);
- - } else {
- - err = phy_write(phydev, AT803X_INTR_ENABLE, 0);
- - if (err)
- - return err;
- -
- - /* Clear any pending interrupts */
- - err = at803x_ack_interrupt(phydev);
- - }
- -
- - return err;
- -}
- -
- -static irqreturn_t at803x_handle_interrupt(struct phy_device *phydev)
- -{
- - int irq_status, int_enabled;
- -
- - irq_status = phy_read(phydev, AT803X_INTR_STATUS);
- - if (irq_status < 0) {
- - phy_error(phydev);
- - return IRQ_NONE;
- - }
- -
- - /* Read the current enabled interrupts */
- - int_enabled = phy_read(phydev, AT803X_INTR_ENABLE);
- - if (int_enabled < 0) {
- - phy_error(phydev);
- - return IRQ_NONE;
- - }
- -
- - /* See if this was one of our enabled interrupts */
- - if (!(irq_status & int_enabled))
- - return IRQ_NONE;
- -
- - phy_trigger_machine(phydev);
- -
- - return IRQ_HANDLED;
- -}
- -
- static void at803x_link_change_notify(struct phy_device *phydev)
- {
- /*
- @@ -908,69 +704,6 @@ static void at803x_link_change_notify(st
- }
- }
-
- -static int at803x_read_specific_status(struct phy_device *phydev,
- - struct at803x_ss_mask ss_mask)
- -{
- - int ss;
- -
- - /* Read the AT8035 PHY-Specific Status register, which indicates the
- - * speed and duplex that the PHY is actually using, irrespective of
- - * whether we are in autoneg mode or not.
- - */
- - ss = phy_read(phydev, AT803X_SPECIFIC_STATUS);
- - if (ss < 0)
- - return ss;
- -
- - if (ss & AT803X_SS_SPEED_DUPLEX_RESOLVED) {
- - int sfc, speed;
- -
- - sfc = phy_read(phydev, AT803X_SPECIFIC_FUNCTION_CONTROL);
- - if (sfc < 0)
- - return sfc;
- -
- - speed = ss & ss_mask.speed_mask;
- - speed >>= ss_mask.speed_shift;
- -
- - switch (speed) {
- - case AT803X_SS_SPEED_10:
- - phydev->speed = SPEED_10;
- - break;
- - case AT803X_SS_SPEED_100:
- - phydev->speed = SPEED_100;
- - break;
- - case AT803X_SS_SPEED_1000:
- - phydev->speed = SPEED_1000;
- - break;
- - case QCA808X_SS_SPEED_2500:
- - phydev->speed = SPEED_2500;
- - break;
- - }
- - if (ss & AT803X_SS_DUPLEX)
- - phydev->duplex = DUPLEX_FULL;
- - else
- - phydev->duplex = DUPLEX_HALF;
- -
- - if (ss & AT803X_SS_MDIX)
- - phydev->mdix = ETH_TP_MDI_X;
- - else
- - phydev->mdix = ETH_TP_MDI;
- -
- - switch (FIELD_GET(AT803X_SFC_MDI_CROSSOVER_MODE_M, sfc)) {
- - case AT803X_SFC_MANUAL_MDI:
- - phydev->mdix_ctrl = ETH_TP_MDI;
- - break;
- - case AT803X_SFC_MANUAL_MDIX:
- - phydev->mdix_ctrl = ETH_TP_MDI_X;
- - break;
- - case AT803X_SFC_AUTOMATIC_CROSSOVER:
- - phydev->mdix_ctrl = ETH_TP_MDI_AUTO;
- - break;
- - }
- - }
- -
- - return 0;
- -}
- -
- static int at803x_read_status(struct phy_device *phydev)
- {
- struct at803x_ss_mask ss_mask = { 0 };
- @@ -1006,50 +739,6 @@ static int at803x_read_status(struct phy
- return 0;
- }
-
- -static int at803x_config_mdix(struct phy_device *phydev, u8 ctrl)
- -{
- - u16 val;
- -
- - switch (ctrl) {
- - case ETH_TP_MDI:
- - val = AT803X_SFC_MANUAL_MDI;
- - break;
- - case ETH_TP_MDI_X:
- - val = AT803X_SFC_MANUAL_MDIX;
- - break;
- - case ETH_TP_MDI_AUTO:
- - val = AT803X_SFC_AUTOMATIC_CROSSOVER;
- - break;
- - default:
- - return 0;
- - }
- -
- - return phy_modify_changed(phydev, AT803X_SPECIFIC_FUNCTION_CONTROL,
- - AT803X_SFC_MDI_CROSSOVER_MODE_M,
- - FIELD_PREP(AT803X_SFC_MDI_CROSSOVER_MODE_M, val));
- -}
- -
- -static int at803x_prepare_config_aneg(struct phy_device *phydev)
- -{
- - int ret;
- -
- - ret = at803x_config_mdix(phydev, phydev->mdix_ctrl);
- - if (ret < 0)
- - return ret;
- -
- - /* Changes of the midx bits are disruptive to the normal operation;
- - * therefore any changes to these registers must be followed by a
- - * software reset to take effect.
- - */
- - if (ret == 1) {
- - ret = genphy_soft_reset(phydev);
- - if (ret < 0)
- - return ret;
- - }
- -
- - return 0;
- -}
- -
- static int at803x_config_aneg(struct phy_device *phydev)
- {
- struct at803x_priv *priv = phydev->priv;
- @@ -1065,80 +754,6 @@ static int at803x_config_aneg(struct phy
- return genphy_config_aneg(phydev);
- }
-
- -static int at803x_get_downshift(struct phy_device *phydev, u8 *d)
- -{
- - int val;
- -
- - val = phy_read(phydev, AT803X_SMART_SPEED);
- - if (val < 0)
- - return val;
- -
- - if (val & AT803X_SMART_SPEED_ENABLE)
- - *d = FIELD_GET(AT803X_SMART_SPEED_RETRY_LIMIT_MASK, val) + 2;
- - else
- - *d = DOWNSHIFT_DEV_DISABLE;
- -
- - return 0;
- -}
- -
- -static int at803x_set_downshift(struct phy_device *phydev, u8 cnt)
- -{
- - u16 mask, set;
- - int ret;
- -
- - switch (cnt) {
- - case DOWNSHIFT_DEV_DEFAULT_COUNT:
- - cnt = AT803X_DEFAULT_DOWNSHIFT;
- - fallthrough;
- - case AT803X_MIN_DOWNSHIFT ... AT803X_MAX_DOWNSHIFT:
- - set = AT803X_SMART_SPEED_ENABLE |
- - AT803X_SMART_SPEED_BYPASS_TIMER |
- - FIELD_PREP(AT803X_SMART_SPEED_RETRY_LIMIT_MASK, cnt - 2);
- - mask = AT803X_SMART_SPEED_RETRY_LIMIT_MASK;
- - break;
- - case DOWNSHIFT_DEV_DISABLE:
- - set = 0;
- - mask = AT803X_SMART_SPEED_ENABLE |
- - AT803X_SMART_SPEED_BYPASS_TIMER;
- - break;
- - default:
- - return -EINVAL;
- - }
- -
- - ret = phy_modify_changed(phydev, AT803X_SMART_SPEED, mask, set);
- -
- - /* After changing the smart speed settings, we need to perform a
- - * software reset, use phy_init_hw() to make sure we set the
- - * reapply any values which might got lost during software reset.
- - */
- - if (ret == 1)
- - ret = phy_init_hw(phydev);
- -
- - return ret;
- -}
- -
- -static int at803x_get_tunable(struct phy_device *phydev,
- - struct ethtool_tunable *tuna, void *data)
- -{
- - switch (tuna->id) {
- - case ETHTOOL_PHY_DOWNSHIFT:
- - return at803x_get_downshift(phydev, data);
- - default:
- - return -EOPNOTSUPP;
- - }
- -}
- -
- -static int at803x_set_tunable(struct phy_device *phydev,
- - struct ethtool_tunable *tuna, const void *data)
- -{
- - switch (tuna->id) {
- - case ETHTOOL_PHY_DOWNSHIFT:
- - return at803x_set_downshift(phydev, *(const u8 *)data);
- - default:
- - return -EOPNOTSUPP;
- - }
- -}
- -
- static int at803x_cable_test_result_trans(u16 status)
- {
- switch (FIELD_GET(AT803X_CDT_STATUS_STAT_MASK, status)) {
- @@ -1170,45 +785,6 @@ static bool at803x_cdt_fault_length_vali
- return false;
- }
-
- -static int at803x_cdt_fault_length(int dt)
- -{
- - /* According to the datasheet the distance to the fault is
- - * DELTA_TIME * 0.824 meters.
- - *
- - * The author suspect the correct formula is:
- - *
- - * fault_distance = DELTA_TIME * (c * VF) / 125MHz / 2
- - *
- - * where c is the speed of light, VF is the velocity factor of
- - * the twisted pair cable, 125MHz the counter frequency and
- - * we need to divide by 2 because the hardware will measure the
- - * round trip time to the fault and back to the PHY.
- - *
- - * With a VF of 0.69 we get the factor 0.824 mentioned in the
- - * datasheet.
- - */
- - return (dt * 824) / 10;
- -}
- -
- -static int at803x_cdt_start(struct phy_device *phydev,
- - u32 cdt_start)
- -{
- - return phy_write(phydev, AT803X_CDT, cdt_start);
- -}
- -
- -static int at803x_cdt_wait_for_completion(struct phy_device *phydev,
- - u32 cdt_en)
- -{
- - int val, ret;
- -
- - /* One test run takes about 25ms */
- - ret = phy_read_poll_timeout(phydev, AT803X_CDT, val,
- - !(val & cdt_en),
- - 30000, 100000, true);
- -
- - return ret < 0 ? ret : 0;
- -}
- -
- static int at803x_cable_test_one_pair(struct phy_device *phydev, int pair)
- {
- static const int ethtool_pair[] = {
- --- a/drivers/net/phy/qcom/qcom-phy-lib.c
- +++ b/drivers/net/phy/qcom/qcom-phy-lib.c
- @@ -3,6 +3,9 @@
- #include <linux/phy.h>
- #include <linux/module.h>
-
- +#include <linux/netdevice.h>
- +#include <linux/etherdevice.h>
- +
- #include "qcom.h"
-
- MODULE_DESCRIPTION("Qualcomm PHY driver Common Functions");
- @@ -51,3 +54,376 @@ int at803x_debug_reg_write(struct phy_de
- return phy_write(phydev, AT803X_DEBUG_DATA, data);
- }
- EXPORT_SYMBOL_GPL(at803x_debug_reg_write);
- +
- +int at803x_set_wol(struct phy_device *phydev,
- + struct ethtool_wolinfo *wol)
- +{
- + int ret, irq_enabled;
- +
- + if (wol->wolopts & WAKE_MAGIC) {
- + struct net_device *ndev = phydev->attached_dev;
- + const u8 *mac;
- + unsigned int i;
- + static const unsigned int offsets[] = {
- + AT803X_LOC_MAC_ADDR_32_47_OFFSET,
- + AT803X_LOC_MAC_ADDR_16_31_OFFSET,
- + AT803X_LOC_MAC_ADDR_0_15_OFFSET,
- + };
- +
- + if (!ndev)
- + return -ENODEV;
- +
- + mac = (const u8 *)ndev->dev_addr;
- +
- + if (!is_valid_ether_addr(mac))
- + return -EINVAL;
- +
- + for (i = 0; i < 3; i++)
- + phy_write_mmd(phydev, MDIO_MMD_PCS, offsets[i],
- + mac[(i * 2) + 1] | (mac[(i * 2)] << 8));
- +
- + /* Enable WOL interrupt */
- + ret = phy_modify(phydev, AT803X_INTR_ENABLE, 0, AT803X_INTR_ENABLE_WOL);
- + if (ret)
- + return ret;
- + } else {
- + /* Disable WOL interrupt */
- + ret = phy_modify(phydev, AT803X_INTR_ENABLE, AT803X_INTR_ENABLE_WOL, 0);
- + if (ret)
- + return ret;
- + }
- +
- + /* Clear WOL status */
- + ret = phy_read(phydev, AT803X_INTR_STATUS);
- + if (ret < 0)
- + return ret;
- +
- + /* Check if there are other interrupts except for WOL triggered when PHY is
- + * in interrupt mode, only the interrupts enabled by AT803X_INTR_ENABLE can
- + * be passed up to the interrupt PIN.
- + */
- + irq_enabled = phy_read(phydev, AT803X_INTR_ENABLE);
- + if (irq_enabled < 0)
- + return irq_enabled;
- +
- + irq_enabled &= ~AT803X_INTR_ENABLE_WOL;
- + if (ret & irq_enabled && !phy_polling_mode(phydev))
- + phy_trigger_machine(phydev);
- +
- + return 0;
- +}
- +EXPORT_SYMBOL_GPL(at803x_set_wol);
- +
- +void at803x_get_wol(struct phy_device *phydev,
- + struct ethtool_wolinfo *wol)
- +{
- + int value;
- +
- + wol->supported = WAKE_MAGIC;
- + wol->wolopts = 0;
- +
- + value = phy_read(phydev, AT803X_INTR_ENABLE);
- + if (value < 0)
- + return;
- +
- + if (value & AT803X_INTR_ENABLE_WOL)
- + wol->wolopts |= WAKE_MAGIC;
- +}
- +EXPORT_SYMBOL_GPL(at803x_get_wol);
- +
- +int at803x_ack_interrupt(struct phy_device *phydev)
- +{
- + int err;
- +
- + err = phy_read(phydev, AT803X_INTR_STATUS);
- +
- + return (err < 0) ? err : 0;
- +}
- +EXPORT_SYMBOL_GPL(at803x_ack_interrupt);
- +
- +int at803x_config_intr(struct phy_device *phydev)
- +{
- + int err;
- + int value;
- +
- + value = phy_read(phydev, AT803X_INTR_ENABLE);
- +
- + if (phydev->interrupts == PHY_INTERRUPT_ENABLED) {
- + /* Clear any pending interrupts */
- + err = at803x_ack_interrupt(phydev);
- + if (err)
- + return err;
- +
- + value |= AT803X_INTR_ENABLE_AUTONEG_ERR;
- + value |= AT803X_INTR_ENABLE_SPEED_CHANGED;
- + value |= AT803X_INTR_ENABLE_DUPLEX_CHANGED;
- + value |= AT803X_INTR_ENABLE_LINK_FAIL;
- + value |= AT803X_INTR_ENABLE_LINK_SUCCESS;
- +
- + err = phy_write(phydev, AT803X_INTR_ENABLE, value);
- + } else {
- + err = phy_write(phydev, AT803X_INTR_ENABLE, 0);
- + if (err)
- + return err;
- +
- + /* Clear any pending interrupts */
- + err = at803x_ack_interrupt(phydev);
- + }
- +
- + return err;
- +}
- +EXPORT_SYMBOL_GPL(at803x_config_intr);
- +
- +irqreturn_t at803x_handle_interrupt(struct phy_device *phydev)
- +{
- + int irq_status, int_enabled;
- +
- + irq_status = phy_read(phydev, AT803X_INTR_STATUS);
- + if (irq_status < 0) {
- + phy_error(phydev);
- + return IRQ_NONE;
- + }
- +
- + /* Read the current enabled interrupts */
- + int_enabled = phy_read(phydev, AT803X_INTR_ENABLE);
- + if (int_enabled < 0) {
- + phy_error(phydev);
- + return IRQ_NONE;
- + }
- +
- + /* See if this was one of our enabled interrupts */
- + if (!(irq_status & int_enabled))
- + return IRQ_NONE;
- +
- + phy_trigger_machine(phydev);
- +
- + return IRQ_HANDLED;
- +}
- +EXPORT_SYMBOL_GPL(at803x_handle_interrupt);
- +
- +int at803x_read_specific_status(struct phy_device *phydev,
- + struct at803x_ss_mask ss_mask)
- +{
- + int ss;
- +
- + /* Read the AT8035 PHY-Specific Status register, which indicates the
- + * speed and duplex that the PHY is actually using, irrespective of
- + * whether we are in autoneg mode or not.
- + */
- + ss = phy_read(phydev, AT803X_SPECIFIC_STATUS);
- + if (ss < 0)
- + return ss;
- +
- + if (ss & AT803X_SS_SPEED_DUPLEX_RESOLVED) {
- + int sfc, speed;
- +
- + sfc = phy_read(phydev, AT803X_SPECIFIC_FUNCTION_CONTROL);
- + if (sfc < 0)
- + return sfc;
- +
- + speed = ss & ss_mask.speed_mask;
- + speed >>= ss_mask.speed_shift;
- +
- + switch (speed) {
- + case AT803X_SS_SPEED_10:
- + phydev->speed = SPEED_10;
- + break;
- + case AT803X_SS_SPEED_100:
- + phydev->speed = SPEED_100;
- + break;
- + case AT803X_SS_SPEED_1000:
- + phydev->speed = SPEED_1000;
- + break;
- + case QCA808X_SS_SPEED_2500:
- + phydev->speed = SPEED_2500;
- + break;
- + }
- + if (ss & AT803X_SS_DUPLEX)
- + phydev->duplex = DUPLEX_FULL;
- + else
- + phydev->duplex = DUPLEX_HALF;
- +
- + if (ss & AT803X_SS_MDIX)
- + phydev->mdix = ETH_TP_MDI_X;
- + else
- + phydev->mdix = ETH_TP_MDI;
- +
- + switch (FIELD_GET(AT803X_SFC_MDI_CROSSOVER_MODE_M, sfc)) {
- + case AT803X_SFC_MANUAL_MDI:
- + phydev->mdix_ctrl = ETH_TP_MDI;
- + break;
- + case AT803X_SFC_MANUAL_MDIX:
- + phydev->mdix_ctrl = ETH_TP_MDI_X;
- + break;
- + case AT803X_SFC_AUTOMATIC_CROSSOVER:
- + phydev->mdix_ctrl = ETH_TP_MDI_AUTO;
- + break;
- + }
- + }
- +
- + return 0;
- +}
- +EXPORT_SYMBOL_GPL(at803x_read_specific_status);
- +
- +int at803x_config_mdix(struct phy_device *phydev, u8 ctrl)
- +{
- + u16 val;
- +
- + switch (ctrl) {
- + case ETH_TP_MDI:
- + val = AT803X_SFC_MANUAL_MDI;
- + break;
- + case ETH_TP_MDI_X:
- + val = AT803X_SFC_MANUAL_MDIX;
- + break;
- + case ETH_TP_MDI_AUTO:
- + val = AT803X_SFC_AUTOMATIC_CROSSOVER;
- + break;
- + default:
- + return 0;
- + }
- +
- + return phy_modify_changed(phydev, AT803X_SPECIFIC_FUNCTION_CONTROL,
- + AT803X_SFC_MDI_CROSSOVER_MODE_M,
- + FIELD_PREP(AT803X_SFC_MDI_CROSSOVER_MODE_M, val));
- +}
- +EXPORT_SYMBOL_GPL(at803x_config_mdix);
- +
- +int at803x_prepare_config_aneg(struct phy_device *phydev)
- +{
- + int ret;
- +
- + ret = at803x_config_mdix(phydev, phydev->mdix_ctrl);
- + if (ret < 0)
- + return ret;
- +
- + /* Changes of the midx bits are disruptive to the normal operation;
- + * therefore any changes to these registers must be followed by a
- + * software reset to take effect.
- + */
- + if (ret == 1) {
- + ret = genphy_soft_reset(phydev);
- + if (ret < 0)
- + return ret;
- + }
- +
- + return 0;
- +}
- +EXPORT_SYMBOL_GPL(at803x_prepare_config_aneg);
- +
- +static int at803x_get_downshift(struct phy_device *phydev, u8 *d)
- +{
- + int val;
- +
- + val = phy_read(phydev, AT803X_SMART_SPEED);
- + if (val < 0)
- + return val;
- +
- + if (val & AT803X_SMART_SPEED_ENABLE)
- + *d = FIELD_GET(AT803X_SMART_SPEED_RETRY_LIMIT_MASK, val) + 2;
- + else
- + *d = DOWNSHIFT_DEV_DISABLE;
- +
- + return 0;
- +}
- +
- +static int at803x_set_downshift(struct phy_device *phydev, u8 cnt)
- +{
- + u16 mask, set;
- + int ret;
- +
- + switch (cnt) {
- + case DOWNSHIFT_DEV_DEFAULT_COUNT:
- + cnt = AT803X_DEFAULT_DOWNSHIFT;
- + fallthrough;
- + case AT803X_MIN_DOWNSHIFT ... AT803X_MAX_DOWNSHIFT:
- + set = AT803X_SMART_SPEED_ENABLE |
- + AT803X_SMART_SPEED_BYPASS_TIMER |
- + FIELD_PREP(AT803X_SMART_SPEED_RETRY_LIMIT_MASK, cnt - 2);
- + mask = AT803X_SMART_SPEED_RETRY_LIMIT_MASK;
- + break;
- + case DOWNSHIFT_DEV_DISABLE:
- + set = 0;
- + mask = AT803X_SMART_SPEED_ENABLE |
- + AT803X_SMART_SPEED_BYPASS_TIMER;
- + break;
- + default:
- + return -EINVAL;
- + }
- +
- + ret = phy_modify_changed(phydev, AT803X_SMART_SPEED, mask, set);
- +
- + /* After changing the smart speed settings, we need to perform a
- + * software reset, use phy_init_hw() to make sure we set the
- + * reapply any values which might got lost during software reset.
- + */
- + if (ret == 1)
- + ret = phy_init_hw(phydev);
- +
- + return ret;
- +}
- +
- +int at803x_get_tunable(struct phy_device *phydev,
- + struct ethtool_tunable *tuna, void *data)
- +{
- + switch (tuna->id) {
- + case ETHTOOL_PHY_DOWNSHIFT:
- + return at803x_get_downshift(phydev, data);
- + default:
- + return -EOPNOTSUPP;
- + }
- +}
- +EXPORT_SYMBOL_GPL(at803x_get_tunable);
- +
- +int at803x_set_tunable(struct phy_device *phydev,
- + struct ethtool_tunable *tuna, const void *data)
- +{
- + switch (tuna->id) {
- + case ETHTOOL_PHY_DOWNSHIFT:
- + return at803x_set_downshift(phydev, *(const u8 *)data);
- + default:
- + return -EOPNOTSUPP;
- + }
- +}
- +EXPORT_SYMBOL_GPL(at803x_set_tunable);
- +
- +int at803x_cdt_fault_length(int dt)
- +{
- + /* According to the datasheet the distance to the fault is
- + * DELTA_TIME * 0.824 meters.
- + *
- + * The author suspect the correct formula is:
- + *
- + * fault_distance = DELTA_TIME * (c * VF) / 125MHz / 2
- + *
- + * where c is the speed of light, VF is the velocity factor of
- + * the twisted pair cable, 125MHz the counter frequency and
- + * we need to divide by 2 because the hardware will measure the
- + * round trip time to the fault and back to the PHY.
- + *
- + * With a VF of 0.69 we get the factor 0.824 mentioned in the
- + * datasheet.
- + */
- + return (dt * 824) / 10;
- +}
- +EXPORT_SYMBOL_GPL(at803x_cdt_fault_length);
- +
- +int at803x_cdt_start(struct phy_device *phydev, u32 cdt_start)
- +{
- + return phy_write(phydev, AT803X_CDT, cdt_start);
- +}
- +EXPORT_SYMBOL_GPL(at803x_cdt_start);
- +
- +int at803x_cdt_wait_for_completion(struct phy_device *phydev,
- + u32 cdt_en)
- +{
- + int val, ret;
- +
- + /* One test run takes about 25ms */
- + ret = phy_read_poll_timeout(phydev, AT803X_CDT, val,
- + !(val & cdt_en),
- + 30000, 100000, true);
- +
- + return ret < 0 ? ret : 0;
- +}
- +EXPORT_SYMBOL_GPL(at803x_cdt_wait_for_completion);
- --- a/drivers/net/phy/qcom/qcom.h
- +++ b/drivers/net/phy/qcom/qcom.h
- @@ -1,5 +1,63 @@
- /* SPDX-License-Identifier: GPL-2.0 */
-
- +#define AT803X_SPECIFIC_FUNCTION_CONTROL 0x10
- +#define AT803X_SFC_ASSERT_CRS BIT(11)
- +#define AT803X_SFC_FORCE_LINK BIT(10)
- +#define AT803X_SFC_MDI_CROSSOVER_MODE_M GENMASK(6, 5)
- +#define AT803X_SFC_AUTOMATIC_CROSSOVER 0x3
- +#define AT803X_SFC_MANUAL_MDIX 0x1
- +#define AT803X_SFC_MANUAL_MDI 0x0
- +#define AT803X_SFC_SQE_TEST BIT(2)
- +#define AT803X_SFC_POLARITY_REVERSAL BIT(1)
- +#define AT803X_SFC_DISABLE_JABBER BIT(0)
- +
- +#define AT803X_SPECIFIC_STATUS 0x11
- +#define AT803X_SS_SPEED_MASK GENMASK(15, 14)
- +#define AT803X_SS_SPEED_1000 2
- +#define AT803X_SS_SPEED_100 1
- +#define AT803X_SS_SPEED_10 0
- +#define AT803X_SS_DUPLEX BIT(13)
- +#define AT803X_SS_SPEED_DUPLEX_RESOLVED BIT(11)
- +#define AT803X_SS_MDIX BIT(6)
- +
- +#define QCA808X_SS_SPEED_MASK GENMASK(9, 7)
- +#define QCA808X_SS_SPEED_2500 4
- +
- +#define AT803X_INTR_ENABLE 0x12
- +#define AT803X_INTR_ENABLE_AUTONEG_ERR BIT(15)
- +#define AT803X_INTR_ENABLE_SPEED_CHANGED BIT(14)
- +#define AT803X_INTR_ENABLE_DUPLEX_CHANGED BIT(13)
- +#define AT803X_INTR_ENABLE_PAGE_RECEIVED BIT(12)
- +#define AT803X_INTR_ENABLE_LINK_FAIL BIT(11)
- +#define AT803X_INTR_ENABLE_LINK_SUCCESS BIT(10)
- +#define AT803X_INTR_ENABLE_LINK_FAIL_BX BIT(8)
- +#define AT803X_INTR_ENABLE_LINK_SUCCESS_BX BIT(7)
- +#define AT803X_INTR_ENABLE_WIRESPEED_DOWNGRADE BIT(5)
- +#define AT803X_INTR_ENABLE_POLARITY_CHANGED BIT(1)
- +#define AT803X_INTR_ENABLE_WOL BIT(0)
- +
- +#define AT803X_INTR_STATUS 0x13
- +
- +#define AT803X_SMART_SPEED 0x14
- +#define AT803X_SMART_SPEED_ENABLE BIT(5)
- +#define AT803X_SMART_SPEED_RETRY_LIMIT_MASK GENMASK(4, 2)
- +#define AT803X_SMART_SPEED_BYPASS_TIMER BIT(1)
- +
- +#define AT803X_CDT 0x16
- +#define AT803X_CDT_MDI_PAIR_MASK GENMASK(9, 8)
- +#define AT803X_CDT_ENABLE_TEST BIT(0)
- +#define AT803X_CDT_STATUS 0x1c
- +#define AT803X_CDT_STATUS_STAT_NORMAL 0
- +#define AT803X_CDT_STATUS_STAT_SHORT 1
- +#define AT803X_CDT_STATUS_STAT_OPEN 2
- +#define AT803X_CDT_STATUS_STAT_FAIL 3
- +#define AT803X_CDT_STATUS_STAT_MASK GENMASK(9, 8)
- +#define AT803X_CDT_STATUS_DELTA_TIME_MASK GENMASK(7, 0)
- +
- +#define AT803X_LOC_MAC_ADDR_0_15_OFFSET 0x804C
- +#define AT803X_LOC_MAC_ADDR_16_31_OFFSET 0x804B
- +#define AT803X_LOC_MAC_ADDR_32_47_OFFSET 0x804A
- +
- #define AT803X_DEBUG_ADDR 0x1D
- #define AT803X_DEBUG_DATA 0x1E
-
- @@ -16,6 +74,10 @@
- #define AT803X_DEBUG_HIB_CTRL_EN_ANY_CHANGE BIT(13)
- #define AT803X_DEBUG_HIB_CTRL_PS_HIB_EN BIT(15)
-
- +#define AT803X_DEFAULT_DOWNSHIFT 5
- +#define AT803X_MIN_DOWNSHIFT 2
- +#define AT803X_MAX_DOWNSHIFT 9
- +
- enum stat_access_type {
- PHY,
- MMD
- @@ -28,7 +90,31 @@ struct at803x_hw_stat {
- enum stat_access_type access_type;
- };
-
- +struct at803x_ss_mask {
- + u16 speed_mask;
- + u8 speed_shift;
- +};
- +
- int at803x_debug_reg_read(struct phy_device *phydev, u16 reg);
- int at803x_debug_reg_mask(struct phy_device *phydev, u16 reg,
- u16 clear, u16 set);
- int at803x_debug_reg_write(struct phy_device *phydev, u16 reg, u16 data);
- +int at803x_set_wol(struct phy_device *phydev,
- + struct ethtool_wolinfo *wol);
- +void at803x_get_wol(struct phy_device *phydev,
- + struct ethtool_wolinfo *wol);
- +int at803x_ack_interrupt(struct phy_device *phydev);
- +int at803x_config_intr(struct phy_device *phydev);
- +irqreturn_t at803x_handle_interrupt(struct phy_device *phydev);
- +int at803x_read_specific_status(struct phy_device *phydev,
- + struct at803x_ss_mask ss_mask);
- +int at803x_config_mdix(struct phy_device *phydev, u8 ctrl);
- +int at803x_prepare_config_aneg(struct phy_device *phydev);
- +int at803x_get_tunable(struct phy_device *phydev,
- + struct ethtool_tunable *tuna, void *data);
- +int at803x_set_tunable(struct phy_device *phydev,
- + struct ethtool_tunable *tuna, const void *data);
- +int at803x_cdt_fault_length(int dt);
- +int at803x_cdt_start(struct phy_device *phydev, u32 cdt_start);
- +int at803x_cdt_wait_for_completion(struct phy_device *phydev,
- + u32 cdt_en);
|