[PATCH wpan-tools 0/3] wpan-ping utility

[PATCH wpan-tools 0/3] wpan-ping utility

[Stefan Schmidt]

Hello.

I had something similar around for a while and it proofed useful for some basic
testing on the ieee 802154 level. It also can be used to see if we regress for
non-6lowpan use cases like short address and ieee802154 sockets.

The only two things missing from my point of view is support for extended
addresses and using recvfrom to avoid specifying the client address on server
side.

Stefan Schmidt (3):
  wpan-ping: Ping utility on IEEE 802.15.4 level
  wpan-ping: Add README for some basic usage descriptions.
  COPYRIGHT: Add my own copyright due to wpan-ping contribution

 COPYING                    |   1 +
 Makefile.am                |   3 +-
 configure.ac               |   1 +
 wpan-ping/Makefile.am      |   8 +
 wpan-ping/README.wpan-ping |  26 +++
 wpan-ping/wpan-ping.c      | 416 +++++++++++++++++++++++++++++++++++++++++++++
 6 files changed, 454 insertions(+), 1 deletion(-)
 create mode 100644 wpan-ping/Makefile.am
 create mode 100644 wpan-ping/README.wpan-ping
 create mode 100644 wpan-ping/wpan-ping.c

regards
Stefan Schmidt

-- 
2.1.0

[PATCH wpan-tools 1/3] wpan-ping: Ping utility on IEEE 802.15.4 level

[Stefan Schmidt]

wpan-ping aims to offer ping/ping6 like functionality on IEEE 802.15.4 level.

No control message protocol is defined so we will simply use DGRAM's over a
plain socket with a server component to emulate the behaviour. Right now it
is possible to specify packet count as well as size and the interface to be
used. So far it uses short addresses only. Support for extended addresses is
on the todo list.

Signed-off-by: Stefan Schmidt <stefan@osg.samsung.com>
---
 Makefile.am           |   3 +-
 configure.ac          |   1 +
 wpan-ping/Makefile.am |   6 +
 wpan-ping/wpan-ping.c | 416 ++++++++++++++++++++++++++++++++++++++++++++++++++
 4 files changed, 425 insertions(+), 1 deletion(-)
 create mode 100644 wpan-ping/Makefile.am
 create mode 100644 wpan-ping/wpan-ping.c

diff --git a/Makefile.am b/Makefile.am
index 06c72cd..2584cb2 100644
--- a/Makefile.am
+++ b/Makefile.am
@@ -20,4 +20,5 @@ AM_LDFLAGS = \
 	-Wl,--as-needed
 
 SUBDIRS = \
-	src
+	src \
+	wpan-ping
diff --git a/configure.ac b/configure.ac
index 81dc596..908e5ce 100644
--- a/configure.ac
+++ b/configure.ac
@@ -55,6 +55,7 @@ AC_CONFIG_HEADERS(config.h)
 AC_CONFIG_FILES([
         Makefile
 	src/Makefile
+	wpan-ping/Makefile
 ])
 
 AC_OUTPUT
diff --git a/wpan-ping/Makefile.am b/wpan-ping/Makefile.am
new file mode 100644
index 0000000..6b511a9
--- /dev/null
+++ b/wpan-ping/Makefile.am
@@ -0,0 +1,6 @@
+bin_PROGRAMS = wpan-ping
+
+wpan_ping_SOURCES = wpan-ping.c
+
+wpan_ping_CFLAGS = $(AM_CFLAGS) $(LIBNL3_CFLAGS)
+wpan_ping_LDADD = $(LIBNL3_LIBS)
diff --git a/wpan-ping/wpan-ping.c b/wpan-ping/wpan-ping.c
new file mode 100644
index 0000000..dbcc780
--- /dev/null
+++ b/wpan-ping/wpan-ping.c
@@ -0,0 +1,416 @@
+/*
+ * Linux IEEE 802.15.4 ping tool
+ *
+ * Copyright (C) 2015 Stefan Schmidt <stefan@datenfreihafen.org>
+ *
+ * Permission to use, copy, modify, and/or distribute this software for any
+ * purpose with or without fee is hereby granted, provided that the above
+ * copyright notice and this permission notice appear in all copies.
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
+ * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
+ * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
+ * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
+ * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
+ * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
+ * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
+ */
+
+#ifdef HAVE_CONFIG_H
+#include <config.h>
+#endif
+
+#include <errno.h>
+#include <net/if.h>
+#include <sys/ioctl.h>
+#include <sys/socket.h>
+#include <sys/time.h>
+#include <stdio.h>
+#include <stdint.h>
+#include <stdlib.h>
+#include <string.h>
+#include <unistd.h>
+#include <getopt.h>
+
+#include <netlink/netlink.h>
+
+#include <netlink/genl/genl.h>
+#include <netlink/genl/family.h>
+#include <netlink/genl/ctrl.h>
+#include <netlink/msg.h>
+#include <netlink/attr.h>
+
+#include "../src/nl802154.h"
+
+#define MIN_PAYLOAD_LEN 5
+#define MAX_PAYLOAD_LEN 115
+#define IEEE802154_ADDR_LEN 8
+
+enum {
+	IEEE802154_ADDR_NONE = 0x0,
+	IEEE802154_ADDR_SHORT = 0x2,
+	IEEE802154_ADDR_LONG = 0x3,
+};
+
+struct ieee802154_addr_sa {
+	int addr_type;
+	uint16_t pan_id;
+	union {
+		uint8_t hwaddr[IEEE802154_ADDR_LEN];
+		uint16_t short_addr;
+	};
+};
+
+struct sockaddr_ieee802154 {
+	sa_family_t family;
+	struct ieee802154_addr_sa addr;
+};
+
+#ifdef HAVE_GETOPT_LONG
+static const struct option perf_long_opts[] = {
+	{ "daemon", required_argument, NULL, 'd' },
+	{ "address", required_argument, NULL, 'a' },
+	{ "count", required_argument, NULL, 'c' },
+	{ "size", required_argument, NULL, 's' },
+	{ "interface", required_argument, NULL, 'i' },
+	{ "version", no_argument, NULL, 'v' },
+	{ "help", no_argument, NULL, 'h' },
+	{ NULL, 0, NULL, 0 },
+};
+#endif
+
+struct config {
+	char packet_len;
+	unsigned short packets;
+	uint16_t dst_addr;
+	uint16_t short_addr;
+	uint16_t pan_id;
+	char server;
+	char *interface;
+	struct nl_sock *nl_sock;
+	int nl802154_id;
+};
+
+extern char *optarg;
+
+void usage(const char *name) {
+	printf("Usage: %s OPTIONS\n"
+	"OPTIONS:\n"
+	"--daemon |-d client address\n"
+	"--address | -a server address\n"
+	"--count | -c number of packets\n"
+	"--size | -s packet length\n"
+	"--interface | -i listen on this interface (default wpan0)\n"
+	"--version | -v print out version\n"
+	"--help This usage text\n", name);
+}
+
+static int nl802154_init(struct config *conf)
+{
+	int err;
+
+	conf->nl_sock = nl_socket_alloc();
+	if (!conf->nl_sock) {
+		fprintf(stderr, "Failed to allocate netlink socket.\n");
+		return -ENOMEM;
+	}
+
+	nl_socket_set_buffer_size(conf->nl_sock, 8192, 8192);
+
+	if (genl_connect(conf->nl_sock)) {
+		fprintf(stderr, "Failed to connect to generic netlink.\n");
+		err = -ENOLINK;
+		goto out_handle_destroy;
+	}
+
+	conf->nl802154_id = genl_ctrl_resolve(conf->nl_sock, "nl802154");
+	if (conf->nl802154_id < 0) {
+		fprintf(stderr, "nl802154 not found.\n");
+		err = -ENOENT;
+		goto out_handle_destroy;
+	}
+
+	return 0;
+
+out_handle_destroy:
+	nl_socket_free(conf->nl_sock);
+	return err;
+}
+
+static void nl802154_cleanup(struct config *conf)
+{
+	nl_close(conf->nl_sock);
+	nl_socket_free(conf->nl_sock);
+}
+
+static int nl_msg_cb(struct nl_msg* msg, void* arg)
+{
+	struct config *conf = arg;
+	struct sockaddr_nl nla;
+	struct nlmsghdr *nlh = nlmsg_hdr(msg);
+	struct nlattr *attrs[NL802154_ATTR_MAX+1];
+
+	struct genlmsghdr *gnlh = (struct genlmsghdr*) nlmsg_data(nlh);
+
+	nla_parse(attrs, NL802154_ATTR_MAX, genlmsg_attrdata(gnlh, 0),
+		  genlmsg_attrlen(gnlh, 0), NULL);
+
+	if (!attrs[NL802154_ATTR_SHORT_ADDR] || !attrs[NL802154_ATTR_PAN_ID])
+		return NL_SKIP;
+
+	/* We only handle short addresses right now */
+	conf->short_addr = nla_get_u16(attrs[NL802154_ATTR_SHORT_ADDR]);
+	conf->pan_id = nla_get_u16(attrs[NL802154_ATTR_PAN_ID]);
+
+	return NL_SKIP;
+}
+
+static int get_interface_info(struct config *conf) {
+	struct nl_msg *msg;
+
+	nl802154_init(conf);
+
+	/* Build and send message */
+	nl_socket_modify_cb(conf->nl_sock, NL_CB_VALID, NL_CB_CUSTOM, nl_msg_cb, conf);
+	msg = nlmsg_alloc();
+	genlmsg_put(msg, NL_AUTO_PORT, NL_AUTO_SEQ, conf->nl802154_id, 0, NLM_F_DUMP, NL802154_CMD_GET_INTERFACE, 0);
+	nla_put_string(msg, NL802154_ATTR_IFNAME, "conf->interface");
+	nl_send_sync(conf->nl_sock, msg);
+
+	nl802154_cleanup(conf);
+	return 0;
+}
+
+static void dump_packet(unsigned char *buf, int len) {
+	int i;
+
+	fprintf(stdout, "Packet payload:");
+	for (i = 0; i < len; i++) {
+		printf(" %x", buf[i]);
+	}
+	printf("\n");
+}
+
+static int generate_packet(unsigned char *buf, struct config *conf, unsigned int seq_num) {
+	int i;
+
+	buf[0] = conf->packet_len;
+	buf[1] = seq_num >> 8; /* Upper byte */
+	buf[2] = seq_num & 0xFF; /* Lower byte */
+	for (i = 3; i < conf->packet_len; i++) {
+		buf[i] = 0xAB;
+	}
+
+	return 0;
+}
+
+static int measure_roundtrip(struct config *conf, int sd) {
+	unsigned char *buf;
+	struct timeval start_time, end_time, timeout;
+	long sec = 0, usec = 0;
+	long sec_max = 0, usec_max = 0;
+	long sec_min = 2147483647, usec_min = 2147483647;
+	long sum_sec = 0, sum_usec = 0;
+	int i, ret, count;
+	unsigned short seq_num;
+	float rtt_min = 0.0, rtt_avg = 0.0, rtt_max = 0.0;
+	float packet_loss = 100.0;
+
+	fprintf(stdout, "PING 0x%04x (PAN ID 0x%04x) %i data bytes\n",
+		conf->dst_addr, conf->pan_id, conf->packet_len);
+	buf = (unsigned char *)malloc(MAX_PAYLOAD_LEN);
+
+	/* 2 seconds packet receive timeout */
+	timeout.tv_sec = 2;
+	timeout.tv_usec = 0;
+	setsockopt(sd, SOL_SOCKET, SO_RCVTIMEO, (struct timeval *)&timeout,sizeof(struct timeval));
+
+	count = 0;
+	for (i = 0; i < conf->packets; i++) {
+		generate_packet(buf, conf, i);
+		seq_num = (buf[1] << 8)| buf[2];
+		send(sd, buf, conf->packet_len, 0);
+		gettimeofday(&start_time, NULL);
+		ret = recv(sd, buf, conf->packet_len, 0);
+		if (seq_num != ((buf[1] << 8)| buf[2])) {
+			printf("Sequenze number did not match\n");
+			continue;
+		}
+		if (ret > 0) {
+			gettimeofday(&end_time, NULL);
+			count++;
+			sec = end_time.tv_sec - start_time.tv_sec;
+			sum_sec += sec;
+			usec = end_time.tv_usec - start_time.tv_usec;
+			if (usec < 0) {
+				usec += 1000000;
+				sec--;
+				sum_sec--;
+			}
+
+			sum_usec += usec;
+			if (sec > sec_max)
+				sec_max = sec;
+			else if (sec < sec_min)
+				sec_min = sec;
+			if (usec > usec_max)
+				usec_max = usec;
+			else if (usec < usec_min)
+				usec_min = usec;
+			if (sec > 0)
+				fprintf(stdout, "Warning: packet return time over a second!\n");
+
+			fprintf(stdout, "%i bytes from 0x%04x seq=%i time=%.1f ms\n", ret,
+				conf->dst_addr, (int)seq_num, (float)usec/1000);
+		} else
+			fprintf(stderr, "Hit 2s packet timeout\n");
+	}
+
+	if (count)
+		packet_loss = 100 - ((100 * count)/conf->packets);
+
+	if (usec_min)
+		rtt_min = (float)usec_min/1000;
+	if (sum_usec && count)
+		rtt_avg = ((float)sum_usec/(float)count)/1000;
+	if (usec_max)
+		rtt_max = (float)usec_max/1000;
+
+	fprintf(stdout, "\n--- 0x%04x ping statistics ---\n", conf->dst_addr);
+	fprintf(stdout, "%i packets transmitted, %i received, %.0f%% packet loss\n",
+		conf->packets, count, packet_loss);
+	fprintf(stdout, "rtt min/avg/max = %.3f/%.3f/%.3f ms\n", rtt_min, rtt_avg, rtt_max);
+
+	free(buf);
+	return 0;
+}
+
+static void init_server(struct config *conf, int sd) {
+	ssize_t len;
+	unsigned char *buf;
+//	struct sockaddr_ieee802154 src;
+//	socklen_t addrlen;
+
+//	addrlen = sizeof(src);
+
+	len = 0;
+	fprintf(stdout, "Server mode. Waiting for packets...\n");
+	buf = (unsigned char *)malloc(MAX_PAYLOAD_LEN);
+
+	while (1) {
+		//len = recvfrom(sd, buf, MAX_PAYLOAD_LEN, 0, (struct sockaddr *)&src, &addrlen);
+		len = recv(sd, buf, MAX_PAYLOAD_LEN, 0);
+		//dump_packet(buf, len);
+		/* Send same packet back */
+		send(sd, buf, len, 0);
+	}
+	free(buf);
+}
+
+static int init_network(struct config *conf) {
+	int sd;
+	int ret;
+	struct sockaddr_ieee802154 a;
+
+	sd = socket(PF_IEEE802154, SOCK_DGRAM, 0);
+	if (sd < 0) {
+		perror("socket");
+		return 1;
+	}
+
+	get_interface_info(conf);
+
+	a.family = AF_IEEE802154;
+	a.addr.addr_type = IEEE802154_ADDR_SHORT;
+	a.addr.pan_id = conf->pan_id;
+
+	/* Bind socket on this side */
+	a.addr.short_addr = conf->short_addr;
+	ret = bind(sd, (struct sockaddr *)&a, sizeof(a));
+	if (ret) {
+		perror("bind");
+		return 1;
+	}
+
+	/* Connect to other side */
+	a.addr.short_addr = conf->dst_addr;
+	ret = connect(sd, (struct sockaddr *)&a, sizeof(a));
+	if (ret) {
+		perror("connect");
+		return 1;
+	}
+
+	if (conf->server)
+		init_server(conf, sd);
+
+	measure_roundtrip(conf, sd);
+
+	shutdown(sd, SHUT_RDWR);
+	close(sd);
+	return 0;
+}
+
+int main(int argc, char *argv[]) {
+	int c;
+	struct config *conf;
+
+	conf = (struct config *) malloc(sizeof(struct config));
+
+	/* Default to interface wpan0 if nothing else is given */
+	conf->interface = "wpan0";
+
+	/* Deafult to minimum packet size */
+	conf->packet_len = MIN_PAYLOAD_LEN;
+
+	if (argc < 2) {
+		usage(argv[0]);
+		exit(1);
+	}
+
+	while (1) {
+#ifdef HAVE_GETOPT_LONG
+		int opt_idx = -1;
+		c = getopt_long(argc, argv, "b:a:c:s:i:d:vh", perf_long_opts, &opt_idx);
+#else
+		c = getopt(argc, argv, "b:a:c:s:i:d:vh");
+#endif
+		if (c == -1)
+			break;
+		switch(c) {
+		case 'a':
+			conf->dst_addr = strtol(optarg, NULL, 16);
+			break;
+		case 'd':
+			conf->server = 1;
+			conf->dst_addr = strtol(optarg, NULL, 16);
+			break;
+		case 'c':
+			conf->packets = atoi(optarg);
+			break;
+		case 's':
+			conf->packet_len = atoi(optarg);
+			if (conf->packet_len >= MAX_PAYLOAD_LEN || conf->packet_len < MIN_PAYLOAD_LEN) {
+				printf("Packet size must be between %i and %i.\n",
+				       MIN_PAYLOAD_LEN, MAX_PAYLOAD_LEN - 1);
+				return 1;
+			}
+			break;
+		case 'i':
+			conf->interface = optarg;
+			break;
+		case 'v':
+			fprintf(stdout, "wpan-ping 0.1\n");
+			return 1;
+		case 'h':
+			usage(argv[0]);
+			return 1;
+		default:
+			usage(argv[0]);
+			return 1;
+		}
+	}
+
+	init_network(conf);
+	free(conf);
+	return 0;
+}
-- 
2.1.0

[PATCH wpan-tools 2/3] wpan-ping: Add README for some basic usage descriptions.

[Stefan Schmidt]

Signed-off-by: Stefan Schmidt <stefan@osg.samsung.com>
---
 wpan-ping/Makefile.am      |  2 ++
 wpan-ping/README.wpan-ping | 26 ++++++++++++++++++++++++++
 2 files changed, 28 insertions(+)
 create mode 100644 wpan-ping/README.wpan-ping

diff --git a/wpan-ping/Makefile.am b/wpan-ping/Makefile.am
index 6b511a9..6021c95 100644
--- a/wpan-ping/Makefile.am
+++ b/wpan-ping/Makefile.am
@@ -4,3 +4,5 @@ wpan_ping_SOURCES = wpan-ping.c
 
 wpan_ping_CFLAGS = $(AM_CFLAGS) $(LIBNL3_CFLAGS)
 wpan_ping_LDADD = $(LIBNL3_LIBS)
+
+EXTRA_DIST = README.wpan-ping
diff --git a/wpan-ping/README.wpan-ping b/wpan-ping/README.wpan-ping
new file mode 100644
index 0000000..4827e21
--- /dev/null
+++ b/wpan-ping/README.wpan-ping
@@ -0,0 +1,26 @@
+wpan-ping aims to offer ping/ping6 like functionality on a IEEE 802.15.4 level.
+
+No control message protocol is defined so we will simply use DGRAM's over a
+plain socket with a server component to emulate the behaviour.
+
+One can specify packet count (-c) as well as size (-s) and the interface to be
+used.
+
+Example usage server side:
+--------------------------
+./wpan-ping -d 0x0001 #0x0001 is the client short address
+Server mode. Waiting for packets...
+
+Example usage client side:
+--------------------------
+./wpan-ping -a 0x0003 -c 5 -s 114 #0x0003 is the server short address
+PING 0x0003 (PAN ID 0xbeef) 114 data bytes
+114 bytes from 0x0003 seq=0 time=22.0 ms
+114 bytes from 0x0003 seq=1 time=27.9 ms
+114 bytes from 0x0003 seq=2 time=21.3 ms
+114 bytes from 0x0003 seq=3 time=21.3 ms
+114 bytes from 0x0003 seq=4 time=20.3 ms
+
+--- 0x0003 ping statistics ---
+5 packets transmitted, 5 received, 0% packet loss
+rtt min/avg/max = 20.261/22.539/27.895 ms
-- 
2.1.0

[PATCH wpan-tools 3/3] COPYRIGHT: Add my own copyright due to wpan-ping contribution

[Stefan Schmidt]

Signed-off-by: Stefan Schmidt <stefan@osg.samsung.com>
---
 COPYING | 1 +
 1 file changed, 1 insertion(+)

diff --git a/COPYING b/COPYING
index 5cd3daa..f579f35 100644
--- a/COPYING
+++ b/COPYING
@@ -1,4 +1,5 @@
 Copyright (c) 2014		Alexander Aring
+Copyright (c) 2015		Stefan Schmidt
 
 
 Code is based on iw tool.
-- 
2.1.0

Re: [PATCH wpan-tools 0/3] wpan-ping utility

[Alexander Aring]

On Thu, Jun 04, 2015 at 03:25:20PM +0200, Stefan Schmidt wrote:
> Hello.
> 
> I had something similar around for a while and it proofed useful for some basic
> testing on the ieee 802154 level. It also can be used to see if we regress for
> non-6lowpan use cases like short address and ieee802154 sockets.
> 
> The only two things missing from my point of view is support for extended
> addresses and using recvfrom to avoid specifying the client address on server
> side.
> 

Applied, thanks.