diff rvinterf/lowlevel/pktfwd.c @ 178:7ab6b29e76bb

rvinterf: forwarding of Rx packets to clients implemented
author Michael Spacefalcon <msokolov@ivan.Harhan.ORG>
date Sat, 23 Nov 2013 22:15:16 +0000
parents
children 2f285f20d617
line wrap: on
line diff
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/rvinterf/lowlevel/pktfwd.c	Sat Nov 23 22:15:16 2013 +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 "../pktmux.h"
+#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);
+}