drivers/net/sfc/base/siena_phy.c

   1 /*
   2  * Copyright (c) 2009-2016 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 "efx.h"
  32 #include "efx_impl.h"
  33
  34 #if EFSYS_OPT_SIENA
  35
  36 static                  void
  37 siena_phy_decode_cap(
  38         __in            uint32_t mcdi_cap,
  39         __out           uint32_t *maskp)
  40 {
  41         uint32_t mask;
  42
  43         mask = 0;
  44         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_10HDX_LBN))
  45                 mask |= (1 << EFX_PHY_CAP_10HDX);
  46         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_10FDX_LBN))
  47                 mask |= (1 << EFX_PHY_CAP_10FDX);
  48         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_100HDX_LBN))
  49                 mask |= (1 << EFX_PHY_CAP_100HDX);
  50         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_100FDX_LBN))
  51                 mask |= (1 << EFX_PHY_CAP_100FDX);
  52         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_1000HDX_LBN))
  53                 mask |= (1 << EFX_PHY_CAP_1000HDX);
  54         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_1000FDX_LBN))
  55                 mask |= (1 << EFX_PHY_CAP_1000FDX);
  56         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_10000FDX_LBN))
  57                 mask |= (1 << EFX_PHY_CAP_10000FDX);
  58         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_PAUSE_LBN))
  59                 mask |= (1 << EFX_PHY_CAP_PAUSE);
  60         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_ASYM_LBN))
  61                 mask |= (1 << EFX_PHY_CAP_ASYM);
  62         if (mcdi_cap & (1 << MC_CMD_PHY_CAP_AN_LBN))
  63                 mask |= (1 << EFX_PHY_CAP_AN);
  64
  65         *maskp = mask;
  66 }
  67
  68 static                  void
  69 siena_phy_decode_link_mode(
  70         __in            efx_nic_t *enp,
  71         __in            uint32_t link_flags,
  72         __in            unsigned int speed,
  73         __in            unsigned int fcntl,
  74         __out           efx_link_mode_t *link_modep,
  75         __out           unsigned int *fcntlp)
  76 {
  77         boolean_t fd = !!(link_flags &
  78                     (1 << MC_CMD_GET_LINK_OUT_FULL_DUPLEX_LBN));
  79         boolean_t up = !!(link_flags &
  80                     (1 << MC_CMD_GET_LINK_OUT_LINK_UP_LBN));
  81
  82         _NOTE(ARGUNUSED(enp))
  83
  84         if (!up)
  85                 *link_modep = EFX_LINK_DOWN;
  86         else if (speed == 10000 && fd)
  87                 *link_modep = EFX_LINK_10000FDX;
  88         else if (speed == 1000)
  89                 *link_modep = fd ? EFX_LINK_1000FDX : EFX_LINK_1000HDX;
  90         else if (speed == 100)
  91                 *link_modep = fd ? EFX_LINK_100FDX : EFX_LINK_100HDX;
  92         else if (speed == 10)
  93                 *link_modep = fd ? EFX_LINK_10FDX : EFX_LINK_10HDX;
  94         else
  95                 *link_modep = EFX_LINK_UNKNOWN;
  96
  97         if (fcntl == MC_CMD_FCNTL_OFF)
  98                 *fcntlp = 0;
  99         else if (fcntl == MC_CMD_FCNTL_RESPOND)
 100                 *fcntlp = EFX_FCNTL_RESPOND;
 101         else if (fcntl == MC_CMD_FCNTL_BIDIR)
 102                 *fcntlp = EFX_FCNTL_RESPOND | EFX_FCNTL_GENERATE;
 103         else {
 104                 EFSYS_PROBE1(mc_pcol_error, int, fcntl);
 105                 *fcntlp = 0;
 106         }
 107 }
 108
 109                         void
 110 siena_phy_link_ev(
 111         __in            efx_nic_t *enp,
 112         __in            efx_qword_t *eqp,
 113         __out           efx_link_mode_t *link_modep)
 114 {
 115         efx_port_t *epp = &(enp->en_port);
 116         unsigned int link_flags;
 117         unsigned int speed;
 118         unsigned int fcntl;
 119         efx_link_mode_t link_mode;
 120         uint32_t lp_cap_mask;
 121
 122         /*
 123          * Convert the LINKCHANGE speed enumeration into mbit/s, in the
 124          * same way as GET_LINK encodes the speed
 125          */
 126         switch (MCDI_EV_FIELD(eqp, LINKCHANGE_SPEED)) {
 127         case MCDI_EVENT_LINKCHANGE_SPEED_100M:
 128                 speed = 100;
 129                 break;
 130         case MCDI_EVENT_LINKCHANGE_SPEED_1G:
 131                 speed = 1000;
 132                 break;
 133         case MCDI_EVENT_LINKCHANGE_SPEED_10G:
 134                 speed = 10000;
 135                 break;
 136         default:
 137                 speed = 0;
 138                 break;
 139         }
 140
 141         link_flags = MCDI_EV_FIELD(eqp, LINKCHANGE_LINK_FLAGS);
 142         siena_phy_decode_link_mode(enp, link_flags, speed,
 143                                     MCDI_EV_FIELD(eqp, LINKCHANGE_FCNTL),
 144                                     &link_mode, &fcntl);
 145         siena_phy_decode_cap(MCDI_EV_FIELD(eqp, LINKCHANGE_LP_CAP),
 146                             &lp_cap_mask);
 147
 148         /*
 149          * It's safe to update ep_lp_cap_mask without the driver's port lock
 150          * because presumably any concurrently running efx_port_poll() is
 151          * only going to arrive at the same value.
 152          *
 153          * ep_fcntl has two meanings. It's either the link common fcntl
 154          * (if the PHY supports AN), or it's the forced link state. If
 155          * the former, it's safe to update the value for the same reason as
 156          * for ep_lp_cap_mask. If the latter, then just ignore the value,
 157          * because we can race with efx_mac_fcntl_set().
 158          */
 159         epp->ep_lp_cap_mask = lp_cap_mask;
 160         if (epp->ep_phy_cap_mask & (1 << EFX_PHY_CAP_AN))
 161                 epp->ep_fcntl = fcntl;
 162
 163         *link_modep = link_mode;
 164 }
 165
 166         __checkReturn   efx_rc_t
 167 siena_phy_power(
 168         __in            efx_nic_t *enp,
 169         __in            boolean_t power)
 170 {
 171         efx_rc_t rc;
 172
 173         if (!power)
 174                 return (0);
 175
 176         /* Check if the PHY is a zombie */
 177         if ((rc = siena_phy_verify(enp)) != 0)
 178                 goto fail1;
 179
 180         enp->en_reset_flags |= EFX_RESET_PHY;
 181
 182         return (0);
 183
 184 fail1:
 185         EFSYS_PROBE1(fail1, efx_rc_t, rc);
 186
 187         return (rc);
 188 }
 189
 190         __checkReturn   efx_rc_t
 191 siena_phy_get_link(
 192         __in            efx_nic_t *enp,
 193         __out           siena_link_state_t *slsp)
 194 {
 195         efx_mcdi_req_t req;
 196         uint8_t payload[MAX(MC_CMD_GET_LINK_IN_LEN,
 197                             MC_CMD_GET_LINK_OUT_LEN)];
 198         efx_rc_t rc;
 199
 200         (void) memset(payload, 0, sizeof (payload));
 201         req.emr_cmd = MC_CMD_GET_LINK;
 202         req.emr_in_buf = payload;
 203         req.emr_in_length = MC_CMD_GET_LINK_IN_LEN;
 204         req.emr_out_buf = payload;
 205         req.emr_out_length = MC_CMD_GET_LINK_OUT_LEN;
 206
 207         efx_mcdi_execute(enp, &req);
 208
 209         if (req.emr_rc != 0) {
 210                 rc = req.emr_rc;
 211                 goto fail1;
 212         }
 213
 214         if (req.emr_out_length_used < MC_CMD_GET_LINK_OUT_LEN) {
 215                 rc = EMSGSIZE;
 216                 goto fail2;
 217         }
 218
 219         siena_phy_decode_cap(MCDI_OUT_DWORD(req, GET_LINK_OUT_CAP),
 220                             &slsp->sls_adv_cap_mask);
 221         siena_phy_decode_cap(MCDI_OUT_DWORD(req, GET_LINK_OUT_LP_CAP),
 222                             &slsp->sls_lp_cap_mask);
 223
 224         siena_phy_decode_link_mode(enp, MCDI_OUT_DWORD(req, GET_LINK_OUT_FLAGS),
 225                             MCDI_OUT_DWORD(req, GET_LINK_OUT_LINK_SPEED),
 226                             MCDI_OUT_DWORD(req, GET_LINK_OUT_FCNTL),
 227                             &slsp->sls_link_mode, &slsp->sls_fcntl);
 228
 229         slsp->sls_mac_up = MCDI_OUT_DWORD(req, GET_LINK_OUT_MAC_FAULT) == 0;
 230
 231         return (0);
 232
 233 fail2:
 234         EFSYS_PROBE(fail2);
 235 fail1:
 236         EFSYS_PROBE1(fail1, efx_rc_t, rc);
 237
 238         return (rc);
 239 }
 240
 241         __checkReturn   efx_rc_t
 242 siena_phy_reconfigure(
 243         __in            efx_nic_t *enp)
 244 {
 245         efx_port_t *epp = &(enp->en_port);
 246         efx_mcdi_req_t req;
 247         uint8_t payload[MAX(MAX(MC_CMD_SET_ID_LED_IN_LEN,
 248                                 MC_CMD_SET_ID_LED_OUT_LEN),
 249                             MAX(MC_CMD_SET_LINK_IN_LEN,
 250                                 MC_CMD_SET_LINK_OUT_LEN))];
 251         uint32_t cap_mask;
 252         unsigned int led_mode;
 253         unsigned int speed;
 254         efx_rc_t rc;
 255
 256         (void) memset(payload, 0, sizeof (payload));
 257         req.emr_cmd = MC_CMD_SET_LINK;
 258         req.emr_in_buf = payload;
 259         req.emr_in_length = MC_CMD_SET_LINK_IN_LEN;
 260         req.emr_out_buf = payload;
 261         req.emr_out_length = MC_CMD_SET_LINK_OUT_LEN;
 262
 263         cap_mask = epp->ep_adv_cap_mask;
 264         MCDI_IN_POPULATE_DWORD_10(req, SET_LINK_IN_CAP,
 265                 PHY_CAP_10HDX, (cap_mask >> EFX_PHY_CAP_10HDX) & 0x1,
 266                 PHY_CAP_10FDX, (cap_mask >> EFX_PHY_CAP_10FDX) & 0x1,
 267                 PHY_CAP_100HDX, (cap_mask >> EFX_PHY_CAP_100HDX) & 0x1,
 268                 PHY_CAP_100FDX, (cap_mask >> EFX_PHY_CAP_100FDX) & 0x1,
 269                 PHY_CAP_1000HDX, (cap_mask >> EFX_PHY_CAP_1000HDX) & 0x1,
 270                 PHY_CAP_1000FDX, (cap_mask >> EFX_PHY_CAP_1000FDX) & 0x1,
 271                 PHY_CAP_10000FDX, (cap_mask >> EFX_PHY_CAP_10000FDX) & 0x1,
 272                 PHY_CAP_PAUSE, (cap_mask >> EFX_PHY_CAP_PAUSE) & 0x1,
 273                 PHY_CAP_ASYM, (cap_mask >> EFX_PHY_CAP_ASYM) & 0x1,
 274                 PHY_CAP_AN, (cap_mask >> EFX_PHY_CAP_AN) & 0x1);
 275
 276         MCDI_IN_SET_DWORD(req, SET_LINK_IN_LOOPBACK_MODE, MC_CMD_LOOPBACK_NONE);
 277         speed = 0;
 278         MCDI_IN_SET_DWORD(req, SET_LINK_IN_LOOPBACK_SPEED, speed);
 279
 280 #if EFSYS_OPT_PHY_FLAGS
 281         MCDI_IN_SET_DWORD(req, SET_LINK_IN_FLAGS, epp->ep_phy_flags);
 282 #else
 283         MCDI_IN_SET_DWORD(req, SET_LINK_IN_FLAGS, 0);
 284 #endif  /* EFSYS_OPT_PHY_FLAGS */
 285
 286         efx_mcdi_execute(enp, &req);
 287
 288         if (req.emr_rc != 0) {
 289                 rc = req.emr_rc;
 290                 goto fail1;
 291         }
 292
 293         /* And set the blink mode */
 294         (void) memset(payload, 0, sizeof (payload));
 295         req.emr_cmd = MC_CMD_SET_ID_LED;
 296         req.emr_in_buf = payload;
 297         req.emr_in_length = MC_CMD_SET_ID_LED_IN_LEN;
 298         req.emr_out_buf = payload;
 299         req.emr_out_length = MC_CMD_SET_ID_LED_OUT_LEN;
 300
 301         MCDI_IN_SET_DWORD(req, SET_ID_LED_IN_STATE, MC_CMD_LED_DEFAULT);
 302
 303         efx_mcdi_execute(enp, &req);
 304
 305         if (req.emr_rc != 0) {
 306                 rc = req.emr_rc;
 307                 goto fail2;
 308         }
 309
 310         return (0);
 311
 312 fail2:
 313         EFSYS_PROBE(fail2);
 314 fail1:
 315         EFSYS_PROBE1(fail1, efx_rc_t, rc);
 316
 317         return (rc);
 318 }
 319
 320         __checkReturn   efx_rc_t
 321 siena_phy_verify(
 322         __in            efx_nic_t *enp)
 323 {
 324         efx_mcdi_req_t req;
 325         uint8_t payload[MAX(MC_CMD_GET_PHY_STATE_IN_LEN,
 326                             MC_CMD_GET_PHY_STATE_OUT_LEN)];
 327         uint32_t state;
 328         efx_rc_t rc;
 329
 330         (void) memset(payload, 0, sizeof (payload));
 331         req.emr_cmd = MC_CMD_GET_PHY_STATE;
 332         req.emr_in_buf = payload;
 333         req.emr_in_length = MC_CMD_GET_PHY_STATE_IN_LEN;
 334         req.emr_out_buf = payload;
 335         req.emr_out_length = MC_CMD_GET_PHY_STATE_OUT_LEN;
 336
 337         efx_mcdi_execute(enp, &req);
 338
 339         if (req.emr_rc != 0) {
 340                 rc = req.emr_rc;
 341                 goto fail1;
 342         }
 343
 344         if (req.emr_out_length_used < MC_CMD_GET_PHY_STATE_OUT_LEN) {
 345                 rc = EMSGSIZE;
 346                 goto fail2;
 347         }
 348
 349         state = MCDI_OUT_DWORD(req, GET_PHY_STATE_OUT_STATE);
 350         if (state != MC_CMD_PHY_STATE_OK) {
 351                 if (state != MC_CMD_PHY_STATE_ZOMBIE)
 352                         EFSYS_PROBE1(mc_pcol_error, int, state);
 353                 rc = ENOTACTIVE;
 354                 goto fail3;
 355         }
 356
 357         return (0);
 358
 359 fail3:
 360         EFSYS_PROBE(fail3);
 361 fail2:
 362         EFSYS_PROBE(fail2);
 363 fail1:
 364         EFSYS_PROBE1(fail1, efx_rc_t, rc);
 365
 366         return (rc);
 367 }
 368
 369         __checkReturn   efx_rc_t
 370 siena_phy_oui_get(
 371         __in            efx_nic_t *enp,
 372         __out           uint32_t *ouip)
 373 {
 374         _NOTE(ARGUNUSED(enp, ouip))
 375
 376         return (ENOTSUP);
 377 }
 378
 379 #if EFSYS_OPT_BIST
 380
 381         __checkReturn           efx_rc_t
 382 siena_phy_bist_start(
 383         __in                    efx_nic_t *enp,
 384         __in                    efx_bist_type_t type)
 385 {
 386         efx_rc_t rc;
 387
 388         if ((rc = efx_mcdi_bist_start(enp, type)) != 0)
 389                 goto fail1;
 390
 391         return (0);
 392
 393 fail1:
 394         EFSYS_PROBE1(fail1, efx_rc_t, rc);
 395
 396         return (rc);
 397 }
 398
 399 static  __checkReturn           unsigned long
 400 siena_phy_sft9001_bist_status(
 401         __in                    uint16_t code)
 402 {
 403         switch (code) {
 404         case MC_CMD_POLL_BIST_SFT9001_PAIR_BUSY:
 405                 return (EFX_PHY_CABLE_STATUS_BUSY);
 406         case MC_CMD_POLL_BIST_SFT9001_INTER_PAIR_SHORT:
 407                 return (EFX_PHY_CABLE_STATUS_INTERPAIRSHORT);
 408         case MC_CMD_POLL_BIST_SFT9001_INTRA_PAIR_SHORT:
 409                 return (EFX_PHY_CABLE_STATUS_INTRAPAIRSHORT);
 410         case MC_CMD_POLL_BIST_SFT9001_PAIR_OPEN:
 411                 return (EFX_PHY_CABLE_STATUS_OPEN);
 412         case MC_CMD_POLL_BIST_SFT9001_PAIR_OK:
 413                 return (EFX_PHY_CABLE_STATUS_OK);
 414         default:
 415                 return (EFX_PHY_CABLE_STATUS_INVALID);
 416         }
 417 }
 418
 419         __checkReturn           efx_rc_t
 420 siena_phy_bist_poll(
 421         __in                    efx_nic_t *enp,
 422         __in                    efx_bist_type_t type,
 423         __out                   efx_bist_result_t *resultp,
 424         __out_opt __drv_when(count > 0, __notnull)
 425         uint32_t *value_maskp,
 426         __out_ecount_opt(count) __drv_when(count > 0, __notnull)
 427         unsigned long *valuesp,
 428         __in                    size_t count)
 429 {
 430         efx_nic_cfg_t *encp = &(enp->en_nic_cfg);
 431         uint8_t payload[MAX(MC_CMD_POLL_BIST_IN_LEN,
 432                             MCDI_CTL_SDU_LEN_MAX)];
 433         uint32_t value_mask = 0;
 434         efx_mcdi_req_t req;
 435         uint32_t result;
 436         efx_rc_t rc;
 437
 438         (void) memset(payload, 0, sizeof (payload));
 439         req.emr_cmd = MC_CMD_POLL_BIST;
 440         req.emr_in_buf = payload;
 441         req.emr_in_length = MC_CMD_POLL_BIST_IN_LEN;
 442         req.emr_out_buf = payload;
 443         req.emr_out_length = MCDI_CTL_SDU_LEN_MAX;
 444
 445         efx_mcdi_execute(enp, &req);
 446
 447         if (req.emr_rc != 0) {
 448                 rc = req.emr_rc;
 449                 goto fail1;
 450         }
 451
 452         if (req.emr_out_length_used < MC_CMD_POLL_BIST_OUT_RESULT_OFST + 4) {
 453                 rc = EMSGSIZE;
 454                 goto fail2;
 455         }
 456
 457         if (count > 0)
 458                 (void) memset(valuesp, '\0', count * sizeof (unsigned long));
 459
 460         result = MCDI_OUT_DWORD(req, POLL_BIST_OUT_RESULT);
 461
 462         /* Extract PHY specific results */
 463         if (result == MC_CMD_POLL_BIST_PASSED &&
 464             encp->enc_phy_type == EFX_PHY_SFT9001B &&
 465             req.emr_out_length_used >= MC_CMD_POLL_BIST_OUT_SFT9001_LEN &&
 466             (type == EFX_BIST_TYPE_PHY_CABLE_SHORT ||
 467             type == EFX_BIST_TYPE_PHY_CABLE_LONG)) {
 468                 uint16_t word;
 469
 470                 if (count > EFX_BIST_PHY_CABLE_LENGTH_A) {
 471                         if (valuesp != NULL)
 472                                 valuesp[EFX_BIST_PHY_CABLE_LENGTH_A] =
 473                                     MCDI_OUT_DWORD(req,
 474                                     POLL_BIST_OUT_SFT9001_CABLE_LENGTH_A);
 475                         value_mask |= (1 << EFX_BIST_PHY_CABLE_LENGTH_A);
 476                 }
 477
 478                 if (count > EFX_BIST_PHY_CABLE_LENGTH_B) {
 479                         if (valuesp != NULL)
 480                                 valuesp[EFX_BIST_PHY_CABLE_LENGTH_B] =
 481                                     MCDI_OUT_DWORD(req,
 482                                     POLL_BIST_OUT_SFT9001_CABLE_LENGTH_B);
 483                         value_mask |= (1 << EFX_BIST_PHY_CABLE_LENGTH_B);
 484                 }
 485
 486                 if (count > EFX_BIST_PHY_CABLE_LENGTH_C) {
 487                         if (valuesp != NULL)
 488                                 valuesp[EFX_BIST_PHY_CABLE_LENGTH_C] =
 489                                     MCDI_OUT_DWORD(req,
 490                                     POLL_BIST_OUT_SFT9001_CABLE_LENGTH_C);
 491                         value_mask |= (1 << EFX_BIST_PHY_CABLE_LENGTH_C);
 492                 }
 493
 494                 if (count > EFX_BIST_PHY_CABLE_LENGTH_D) {
 495                         if (valuesp != NULL)
 496                                 valuesp[EFX_BIST_PHY_CABLE_LENGTH_D] =
 497                                     MCDI_OUT_DWORD(req,
 498                                     POLL_BIST_OUT_SFT9001_CABLE_LENGTH_D);
 499                         value_mask |= (1 << EFX_BIST_PHY_CABLE_LENGTH_D);
 500                 }
 501
 502                 if (count > EFX_BIST_PHY_CABLE_STATUS_A) {
 503                         if (valuesp != NULL) {
 504                                 word = MCDI_OUT_WORD(req,
 505                                     POLL_BIST_OUT_SFT9001_CABLE_STATUS_A);
 506                                 valuesp[EFX_BIST_PHY_CABLE_STATUS_A] =
 507                                     siena_phy_sft9001_bist_status(word);
 508                         }
 509                         value_mask |= (1 << EFX_BIST_PHY_CABLE_STATUS_A);
 510                 }
 511
 512                 if (count > EFX_BIST_PHY_CABLE_STATUS_B) {
 513                         if (valuesp != NULL) {
 514                                 word = MCDI_OUT_WORD(req,
 515                                     POLL_BIST_OUT_SFT9001_CABLE_STATUS_B);
 516                                 valuesp[EFX_BIST_PHY_CABLE_STATUS_B] =
 517                                     siena_phy_sft9001_bist_status(word);
 518                         }
 519                         value_mask |= (1 << EFX_BIST_PHY_CABLE_STATUS_B);
 520                 }
 521
 522                 if (count > EFX_BIST_PHY_CABLE_STATUS_C) {
 523                         if (valuesp != NULL) {
 524                                 word = MCDI_OUT_WORD(req,
 525                                     POLL_BIST_OUT_SFT9001_CABLE_STATUS_C);
 526                                 valuesp[EFX_BIST_PHY_CABLE_STATUS_C] =
 527                                     siena_phy_sft9001_bist_status(word);
 528                         }
 529                         value_mask |= (1 << EFX_BIST_PHY_CABLE_STATUS_C);
 530                 }
 531
 532                 if (count > EFX_BIST_PHY_CABLE_STATUS_D) {
 533                         if (valuesp != NULL) {
 534                                 word = MCDI_OUT_WORD(req,
 535                                     POLL_BIST_OUT_SFT9001_CABLE_STATUS_D);
 536                                 valuesp[EFX_BIST_PHY_CABLE_STATUS_D] =
 537                                     siena_phy_sft9001_bist_status(word);
 538                         }
 539                         value_mask |= (1 << EFX_BIST_PHY_CABLE_STATUS_D);
 540                 }
 541
 542         } else if (result == MC_CMD_POLL_BIST_FAILED &&
 543                     encp->enc_phy_type == EFX_PHY_QLX111V &&
 544                     req.emr_out_length >= MC_CMD_POLL_BIST_OUT_MRSFP_LEN &&
 545                     count > EFX_BIST_FAULT_CODE) {
 546                 if (valuesp != NULL)
 547                         valuesp[EFX_BIST_FAULT_CODE] =
 548                             MCDI_OUT_DWORD(req, POLL_BIST_OUT_MRSFP_TEST);
 549                 value_mask |= 1 << EFX_BIST_FAULT_CODE;
 550         }
 551
 552         if (value_maskp != NULL)
 553                 *value_maskp = value_mask;
 554
 555         EFSYS_ASSERT(resultp != NULL);
 556         if (result == MC_CMD_POLL_BIST_RUNNING)
 557                 *resultp = EFX_BIST_RESULT_RUNNING;
 558         else if (result == MC_CMD_POLL_BIST_PASSED)
 559                 *resultp = EFX_BIST_RESULT_PASSED;
 560         else
 561                 *resultp = EFX_BIST_RESULT_FAILED;
 562
 563         return (0);
 564
 565 fail2:
 566         EFSYS_PROBE(fail2);
 567 fail1:
 568         EFSYS_PROBE1(fail1, efx_rc_t, rc);
 569
 570         return (rc);
 571 }
 572
 573                         void
 574 siena_phy_bist_stop(
 575         __in            efx_nic_t *enp,
 576         __in            efx_bist_type_t type)
 577 {
 578         /* There is no way to stop BIST on Siena */
 579         _NOTE(ARGUNUSED(enp, type))
 580 }
 581
 582 #endif  /* EFSYS_OPT_BIST */
 583
 584 #endif  /* EFSYS_OPT_SIENA */