drivers/net/sfc/base/efx_port.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         __checkReturn   efx_rc_t
  35 efx_port_init(
  36         __in            efx_nic_t *enp)
  37 {
  38         efx_port_t *epp = &(enp->en_port);
  39         const efx_phy_ops_t *epop = epp->ep_epop;
  40         efx_rc_t rc;
  41
  42         EFSYS_ASSERT3U(enp->en_magic, ==, EFX_NIC_MAGIC);
  43         EFSYS_ASSERT3U(enp->en_mod_flags, &, EFX_MOD_PROBE);
  44         EFSYS_ASSERT3U(enp->en_mod_flags, &, EFX_MOD_NIC);
  45
  46         if (enp->en_mod_flags & EFX_MOD_PORT) {
  47                 rc = EINVAL;
  48                 goto fail1;
  49         }
  50
  51         enp->en_mod_flags |= EFX_MOD_PORT;
  52
  53         epp->ep_mac_type = EFX_MAC_INVALID;
  54         epp->ep_link_mode = EFX_LINK_UNKNOWN;
  55         epp->ep_mac_drain = B_TRUE;
  56
  57         /* Configure the MAC */
  58         if ((rc = efx_mac_select(enp)) != 0)
  59                 goto fail1;
  60
  61         epp->ep_emop->emo_reconfigure(enp);
  62
  63         /* Pick up current phy capababilities */
  64         efx_port_poll(enp, NULL);
  65
  66         /*
  67          * Turn on the PHY if available, otherwise reset it, and
  68          * reconfigure it with the current configuration.
  69          */
  70         if (epop->epo_power != NULL) {
  71                 if ((rc = epop->epo_power(enp, B_TRUE)) != 0)
  72                         goto fail2;
  73         } else {
  74                 if ((rc = epop->epo_reset(enp)) != 0)
  75                         goto fail2;
  76         }
  77
  78         EFSYS_ASSERT(enp->en_reset_flags & EFX_RESET_PHY);
  79         enp->en_reset_flags &= ~EFX_RESET_PHY;
  80
  81         if ((rc = epop->epo_reconfigure(enp)) != 0)
  82                 goto fail3;
  83
  84         return (0);
  85
  86 fail3:
  87         EFSYS_PROBE(fail3);
  88 fail2:
  89         EFSYS_PROBE(fail2);
  90 fail1:
  91         EFSYS_PROBE1(fail1, efx_rc_t, rc);
  92
  93         enp->en_mod_flags &= ~EFX_MOD_PORT;
  94
  95         return (rc);
  96 }
  97
  98         __checkReturn   efx_rc_t
  99 efx_port_poll(
 100         __in            efx_nic_t *enp,
 101         __out_opt       efx_link_mode_t *link_modep)
 102 {
 103         efx_port_t *epp = &(enp->en_port);
 104         const efx_mac_ops_t *emop = epp->ep_emop;
 105         efx_link_mode_t ignore_link_mode;
 106         efx_rc_t rc;
 107
 108         EFSYS_ASSERT3U(enp->en_magic, ==, EFX_NIC_MAGIC);
 109         EFSYS_ASSERT3U(enp->en_mod_flags, &, EFX_MOD_PORT);
 110
 111         EFSYS_ASSERT(emop != NULL);
 112         EFSYS_ASSERT(!epp->ep_mac_stats_pending);
 113
 114         if (link_modep == NULL)
 115                 link_modep = &ignore_link_mode;
 116
 117         if ((rc = emop->emo_poll(enp, link_modep)) != 0)
 118                 goto fail1;
 119
 120         return (0);
 121
 122 fail1:
 123         EFSYS_PROBE1(fail1, efx_rc_t, rc);
 124
 125         return (rc);
 126 }
 127
 128                         void
 129 efx_port_fini(
 130         __in            efx_nic_t *enp)
 131 {
 132         efx_port_t *epp = &(enp->en_port);
 133         const efx_phy_ops_t *epop = epp->ep_epop;
 134
 135         EFSYS_ASSERT3U(enp->en_magic, ==, EFX_NIC_MAGIC);
 136         EFSYS_ASSERT3U(enp->en_mod_flags, &, EFX_MOD_PROBE);
 137         EFSYS_ASSERT3U(enp->en_mod_flags, &, EFX_MOD_NIC);
 138         EFSYS_ASSERT3U(enp->en_mod_flags, &, EFX_MOD_PORT);
 139
 140         EFSYS_ASSERT(epp->ep_mac_drain);
 141
 142         epp->ep_emop = NULL;
 143         epp->ep_mac_type = EFX_MAC_INVALID;
 144         epp->ep_mac_drain = B_FALSE;
 145
 146         /* Turn off the PHY */
 147         if (epop->epo_power != NULL)
 148                 (void) epop->epo_power(enp, B_FALSE);
 149
 150         enp->en_mod_flags &= ~EFX_MOD_PORT;
 151 }