net/ieee80211/softmac/ieee80211softmac_io.c

   1 /*
   2  * Some parts based on code from net80211
   3  * Copyright (c) 2001 Atsushi Onoe
   4  * Copyright (c) 2002-2005 Sam Leffler, Errno Consulting
   5  * All rights reserved.
   6  *
   7  * Redistribution and use in source and binary forms, with or without
   8  * modification, are permitted provided that the following conditions
   9  * are met:
  10  * 1. Redistributions of source code must retain the above copyright
  11  *    notice, this list of conditions and the following disclaimer.
  12  * 2. Redistributions in binary form must reproduce the above copyright
  13  *    notice, this list of conditions and the following disclaimer in the
  14  *    documentation and/or other materials provided with the distribution.
  15  * 3. The name of the author may not be used to endorse or promote products
  16  *    derived from this software without specific prior written permission.
  17  *
  18  * Alternatively, this software may be distributed under the terms of the
  19  * GNU General Public License ("GPL") version 2 as published by the Free
  20  * Software Foundation.
  21  *
  22  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
  23  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  24  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  25  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
  26  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  27  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  28  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  29  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  30  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  31  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  32  *
  33  */
  34
  35 #include "ieee80211softmac_priv.h"
  36
  37 /* Helper functions for inserting data into the frames */
  38
  39 /*
  40  * Adds an ESSID element to the frame
  41  *
  42  */
  43 static u8 *
  44 ieee80211softmac_add_essid(u8 *dst, struct ieee80211softmac_essid *essid)
  45 {
  46         if (essid) {
  47                 *dst++ = MFIE_TYPE_SSID;
  48                 *dst++ = essid->len;
  49                 memcpy(dst, essid->data, essid->len);
  50                 return dst+essid->len;
  51         } else {
  52                 *dst++ = MFIE_TYPE_SSID;
  53                 *dst++ = 0;
  54                 return dst;
  55         }
  56 }
  57
  58 /* Adds Supported Rates and if required Extended Rates Information Element
  59  * to the frame, ASSUMES WE HAVE A SORTED LIST OF RATES */
  60 static u8 *
  61 ieee80211softmac_frame_add_rates(u8 *dst, const struct ieee80211softmac_ratesinfo *r)
  62 {
  63         int cck_len, ofdm_len;
  64         *dst++ = MFIE_TYPE_RATES;
  65
  66         for(cck_len=0; ieee80211_is_cck_rate(r->rates[cck_len]) && (cck_len < r->count);cck_len++);
  67
  68         if(cck_len > IEEE80211SOFTMAC_MAX_RATES_LEN)
  69                 cck_len = IEEE80211SOFTMAC_MAX_RATES_LEN;
  70         *dst++ = cck_len;
  71         memcpy(dst, r->rates, cck_len);
  72         dst += cck_len;
  73
  74         if(cck_len < r->count){
  75                 for (ofdm_len=0; ieee80211_is_ofdm_rate(r->rates[ofdm_len + cck_len]) && (ofdm_len + cck_len < r->count); ofdm_len++);
  76                 if (ofdm_len > 0) {
  77                         if (ofdm_len > IEEE80211SOFTMAC_MAX_EX_RATES_LEN)
  78                                 ofdm_len = IEEE80211SOFTMAC_MAX_EX_RATES_LEN;
  79                         *dst++ = MFIE_TYPE_RATES_EX;
  80                         *dst++ = ofdm_len;
  81                         memcpy(dst, r->rates + cck_len, ofdm_len);
  82                         dst += ofdm_len;
  83                 }
  84         }
  85         return dst;
  86 }
  87
  88 /* Allocate a management frame */
  89 static u8 *
  90 ieee80211softmac_alloc_mgt(u32 size)
  91 {
  92         u8 * data;
  93
  94         /* Add the header and FCS to the size */
  95         size = size + IEEE80211_3ADDR_LEN;
  96         if(size > IEEE80211_DATA_LEN)
  97                 return NULL;
  98         /* Allocate the frame */
  99         data = kmalloc(size, GFP_ATOMIC);
 100         memset(data, 0, size);
 101         return data;
 102 }
 103
 104 /*
 105  * Add a 2 Address Header
 106  */
 107 static void
 108 ieee80211softmac_hdr_2addr(struct ieee80211softmac_device *mac,
 109         struct ieee80211_hdr_2addr *header, u32 type, u8 *dest)
 110 {
 111         /* Fill in the frame control flags */
 112         header->frame_ctl = cpu_to_le16(type);
 113         /* Control packets always have WEP turned off */
 114         if(type > IEEE80211_STYPE_CFENDACK && type < IEEE80211_STYPE_PSPOLL)
 115                 header->frame_ctl |= mac->ieee->sec.level ? cpu_to_le16(IEEE80211_FCTL_PROTECTED) : 0;
 116
 117         /* Fill in the duration */
 118         header->duration_id = 0;
 119         /* FIXME: How do I find this?
 120          * calculate. But most drivers just fill in 0 (except if it's a station id of course) */
 121
 122         /* Fill in the Destination Address */
 123         if(dest == NULL)
 124                 memset(header->addr1, 0xFF, ETH_ALEN);
 125         else
 126                 memcpy(header->addr1, dest, ETH_ALEN);
 127         /* Fill in the Source Address */
 128         memcpy(header->addr2, mac->ieee->dev->dev_addr, ETH_ALEN);
 129
 130 }
 131
 132
 133 /* Add a 3 Address Header */
 134 static void
 135 ieee80211softmac_hdr_3addr(struct ieee80211softmac_device *mac,
 136         struct ieee80211_hdr_3addr *header, u32 type, u8 *dest, u8 *bssid)
 137 {
 138         /* This is common with 2addr, so use that instead */
 139         ieee80211softmac_hdr_2addr(mac, (struct ieee80211_hdr_2addr *)header, type, dest);
 140
 141         /* Fill in the BSS ID */
 142         if(bssid == NULL)
 143                 memset(header->addr3, 0xFF, ETH_ALEN);
 144         else
 145                 memcpy(header->addr3, bssid, ETH_ALEN);
 146
 147         /* Fill in the sequence # */
 148         /* FIXME: I need to add this to the softmac struct
 149          * shouldn't the sequence number be in ieee80211? */
 150 }
 151
 152
 153 /*****************************************************************************
 154  * Create Management packets
 155  *****************************************************************************/
 156
 157 /* Creates an association request packet */
 158 static u32
 159 ieee80211softmac_assoc_req(struct ieee80211_assoc_request **pkt,
 160         struct ieee80211softmac_device *mac, struct ieee80211softmac_network *net)
 161 {
 162         u8 *data;
 163         (*pkt) = (struct ieee80211_assoc_request *)ieee80211softmac_alloc_mgt(
 164                 2 +             /* Capability Info */
 165                 2 +             /* Listen Interval */
 166                 /* SSID IE */
 167                 1 + 1 + IW_ESSID_MAX_SIZE +
 168                 /* Rates IE */
 169                 1 + 1 + IEEE80211SOFTMAC_MAX_RATES_LEN +
 170                 /* Extended Rates IE */
 171                 1 + 1 + IEEE80211SOFTMAC_MAX_EX_RATES_LEN +
 172                 /* WPA IE if present */
 173                 mac->wpa.IElen
 174                 /* Other IE's?  Optional?
 175                  * Yeah, probably need an extra IE parameter -- lots of vendors like to
 176                  * fill in their own IEs */
 177         );
 178         if (unlikely((*pkt) == NULL))
 179                 return 0;
 180         ieee80211softmac_hdr_3addr(mac, &((*pkt)->header), IEEE80211_STYPE_ASSOC_REQ, net->bssid, net->bssid);
 181
 182         /* Fill in capability Info */
 183         switch (mac->ieee->iw_mode) {
 184         case IW_MODE_INFRA:
 185                 (*pkt)->capability = cpu_to_le16(WLAN_CAPABILITY_ESS);
 186                 break;
 187         case IW_MODE_ADHOC:
 188                 (*pkt)->capability = cpu_to_le16(WLAN_CAPABILITY_IBSS);
 189                 break;
 190         case IW_MODE_AUTO:
 191                 (*pkt)->capability = net->capabilities & (WLAN_CAPABILITY_ESS|WLAN_CAPABILITY_IBSS);
 192                 break;
 193         default:
 194                 /* bleh. we don't ever go to these modes */
 195                 printk(KERN_ERR PFX "invalid iw_mode!\n");
 196                 break;
 197         }
 198         /* Need to add this
 199         (*pkt)->capability |= mac->ieee->short_slot ?
 200                         cpu_to_le16(WLAN_CAPABILITY_SHORT_SLOT_TIME) : 0;
 201          */
 202         (*pkt)->capability |= mac->ieee->sec.level ? cpu_to_le16(WLAN_CAPABILITY_PRIVACY) : 0;
 203         /* Fill in Listen Interval (?) */
 204         (*pkt)->listen_interval = cpu_to_le16(10);
 205
 206         data = (u8 *)(*pkt)->info_element;
 207         /* Add SSID */
 208         data = ieee80211softmac_add_essid(data, &net->essid);
 209         /* Add Rates */
 210         data = ieee80211softmac_frame_add_rates(data, &mac->ratesinfo);
 211         /* Add WPA IE */
 212         if (mac->wpa.IElen && mac->wpa.IE) {
 213                 memcpy(data, mac->wpa.IE, mac->wpa.IElen);
 214                 data += mac->wpa.IElen;
 215         }
 216         /* Return the number of used bytes */
 217         return (data - (u8*)(*pkt));
 218 }
 219
 220 /* Create a reassociation request packet */
 221 static u32
 222 ieee80211softmac_reassoc_req(struct ieee80211_reassoc_request **pkt,
 223         struct ieee80211softmac_device *mac, struct ieee80211softmac_network *net)
 224 {
 225         u8 *data;
 226         (*pkt) = (struct ieee80211_reassoc_request *)ieee80211softmac_alloc_mgt(
 227                 2 +             /* Capability Info */
 228                 2 +             /* Listen Interval */
 229                 ETH_ALEN +      /* AP MAC */
 230                 /* SSID IE */
 231                 1 + 1 + IW_ESSID_MAX_SIZE +
 232                 /* Rates IE */
 233                 1 + 1 + IEEE80211SOFTMAC_MAX_RATES_LEN +
 234                 /* Extended Rates IE */
 235                 1 + 1 + IEEE80211SOFTMAC_MAX_EX_RATES_LEN
 236                 /* Other IE's? */
 237         );
 238         if (unlikely((*pkt) == NULL))
 239                 return 0;
 240         ieee80211softmac_hdr_3addr(mac, &((*pkt)->header), IEEE80211_STYPE_REASSOC_REQ, net->bssid, net->bssid);
 241
 242         /* Fill in capability Info */
 243         (*pkt)->capability = mac->ieee->iw_mode == IW_MODE_MASTER ?
 244                                 cpu_to_le16(WLAN_CAPABILITY_ESS) :
 245                                 cpu_to_le16(WLAN_CAPABILITY_IBSS);
 246         /*
 247         (*pkt)->capability |= mac->ieee->short_slot ?
 248                         cpu_to_le16(WLAN_CAPABILITY_SHORT_SLOT_TIME) : 0;
 249          */
 250         (*pkt)->capability |= mac->ieee->sec.level ?
 251                         cpu_to_le16(WLAN_CAPABILITY_PRIVACY) : 0;
 252
 253         /* Fill in Listen Interval (?) */
 254         (*pkt)->listen_interval = cpu_to_le16(10);
 255         /* Fill in the current AP MAC */
 256         memcpy((*pkt)->current_ap, mac->ieee->bssid, ETH_ALEN);
 257
 258         data = (u8 *)(*pkt)->info_element;
 259         /* Add SSID */
 260         data = ieee80211softmac_add_essid(data, &net->essid);
 261         /* Add Rates */
 262         data = ieee80211softmac_frame_add_rates(data, &mac->ratesinfo);
 263         /* Return packet size */
 264         return (data - (u8 *)(*pkt));
 265 }
 266
 267 /* Create an authentication packet */
 268 static u32
 269 ieee80211softmac_auth(struct ieee80211_auth **pkt,
 270         struct ieee80211softmac_device *mac, struct ieee80211softmac_network *net,
 271         u16 transaction, u16 status)
 272 {
 273         u8 *data;
 274         /* Allocate Packet */
 275         (*pkt) = (struct ieee80211_auth *)ieee80211softmac_alloc_mgt(
 276                 2 +             /* Auth Algorithm */
 277                 2 +             /* Auth Transaction Seq */
 278                 2 +             /* Status Code */
 279                  /* Challenge Text IE */
 280                 mac->ieee->open_wep ? 0 :
 281                 1 + 1 + WLAN_AUTH_CHALLENGE_LEN
 282         );
 283         if (unlikely((*pkt) == NULL))
 284                 return 0;
 285         ieee80211softmac_hdr_3addr(mac, &((*pkt)->header), IEEE80211_STYPE_AUTH, net->bssid, net->bssid);
 286
 287         /* Algorithm */
 288         (*pkt)->algorithm = mac->ieee->open_wep ?
 289                 cpu_to_le16(WLAN_AUTH_OPEN) :
 290                 cpu_to_le16(WLAN_AUTH_SHARED_KEY);
 291         /* Transaction */
 292         (*pkt)->transaction = cpu_to_le16(transaction);
 293         /* Status */
 294         (*pkt)->status = cpu_to_le16(status);
 295
 296         data = (u8 *)(*pkt)->info_element;
 297         /* Challenge Text */
 298         if(!mac->ieee->open_wep){
 299                 *data = MFIE_TYPE_CHALLENGE;
 300                 data++;
 301
 302                 /* Copy the challenge in */
 303                 // *data = challenge length
 304                 // data += sizeof(u16);
 305                 // memcpy(data, challenge, challenge length);
 306                 // data += challenge length;
 307
 308                 /* Add the full size to the packet length */
 309         }
 310
 311         /* Return the packet size */
 312         return (data - (u8 *)(*pkt));
 313 }
 314
 315 /* Create a disassocation or deauthentication packet */
 316 static u32
 317 ieee80211softmac_disassoc_deauth(struct ieee80211_disassoc **pkt,
 318         struct ieee80211softmac_device *mac, struct ieee80211softmac_network *net,
 319         u16 type, u16 reason)
 320 {
 321         /* Allocate Packet */
 322         (*pkt) = (struct ieee80211_disassoc *)ieee80211softmac_alloc_mgt(2);
 323         if (unlikely((*pkt) == NULL))
 324                 return 0;
 325         ieee80211softmac_hdr_3addr(mac, &((*pkt)->header), type, net->bssid, net->bssid);
 326         /* Reason */
 327         (*pkt)->reason = cpu_to_le16(reason);
 328         /* Return the packet size */
 329         return (2 + IEEE80211_3ADDR_LEN);
 330 }
 331
 332 /* Create a probe request packet */
 333 static u32
 334 ieee80211softmac_probe_req(struct ieee80211_probe_request **pkt,
 335         struct ieee80211softmac_device *mac, struct ieee80211softmac_essid *essid)
 336 {
 337         u8 *data;
 338         /* Allocate Packet */
 339         (*pkt) = (struct ieee80211_probe_request *)ieee80211softmac_alloc_mgt(
 340                 /* SSID of requested network */
 341                 1 + 1 + IW_ESSID_MAX_SIZE +
 342                 /* Rates IE */
 343                 1 + 1 + IEEE80211SOFTMAC_MAX_RATES_LEN +
 344                 /* Extended Rates IE */
 345                 1 + 1 + IEEE80211SOFTMAC_MAX_EX_RATES_LEN
 346         );
 347         if (unlikely((*pkt) == NULL))
 348                 return 0;
 349         ieee80211softmac_hdr_3addr(mac, &((*pkt)->header), IEEE80211_STYPE_PROBE_REQ, NULL, NULL);
 350
 351         data = (u8 *)(*pkt)->info_element;
 352         /* Add ESSID (can be NULL) */
 353         data = ieee80211softmac_add_essid(data, essid);
 354         /* Add Rates */
 355         data = ieee80211softmac_frame_add_rates(data, &mac->ratesinfo);
 356         /* Return packet size */
 357         return (data - (u8 *)(*pkt));
 358 }
 359
 360 /* Create a probe response packet */
 361 /* FIXME: Not complete */
 362 static u32
 363 ieee80211softmac_probe_resp(struct ieee80211_probe_response **pkt,
 364         struct ieee80211softmac_device *mac, struct ieee80211softmac_network *net)
 365 {
 366         u8 *data;
 367         /* Allocate Packet */
 368         (*pkt) = (struct ieee80211_probe_response *)ieee80211softmac_alloc_mgt(
 369                 8 +             /* Timestamp */
 370                 2 +             /* Beacon Interval */
 371                 2 +             /* Capability Info */
 372                                 /* SSID IE */
 373                 1 + 1 + IW_ESSID_MAX_SIZE +
 374                 7 +             /* FH Parameter Set */
 375                 2 +             /* DS Parameter Set */
 376                 8 +             /* CF Parameter Set */
 377                 4               /* IBSS Parameter Set */
 378         );
 379         if (unlikely((*pkt) == NULL))
 380                 return 0;
 381         ieee80211softmac_hdr_3addr(mac, &((*pkt)->header), IEEE80211_STYPE_PROBE_RESP, net->bssid, net->bssid);
 382         data = (u8 *)(*pkt)->info_element;
 383
 384         /* Return the packet size */
 385         return (data - (u8 *)(*pkt));
 386 }
 387
 388
 389 /* Sends a manangement packet
 390  * FIXME: document the use of the arg parameter
 391  * for _AUTH: (transaction #) | (status << 16)
 392  */
 393 int
 394 ieee80211softmac_send_mgt_frame(struct ieee80211softmac_device *mac,
 395         void *ptrarg, u32 type, u32 arg)
 396 {
 397         void *pkt = NULL;
 398         u32 pkt_size = 0;
 399
 400         switch(type) {
 401         case IEEE80211_STYPE_ASSOC_REQ:
 402                 pkt_size = ieee80211softmac_assoc_req((struct ieee80211_assoc_request **)(&pkt), mac, (struct ieee80211softmac_network *)ptrarg);
 403                 break;
 404         case IEEE80211_STYPE_REASSOC_REQ:
 405                 pkt_size = ieee80211softmac_reassoc_req((struct ieee80211_reassoc_request **)(&pkt), mac, (struct ieee80211softmac_network *)ptrarg);
 406                 break;
 407         case IEEE80211_STYPE_AUTH:
 408                 pkt_size = ieee80211softmac_auth((struct ieee80211_auth **)(&pkt), mac, (struct ieee80211softmac_network *)ptrarg, (u16)(arg & 0xFFFF), (u16) (arg >> 16));
 409                 break;
 410         case IEEE80211_STYPE_DISASSOC:
 411         case IEEE80211_STYPE_DEAUTH:
 412                 pkt_size = ieee80211softmac_disassoc_deauth((struct ieee80211_disassoc **)(&pkt), mac, (struct ieee80211softmac_network *)ptrarg, type, (u16)(arg & 0xFFFF));
 413                 break;
 414         case IEEE80211_STYPE_PROBE_REQ:
 415                 pkt_size = ieee80211softmac_probe_req((struct ieee80211_probe_request **)(&pkt), mac, (struct ieee80211softmac_essid *)ptrarg);
 416                 break;
 417         case IEEE80211_STYPE_PROBE_RESP:
 418                 pkt_size = ieee80211softmac_probe_resp((struct ieee80211_probe_response **)(&pkt), mac, (struct ieee80211softmac_network *)ptrarg);
 419                 break;
 420         default:
 421                 printkl(KERN_DEBUG PFX "Unsupported Management Frame type: %i\n", type);
 422                 return -EINVAL;
 423         };
 424
 425         if(pkt_size == 0 || pkt == NULL) {
 426                 printkl(KERN_DEBUG PFX "Error, packet is nonexistant or 0 length\n");
 427                 return -ENOMEM;
 428         }
 429
 430         /* Send the packet to the ieee80211 layer for tx */
 431         /* we defined softmac->mgmt_xmit for this. Should we keep it
 432          * as it is (that means we'd need to wrap this into a txb),
 433          * modify the prototype (so it matches this function),
 434          * or get rid of it alltogether?
 435          * Does this work for you now?
 436          */
 437         ieee80211_tx_frame(mac->ieee, (struct ieee80211_hdr *)pkt, pkt_size);
 438
 439         kfree(pkt);
 440         return 0;
 441 }
 442
 443
 444 /* Create an rts/cts frame */
 445 static u32
 446 ieee80211softmac_rts_cts(struct ieee80211_hdr_2addr **pkt,
 447         struct ieee80211softmac_device *mac, struct ieee80211softmac_network *net,
 448         u32 type)
 449 {
 450         /* Allocate Packet */
 451         (*pkt) = kmalloc(IEEE80211_2ADDR_LEN, GFP_ATOMIC);
 452         memset(*pkt, 0, IEEE80211_2ADDR_LEN);
 453         if((*pkt) == NULL)
 454                 return 0;
 455         ieee80211softmac_hdr_2addr(mac, (*pkt), type, net->bssid);
 456         return IEEE80211_2ADDR_LEN;
 457 }
 458
 459
 460 /* Sends a control packet */
 461 static int
 462 ieee80211softmac_send_ctl_frame(struct ieee80211softmac_device *mac,
 463         struct ieee80211softmac_network *net, u32 type, u32 arg)
 464 {
 465         void *pkt = NULL;
 466         u32 pkt_size = 0;
 467
 468         switch(type) {
 469         case IEEE80211_STYPE_RTS:
 470         case IEEE80211_STYPE_CTS:
 471                 pkt_size = ieee80211softmac_rts_cts((struct ieee80211_hdr_2addr **)(&pkt), mac, net, type);
 472                 break;
 473         default:
 474                 printkl(KERN_DEBUG PFX "Unsupported Control Frame type: %i\n", type);
 475                 return -EINVAL;
 476         }
 477
 478         if(pkt_size == 0)
 479                 return -ENOMEM;
 480
 481         /* Send the packet to the ieee80211 layer for tx */
 482         ieee80211_tx_frame(mac->ieee, (struct ieee80211_hdr *) pkt, pkt_size);
 483
 484         kfree(pkt);
 485         return 0;
 486 }