contrib/hostapd-0.4.9/iapp.c

   1 /*
   2  * Host AP (software wireless LAN access point) user space daemon for
   3  * Host AP kernel driver / IEEE 802.11F-2003 Inter-Access Point Protocol (IAPP)
   4  * Copyright (c) 2002-2005, Jouni Malinen <jkmaline@cc.hut.fi>
   5  *
   6  * This program is free software; you can redistribute it and/or modify
   7  * it under the terms of the GNU General Public License version 2 as
   8  * published by the Free Software Foundation.
   9  *
  10  * Alternatively, this software may be distributed under the terms of BSD
  11  * license.
  12  *
  13  * See README and COPYING for more details.
  14  */
  15
  16 /* TODO:
  17  * Level 1: no administrative or security support
  18  *      (e.g., static BSSID to IP address mapping in each AP)
  19  * Level 2: support for dynamic mapping of BSSID to IP address
  20  * Level 3: support for encryption and authentication of IAPP messages
  21  * - add support for MOVE-notify and MOVE-response (this requires support for
  22  *   finding out IP address for previous AP using RADIUS)
  23  * - add support for Send- and ACK-Security-Block to speedup IEEE 802.1X during
  24  *   reassociation to another AP
  25  * - implement counters etc. for IAPP MIB
  26  * - verify endianness of fields in IAPP messages; are they big-endian as
  27  *   used here?
  28  * - RADIUS connection for AP registration and BSSID to IP address mapping
  29  * - TCP connection for IAPP MOVE, CACHE
  30  * - broadcast ESP for IAPP ADD-notify
  31  * - ESP for IAPP MOVE messages
  32  * - security block sending/processing
  33  * - IEEE 802.11 context transfer
  34  */
  35
  36 #include <stdlib.h>
  37 #include <stdio.h>
  38 #include <string.h>
  39 #include <unistd.h>
  40 #include <netinet/in.h>
  41 #include <net/if.h>
  42 #include <sys/ioctl.h>
  43 #include <sys/socket.h>
  44 #include <arpa/inet.h>
  45 #ifdef USE_KERNEL_HEADERS
  46 #include <linux/if_packet.h>
  47 #else /* USE_KERNEL_HEADERS */
  48 #include <netpacket/packet.h>
  49 #endif /* USE_KERNEL_HEADERS */
  50
  51 #include "hostapd.h"
  52 #include "ieee802_11.h"
  53 #include "iapp.h"
  54 #include "eloop.h"
  55 #include "sta_info.h"
  56 #include "hostap_common.h"
  57
  58
  59 #define IAPP_MULTICAST "224.0.1.178"
  60 #define IAPP_UDP_PORT 3517
  61 #define IAPP_TCP_PORT 3517
  62
  63 struct iapp_hdr {
  64         u8 version;
  65         u8 command;
  66         u16 identifier;
  67         u16 length;
  68         /* followed by length-6 octets of data */
  69 } __attribute__ ((packed));
  70
  71 #define IAPP_VERSION 0
  72
  73 enum IAPP_COMMAND {
  74         IAPP_CMD_ADD_notify = 0,
  75         IAPP_CMD_MOVE_notify = 1,
  76         IAPP_CMD_MOVE_response = 2,
  77         IAPP_CMD_Send_Security_Block = 3,
  78         IAPP_CMD_ACK_Security_Block = 4,
  79         IAPP_CMD_CACHE_notify = 5,
  80         IAPP_CMD_CACHE_response = 6,
  81 };
  82
  83
  84 /* ADD-notify - multicast UDP on the local LAN */
  85 struct iapp_add_notify {
  86         u8 addr_len; /* ETH_ALEN */
  87         u8 reserved;
  88         u8 mac_addr[ETH_ALEN];
  89         u16 seq_num;
  90 } __attribute__ ((packed));
  91
  92
  93 /* Layer 2 Update frame (802.2 Type 1 LLC XID Update response) */
  94 struct iapp_layer2_update {
  95         u8 da[ETH_ALEN]; /* broadcast */
  96         u8 sa[ETH_ALEN]; /* STA addr */
  97         u16 len; /* 6 */
  98         u8 dsap; /* null DSAP address */
  99         u8 ssap; /* null SSAP address, CR=Response */
 100         u8 control;
 101         u8 xid_info[3];
 102 } __attribute__ ((packed));
 103
 104
 105 /* MOVE-notify - unicast TCP */
 106 struct iapp_move_notify {
 107         u8 addr_len; /* ETH_ALEN */
 108         u8 reserved;
 109         u8 mac_addr[ETH_ALEN];
 110         u16 seq_num;
 111         u16 ctx_block_len;
 112         /* followed by ctx_block_len bytes */
 113 } __attribute__ ((packed));
 114
 115
 116 /* MOVE-response - unicast TCP */
 117 struct iapp_move_response {
 118         u8 addr_len; /* ETH_ALEN */
 119         u8 status;
 120         u8 mac_addr[ETH_ALEN];
 121         u16 seq_num;
 122         u16 ctx_block_len;
 123         /* followed by ctx_block_len bytes */
 124 } __attribute__ ((packed));
 125
 126 enum {
 127         IAPP_MOVE_SUCCESSFUL = 0,
 128         IAPP_MOVE_DENIED = 1,
 129         IAPP_MOVE_STALE_MOVE = 2,
 130 };
 131
 132
 133 /* CACHE-notify */
 134 struct iapp_cache_notify {
 135         u8 addr_len; /* ETH_ALEN */
 136         u8 reserved;
 137         u8 mac_addr[ETH_ALEN];
 138         u16 seq_num;
 139         u8 current_ap[ETH_ALEN];
 140         u16 ctx_block_len;
 141         /* ctx_block_len bytes of context block followed by 16-bit context
 142          * timeout */
 143 } __attribute__ ((packed));
 144
 145
 146 /* CACHE-response - unicast TCP */
 147 struct iapp_cache_response {
 148         u8 addr_len; /* ETH_ALEN */
 149         u8 status;
 150         u8 mac_addr[ETH_ALEN];
 151         u16 seq_num;
 152 } __attribute__ ((packed));
 153
 154 enum {
 155         IAPP_CACHE_SUCCESSFUL = 0,
 156         IAPP_CACHE_STALE_CACHE = 1,
 157 };
 158
 159
 160 /* Send-Security-Block - unicast TCP */
 161 struct iapp_send_security_block {
 162         u8 iv[8];
 163         u16 sec_block_len;
 164         /* followed by sec_block_len bytes of security block */
 165 } __attribute__ ((packed));
 166
 167
 168 /* ACK-Security-Block - unicast TCP */
 169 struct iapp_ack_security_block {
 170         u8 iv[8];
 171         u8 new_ap_ack_authenticator[48];
 172 } __attribute__ ((packed));
 173
 174
 175 struct iapp_data {
 176         struct hostapd_data *hapd;
 177         u16 identifier; /* next IAPP identifier */
 178         struct in_addr own, multicast;
 179         int udp_sock;
 180         int packet_sock;
 181 };
 182
 183
 184 static void iapp_send_add(struct iapp_data *iapp, u8 *macaddr, u16 seq_num)
 185 {
 186         char buf[128];
 187         struct iapp_hdr *hdr;
 188         struct iapp_add_notify *add;
 189         struct sockaddr_in addr;
 190
 191         /* Send IAPP ADD-notify to remove possible association from other APs
 192          */
 193
 194         hdr = (struct iapp_hdr *) buf;
 195         hdr->version = IAPP_VERSION;
 196         hdr->command = IAPP_CMD_ADD_notify;
 197         hdr->identifier = host_to_be16(iapp->identifier++);
 198         hdr->length = host_to_be16(sizeof(*hdr) + sizeof(*add));
 199
 200         add = (struct iapp_add_notify *) (hdr + 1);
 201         add->addr_len = ETH_ALEN;
 202         add->reserved = 0;
 203         memcpy(add->mac_addr, macaddr, ETH_ALEN);
 204
 205         add->seq_num = host_to_be16(seq_num);
 206
 207         memset(&addr, 0, sizeof(addr));
 208         addr.sin_family = AF_INET;
 209         addr.sin_addr.s_addr = iapp->multicast.s_addr;
 210         addr.sin_port = htons(IAPP_UDP_PORT);
 211         if (sendto(iapp->udp_sock, buf, (char *) (add + 1) - buf, 0,
 212                    (struct sockaddr *) &addr, sizeof(addr)) < 0)
 213                 perror("sendto[IAPP-ADD]");
 214 }
 215
 216
 217 static void iapp_send_layer2_update(struct iapp_data *iapp, u8 *addr)
 218 {
 219         struct iapp_layer2_update msg;
 220
 221         /* Send Level 2 Update Frame to update forwarding tables in layer 2
 222          * bridge devices */
 223
 224         /* 802.2 Type 1 Logical Link Control (LLC) Exchange Identifier (XID)
 225          * Update response frame; IEEE Std 802.2-1998, 5.4.1.2.1 */
 226
 227         memset(msg.da, 0xff, ETH_ALEN);
 228         memcpy(msg.sa, addr, ETH_ALEN);
 229         msg.len = host_to_be16(6);
 230         msg.dsap = 0; /* NULL DSAP address */
 231         msg.ssap = 0x01; /* NULL SSAP address, CR Bit: Response */
 232         msg.control = 0xaf; /* XID response lsb.1111F101.
 233                              * F=0 (no poll command; unsolicited frame) */
 234         msg.xid_info[0] = 0x81; /* XID format identifier */
 235         msg.xid_info[1] = 1; /* LLC types/classes: Type 1 LLC */
 236         msg.xid_info[2] = 1 << 1; /* XID sender's receive window size (RW)
 237                                    * FIX: what is correct RW with 802.11? */
 238
 239         if (send(iapp->packet_sock, &msg, sizeof(msg), 0) < 0)
 240                 perror("send[L2 Update]");
 241 }
 242
 243
 244 void iapp_new_station(struct iapp_data *iapp, struct sta_info *sta)
 245 {
 246         struct ieee80211_mgmt *assoc;
 247         u16 seq;
 248
 249         if (iapp == NULL)
 250                 return;
 251
 252         assoc = sta->last_assoc_req;
 253         seq = assoc ? WLAN_GET_SEQ_SEQ(le_to_host16(assoc->seq_ctrl)) : 0;
 254
 255         /* IAPP-ADD.request(MAC Address, Sequence Number, Timeout) */
 256         hostapd_logger(iapp->hapd, sta->addr, HOSTAPD_MODULE_IAPP,
 257                        HOSTAPD_LEVEL_DEBUG, "IAPP-ADD.request(seq=%d)", seq);
 258         iapp_send_layer2_update(iapp, sta->addr);
 259         iapp_send_add(iapp, sta->addr, seq);
 260
 261         if (assoc && WLAN_FC_GET_STYPE(le_to_host16(assoc->frame_control)) ==
 262             WLAN_FC_STYPE_REASSOC_REQ) {
 263                 /* IAPP-MOVE.request(MAC Address, Sequence Number, Old AP,
 264                  *                   Context Block, Timeout)
 265                  */
 266                 /* TODO: Send IAPP-MOVE to the old AP; Map Old AP BSSID to
 267                  * IP address */
 268         }
 269 }
 270
 271
 272 static void iapp_process_add_notify(struct iapp_data *iapp,
 273                                     struct sockaddr_in *from,
 274                                     struct iapp_hdr *hdr, int len)
 275 {
 276         struct iapp_add_notify *add = (struct iapp_add_notify *) (hdr + 1);
 277         struct sta_info *sta;
 278
 279         if (len != sizeof(*add)) {
 280                 printf("Invalid IAPP-ADD packet length %d (expected %lu)\n",
 281                        len, (unsigned long) sizeof(*add));
 282                 return;
 283         }
 284
 285         sta = ap_get_sta(iapp->hapd, add->mac_addr);
 286
 287         /* IAPP-ADD.indication(MAC Address, Sequence Number) */
 288         hostapd_logger(iapp->hapd, add->mac_addr, HOSTAPD_MODULE_IAPP,
 289                        HOSTAPD_LEVEL_INFO,
 290                        "Received IAPP ADD-notify (seq# %d) from %s:%d%s",
 291                        be_to_host16(add->seq_num),
 292                        inet_ntoa(from->sin_addr), ntohs(from->sin_port),
 293                        sta ? "" : " (STA not found)");
 294
 295         if (!sta)
 296                 return;
 297
 298         /* TODO: could use seq_num to try to determine whether last association
 299          * to this AP is newer than the one advertised in IAPP-ADD. Although,
 300          * this is not really a reliable verification. */
 301
 302         hostapd_logger(iapp->hapd, add->mac_addr, HOSTAPD_MODULE_IAPP,
 303                        HOSTAPD_LEVEL_DEBUG,
 304                        "Removing STA due to IAPP ADD-notify");
 305         sta->flags &= ~(WLAN_STA_AUTH | WLAN_STA_ASSOC | WLAN_STA_AUTHORIZED);
 306         eloop_cancel_timeout(ap_handle_timer, iapp->hapd, sta);
 307         eloop_register_timeout(0, 0, ap_handle_timer, iapp->hapd, sta);
 308         sta->timeout_next = STA_REMOVE;
 309 }
 310
 311
 312 static void iapp_receive_udp(int sock, void *eloop_ctx, void *sock_ctx)
 313 {
 314         struct iapp_data *iapp = eloop_ctx;
 315         int len, hlen;
 316         unsigned char buf[128];
 317         struct sockaddr_in from;
 318         socklen_t fromlen;
 319         struct iapp_hdr *hdr;
 320
 321         /* Handle incoming IAPP frames (over UDP/IP) */
 322
 323         fromlen = sizeof(from);
 324         len = recvfrom(iapp->udp_sock, buf, sizeof(buf), 0,
 325                        (struct sockaddr *) &from, &fromlen);
 326         if (len < 0)
 327                 perror("recvfrom");
 328
 329         if (from.sin_addr.s_addr == iapp->own.s_addr)
 330                 return; /* ignore own IAPP messages */
 331
 332         hostapd_logger(iapp->hapd, NULL, HOSTAPD_MODULE_IAPP,
 333                        HOSTAPD_LEVEL_DEBUG,
 334                        "Received %d byte IAPP frame from %s%s\n",
 335                        len, inet_ntoa(from.sin_addr),
 336                        len < sizeof(*hdr) ? " (too short)" : "");
 337
 338         if (len < sizeof(*hdr))
 339                 return;
 340
 341         hdr = (struct iapp_hdr *) buf;
 342         hlen = be_to_host16(hdr->length);
 343         hostapd_logger(iapp->hapd, NULL, HOSTAPD_MODULE_IAPP,
 344                        HOSTAPD_LEVEL_DEBUG,
 345                        "RX: version=%d command=%d id=%d len=%d\n",
 346                        hdr->version, hdr->command,
 347                        be_to_host16(hdr->identifier), hlen);
 348         if (hdr->version != IAPP_VERSION) {
 349                 printf("Dropping IAPP frame with unknown version %d\n",
 350                        hdr->version);
 351                 return;
 352         }
 353         if (hlen > len) {
 354                 printf("Underflow IAPP frame (hlen=%d len=%d)\n", hlen, len);
 355                 return;
 356         }
 357         if (hlen < len) {
 358                 printf("Ignoring %d extra bytes from IAPP frame\n",
 359                        len - hlen);
 360                 len = hlen;
 361         }
 362
 363         switch (hdr->command) {
 364         case IAPP_CMD_ADD_notify:
 365                 iapp_process_add_notify(iapp, &from, hdr, hlen - sizeof(*hdr));
 366                 break;
 367         case IAPP_CMD_MOVE_notify:
 368                 /* TODO: MOVE is using TCP; so move this to TCP handler once it
 369                  * is implemented.. */
 370                 /* IAPP-MOVE.indication(MAC Address, New BSSID,
 371                  * Sequence Number, AP Address, Context Block) */
 372                 /* TODO: process */
 373                 break;
 374         default:
 375                 printf("Unknown IAPP command %d\n", hdr->command);
 376                 break;
 377         }
 378 }
 379
 380
 381 struct iapp_data * iapp_init(struct hostapd_data *hapd, const char *iface)
 382 {
 383         struct ifreq ifr;
 384         struct sockaddr_ll addr;
 385         int ifindex;
 386         struct sockaddr_in *paddr, uaddr;
 387         struct iapp_data *iapp;
 388         struct ip_mreqn mreq;
 389
 390         iapp = malloc(sizeof(*iapp));
 391         if (iapp == NULL)
 392                 return NULL;
 393         memset(iapp, 0, sizeof(*iapp));
 394         iapp->hapd = hapd;
 395         iapp->udp_sock = iapp->packet_sock = -1;
 396
 397         /* TODO:
 398          * open socket for sending and receiving IAPP frames over TCP
 399          */
 400
 401         iapp->udp_sock = socket(PF_INET, SOCK_DGRAM, 0);
 402         if (iapp->udp_sock < 0) {
 403                 perror("socket[PF_INET,SOCK_DGRAM]");
 404                 iapp_deinit(iapp);
 405                 return NULL;
 406         }
 407
 408         memset(&ifr, 0, sizeof(ifr));
 409         strncpy(ifr.ifr_name, iface, sizeof(ifr.ifr_name));
 410         if (ioctl(iapp->udp_sock, SIOCGIFINDEX, &ifr) != 0) {
 411                 perror("ioctl(SIOCGIFINDEX)");
 412                 iapp_deinit(iapp);
 413                 return NULL;
 414         }
 415         ifindex = ifr.ifr_ifindex;
 416
 417         if (ioctl(iapp->udp_sock, SIOCGIFADDR, &ifr) != 0) {
 418                 perror("ioctl(SIOCGIFADDR)");
 419                 iapp_deinit(iapp);
 420                 return NULL;
 421         }
 422         paddr = (struct sockaddr_in *) &ifr.ifr_addr;
 423         if (paddr->sin_family != AF_INET) {
 424                 printf("Invalid address family %i (SIOCGIFADDR)\n",
 425                        paddr->sin_family);
 426                 iapp_deinit(iapp);
 427                 return NULL;
 428         }
 429         iapp->own.s_addr = paddr->sin_addr.s_addr;
 430
 431         if (ioctl(iapp->udp_sock, SIOCGIFBRDADDR, &ifr) != 0) {
 432                 perror("ioctl(SIOCGIFBRDADDR)");
 433                 iapp_deinit(iapp);
 434                 return NULL;
 435         }
 436         paddr = (struct sockaddr_in *) &ifr.ifr_addr;
 437         if (paddr->sin_family != AF_INET) {
 438                 printf("Invalid address family %i (SIOCGIFBRDADDR)\n",
 439                        paddr->sin_family);
 440                 iapp_deinit(iapp);
 441                 return NULL;
 442         }
 443         inet_aton(IAPP_MULTICAST, &iapp->multicast);
 444
 445         memset(&uaddr, 0, sizeof(uaddr));
 446         uaddr.sin_family = AF_INET;
 447         uaddr.sin_port = htons(IAPP_UDP_PORT);
 448         if (bind(iapp->udp_sock, (struct sockaddr *) &uaddr,
 449                  sizeof(uaddr)) < 0) {
 450                 perror("bind[UDP]");
 451                 iapp_deinit(iapp);
 452                 return NULL;
 453         }
 454
 455         memset(&mreq, 0, sizeof(mreq));
 456         mreq.imr_multiaddr = iapp->multicast;
 457         mreq.imr_address.s_addr = INADDR_ANY;
 458         mreq.imr_ifindex = 0;
 459         if (setsockopt(iapp->udp_sock, SOL_IP, IP_ADD_MEMBERSHIP, &mreq,
 460                        sizeof(mreq)) < 0) {
 461                 perror("setsockopt[UDP,IP_ADD_MEMBERSHIP]");
 462                 return NULL;
 463         }
 464
 465         iapp->packet_sock = socket(PF_PACKET, SOCK_RAW, htons(ETH_P_ALL));
 466         if (iapp->packet_sock < 0) {
 467                 perror("socket[PF_PACKET,SOCK_RAW]");
 468                 return NULL;
 469         }
 470
 471         memset(&addr, 0, sizeof(addr));
 472         addr.sll_family = AF_PACKET;
 473         addr.sll_ifindex = ifindex;
 474         if (bind(iapp->packet_sock, (struct sockaddr *) &addr,
 475                  sizeof(addr)) < 0) {
 476                 perror("bind[PACKET]");
 477                 return NULL;
 478         }
 479
 480         if (eloop_register_read_sock(iapp->udp_sock, iapp_receive_udp,
 481                                      iapp, NULL)) {
 482                 printf("Could not register read socket for IAPP.\n");
 483                 return NULL;
 484         }
 485
 486         printf("IEEE 802.11F (IAPP) using interface %s\n", iface);
 487
 488         /* TODO: For levels 2 and 3: send RADIUS Initiate-Request, receive
 489          * RADIUS Initiate-Accept or Initiate-Reject. IAPP port should actually
 490          * be openned only after receiving Initiate-Accept. If Initiate-Reject
 491          * is received, IAPP is not started. */
 492
 493         return iapp;
 494 }
 495
 496
 497 void iapp_deinit(struct iapp_data *iapp)
 498 {
 499         struct ip_mreqn mreq;
 500
 501         if (iapp == NULL)
 502                 return;
 503
 504         if (iapp->udp_sock >= 0) {
 505                 memset(&mreq, 0, sizeof(mreq));
 506                 mreq.imr_multiaddr = iapp->multicast;
 507                 mreq.imr_address.s_addr = INADDR_ANY;
 508                 mreq.imr_ifindex = 0;
 509                 if (setsockopt(iapp->udp_sock, SOL_IP, IP_DROP_MEMBERSHIP,
 510                                &mreq, sizeof(mreq)) < 0) {
 511                         perror("setsockopt[UDP,IP_DEL_MEMBERSHIP]");
 512                 }
 513
 514                 eloop_unregister_read_sock(iapp->udp_sock);
 515                 close(iapp->udp_sock);
 516         }
 517         if (iapp->packet_sock >= 0) {
 518                 eloop_unregister_read_sock(iapp->packet_sock);
 519                 close(iapp->packet_sock);
 520         }
 521         free(iapp);
 522 }