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>
26 static void print_power_mode(struct nlattr
*a
)
28 enum nl80211_mesh_power_mode pm
= nla_get_u32(a
);
31 case NL80211_MESH_POWER_ACTIVE
:
34 case NL80211_MESH_POWER_LIGHT_SLEEP
:
35 printf("LIGHT SLEEP");
37 case NL80211_MESH_POWER_DEEP_SLEEP
:
46 void parse_tx_bitrate(struct nlattr
*bitrate_attr
, char *buf
, int buflen
)
50 struct nlattr
*rinfo
[NL80211_RATE_INFO_MAX
+ 1];
51 static struct nla_policy rate_policy
[NL80211_RATE_INFO_MAX
+ 1] = {
52 [NL80211_RATE_INFO_BITRATE
] = { .type
= NLA_U16
},
53 [NL80211_RATE_INFO_BITRATE32
] = { .type
= NLA_U32
},
54 [NL80211_RATE_INFO_MCS
] = { .type
= NLA_U8
},
55 [NL80211_RATE_INFO_40_MHZ_WIDTH
] = { .type
= NLA_FLAG
},
56 [NL80211_RATE_INFO_SHORT_GI
] = { .type
= NLA_FLAG
},
59 if (nla_parse_nested(rinfo
, NL80211_RATE_INFO_MAX
,
60 bitrate_attr
, rate_policy
)) {
61 snprintf(buf
, buflen
, "failed to parse nested rate attributes!");
65 if (rinfo
[NL80211_RATE_INFO_BITRATE32
])
66 rate
= nla_get_u32(rinfo
[NL80211_RATE_INFO_BITRATE32
]);
67 else if (rinfo
[NL80211_RATE_INFO_BITRATE
])
68 rate
= nla_get_u16(rinfo
[NL80211_RATE_INFO_BITRATE
]);
70 pos
+= snprintf(pos
, buflen
- (pos
- buf
),
71 "%d.%d MBit/s", rate
/ 10, rate
% 10);
73 if (rinfo
[NL80211_RATE_INFO_MCS
])
74 pos
+= snprintf(pos
, buflen
- (pos
- buf
),
75 " MCS %d", nla_get_u8(rinfo
[NL80211_RATE_INFO_MCS
]));
76 if (rinfo
[NL80211_RATE_INFO_VHT_MCS
])
77 pos
+= snprintf(pos
, buflen
- (pos
- buf
),
78 " VHT-MCS %d", nla_get_u8(rinfo
[NL80211_RATE_INFO_VHT_MCS
]));
79 if (rinfo
[NL80211_RATE_INFO_40_MHZ_WIDTH
])
80 pos
+= snprintf(pos
, buflen
- (pos
- buf
), " 40MHz");
81 if (rinfo
[NL80211_RATE_INFO_80_MHZ_WIDTH
])
82 pos
+= snprintf(pos
, buflen
- (pos
- buf
), " 80MHz");
83 if (rinfo
[NL80211_RATE_INFO_80P80_MHZ_WIDTH
])
84 pos
+= snprintf(pos
, buflen
- (pos
- buf
), " 80P80MHz");
85 if (rinfo
[NL80211_RATE_INFO_160_MHZ_WIDTH
])
86 pos
+= snprintf(pos
, buflen
- (pos
- buf
), " 160MHz");
87 if (rinfo
[NL80211_RATE_INFO_SHORT_GI
])
88 pos
+= snprintf(pos
, buflen
- (pos
- buf
), " short GI");
89 if (rinfo
[NL80211_RATE_INFO_VHT_NSS
])
90 pos
+= snprintf(pos
, buflen
- (pos
- buf
),
91 " VHT-NSS %d", nla_get_u8(rinfo
[NL80211_RATE_INFO_VHT_NSS
]));
94 static int print_sta_handler(struct nl_msg
*msg
, void *arg
)
96 struct nlattr
*tb
[NL80211_ATTR_MAX
+ 1];
97 struct genlmsghdr
*gnlh
= nlmsg_data(nlmsg_hdr(msg
));
98 struct nlattr
*sinfo
[NL80211_STA_INFO_MAX
+ 1];
99 char mac_addr
[20], state_name
[10], dev
[20];
100 struct nl80211_sta_flag_update
*sta_flags
;
101 static struct nla_policy stats_policy
[NL80211_STA_INFO_MAX
+ 1] = {
102 [NL80211_STA_INFO_INACTIVE_TIME
] = { .type
= NLA_U32
},
103 [NL80211_STA_INFO_RX_BYTES
] = { .type
= NLA_U32
},
104 [NL80211_STA_INFO_TX_BYTES
] = { .type
= NLA_U32
},
105 [NL80211_STA_INFO_RX_PACKETS
] = { .type
= NLA_U32
},
106 [NL80211_STA_INFO_TX_PACKETS
] = { .type
= NLA_U32
},
107 [NL80211_STA_INFO_SIGNAL
] = { .type
= NLA_U8
},
108 [NL80211_STA_INFO_T_OFFSET
] = { .type
= NLA_U64
},
109 [NL80211_STA_INFO_TX_BITRATE
] = { .type
= NLA_NESTED
},
110 [NL80211_STA_INFO_LLID
] = { .type
= NLA_U16
},
111 [NL80211_STA_INFO_PLID
] = { .type
= NLA_U16
},
112 [NL80211_STA_INFO_PLINK_STATE
] = { .type
= NLA_U8
},
113 [NL80211_STA_INFO_TX_RETRIES
] = { .type
= NLA_U32
},
114 [NL80211_STA_INFO_TX_FAILED
] = { .type
= NLA_U32
},
115 [NL80211_STA_INFO_STA_FLAGS
] =
116 { .minlen
= sizeof(struct nl80211_sta_flag_update
) },
117 [NL80211_STA_INFO_LOCAL_PM
] = { .type
= NLA_U32
},
118 [NL80211_STA_INFO_PEER_PM
] = { .type
= NLA_U32
},
119 [NL80211_STA_INFO_NONPEER_PM
] = { .type
= NLA_U32
},
122 nla_parse(tb
, NL80211_ATTR_MAX
, genlmsg_attrdata(gnlh
, 0),
123 genlmsg_attrlen(gnlh
, 0), NULL
);
126 * TODO: validate the interface and mac address!
127 * Otherwise, there's a race condition as soon as
128 * the kernel starts sending station notifications.
131 if (!tb
[NL80211_ATTR_STA_INFO
]) {
132 fprintf(stderr
, "sta stats missing!\n");
135 if (nla_parse_nested(sinfo
, NL80211_STA_INFO_MAX
,
136 tb
[NL80211_ATTR_STA_INFO
],
138 fprintf(stderr
, "failed to parse nested attributes!\n");
142 mac_addr_n2a(mac_addr
, nla_data(tb
[NL80211_ATTR_MAC
]));
143 if_indextoname(nla_get_u32(tb
[NL80211_ATTR_IFINDEX
]), dev
);
144 printf("Station %s (on %s)", mac_addr
, dev
);
146 if (sinfo
[NL80211_STA_INFO_INACTIVE_TIME
])
147 printf("\n\tinactive time:\t%u ms",
148 nla_get_u32(sinfo
[NL80211_STA_INFO_INACTIVE_TIME
]));
149 if (sinfo
[NL80211_STA_INFO_RX_BYTES
])
150 printf("\n\trx bytes:\t%u",
151 nla_get_u32(sinfo
[NL80211_STA_INFO_RX_BYTES
]));
152 if (sinfo
[NL80211_STA_INFO_RX_PACKETS
])
153 printf("\n\trx packets:\t%u",
154 nla_get_u32(sinfo
[NL80211_STA_INFO_RX_PACKETS
]));
155 if (sinfo
[NL80211_STA_INFO_TX_BYTES
])
156 printf("\n\ttx bytes:\t%u",
157 nla_get_u32(sinfo
[NL80211_STA_INFO_TX_BYTES
]));
158 if (sinfo
[NL80211_STA_INFO_TX_PACKETS
])
159 printf("\n\ttx packets:\t%u",
160 nla_get_u32(sinfo
[NL80211_STA_INFO_TX_PACKETS
]));
161 if (sinfo
[NL80211_STA_INFO_TX_RETRIES
])
162 printf("\n\ttx retries:\t%u",
163 nla_get_u32(sinfo
[NL80211_STA_INFO_TX_RETRIES
]));
164 if (sinfo
[NL80211_STA_INFO_TX_FAILED
])
165 printf("\n\ttx failed:\t%u",
166 nla_get_u32(sinfo
[NL80211_STA_INFO_TX_FAILED
]));
167 if (sinfo
[NL80211_STA_INFO_SIGNAL
])
168 printf("\n\tsignal: \t%d dBm",
169 (int8_t)nla_get_u8(sinfo
[NL80211_STA_INFO_SIGNAL
]));
170 if (sinfo
[NL80211_STA_INFO_SIGNAL_AVG
])
171 printf("\n\tsignal avg:\t%d dBm",
172 (int8_t)nla_get_u8(sinfo
[NL80211_STA_INFO_SIGNAL_AVG
]));
173 if (sinfo
[NL80211_STA_INFO_T_OFFSET
])
174 printf("\n\tToffset:\t%lld us",
175 (unsigned long long)nla_get_u64(sinfo
[NL80211_STA_INFO_T_OFFSET
]));
177 if (sinfo
[NL80211_STA_INFO_TX_BITRATE
]) {
180 parse_tx_bitrate(sinfo
[NL80211_STA_INFO_TX_BITRATE
], buf
, sizeof(buf
));
181 printf("\n\ttx bitrate:\t%s", buf
);
184 if (sinfo
[NL80211_STA_INFO_LLID
])
185 printf("\n\tmesh llid:\t%d",
186 nla_get_u16(sinfo
[NL80211_STA_INFO_LLID
]));
187 if (sinfo
[NL80211_STA_INFO_PLID
])
188 printf("\n\tmesh plid:\t%d",
189 nla_get_u16(sinfo
[NL80211_STA_INFO_PLID
]));
190 if (sinfo
[NL80211_STA_INFO_PLINK_STATE
]) {
191 switch (nla_get_u8(sinfo
[NL80211_STA_INFO_PLINK_STATE
])) {
193 strcpy(state_name
, "LISTEN");
196 strcpy(state_name
, "OPN_SNT");
199 strcpy(state_name
, "OPN_RCVD");
202 strcpy(state_name
, "CNF_RCVD");
205 strcpy(state_name
, "ESTAB");
208 strcpy(state_name
, "HOLDING");
211 strcpy(state_name
, "BLOCKED");
214 strcpy(state_name
, "UNKNOWN");
217 printf("\n\tmesh plink:\t%s", state_name
);
219 if (sinfo
[NL80211_STA_INFO_LOCAL_PM
]) {
220 printf("\n\tmesh local PS mode:\t");
221 print_power_mode(sinfo
[NL80211_STA_INFO_LOCAL_PM
]);
223 if (sinfo
[NL80211_STA_INFO_PEER_PM
]) {
224 printf("\n\tmesh peer PS mode:\t");
225 print_power_mode(sinfo
[NL80211_STA_INFO_PEER_PM
]);
227 if (sinfo
[NL80211_STA_INFO_NONPEER_PM
]) {
228 printf("\n\tmesh non-peer PS mode:\t");
229 print_power_mode(sinfo
[NL80211_STA_INFO_NONPEER_PM
]);
232 if (sinfo
[NL80211_STA_INFO_STA_FLAGS
]) {
233 sta_flags
= (struct nl80211_sta_flag_update
*)
234 nla_data(sinfo
[NL80211_STA_INFO_STA_FLAGS
]);
236 if (sta_flags
->mask
& BIT(NL80211_STA_FLAG_AUTHORIZED
)) {
237 printf("\n\tauthorized:\t");
238 if (sta_flags
->set
& BIT(NL80211_STA_FLAG_AUTHORIZED
))
244 if (sta_flags
->mask
& BIT(NL80211_STA_FLAG_AUTHENTICATED
)) {
245 printf("\n\tauthenticated:\t");
246 if (sta_flags
->set
& BIT(NL80211_STA_FLAG_AUTHENTICATED
))
252 if (sta_flags
->mask
& BIT(NL80211_STA_FLAG_SHORT_PREAMBLE
)) {
253 printf("\n\tpreamble:\t");
254 if (sta_flags
->set
& BIT(NL80211_STA_FLAG_SHORT_PREAMBLE
))
260 if (sta_flags
->mask
& BIT(NL80211_STA_FLAG_WME
)) {
261 printf("\n\tWMM/WME:\t");
262 if (sta_flags
->set
& BIT(NL80211_STA_FLAG_WME
))
268 if (sta_flags
->mask
& BIT(NL80211_STA_FLAG_MFP
)) {
269 printf("\n\tMFP:\t\t");
270 if (sta_flags
->set
& BIT(NL80211_STA_FLAG_MFP
))
276 if (sta_flags
->mask
& BIT(NL80211_STA_FLAG_TDLS_PEER
)) {
277 printf("\n\tTDLS peer:\t");
278 if (sta_flags
->set
& BIT(NL80211_STA_FLAG_TDLS_PEER
))
289 static int handle_station_get(struct nl80211_state
*state
,
292 int argc
, char **argv
,
295 unsigned char mac_addr
[ETH_ALEN
];
300 if (mac_addr_a2n(mac_addr
, argv
[0])) {
301 fprintf(stderr
, "invalid mac address\n");
311 NLA_PUT(msg
, NL80211_ATTR_MAC
, ETH_ALEN
, mac_addr
);
313 nl_cb_set(cb
, NL_CB_VALID
, NL_CB_CUSTOM
, print_sta_handler
, NULL
);
319 COMMAND(station
, get
, "<MAC address>",
320 NL80211_CMD_GET_STATION
, 0, CIB_NETDEV
, handle_station_get
,
321 "Get information for a specific station.");
322 COMMAND(station
, del
, "<MAC address>",
323 NL80211_CMD_DEL_STATION
, 0, CIB_NETDEV
, handle_station_get
,
324 "Remove the given station entry (use with caution!)");
326 static const struct cmd
*station_set_plink
;
327 static const struct cmd
*station_set_vlan
;
328 static const struct cmd
*station_set_mesh_power_mode
;
330 static const struct cmd
*select_station_cmd(int argc
, char **argv
)
334 if (strcmp(argv
[1], "plink_action") == 0)
335 return station_set_plink
;
336 if (strcmp(argv
[1], "vlan") == 0)
337 return station_set_vlan
;
338 if (strcmp(argv
[1], "mesh_power_mode") == 0)
339 return station_set_mesh_power_mode
;
343 static int handle_station_set_plink(struct nl80211_state
*state
,
346 int argc
, char **argv
,
349 unsigned char plink_action
;
350 unsigned char mac_addr
[ETH_ALEN
];
355 if (mac_addr_a2n(mac_addr
, argv
[0])) {
356 fprintf(stderr
, "invalid mac address\n");
362 if (strcmp("plink_action", argv
[0]) != 0)
367 if (strcmp("open", argv
[0]) == 0)
368 plink_action
= NL80211_PLINK_ACTION_OPEN
;
369 else if (strcmp("block", argv
[0]) == 0)
370 plink_action
= NL80211_PLINK_ACTION_BLOCK
;
372 fprintf(stderr
, "plink action not supported\n");
381 NLA_PUT(msg
, NL80211_ATTR_MAC
, ETH_ALEN
, mac_addr
);
382 NLA_PUT_U8(msg
, NL80211_ATTR_STA_PLINK_ACTION
, plink_action
);
388 COMMAND_ALIAS(station
, set
, "<MAC address> plink_action <open|block>",
389 NL80211_CMD_SET_STATION
, 0, CIB_NETDEV
, handle_station_set_plink
,
390 "Set mesh peer link action for this station (peer).",
391 select_station_cmd
, station_set_plink
);
393 static int handle_station_set_vlan(struct nl80211_state
*state
,
396 int argc
, char **argv
,
399 unsigned char mac_addr
[ETH_ALEN
];
400 unsigned long sta_vlan
= 0;
406 if (mac_addr_a2n(mac_addr
, argv
[0])) {
407 fprintf(stderr
, "invalid mac address\n");
413 if (strcmp("vlan", argv
[0]) != 0)
418 sta_vlan
= strtoul(argv
[0], &err
, 0);
420 fprintf(stderr
, "invalid vlan id\n");
429 NLA_PUT(msg
, NL80211_ATTR_MAC
, ETH_ALEN
, mac_addr
);
430 NLA_PUT_U32(msg
, NL80211_ATTR_STA_VLAN
, sta_vlan
);
436 COMMAND_ALIAS(station
, set
, "<MAC address> vlan <ifindex>",
437 NL80211_CMD_SET_STATION
, 0, CIB_NETDEV
, handle_station_set_vlan
,
438 "Set an AP VLAN for this station.",
439 select_station_cmd
, station_set_vlan
);
441 static int handle_station_set_mesh_power_mode(struct nl80211_state
*state
,
444 int argc
, char **argv
,
447 unsigned char mesh_power_mode
;
448 unsigned char mac_addr
[ETH_ALEN
];
453 if (mac_addr_a2n(mac_addr
, argv
[0])) {
454 fprintf(stderr
, "invalid mac address\n");
460 if (strcmp("mesh_power_mode", argv
[0]) != 0)
465 if (strcmp("active", argv
[0]) == 0)
466 mesh_power_mode
= NL80211_MESH_POWER_ACTIVE
;
467 else if (strcmp("light", argv
[0]) == 0)
468 mesh_power_mode
= NL80211_MESH_POWER_LIGHT_SLEEP
;
469 else if (strcmp("deep", argv
[0]) == 0)
470 mesh_power_mode
= NL80211_MESH_POWER_DEEP_SLEEP
;
472 fprintf(stderr
, "unknown mesh power mode\n");
481 NLA_PUT(msg
, NL80211_ATTR_MAC
, ETH_ALEN
, mac_addr
);
482 NLA_PUT_U32(msg
, NL80211_ATTR_LOCAL_MESH_POWER_MODE
, mesh_power_mode
);
488 COMMAND_ALIAS(station
, set
, "<MAC address> mesh_power_mode "
489 "<active|light|deep>", NL80211_CMD_SET_STATION
, 0, CIB_NETDEV
,
490 handle_station_set_mesh_power_mode
,
491 "Set link-specific mesh power mode for this station",
492 select_station_cmd
, station_set_mesh_power_mode
);
494 static int handle_station_dump(struct nl80211_state
*state
,
497 int argc
, char **argv
,
500 nl_cb_set(cb
, NL_CB_VALID
, NL_CB_CUSTOM
, print_sta_handler
, NULL
);
503 COMMAND(station
, dump
, NULL
,
504 NL80211_CMD_GET_STATION
, NLM_F_DUMP
, CIB_NETDEV
, handle_station_dump
,
505 "List all stations known, e.g. the AP on managed interfaces");