Messages in this thread | | | From | Bjørn Mork <> | Subject | Re: [PATCH v2] net: mtk_sgmii: implement mtk_pcs_ops | Date | Mon, 16 Jan 2023 14:08:30 +0100 |
| |
Frank Wunderlich <frank-w@public-files.de> writes:
> apart from this little problem it works much better than it actually is so imho more > people should test it on different platforms.
Hello! I've been banging my head against an MT7986 board with two Maxlinear GPY211C phys for a while. One of those phys is connected to port 5 of the MT7531 switch. This is working perfectly.
The other GPY211C is connected to the second MT7986 mac. This one is giving me a headache...
I can only get the port to work at 2500Mb/s. Changing the speed to anything lower looks fine in ethtool etc, but traffic is blocked.
Not knowing the first thing about MACs and PHYs and such, my best guess is that there is something wrong with the PCS config.
Now I am currently testing this on an older kernel (using OpenWrt - booting mainline is not straight forward). But I have backported all the patches which came out of this thread. The resulting mtk_sgmii.c is identical to the one currently in next-next, except for some additional debug printk's. Since this is a small file, I've attached my current mtk_sgmii.c copy for reference.
The output of those printks when changing peer speed to to 1000Mb/s is:
[ 363.099410] mtk_soc_eth 15100000.ethernet wan: Link is Down [ 365.189945] mtk_sgmii_select_pcs: id=1 [ 365.193709] mtk_pcs_config: interface=4 [ 365.197530] offset:0 0x140 [ 365.197533] offset:4 0x4d544950 [ 365.200237] offset:8 0x20 [ 365.203365] mtk_pcs_config: rgc3=0x0, advertise=0x1 (changed), link_timer=1600000, sgm_mode=0x1, bmcr=0x0 [ 365.215601] mtk_pcs_link_up: interface=4 [ 365.219511] offset:0 0x140 [ 365.219513] offset:4 0x4d544950 [ 365.222204] offset:8 0x1 [ 365.225328] mtk_pcs_link_up: sgm_mode=0x18 [ 365.231940] mtk_soc_eth 15100000.ethernet wan: Link is Up - 1Gbps/Full - flow control rx/tx
and when changing peer back to autoneg (i.e. 2500Mb/s):
[ 878.939417] mtk_soc_eth 15100000.ethernet wan: Link is Down [ 883.099857] mtk_sgmii_select_pcs: id=1 [ 883.103620] mtk_pcs_config: interface=22 [ 883.107527] offset:0 0x140 [ 883.107529] offset:4 0x4d544950 [ 883.110234] offset:8 0x1 [ 883.113363] mtk_pcs_config: rgc3=0x4, advertise=0x20 (changed), link_timer=10000000, sgm_mode=0x0, bmcr=0x0 [ 883.125686] mtk_pcs_link_up: interface=22 [ 883.129683] offset:0 0x40140 [ 883.129685] offset:4 0x4d544950 [ 883.132550] offset:8 0x20 [ 883.135687] mtk_soc_eth 15100000.ethernet wan: Link is Up - 2.5Gbps/Full - flow control rx/tx
ethtool output looks as expected in both cases:
# ethtool wan Settings for wan: Supported ports: [ ] Supported link modes: 10baseT/Half 10baseT/Full 100baseT/Half 100baseT/Full 1000baseT/Full 2500baseT/Full Supported pause frame use: Symmetric Receive-only Supports auto-negotiation: Yes Supported FEC modes: Not reported Advertised link modes: 10baseT/Half 10baseT/Full 100baseT/Half 100baseT/Full 1000baseT/Full 2500baseT/Full Advertised pause frame use: Symmetric Receive-only Advertised auto-negotiation: Yes Advertised FEC modes: Not reported Link partner advertised link modes: 1000baseT/Full Link partner advertised pause frame use: Symmetric Receive-only Link partner advertised auto-negotiation: Yes Link partner advertised FEC modes: Not reported Speed: 1000Mb/s Duplex: Full Auto-negotiation: on master-slave cfg: preferred slave master-slave status: slave Port: Twisted Pair PHYAD: 6 Transceiver: external MDI-X: on (auto) Current message level: 0x000000ff (255) drv probe link timer ifdown ifup rx_err tx_err Link detected: yes
# ethtool wan Settings for wan: Supported ports: [ ] Supported link modes: 10baseT/Half 10baseT/Full 100baseT/Half 100baseT/Full 1000baseT/Full 2500baseT/Full Supported pause frame use: Symmetric Receive-only Supports auto-negotiation: Yes Supported FEC modes: Not reported Advertised link modes: 10baseT/Half 10baseT/Full 100baseT/Half 100baseT/Full 1000baseT/Full 2500baseT/Full Advertised pause frame use: Symmetric Receive-only Advertised auto-negotiation: Yes Advertised FEC modes: Not reported Link partner advertised link modes: 100baseT/Full 1000baseT/Full 2500baseT/Full Link partner advertised pause frame use: Symmetric Receive-only Link partner advertised auto-negotiation: Yes Link partner advertised FEC modes: Not reported Speed: 2500Mb/s Duplex: Full Auto-negotiation: on master-slave cfg: preferred slave master-slave status: master Port: Twisted Pair PHYAD: 6 Transceiver: external MDI-X: on (auto) Current message level: 0x000000ff (255) drv probe link timer ifdown ifup rx_err tx_err Link detected: yes
The behaviour looks similar to the GPY211C attached to switch port 5. Except that the latter works regardless of speed..
I did however notice one difference, which may or may not be significant, in the VSPEC1_SGMII_STAT register of the phys after changing to 1000Mb/s. The switch attached phy reports:
root@OpenWrt:/# mdio mdio-bus 5:30 raw 9 0x002e
while the soc mac attached phy reports
root@OpenWrt:/# mdio mdio-bus 6:30 raw 9 0x000e
According to https://assets.maxlinear.com/web/documents/617810_gpy211b1vc_gpy211c0vc_ds_rev1.4.pdf bit 5 is "Auto-Negotiation Completed". So it does look like the switch mac is doing AN on the SGMII link, and the soc mac is not. Is that correct?
Any hints on where I should look next?
The ethernet part of my device tree looks like this:
ð { status = "okay";
gmac0: mac@0 { compatible = "mediatek,eth-mac"; reg = <0>; phy-mode = "2500base-x";
fixed-link { speed = <2500>; full-duplex; pause; }; };
mac@1 { compatible = "mediatek,eth-mac"; reg = <1>; label = "wan"; phy-mode = "2500base-x"; phy-handle = <&phy6>; };
mdio: mdio-bus { #address-cells = <1>; #size-cells = <0>; }; };
&mdio { reset-gpios = <&pio 6 GPIO_ACTIVE_LOW>; reset-delay-us = <50000>; reset-post-delay-us = <20000>; phy5: phy@5 { compatible = "ethernet-phy-ieee802.3-c45"; reg = <5>; };
phy6: phy@6 { compatible = "ethernet-phy-ieee802.3-c45"; reg = <6>; };
switch: switch@1f { compatible = "mediatek,mt7531"; reg = <31>; reset-gpios = <&pio 5 GPIO_ACTIVE_HIGH>; interrupt-controller; #interrupt-cells = <1>; interrupt-parent = <&pio>; interrupts = <66 IRQ_TYPE_LEVEL_HIGH>; }; };
&switch { ports { #address-cells = <1>; #size-cells = <0>;
port@0 { reg = <0>; label = "lan3"; };
port@1 { reg = <1>; label = "lan2"; };
port@2 { reg = <2>; label = "lan1"; };
port@5 { reg = <5>; label = "lan4"; phy-mode = "2500base-x"; phy-handle = <&phy5>; };
port@6 { reg = <6>; label = "cpu"; ethernet = <&gmac0>; phy-mode = "2500base-x";
fixed-link { speed = <2500>; full-duplex; pause; }; }; }; };
Bjørn
// SPDX-License-Identifier: GPL-2.0 // Copyright (c) 2018-2019 MediaTek Inc.
/* A library for MediaTek SGMII circuit * * Author: Sean Wang <sean.wang@mediatek.com> * */
#include <linux/mfd/syscon.h> #include <linux/of.h> #include <linux/phylink.h> #include <linux/regmap.h>
#include "mtk_eth_soc.h"
static struct mtk_pcs *pcs_to_mtk_pcs(struct phylink_pcs *pcs) { return container_of(pcs, struct mtk_pcs, pcs); }
static void _dump_pcs_ctrl(struct mtk_pcs *mpcs) { unsigned int val;
regmap_read(mpcs->regmap, SGMSYS_PCS_CONTROL_1, &val); pr_info("offset:0 0x%x", val); regmap_read(mpcs->regmap, SGMSYS_PCS_CONTROL_1+4, &val); pr_info("offset:4 0x%x", val); regmap_read(mpcs->regmap, SGMSYS_PCS_CONTROL_1+8, &val); pr_info("offset:8 0x%x", val); }
static void mtk_pcs_get_state(struct phylink_pcs *pcs, struct phylink_link_state *state) { struct mtk_pcs *mpcs = pcs_to_mtk_pcs(pcs); unsigned int bm, adv;
/* Read the BMSR and LPA */ regmap_read(mpcs->regmap, SGMSYS_PCS_CONTROL_1, &bm); regmap_read(mpcs->regmap, SGMSYS_PCS_ADVERTISE, &adv);
phylink_mii_c22_pcs_decode_state(state, FIELD_GET(SGMII_BMSR, bm), FIELD_GET(SGMII_LPA, adv));
pr_info("%s: bm=0x%x, adv=0x%x\n", __FUNCTION__, bm, adv); }
static int mtk_pcs_config(struct phylink_pcs *pcs, unsigned int mode, phy_interface_t interface, const unsigned long *advertising, bool permit_pause_to_mac) { struct mtk_pcs *mpcs = pcs_to_mtk_pcs(pcs); unsigned int rgc3, sgm_mode, bmcr; int advertise, link_timer; bool changed, use_an;
pr_info("%s: interface=%u\n", __FUNCTION__, interface); _dump_pcs_ctrl(mpcs); if (interface == PHY_INTERFACE_MODE_2500BASEX) rgc3 = RG_PHY_SPEED_3_125G; else rgc3 = 0;
advertise = phylink_mii_c22_pcs_encode_advertisement(interface, advertising); if (advertise < 0) return advertise;
link_timer = phylink_get_link_timer_ns(interface); if (link_timer < 0) return link_timer;
/* Clearing IF_MODE_BIT0 switches the PCS to BASE-X mode, and * we assume that fixes it's speed at bitrate = line rate (in * other words, 1000Mbps or 2500Mbps). */ if (interface == PHY_INTERFACE_MODE_SGMII) { sgm_mode = SGMII_IF_MODE_SGMII; if (phylink_autoneg_inband(mode)) { sgm_mode |= SGMII_REMOTE_FAULT_DIS | SGMII_SPEED_DUPLEX_AN; use_an = true; } else { use_an = false; } } else if (phylink_autoneg_inband(mode)) { /* 1000base-X or 2500base-X autoneg */ sgm_mode = SGMII_REMOTE_FAULT_DIS; use_an = linkmode_test_bit(ETHTOOL_LINK_MODE_Autoneg_BIT, advertising); } else { /* 1000base-X or 2500base-X without autoneg */ sgm_mode = 0; use_an = false; }
if (use_an) { /* FIXME: Do we need to set AN_RESTART here? */ bmcr = SGMII_AN_RESTART | SGMII_AN_ENABLE; } else { bmcr = 0; }
/* Configure the underlying interface speed */ regmap_update_bits(mpcs->regmap, mpcs->ana_rgc3, RG_PHY_SPEED_3_125G, rgc3);
/* Update the advertisement, noting whether it has changed */ regmap_update_bits_check(mpcs->regmap, SGMSYS_PCS_ADVERTISE, SGMII_ADVERTISE, advertise, &changed);
/* Setup the link timer and QPHY power up inside SGMIISYS */ regmap_write(mpcs->regmap, SGMSYS_PCS_LINK_TIMER, link_timer / 2 / 8);
/* Update the sgmsys mode register */ regmap_update_bits(mpcs->regmap, SGMSYS_SGMII_MODE, SGMII_REMOTE_FAULT_DIS | SGMII_SPEED_DUPLEX_AN | SGMII_IF_MODE_SGMII, sgm_mode);
/* Update the BMCR */ regmap_update_bits(mpcs->regmap, SGMSYS_PCS_CONTROL_1, SGMII_AN_RESTART | SGMII_AN_ENABLE, bmcr);
/* Release PHYA power down state */ regmap_update_bits(mpcs->regmap, SGMSYS_QPHY_PWR_STATE_CTRL, SGMII_PHYA_PWD, 0);
pr_info("%s: rgc3=0x%x, advertise=0x%x (%schanged), link_timer=%u, sgm_mode=0x%x, bmcr=0x%x\n", __FUNCTION__, rgc3, advertise, changed ? "" : "not ", link_timer, sgm_mode, bmcr); return changed; }
static void mtk_pcs_restart_an(struct phylink_pcs *pcs) { struct mtk_pcs *mpcs = pcs_to_mtk_pcs(pcs);
regmap_update_bits(mpcs->regmap, SGMSYS_PCS_CONTROL_1, SGMII_AN_RESTART, SGMII_AN_RESTART); pr_info("%s\n", __FUNCTION__); }
static void mtk_pcs_link_up(struct phylink_pcs *pcs, unsigned int mode, phy_interface_t interface, int speed, int duplex) { struct mtk_pcs *mpcs = pcs_to_mtk_pcs(pcs); unsigned int sgm_mode;
pr_info("%s: interface=%u\n", __FUNCTION__, interface); _dump_pcs_ctrl(mpcs); if (interface != PHY_INTERFACE_MODE_SGMII || phylink_autoneg_inband(mode)) return;
/* Force the speed and duplex setting */ if (speed == SPEED_10) sgm_mode = SGMII_SPEED_10; else if (speed == SPEED_100) sgm_mode = SGMII_SPEED_100; else sgm_mode = SGMII_SPEED_1000;
if (duplex == DUPLEX_FULL) sgm_mode |= SGMII_DUPLEX_FULL;
regmap_update_bits(mpcs->regmap, SGMSYS_SGMII_MODE, SGMII_DUPLEX_FULL | SGMII_SPEED_MASK, sgm_mode); pr_info("%s: sgm_mode=0x%x\n", __FUNCTION__, sgm_mode); }
static const struct phylink_pcs_ops mtk_pcs_ops = { .pcs_get_state = mtk_pcs_get_state, .pcs_config = mtk_pcs_config, .pcs_an_restart = mtk_pcs_restart_an, .pcs_link_up = mtk_pcs_link_up, };
int mtk_sgmii_init(struct mtk_sgmii *ss, struct device_node *r, u32 ana_rgc3) { struct device_node *np; int i;
for (i = 0; i < MTK_MAX_DEVS; i++) { np = of_parse_phandle(r, "mediatek,sgmiisys", i); if (!np) break;
ss->pcs[i].ana_rgc3 = ana_rgc3; ss->pcs[i].regmap = syscon_node_to_regmap(np); of_node_put(np); if (IS_ERR(ss->pcs[i].regmap)) return PTR_ERR(ss->pcs[i].regmap);
ss->pcs[i].pcs.ops = &mtk_pcs_ops; // ss->pcs[i].pcs.poll = 1; }
pr_info("%s: ana_rgc3=0x%x\n", __FUNCTION__, ana_rgc3); return 0; }
struct phylink_pcs *mtk_sgmii_select_pcs(struct mtk_sgmii *ss, int id) { if (!ss->pcs[id].regmap) return NULL;
pr_info("%s: id=%d\n", __FUNCTION__, id); return &ss->pcs[id].pcs; }
| |