drivers/net/sfc/sfc_port.c

   1 /*-
   2  * Copyright (c) 2016 Solarflare Communications Inc.
   3  * All rights reserved.
   4  *
   5  * This software was jointly developed between OKTET Labs (under contract
   6  * for Solarflare) and Solarflare Communications, Inc.
   7  *
   8  * Redistribution and use in source and binary forms, with or without
   9  * modification, are permitted provided that the following conditions are met:
  10  *
  11  * 1. Redistributions of source code must retain the above copyright notice,
  12  *    this list of conditions and the following disclaimer.
  13  * 2. Redistributions in binary form must reproduce the above copyright notice,
  14  *    this list of conditions and the following disclaimer in the documentation
  15  *    and/or other materials provided with the distribution.
  16  *
  17  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
  18  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
  19  * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
  20  * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR
  21  * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
  22  * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
  23  * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
  24  * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
  25  * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
  26  * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
  27  * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  28  */
  29
  30 #include "efx.h"
  31
  32 #include "sfc.h"
  33 #include "sfc_log.h"
  34
  35 /**
  36  * Update MAC statistics in the buffer.
  37  *
  38  * @param       sa      Adapter
  39  *
  40  * @return Status code
  41  * @retval      0       Success
  42  * @retval      EAGAIN  Try again
  43  * @retval      ENOMEM  Memory allocation failure
  44  */
  45 int
  46 sfc_port_update_mac_stats(struct sfc_adapter *sa)
  47 {
  48         struct sfc_port *port = &sa->port;
  49         int rc;
  50
  51         SFC_ASSERT(rte_spinlock_is_locked(&port->mac_stats_lock));
  52
  53         if (sa->state != SFC_ADAPTER_STARTED)
  54                 return EINVAL;
  55
  56         rc = efx_mac_stats_update(sa->nic, &port->mac_stats_dma_mem,
  57                                   port->mac_stats_buf, NULL);
  58         if (rc != 0)
  59                 return rc;
  60
  61         return 0;
  62 }
  63
  64 static int
  65 sfc_port_init_dev_link(struct sfc_adapter *sa)
  66 {
  67         struct rte_eth_link *dev_link = &sa->eth_dev->data->dev_link;
  68         int rc;
  69         efx_link_mode_t link_mode;
  70         struct rte_eth_link current_link;
  71
  72         rc = efx_port_poll(sa->nic, &link_mode);
  73         if (rc != 0)
  74                 return rc;
  75
  76         sfc_port_link_mode_to_info(link_mode, &current_link);
  77
  78         EFX_STATIC_ASSERT(sizeof(*dev_link) == sizeof(rte_atomic64_t));
  79         rte_atomic64_set((rte_atomic64_t *)dev_link,
  80                          *(uint64_t *)&current_link);
  81
  82         return 0;
  83 }
  84
  85 int
  86 sfc_port_start(struct sfc_adapter *sa)
  87 {
  88         struct sfc_port *port = &sa->port;
  89         int rc;
  90
  91         sfc_log_init(sa, "entry");
  92
  93         sfc_log_init(sa, "init filters");
  94         rc = efx_filter_init(sa->nic);
  95         if (rc != 0)
  96                 goto fail_filter_init;
  97
  98         sfc_log_init(sa, "init port");
  99         rc = efx_port_init(sa->nic);
 100         if (rc != 0)
 101                 goto fail_port_init;
 102
 103         sfc_log_init(sa, "set flow control to %#x autoneg=%u",
 104                      port->flow_ctrl, port->flow_ctrl_autoneg);
 105         rc = efx_mac_fcntl_set(sa->nic, port->flow_ctrl,
 106                                port->flow_ctrl_autoneg);
 107         if (rc != 0)
 108                 goto fail_mac_fcntl_set;
 109
 110         sfc_log_init(sa, "set phy adv caps to %#x", port->phy_adv_cap);
 111         rc = efx_phy_adv_cap_set(sa->nic, port->phy_adv_cap);
 112         if (rc != 0)
 113                 goto fail_phy_adv_cap_set;
 114
 115         sfc_log_init(sa, "set MAC PDU %u", (unsigned int)port->pdu);
 116         rc = efx_mac_pdu_set(sa->nic, port->pdu);
 117         if (rc != 0)
 118                 goto fail_mac_pdu_set;
 119
 120         sfc_log_init(sa, "set MAC address");
 121         rc = efx_mac_addr_set(sa->nic,
 122                               sa->eth_dev->data->mac_addrs[0].addr_bytes);
 123         if (rc != 0)
 124                 goto fail_mac_addr_set;
 125
 126         sfc_log_init(sa, "set MAC filters");
 127         port->promisc = (sa->eth_dev->data->promiscuous != 0) ?
 128                         B_TRUE : B_FALSE;
 129         port->allmulti = (sa->eth_dev->data->all_multicast != 0) ?
 130                          B_TRUE : B_FALSE;
 131         rc = sfc_set_rx_mode(sa);
 132         if (rc != 0)
 133                 goto fail_mac_filter_set;
 134
 135         efx_mac_stats_get_mask(sa->nic, port->mac_stats_mask,
 136                                sizeof(port->mac_stats_mask));
 137
 138         /* Update MAC stats using periodic DMA.
 139          * Common code always uses 1000ms update period, so period_ms
 140          * parameter only needs to be non-zero to start updates.
 141          */
 142         sfc_log_init(sa, "request MAC stats DMA'ing");
 143         rc = efx_mac_stats_periodic(sa->nic, &port->mac_stats_dma_mem,
 144                                     1000, B_FALSE);
 145         if (rc != 0)
 146                 goto fail_mac_stats_periodic;
 147
 148         sfc_log_init(sa, "disable MAC drain");
 149         rc = efx_mac_drain(sa->nic, B_FALSE);
 150         if (rc != 0)
 151                 goto fail_mac_drain;
 152
 153         /* Synchronize link status knowledge */
 154         rc = sfc_port_init_dev_link(sa);
 155         if (rc != 0)
 156                 goto fail_port_init_dev_link;
 157
 158         sfc_log_init(sa, "done");
 159         return 0;
 160
 161 fail_port_init_dev_link:
 162         (void)efx_mac_drain(sa->nic, B_TRUE);
 163
 164 fail_mac_drain:
 165         (void)efx_mac_stats_periodic(sa->nic, &port->mac_stats_dma_mem,
 166                                      0, B_FALSE);
 167
 168 fail_mac_stats_periodic:
 169 fail_mac_filter_set:
 170 fail_mac_addr_set:
 171 fail_mac_pdu_set:
 172 fail_phy_adv_cap_set:
 173 fail_mac_fcntl_set:
 174         efx_port_fini(sa->nic);
 175
 176 fail_port_init:
 177         efx_filter_fini(sa->nic);
 178
 179 fail_filter_init:
 180         sfc_log_init(sa, "failed %d", rc);
 181         return rc;
 182 }
 183
 184 void
 185 sfc_port_stop(struct sfc_adapter *sa)
 186 {
 187         sfc_log_init(sa, "entry");
 188
 189         efx_mac_drain(sa->nic, B_TRUE);
 190
 191         (void)efx_mac_stats_periodic(sa->nic, &sa->port.mac_stats_dma_mem,
 192                                      0, B_FALSE);
 193
 194         efx_port_fini(sa->nic);
 195         efx_filter_fini(sa->nic);
 196
 197         sfc_log_init(sa, "done");
 198 }
 199
 200 int
 201 sfc_port_init(struct sfc_adapter *sa)
 202 {
 203         const struct rte_eth_dev_data *dev_data = sa->eth_dev->data;
 204         struct sfc_port *port = &sa->port;
 205         int rc;
 206
 207         sfc_log_init(sa, "entry");
 208
 209         /* Enable flow control by default */
 210         port->flow_ctrl = EFX_FCNTL_RESPOND | EFX_FCNTL_GENERATE;
 211         port->flow_ctrl_autoneg = B_TRUE;
 212
 213         if (dev_data->dev_conf.rxmode.jumbo_frame)
 214                 port->pdu = dev_data->dev_conf.rxmode.max_rx_pkt_len;
 215         else
 216                 port->pdu = EFX_MAC_PDU(dev_data->mtu);
 217
 218         rte_spinlock_init(&port->mac_stats_lock);
 219
 220         rc = ENOMEM;
 221         port->mac_stats_buf = rte_calloc_socket("mac_stats_buf", EFX_MAC_NSTATS,
 222                                                 sizeof(uint64_t), 0,
 223                                                 sa->socket_id);
 224         if (port->mac_stats_buf == NULL)
 225                 goto fail_mac_stats_buf_alloc;
 226
 227         rc = sfc_dma_alloc(sa, "mac_stats", 0, EFX_MAC_STATS_SIZE,
 228                            sa->socket_id, &port->mac_stats_dma_mem);
 229         if (rc != 0)
 230                 goto fail_mac_stats_dma_alloc;
 231
 232         sfc_log_init(sa, "done");
 233         return 0;
 234
 235 fail_mac_stats_dma_alloc:
 236         rte_free(port->mac_stats_buf);
 237 fail_mac_stats_buf_alloc:
 238         sfc_log_init(sa, "failed %d", rc);
 239         return rc;
 240 }
 241
 242 void
 243 sfc_port_fini(struct sfc_adapter *sa)
 244 {
 245         struct sfc_port *port = &sa->port;
 246
 247         sfc_log_init(sa, "entry");
 248
 249         sfc_dma_free(sa, &port->mac_stats_dma_mem);
 250         rte_free(port->mac_stats_buf);
 251
 252         sfc_log_init(sa, "done");
 253 }
 254
 255 int
 256 sfc_set_rx_mode(struct sfc_adapter *sa)
 257 {
 258         struct sfc_port *port = &sa->port;
 259         int rc;
 260
 261         rc = efx_mac_filter_set(sa->nic, port->promisc, B_TRUE,
 262                                 port->promisc || port->allmulti, B_TRUE);
 263
 264         return rc;
 265 }
 266
 267 void
 268 sfc_port_link_mode_to_info(efx_link_mode_t link_mode,
 269                            struct rte_eth_link *link_info)
 270 {
 271         SFC_ASSERT(link_mode < EFX_LINK_NMODES);
 272
 273         memset(link_info, 0, sizeof(*link_info));
 274         if ((link_mode == EFX_LINK_DOWN) || (link_mode == EFX_LINK_UNKNOWN))
 275                 link_info->link_status = ETH_LINK_DOWN;
 276         else
 277                 link_info->link_status = ETH_LINK_UP;
 278
 279         switch (link_mode) {
 280         case EFX_LINK_10HDX:
 281                 link_info->link_speed  = ETH_SPEED_NUM_10M;
 282                 link_info->link_duplex = ETH_LINK_HALF_DUPLEX;
 283                 break;
 284         case EFX_LINK_10FDX:
 285                 link_info->link_speed  = ETH_SPEED_NUM_10M;
 286                 link_info->link_duplex = ETH_LINK_FULL_DUPLEX;
 287                 break;
 288         case EFX_LINK_100HDX:
 289                 link_info->link_speed  = ETH_SPEED_NUM_100M;
 290                 link_info->link_duplex = ETH_LINK_HALF_DUPLEX;
 291                 break;
 292         case EFX_LINK_100FDX:
 293                 link_info->link_speed  = ETH_SPEED_NUM_100M;
 294                 link_info->link_duplex = ETH_LINK_FULL_DUPLEX;
 295                 break;
 296         case EFX_LINK_1000HDX:
 297                 link_info->link_speed  = ETH_SPEED_NUM_1G;
 298                 link_info->link_duplex = ETH_LINK_HALF_DUPLEX;
 299                 break;
 300         case EFX_LINK_1000FDX:
 301                 link_info->link_speed  = ETH_SPEED_NUM_1G;
 302                 link_info->link_duplex = ETH_LINK_FULL_DUPLEX;
 303                 break;
 304         case EFX_LINK_10000FDX:
 305                 link_info->link_speed  = ETH_SPEED_NUM_10G;
 306                 link_info->link_duplex = ETH_LINK_FULL_DUPLEX;
 307                 break;
 308         case EFX_LINK_40000FDX:
 309                 link_info->link_speed  = ETH_SPEED_NUM_40G;
 310                 link_info->link_duplex = ETH_LINK_FULL_DUPLEX;
 311                 break;
 312         default:
 313                 SFC_ASSERT(B_FALSE);
 314                 /* FALLTHROUGH */
 315         case EFX_LINK_UNKNOWN:
 316         case EFX_LINK_DOWN:
 317                 link_info->link_speed  = ETH_SPEED_NUM_NONE;
 318                 link_info->link_duplex = 0;
 319                 break;
 320         }
 321
 322         link_info->link_autoneg = ETH_LINK_AUTONEG;
 323 }