]>
Commit | Line | Data |
---|---|---|
894d2e2b JD |
1 | #include <net/if.h> |
2 | #include <errno.h> | |
3 | #include <string.h> | |
4 | ||
5 | #include <netlink/genl/genl.h> | |
6 | #include <netlink/genl/family.h> | |
7 | #include <netlink/genl/ctrl.h> | |
8 | #include <netlink/msg.h> | |
9 | #include <netlink/attr.h> | |
10 | ||
11 | #include "nl80211.h" | |
12 | #include "iw.h" | |
13 | ||
14 | SECTION(vendor); | |
15 | ||
16 | static int read_file(FILE *file, char *buf, size_t size) | |
17 | { | |
18 | int data, count = 0; | |
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 | ||
30 | static int read_hex(int argc, char **argv, char *buf, size_t size) | |
31 | { | |
32 | int i, res; | |
33 | unsigned int data; | |
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 | ||
48 | static int handle_vendor(struct nl80211_state *state, struct nl_cb *cb, | |
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) | |
59 | return -EINVAL; | |
60 | ||
61 | res = sscanf(argv[0], "0x%x", &oui); | |
62 | if (res != 1) | |
63 | return -EINVAL; | |
64 | ||
65 | res = sscanf(argv[1], "0x%x", &subcmd); | |
66 | if (res != 1) | |
67 | return -EINVAL; | |
68 | ||
69 | if (!strcmp(argv[2], "-")) | |
70 | file = stdin; | |
71 | else | |
72 | file = fopen(argv[2], "r"); | |
73 | ||
74 | NLA_PUT_U32(msg, NL80211_ATTR_VENDOR_ID, oui); | |
75 | NLA_PUT_U32(msg, NL80211_ATTR_VENDOR_SUBCMD, subcmd); | |
76 | ||
77 | if (file) { | |
78 | count = read_file(file, buf, sizeof(buf)); | |
79 | fclose(file); | |
80 | } else | |
81 | count = read_hex(argc - 2, &argv[2], buf, sizeof(buf)); | |
82 | ||
83 | if (count < 0) | |
84 | return -EINVAL; | |
85 | ||
86 | if (count > 0) | |
87 | NLA_PUT(msg, NL80211_ATTR_VENDOR_DATA, count, buf); | |
88 | ||
89 | return 0; | |
90 | ||
91 | nla_put_failure: | |
92 | return -ENOBUFS; | |
93 | } | |
94 | ||
95 | COMMAND(vendor, send, "<oui> <subcmd> <filename|-|hex data>", NL80211_CMD_VENDOR, 0, CIB_NETDEV, handle_vendor, ""); |