tools/dirtpan/: rewritten for simultaneous reception and transmission

Note that the PHY is still half-duplex, but we don't need to insist
on the entire packet reception/transmission to finish before letting
the peer have its say.

tools/dirtpan/dirtpan.c

@@ -11,6 +11,7 @@
  */
 
 
+#include <stdarg.h>
 #include <stdint.h>
 #include <stdlib.h>
 #include <stdio.h>
@@ -58,18 +59,12 @@ enum packet_type {
 #define	T_ACK_MS	50
 
 
-static enum state {
-	s_idle,
-	s_tx,
-	s_rx,
-} state = s_idle;
-
-
 static int tun, net;
-static uint8_t packet[MAX_PACKET+1];
+static uint8_t rx_packet[MAX_PACKET], tx_packet[MAX_PACKET+1];
-static void *pos;
+static void *rx_pos, *tx_pos;
-static int left;
+static int rx_left, tx_left;
-static int my_seq = 0, peer_seq;
+static int txing = 0, rxing = 0;
+static int rx_seq, tx_seq = 0;
 static int retries;
 static int debug = 0;
 
@@ -79,23 +74,8 @@ static int debug = 0;
 
 static void debug_label(const char *label)
 {
-	const char *t;
+	fprintf(stderr, "%s(%c%c)",
-
+	    label, txing ? 'T' : '-', rxing ? 'R' : '-');
-	switch (state) {
-	case s_idle:
-		t = "--";
-		break;
-	case s_tx:
-		t = "tx";
-		break;
-	case s_rx:
-		t = "rx";
-		break;
-	default:
-		t = "???";
-		break;
-	}
-	fprintf(stderr, "%s(%s)", label, t);
 }
 
 
@@ -163,36 +143,73 @@ static void debug_timeout(const char *label)
 /* ----- Timers ------------------------------------------------------------ */
 
 
-static struct timeval t0;
+static struct timeval t_reass, t_ack;
 
 
-static void start_timer(void)
+static void start_timer(struct timeval *t, int ms)
 {
-	gettimeofday(&t0, NULL);
+	assert(!t->tv_sec && !t->tv_usec);
+	gettimeofday(t, NULL);
+	t->tv_usec += 1000*ms;
+	while (t->tv_usec >= 1000000) {
+		t->tv_sec++;
+		t->tv_usec -= 1000000;
+	}
 }
 
 
-static struct timeval *timeout(int ms)
+static void stop_timer(struct timeval *t)
 {
-	static struct timeval t;
+	assert(t->tv_sec || t->tv_usec);
-
+	t->tv_sec = 0;
-	gettimeofday(&t, NULL);
+	t->tv_usec = 0;
-	t.tv_sec -= t0.tv_sec;
-	t.tv_usec -= t0.tv_usec;
-	t.tv_usec += 1000*ms;
-
-	while (t.tv_usec < 0) {
-		t.tv_sec--;
-		t.tv_usec += 1000000;
 }
-	while (t.tv_usec >= 1000000) {
-		t.tv_sec++;
-		t.tv_usec -= 1000000;
-	}
-	if (t.tv_sec < 0)
-		t.tv_sec = t.tv_usec = 0;
 
-	return &t;
+
+static const struct timeval *next_timer(int n, ...)
+{
+	va_list ap;
+	const struct timeval *next = NULL;
+	const struct timeval *t;
+
+	va_start(ap, n);
+	while (n--) {
+		t = va_arg(ap, const struct timeval *);
+		if (!t->tv_sec && !t->tv_usec)
+			continue;
+		if (next) {
+			if (next->tv_sec < t->tv_sec)
+				continue;
+			if (next->tv_sec == t->tv_sec &&
+			    next->tv_usec < t->tv_usec)
+				continue;
+		}
+		next = t;
+	}
+	va_end(ap);
+	return next;
+}
+
+
+static struct timeval *timer_delta(const struct timeval *t)
+{
+	static struct timeval d;
+
+	if (!t)
+		return NULL;
+
+	gettimeofday(&d, NULL);
+	d.tv_sec = t->tv_sec-d.tv_sec;
+	d.tv_usec = t->tv_usec-d.tv_usec;
+
+	while (d.tv_usec < 0) {
+		d.tv_sec--;
+		d.tv_usec += 1000000;
+	}
+	if (d.tv_sec < 0)
+		d.tv_sec = d.tv_usec = 0;
+
+	return &d;
 }
 
 
@@ -201,7 +218,7 @@ static struct timeval *timeout(int ms)
 
 static inline int send_size(void)
 {
-	return left > MAX_FRAG ? MAX_FRAG : left;
+	return tx_left > MAX_FRAG ? MAX_FRAG : tx_left;
 }
 
 
@@ -228,11 +245,11 @@ static void send_frame(void *buf, int size)
 
 static void send_more(void)
 {
-	uint8_t *p = pos-1;
+	uint8_t *p = tx_pos-1;
 
-	*p = (pos == packet+1 ? pt_first : pt_next) | (my_seq ? SEQ : 0);
+	*p = (tx_pos == tx_packet+1 ? pt_first : pt_next) | (tx_seq ? SEQ : 0);
 	send_frame(p, send_size()+1);
-	start_timer();
+	start_timer(&t_ack, T_ACK_MS);
 }
 
 
@@ -261,75 +278,67 @@ static void rx_pck(void *buf, int size)
 	type = ctrl & PT_MASK;
 	seq = !!(ctrl & SEQ);
 
-	if (type == pt_first || type == pt_next)
+	switch (type) {
+	case pt_first:
 		send_ack(seq);
-	switch (state) {
+		if (rxing) {
-	case s_tx:
+			stop_timer(&t_reass);
-		if (type == pt_first) {
+			rxing = 0;
-			/*
+		}
-			 * @@@ Not optimal - we break the tie but lose a
+		break;
-			 * perfectly good frame.
+	case pt_next:
-			 */
+		send_ack(seq);
-			state = s_idle;
+		if (!rxing)
+			return;
+		if (seq == rx_seq)
+			return; /* retransmission */
+		break;
+	case pt_ack:
+		if (!txing)
+			return;
+		if (seq != tx_seq)
+			return;
+		stop_timer(&t_ack);
+		tx_pos += send_size();
+		tx_left -= send_size();
+		if (!tx_left) {
+			txing = 0;
 			return;
 		}
-		if (type != pt_ack)
+		tx_seq = !tx_seq;
-			return;
-		if (seq != my_seq)
-			return;
-		pos += send_size();
-		left -= send_size();
-		if (!left) {
-			state = s_idle;
-			return;
-		}
-		my_seq = !my_seq;
 		retries = 0;
 		send_more();
 		return;
-	case s_rx:
-		if (type == pt_first) {
-			start_timer();
-			state = s_idle;
-			break;
-		}
-		if (type != pt_next)
-			return;
-		if (seq == peer_seq)
-			return; /* retransmission */
-		goto recv_more;
-	case s_idle:
-		if (type == pt_first)
-			break;
-		if (type == pt_next)
-			return;
-		return;
 	default:
 		abort();
 	}
 
+	if (!rxing) {
 		if (size < 5)
 			return;
-	left = p[3] << 8 | p[4];
+		rx_left = p[3] << 8 | p[4];
-	if (left > MAX_PACKET+1)
+		if (rx_left > MAX_PACKET)
 			return;
-	state = s_rx;
+		start_timer(&t_reass, T_REASS_MS);
-	pos = packet;
+		rxing = 1;
+		rx_pos = rx_packet;
+	}
 
-recv_more:
+	if (rx_left < size-1) {
-	if (left < size-1) {
+		stop_timer(&t_reass);
-		state = s_idle;
+		rxing = 0;
 		return;
 	}
-	memcpy(pos, buf+1, size-1);
+	memcpy(rx_pos, buf+1, size-1);
-	pos += size-1;
+	rx_pos += size-1;
-	left -= size-1;
+	rx_left -= size-1;
-	peer_seq = seq;
+	rx_seq = seq;
 
-	if (!left) {
+	if (!rx_left) {
-		debug_ip("<-", packet, pos-(void *) packet);
+		debug_ip("<-", rx_packet, rx_pos-(void *) rx_packet);
-		write_buf(tun, packet, pos-(void *) packet);
+		write_buf(tun, rx_packet, rx_pos-(void *) rx_packet);
-		state = s_idle;
+		stop_timer(&t_reass);
+		rxing = 0;
 	}
 }
 
@@ -339,17 +348,17 @@ static void tx_pck(void *buf, int size)
 	const uint8_t *p = buf;
 
 	debug_ip(">-", buf, size);
-	assert(state == s_idle);
+	assert(!txing);
-	state = s_tx;
+	txing = 1;
-	pos = packet+1;
+	tx_pos = tx_packet+1;
-	left = p[2] << 8 | p[3];
+	tx_left = p[2] << 8 | p[3];
-	assert(left <= MAX_PACKET);
+	assert(tx_left <= MAX_PACKET);
-	assert(left == size);
+	assert(tx_left == size);
 	/*
-	 * We could avoid the memcpy by reading directly into "packet"
+	 * @@@ We could avoid the memcpy by reading directly into "tx_packet"
 	 */
-	memcpy(pos, buf, size);
+	memcpy(tx_pos, buf, size);
-	my_seq = !my_seq;
+	tx_seq = !tx_seq;
 	retries = 0;
 	send_more();
 }
@@ -358,8 +367,10 @@ static void tx_pck(void *buf, int size)
 static void ack_timeout(void)
 {
 	debug_timeout("ACK-TO");
+	assert(txing);
+	stop_timer(&t_ack);
 	if (++retries == MAX_TRIES)
-		state = s_idle;
+		txing = 0;
 	else
 		send_more();
 }
@@ -368,7 +379,9 @@ static void ack_timeout(void)
 static void reass_timeout(void)
 {
 	debug_timeout("REASS-TO");
-	state = s_idle;
+	assert(rxing);
+	stop_timer(&t_reass);
+	rxing = 0;
 }
 
 
@@ -378,43 +391,32 @@ static void reass_timeout(void)
 static void event(void)
 {
 	uint8_t buf[MAX_PACKET];
-	struct timeval *to;
+	const struct timeval *to;
 	fd_set rset;
 	int res;
 	ssize_t got;
 
 	FD_ZERO(&rset);
 	FD_SET(net, &rset);
-	switch (state) {
+
-	case s_idle:
+	/* only accept more work if we're idle */
+	if (!txing && !rxing)
 		FD_SET(tun, &rset);
-		to = NULL;
+
-		break;
+	to = next_timer(2, &t_reass, &t_ack);
-	case s_rx:
+
-		to = timeout(T_REASS_MS);
+	res = select(net > tun ? net+1 : tun+1, &rset, NULL, NULL,
-		break;
+	    timer_delta(to));
-	case s_tx:
-		to = timeout(T_ACK_MS);
-		break;
-	default:
-		abort();
-	}
-	res = select(net > tun ? net+1 : tun+1, &rset, NULL, NULL, to);
 	if (res < 0) {
 		perror("select");
 		return;
 	}
 	if (!res) {
-		switch (state) {
+		assert(to);
-		case s_rx:
+		if (to == &t_reass)
 			reass_timeout();
-			break;
+		else
-		case s_tx:
 			ack_timeout();
-			break;
-		default:
-			abort();
-		}
 	}
 	if (FD_ISSET(tun, &rset)) {
 		got = read(tun, buf, sizeof(buf));