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>
27 PLINK_ACTION_UNDEFINED
,
33 static int print_sta_handler(struct nl_msg
*msg
, void *arg
)
35 struct nlattr
*tb
[NL80211_ATTR_MAX
+ 1];
36 struct genlmsghdr
*gnlh
= nlmsg_data(nlmsg_hdr(msg
));
37 struct nlattr
*sinfo
[NL80211_STA_INFO_MAX
+ 1];
38 struct nlattr
*rinfo
[NL80211_RATE_INFO_MAX
+ 1];
39 char mac_addr
[20], state_name
[10], dev
[20];
40 struct nl80211_sta_flag_update
*sta_flags
;
41 static struct nla_policy stats_policy
[NL80211_STA_INFO_MAX
+ 1] = {
42 [NL80211_STA_INFO_INACTIVE_TIME
] = { .type
= NLA_U32
},
43 [NL80211_STA_INFO_RX_BYTES
] = { .type
= NLA_U32
},
44 [NL80211_STA_INFO_TX_BYTES
] = { .type
= NLA_U32
},
45 [NL80211_STA_INFO_RX_PACKETS
] = { .type
= NLA_U32
},
46 [NL80211_STA_INFO_TX_PACKETS
] = { .type
= NLA_U32
},
47 [NL80211_STA_INFO_SIGNAL
] = { .type
= NLA_U8
},
48 [NL80211_STA_INFO_TX_BITRATE
] = { .type
= NLA_NESTED
},
49 [NL80211_STA_INFO_LLID
] = { .type
= NLA_U16
},
50 [NL80211_STA_INFO_PLID
] = { .type
= NLA_U16
},
51 [NL80211_STA_INFO_PLINK_STATE
] = { .type
= NLA_U8
},
52 [NL80211_STA_INFO_TX_RETRIES
] = { .type
= NLA_U32
},
53 [NL80211_STA_INFO_TX_FAILED
] = { .type
= NLA_U32
},
54 [NL80211_STA_INFO_STA_FLAGS
] =
55 { .minlen
= sizeof(struct nl80211_sta_flag_update
) },
58 static struct nla_policy rate_policy
[NL80211_RATE_INFO_MAX
+ 1] = {
59 [NL80211_RATE_INFO_BITRATE
] = { .type
= NLA_U16
},
60 [NL80211_RATE_INFO_MCS
] = { .type
= NLA_U8
},
61 [NL80211_RATE_INFO_40_MHZ_WIDTH
] = { .type
= NLA_FLAG
},
62 [NL80211_RATE_INFO_SHORT_GI
] = { .type
= NLA_FLAG
},
65 nla_parse(tb
, NL80211_ATTR_MAX
, genlmsg_attrdata(gnlh
, 0),
66 genlmsg_attrlen(gnlh
, 0), NULL
);
69 * TODO: validate the interface and mac address!
70 * Otherwise, there's a race condition as soon as
71 * the kernel starts sending station notifications.
74 if (!tb
[NL80211_ATTR_STA_INFO
]) {
75 fprintf(stderr
, "sta stats missing!\n");
78 if (nla_parse_nested(sinfo
, NL80211_STA_INFO_MAX
,
79 tb
[NL80211_ATTR_STA_INFO
],
81 fprintf(stderr
, "failed to parse nested attributes!\n");
85 mac_addr_n2a(mac_addr
, nla_data(tb
[NL80211_ATTR_MAC
]));
86 if_indextoname(nla_get_u32(tb
[NL80211_ATTR_IFINDEX
]), dev
);
87 printf("Station %s (on %s)", mac_addr
, dev
);
89 if (sinfo
[NL80211_STA_INFO_INACTIVE_TIME
])
90 printf("\n\tinactive time:\t%u ms",
91 nla_get_u32(sinfo
[NL80211_STA_INFO_INACTIVE_TIME
]));
92 if (sinfo
[NL80211_STA_INFO_RX_BYTES
])
93 printf("\n\trx bytes:\t%u",
94 nla_get_u32(sinfo
[NL80211_STA_INFO_RX_BYTES
]));
95 if (sinfo
[NL80211_STA_INFO_RX_PACKETS
])
96 printf("\n\trx packets:\t%u",
97 nla_get_u32(sinfo
[NL80211_STA_INFO_RX_PACKETS
]));
98 if (sinfo
[NL80211_STA_INFO_TX_BYTES
])
99 printf("\n\ttx bytes:\t%u",
100 nla_get_u32(sinfo
[NL80211_STA_INFO_TX_BYTES
]));
101 if (sinfo
[NL80211_STA_INFO_TX_PACKETS
])
102 printf("\n\ttx packets:\t%u",
103 nla_get_u32(sinfo
[NL80211_STA_INFO_TX_PACKETS
]));
104 if (sinfo
[NL80211_STA_INFO_TX_RETRIES
])
105 printf("\n\ttx retries:\t%u",
106 nla_get_u32(sinfo
[NL80211_STA_INFO_TX_RETRIES
]));
107 if (sinfo
[NL80211_STA_INFO_TX_FAILED
])
108 printf("\n\ttx failed:\t%u",
109 nla_get_u32(sinfo
[NL80211_STA_INFO_TX_FAILED
]));
110 if (sinfo
[NL80211_STA_INFO_SIGNAL
])
111 printf("\n\tsignal: \t%d dBm",
112 (int8_t)nla_get_u8(sinfo
[NL80211_STA_INFO_SIGNAL
]));
113 if (sinfo
[NL80211_STA_INFO_SIGNAL_AVG
])
114 printf("\n\tsignal avg:\t%d dBm",
115 (int8_t)nla_get_u8(sinfo
[NL80211_STA_INFO_SIGNAL_AVG
]));
117 if (sinfo
[NL80211_STA_INFO_TX_BITRATE
]) {
118 if (nla_parse_nested(rinfo
, NL80211_RATE_INFO_MAX
,
119 sinfo
[NL80211_STA_INFO_TX_BITRATE
], rate_policy
)) {
120 fprintf(stderr
, "failed to parse nested rate attributes!\n");
122 printf("\n\ttx bitrate:\t");
123 if (rinfo
[NL80211_RATE_INFO_BITRATE
]) {
124 int rate
= nla_get_u16(rinfo
[NL80211_RATE_INFO_BITRATE
]);
125 printf("%d.%d MBit/s", rate
/ 10, rate
% 10);
128 if (rinfo
[NL80211_RATE_INFO_MCS
])
129 printf(" MCS %d", nla_get_u8(rinfo
[NL80211_RATE_INFO_MCS
]));
130 if (rinfo
[NL80211_RATE_INFO_40_MHZ_WIDTH
])
132 if (rinfo
[NL80211_RATE_INFO_SHORT_GI
])
137 if (sinfo
[NL80211_STA_INFO_LLID
])
138 printf("\n\tmesh llid:\t%d",
139 nla_get_u16(sinfo
[NL80211_STA_INFO_LLID
]));
140 if (sinfo
[NL80211_STA_INFO_PLID
])
141 printf("\n\tmesh plid:\t%d",
142 nla_get_u16(sinfo
[NL80211_STA_INFO_PLID
]));
143 if (sinfo
[NL80211_STA_INFO_PLINK_STATE
]) {
144 switch (nla_get_u8(sinfo
[NL80211_STA_INFO_PLINK_STATE
])) {
146 strcpy(state_name
, "LISTEN");
149 strcpy(state_name
, "OPN_SNT");
152 strcpy(state_name
, "OPN_RCVD");
155 strcpy(state_name
, "CNF_RCVD");
158 strcpy(state_name
, "ESTAB");
161 strcpy(state_name
, "HOLDING");
164 strcpy(state_name
, "BLOCKED");
167 strcpy(state_name
, "UNKNOWN");
170 printf("\n\tmesh plink:\t%s", state_name
);
173 if (sinfo
[NL80211_STA_INFO_STA_FLAGS
]) {
174 sta_flags
= (struct nl80211_sta_flag_update
*)
175 nla_data(sinfo
[NL80211_STA_INFO_STA_FLAGS
]);
177 if (sta_flags
->mask
& BIT(NL80211_STA_FLAG_AUTHORIZED
)) {
178 printf("\n\tauthorized:\t");
179 if (sta_flags
->set
& BIT(NL80211_STA_FLAG_AUTHORIZED
))
185 if (sta_flags
->mask
& BIT(NL80211_STA_FLAG_AUTHENTICATED
)) {
186 printf("\n\tauthenticated:\t");
187 if (sta_flags
->set
& BIT(NL80211_STA_FLAG_AUTHENTICATED
))
193 if (sta_flags
->mask
& BIT(NL80211_STA_FLAG_SHORT_PREAMBLE
)) {
194 printf("\n\tpreamble:\t");
195 if (sta_flags
->set
& BIT(NL80211_STA_FLAG_SHORT_PREAMBLE
))
201 if (sta_flags
->mask
& BIT(NL80211_STA_FLAG_WME
)) {
202 printf("\n\tWMM/WME:\t");
203 if (sta_flags
->set
& BIT(NL80211_STA_FLAG_WME
))
209 if (sta_flags
->mask
& BIT(NL80211_STA_FLAG_MFP
)) {
210 printf("\n\tMFP:\t\t");
211 if (sta_flags
->set
& BIT(NL80211_STA_FLAG_MFP
))
217 if (sta_flags
->mask
& BIT(NL80211_STA_FLAG_TDLS_PEER
)) {
218 printf("\n\tTDLS peer:\t\t");
219 if (sta_flags
->set
& BIT(NL80211_STA_FLAG_TDLS_PEER
))
230 static int handle_station_get(struct nl80211_state
*state
,
233 int argc
, char **argv
)
235 unsigned char mac_addr
[ETH_ALEN
];
240 if (mac_addr_a2n(mac_addr
, argv
[0])) {
241 fprintf(stderr
, "invalid mac address\n");
251 NLA_PUT(msg
, NL80211_ATTR_MAC
, ETH_ALEN
, mac_addr
);
253 nl_cb_set(cb
, NL_CB_VALID
, NL_CB_CUSTOM
, print_sta_handler
, NULL
);
259 COMMAND(station
, get
, "<MAC address>",
260 NL80211_CMD_GET_STATION
, 0, CIB_NETDEV
, handle_station_get
,
261 "Get information for a specific station.");
262 COMMAND(station
, del
, "<MAC address>",
263 NL80211_CMD_DEL_STATION
, 0, CIB_NETDEV
, handle_station_get
,
264 "Remove the given station entry (use with caution!)");
266 static const struct cmd
*station_set_plink
;
267 static const struct cmd
*station_set_vlan
;
269 static const struct cmd
*select_station_cmd(int argc
, char **argv
)
273 if (strcmp(argv
[1], "plink_action") == 0)
274 return station_set_plink
;
275 if (strcmp(argv
[1], "vlan") == 0)
276 return station_set_vlan
;
280 static int handle_station_set_plink(struct nl80211_state
*state
,
283 int argc
, char **argv
)
285 unsigned char plink_action
;
286 unsigned char mac_addr
[ETH_ALEN
];
291 if (mac_addr_a2n(mac_addr
, argv
[0])) {
292 fprintf(stderr
, "invalid mac address\n");
298 if (strcmp("plink_action", argv
[0]) != 0)
303 if (strcmp("open", argv
[0]) == 0)
304 plink_action
= PLINK_ACTION_OPEN
;
305 else if (strcmp("block", argv
[0]) == 0)
306 plink_action
= PLINK_ACTION_BLOCK
;
308 fprintf(stderr
, "plink action not supported\n");
317 NLA_PUT(msg
, NL80211_ATTR_MAC
, ETH_ALEN
, mac_addr
);
318 NLA_PUT_U8(msg
, NL80211_ATTR_STA_PLINK_ACTION
, plink_action
);
324 COMMAND_ALIAS(station
, set
, "<MAC address> plink_action <open|block>",
325 NL80211_CMD_SET_STATION
, 0, CIB_NETDEV
, handle_station_set_plink
,
326 "Set mesh peer link action for this station (peer).",
327 select_station_cmd
, station_set_plink
);
329 static int handle_station_set_vlan(struct nl80211_state
*state
,
332 int argc
, char **argv
)
334 unsigned char mac_addr
[ETH_ALEN
];
335 unsigned long sta_vlan
= 0;
341 if (mac_addr_a2n(mac_addr
, argv
[0])) {
342 fprintf(stderr
, "invalid mac address\n");
348 if (strcmp("vlan", argv
[0]) != 0)
353 sta_vlan
= strtoul(argv
[0], &err
, 0);
355 fprintf(stderr
, "invalid vlan id\n");
364 NLA_PUT(msg
, NL80211_ATTR_MAC
, ETH_ALEN
, mac_addr
);
365 NLA_PUT_U32(msg
, NL80211_ATTR_STA_VLAN
, sta_vlan
);
371 COMMAND_ALIAS(station
, set
, "<MAC address> vlan <ifindex>",
372 NL80211_CMD_SET_STATION
, 0, CIB_NETDEV
, handle_station_set_vlan
,
373 "Set an AP VLAN for this station.",
374 select_station_cmd
, station_set_vlan
);
377 static int handle_station_dump(struct nl80211_state
*state
,
380 int argc
, char **argv
)
382 nl_cb_set(cb
, NL_CB_VALID
, NL_CB_CUSTOM
, print_sta_handler
, NULL
);
385 COMMAND(station
, dump
, NULL
,
386 NL80211_CMD_GET_STATION
, NLM_F_DUMP
, CIB_NETDEV
, handle_station_dump
,
387 "List all stations known, e.g. the AP on managed interfaces");