[thirdparty/iw.git] / station.c

#include <net/if.h>
#include <errno.h>
#include <string.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 "nl80211.h"
#include "iw.h"

SECTION(station);

enum plink_state {
	LISTEN,
	OPN_SNT,
	OPN_RCVD,
	CNF_RCVD,
	ESTAB,
	HOLDING,
	BLOCKED
};

enum plink_actions {
	PLINK_ACTION_UNDEFINED,
	PLINK_ACTION_OPEN,
	PLINK_ACTION_BLOCK,
};


static int print_sta_handler(struct nl_msg *msg, void *arg)
{
	struct nlattr *tb[NL80211_ATTR_MAX + 1];
	struct genlmsghdr *gnlh = nlmsg_data(nlmsg_hdr(msg));
	struct nlattr *sinfo[NL80211_STA_INFO_MAX + 1];
	struct nlattr *rinfo[NL80211_RATE_INFO_MAX + 1];
	char mac_addr[20], state_name[10], dev[20];
	static struct nla_policy stats_policy[NL80211_STA_INFO_MAX + 1] = {
		[NL80211_STA_INFO_INACTIVE_TIME] = { .type = NLA_U32 },
		[NL80211_STA_INFO_RX_BYTES] = { .type = NLA_U32 },
		[NL80211_STA_INFO_TX_BYTES] = { .type = NLA_U32 },
		[NL80211_STA_INFO_RX_PACKETS] = { .type = NLA_U32 },
		[NL80211_STA_INFO_TX_PACKETS] = { .type = NLA_U32 },
		[NL80211_STA_INFO_SIGNAL] = { .type = NLA_U8 },
		[NL80211_STA_INFO_TX_BITRATE] = { .type = NLA_NESTED },
		[NL80211_STA_INFO_LLID] = { .type = NLA_U16 },
		[NL80211_STA_INFO_PLID] = { .type = NLA_U16 },
		[NL80211_STA_INFO_PLINK_STATE] = { .type = NLA_U8 },
	};

	static struct nla_policy rate_policy[NL80211_RATE_INFO_MAX + 1] = {
		[NL80211_RATE_INFO_BITRATE] = { .type = NLA_U16 },
		[NL80211_RATE_INFO_MCS] = { .type = NLA_U8 },
		[NL80211_RATE_INFO_40_MHZ_WIDTH] = { .type = NLA_FLAG },
		[NL80211_RATE_INFO_SHORT_GI] = { .type = NLA_FLAG },
	};

	nla_parse(tb, NL80211_ATTR_MAX, genlmsg_attrdata(gnlh, 0),
		  genlmsg_attrlen(gnlh, 0), NULL);

	/*
	 * TODO: validate the interface and mac address!
	 * Otherwise, there's a race condition as soon as
	 * the kernel starts sending station notifications.
	 */

	if (!tb[NL80211_ATTR_STA_INFO]) {
		fprintf(stderr, "sta stats missing!");
		return NL_SKIP;
	}
	if (nla_parse_nested(sinfo, NL80211_STA_INFO_MAX,
			     tb[NL80211_ATTR_STA_INFO],
			     stats_policy)) {
		fprintf(stderr, "failed to parse nested attributes!");
		return NL_SKIP;
	}

	mac_addr_n2a(mac_addr, nla_data(tb[NL80211_ATTR_MAC]));
	if_indextoname(nla_get_u32(tb[NL80211_ATTR_IFINDEX]), dev);
	printf("Station %s (on %s)", mac_addr, dev);

	if (sinfo[NL80211_STA_INFO_INACTIVE_TIME])
		printf("\n\tinactive time:\t%u ms",
			nla_get_u32(sinfo[NL80211_STA_INFO_INACTIVE_TIME]));
	if (sinfo[NL80211_STA_INFO_RX_BYTES])
		printf("\n\trx bytes:\t%u",
			nla_get_u32(sinfo[NL80211_STA_INFO_RX_BYTES]));
	if (sinfo[NL80211_STA_INFO_RX_PACKETS])
		printf("\n\trx packets:\t%u",
			nla_get_u32(sinfo[NL80211_STA_INFO_RX_PACKETS]));
	if (sinfo[NL80211_STA_INFO_TX_BYTES])
		printf("\n\ttx bytes:\t%u",
			nla_get_u32(sinfo[NL80211_STA_INFO_TX_BYTES]));
	if (sinfo[NL80211_STA_INFO_TX_PACKETS])
		printf("\n\ttx packets:\t%u",
			nla_get_u32(sinfo[NL80211_STA_INFO_TX_PACKETS]));
	if (sinfo[NL80211_STA_INFO_SIGNAL])
		printf("\n\tsignal:  \t%d dBm",
			(int8_t)nla_get_u8(sinfo[NL80211_STA_INFO_SIGNAL]));

	if (sinfo[NL80211_STA_INFO_TX_BITRATE]) {
		if (nla_parse_nested(rinfo, NL80211_RATE_INFO_MAX,
				     sinfo[NL80211_STA_INFO_TX_BITRATE], rate_policy)) {
			fprintf(stderr, "failed to parse nested rate attributes!");
		} else {
			printf("\n\ttx bitrate:\t");
			if (rinfo[NL80211_RATE_INFO_BITRATE]) {
				int rate = nla_get_u16(rinfo[NL80211_RATE_INFO_BITRATE]);
				printf("%d.%d MBit/s", rate / 10, rate % 10);
			}

			if (rinfo[NL80211_RATE_INFO_MCS])
				printf(" MCS %d", nla_get_u8(rinfo[NL80211_RATE_INFO_MCS]));
			if (rinfo[NL80211_RATE_INFO_40_MHZ_WIDTH])
				printf(" 40Mhz");
			if (rinfo[NL80211_RATE_INFO_SHORT_GI])
				printf(" short GI");
		}
	}

	if (sinfo[NL80211_STA_INFO_LLID])
		printf("\n\tmesh llid:\t%d",
			nla_get_u16(sinfo[NL80211_STA_INFO_LLID]));
	if (sinfo[NL80211_STA_INFO_PLID])
		printf("\n\tmesh plid:\t%d",
			nla_get_u16(sinfo[NL80211_STA_INFO_PLID]));
	if (sinfo[NL80211_STA_INFO_PLINK_STATE]) {
		switch (nla_get_u8(sinfo[NL80211_STA_INFO_PLINK_STATE])) {
		case LISTEN:
			strcpy(state_name, "LISTEN");
			break;
		case OPN_SNT:
			strcpy(state_name, "OPN_SNT");
			break;
		case OPN_RCVD:
			strcpy(state_name, "OPN_RCVD");
			break;
		case CNF_RCVD:
			strcpy(state_name, "CNF_RCVD");
			break;
		case ESTAB:
			strcpy(state_name, "ESTAB");
			break;
		case HOLDING:
			strcpy(state_name, "HOLDING");
			break;
		case BLOCKED:
			strcpy(state_name, "BLOCKED");
			break;
		default:
			strcpy(state_name, "UNKNOWN");
			break;
		}
		printf("\n\tmesh plink:\t%s", state_name);
	}

	printf("\n");
	return NL_SKIP;
}

static int handle_station_get(struct nl80211_state *state,
			      struct nl_cb *cb,
			      struct nl_msg *msg,
			      int argc, char **argv)
{
	unsigned char mac_addr[ETH_ALEN];

	if (argc < 1)
		return 1;

	if (mac_addr_a2n(mac_addr, argv[0])) {
		fprintf(stderr, "invalid mac address\n");
		return 2;
	}

	argc--;
	argv++;

	if (argc)
		return 1;

	NLA_PUT(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr);

	nl_cb_set(cb, NL_CB_VALID, NL_CB_CUSTOM, print_sta_handler, NULL);

	return 0;
 nla_put_failure:
	return -ENOBUFS;
}
COMMAND(station, get, "<MAC address>",
	NL80211_CMD_GET_STATION, 0, CIB_NETDEV, handle_station_get,
	"Get information for a specific station.");
COMMAND(station, del, "<MAC address>",
	NL80211_CMD_DEL_STATION, 0, CIB_NETDEV, handle_station_get,
	"Remove the given station entry (use with caution!)");

static int handle_station_set(struct nl80211_state *state,
			      struct nl_cb *cb,
			      struct nl_msg *msg,
			      int argc, char **argv)
{
	unsigned char plink_action;
	unsigned char mac_addr[ETH_ALEN];

	if (argc < 3)
		return 1;

	if (mac_addr_a2n(mac_addr, argv[0])) {
		fprintf(stderr, "invalid mac address\n");
		return 2;
	}
	argc--;
	argv++;

	if (strcmp("plink_action", argv[0]) != 0)
		return 1;
	argc--;
	argv++;

	if (strcmp("open", argv[0]) == 0)
		plink_action = PLINK_ACTION_OPEN;
	else if (strcmp("block", argv[0]) == 0)
		plink_action = PLINK_ACTION_BLOCK;
	else {
		fprintf(stderr, "plink action not supported\n");
		return 2;
	}
	argc--;
	argv++;

	if (argc)
		return 1;

	NLA_PUT(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr);
	NLA_PUT_U8(msg, NL80211_ATTR_STA_PLINK_ACTION, plink_action);

	return 0;
 nla_put_failure:
	return -ENOBUFS;
}
COMMAND(station, set, "<MAC address> plink_action <open|block>",
	NL80211_CMD_SET_STATION, 0, CIB_NETDEV, handle_station_set,
	"Set mesh peer link action for this station (peer).");

static int handle_station_dump(struct nl80211_state *state,
			       struct nl_cb *cb,
			       struct nl_msg *msg,
			       int argc, char **argv)
{
	nl_cb_set(cb, NL_CB_VALID, NL_CB_CUSTOM, print_sta_handler, NULL);
	return 0;
}
COMMAND(station, dump, NULL,
	NL80211_CMD_GET_STATION, NLM_F_DUMP, CIB_NETDEV, handle_station_dump,
	"List all stations known, e.g. the AP on managed interfaces");
Commit	Line	Data
2ef1be68	1	#include <net/if.h>
3d1e8704	2	#include <errno.h>
d5ac8ad3	3	#include <string.h>
2ef1be68	4
3d1e8704 LCC	5	#include <netlink/genl/genl.h>
	6	#include <netlink/genl/family.h>
	7	#include <netlink/genl/ctrl.h>
	8	#include <netlink/msg.h>
	9	#include <netlink/attr.h>
3d1e8704	10
f408e01b	11	#include "nl80211.h"
3d1e8704 LCC	12	#include "iw.h"
3d1e8704 LCC	13
4698bfc2 JB	14	SECTION(station);
4698bfc2 JB	15
3d1e8704 LCC	16	enum plink_state {
	17	LISTEN,
	18	OPN_SNT,
	19	OPN_RCVD,
	20	CNF_RCVD,
	21	ESTAB,
	22	HOLDING,
	23	BLOCKED
	24	};
	25
	26	enum plink_actions {
	27	PLINK_ACTION_UNDEFINED,
	28	PLINK_ACTION_OPEN,
	29	PLINK_ACTION_BLOCK,
	30	};
	31
	32
3d1e8704 LCC	33	static int print_sta_handler(struct nl_msg msg, void arg)
	34	{
	35	struct nlattr *tb[NL80211_ATTR_MAX + 1];
	36	struct genlmsghdr *gnlh = nlmsg_data(nlmsg_hdr(msg));
	37	struct nlattr *sinfo[NL80211_STA_INFO_MAX + 1];
9cd3f1c1	38	struct nlattr *rinfo[NL80211_RATE_INFO_MAX + 1];
3d1e8704 LCC	39	char mac_addr[20], state_name[10], dev[20];
	40	static struct nla_policy stats_policy[NL80211_STA_INFO_MAX + 1] = {
	41	[NL80211_STA_INFO_INACTIVE_TIME] = { .type = NLA_U32 },
	42	[NL80211_STA_INFO_RX_BYTES] = { .type = NLA_U32 },
	43	[NL80211_STA_INFO_TX_BYTES] = { .type = NLA_U32 },
859677cb JB	44	[NL80211_STA_INFO_RX_PACKETS] = { .type = NLA_U32 },
859677cb JB	45	[NL80211_STA_INFO_TX_PACKETS] = { .type = NLA_U32 },
9cd3f1c1 HR	46	[NL80211_STA_INFO_SIGNAL] = { .type = NLA_U8 },
9cd3f1c1 HR	47	[NL80211_STA_INFO_TX_BITRATE] = { .type = NLA_NESTED },
3d1e8704 LCC	48	[NL80211_STA_INFO_LLID] = { .type = NLA_U16 },
	49	[NL80211_STA_INFO_PLID] = { .type = NLA_U16 },
	50	[NL80211_STA_INFO_PLINK_STATE] = { .type = NLA_U8 },
	51	};
	52
9cd3f1c1 HR	53	static struct nla_policy rate_policy[NL80211_RATE_INFO_MAX + 1] = {
	54	[NL80211_RATE_INFO_BITRATE] = { .type = NLA_U16 },
	55	[NL80211_RATE_INFO_MCS] = { .type = NLA_U8 },
	56	[NL80211_RATE_INFO_40_MHZ_WIDTH] = { .type = NLA_FLAG },
	57	[NL80211_RATE_INFO_SHORT_GI] = { .type = NLA_FLAG },
	58	};
	59
3d1e8704 LCC	60	nla_parse(tb, NL80211_ATTR_MAX, genlmsg_attrdata(gnlh, 0),
	61	genlmsg_attrlen(gnlh, 0), NULL);
	62
	63	/*
	64	* TODO: validate the interface and mac address!
	65	* Otherwise, there's a race condition as soon as
	66	* the kernel starts sending station notifications.
	67	*/
	68
	69	if (!tb[NL80211_ATTR_STA_INFO]) {
	70	fprintf(stderr, "sta stats missing!");
	71	return NL_SKIP;
	72	}
	73	if (nla_parse_nested(sinfo, NL80211_STA_INFO_MAX,
	74	tb[NL80211_ATTR_STA_INFO],
	75	stats_policy)) {
	76	fprintf(stderr, "failed to parse nested attributes!");
	77	return NL_SKIP;
	78	}
	79
	80	mac_addr_n2a(mac_addr, nla_data(tb[NL80211_ATTR_MAC]));
	81	if_indextoname(nla_get_u32(tb[NL80211_ATTR_IFINDEX]), dev);
fbb181fa	82	printf("Station %s (on %s)", mac_addr, dev);
3d1e8704 LCC	83
3d1e8704 LCC	84	if (sinfo[NL80211_STA_INFO_INACTIVE_TIME])
f5c9799c	85	printf("\n\tinactive time:\t%u ms",
3d1e8704 LCC	86	nla_get_u32(sinfo[NL80211_STA_INFO_INACTIVE_TIME]));
3d1e8704 LCC	87	if (sinfo[NL80211_STA_INFO_RX_BYTES])
f5c9799c	88	printf("\n\trx bytes:\t%u",
3d1e8704	89	nla_get_u32(sinfo[NL80211_STA_INFO_RX_BYTES]));
859677cb	90	if (sinfo[NL80211_STA_INFO_RX_PACKETS])
f5c9799c	91	printf("\n\trx packets:\t%u",
859677cb	92	nla_get_u32(sinfo[NL80211_STA_INFO_RX_PACKETS]));
3d1e8704	93	if (sinfo[NL80211_STA_INFO_TX_BYTES])
f5c9799c	94	printf("\n\ttx bytes:\t%u",
3d1e8704	95	nla_get_u32(sinfo[NL80211_STA_INFO_TX_BYTES]));
859677cb	96	if (sinfo[NL80211_STA_INFO_TX_PACKETS])
f5c9799c	97	printf("\n\ttx packets:\t%u",
859677cb	98	nla_get_u32(sinfo[NL80211_STA_INFO_TX_PACKETS]));
9cd3f1c1 HR	99	if (sinfo[NL80211_STA_INFO_SIGNAL])
	100	printf("\n\tsignal: \t%d dBm",
	101	(int8_t)nla_get_u8(sinfo[NL80211_STA_INFO_SIGNAL]));
	102
	103	if (sinfo[NL80211_STA_INFO_TX_BITRATE]) {
	104	if (nla_parse_nested(rinfo, NL80211_RATE_INFO_MAX,
	105	sinfo[NL80211_STA_INFO_TX_BITRATE], rate_policy)) {
	106	fprintf(stderr, "failed to parse nested rate attributes!");
	107	} else {
	108	printf("\n\ttx bitrate:\t");
	109	if (rinfo[NL80211_RATE_INFO_BITRATE]) {
	110	int rate = nla_get_u16(rinfo[NL80211_RATE_INFO_BITRATE]);
	111	printf("%d.%d MBit/s", rate / 10, rate % 10);
	112	}
	113
	114	if (rinfo[NL80211_RATE_INFO_MCS])
	115	printf(" MCS %d", nla_get_u8(rinfo[NL80211_RATE_INFO_MCS]));
	116	if (rinfo[NL80211_RATE_INFO_40_MHZ_WIDTH])
	117	printf(" 40Mhz");
	118	if (rinfo[NL80211_RATE_INFO_SHORT_GI])
	119	printf(" short GI");
	120	}
	121	}
	122
3d1e8704	123	if (sinfo[NL80211_STA_INFO_LLID])
fbb181fa	124	printf("\n\tmesh llid:\t%d",
3d1e8704 LCC	125	nla_get_u16(sinfo[NL80211_STA_INFO_LLID]));
3d1e8704 LCC	126	if (sinfo[NL80211_STA_INFO_PLID])
fbb181fa	127	printf("\n\tmesh plid:\t%d",
3d1e8704 LCC	128	nla_get_u16(sinfo[NL80211_STA_INFO_PLID]));
3d1e8704 LCC	129	if (sinfo[NL80211_STA_INFO_PLINK_STATE]) {
dbaabba1	130	switch (nla_get_u8(sinfo[NL80211_STA_INFO_PLINK_STATE])) {
3d1e8704 LCC	131	case LISTEN:
	132	strcpy(state_name, "LISTEN");
	133	break;
	134	case OPN_SNT:
	135	strcpy(state_name, "OPN_SNT");
	136	break;
	137	case OPN_RCVD:
	138	strcpy(state_name, "OPN_RCVD");
	139	break;
	140	case CNF_RCVD:
	141	strcpy(state_name, "CNF_RCVD");
	142	break;
	143	case ESTAB:
	144	strcpy(state_name, "ESTAB");
	145	break;
	146	case HOLDING:
	147	strcpy(state_name, "HOLDING");
	148	break;
	149	case BLOCKED:
	150	strcpy(state_name, "BLOCKED");
	151	break;
	152	default:
	153	strcpy(state_name, "UNKNOWN");
	154	break;
	155	}
fbb181fa	156	printf("\n\tmesh plink:\t%s", state_name);
3d1e8704 LCC	157	}
	158
	159	printf("\n");
	160	return NL_SKIP;
	161	}
	162
7c37a24d JB	163	static int handle_station_get(struct nl80211_state *state,
7c37a24d JB	164	struct nl_cb *cb,
b1ca19a8 JB	165	struct nl_msg *msg,
b1ca19a8 JB	166	int argc, char **argv)
3d1e8704	167	{
3d1e8704 LCC	168	unsigned char mac_addr[ETH_ALEN];
3d1e8704 LCC	169
b1ca19a8	170	if (argc < 1)
5e75fd04	171	return 1;
3d1e8704 LCC	172
	173	if (mac_addr_a2n(mac_addr, argv[0])) {
	174	fprintf(stderr, "invalid mac address\n");
5e75fd04	175	return 2;
3d1e8704 LCC	176	}
	177
	178	argc--;
	179	argv++;
	180
b1ca19a8	181	if (argc)
5e75fd04	182	return 1;
3d1e8704 LCC	183
3d1e8704 LCC	184	NLA_PUT(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr);
3d1e8704	185
3d1e8704	186	nl_cb_set(cb, NL_CB_VALID, NL_CB_CUSTOM, print_sta_handler, NULL);
3d1e8704	187
70391ccf	188	return 0;
3d1e8704	189	nla_put_failure:
70391ccf	190	return -ENOBUFS;
3d1e8704	191	}
b1ca19a8	192	COMMAND(station, get, "<MAC address>",
70cf4544 JB	193	NL80211_CMD_GET_STATION, 0, CIB_NETDEV, handle_station_get,
70cf4544 JB	194	"Get information for a specific station.");
b1ca19a8	195	COMMAND(station, del, "<MAC address>",
70cf4544 JB	196	NL80211_CMD_DEL_STATION, 0, CIB_NETDEV, handle_station_get,
70cf4544 JB	197	"Remove the given station entry (use with caution!)");
3d1e8704	198
7c37a24d JB	199	static int handle_station_set(struct nl80211_state *state,
7c37a24d JB	200	struct nl_cb *cb,
b1ca19a8 JB	201	struct nl_msg *msg,
b1ca19a8 JB	202	int argc, char **argv)
3d1e8704	203	{
3d1e8704 LCC	204	unsigned char plink_action;
	205	unsigned char mac_addr[ETH_ALEN];
	206
b1ca19a8	207	if (argc < 3)
5e75fd04	208	return 1;
3d1e8704 LCC	209
	210	if (mac_addr_a2n(mac_addr, argv[0])) {
	211	fprintf(stderr, "invalid mac address\n");
5e75fd04	212	return 2;
3d1e8704 LCC	213	}
	214	argc--;
	215	argv++;
	216
b1ca19a8 JB	217	if (strcmp("plink_action", argv[0]) != 0)
b1ca19a8 JB	218	return 1;
3d1e8704 LCC	219	argc--;
	220	argv++;
	221
	222	if (strcmp("open", argv[0]) == 0)
	223	plink_action = PLINK_ACTION_OPEN;
	224	else if (strcmp("block", argv[0]) == 0)
	225	plink_action = PLINK_ACTION_BLOCK;
	226	else {
	227	fprintf(stderr, "plink action not supported\n");
5e75fd04	228	return 2;
3d1e8704 LCC	229	}
	230	argc--;
	231	argv++;
	232
b1ca19a8	233	if (argc)
5e75fd04	234	return 1;
3d1e8704 LCC	235
3d1e8704 LCC	236	NLA_PUT(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr);
3d1e8704 LCC	237	NLA_PUT_U8(msg, NL80211_ATTR_STA_PLINK_ACTION, plink_action);
3d1e8704 LCC	238
70391ccf	239	return 0;
3d1e8704	240	nla_put_failure:
70391ccf	241	return -ENOBUFS;
3d1e8704	242	}
b1ca19a8	243	COMMAND(station, set, "<MAC address> plink_action <open\|block>",
70cf4544 JB	244	NL80211_CMD_SET_STATION, 0, CIB_NETDEV, handle_station_set,
70cf4544 JB	245	"Set mesh peer link action for this station (peer).");
b1ca19a8	246
7c37a24d JB	247	static int handle_station_dump(struct nl80211_state *state,
7c37a24d JB	248	struct nl_cb *cb,
b1ca19a8 JB	249	struct nl_msg *msg,
b1ca19a8 JB	250	int argc, char **argv)
3d1e8704	251	{
3d1e8704	252	nl_cb_set(cb, NL_CB_VALID, NL_CB_CUSTOM, print_sta_handler, NULL);
70391ccf	253	return 0;
3d1e8704	254	}
b1ca19a8	255	COMMAND(station, dump, NULL,
70cf4544 JB	256	NL80211_CMD_GET_STATION, NLM_F_DUMP, CIB_NETDEV, handle_station_dump,
70cf4544 JB	257	"List all stations known, e.g. the AP on managed interfaces");