lib/librte_kni/rte_kni_fifo.h

   1 /* SPDX-License-Identifier: BSD-3-Clause
   2  * Copyright(c) 2010-2014 Intel Corporation
   3  */
   4
   5
   6
   7 /**
   8  * Initializes the kni fifo structure
   9  */
  10 static void
  11 kni_fifo_init(struct rte_kni_fifo *fifo, unsigned size)
  12 {
  13         /* Ensure size is power of 2 */
  14         if (size & (size - 1))
  15                 rte_panic("KNI fifo size must be power of 2\n");
  16
  17         fifo->write = 0;
  18         fifo->read = 0;
  19         fifo->len = size;
  20         fifo->elem_size = sizeof(void *);
  21 }
  22
  23 /**
  24  * Adds num elements into the fifo. Return the number actually written
  25  */
  26 static inline unsigned
  27 kni_fifo_put(struct rte_kni_fifo *fifo, void **data, unsigned num)
  28 {
  29         unsigned i = 0;
  30         unsigned fifo_write = fifo->write;
  31         unsigned new_write = fifo_write;
  32         rte_smp_rmb();
  33         unsigned fifo_read = fifo->read;
  34
  35         for (i = 0; i < num; i++) {
  36                 new_write = (new_write + 1) & (fifo->len - 1);
  37
  38                 if (new_write == fifo_read)
  39                         break;
  40                 fifo->buffer[fifo_write] = data[i];
  41                 fifo_write = new_write;
  42         }
  43         rte_smp_wmb();
  44         fifo->write = fifo_write;
  45         return i;
  46 }
  47
  48 /**
  49  * Get up to num elements from the fifo. Return the number actually read
  50  */
  51 static inline unsigned
  52 kni_fifo_get(struct rte_kni_fifo *fifo, void **data, unsigned num)
  53 {
  54         unsigned i = 0;
  55         unsigned new_read = fifo->read;
  56         rte_smp_rmb();
  57         unsigned fifo_write = fifo->write;
  58
  59         for (i = 0; i < num; i++) {
  60                 if (new_read == fifo_write)
  61                         break;
  62
  63                 data[i] = fifo->buffer[new_read];
  64                 new_read = (new_read + 1) & (fifo->len - 1);
  65         }
  66         rte_smp_rmb();
  67         fifo->read = new_read;
  68         return i;
  69 }
  70
  71 /**
  72  * Get the num of elements in the fifo
  73  */
  74 static inline uint32_t
  75 kni_fifo_count(struct rte_kni_fifo *fifo)
  76 {
  77         unsigned fifo_write = fifo->write;
  78         rte_smp_rmb();
  79         unsigned fifo_read = fifo->read;
  80         return (fifo->len + fifo_write - fifo_read) & (fifo->len - 1);
  81 }