[thirdparty/iw.git] / ibss.c

#ifndef _POSIX_SOURCE
#define _POSIX_SOURCE
#endif
#include <errno.h>
#include <string.h>
#include <strings.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(ibss);

static int join_ibss(struct nl80211_state *state,
		     struct nl_cb *cb,
		     struct nl_msg *msg,
		     int argc, char **argv,
		     enum id_input id)
{
	char *end;
	unsigned char abssid[6];
	unsigned char rates[NL80211_MAX_SUPP_RATES];
	int n_rates = 0;
	char *value = NULL, *sptr = NULL;
	float rate;
	int bintval;
	int i;
	unsigned long freq;
	static const struct {
		const char *name;
		unsigned int width;
		int freq1_diff;
		int chantype; /* for older kernel */
	} *chanmode_selected = NULL, chanmode[] = {
		{ .name = "HT20",
		  .width = NL80211_CHAN_WIDTH_20,
		  .freq1_diff = 0,
		  .chantype = NL80211_CHAN_HT20 },
		{ .name = "HT40+",
		  .width = NL80211_CHAN_WIDTH_40,
		  .freq1_diff = 10,
		  .chantype = NL80211_CHAN_HT40PLUS },
		{ .name = "HT40-",
		  .width = NL80211_CHAN_WIDTH_40,
		  .freq1_diff = -10,
		  .chantype = NL80211_CHAN_HT40MINUS },
		{ .name = "NOHT",
		  .width = NL80211_CHAN_WIDTH_20_NOHT,
		  .freq1_diff = 0,
		  .chantype = NL80211_CHAN_NO_HT },
		{ .name = "5MHZ",
		  .width = NL80211_CHAN_WIDTH_5,
		  .freq1_diff = 0,
		  .chantype = -1 },
		{ .name = "10MHZ",
		  .width = NL80211_CHAN_WIDTH_10,
		  .freq1_diff = 0,
		  .chantype = -1 },
	};

	if (argc < 2)
		return 1;

	/* SSID */
	NLA_PUT(msg, NL80211_ATTR_SSID, strlen(argv[0]), argv[0]);
	argv++;
	argc--;

	/* freq */
	freq = strtoul(argv[0], &end, 10);
	if (*end != '\0')
		return 1;

	NLA_PUT_U32(msg, NL80211_ATTR_WIPHY_FREQ, freq);
	argv++;
	argc--;

	if (argc) {
		for (i = 0; i < ARRAY_SIZE(chanmode); i++) {
			if (strcasecmp(chanmode[i].name, argv[0]) == 0) {
				chanmode_selected = &chanmode[i];
				break;
			}
		}
		if (chanmode_selected) {
			NLA_PUT_U32(msg, NL80211_ATTR_CHANNEL_WIDTH,
				    chanmode_selected->width);
			NLA_PUT_U32(msg, NL80211_ATTR_CENTER_FREQ1,
				    freq + chanmode_selected->freq1_diff);
			if (chanmode_selected->chantype != -1)
				NLA_PUT_U32(msg,
					    NL80211_ATTR_WIPHY_CHANNEL_TYPE,
					    chanmode_selected->chantype);

			argv++;
			argc--;
		}

	}

	if (argc && strcmp(argv[0], "fixed-freq") == 0) {
		NLA_PUT_FLAG(msg, NL80211_ATTR_FREQ_FIXED);
		argv++;
		argc--;
	}

	if (argc) {
		if (mac_addr_a2n(abssid, argv[0]) == 0) {
			NLA_PUT(msg, NL80211_ATTR_MAC, 6, abssid);
			argv++;
			argc--;
		}
	}

	if (argc > 1 && strcmp(argv[0], "beacon-interval") == 0) {
		argv++;
		argc--;
		bintval = strtoul(argv[0], &end, 10);
		if (*end != '\0')
			return 1;
		NLA_PUT_U32(msg, NL80211_ATTR_BEACON_INTERVAL, bintval);
		argv++;
		argc--;
	}

	/* basic rates */
	if (argc > 1 && strcmp(argv[0], "basic-rates") == 0) {
		argv++;
		argc--;

		value = strtok_r(argv[0], ",", &sptr);

		while (value && n_rates < NL80211_MAX_SUPP_RATES) {
			rate = strtod(value, &end);
			rates[n_rates] = rate * 2;

			/* filter out suspicious values  */
			if (*end != '\0' || !rates[n_rates] ||
			    rate*2 != rates[n_rates])
				return 1;

			n_rates++;
			value = strtok_r(NULL, ",", &sptr);
		}

		NLA_PUT(msg, NL80211_ATTR_BSS_BASIC_RATES, n_rates, rates);

		argv++;
		argc--;
	}

	/* multicast rate */
	if (argc > 1 && strcmp(argv[0], "mcast-rate") == 0) {
		argv++;
		argc--;

		rate = strtod(argv[0], &end);
		if (*end != '\0')
			return 1;

		NLA_PUT_U32(msg, NL80211_ATTR_MCAST_RATE, (int)(rate * 10));
		argv++;
		argc--;
	}

	if (!argc)
		return 0;

	if (strcmp(*argv, "key") != 0 && strcmp(*argv, "keys") != 0)
		return 1;

	argv++;
	argc--;

	return parse_keys(msg, argv, argc);
 nla_put_failure:
	return -ENOSPC;
}

static int leave_ibss(struct nl80211_state *state,
		      struct nl_cb *cb,
		      struct nl_msg *msg,
		      int argc, char **argv,
		      enum id_input id)
{
	return 0;
}
COMMAND(ibss, leave, NULL,
	NL80211_CMD_LEAVE_IBSS, 0, CIB_NETDEV, leave_ibss,
	"Leave the current IBSS cell.");
COMMAND(ibss, join,
	"<SSID> <freq in MHz> [HT20|HT40+|HT40-|NOHT|5MHZ|10MHZ] [fixed-freq] [<fixed bssid>] [beacon-interval <TU>]"
	" [basic-rates <rate in Mbps,rate2,...>] [mcast-rate <rate in Mbps>] "
	"[key d:0:abcde]",
	NL80211_CMD_JOIN_IBSS, 0, CIB_NETDEV, join_ibss,
	"Join the IBSS cell with the given SSID, if it doesn't exist create\n"
	"it on the given frequency. When fixed frequency is requested, don't\n"
	"join/create a cell on a different frequency. When a fixed BSSID is\n"
	"requested use that BSSID and do not adopt another cell's BSSID even\n"
	"if it has higher TSF and the same SSID. If an IBSS is created, create\n"
	"it with the specified basic-rates, multicast-rate and beacon-interval.");
Commit	Line	Data
b893686f JB	1	#ifndef _POSIX_SOURCE
	2	#define _POSIX_SOURCE
	3	#endif
edea4d14	4	#include <errno.h>
b893686f	5	#include <string.h>
135cb523	6	#include <strings.h>
edea4d14 JB	7
	8	#include <netlink/genl/genl.h>
	9	#include <netlink/genl/family.h>
	10	#include <netlink/genl/ctrl.h>
	11	#include <netlink/msg.h>
	12	#include <netlink/attr.h>
	13
	14	#include "nl80211.h"
	15	#include "iw.h"
	16
4698bfc2 JB	17	SECTION(ibss);
4698bfc2 JB	18
edea4d14 JB	19	static int join_ibss(struct nl80211_state *state,
	20	struct nl_cb *cb,
	21	struct nl_msg *msg,
05514f95 JB	22	int argc, char **argv,
05514f95 JB	23	enum id_input id)
edea4d14	24	{
95940df3	25	char *end;
edea4d14	26	unsigned char abssid[6];
6a24bb22 TP	27	unsigned char rates[NL80211_MAX_SUPP_RATES];
	28	int n_rates = 0;
	29	char value = NULL, sptr = NULL;
	30	float rate;
ec46ba52	31	int bintval;
135cb523	32	int i;
85da7703	33	unsigned long freq;
135cb523 SW	34	static const struct {
135cb523 SW	35	const char *name;
85da7703 SW	36	unsigned int width;
	37	int freq1_diff;
	38	int chantype; /* for older kernel */
	39	} *chanmode_selected = NULL, chanmode[] = {
	40	{ .name = "HT20",
	41	.width = NL80211_CHAN_WIDTH_20,
	42	.freq1_diff = 0,
	43	.chantype = NL80211_CHAN_HT20 },
	44	{ .name = "HT40+",
	45	.width = NL80211_CHAN_WIDTH_40,
	46	.freq1_diff = 10,
	47	.chantype = NL80211_CHAN_HT40PLUS },
	48	{ .name = "HT40-",
	49	.width = NL80211_CHAN_WIDTH_40,
	50	.freq1_diff = -10,
	51	.chantype = NL80211_CHAN_HT40MINUS },
	52	{ .name = "NOHT",
	53	.width = NL80211_CHAN_WIDTH_20_NOHT,
	54	.freq1_diff = 0,
	55	.chantype = NL80211_CHAN_NO_HT },
	56	{ .name = "5MHZ",
	57	.width = NL80211_CHAN_WIDTH_5,
	58	.freq1_diff = 0,
	59	.chantype = -1 },
	60	{ .name = "10MHZ",
	61	.width = NL80211_CHAN_WIDTH_10,
	62	.freq1_diff = 0,
	63	.chantype = -1 },
135cb523	64	};
edea4d14	65
95940df3 JB	66	if (argc < 2)
95940df3 JB	67	return 1;
edea4d14	68
95940df3 JB	69	/* SSID */
95940df3 JB	70	NLA_PUT(msg, NL80211_ATTR_SSID, strlen(argv[0]), argv[0]);
edea4d14 JB	71	argv++;
	72	argc--;
	73
95940df3	74	/* freq */
85da7703	75	freq = strtoul(argv[0], &end, 10);
95940df3 JB	76	if (*end != '\0')
95940df3 JB	77	return 1;
85da7703 SW	78
85da7703 SW	79	NLA_PUT_U32(msg, NL80211_ATTR_WIPHY_FREQ, freq);
95940df3 JB	80	argv++;
95940df3 JB	81	argc--;
edea4d14	82
135cb523	83	if (argc) {
85da7703 SW	84	for (i = 0; i < ARRAY_SIZE(chanmode); i++) {
	85	if (strcasecmp(chanmode[i].name, argv[0]) == 0) {
	86	chanmode_selected = &chanmode[i];
135cb523 SW	87	break;
	88	}
	89	}
85da7703 SW	90	if (chanmode_selected) {
	91	NLA_PUT_U32(msg, NL80211_ATTR_CHANNEL_WIDTH,
	92	chanmode_selected->width);
	93	NLA_PUT_U32(msg, NL80211_ATTR_CENTER_FREQ1,
	94	freq + chanmode_selected->freq1_diff);
	95	if (chanmode_selected->chantype != -1)
	96	NLA_PUT_U32(msg,
	97	NL80211_ATTR_WIPHY_CHANNEL_TYPE,
	98	chanmode_selected->chantype);
	99
135cb523 SW	100	argv++;
	101	argc--;
	102	}
	103
	104	}
	105
95940df3 JB	106	if (argc && strcmp(argv[0], "fixed-freq") == 0) {
	107	NLA_PUT_FLAG(msg, NL80211_ATTR_FREQ_FIXED);
	108	argv++;
	109	argc--;
edea4d14 JB	110	}
edea4d14 JB	111
95940df3	112	if (argc) {
51e9bd80 JB	113	if (mac_addr_a2n(abssid, argv[0]) == 0) {
	114	NLA_PUT(msg, NL80211_ATTR_MAC, 6, abssid);
	115	argv++;
	116	argc--;
	117	}
edea4d14 JB	118	}
edea4d14 JB	119
ec46ba52 BR	120	if (argc > 1 && strcmp(argv[0], "beacon-interval") == 0) {
	121	argv++;
	122	argc--;
	123	bintval = strtoul(argv[0], &end, 10);
	124	if (*end != '\0')
	125	return 1;
	126	NLA_PUT_U32(msg, NL80211_ATTR_BEACON_INTERVAL, bintval);
	127	argv++;
	128	argc--;
	129	}
	130
6a24bb22 TP	131	/* basic rates */
	132	if (argc > 1 && strcmp(argv[0], "basic-rates") == 0) {
	133	argv++;
	134	argc--;
	135
	136	value = strtok_r(argv[0], ",", &sptr);
	137
	138	while (value && n_rates < NL80211_MAX_SUPP_RATES) {
	139	rate = strtod(value, &end);
	140	rates[n_rates] = rate * 2;
	141
	142	/* filter out suspicious values */
	143	if (*end != '\0' \|\| !rates[n_rates] \|\|
	144	rate*2 != rates[n_rates])
	145	return 1;
	146
	147	n_rates++;
	148	value = strtok_r(NULL, ",", &sptr);
	149	}
	150
	151	NLA_PUT(msg, NL80211_ATTR_BSS_BASIC_RATES, n_rates, rates);
	152
	153	argv++;
	154	argc--;
	155	}
	156
506b442b FF	157	/* multicast rate */
	158	if (argc > 1 && strcmp(argv[0], "mcast-rate") == 0) {
	159	argv++;
	160	argc--;
	161
	162	rate = strtod(argv[0], &end);
	163	if (*end != '\0')
	164	return 1;
	165
e399be8c	166	NLA_PUT_U32(msg, NL80211_ATTR_MCAST_RATE, (int)(rate * 10));
506b442b FF	167	argv++;
	168	argc--;
	169	}
	170
1e03690e JB	171	if (!argc)
1e03690e JB	172	return 0;
edea4d14	173
1e03690e JB	174	if (strcmp(argv, "key") != 0 && strcmp(argv, "keys") != 0)
1e03690e JB	175	return 1;
ded1f078	176
1e03690e JB	177	argv++;
1e03690e JB	178	argc--;
51e9bd80	179
1e03690e	180	return parse_keys(msg, argv, argc);
edea4d14 JB	181	nla_put_failure:
	182	return -ENOSPC;
	183	}
	184
	185	static int leave_ibss(struct nl80211_state *state,
	186	struct nl_cb *cb,
	187	struct nl_msg *msg,
05514f95 JB	188	int argc, char **argv,
05514f95 JB	189	enum id_input id)
edea4d14 JB	190	{
	191	return 0;
	192	}
	193	COMMAND(ibss, leave, NULL,
806bad30 JB	194	NL80211_CMD_LEAVE_IBSS, 0, CIB_NETDEV, leave_ibss,
806bad30 JB	195	"Leave the current IBSS cell.");
6a24bb22	196	COMMAND(ibss, join,
85da7703	197	"<SSID> <freq in MHz> [HT20\|HT40+\|HT40-\|NOHT\|5MHZ\|10MHZ] [fixed-freq] [<fixed bssid>] [beacon-interval <TU>]"
506b442b FF	198	" [basic-rates <rate in Mbps,rate2,...>] [mcast-rate <rate in Mbps>] "
506b442b FF	199	"[key d:0:abcde]",
806bad30 JB	200	NL80211_CMD_JOIN_IBSS, 0, CIB_NETDEV, join_ibss,
	201	"Join the IBSS cell with the given SSID, if it doesn't exist create\n"
	202	"it on the given frequency. When fixed frequency is requested, don't\n"
	203	"join/create a cell on a different frequency. When a fixed BSSID is\n"
	204	"requested use that BSSID and do not adopt another cell's BSSID even\n"
ec46ba52	205	"if it has higher TSF and the same SSID. If an IBSS is created, create\n"
506b442b	206	"it with the specified basic-rates, multicast-rate and beacon-interval.");