[thirdparty/iw.git] / reg.c

#include <net/if.h>
#include <errno.h>
#include <string.h>
#include <stdbool.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(reg);

#define MHZ_TO_KHZ(freq) ((freq) * 1000)
#define KHZ_TO_MHZ(freq) ((freq) / 1000)
#define DBI_TO_MBI(gain) ((gain) * 100)
#define MBI_TO_DBI(gain) ((gain) / 100)
#define DBM_TO_MBM(gain) ((gain) * 100)
#define MBM_TO_DBM(gain) ((gain) / 100)

static bool isalpha_upper(char letter)
{
	if (letter >= 65 && letter <= 90)
		return true;
	return false;
}

static bool is_alpha2(char *alpha2)
{
	if (isalpha_upper(alpha2[0]) && isalpha_upper(alpha2[1]))
		return true;
	return false;
}

static bool is_world_regdom(char *alpha2)
{
	/* ASCII 0 */
	if (alpha2[0] == 48 && alpha2[1] == 48)
		return true;
	return false;
}

char *reg_initiator_to_string(__u8 initiator)
{
	switch (initiator) {
	case NL80211_REGDOM_SET_BY_CORE:
		return "the wireless core upon initialization";
	case NL80211_REGDOM_SET_BY_USER:
		return "a user";
	case NL80211_REGDOM_SET_BY_DRIVER:
		return "a driver";
	case NL80211_REGDOM_SET_BY_COUNTRY_IE:
		return "a country IE";
	default:
		return "BUG";
	}
}

static const char *dfs_domain_name(enum nl80211_dfs_regions region)
{
	switch (region) {
	case NL80211_DFS_UNSET:
		return "DFS-UNSET";
	case NL80211_DFS_FCC:
		return "DFS-FCC";
	case NL80211_DFS_ETSI:
		return "DFS-ETSI";
	case NL80211_DFS_JP:
		return "DFS-JP";
	default:
		return "DFS-invalid";
	}
}

static int handle_reg_set(struct nl80211_state *state,
			  struct nl_cb *cb,
			  struct nl_msg *msg,
			  int argc, char **argv,
			  enum id_input id)
{
	char alpha2[3];

	if (argc < 1)
		return 1;

	if (!is_alpha2(argv[0]) && !is_world_regdom(argv[0])) {
		fprintf(stderr, "not a valid ISO/IEC 3166-1 alpha2\n");
		fprintf(stderr, "Special non-alpha2 usable entries:\n");
		fprintf(stderr, "\t00\tWorld Regulatory domain\n");
		return 2;
	}

	alpha2[0] = argv[0][0];
	alpha2[1] = argv[0][1];
	alpha2[2] = '\0';

	argc--;
	argv++;

	if (argc)
		return 1;

	NLA_PUT_STRING(msg, NL80211_ATTR_REG_ALPHA2, alpha2);

	return 0;
 nla_put_failure:
	return -ENOBUFS;
}
COMMAND(reg, set, "<ISO/IEC 3166-1 alpha2>",
	NL80211_CMD_REQ_SET_REG, 0, CIB_NONE, handle_reg_set,
	"Notify the kernel about the current regulatory domain.");

static int print_reg_handler(struct nl_msg *msg, void *arg)

{
#define PARSE_FLAG(nl_flag, string_value)  do { \
		if ((flags & nl_flag)) { \
			printf(", %s", string_value); \
		} \
	} while (0)
	struct nlattr *tb_msg[NL80211_ATTR_MAX + 1];
	struct genlmsghdr *gnlh = nlmsg_data(nlmsg_hdr(msg));
	char *alpha2;
	struct nlattr *nl_rule;
	int rem_rule;
	enum nl80211_dfs_regions dfs_domain;
	static struct nla_policy reg_rule_policy[NL80211_FREQUENCY_ATTR_MAX + 1] = {
		[NL80211_ATTR_REG_RULE_FLAGS]		= { .type = NLA_U32 },
		[NL80211_ATTR_FREQ_RANGE_START]		= { .type = NLA_U32 },
		[NL80211_ATTR_FREQ_RANGE_END]		= { .type = NLA_U32 },
		[NL80211_ATTR_FREQ_RANGE_MAX_BW]	= { .type = NLA_U32 },
		[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN]	= { .type = NLA_U32 },
		[NL80211_ATTR_POWER_RULE_MAX_EIRP]	= { .type = NLA_U32 },
		[NL80211_ATTR_DFS_CAC_TIME]		= { .type = NLA_U32 },
	};

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

	if (!tb_msg[NL80211_ATTR_REG_ALPHA2]) {
		printf("No alpha2\n");
		return NL_SKIP;
	}

	if (!tb_msg[NL80211_ATTR_REG_RULES]) {
		printf("No reg rules\n");
		return NL_SKIP;
	}

	if (tb_msg[NL80211_ATTR_DFS_REGION])
		dfs_domain = nla_get_u8(tb_msg[NL80211_ATTR_DFS_REGION]);
	else
		dfs_domain = NL80211_DFS_UNSET;

	alpha2 = nla_data(tb_msg[NL80211_ATTR_REG_ALPHA2]);
	printf("country %c%c: %s\n", alpha2[0], alpha2[1], dfs_domain_name(dfs_domain));

	nla_for_each_nested(nl_rule, tb_msg[NL80211_ATTR_REG_RULES], rem_rule) {
		struct nlattr *tb_rule[NL80211_FREQUENCY_ATTR_MAX + 1];
		__u32 flags, start_freq_khz, end_freq_khz, max_bw_khz, max_ant_gain_mbi, max_eirp_mbm;

		nla_parse(tb_rule, NL80211_FREQUENCY_ATTR_MAX, nla_data(nl_rule), nla_len(nl_rule), reg_rule_policy);

		flags = nla_get_u32(tb_rule[NL80211_ATTR_REG_RULE_FLAGS]);
		start_freq_khz = nla_get_u32(tb_rule[NL80211_ATTR_FREQ_RANGE_START]);
		end_freq_khz = nla_get_u32(tb_rule[NL80211_ATTR_FREQ_RANGE_END]);
		max_bw_khz = nla_get_u32(tb_rule[NL80211_ATTR_FREQ_RANGE_MAX_BW]);
		max_ant_gain_mbi = nla_get_u32(tb_rule[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN]);
		max_eirp_mbm = nla_get_u32(tb_rule[NL80211_ATTR_POWER_RULE_MAX_EIRP]);


		printf("\t(%d - %d @ %d), (",
			KHZ_TO_MHZ(start_freq_khz), KHZ_TO_MHZ(end_freq_khz), KHZ_TO_MHZ(max_bw_khz));

		if (MBI_TO_DBI(max_ant_gain_mbi))
			printf("%d", MBI_TO_DBI(max_ant_gain_mbi));
		else
			printf("N/A");

		printf(", %d)", MBM_TO_DBM(max_eirp_mbm));

		if ((flags & NL80211_RRF_DFS) && tb_rule[NL80211_ATTR_DFS_CAC_TIME])
			printf(", (%u ms)", nla_get_u32(tb_rule[NL80211_ATTR_DFS_CAC_TIME]));
		else
			printf(", (N/A)");

		if (!flags) {
			printf("\n");
			continue;
		}

		/* Sync this output format to match that of dbparse.py from wireless-regdb.git */
		PARSE_FLAG(NL80211_RRF_NO_OFDM, "NO-OFDM");
		PARSE_FLAG(NL80211_RRF_NO_CCK, "NO-CCK");
		PARSE_FLAG(NL80211_RRF_NO_INDOOR, "NO-INDOOR");
		PARSE_FLAG(NL80211_RRF_NO_OUTDOOR, "NO-OUTDOOR");
		PARSE_FLAG(NL80211_RRF_DFS, "DFS");
		PARSE_FLAG(NL80211_RRF_PTP_ONLY, "PTP-ONLY");

		/* Kernels that support NO_IR always turn on both flags */
		if ((flags & NL80211_RRF_NO_IR) && (flags & __NL80211_RRF_NO_IBSS)) {
			printf(", NO-IR");
		} else {
			PARSE_FLAG(NL80211_RRF_PASSIVE_SCAN, "PASSIVE-SCAN");
			PARSE_FLAG(__NL80211_RRF_NO_IBSS, "NO-IBSS");
		}

		printf("\n");
	}
	return NL_OK;
#undef PARSE_FLAG
}

static int handle_reg_get(struct nl80211_state *state,
			  struct nl_cb *cb,
			  struct nl_msg *msg,
			  int argc, char **argv,
			  enum id_input id)
{
	nl_cb_set(cb, NL_CB_VALID, NL_CB_CUSTOM, print_reg_handler, NULL);
	return 0;
}
COMMAND(reg, get, NULL, NL80211_CMD_GET_REG, 0, CIB_NONE, handle_reg_get,
	"Print out the kernel's current regulatory domain information.");
Commit	Line	Data
14a0380d LR	1	#include <net/if.h>
	2	#include <errno.h>
	3	#include <string.h>
ffc08bcb	4	#include <stdbool.h>
14a0380d LR	5
	6	#include <netlink/genl/genl.h>
	7	#include <netlink/genl/family.h>
	8	#include <netlink/genl/ctrl.h>
	9	#include <netlink/msg.h>
	10	#include <netlink/attr.h>
	11
f408e01b	12	#include "nl80211.h"
14a0380d LR	13	#include "iw.h"
14a0380d LR	14
4698bfc2 JB	15	SECTION(reg);
4698bfc2 JB	16
7ab65227 LR	17	#define MHZ_TO_KHZ(freq) ((freq) * 1000)
	18	#define KHZ_TO_MHZ(freq) ((freq) / 1000)
	19	#define DBI_TO_MBI(gain) ((gain) * 100)
	20	#define MBI_TO_DBI(gain) ((gain) / 100)
	21	#define DBM_TO_MBM(gain) ((gain) * 100)
	22	#define MBM_TO_DBM(gain) ((gain) / 100)
	23
ffc08bcb	24	static bool isalpha_upper(char letter)
14a0380d LR	25	{
14a0380d LR	26	if (letter >= 65 && letter <= 90)
ffc08bcb LR	27	return true;
ffc08bcb LR	28	return false;
14a0380d LR	29	}
14a0380d LR	30
ffc08bcb	31	static bool is_alpha2(char *alpha2)
14a0380d LR	32	{
14a0380d LR	33	if (isalpha_upper(alpha2[0]) && isalpha_upper(alpha2[1]))
ffc08bcb LR	34	return true;
ffc08bcb LR	35	return false;
14a0380d LR	36	}
14a0380d LR	37
ffc08bcb	38	static bool is_world_regdom(char *alpha2)
14a0380d LR	39	{
	40	/* ASCII 0 */
	41	if (alpha2[0] == 48 && alpha2[1] == 48)
ffc08bcb LR	42	return true;
ffc08bcb LR	43	return false;
14a0380d LR	44	}
14a0380d LR	45
601c6ab2 LR	46	char *reg_initiator_to_string(__u8 initiator)
	47	{
	48	switch (initiator) {
	49	case NL80211_REGDOM_SET_BY_CORE:
	50	return "the wireless core upon initialization";
	51	case NL80211_REGDOM_SET_BY_USER:
	52	return "a user";
	53	case NL80211_REGDOM_SET_BY_DRIVER:
	54	return "a driver";
	55	case NL80211_REGDOM_SET_BY_COUNTRY_IE:
	56	return "a country IE";
	57	default:
	58	return "BUG";
	59	}
	60	}
	61
9e8a208b ZK	62	static const char *dfs_domain_name(enum nl80211_dfs_regions region)
	63	{
	64	switch (region) {
	65	case NL80211_DFS_UNSET:
	66	return "DFS-UNSET";
	67	case NL80211_DFS_FCC:
	68	return "DFS-FCC";
	69	case NL80211_DFS_ETSI:
	70	return "DFS-ETSI";
	71	case NL80211_DFS_JP:
	72	return "DFS-JP";
	73	default:
	74	return "DFS-invalid";
	75	}
	76	}
	77
7c37a24d JB	78	static int handle_reg_set(struct nl80211_state *state,
7c37a24d JB	79	struct nl_cb *cb,
1c05c109	80	struct nl_msg *msg,
05514f95 JB	81	int argc, char **argv,
05514f95 JB	82	enum id_input id)
14a0380d	83	{
14a0380d LR	84	char alpha2[3];
14a0380d LR	85
1c05c109	86	if (argc < 1)
5e75fd04	87	return 1;
14a0380d LR	88
	89	if (!is_alpha2(argv[0]) && !is_world_regdom(argv[0])) {
	90	fprintf(stderr, "not a valid ISO/IEC 3166-1 alpha2\n");
40ffa988	91	fprintf(stderr, "Special non-alpha2 usable entries:\n");
14a0380d	92	fprintf(stderr, "\t00\tWorld Regulatory domain\n");
5e75fd04	93	return 2;
14a0380d LR	94	}
	95
	96	alpha2[0] = argv[0][0];
	97	alpha2[1] = argv[0][1];
	98	alpha2[2] = '\0';
	99
	100	argc--;
	101	argv++;
	102
1c05c109	103	if (argc)
5e75fd04	104	return 1;
14a0380d LR	105
	106	NLA_PUT_STRING(msg, NL80211_ATTR_REG_ALPHA2, alpha2);
	107
70391ccf	108	return 0;
14a0380d	109	nla_put_failure:
70391ccf	110	return -ENOBUFS;
14a0380d	111	}
1c05c109	112	COMMAND(reg, set, "<ISO/IEC 3166-1 alpha2>",
70cf4544 JB	113	NL80211_CMD_REQ_SET_REG, 0, CIB_NONE, handle_reg_set,
70cf4544 JB	114	"Notify the kernel about the current regulatory domain.");
7ab65227 LR	115
	116	static int print_reg_handler(struct nl_msg msg, void arg)
	117
	118	{
	119	#define PARSE_FLAG(nl_flag, string_value) do { \
	120	if ((flags & nl_flag)) { \
	121	printf(", %s", string_value); \
	122	} \
	123	} while (0)
	124	struct nlattr *tb_msg[NL80211_ATTR_MAX + 1];
	125	struct genlmsghdr *gnlh = nlmsg_data(nlmsg_hdr(msg));
	126	char *alpha2;
	127	struct nlattr *nl_rule;
	128	int rem_rule;
9e8a208b	129	enum nl80211_dfs_regions dfs_domain;
7ab65227	130	static struct nla_policy reg_rule_policy[NL80211_FREQUENCY_ATTR_MAX + 1] = {
c551449a JB	131	[NL80211_ATTR_REG_RULE_FLAGS] = { .type = NLA_U32 },
	132	[NL80211_ATTR_FREQ_RANGE_START] = { .type = NLA_U32 },
	133	[NL80211_ATTR_FREQ_RANGE_END] = { .type = NLA_U32 },
	134	[NL80211_ATTR_FREQ_RANGE_MAX_BW] = { .type = NLA_U32 },
	135	[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN] = { .type = NLA_U32 },
	136	[NL80211_ATTR_POWER_RULE_MAX_EIRP] = { .type = NLA_U32 },
8220747f	137	[NL80211_ATTR_DFS_CAC_TIME] = { .type = NLA_U32 },
7ab65227 LR	138	};
	139
	140	nla_parse(tb_msg, NL80211_ATTR_MAX, genlmsg_attrdata(gnlh, 0),
	141	genlmsg_attrlen(gnlh, 0), NULL);
	142
	143	if (!tb_msg[NL80211_ATTR_REG_ALPHA2]) {
	144	printf("No alpha2\n");
	145	return NL_SKIP;
	146	}
	147
	148	if (!tb_msg[NL80211_ATTR_REG_RULES]) {
	149	printf("No reg rules\n");
	150	return NL_SKIP;
	151	}
	152
9e8a208b ZK	153	if (tb_msg[NL80211_ATTR_DFS_REGION])
	154	dfs_domain = nla_get_u8(tb_msg[NL80211_ATTR_DFS_REGION]);
	155	else
	156	dfs_domain = NL80211_DFS_UNSET;
	157
7ab65227	158	alpha2 = nla_data(tb_msg[NL80211_ATTR_REG_ALPHA2]);
9e8a208b	159	printf("country %c%c: %s\n", alpha2[0], alpha2[1], dfs_domain_name(dfs_domain));
7ab65227 LR	160
	161	nla_for_each_nested(nl_rule, tb_msg[NL80211_ATTR_REG_RULES], rem_rule) {
	162	struct nlattr *tb_rule[NL80211_FREQUENCY_ATTR_MAX + 1];
	163	__u32 flags, start_freq_khz, end_freq_khz, max_bw_khz, max_ant_gain_mbi, max_eirp_mbm;
	164
	165	nla_parse(tb_rule, NL80211_FREQUENCY_ATTR_MAX, nla_data(nl_rule), nla_len(nl_rule), reg_rule_policy);
	166
	167	flags = nla_get_u32(tb_rule[NL80211_ATTR_REG_RULE_FLAGS]);
	168	start_freq_khz = nla_get_u32(tb_rule[NL80211_ATTR_FREQ_RANGE_START]);
	169	end_freq_khz = nla_get_u32(tb_rule[NL80211_ATTR_FREQ_RANGE_END]);
	170	max_bw_khz = nla_get_u32(tb_rule[NL80211_ATTR_FREQ_RANGE_MAX_BW]);
	171	max_ant_gain_mbi = nla_get_u32(tb_rule[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN]);
	172	max_eirp_mbm = nla_get_u32(tb_rule[NL80211_ATTR_POWER_RULE_MAX_EIRP]);
	173
	174
	175	printf("\t(%d - %d @ %d), (",
	176	KHZ_TO_MHZ(start_freq_khz), KHZ_TO_MHZ(end_freq_khz), KHZ_TO_MHZ(max_bw_khz));
	177
	178	if (MBI_TO_DBI(max_ant_gain_mbi))
	179	printf("%d", MBI_TO_DBI(max_ant_gain_mbi));
	180	else
	181	printf("N/A");
	182
	183	printf(", %d)", MBM_TO_DBM(max_eirp_mbm));
	184
8220747f JD	185	if ((flags & NL80211_RRF_DFS) && tb_rule[NL80211_ATTR_DFS_CAC_TIME])
	186	printf(", (%u ms)", nla_get_u32(tb_rule[NL80211_ATTR_DFS_CAC_TIME]));
	187	else
	188	printf(", (N/A)");
	189
7ab65227 LR	190	if (!flags) {
	191	printf("\n");
	192	continue;
	193	}
	194
	195	/* Sync this output format to match that of dbparse.py from wireless-regdb.git */
	196	PARSE_FLAG(NL80211_RRF_NO_OFDM, "NO-OFDM");
	197	PARSE_FLAG(NL80211_RRF_NO_CCK, "NO-CCK");
	198	PARSE_FLAG(NL80211_RRF_NO_INDOOR, "NO-INDOOR");
	199	PARSE_FLAG(NL80211_RRF_NO_OUTDOOR, "NO-OUTDOOR");
	200	PARSE_FLAG(NL80211_RRF_DFS, "DFS");
	201	PARSE_FLAG(NL80211_RRF_PTP_ONLY, "PTP-ONLY");
f0c48e7b IP	202
	203	/* Kernels that support NO_IR always turn on both flags */
	204	if ((flags & NL80211_RRF_NO_IR) && (flags & __NL80211_RRF_NO_IBSS)) {
	205	printf(", NO-IR");
	206	} else {
	207	PARSE_FLAG(NL80211_RRF_PASSIVE_SCAN, "PASSIVE-SCAN");
	208	PARSE_FLAG(__NL80211_RRF_NO_IBSS, "NO-IBSS");
	209	}
7ab65227 LR	210
	211	printf("\n");
	212	}
	213	return NL_OK;
	214	#undef PARSE_FLAG
	215	}
	216
7c37a24d JB	217	static int handle_reg_get(struct nl80211_state *state,
7c37a24d JB	218	struct nl_cb *cb,
7ab65227	219	struct nl_msg *msg,
05514f95 JB	220	int argc, char **argv,
05514f95 JB	221	enum id_input id)
7ab65227 LR	222	{
	223	nl_cb_set(cb, NL_CB_VALID, NL_CB_CUSTOM, print_reg_handler, NULL);
	224	return 0;
	225	}
70cf4544 JB	226	COMMAND(reg, get, NULL, NL80211_CMD_GET_REG, 0, CIB_NONE, handle_reg_get,
70cf4544 JB	227	"Print out the kernel's current regulatory domain information.");