1 /* Host AP driver Info Frame processing (part of hostap.o module) */
3 #include "hostap_wlan.h"
7 /* Called only as a tasklet (software IRQ) */
8 static void prism2_info_commtallies16(local_info_t *local, unsigned char *buf,
11 struct hfa384x_comm_tallies *tallies;
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);
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
47 /* Called only as a tasklet (software IRQ) */
48 static void prism2_info_commtallies32(local_info_t *local, unsigned char *buf,
51 struct hfa384x_comm_tallies32 *tallies;
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);
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
87 /* Called only as a tasklet (software IRQ) */
88 static void prism2_info_commtallies(local_info_t *local, unsigned char *buf,
92 prism2_info_commtallies32(local, buf, left);
94 prism2_info_commtallies16(local, buf, left);
98 #ifndef PRISM2_NO_STATION_MODES
99 #ifndef PRISM2_NO_DEBUG
100 static const char* hfa384x_linkstatus_str(u16 linkstatus)
102 switch (linkstatus) {
103 case HFA384X_LINKSTATUS_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";
119 #endif /* PRISM2_NO_DEBUG */
122 /* Called only as a tasklet (software IRQ) */
123 static void prism2_info_linkstatus(local_info_t *local, unsigned char *buf,
129 /* Alloc new JoinRequests to occur since LinkStatus for the previous
130 * has been received */
131 local->last_join_time = 0;
134 printk(KERN_DEBUG "%s: invalid linkstatus info frame "
135 "length %d\n", local->dev->name, left);
139 non_sta_mode = local->iw_mode == IW_MODE_MASTER ||
140 local->iw_mode == IW_MODE_REPEAT ||
141 local->iw_mode == IW_MODE_MONITOR;
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));
150 netif_carrier_on(local->dev);
151 netif_carrier_on(local->ddev);
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);
162 static void prism2_host_roaming(local_info_t *local)
164 struct hfa384x_join_request req;
165 struct net_device *dev = local->dev;
166 struct hfa384x_hostscan_result *selected, *entry;
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",
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.
184 * Could do periodic RID_SCANREQUEST or Inquire F101 to get new
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",
195 selected = &local->last_scan_results[0];
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)
207 PDEBUG(DEBUG_EXTRA, "%s: using preferred AP "
208 "selection\n", dev->name);
215 memcpy(req.bssid, selected->bssid, 6);
216 req.channel = selected->chid;
217 spin_unlock_irqrestore(&local->lock, flags);
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,
223 printk(KERN_DEBUG "%s: JoinRequest failed\n", dev->name);
225 local->last_join_time = jiffies;
229 static void hostap_report_scan_complete(local_info_t *local)
231 union iwreq_data wrqu;
233 /* Inform user space about new scan results (just empty event,
234 * SIOCGIWSCAN can be used to fetch data */
235 wrqu.data.length = 0;
237 wireless_send_event(local->dev, SIOCGIWSCAN, &wrqu, NULL);
239 /* Allow SIOCGIWSCAN handling to occur since we have received
241 local->scan_timestamp = 0;
245 /* Called only as a tasklet (software IRQ) */
246 static void prism2_info_scanresults(local_info_t *local, unsigned char *buf,
252 struct hfa384x_scan_result *res;
253 struct hfa384x_hostscan_result *results, *prev;
256 printk(KERN_DEBUG "%s: invalid scanresult info frame "
257 "length %d\n", local->dev->name, left);
266 new_count = left / sizeof(struct hfa384x_scan_result);
267 results = kmalloc(new_count * sizeof(struct hfa384x_hostscan_result),
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));
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);
288 hostap_report_scan_complete(local);
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);
296 /* Called only as a tasklet (software IRQ) */
297 static void prism2_info_hostscanresults(local_info_t *local,
298 unsigned char *buf, int left)
300 int i, result_size, copy_len, new_count;
301 struct hfa384x_hostscan_result *results, *prev;
306 wake_up_interruptible(&local->hostscan_wq);
309 printk(KERN_DEBUG "%s: invalid hostscanresult info frame "
310 "length %d\n", local->dev->name, left);
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);
321 if (copy_len > sizeof(struct hfa384x_hostscan_result))
322 copy_len = sizeof(struct hfa384x_hostscan_result);
329 new_count = left / result_size;
330 results = kcalloc(new_count, sizeof(struct hfa384x_hostscan_result),
335 for (i = 0; i < new_count; i++) {
336 memcpy(&results[i], ptr, copy_len);
342 printk(KERN_DEBUG "%s: short HostScan result entry (%d/%d)\n",
343 local->dev->name, left, result_size);
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);
354 hostap_report_scan_complete(local);
356 #endif /* PRISM2_NO_STATION_MODES */
359 /* Called only as a tasklet (software IRQ) */
360 void hostap_info_process(local_info_t *local, struct sk_buff *skb)
362 struct hfa384x_info_frame *info;
365 #ifndef PRISM2_NO_DEBUG
367 #endif /* PRISM2_NO_DEBUG */
369 info = (struct hfa384x_info_frame *) skb->data;
370 buf = skb->data + sizeof(*info);
371 left = skb->len - sizeof(*info);
373 switch (info->type) {
374 case HFA384X_INFO_COMMTALLIES:
375 prism2_info_commtallies(local, buf, left);
378 #ifndef PRISM2_NO_STATION_MODES
379 case HFA384X_INFO_LINKSTATUS:
380 prism2_info_linkstatus(local, buf, left);
383 case HFA384X_INFO_SCANRESULTS:
384 prism2_info_scanresults(local, buf, left);
387 case HFA384X_INFO_HOSTSCANRESULTS:
388 prism2_info_hostscanresults(local, buf, left);
390 #endif /* PRISM2_NO_STATION_MODES */
392 #ifndef PRISM2_NO_DEBUG
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");
401 #endif /* PRISM2_NO_DEBUG */
406 #ifndef PRISM2_NO_STATION_MODES
407 static void handle_info_queue_linkstatus(local_info_t *local)
409 int val = local->prev_link_status;
411 union iwreq_data wrqu;
414 val == HFA384X_LINKSTATUS_CONNECTED ||
415 val == HFA384X_LINKSTATUS_AP_CHANGE ||
416 val == HFA384X_LINKSTATUS_AP_IN_RANGE;
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);
423 PDEBUG(DEBUG_EXTRA, "%s: LinkStatus: BSSID=" MACSTR "\n",
425 MAC2STR((unsigned char *) local->bssid));
426 if (local->wds_type & HOSTAP_WDS_AP_CLIENT)
427 hostap_add_sta(local->ap, local->bssid);
430 /* Get BSSID if we have a valid AP address */
432 netif_carrier_on(local->dev);
433 netif_carrier_on(local->ddev);
434 memcpy(wrqu.ap_addr.sa_data, local->bssid, ETH_ALEN);
436 netif_carrier_off(local->dev);
437 netif_carrier_off(local->ddev);
438 memset(wrqu.ap_addr.sa_data, 0, ETH_ALEN);
440 wrqu.ap_addr.sa_family = ARPHRD_ETHER;
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
448 if (connected || local->prev_linkstatus_connected)
449 wireless_send_event(local->dev, SIOCGIWAP, &wrqu, NULL);
450 local->prev_linkstatus_connected = connected;
454 static void handle_info_queue_scanresults(local_info_t *local)
456 if (local->host_roaming == 1 && local->iw_mode == IW_MODE_INFRA)
457 prism2_host_roaming(local);
459 if (local->host_roaming == 2 && local->iw_mode == IW_MODE_INFRA &&
460 memcmp(local->preferred_ap, "\x00\x00\x00\x00\x00\x00",
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.
469 prism2_host_roaming(local);
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(void *data)
478 local_info_t *local = (local_info_t *) data;
480 if (test_and_clear_bit(PRISM2_INFO_PENDING_LINKSTATUS,
481 &local->pending_info))
482 handle_info_queue_linkstatus(local);
484 if (test_and_clear_bit(PRISM2_INFO_PENDING_SCANRESULTS,
485 &local->pending_info))
486 handle_info_queue_scanresults(local);
488 #endif /* PRISM2_NO_STATION_MODES */
491 void hostap_info_init(local_info_t *local)
493 skb_queue_head_init(&local->info_list);
494 #ifndef PRISM2_NO_STATION_MODES
495 INIT_WORK(&local->info_queue, handle_info_queue, local);
496 #endif /* PRISM2_NO_STATION_MODES */
500 EXPORT_SYMBOL(hostap_info_init);
501 EXPORT_SYMBOL(hostap_info_process);