projects / thirdparty / iw.git / blame
| Commit | Line | Data |
|---|---|---|
| 894d2e2b JD |
1 | #include <errno.h> |
| 2 | #include <string.h> | |
| 3 | ||
| 4 | #include <netlink/genl/genl.h> | |
| 5 | #include <netlink/genl/family.h> | |
| 6 | #include <netlink/genl/ctrl.h> | |
| 7 | #include <netlink/msg.h> | |
| 8 | #include <netlink/attr.h> | |
| 9 | ||
| 10 | #include "nl80211.h" | |
| 11 | #include "iw.h" | |
| 12 | ||
| 13 | SECTION(vendor); | |
| 14 | ||
| 15 | static int read_file(FILE *file, char *buf, size_t size) | |
| 16 | { | |
| 0ee571d5 JB |
17 | size_t count = 0; |
| 18 | int data; | |
| 894d2e2b JD |
19 | |
| 20 | while ((data = fgetc(file)) != EOF) { | |
| 21 | if (count >= size) | |
| 22 | return -EINVAL; | |
| 23 | buf[count] = data; | |
| 24 | count++; | |
| 25 | } | |
| 26 | ||
| 27 | return count; | |
| 28 | } | |
| 29 | ||
| 0ee571d5 | 30 | static int read_hex(unsigned int argc, char **argv, char *buf, size_t size) |
| 894d2e2b | 31 | { |
| 0ee571d5 JB |
32 | unsigned int i, data; |
| 33 | int res; | |
| 894d2e2b JD |
34 | |
| 35 | if (argc > size) | |
| 36 | return -EINVAL; | |
| 37 | ||
| 38 | for (i = 0; i < argc; i++) { | |
| 39 | res = sscanf(argv[i], "0x%x", &data); | |
| 40 | if (res != 1 || data > 0xff) | |
| 41 | return -EINVAL; | |
| 42 | buf[i] = data; | |
| 43 | } | |
| 44 | ||
| 45 | return argc; | |
| 46 | } | |
| 47 | ||
| 34b23014 | 48 | static int handle_vendor(struct nl80211_state *state, |
| 894d2e2b JD |
49 | struct nl_msg *msg, int argc, char **argv, |
| 50 | enum id_input id) | |
| 51 | { | |
| 52 | unsigned int oui; | |
| 53 | unsigned int subcmd; | |
| 54 | char buf[2048] = {}; | |
| 55 | int res, count = 0; | |
| 56 | FILE *file = NULL; | |
| 57 | ||
| 58 | if (argc < 3) | |
| 6cd36342 | 59 | return 1; |
| 894d2e2b JD |
60 | |
| 61 | res = sscanf(argv[0], "0x%x", &oui); | |
| 6cd36342 OO |
62 | if (res != 1) { |
| 63 | printf("Vendor command must start with 0x\n"); | |
| 64 | return 2; | |
| 65 | } | |
| 894d2e2b JD |
66 | |
| 67 | res = sscanf(argv[1], "0x%x", &subcmd); | |
| 6cd36342 OO |
68 | if (res != 1) { |
| 69 | printf("Sub command must start with 0x\n"); | |
| 70 | return 2; | |
| 71 | } | |
| 894d2e2b JD |
72 | |
| 73 | if (!strcmp(argv[2], "-")) | |
| 74 | file = stdin; | |
| 75 | else | |
| 76 | file = fopen(argv[2], "r"); | |
| 77 | ||
| 78 | NLA_PUT_U32(msg, NL80211_ATTR_VENDOR_ID, oui); | |
| 79 | NLA_PUT_U32(msg, NL80211_ATTR_VENDOR_SUBCMD, subcmd); | |
| 80 | ||
| 81 | if (file) { | |
| 82 | count = read_file(file, buf, sizeof(buf)); | |
| 83 | fclose(file); | |
| 84 | } else | |
| 85 | count = read_hex(argc - 2, &argv[2], buf, sizeof(buf)); | |
| 86 | ||
| 87 | if (count < 0) | |
| 88 | return -EINVAL; | |
| 89 | ||
| 90 | if (count > 0) | |
| 91 | NLA_PUT(msg, NL80211_ATTR_VENDOR_DATA, count, buf); | |
| 92 | ||
| 93 | return 0; | |
| 94 | ||
| 95 | nla_put_failure: | |
| 96 | return -ENOBUFS; | |
| 97 | } | |
| 98 | ||
| 99 | COMMAND(vendor, send, "<oui> <subcmd> <filename|-|hex data>", NL80211_CMD_VENDOR, 0, CIB_NETDEV, handle_vendor, ""); |