blob: 94a05938d26e73fe898d686d5bb3dd49a7fa21bf [file] [log] [blame]
/*
* Copyright (c) 2016-2019 Cisco and/or its affiliates.
* Copyright (c) 2019 Arm Limited
* Copyright (c) 2010-2017 Intel Corporation and/or its affiliates.
* Copyright (c) 2007-2009 Kip Macy kmacy@freebsd.org
* Inspired from DPDK rte_ring.h (SPSC only) (derived from freebsd bufring.h).
* Licensed under the Apache License, Version 2.0 (the "License");
* you may not use this file except in compliance with the License.
* You may obtain a copy of the License at:
*
* http://www.apache.org/licenses/LICENSE-2.0
*
* Unless required by applicable law or agreed to in writing, software
* distributed under the License is distributed on an "AS IS" BASIS,
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
* See the License for the specific language governing permissions and
* limitations under the License.
*/
#ifndef __included_ssvm_fifo_h__
#define __included_ssvm_fifo_h__
#include <vppinfra/clib.h>
#include <vppinfra/vec.h>
#include <vppinfra/mheap.h>
#include <vppinfra/heap.h>
#include <vppinfra/pool.h>
#include <vppinfra/format.h>
#include <pthread.h>
/** Out-of-order segment */
typedef struct
{
u32 next; /**< Next linked-list element pool index */
u32 prev; /**< Previous linked-list element pool index */
u32 start; /**< Start of segment, normalized*/
u32 length; /**< Length of segment */
} ooo_segment_t;
format_function_t format_ooo_segment;
format_function_t format_ooo_list;
#define SVM_FIFO_TRACE (0)
#define OOO_SEGMENT_INVALID_INDEX ((u32)~0)
#define SVM_FIFO_INVALID_SESSION_INDEX ((u32)~0)
#define SVM_FIFO_INVALID_INDEX ((u32)~0)
#define SVM_FIFO_MAX_EVT_SUBSCRIBERS 8
enum
{
SVM_FIFO_NO_TX_NOTIF = 0,
SVM_FIFO_WANT_TX_NOTIF = 1,
SVM_FIFO_WANT_TX_NOTIF_IF_FULL = 2,
};
typedef struct
{
u32 offset;
u32 len;
u32 action;
} svm_fifo_trace_elem_t;
typedef struct _svm_fifo
{
CLIB_CACHE_LINE_ALIGN_MARK (shared_first);
u32 size; /**< size of the fifo(must be power of 2) */
u32 nitems; /**< usable size(size-1) */
CLIB_CACHE_LINE_ALIGN_MARK (shared_second);
volatile u32 has_event; /**< non-zero if deq event exists */
u32 master_session_index;
u32 client_session_index;
u8 master_thread_index;
u8 client_thread_index;
u32 segment_manager;
u32 segment_index;
u32 ct_session_index; /**< Local session index for vpp */
u32 freelist_index; /**< aka log2(allocated_size) - const. */
i8 refcnt; /**< reference count */
CLIB_CACHE_LINE_ALIGN_MARK (consumer);
u32 head;
volatile u32 want_tx_ntf; /**< producer wants nudge */
volatile u32 has_tx_ntf;
CLIB_CACHE_LINE_ALIGN_MARK (producer);
u32 tail;
ooo_segment_t *ooo_segments; /**< Pool of ooo segments */
u32 ooos_list_head; /**< Head of out-of-order linked-list */
u32 ooos_newest; /**< Last segment to have been updated */
struct _svm_fifo *next; /**< next in freelist/active chain */
struct _svm_fifo *prev; /**< prev in active chain */
volatile u8 n_subscribers;
u8 subscribers[SVM_FIFO_MAX_EVT_SUBSCRIBERS];
#if SVM_FIFO_TRACE
svm_fifo_trace_elem_t *trace;
#endif
CLIB_CACHE_LINE_ALIGN_MARK (data);
} svm_fifo_t;
typedef enum
{
SVM_FIFO_FULL = -2,
} svm_fifo_err_t;
typedef struct svm_fifo_segment_
{
u8 *data;
u32 len;
} svm_fifo_segment_t;
#if SVM_FIFO_TRACE
#define svm_fifo_trace_add(_f, _s, _l, _t) \
{ \
svm_fifo_trace_elem_t *trace_elt; \
vec_add2(_f->trace, trace_elt, 1); \
trace_elt->offset = _s; \
trace_elt->len = _l; \
trace_elt->action = _t; \
}
#else
#define svm_fifo_trace_add(_f, _s, _l, _t)
#endif
u8 *svm_fifo_dump_trace (u8 * s, svm_fifo_t * f);
u8 *svm_fifo_replay (u8 * s, svm_fifo_t * f, u8 no_read, u8 verbose);
/* internal function */
static inline void
f_load_head_tail_cons (svm_fifo_t * f, u32 * head, u32 * tail)
{
/* load-relaxed: consumer owned index */
*head = f->head;
/* load-acq: consumer foreign index (paired with store-rel in producer) */
*tail = clib_atomic_load_acq_n (&f->tail);
}
/* internal function */
static inline void
f_load_head_tail_prod (svm_fifo_t * f, u32 * head, u32 * tail)
{
/* load relaxed: producer owned index */
*tail = f->tail;
/* load-acq: producer foreign index (paired with store-rel in consumer) */
*head = clib_atomic_load_acq_n (&f->head);
}
/* producer consumer role independent */
/* internal function */
static inline void
f_load_head_tail_all_acq (svm_fifo_t * f, u32 * head, u32 * tail)
{
/* load-acq : consumer foreign index (paired with store-rel) */
*tail = clib_atomic_load_acq_n (&f->tail);
/* load-acq : producer foriegn index (paired with store-rel) */
*head = clib_atomic_load_acq_n (&f->head);
}
/* internal function */
static inline u32
f_free_count (svm_fifo_t * f, u32 head, u32 tail)
{
return (f->nitems + head - tail);
}
/* internal function */
static inline u32
f_cursize (svm_fifo_t * f, u32 head, u32 tail)
{
return (f->nitems - f_free_count (f, head, tail));
}
/* used by consumer */
static inline u32
svm_fifo_max_dequeue_cons (svm_fifo_t * f)
{
u32 tail, head;
f_load_head_tail_cons (f, &head, &tail);
return f_cursize (f, head, tail);
}
/* used by producer*/
static inline u32
svm_fifo_max_dequeue_prod (svm_fifo_t * f)
{
u32 tail, head;
f_load_head_tail_prod (f, &head, &tail);
return f_cursize (f, head, tail);
}
/* use producer or consumer specific functions for perfomance.
* svm_fifo_max_dequeue_cons (svm_fifo_t *f)
* svm_fifo_max_dequeue_prod (svm_fifo_t *f)
*/
static inline u32
svm_fifo_max_dequeue (svm_fifo_t * f)
{
u32 tail, head;
f_load_head_tail_all_acq (f, &head, &tail);
return f_cursize (f, head, tail);
}
/* used by producer */
static inline int
svm_fifo_is_full_prod (svm_fifo_t * f)
{
return (svm_fifo_max_dequeue_prod (f) == f->nitems);
}
/* use producer or consumer specific functions for perfomance.
* svm_fifo_is_full_prod (svm_fifo_t * f)
* add cons version if needed
*/
static inline int
svm_fifo_is_full (svm_fifo_t * f)
{
return (svm_fifo_max_dequeue (f) == f->nitems);
}
/* used by consumer */
static inline int
svm_fifo_is_empty_cons (svm_fifo_t * f)
{
return (svm_fifo_max_dequeue_cons (f) == 0);
}
/* used by producer */
static inline int
svm_fifo_is_empty_prod (svm_fifo_t * f)
{
return (svm_fifo_max_dequeue_prod (f) == 0);
}
/* use producer or consumer specific functions for perfomance.
* svm_fifo_is_empty_cons (svm_fifo_t * f)
* svm_fifo_is_empty_prod (svm_fifo_t * f)
*/
static inline int
svm_fifo_is_empty (svm_fifo_t * f)
{
return (svm_fifo_max_dequeue (f) == 0);
}
/* used by producer*/
static inline u32
svm_fifo_max_enqueue_prod (svm_fifo_t * f)
{
u32 head, tail;
f_load_head_tail_prod (f, &head, &tail);
return f_free_count (f, head, tail);
}
/* use producer or consumer specfic functions for perfomance.
* svm_fifo_max_enqueue_prod (svm_fifo_t *f)
* add consumer specific version if needed.
*/
static inline u32
svm_fifo_max_enqueue (svm_fifo_t * f)
{
u32 head, tail;
f_load_head_tail_all_acq (f, &head, &tail);
return f_free_count (f, head, tail);
}
static inline int
svm_fifo_has_event (svm_fifo_t * f)
{
return f->has_event;
}
static inline u8
svm_fifo_has_ooo_data (svm_fifo_t * f)
{
return f->ooos_list_head != OOO_SEGMENT_INVALID_INDEX;
}
/**
* Sets fifo event flag.
*
* Also acts as a release ordering.
*
* @return 1 if flag was not set.
*/
always_inline u8
svm_fifo_set_event (svm_fifo_t * f)
{
/* return __sync_lock_test_and_set (&f->has_event, 1) == 0;
return __sync_bool_compare_and_swap (&f->has_event, 0, 1); */
return !clib_atomic_swap_rel_n (&f->has_event, 1);
}
/**
* Unsets fifo event flag.
*
* Also acts as an acquire barrier.
*/
always_inline void
svm_fifo_unset_event (svm_fifo_t * f)
{
clib_atomic_swap_acq_n (&f->has_event, 0);
}
svm_fifo_t *svm_fifo_create (u32 data_size_in_bytes);
void svm_fifo_free (svm_fifo_t * f);
int svm_fifo_enqueue_nowait (svm_fifo_t * f, u32 max_bytes,
const u8 * copy_from_here);
int svm_fifo_enqueue_with_offset (svm_fifo_t * f, u32 offset,
u32 required_bytes, u8 * copy_from_here);
int svm_fifo_dequeue_nowait (svm_fifo_t * f, u32 max_bytes, u8 * copy_here);
int svm_fifo_peek (svm_fifo_t * f, u32 offset, u32 max_bytes, u8 * copy_here);
int svm_fifo_dequeue_drop (svm_fifo_t * f, u32 max_bytes);
void svm_fifo_dequeue_drop_all (svm_fifo_t * f);
int svm_fifo_segments (svm_fifo_t * f, svm_fifo_segment_t * fs);
void svm_fifo_segments_free (svm_fifo_t * f, svm_fifo_segment_t * fs);
void svm_fifo_init_pointers (svm_fifo_t * f, u32 pointer);
void svm_fifo_clone (svm_fifo_t * df, svm_fifo_t * sf);
void svm_fifo_overwrite_head (svm_fifo_t * f, u8 * data, u32 len);
void svm_fifo_add_subscriber (svm_fifo_t * f, u8 subscriber);
void svm_fifo_del_subscriber (svm_fifo_t * f, u8 subscriber);
format_function_t format_svm_fifo;
/**
* Max contiguous chunk of data that can be read
*/
always_inline u32
svm_fifo_max_read_chunk (svm_fifo_t * f)
{
u32 head, tail;
u32 head_idx, tail_idx;
f_load_head_tail_cons (f, &head, &tail);
head_idx = head % f->size;
tail_idx = tail % f->size;
return tail_idx > head_idx ? (tail_idx - head_idx) : (f->size - head_idx);
}
/**
* Max contiguous chunk of data that can be written
*/
always_inline u32
svm_fifo_max_write_chunk (svm_fifo_t * f)
{
u32 head, tail;
u32 head_idx, tail_idx;
f_load_head_tail_prod (f, &head, &tail);
head_idx = head % f->size;
tail_idx = tail % f->size;
return tail_idx >= head_idx ? (f->size - tail_idx) : (head_idx - tail_idx);
}
/**
* Advance tail pointer
*
* Useful for moving tail pointer after external enqueue.
*/
always_inline void
svm_fifo_enqueue_nocopy (svm_fifo_t * f, u32 bytes)
{
ASSERT (bytes <= svm_fifo_max_enqueue_prod (f));
/* load-relaxed: producer owned index */
u32 tail = f->tail;
tail += bytes;
/* store-rel: producer owned index (paired with load-acq in consumer) */
clib_atomic_store_rel_n (&f->tail, tail);
}
always_inline u8 *
svm_fifo_head (svm_fifo_t * f)
{
/* load-relaxed: consumer owned index */
return (f->data + (f->head % f->size));
}
always_inline u8 *
svm_fifo_tail (svm_fifo_t * f)
{
/* load-relaxed: producer owned index */
return (f->data + (f->tail % f->size));
}
static inline void
svm_fifo_add_want_tx_ntf (svm_fifo_t * f, u8 ntf_type)
{
f->want_tx_ntf |= ntf_type;
}
static inline void
svm_fifo_del_want_tx_ntf (svm_fifo_t * f, u8 ntf_type)
{
f->want_tx_ntf &= ~ntf_type;
}
static inline void
svm_fifo_clear_tx_ntf (svm_fifo_t * f)
{
/* Set the flag if want_tx_notif_if_full was the only ntf requested */
f->has_tx_ntf = f->want_tx_ntf == SVM_FIFO_WANT_TX_NOTIF_IF_FULL;
svm_fifo_del_want_tx_ntf (f, SVM_FIFO_WANT_TX_NOTIF);
}
static inline void
svm_fifo_reset_tx_ntf (svm_fifo_t * f)
{
f->has_tx_ntf = 0;
}
static inline u8
svm_fifo_needs_tx_ntf (svm_fifo_t * f, u32 n_last_deq)
{
u8 want_ntf = f->want_tx_ntf;
if (PREDICT_TRUE (want_ntf == SVM_FIFO_NO_TX_NOTIF))
return 0;
else if (want_ntf & SVM_FIFO_WANT_TX_NOTIF)
return 1;
else if (want_ntf & SVM_FIFO_WANT_TX_NOTIF_IF_FULL)
{
u32 max_deq = svm_fifo_max_dequeue_cons (f);
u32 nitems = f->nitems;
if (!f->has_tx_ntf && max_deq < nitems
&& max_deq + n_last_deq >= nitems)
return 1;
return 0;
}
return 0;
}
always_inline u8
svm_fifo_n_subscribers (svm_fifo_t * f)
{
return f->n_subscribers;
}
u32 svm_fifo_number_ooo_segments (svm_fifo_t * f);
ooo_segment_t *svm_fifo_first_ooo_segment (svm_fifo_t * f);
always_inline ooo_segment_t *
svm_fifo_newest_ooo_segment (svm_fifo_t * f)
{
if (f->ooos_newest == OOO_SEGMENT_INVALID_INDEX)
return 0;
return pool_elt_at_index (f->ooo_segments, f->ooos_newest);
}
always_inline void
svm_fifo_newest_ooo_segment_reset (svm_fifo_t * f)
{
f->ooos_newest = OOO_SEGMENT_INVALID_INDEX;
}
always_inline u32
ooo_segment_distance_from_tail (svm_fifo_t * f, u32 pos, u32 tail)
{
return ((pos - tail) % f->size);
}
always_inline u32
ooo_segment_distance_to_tail (svm_fifo_t * f, u32 pos, u32 tail)
{
return ((tail - pos) % f->size);
}
always_inline u32
ooo_segment_offset_prod (svm_fifo_t * f, ooo_segment_t * s)
{
u32 tail;
/* load-relaxed: producer owned index */
tail = f->tail;
return ooo_segment_distance_from_tail (f, s->start, tail);
}
always_inline u32
ooo_segment_length (svm_fifo_t * f, ooo_segment_t * s)
{
return s->length;
}
always_inline ooo_segment_t *
ooo_segment_get_prev (svm_fifo_t * f, ooo_segment_t * s)
{
if (s->prev == OOO_SEGMENT_INVALID_INDEX)
return 0;
return pool_elt_at_index (f->ooo_segments, s->prev);
}
always_inline ooo_segment_t *
ooo_segment_next (svm_fifo_t * f, ooo_segment_t * s)
{
if (s->next == OOO_SEGMENT_INVALID_INDEX)
return 0;
return pool_elt_at_index (f->ooo_segments, s->next);
}
#endif /* __included_ssvm_fifo_h__ */
/*
* fd.io coding-style-patch-verification: ON
*
* Local Variables:
* eval: (c-set-style "gnu")
* End:
*/