]> git.ipfire.org Git - thirdparty/iw.git/blobdiff - util.c
Add cac command to allow clearing channels
[thirdparty/iw.git] / util.c
diff --git a/util.c b/util.c
index c272c1dae9e3ad5b80415fa30c3da4ed893a3283..833b1ce086f17a84e1df844e6c1e9e64dcbc4625 100644 (file)
--- a/util.c
+++ b/util.c
@@ -133,6 +133,8 @@ static const char *ifmodes[NL80211_IFTYPE_MAX + 1] = {
        "P2P-client",
        "P2P-GO",
        "P2P-device",
+       "outside context of a BSS",
+       "NAN",
 };
 
 static char modebuf[100];
@@ -147,7 +149,7 @@ const char *iftype_name(enum nl80211_iftype iftype)
 
 static const char *commands[NL80211_CMD_MAX + 1] = {
 /*
- * sed 's/^\tNL80211_CMD_//;t n;d;:n s%^\([^=]*\),.*%\t[NL80211_CMD_\1] = \"\L\1\",%;t;d' nl80211.h
+ * sed 's%^\tNL80211_CMD_%%;t n;d;:n s%^\([^=]*\),.*%\t[NL80211_CMD_\1] = \"\L\1\",%;t;d' nl80211.h | grep -v "reserved"
  */
        [NL80211_CMD_UNSPEC] = "unspec",
        [NL80211_CMD_GET_WIPHY] = "get_wiphy",
@@ -240,6 +242,35 @@ static const char *commands[NL80211_CMD_MAX + 1] = {
        [NL80211_CMD_START_P2P_DEVICE] = "start_p2p_device",
        [NL80211_CMD_STOP_P2P_DEVICE] = "stop_p2p_device",
        [NL80211_CMD_CONN_FAILED] = "conn_failed",
+       [NL80211_CMD_SET_MCAST_RATE] = "set_mcast_rate",
+       [NL80211_CMD_SET_MAC_ACL] = "set_mac_acl",
+       [NL80211_CMD_RADAR_DETECT] = "radar_detect",
+       [NL80211_CMD_GET_PROTOCOL_FEATURES] = "get_protocol_features",
+       [NL80211_CMD_UPDATE_FT_IES] = "update_ft_ies",
+       [NL80211_CMD_FT_EVENT] = "ft_event",
+       [NL80211_CMD_CRIT_PROTOCOL_START] = "crit_protocol_start",
+       [NL80211_CMD_CRIT_PROTOCOL_STOP] = "crit_protocol_stop",
+       [NL80211_CMD_GET_COALESCE] = "get_coalesce",
+       [NL80211_CMD_SET_COALESCE] = "set_coalesce",
+       [NL80211_CMD_CHANNEL_SWITCH] = "channel_switch",
+       [NL80211_CMD_VENDOR] = "vendor",
+       [NL80211_CMD_SET_QOS_MAP] = "set_qos_map",
+       [NL80211_CMD_ADD_TX_TS] = "add_tx_ts",
+       [NL80211_CMD_DEL_TX_TS] = "del_tx_ts",
+       [NL80211_CMD_GET_MPP] = "get_mpp",
+       [NL80211_CMD_JOIN_OCB] = "join_ocb",
+       [NL80211_CMD_LEAVE_OCB] = "leave_ocb",
+       [NL80211_CMD_CH_SWITCH_STARTED_NOTIFY] = "ch_switch_started_notify",
+       [NL80211_CMD_TDLS_CHANNEL_SWITCH] = "tdls_channel_switch",
+       [NL80211_CMD_TDLS_CANCEL_CHANNEL_SWITCH] = "tdls_cancel_channel_switch",
+       [NL80211_CMD_WIPHY_REG_CHANGE] = "wiphy_reg_change",
+       [NL80211_CMD_ABORT_SCAN] = "abort_scan",
+       [NL80211_CMD_START_NAN] = "start_nan",
+       [NL80211_CMD_STOP_NAN] = "stop_nan",
+       [NL80211_CMD_ADD_NAN_FUNCTION] = "add_nan_function",
+       [NL80211_CMD_DEL_NAN_FUNCTION] = "del_nan_function",
+       [NL80211_CMD_CHANGE_NAN_CONFIG] = "change_nan_config",
+       [NL80211_CMD_NAN_MATCH] = "nan_match",
 };
 
 static char cmdbuf[100];
@@ -252,34 +283,50 @@ const char *command_name(enum nl80211_commands cmd)
        return cmdbuf;
 }
 
-int ieee80211_channel_to_frequency(int chan)
+int ieee80211_channel_to_frequency(int chan, enum nl80211_band band)
 {
-       if (chan < 14)
-               return 2407 + chan * 5;
-
-       if (chan == 14)
-               return 2484;
-
-       /* FIXME: dot11ChannelStartingFactor (802.11-2007 17.3.8.3.2) */
-       return (chan + 1000) * 5;
+       /* see 802.11 17.3.8.3.2 and Annex J
+        * there are overlapping channel numbers in 5GHz and 2GHz bands */
+       if (chan <= 0)
+               return 0; /* not supported */
+       switch (band) {
+       case NL80211_BAND_2GHZ:
+               if (chan == 14)
+                       return 2484;
+               else if (chan < 14)
+                       return 2407 + chan * 5;
+               break;
+       case NL80211_BAND_5GHZ:
+               if (chan >= 182 && chan <= 196)
+                       return 4000 + chan * 5;
+               else
+                       return 5000 + chan * 5;
+               break;
+       case NL80211_BAND_60GHZ:
+               if (chan < 5)
+                       return 56160 + chan * 2160;
+               break;
+       default:
+               ;
+       }
+       return 0; /* not supported */
 }
 
 int ieee80211_frequency_to_channel(int freq)
 {
+       /* see 802.11-2007 17.3.8.3.2 and Annex J */
        if (freq == 2484)
                return 14;
-
-       if (freq < 2484)
+       else if (freq < 2484)
                return (freq - 2407) / 5;
-
-       /* FIXME: dot11ChannelStartingFactor (802.11-2007 17.3.8.3.2) */
-       if (freq < 45000)
-               return freq/5 - 1000;
-
-       if (freq >= 58320 && freq <= 64800)
+       else if (freq >= 4910 && freq <= 4980)
+               return (freq - 4000) / 5;
+       else if (freq <= 45000) /* DMG band lower limit */
+               return (freq - 5000) / 5;
+       else if (freq >= 58320 && freq <= 64800)
                return (freq - 56160) / 2160;
-
-       return 0;
+       else
+               return 0;
 }
 
 void print_ssid_escaped(const uint8_t len, const uint8_t *data)
@@ -306,7 +353,7 @@ static int hex2num(char digit)
        return tolower(digit) - 'a' + 10;
 }
 
-static int hex2byte(char *hex)
+static int hex2byte(const char *hex)
 {
        int d1, d2;
 
@@ -319,7 +366,7 @@ static int hex2byte(char *hex)
        return (d1 << 4) | d2;
 }
 
-static char *hex2bin(char *hex, char *buf)
+static char *hex2bin(const char *hex, char *buf)
 {
        char *result = buf;
        int d;
@@ -422,6 +469,245 @@ int parse_keys(struct nl_msg *msg, char **argv, int argc)
        return 2;
 }
 
+static int parse_freqs(struct chandef *chandef, int argc, char **argv,
+                      int *parsed)
+{
+       static const struct {
+               const char *name;
+               unsigned int val;
+       } bwmap[] = {
+               { .name = "5", .val = NL80211_CHAN_WIDTH_5, },
+               { .name = "10", .val = NL80211_CHAN_WIDTH_10, },
+               { .name = "20", .val = NL80211_CHAN_WIDTH_20, },
+               { .name = "40", .val = NL80211_CHAN_WIDTH_40, },
+               { .name = "80", .val = NL80211_CHAN_WIDTH_80, },
+               { .name = "80+80", .val = NL80211_CHAN_WIDTH_80P80, },
+               { .name = "160", .val = NL80211_CHAN_WIDTH_160, },
+       };
+       uint32_t freq;
+       unsigned int i, bwval = NL80211_CHAN_WIDTH_20_NOHT;
+       char *end;
+
+       if (argc < 1)
+               return 0;
+
+       for (i = 0; i < ARRAY_SIZE(bwmap); i++) {
+               if (strcasecmp(bwmap[i].name, argv[0]) == 0) {
+                       bwval = bwmap[i].val;
+                       *parsed += 1;
+                       break;
+               }
+       }
+       chandef->width = bwval;
+
+       /* First argument was not understood, give up gracefully. */
+       if (bwval == NL80211_CHAN_WIDTH_20_NOHT)
+               return 0;
+
+       if (argc < 2)
+               return 0;
+
+       /* center freq 1 */
+       if (!*argv[1])
+               return 0;
+       freq = strtoul(argv[1], &end, 10);
+       if (*end)
+               return 0;
+       *parsed += 1;
+
+       chandef->center_freq1 = freq;
+
+       if (argc < 3)
+               return 0;
+
+       /* center freq 2 */
+       if (!*argv[2])
+               return 0;
+       freq = strtoul(argv[2], &end, 10);
+       if (*end)
+               return 0;
+       chandef->center_freq2 = freq;
+
+       *parsed += 1;
+
+       return 0;
+}
+
+
+/**
+ * parse_freqchan - Parse frequency or channel definition
+ *
+ * @chandef: chandef structure to be filled in
+ * @chan: Boolean whether to parse a channel or frequency based specifier
+ * @argc: Number of arguments
+ * @argv: Array of string arguments
+ * @parsed: Pointer to return the number of used arguments, or NULL to error
+ *          out if any argument is left unused.
+ *
+ * The given chandef structure will be filled in from the command line
+ * arguments. argc/argv will be updated so that further arguments from the
+ * command line can be parsed.
+ *
+ * Note that no integer argument may follow a frequency definition to allow the
+ * user to skip the center frequency definition(s).
+ *
+ * The working specifier if chan is set are:
+ *   <channel> [NOHT|HT20|HT40+|HT40-|5MHz|10MHz|80MHz]
+ *
+ * And if frequency is set:
+ *   <freq> [NOHT|HT20|HT40+|HT40-|5MHz|10MHz|80MHz]
+ *   <control freq> [5|10|20|40|80|80+80|160] [<center1_freq> [<center2_freq>]]
+ *
+ * If the mode/channel width is not given the NOHT is assumed.
+ *
+ * Return: Number of used arguments, zero or negative error number otherwise
+ */
+int parse_freqchan(struct chandef *chandef, bool chan, int argc, char **argv,
+                  int *parsed)
+{
+       char *end;
+       static const struct chanmode 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 },
+               { .name = "80MHz",
+                 .width = NL80211_CHAN_WIDTH_80,
+                 .freq1_diff = 0,
+                 .chantype = -1 },
+       };
+       const struct chanmode *chanmode_selected = NULL;
+       unsigned int freq;
+       unsigned int i;
+       int _parsed = 0;
+       int res = 0;
+
+       if (argc < 1)
+               return 1;
+
+       if (!argv[0])
+               goto out;
+       freq = strtoul(argv[0], &end, 10);
+       if (*end) {
+               res = 1;
+               goto out;
+       }
+
+       _parsed += 1;
+
+       memset(chandef, 0, sizeof(struct chandef));
+
+       if (chan) {
+               enum nl80211_band band;
+
+               band = freq <= 14 ? NL80211_BAND_2GHZ : NL80211_BAND_5GHZ;
+               freq = ieee80211_channel_to_frequency(freq, band);
+       }
+       chandef->control_freq = freq;
+       /* Assume 20MHz NOHT channel for now. */
+       chandef->center_freq1 = freq;
+
+       /* Try to parse HT mode definitions */
+       if (argc > 1) {
+               for (i = 0; i < ARRAY_SIZE(chanmode); i++) {
+                       if (strcasecmp(chanmode[i].name, argv[1]) == 0) {
+                               chanmode_selected = &chanmode[i];
+                               _parsed += 1;
+                               break;
+                       }
+               }
+       }
+
+       /* channel mode given, use it and return. */
+       if (chanmode_selected) {
+               chandef->center_freq1 = get_cf1(chanmode_selected, freq);
+               chandef->width = chanmode_selected->width;
+               goto out;
+       }
+
+       /* This was a only a channel definition, nothing further may follow. */
+       if (chan)
+               goto out;
+
+       res = parse_freqs(chandef, argc - 1, argv + 1, &_parsed);
+
+ out:
+       /* Error out if parsed is NULL. */
+       if (!parsed && _parsed != argc)
+               return 1;
+
+       if (parsed)
+               *parsed = _parsed;
+
+       return res;
+}
+
+int put_chandef(struct nl_msg *msg, struct chandef *chandef)
+{
+       NLA_PUT_U32(msg, NL80211_ATTR_WIPHY_FREQ, chandef->control_freq);
+       NLA_PUT_U32(msg, NL80211_ATTR_CHANNEL_WIDTH, chandef->width);
+
+       switch (chandef->width) {
+       case NL80211_CHAN_WIDTH_20_NOHT:
+               NLA_PUT_U32(msg,
+                           NL80211_ATTR_WIPHY_CHANNEL_TYPE,
+                           NL80211_CHAN_NO_HT);
+               break;
+       case NL80211_CHAN_WIDTH_20:
+               NLA_PUT_U32(msg,
+                           NL80211_ATTR_WIPHY_CHANNEL_TYPE,
+                           NL80211_CHAN_HT20);
+               break;
+       case NL80211_CHAN_WIDTH_40:
+               if (chandef->control_freq > chandef->center_freq1)
+                       NLA_PUT_U32(msg,
+                                   NL80211_ATTR_WIPHY_CHANNEL_TYPE,
+                                   NL80211_CHAN_HT40MINUS);
+               else
+                       NLA_PUT_U32(msg,
+                                   NL80211_ATTR_WIPHY_CHANNEL_TYPE,
+                                   NL80211_CHAN_HT40PLUS);
+               break;
+       default:
+               break;
+       }
+
+       if (chandef->center_freq1)
+               NLA_PUT_U32(msg,
+                           NL80211_ATTR_CENTER_FREQ1,
+                           chandef->center_freq1);
+
+       if (chandef->center_freq2)
+               NLA_PUT_U32(msg,
+                           NL80211_ATTR_CENTER_FREQ2,
+                           chandef->center_freq2);
+
+       return 0;
+
+ nla_put_failure:
+       return -ENOBUFS;
+}
+
 static void print_mcs_index(const __u8 *mcs)
 {
        int mcs_bit, prev_bit = -2, prev_cont = 0;
@@ -566,7 +852,7 @@ void print_ht_mcs(const __u8 *mcs)
        unsigned int tx_max_num_spatial_streams, max_rx_supp_data_rate;
        bool tx_mcs_set_defined, tx_mcs_set_equal, tx_unequal_modulation;
 
-       max_rx_supp_data_rate = ((mcs[10] >> 8) & ((mcs[11] & 0x3) << 8));
+       max_rx_supp_data_rate = (mcs[10] | ((mcs[11] & 0x3) << 8));
        tx_mcs_set_defined = !!(mcs[12] & (1 << 0));
        tx_mcs_set_equal = !(mcs[12] & (1 << 1));
        tx_max_num_spatial_streams = ((mcs[12] >> 2) & 3) + 1;
@@ -643,8 +929,8 @@ void print_vht_info(__u32 capa, const __u8 *mcs)
        PRINT_VHT_CAPA(22, "+HTC-VHT");
        /* max A-MPDU */
        /* VHT link adaptation */
-       PRINT_VHT_CAPA(29, "RX antenna pattern consistency");
-       PRINT_VHT_CAPA(30, "TX antenna pattern consistency");
+       PRINT_VHT_CAPA(28, "RX antenna pattern consistency");
+       PRINT_VHT_CAPA(29, "TX antenna pattern consistency");
 
        printf("\t\tVHT RX MCS set:\n");
        tmp = mcs[0] | (mcs[1] << 8);
@@ -674,3 +960,42 @@ void print_vht_info(__u32 capa, const __u8 *mcs)
        tmp = mcs[6] | (mcs[7] << 8);
        printf("\t\tVHT TX highest supported: %d Mbps\n", tmp & 0x1fff);
 }
+
+void iw_hexdump(const char *prefix, const __u8 *buf, size_t size)
+{
+       size_t i;
+
+       printf("%s: ", prefix);
+       for (i = 0; i < size; i++) {
+               if (i && i % 16 == 0)
+                       printf("\n%s: ", prefix);
+               printf("%02x ", buf[i]);
+       }
+       printf("\n\n");
+}
+
+int get_cf1(const struct chanmode *chanmode, unsigned long freq)
+{
+       unsigned int cf1 = freq, j;
+       unsigned int vht80[] = { 5180, 5260, 5500, 5580, 5660, 5745 };
+
+       switch (chanmode->width) {
+       case NL80211_CHAN_WIDTH_80:
+               /* setup center_freq1 */
+               for (j = 0; j < ARRAY_SIZE(vht80); j++) {
+                       if (freq >= vht80[j] && freq < vht80[j] + 80)
+                               break;
+               }
+
+               if (j == ARRAY_SIZE(vht80))
+                       break;
+
+               cf1 = vht80[j] + 30;
+               break;
+       default:
+               cf1 = freq + chanmode->freq1_diff;
+               break;
+       }
+
+       return cf1;
+}