net/sfc/base: add efsys macro to get memory region size
[dpdk.git] / drivers / net / sfc / base / siena_phy.c
index 6451298..4b2190d 100644 (file)
@@ -1,31 +1,7 @@
-/*
- * Copyright (c) 2009-2016 Solarflare Communications Inc.
- * All rights reserved.
- *
- * Redistribution and use in source and binary forms, with or without
- * modification, are permitted provided that the following conditions are met:
- *
- * 1. Redistributions of source code must retain the above copyright notice,
- *    this list of conditions and the following disclaimer.
- * 2. Redistributions in binary form must reproduce the above copyright notice,
- *    this list of conditions and the following disclaimer in the documentation
- *    and/or other materials provided with the distribution.
+/* SPDX-License-Identifier: BSD-3-Clause
  *
- * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
- * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
- * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
- * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR
- * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
- * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
- * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
- * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
- * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
- * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
- * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
- *
- * The views and conclusions contained in the software and documentation are
- * those of the authors and should not be interpreted as representing official
- * policies, either expressed or implied, of the FreeBSD Project.
+ * Copyright (c) 2009-2018 Solarflare Communications Inc.
+ * All rights reserved.
  */
 
 #include "efx.h"
@@ -226,6 +202,30 @@ siena_phy_get_link(
                            MCDI_OUT_DWORD(req, GET_LINK_OUT_FCNTL),
                            &slsp->sls_link_mode, &slsp->sls_fcntl);
 
+#if EFSYS_OPT_LOOPBACK
+       /* Assert the MC_CMD_LOOPBACK and EFX_LOOPBACK namespace agree */
+       EFX_STATIC_ASSERT(MC_CMD_LOOPBACK_NONE == EFX_LOOPBACK_OFF);
+       EFX_STATIC_ASSERT(MC_CMD_LOOPBACK_DATA == EFX_LOOPBACK_DATA);
+       EFX_STATIC_ASSERT(MC_CMD_LOOPBACK_GMAC == EFX_LOOPBACK_GMAC);
+       EFX_STATIC_ASSERT(MC_CMD_LOOPBACK_XGMII == EFX_LOOPBACK_XGMII);
+       EFX_STATIC_ASSERT(MC_CMD_LOOPBACK_XGXS == EFX_LOOPBACK_XGXS);
+       EFX_STATIC_ASSERT(MC_CMD_LOOPBACK_XAUI == EFX_LOOPBACK_XAUI);
+       EFX_STATIC_ASSERT(MC_CMD_LOOPBACK_GMII == EFX_LOOPBACK_GMII);
+       EFX_STATIC_ASSERT(MC_CMD_LOOPBACK_SGMII == EFX_LOOPBACK_SGMII);
+       EFX_STATIC_ASSERT(MC_CMD_LOOPBACK_XGBR == EFX_LOOPBACK_XGBR);
+       EFX_STATIC_ASSERT(MC_CMD_LOOPBACK_XFI == EFX_LOOPBACK_XFI);
+       EFX_STATIC_ASSERT(MC_CMD_LOOPBACK_XAUI_FAR == EFX_LOOPBACK_XAUI_FAR);
+       EFX_STATIC_ASSERT(MC_CMD_LOOPBACK_GMII_FAR == EFX_LOOPBACK_GMII_FAR);
+       EFX_STATIC_ASSERT(MC_CMD_LOOPBACK_SGMII_FAR == EFX_LOOPBACK_SGMII_FAR);
+       EFX_STATIC_ASSERT(MC_CMD_LOOPBACK_XFI_FAR == EFX_LOOPBACK_XFI_FAR);
+       EFX_STATIC_ASSERT(MC_CMD_LOOPBACK_GPHY == EFX_LOOPBACK_GPHY);
+       EFX_STATIC_ASSERT(MC_CMD_LOOPBACK_PHYXS == EFX_LOOPBACK_PHY_XS);
+       EFX_STATIC_ASSERT(MC_CMD_LOOPBACK_PCS == EFX_LOOPBACK_PCS);
+       EFX_STATIC_ASSERT(MC_CMD_LOOPBACK_PMAPMD == EFX_LOOPBACK_PMA_PMD);
+
+       slsp->sls_loopback = MCDI_OUT_DWORD(req, GET_LINK_OUT_LOOPBACK_MODE);
+#endif /* EFSYS_OPT_LOOPBACK */
+
        slsp->sls_mac_up = MCDI_OUT_DWORD(req, GET_LINK_OUT_MAC_FAULT) == 0;
 
        return (0);
@@ -249,7 +249,9 @@ siena_phy_reconfigure(
                            MAX(MC_CMD_SET_LINK_IN_LEN,
                                MC_CMD_SET_LINK_OUT_LEN))];
        uint32_t cap_mask;
+#if EFSYS_OPT_PHY_LED_CONTROL
        unsigned int led_mode;
+#endif
        unsigned int speed;
        efx_rc_t rc;
 
@@ -273,8 +275,26 @@ siena_phy_reconfigure(
                PHY_CAP_ASYM, (cap_mask >> EFX_PHY_CAP_ASYM) & 0x1,
                PHY_CAP_AN, (cap_mask >> EFX_PHY_CAP_AN) & 0x1);
 
+#if EFSYS_OPT_LOOPBACK
+       MCDI_IN_SET_DWORD(req, SET_LINK_IN_LOOPBACK_MODE,
+                   epp->ep_loopback_type);
+       switch (epp->ep_loopback_link_mode) {
+       case EFX_LINK_100FDX:
+               speed = 100;
+               break;
+       case EFX_LINK_1000FDX:
+               speed = 1000;
+               break;
+       case EFX_LINK_10000FDX:
+               speed = 10000;
+               break;
+       default:
+               speed = 0;
+       }
+#else
        MCDI_IN_SET_DWORD(req, SET_LINK_IN_LOOPBACK_MODE, MC_CMD_LOOPBACK_NONE);
        speed = 0;
+#endif /* EFSYS_OPT_LOOPBACK */
        MCDI_IN_SET_DWORD(req, SET_LINK_IN_LOOPBACK_SPEED, speed);
 
 #if EFSYS_OPT_PHY_FLAGS
@@ -298,7 +318,26 @@ siena_phy_reconfigure(
        req.emr_out_buf = payload;
        req.emr_out_length = MC_CMD_SET_ID_LED_OUT_LEN;
 
+#if EFSYS_OPT_PHY_LED_CONTROL
+       switch (epp->ep_phy_led_mode) {
+       case EFX_PHY_LED_DEFAULT:
+               led_mode = MC_CMD_LED_DEFAULT;
+               break;
+       case EFX_PHY_LED_OFF:
+               led_mode = MC_CMD_LED_OFF;
+               break;
+       case EFX_PHY_LED_ON:
+               led_mode = MC_CMD_LED_ON;
+               break;
+       default:
+               EFSYS_ASSERT(0);
+               led_mode = MC_CMD_LED_DEFAULT;
+       }
+
+       MCDI_IN_SET_DWORD(req, SET_ID_LED_IN_STATE, led_mode);
+#else
        MCDI_IN_SET_DWORD(req, SET_ID_LED_IN_STATE, MC_CMD_LED_DEFAULT);
+#endif /* EFSYS_OPT_PHY_LED_CONTROL */
 
        efx_mcdi_execute(enp, &req);
 
@@ -376,6 +415,165 @@ siena_phy_oui_get(
        return (ENOTSUP);
 }
 
+#if EFSYS_OPT_PHY_STATS
+
+#define        SIENA_SIMPLE_STAT_SET(_vmask, _esmp, _smask, _stat,             \
+                           _mc_record, _efx_record)                    \
+       if ((_vmask) & (1ULL << (_mc_record))) {                        \
+               (_smask) |= (1ULL << (_efx_record));                    \
+               if ((_stat) != NULL && !EFSYS_MEM_IS_NULL(_esmp)) {     \
+                       efx_dword_t dword;                              \
+                       EFSYS_MEM_READD(_esmp, (_mc_record) * 4, &dword);\
+                       (_stat)[_efx_record] =                          \
+                               EFX_DWORD_FIELD(dword, EFX_DWORD_0);    \
+               }                                                       \
+       }
+
+#define        SIENA_SIMPLE_STAT_SET2(_vmask, _esmp, _smask, _stat, _record)   \
+       SIENA_SIMPLE_STAT_SET(_vmask, _esmp, _smask, _stat,             \
+                           MC_CMD_ ## _record,                         \
+                           EFX_PHY_STAT_ ## _record)
+
+                                               void
+siena_phy_decode_stats(
+       __in                                    efx_nic_t *enp,
+       __in                                    uint32_t vmask,
+       __in_opt                                efsys_mem_t *esmp,
+       __out_opt                               uint64_t *smaskp,
+       __inout_ecount_opt(EFX_PHY_NSTATS)      uint32_t *stat)
+{
+       uint64_t smask = 0;
+
+       _NOTE(ARGUNUSED(enp))
+
+       SIENA_SIMPLE_STAT_SET2(vmask, esmp, smask, stat, OUI);
+       SIENA_SIMPLE_STAT_SET2(vmask, esmp, smask, stat, PMA_PMD_LINK_UP);
+       SIENA_SIMPLE_STAT_SET2(vmask, esmp, smask, stat, PMA_PMD_RX_FAULT);
+       SIENA_SIMPLE_STAT_SET2(vmask, esmp, smask, stat, PMA_PMD_TX_FAULT);
+
+       if (vmask & (1 << MC_CMD_PMA_PMD_SIGNAL)) {
+               smask |=   ((1ULL << EFX_PHY_STAT_PMA_PMD_SIGNAL_A) |
+                           (1ULL << EFX_PHY_STAT_PMA_PMD_SIGNAL_B) |
+                           (1ULL << EFX_PHY_STAT_PMA_PMD_SIGNAL_C) |
+                           (1ULL << EFX_PHY_STAT_PMA_PMD_SIGNAL_D));
+               if (stat != NULL && esmp != NULL && !EFSYS_MEM_IS_NULL(esmp)) {
+                       efx_dword_t dword;
+                       uint32_t sig;
+                       EFSYS_MEM_READD(esmp, 4 * MC_CMD_PMA_PMD_SIGNAL,
+                                       &dword);
+                       sig = EFX_DWORD_FIELD(dword, EFX_DWORD_0);
+                       stat[EFX_PHY_STAT_PMA_PMD_SIGNAL_A] = (sig >> 1) & 1;
+                       stat[EFX_PHY_STAT_PMA_PMD_SIGNAL_B] = (sig >> 2) & 1;
+                       stat[EFX_PHY_STAT_PMA_PMD_SIGNAL_C] = (sig >> 3) & 1;
+                       stat[EFX_PHY_STAT_PMA_PMD_SIGNAL_D] = (sig >> 4) & 1;
+               }
+       }
+
+       SIENA_SIMPLE_STAT_SET(vmask, esmp, smask, stat, MC_CMD_PMA_PMD_SNR_A,
+                           EFX_PHY_STAT_SNR_A);
+       SIENA_SIMPLE_STAT_SET(vmask, esmp, smask, stat, MC_CMD_PMA_PMD_SNR_B,
+                           EFX_PHY_STAT_SNR_B);
+       SIENA_SIMPLE_STAT_SET(vmask, esmp, smask, stat, MC_CMD_PMA_PMD_SNR_C,
+                           EFX_PHY_STAT_SNR_C);
+       SIENA_SIMPLE_STAT_SET(vmask, esmp, smask, stat, MC_CMD_PMA_PMD_SNR_D,
+                           EFX_PHY_STAT_SNR_D);
+
+       SIENA_SIMPLE_STAT_SET2(vmask, esmp, smask, stat, PCS_LINK_UP);
+       SIENA_SIMPLE_STAT_SET2(vmask, esmp, smask, stat, PCS_RX_FAULT);
+       SIENA_SIMPLE_STAT_SET2(vmask, esmp, smask, stat, PCS_TX_FAULT);
+       SIENA_SIMPLE_STAT_SET2(vmask, esmp, smask, stat, PCS_BER);
+       SIENA_SIMPLE_STAT_SET2(vmask, esmp, smask, stat, PCS_BLOCK_ERRORS);
+
+       SIENA_SIMPLE_STAT_SET(vmask, esmp, smask, stat, MC_CMD_PHYXS_LINK_UP,
+                           EFX_PHY_STAT_PHY_XS_LINK_UP);
+       SIENA_SIMPLE_STAT_SET(vmask, esmp, smask, stat, MC_CMD_PHYXS_RX_FAULT,
+                           EFX_PHY_STAT_PHY_XS_RX_FAULT);
+       SIENA_SIMPLE_STAT_SET(vmask, esmp, smask, stat, MC_CMD_PHYXS_TX_FAULT,
+                           EFX_PHY_STAT_PHY_XS_TX_FAULT);
+       SIENA_SIMPLE_STAT_SET(vmask, esmp, smask, stat, MC_CMD_PHYXS_ALIGN,
+                           EFX_PHY_STAT_PHY_XS_ALIGN);
+
+       if (vmask & (1 << MC_CMD_PHYXS_SYNC)) {
+               smask |=   ((1 << EFX_PHY_STAT_PHY_XS_SYNC_A) |
+                           (1 << EFX_PHY_STAT_PHY_XS_SYNC_B) |
+                           (1 << EFX_PHY_STAT_PHY_XS_SYNC_C) |
+                           (1 << EFX_PHY_STAT_PHY_XS_SYNC_D));
+               if (stat != NULL && !EFSYS_MEM_IS_NULL(esmp)) {
+                       efx_dword_t dword;
+                       uint32_t sync;
+                       EFSYS_MEM_READD(esmp, 4 * MC_CMD_PHYXS_SYNC, &dword);
+                       sync = EFX_DWORD_FIELD(dword, EFX_DWORD_0);
+                       stat[EFX_PHY_STAT_PHY_XS_SYNC_A] = (sync >> 0) & 1;
+                       stat[EFX_PHY_STAT_PHY_XS_SYNC_B] = (sync >> 1) & 1;
+                       stat[EFX_PHY_STAT_PHY_XS_SYNC_C] = (sync >> 2) & 1;
+                       stat[EFX_PHY_STAT_PHY_XS_SYNC_D] = (sync >> 3) & 1;
+               }
+       }
+
+       SIENA_SIMPLE_STAT_SET2(vmask, esmp, smask, stat, AN_LINK_UP);
+       SIENA_SIMPLE_STAT_SET2(vmask, esmp, smask, stat, AN_COMPLETE);
+
+       SIENA_SIMPLE_STAT_SET(vmask, esmp, smask, stat, MC_CMD_CL22_LINK_UP,
+                           EFX_PHY_STAT_CL22EXT_LINK_UP);
+
+       if (smaskp != NULL)
+               *smaskp = smask;
+}
+
+       __checkReturn                           efx_rc_t
+siena_phy_stats_update(
+       __in                                    efx_nic_t *enp,
+       __in                                    efsys_mem_t *esmp,
+       __inout_ecount(EFX_PHY_NSTATS)          uint32_t *stat)
+{
+       efx_nic_cfg_t *encp = &(enp->en_nic_cfg);
+       uint32_t vmask = encp->enc_mcdi_phy_stat_mask;
+       uint64_t smask;
+       efx_mcdi_req_t req;
+       uint8_t payload[MAX(MC_CMD_PHY_STATS_IN_LEN,
+                           MC_CMD_PHY_STATS_OUT_DMA_LEN)];
+       efx_rc_t rc;
+
+       if ((esmp == NULL) || (EFSYS_MEM_SIZE(esmp) < EFX_PHY_STATS_SIZE)) {
+               rc = EINVAL;
+               goto fail1;
+       }
+
+       (void) memset(payload, 0, sizeof (payload));
+       req.emr_cmd = MC_CMD_PHY_STATS;
+       req.emr_in_buf = payload;
+       req.emr_in_length = MC_CMD_PHY_STATS_IN_LEN;
+       req.emr_out_buf = payload;
+       req.emr_out_length = MC_CMD_PHY_STATS_OUT_DMA_LEN;
+
+       MCDI_IN_SET_DWORD(req, PHY_STATS_IN_DMA_ADDR_LO,
+                           EFSYS_MEM_ADDR(esmp) & 0xffffffff);
+       MCDI_IN_SET_DWORD(req, PHY_STATS_IN_DMA_ADDR_HI,
+                           EFSYS_MEM_ADDR(esmp) >> 32);
+
+       efx_mcdi_execute(enp, &req);
+
+       if (req.emr_rc != 0) {
+               rc = req.emr_rc;
+               goto fail2;
+       }
+       EFSYS_ASSERT3U(req.emr_out_length, ==, MC_CMD_PHY_STATS_OUT_DMA_LEN);
+
+       siena_phy_decode_stats(enp, vmask, esmp, &smask, stat);
+       EFSYS_ASSERT(smask == encp->enc_phy_stat_mask);
+
+       return (0);
+
+fail2:
+       EFSYS_PROBE(fail2);
+fail1:
+       EFSYS_PROBE1(fail1, efx_rc_t, rc);
+
+       return (0);
+}
+
+#endif /* EFSYS_OPT_PHY_STATS */
+
 #if EFSYS_OPT_BIST
 
        __checkReturn           efx_rc_t