sys/dev/sfxge/common/siena_phy.c

   1 /*-
   2  * Copyright (c) 2009-2015 Solarflare Communications Inc.
   3  * All rights reserved.
   4  *
   5  * Redistribution and use in source and binary forms, with or without
   6  * modification, are permitted provided that the following conditions are met:
   7  *
   8  * 1. Redistributions of source code must retain the above copyright notice,
   9  *    this list of conditions and the following disclaimer.
  10  * 2. Redistributions in binary form must reproduce the above copyright notice,
  11  *    this list of conditions and the following disclaimer in the documentation
  12  *    and/or other materials provided with the distribution.
  13  *
  14  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
  15  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
  16  * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
  17  * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR
  18  * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
  19  * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
  20  * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
  21  * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
  22  * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
  23  * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
  24  * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  25  *
  26  * The views and conclusions contained in the software and documentation are
  27  * those of the authors and should not be interpreted as representing official
  28  * policies, either expressed or implied, of the FreeBSD Project.
  29  */
  30
  31 #include <sys/cdefs.h>
  32 __FBSDID("$FreeBSD$");
  33
  34 #include "efsys.h"
  35 #include "efx.h"
  36 #include "efx_impl.h"
  37
  38 #if EFSYS_OPT_SIENA
  39
  40 static                  void
  41 siena_phy_decode_cap(
  42         __in            uint32_t mcdi_cap,
  43         __out           uint32_t *maskp)
  44 {
  45         uint32_t mask;
  46
  47         mask = 0;
  48         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_10HDX_LBN))
  49                 mask |= (1 << EFX_PHY_CAP_10HDX);
  50         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_10FDX_LBN))
  51                 mask |= (1 << EFX_PHY_CAP_10FDX);
  52         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_100HDX_LBN))
  53                 mask |= (1 << EFX_PHY_CAP_100HDX);
  54         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_100FDX_LBN))
  55                 mask |= (1 << EFX_PHY_CAP_100FDX);
  56         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_1000HDX_LBN))
  57                 mask |= (1 << EFX_PHY_CAP_1000HDX);
  58         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_1000FDX_LBN))
  59                 mask |= (1 << EFX_PHY_CAP_1000FDX);
  60         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_10000FDX_LBN))
  61                 mask |= (1 << EFX_PHY_CAP_10000FDX);
  62         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_PAUSE_LBN))
  63                 mask |= (1 << EFX_PHY_CAP_PAUSE);
  64         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_ASYM_LBN))
  65                 mask |= (1 << EFX_PHY_CAP_ASYM);
  66         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_AN_LBN))
  67                 mask |= (1 << EFX_PHY_CAP_AN);
  68
  69         *maskp = mask;
  70 }
  71
  72 static                  void
  73 siena_phy_decode_link_mode(
  74         __in            efx_nic_t *enp,
  75         __in            uint32_t link_flags,
  76         __in            unsigned int speed,
  77         __in            unsigned int fcntl,
  78         __out           efx_link_mode_t *link_modep,
  79         __out           unsigned int *fcntlp)
  80 {
  81         boolean_t fd = !!(link_flags &
  82                     (1 << MC_CMD_GET_LINK_OUT_FULL_DUPLEX_LBN));
  83         boolean_t up = !!(link_flags &
  84                     (1 << MC_CMD_GET_LINK_OUT_LINK_UP_LBN));
  85
  86         _NOTE(ARGUNUSED(enp))
  87
  88         if (!up)
  89                 *link_modep = EFX_LINK_DOWN;
  90         else if (speed == 10000 && fd)
  91                 *link_modep = EFX_LINK_10000FDX;
  92         else if (speed == 1000)
  93                 *link_modep = fd ? EFX_LINK_1000FDX : EFX_LINK_1000HDX;
  94         else if (speed == 100)
  95                 *link_modep = fd ? EFX_LINK_100FDX : EFX_LINK_100HDX;
  96         else if (speed == 10)
  97                 *link_modep = fd ? EFX_LINK_10FDX : EFX_LINK_10HDX;
  98         else
  99                 *link_modep = EFX_LINK_UNKNOWN;
 100
 101         if (fcntl == MC_CMD_FCNTL_OFF)
 102                 *fcntlp = 0;
 103         else if (fcntl == MC_CMD_FCNTL_RESPOND)
 104                 *fcntlp = EFX_FCNTL_RESPOND;
 105         else if (fcntl == MC_CMD_FCNTL_BIDIR)
 106                 *fcntlp = EFX_FCNTL_RESPOND | EFX_FCNTL_GENERATE;
 107         else {
 108                 EFSYS_PROBE1(mc_pcol_error, int, fcntl);
 109                 *fcntlp = 0;
 110         }
 111 }
 112
 113                         void
 114 siena_phy_link_ev(
 115         __in            efx_nic_t *enp,
 116         __in            efx_qword_t *eqp,
 117         __out           efx_link_mode_t *link_modep)
 118 {
 119         efx_port_t *epp = &(enp->en_port);
 120         unsigned int link_flags;
 121         unsigned int speed;
 122         unsigned int fcntl;
 123         efx_link_mode_t link_mode;
 124         uint32_t lp_cap_mask;
 125
 126         /*
 127          * Convert the LINKCHANGE speed enumeration into mbit/s, in the
 128          * same way as GET_LINK encodes the speed
 129          */
 130         switch (MCDI_EV_FIELD(eqp, LINKCHANGE_SPEED)) {
 131         case MCDI_EVENT_LINKCHANGE_SPEED_100M:
 132                 speed = 100;
 133                 break;
 134         case MCDI_EVENT_LINKCHANGE_SPEED_1G:
 135                 speed = 1000;
 136                 break;
 137         case MCDI_EVENT_LINKCHANGE_SPEED_10G:
 138                 speed = 10000;
 139                 break;
 140         default:
 141                 speed = 0;
 142                 break;
 143         }
 144
 145         link_flags = MCDI_EV_FIELD(eqp, LINKCHANGE_LINK_FLAGS);
 146         siena_phy_decode_link_mode(enp, link_flags, speed,
 147                                     MCDI_EV_FIELD(eqp, LINKCHANGE_FCNTL),
 148                                     &link_mode, &fcntl);
 149         siena_phy_decode_cap(MCDI_EV_FIELD(eqp, LINKCHANGE_LP_CAP),
 150                             &lp_cap_mask);
 151
 152         /*
 153          * It's safe to update ep_lp_cap_mask without the driver's port lock
 154          * because presumably any concurrently running efx_port_poll() is
 155          * only going to arrive at the same value.
 156          *
 157          * ep_fcntl has two meanings. It's either the link common fcntl
 158          * (if the PHY supports AN), or it's the forced link state. If
 159          * the former, it's safe to update the value for the same reason as
 160          * for ep_lp_cap_mask. If the latter, then just ignore the value,
 161          * because we can race with efx_mac_fcntl_set().
 162          */
 163         epp->ep_lp_cap_mask = lp_cap_mask;
 164         if (epp->ep_phy_cap_mask & (1 << EFX_PHY_CAP_AN))
 165                 epp->ep_fcntl = fcntl;
 166
 167         *link_modep = link_mode;
 168 }
 169
 170         __checkReturn   int
 171 siena_phy_power(
 172         __in            efx_nic_t *enp,
 173         __in            boolean_t power)
 174 {
 175         int rc;
 176
 177         if (!power)
 178                 return (0);
 179
 180         /* Check if the PHY is a zombie */
 181         if ((rc = siena_phy_verify(enp)) != 0)
 182                 goto fail1;
 183
 184         enp->en_reset_flags |= EFX_RESET_PHY;
 185
 186         return (0);
 187
 188 fail1:
 189         EFSYS_PROBE1(fail1, int, rc);
 190
 191         return (rc);
 192 }
 193
 194         __checkReturn   int
 195 siena_phy_get_link(
 196         __in            efx_nic_t *enp,
 197         __out           siena_link_state_t *slsp)
 198 {
 199         efx_mcdi_req_t req;
 200         uint8_t payload[MAX(MC_CMD_GET_LINK_IN_LEN,
 201                             MC_CMD_GET_LINK_OUT_LEN)];
 202         int rc;
 203
 204         (void) memset(payload, 0, sizeof (payload));
 205         req.emr_cmd = MC_CMD_GET_LINK;
 206         req.emr_in_buf = payload;
 207         req.emr_in_length = MC_CMD_GET_LINK_IN_LEN;
 208         req.emr_out_buf = payload;
 209         req.emr_out_length = MC_CMD_GET_LINK_OUT_LEN;
 210
 211         efx_mcdi_execute(enp, &req);
 212
 213         if (req.emr_rc != 0) {
 214                 rc = req.emr_rc;
 215                 goto fail1;
 216         }
 217
 218         if (req.emr_out_length_used < MC_CMD_GET_LINK_OUT_LEN) {
 219                 rc = EMSGSIZE;
 220                 goto fail2;
 221         }
 222
 223         siena_phy_decode_cap(MCDI_OUT_DWORD(req, GET_LINK_OUT_CAP),
 224                             &slsp->sls_adv_cap_mask);
 225         siena_phy_decode_cap(MCDI_OUT_DWORD(req, GET_LINK_OUT_LP_CAP),
 226                             &slsp->sls_lp_cap_mask);
 227
 228         siena_phy_decode_link_mode(enp, MCDI_OUT_DWORD(req, GET_LINK_OUT_FLAGS),
 229                             MCDI_OUT_DWORD(req, GET_LINK_OUT_LINK_SPEED),
 230                             MCDI_OUT_DWORD(req, GET_LINK_OUT_FCNTL),
 231                             &slsp->sls_link_mode, &slsp->sls_fcntl);
 232
 233 #if EFSYS_OPT_LOOPBACK
 234         /* Assert the MC_CMD_LOOPBACK and EFX_LOOPBACK namespace agree */
 235         EFX_STATIC_ASSERT(MC_CMD_LOOPBACK_NONE == EFX_LOOPBACK_OFF);
 236         EFX_STATIC_ASSERT(MC_CMD_LOOPBACK_DATA == EFX_LOOPBACK_DATA);
 237         EFX_STATIC_ASSERT(MC_CMD_LOOPBACK_GMAC == EFX_LOOPBACK_GMAC);
 238         EFX_STATIC_ASSERT(MC_CMD_LOOPBACK_XGMII == EFX_LOOPBACK_XGMII);
 239         EFX_STATIC_ASSERT(MC_CMD_LOOPBACK_XGXS == EFX_LOOPBACK_XGXS);
 240         EFX_STATIC_ASSERT(MC_CMD_LOOPBACK_XAUI == EFX_LOOPBACK_XAUI);
 241         EFX_STATIC_ASSERT(MC_CMD_LOOPBACK_GMII == EFX_LOOPBACK_GMII);
 242         EFX_STATIC_ASSERT(MC_CMD_LOOPBACK_SGMII == EFX_LOOPBACK_SGMII);
 243         EFX_STATIC_ASSERT(MC_CMD_LOOPBACK_XGBR == EFX_LOOPBACK_XGBR);
 244         EFX_STATIC_ASSERT(MC_CMD_LOOPBACK_XFI == EFX_LOOPBACK_XFI);
 245         EFX_STATIC_ASSERT(MC_CMD_LOOPBACK_XAUI_FAR == EFX_LOOPBACK_XAUI_FAR);
 246         EFX_STATIC_ASSERT(MC_CMD_LOOPBACK_GMII_FAR == EFX_LOOPBACK_GMII_FAR);
 247         EFX_STATIC_ASSERT(MC_CMD_LOOPBACK_SGMII_FAR == EFX_LOOPBACK_SGMII_FAR);
 248         EFX_STATIC_ASSERT(MC_CMD_LOOPBACK_XFI_FAR == EFX_LOOPBACK_XFI_FAR);
 249         EFX_STATIC_ASSERT(MC_CMD_LOOPBACK_GPHY == EFX_LOOPBACK_GPHY);
 250         EFX_STATIC_ASSERT(MC_CMD_LOOPBACK_PHYXS == EFX_LOOPBACK_PHY_XS);
 251         EFX_STATIC_ASSERT(MC_CMD_LOOPBACK_PCS == EFX_LOOPBACK_PCS);
 252         EFX_STATIC_ASSERT(MC_CMD_LOOPBACK_PMAPMD == EFX_LOOPBACK_PMA_PMD);
 253
 254         slsp->sls_loopback = MCDI_OUT_DWORD(req, GET_LINK_OUT_LOOPBACK_MODE);
 255 #endif  /* EFSYS_OPT_LOOPBACK */
 256
 257         slsp->sls_mac_up = MCDI_OUT_DWORD(req, GET_LINK_OUT_MAC_FAULT) == 0;
 258
 259         return (0);
 260
 261 fail2:
 262         EFSYS_PROBE(fail2);
 263 fail1:
 264         EFSYS_PROBE1(fail1, int, rc);
 265
 266         return (rc);
 267 }
 268
 269         __checkReturn   int
 270 siena_phy_reconfigure(
 271         __in            efx_nic_t *enp)
 272 {
 273         efx_port_t *epp = &(enp->en_port);
 274         efx_mcdi_req_t req;
 275         uint8_t payload[MAX(MAX(MC_CMD_SET_ID_LED_IN_LEN,
 276                                 MC_CMD_SET_ID_LED_OUT_LEN),
 277                             MAX(MC_CMD_SET_LINK_IN_LEN,
 278                                 MC_CMD_SET_LINK_OUT_LEN))];
 279         uint32_t cap_mask;
 280         unsigned int led_mode;
 281         unsigned int speed;
 282         int rc;
 283
 284         (void) memset(payload, 0, sizeof (payload));
 285         req.emr_cmd = MC_CMD_SET_LINK;
 286         req.emr_in_buf = payload;
 287         req.emr_in_length = MC_CMD_SET_LINK_IN_LEN;
 288         req.emr_out_buf = payload;
 289         req.emr_out_length = MC_CMD_SET_LINK_OUT_LEN;
 290
 291         cap_mask = epp->ep_adv_cap_mask;
 292         MCDI_IN_POPULATE_DWORD_10(req, SET_LINK_IN_CAP,
 293                 PHY_CAP_10HDX, (cap_mask >> EFX_PHY_CAP_10HDX) & 0x1,
 294                 PHY_CAP_10FDX, (cap_mask >> EFX_PHY_CAP_10FDX) & 0x1,
 295                 PHY_CAP_100HDX, (cap_mask >> EFX_PHY_CAP_100HDX) & 0x1,
 296                 PHY_CAP_100FDX, (cap_mask >> EFX_PHY_CAP_100FDX) & 0x1,
 297                 PHY_CAP_1000HDX, (cap_mask >> EFX_PHY_CAP_1000HDX) & 0x1,
 298                 PHY_CAP_1000FDX, (cap_mask >> EFX_PHY_CAP_1000FDX) & 0x1,
 299                 PHY_CAP_10000FDX, (cap_mask >> EFX_PHY_CAP_10000FDX) & 0x1,
 300                 PHY_CAP_PAUSE, (cap_mask >> EFX_PHY_CAP_PAUSE) & 0x1,
 301                 PHY_CAP_ASYM, (cap_mask >> EFX_PHY_CAP_ASYM) & 0x1,
 302                 PHY_CAP_AN, (cap_mask >> EFX_PHY_CAP_AN) & 0x1);
 303
 304 #if EFSYS_OPT_LOOPBACK
 305         MCDI_IN_SET_DWORD(req, SET_LINK_IN_LOOPBACK_MODE,
 306                     epp->ep_loopback_type);
 307         switch (epp->ep_loopback_link_mode) {
 308         case EFX_LINK_100FDX:
 309                 speed = 100;
 310                 break;
 311         case EFX_LINK_1000FDX:
 312                 speed = 1000;
 313                 break;
 314         case EFX_LINK_10000FDX:
 315                 speed = 10000;
 316                 break;
 317         default:
 318                 speed = 0;
 319         }
 320 #else
 321         MCDI_IN_SET_DWORD(req, SET_LINK_IN_LOOPBACK_MODE, MC_CMD_LOOPBACK_NONE);
 322         speed = 0;
 323 #endif  /* EFSYS_OPT_LOOPBACK */
 324         MCDI_IN_SET_DWORD(req, SET_LINK_IN_LOOPBACK_SPEED, speed);
 325
 326 #if EFSYS_OPT_PHY_FLAGS
 327         MCDI_IN_SET_DWORD(req, SET_LINK_IN_FLAGS, epp->ep_phy_flags);
 328 #else
 329         MCDI_IN_SET_DWORD(req, SET_LINK_IN_FLAGS, 0);
 330 #endif  /* EFSYS_OPT_PHY_FLAGS */
 331
 332         efx_mcdi_execute(enp, &req);
 333
 334         if (req.emr_rc != 0) {
 335                 rc = req.emr_rc;
 336                 goto fail1;
 337         }
 338
 339         /* And set the blink mode */
 340         (void) memset(payload, 0, sizeof (payload));
 341         req.emr_cmd = MC_CMD_SET_ID_LED;
 342         req.emr_in_buf = payload;
 343         req.emr_in_length = MC_CMD_SET_ID_LED_IN_LEN;
 344         req.emr_out_buf = payload;
 345         req.emr_out_length = MC_CMD_SET_ID_LED_OUT_LEN;
 346
 347 #if EFSYS_OPT_PHY_LED_CONTROL
 348         switch (epp->ep_phy_led_mode) {
 349         case EFX_PHY_LED_DEFAULT:
 350                 led_mode = MC_CMD_LED_DEFAULT;
 351                 break;
 352         case EFX_PHY_LED_OFF:
 353                 led_mode = MC_CMD_LED_OFF;
 354                 break;
 355         case EFX_PHY_LED_ON:
 356                 led_mode = MC_CMD_LED_ON;
 357                 break;
 358         default:
 359                 EFSYS_ASSERT(0);
 360                 led_mode = MC_CMD_LED_DEFAULT;
 361         }
 362
 363         MCDI_IN_SET_DWORD(req, SET_ID_LED_IN_STATE, led_mode);
 364 #else
 365         MCDI_IN_SET_DWORD(req, SET_ID_LED_IN_STATE, MC_CMD_LED_DEFAULT);
 366 #endif  /* EFSYS_OPT_PHY_LED_CONTROL */
 367
 368         efx_mcdi_execute(enp, &req);
 369
 370         if (req.emr_rc != 0) {
 371                 rc = req.emr_rc;
 372                 goto fail2;
 373         }
 374
 375         return (0);
 376
 377 fail2:
 378         EFSYS_PROBE(fail2);
 379 fail1:
 380         EFSYS_PROBE1(fail1, int, rc);
 381
 382         return (rc);
 383 }
 384
 385         __checkReturn   int
 386 siena_phy_verify(
 387         __in            efx_nic_t *enp)
 388 {
 389         efx_mcdi_req_t req;
 390         uint8_t payload[MAX(MC_CMD_GET_PHY_STATE_IN_LEN,
 391                             MC_CMD_GET_PHY_STATE_OUT_LEN)];
 392         uint32_t state;
 393         int rc;
 394
 395         (void) memset(payload, 0, sizeof (payload));
 396         req.emr_cmd = MC_CMD_GET_PHY_STATE;
 397         req.emr_in_buf = payload;
 398         req.emr_in_length = MC_CMD_GET_PHY_STATE_IN_LEN;
 399         req.emr_out_buf = payload;
 400         req.emr_out_length = MC_CMD_GET_PHY_STATE_OUT_LEN;
 401
 402         efx_mcdi_execute(enp, &req);
 403
 404         if (req.emr_rc != 0) {
 405                 rc = req.emr_rc;
 406                 goto fail1;
 407         }
 408
 409         if (req.emr_out_length_used < MC_CMD_GET_PHY_STATE_OUT_LEN) {
 410                 rc = EMSGSIZE;
 411                 goto fail2;
 412         }
 413
 414         state = MCDI_OUT_DWORD(req, GET_PHY_STATE_OUT_STATE);
 415         if (state != MC_CMD_PHY_STATE_OK) {
 416                 if (state != MC_CMD_PHY_STATE_ZOMBIE)
 417                         EFSYS_PROBE1(mc_pcol_error, int, state);
 418                 rc = ENOTACTIVE;
 419                 goto fail3;
 420         }
 421
 422         return (0);
 423
 424 fail3:
 425         EFSYS_PROBE(fail3);
 426 fail2:
 427         EFSYS_PROBE(fail2);
 428 fail1:
 429         EFSYS_PROBE1(fail1, int, rc);
 430
 431         return (rc);
 432 }
 433
 434         __checkReturn   int
 435 siena_phy_oui_get(
 436         __in            efx_nic_t *enp,
 437         __out           uint32_t *ouip)
 438 {
 439         _NOTE(ARGUNUSED(enp, ouip))
 440
 441         return (ENOTSUP);
 442 }
 443
 444 #if EFSYS_OPT_PHY_STATS
 445
 446 #define SIENA_SIMPLE_STAT_SET(_vmask, _esmp, _smask, _stat,             \
 447                             _mc_record, _efx_record)                    \
 448         if ((_vmask) & (1ULL << (_mc_record))) {                        \
 449                 (_smask) |= (1ULL << (_efx_record));                    \
 450                 if ((_stat) != NULL && !EFSYS_MEM_IS_NULL(_esmp)) {     \
 451                         efx_dword_t dword;                              \
 452                         EFSYS_MEM_READD(_esmp, (_mc_record) * 4, &dword);\
 453                         (_stat)[_efx_record] =                          \
 454                                 EFX_DWORD_FIELD(dword, EFX_DWORD_0);    \
 455                 }                                                       \
 456         }
 457
 458 #define SIENA_SIMPLE_STAT_SET2(_vmask, _esmp, _smask, _stat, _record)   \
 459         SIENA_SIMPLE_STAT_SET(_vmask, _esmp, _smask, _stat,             \
 460                             MC_CMD_ ## _record,                         \
 461                             EFX_PHY_STAT_ ## _record)
 462
 463                                                 void
 464 siena_phy_decode_stats(
 465         __in                                    efx_nic_t *enp,
 466         __in                                    uint32_t vmask,
 467         __in_opt                                efsys_mem_t *esmp,
 468         __out_opt                               uint64_t *smaskp,
 469         __out_ecount_opt(EFX_PHY_NSTATS)        uint32_t *stat)
 470 {
 471         uint64_t smask = 0;
 472
 473         _NOTE(ARGUNUSED(enp))
 474
 475         SIENA_SIMPLE_STAT_SET2(vmask, esmp, smask, stat, OUI);
 476         SIENA_SIMPLE_STAT_SET2(vmask, esmp, smask, stat, PMA_PMD_LINK_UP);
 477         SIENA_SIMPLE_STAT_SET2(vmask, esmp, smask, stat, PMA_PMD_RX_FAULT);
 478         SIENA_SIMPLE_STAT_SET2(vmask, esmp, smask, stat, PMA_PMD_TX_FAULT);
 479
 480         if (vmask & (1 << MC_CMD_PMA_PMD_SIGNAL)) {
 481                 smask |=   ((1ULL << EFX_PHY_STAT_PMA_PMD_SIGNAL_A) |
 482                             (1ULL << EFX_PHY_STAT_PMA_PMD_SIGNAL_B) |
 483                             (1ULL << EFX_PHY_STAT_PMA_PMD_SIGNAL_C) |
 484                             (1ULL << EFX_PHY_STAT_PMA_PMD_SIGNAL_D));
 485                 if (stat != NULL && esmp != NULL && !EFSYS_MEM_IS_NULL(esmp)) {
 486                         efx_dword_t dword;
 487                         uint32_t sig;
 488                         EFSYS_MEM_READD(esmp, 4 * MC_CMD_PMA_PMD_SIGNAL,
 489                                         &dword);
 490                         sig = EFX_DWORD_FIELD(dword, EFX_DWORD_0);
 491                         stat[EFX_PHY_STAT_PMA_PMD_SIGNAL_A] = (sig >> 1) & 1;
 492                         stat[EFX_PHY_STAT_PMA_PMD_SIGNAL_B] = (sig >> 2) & 1;
 493                         stat[EFX_PHY_STAT_PMA_PMD_SIGNAL_C] = (sig >> 3) & 1;
 494                         stat[EFX_PHY_STAT_PMA_PMD_SIGNAL_D] = (sig >> 4) & 1;
 495                 }
 496         }
 497
 498         SIENA_SIMPLE_STAT_SET(vmask, esmp, smask, stat, MC_CMD_PMA_PMD_SNR_A,
 499                             EFX_PHY_STAT_SNR_A);
 500         SIENA_SIMPLE_STAT_SET(vmask, esmp, smask, stat, MC_CMD_PMA_PMD_SNR_B,
 501                             EFX_PHY_STAT_SNR_B);
 502         SIENA_SIMPLE_STAT_SET(vmask, esmp, smask, stat, MC_CMD_PMA_PMD_SNR_C,
 503                             EFX_PHY_STAT_SNR_C);
 504         SIENA_SIMPLE_STAT_SET(vmask, esmp, smask, stat, MC_CMD_PMA_PMD_SNR_D,
 505                             EFX_PHY_STAT_SNR_D);
 506
 507         SIENA_SIMPLE_STAT_SET2(vmask, esmp, smask, stat, PCS_LINK_UP);
 508         SIENA_SIMPLE_STAT_SET2(vmask, esmp, smask, stat, PCS_RX_FAULT);
 509         SIENA_SIMPLE_STAT_SET2(vmask, esmp, smask, stat, PCS_TX_FAULT);
 510         SIENA_SIMPLE_STAT_SET2(vmask, esmp, smask, stat, PCS_BER);
 511         SIENA_SIMPLE_STAT_SET2(vmask, esmp, smask, stat, PCS_BLOCK_ERRORS);
 512
 513         SIENA_SIMPLE_STAT_SET(vmask, esmp, smask, stat, MC_CMD_PHYXS_LINK_UP,
 514                             EFX_PHY_STAT_PHY_XS_LINK_UP);
 515         SIENA_SIMPLE_STAT_SET(vmask, esmp, smask, stat, MC_CMD_PHYXS_RX_FAULT,
 516                             EFX_PHY_STAT_PHY_XS_RX_FAULT);
 517         SIENA_SIMPLE_STAT_SET(vmask, esmp, smask, stat, MC_CMD_PHYXS_TX_FAULT,
 518                             EFX_PHY_STAT_PHY_XS_TX_FAULT);
 519         SIENA_SIMPLE_STAT_SET(vmask, esmp, smask, stat, MC_CMD_PHYXS_ALIGN,
 520                             EFX_PHY_STAT_PHY_XS_ALIGN);
 521
 522         if (vmask & (1 << MC_CMD_PHYXS_SYNC)) {
 523                 smask |=   ((1 << EFX_PHY_STAT_PHY_XS_SYNC_A) |
 524                             (1 << EFX_PHY_STAT_PHY_XS_SYNC_B) |
 525                             (1 << EFX_PHY_STAT_PHY_XS_SYNC_C) |
 526                             (1 << EFX_PHY_STAT_PHY_XS_SYNC_D));
 527                 if (stat != NULL && !EFSYS_MEM_IS_NULL(esmp)) {
 528                         efx_dword_t dword;
 529                         uint32_t sync;
 530                         EFSYS_MEM_READD(esmp, 4 * MC_CMD_PHYXS_SYNC, &dword);
 531                         sync = EFX_DWORD_FIELD(dword, EFX_DWORD_0);
 532                         stat[EFX_PHY_STAT_PHY_XS_SYNC_A] = (sync >> 0) & 1;
 533                         stat[EFX_PHY_STAT_PHY_XS_SYNC_B] = (sync >> 1) & 1;
 534                         stat[EFX_PHY_STAT_PHY_XS_SYNC_C] = (sync >> 2) & 1;
 535                         stat[EFX_PHY_STAT_PHY_XS_SYNC_D] = (sync >> 3) & 1;
 536                 }
 537         }
 538
 539         SIENA_SIMPLE_STAT_SET2(vmask, esmp, smask, stat, AN_LINK_UP);
 540         SIENA_SIMPLE_STAT_SET2(vmask, esmp, smask, stat, AN_COMPLETE);
 541
 542         SIENA_SIMPLE_STAT_SET(vmask, esmp, smask, stat, MC_CMD_CL22_LINK_UP,
 543                             EFX_PHY_STAT_CL22EXT_LINK_UP);
 544
 545         if (smaskp != NULL)
 546                 *smaskp = smask;
 547 }
 548
 549         __checkReturn                           int
 550 siena_phy_stats_update(
 551         __in                                    efx_nic_t *enp,
 552         __in                                    efsys_mem_t *esmp,
 553         __out_ecount(EFX_PHY_NSTATS)            uint32_t *stat)
 554 {
 555         efx_nic_cfg_t *encp = &(enp->en_nic_cfg);
 556         uint32_t vmask = encp->enc_mcdi_phy_stat_mask;
 557         uint64_t smask;
 558         efx_mcdi_req_t req;
 559         uint8_t payload[MAX(MC_CMD_PHY_STATS_IN_LEN,
 560                             MC_CMD_PHY_STATS_OUT_DMA_LEN)];
 561         int rc;
 562
 563         (void) memset(payload, 0, sizeof (payload));
 564         req.emr_cmd = MC_CMD_PHY_STATS;
 565         req.emr_in_buf = payload;
 566         req.emr_in_length = MC_CMD_PHY_STATS_IN_LEN;
 567         req.emr_out_buf = payload;
 568         req.emr_out_length = MC_CMD_PHY_STATS_OUT_DMA_LEN;
 569
 570         MCDI_IN_SET_DWORD(req, PHY_STATS_IN_DMA_ADDR_LO,
 571                             EFSYS_MEM_ADDR(esmp) & 0xffffffff);
 572         MCDI_IN_SET_DWORD(req, PHY_STATS_IN_DMA_ADDR_HI,
 573                             EFSYS_MEM_ADDR(esmp) >> 32);
 574
 575         efx_mcdi_execute(enp, &req);
 576
 577         if (req.emr_rc != 0) {
 578                 rc = req.emr_rc;
 579                 goto fail1;
 580         }
 581         EFSYS_ASSERT3U(req.emr_out_length, ==, MC_CMD_PHY_STATS_OUT_DMA_LEN);
 582
 583         siena_phy_decode_stats(enp, vmask, esmp, &smask, stat);
 584         EFSYS_ASSERT(smask == encp->enc_phy_stat_mask);
 585
 586         return (0);
 587
 588 fail1:
 589         EFSYS_PROBE1(fail1, int, rc);
 590
 591         return (0);
 592 }
 593
 594 #endif  /* EFSYS_OPT_PHY_STATS */
 595
 596 #if EFSYS_OPT_PHY_PROPS
 597
 598 #if EFSYS_OPT_NAMES
 599
 600 extern          const char *
 601 siena_phy_prop_name(
 602         __in    efx_nic_t *enp,
 603         __in    unsigned int id)
 604 {
 605         _NOTE(ARGUNUSED(enp, id))
 606
 607         return (NULL);
 608 }
 609
 610 #endif  /* EFSYS_OPT_NAMES */
 611
 612 extern  __checkReturn   int
 613 siena_phy_prop_get(
 614         __in            efx_nic_t *enp,
 615         __in            unsigned int id,
 616         __in            uint32_t flags,
 617         __out           uint32_t *valp)
 618 {
 619         _NOTE(ARGUNUSED(enp, id, flags, valp))
 620
 621         return (ENOTSUP);
 622 }
 623
 624 extern  __checkReturn   int
 625 siena_phy_prop_set(
 626         __in            efx_nic_t *enp,
 627         __in            unsigned int id,
 628         __in            uint32_t val)
 629 {
 630         _NOTE(ARGUNUSED(enp, id, val))
 631
 632         return (ENOTSUP);
 633 }
 634
 635 #endif  /* EFSYS_OPT_PHY_PROPS */
 636
 637 #if EFSYS_OPT_BIST
 638
 639         __checkReturn           int
 640 siena_phy_bist_start(
 641         __in                    efx_nic_t *enp,
 642         __in                    efx_bist_type_t type)
 643 {
 644         int rc;
 645
 646         if ((rc = efx_mcdi_bist_start(enp, type)) != 0)
 647                 goto fail1;
 648
 649         return (0);
 650
 651 fail1:
 652         EFSYS_PROBE1(fail1, int, rc);
 653
 654         return (rc);
 655 }
 656
 657 static  __checkReturn           unsigned long
 658 siena_phy_sft9001_bist_status(
 659         __in                    uint16_t code)
 660 {
 661         switch (code) {
 662         case MC_CMD_POLL_BIST_SFT9001_PAIR_BUSY:
 663                 return (EFX_PHY_CABLE_STATUS_BUSY);
 664         case MC_CMD_POLL_BIST_SFT9001_INTER_PAIR_SHORT:
 665                 return (EFX_PHY_CABLE_STATUS_INTERPAIRSHORT);
 666         case MC_CMD_POLL_BIST_SFT9001_INTRA_PAIR_SHORT:
 667                 return (EFX_PHY_CABLE_STATUS_INTRAPAIRSHORT);
 668         case MC_CMD_POLL_BIST_SFT9001_PAIR_OPEN:
 669                 return (EFX_PHY_CABLE_STATUS_OPEN);
 670         case MC_CMD_POLL_BIST_SFT9001_PAIR_OK:
 671                 return (EFX_PHY_CABLE_STATUS_OK);
 672         default:
 673                 return (EFX_PHY_CABLE_STATUS_INVALID);
 674         }
 675 }
 676
 677         __checkReturn           int
 678 siena_phy_bist_poll(
 679         __in                    efx_nic_t *enp,
 680         __in                    efx_bist_type_t type,
 681         __out                   efx_bist_result_t *resultp,
 682         __out_opt __drv_when(count > 0, __notnull)
 683         uint32_t *value_maskp,
 684         __out_ecount_opt(count) __drv_when(count > 0, __notnull)
 685         unsigned long *valuesp,
 686         __in                    size_t count)
 687 {
 688         efx_nic_cfg_t *encp = &(enp->en_nic_cfg);
 689         uint8_t payload[MAX(MC_CMD_POLL_BIST_IN_LEN,
 690                             MCDI_CTL_SDU_LEN_MAX)];
 691         uint32_t value_mask = 0;
 692         efx_mcdi_req_t req;
 693         uint32_t result;
 694         int rc;
 695
 696         (void) memset(payload, 0, sizeof (payload));
 697         req.emr_cmd = MC_CMD_POLL_BIST;
 698         req.emr_in_buf = payload;
 699         req.emr_in_length = MC_CMD_POLL_BIST_IN_LEN;
 700         req.emr_out_buf = payload;
 701         req.emr_out_length = MCDI_CTL_SDU_LEN_MAX;
 702
 703         efx_mcdi_execute(enp, &req);
 704
 705         if (req.emr_rc != 0) {
 706                 rc = req.emr_rc;
 707                 goto fail1;
 708         }
 709
 710         if (req.emr_out_length_used < MC_CMD_POLL_BIST_OUT_RESULT_OFST + 4) {
 711                 rc = EMSGSIZE;
 712                 goto fail2;
 713         }
 714
 715         if (count > 0)
 716                 (void) memset(valuesp, '\0', count * sizeof (unsigned long));
 717
 718         result = MCDI_OUT_DWORD(req, POLL_BIST_OUT_RESULT);
 719
 720         /* Extract PHY specific results */
 721         if (result == MC_CMD_POLL_BIST_PASSED &&
 722             encp->enc_phy_type == EFX_PHY_SFT9001B &&
 723             req.emr_out_length_used >= MC_CMD_POLL_BIST_OUT_SFT9001_LEN &&
 724             (type == EFX_BIST_TYPE_PHY_CABLE_SHORT ||
 725             type == EFX_BIST_TYPE_PHY_CABLE_LONG)) {
 726                 uint16_t word;
 727
 728                 if (count > EFX_BIST_PHY_CABLE_LENGTH_A) {
 729                         if (valuesp != NULL)
 730                                 valuesp[EFX_BIST_PHY_CABLE_LENGTH_A] =
 731                                     MCDI_OUT_DWORD(req,
 732                                     POLL_BIST_OUT_SFT9001_CABLE_LENGTH_A);
 733                         value_mask |= (1 << EFX_BIST_PHY_CABLE_LENGTH_A);
 734                 }
 735
 736                 if (count > EFX_BIST_PHY_CABLE_LENGTH_B) {
 737                         if (valuesp != NULL)
 738                                 valuesp[EFX_BIST_PHY_CABLE_LENGTH_B] =
 739                                     MCDI_OUT_DWORD(req,
 740                                     POLL_BIST_OUT_SFT9001_CABLE_LENGTH_B);
 741                         value_mask |= (1 << EFX_BIST_PHY_CABLE_LENGTH_B);
 742                 }
 743
 744                 if (count > EFX_BIST_PHY_CABLE_LENGTH_C) {
 745                         if (valuesp != NULL)
 746                                 valuesp[EFX_BIST_PHY_CABLE_LENGTH_C] =
 747                                     MCDI_OUT_DWORD(req,
 748                                     POLL_BIST_OUT_SFT9001_CABLE_LENGTH_C);
 749                         value_mask |= (1 << EFX_BIST_PHY_CABLE_LENGTH_C);
 750                 }
 751
 752                 if (count > EFX_BIST_PHY_CABLE_LENGTH_D) {
 753                         if (valuesp != NULL)
 754                                 valuesp[EFX_BIST_PHY_CABLE_LENGTH_D] =
 755                                     MCDI_OUT_DWORD(req,
 756                                     POLL_BIST_OUT_SFT9001_CABLE_LENGTH_D);
 757                         value_mask |= (1 << EFX_BIST_PHY_CABLE_LENGTH_D);
 758                 }
 759
 760                 if (count > EFX_BIST_PHY_CABLE_STATUS_A) {
 761                         if (valuesp != NULL) {
 762                                 word = MCDI_OUT_WORD(req,
 763                                     POLL_BIST_OUT_SFT9001_CABLE_STATUS_A);
 764                                 valuesp[EFX_BIST_PHY_CABLE_STATUS_A] =
 765                                     siena_phy_sft9001_bist_status(word);
 766                         }
 767                         value_mask |= (1 << EFX_BIST_PHY_CABLE_STATUS_A);
 768                 }
 769
 770                 if (count > EFX_BIST_PHY_CABLE_STATUS_B) {
 771                         if (valuesp != NULL) {
 772                                 word = MCDI_OUT_WORD(req,
 773                                     POLL_BIST_OUT_SFT9001_CABLE_STATUS_B);
 774                                 valuesp[EFX_BIST_PHY_CABLE_STATUS_B] =
 775                                     siena_phy_sft9001_bist_status(word);
 776                         }
 777                         value_mask |= (1 << EFX_BIST_PHY_CABLE_STATUS_B);
 778                 }
 779
 780                 if (count > EFX_BIST_PHY_CABLE_STATUS_C) {
 781                         if (valuesp != NULL) {
 782                                 word = MCDI_OUT_WORD(req,
 783                                     POLL_BIST_OUT_SFT9001_CABLE_STATUS_C);
 784                                 valuesp[EFX_BIST_PHY_CABLE_STATUS_C] =
 785                                     siena_phy_sft9001_bist_status(word);
 786                         }
 787                         value_mask |= (1 << EFX_BIST_PHY_CABLE_STATUS_C);
 788                 }
 789
 790                 if (count > EFX_BIST_PHY_CABLE_STATUS_D) {
 791                         if (valuesp != NULL) {
 792                                 word = MCDI_OUT_WORD(req,
 793                                     POLL_BIST_OUT_SFT9001_CABLE_STATUS_D);
 794                                 valuesp[EFX_BIST_PHY_CABLE_STATUS_D] =
 795                                     siena_phy_sft9001_bist_status(word);
 796                         }
 797                         value_mask |= (1 << EFX_BIST_PHY_CABLE_STATUS_D);
 798                 }
 799
 800         } else if (result == MC_CMD_POLL_BIST_FAILED &&
 801                     encp->enc_phy_type == EFX_PHY_QLX111V &&
 802                     req.emr_out_length >= MC_CMD_POLL_BIST_OUT_MRSFP_LEN &&
 803                     count > EFX_BIST_FAULT_CODE) {
 804                 if (valuesp != NULL)
 805                         valuesp[EFX_BIST_FAULT_CODE] =
 806                             MCDI_OUT_DWORD(req, POLL_BIST_OUT_MRSFP_TEST);
 807                 value_mask |= 1 << EFX_BIST_FAULT_CODE;
 808         }
 809
 810         if (value_maskp != NULL)
 811                 *value_maskp = value_mask;
 812
 813         EFSYS_ASSERT(resultp != NULL);
 814         if (result == MC_CMD_POLL_BIST_RUNNING)
 815                 *resultp = EFX_BIST_RESULT_RUNNING;
 816         else if (result == MC_CMD_POLL_BIST_PASSED)
 817                 *resultp = EFX_BIST_RESULT_PASSED;
 818         else
 819                 *resultp = EFX_BIST_RESULT_FAILED;
 820
 821         return (0);
 822
 823 fail2:
 824         EFSYS_PROBE(fail2);
 825 fail1:
 826         EFSYS_PROBE1(fail1, int, rc);
 827
 828         return (rc);
 829 }
 830
 831                         void
 832 siena_phy_bist_stop(
 833         __in            efx_nic_t *enp,
 834         __in            efx_bist_type_t type)
 835 {
 836         /* There is no way to stop BIST on Siena */
 837         _NOTE(ARGUNUSED(enp, type))
 838 }
 839
 840 #endif  /* EFSYS_OPT_BIST */
 841
 842 #endif  /* EFSYS_OPT_SIENA */