Oops forgot to git commit pub.c

1 files changed, 299 insertions, 0 deletions

diff --git a/src/protocol/pubsub/pub.c b/src/protocol/pubsub/pub.c
new file mode 100644
index 00000000..b1f91fe2
--- /dev/null
+++ b/src/protocol/pubsub/pub.c
@@ -0,0 +1,299 @@
+//
+// Copyright 2017 Garrett D'Amore <garrett@damore.org>
+//
+// This software is supplied under the terms of the MIT License, a
+// copy of which should be located in the distribution where this
+// file was obtained (LICENSE.txt).  A copy of the license may also be
+// found online at https://opensource.org/licenses/MIT.
+//
+
+#include <stdlib.h>
+#include <string.h>
+
+#include "core/nng_impl.h"
+
+// Publish protocol.  The PUB protocol simply sends messages out, as
+// a broadcast.  It has nothing more sophisticated because it does not
+// perform sender-side filtering.  Its best effort delivery, so anything
+// that can't receive the message won't get one.
+
+typedef struct nni_pub_pipe	nni_pub_pipe;
+typedef struct nni_pub_sock	nni_pub_sock;
+
+// An nni_pub_sock is our per-socket protocol private structure.
+struct nni_pub_sock {
+	nni_sock *	sock;
+	nni_mtx		mx;
+	nni_msgq *	uwq;
+	int		raw;
+	nni_thr		sender;
+	nni_list	pipes;
+};
+
+// An nni_pub_pipe is our per-pipe protocol private structure.
+struct nni_pub_pipe {
+	nni_pipe *	pipe;
+	nni_pub_sock *	pub;
+	nni_msgq *	sendq;
+	nni_list_node	node;
+	int		sigclose;
+};
+
+static void nni_pub_broadcast(void *);
+
+static int
+nni_pub_init(void **pubp, nni_sock *sock)
+{
+	nni_pub_sock *pub;
+	int rv;
+
+	if ((pub = NNI_ALLOC_STRUCT(pub)) == NULL) {
+		return (NNG_ENOMEM);
+	}
+	if ((rv = nni_mtx_init(&pub->mx)) != 0) {
+		NNI_FREE_STRUCT(pub);
+		return (rv);
+	}
+	pub->sock = sock;
+	pub->raw = 0;
+	NNI_LIST_INIT(&pub->pipes, nni_pub_pipe, node);
+
+	pub->uwq = nni_sock_sendq(sock);
+
+	rv = nni_thr_init(&pub->sender, nni_pub_broadcast, pub);
+	if (rv != 0) {
+		nni_mtx_fini(&pub->mx);
+		NNI_FREE_STRUCT(pub);
+		return (rv);
+	}
+	*pubp = pub;
+	nni_sock_recverr(sock, NNG_ENOTSUP);
+	nni_thr_run(&pub->sender);
+	return (0);
+}
+
+
+static void
+nni_pub_fini(void *arg)
+{
+	nni_pub_sock *pub = arg;
+
+	nni_thr_fini(&pub->sender);
+	nni_mtx_fini(&pub->mx);
+	NNI_FREE_STRUCT(pub);
+}
+
+
+static int
+nni_pub_pipe_init(void **ppp, nni_pipe *pipe, void *psock)
+{
+	nni_pub_pipe *pp;
+	int rv;
+
+	if ((pp = NNI_ALLOC_STRUCT(pp)) == NULL) {
+		return (NNG_ENOMEM);
+	}
+	// XXX: consider making this depth tunable
+	if ((rv = nni_msgq_init(&pp->sendq, 16)) != 0) {
+		NNI_FREE_STRUCT(pp);
+		return (rv);
+	}
+	pp->pipe = pipe;
+	pp->pub = psock;
+	pp->sigclose = 0;
+	*ppp = pp;
+	return (0);
+}
+
+
+static void
+nni_pub_pipe_fini(void *arg)
+{
+	nni_pub_pipe *pp = arg;
+
+	nni_msgq_fini(pp->sendq);
+	NNI_FREE_STRUCT(pp);
+}
+
+
+static int
+nni_pub_pipe_add(void *arg)
+{
+	nni_pub_pipe *pp = arg;
+	nni_pub_sock *pub = pp->pub;
+	int rv;
+
+	if (nni_pipe_peer(pp->pipe) != NNG_PROTO_SUB) {
+		return (NNG_EPROTO);
+	}
+	nni_mtx_lock(&pub->mx);
+	nni_list_append(&pub->pipes, pp);
+	nni_mtx_unlock(&pub->mx);
+
+	return (rv);
+}
+
+
+static void
+nni_pub_pipe_rem(void *arg)
+{
+	nni_pub_pipe *pp = arg;
+	nni_pub_sock *pub = pp->pub;
+
+	nni_mtx_lock(&pub->mx);
+	nni_list_remove(&pub->pipes, pp);
+	nni_mtx_unlock(&pub->mx);
+}
+
+
+static void
+nni_pub_broadcast(void *arg)
+{
+	nni_pub_sock *pub = arg;
+	nni_msgq *uwq = pub->uwq;
+	nni_msg *msg, *dup;
+
+	for (;;) {
+		nni_pub_pipe *pp;
+		nni_pub_pipe *last;
+		int rv;
+
+		if ((rv = nni_msgq_get(uwq, &msg)) != 0) {
+			break;
+		}
+
+		nni_mtx_lock(&pub->mx);
+		last = nni_list_last(&pub->pipes);
+		NNI_LIST_FOREACH (&pub->pipes, pp) {
+			if (pp != last) {
+				rv = nni_msg_dup(&dup, msg);
+				if (rv != 0) {
+					continue;
+				}
+			} else {
+				dup = msg;
+			}
+			if ((rv = nni_msgq_tryput(pp->sendq, msg)) != 0) {
+				nni_msg_free(dup);
+			}
+		}
+		nni_mtx_unlock(&pub->mx);
+
+		if (last == NULL) {
+			nni_msg_free(msg);
+		}
+	}
+}
+
+
+static void
+nni_pub_pipe_send(void *arg)
+{
+	nni_pub_pipe *pp = arg;
+	nni_msgq *wq = pp->sendq;
+	nni_pipe *pipe = pp->pipe;
+	nni_msg *msg;
+	int rv;
+
+	for (;;) {
+		rv = nni_msgq_get_sig(wq, &msg, &pp->sigclose);
+		if (rv != 0) {
+			break;
+		}
+
+		rv = nni_pipe_send(pipe, msg);
+		if (rv != 0) {
+			nni_msg_free(msg);
+			break;
+		}
+	}
+	nni_pipe_close(pipe);
+}
+
+
+static void
+nni_pub_pipe_recv(void *arg)
+{
+	nni_pub_pipe *pp = arg;
+	nni_msgq *uwq = pp->pub->uwq;
+	nni_pipe *pipe = pp->pipe;
+	nni_msg *msg;
+	int rv;
+
+	// All we do is spin, waiting for the underlying transport to close.
+	// We discard anything we happen to get.
+	for (;;) {
+		rv = nni_pipe_recv(pipe, &msg);
+		if (rv != 0) {
+			break;
+		}
+		nni_msg_free(msg);
+	}
+
+	nni_msgq_signal(uwq, &pp->sigclose);
+	nni_msgq_signal(pp->sendq, &pp->sigclose);
+	nni_pipe_close(pipe);
+}
+
+
+static int
+nni_pub_setopt(void *arg, int opt, const void *buf, size_t sz)
+{
+	nni_pub_sock *pub = arg;
+	int rv;
+
+	switch (opt) {
+	case NNG_OPT_RAW:
+		nni_mtx_lock(&pub->mx);
+		rv = nni_setopt_int(&pub->raw, buf, sz, 0, 1);
+		nni_mtx_unlock(&pub->mx);
+		break;
+	default:
+		rv = NNG_ENOTSUP;
+	}
+	return (rv);
+}
+
+
+static int
+nni_pub_getopt(void *arg, int opt, void *buf, size_t *szp)
+{
+	nni_pub_sock *pub = arg;
+	int rv;
+
+	switch (opt) {
+	case NNG_OPT_RAW:
+		nni_mtx_lock(&pub->mx);
+		rv = nni_getopt_int(&pub->raw, buf, szp);
+		nni_mtx_unlock(&pub->mx);
+		break;
+	default:
+		rv = NNG_ENOTSUP;
+	}
+	return (rv);
+}
+
+
+// This is the global protocol structure -- our linkage to the core.
+// This should be the only global non-static symbol in this file.
+static nni_proto_pipe nni_pub_proto_pipe = {
+	.pipe_init	= nni_pub_pipe_init,
+	.pipe_fini	= nni_pub_pipe_fini,
+	.pipe_add	= nni_pub_pipe_add,
+	.pipe_rem	= nni_pub_pipe_rem,
+	.pipe_send	= nni_pub_pipe_send,
+	.pipe_recv	= nni_pub_pipe_recv,
+};
+
+nni_proto nni_pub_proto = {
+	.proto_self		= NNG_PROTO_PUB,
+	.proto_peer		= NNG_PROTO_SUB,
+	.proto_name		= "pub",
+	.proto_pipe		= &nni_pub_proto_pipe,
+	.proto_init		= nni_pub_init,
+	.proto_fini		= nni_pub_fini,
+	.proto_setopt		= nni_pub_setopt,
+	.proto_getopt		= nni_pub_getopt,
+	.proto_recv_filter	= NULL,
+	.proto_send_filter	= NULL,
+};