linux/drivers/net/ethernet/broadcom/bnxt/bnxt_ulp.c
<<
>>
Prefs
   1/* Broadcom NetXtreme-C/E network driver.
   2 *
   3 * Copyright (c) 2016-2018 Broadcom Limited
   4 *
   5 * This program is free software; you can redistribute it and/or modify
   6 * it under the terms of the GNU General Public License as published by
   7 * the Free Software Foundation.
   8 */
   9
  10#include <linux/module.h>
  11
  12#include <linux/kernel.h>
  13#include <linux/errno.h>
  14#include <linux/interrupt.h>
  15#include <linux/pci.h>
  16#include <linux/netdevice.h>
  17#include <linux/rtnetlink.h>
  18#include <linux/bitops.h>
  19#include <linux/irq.h>
  20#include <asm/byteorder.h>
  21#include <linux/bitmap.h>
  22
  23#include "bnxt_hsi.h"
  24#include "bnxt.h"
  25#include "bnxt_ulp.h"
  26
  27static int bnxt_register_dev(struct bnxt_en_dev *edev, int ulp_id,
  28                             struct bnxt_ulp_ops *ulp_ops, void *handle)
  29{
  30        struct net_device *dev = edev->net;
  31        struct bnxt *bp = netdev_priv(dev);
  32        struct bnxt_ulp *ulp;
  33
  34        ASSERT_RTNL();
  35        if (ulp_id >= BNXT_MAX_ULP)
  36                return -EINVAL;
  37
  38        ulp = &edev->ulp_tbl[ulp_id];
  39        if (rcu_access_pointer(ulp->ulp_ops)) {
  40                netdev_err(bp->dev, "ulp id %d already registered\n", ulp_id);
  41                return -EBUSY;
  42        }
  43        if (ulp_id == BNXT_ROCE_ULP) {
  44                unsigned int max_stat_ctxs;
  45
  46                max_stat_ctxs = bnxt_get_max_func_stat_ctxs(bp);
  47                if (max_stat_ctxs <= BNXT_MIN_ROCE_STAT_CTXS ||
  48                    bp->num_stat_ctxs == max_stat_ctxs)
  49                        return -ENOMEM;
  50                bnxt_set_max_func_stat_ctxs(bp, max_stat_ctxs -
  51                                            BNXT_MIN_ROCE_STAT_CTXS);
  52        }
  53
  54        atomic_set(&ulp->ref_count, 0);
  55        ulp->handle = handle;
  56        rcu_assign_pointer(ulp->ulp_ops, ulp_ops);
  57
  58        if (ulp_id == BNXT_ROCE_ULP) {
  59                if (test_bit(BNXT_STATE_OPEN, &bp->state))
  60                        bnxt_hwrm_vnic_cfg(bp, 0);
  61        }
  62
  63        return 0;
  64}
  65
  66static int bnxt_unregister_dev(struct bnxt_en_dev *edev, int ulp_id)
  67{
  68        struct net_device *dev = edev->net;
  69        struct bnxt *bp = netdev_priv(dev);
  70        struct bnxt_ulp *ulp;
  71        int i = 0;
  72
  73        ASSERT_RTNL();
  74        if (ulp_id >= BNXT_MAX_ULP)
  75                return -EINVAL;
  76
  77        ulp = &edev->ulp_tbl[ulp_id];
  78        if (!rcu_access_pointer(ulp->ulp_ops)) {
  79                netdev_err(bp->dev, "ulp id %d not registered\n", ulp_id);
  80                return -EINVAL;
  81        }
  82        if (ulp_id == BNXT_ROCE_ULP) {
  83                unsigned int max_stat_ctxs;
  84
  85                max_stat_ctxs = bnxt_get_max_func_stat_ctxs(bp);
  86                bnxt_set_max_func_stat_ctxs(bp, max_stat_ctxs + 1);
  87                if (ulp->msix_requested)
  88                        edev->en_ops->bnxt_free_msix(edev, ulp_id);
  89        }
  90        if (ulp->max_async_event_id)
  91                bnxt_hwrm_func_rgtr_async_events(bp, NULL, 0);
  92
  93        RCU_INIT_POINTER(ulp->ulp_ops, NULL);
  94        synchronize_rcu();
  95        ulp->max_async_event_id = 0;
  96        ulp->async_events_bmap = NULL;
  97        while (atomic_read(&ulp->ref_count) != 0 && i < 10) {
  98                msleep(100);
  99                i++;
 100        }
 101        return 0;
 102}
 103
 104static void bnxt_fill_msix_vecs(struct bnxt *bp, struct bnxt_msix_entry *ent)
 105{
 106        struct bnxt_en_dev *edev = bp->edev;
 107        int num_msix, idx, i;
 108
 109        num_msix = edev->ulp_tbl[BNXT_ROCE_ULP].msix_requested;
 110        idx = edev->ulp_tbl[BNXT_ROCE_ULP].msix_base;
 111        for (i = 0; i < num_msix; i++) {
 112                ent[i].vector = bp->irq_tbl[idx + i].vector;
 113                ent[i].ring_idx = idx + i;
 114                ent[i].db_offset = (idx + i) * 0x80;
 115        }
 116}
 117
 118static int bnxt_req_msix_vecs(struct bnxt_en_dev *edev, int ulp_id,
 119                              struct bnxt_msix_entry *ent, int num_msix)
 120{
 121        struct net_device *dev = edev->net;
 122        struct bnxt *bp = netdev_priv(dev);
 123        int max_idx, max_cp_rings;
 124        int avail_msix, idx;
 125        int rc = 0;
 126
 127        ASSERT_RTNL();
 128        if (ulp_id != BNXT_ROCE_ULP)
 129                return -EINVAL;
 130
 131        if (!(bp->flags & BNXT_FLAG_USING_MSIX))
 132                return -ENODEV;
 133
 134        if (edev->ulp_tbl[ulp_id].msix_requested)
 135                return -EAGAIN;
 136
 137        max_cp_rings = bnxt_get_max_func_cp_rings(bp);
 138        avail_msix = bnxt_get_avail_msix(bp, num_msix);
 139        if (!avail_msix)
 140                return -ENOMEM;
 141        if (avail_msix > num_msix)
 142                avail_msix = num_msix;
 143
 144        if (bp->flags & BNXT_FLAG_NEW_RM) {
 145                idx = bp->cp_nr_rings;
 146        } else {
 147                max_idx = min_t(int, bp->total_irqs, max_cp_rings);
 148                idx = max_idx - avail_msix;
 149        }
 150        edev->ulp_tbl[ulp_id].msix_base = idx;
 151        edev->ulp_tbl[ulp_id].msix_requested = avail_msix;
 152        if (bp->total_irqs < (idx + avail_msix)) {
 153                if (netif_running(dev)) {
 154                        bnxt_close_nic(bp, true, false);
 155                        rc = bnxt_open_nic(bp, true, false);
 156                } else {
 157                        rc = bnxt_reserve_rings(bp);
 158                }
 159        }
 160        if (rc) {
 161                edev->ulp_tbl[ulp_id].msix_requested = 0;
 162                return -EAGAIN;
 163        }
 164
 165        if (bp->flags & BNXT_FLAG_NEW_RM) {
 166                struct bnxt_hw_resc *hw_resc = &bp->hw_resc;
 167
 168                avail_msix = hw_resc->resv_cp_rings - bp->cp_nr_rings;
 169                edev->ulp_tbl[ulp_id].msix_requested = avail_msix;
 170        }
 171        bnxt_fill_msix_vecs(bp, ent);
 172        bnxt_set_max_func_irqs(bp, bnxt_get_max_func_irqs(bp) - avail_msix);
 173        bnxt_set_max_func_cp_rings(bp, max_cp_rings - avail_msix);
 174        edev->flags |= BNXT_EN_FLAG_MSIX_REQUESTED;
 175        return avail_msix;
 176}
 177
 178static int bnxt_free_msix_vecs(struct bnxt_en_dev *edev, int ulp_id)
 179{
 180        struct net_device *dev = edev->net;
 181        struct bnxt *bp = netdev_priv(dev);
 182        int max_cp_rings, msix_requested;
 183
 184        ASSERT_RTNL();
 185        if (ulp_id != BNXT_ROCE_ULP)
 186                return -EINVAL;
 187
 188        if (!(edev->flags & BNXT_EN_FLAG_MSIX_REQUESTED))
 189                return 0;
 190
 191        max_cp_rings = bnxt_get_max_func_cp_rings(bp);
 192        msix_requested = edev->ulp_tbl[ulp_id].msix_requested;
 193        bnxt_set_max_func_cp_rings(bp, max_cp_rings + msix_requested);
 194        edev->ulp_tbl[ulp_id].msix_requested = 0;
 195        bnxt_set_max_func_irqs(bp, bnxt_get_max_func_irqs(bp) + msix_requested);
 196        edev->flags &= ~BNXT_EN_FLAG_MSIX_REQUESTED;
 197        if (netif_running(dev)) {
 198                bnxt_close_nic(bp, true, false);
 199                bnxt_open_nic(bp, true, false);
 200        }
 201        return 0;
 202}
 203
 204int bnxt_get_ulp_msix_num(struct bnxt *bp)
 205{
 206        if (bnxt_ulp_registered(bp->edev, BNXT_ROCE_ULP)) {
 207                struct bnxt_en_dev *edev = bp->edev;
 208
 209                return edev->ulp_tbl[BNXT_ROCE_ULP].msix_requested;
 210        }
 211        return 0;
 212}
 213
 214int bnxt_get_ulp_msix_base(struct bnxt *bp)
 215{
 216        if (bnxt_ulp_registered(bp->edev, BNXT_ROCE_ULP)) {
 217                struct bnxt_en_dev *edev = bp->edev;
 218
 219                if (edev->ulp_tbl[BNXT_ROCE_ULP].msix_requested)
 220                        return edev->ulp_tbl[BNXT_ROCE_ULP].msix_base;
 221        }
 222        return 0;
 223}
 224
 225void bnxt_subtract_ulp_resources(struct bnxt *bp, int ulp_id)
 226{
 227        ASSERT_RTNL();
 228        if (bnxt_ulp_registered(bp->edev, ulp_id)) {
 229                struct bnxt_en_dev *edev = bp->edev;
 230                unsigned int msix_req, max;
 231
 232                msix_req = edev->ulp_tbl[ulp_id].msix_requested;
 233                max = bnxt_get_max_func_cp_rings(bp);
 234                bnxt_set_max_func_cp_rings(bp, max - msix_req);
 235                max = bnxt_get_max_func_stat_ctxs(bp);
 236                bnxt_set_max_func_stat_ctxs(bp, max - 1);
 237        }
 238}
 239
 240static int bnxt_send_msg(struct bnxt_en_dev *edev, int ulp_id,
 241                         struct bnxt_fw_msg *fw_msg)
 242{
 243        struct net_device *dev = edev->net;
 244        struct bnxt *bp = netdev_priv(dev);
 245        struct input *req;
 246        int rc;
 247
 248        mutex_lock(&bp->hwrm_cmd_lock);
 249        req = fw_msg->msg;
 250        req->resp_addr = cpu_to_le64(bp->hwrm_cmd_resp_dma_addr);
 251        rc = _hwrm_send_message(bp, fw_msg->msg, fw_msg->msg_len,
 252                                fw_msg->timeout);
 253        if (!rc) {
 254                struct output *resp = bp->hwrm_cmd_resp_addr;
 255                u32 len = le16_to_cpu(resp->resp_len);
 256
 257                if (fw_msg->resp_max_len < len)
 258                        len = fw_msg->resp_max_len;
 259
 260                memcpy(fw_msg->resp, resp, len);
 261        }
 262        mutex_unlock(&bp->hwrm_cmd_lock);
 263        return rc;
 264}
 265
 266static void bnxt_ulp_get(struct bnxt_ulp *ulp)
 267{
 268        atomic_inc(&ulp->ref_count);
 269}
 270
 271static void bnxt_ulp_put(struct bnxt_ulp *ulp)
 272{
 273        atomic_dec(&ulp->ref_count);
 274}
 275
 276void bnxt_ulp_stop(struct bnxt *bp)
 277{
 278        struct bnxt_en_dev *edev = bp->edev;
 279        struct bnxt_ulp_ops *ops;
 280        int i;
 281
 282        if (!edev)
 283                return;
 284
 285        for (i = 0; i < BNXT_MAX_ULP; i++) {
 286                struct bnxt_ulp *ulp = &edev->ulp_tbl[i];
 287
 288                ops = rtnl_dereference(ulp->ulp_ops);
 289                if (!ops || !ops->ulp_stop)
 290                        continue;
 291                ops->ulp_stop(ulp->handle);
 292        }
 293}
 294
 295void bnxt_ulp_start(struct bnxt *bp)
 296{
 297        struct bnxt_en_dev *edev = bp->edev;
 298        struct bnxt_ulp_ops *ops;
 299        int i;
 300
 301        if (!edev)
 302                return;
 303
 304        for (i = 0; i < BNXT_MAX_ULP; i++) {
 305                struct bnxt_ulp *ulp = &edev->ulp_tbl[i];
 306
 307                ops = rtnl_dereference(ulp->ulp_ops);
 308                if (!ops || !ops->ulp_start)
 309                        continue;
 310                ops->ulp_start(ulp->handle);
 311        }
 312}
 313
 314void bnxt_ulp_sriov_cfg(struct bnxt *bp, int num_vfs)
 315{
 316        struct bnxt_en_dev *edev = bp->edev;
 317        struct bnxt_ulp_ops *ops;
 318        int i;
 319
 320        if (!edev)
 321                return;
 322
 323        for (i = 0; i < BNXT_MAX_ULP; i++) {
 324                struct bnxt_ulp *ulp = &edev->ulp_tbl[i];
 325
 326                rcu_read_lock();
 327                ops = rcu_dereference(ulp->ulp_ops);
 328                if (!ops || !ops->ulp_sriov_config) {
 329                        rcu_read_unlock();
 330                        continue;
 331                }
 332                bnxt_ulp_get(ulp);
 333                rcu_read_unlock();
 334                ops->ulp_sriov_config(ulp->handle, num_vfs);
 335                bnxt_ulp_put(ulp);
 336        }
 337}
 338
 339void bnxt_ulp_shutdown(struct bnxt *bp)
 340{
 341        struct bnxt_en_dev *edev = bp->edev;
 342        struct bnxt_ulp_ops *ops;
 343        int i;
 344
 345        if (!edev)
 346                return;
 347
 348        for (i = 0; i < BNXT_MAX_ULP; i++) {
 349                struct bnxt_ulp *ulp = &edev->ulp_tbl[i];
 350
 351                ops = rtnl_dereference(ulp->ulp_ops);
 352                if (!ops || !ops->ulp_shutdown)
 353                        continue;
 354                ops->ulp_shutdown(ulp->handle);
 355        }
 356}
 357
 358void bnxt_ulp_irq_stop(struct bnxt *bp)
 359{
 360        struct bnxt_en_dev *edev = bp->edev;
 361        struct bnxt_ulp_ops *ops;
 362
 363        if (!edev || !(edev->flags & BNXT_EN_FLAG_MSIX_REQUESTED))
 364                return;
 365
 366        if (bnxt_ulp_registered(bp->edev, BNXT_ROCE_ULP)) {
 367                struct bnxt_ulp *ulp = &edev->ulp_tbl[BNXT_ROCE_ULP];
 368
 369                if (!ulp->msix_requested)
 370                        return;
 371
 372                ops = rtnl_dereference(ulp->ulp_ops);
 373                if (!ops || !ops->ulp_irq_stop)
 374                        return;
 375                ops->ulp_irq_stop(ulp->handle);
 376        }
 377}
 378
 379void bnxt_ulp_irq_restart(struct bnxt *bp, int err)
 380{
 381        struct bnxt_en_dev *edev = bp->edev;
 382        struct bnxt_ulp_ops *ops;
 383
 384        if (!edev || !(edev->flags & BNXT_EN_FLAG_MSIX_REQUESTED))
 385                return;
 386
 387        if (bnxt_ulp_registered(bp->edev, BNXT_ROCE_ULP)) {
 388                struct bnxt_ulp *ulp = &edev->ulp_tbl[BNXT_ROCE_ULP];
 389                struct bnxt_msix_entry *ent = NULL;
 390
 391                if (!ulp->msix_requested)
 392                        return;
 393
 394                ops = rtnl_dereference(ulp->ulp_ops);
 395                if (!ops || !ops->ulp_irq_restart)
 396                        return;
 397
 398                if (!err) {
 399                        ent = kcalloc(ulp->msix_requested, sizeof(*ent),
 400                                      GFP_KERNEL);
 401                        if (!ent)
 402                                return;
 403                        bnxt_fill_msix_vecs(bp, ent);
 404                }
 405                ops->ulp_irq_restart(ulp->handle, ent);
 406                kfree(ent);
 407        }
 408}
 409
 410void bnxt_ulp_async_events(struct bnxt *bp, struct hwrm_async_event_cmpl *cmpl)
 411{
 412        u16 event_id = le16_to_cpu(cmpl->event_id);
 413        struct bnxt_en_dev *edev = bp->edev;
 414        struct bnxt_ulp_ops *ops;
 415        int i;
 416
 417        if (!edev)
 418                return;
 419
 420        rcu_read_lock();
 421        for (i = 0; i < BNXT_MAX_ULP; i++) {
 422                struct bnxt_ulp *ulp = &edev->ulp_tbl[i];
 423
 424                ops = rcu_dereference(ulp->ulp_ops);
 425                if (!ops || !ops->ulp_async_notifier)
 426                        continue;
 427                if (!ulp->async_events_bmap ||
 428                    event_id > ulp->max_async_event_id)
 429                        continue;
 430
 431                /* Read max_async_event_id first before testing the bitmap. */
 432                smp_rmb();
 433                if (test_bit(event_id, ulp->async_events_bmap))
 434                        ops->ulp_async_notifier(ulp->handle, cmpl);
 435        }
 436        rcu_read_unlock();
 437}
 438
 439static int bnxt_register_async_events(struct bnxt_en_dev *edev, int ulp_id,
 440                                      unsigned long *events_bmap, u16 max_id)
 441{
 442        struct net_device *dev = edev->net;
 443        struct bnxt *bp = netdev_priv(dev);
 444        struct bnxt_ulp *ulp;
 445
 446        if (ulp_id >= BNXT_MAX_ULP)
 447                return -EINVAL;
 448
 449        ulp = &edev->ulp_tbl[ulp_id];
 450        ulp->async_events_bmap = events_bmap;
 451        /* Make sure bnxt_ulp_async_events() sees this order */
 452        smp_wmb();
 453        ulp->max_async_event_id = max_id;
 454        bnxt_hwrm_func_rgtr_async_events(bp, events_bmap, max_id + 1);
 455        return 0;
 456}
 457
 458static const struct bnxt_en_ops bnxt_en_ops_tbl = {
 459        .bnxt_register_device   = bnxt_register_dev,
 460        .bnxt_unregister_device = bnxt_unregister_dev,
 461        .bnxt_request_msix      = bnxt_req_msix_vecs,
 462        .bnxt_free_msix         = bnxt_free_msix_vecs,
 463        .bnxt_send_fw_msg       = bnxt_send_msg,
 464        .bnxt_register_fw_async_events  = bnxt_register_async_events,
 465};
 466
 467struct bnxt_en_dev *bnxt_ulp_probe(struct net_device *dev)
 468{
 469        struct bnxt *bp = netdev_priv(dev);
 470        struct bnxt_en_dev *edev;
 471
 472        edev = bp->edev;
 473        if (!edev) {
 474                edev = kzalloc(sizeof(*edev), GFP_KERNEL);
 475                if (!edev)
 476                        return ERR_PTR(-ENOMEM);
 477                edev->en_ops = &bnxt_en_ops_tbl;
 478                if (bp->flags & BNXT_FLAG_ROCEV1_CAP)
 479                        edev->flags |= BNXT_EN_FLAG_ROCEV1_CAP;
 480                if (bp->flags & BNXT_FLAG_ROCEV2_CAP)
 481                        edev->flags |= BNXT_EN_FLAG_ROCEV2_CAP;
 482                edev->net = dev;
 483                edev->pdev = bp->pdev;
 484                bp->edev = edev;
 485        }
 486        return bp->edev;
 487}
 488