linux/drivers/net/ethernet/mellanox/mlx5/core/fs_counters.c
<<
>>
Prefs
   1/*
   2 * Copyright (c) 2016, Mellanox Technologies. All rights reserved.
   3 *
   4 * This software is available to you under a choice of one of two
   5 * licenses.  You may choose to be licensed under the terms of the GNU
   6 * General Public License (GPL) Version 2, available from the file
   7 * COPYING in the main directory of this source tree, or the
   8 * OpenIB.org BSD license below:
   9 *
  10 *     Redistribution and use in source and binary forms, with or
  11 *     without modification, are permitted provided that the following
  12 *     conditions are met:
  13 *
  14 *      - Redistributions of source code must retain the above
  15 *        copyright notice, this list of conditions and the following
  16 *        disclaimer.
  17 *
  18 *      - Redistributions in binary form must reproduce the above
  19 *        copyright notice, this list of conditions and the following
  20 *        disclaimer in the documentation and/or other materials
  21 *        provided with the distribution.
  22 *
  23 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
  24 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
  25 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
  26 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
  27 * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
  28 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
  29 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
  30 * SOFTWARE.
  31 */
  32
  33#include <linux/mlx5/driver.h>
  34#include <linux/mlx5/fs.h>
  35#include <linux/rbtree.h>
  36#include "mlx5_core.h"
  37#include "fs_core.h"
  38#include "fs_cmd.h"
  39
  40#define MLX5_FC_STATS_PERIOD msecs_to_jiffies(1000)
  41/* Max number of counters to query in bulk read is 32K */
  42#define MLX5_SW_MAX_COUNTERS_BULK BIT(15)
  43#define MLX5_FC_POOL_MAX_THRESHOLD BIT(18)
  44#define MLX5_FC_POOL_USED_BUFF_RATIO 10
  45
  46struct mlx5_fc_cache {
  47        u64 packets;
  48        u64 bytes;
  49        u64 lastuse;
  50};
  51
  52struct mlx5_fc {
  53        struct list_head list;
  54        struct llist_node addlist;
  55        struct llist_node dellist;
  56
  57        /* last{packets,bytes} members are used when calculating the delta since
  58         * last reading
  59         */
  60        u64 lastpackets;
  61        u64 lastbytes;
  62
  63        struct mlx5_fc_bulk *bulk;
  64        u32 id;
  65        bool aging;
  66
  67        struct mlx5_fc_cache cache ____cacheline_aligned_in_smp;
  68};
  69
  70static void mlx5_fc_pool_init(struct mlx5_fc_pool *fc_pool, struct mlx5_core_dev *dev);
  71static void mlx5_fc_pool_cleanup(struct mlx5_fc_pool *fc_pool);
  72static struct mlx5_fc *mlx5_fc_pool_acquire_counter(struct mlx5_fc_pool *fc_pool);
  73static void mlx5_fc_pool_release_counter(struct mlx5_fc_pool *fc_pool, struct mlx5_fc *fc);
  74
  75/* locking scheme:
  76 *
  77 * It is the responsibility of the user to prevent concurrent calls or bad
  78 * ordering to mlx5_fc_create(), mlx5_fc_destroy() and accessing a reference
  79 * to struct mlx5_fc.
  80 * e.g en_tc.c is protected by RTNL lock of its caller, and will never call a
  81 * dump (access to struct mlx5_fc) after a counter is destroyed.
  82 *
  83 * access to counter list:
  84 * - create (user context)
  85 *   - mlx5_fc_create() only adds to an addlist to be used by
  86 *     mlx5_fc_stats_work(). addlist is a lockless single linked list
  87 *     that doesn't require any additional synchronization when adding single
  88 *     node.
  89 *   - spawn thread to do the actual destroy
  90 *
  91 * - destroy (user context)
  92 *   - add a counter to lockless dellist
  93 *   - spawn thread to do the actual del
  94 *
  95 * - dump (user context)
  96 *   user should not call dump after destroy
  97 *
  98 * - query (single thread workqueue context)
  99 *   destroy/dump - no conflict (see destroy)
 100 *   query/dump - packets and bytes might be inconsistent (since update is not
 101 *                atomic)
 102 *   query/create - no conflict (see create)
 103 *   since every create/destroy spawn the work, only after necessary time has
 104 *   elapsed, the thread will actually query the hardware.
 105 */
 106
 107static struct list_head *mlx5_fc_counters_lookup_next(struct mlx5_core_dev *dev,
 108                                                      u32 id)
 109{
 110        struct mlx5_fc_stats *fc_stats = &dev->priv.fc_stats;
 111        unsigned long next_id = (unsigned long)id + 1;
 112        struct mlx5_fc *counter;
 113        unsigned long tmp;
 114
 115        rcu_read_lock();
 116        /* skip counters that are in idr, but not yet in counters list */
 117        idr_for_each_entry_continue_ul(&fc_stats->counters_idr,
 118                                       counter, tmp, next_id) {
 119                if (!list_empty(&counter->list))
 120                        break;
 121        }
 122        rcu_read_unlock();
 123
 124        return counter ? &counter->list : &fc_stats->counters;
 125}
 126
 127static void mlx5_fc_stats_insert(struct mlx5_core_dev *dev,
 128                                 struct mlx5_fc *counter)
 129{
 130        struct list_head *next = mlx5_fc_counters_lookup_next(dev, counter->id);
 131
 132        list_add_tail(&counter->list, next);
 133}
 134
 135static void mlx5_fc_stats_remove(struct mlx5_core_dev *dev,
 136                                 struct mlx5_fc *counter)
 137{
 138        struct mlx5_fc_stats *fc_stats = &dev->priv.fc_stats;
 139
 140        list_del(&counter->list);
 141
 142        spin_lock(&fc_stats->counters_idr_lock);
 143        WARN_ON(!idr_remove(&fc_stats->counters_idr, counter->id));
 144        spin_unlock(&fc_stats->counters_idr_lock);
 145}
 146
 147static int get_max_bulk_query_len(struct mlx5_core_dev *dev)
 148{
 149        return min_t(int, MLX5_SW_MAX_COUNTERS_BULK,
 150                          (1 << MLX5_CAP_GEN(dev, log_max_flow_counter_bulk)));
 151}
 152
 153static void update_counter_cache(int index, u32 *bulk_raw_data,
 154                                 struct mlx5_fc_cache *cache)
 155{
 156        void *stats = MLX5_ADDR_OF(query_flow_counter_out, bulk_raw_data,
 157                             flow_statistics[index]);
 158        u64 packets = MLX5_GET64(traffic_counter, stats, packets);
 159        u64 bytes = MLX5_GET64(traffic_counter, stats, octets);
 160
 161        if (cache->packets == packets)
 162                return;
 163
 164        cache->packets = packets;
 165        cache->bytes = bytes;
 166        cache->lastuse = jiffies;
 167}
 168
 169static void mlx5_fc_stats_query_counter_range(struct mlx5_core_dev *dev,
 170                                              struct mlx5_fc *first,
 171                                              u32 last_id)
 172{
 173        struct mlx5_fc_stats *fc_stats = &dev->priv.fc_stats;
 174        bool query_more_counters = (first->id <= last_id);
 175        int max_bulk_len = get_max_bulk_query_len(dev);
 176        u32 *data = fc_stats->bulk_query_out;
 177        struct mlx5_fc *counter = first;
 178        u32 bulk_base_id;
 179        int bulk_len;
 180        int err;
 181
 182        while (query_more_counters) {
 183                /* first id must be aligned to 4 when using bulk query */
 184                bulk_base_id = counter->id & ~0x3;
 185
 186                /* number of counters to query inc. the last counter */
 187                bulk_len = min_t(int, max_bulk_len,
 188                                 ALIGN(last_id - bulk_base_id + 1, 4));
 189
 190                err = mlx5_cmd_fc_bulk_query(dev, bulk_base_id, bulk_len,
 191                                             data);
 192                if (err) {
 193                        mlx5_core_err(dev, "Error doing bulk query: %d\n", err);
 194                        return;
 195                }
 196                query_more_counters = false;
 197
 198                list_for_each_entry_from(counter, &fc_stats->counters, list) {
 199                        int counter_index = counter->id - bulk_base_id;
 200                        struct mlx5_fc_cache *cache = &counter->cache;
 201
 202                        if (counter->id >= bulk_base_id + bulk_len) {
 203                                query_more_counters = true;
 204                                break;
 205                        }
 206
 207                        update_counter_cache(counter_index, data, cache);
 208                }
 209        }
 210}
 211
 212static void mlx5_fc_free(struct mlx5_core_dev *dev, struct mlx5_fc *counter)
 213{
 214        mlx5_cmd_fc_free(dev, counter->id);
 215        kfree(counter);
 216}
 217
 218static void mlx5_fc_release(struct mlx5_core_dev *dev, struct mlx5_fc *counter)
 219{
 220        struct mlx5_fc_stats *fc_stats = &dev->priv.fc_stats;
 221
 222        if (counter->bulk)
 223                mlx5_fc_pool_release_counter(&fc_stats->fc_pool, counter);
 224        else
 225                mlx5_fc_free(dev, counter);
 226}
 227
 228static void mlx5_fc_stats_work(struct work_struct *work)
 229{
 230        struct mlx5_core_dev *dev = container_of(work, struct mlx5_core_dev,
 231                                                 priv.fc_stats.work.work);
 232        struct mlx5_fc_stats *fc_stats = &dev->priv.fc_stats;
 233        /* Take dellist first to ensure that counters cannot be deleted before
 234         * they are inserted.
 235         */
 236        struct llist_node *dellist = llist_del_all(&fc_stats->dellist);
 237        struct llist_node *addlist = llist_del_all(&fc_stats->addlist);
 238        struct mlx5_fc *counter = NULL, *last = NULL, *tmp;
 239        unsigned long now = jiffies;
 240
 241        if (addlist || !list_empty(&fc_stats->counters))
 242                queue_delayed_work(fc_stats->wq, &fc_stats->work,
 243                                   fc_stats->sampling_interval);
 244
 245        llist_for_each_entry(counter, addlist, addlist)
 246                mlx5_fc_stats_insert(dev, counter);
 247
 248        llist_for_each_entry_safe(counter, tmp, dellist, dellist) {
 249                mlx5_fc_stats_remove(dev, counter);
 250
 251                mlx5_fc_release(dev, counter);
 252        }
 253
 254        if (time_before(now, fc_stats->next_query) ||
 255            list_empty(&fc_stats->counters))
 256                return;
 257        last = list_last_entry(&fc_stats->counters, struct mlx5_fc, list);
 258
 259        counter = list_first_entry(&fc_stats->counters, struct mlx5_fc,
 260                                   list);
 261        if (counter)
 262                mlx5_fc_stats_query_counter_range(dev, counter, last->id);
 263
 264        fc_stats->next_query = now + fc_stats->sampling_interval;
 265}
 266
 267static struct mlx5_fc *mlx5_fc_single_alloc(struct mlx5_core_dev *dev)
 268{
 269        struct mlx5_fc *counter;
 270        int err;
 271
 272        counter = kzalloc(sizeof(*counter), GFP_KERNEL);
 273        if (!counter)
 274                return ERR_PTR(-ENOMEM);
 275
 276        err = mlx5_cmd_fc_alloc(dev, &counter->id);
 277        if (err) {
 278                kfree(counter);
 279                return ERR_PTR(err);
 280        }
 281
 282        return counter;
 283}
 284
 285static struct mlx5_fc *mlx5_fc_acquire(struct mlx5_core_dev *dev, bool aging)
 286{
 287        struct mlx5_fc_stats *fc_stats = &dev->priv.fc_stats;
 288        struct mlx5_fc *counter;
 289
 290        if (aging && MLX5_CAP_GEN(dev, flow_counter_bulk_alloc) != 0) {
 291                counter = mlx5_fc_pool_acquire_counter(&fc_stats->fc_pool);
 292                if (!IS_ERR(counter))
 293                        return counter;
 294        }
 295
 296        return mlx5_fc_single_alloc(dev);
 297}
 298
 299struct mlx5_fc *mlx5_fc_create(struct mlx5_core_dev *dev, bool aging)
 300{
 301        struct mlx5_fc *counter = mlx5_fc_acquire(dev, aging);
 302        struct mlx5_fc_stats *fc_stats = &dev->priv.fc_stats;
 303        int err;
 304
 305        if (IS_ERR(counter))
 306                return counter;
 307
 308        INIT_LIST_HEAD(&counter->list);
 309        counter->aging = aging;
 310
 311        if (aging) {
 312                u32 id = counter->id;
 313
 314                counter->cache.lastuse = jiffies;
 315                counter->lastbytes = counter->cache.bytes;
 316                counter->lastpackets = counter->cache.packets;
 317
 318                idr_preload(GFP_KERNEL);
 319                spin_lock(&fc_stats->counters_idr_lock);
 320
 321                err = idr_alloc_u32(&fc_stats->counters_idr, counter, &id, id,
 322                                    GFP_NOWAIT);
 323
 324                spin_unlock(&fc_stats->counters_idr_lock);
 325                idr_preload_end();
 326                if (err)
 327                        goto err_out_alloc;
 328
 329                llist_add(&counter->addlist, &fc_stats->addlist);
 330
 331                mod_delayed_work(fc_stats->wq, &fc_stats->work, 0);
 332        }
 333
 334        return counter;
 335
 336err_out_alloc:
 337        mlx5_fc_release(dev, counter);
 338        return ERR_PTR(err);
 339}
 340EXPORT_SYMBOL(mlx5_fc_create);
 341
 342u32 mlx5_fc_id(struct mlx5_fc *counter)
 343{
 344        return counter->id;
 345}
 346EXPORT_SYMBOL(mlx5_fc_id);
 347
 348void mlx5_fc_destroy(struct mlx5_core_dev *dev, struct mlx5_fc *counter)
 349{
 350        struct mlx5_fc_stats *fc_stats = &dev->priv.fc_stats;
 351
 352        if (!counter)
 353                return;
 354
 355        if (counter->aging) {
 356                llist_add(&counter->dellist, &fc_stats->dellist);
 357                mod_delayed_work(fc_stats->wq, &fc_stats->work, 0);
 358                return;
 359        }
 360
 361        mlx5_fc_release(dev, counter);
 362}
 363EXPORT_SYMBOL(mlx5_fc_destroy);
 364
 365int mlx5_init_fc_stats(struct mlx5_core_dev *dev)
 366{
 367        struct mlx5_fc_stats *fc_stats = &dev->priv.fc_stats;
 368        int max_bulk_len;
 369        int max_out_len;
 370
 371        spin_lock_init(&fc_stats->counters_idr_lock);
 372        idr_init(&fc_stats->counters_idr);
 373        INIT_LIST_HEAD(&fc_stats->counters);
 374        init_llist_head(&fc_stats->addlist);
 375        init_llist_head(&fc_stats->dellist);
 376
 377        max_bulk_len = get_max_bulk_query_len(dev);
 378        max_out_len = mlx5_cmd_fc_get_bulk_query_out_len(max_bulk_len);
 379        fc_stats->bulk_query_out = kzalloc(max_out_len, GFP_KERNEL);
 380        if (!fc_stats->bulk_query_out)
 381                return -ENOMEM;
 382
 383        fc_stats->wq = create_singlethread_workqueue("mlx5_fc");
 384        if (!fc_stats->wq)
 385                goto err_wq_create;
 386
 387        fc_stats->sampling_interval = MLX5_FC_STATS_PERIOD;
 388        INIT_DELAYED_WORK(&fc_stats->work, mlx5_fc_stats_work);
 389
 390        mlx5_fc_pool_init(&fc_stats->fc_pool, dev);
 391        return 0;
 392
 393err_wq_create:
 394        kfree(fc_stats->bulk_query_out);
 395        return -ENOMEM;
 396}
 397
 398void mlx5_cleanup_fc_stats(struct mlx5_core_dev *dev)
 399{
 400        struct mlx5_fc_stats *fc_stats = &dev->priv.fc_stats;
 401        struct llist_node *tmplist;
 402        struct mlx5_fc *counter;
 403        struct mlx5_fc *tmp;
 404
 405        cancel_delayed_work_sync(&dev->priv.fc_stats.work);
 406        destroy_workqueue(dev->priv.fc_stats.wq);
 407        dev->priv.fc_stats.wq = NULL;
 408
 409        tmplist = llist_del_all(&fc_stats->addlist);
 410        llist_for_each_entry_safe(counter, tmp, tmplist, addlist)
 411                mlx5_fc_release(dev, counter);
 412
 413        list_for_each_entry_safe(counter, tmp, &fc_stats->counters, list)
 414                mlx5_fc_release(dev, counter);
 415
 416        mlx5_fc_pool_cleanup(&fc_stats->fc_pool);
 417        idr_destroy(&fc_stats->counters_idr);
 418        kfree(fc_stats->bulk_query_out);
 419}
 420
 421int mlx5_fc_query(struct mlx5_core_dev *dev, struct mlx5_fc *counter,
 422                  u64 *packets, u64 *bytes)
 423{
 424        return mlx5_cmd_fc_query(dev, counter->id, packets, bytes);
 425}
 426EXPORT_SYMBOL(mlx5_fc_query);
 427
 428u64 mlx5_fc_query_lastuse(struct mlx5_fc *counter)
 429{
 430        return counter->cache.lastuse;
 431}
 432
 433void mlx5_fc_query_cached(struct mlx5_fc *counter,
 434                          u64 *bytes, u64 *packets, u64 *lastuse)
 435{
 436        struct mlx5_fc_cache c;
 437
 438        c = counter->cache;
 439
 440        *bytes = c.bytes - counter->lastbytes;
 441        *packets = c.packets - counter->lastpackets;
 442        *lastuse = c.lastuse;
 443
 444        counter->lastbytes = c.bytes;
 445        counter->lastpackets = c.packets;
 446}
 447
 448void mlx5_fc_queue_stats_work(struct mlx5_core_dev *dev,
 449                              struct delayed_work *dwork,
 450                              unsigned long delay)
 451{
 452        struct mlx5_fc_stats *fc_stats = &dev->priv.fc_stats;
 453
 454        queue_delayed_work(fc_stats->wq, dwork, delay);
 455}
 456
 457void mlx5_fc_update_sampling_interval(struct mlx5_core_dev *dev,
 458                                      unsigned long interval)
 459{
 460        struct mlx5_fc_stats *fc_stats = &dev->priv.fc_stats;
 461
 462        fc_stats->sampling_interval = min_t(unsigned long, interval,
 463                                            fc_stats->sampling_interval);
 464}
 465
 466/* Flow counter bluks */
 467
 468struct mlx5_fc_bulk {
 469        struct list_head pool_list;
 470        u32 base_id;
 471        int bulk_len;
 472        unsigned long *bitmask;
 473        struct mlx5_fc fcs[];
 474};
 475
 476static void mlx5_fc_init(struct mlx5_fc *counter, struct mlx5_fc_bulk *bulk,
 477                         u32 id)
 478{
 479        counter->bulk = bulk;
 480        counter->id = id;
 481}
 482
 483static int mlx5_fc_bulk_get_free_fcs_amount(struct mlx5_fc_bulk *bulk)
 484{
 485        return bitmap_weight(bulk->bitmask, bulk->bulk_len);
 486}
 487
 488static struct mlx5_fc_bulk *mlx5_fc_bulk_create(struct mlx5_core_dev *dev)
 489{
 490        enum mlx5_fc_bulk_alloc_bitmask alloc_bitmask;
 491        struct mlx5_fc_bulk *bulk;
 492        int err = -ENOMEM;
 493        int bulk_len;
 494        u32 base_id;
 495        int i;
 496
 497        alloc_bitmask = MLX5_CAP_GEN(dev, flow_counter_bulk_alloc);
 498        bulk_len = alloc_bitmask > 0 ? MLX5_FC_BULK_NUM_FCS(alloc_bitmask) : 1;
 499
 500        bulk = kvzalloc(sizeof(*bulk) + bulk_len * sizeof(struct mlx5_fc),
 501                        GFP_KERNEL);
 502        if (!bulk)
 503                goto err_alloc_bulk;
 504
 505        bulk->bitmask = kvcalloc(BITS_TO_LONGS(bulk_len), sizeof(unsigned long),
 506                                 GFP_KERNEL);
 507        if (!bulk->bitmask)
 508                goto err_alloc_bitmask;
 509
 510        err = mlx5_cmd_fc_bulk_alloc(dev, alloc_bitmask, &base_id);
 511        if (err)
 512                goto err_mlx5_cmd_bulk_alloc;
 513
 514        bulk->base_id = base_id;
 515        bulk->bulk_len = bulk_len;
 516        for (i = 0; i < bulk_len; i++) {
 517                mlx5_fc_init(&bulk->fcs[i], bulk, base_id + i);
 518                set_bit(i, bulk->bitmask);
 519        }
 520
 521        return bulk;
 522
 523err_mlx5_cmd_bulk_alloc:
 524        kvfree(bulk->bitmask);
 525err_alloc_bitmask:
 526        kvfree(bulk);
 527err_alloc_bulk:
 528        return ERR_PTR(err);
 529}
 530
 531static int
 532mlx5_fc_bulk_destroy(struct mlx5_core_dev *dev, struct mlx5_fc_bulk *bulk)
 533{
 534        if (mlx5_fc_bulk_get_free_fcs_amount(bulk) < bulk->bulk_len) {
 535                mlx5_core_err(dev, "Freeing bulk before all counters were released\n");
 536                return -EBUSY;
 537        }
 538
 539        mlx5_cmd_fc_free(dev, bulk->base_id);
 540        kvfree(bulk->bitmask);
 541        kvfree(bulk);
 542
 543        return 0;
 544}
 545
 546static struct mlx5_fc *mlx5_fc_bulk_acquire_fc(struct mlx5_fc_bulk *bulk)
 547{
 548        int free_fc_index = find_first_bit(bulk->bitmask, bulk->bulk_len);
 549
 550        if (free_fc_index >= bulk->bulk_len)
 551                return ERR_PTR(-ENOSPC);
 552
 553        clear_bit(free_fc_index, bulk->bitmask);
 554        return &bulk->fcs[free_fc_index];
 555}
 556
 557static int mlx5_fc_bulk_release_fc(struct mlx5_fc_bulk *bulk, struct mlx5_fc *fc)
 558{
 559        int fc_index = fc->id - bulk->base_id;
 560
 561        if (test_bit(fc_index, bulk->bitmask))
 562                return -EINVAL;
 563
 564        set_bit(fc_index, bulk->bitmask);
 565        return 0;
 566}
 567
 568/* Flow counters pool API */
 569
 570static void mlx5_fc_pool_init(struct mlx5_fc_pool *fc_pool, struct mlx5_core_dev *dev)
 571{
 572        fc_pool->dev = dev;
 573        mutex_init(&fc_pool->pool_lock);
 574        INIT_LIST_HEAD(&fc_pool->fully_used);
 575        INIT_LIST_HEAD(&fc_pool->partially_used);
 576        INIT_LIST_HEAD(&fc_pool->unused);
 577        fc_pool->available_fcs = 0;
 578        fc_pool->used_fcs = 0;
 579        fc_pool->threshold = 0;
 580}
 581
 582static void mlx5_fc_pool_cleanup(struct mlx5_fc_pool *fc_pool)
 583{
 584        struct mlx5_core_dev *dev = fc_pool->dev;
 585        struct mlx5_fc_bulk *bulk;
 586        struct mlx5_fc_bulk *tmp;
 587
 588        list_for_each_entry_safe(bulk, tmp, &fc_pool->fully_used, pool_list)
 589                mlx5_fc_bulk_destroy(dev, bulk);
 590        list_for_each_entry_safe(bulk, tmp, &fc_pool->partially_used, pool_list)
 591                mlx5_fc_bulk_destroy(dev, bulk);
 592        list_for_each_entry_safe(bulk, tmp, &fc_pool->unused, pool_list)
 593                mlx5_fc_bulk_destroy(dev, bulk);
 594}
 595
 596static void mlx5_fc_pool_update_threshold(struct mlx5_fc_pool *fc_pool)
 597{
 598        fc_pool->threshold = min_t(int, MLX5_FC_POOL_MAX_THRESHOLD,
 599                                   fc_pool->used_fcs / MLX5_FC_POOL_USED_BUFF_RATIO);
 600}
 601
 602static struct mlx5_fc_bulk *
 603mlx5_fc_pool_alloc_new_bulk(struct mlx5_fc_pool *fc_pool)
 604{
 605        struct mlx5_core_dev *dev = fc_pool->dev;
 606        struct mlx5_fc_bulk *new_bulk;
 607
 608        new_bulk = mlx5_fc_bulk_create(dev);
 609        if (!IS_ERR(new_bulk))
 610                fc_pool->available_fcs += new_bulk->bulk_len;
 611        mlx5_fc_pool_update_threshold(fc_pool);
 612        return new_bulk;
 613}
 614
 615static void
 616mlx5_fc_pool_free_bulk(struct mlx5_fc_pool *fc_pool, struct mlx5_fc_bulk *bulk)
 617{
 618        struct mlx5_core_dev *dev = fc_pool->dev;
 619
 620        fc_pool->available_fcs -= bulk->bulk_len;
 621        mlx5_fc_bulk_destroy(dev, bulk);
 622        mlx5_fc_pool_update_threshold(fc_pool);
 623}
 624
 625static struct mlx5_fc *
 626mlx5_fc_pool_acquire_from_list(struct list_head *src_list,
 627                               struct list_head *next_list,
 628                               bool move_non_full_bulk)
 629{
 630        struct mlx5_fc_bulk *bulk;
 631        struct mlx5_fc *fc;
 632
 633        if (list_empty(src_list))
 634                return ERR_PTR(-ENODATA);
 635
 636        bulk = list_first_entry(src_list, struct mlx5_fc_bulk, pool_list);
 637        fc = mlx5_fc_bulk_acquire_fc(bulk);
 638        if (move_non_full_bulk || mlx5_fc_bulk_get_free_fcs_amount(bulk) == 0)
 639                list_move(&bulk->pool_list, next_list);
 640        return fc;
 641}
 642
 643static struct mlx5_fc *
 644mlx5_fc_pool_acquire_counter(struct mlx5_fc_pool *fc_pool)
 645{
 646        struct mlx5_fc_bulk *new_bulk;
 647        struct mlx5_fc *fc;
 648
 649        mutex_lock(&fc_pool->pool_lock);
 650
 651        fc = mlx5_fc_pool_acquire_from_list(&fc_pool->partially_used,
 652                                            &fc_pool->fully_used, false);
 653        if (IS_ERR(fc))
 654                fc = mlx5_fc_pool_acquire_from_list(&fc_pool->unused,
 655                                                    &fc_pool->partially_used,
 656                                                    true);
 657        if (IS_ERR(fc)) {
 658                new_bulk = mlx5_fc_pool_alloc_new_bulk(fc_pool);
 659                if (IS_ERR(new_bulk)) {
 660                        fc = ERR_CAST(new_bulk);
 661                        goto out;
 662                }
 663                fc = mlx5_fc_bulk_acquire_fc(new_bulk);
 664                list_add(&new_bulk->pool_list, &fc_pool->partially_used);
 665        }
 666        fc_pool->available_fcs--;
 667        fc_pool->used_fcs++;
 668
 669out:
 670        mutex_unlock(&fc_pool->pool_lock);
 671        return fc;
 672}
 673
 674static void
 675mlx5_fc_pool_release_counter(struct mlx5_fc_pool *fc_pool, struct mlx5_fc *fc)
 676{
 677        struct mlx5_core_dev *dev = fc_pool->dev;
 678        struct mlx5_fc_bulk *bulk = fc->bulk;
 679        int bulk_free_fcs_amount;
 680
 681        mutex_lock(&fc_pool->pool_lock);
 682
 683        if (mlx5_fc_bulk_release_fc(bulk, fc)) {
 684                mlx5_core_warn(dev, "Attempted to release a counter which is not acquired\n");
 685                goto unlock;
 686        }
 687
 688        fc_pool->available_fcs++;
 689        fc_pool->used_fcs--;
 690
 691        bulk_free_fcs_amount = mlx5_fc_bulk_get_free_fcs_amount(bulk);
 692        if (bulk_free_fcs_amount == 1)
 693                list_move_tail(&bulk->pool_list, &fc_pool->partially_used);
 694        if (bulk_free_fcs_amount == bulk->bulk_len) {
 695                list_del(&bulk->pool_list);
 696                if (fc_pool->available_fcs > fc_pool->threshold)
 697                        mlx5_fc_pool_free_bulk(fc_pool, bulk);
 698                else
 699                        list_add(&bulk->pool_list, &fc_pool->unused);
 700        }
 701
 702unlock:
 703        mutex_unlock(&fc_pool->pool_lock);
 704}
 705