Received: by 2002:ad5:4acb:0:0:0:0:0 with SMTP id n11csp509559imw; Thu, 14 Jul 2022 05:47:01 -0700 (PDT) X-Google-Smtp-Source: AGRyM1te8Tn6B8IP+kb+SIuqShk2vd0AHPWdhV4oJT0AtzPUYsKQB+3rke+FvekziYmhdHJyg97k X-Received: by 2002:a17:907:2856:b0:72b:54bd:40eb with SMTP id el22-20020a170907285600b0072b54bd40ebmr8407966ejc.542.1657802820890; Thu, 14 Jul 2022 05:47:00 -0700 (PDT) ARC-Seal: i=1; a=rsa-sha256; t=1657802820; cv=none; d=google.com; s=arc-20160816; b=Z1eFgXG3XiQs923tCnS2PPABWEbQo25y+ZfEKNPyDpaD41xaEwmhKaHM/2s4JKdgGZ +t16VC/nIOwIu2+3N40CwfL95DJ4/+ExyTQcV72gBWiOOMAOUbui+CZV/GLkavRbLDNT GAUmp80AZsyD79iCsrYiLIs5gvyEfMdTRTybHCmHNfMjwIBNuieyp5PVQLSC1zlKZViG 3swJ++BCQfECahyCR7C4fMLE1wEgBiWRuR/6W05eEcZsQg7TW7khQqIESW4X5phTLHCT em5VQ7wsgTEz5rKFAccHvXf6ppIrqJMw4XbMhoc05hURcFOU0UA8CjY7CVWxQHcz4WL9 Y04Q== ARC-Message-Signature: i=1; a=rsa-sha256; c=relaxed/relaxed; d=google.com; s=arc-20160816; h=list-id:precedence:sender:in-reply-to:content-disposition :mime-version:references:message-id:subject:cc:to:from:date :dkim-signature; bh=ZF5D/YPZfSoYL9UxmTI6VmdqxY8D4hjniel8yVXIkF8=; b=LGhHVqBZr3HXsYoTTcuscQzoIr3RNhigccmsw68FSIl6UchlMGTrtQCFKsD3Ki18HH g6aWiuPgXUnUWMonhBUtxVRNtjjuvT9RUMAWuOXPMqOGx2zNdmuim2GlFZKdOVEkY7LZ bUlS4h0NzgnRgznsZwhacwURXfTnVsaiU64oBjd75zR5+4S4rzlt9/SonSwfGTNkOxQN 0XYLylPopWZi+hbQWlLVUecUE66wwQ+2oM/5Xr9rreqIvhahRxoajk9U9PnTaZxbBo1f Y/3vaG1waVdH+EycXEBvt2OG4EJZEps7vSonqbuoITPY9x8QGLD0yZ5aQ2xgAXm5Xpca EJUA== ARC-Authentication-Results: i=1; mx.google.com; dkim=fail (test mode) header.i=@armlinux.org.uk header.s=pandora-2019 header.b=leukULvK; spf=pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 2620:137:e000::1:20 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org; dmarc=fail (p=NONE sp=NONE dis=NONE) header.from=armlinux.org.uk Return-Path: Received: from out1.vger.email (out1.vger.email. [2620:137:e000::1:20]) by mx.google.com with ESMTP id s19-20020a056402521300b0043a119b4bd0si2603144edd.554.2022.07.14.05.46.36; Thu, 14 Jul 2022 05:47:00 -0700 (PDT) Received-SPF: pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 2620:137:e000::1:20 as permitted sender) client-ip=2620:137:e000::1:20; Authentication-Results: mx.google.com; dkim=fail (test mode) header.i=@armlinux.org.uk header.s=pandora-2019 header.b=leukULvK; spf=pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 2620:137:e000::1:20 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org; dmarc=fail (p=NONE sp=NONE dis=NONE) header.from=armlinux.org.uk Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S238852AbiGNMlA (ORCPT + 99 others); Thu, 14 Jul 2022 08:41:00 -0400 Received: from lindbergh.monkeyblade.net ([23.128.96.19]:32928 "EHLO lindbergh.monkeyblade.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S231795AbiGNMk5 (ORCPT ); Thu, 14 Jul 2022 08:40:57 -0400 Received: from pandora.armlinux.org.uk (pandora.armlinux.org.uk [IPv6:2001:4d48:ad52:32c8:5054:ff:fe00:142]) by lindbergh.monkeyblade.net (Postfix) with ESMTPS id 1E2AD5A2D3; Thu, 14 Jul 2022 05:40:56 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; q=dns/txt; c=relaxed/relaxed; d=armlinux.org.uk; s=pandora-2019; h=Sender:In-Reply-To:Content-Type: MIME-Version:References:Message-ID:Subject:Cc:To:From:Date:Reply-To: Content-Transfer-Encoding:Content-ID:Content-Description:Resent-Date: Resent-From:Resent-Sender:Resent-To:Resent-Cc:Resent-Message-ID:List-Id: List-Help:List-Unsubscribe:List-Subscribe:List-Post:List-Owner:List-Archive; bh=ZF5D/YPZfSoYL9UxmTI6VmdqxY8D4hjniel8yVXIkF8=; b=leukULvKmJ0YrsQKUiERnznPqi tfD3603s/pPZTiDc8YoW6PjVfCgpKOn+3QLn/osprQirCokALYN2SFftCcGW5AByYe+wZUS108REK tmvGHLmrbtbLKaolWrwjLhN3VKnnk5sZR9D7rYdlxmFQrAl+dbJmvwNfR+oX9OWcltsVmbOXUd2DZ RkcqHYsu5GM3TPdxympV+gF2oXEqhrCfjLBMhvzk2EoUjIghewD/N4ZTKD/L6KCZjubqBC0oYX9UY ZNBxUZFI2qZpErub1JTlLB+r202qsNoL8E+LWvSpT8+nprfn1dTT1hJj70UZiCzN/g+rlv0Q6EqNZ NeChPL4w==; Received: from shell.armlinux.org.uk ([fd8f:7570:feb6:1:5054:ff:fe00:4ec]:33340) by pandora.armlinux.org.uk with esmtpsa (TLS1.3) tls TLS_ECDHE_RSA_WITH_AES_256_GCM_SHA384 (Exim 4.94.2) (envelope-from ) id 1oBy9G-0005nf-BW; Thu, 14 Jul 2022 13:40:54 +0100 Received: from linux by shell.armlinux.org.uk with local (Exim 4.94.2) (envelope-from ) id 1oBy9F-0006cn-DX; Thu, 14 Jul 2022 13:40:53 +0100 Date: Thu, 14 Jul 2022 13:40:53 +0100 From: "Russell King (Oracle)" To: Oleksandr Mazur Cc: netdev@vger.kernel.org, linux-kernel@vger.kernel.org, davem@davemloft.net, edumazet@google.com, kuba@kernel.org, pabeni@redhat.com, yevhen.orlov@plvision.eu, taras.chornyi@plvision.eu, andrew@lunn.ch Subject: Re: [PATCH V3 net-next] net: marvell: prestera: add phylink support Message-ID: References: <20220714105516.14291-1-oleksandr.mazur@plvision.eu> MIME-Version: 1.0 Content-Type: text/plain; charset=us-ascii Content-Disposition: inline In-Reply-To: <20220714105516.14291-1-oleksandr.mazur@plvision.eu> Sender: Russell King (Oracle) X-Spam-Status: No, score=-2.1 required=5.0 tests=BAYES_00,DKIM_SIGNED, DKIM_VALID,DKIM_VALID_AU,DKIM_VALID_EF,SPF_HELO_NONE,SPF_NONE, T_SCC_BODY_TEXT_LINE autolearn=ham autolearn_force=no version=3.4.6 X-Spam-Checker-Version: SpamAssassin 3.4.6 (2021-04-09) on lindbergh.monkeyblade.net Precedence: bulk List-ID: X-Mailing-List: linux-kernel@vger.kernel.org Hi Oleksandr, A process tip: don't send another version immediately after receiving feedback from a previous version - it's really not helpful, and it overloads reviewers with additional burden. Please wait at least a few days to see if anyone else comments on the changes before sending another revision of it - or a reviewer replies to your reply (as I have just done.) Thanks. On Thu, Jul 14, 2022 at 01:55:16PM +0300, Oleksandr Mazur wrote: > For SFP port prestera driver will use kernel > phylink infrastucture to configure port mode based on > the module that has beed inserted > > Co-developed-by: Yevhen Orlov > Signed-off-by: Yevhen Orlov > Co-developed-by: Taras Chornyi > Signed-off-by: Taras Chornyi > Signed-off-by: Oleksandr Mazur > > PATCH V3: > - force inband mode for SGMII > - fix >80 chars warning of checkpatch where possible (2/5) > - structure phylink_mac_change alongside phylink-related if-clause; > PATCH V2: > - fix mistreat of bitfield values as if they were bools. > - remove phylink_config ifdefs. > - remove obsolete phylink pcs / mac callbacks; > - rework mac (/pcs) config to not look for speed / duplex > parameters while link is not yet set up. > - remove unused functions. > - add phylink select cfg to prestera Kconfig. > --- > drivers/net/ethernet/marvell/prestera/Kconfig | 1 + > .../net/ethernet/marvell/prestera/prestera.h | 9 + > .../marvell/prestera/prestera_ethtool.c | 28 +- > .../marvell/prestera/prestera_ethtool.h | 3 - > .../ethernet/marvell/prestera/prestera_main.c | 348 ++++++++++++++++-- > 5 files changed, 327 insertions(+), 62 deletions(-) > > diff --git a/drivers/net/ethernet/marvell/prestera/Kconfig b/drivers/net/ethernet/marvell/prestera/Kconfig > index b6f20e2034c6..f2f7663c3d10 100644 > --- a/drivers/net/ethernet/marvell/prestera/Kconfig > +++ b/drivers/net/ethernet/marvell/prestera/Kconfig > @@ -8,6 +8,7 @@ config PRESTERA > depends on NET_SWITCHDEV && VLAN_8021Q > depends on BRIDGE || BRIDGE=n > select NET_DEVLINK > + select PHYLINK > help > This driver supports Marvell Prestera Switch ASICs family. > > diff --git a/drivers/net/ethernet/marvell/prestera/prestera.h b/drivers/net/ethernet/marvell/prestera/prestera.h > index bff9651f0a89..832c27e0c284 100644 > --- a/drivers/net/ethernet/marvell/prestera/prestera.h > +++ b/drivers/net/ethernet/marvell/prestera/prestera.h > @@ -7,6 +7,7 @@ > #include > #include > #include > +#include > #include > #include > > @@ -92,6 +93,7 @@ struct prestera_lag { > struct prestera_flow_block; > > struct prestera_port_mac_state { > + bool valid; > u32 mode; > u32 speed; > bool oper; > @@ -151,6 +153,12 @@ struct prestera_port { > struct prestera_port_phy_config cfg_phy; > struct prestera_port_mac_state state_mac; > struct prestera_port_phy_state state_phy; > + > + struct phylink_config phy_config; > + struct phylink *phy_link; > + struct phylink_pcs phylink_pcs; > + > + rwlock_t state_mac_lock; > }; > > struct prestera_device { > @@ -291,6 +299,7 @@ struct prestera_switch { > u32 mtu_min; > u32 mtu_max; > u8 id; > + struct device_node *np; > struct prestera_router *router; > struct prestera_lag *lags; > struct prestera_counter *counter; > diff --git a/drivers/net/ethernet/marvell/prestera/prestera_ethtool.c b/drivers/net/ethernet/marvell/prestera/prestera_ethtool.c > index 40d5b89573bb..1da7ff889417 100644 > --- a/drivers/net/ethernet/marvell/prestera/prestera_ethtool.c > +++ b/drivers/net/ethernet/marvell/prestera/prestera_ethtool.c > @@ -521,6 +521,9 @@ prestera_ethtool_get_link_ksettings(struct net_device *dev, > ecmd->base.speed = SPEED_UNKNOWN; > ecmd->base.duplex = DUPLEX_UNKNOWN; > > + if (port->phy_link) > + return phylink_ethtool_ksettings_get(port->phy_link, ecmd); > + > ecmd->base.autoneg = port->autoneg ? AUTONEG_ENABLE : AUTONEG_DISABLE; > > if (port->caps.type == PRESTERA_PORT_TYPE_TP) { > @@ -648,6 +651,9 @@ prestera_ethtool_set_link_ksettings(struct net_device *dev, > u8 adver_fec; > int err; > > + if (port->phy_link) > + return phylink_ethtool_ksettings_set(port->phy_link, ecmd); > + > err = prestera_port_type_set(ecmd, port); > if (err) > return err; > @@ -782,28 +788,6 @@ static int prestera_ethtool_nway_reset(struct net_device *dev) > return -EINVAL; > } > > -void prestera_ethtool_port_state_changed(struct prestera_port *port, > - struct prestera_port_event *evt) > -{ > - struct prestera_port_mac_state *smac = &port->state_mac; > - > - smac->oper = evt->data.mac.oper; > - > - if (smac->oper) { > - smac->mode = evt->data.mac.mode; > - smac->speed = evt->data.mac.speed; > - smac->duplex = evt->data.mac.duplex; > - smac->fc = evt->data.mac.fc; > - smac->fec = evt->data.mac.fec; > - } else { > - smac->mode = PRESTERA_MAC_MODE_MAX; > - smac->speed = SPEED_UNKNOWN; > - smac->duplex = DUPLEX_UNKNOWN; > - smac->fc = 0; > - smac->fec = 0; > - } > -} > - > const struct ethtool_ops prestera_ethtool_ops = { > .get_drvinfo = prestera_ethtool_get_drvinfo, > .get_link_ksettings = prestera_ethtool_get_link_ksettings, > diff --git a/drivers/net/ethernet/marvell/prestera/prestera_ethtool.h b/drivers/net/ethernet/marvell/prestera/prestera_ethtool.h > index 9eb18e99dea6..bd5600886bc6 100644 > --- a/drivers/net/ethernet/marvell/prestera/prestera_ethtool.h > +++ b/drivers/net/ethernet/marvell/prestera/prestera_ethtool.h > @@ -11,7 +11,4 @@ struct prestera_port; > > extern const struct ethtool_ops prestera_ethtool_ops; > > -void prestera_ethtool_port_state_changed(struct prestera_port *port, > - struct prestera_port_event *evt); > - > #endif /* _PRESTERA_ETHTOOL_H_ */ > diff --git a/drivers/net/ethernet/marvell/prestera/prestera_main.c b/drivers/net/ethernet/marvell/prestera/prestera_main.c > index ea5bd5069826..65fded8c8f87 100644 > --- a/drivers/net/ethernet/marvell/prestera/prestera_main.c > +++ b/drivers/net/ethernet/marvell/prestera/prestera_main.c > @@ -9,6 +9,7 @@ > #include > #include > #include > +#include > > #include "prestera.h" > #include "prestera_hw.h" > @@ -142,18 +143,24 @@ static int prestera_port_open(struct net_device *dev) > struct prestera_port_mac_config cfg_mac; > int err = 0; > > - if (port->caps.transceiver == PRESTERA_PORT_TCVR_SFP) { > - err = prestera_port_cfg_mac_read(port, &cfg_mac); > - if (!err) { > - cfg_mac.admin = true; > - err = prestera_port_cfg_mac_write(port, &cfg_mac); > - } > + if (port->phy_link) { > + phylink_start(port->phy_link); > } else { > - port->cfg_phy.admin = true; > - err = prestera_hw_port_phy_mode_set(port, true, port->autoneg, > - port->cfg_phy.mode, > - port->adver_link_modes, > - port->cfg_phy.mdix); > + if (port->caps.transceiver == PRESTERA_PORT_TCVR_SFP) { > + err = prestera_port_cfg_mac_read(port, &cfg_mac); > + if (!err) { > + cfg_mac.admin = true; > + err = prestera_port_cfg_mac_write(port, > + &cfg_mac); > + } > + } else { > + port->cfg_phy.admin = true; > + err = prestera_hw_port_phy_mode_set(port, true, > + port->autoneg, > + port->cfg_phy.mode, > + port->adver_link_modes, > + port->cfg_phy.mdix); > + } > } > > netif_start_queue(dev); > @@ -169,23 +176,255 @@ static int prestera_port_close(struct net_device *dev) > > netif_stop_queue(dev); > > - if (port->caps.transceiver == PRESTERA_PORT_TCVR_SFP) { > + if (port->phy_link) { > + phylink_stop(port->phy_link); > + phylink_disconnect_phy(port->phy_link); > err = prestera_port_cfg_mac_read(port, &cfg_mac); > if (!err) { > cfg_mac.admin = false; > prestera_port_cfg_mac_write(port, &cfg_mac); > } > } else { > - port->cfg_phy.admin = false; > - err = prestera_hw_port_phy_mode_set(port, false, port->autoneg, > - port->cfg_phy.mode, > - port->adver_link_modes, > - port->cfg_phy.mdix); > + if (port->caps.transceiver == PRESTERA_PORT_TCVR_SFP) { > + err = prestera_port_cfg_mac_read(port, &cfg_mac); > + if (!err) { > + cfg_mac.admin = false; > + prestera_port_cfg_mac_write(port, &cfg_mac); > + } > + } else { > + port->cfg_phy.admin = false; > + err = prestera_hw_port_phy_mode_set(port, false, port->autoneg, > + port->cfg_phy.mode, > + port->adver_link_modes, > + port->cfg_phy.mdix); > + } > + } > + > + return err; > +} > + > +static void > +prestera_port_mac_state_cache_read(struct prestera_port *port, > + struct prestera_port_mac_state *state) > +{ > + read_lock(&port->state_mac_lock); > + *state = port->state_mac; > + read_unlock(&port->state_mac_lock); > +} > + > +static void > +prestera_port_mac_state_cache_write(struct prestera_port *port, > + struct prestera_port_mac_state *state) > +{ > + write_lock(&port->state_mac_lock); > + port->state_mac = *state; > + write_unlock(&port->state_mac_lock); > +} > + > +static struct prestera_port *prestera_pcs_to_port(struct phylink_pcs *pcs) > +{ > + return container_of(pcs, struct prestera_port, phylink_pcs); > +} > + > +static void prestera_mac_config(struct phylink_config *config, > + unsigned int an_mode, > + const struct phylink_link_state *state) > +{ > +} > + > +static void prestera_mac_link_down(struct phylink_config *config, > + unsigned int mode, phy_interface_t interface) > +{ > + struct net_device *ndev = to_net_dev(config->dev); > + struct prestera_port *port = netdev_priv(ndev); > + struct prestera_port_mac_state state_mac; > + > + /* Invalidate. Parameters will update on next link event. */ > + memset(&state_mac, 0, sizeof(state_mac)); > + state_mac.valid = false; > + prestera_port_mac_state_cache_write(port, &state_mac); > +} > + > +static void prestera_mac_link_up(struct phylink_config *config, > + struct phy_device *phy, > + unsigned int mode, phy_interface_t interface, > + int speed, int duplex, > + bool tx_pause, bool rx_pause) > +{ > +} > + > +static struct phylink_pcs * > +prestera_mac_select_pcs(struct phylink_config *config, > + phy_interface_t interface) > +{ > + struct net_device *dev = to_net_dev(config->dev); > + struct prestera_port *port = netdev_priv(dev); > + > + return &port->phylink_pcs; > +} > + > +static void prestera_pcs_get_state(struct phylink_pcs *pcs, > + struct phylink_link_state *state) > +{ > + struct prestera_port *port = container_of(pcs, struct prestera_port, > + phylink_pcs); > + struct prestera_port_mac_state smac; > + > + prestera_port_mac_state_cache_read(port, &smac); > + > + if (smac.valid) { > + state->link = smac.oper ? 1 : 0; > + /* AN is completed, when port is up */ > + state->an_complete = (smac.oper && port->autoneg) ? 1 : 0; > + state->speed = smac.speed; > + state->duplex = smac.duplex; > + } else { > + state->link = 0; > + state->an_complete = 0; > + } > +} > + > +static int prestera_pcs_config(struct phylink_pcs *pcs, > + unsigned int mode, > + phy_interface_t interface, > + const unsigned long *advertising, > + bool permit_pause_to_mac) > +{ > + struct prestera_port *port = port = prestera_pcs_to_port(pcs); > + struct prestera_port_mac_config cfg_mac; > + int err; > + > + err = prestera_port_cfg_mac_read(port, &cfg_mac); > + if (err) > + return err; > + > + cfg_mac.admin = true; > + cfg_mac.fec = PRESTERA_PORT_FEC_OFF; > + > + switch (interface) { > + case PHY_INTERFACE_MODE_10GBASER: > + cfg_mac.speed = SPEED_10000; > + cfg_mac.inband = 0; > + cfg_mac.mode = PRESTERA_MAC_MODE_SR_LR; > + break; > + case PHY_INTERFACE_MODE_2500BASEX: > + cfg_mac.speed = SPEED_2500; > + cfg_mac.duplex = DUPLEX_FULL; > + cfg_mac.inband = test_bit(ETHTOOL_LINK_MODE_Autoneg_BIT, > + advertising); > + cfg_mac.mode = PRESTERA_MAC_MODE_SGMII; > + break; > + case PHY_INTERFACE_MODE_SGMII: > + cfg_mac.inband = 1; > + cfg_mac.mode = PRESTERA_MAC_MODE_SGMII; > + break; > + case PHY_INTERFACE_MODE_1000BASEX: > + default: > + cfg_mac.speed = SPEED_1000; > + cfg_mac.duplex = DUPLEX_FULL; > + cfg_mac.inband = test_bit(ETHTOOL_LINK_MODE_Autoneg_BIT, > + advertising); > + cfg_mac.mode = PRESTERA_MAC_MODE_1000BASE_X; > + break; > + } > + > + err = prestera_port_cfg_mac_write(port, &cfg_mac); > + if (err) > + return err; > + > + return 0; > +} > + > +static void prestera_pcs_an_restart(struct phylink_pcs *pcs) > +{ > +} > + > +static const struct phylink_mac_ops prestera_mac_ops = { > + .validate = phylink_generic_validate, > + .mac_select_pcs = prestera_mac_select_pcs, > + .mac_config = prestera_mac_config, > + .mac_link_down = prestera_mac_link_down, > + .mac_link_up = prestera_mac_link_up, > +}; > + > +static const struct phylink_pcs_ops prestera_pcs_ops = { > + .pcs_get_state = prestera_pcs_get_state, > + .pcs_config = prestera_pcs_config, > + .pcs_an_restart = prestera_pcs_an_restart, > +}; > + > +static int prestera_port_sfp_bind(struct prestera_port *port) > +{ > + struct prestera_switch *sw = port->sw; > + struct device_node *ports, *node; > + struct fwnode_handle *fwnode; > + struct phylink *phy_link; > + int err; > + > + if (!sw->np) > + return 0; > + > + ports = of_find_node_by_name(sw->np, "ports"); > + > + for_each_child_of_node(ports, node) { > + int num; > + > + err = of_property_read_u32(node, "prestera,port-num", &num); > + if (err) { > + dev_err(sw->dev->dev, > + "device node %pOF has no valid reg property: %d\n", > + node, err); > + goto out; > + } > + > + if (port->fp_id != num) > + continue; > + > + port->phylink_pcs.ops = &prestera_pcs_ops; > + > + port->phy_config.dev = &port->dev->dev; > + port->phy_config.type = PHYLINK_NETDEV; > + > + fwnode = of_fwnode_handle(node); > + > + __set_bit(PHY_INTERFACE_MODE_10GBASER, > + port->phy_config.supported_interfaces); > + __set_bit(PHY_INTERFACE_MODE_2500BASEX, > + port->phy_config.supported_interfaces); > + __set_bit(PHY_INTERFACE_MODE_SGMII, > + port->phy_config.supported_interfaces); > + __set_bit(PHY_INTERFACE_MODE_1000BASEX, > + port->phy_config.supported_interfaces); > + > + port->phy_config.mac_capabilities = > + MAC_1000 | MAC_2500FD | MAC_10000FD; > + > + phy_link = phylink_create(&port->phy_config, fwnode, > + PHY_INTERFACE_MODE_INTERNAL, > + &prestera_mac_ops); > + if (IS_ERR(phy_link)) { > + netdev_err(port->dev, "failed to create phylink\n"); > + err = PTR_ERR(phy_link); > + goto out; > + } > + > + port->phy_link = phy_link; > + break; > } > > +out: > + of_node_put(ports); > return err; > } > > +static int prestera_port_sfp_unbind(struct prestera_port *port) > +{ > + if (port->phy_link) > + phylink_destroy(port->phy_link); > + > + return 0; > +} > + > static netdev_tx_t prestera_port_xmit(struct sk_buff *skb, > struct net_device *dev) > { > @@ -380,8 +619,10 @@ static int prestera_port_create(struct prestera_switch *sw, u32 id) > dev->features |= NETIF_F_NETNS_LOCAL | NETIF_F_HW_TC; > dev->netdev_ops = &prestera_netdev_ops; > dev->ethtool_ops = &prestera_ethtool_ops; > + SET_NETDEV_DEV(dev, sw->dev->dev); > > - netif_carrier_off(dev); > + if (port->caps.transceiver != PRESTERA_PORT_TCVR_SFP) > + netif_carrier_off(dev); > > dev->mtu = min_t(unsigned int, sw->mtu_max, PRESTERA_MTU_DEFAULT); > dev->min_mtu = sw->mtu_min; > @@ -432,7 +673,7 @@ static int prestera_port_create(struct prestera_switch *sw, u32 id) > cfg_mac.admin = false; > cfg_mac.mode = PRESTERA_MAC_MODE_MAX; > } > - cfg_mac.inband = false; > + cfg_mac.inband = 0; > cfg_mac.speed = 0; > cfg_mac.duplex = DUPLEX_UNKNOWN; > cfg_mac.fec = PRESTERA_PORT_FEC_OFF; > @@ -474,8 +715,13 @@ static int prestera_port_create(struct prestera_switch *sw, u32 id) > > prestera_devlink_port_set(port); > > + err = prestera_port_sfp_bind(port); > + if (err) > + goto err_sfp_bind; > + > return 0; > > +err_sfp_bind: > err_register_netdev: > prestera_port_list_del(port); > err_port_init: > @@ -521,8 +767,10 @@ static int prestera_create_ports(struct prestera_switch *sw) > return 0; > > err_port_create: > - list_for_each_entry_safe(port, tmp, &sw->port_list, list) > + list_for_each_entry_safe(port, tmp, &sw->port_list, list) { > + prestera_port_sfp_unbind(port); > prestera_port_destroy(port); > + } > > return err; > } > @@ -530,25 +778,47 @@ static int prestera_create_ports(struct prestera_switch *sw) > static void prestera_port_handle_event(struct prestera_switch *sw, > struct prestera_event *evt, void *arg) > { > + struct prestera_port_mac_state smac; > + struct prestera_port_event *pevt; > struct delayed_work *caching_dw; > struct prestera_port *port; > > - port = prestera_find_port(sw, evt->port_evt.port_id); > - if (!port || !port->dev) > - return; > - > - caching_dw = &port->cached_hw_stats.caching_dw; > - > - prestera_ethtool_port_state_changed(port, &evt->port_evt); > - > if (evt->id == PRESTERA_PORT_EVENT_MAC_STATE_CHANGED) { > + pevt = &evt->port_evt; > + port = prestera_find_port(sw, pevt->port_id); > + if (!port || !port->dev) > + return; > + > + caching_dw = &port->cached_hw_stats.caching_dw; > + > + if (port->phy_link) { > + memset(&smac, 0, sizeof(smac)); > + smac.valid = true; > + smac.oper = pevt->data.mac.oper; > + if (smac.oper) { > + smac.mode = pevt->data.mac.mode; > + smac.speed = pevt->data.mac.speed; > + smac.duplex = pevt->data.mac.duplex; > + smac.fc = pevt->data.mac.fc; > + smac.fec = pevt->data.mac.fec; > + phylink_mac_change(port->phy_link, true); > + } else { > + phylink_mac_change(port->phy_link, false); > + } > + prestera_port_mac_state_cache_write(port, &smac); > + } > + > if (port->state_mac.oper) { > - netif_carrier_on(port->dev); > + if (!port->phy_link) > + netif_carrier_on(port->dev); > + > if (!delayed_work_pending(caching_dw)) > queue_delayed_work(prestera_wq, caching_dw, 0); > } else if (netif_running(port->dev) && > netif_carrier_ok(port->dev)) { > - netif_carrier_off(port->dev); > + if (!port->phy_link) > + netif_carrier_off(port->dev); > + > if (delayed_work_pending(caching_dw)) > cancel_delayed_work(caching_dw); > } > @@ -571,19 +841,20 @@ static void prestera_event_handlers_unregister(struct prestera_switch *sw) > static int prestera_switch_set_base_mac_addr(struct prestera_switch *sw) > { > struct device_node *base_mac_np; > - struct device_node *np; > int ret; > > - np = of_find_compatible_node(NULL, NULL, "marvell,prestera"); > - base_mac_np = of_parse_phandle(np, "base-mac-provider", 0); > + if (sw->np) { > + base_mac_np = of_parse_phandle(sw->np, "base-mac-provider", 0); > + if (base_mac_np) { > + ret = of_get_mac_address(base_mac_np, sw->base_mac); > + of_node_put(base_mac_np); > + } > + } > > - ret = of_get_mac_address(base_mac_np, sw->base_mac); > - if (ret) { > + if (!is_valid_ether_addr(sw->base_mac) || ret) { > eth_random_addr(sw->base_mac); > dev_info(prestera_dev(sw), "using random base mac address\n"); > } > - of_node_put(base_mac_np); > - of_node_put(np); > > return prestera_hw_switch_mac_set(sw, sw->base_mac); > } > @@ -1083,6 +1354,8 @@ static int prestera_switch_init(struct prestera_switch *sw) > { > int err; > > + sw->np = of_find_compatible_node(NULL, NULL, "marvell,prestera"); > + > err = prestera_hw_switch_init(sw); > if (err) { > dev_err(prestera_dev(sw), "Failed to init Switch device\n"); > @@ -1183,6 +1456,7 @@ static void prestera_switch_fini(struct prestera_switch *sw) > prestera_router_fini(sw); > prestera_netdev_event_handler_unregister(sw); > prestera_hw_switch_fini(sw); > + of_node_put(sw->np); > } > > int prestera_device_register(struct prestera_device *dev) > -- > 2.17.1 > > -- RMK's Patch system: https://www.armlinux.org.uk/developer/patches/ FTTP is here! 40Mbps down 10Mbps up. Decent connectivity at last!