Merge pull request #2875 from opensourcerouting/fabricd

OpenFabric support

1 files changed, 182 insertions, 0 deletions

diff --git a/isisd/isis_tx_queue.c b/isisd/isis_tx_queue.c
new file mode 100644
index 0000000000..32427628ad
--- /dev/null
+++ b/isisd/isis_tx_queue.c
@@ -0,0 +1,182 @@
+/*
+ * IS-IS Rout(e)ing protocol - LSP TX Queuing logic
+ *
+ * Copyright (C) 2018 Christian Franke
+ *
+ * This file is part of FreeRangeRouting (FRR)
+ *
+ * FRR is free software; you can redistribute it and/or modify it
+ * under the terms of the GNU General Public License as published by the
+ * Free Software Foundation; either version 2, or (at your option) any
+ * later version.
+ *
+ * FRR is distributed in the hope that it will be useful, but
+ * WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
+ * General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License along
+ * with this program; see the file COPYING; if not, write to the Free Software
+ * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
+ */
+#include <zebra.h>
+
+#include "hash.h"
+#include "jhash.h"
+
+#include "isisd/isisd.h"
+#include "isisd/isis_memory.h"
+#include "isisd/isis_flags.h"
+#include "dict.h"
+#include "isisd/isis_circuit.h"
+#include "isisd/isis_lsp.h"
+#include "isisd/isis_tx_queue.h"
+
+DEFINE_MTYPE_STATIC(ISISD, TX_QUEUE, "ISIS TX Queue")
+DEFINE_MTYPE_STATIC(ISISD, TX_QUEUE_ENTRY, "ISIS TX Queue Entry")
+
+struct isis_tx_queue {
+	void *arg;
+	void (*send_event)(void *arg, struct isis_lsp *, enum isis_tx_type);
+	struct hash *hash;
+};
+
+struct isis_tx_queue_entry {
+	struct isis_lsp *lsp;
+	enum isis_tx_type type;
+	struct thread *retry;
+	struct isis_tx_queue *queue;
+};
+
+static unsigned tx_queue_hash_key(void *p)
+{
+	struct isis_tx_queue_entry *e = p;
+
+	uint32_t id_key = jhash(e->lsp->hdr.lsp_id,
+				ISIS_SYS_ID_LEN + 2, 0x55aa5a5a);
+
+	return jhash_1word(e->lsp->level, id_key);
+}
+
+static int tx_queue_hash_cmp(const void *a, const void *b)
+{
+	const struct isis_tx_queue_entry *ea = a, *eb = b;
+
+	if (ea->lsp->level != eb->lsp->level)
+		return 0;
+
+	if (memcmp(ea->lsp->hdr.lsp_id, eb->lsp->hdr.lsp_id,
+		   ISIS_SYS_ID_LEN + 2))
+		return 0;
+
+	return 1;
+}
+
+struct isis_tx_queue *isis_tx_queue_new(void *arg,
+					void(*send_event)(void *arg,
+							  struct isis_lsp *,
+							  enum isis_tx_type))
+{
+	struct isis_tx_queue *rv = XCALLOC(MTYPE_TX_QUEUE, sizeof(*rv));
+
+	rv->arg = arg;
+	rv->send_event = send_event;
+
+	rv->hash = hash_create(tx_queue_hash_key, tx_queue_hash_cmp, NULL);
+	return rv;
+}
+
+static void tx_queue_element_free(void *element)
+{
+	struct isis_tx_queue_entry *e = element;
+
+	if (e->retry)
+		thread_cancel(e->retry);
+
+	XFREE(MTYPE_TX_QUEUE_ENTRY, e);
+}
+
+void isis_tx_queue_free(struct isis_tx_queue *queue)
+{
+	hash_clean(queue->hash, tx_queue_element_free);
+	hash_free(queue->hash);
+	XFREE(MTYPE_TX_QUEUE, queue);
+}
+
+static struct isis_tx_queue_entry *tx_queue_find(struct isis_tx_queue *queue,
+						 struct isis_lsp *lsp)
+{
+	struct isis_tx_queue_entry e = {
+		.lsp = lsp
+	};
+
+	return hash_lookup(queue->hash, &e);
+}
+
+static int tx_queue_send_event(struct thread *thread)
+{
+	struct isis_tx_queue_entry *e = THREAD_ARG(thread);
+	struct isis_tx_queue *queue = e->queue;
+
+	e->retry = NULL;
+	thread_add_timer(master, tx_queue_send_event, e, 5, &e->retry);
+
+	queue->send_event(queue->arg, e->lsp, e->type);
+	/* Don't access e here anymore, send_event might have destroyed it */
+
+	return 0;
+}
+
+void isis_tx_queue_add(struct isis_tx_queue *queue,
+		       struct isis_lsp *lsp,
+		       enum isis_tx_type type)
+{
+	if (!queue)
+		return;
+
+	struct isis_tx_queue_entry *e = tx_queue_find(queue, lsp);
+	if (!e) {
+		e = XCALLOC(MTYPE_TX_QUEUE_ENTRY, sizeof(*e));
+		e->lsp = lsp;
+		e->queue = queue;
+
+		struct isis_tx_queue_entry *inserted;
+		inserted = hash_get(queue->hash, e, hash_alloc_intern);
+		assert(inserted == e);
+	}
+
+	e->type = type;
+
+	if (e->retry)
+		thread_cancel(e->retry);
+	thread_add_event(master, tx_queue_send_event, e, 0, &e->retry);
+}
+
+void isis_tx_queue_del(struct isis_tx_queue *queue, struct isis_lsp *lsp)
+{
+	if (!queue)
+		return;
+
+	struct isis_tx_queue_entry *e = tx_queue_find(queue, lsp);
+	if (!e)
+		return;
+
+	if (e->retry)
+		thread_cancel(e->retry);
+
+	hash_release(queue->hash, e);
+	XFREE(MTYPE_TX_QUEUE_ENTRY, e);
+}
+
+unsigned long isis_tx_queue_len(struct isis_tx_queue *queue)
+{
+	if (!queue)
+		return 0;
+
+	return hashcount(queue->hash);
+}
+
+void isis_tx_queue_clean(struct isis_tx_queue *queue)
+{
+	hash_clean(queue->hash, tx_queue_element_free);
+}