X-Git-Url: https://git.piment-noir.org/?a=blobdiff_plain;f=lib%2Fpdu.c;h=4d487b71b0c692408dd606881294eaa229dde9b0;hb=8e003243fbec4cff4af3e9ca01ea713065336970;hp=8aefa5743d9d76f14f98b4d7e780d7ffb09d132a;hpb=98f5fee87dc8e02673c8793d697338b543eba8f8;p=deb_libnfs.git

diff --git a/lib/pdu.c b/lib/pdu.c
index 8aefa57..4d487b7 100644
--- a/lib/pdu.c
+++ b/lib/pdu.c
@@ -14,56 +14,114 @@
    You should have received a copy of the GNU Lesser General Public License
    along with this program; if not, see <http://www.gnu.org/licenses/>.
 */
+#ifdef HAVE_CONFIG_H
+#include "config.h"
+#endif
 
-#include <stdio.h>
+#ifdef AROS
+#include "aros_compat.h"
+#endif
+
+#ifdef WIN32
+#include "win32_compat.h"
+#endif
+
+#ifdef HAVE_NETINET_IN_H
+#include <netinet/in.h>
+#endif
+
+#ifdef HAVE_SYS_SOCKET_H
+#include <sys/socket.h>
+#endif
+
+#ifdef HAVE_STRINGS_H
 #include <strings.h>
+#endif
+
+#include <stdio.h>
 #include <stdlib.h>
-#include <rpc/rpc.h>
-#include <rpc/xdr.h>
-#include <rpc/rpc_msg.h>
+#include <string.h>
+#include <assert.h>
+#include <errno.h>
 #include "slist.h"
+#include "libnfs-zdr.h"
 #include "libnfs.h"
 #include "libnfs-raw.h"
 #include "libnfs-private.h"
 
-struct rpc_pdu *rpc_allocate_pdu(struct rpc_context *rpc, int program, int version, int procedure, rpc_cb cb, void *private_data, xdrproc_t xdr_decode_fn, int xdr_decode_bufsize)
+void rpc_reset_queue(struct rpc_queue *q)
+{
+	q->head = NULL;
+	q->tail = NULL;
+}
+
+/*
+ * Push to the tail end of the queue
+ */
+void rpc_enqueue(struct rpc_queue *q, struct rpc_pdu *pdu)
+{
+	if (q->head == NULL)
+		q->head = pdu;
+	else
+		q->tail->next = pdu;
+	q->tail = pdu;
+	pdu->next = NULL;
+}
+
+/*
+ * Push to the front/head of the queue
+ */
+void rpc_return_to_queue(struct rpc_queue *q, struct rpc_pdu *pdu)
+{
+	pdu->next = q->head;
+	q->head = pdu;
+	if (q->tail == NULL)
+		q->tail = pdu;
+}
+
+unsigned int rpc_hash_xid(uint32_t xid)
+{
+	return (xid * 7919) % HASHES;
+}
+
+struct rpc_pdu *rpc_allocate_pdu(struct rpc_context *rpc, int program, int version, int procedure, rpc_cb cb, void *private_data, zdrproc_t zdr_decode_fn, int zdr_decode_bufsize)
 {
 	struct rpc_pdu *pdu;
 	struct rpc_msg msg;
 
-	if (rpc == NULL) {
-		printf("trying to allocate rpc pdu on NULL context\n");
-		return NULL;
-	}
+	assert(rpc->magic == RPC_CONTEXT_MAGIC);
 
 	pdu = malloc(sizeof(struct rpc_pdu));
 	if (pdu == NULL) {
-		printf("Failed to allocate pdu structure\n");
+		rpc_set_error(rpc, "Out of memory: Failed to allocate pdu structure");
 		return NULL;
 	}
-	bzero(pdu, sizeof(struct rpc_pdu));
+	memset(pdu, 0, sizeof(struct rpc_pdu));
 	pdu->xid                = rpc->xid++;
 	pdu->cb                 = cb;
 	pdu->private_data       = private_data;
-	pdu->xdr_decode_fn      = xdr_decode_fn;
-	pdu->xdr_decode_bufsize = xdr_decode_bufsize;
-
-	xdrmem_create(&pdu->xdr, rpc->encodebuf, rpc->encodebuflen, XDR_ENCODE);
-	xdr_setpos(&pdu->xdr, 4); /* skip past the record marker */
-
-	bzero(&msg, sizeof(struct rpc_msg));
-	msg.rm_xid = pdu->xid;
-        msg.rm_direction = CALL;
-	msg.rm_call.cb_rpcvers = RPC_MSG_VERSION;
-	msg.rm_call.cb_prog = program;
-	msg.rm_call.cb_vers = version;
-	msg.rm_call.cb_proc = procedure;
-	msg.rm_call.cb_cred = rpc->auth->ah_cred;
-	msg.rm_call.cb_verf = rpc->auth->ah_verf;
-
-	if (xdr_callmsg(&pdu->xdr, &msg) == 0) {
-		printf("xdr_callmsg failed\n");
-		xdr_destroy(&pdu->xdr);
+	pdu->zdr_decode_fn      = zdr_decode_fn;
+	pdu->zdr_decode_bufsize = zdr_decode_bufsize;
+
+	zdrmem_create(&pdu->zdr, rpc->encodebuf, rpc->encodebuflen, ZDR_ENCODE);
+	if (rpc->is_udp == 0) {
+		zdr_setpos(&pdu->zdr, 4); /* skip past the record marker */
+	}
+
+	memset(&msg, 0, sizeof(struct rpc_msg));
+	msg.xid                = pdu->xid;
+        msg.direction          = CALL;
+	msg.body.cbody.rpcvers = RPC_MSG_VERSION;
+	msg.body.cbody.prog    = program;
+	msg.body.cbody.vers    = version;
+	msg.body.cbody.proc    = procedure;
+	msg.body.cbody.cred    = rpc->auth->ah_cred;
+	msg.body.cbody.verf    = rpc->auth->ah_verf;
+
+	if (zdr_callmsg(rpc, &pdu->zdr, &msg) == 0) {
+		rpc_set_error(rpc, "zdr_callmsg failed with %s",
+			      rpc_get_error(rpc));
+		zdr_destroy(&pdu->zdr);
 		free(pdu);
 		return NULL;
 	}
@@ -71,34 +129,59 @@ struct rpc_pdu *rpc_allocate_pdu(struct rpc_context *rpc, int program, int versi
 	return pdu;
 }
 
-void rpc_free_pdu(struct rpc_context *rpc _U_, struct rpc_pdu *pdu)
+void rpc_free_pdu(struct rpc_context *rpc, struct rpc_pdu *pdu)
 {
+	assert(rpc->magic == RPC_CONTEXT_MAGIC);
+
 	if (pdu->outdata.data != NULL) {
 		free(pdu->outdata.data);
 		pdu->outdata.data = NULL;
 	}
 
-	if (pdu->xdr_decode_buf != NULL) {
-		xdr_free(pdu->xdr_decode_fn, pdu->xdr_decode_buf);
-		free(pdu->xdr_decode_buf);
-		pdu->xdr_decode_buf = NULL;
+	if (pdu->zdr_decode_buf != NULL) {
+		zdr_free(pdu->zdr_decode_fn, pdu->zdr_decode_buf);
+		free(pdu->zdr_decode_buf);
+		pdu->zdr_decode_buf = NULL;
 	}
 
-	xdr_destroy(&pdu->xdr);
+	zdr_destroy(&pdu->zdr);
+
 	free(pdu);
 }
 
+void rpc_set_next_xid(struct rpc_context *rpc, uint32_t xid)
+{
+	rpc->xid = xid;
+}
 
 int rpc_queue_pdu(struct rpc_context *rpc, struct rpc_pdu *pdu)
 {
 	int size, recordmarker;
 
-	size = xdr_getpos(&pdu->xdr);
+	assert(rpc->magic == RPC_CONTEXT_MAGIC);
+
+	size = zdr_getpos(&pdu->zdr);
+
+	/* for udp we dont queue, we just send it straight away */
+	if (rpc->is_udp != 0) {
+		unsigned int hash;
+
+// XXX add a rpc->udp_dest_sock_size  and get rid of sys/socket.h and netinet/in.h
+		if (sendto(rpc->fd, rpc->encodebuf, size, MSG_DONTWAIT, rpc->udp_dest, sizeof(struct sockaddr_in)) < 0) {
+			rpc_set_error(rpc, "Sendto failed with errno %s", strerror(errno));
+			rpc_free_pdu(rpc, pdu);
+			return -1;
+		}
+
+		hash = rpc_hash_xid(pdu->xid);
+		rpc_enqueue(&rpc->waitpdu[hash], pdu);
+		return 0;
+	}
 
 	/* write recordmarker */
-	xdr_setpos(&pdu->xdr, 0);
+	zdr_setpos(&pdu->zdr, 0);
 	recordmarker = (size - 4) | 0x80000000;
-	xdr_int(&pdu->xdr, &recordmarker);
+	zdr_int(&pdu->zdr, &recordmarker);
 
 	pdu->outdata.size = size;
 	pdu->outdata.data = malloc(pdu->outdata.size);
@@ -109,7 +192,7 @@ int rpc_queue_pdu(struct rpc_context *rpc, struct rpc_pdu *pdu)
 	}
 
 	memcpy(pdu->outdata.data, rpc->encodebuf, pdu->outdata.size);
-	SLIST_ADD_END(&rpc->outqueue, pdu);
+	rpc_enqueue(&rpc->outqueue, pdu);
 
 	return 0;
 }
@@ -120,48 +203,53 @@ int rpc_get_pdu_size(char *buf)
 
 	size = ntohl(*(uint32_t *)buf);
 
-	if ((size & 0x80000000) == 0) {
-		printf("cant handle oncrpc fragments\n");
-		return -1;
-	}
-
 	return (size & 0x7fffffff) + 4;
 }
 
-static int rpc_process_reply(struct rpc_context *rpc, struct rpc_pdu *pdu, XDR *xdr)
+static int rpc_process_reply(struct rpc_context *rpc, struct rpc_pdu *pdu, ZDR *zdr)
 {
 	struct rpc_msg msg;
 
-	bzero(&msg, sizeof(struct rpc_msg));
-	msg.acpted_rply.ar_verf = _null_auth;
-	if (pdu->xdr_decode_bufsize > 0) {
-		pdu->xdr_decode_buf = malloc(pdu->xdr_decode_bufsize);
-		if (pdu->xdr_decode_buf == NULL) {
-			printf("xdr_replymsg failed in portmap_getport_reply\n");
-			pdu->cb(rpc, RPC_STATUS_ERROR, "Failed to allocate buffer for decoding of XDR reply", pdu->private_data);
+	assert(rpc->magic == RPC_CONTEXT_MAGIC);
+
+	memset(&msg, 0, sizeof(struct rpc_msg));
+	msg.body.rbody.reply.areply.verf = _null_auth;
+	if (pdu->zdr_decode_bufsize > 0) {
+		if (pdu->zdr_decode_buf != NULL) {
+			free(pdu->zdr_decode_buf);
+		}
+		pdu->zdr_decode_buf = malloc(pdu->zdr_decode_bufsize);
+		if (pdu->zdr_decode_buf == NULL) {
+			rpc_set_error(rpc, "Failed to allocate memory for "
+				      "zdr_encode_buf in rpc_process_reply");
+			pdu->cb(rpc, RPC_STATUS_ERROR, "Failed to allocate "
+				"buffer for decoding of ZDR reply",
+				pdu->private_data);
 			return 0;
 		}
-		bzero(pdu->xdr_decode_buf, pdu->xdr_decode_bufsize);
+		memset(pdu->zdr_decode_buf, 0, pdu->zdr_decode_bufsize);
 	}
-	msg.acpted_rply.ar_results.where = pdu->xdr_decode_buf;
-	msg.acpted_rply.ar_results.proc  = pdu->xdr_decode_fn;
-
-	if (xdr_replymsg(xdr, &msg) == 0) {
-		printf("xdr_replymsg failed in portmap_getport_reply\n");
-		pdu->cb(rpc, RPC_STATUS_ERROR, "Message rejected by server", pdu->private_data);
-		if (pdu->xdr_decode_buf != NULL) {
-			free(pdu->xdr_decode_buf);
-			pdu->xdr_decode_buf = NULL;
+	msg.body.rbody.reply.areply.reply_data.results.where = pdu->zdr_decode_buf;
+	msg.body.rbody.reply.areply.reply_data.results.proc  = pdu->zdr_decode_fn;
+
+	if (zdr_replymsg(rpc, zdr, &msg) == 0) {
+		rpc_set_error(rpc, "zdr_replymsg failed in rpc_process_reply: "
+			      "%s", rpc_get_error(rpc));
+		pdu->cb(rpc, RPC_STATUS_ERROR, "Message rejected by server",
+			pdu->private_data);
+		if (pdu->zdr_decode_buf != NULL) {
+			free(pdu->zdr_decode_buf);
+			pdu->zdr_decode_buf = NULL;
 		}
 		return 0;
 	}
-	if (msg.rm_reply.rp_stat != MSG_ACCEPTED) {
+	if (msg.body.rbody.stat != MSG_ACCEPTED) {
 		pdu->cb(rpc, RPC_STATUS_ERROR, "RPC Packet not accepted by the server", pdu->private_data);
 		return 0;
 	}
-	switch (msg.rm_reply.rp_acpt.ar_stat) {
+	switch (msg.body.rbody.reply.areply.stat) {
 	case SUCCESS:
-		pdu->cb(rpc, RPC_STATUS_SUCCESS, pdu->xdr_decode_buf, pdu->private_data);
+		pdu->cb(rpc, RPC_STATUS_SUCCESS, pdu->zdr_decode_buf, pdu->private_data);
 		break;
 	case PROG_UNAVAIL:
 		pdu->cb(rpc, RPC_STATUS_ERROR, "Server responded: Program not available", pdu->private_data);
@@ -188,41 +276,111 @@ static int rpc_process_reply(struct rpc_context *rpc, struct rpc_pdu *pdu, XDR *
 
 int rpc_process_pdu(struct rpc_context *rpc, char *buf, int size)
 {
-	struct rpc_pdu *pdu;
-	XDR xdr;
-	int pos, recordmarker;
-	unsigned int xid;
+	struct rpc_pdu *pdu, *prev_pdu;
+	struct rpc_queue *q;
+	ZDR zdr;
+	int pos, recordmarker = 0;
+	unsigned int hash;
+	uint32_t xid;
+	char *reasbuf = NULL;
+
+	assert(rpc->magic == RPC_CONTEXT_MAGIC);
+
+	memset(&zdr, 0, sizeof(ZDR));
+
+	zdrmem_create(&zdr, buf, size, ZDR_DECODE);
+	if (rpc->is_udp == 0) {
+		if (zdr_int(&zdr, &recordmarker) == 0) {
+			rpc_set_error(rpc, "zdr_int reading recordmarker failed");
+			zdr_destroy(&zdr);
+			return -1;
+		}
+		if (!(recordmarker&0x80000000)) {
+			zdr_destroy(&zdr);
+			if (rpc_add_fragment(rpc, buf+4, size-4) != 0) {
+				rpc_set_error(rpc, "Failed to queue fragment for reassembly.");
+				return -1;
+			}
+			return 0;
+		}
+	}
 
-	bzero(&xdr, sizeof(XDR));
+	/* reassembly */
+	if (recordmarker != 0 && rpc->fragments != NULL) {
+		struct rpc_fragment *fragment;
+		uint32_t total = size - 4;
+		char *ptr;
 
-	xdrmem_create(&xdr, buf, size, XDR_DECODE);
-	if (xdr_int(&xdr, &recordmarker) == 0) {
-		printf("xdr_int reading recordmarker failed\n");
-		xdr_destroy(&xdr);
-		return -1;
+		zdr_destroy(&zdr);
+		for (fragment = rpc->fragments; fragment; fragment = fragment->next) {
+			total += fragment->size;
+		}
+
+		reasbuf = malloc(total);
+		if (reasbuf == NULL) {
+			rpc_set_error(rpc, "Failed to reassemble PDU");
+			rpc_free_all_fragments(rpc);
+			return -1;
+		}
+		ptr = reasbuf;
+		for (fragment = rpc->fragments; fragment; fragment = fragment->next) {
+			memcpy(ptr, fragment->data, fragment->size);
+			ptr += fragment->size;
+		}
+		memcpy(ptr, buf + 4, size - 4);
+		zdrmem_create(&zdr, reasbuf, total, ZDR_DECODE);
+		rpc_free_all_fragments(rpc);
 	}
-	pos = xdr_getpos(&xdr);
-	if (xdr_int(&xdr, (int *)&xid) == 0) {
-		printf("xdr_int reading xid failed\n");
-		xdr_destroy(&xdr);
+
+	pos = zdr_getpos(&zdr);
+	if (zdr_int(&zdr, (int *)&xid) == 0) {
+		rpc_set_error(rpc, "zdr_int reading xid failed");
+		zdr_destroy(&zdr);
+		if (reasbuf != NULL) {
+			free(reasbuf);
+		}
 		return -1;
 	}
-	xdr_setpos(&xdr, pos);
+	zdr_setpos(&zdr, pos);
+
+	/* Look up the transaction in a hash table of our requests */
+	hash = rpc_hash_xid(xid);
+	q = &rpc->waitpdu[hash];
 
-	for (pdu=rpc->waitpdu; pdu; pdu=pdu->next) {
+	/* Follow the hash chain.  Linear traverse singly-linked list,
+	 * but track previous entry for optimised removal */
+	prev_pdu = NULL;
+	for (pdu=q->head; pdu; pdu=pdu->next) {
 		if (pdu->xid != xid) {
+			prev_pdu = pdu;
 			continue;
 		}
-		SLIST_REMOVE(&rpc->waitpdu, pdu);
-		if (rpc_process_reply(rpc, pdu, &xdr) != 0) {
-			printf("rpc_procdess_reply failed\n");
+		if (rpc->is_udp == 0 || rpc->is_broadcast == 0) {
+			/* Singly-linked but we track head and tail */
+			if (pdu == q->head)
+				q->head = pdu->next;
+			if (pdu == q->tail)
+				q->tail = prev_pdu;
+			if (prev_pdu != NULL)
+				prev_pdu->next = pdu->next;
+		}
+		if (rpc_process_reply(rpc, pdu, &zdr) != 0) {
+			rpc_set_error(rpc, "rpc_procdess_reply failed");
+		}
+		zdr_destroy(&zdr);
+		if (rpc->is_udp == 0 || rpc->is_broadcast == 0) {
+			rpc_free_pdu(rpc, pdu);
+		}
+		if (reasbuf != NULL) {
+			free(reasbuf);
 		}
-		xdr_destroy(&xdr);
-		rpc_free_pdu(rpc, pdu);
 		return 0;
 	}
-	printf("No matching pdu found for xid:%d\n", xid);
-	xdr_destroy(&xdr);
+	rpc_set_error(rpc, "No matching pdu found for xid:%d", xid);
+	zdr_destroy(&zdr);
+	if (reasbuf != NULL) {
+		free(reasbuf);
+	}
 	return -1;
 }