Actually hook powernow.4 into the build.
[dragonfly.git] / contrib / hostapd / hostapd / iapp.c
blob6d6dba8f7b9a3e1b061392c72708074d010914f0
1 /*
2 * hostapd / IEEE 802.11F-2003 Inter-Access Point Protocol (IAPP)
3 * Copyright (c) 2002-2007, Jouni Malinen <j@w1.fi>
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License version 2 as
7 * published by the Free Software Foundation.
9 * Alternatively, this software may be distributed under the terms of BSD
10 * license.
12 * See README and COPYING for more details.
14 * Note: IEEE 802.11F-2003 was a experimental use specification. It has expired
15 * and IEEE has withdrawn it. In other words, it is likely better to look at
16 * using some other mechanism for AP-to-AP communication than extending the
17 * implementation here.
20 /* TODO:
21 * Level 1: no administrative or security support
22 * (e.g., static BSSID to IP address mapping in each AP)
23 * Level 2: support for dynamic mapping of BSSID to IP address
24 * Level 3: support for encryption and authentication of IAPP messages
25 * - add support for MOVE-notify and MOVE-response (this requires support for
26 * finding out IP address for previous AP using RADIUS)
27 * - add support for Send- and ACK-Security-Block to speedup IEEE 802.1X during
28 * reassociation to another AP
29 * - implement counters etc. for IAPP MIB
30 * - verify endianness of fields in IAPP messages; are they big-endian as
31 * used here?
32 * - RADIUS connection for AP registration and BSSID to IP address mapping
33 * - TCP connection for IAPP MOVE, CACHE
34 * - broadcast ESP for IAPP ADD-notify
35 * - ESP for IAPP MOVE messages
36 * - security block sending/processing
37 * - IEEE 802.11 context transfer
40 #include "includes.h"
41 #include <net/if.h>
42 #include <sys/ioctl.h>
43 #ifdef USE_KERNEL_HEADERS
44 #include <linux/if_packet.h>
45 #else /* USE_KERNEL_HEADERS */
46 #include <netpacket/packet.h>
47 #endif /* USE_KERNEL_HEADERS */
49 #include "hostapd.h"
50 #include "ieee802_11.h"
51 #include "iapp.h"
52 #include "eloop.h"
53 #include "sta_info.h"
56 #define IAPP_MULTICAST "224.0.1.178"
57 #define IAPP_UDP_PORT 3517
58 #define IAPP_TCP_PORT 3517
60 struct iapp_hdr {
61 u8 version;
62 u8 command;
63 be16 identifier;
64 be16 length;
65 /* followed by length-6 octets of data */
66 } __attribute__ ((packed));
68 #define IAPP_VERSION 0
70 enum IAPP_COMMAND {
71 IAPP_CMD_ADD_notify = 0,
72 IAPP_CMD_MOVE_notify = 1,
73 IAPP_CMD_MOVE_response = 2,
74 IAPP_CMD_Send_Security_Block = 3,
75 IAPP_CMD_ACK_Security_Block = 4,
76 IAPP_CMD_CACHE_notify = 5,
77 IAPP_CMD_CACHE_response = 6,
81 /* ADD-notify - multicast UDP on the local LAN */
82 struct iapp_add_notify {
83 u8 addr_len; /* ETH_ALEN */
84 u8 reserved;
85 u8 mac_addr[ETH_ALEN];
86 be16 seq_num;
87 } __attribute__ ((packed));
90 /* Layer 2 Update frame (802.2 Type 1 LLC XID Update response) */
91 struct iapp_layer2_update {
92 u8 da[ETH_ALEN]; /* broadcast */
93 u8 sa[ETH_ALEN]; /* STA addr */
94 be16 len; /* 6 */
95 u8 dsap; /* null DSAP address */
96 u8 ssap; /* null SSAP address, CR=Response */
97 u8 control;
98 u8 xid_info[3];
99 } __attribute__ ((packed));
102 /* MOVE-notify - unicast TCP */
103 struct iapp_move_notify {
104 u8 addr_len; /* ETH_ALEN */
105 u8 reserved;
106 u8 mac_addr[ETH_ALEN];
107 u16 seq_num;
108 u16 ctx_block_len;
109 /* followed by ctx_block_len bytes */
110 } __attribute__ ((packed));
113 /* MOVE-response - unicast TCP */
114 struct iapp_move_response {
115 u8 addr_len; /* ETH_ALEN */
116 u8 status;
117 u8 mac_addr[ETH_ALEN];
118 u16 seq_num;
119 u16 ctx_block_len;
120 /* followed by ctx_block_len bytes */
121 } __attribute__ ((packed));
123 enum {
124 IAPP_MOVE_SUCCESSFUL = 0,
125 IAPP_MOVE_DENIED = 1,
126 IAPP_MOVE_STALE_MOVE = 2,
130 /* CACHE-notify */
131 struct iapp_cache_notify {
132 u8 addr_len; /* ETH_ALEN */
133 u8 reserved;
134 u8 mac_addr[ETH_ALEN];
135 u16 seq_num;
136 u8 current_ap[ETH_ALEN];
137 u16 ctx_block_len;
138 /* ctx_block_len bytes of context block followed by 16-bit context
139 * timeout */
140 } __attribute__ ((packed));
143 /* CACHE-response - unicast TCP */
144 struct iapp_cache_response {
145 u8 addr_len; /* ETH_ALEN */
146 u8 status;
147 u8 mac_addr[ETH_ALEN];
148 u16 seq_num;
149 } __attribute__ ((packed));
151 enum {
152 IAPP_CACHE_SUCCESSFUL = 0,
153 IAPP_CACHE_STALE_CACHE = 1,
157 /* Send-Security-Block - unicast TCP */
158 struct iapp_send_security_block {
159 u8 iv[8];
160 u16 sec_block_len;
161 /* followed by sec_block_len bytes of security block */
162 } __attribute__ ((packed));
165 /* ACK-Security-Block - unicast TCP */
166 struct iapp_ack_security_block {
167 u8 iv[8];
168 u8 new_ap_ack_authenticator[48];
169 } __attribute__ ((packed));
172 struct iapp_data {
173 struct hostapd_data *hapd;
174 u16 identifier; /* next IAPP identifier */
175 struct in_addr own, multicast;
176 int udp_sock;
177 int packet_sock;
181 static void iapp_send_add(struct iapp_data *iapp, u8 *mac_addr, u16 seq_num)
183 char buf[128];
184 struct iapp_hdr *hdr;
185 struct iapp_add_notify *add;
186 struct sockaddr_in addr;
188 /* Send IAPP ADD-notify to remove possible association from other APs
191 hdr = (struct iapp_hdr *) buf;
192 hdr->version = IAPP_VERSION;
193 hdr->command = IAPP_CMD_ADD_notify;
194 hdr->identifier = host_to_be16(iapp->identifier++);
195 hdr->length = host_to_be16(sizeof(*hdr) + sizeof(*add));
197 add = (struct iapp_add_notify *) (hdr + 1);
198 add->addr_len = ETH_ALEN;
199 add->reserved = 0;
200 os_memcpy(add->mac_addr, mac_addr, ETH_ALEN);
202 add->seq_num = host_to_be16(seq_num);
204 os_memset(&addr, 0, sizeof(addr));
205 addr.sin_family = AF_INET;
206 addr.sin_addr.s_addr = iapp->multicast.s_addr;
207 addr.sin_port = htons(IAPP_UDP_PORT);
208 if (sendto(iapp->udp_sock, buf, (char *) (add + 1) - buf, 0,
209 (struct sockaddr *) &addr, sizeof(addr)) < 0)
210 perror("sendto[IAPP-ADD]");
214 static void iapp_send_layer2_update(struct iapp_data *iapp, u8 *addr)
216 struct iapp_layer2_update msg;
218 /* Send Level 2 Update Frame to update forwarding tables in layer 2
219 * bridge devices */
221 /* 802.2 Type 1 Logical Link Control (LLC) Exchange Identifier (XID)
222 * Update response frame; IEEE Std 802.2-1998, 5.4.1.2.1 */
224 os_memset(msg.da, 0xff, ETH_ALEN);
225 os_memcpy(msg.sa, addr, ETH_ALEN);
226 msg.len = host_to_be16(6);
227 msg.dsap = 0; /* NULL DSAP address */
228 msg.ssap = 0x01; /* NULL SSAP address, CR Bit: Response */
229 msg.control = 0xaf; /* XID response lsb.1111F101.
230 * F=0 (no poll command; unsolicited frame) */
231 msg.xid_info[0] = 0x81; /* XID format identifier */
232 msg.xid_info[1] = 1; /* LLC types/classes: Type 1 LLC */
233 msg.xid_info[2] = 1 << 1; /* XID sender's receive window size (RW)
234 * FIX: what is correct RW with 802.11? */
236 if (send(iapp->packet_sock, &msg, sizeof(msg), 0) < 0)
237 perror("send[L2 Update]");
242 * iapp_new_station - IAPP processing for a new STA
243 * @iapp: IAPP data
244 * @sta: The associated station
246 void iapp_new_station(struct iapp_data *iapp, struct sta_info *sta)
248 struct ieee80211_mgmt *assoc;
249 u16 seq;
251 if (iapp == NULL)
252 return;
254 assoc = sta->last_assoc_req;
255 seq = assoc ? WLAN_GET_SEQ_SEQ(le_to_host16(assoc->seq_ctrl)) : 0;
257 /* IAPP-ADD.request(MAC Address, Sequence Number, Timeout) */
258 hostapd_logger(iapp->hapd, sta->addr, HOSTAPD_MODULE_IAPP,
259 HOSTAPD_LEVEL_DEBUG, "IAPP-ADD.request(seq=%d)", seq);
260 iapp_send_layer2_update(iapp, sta->addr);
261 iapp_send_add(iapp, sta->addr, seq);
263 if (assoc && WLAN_FC_GET_STYPE(le_to_host16(assoc->frame_control)) ==
264 WLAN_FC_STYPE_REASSOC_REQ) {
265 /* IAPP-MOVE.request(MAC Address, Sequence Number, Old AP,
266 * Context Block, Timeout)
268 /* TODO: Send IAPP-MOVE to the old AP; Map Old AP BSSID to
269 * IP address */
274 static void iapp_process_add_notify(struct iapp_data *iapp,
275 struct sockaddr_in *from,
276 struct iapp_hdr *hdr, int len)
278 struct iapp_add_notify *add = (struct iapp_add_notify *) (hdr + 1);
279 struct sta_info *sta;
281 if (len != sizeof(*add)) {
282 printf("Invalid IAPP-ADD packet length %d (expected %lu)\n",
283 len, (unsigned long) sizeof(*add));
284 return;
287 sta = ap_get_sta(iapp->hapd, add->mac_addr);
289 /* IAPP-ADD.indication(MAC Address, Sequence Number) */
290 hostapd_logger(iapp->hapd, add->mac_addr, HOSTAPD_MODULE_IAPP,
291 HOSTAPD_LEVEL_INFO,
292 "Received IAPP ADD-notify (seq# %d) from %s:%d%s",
293 be_to_host16(add->seq_num),
294 inet_ntoa(from->sin_addr), ntohs(from->sin_port),
295 sta ? "" : " (STA not found)");
297 if (!sta)
298 return;
300 /* TODO: could use seq_num to try to determine whether last association
301 * to this AP is newer than the one advertised in IAPP-ADD. Although,
302 * this is not really a reliable verification. */
304 hostapd_logger(iapp->hapd, add->mac_addr, HOSTAPD_MODULE_IAPP,
305 HOSTAPD_LEVEL_DEBUG,
306 "Removing STA due to IAPP ADD-notify");
307 sta->flags &= ~(WLAN_STA_AUTH | WLAN_STA_ASSOC | WLAN_STA_AUTHORIZED);
308 eloop_cancel_timeout(ap_handle_timer, iapp->hapd, sta);
309 eloop_register_timeout(0, 0, ap_handle_timer, iapp->hapd, sta);
310 sta->timeout_next = STA_REMOVE;
315 * iapp_receive_udp - Process IAPP UDP frames
316 * @sock: File descriptor for the socket
317 * @eloop_ctx: IAPP data (struct iapp_data *)
318 * @sock_ctx: Not used
320 static void iapp_receive_udp(int sock, void *eloop_ctx, void *sock_ctx)
322 struct iapp_data *iapp = eloop_ctx;
323 int len, hlen;
324 unsigned char buf[128];
325 struct sockaddr_in from;
326 socklen_t fromlen;
327 struct iapp_hdr *hdr;
329 /* Handle incoming IAPP frames (over UDP/IP) */
331 fromlen = sizeof(from);
332 len = recvfrom(iapp->udp_sock, buf, sizeof(buf), 0,
333 (struct sockaddr *) &from, &fromlen);
334 if (len < 0) {
335 perror("recvfrom");
336 return;
339 if (from.sin_addr.s_addr == iapp->own.s_addr)
340 return; /* ignore own IAPP messages */
342 hostapd_logger(iapp->hapd, NULL, HOSTAPD_MODULE_IAPP,
343 HOSTAPD_LEVEL_DEBUG,
344 "Received %d byte IAPP frame from %s%s\n",
345 len, inet_ntoa(from.sin_addr),
346 len < (int) sizeof(*hdr) ? " (too short)" : "");
348 if (len < (int) sizeof(*hdr))
349 return;
351 hdr = (struct iapp_hdr *) buf;
352 hlen = be_to_host16(hdr->length);
353 hostapd_logger(iapp->hapd, NULL, HOSTAPD_MODULE_IAPP,
354 HOSTAPD_LEVEL_DEBUG,
355 "RX: version=%d command=%d id=%d len=%d\n",
356 hdr->version, hdr->command,
357 be_to_host16(hdr->identifier), hlen);
358 if (hdr->version != IAPP_VERSION) {
359 printf("Dropping IAPP frame with unknown version %d\n",
360 hdr->version);
361 return;
363 if (hlen > len) {
364 printf("Underflow IAPP frame (hlen=%d len=%d)\n", hlen, len);
365 return;
367 if (hlen < len) {
368 printf("Ignoring %d extra bytes from IAPP frame\n",
369 len - hlen);
370 len = hlen;
373 switch (hdr->command) {
374 case IAPP_CMD_ADD_notify:
375 iapp_process_add_notify(iapp, &from, hdr, hlen - sizeof(*hdr));
376 break;
377 case IAPP_CMD_MOVE_notify:
378 /* TODO: MOVE is using TCP; so move this to TCP handler once it
379 * is implemented.. */
380 /* IAPP-MOVE.indication(MAC Address, New BSSID,
381 * Sequence Number, AP Address, Context Block) */
382 /* TODO: process */
383 break;
384 default:
385 printf("Unknown IAPP command %d\n", hdr->command);
386 break;
391 struct iapp_data * iapp_init(struct hostapd_data *hapd, const char *iface)
393 struct ifreq ifr;
394 struct sockaddr_ll addr;
395 int ifindex;
396 struct sockaddr_in *paddr, uaddr;
397 struct iapp_data *iapp;
398 struct ip_mreqn mreq;
400 iapp = os_zalloc(sizeof(*iapp));
401 if (iapp == NULL)
402 return NULL;
403 iapp->hapd = hapd;
404 iapp->udp_sock = iapp->packet_sock = -1;
406 /* TODO:
407 * open socket for sending and receiving IAPP frames over TCP
410 iapp->udp_sock = socket(PF_INET, SOCK_DGRAM, 0);
411 if (iapp->udp_sock < 0) {
412 perror("socket[PF_INET,SOCK_DGRAM]");
413 iapp_deinit(iapp);
414 return NULL;
417 os_memset(&ifr, 0, sizeof(ifr));
418 os_strlcpy(ifr.ifr_name, iface, sizeof(ifr.ifr_name));
419 if (ioctl(iapp->udp_sock, SIOCGIFINDEX, &ifr) != 0) {
420 perror("ioctl(SIOCGIFINDEX)");
421 iapp_deinit(iapp);
422 return NULL;
424 ifindex = ifr.ifr_ifindex;
426 if (ioctl(iapp->udp_sock, SIOCGIFADDR, &ifr) != 0) {
427 perror("ioctl(SIOCGIFADDR)");
428 iapp_deinit(iapp);
429 return NULL;
431 paddr = (struct sockaddr_in *) &ifr.ifr_addr;
432 if (paddr->sin_family != AF_INET) {
433 printf("Invalid address family %i (SIOCGIFADDR)\n",
434 paddr->sin_family);
435 iapp_deinit(iapp);
436 return NULL;
438 iapp->own.s_addr = paddr->sin_addr.s_addr;
440 if (ioctl(iapp->udp_sock, SIOCGIFBRDADDR, &ifr) != 0) {
441 perror("ioctl(SIOCGIFBRDADDR)");
442 iapp_deinit(iapp);
443 return NULL;
445 paddr = (struct sockaddr_in *) &ifr.ifr_addr;
446 if (paddr->sin_family != AF_INET) {
447 printf("Invalid address family %i (SIOCGIFBRDADDR)\n",
448 paddr->sin_family);
449 iapp_deinit(iapp);
450 return NULL;
452 inet_aton(IAPP_MULTICAST, &iapp->multicast);
454 os_memset(&uaddr, 0, sizeof(uaddr));
455 uaddr.sin_family = AF_INET;
456 uaddr.sin_port = htons(IAPP_UDP_PORT);
457 if (bind(iapp->udp_sock, (struct sockaddr *) &uaddr,
458 sizeof(uaddr)) < 0) {
459 perror("bind[UDP]");
460 iapp_deinit(iapp);
461 return NULL;
464 os_memset(&mreq, 0, sizeof(mreq));
465 mreq.imr_multiaddr = iapp->multicast;
466 mreq.imr_address.s_addr = INADDR_ANY;
467 mreq.imr_ifindex = 0;
468 if (setsockopt(iapp->udp_sock, SOL_IP, IP_ADD_MEMBERSHIP, &mreq,
469 sizeof(mreq)) < 0) {
470 perror("setsockopt[UDP,IP_ADD_MEMBERSHIP]");
471 iapp_deinit(iapp);
472 return NULL;
475 iapp->packet_sock = socket(PF_PACKET, SOCK_RAW, htons(ETH_P_ALL));
476 if (iapp->packet_sock < 0) {
477 perror("socket[PF_PACKET,SOCK_RAW]");
478 iapp_deinit(iapp);
479 return NULL;
482 os_memset(&addr, 0, sizeof(addr));
483 addr.sll_family = AF_PACKET;
484 addr.sll_ifindex = ifindex;
485 if (bind(iapp->packet_sock, (struct sockaddr *) &addr,
486 sizeof(addr)) < 0) {
487 perror("bind[PACKET]");
488 iapp_deinit(iapp);
489 return NULL;
492 if (eloop_register_read_sock(iapp->udp_sock, iapp_receive_udp,
493 iapp, NULL)) {
494 printf("Could not register read socket for IAPP.\n");
495 iapp_deinit(iapp);
496 return NULL;
499 printf("IEEE 802.11F (IAPP) using interface %s\n", iface);
501 /* TODO: For levels 2 and 3: send RADIUS Initiate-Request, receive
502 * RADIUS Initiate-Accept or Initiate-Reject. IAPP port should actually
503 * be openned only after receiving Initiate-Accept. If Initiate-Reject
504 * is received, IAPP is not started. */
506 return iapp;
510 void iapp_deinit(struct iapp_data *iapp)
512 struct ip_mreqn mreq;
514 if (iapp == NULL)
515 return;
517 if (iapp->udp_sock >= 0) {
518 os_memset(&mreq, 0, sizeof(mreq));
519 mreq.imr_multiaddr = iapp->multicast;
520 mreq.imr_address.s_addr = INADDR_ANY;
521 mreq.imr_ifindex = 0;
522 if (setsockopt(iapp->udp_sock, SOL_IP, IP_DROP_MEMBERSHIP,
523 &mreq, sizeof(mreq)) < 0) {
524 perror("setsockopt[UDP,IP_DEL_MEMBERSHIP]");
527 eloop_unregister_read_sock(iapp->udp_sock);
528 close(iapp->udp_sock);
530 if (iapp->packet_sock >= 0) {
531 eloop_unregister_read_sock(iapp->packet_sock);
532 close(iapp->packet_sock);
534 os_free(iapp);
537 int iapp_reconfig(struct hostapd_data *hapd, struct hostapd_config *oldconf,
538 struct hostapd_bss_config *oldbss)
540 if (hapd->conf->ieee802_11f != oldbss->ieee802_11f ||
541 os_strcmp(hapd->conf->iapp_iface, oldbss->iapp_iface) != 0) {
542 iapp_deinit(hapd->iapp);
543 hapd->iapp = NULL;
545 if (hapd->conf->ieee802_11f) {
546 hapd->iapp = iapp_init(hapd, hapd->conf->iapp_iface);
547 if (hapd->iapp == NULL)
548 return -1;
552 return 0;