release/src-rt-6.x/linux/linux-2.6/drivers/net/wireless/hostap/hostap_info.c

   1 /* Host AP driver Info Frame processing (part of hostap.o module) */
   2
   3 #include "hostap_wlan.h"
   4 #include "hostap.h"
   5 #include "hostap_ap.h"
   6
   7 /* Called only as a tasklet (software IRQ) */
   8 static void prism2_info_commtallies16(local_info_t *local, unsigned char *buf,
   9                                       int left)
  10 {
  11         struct hfa384x_comm_tallies *tallies;
  12
  13         if (left < sizeof(struct hfa384x_comm_tallies)) {
  14                 printk(KERN_DEBUG "%s: too short (len=%d) commtallies "
  15                        "info frame\n", local->dev->name, left);
  16                 return;
  17         }
  18
  19         tallies = (struct hfa384x_comm_tallies *) buf;
  20 #define ADD_COMM_TALLIES(name) \
  21 local->comm_tallies.name += le16_to_cpu(tallies->name)
  22         ADD_COMM_TALLIES(tx_unicast_frames);
  23         ADD_COMM_TALLIES(tx_multicast_frames);
  24         ADD_COMM_TALLIES(tx_fragments);
  25         ADD_COMM_TALLIES(tx_unicast_octets);
  26         ADD_COMM_TALLIES(tx_multicast_octets);
  27         ADD_COMM_TALLIES(tx_deferred_transmissions);
  28         ADD_COMM_TALLIES(tx_single_retry_frames);
  29         ADD_COMM_TALLIES(tx_multiple_retry_frames);
  30         ADD_COMM_TALLIES(tx_retry_limit_exceeded);
  31         ADD_COMM_TALLIES(tx_discards);
  32         ADD_COMM_TALLIES(rx_unicast_frames);
  33         ADD_COMM_TALLIES(rx_multicast_frames);
  34         ADD_COMM_TALLIES(rx_fragments);
  35         ADD_COMM_TALLIES(rx_unicast_octets);
  36         ADD_COMM_TALLIES(rx_multicast_octets);
  37         ADD_COMM_TALLIES(rx_fcs_errors);
  38         ADD_COMM_TALLIES(rx_discards_no_buffer);
  39         ADD_COMM_TALLIES(tx_discards_wrong_sa);
  40         ADD_COMM_TALLIES(rx_discards_wep_undecryptable);
  41         ADD_COMM_TALLIES(rx_message_in_msg_fragments);
  42         ADD_COMM_TALLIES(rx_message_in_bad_msg_fragments);
  43 #undef ADD_COMM_TALLIES
  44 }
  45
  46
  47 /* Called only as a tasklet (software IRQ) */
  48 static void prism2_info_commtallies32(local_info_t *local, unsigned char *buf,
  49                                       int left)
  50 {
  51         struct hfa384x_comm_tallies32 *tallies;
  52
  53         if (left < sizeof(struct hfa384x_comm_tallies32)) {
  54                 printk(KERN_DEBUG "%s: too short (len=%d) commtallies32 "
  55                        "info frame\n", local->dev->name, left);
  56                 return;
  57         }
  58
  59         tallies = (struct hfa384x_comm_tallies32 *) buf;
  60 #define ADD_COMM_TALLIES(name) \
  61 local->comm_tallies.name += le32_to_cpu(tallies->name)
  62         ADD_COMM_TALLIES(tx_unicast_frames);
  63         ADD_COMM_TALLIES(tx_multicast_frames);
  64         ADD_COMM_TALLIES(tx_fragments);
  65         ADD_COMM_TALLIES(tx_unicast_octets);
  66         ADD_COMM_TALLIES(tx_multicast_octets);
  67         ADD_COMM_TALLIES(tx_deferred_transmissions);
  68         ADD_COMM_TALLIES(tx_single_retry_frames);
  69         ADD_COMM_TALLIES(tx_multiple_retry_frames);
  70         ADD_COMM_TALLIES(tx_retry_limit_exceeded);
  71         ADD_COMM_TALLIES(tx_discards);
  72         ADD_COMM_TALLIES(rx_unicast_frames);
  73         ADD_COMM_TALLIES(rx_multicast_frames);
  74         ADD_COMM_TALLIES(rx_fragments);
  75         ADD_COMM_TALLIES(rx_unicast_octets);
  76         ADD_COMM_TALLIES(rx_multicast_octets);
  77         ADD_COMM_TALLIES(rx_fcs_errors);
  78         ADD_COMM_TALLIES(rx_discards_no_buffer);
  79         ADD_COMM_TALLIES(tx_discards_wrong_sa);
  80         ADD_COMM_TALLIES(rx_discards_wep_undecryptable);
  81         ADD_COMM_TALLIES(rx_message_in_msg_fragments);
  82         ADD_COMM_TALLIES(rx_message_in_bad_msg_fragments);
  83 #undef ADD_COMM_TALLIES
  84 }
  85
  86
  87 /* Called only as a tasklet (software IRQ) */
  88 static void prism2_info_commtallies(local_info_t *local, unsigned char *buf,
  89                                     int left)
  90 {
  91         if (local->tallies32)
  92                 prism2_info_commtallies32(local, buf, left);
  93         else
  94                 prism2_info_commtallies16(local, buf, left);
  95 }
  96
  97
  98 #ifndef PRISM2_NO_STATION_MODES
  99 #ifndef PRISM2_NO_DEBUG
 100 static const char* hfa384x_linkstatus_str(u16 linkstatus)
 101 {
 102         switch (linkstatus) {
 103         case HFA384X_LINKSTATUS_CONNECTED:
 104                 return "Connected";
 105         case HFA384X_LINKSTATUS_DISCONNECTED:
 106                 return "Disconnected";
 107         case HFA384X_LINKSTATUS_AP_CHANGE:
 108                 return "Access point change";
 109         case HFA384X_LINKSTATUS_AP_OUT_OF_RANGE:
 110                 return "Access point out of range";
 111         case HFA384X_LINKSTATUS_AP_IN_RANGE:
 112                 return "Access point in range";
 113         case HFA384X_LINKSTATUS_ASSOC_FAILED:
 114                 return "Association failed";
 115         default:
 116                 return "Unknown";
 117         }
 118 }
 119 #endif /* PRISM2_NO_DEBUG */
 120
 121
 122 /* Called only as a tasklet (software IRQ) */
 123 static void prism2_info_linkstatus(local_info_t *local, unsigned char *buf,
 124                                     int left)
 125 {
 126         u16 val;
 127         int non_sta_mode;
 128
 129         /* Alloc new JoinRequests to occur since LinkStatus for the previous
 130          * has been received */
 131         local->last_join_time = 0;
 132
 133         if (left != 2) {
 134                 printk(KERN_DEBUG "%s: invalid linkstatus info frame "
 135                        "length %d\n", local->dev->name, left);
 136                 return;
 137         }
 138
 139         non_sta_mode = local->iw_mode == IW_MODE_MASTER ||
 140                 local->iw_mode == IW_MODE_REPEAT ||
 141                 local->iw_mode == IW_MODE_MONITOR;
 142
 143         val = buf[0] | (buf[1] << 8);
 144         if (!non_sta_mode || val != HFA384X_LINKSTATUS_DISCONNECTED) {
 145                 PDEBUG(DEBUG_EXTRA, "%s: LinkStatus=%d (%s)\n",
 146                        local->dev->name, val, hfa384x_linkstatus_str(val));
 147         }
 148
 149         if (non_sta_mode) {
 150                 netif_carrier_on(local->dev);
 151                 netif_carrier_on(local->ddev);
 152                 return;
 153         }
 154
 155         /* Get current BSSID later in scheduled task */
 156         set_bit(PRISM2_INFO_PENDING_LINKSTATUS, &local->pending_info);
 157         local->prev_link_status = val;
 158         schedule_work(&local->info_queue);
 159 }
 160
 161
 162 static void prism2_host_roaming(local_info_t *local)
 163 {
 164         struct hfa384x_join_request req;
 165         struct net_device *dev = local->dev;
 166         struct hfa384x_hostscan_result *selected, *entry;
 167         int i;
 168         unsigned long flags;
 169
 170         if (local->last_join_time &&
 171             time_before(jiffies, local->last_join_time + 10 * HZ)) {
 172                 PDEBUG(DEBUG_EXTRA, "%s: last join request has not yet been "
 173                        "completed - waiting for it before issuing new one\n",
 174                        dev->name);
 175                 return;
 176         }
 177
 178         /* ScanResults are sorted: first ESS results in decreasing signal
 179          * quality then IBSS results in similar order.
 180          * Trivial roaming policy: just select the first entry.
 181          * This could probably be improved by adding hysteresis to limit
 182          * number of handoffs, etc.
 183          *
 184          * Could do periodic RID_SCANREQUEST or Inquire F101 to get new
 185          * ScanResults */
 186         spin_lock_irqsave(&local->lock, flags);
 187         if (local->last_scan_results == NULL ||
 188             local->last_scan_results_count == 0) {
 189                 spin_unlock_irqrestore(&local->lock, flags);
 190                 PDEBUG(DEBUG_EXTRA, "%s: no scan results for host roaming\n",
 191                        dev->name);
 192                 return;
 193         }
 194
 195         selected = &local->last_scan_results[0];
 196
 197         if (local->preferred_ap[0] || local->preferred_ap[1] ||
 198             local->preferred_ap[2] || local->preferred_ap[3] ||
 199             local->preferred_ap[4] || local->preferred_ap[5]) {
 200                 /* Try to find preferred AP */
 201                 PDEBUG(DEBUG_EXTRA, "%s: Preferred AP BSSID " MACSTR "\n",
 202                        dev->name, MAC2STR(local->preferred_ap));
 203                 for (i = 0; i < local->last_scan_results_count; i++) {
 204                         entry = &local->last_scan_results[i];
 205                         if (memcmp(local->preferred_ap, entry->bssid, 6) == 0)
 206                         {
 207                                 PDEBUG(DEBUG_EXTRA, "%s: using preferred AP "
 208                                        "selection\n", dev->name);
 209                                 selected = entry;
 210                                 break;
 211                         }
 212                 }
 213         }
 214
 215         memcpy(req.bssid, selected->bssid, 6);
 216         req.channel = selected->chid;
 217         spin_unlock_irqrestore(&local->lock, flags);
 218
 219         PDEBUG(DEBUG_EXTRA, "%s: JoinRequest: BSSID=" MACSTR " channel=%d\n",
 220                dev->name, MAC2STR(req.bssid), le16_to_cpu(req.channel));
 221         if (local->func->set_rid(dev, HFA384X_RID_JOINREQUEST, &req,
 222                                  sizeof(req))) {
 223                 printk(KERN_DEBUG "%s: JoinRequest failed\n", dev->name);
 224         }
 225         local->last_join_time = jiffies;
 226 }
 227
 228
 229 static void hostap_report_scan_complete(local_info_t *local)
 230 {
 231         union iwreq_data wrqu;
 232
 233         /* Inform user space about new scan results (just empty event,
 234          * SIOCGIWSCAN can be used to fetch data */
 235         wrqu.data.length = 0;
 236         wrqu.data.flags = 0;
 237         wireless_send_event(local->dev, SIOCGIWSCAN, &wrqu, NULL);
 238
 239         /* Allow SIOCGIWSCAN handling to occur since we have received
 240          * scanning result */
 241         local->scan_timestamp = 0;
 242 }
 243
 244
 245 /* Called only as a tasklet (software IRQ) */
 246 static void prism2_info_scanresults(local_info_t *local, unsigned char *buf,
 247                                     int left)
 248 {
 249         u16 *pos;
 250         int new_count, i;
 251         unsigned long flags;
 252         struct hfa384x_scan_result *res;
 253         struct hfa384x_hostscan_result *results, *prev;
 254
 255         if (left < 4) {
 256                 printk(KERN_DEBUG "%s: invalid scanresult info frame "
 257                        "length %d\n", local->dev->name, left);
 258                 return;
 259         }
 260
 261         pos = (u16 *) buf;
 262         pos++;
 263         pos++;
 264         left -= 4;
 265
 266         new_count = left / sizeof(struct hfa384x_scan_result);
 267         results = kmalloc(new_count * sizeof(struct hfa384x_hostscan_result),
 268                           GFP_ATOMIC);
 269         if (results == NULL)
 270                 return;
 271
 272         /* Convert to hostscan result format. */
 273         res = (struct hfa384x_scan_result *) pos;
 274         for (i = 0; i < new_count; i++) {
 275                 memcpy(&results[i], &res[i],
 276                        sizeof(struct hfa384x_scan_result));
 277                 results[i].atim = 0;
 278         }
 279
 280         spin_lock_irqsave(&local->lock, flags);
 281         local->last_scan_type = PRISM2_SCAN;
 282         prev = local->last_scan_results;
 283         local->last_scan_results = results;
 284         local->last_scan_results_count = new_count;
 285         spin_unlock_irqrestore(&local->lock, flags);
 286         kfree(prev);
 287
 288         hostap_report_scan_complete(local);
 289
 290         /* Perform rest of ScanResults handling later in scheduled task */
 291         set_bit(PRISM2_INFO_PENDING_SCANRESULTS, &local->pending_info);
 292         schedule_work(&local->info_queue);
 293 }
 294
 295
 296 /* Called only as a tasklet (software IRQ) */
 297 static void prism2_info_hostscanresults(local_info_t *local,
 298                                         unsigned char *buf, int left)
 299 {
 300         int i, result_size, copy_len, new_count;
 301         struct hfa384x_hostscan_result *results, *prev;
 302         unsigned long flags;
 303         u16 *pos;
 304         u8 *ptr;
 305
 306         wake_up_interruptible(&local->hostscan_wq);
 307
 308         if (left < 4) {
 309                 printk(KERN_DEBUG "%s: invalid hostscanresult info frame "
 310                        "length %d\n", local->dev->name, left);
 311                 return;
 312         }
 313
 314         pos = (u16 *) buf;
 315         copy_len = result_size = le16_to_cpu(*pos);
 316         if (result_size == 0) {
 317                 printk(KERN_DEBUG "%s: invalid result_size (0) in "
 318                        "hostscanresults\n", local->dev->name);
 319                 return;
 320         }
 321         if (copy_len > sizeof(struct hfa384x_hostscan_result))
 322                 copy_len = sizeof(struct hfa384x_hostscan_result);
 323
 324         pos++;
 325         pos++;
 326         left -= 4;
 327         ptr = (u8 *) pos;
 328
 329         new_count = left / result_size;
 330         results = kcalloc(new_count, sizeof(struct hfa384x_hostscan_result),
 331                           GFP_ATOMIC);
 332         if (results == NULL)
 333                 return;
 334
 335         for (i = 0; i < new_count; i++) {
 336                 memcpy(&results[i], ptr, copy_len);
 337                 ptr += result_size;
 338                 left -= result_size;
 339         }
 340
 341         if (left) {
 342                 printk(KERN_DEBUG "%s: short HostScan result entry (%d/%d)\n",
 343                        local->dev->name, left, result_size);
 344         }
 345
 346         spin_lock_irqsave(&local->lock, flags);
 347         local->last_scan_type = PRISM2_HOSTSCAN;
 348         prev = local->last_scan_results;
 349         local->last_scan_results = results;
 350         local->last_scan_results_count = new_count;
 351         spin_unlock_irqrestore(&local->lock, flags);
 352         kfree(prev);
 353
 354         hostap_report_scan_complete(local);
 355 }
 356 #endif /* PRISM2_NO_STATION_MODES */
 357
 358
 359 /* Called only as a tasklet (software IRQ) */
 360 void hostap_info_process(local_info_t *local, struct sk_buff *skb)
 361 {
 362         struct hfa384x_info_frame *info;
 363         unsigned char *buf;
 364         int left;
 365 #ifndef PRISM2_NO_DEBUG
 366         int i;
 367 #endif /* PRISM2_NO_DEBUG */
 368
 369         info = (struct hfa384x_info_frame *) skb->data;
 370         buf = skb->data + sizeof(*info);
 371         left = skb->len - sizeof(*info);
 372
 373         switch (info->type) {
 374         case HFA384X_INFO_COMMTALLIES:
 375                 prism2_info_commtallies(local, buf, left);
 376                 break;
 377
 378 #ifndef PRISM2_NO_STATION_MODES
 379         case HFA384X_INFO_LINKSTATUS:
 380                 prism2_info_linkstatus(local, buf, left);
 381                 break;
 382
 383         case HFA384X_INFO_SCANRESULTS:
 384                 prism2_info_scanresults(local, buf, left);
 385                 break;
 386
 387         case HFA384X_INFO_HOSTSCANRESULTS:
 388                 prism2_info_hostscanresults(local, buf, left);
 389                 break;
 390 #endif /* PRISM2_NO_STATION_MODES */
 391
 392 #ifndef PRISM2_NO_DEBUG
 393         default:
 394                 PDEBUG(DEBUG_EXTRA, "%s: INFO - len=%d type=0x%04x\n",
 395                        local->dev->name, info->len, info->type);
 396                 PDEBUG(DEBUG_EXTRA, "Unknown info frame:");
 397                 for (i = 0; i < (left < 100 ? left : 100); i++)
 398                         PDEBUG2(DEBUG_EXTRA, " %02x", buf[i]);
 399                 PDEBUG2(DEBUG_EXTRA, "\n");
 400                 break;
 401 #endif /* PRISM2_NO_DEBUG */
 402         }
 403 }
 404
 405
 406 #ifndef PRISM2_NO_STATION_MODES
 407 static void handle_info_queue_linkstatus(local_info_t *local)
 408 {
 409         int val = local->prev_link_status;
 410         int connected;
 411         union iwreq_data wrqu;
 412
 413         connected =
 414                 val == HFA384X_LINKSTATUS_CONNECTED ||
 415                 val == HFA384X_LINKSTATUS_AP_CHANGE ||
 416                 val == HFA384X_LINKSTATUS_AP_IN_RANGE;
 417
 418         if (local->func->get_rid(local->dev, HFA384X_RID_CURRENTBSSID,
 419                                  local->bssid, ETH_ALEN, 1) < 0) {
 420                 printk(KERN_DEBUG "%s: could not read CURRENTBSSID after "
 421                        "LinkStatus event\n", local->dev->name);
 422         } else {
 423                 PDEBUG(DEBUG_EXTRA, "%s: LinkStatus: BSSID=" MACSTR "\n",
 424                        local->dev->name,
 425                        MAC2STR((unsigned char *) local->bssid));
 426                 if (local->wds_type & HOSTAP_WDS_AP_CLIENT)
 427                         hostap_add_sta(local->ap, local->bssid);
 428         }
 429
 430         /* Get BSSID if we have a valid AP address */
 431         if (connected) {
 432                 netif_carrier_on(local->dev);
 433                 netif_carrier_on(local->ddev);
 434                 memcpy(wrqu.ap_addr.sa_data, local->bssid, ETH_ALEN);
 435         } else {
 436                 netif_carrier_off(local->dev);
 437                 netif_carrier_off(local->ddev);
 438                 memset(wrqu.ap_addr.sa_data, 0, ETH_ALEN);
 439         }
 440         wrqu.ap_addr.sa_family = ARPHRD_ETHER;
 441
 442         /*
 443          * Filter out sequential disconnect events in order not to cause a
 444          * flood of SIOCGIWAP events that have a race condition with EAPOL
 445          * frames and can confuse wpa_supplicant about the current association
 446          * status.
 447          */
 448         if (connected || local->prev_linkstatus_connected)
 449                 wireless_send_event(local->dev, SIOCGIWAP, &wrqu, NULL);
 450         local->prev_linkstatus_connected = connected;
 451 }
 452
 453
 454 static void handle_info_queue_scanresults(local_info_t *local)
 455 {
 456         if (local->host_roaming == 1 && local->iw_mode == IW_MODE_INFRA)
 457                 prism2_host_roaming(local);
 458
 459         if (local->host_roaming == 2 && local->iw_mode == IW_MODE_INFRA &&
 460             memcmp(local->preferred_ap, "\x00\x00\x00\x00\x00\x00",
 461                    ETH_ALEN) != 0) {
 462                 /*
 463                  * Firmware seems to be getting into odd state in host_roaming
 464                  * mode 2 when hostscan is used without join command, so try
 465                  * to fix this by re-joining the current AP. This does not
 466                  * actually trigger a new association if the current AP is
 467                  * still in the scan results.
 468                  */
 469                 prism2_host_roaming(local);
 470         }
 471 }
 472
 473
 474 /* Called only as scheduled task after receiving info frames (used to avoid
 475  * pending too much time in HW IRQ handler). */
 476 static void handle_info_queue(struct work_struct *work)
 477 {
 478         local_info_t *local = container_of(work, local_info_t, info_queue);
 479
 480         if (test_and_clear_bit(PRISM2_INFO_PENDING_LINKSTATUS,
 481                                &local->pending_info))
 482                 handle_info_queue_linkstatus(local);
 483
 484         if (test_and_clear_bit(PRISM2_INFO_PENDING_SCANRESULTS,
 485                                &local->pending_info))
 486                 handle_info_queue_scanresults(local);
 487 }
 488 #endif /* PRISM2_NO_STATION_MODES */
 489
 490
 491 void hostap_info_init(local_info_t *local)
 492 {
 493         skb_queue_head_init(&local->info_list);
 494 #ifndef PRISM2_NO_STATION_MODES
 495         INIT_WORK(&local->info_queue, handle_info_queue);
 496 #endif /* PRISM2_NO_STATION_MODES */
 497 }
 498
 499
 500 EXPORT_SYMBOL(hostap_info_init);
 501 EXPORT_SYMBOL(hostap_info_process);