7 #include <netlink/genl/genl.h>
8 #include <netlink/genl/family.h>
9 #include <netlink/genl/ctrl.h>
10 #include <netlink/msg.h>
11 #include <netlink/attr.h>
22 static struct link_result lr
= { .link_found
= false };
24 static int link_bss_handler(struct nl_msg
*msg
, void *arg
)
26 struct nlattr
*tb
[NL80211_ATTR_MAX
+ 1];
27 struct genlmsghdr
*gnlh
= nlmsg_data(nlmsg_hdr(msg
));
28 struct nlattr
*bss
[NL80211_BSS_MAX
+ 1];
29 static struct nla_policy bss_policy
[NL80211_BSS_MAX
+ 1] = {
30 [NL80211_BSS_TSF
] = { .type
= NLA_U64
},
31 [NL80211_BSS_FREQUENCY
] = { .type
= NLA_U32
},
32 [NL80211_BSS_BSSID
] = { },
33 [NL80211_BSS_BEACON_INTERVAL
] = { .type
= NLA_U16
},
34 [NL80211_BSS_CAPABILITY
] = { .type
= NLA_U16
},
35 [NL80211_BSS_INFORMATION_ELEMENTS
] = { },
36 [NL80211_BSS_SIGNAL_MBM
] = { .type
= NLA_U32
},
37 [NL80211_BSS_SIGNAL_UNSPEC
] = { .type
= NLA_U8
},
38 [NL80211_BSS_STATUS
] = { .type
= NLA_U32
},
40 struct link_result
*result
= arg
;
41 char mac_addr
[20], dev
[20];
43 nla_parse(tb
, NL80211_ATTR_MAX
, genlmsg_attrdata(gnlh
, 0),
44 genlmsg_attrlen(gnlh
, 0), NULL
);
46 if (!tb
[NL80211_ATTR_BSS
]) {
47 fprintf(stderr
, "bss info missing!\n");
50 if (nla_parse_nested(bss
, NL80211_BSS_MAX
,
53 fprintf(stderr
, "failed to parse nested attributes!\n");
57 if (!bss
[NL80211_BSS_BSSID
])
60 if (!bss
[NL80211_BSS_STATUS
])
63 mac_addr_n2a(mac_addr
, nla_data(bss
[NL80211_BSS_BSSID
]));
64 if_indextoname(nla_get_u32(tb
[NL80211_ATTR_IFINDEX
]), dev
);
66 switch (nla_get_u32(bss
[NL80211_BSS_STATUS
])) {
67 case NL80211_BSS_STATUS_ASSOCIATED
:
68 printf("Connected to %s (on %s)\n", mac_addr
, dev
);
70 case NL80211_BSS_STATUS_AUTHENTICATED
:
71 printf("Authenticated with %s (on %s)\n", mac_addr
, dev
);
73 case NL80211_BSS_STATUS_IBSS_JOINED
:
74 printf("Joined IBSS %s (on %s)\n", mac_addr
, dev
);
80 result
->anything_found
= true;
82 if (bss
[NL80211_BSS_INFORMATION_ELEMENTS
])
83 print_ies(nla_data(bss
[NL80211_BSS_INFORMATION_ELEMENTS
]),
84 nla_len(bss
[NL80211_BSS_INFORMATION_ELEMENTS
]),
87 if (bss
[NL80211_BSS_FREQUENCY
])
88 printf("\tfreq: %d\n",
89 nla_get_u32(bss
[NL80211_BSS_FREQUENCY
]));
91 if (nla_get_u32(bss
[NL80211_BSS_STATUS
]) != NL80211_BSS_STATUS_ASSOCIATED
)
94 /* only in the assoc case do we want more info from station get */
95 result
->link_found
= true;
96 memcpy(result
->bssid
, nla_data(bss
[NL80211_BSS_BSSID
]), 6);
100 static int handle_scan_for_link(struct nl80211_state
*state
,
103 int argc
, char **argv
,
109 nl_cb_set(cb
, NL_CB_VALID
, NL_CB_CUSTOM
, link_bss_handler
, &lr
);
113 static int print_link_sta(struct nl_msg
*msg
, void *arg
)
115 struct nlattr
*tb
[NL80211_ATTR_MAX
+ 1];
116 struct genlmsghdr
*gnlh
= nlmsg_data(nlmsg_hdr(msg
));
117 struct nlattr
*sinfo
[NL80211_STA_INFO_MAX
+ 1];
118 struct nlattr
*binfo
[NL80211_STA_BSS_PARAM_MAX
+ 1];
119 static struct nla_policy stats_policy
[NL80211_STA_INFO_MAX
+ 1] = {
120 [NL80211_STA_INFO_INACTIVE_TIME
] = { .type
= NLA_U32
},
121 [NL80211_STA_INFO_RX_BYTES
] = { .type
= NLA_U32
},
122 [NL80211_STA_INFO_TX_BYTES
] = { .type
= NLA_U32
},
123 [NL80211_STA_INFO_RX_PACKETS
] = { .type
= NLA_U32
},
124 [NL80211_STA_INFO_TX_PACKETS
] = { .type
= NLA_U32
},
125 [NL80211_STA_INFO_SIGNAL
] = { .type
= NLA_U8
},
126 [NL80211_STA_INFO_TX_BITRATE
] = { .type
= NLA_NESTED
},
127 [NL80211_STA_INFO_LLID
] = { .type
= NLA_U16
},
128 [NL80211_STA_INFO_PLID
] = { .type
= NLA_U16
},
129 [NL80211_STA_INFO_PLINK_STATE
] = { .type
= NLA_U8
},
131 static struct nla_policy bss_policy
[NL80211_STA_BSS_PARAM_MAX
+ 1] = {
132 [NL80211_STA_BSS_PARAM_CTS_PROT
] = { .type
= NLA_FLAG
},
133 [NL80211_STA_BSS_PARAM_SHORT_PREAMBLE
] = { .type
= NLA_FLAG
},
134 [NL80211_STA_BSS_PARAM_SHORT_SLOT_TIME
] = { .type
= NLA_FLAG
},
135 [NL80211_STA_BSS_PARAM_DTIM_PERIOD
] = { .type
= NLA_U8
},
136 [NL80211_STA_BSS_PARAM_BEACON_INTERVAL
] = { .type
= NLA_U16
},
139 nla_parse(tb
, NL80211_ATTR_MAX
, genlmsg_attrdata(gnlh
, 0),
140 genlmsg_attrlen(gnlh
, 0), NULL
);
142 if (!tb
[NL80211_ATTR_STA_INFO
]) {
143 fprintf(stderr
, "sta stats missing!\n");
146 if (nla_parse_nested(sinfo
, NL80211_STA_INFO_MAX
,
147 tb
[NL80211_ATTR_STA_INFO
],
149 fprintf(stderr
, "failed to parse nested attributes!\n");
153 if (sinfo
[NL80211_STA_INFO_RX_BYTES
] && sinfo
[NL80211_STA_INFO_RX_PACKETS
])
154 printf("\tRX: %u bytes (%u packets)\n",
155 nla_get_u32(sinfo
[NL80211_STA_INFO_RX_BYTES
]),
156 nla_get_u32(sinfo
[NL80211_STA_INFO_RX_PACKETS
]));
157 if (sinfo
[NL80211_STA_INFO_TX_BYTES
] && sinfo
[NL80211_STA_INFO_TX_PACKETS
])
158 printf("\tTX: %u bytes (%u packets)\n",
159 nla_get_u32(sinfo
[NL80211_STA_INFO_TX_BYTES
]),
160 nla_get_u32(sinfo
[NL80211_STA_INFO_TX_PACKETS
]));
161 if (sinfo
[NL80211_STA_INFO_SIGNAL
])
162 printf("\tsignal: %d dBm\n",
163 (int8_t)nla_get_u8(sinfo
[NL80211_STA_INFO_SIGNAL
]));
165 if (sinfo
[NL80211_STA_INFO_TX_BITRATE
]) {
168 parse_bitrate(sinfo
[NL80211_STA_INFO_TX_BITRATE
], buf
, sizeof(buf
));
169 printf("\ttx bitrate: %s\n", buf
);
172 if (sinfo
[NL80211_STA_INFO_BSS_PARAM
]) {
173 if (nla_parse_nested(binfo
, NL80211_STA_BSS_PARAM_MAX
,
174 sinfo
[NL80211_STA_INFO_BSS_PARAM
],
176 fprintf(stderr
, "failed to parse nested bss parameters!\n");
179 printf("\n\tbss flags:\t");
180 if (binfo
[NL80211_STA_BSS_PARAM_CTS_PROT
]) {
181 printf("CTS-protection");
184 if (binfo
[NL80211_STA_BSS_PARAM_SHORT_PREAMBLE
]) {
185 printf("%sshort-preamble", delim
);
188 if (binfo
[NL80211_STA_BSS_PARAM_SHORT_SLOT_TIME
])
189 printf("%sshort-slot-time", delim
);
190 printf("\n\tdtim period:\t%d",
191 nla_get_u8(binfo
[NL80211_STA_BSS_PARAM_DTIM_PERIOD
]));
192 printf("\n\tbeacon int:\t%d",
193 nla_get_u16(binfo
[NL80211_STA_BSS_PARAM_BEACON_INTERVAL
]));
201 static int handle_link_sta(struct nl80211_state
*state
,
204 int argc
, char **argv
,
207 unsigned char mac_addr
[ETH_ALEN
];
212 if (mac_addr_a2n(mac_addr
, argv
[0])) {
213 fprintf(stderr
, "invalid mac address\n");
223 NLA_PUT(msg
, NL80211_ATTR_MAC
, ETH_ALEN
, mac_addr
);
225 nl_cb_set(cb
, NL_CB_VALID
, NL_CB_CUSTOM
, print_link_sta
, NULL
);
232 static int handle_link(struct nl80211_state
*state
, struct nl_cb
*cb
,
233 struct nl_msg
*msg
, int argc
, char **argv
,
236 char *link_argv
[] = {
242 char *station_argv
[] = {
252 link_argv
[0] = argv
[0];
253 err
= handle_cmd(state
, id
, 3, link_argv
);
257 if (!lr
.link_found
) {
258 if (!lr
.anything_found
)
259 printf("Not connected.\n");
263 mac_addr_n2a(bssid_buf
, lr
.bssid
);
264 bssid_buf
[17] = '\0';
266 station_argv
[0] = argv
[0];
267 station_argv
[3] = bssid_buf
;
268 return handle_cmd(state
, id
, 4, station_argv
);
270 TOPLEVEL(link
, NULL
, 0, 0, CIB_NETDEV
, handle_link
,
271 "Print information about the current link, if any.");
272 HIDDEN(link
, get_sta
, "", NL80211_CMD_GET_STATION
, 0,
273 CIB_NETDEV
, handle_link_sta
);
274 HIDDEN(link
, get_bss
, NULL
, NL80211_CMD_GET_SCAN
, NLM_F_DUMP
,
275 CIB_NETDEV
, handle_scan_for_link
);