[thirdparty/iw.git] / interface.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"

static char *mntr_flags[NL80211_MNTR_FLAG_MAX + 1] = {
	"none",
	"fcsfail",
	"plcpfail",
	"control",
	"otherbss",
	"cook",
};

static int parse_mntr_flags(int *_argc, char ***_argv,
			    struct nl_msg *msg)
{
	struct nl_msg *flags;
	int err = -ENOBUFS;
	enum nl80211_mntr_flags flag;
	int argc = *_argc;
	char **argv = *_argv;

	flags = nlmsg_alloc();
	if (!flags)
		return -ENOMEM;

	while (argc) {
		int ok = 0;
		for (flag = __NL80211_MNTR_FLAG_INVALID;
		     flag <= NL80211_MNTR_FLAG_MAX; flag++) {
			if (strcmp(*argv, mntr_flags[flag]) == 0) {
				ok = 1;
				/*
				 * This shouldn't be adding "flag" if that is
				 * zero, but due to a problem in the kernel's
				 * nl80211 code (using NLA_NESTED policy) it
				 * will reject an empty nested attribute but
				 * not one that contains an invalid attribute
				 */
				NLA_PUT_FLAG(flags, flag);
				break;
			}
		}
		if (!ok) {
			err = -EINVAL;
			goto out;
		}
		argc--;
		argv++;
	}

	nla_put_nested(msg, NL80211_ATTR_MNTR_FLAGS, flags);
	err = 0;
 nla_put_failure:
 out:
	nlmsg_free(flags);

	*_argc = argc;
	*_argv = argv;

	return err;
}

/* return 0 if not found, 1 if ok, -1 on error */
static int get_if_type(int *argc, char ***argv, enum nl80211_iftype *type)
{
	char *tpstr;

	if (*argc < 2)
		return 0;

	if (strcmp((*argv)[0], "type"))
		return 0;

	tpstr = (*argv)[1];
	*argc -= 2;
	*argv += 2;

	if (strcmp(tpstr, "adhoc") == 0 ||
	    strcmp(tpstr, "ibss") == 0) {
		*type = NL80211_IFTYPE_ADHOC;
		return 1;
	} else if (strcmp(tpstr, "monitor") == 0) {
		*type = NL80211_IFTYPE_MONITOR;
		return 1;
	} else if (strcmp(tpstr, "master") == 0) {
		*type = NL80211_IFTYPE_UNSPECIFIED;
		fprintf(stderr, "See http://wireless.kernel.org/RTFM-AP.\n");
		return 2;
	} else if (strcmp(tpstr, "ap") == 0) {
		*type = NL80211_IFTYPE_UNSPECIFIED;
		fprintf(stderr, "See http://wireless.kernel.org/RTFM-AP.\n");
		return 2;
	} else if (strcmp(tpstr, "__ap") == 0) {
		*type = NL80211_IFTYPE_AP;
		return 1;
	} else if (strcmp(tpstr, "__ap_vlan") == 0) {
		*type = NL80211_IFTYPE_AP_VLAN;
		return 1;
	} else if (strcmp(tpstr, "wds") == 0) {
		*type = NL80211_IFTYPE_WDS;
		return 1;
	} else if (strcmp(tpstr, "managed") == 0 ||
		   strcmp(tpstr, "mgd") == 0 ||
		   strcmp(tpstr, "station") == 0) {
		*type = NL80211_IFTYPE_STATION;
		return 1;
	} else if (strcmp(tpstr, "mp") == 0 ||
		   strcmp(tpstr, "mesh") == 0) {
		*type = NL80211_IFTYPE_MESH_POINT;
		return 1;
	}


	fprintf(stderr, "invalid interface type %s\n", tpstr);
	return -1;
}

static int handle_interface_add(struct nl80211_state *state,
				struct nl_cb *cb,
				struct nl_msg *msg,
				int argc, char **argv)
{
	char *name;
	char *mesh_id = NULL;
	enum nl80211_iftype type;
	int tpset;

	if (argc < 1)
		return 1;

	name = argv[0];
	argc--;
	argv++;

	tpset = get_if_type(&argc, &argv, &type);
	if (tpset != 1)
		return tpset;

	if (argc) {
		if (strcmp(argv[0], "mesh_id") == 0) {
			argc--;
			argv++;

			if (!argc)
				return 1;
			mesh_id = argv[0];
			argc--;
			argv++;
		} else if (strcmp(argv[0], "flags") == 0) {
			argc--;
			argv++;
			if (parse_mntr_flags(&argc, &argv, msg)) {
				fprintf(stderr, "flags error\n");
				return 2;
			}
		} else {
			return 1;
		}
	}

	if (argc)
		return 1;

	NLA_PUT_STRING(msg, NL80211_ATTR_IFNAME, name);
	if (tpset)
		NLA_PUT_U32(msg, NL80211_ATTR_IFTYPE, type);
	if (mesh_id)
		NLA_PUT(msg, NL80211_ATTR_MESH_ID, strlen(mesh_id), mesh_id);

	return 0;
 nla_put_failure:
	return -ENOBUFS;
}
COMMAND(interface, add, "<name> type <type> [mesh_id <meshid>] [flags ...]",
	NL80211_CMD_NEW_INTERFACE, 0, CIB_PHY, handle_interface_add);
COMMAND(interface, add, "<name> type <type> [mesh_id <meshid>] [flags ...]",
	NL80211_CMD_NEW_INTERFACE, 0, CIB_NETDEV, handle_interface_add);

static int handle_interface_del(struct nl80211_state *state,
				struct nl_cb *cb,
				struct nl_msg *msg,
				int argc, char **argv)
{
	return 0;
}
TOPLEVEL(del, NULL, NL80211_CMD_DEL_INTERFACE, 0, CIB_NETDEV, handle_interface_del);
HIDDEN(interface, del, NULL, NL80211_CMD_DEL_INTERFACE, 0, CIB_NETDEV, handle_interface_del);

static int print_iface_handler(struct nl_msg *msg, void *arg)
{
	struct genlmsghdr *gnlh = nlmsg_data(nlmsg_hdr(msg));
	struct nlattr *tb_msg[NL80211_ATTR_MAX + 1];

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

	if (tb_msg[NL80211_ATTR_IFNAME])
		printf("Interface %s\n", nla_get_string(tb_msg[NL80211_ATTR_IFNAME]));
	if (tb_msg[NL80211_ATTR_IFINDEX])
		printf("\tifindex %d\n", nla_get_u32(tb_msg[NL80211_ATTR_IFINDEX]));
	if (tb_msg[NL80211_ATTR_IFTYPE])
		printf("\ttype %s\n", iftype_name(nla_get_u32(tb_msg[NL80211_ATTR_IFTYPE])));

	return NL_SKIP;
}

static int handle_interface_info(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_iface_handler, NULL);
	return 0;
}
TOPLEVEL(info, NULL, NL80211_CMD_GET_INTERFACE, 0, CIB_NETDEV, handle_interface_info);

static int handle_interface_set(struct nl80211_state *state,
				struct nl_cb *cb,
				struct nl_msg *msg,
				int argc, char **argv)
{
	if (!argc)
		return 1;

	NLA_PUT_U32(msg, NL80211_ATTR_IFTYPE, NL80211_IFTYPE_MONITOR);

	switch (parse_mntr_flags(&argc, &argv, msg)) {
	case 0:
		return 0;
	case -ENOMEM:
		fprintf(stderr, "failed to allocate flags\n");
		return 2;
	case -EINVAL:
		fprintf(stderr, "unknown flag %s\n", *argv);
		return 2;
	default:
		return 2;
	}
 nla_put_failure:
	return -ENOBUFS;
}
COMMAND(set, monitor, "<flag> [...]",
	NL80211_CMD_SET_INTERFACE, 0, CIB_NETDEV, handle_interface_set);

static int handle_interface_meshid(struct nl80211_state *state,
				   struct nl_cb *cb,
				   struct nl_msg *msg,
				   int argc, char **argv)
{
	char *mesh_id = NULL;

	if (argc != 1)
		return 1;

	mesh_id = argv[0];

	NLA_PUT(msg, NL80211_ATTR_MESH_ID, strlen(mesh_id), mesh_id);

	return 0;
 nla_put_failure:
	return -ENOBUFS;
}
COMMAND(set, meshid, "<meshid>",
	NL80211_CMD_SET_INTERFACE, 0, CIB_NETDEV, handle_interface_meshid);
Commit	Line	Data
2ef1be68	1	#include <net/if.h>
45c7212c	2	#include <errno.h>
d5ac8ad3	3	#include <string.h>
2ef1be68	4
45c7212c JB	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>
45c7212c	10
f408e01b	11	#include "nl80211.h"
45c7212c JB	12	#include "iw.h"
45c7212c JB	13
cd293761	14	static char *mntr_flags[NL80211_MNTR_FLAG_MAX + 1] = {
dd65496b	15	"none",
cd293761 JB	16	"fcsfail",
	17	"plcpfail",
	18	"control",
	19	"otherbss",
	20	"cook",
	21	};
	22
dd65496b JB	23	static int parse_mntr_flags(int _argc, char **_argv,
	24	struct nl_msg *msg)
	25	{
	26	struct nl_msg *flags;
	27	int err = -ENOBUFS;
	28	enum nl80211_mntr_flags flag;
	29	int argc = *_argc;
	30	char *argv = _argv;
	31
	32	flags = nlmsg_alloc();
	33	if (!flags)
	34	return -ENOMEM;
	35
	36	while (argc) {
	37	int ok = 0;
	38	for (flag = __NL80211_MNTR_FLAG_INVALID;
e14cc99e	39	flag <= NL80211_MNTR_FLAG_MAX; flag++) {
dd65496b JB	40	if (strcmp(*argv, mntr_flags[flag]) == 0) {
dd65496b JB	41	ok = 1;
4a3bf753 JB	42	/*
	43	* This shouldn't be adding "flag" if that is
	44	* zero, but due to a problem in the kernel's
	45	* nl80211 code (using NLA_NESTED policy) it
	46	* will reject an empty nested attribute but
	47	* not one that contains an invalid attribute
	48	*/
dd65496b JB	49	NLA_PUT_FLAG(flags, flag);
	50	break;
	51	}
	52	}
	53	if (!ok) {
	54	err = -EINVAL;
	55	goto out;
	56	}
	57	argc--;
	58	argv++;
	59	}
	60
	61	nla_put_nested(msg, NL80211_ATTR_MNTR_FLAGS, flags);
	62	err = 0;
	63	nla_put_failure:
	64	out:
	65	nlmsg_free(flags);
	66
	67	*_argc = argc;
	68	*_argv = argv;
	69
	70	return err;
	71	}
	72
45c7212c JB	73	/* return 0 if not found, 1 if ok, -1 on error */
	74	static int get_if_type(int argc, char *argv, enum nl80211_iftype type)
	75	{
	76	char *tpstr;
	77
	78	if (*argc < 2)
	79	return 0;
	80
	81	if (strcmp((*argv)[0], "type"))
	82	return 0;
	83
	84	tpstr = (*argv)[1];
	85	*argc -= 2;
	86	*argv += 2;
	87
	88	if (strcmp(tpstr, "adhoc") == 0 \|\|
	89	strcmp(tpstr, "ibss") == 0) {
	90	*type = NL80211_IFTYPE_ADHOC;
	91	return 1;
	92	} else if (strcmp(tpstr, "monitor") == 0) {
	93	*type = NL80211_IFTYPE_MONITOR;
	94	return 1;
c1d44a6c JB	95	} else if (strcmp(tpstr, "master") == 0) {
	96	*type = NL80211_IFTYPE_UNSPECIFIED;
	97	fprintf(stderr, "See http://wireless.kernel.org/RTFM-AP.\n");
	98	return 2;
	99	} else if (strcmp(tpstr, "ap") == 0) {
	100	*type = NL80211_IFTYPE_UNSPECIFIED;
	101	fprintf(stderr, "See http://wireless.kernel.org/RTFM-AP.\n");
	102	return 2;
4d3a72da	103	} else if (strcmp(tpstr, "__ap") == 0) {
45c7212c JB	104	*type = NL80211_IFTYPE_AP;
45c7212c JB	105	return 1;
4d3a72da	106	} else if (strcmp(tpstr, "__ap_vlan") == 0) {
45c7212c JB	107	*type = NL80211_IFTYPE_AP_VLAN;
	108	return 1;
	109	} else if (strcmp(tpstr, "wds") == 0) {
	110	*type = NL80211_IFTYPE_WDS;
	111	return 1;
a65df165 JB	112	} else if (strcmp(tpstr, "managed") == 0 \|\|
	113	strcmp(tpstr, "mgd") == 0 \|\|
	114	strcmp(tpstr, "station") == 0) {
45c7212c JB	115	*type = NL80211_IFTYPE_STATION;
45c7212c JB	116	return 1;
3d1e8704	117	} else if (strcmp(tpstr, "mp") == 0 \|\|
a65df165	118	strcmp(tpstr, "mesh") == 0) {
3d1e8704 LCC	119	*type = NL80211_IFTYPE_MESH_POINT;
3d1e8704 LCC	120	return 1;
45c7212c JB	121	}
	122
	123
	124	fprintf(stderr, "invalid interface type %s\n", tpstr);
	125	return -1;
	126	}
	127
7c37a24d JB	128	static int handle_interface_add(struct nl80211_state *state,
7c37a24d JB	129	struct nl_cb *cb,
bd396f2a JB	130	struct nl_msg *msg,
bd396f2a JB	131	int argc, char **argv)
45c7212c	132	{
2dfd6bfa	133	char *name;
3d1e8704	134	char *mesh_id = NULL;
45c7212c	135	enum nl80211_iftype type;
70391ccf	136	int tpset;
45c7212c	137
bd396f2a	138	if (argc < 1)
5e75fd04	139	return 1;
45c7212c	140
2dfd6bfa	141	name = argv[0];
45c7212c JB	142	argc--;
	143	argv++;
	144
2dfd6bfa	145	tpset = get_if_type(&argc, &argv, &type);
c1d44a6c JB	146	if (tpset != 1)
c1d44a6c JB	147	return tpset;
45c7212c	148
3d1e8704	149	if (argc) {
dd65496b JB	150	if (strcmp(argv[0], "mesh_id") == 0) {
	151	argc--;
	152	argv++;
	153
	154	if (!argc)
	155	return 1;
	156	mesh_id = argv[0];
	157	argc--;
	158	argv++;
	159	} else if (strcmp(argv[0], "flags") == 0) {
	160	argc--;
	161	argv++;
	162	if (parse_mntr_flags(&argc, &argv, msg)) {
	163	fprintf(stderr, "flags error\n");
	164	return 2;
	165	}
	166	} else {
5e75fd04	167	return 1;
dd65496b	168	}
3d1e8704 LCC	169	}
3d1e8704 LCC	170
5e75fd04 JB	171	if (argc)
5e75fd04 JB	172	return 1;
45c7212c	173
45c7212c JB	174	NLA_PUT_STRING(msg, NL80211_ATTR_IFNAME, name);
	175	if (tpset)
	176	NLA_PUT_U32(msg, NL80211_ATTR_IFTYPE, type);
3d1e8704 LCC	177	if (mesh_id)
3d1e8704 LCC	178	NLA_PUT(msg, NL80211_ATTR_MESH_ID, strlen(mesh_id), mesh_id);
45c7212c	179
70391ccf	180	return 0;
5e75fd04	181	nla_put_failure:
70391ccf	182	return -ENOBUFS;
45c7212c	183	}
dd65496b	184	COMMAND(interface, add, "<name> type <type> [mesh_id <meshid>] [flags ...]",
bd396f2a	185	NL80211_CMD_NEW_INTERFACE, 0, CIB_PHY, handle_interface_add);
dd65496b	186	COMMAND(interface, add, "<name> type <type> [mesh_id <meshid>] [flags ...]",
1cd3b6c6	187	NL80211_CMD_NEW_INTERFACE, 0, CIB_NETDEV, handle_interface_add);
45c7212c	188
7c37a24d JB	189	static int handle_interface_del(struct nl80211_state *state,
7c37a24d JB	190	struct nl_cb *cb,
bd396f2a JB	191	struct nl_msg *msg,
bd396f2a JB	192	int argc, char **argv)
3fcfe40e	193	{
70391ccf	194	return 0;
3fcfe40e	195	}
bd396f2a	196	TOPLEVEL(del, NULL, NL80211_CMD_DEL_INTERFACE, 0, CIB_NETDEV, handle_interface_del);
ce5af55c	197	HIDDEN(interface, del, NULL, NL80211_CMD_DEL_INTERFACE, 0, CIB_NETDEV, handle_interface_del);
3fcfe40e	198
541ef425 JB	199	static int print_iface_handler(struct nl_msg msg, void arg)
	200	{
	201	struct genlmsghdr *gnlh = nlmsg_data(nlmsg_hdr(msg));
	202	struct nlattr *tb_msg[NL80211_ATTR_MAX + 1];
	203
	204	nla_parse(tb_msg, NL80211_ATTR_MAX, genlmsg_attrdata(gnlh, 0),
	205	genlmsg_attrlen(gnlh, 0), NULL);
	206
	207	if (tb_msg[NL80211_ATTR_IFNAME])
	208	printf("Interface %s\n", nla_get_string(tb_msg[NL80211_ATTR_IFNAME]));
	209	if (tb_msg[NL80211_ATTR_IFINDEX])
	210	printf("\tifindex %d\n", nla_get_u32(tb_msg[NL80211_ATTR_IFINDEX]));
	211	if (tb_msg[NL80211_ATTR_IFTYPE])
	212	printf("\ttype %s\n", iftype_name(nla_get_u32(tb_msg[NL80211_ATTR_IFTYPE])));
	213
	214	return NL_SKIP;
	215	}
	216
7c37a24d JB	217	static int handle_interface_info(struct nl80211_state *state,
7c37a24d JB	218	struct nl_cb *cb,
bd396f2a JB	219	struct nl_msg *msg,
bd396f2a JB	220	int argc, char **argv)
541ef425	221	{
541ef425	222	nl_cb_set(cb, NL_CB_VALID, NL_CB_CUSTOM, print_iface_handler, NULL);
70391ccf	223	return 0;
541ef425	224	}
bd396f2a	225	TOPLEVEL(info, NULL, NL80211_CMD_GET_INTERFACE, 0, CIB_NETDEV, handle_interface_info);
cd293761	226
7c37a24d JB	227	static int handle_interface_set(struct nl80211_state *state,
7c37a24d JB	228	struct nl_cb *cb,
cd293761 JB	229	struct nl_msg *msg,
	230	int argc, char **argv)
	231	{
cd293761 JB	232	if (!argc)
	233	return 1;
	234
cd293761 JB	235	NLA_PUT_U32(msg, NL80211_ATTR_IFTYPE, NL80211_IFTYPE_MONITOR);
cd293761 JB	236
dd65496b JB	237	switch (parse_mntr_flags(&argc, &argv, msg)) {
	238	case 0:
	239	return 0;
	240	case -ENOMEM:
	241	fprintf(stderr, "failed to allocate flags\n");
	242	return 2;
	243	case -EINVAL:
	244	fprintf(stderr, "unknown flag %s\n", *argv);
	245	return 2;
	246	default:
	247	return 2;
cd293761	248	}
cd293761	249	nla_put_failure:
dd65496b	250	return -ENOBUFS;
cd293761 JB	251	}
	252	COMMAND(set, monitor, "<flag> [...]",
	253	NL80211_CMD_SET_INTERFACE, 0, CIB_NETDEV, handle_interface_set);
82d028d0	254
7c37a24d JB	255	static int handle_interface_meshid(struct nl80211_state *state,
7c37a24d JB	256	struct nl_cb *cb,
82d028d0 JB	257	struct nl_msg *msg,
	258	int argc, char **argv)
	259	{
	260	char *mesh_id = NULL;
	261
	262	if (argc != 1)
	263	return 1;
	264
	265	mesh_id = argv[0];
	266
	267	NLA_PUT(msg, NL80211_ATTR_MESH_ID, strlen(mesh_id), mesh_id);
	268
	269	return 0;
	270	nla_put_failure:
	271	return -ENOBUFS;
	272	}
	273	COMMAND(set, meshid, "<meshid>",
	274	NL80211_CMD_SET_INTERFACE, 0, CIB_NETDEV, handle_interface_meshid);