From patchwork Thu Jul 16 11:54:34 2020 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Alexander Lobakin X-Patchwork-Id: 11667241 Return-Path: Received: from mail.kernel.org (pdx-korg-mail-1.web.codeaurora.org [172.30.200.123]) by pdx-korg-patchwork-2.web.codeaurora.org (Postfix) with ESMTP id E66E360D for ; Thu, 16 Jul 2020 11:57:27 +0000 (UTC) Received: from vger.kernel.org (vger.kernel.org [23.128.96.18]) by mail.kernel.org (Postfix) with ESMTP id B5DDB20787 for ; Thu, 16 Jul 2020 11:57:27 +0000 (UTC) Authentication-Results: mail.kernel.org; dkim=fail reason="key not found in DNS" (0-bit key) header.d=marvell.com header.i=@marvell.com header.b="emwHvaNa" Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1728516AbgGPLz7 (ORCPT ); Thu, 16 Jul 2020 07:55:59 -0400 Received: from mx0b-0016f401.pphosted.com ([67.231.156.173]:20468 "EHLO mx0b-0016f401.pphosted.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1726855AbgGPLzx (ORCPT ); Thu, 16 Jul 2020 07:55:53 -0400 Received: from pps.filterd (m0045851.ppops.net [127.0.0.1]) by mx0b-0016f401.pphosted.com (8.16.0.42/8.16.0.42) with SMTP id 06GBp71f006965; Thu, 16 Jul 2020 04:55:43 -0700 DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=marvell.com; h=from : to : cc : subject : date : message-id : in-reply-to : references : mime-version : content-transfer-encoding : content-type; s=pfpt0818; bh=H0eTXvkjoBMJkIXZqngjS4Z26jA/lcJ57BKEa4UA4FY=; b=emwHvaNa4yrzMfIyHFEfppc77BUSd+suLDfQi8vOCaN5811RvfuNAXEvqeT3zg89ATMO gGLoTxWLW+JQenPtTrdban9KP9mmK9fjZFR5uDt2MuGEUDw2xmI7ZVWbXm5Bi/wuaq6S EwiKjH2VPRp1ue8wX0ml9oSbetOz1okS4e9GdRiBUf8L5GyGYvYYdt39OIKOfn3iHL/P v0LJUjh35MOjnospERnxPalVotdlzAs/mUTWyGV1z9cryuV7Wy6oSRf8AVV5nXT4liZ6 kEcKhWE8m48UzoRWyhdMGWZfboqlTRemisBsLfO+2jsSr0N//j6DNKPhF4Wu9ltDqJ4j hA== Received: from sc-exch04.marvell.com ([199.233.58.184]) by mx0b-0016f401.pphosted.com with ESMTP id 328mmhyg0p-1 (version=TLSv1.2 cipher=ECDHE-RSA-AES256-SHA384 bits=256 verify=NOT); Thu, 16 Jul 2020 04:55:42 -0700 Received: from DC5-EXCH01.marvell.com (10.69.176.38) by SC-EXCH04.marvell.com (10.93.176.84) with Microsoft SMTP Server (TLS) id 15.0.1497.2; Thu, 16 Jul 2020 04:55:41 -0700 Received: from maili.marvell.com (10.69.176.80) by DC5-EXCH01.marvell.com (10.69.176.38) with Microsoft SMTP Server id 15.0.1497.2 via Frontend Transport; Thu, 16 Jul 2020 04:55:41 -0700 Received: from NN-LT0049.marvell.com (NN-LT0049.marvell.com [10.193.54.6]) by maili.marvell.com (Postfix) with ESMTP id D48E23F703F; Thu, 16 Jul 2020 04:55:36 -0700 (PDT) From: Alexander Lobakin To: "David S. Miller" , Jakub Kicinski CC: Alexander Lobakin , Igor Russkikh , Michal Kalderon , "Ariel Elior" , Denis Bolotin , "James E.J. Bottomley" , "Martin K. Petersen" , , , , , Subject: [PATCH net-next 01/13] qed: convert link mode from u32 to bitmap Date: Thu, 16 Jul 2020 14:54:34 +0300 Message-ID: <20200716115446.994-2-alobakin@marvell.com> X-Mailer: git-send-email 2.25.1 In-Reply-To: <20200716115446.994-1-alobakin@marvell.com> References: <20200716115446.994-1-alobakin@marvell.com> MIME-Version: 1.0 X-Proofpoint-Virus-Version: vendor=fsecure engine=2.50.10434:6.0.235,18.0.687 definitions=2020-07-16_05:2020-07-16,2020-07-16 signatures=0 Sender: linux-scsi-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-scsi@vger.kernel.org Currently qed driver already ran out of 32 bits to store link modes, and this doesn't allow to add and support more speeds. Convert link mode to bitmap that will always have enough space for any number of speeds and modes. This involves changes in qede and qedf as well, as they use definitions from shared "qed_if.h". Misc: add build-time check that qed_lm_map[] is always synchronized with enum qed_link_mode_bits. Signed-off-by: Alexander Lobakin Signed-off-by: Igor Russkikh --- drivers/net/ethernet/qlogic/qed/qed_main.c | 287 ++++++++++-------- .../net/ethernet/qlogic/qede/qede_ethtool.c | 247 +++++++-------- drivers/scsi/qedf/qedf_main.c | 77 +++-- include/linux/qed/qed_if.h | 90 +++--- 4 files changed, 374 insertions(+), 327 deletions(-) diff --git a/drivers/net/ethernet/qlogic/qed/qed_main.c b/drivers/net/ethernet/qlogic/qed/qed_main.c index 4c5f5bd91359..8a0b8da19547 100644 --- a/drivers/net/ethernet/qlogic/qed/qed_main.c +++ b/drivers/net/ethernet/qlogic/qed/qed_main.c @@ -1456,10 +1456,11 @@ static bool qed_can_link_change(struct qed_dev *cdev) static int qed_set_link(struct qed_dev *cdev, struct qed_link_params *params) { - struct qed_hwfn *hwfn; struct qed_mcp_link_params *link_params; + QED_LM_DECLARE(sup_caps); + struct qed_hwfn *hwfn; struct qed_ptt *ptt; - u32 sup_caps; + u32 as; int rc; if (!cdev) @@ -1482,57 +1483,79 @@ static int qed_set_link(struct qed_dev *cdev, struct qed_link_params *params) return -EBUSY; link_params = qed_mcp_get_link_params(hwfn); + if (!link_params) + return -ENODATA; + if (params->override_flags & QED_LINK_OVERRIDE_SPEED_AUTONEG) link_params->speed.autoneg = params->autoneg; + if (params->override_flags & QED_LINK_OVERRIDE_SPEED_ADV_SPEEDS) { - link_params->speed.advertised_speeds = 0; - sup_caps = QED_LM_1000baseT_Full_BIT | - QED_LM_1000baseKX_Full_BIT | - QED_LM_1000baseX_Full_BIT; - if (params->adv_speeds & sup_caps) - link_params->speed.advertised_speeds |= - NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_1G; - sup_caps = QED_LM_10000baseT_Full_BIT | - QED_LM_10000baseKR_Full_BIT | - QED_LM_10000baseKX4_Full_BIT | - QED_LM_10000baseR_FEC_BIT | - QED_LM_10000baseCR_Full_BIT | - QED_LM_10000baseSR_Full_BIT | - QED_LM_10000baseLR_Full_BIT | - QED_LM_10000baseLRM_Full_BIT; - if (params->adv_speeds & sup_caps) - link_params->speed.advertised_speeds |= - NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_10G; - if (params->adv_speeds & QED_LM_20000baseKR2_Full_BIT) - link_params->speed.advertised_speeds |= - NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_20G; - sup_caps = QED_LM_25000baseKR_Full_BIT | - QED_LM_25000baseCR_Full_BIT | - QED_LM_25000baseSR_Full_BIT; - if (params->adv_speeds & sup_caps) - link_params->speed.advertised_speeds |= - NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_25G; - sup_caps = QED_LM_40000baseLR4_Full_BIT | - QED_LM_40000baseKR4_Full_BIT | - QED_LM_40000baseCR4_Full_BIT | - QED_LM_40000baseSR4_Full_BIT; - if (params->adv_speeds & sup_caps) - link_params->speed.advertised_speeds |= - NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_40G; - sup_caps = QED_LM_50000baseKR2_Full_BIT | - QED_LM_50000baseCR2_Full_BIT | - QED_LM_50000baseSR2_Full_BIT; - if (params->adv_speeds & sup_caps) - link_params->speed.advertised_speeds |= - NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_50G; - sup_caps = QED_LM_100000baseKR4_Full_BIT | - QED_LM_100000baseSR4_Full_BIT | - QED_LM_100000baseCR4_Full_BIT | - QED_LM_100000baseLR4_ER4_Full_BIT; - if (params->adv_speeds & sup_caps) - link_params->speed.advertised_speeds |= - NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_BB_100G; + as = 0; + + qed_link_mode_zero(sup_caps); + __set_bit(QED_LM_1000baseT_Full, sup_caps); + __set_bit(QED_LM_1000baseKX_Full, sup_caps); + __set_bit(QED_LM_1000baseX_Full, sup_caps); + + if (qed_link_mode_intersects(params->adv_speeds, sup_caps)) + as |= NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_1G; + + qed_link_mode_zero(sup_caps); + __set_bit(QED_LM_10000baseT_Full, sup_caps); + __set_bit(QED_LM_10000baseKR_Full, sup_caps); + __set_bit(QED_LM_10000baseKX4_Full, sup_caps); + __set_bit(QED_LM_10000baseR_FEC, sup_caps); + __set_bit(QED_LM_10000baseCR_Full, sup_caps); + __set_bit(QED_LM_10000baseSR_Full, sup_caps); + __set_bit(QED_LM_10000baseLR_Full, sup_caps); + __set_bit(QED_LM_10000baseLRM_Full, sup_caps); + + if (qed_link_mode_intersects(params->adv_speeds, sup_caps)) + as |= NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_10G; + + qed_link_mode_zero(sup_caps); + __set_bit(QED_LM_20000baseKR2_Full, sup_caps); + + if (qed_link_mode_intersects(params->adv_speeds, sup_caps)) + as |= NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_20G; + + qed_link_mode_zero(sup_caps); + __set_bit(QED_LM_25000baseKR_Full, sup_caps); + __set_bit(QED_LM_25000baseCR_Full, sup_caps); + __set_bit(QED_LM_25000baseSR_Full, sup_caps); + + if (qed_link_mode_intersects(params->adv_speeds, sup_caps)) + as |= NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_25G; + + qed_link_mode_zero(sup_caps); + __set_bit(QED_LM_40000baseLR4_Full, sup_caps); + __set_bit(QED_LM_40000baseKR4_Full, sup_caps); + __set_bit(QED_LM_40000baseCR4_Full, sup_caps); + __set_bit(QED_LM_40000baseSR4_Full, sup_caps); + + if (qed_link_mode_intersects(params->adv_speeds, sup_caps)) + as |= NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_40G; + + qed_link_mode_zero(sup_caps); + __set_bit(QED_LM_50000baseKR2_Full, sup_caps); + __set_bit(QED_LM_50000baseCR2_Full, sup_caps); + __set_bit(QED_LM_50000baseSR2_Full, sup_caps); + + if (qed_link_mode_intersects(params->adv_speeds, sup_caps)) + as |= NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_50G; + + qed_link_mode_zero(sup_caps); + __set_bit(QED_LM_100000baseKR4_Full, sup_caps); + __set_bit(QED_LM_100000baseSR4_Full, sup_caps); + __set_bit(QED_LM_100000baseCR4_Full, sup_caps); + __set_bit(QED_LM_100000baseLR4_ER4_Full, sup_caps); + + if (qed_link_mode_intersects(params->adv_speeds, sup_caps)) + as |= NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_BB_100G; + + link_params->speed.advertised_speeds = as; } + if (params->override_flags & QED_LINK_OVERRIDE_SPEED_FORCED_SPEED) link_params->speed.forced_speed = params->forced_speed; if (params->override_flags & QED_LINK_OVERRIDE_PAUSE_CONFIG) { @@ -1644,7 +1667,7 @@ static int qed_get_link_data(struct qed_hwfn *hwfn, static void qed_fill_link_capability(struct qed_hwfn *hwfn, struct qed_ptt *ptt, u32 capability, - u32 *if_capability) + unsigned long *if_caps) { u32 media_type, tcvr_state, tcvr_type; u32 speed_mask, board_cfg; @@ -1667,113 +1690,117 @@ static void qed_fill_link_capability(struct qed_hwfn *hwfn, switch (media_type) { case MEDIA_DA_TWINAX: - *if_capability |= QED_LM_FIBRE_BIT; + __set_bit(QED_LM_FIBRE, if_caps); + if (capability & NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_20G) - *if_capability |= QED_LM_20000baseKR2_Full_BIT; + __set_bit(QED_LM_20000baseKR2_Full, if_caps); + /* For DAC media multiple speed capabilities are supported*/ capability = capability & speed_mask; if (capability & NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_1G) - *if_capability |= QED_LM_1000baseKX_Full_BIT; + __set_bit(QED_LM_1000baseKX_Full, if_caps); if (capability & NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_10G) - *if_capability |= QED_LM_10000baseCR_Full_BIT; + __set_bit(QED_LM_10000baseCR_Full, if_caps); if (capability & NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_40G) - *if_capability |= QED_LM_40000baseCR4_Full_BIT; + __set_bit(QED_LM_40000baseCR4_Full, if_caps); if (capability & NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_25G) - *if_capability |= QED_LM_25000baseCR_Full_BIT; + __set_bit(QED_LM_25000baseCR_Full, if_caps); if (capability & NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_50G) - *if_capability |= QED_LM_50000baseCR2_Full_BIT; + __set_bit(QED_LM_50000baseCR2_Full, if_caps); if (capability & - NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_BB_100G) - *if_capability |= QED_LM_100000baseCR4_Full_BIT; + NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_BB_100G) + __set_bit(QED_LM_100000baseCR4_Full, if_caps); + break; case MEDIA_BASE_T: - *if_capability |= QED_LM_TP_BIT; + __set_bit(QED_LM_TP, if_caps); + if (board_cfg & NVM_CFG1_PORT_PORT_TYPE_EXT_PHY) { if (capability & - NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_1G) { - *if_capability |= QED_LM_1000baseT_Full_BIT; - } + NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_1G) + __set_bit(QED_LM_1000baseT_Full, if_caps); if (capability & - NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_10G) { - *if_capability |= QED_LM_10000baseT_Full_BIT; - } + NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_10G) + __set_bit(QED_LM_10000baseT_Full, if_caps); } + if (board_cfg & NVM_CFG1_PORT_PORT_TYPE_MODULE) { - *if_capability |= QED_LM_FIBRE_BIT; + __set_bit(QED_LM_FIBRE, if_caps); + if (tcvr_type == ETH_TRANSCEIVER_TYPE_1000BASET) - *if_capability |= QED_LM_1000baseT_Full_BIT; + __set_bit(QED_LM_1000baseT_Full, if_caps); if (tcvr_type == ETH_TRANSCEIVER_TYPE_10G_BASET) - *if_capability |= QED_LM_10000baseT_Full_BIT; + __set_bit(QED_LM_10000baseT_Full, if_caps); } + break; case MEDIA_SFP_1G_FIBER: case MEDIA_SFPP_10G_FIBER: case MEDIA_XFP_FIBER: case MEDIA_MODULE_FIBER: - *if_capability |= QED_LM_FIBRE_BIT; - if (capability & - NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_1G) { + __set_bit(QED_LM_FIBRE, if_caps); + + if (capability & NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_1G) { if ((tcvr_type == ETH_TRANSCEIVER_TYPE_1G_LX) || (tcvr_type == ETH_TRANSCEIVER_TYPE_1G_SX)) - *if_capability |= QED_LM_1000baseKX_Full_BIT; + __set_bit(QED_LM_1000baseKX_Full, if_caps); } - if (capability & - NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_10G) { + + if (capability & NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_10G) { if (tcvr_type == ETH_TRANSCEIVER_TYPE_10G_SR) - *if_capability |= QED_LM_10000baseSR_Full_BIT; + __set_bit(QED_LM_10000baseSR_Full, if_caps); if (tcvr_type == ETH_TRANSCEIVER_TYPE_10G_LR) - *if_capability |= QED_LM_10000baseLR_Full_BIT; + __set_bit(QED_LM_10000baseLR_Full, if_caps); if (tcvr_type == ETH_TRANSCEIVER_TYPE_10G_LRM) - *if_capability |= QED_LM_10000baseLRM_Full_BIT; + __set_bit(QED_LM_10000baseLRM_Full, if_caps); if (tcvr_type == ETH_TRANSCEIVER_TYPE_10G_ER) - *if_capability |= QED_LM_10000baseR_FEC_BIT; + __set_bit(QED_LM_10000baseR_FEC, if_caps); } + if (capability & NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_20G) - *if_capability |= QED_LM_20000baseKR2_Full_BIT; - if (capability & - NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_25G) { + __set_bit(QED_LM_20000baseKR2_Full, if_caps); + + if (capability & NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_25G) { if (tcvr_type == ETH_TRANSCEIVER_TYPE_25G_SR) - *if_capability |= QED_LM_25000baseSR_Full_BIT; + __set_bit(QED_LM_25000baseSR_Full, if_caps); } - if (capability & - NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_40G) { + + if (capability & NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_40G) { if (tcvr_type == ETH_TRANSCEIVER_TYPE_40G_LR4) - *if_capability |= QED_LM_40000baseLR4_Full_BIT; + __set_bit(QED_LM_40000baseLR4_Full, if_caps); if (tcvr_type == ETH_TRANSCEIVER_TYPE_40G_SR4) - *if_capability |= QED_LM_40000baseSR4_Full_BIT; + __set_bit(QED_LM_40000baseSR4_Full, if_caps); } - if (capability & - NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_50G) - *if_capability |= QED_LM_50000baseKR2_Full_BIT; + + if (capability & NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_50G) + __set_bit(QED_LM_50000baseKR2_Full, if_caps); + if (capability & NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_BB_100G) { if (tcvr_type == ETH_TRANSCEIVER_TYPE_100G_SR4) - *if_capability |= QED_LM_100000baseSR4_Full_BIT; + __set_bit(QED_LM_100000baseSR4_Full, if_caps); } break; case MEDIA_KR: - *if_capability |= QED_LM_Backplane_BIT; + __set_bit(QED_LM_Backplane, if_caps); + if (capability & NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_20G) - *if_capability |= QED_LM_20000baseKR2_Full_BIT; - if (capability & - NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_1G) - *if_capability |= QED_LM_1000baseKX_Full_BIT; - if (capability & - NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_10G) - *if_capability |= QED_LM_10000baseKR_Full_BIT; - if (capability & - NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_25G) - *if_capability |= QED_LM_25000baseKR_Full_BIT; - if (capability & - NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_40G) - *if_capability |= QED_LM_40000baseKR4_Full_BIT; - if (capability & - NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_50G) - *if_capability |= QED_LM_50000baseKR2_Full_BIT; + __set_bit(QED_LM_20000baseKR2_Full, if_caps); + if (capability & NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_1G) + __set_bit(QED_LM_1000baseKX_Full, if_caps); + if (capability & NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_10G) + __set_bit(QED_LM_10000baseKR_Full, if_caps); + if (capability & NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_25G) + __set_bit(QED_LM_25000baseKR_Full, if_caps); + if (capability & NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_40G) + __set_bit(QED_LM_40000baseKR4_Full, if_caps); + if (capability & NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_50G) + __set_bit(QED_LM_50000baseKR2_Full, if_caps); if (capability & NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_BB_100G) - *if_capability |= QED_LM_100000baseKR4_Full_BIT; + __set_bit(QED_LM_100000baseKR4_Full, if_caps); + break; case MEDIA_UNSPECIFIED: case MEDIA_NOT_PRESENT: @@ -1806,26 +1833,27 @@ static void qed_fill_link(struct qed_hwfn *hwfn, /* TODO - at the moment assume supported and advertised speed equal */ if (link_caps.default_speed_autoneg) - if_link->supported_caps |= QED_LM_Autoneg_BIT; + __set_bit(QED_LM_Autoneg, if_link->supported_caps); if (params.pause.autoneg || (params.pause.forced_rx && params.pause.forced_tx)) - if_link->supported_caps |= QED_LM_Asym_Pause_BIT; + __set_bit(QED_LM_Asym_Pause, if_link->supported_caps); if (params.pause.autoneg || params.pause.forced_rx || params.pause.forced_tx) - if_link->supported_caps |= QED_LM_Pause_BIT; + __set_bit(QED_LM_Pause, if_link->supported_caps); + + qed_link_mode_copy(if_link->advertised_caps, if_link->supported_caps); - if_link->advertised_caps = if_link->supported_caps; if (params.speed.autoneg) - if_link->advertised_caps |= QED_LM_Autoneg_BIT; + __set_bit(QED_LM_Autoneg, if_link->advertised_caps); else - if_link->advertised_caps &= ~QED_LM_Autoneg_BIT; + __clear_bit(QED_LM_Autoneg, if_link->advertised_caps); /* Fill link advertised capability*/ qed_fill_link_capability(hwfn, ptt, params.speed.advertised_speeds, - &if_link->advertised_caps); + if_link->advertised_caps); /* Fill link supported capability*/ qed_fill_link_capability(hwfn, ptt, link_caps.speed_capabilities, - &if_link->supported_caps); + if_link->supported_caps); if (link.link_up) if_link->speed = link.speed; @@ -1845,30 +1873,29 @@ static void qed_fill_link(struct qed_hwfn *hwfn, if_link->pause_config |= QED_LINK_PAUSE_TX_ENABLE; /* Link partner capabilities */ - if (link.partner_adv_speed & - QED_LINK_PARTNER_SPEED_1G_FD) - if_link->lp_caps |= QED_LM_1000baseT_Full_BIT; + + if (link.partner_adv_speed & QED_LINK_PARTNER_SPEED_1G_FD) + __set_bit(QED_LM_1000baseT_Full, if_link->lp_caps); if (link.partner_adv_speed & QED_LINK_PARTNER_SPEED_10G) - if_link->lp_caps |= QED_LM_10000baseKR_Full_BIT; + __set_bit(QED_LM_10000baseKR_Full, if_link->lp_caps); if (link.partner_adv_speed & QED_LINK_PARTNER_SPEED_20G) - if_link->lp_caps |= QED_LM_20000baseKR2_Full_BIT; + __set_bit(QED_LM_20000baseKR2_Full, if_link->lp_caps); if (link.partner_adv_speed & QED_LINK_PARTNER_SPEED_25G) - if_link->lp_caps |= QED_LM_25000baseKR_Full_BIT; + __set_bit(QED_LM_25000baseKR_Full, if_link->lp_caps); if (link.partner_adv_speed & QED_LINK_PARTNER_SPEED_40G) - if_link->lp_caps |= QED_LM_40000baseLR4_Full_BIT; + __set_bit(QED_LM_40000baseLR4_Full, if_link->lp_caps); if (link.partner_adv_speed & QED_LINK_PARTNER_SPEED_50G) - if_link->lp_caps |= QED_LM_50000baseKR2_Full_BIT; + __set_bit(QED_LM_50000baseKR2_Full, if_link->lp_caps); if (link.partner_adv_speed & QED_LINK_PARTNER_SPEED_100G) - if_link->lp_caps |= QED_LM_100000baseKR4_Full_BIT; + __set_bit(QED_LM_100000baseKR4_Full, if_link->lp_caps); if (link.an_complete) - if_link->lp_caps |= QED_LM_Autoneg_BIT; - + __set_bit(QED_LM_Autoneg, if_link->lp_caps); if (link.partner_adv_pause) - if_link->lp_caps |= QED_LM_Pause_BIT; + __set_bit(QED_LM_Pause, if_link->lp_caps); if (link.partner_adv_pause == QED_LINK_PARTNER_ASYMMETRIC_PAUSE || link.partner_adv_pause == QED_LINK_PARTNER_BOTH_PAUSE) - if_link->lp_caps |= QED_LM_Asym_Pause_BIT; + __set_bit(QED_LM_Asym_Pause, if_link->lp_caps); if (link_caps.default_eee == QED_MCP_EEE_UNSUPPORTED) { if_link->eee_supported = false; diff --git a/drivers/net/ethernet/qlogic/qede/qede_ethtool.c b/drivers/net/ethernet/qlogic/qede/qede_ethtool.c index d3fc7403d095..f47167cfa382 100644 --- a/drivers/net/ethernet/qlogic/qede/qede_ethtool.c +++ b/drivers/net/ethernet/qlogic/qede/qede_ethtool.c @@ -419,75 +419,78 @@ static int qede_set_priv_flags(struct net_device *dev, u32 flags) } struct qede_link_mode_mapping { - u32 qed_link_mode; - u32 ethtool_link_mode; + u32 qed_link_mode; + u32 ethtool_link_mode; }; +#define QEDE_ETHTOOL_LM_MAP(mode) \ +{ \ + .qed_link_mode = QED_LM_##mode, \ + .ethtool_link_mode = ETHTOOL_LINK_MODE_##mode##_BIT, \ +} + static const struct qede_link_mode_mapping qed_lm_map[] = { - {QED_LM_FIBRE_BIT, ETHTOOL_LINK_MODE_FIBRE_BIT}, - {QED_LM_Autoneg_BIT, ETHTOOL_LINK_MODE_Autoneg_BIT}, - {QED_LM_Asym_Pause_BIT, ETHTOOL_LINK_MODE_Asym_Pause_BIT}, - {QED_LM_Pause_BIT, ETHTOOL_LINK_MODE_Pause_BIT}, - {QED_LM_1000baseT_Full_BIT, ETHTOOL_LINK_MODE_1000baseT_Full_BIT}, - {QED_LM_10000baseT_Full_BIT, ETHTOOL_LINK_MODE_10000baseT_Full_BIT}, - {QED_LM_TP_BIT, ETHTOOL_LINK_MODE_TP_BIT}, - {QED_LM_Backplane_BIT, ETHTOOL_LINK_MODE_Backplane_BIT}, - {QED_LM_1000baseKX_Full_BIT, ETHTOOL_LINK_MODE_1000baseKX_Full_BIT}, - {QED_LM_10000baseKX4_Full_BIT, ETHTOOL_LINK_MODE_10000baseKX4_Full_BIT}, - {QED_LM_10000baseKR_Full_BIT, ETHTOOL_LINK_MODE_10000baseKR_Full_BIT}, - {QED_LM_10000baseKR_Full_BIT, ETHTOOL_LINK_MODE_10000baseKR_Full_BIT}, - {QED_LM_10000baseR_FEC_BIT, ETHTOOL_LINK_MODE_10000baseR_FEC_BIT}, - {QED_LM_20000baseKR2_Full_BIT, ETHTOOL_LINK_MODE_20000baseKR2_Full_BIT}, - {QED_LM_40000baseKR4_Full_BIT, ETHTOOL_LINK_MODE_40000baseKR4_Full_BIT}, - {QED_LM_40000baseCR4_Full_BIT, ETHTOOL_LINK_MODE_40000baseCR4_Full_BIT}, - {QED_LM_40000baseSR4_Full_BIT, ETHTOOL_LINK_MODE_40000baseSR4_Full_BIT}, - {QED_LM_40000baseLR4_Full_BIT, ETHTOOL_LINK_MODE_40000baseLR4_Full_BIT}, - {QED_LM_25000baseCR_Full_BIT, ETHTOOL_LINK_MODE_25000baseCR_Full_BIT}, - {QED_LM_25000baseKR_Full_BIT, ETHTOOL_LINK_MODE_25000baseKR_Full_BIT}, - {QED_LM_25000baseSR_Full_BIT, ETHTOOL_LINK_MODE_25000baseSR_Full_BIT}, - {QED_LM_50000baseCR2_Full_BIT, ETHTOOL_LINK_MODE_50000baseCR2_Full_BIT}, - {QED_LM_50000baseKR2_Full_BIT, ETHTOOL_LINK_MODE_50000baseKR2_Full_BIT}, - {QED_LM_100000baseKR4_Full_BIT, - ETHTOOL_LINK_MODE_100000baseKR4_Full_BIT}, - {QED_LM_100000baseSR4_Full_BIT, - ETHTOOL_LINK_MODE_100000baseSR4_Full_BIT}, - {QED_LM_100000baseCR4_Full_BIT, - ETHTOOL_LINK_MODE_100000baseCR4_Full_BIT}, - {QED_LM_100000baseLR4_ER4_Full_BIT, - ETHTOOL_LINK_MODE_100000baseLR4_ER4_Full_BIT}, - {QED_LM_50000baseSR2_Full_BIT, ETHTOOL_LINK_MODE_50000baseSR2_Full_BIT}, - {QED_LM_1000baseX_Full_BIT, ETHTOOL_LINK_MODE_1000baseX_Full_BIT}, - {QED_LM_10000baseCR_Full_BIT, ETHTOOL_LINK_MODE_10000baseCR_Full_BIT}, - {QED_LM_10000baseSR_Full_BIT, ETHTOOL_LINK_MODE_10000baseSR_Full_BIT}, - {QED_LM_10000baseLR_Full_BIT, ETHTOOL_LINK_MODE_10000baseLR_Full_BIT}, - {QED_LM_10000baseLRM_Full_BIT, ETHTOOL_LINK_MODE_10000baseLRM_Full_BIT}, + QEDE_ETHTOOL_LM_MAP(FIBRE), + QEDE_ETHTOOL_LM_MAP(Autoneg), + QEDE_ETHTOOL_LM_MAP(Asym_Pause), + QEDE_ETHTOOL_LM_MAP(Pause), + QEDE_ETHTOOL_LM_MAP(1000baseT_Full), + QEDE_ETHTOOL_LM_MAP(10000baseT_Full), + QEDE_ETHTOOL_LM_MAP(TP), + QEDE_ETHTOOL_LM_MAP(Backplane), + QEDE_ETHTOOL_LM_MAP(1000baseKX_Full), + QEDE_ETHTOOL_LM_MAP(10000baseKX4_Full), + QEDE_ETHTOOL_LM_MAP(10000baseKR_Full), + QEDE_ETHTOOL_LM_MAP(10000baseR_FEC), + QEDE_ETHTOOL_LM_MAP(20000baseKR2_Full), + QEDE_ETHTOOL_LM_MAP(40000baseKR4_Full), + QEDE_ETHTOOL_LM_MAP(40000baseCR4_Full), + QEDE_ETHTOOL_LM_MAP(40000baseSR4_Full), + QEDE_ETHTOOL_LM_MAP(40000baseLR4_Full), + QEDE_ETHTOOL_LM_MAP(25000baseCR_Full), + QEDE_ETHTOOL_LM_MAP(25000baseKR_Full), + QEDE_ETHTOOL_LM_MAP(25000baseSR_Full), + QEDE_ETHTOOL_LM_MAP(50000baseCR2_Full), + QEDE_ETHTOOL_LM_MAP(50000baseKR2_Full), + QEDE_ETHTOOL_LM_MAP(100000baseKR4_Full), + QEDE_ETHTOOL_LM_MAP(100000baseSR4_Full), + QEDE_ETHTOOL_LM_MAP(100000baseCR4_Full), + QEDE_ETHTOOL_LM_MAP(100000baseLR4_ER4_Full), + QEDE_ETHTOOL_LM_MAP(50000baseSR2_Full), + QEDE_ETHTOOL_LM_MAP(1000baseX_Full), + QEDE_ETHTOOL_LM_MAP(10000baseCR_Full), + QEDE_ETHTOOL_LM_MAP(10000baseSR_Full), + QEDE_ETHTOOL_LM_MAP(10000baseLR_Full), + QEDE_ETHTOOL_LM_MAP(10000baseLRM_Full), }; -#define QEDE_DRV_TO_ETHTOOL_CAPS(caps, lk_ksettings, name) \ -{ \ - int i; \ - \ - for (i = 0; i < ARRAY_SIZE(qed_lm_map); i++) { \ - if ((caps) & (qed_lm_map[i].qed_link_mode)) \ - __set_bit(qed_lm_map[i].ethtool_link_mode,\ - lk_ksettings->link_modes.name); \ - } \ +static_assert(ARRAY_SIZE(qed_lm_map) == QED_LM_COUNT); + +static void qede_drv_to_ethtool_caps(const unsigned long *qed_caps, + unsigned long *ethtool_caps) +{ + u32 i; + + for (i = 0; i < ARRAY_SIZE(qed_lm_map); i++) + if (test_bit(qed_lm_map[i].qed_link_mode, qed_caps)) + __set_bit(qed_lm_map[i].ethtool_link_mode, + ethtool_caps); } -#define QEDE_ETHTOOL_TO_DRV_CAPS(caps, lk_ksettings, name) \ -{ \ - int i; \ - \ - for (i = 0; i < ARRAY_SIZE(qed_lm_map); i++) { \ - if (test_bit(qed_lm_map[i].ethtool_link_mode, \ - lk_ksettings->link_modes.name)) \ - caps |= qed_lm_map[i].qed_link_mode; \ - } \ +static void qede_ethtool_to_drv_caps(unsigned long *qed_caps, + const unsigned long *ethtool_caps) +{ + u32 i; + + for (i = 0; i < ARRAY_SIZE(qed_lm_map); i++) + if (test_bit(qed_lm_map[i].ethtool_link_mode, ethtool_caps)) + __set_bit(qed_lm_map[i].qed_link_mode, qed_caps); } static int qede_get_link_ksettings(struct net_device *dev, struct ethtool_link_ksettings *cmd) { + typeof(cmd->link_modes) *link_modes = &cmd->link_modes; struct ethtool_link_settings *base = &cmd->base; struct qede_dev *edev = netdev_priv(dev); struct qed_link_output current_link; @@ -498,13 +501,16 @@ static int qede_get_link_ksettings(struct net_device *dev, edev->ops->common->get_link(edev->cdev, ¤t_link); ethtool_link_ksettings_zero_link_mode(cmd, supported); - QEDE_DRV_TO_ETHTOOL_CAPS(current_link.supported_caps, cmd, supported) + qede_drv_to_ethtool_caps(current_link.supported_caps, + link_modes->supported); ethtool_link_ksettings_zero_link_mode(cmd, advertising); - QEDE_DRV_TO_ETHTOOL_CAPS(current_link.advertised_caps, cmd, advertising) + qede_drv_to_ethtool_caps(current_link.advertised_caps, + link_modes->advertising); ethtool_link_ksettings_zero_link_mode(cmd, lp_advertising); - QEDE_DRV_TO_ETHTOOL_CAPS(current_link.lp_caps, cmd, lp_advertising) + qede_drv_to_ethtool_caps(current_link.lp_caps, + link_modes->lp_advertising); if ((edev->state == QEDE_STATE_OPEN) && (current_link.link_up)) { base->speed = current_link.speed; @@ -530,7 +536,7 @@ static int qede_set_link_ksettings(struct net_device *dev, struct qede_dev *edev = netdev_priv(dev); struct qed_link_output current_link; struct qed_link_params params; - u32 sup_caps; + QED_LM_DECLARE(sup_caps); if (!edev->ops || !edev->ops->common->can_link_change(edev->cdev)) { DP_INFO(edev, "Link settings are not allowed to be changed\n"); @@ -542,105 +548,81 @@ static int qede_set_link_ksettings(struct net_device *dev, params.override_flags |= QED_LINK_OVERRIDE_SPEED_ADV_SPEEDS; params.override_flags |= QED_LINK_OVERRIDE_SPEED_AUTONEG; + if (base->autoneg == AUTONEG_ENABLE) { - if (!(current_link.supported_caps & QED_LM_Autoneg_BIT)) { + if (!test_bit(QED_LM_Autoneg, current_link.supported_caps)) { DP_INFO(edev, "Auto negotiation is not supported\n"); return -EOPNOTSUPP; } params.autoneg = true; params.forced_speed = 0; - QEDE_ETHTOOL_TO_DRV_CAPS(params.adv_speeds, cmd, advertising) + + qede_ethtool_to_drv_caps(params.adv_speeds, + cmd->link_modes.advertising); } else { /* forced speed */ params.override_flags |= QED_LINK_OVERRIDE_SPEED_FORCED_SPEED; params.autoneg = false; params.forced_speed = base->speed; + + qed_link_mode_zero(sup_caps); + switch (base->speed) { case SPEED_1000: - sup_caps = QED_LM_1000baseT_Full_BIT | - QED_LM_1000baseKX_Full_BIT | - QED_LM_1000baseX_Full_BIT; - if (!(current_link.supported_caps & sup_caps)) { - DP_INFO(edev, "1G speed not supported\n"); - return -EINVAL; - } - params.adv_speeds = current_link.supported_caps & - sup_caps; + __set_bit(QED_LM_1000baseT_Full, sup_caps); + __set_bit(QED_LM_1000baseKX_Full, sup_caps); + __set_bit(QED_LM_1000baseX_Full, sup_caps); break; case SPEED_10000: - sup_caps = QED_LM_10000baseT_Full_BIT | - QED_LM_10000baseKR_Full_BIT | - QED_LM_10000baseKX4_Full_BIT | - QED_LM_10000baseR_FEC_BIT | - QED_LM_10000baseCR_Full_BIT | - QED_LM_10000baseSR_Full_BIT | - QED_LM_10000baseLR_Full_BIT | - QED_LM_10000baseLRM_Full_BIT; - if (!(current_link.supported_caps & sup_caps)) { - DP_INFO(edev, "10G speed not supported\n"); - return -EINVAL; - } - params.adv_speeds = current_link.supported_caps & - sup_caps; + __set_bit(QED_LM_10000baseT_Full, sup_caps); + __set_bit(QED_LM_10000baseKR_Full, sup_caps); + __set_bit(QED_LM_10000baseKX4_Full, sup_caps); + __set_bit(QED_LM_10000baseR_FEC, sup_caps); + __set_bit(QED_LM_10000baseCR_Full, sup_caps); + __set_bit(QED_LM_10000baseSR_Full, sup_caps); + __set_bit(QED_LM_10000baseLR_Full, sup_caps); + __set_bit(QED_LM_10000baseLRM_Full, sup_caps); break; case SPEED_20000: - if (!(current_link.supported_caps & - QED_LM_20000baseKR2_Full_BIT)) { - DP_INFO(edev, "20G speed not supported\n"); - return -EINVAL; - } - params.adv_speeds = QED_LM_20000baseKR2_Full_BIT; + __set_bit(QED_LM_20000baseKR2_Full, sup_caps); break; case SPEED_25000: - sup_caps = QED_LM_25000baseKR_Full_BIT | - QED_LM_25000baseCR_Full_BIT | - QED_LM_25000baseSR_Full_BIT; - if (!(current_link.supported_caps & sup_caps)) { - DP_INFO(edev, "25G speed not supported\n"); - return -EINVAL; - } - params.adv_speeds = current_link.supported_caps & - sup_caps; + __set_bit(QED_LM_25000baseKR_Full, sup_caps); + __set_bit(QED_LM_25000baseCR_Full, sup_caps); + __set_bit(QED_LM_25000baseSR_Full, sup_caps); break; case SPEED_40000: - sup_caps = QED_LM_40000baseLR4_Full_BIT | - QED_LM_40000baseKR4_Full_BIT | - QED_LM_40000baseCR4_Full_BIT | - QED_LM_40000baseSR4_Full_BIT; - if (!(current_link.supported_caps & sup_caps)) { - DP_INFO(edev, "40G speed not supported\n"); - return -EINVAL; - } - params.adv_speeds = current_link.supported_caps & - sup_caps; + __set_bit(QED_LM_40000baseLR4_Full, sup_caps); + __set_bit(QED_LM_40000baseKR4_Full, sup_caps); + __set_bit(QED_LM_40000baseCR4_Full, sup_caps); + __set_bit(QED_LM_40000baseSR4_Full, sup_caps); break; case SPEED_50000: - sup_caps = QED_LM_50000baseKR2_Full_BIT | - QED_LM_50000baseCR2_Full_BIT | - QED_LM_50000baseSR2_Full_BIT; - if (!(current_link.supported_caps & sup_caps)) { - DP_INFO(edev, "50G speed not supported\n"); - return -EINVAL; - } - params.adv_speeds = current_link.supported_caps & - sup_caps; + __set_bit(QED_LM_50000baseKR2_Full, sup_caps); + __set_bit(QED_LM_50000baseCR2_Full, sup_caps); + __set_bit(QED_LM_50000baseSR2_Full, sup_caps); break; case SPEED_100000: - sup_caps = QED_LM_100000baseKR4_Full_BIT | - QED_LM_100000baseSR4_Full_BIT | - QED_LM_100000baseCR4_Full_BIT | - QED_LM_100000baseLR4_ER4_Full_BIT; - if (!(current_link.supported_caps & sup_caps)) { - DP_INFO(edev, "100G speed not supported\n"); - return -EINVAL; - } - params.adv_speeds = current_link.supported_caps & - sup_caps; + __set_bit(QED_LM_100000baseKR4_Full, sup_caps); + __set_bit(QED_LM_100000baseSR4_Full, sup_caps); + __set_bit(QED_LM_100000baseCR4_Full, sup_caps); + __set_bit(QED_LM_100000baseLR4_ER4_Full, sup_caps); break; default: DP_INFO(edev, "Unsupported speed %u\n", base->speed); return -EINVAL; } + + if (!qed_link_mode_intersects(current_link.supported_caps, + sup_caps)) { + DP_INFO(edev, "%uG speed not supported\n", + base->speed / 1000); + return -EINVAL; + } + + qed_link_mode_and(params.adv_speeds, + current_link.supported_caps, + sup_caps); } params.link_up = true; @@ -1006,13 +988,16 @@ static int qede_set_pauseparam(struct net_device *dev, memset(¶ms, 0, sizeof(params)); params.override_flags |= QED_LINK_OVERRIDE_PAUSE_CONFIG; + if (epause->autoneg) { - if (!(current_link.supported_caps & QED_LM_Autoneg_BIT)) { + if (!test_bit(QED_LM_Autoneg, current_link.supported_caps)) { DP_INFO(edev, "autoneg not supported\n"); return -EINVAL; } + params.pause_config |= QED_LINK_PAUSE_AUTONEG_ENABLE; } + if (epause->rx_pause) params.pause_config |= QED_LINK_PAUSE_RX_ENABLE; if (epause->tx_pause) diff --git a/drivers/scsi/qedf/qedf_main.c b/drivers/scsi/qedf/qedf_main.c index 36b1ca2dadbb..4f4f786f3710 100644 --- a/drivers/scsi/qedf/qedf_main.c +++ b/drivers/scsi/qedf/qedf_main.c @@ -441,6 +441,7 @@ static void qedf_update_link_speed(struct qedf_ctx *qedf, struct qed_link_output *link) { struct fc_lport *lport = qedf->lport; + QED_LM_DECLARE(sup_caps); lport->link_speed = FC_PORTSPEED_UNKNOWN; lport->link_supported_speeds = FC_PORTSPEED_UNKNOWN; @@ -474,40 +475,60 @@ static void qedf_update_link_speed(struct qedf_ctx *qedf, * Set supported link speed by querying the supported * capabilities of the link. */ - if ((link->supported_caps & QED_LM_10000baseT_Full_BIT) || - (link->supported_caps & QED_LM_10000baseKX4_Full_BIT) || - (link->supported_caps & QED_LM_10000baseR_FEC_BIT) || - (link->supported_caps & QED_LM_10000baseCR_Full_BIT) || - (link->supported_caps & QED_LM_10000baseSR_Full_BIT) || - (link->supported_caps & QED_LM_10000baseLR_Full_BIT) || - (link->supported_caps & QED_LM_10000baseLRM_Full_BIT) || - (link->supported_caps & QED_LM_10000baseKR_Full_BIT)) { + + qed_link_mode_zero(sup_caps); + __set_bit(QED_LM_10000baseT_Full, sup_caps); + __set_bit(QED_LM_10000baseKX4_Full, sup_caps); + __set_bit(QED_LM_10000baseR_FEC, sup_caps); + __set_bit(QED_LM_10000baseCR_Full, sup_caps); + __set_bit(QED_LM_10000baseSR_Full, sup_caps); + __set_bit(QED_LM_10000baseLR_Full, sup_caps); + __set_bit(QED_LM_10000baseLRM_Full, sup_caps); + __set_bit(QED_LM_10000baseKR_Full, sup_caps); + + if (qed_link_mode_intersects(link->supported_caps, sup_caps)) lport->link_supported_speeds |= FC_PORTSPEED_10GBIT; - } - if ((link->supported_caps & QED_LM_25000baseKR_Full_BIT) || - (link->supported_caps & QED_LM_25000baseCR_Full_BIT) || - (link->supported_caps & QED_LM_25000baseSR_Full_BIT)) { + + qed_link_mode_zero(sup_caps); + __set_bit(QED_LM_25000baseKR_Full, sup_caps); + __set_bit(QED_LM_25000baseCR_Full, sup_caps); + __set_bit(QED_LM_25000baseSR_Full, sup_caps); + + if (qed_link_mode_intersects(link->supported_caps, sup_caps)) lport->link_supported_speeds |= FC_PORTSPEED_25GBIT; - } - if ((link->supported_caps & QED_LM_40000baseLR4_Full_BIT) || - (link->supported_caps & QED_LM_40000baseKR4_Full_BIT) || - (link->supported_caps & QED_LM_40000baseCR4_Full_BIT) || - (link->supported_caps & QED_LM_40000baseSR4_Full_BIT)) { + + qed_link_mode_zero(sup_caps); + __set_bit(QED_LM_40000baseLR4_Full, sup_caps); + __set_bit(QED_LM_40000baseKR4_Full, sup_caps); + __set_bit(QED_LM_40000baseCR4_Full, sup_caps); + __set_bit(QED_LM_40000baseSR4_Full, sup_caps); + + if (qed_link_mode_intersects(link->supported_caps, sup_caps)) lport->link_supported_speeds |= FC_PORTSPEED_40GBIT; - } - if ((link->supported_caps & QED_LM_50000baseKR2_Full_BIT) || - (link->supported_caps & QED_LM_50000baseCR2_Full_BIT) || - (link->supported_caps & QED_LM_50000baseSR2_Full_BIT)) { + + qed_link_mode_zero(sup_caps); + __set_bit(QED_LM_50000baseKR2_Full, sup_caps); + __set_bit(QED_LM_50000baseCR2_Full, sup_caps); + __set_bit(QED_LM_50000baseSR2_Full, sup_caps); + + if (qed_link_mode_intersects(link->supported_caps, sup_caps)) lport->link_supported_speeds |= FC_PORTSPEED_50GBIT; - } - if ((link->supported_caps & QED_LM_100000baseKR4_Full_BIT) || - (link->supported_caps & QED_LM_100000baseSR4_Full_BIT) || - (link->supported_caps & QED_LM_100000baseCR4_Full_BIT) || - (link->supported_caps & QED_LM_100000baseLR4_ER4_Full_BIT)) { + + qed_link_mode_zero(sup_caps); + __set_bit(QED_LM_100000baseKR4_Full, sup_caps); + __set_bit(QED_LM_100000baseSR4_Full, sup_caps); + __set_bit(QED_LM_100000baseCR4_Full, sup_caps); + __set_bit(QED_LM_100000baseLR4_ER4_Full, sup_caps); + + if (qed_link_mode_intersects(link->supported_caps, sup_caps)) lport->link_supported_speeds |= FC_PORTSPEED_100GBIT; - } - if (link->supported_caps & QED_LM_20000baseKR2_Full_BIT) + + qed_link_mode_zero(sup_caps); + __set_bit(QED_LM_20000baseKR2_Full, sup_caps); + + if (qed_link_mode_intersects(link->supported_caps, sup_caps)) lport->link_supported_speeds |= FC_PORTSPEED_20GBIT; + fc_host_supported_speeds(lport->host) = lport->link_supported_speeds; } diff --git a/include/linux/qed/qed_if.h b/include/linux/qed/qed_if.h index 8a6e3ad436d1..a039f8519829 100644 --- a/include/linux/qed/qed_if.h +++ b/include/linux/qed/qed_if.h @@ -662,41 +662,54 @@ enum qed_protocol { }; enum qed_link_mode_bits { - QED_LM_FIBRE_BIT = BIT(0), - QED_LM_Autoneg_BIT = BIT(1), - QED_LM_Asym_Pause_BIT = BIT(2), - QED_LM_Pause_BIT = BIT(3), - QED_LM_1000baseT_Full_BIT = BIT(4), - QED_LM_10000baseT_Full_BIT = BIT(5), - QED_LM_10000baseKR_Full_BIT = BIT(6), - QED_LM_20000baseKR2_Full_BIT = BIT(7), - QED_LM_25000baseKR_Full_BIT = BIT(8), - QED_LM_40000baseLR4_Full_BIT = BIT(9), - QED_LM_50000baseKR2_Full_BIT = BIT(10), - QED_LM_100000baseKR4_Full_BIT = BIT(11), - QED_LM_TP_BIT = BIT(12), - QED_LM_Backplane_BIT = BIT(13), - QED_LM_1000baseKX_Full_BIT = BIT(14), - QED_LM_10000baseKX4_Full_BIT = BIT(15), - QED_LM_10000baseR_FEC_BIT = BIT(16), - QED_LM_40000baseKR4_Full_BIT = BIT(17), - QED_LM_40000baseCR4_Full_BIT = BIT(18), - QED_LM_40000baseSR4_Full_BIT = BIT(19), - QED_LM_25000baseCR_Full_BIT = BIT(20), - QED_LM_25000baseSR_Full_BIT = BIT(21), - QED_LM_50000baseCR2_Full_BIT = BIT(22), - QED_LM_100000baseSR4_Full_BIT = BIT(23), - QED_LM_100000baseCR4_Full_BIT = BIT(24), - QED_LM_100000baseLR4_ER4_Full_BIT = BIT(25), - QED_LM_50000baseSR2_Full_BIT = BIT(26), - QED_LM_1000baseX_Full_BIT = BIT(27), - QED_LM_10000baseCR_Full_BIT = BIT(28), - QED_LM_10000baseSR_Full_BIT = BIT(29), - QED_LM_10000baseLR_Full_BIT = BIT(30), - QED_LM_10000baseLRM_Full_BIT = BIT(31), - QED_LM_COUNT = 32 + QED_LM_FIBRE, + QED_LM_Autoneg, + QED_LM_Asym_Pause, + QED_LM_Pause, + QED_LM_1000baseT_Full, + QED_LM_10000baseT_Full, + QED_LM_10000baseKR_Full, + QED_LM_20000baseKR2_Full, + QED_LM_25000baseKR_Full, + QED_LM_40000baseLR4_Full, + QED_LM_50000baseKR2_Full, + QED_LM_100000baseKR4_Full, + QED_LM_TP, + QED_LM_Backplane, + QED_LM_1000baseKX_Full, + QED_LM_10000baseKX4_Full, + QED_LM_10000baseR_FEC, + QED_LM_40000baseKR4_Full, + QED_LM_40000baseCR4_Full, + QED_LM_40000baseSR4_Full, + QED_LM_25000baseCR_Full, + QED_LM_25000baseSR_Full, + QED_LM_50000baseCR2_Full, + QED_LM_100000baseSR4_Full, + QED_LM_100000baseCR4_Full, + QED_LM_100000baseLR4_ER4_Full, + QED_LM_50000baseSR2_Full, + QED_LM_1000baseX_Full, + QED_LM_10000baseCR_Full, + QED_LM_10000baseSR_Full, + QED_LM_10000baseLR_Full, + QED_LM_10000baseLRM_Full, + QED_LM_COUNT, }; +#define QED_LM_DECLARE(lm) DECLARE_BITMAP((lm), \ + QED_LM_COUNT) + +#define qed_link_mode_zero(lm) bitmap_zero((lm), QED_LM_COUNT) +#define qed_link_mode_copy(dst, src) bitmap_copy((dst), (src), \ + QED_LM_COUNT) +#define qed_link_mode_and(dst, src1, src2) bitmap_and((dst), \ + (src1), (src2), \ + QED_LM_COUNT) +#define qed_link_mode_intersects(lm1, lm2) bitmap_intersects((lm1), \ + (lm2), \ + QED_LM_COUNT) + struct qed_link_params { bool link_up; @@ -708,7 +721,9 @@ struct qed_link_params { #define QED_LINK_OVERRIDE_EEE_CONFIG BIT(5) u32 override_flags; bool autoneg; - u32 adv_speeds; + + QED_LM_DECLARE(adv_speeds); + u32 forced_speed; #define QED_LINK_PAUSE_AUTONEG_ENABLE BIT(0) #define QED_LINK_PAUSE_RX_ENABLE BIT(1) @@ -726,10 +741,9 @@ struct qed_link_params { struct qed_link_output { bool link_up; - /* In QED_LM_* defs */ - u32 supported_caps; - u32 advertised_caps; - u32 lp_caps; + QED_LM_DECLARE(supported_caps); + QED_LM_DECLARE(advertised_caps); + QED_LM_DECLARE(lp_caps); u32 speed; /* In Mb/s */ u8 duplex; /* In DUPLEX defs */