]>
Commit | Line | Data |
---|---|---|
79f99b9a | 1 | #include <errno.h> |
2ef1be68 JB |
2 | #include <linux/nl80211.h> |
3 | #include <net/if.h> | |
4 | ||
79f99b9a JB |
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> | |
79f99b9a JB |
10 | |
11 | #include "iw.h" | |
12 | ||
13 | static void print_flag(const char *name, int *open) | |
14 | { | |
15 | if (!*open) | |
16 | printf(" ("); | |
17 | else | |
18 | printf(", "); | |
19 | printf(name); | |
20 | *open = 1; | |
21 | } | |
22 | ||
23 | static int print_phy_handler(struct nl_msg *msg, void *arg) | |
24 | { | |
25 | struct nlattr *tb_msg[NL80211_ATTR_MAX + 1]; | |
26 | struct genlmsghdr *gnlh = nlmsg_data(nlmsg_hdr(msg)); | |
27 | ||
28 | struct nlattr *tb_band[NL80211_BAND_ATTR_MAX + 1]; | |
29 | ||
30 | struct nlattr *tb_freq[NL80211_FREQUENCY_ATTR_MAX + 1]; | |
31 | static struct nla_policy freq_policy[NL80211_FREQUENCY_ATTR_MAX + 1] = { | |
32 | [NL80211_FREQUENCY_ATTR_FREQ] = { .type = NLA_U32 }, | |
33 | [NL80211_FREQUENCY_ATTR_DISABLED] = { .type = NLA_FLAG }, | |
34 | [NL80211_FREQUENCY_ATTR_PASSIVE_SCAN] = { .type = NLA_FLAG }, | |
35 | [NL80211_FREQUENCY_ATTR_NO_IBSS] = { .type = NLA_FLAG }, | |
36 | [NL80211_FREQUENCY_ATTR_RADAR] = { .type = NLA_FLAG }, | |
37 | }; | |
38 | ||
39 | struct nlattr *tb_rate[NL80211_BITRATE_ATTR_MAX + 1]; | |
40 | static struct nla_policy rate_policy[NL80211_BITRATE_ATTR_MAX + 1] = { | |
41 | [NL80211_BITRATE_ATTR_RATE] = { .type = NLA_U32 }, | |
42 | [NL80211_BITRATE_ATTR_2GHZ_SHORTPREAMBLE] = { .type = NLA_FLAG }, | |
43 | }; | |
44 | ||
45 | struct nlattr *nl_band; | |
46 | struct nlattr *nl_freq; | |
47 | struct nlattr *nl_rate; | |
6367e71a | 48 | struct nlattr *nl_mode; |
79f99b9a | 49 | int bandidx = 1; |
6367e71a | 50 | int rem_band, rem_freq, rem_rate, rem_mode; |
79f99b9a JB |
51 | int open; |
52 | ||
53 | nla_parse(tb_msg, NL80211_ATTR_MAX, genlmsg_attrdata(gnlh, 0), | |
54 | genlmsg_attrlen(gnlh, 0), NULL); | |
55 | ||
56 | if (!tb_msg[NL80211_ATTR_WIPHY_BANDS]) | |
57 | return NL_SKIP; | |
58 | ||
59 | nla_for_each_nested(nl_band, tb_msg[NL80211_ATTR_WIPHY_BANDS], rem_band) { | |
60 | printf("Band %d:\n", bandidx); | |
61 | bandidx++; | |
62 | ||
63 | nla_parse(tb_band, NL80211_BAND_ATTR_MAX, nla_data(nl_band), | |
64 | nla_len(nl_band), NULL); | |
65 | ||
66 | printf("\tFrequencies:\n"); | |
67 | ||
68 | nla_for_each_nested(nl_freq, tb_band[NL80211_BAND_ATTR_FREQS], rem_freq) { | |
69 | nla_parse(tb_freq, NL80211_FREQUENCY_ATTR_MAX, nla_data(nl_freq), | |
70 | nla_len(nl_freq), freq_policy); | |
71 | if (!tb_freq[NL80211_FREQUENCY_ATTR_FREQ]) | |
72 | continue; | |
73 | printf("\t\t* %d MHz", nla_get_u32(tb_freq[NL80211_FREQUENCY_ATTR_FREQ])); | |
74 | open = 0; | |
75 | if (tb_freq[NL80211_FREQUENCY_ATTR_DISABLED]) | |
76 | print_flag("disabled", &open); | |
77 | if (tb_freq[NL80211_FREQUENCY_ATTR_PASSIVE_SCAN]) | |
78 | print_flag("passive scanning", &open); | |
79 | if (tb_freq[NL80211_FREQUENCY_ATTR_NO_IBSS]) | |
80 | print_flag("no IBSS", &open); | |
81 | if (tb_freq[NL80211_FREQUENCY_ATTR_RADAR]) | |
82 | print_flag("radar detection", &open); | |
83 | if (open) | |
84 | printf(")"); | |
85 | printf("\n"); | |
86 | } | |
87 | ||
88 | printf("\tBitrates:\n"); | |
89 | ||
90 | nla_for_each_nested(nl_rate, tb_band[NL80211_BAND_ATTR_RATES], rem_rate) { | |
91 | nla_parse(tb_rate, NL80211_BITRATE_ATTR_MAX, nla_data(nl_rate), | |
92 | nla_len(nl_rate), rate_policy); | |
93 | if (!tb_rate[NL80211_BITRATE_ATTR_RATE]) | |
94 | continue; | |
95 | printf("\t\t* %2.1f Mbps", 0.1 * nla_get_u32(tb_rate[NL80211_BITRATE_ATTR_RATE])); | |
96 | open = 0; | |
97 | if (tb_rate[NL80211_BITRATE_ATTR_2GHZ_SHORTPREAMBLE]) | |
98 | print_flag("short preamble supported", &open); | |
99 | if (open) | |
100 | printf(")"); | |
101 | printf("\n"); | |
102 | } | |
103 | } | |
104 | ||
6367e71a JB |
105 | if (!tb_msg[NL80211_ATTR_SUPPORTED_IFTYPES]) |
106 | return NL_SKIP; | |
107 | ||
108 | printf("Supported interface modes:\n"); | |
541ef425 JB |
109 | nla_for_each_nested(nl_mode, tb_msg[NL80211_ATTR_SUPPORTED_IFTYPES], rem_mode) |
110 | printf("\t * %s\n", iftype_name(nl_mode->nla_type)); | |
6367e71a | 111 | |
79f99b9a JB |
112 | return NL_SKIP; |
113 | } | |
114 | ||
115 | ||
116 | ||
117 | static int ack_wait_handler(struct nl_msg *msg, void *arg) | |
118 | { | |
119 | int *finished = arg; | |
120 | ||
121 | *finished = 1; | |
122 | return NL_STOP; | |
123 | } | |
124 | ||
125 | int handle_info(struct nl80211_state *state, char *phy, char *dev) | |
126 | { | |
127 | struct nl_msg *msg; | |
128 | int err = -1; | |
541ef425 | 129 | struct nl_cb *cb; |
79f99b9a JB |
130 | int finished; |
131 | ||
132 | msg = nlmsg_alloc(); | |
133 | if (!msg) { | |
134 | fprintf(stderr, "failed to allocate netlink msg\n"); | |
135 | return -1; | |
136 | } | |
137 | ||
138 | genlmsg_put(msg, 0, 0, genl_family_get_id(state->nl80211), 0, | |
139 | 0, NL80211_CMD_GET_WIPHY, 0); | |
140 | if (dev) | |
141 | NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, if_nametoindex(dev)); | |
142 | if (phy) | |
143 | return -1; /* XXX TODO */ | |
144 | ||
145 | cb = nl_cb_alloc(NL_CB_CUSTOM); | |
146 | if (!cb) | |
147 | goto out; | |
148 | ||
149 | if (nl_send_auto_complete(state->nl_handle, msg) < 0) | |
150 | goto out; | |
151 | ||
152 | nl_cb_set(cb, NL_CB_VALID, NL_CB_CUSTOM, print_phy_handler, NULL); | |
153 | nl_cb_set(cb, NL_CB_ACK, NL_CB_CUSTOM, ack_wait_handler, &finished); | |
154 | ||
155 | err = nl_recvmsgs(state->nl_handle, cb); | |
156 | ||
157 | if (!finished) | |
158 | err = nl_wait_for_ack(state->nl_handle); | |
159 | ||
160 | if (err < 0) | |
161 | goto out; | |
162 | err = 0; | |
163 | ||
164 | out: | |
165 | nl_cb_put(cb); | |
166 | nla_put_failure: | |
167 | if (err) | |
168 | fprintf(stderr, "failed to get information: %d\n", err); | |
169 | nlmsg_free(msg); | |
170 | return err; | |
171 | } |