wlanwatch.c revision 178698
1/*- 2 * Copyright (c) 2002-2007 Sam Leffler, Errno Consulting 3 * All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 8 * 1. Redistributions of source code must retain the above copyright 9 * notice, this list of conditions and the following disclaimer, 10 * without modification. 11 * 2. Redistributions in binary form must reproduce at minimum a disclaimer 12 * similar to the "NO WARRANTY" disclaimer below ("Disclaimer") and any 13 * redistribution must be conditioned upon including a substantially 14 * similar Disclaimer requirement for further binary redistribution. 15 * 16 * NO WARRANTY 17 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 18 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 19 * LIMITED TO, THE IMPLIED WARRANTIES OF NONINFRINGEMENT, MERCHANTIBILITY 20 * AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL 21 * THE COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR SPECIAL, EXEMPLARY, 22 * OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 23 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 24 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER 25 * IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 26 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF 27 * THE POSSIBILITY OF SUCH DAMAGES. 28 * 29 * $FreeBSD: head/tools/tools/net80211/wlanwatch/wlanwatch.c 178698 2008-04-30 19:45:32Z sam $ 30 */ 31 32/* 33 * Monitor 802.11 events using a routing socket. 34 * Code liberaly swiped from route(8). 35 */ 36#include <sys/param.h> 37#include <sys/file.h> 38#include <sys/socket.h> 39#include <sys/ioctl.h> 40#include <sys/sysctl.h> 41#include <sys/types.h> 42 43#include <net/if.h> 44#include <net/route.h> 45#include <net/if_dl.h> 46#include <netinet/in.h> 47#include <netinet/if_ether.h> 48#include <netatalk/at.h> 49#ifdef __NetBSD__ 50#include <net80211/ieee80211_netbsd.h> 51#elif __FreeBSD__ 52#include <net80211/ieee80211_freebsd.h> 53#else 54#error "No support for your operating system!" 55#endif 56#include <arpa/inet.h> 57#include <netdb.h> 58 59#include <ctype.h> 60#include <err.h> 61#include <errno.h> 62#include <paths.h> 63#include <stdio.h> 64#include <stdlib.h> 65#include <string.h> 66#include <sysexits.h> 67#include <unistd.h> 68#include <ifaddrs.h> 69 70/* XXX */ 71enum ieee80211_notify_cac_event { 72 IEEE80211_NOTIFY_CAC_START = 0, /* CAC timer started */ 73 IEEE80211_NOTIFY_CAC_STOP = 1, /* CAC intentionally stopped */ 74 IEEE80211_NOTIFY_CAC_RADAR = 2, /* CAC stopped due to radar detectio */ 75 IEEE80211_NOTIFY_CAC_EXPIRE = 3, /* CAC expired w/o radar */ 76}; 77 78static void print_rtmsg(struct rt_msghdr *rtm, int msglen); 79 80int nflag = 0; 81 82int 83main(int argc, char *argv[]) 84{ 85 int n, s; 86 char msg[2048]; 87 88 s = socket(PF_ROUTE, SOCK_RAW, 0); 89 if (s < 0) 90 err(EX_OSERR, "socket"); 91 for(;;) { 92 n = read(s, msg, 2048); 93 print_rtmsg((struct rt_msghdr *)msg, n); 94 } 95 return 0; 96} 97 98static void 99bprintf(FILE *fp, int b, char *s) 100{ 101 int i; 102 int gotsome = 0; 103 104 if (b == 0) 105 return; 106 while ((i = *s++) != 0) { 107 if (b & (1 << (i-1))) { 108 if (gotsome == 0) 109 i = '<'; 110 else 111 i = ','; 112 (void) putc(i, fp); 113 gotsome = 1; 114 for (; (i = *s) > 32; s++) 115 (void) putc(i, fp); 116 } else 117 while (*s > 32) 118 s++; 119 } 120 if (gotsome) 121 putc('>', fp); 122} 123 124char metricnames[] = 125"\011pksent\010rttvar\7rtt\6ssthresh\5sendpipe\4recvpipe\3expire\2hopcount" 126"\1mtu"; 127char routeflags[] = 128"\1UP\2GATEWAY\3HOST\4REJECT\5DYNAMIC\6MODIFIED\7DONE\010MASK_PRESENT" 129"\011CLONING\012XRESOLVE\013LLINFO\014STATIC\015BLACKHOLE\016b016" 130"\017PROTO2\020PROTO1\021PRCLONING\022WASCLONED\023PROTO3\024CHAINDELETE" 131"\025PINNED\026LOCAL\027BROADCAST\030MULTICAST"; 132char ifnetflags[] = 133"\1UP\2BROADCAST\3DEBUG\4LOOPBACK\5PTP\6b6\7RUNNING\010NOARP" 134"\011PPROMISC\012ALLMULTI\013OACTIVE\014SIMPLEX\015LINK0\016LINK1" 135"\017LINK2\020MULTICAST"; 136char addrnames[] = 137"\1DST\2GATEWAY\3NETMASK\4GENMASK\5IFP\6IFA\7AUTHOR\010BRD"; 138 139static const char * 140routename(struct sockaddr *sa) 141{ 142 char *cp; 143 static char line[MAXHOSTNAMELEN + 1]; 144 struct hostent *hp; 145 static char domain[MAXHOSTNAMELEN + 1]; 146 static int first = 1, n; 147 148 if (first) { 149 first = 0; 150 if (gethostname(domain, MAXHOSTNAMELEN) == 0 && 151 (cp = strchr(domain, '.'))) { 152 domain[MAXHOSTNAMELEN] = '\0'; 153 (void) strcpy(domain, cp + 1); 154 } else 155 domain[0] = 0; 156 } 157 158 if (sa->sa_len == 0) 159 strcpy(line, "default"); 160 else switch (sa->sa_family) { 161 162 case AF_INET: 163 { struct in_addr in; 164 in = ((struct sockaddr_in *)sa)->sin_addr; 165 166 cp = 0; 167 if (in.s_addr == INADDR_ANY || sa->sa_len < 4) 168 cp = "default"; 169 if (cp == 0 && !nflag) { 170 hp = gethostbyaddr((char *)&in, sizeof (struct in_addr), 171 AF_INET); 172 if (hp) { 173 if ((cp = strchr(hp->h_name, '.')) && 174 !strcmp(cp + 1, domain)) 175 *cp = 0; 176 cp = hp->h_name; 177 } 178 } 179 if (cp) { 180 strncpy(line, cp, sizeof(line) - 1); 181 line[sizeof(line) - 1] = '\0'; 182 } else 183 (void) sprintf(line, "%s", inet_ntoa(in)); 184 break; 185 } 186 187#ifdef INET6 188 case AF_INET6: 189 { 190 struct sockaddr_in6 sin6; /* use static var for safety */ 191 int niflags = 0; 192#ifdef NI_WITHSCOPEID 193 niflags = NI_WITHSCOPEID; 194#endif 195 196 memset(&sin6, 0, sizeof(sin6)); 197 memcpy(&sin6, sa, sa->sa_len); 198 sin6.sin6_len = sizeof(struct sockaddr_in6); 199 sin6.sin6_family = AF_INET6; 200#ifdef __KAME__ 201 if (sa->sa_len == sizeof(struct sockaddr_in6) && 202 (IN6_IS_ADDR_LINKLOCAL(&sin6.sin6_addr) || 203 IN6_IS_ADDR_MC_LINKLOCAL(&sin6.sin6_addr)) && 204 sin6.sin6_scope_id == 0) { 205 sin6.sin6_scope_id = 206 ntohs(*(u_int16_t *)&sin6.sin6_addr.s6_addr[2]); 207 sin6.sin6_addr.s6_addr[2] = 0; 208 sin6.sin6_addr.s6_addr[3] = 0; 209 } 210#endif 211 if (nflag) 212 niflags |= NI_NUMERICHOST; 213 if (getnameinfo((struct sockaddr *)&sin6, sin6.sin6_len, 214 line, sizeof(line), NULL, 0, niflags) != 0) 215 strncpy(line, "invalid", sizeof(line)); 216 217 return(line); 218 } 219#endif 220 221 case AF_LINK: 222 return (link_ntoa((struct sockaddr_dl *)sa)); 223 224 default: 225 { u_short *s = (u_short *)sa; 226 u_short *slim = s + ((sa->sa_len + 1) >> 1); 227 char *cp = line + sprintf(line, "(%d)", sa->sa_family); 228 char *cpe = line + sizeof(line); 229 230 while (++s < slim && cp < cpe) /* start with sa->sa_data */ 231 if ((n = snprintf(cp, cpe - cp, " %x", *s)) > 0) 232 cp += n; 233 else 234 *cp = '\0'; 235 break; 236 } 237 } 238 return (line); 239} 240 241#ifndef SA_SIZE 242/* 243 * This macro returns the size of a struct sockaddr when passed 244 * through a routing socket. Basically we round up sa_len to 245 * a multiple of sizeof(long), with a minimum of sizeof(long). 246 * The check for a NULL pointer is just a convenience, probably never used. 247 * The case sa_len == 0 should only apply to empty structures. 248 */ 249#define SA_SIZE(sa) \ 250 ( (!(sa) || ((struct sockaddr *)(sa))->sa_len == 0) ? \ 251 sizeof(long) : \ 252 1 + ( (((struct sockaddr *)(sa))->sa_len - 1) | (sizeof(long) - 1) ) ) 253#endif 254 255static void 256pmsg_addrs(char *cp, int addrs) 257{ 258 struct sockaddr *sa; 259 int i; 260 261 if (addrs == 0) { 262 (void) putchar('\n'); 263 return; 264 } 265 printf("\nsockaddrs: "); 266 bprintf(stdout, addrs, addrnames); 267 putchar('\n'); 268 for (i = 1; i; i <<= 1) 269 if (i & addrs) { 270 sa = (struct sockaddr *)cp; 271 printf(" %s", routename(sa)); 272 cp += SA_SIZE(sa); 273 } 274 putchar('\n'); 275 fflush(stdout); 276} 277 278static const char * 279ether_sprintf(const uint8_t mac[6]) 280{ 281 static char buf[32]; 282 283 snprintf(buf, sizeof(buf), "%02x:%02x:%02x:%02x:%02x:%02x", 284 mac[0], mac[1], mac[2], mac[3], mac[4], mac[5]); 285 return buf; 286} 287 288static void 289print_rtmsg(struct rt_msghdr *rtm, int msglen) 290{ 291 struct if_msghdr *ifm; 292 struct if_announcemsghdr *ifan; 293 time_t now = time(NULL); 294 char *cnow = ctime(&now); 295 296 if (rtm->rtm_version != RTM_VERSION) { 297 (void) printf("routing message version %d not understood\n", 298 rtm->rtm_version); 299 return; 300 } 301 switch (rtm->rtm_type) { 302 case RTM_IFINFO: 303 ifm = (struct if_msghdr *)rtm; 304 printf("%.19s RTM_IFINFO: if# %d, ", 305 cnow, ifm->ifm_index); 306 switch (ifm->ifm_data.ifi_link_state) { 307 case LINK_STATE_DOWN: 308 printf("link: down, flags:"); 309 break; 310 case LINK_STATE_UP: 311 printf("link: up, flags:"); 312 break; 313 default: 314 printf("link: unknown<%d>, flags:", 315 ifm->ifm_data.ifi_link_state); 316 break; 317 } 318 bprintf(stdout, ifm->ifm_flags, ifnetflags); 319 pmsg_addrs((char *)(ifm + 1), ifm->ifm_addrs); 320 break; 321 case RTM_IFANNOUNCE: 322 ifan = (struct if_announcemsghdr *)rtm; 323 printf("%.19s RTM_IFANNOUNCE: if# %d, what: ", 324 cnow, ifan->ifan_index); 325 switch (ifan->ifan_what) { 326 case IFAN_ARRIVAL: 327 printf("arrival"); 328 break; 329 case IFAN_DEPARTURE: 330 printf("departure"); 331 break; 332 default: 333 printf("#%d", ifan->ifan_what); 334 break; 335 } 336 printf("\n"); 337 break; 338 case RTM_IEEE80211: 339#define V(type) ((struct type *)(&ifan[1])) 340 ifan = (struct if_announcemsghdr *)rtm; 341 printf("%.19s RTM_IEEE80211: if# %d, ", cnow, ifan->ifan_index); 342 switch (ifan->ifan_what) { 343 case RTM_IEEE80211_ASSOC: 344 printf("associate with %s", 345 ether_sprintf(V(ieee80211_join_event)->iev_addr)); 346 break; 347 case RTM_IEEE80211_REASSOC: 348 printf("reassociate with %s", 349 ether_sprintf(V(ieee80211_join_event)->iev_addr)); 350 break; 351 case RTM_IEEE80211_DISASSOC: 352 printf("disassociate"); 353 break; 354 case RTM_IEEE80211_JOIN: 355 case RTM_IEEE80211_REJOIN: 356 printf("%s station %sjoin", 357 ether_sprintf(V(ieee80211_join_event)->iev_addr), 358 ifan->ifan_what == RTM_IEEE80211_REJOIN ? "re" : "" 359 ); 360 break; 361 case RTM_IEEE80211_LEAVE: 362 printf("%s station leave", 363 ether_sprintf(V(ieee80211_leave_event)->iev_addr)); 364 break; 365 case RTM_IEEE80211_SCAN: 366 printf("scan complete"); 367 break; 368 case RTM_IEEE80211_REPLAY: 369 printf("replay failure: src %s " 370 , ether_sprintf(V(ieee80211_replay_event)->iev_src) 371 ); 372 printf("dst %s cipher %u keyix %u keyrsc %llu rsc %llu" 373 , ether_sprintf(V(ieee80211_replay_event)->iev_dst) 374 , V(ieee80211_replay_event)->iev_cipher 375 , V(ieee80211_replay_event)->iev_keyix 376 , V(ieee80211_replay_event)->iev_keyrsc 377 , V(ieee80211_replay_event)->iev_rsc 378 ); 379 break; 380 case RTM_IEEE80211_MICHAEL: 381 printf("michael failure: src %s " 382 , ether_sprintf(V(ieee80211_michael_event)->iev_src) 383 ); 384 printf("dst %s cipher %u keyix %u" 385 , ether_sprintf(V(ieee80211_michael_event)->iev_dst) 386 , V(ieee80211_michael_event)->iev_cipher 387 , V(ieee80211_michael_event)->iev_keyix 388 ); 389 break; 390 case RTM_IEEE80211_WDS: 391 printf("%s wds discovery", 392 ether_sprintf(V(ieee80211_wds_event)->iev_addr)); 393 break; 394 case RTM_IEEE80211_CSA: 395 printf("channel switch announcement: channel %u (%u MHz flags 0x%x) mode %d count %d" 396 , V(ieee80211_csa_event)->iev_ieee 397 , V(ieee80211_csa_event)->iev_freq 398 , V(ieee80211_csa_event)->iev_flags 399 , V(ieee80211_csa_event)->iev_mode 400 , V(ieee80211_csa_event)->iev_count 401 ); 402 break; 403 case RTM_IEEE80211_CAC: 404 printf("channel availability check " 405 "(channel %u, %u MHz flags 0x%x) " 406 , V(ieee80211_cac_event)->iev_ieee 407 , V(ieee80211_cac_event)->iev_freq 408 , V(ieee80211_cac_event)->iev_flags 409 ); 410 switch (V(ieee80211_cac_event)->iev_type) { 411 case IEEE80211_NOTIFY_CAC_START: 412 printf("start timer"); 413 break; 414 case IEEE80211_NOTIFY_CAC_STOP: 415 printf("stop timer"); 416 break; 417 case IEEE80211_NOTIFY_CAC_EXPIRE: 418 printf("timer expired"); 419 break; 420 case IEEE80211_NOTIFY_CAC_RADAR: 421 printf("radar detected"); 422 break; 423 default: 424 printf("unknown type %d", 425 V(ieee80211_cac_event)->iev_type); 426 break; 427 } 428 break; 429 case RTM_IEEE80211_DEAUTH: 430 printf("%s wds deauth", 431 ether_sprintf(V(ieee80211_deauth_event)->iev_addr)); 432 break; 433 case RTM_IEEE80211_AUTH: 434 printf("%s node authenticate", 435 ether_sprintf(V(ieee80211_auth_event)->iev_addr)); 436 break; 437 case RTM_IEEE80211_COUNTRY: 438 printf("%s adopt country code '%c%c'", 439 ether_sprintf(V(ieee80211_country_event)->iev_addr), 440 V(ieee80211_country_event)->iev_cc[0], 441 V(ieee80211_country_event)->iev_cc[1]); 442 break; 443 case RTM_IEEE80211_RADIO: 444 printf("radio %s", 445 V(ieee80211_radio_event)->iev_state ? "ON" : "OFF"); 446 break; 447 default: 448 printf("what: #%d", ifan->ifan_what); 449 break; 450 } 451 printf("\n"); 452 break; 453#undef V 454 } 455} 456