Return-Path: X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on aws-us-west-2-korg-lkml-1.web.codeaurora.org X-Spam-Level: X-Spam-Status: No, score=-9.8 required=3.0 tests=DKIM_SIGNED,DKIM_VALID, DKIM_VALID_AU,FREEMAIL_FORGED_FROMDOMAIN,FREEMAIL_FROM, HEADER_FROM_DIFFERENT_DOMAINS,INCLUDES_PATCH,MAILING_LIST_MULTI,SIGNED_OFF_BY, SPF_HELO_NONE,SPF_PASS,USER_AGENT_GIT autolearn=ham autolearn_force=no version=3.4.0 Received: from mail.kernel.org (mail.kernel.org [198.145.29.99]) by smtp.lore.kernel.org (Postfix) with ESMTP id D0647C43331 for ; Tue, 24 Mar 2020 12:49:06 +0000 (UTC) Received: from vger.kernel.org (vger.kernel.org [209.132.180.67]) by mail.kernel.org (Postfix) with ESMTP id 9851B207FF for ; Tue, 24 Mar 2020 12:49:06 +0000 (UTC) Authentication-Results: mail.kernel.org; dkim=pass (2048-bit key) header.d=gmail.com header.i=@gmail.com header.b="hwOUoOFr" Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1727398AbgCXMtF (ORCPT ); Tue, 24 Mar 2020 08:49:05 -0400 Received: from mail-wm1-f67.google.com ([209.85.128.67]:34781 "EHLO mail-wm1-f67.google.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1727303AbgCXMtF (ORCPT ); Tue, 24 Mar 2020 08:49:05 -0400 Received: by mail-wm1-f67.google.com with SMTP id 26so2437639wmk.1 for ; Tue, 24 Mar 2020 05:49:04 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=gmail.com; s=20161025; h=from:to:cc:subject:date:message-id; bh=TDFinHncpxFJ2aEKvwmitl1HV976gEnCeXH+G0Lzwbs=; b=hwOUoOFrEAWzy+9x1GzBWc3bJOEcbpAM7Gwrs6fBIKw7DU+5SWwVGOjejsqvWy/u1j 1uk/dZtPLLZYtenN+A5RWxTuGBr8Wi8yOHSgeaGQjuqFG2lfxOuuZXJVwSD9KuHPhDNa lVa2Up7XT3eLxH0DYj9mO7U0ETVfSF/PmM0Y4UfEFDnnJ3s2JlK0Nig4vLEvSIL4HcdC xnALRavAJBlPKduye9HfUJZTTA/WKJmNpX82fctdvxG6b5xO6tSEhJfCiXNiPKsff/aM GH+yIyvIYMdleZKGjcAdhk/ITiOZDG/y3pt742F7xev4d6JVfewd7gz6RCJkvOJ0GCnY WGNg== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20161025; h=x-gm-message-state:from:to:cc:subject:date:message-id; bh=TDFinHncpxFJ2aEKvwmitl1HV976gEnCeXH+G0Lzwbs=; b=nnSsJtOrDvbGXGZ5ySwlrh9oJkN3pch1Bi1wGRqlIvl940+mgBDT2XGqogokduhdx/ Cu4jIxIsPxwZCOLCoAsJutuEhltJUoh8qK+ZeBYj5FidN2R+Kp7owx6QSQymec4yHoQX lsN/xuvJzXrPNeG1uCUX9v5bS5WpdyQFcog4gQviWTOXUVzMKa1s2iUtXkTBSSu9j20Y /l3RJYiA1mJApbPvzGvlCco5rzzzy46m9U9y3ID0nmEZtFhsd1zORr9PPTeJShoIUVRM bQ21NImh3/4xClG0OFRdjmxfER/HK7z76uM0Ut1eM6lb6hPLY9EwXsRg/BhmsbDlwD4x 3w/w== X-Gm-Message-State: ANhLgQ0+ncKespsgUtDnc5Rv/w6go+0f/W08gQIuLSocqZtDxN5V9Vxq 3eweyBKAvZgodVH3wCNuOik= X-Google-Smtp-Source: ADFU+vtEgWDTNBbKWLMsqfSEfZOZ874sCCX8G1peGFmADkqhR3AQELpiWX9sml2E5ywxK/0YY4u08g== X-Received: by 2002:a7b:cb81:: with SMTP id m1mr4403825wmi.1.1585054143641; Tue, 24 Mar 2020 05:49:03 -0700 (PDT) Received: from localhost.localdomain ([79.115.60.40]) by smtp.gmail.com with ESMTPSA id a8sm3936936wmb.39.2020.03.24.05.49.02 (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Tue, 24 Mar 2020 05:49:03 -0700 (PDT) From: Vladimir Oltean To: davem@davemloft.net Cc: netdev@vger.kernel.org, andrew@lunn.ch, f.fainelli@gmail.com, hkallweit1@gmail.com, antoine.tenart@bootlin.com Subject: [PATCH net-next] net: phy: mscc: consolidate a common RGMII delay implementation Date: Tue, 24 Mar 2020 14:48:37 +0200 Message-Id: <20200324124837.21556-1-olteanv@gmail.com> X-Mailer: git-send-email 2.17.1 Sender: netdev-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: netdev@vger.kernel.org From: Vladimir Oltean It looks like the VSC8584 PHY driver is rolling its own RGMII delay configuration code, despite the fact that the logic is mostly the same. In fact only the register layout and position for the RGMII controls has changed. So we need to adapt and parameterize the PHY-dependent bit fields when calling the new generic function. Signed-off-by: Vladimir Oltean --- drivers/net/phy/mscc/mscc.h | 28 ++++--------- drivers/net/phy/mscc/mscc_main.c | 71 +++++++++++++++----------------- 2 files changed, 42 insertions(+), 57 deletions(-) diff --git a/drivers/net/phy/mscc/mscc.h b/drivers/net/phy/mscc/mscc.h index d983d3af66d6..030bf8b600df 100644 --- a/drivers/net/phy/mscc/mscc.h +++ b/drivers/net/phy/mscc/mscc.h @@ -161,25 +161,15 @@ enum rgmii_clock_delay { /* Extended Page 2 Registers */ #define MSCC_PHY_CU_PMD_TX_CNTL 16 -#define MSCC_PHY_RGMII_SETTINGS 18 -#define RGMII_SKEW_RX_POS 1 -#define RGMII_SKEW_TX_POS 4 - -/* RGMII skew values, in ns */ -#define VSC8584_RGMII_SKEW_0_2 0 -#define VSC8584_RGMII_SKEW_0_8 1 -#define VSC8584_RGMII_SKEW_1_1 2 -#define VSC8584_RGMII_SKEW_1_7 3 -#define VSC8584_RGMII_SKEW_2_0 4 -#define VSC8584_RGMII_SKEW_2_3 5 -#define VSC8584_RGMII_SKEW_2_6 6 -#define VSC8584_RGMII_SKEW_3_4 7 - -#define MSCC_PHY_RGMII_CNTL 20 -#define RGMII_RX_CLK_DELAY_MASK 0x0070 -#define RGMII_RX_CLK_DELAY_POS 4 -#define RGMII_TX_CLK_DELAY_MASK 0x0007 -#define RGMII_TX_CLK_DELAY_POS 0 +/* RGMII setting controls at address 18E2, for VSC8572 and similar */ +#define VSC8572_RGMII_CNTL 18 +#define VSC8572_RGMII_RX_DELAY_MASK 0x000E +#define VSC8572_RGMII_TX_DELAY_MASK 0x0070 + +/* RGMII controls at address 20E2, for VSC8502 and similar */ +#define VSC8502_RGMII_CNTL 20 +#define VSC8502_RGMII_RX_DELAY_MASK 0x0070 +#define VSC8502_RGMII_TX_DELAY_MASK 0x0007 #define MSCC_PHY_WOL_LOWER_MAC_ADDR 21 #define MSCC_PHY_WOL_MID_MAC_ADDR 22 diff --git a/drivers/net/phy/mscc/mscc_main.c b/drivers/net/phy/mscc/mscc_main.c index 19603081dd14..d14d4c7263f4 100644 --- a/drivers/net/phy/mscc/mscc_main.c +++ b/drivers/net/phy/mscc/mscc_main.c @@ -520,28 +520,27 @@ static int vsc85xx_mac_if_set(struct phy_device *phydev, return rc; } -static int vsc85xx_default_config(struct phy_device *phydev) +static int vsc85xx_rgmii_set_skews(struct phy_device *phydev, u32 rgmii_cntl, + u16 rgmii_rx_delay_mask, + u16 rgmii_tx_delay_mask) { + u16 rgmii_rx_delay_pos = ffs(rgmii_rx_delay_mask) - 1; + u16 rgmii_tx_delay_pos = ffs(rgmii_tx_delay_mask) - 1; u16 reg_val = 0; int rc; - phydev->mdix_ctrl = ETH_TP_MDI_AUTO; - - if (!phy_interface_mode_is_rgmii(phydev->interface)) - return 0; - mutex_lock(&phydev->lock); if (phydev->interface == PHY_INTERFACE_MODE_RGMII_RXID || phydev->interface == PHY_INTERFACE_MODE_RGMII_ID) - reg_val |= RGMII_CLK_DELAY_2_0_NS << RGMII_RX_CLK_DELAY_POS; + reg_val |= RGMII_CLK_DELAY_2_0_NS << rgmii_rx_delay_pos; if (phydev->interface == PHY_INTERFACE_MODE_RGMII_TXID || phydev->interface == PHY_INTERFACE_MODE_RGMII_ID) - reg_val |= RGMII_CLK_DELAY_2_0_NS << RGMII_TX_CLK_DELAY_POS; + reg_val |= RGMII_CLK_DELAY_2_0_NS << rgmii_tx_delay_pos; rc = phy_modify_paged(phydev, MSCC_PHY_PAGE_EXTENDED_2, - MSCC_PHY_RGMII_CNTL, - RGMII_RX_CLK_DELAY_MASK | RGMII_TX_CLK_DELAY_MASK, + rgmii_cntl, + rgmii_rx_delay_mask | rgmii_tx_delay_mask, reg_val); mutex_unlock(&phydev->lock); @@ -549,6 +548,23 @@ static int vsc85xx_default_config(struct phy_device *phydev) return rc; } +static int vsc85xx_default_config(struct phy_device *phydev) +{ + int rc; + + phydev->mdix_ctrl = ETH_TP_MDI_AUTO; + + if (phy_interface_mode_is_rgmii(phydev->interface)) { + rc = vsc85xx_rgmii_set_skews(phydev, VSC8502_RGMII_CNTL, + VSC8502_RGMII_RX_DELAY_MASK, + VSC8502_RGMII_TX_DELAY_MASK); + if (rc) + return rc; + } + + return 0; +} + static int vsc85xx_get_tunable(struct phy_device *phydev, struct ethtool_tunable *tuna, void *data) { @@ -1301,32 +1317,6 @@ static bool vsc8584_is_pkg_init(struct phy_device *phydev, bool reversed) return false; } -static void vsc8584_rgmii_set_skews(struct phy_device *phydev) -{ - u32 skew_rx, skew_tx; - - /* We first set the Rx and Tx skews to their default value in h/w - * (0.2 ns). - */ - skew_rx = VSC8584_RGMII_SKEW_0_2; - skew_tx = VSC8584_RGMII_SKEW_0_2; - - /* We then set the skews based on the interface mode. */ - if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID || - phydev->interface == PHY_INTERFACE_MODE_RGMII_RXID) - skew_rx = VSC8584_RGMII_SKEW_2_0; - if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID || - phydev->interface == PHY_INTERFACE_MODE_RGMII_TXID) - skew_tx = VSC8584_RGMII_SKEW_2_0; - - /* Finally we apply the skews configuration. */ - phy_modify_paged(phydev, MSCC_PHY_PAGE_EXTENDED_2, - MSCC_PHY_RGMII_SETTINGS, - (0x7 << RGMII_SKEW_RX_POS) | (0x7 << RGMII_SKEW_TX_POS), - (skew_rx << RGMII_SKEW_RX_POS) | - (skew_tx << RGMII_SKEW_TX_POS)); -} - static int vsc8584_config_init(struct phy_device *phydev) { struct vsc8531_private *vsc8531 = phydev->priv; @@ -1461,8 +1451,13 @@ static int vsc8584_config_init(struct phy_device *phydev) if (ret) return ret; - if (phy_interface_is_rgmii(phydev)) - vsc8584_rgmii_set_skews(phydev); + if (phy_interface_is_rgmii(phydev)) { + ret = vsc85xx_rgmii_set_skews(phydev, VSC8572_RGMII_CNTL, + VSC8572_RGMII_RX_DELAY_MASK, + VSC8572_RGMII_TX_DELAY_MASK); + if (ret) + return ret; + } ret = genphy_soft_reset(phydev); if (ret) -- 2.17.1