]> 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 7b51b23910110c2d63a816ac4a9c59f9793dbfcb..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",
@@ -259,6 +261,16 @@ static const char *commands[NL80211_CMD_MAX + 1] = {
        [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];
@@ -341,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;
 
@@ -354,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;
@@ -457,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;
@@ -712,7 +963,7 @@ void print_vht_info(__u32 capa, const __u8 *mcs)
 
 void iw_hexdump(const char *prefix, const __u8 *buf, size_t size)
 {
-       int i;
+       size_t i;
 
        printf("%s: ", prefix);
        for (i = 0; i < size; i++) {
@@ -722,3 +973,29 @@ void iw_hexdump(const char *prefix, const __u8 *buf, size_t size)
        }
        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;
+}