iw: add vendor send command

This allow to send vendor data to the driver.
This command required OUI and SUBCMD parameters.

Also optional DATA parameter could be used:

cat data.bin | iw wlan0 send oui subcmd -
iw wlan0 send oui subcmd file.bin
iw wlan0 vendor send oui subcmd 0x00 0x00 0x00 0x1f
echo EOF | iw wlan0 vendor send oui subcmd -

Signed-off-by: Janusz Dziedzic <janusz.dziedzic@tieto.com>
Signed-off-by: Johannes Berg <johannes.berg@intel.com>

diff --git a/vendor.c b/vendor.c
new file mode 100644 (file)
index 0000000..f32c00b
--- /dev/null
+++ b/vendor.c
@@ -0,0 +1,95 @@
+#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"
+
+SECTION(vendor);
+
+static int read_file(FILE *file, char *buf, size_t size)
+{
+       int data, count = 0;
+
+       while ((data = fgetc(file)) != EOF) {
+               if (count >= size)
+                       return -EINVAL;
+               buf[count] = data;
+               count++;
+       }
+
+       return count;
+}
+
+static int read_hex(int argc, char **argv, char *buf, size_t size)
+{
+       int i, res;
+       unsigned int data;
+
+       if (argc > size)
+               return -EINVAL;
+
+       for (i = 0; i < argc; i++) {
+               res = sscanf(argv[i], "0x%x", &data);
+               if (res != 1 || data > 0xff)
+                       return -EINVAL;
+               buf[i] = data;
+       }
+
+       return argc;
+}
+
+static int handle_vendor(struct nl80211_state *state, struct nl_cb *cb,
+                        struct nl_msg *msg, int argc, char **argv,
+                        enum id_input id)
+{
+       unsigned int oui;
+       unsigned int subcmd;
+       char buf[2048] = {};
+       int res, count = 0;
+       FILE *file = NULL;
+
+       if (argc < 3)
+               return -EINVAL;
+
+       res = sscanf(argv[0], "0x%x", &oui);
+       if (res != 1)
+               return -EINVAL;
+
+       res = sscanf(argv[1], "0x%x", &subcmd);
+       if (res != 1)
+               return -EINVAL;
+
+       if (!strcmp(argv[2], "-"))
+               file = stdin;
+       else
+               file = fopen(argv[2], "r");
+
+       NLA_PUT_U32(msg, NL80211_ATTR_VENDOR_ID, oui);
+       NLA_PUT_U32(msg, NL80211_ATTR_VENDOR_SUBCMD, subcmd);
+
+       if (file) {
+               count = read_file(file, buf, sizeof(buf));
+               fclose(file);
+       } else
+               count = read_hex(argc - 2, &argv[2], buf, sizeof(buf));
+
+       if (count < 0)
+               return -EINVAL;
+
+       if (count > 0)
+               NLA_PUT(msg, NL80211_ATTR_VENDOR_DATA, count, buf);
+
+       return 0;
+
+nla_put_failure:
+       return -ENOBUFS;
+}
+
+COMMAND(vendor, send, "<oui> <subcmd> <filename|-|hex data>", NL80211_CMD_VENDOR, 0, CIB_NETDEV, handle_vendor, "");