]>
Commit | Line | Data |
---|---|---|
ba4f75ba ZZY |
1 | #include <errno.h> |
2 | #include <string.h> | |
3 | ||
4 | #include <netlink/genl/genl.h> | |
5 | #include <netlink/msg.h> | |
6 | #include <netlink/attr.h> | |
7 | ||
8 | #include "nl80211.h" | |
9 | #include "iw.h" | |
10 | ||
11 | static int set_sar_specs(struct nl80211_state *state, | |
12 | struct nl_msg *msg, | |
13 | int argc, char **argv, | |
14 | enum id_input id) | |
15 | { | |
16 | struct nlattr *nl_sar, *nl_specs, *nl_sub; | |
17 | enum nl80211_sar_type type; | |
18 | __u32 idx; | |
19 | __s32 pwr; | |
20 | char *tmp; | |
21 | int count, i; | |
22 | ||
23 | if (argc <= 1) | |
24 | return -EINVAL; | |
25 | ||
26 | type = atoi(argv[0]); | |
27 | ||
28 | nl_sar = nla_nest_start(msg, NL80211_ATTR_SAR_SPEC); | |
29 | if (!nl_sar) | |
30 | goto nla_put_failure; | |
31 | ||
32 | NLA_PUT_U32(msg, NL80211_SAR_ATTR_TYPE, type); | |
33 | ||
34 | nl_specs = nla_nest_start(msg, NL80211_SAR_ATTR_SPECS); | |
35 | if (!nl_specs) | |
36 | goto nla_put_failure; | |
37 | ||
38 | for (i = 1; i < argc; i++) { | |
39 | tmp = strchr(argv[i], ':'); | |
40 | if (!tmp) | |
41 | return -EINVAL; | |
42 | ||
43 | if (tmp != strrchr(argv[i], ':')) | |
44 | return -EINVAL; | |
45 | ||
46 | count = sscanf(argv[i], "%u:%d", &idx, &pwr); | |
47 | if (count != 2) | |
48 | return -EINVAL; | |
49 | ||
50 | nl_sub = nla_nest_start(msg, i - 1); | |
51 | if (!nl_sub) | |
52 | goto nla_put_failure; | |
53 | ||
54 | NLA_PUT_U32(msg, NL80211_SAR_ATTR_SPECS_RANGE_INDEX, idx); | |
55 | NLA_PUT_S32(msg, NL80211_SAR_ATTR_SPECS_POWER, pwr); | |
56 | ||
57 | nla_nest_end(msg, nl_sub); | |
58 | } | |
59 | ||
60 | nla_nest_end(msg, nl_specs); | |
61 | nla_nest_end(msg, nl_sar); | |
62 | ||
63 | return 0; | |
64 | ||
65 | nla_put_failure: | |
66 | return -ENOBUFS; | |
67 | } | |
68 | ||
69 | COMMAND(set, sar_specs, "<sar type> <range index:sar power>*", | |
70 | NL80211_CMD_SET_SAR_SPECS, 0, CIB_PHY, set_sar_specs, | |
71 | "Set SAR specs corresponding to SAR capa of wiphy."); |