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_T_OFFSET
] = { .type
= NLA_U64
},
49 [NL80211_STA_INFO_TX_BITRATE
] = { .type
= NLA_NESTED
},
50 [NL80211_STA_INFO_LLID
] = { .type
= NLA_U16
},
51 [NL80211_STA_INFO_PLID
] = { .type
= NLA_U16
},
52 [NL80211_STA_INFO_PLINK_STATE
] = { .type
= NLA_U8
},
53 [NL80211_STA_INFO_TX_RETRIES
] = { .type
= NLA_U32
},
54 [NL80211_STA_INFO_TX_FAILED
] = { .type
= NLA_U32
},
55 [NL80211_STA_INFO_STA_FLAGS
] =
56 { .minlen
= sizeof(struct nl80211_sta_flag_update
) },
59 static struct nla_policy rate_policy
[NL80211_RATE_INFO_MAX
+ 1] = {
60 [NL80211_RATE_INFO_BITRATE
] = { .type
= NLA_U16
},
61 [NL80211_RATE_INFO_BITRATE32
] = { .type
= NLA_U32
},
62 [NL80211_RATE_INFO_MCS
] = { .type
= NLA_U8
},
63 [NL80211_RATE_INFO_40_MHZ_WIDTH
] = { .type
= NLA_FLAG
},
64 [NL80211_RATE_INFO_SHORT_GI
] = { .type
= NLA_FLAG
},
67 nla_parse(tb
, NL80211_ATTR_MAX
, genlmsg_attrdata(gnlh
, 0),
68 genlmsg_attrlen(gnlh
, 0), NULL
);
71 * TODO: validate the interface and mac address!
72 * Otherwise, there's a race condition as soon as
73 * the kernel starts sending station notifications.
76 if (!tb
[NL80211_ATTR_STA_INFO
]) {
77 fprintf(stderr
, "sta stats missing!\n");
80 if (nla_parse_nested(sinfo
, NL80211_STA_INFO_MAX
,
81 tb
[NL80211_ATTR_STA_INFO
],
83 fprintf(stderr
, "failed to parse nested attributes!\n");
87 mac_addr_n2a(mac_addr
, nla_data(tb
[NL80211_ATTR_MAC
]));
88 if_indextoname(nla_get_u32(tb
[NL80211_ATTR_IFINDEX
]), dev
);
89 printf("Station %s (on %s)", mac_addr
, dev
);
91 if (sinfo
[NL80211_STA_INFO_INACTIVE_TIME
])
92 printf("\n\tinactive time:\t%u ms",
93 nla_get_u32(sinfo
[NL80211_STA_INFO_INACTIVE_TIME
]));
94 if (sinfo
[NL80211_STA_INFO_RX_BYTES
])
95 printf("\n\trx bytes:\t%u",
96 nla_get_u32(sinfo
[NL80211_STA_INFO_RX_BYTES
]));
97 if (sinfo
[NL80211_STA_INFO_RX_PACKETS
])
98 printf("\n\trx packets:\t%u",
99 nla_get_u32(sinfo
[NL80211_STA_INFO_RX_PACKETS
]));
100 if (sinfo
[NL80211_STA_INFO_TX_BYTES
])
101 printf("\n\ttx bytes:\t%u",
102 nla_get_u32(sinfo
[NL80211_STA_INFO_TX_BYTES
]));
103 if (sinfo
[NL80211_STA_INFO_TX_PACKETS
])
104 printf("\n\ttx packets:\t%u",
105 nla_get_u32(sinfo
[NL80211_STA_INFO_TX_PACKETS
]));
106 if (sinfo
[NL80211_STA_INFO_TX_RETRIES
])
107 printf("\n\ttx retries:\t%u",
108 nla_get_u32(sinfo
[NL80211_STA_INFO_TX_RETRIES
]));
109 if (sinfo
[NL80211_STA_INFO_TX_FAILED
])
110 printf("\n\ttx failed:\t%u",
111 nla_get_u32(sinfo
[NL80211_STA_INFO_TX_FAILED
]));
112 if (sinfo
[NL80211_STA_INFO_SIGNAL
])
113 printf("\n\tsignal: \t%d dBm",
114 (int8_t)nla_get_u8(sinfo
[NL80211_STA_INFO_SIGNAL
]));
115 if (sinfo
[NL80211_STA_INFO_SIGNAL_AVG
])
116 printf("\n\tsignal avg:\t%d dBm",
117 (int8_t)nla_get_u8(sinfo
[NL80211_STA_INFO_SIGNAL_AVG
]));
118 if (sinfo
[NL80211_STA_INFO_T_OFFSET
])
119 printf("\n\tToffset:\t%lld us",
120 (unsigned long long)nla_get_u64(sinfo
[NL80211_STA_INFO_T_OFFSET
]));
122 if (sinfo
[NL80211_STA_INFO_TX_BITRATE
]) {
123 if (nla_parse_nested(rinfo
, NL80211_RATE_INFO_MAX
,
124 sinfo
[NL80211_STA_INFO_TX_BITRATE
], rate_policy
)) {
125 fprintf(stderr
, "failed to parse nested rate attributes!\n");
128 printf("\n\ttx bitrate:\t");
129 if (rinfo
[NL80211_RATE_INFO_BITRATE32
])
130 rate
= nla_get_u32(rinfo
[NL80211_RATE_INFO_BITRATE32
]);
131 else if (rinfo
[NL80211_RATE_INFO_BITRATE
])
132 rate
= nla_get_u16(rinfo
[NL80211_RATE_INFO_BITRATE
]);
134 printf("%d.%d MBit/s", rate
/ 10, rate
% 10);
136 if (rinfo
[NL80211_RATE_INFO_MCS
])
137 printf(" MCS %d", nla_get_u8(rinfo
[NL80211_RATE_INFO_MCS
]));
138 if (rinfo
[NL80211_RATE_INFO_40_MHZ_WIDTH
])
140 if (rinfo
[NL80211_RATE_INFO_SHORT_GI
])
145 if (sinfo
[NL80211_STA_INFO_LLID
])
146 printf("\n\tmesh llid:\t%d",
147 nla_get_u16(sinfo
[NL80211_STA_INFO_LLID
]));
148 if (sinfo
[NL80211_STA_INFO_PLID
])
149 printf("\n\tmesh plid:\t%d",
150 nla_get_u16(sinfo
[NL80211_STA_INFO_PLID
]));
151 if (sinfo
[NL80211_STA_INFO_PLINK_STATE
]) {
152 switch (nla_get_u8(sinfo
[NL80211_STA_INFO_PLINK_STATE
])) {
154 strcpy(state_name
, "LISTEN");
157 strcpy(state_name
, "OPN_SNT");
160 strcpy(state_name
, "OPN_RCVD");
163 strcpy(state_name
, "CNF_RCVD");
166 strcpy(state_name
, "ESTAB");
169 strcpy(state_name
, "HOLDING");
172 strcpy(state_name
, "BLOCKED");
175 strcpy(state_name
, "UNKNOWN");
178 printf("\n\tmesh plink:\t%s", state_name
);
181 if (sinfo
[NL80211_STA_INFO_STA_FLAGS
]) {
182 sta_flags
= (struct nl80211_sta_flag_update
*)
183 nla_data(sinfo
[NL80211_STA_INFO_STA_FLAGS
]);
185 if (sta_flags
->mask
& BIT(NL80211_STA_FLAG_AUTHORIZED
)) {
186 printf("\n\tauthorized:\t");
187 if (sta_flags
->set
& BIT(NL80211_STA_FLAG_AUTHORIZED
))
193 if (sta_flags
->mask
& BIT(NL80211_STA_FLAG_AUTHENTICATED
)) {
194 printf("\n\tauthenticated:\t");
195 if (sta_flags
->set
& BIT(NL80211_STA_FLAG_AUTHENTICATED
))
201 if (sta_flags
->mask
& BIT(NL80211_STA_FLAG_SHORT_PREAMBLE
)) {
202 printf("\n\tpreamble:\t");
203 if (sta_flags
->set
& BIT(NL80211_STA_FLAG_SHORT_PREAMBLE
))
209 if (sta_flags
->mask
& BIT(NL80211_STA_FLAG_WME
)) {
210 printf("\n\tWMM/WME:\t");
211 if (sta_flags
->set
& BIT(NL80211_STA_FLAG_WME
))
217 if (sta_flags
->mask
& BIT(NL80211_STA_FLAG_MFP
)) {
218 printf("\n\tMFP:\t\t");
219 if (sta_flags
->set
& BIT(NL80211_STA_FLAG_MFP
))
225 if (sta_flags
->mask
& BIT(NL80211_STA_FLAG_TDLS_PEER
)) {
226 printf("\n\tTDLS peer:\t\t");
227 if (sta_flags
->set
& BIT(NL80211_STA_FLAG_TDLS_PEER
))
238 static int handle_station_get(struct nl80211_state
*state
,
241 int argc
, char **argv
,
244 unsigned char mac_addr
[ETH_ALEN
];
249 if (mac_addr_a2n(mac_addr
, argv
[0])) {
250 fprintf(stderr
, "invalid mac address\n");
260 NLA_PUT(msg
, NL80211_ATTR_MAC
, ETH_ALEN
, mac_addr
);
262 nl_cb_set(cb
, NL_CB_VALID
, NL_CB_CUSTOM
, print_sta_handler
, NULL
);
268 COMMAND(station
, get
, "<MAC address>",
269 NL80211_CMD_GET_STATION
, 0, CIB_NETDEV
, handle_station_get
,
270 "Get information for a specific station.");
271 COMMAND(station
, del
, "<MAC address>",
272 NL80211_CMD_DEL_STATION
, 0, CIB_NETDEV
, handle_station_get
,
273 "Remove the given station entry (use with caution!)");
275 static const struct cmd
*station_set_plink
;
276 static const struct cmd
*station_set_vlan
;
278 static const struct cmd
*select_station_cmd(int argc
, char **argv
)
282 if (strcmp(argv
[1], "plink_action") == 0)
283 return station_set_plink
;
284 if (strcmp(argv
[1], "vlan") == 0)
285 return station_set_vlan
;
289 static int handle_station_set_plink(struct nl80211_state
*state
,
292 int argc
, char **argv
,
295 unsigned char plink_action
;
296 unsigned char mac_addr
[ETH_ALEN
];
301 if (mac_addr_a2n(mac_addr
, argv
[0])) {
302 fprintf(stderr
, "invalid mac address\n");
308 if (strcmp("plink_action", argv
[0]) != 0)
313 if (strcmp("open", argv
[0]) == 0)
314 plink_action
= PLINK_ACTION_OPEN
;
315 else if (strcmp("block", argv
[0]) == 0)
316 plink_action
= PLINK_ACTION_BLOCK
;
318 fprintf(stderr
, "plink action not supported\n");
327 NLA_PUT(msg
, NL80211_ATTR_MAC
, ETH_ALEN
, mac_addr
);
328 NLA_PUT_U8(msg
, NL80211_ATTR_STA_PLINK_ACTION
, plink_action
);
334 COMMAND_ALIAS(station
, set
, "<MAC address> plink_action <open|block>",
335 NL80211_CMD_SET_STATION
, 0, CIB_NETDEV
, handle_station_set_plink
,
336 "Set mesh peer link action for this station (peer).",
337 select_station_cmd
, station_set_plink
);
339 static int handle_station_set_vlan(struct nl80211_state
*state
,
342 int argc
, char **argv
,
345 unsigned char mac_addr
[ETH_ALEN
];
346 unsigned long sta_vlan
= 0;
352 if (mac_addr_a2n(mac_addr
, argv
[0])) {
353 fprintf(stderr
, "invalid mac address\n");
359 if (strcmp("vlan", argv
[0]) != 0)
364 sta_vlan
= strtoul(argv
[0], &err
, 0);
366 fprintf(stderr
, "invalid vlan id\n");
375 NLA_PUT(msg
, NL80211_ATTR_MAC
, ETH_ALEN
, mac_addr
);
376 NLA_PUT_U32(msg
, NL80211_ATTR_STA_VLAN
, sta_vlan
);
382 COMMAND_ALIAS(station
, set
, "<MAC address> vlan <ifindex>",
383 NL80211_CMD_SET_STATION
, 0, CIB_NETDEV
, handle_station_set_vlan
,
384 "Set an AP VLAN for this station.",
385 select_station_cmd
, station_set_vlan
);
388 static int handle_station_dump(struct nl80211_state
*state
,
391 int argc
, char **argv
,
394 nl_cb_set(cb
, NL_CB_VALID
, NL_CB_CUSTOM
, print_sta_handler
, NULL
);
397 COMMAND(station
, dump
, NULL
,
398 NL80211_CMD_GET_STATION
, NLM_F_DUMP
, CIB_NETDEV
, handle_station_dump
,
399 "List all stations known, e.g. the AP on managed interfaces");