[net-next-2.6.git] / drivers / net / wireless / hostap / hostap_info.c

/* Host AP driver Info Frame processing (part of hostap.o module) */

#include "hostap_wlan.h"
#include "hostap.h"
#include "hostap_ap.h"

/* Called only as a tasklet (software IRQ) */
static void prism2_info_commtallies16(local_info_t *local, unsigned char *buf,
				      int left)
{
	struct hfa384x_comm_tallies *tallies;

	if (left < sizeof(struct hfa384x_comm_tallies)) {
		printk(KERN_DEBUG "%s: too short (len=%d) commtallies "
		       "info frame\n", local->dev->name, left);
		return;
	}

	tallies = (struct hfa384x_comm_tallies *) buf;
#define ADD_COMM_TALLIES(name) \
local->comm_tallies.name += le16_to_cpu(tallies->name)
	ADD_COMM_TALLIES(tx_unicast_frames);
	ADD_COMM_TALLIES(tx_multicast_frames);
	ADD_COMM_TALLIES(tx_fragments);
	ADD_COMM_TALLIES(tx_unicast_octets);
	ADD_COMM_TALLIES(tx_multicast_octets);
	ADD_COMM_TALLIES(tx_deferred_transmissions);
	ADD_COMM_TALLIES(tx_single_retry_frames);
	ADD_COMM_TALLIES(tx_multiple_retry_frames);
	ADD_COMM_TALLIES(tx_retry_limit_exceeded);
	ADD_COMM_TALLIES(tx_discards);
	ADD_COMM_TALLIES(rx_unicast_frames);
	ADD_COMM_TALLIES(rx_multicast_frames);
	ADD_COMM_TALLIES(rx_fragments);
	ADD_COMM_TALLIES(rx_unicast_octets);
	ADD_COMM_TALLIES(rx_multicast_octets);
	ADD_COMM_TALLIES(rx_fcs_errors);
	ADD_COMM_TALLIES(rx_discards_no_buffer);
	ADD_COMM_TALLIES(tx_discards_wrong_sa);
	ADD_COMM_TALLIES(rx_discards_wep_undecryptable);
	ADD_COMM_TALLIES(rx_message_in_msg_fragments);
	ADD_COMM_TALLIES(rx_message_in_bad_msg_fragments);
#undef ADD_COMM_TALLIES
}


/* Called only as a tasklet (software IRQ) */
static void prism2_info_commtallies32(local_info_t *local, unsigned char *buf,
				      int left)
{
	struct hfa384x_comm_tallies32 *tallies;

	if (left < sizeof(struct hfa384x_comm_tallies32)) {
		printk(KERN_DEBUG "%s: too short (len=%d) commtallies32 "
		       "info frame\n", local->dev->name, left);
		return;
	}

	tallies = (struct hfa384x_comm_tallies32 *) buf;
#define ADD_COMM_TALLIES(name) \
local->comm_tallies.name += le32_to_cpu(tallies->name)
	ADD_COMM_TALLIES(tx_unicast_frames);
	ADD_COMM_TALLIES(tx_multicast_frames);
	ADD_COMM_TALLIES(tx_fragments);
	ADD_COMM_TALLIES(tx_unicast_octets);
	ADD_COMM_TALLIES(tx_multicast_octets);
	ADD_COMM_TALLIES(tx_deferred_transmissions);
	ADD_COMM_TALLIES(tx_single_retry_frames);
	ADD_COMM_TALLIES(tx_multiple_retry_frames);
	ADD_COMM_TALLIES(tx_retry_limit_exceeded);
	ADD_COMM_TALLIES(tx_discards);
	ADD_COMM_TALLIES(rx_unicast_frames);
	ADD_COMM_TALLIES(rx_multicast_frames);
	ADD_COMM_TALLIES(rx_fragments);
	ADD_COMM_TALLIES(rx_unicast_octets);
	ADD_COMM_TALLIES(rx_multicast_octets);
	ADD_COMM_TALLIES(rx_fcs_errors);
	ADD_COMM_TALLIES(rx_discards_no_buffer);
	ADD_COMM_TALLIES(tx_discards_wrong_sa);
	ADD_COMM_TALLIES(rx_discards_wep_undecryptable);
	ADD_COMM_TALLIES(rx_message_in_msg_fragments);
	ADD_COMM_TALLIES(rx_message_in_bad_msg_fragments);
#undef ADD_COMM_TALLIES
}


/* Called only as a tasklet (software IRQ) */
static void prism2_info_commtallies(local_info_t *local, unsigned char *buf,
				    int left)
{
	if (local->tallies32)
		prism2_info_commtallies32(local, buf, left);
	else
		prism2_info_commtallies16(local, buf, left);
}


#ifndef PRISM2_NO_STATION_MODES
#ifndef PRISM2_NO_DEBUG
static const char* hfa384x_linkstatus_str(u16 linkstatus)
{
	switch (linkstatus) {
	case HFA384X_LINKSTATUS_CONNECTED:
		return "Connected";
	case HFA384X_LINKSTATUS_DISCONNECTED:
		return "Disconnected";
	case HFA384X_LINKSTATUS_AP_CHANGE:
		return "Access point change";
	case HFA384X_LINKSTATUS_AP_OUT_OF_RANGE:
		return "Access point out of range";
	case HFA384X_LINKSTATUS_AP_IN_RANGE:
		return "Access point in range";
	case HFA384X_LINKSTATUS_ASSOC_FAILED:
		return "Association failed";
	default:
		return "Unknown";
	}
}
#endif /* PRISM2_NO_DEBUG */


/* Called only as a tasklet (software IRQ) */
static void prism2_info_linkstatus(local_info_t *local, unsigned char *buf,
				    int left)
{
	u16 val;
	int non_sta_mode;

	/* Alloc new JoinRequests to occur since LinkStatus for the previous
	 * has been received */
	local->last_join_time = 0;

	if (left != 2) {
		printk(KERN_DEBUG "%s: invalid linkstatus info frame "
		       "length %d\n", local->dev->name, left);
		return;
	}

	non_sta_mode = local->iw_mode == IW_MODE_MASTER ||
		local->iw_mode == IW_MODE_REPEAT ||
		local->iw_mode == IW_MODE_MONITOR;

	val = buf[0] | (buf[1] << 8);
	if (!non_sta_mode || val != HFA384X_LINKSTATUS_DISCONNECTED) {
		PDEBUG(DEBUG_EXTRA, "%s: LinkStatus=%d (%s)\n",
		       local->dev->name, val, hfa384x_linkstatus_str(val));
	}

	if (non_sta_mode) {
		netif_carrier_on(local->dev);
		netif_carrier_on(local->ddev);
		return;
	}

	/* Get current BSSID later in scheduled task */
	set_bit(PRISM2_INFO_PENDING_LINKSTATUS, &local->pending_info);
	local->prev_link_status = val;
	schedule_work(&local->info_queue);
}


static void prism2_host_roaming(local_info_t *local)
{
	struct hfa384x_join_request req;
	struct net_device *dev = local->dev;
	struct hfa384x_hostscan_result *selected, *entry;
	int i;
	unsigned long flags;

	if (local->last_join_time &&
	    time_before(jiffies, local->last_join_time + 10 * HZ)) {
		PDEBUG(DEBUG_EXTRA, "%s: last join request has not yet been "
		       "completed - waiting for it before issuing new one\n",
		       dev->name);
		return;
	}

	/* ScanResults are sorted: first ESS results in decreasing signal
	 * quality then IBSS results in similar order.
	 * Trivial roaming policy: just select the first entry.
	 * This could probably be improved by adding hysteresis to limit
	 * number of handoffs, etc.
	 *
	 * Could do periodic RID_SCANREQUEST or Inquire F101 to get new
	 * ScanResults */
	spin_lock_irqsave(&local->lock, flags);
	if (local->last_scan_results == NULL ||
	    local->last_scan_results_count == 0) {
		spin_unlock_irqrestore(&local->lock, flags);
		PDEBUG(DEBUG_EXTRA, "%s: no scan results for host roaming\n",
		       dev->name);
		return;
	}

	selected = &local->last_scan_results[0];

	if (local->preferred_ap[0] || local->preferred_ap[1] ||
	    local->preferred_ap[2] || local->preferred_ap[3] ||
	    local->preferred_ap[4] || local->preferred_ap[5]) {
		/* Try to find preferred AP */
		PDEBUG(DEBUG_EXTRA, "%s: Preferred AP BSSID " MACSTR "\n",
		       dev->name, MAC2STR(local->preferred_ap));
		for (i = 0; i < local->last_scan_results_count; i++) {
			entry = &local->last_scan_results[i];
			if (memcmp(local->preferred_ap, entry->bssid, 6) == 0)
			{
				PDEBUG(DEBUG_EXTRA, "%s: using preferred AP "
				       "selection\n", dev->name);
				selected = entry;
				break;
			}
		}
	}

	memcpy(req.bssid, selected->bssid, 6);
	req.channel = selected->chid;
	spin_unlock_irqrestore(&local->lock, flags);

	PDEBUG(DEBUG_EXTRA, "%s: JoinRequest: BSSID=" MACSTR " channel=%d\n",
	       dev->name, MAC2STR(req.bssid), le16_to_cpu(req.channel));
	if (local->func->set_rid(dev, HFA384X_RID_JOINREQUEST, &req,
				 sizeof(req))) {
		printk(KERN_DEBUG "%s: JoinRequest failed\n", dev->name);
	}
	local->last_join_time = jiffies;
}


static void hostap_report_scan_complete(local_info_t *local)
{
	union iwreq_data wrqu;

	/* Inform user space about new scan results (just empty event,
	 * SIOCGIWSCAN can be used to fetch data */
	wrqu.data.length = 0;
	wrqu.data.flags = 0;
	wireless_send_event(local->dev, SIOCGIWSCAN, &wrqu, NULL);

	/* Allow SIOCGIWSCAN handling to occur since we have received
	 * scanning result */
	local->scan_timestamp = 0;
}


/* Called only as a tasklet (software IRQ) */
static void prism2_info_scanresults(local_info_t *local, unsigned char *buf,
				    int left)
{
	u16 *pos;
	int new_count, i;
	unsigned long flags;
	struct hfa384x_scan_result *res;
	struct hfa384x_hostscan_result *results, *prev;

	if (left < 4) {
		printk(KERN_DEBUG "%s: invalid scanresult info frame "
		       "length %d\n", local->dev->name, left);
		return;
	}

	pos = (u16 *) buf;
	pos++;
	pos++;
	left -= 4;

	new_count = left / sizeof(struct hfa384x_scan_result);
	results = kmalloc(new_count * sizeof(struct hfa384x_hostscan_result),
			  GFP_ATOMIC);
	if (results == NULL)
		return;

	/* Convert to hostscan result format. */
	res = (struct hfa384x_scan_result *) pos;
	for (i = 0; i < new_count; i++) {
		memcpy(&results[i], &res[i],
		       sizeof(struct hfa384x_scan_result));
		results[i].atim = 0;
	}

	spin_lock_irqsave(&local->lock, flags);
	local->last_scan_type = PRISM2_SCAN;
	prev = local->last_scan_results;
	local->last_scan_results = results;
	local->last_scan_results_count = new_count;
	spin_unlock_irqrestore(&local->lock, flags);
	kfree(prev);

	hostap_report_scan_complete(local);

	/* Perform rest of ScanResults handling later in scheduled task */
	set_bit(PRISM2_INFO_PENDING_SCANRESULTS, &local->pending_info);
	schedule_work(&local->info_queue);
}


/* Called only as a tasklet (software IRQ) */
static void prism2_info_hostscanresults(local_info_t *local,
					unsigned char *buf, int left)
{
	int i, result_size, copy_len, new_count;
	struct hfa384x_hostscan_result *results, *prev;
	unsigned long flags;
	u16 *pos;
	u8 *ptr;

	wake_up_interruptible(&local->hostscan_wq);

	if (left < 4) {
		printk(KERN_DEBUG "%s: invalid hostscanresult info frame "
		       "length %d\n", local->dev->name, left);
		return;
	}

	pos = (u16 *) buf;
	copy_len = result_size = le16_to_cpu(*pos);
	if (result_size == 0) {
		printk(KERN_DEBUG "%s: invalid result_size (0) in "
		       "hostscanresults\n", local->dev->name);
		return;
	}
	if (copy_len > sizeof(struct hfa384x_hostscan_result))
		copy_len = sizeof(struct hfa384x_hostscan_result);

	pos++;
	pos++;
	left -= 4;
	ptr = (u8 *) pos;

	new_count = left / result_size;
	results = kmalloc(new_count * sizeof(struct hfa384x_hostscan_result),
			  GFP_ATOMIC);
	if (results == NULL)
		return;
	memset(results, 0, new_count * sizeof(struct hfa384x_hostscan_result));

	for (i = 0; i < new_count; i++) {
		memcpy(&results[i], ptr, copy_len);
		ptr += result_size;
		left -= result_size;
	}

	if (left) {
		printk(KERN_DEBUG "%s: short HostScan result entry (%d/%d)\n",
		       local->dev->name, left, result_size);
	}

	spin_lock_irqsave(&local->lock, flags);
	local->last_scan_type = PRISM2_HOSTSCAN;
	prev = local->last_scan_results;
	local->last_scan_results = results;
	local->last_scan_results_count = new_count;
	spin_unlock_irqrestore(&local->lock, flags);
	kfree(prev);

	hostap_report_scan_complete(local);
}
#endif /* PRISM2_NO_STATION_MODES */


/* Called only as a tasklet (software IRQ) */
void hostap_info_process(local_info_t *local, struct sk_buff *skb)
{
	struct hfa384x_info_frame *info;
	unsigned char *buf;
	int left;
#ifndef PRISM2_NO_DEBUG
	int i;
#endif /* PRISM2_NO_DEBUG */

	info = (struct hfa384x_info_frame *) skb->data;
	buf = skb->data + sizeof(*info);
	left = skb->len - sizeof(*info);

	switch (info->type) {
	case HFA384X_INFO_COMMTALLIES:
		prism2_info_commtallies(local, buf, left);
		break;

#ifndef PRISM2_NO_STATION_MODES
	case HFA384X_INFO_LINKSTATUS:
		prism2_info_linkstatus(local, buf, left);
		break;

	case HFA384X_INFO_SCANRESULTS:
		prism2_info_scanresults(local, buf, left);
		break;

	case HFA384X_INFO_HOSTSCANRESULTS:
		prism2_info_hostscanresults(local, buf, left);
		break;
#endif /* PRISM2_NO_STATION_MODES */

#ifndef PRISM2_NO_DEBUG
	default:
		PDEBUG(DEBUG_EXTRA, "%s: INFO - len=%d type=0x%04x\n",
		       local->dev->name, info->len, info->type);
		PDEBUG(DEBUG_EXTRA, "Unknown info frame:");
		for (i = 0; i < (left < 100 ? left : 100); i++)
			PDEBUG2(DEBUG_EXTRA, " %02x", buf[i]);
		PDEBUG2(DEBUG_EXTRA, "\n");
		break;
#endif /* PRISM2_NO_DEBUG */
	}
}


#ifndef PRISM2_NO_STATION_MODES
static void handle_info_queue_linkstatus(local_info_t *local)
{
	int val = local->prev_link_status;
	int connected;
	union iwreq_data wrqu;

	connected =
		val == HFA384X_LINKSTATUS_CONNECTED ||
		val == HFA384X_LINKSTATUS_AP_CHANGE ||
		val == HFA384X_LINKSTATUS_AP_IN_RANGE;

	if (local->func->get_rid(local->dev, HFA384X_RID_CURRENTBSSID,
				 local->bssid, ETH_ALEN, 1) < 0) {
		printk(KERN_DEBUG "%s: could not read CURRENTBSSID after "
		       "LinkStatus event\n", local->dev->name);
	} else {
		PDEBUG(DEBUG_EXTRA, "%s: LinkStatus: BSSID=" MACSTR "\n",
		       local->dev->name,
		       MAC2STR((unsigned char *) local->bssid));
		if (local->wds_type & HOSTAP_WDS_AP_CLIENT)
			hostap_add_sta(local->ap, local->bssid);
	}

	/* Get BSSID if we have a valid AP address */
	if (connected) {
		netif_carrier_on(local->dev);
		netif_carrier_on(local->ddev);
		memcpy(wrqu.ap_addr.sa_data, local->bssid, ETH_ALEN);
	} else {
		netif_carrier_off(local->dev);
		netif_carrier_off(local->ddev);
		memset(wrqu.ap_addr.sa_data, 0, ETH_ALEN);
	}
	wrqu.ap_addr.sa_family = ARPHRD_ETHER;

	/*
	 * Filter out sequential disconnect events in order not to cause a
	 * flood of SIOCGIWAP events that have a race condition with EAPOL
	 * frames and can confuse wpa_supplicant about the current association
	 * status.
	 */
	if (connected || local->prev_linkstatus_connected)
		wireless_send_event(local->dev, SIOCGIWAP, &wrqu, NULL);
	local->prev_linkstatus_connected = connected;
}


static void handle_info_queue_scanresults(local_info_t *local)
{
	if (local->host_roaming == 1 && local->iw_mode == IW_MODE_INFRA)
		prism2_host_roaming(local);

	if (local->host_roaming == 2 && local->iw_mode == IW_MODE_INFRA &&
	    memcmp(local->preferred_ap, "\x00\x00\x00\x00\x00\x00",
		   ETH_ALEN) != 0) {
		/*
		 * Firmware seems to be getting into odd state in host_roaming
		 * mode 2 when hostscan is used without join command, so try
		 * to fix this by re-joining the current AP. This does not
		 * actually trigger a new association if the current AP is
		 * still in the scan results.
		 */
		prism2_host_roaming(local);
	}
}


/* Called only as scheduled task after receiving info frames (used to avoid
 * pending too much time in HW IRQ handler). */
static void handle_info_queue(struct work_struct *work)
{
	local_info_t *local = container_of(work, local_info_t, info_queue);

	if (test_and_clear_bit(PRISM2_INFO_PENDING_LINKSTATUS,
			       &local->pending_info))
		handle_info_queue_linkstatus(local);

	if (test_and_clear_bit(PRISM2_INFO_PENDING_SCANRESULTS,
			       &local->pending_info))
		handle_info_queue_scanresults(local);
}
#endif /* PRISM2_NO_STATION_MODES */


void hostap_info_init(local_info_t *local)
{
	skb_queue_head_init(&local->info_list);
#ifndef PRISM2_NO_STATION_MODES
	INIT_WORK(&local->info_queue, handle_info_queue);
#endif /* PRISM2_NO_STATION_MODES */
}


EXPORT_SYMBOL(hostap_info_init);
EXPORT_SYMBOL(hostap_info_process);
Commit	Line	Data
ff1d2767 JM	1	/* Host AP driver Info Frame processing (part of hostap.o module) */
ff1d2767 JM	2
5fad5a2e AB	3	#include "hostap_wlan.h"
	4	#include "hostap.h"
	5	#include "hostap_ap.h"
ff1d2767 JM	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;
2e4fd068	166	struct hfa384x_hostscan_result selected, entry;
ff1d2767 JM	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;
2e4fd068	250	int new_count, i;
ff1d2767	251	unsigned long flags;
2e4fd068 JM	252	struct hfa384x_scan_result *res;
2e4fd068 JM	253	struct hfa384x_hostscan_result results, prev;
ff1d2767 JM	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);
2e4fd068	267	results = kmalloc(new_count * sizeof(struct hfa384x_hostscan_result),
ff1d2767 JM	268	GFP_ATOMIC);
	269	if (results == NULL)
	270	return;
2e4fd068 JM	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	}
ff1d2767 JM	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 = kmalloc(new_count * sizeof(struct hfa384x_hostscan_result),
	331	GFP_ATOMIC);
	332	if (results == NULL)
	333	return;
	334	memset(results, 0, new_count * sizeof(struct hfa384x_hostscan_result));
	335
	336	for (i = 0; i < new_count; i++) {
	337	memcpy(&results[i], ptr, copy_len);
	338	ptr += result_size;
	339	left -= result_size;
	340	}
	341
	342	if (left) {
343	printk(KERN_DEBUG "%s: short HostScan result entry (%d/%d)\n",
344	local->dev->name, left, result_size);
345	}
346
347	spin_lock_irqsave(&local->lock, flags);
348	local->last_scan_type = PRISM2_HOSTSCAN;
2e4fd068 JM	349	prev = local->last_scan_results;
	350	local->last_scan_results = results;
	351	local->last_scan_results_count = new_count;
ff1d2767 JM	352	spin_unlock_irqrestore(&local->lock, flags);
	353	kfree(prev);
	354
	355	hostap_report_scan_complete(local);
	356	}
	357	#endif /* PRISM2_NO_STATION_MODES */
	358
	359
	360	/* Called only as a tasklet (software IRQ) */
	361	void hostap_info_process(local_info_t local, struct sk_buff skb)
	362	{
	363	struct hfa384x_info_frame *info;
	364	unsigned char *buf;
	365	int left;
	366	#ifndef PRISM2_NO_DEBUG
	367	int i;
	368	#endif /* PRISM2_NO_DEBUG */
	369
	370	info = (struct hfa384x_info_frame *) skb->data;
	371	buf = skb->data + sizeof(*info);
	372	left = skb->len - sizeof(*info);
	373
	374	switch (info->type) {
	375	case HFA384X_INFO_COMMTALLIES:
	376	prism2_info_commtallies(local, buf, left);
	377	break;
	378
	379	#ifndef PRISM2_NO_STATION_MODES
	380	case HFA384X_INFO_LINKSTATUS:
	381	prism2_info_linkstatus(local, buf, left);
	382	break;
	383
	384	case HFA384X_INFO_SCANRESULTS:
	385	prism2_info_scanresults(local, buf, left);
	386	break;
	387
	388	case HFA384X_INFO_HOSTSCANRESULTS:
	389	prism2_info_hostscanresults(local, buf, left);
	390	break;
	391	#endif /* PRISM2_NO_STATION_MODES */
	392
	393	#ifndef PRISM2_NO_DEBUG
	394	default:
	395	PDEBUG(DEBUG_EXTRA, "%s: INFO - len=%d type=0x%04x\n",
	396	local->dev->name, info->len, info->type);
	397	PDEBUG(DEBUG_EXTRA, "Unknown info frame:");
	398	for (i = 0; i < (left < 100 ? left : 100); i++)
	399	PDEBUG2(DEBUG_EXTRA, " %02x", buf[i]);
	400	PDEBUG2(DEBUG_EXTRA, "\n");
	401	break;
	402	#endif /* PRISM2_NO_DEBUG */
	403	}
	404	}
	405
	406
	407	#ifndef PRISM2_NO_STATION_MODES
	408	static void handle_info_queue_linkstatus(local_info_t *local)
	409	{
	410	int val = local->prev_link_status;
	411	int connected;
	412	union iwreq_data wrqu;
	413
	414	connected =
	415	val == HFA384X_LINKSTATUS_CONNECTED \|\|
416	val == HFA384X_LINKSTATUS_AP_CHANGE \|\|
417	val == HFA384X_LINKSTATUS_AP_IN_RANGE;
418
419	if (local->func->get_rid(local->dev, HFA384X_RID_CURRENTBSSID,
420	local->bssid, ETH_ALEN, 1) < 0) {
421	printk(KERN_DEBUG "%s: could not read CURRENTBSSID after "
422	"LinkStatus event\n", local->dev->name);
423	} else {
424	PDEBUG(DEBUG_EXTRA, "%s: LinkStatus: BSSID=" MACSTR "\n",
425	local->dev->name,
426	MAC2STR((unsigned char *) local->bssid));
427	if (local->wds_type & HOSTAP_WDS_AP_CLIENT)
428	hostap_add_sta(local->ap, local->bssid);
429	}
430
431	/* Get BSSID if we have a valid AP address */
432	if (connected) {
433	netif_carrier_on(local->dev);
434	netif_carrier_on(local->ddev);
435	memcpy(wrqu.ap_addr.sa_data, local->bssid, ETH_ALEN);
436	} else {
437	netif_carrier_off(local->dev);
438	netif_carrier_off(local->ddev);
439	memset(wrqu.ap_addr.sa_data, 0, ETH_ALEN);
440	}
441	wrqu.ap_addr.sa_family = ARPHRD_ETHER;
442
443	/*
444	* Filter out sequential disconnect events in order not to cause a
445	* flood of SIOCGIWAP events that have a race condition with EAPOL
446	* frames and can confuse wpa_supplicant about the current association
447	* status.
448	*/
449	if (connected \|\| local->prev_linkstatus_connected)
450	wireless_send_event(local->dev, SIOCGIWAP, &wrqu, NULL);
451	local->prev_linkstatus_connected = connected;
452	}
453
454
455	static void handle_info_queue_scanresults(local_info_t *local)
456	{
457	if (local->host_roaming == 1 && local->iw_mode == IW_MODE_INFRA)
458	prism2_host_roaming(local);
0c629a69 JM	459
	460	if (local->host_roaming == 2 && local->iw_mode == IW_MODE_INFRA &&
	461	memcmp(local->preferred_ap, "\x00\x00\x00\x00\x00\x00",
	462	ETH_ALEN) != 0) {
	463	/*
	464	* Firmware seems to be getting into odd state in host_roaming
	465	* mode 2 when hostscan is used without join command, so try
	466	* to fix this by re-joining the current AP. This does not
	467	* actually trigger a new association if the current AP is
	468	* still in the scan results.
	469	*/
	470	prism2_host_roaming(local);
	471	}
ff1d2767 JM	472	}
	473
	474
	475	/* Called only as scheduled task after receiving info frames (used to avoid
	476	* pending too much time in HW IRQ handler). */
c4028958	477	static void handle_info_queue(struct work_struct *work)
ff1d2767	478	{
c4028958	479	local_info_t *local = container_of(work, local_info_t, info_queue);
ff1d2767 JM	480
	481	if (test_and_clear_bit(PRISM2_INFO_PENDING_LINKSTATUS,
	482	&local->pending_info))
	483	handle_info_queue_linkstatus(local);
	484
	485	if (test_and_clear_bit(PRISM2_INFO_PENDING_SCANRESULTS,
	486	&local->pending_info))
	487	handle_info_queue_scanresults(local);
	488	}
	489	#endif /* PRISM2_NO_STATION_MODES */
	490
	491
	492	void hostap_info_init(local_info_t *local)
	493	{
	494	skb_queue_head_init(&local->info_list);
	495	#ifndef PRISM2_NO_STATION_MODES
c4028958	496	INIT_WORK(&local->info_queue, handle_info_queue);
ff1d2767 JM	497	#endif /* PRISM2_NO_STATION_MODES */
	498	}
	499
	500
	501	EXPORT_SYMBOL(hostap_info_init);
	502	EXPORT_SYMBOL(hostap_info_process);