diff rvinterf/lowlevel/pktfwd.c @ 0:e7502631a0f9

initial import from freecalypso-sw rev 1033:5ab737ac3ad7
author Mychaela Falconia <falcon@freecalypso.org>
date Sat, 11 Jun 2016 00:13:35 +0000
parents
children
line wrap: on
line diff
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/rvinterf/lowlevel/pktfwd.c	Sat Jun 11 00:13:35 2016 +0000
@@ -0,0 +1,62 @@
+/*
+ * This rvinterf module handles the forwarding of target->host packets
+ * to clients connected via the local socket interface.
+ */
+
+#include <sys/types.h>
+#include <stdio.h>
+#include <string.h>
+#include <strings.h>
+#include <stdlib.h>
+#include <unistd.h>
+#include "../include/pktmux.h"
+#include "../include/localsock.h"
+#include "client.h"
+
+extern u_char rxpkt[];
+extern size_t rxpkt_len;
+
+extern struct client *client_head;
+
+forward_pkt_to_client(cli)
+	struct client *cli;
+{
+	int len1;
+	u_char hdr[3];
+
+	len1 = rxpkt_len + 1;
+	hdr[0] = len1 >> 8;
+	hdr[1] = len1 & 0xFF;
+	hdr[2] = RVI2CLI_PKT_FROM_TARGET;
+	write(cli->fd, hdr, 3);
+	write(cli->fd, rxpkt, rxpkt_len);
+}
+
+forward_rv_trace()
+{
+	u32 useid;
+	struct client *cli;
+	int i, match;
+
+	useid = rxpkt[1] << 24 | rxpkt[2] << 16 | rxpkt[3] << 8 | rxpkt[4];
+	for (cli = client_head; cli; cli = cli->next) {
+		match = 0;
+		for (i = 0; i < cli->int_rvt_count; i++)
+			if ((useid & cli->int_rvt_mask[i]) ==
+			    cli->int_rvt_match[i]) {
+				match = 1;
+				break;
+			}
+		if (match)
+			forward_pkt_to_client(cli);
+	}
+}
+
+forward_nonrvt_pkt()
+{
+	struct client *cli;
+
+	for (cli = client_head; cli; cli = cli->next)
+		if (cli->int_proto[rxpkt[0] - 0x12])
+			forward_pkt_to_client(cli);
+}