1 /* Encapsulate basic setting changes and retrieval on Hermes hardware
2  *
3  * See copyright notice in main.c
4  */
5 #include <linux/kernel.h>
6 #include <linux/device.h>
7 #include <linux/if_arp.h>
8 #include <linux/ieee80211.h>
9 #include <linux/wireless.h>
10 #include <net/cfg80211.h>
11 #include "hermes.h"
12 #include "hermes_rid.h"
13 #include "orinoco.h"
14 
15 #include "hw.h"
16 
17 #define SYMBOL_MAX_VER_LEN	(14)
18 
19 /* Symbol firmware has a bug allocating buffers larger than this */
20 #define TX_NICBUF_SIZE_BUG	1585
21 
22 /********************************************************************/
23 /* Data tables                                                      */
24 /********************************************************************/
25 
26 /* This tables gives the actual meanings of the bitrate IDs returned
27  * by the firmware. */
28 static const struct {
29 	int bitrate; /* in 100s of kilobits */
30 	int automatic;
31 	u16 agere_txratectrl;
32 	u16 intersil_txratectrl;
33 } bitrate_table[] = {
34 	{110, 1,  3, 15}, /* Entry 0 is the default */
35 	{10,  0,  1,  1},
36 	{10,  1,  1,  1},
37 	{20,  0,  2,  2},
38 	{20,  1,  6,  3},
39 	{55,  0,  4,  4},
40 	{55,  1,  7,  7},
41 	{110, 0,  5,  8},
42 };
43 #define BITRATE_TABLE_SIZE ARRAY_SIZE(bitrate_table)
44 
45 /* Firmware version encoding */
46 struct comp_id {
47 	u16 id, variant, major, minor;
48 } __packed;
49 
50 static inline enum fwtype determine_firmware_type(struct comp_id *nic_id)
51 {
52 	if (nic_id->id < 0x8000)
53 		return FIRMWARE_TYPE_AGERE;
54 	else if (nic_id->id == 0x8000 && nic_id->major == 0)
55 		return FIRMWARE_TYPE_SYMBOL;
56 	else
57 		return FIRMWARE_TYPE_INTERSIL;
58 }
59 
60 /* Set priv->firmware type, determine firmware properties
61  * This function can be called before we have registerred with netdev,
62  * so all errors go out with dev_* rather than printk
63  *
64  * If non-NULL stores a firmware description in fw_name.
65  * If non-NULL stores a HW version in hw_ver
66  *
67  * These are output via generic cfg80211 ethtool support.
68  */
69 int determine_fw_capabilities(struct orinoco_private *priv,
70 			      char *fw_name, size_t fw_name_len,
71 			      u32 *hw_ver)
72 {
73 	struct device *dev = priv->dev;
74 	struct hermes *hw = &priv->hw;
75 	int err;
76 	struct comp_id nic_id, sta_id;
77 	unsigned int firmver;
78 	char tmp[SYMBOL_MAX_VER_LEN + 1] __attribute__((aligned(2)));
79 
80 	/* Get the hardware version */
81 	err = HERMES_READ_RECORD_PR(hw, USER_BAP, HERMES_RID_NICID, &nic_id);
82 	if (err) {
83 		dev_err(dev, "Cannot read hardware identity: error %d\n",
84 			err);
85 		return err;
86 	}
87 
88 	le16_to_cpus(&nic_id.id);
89 	le16_to_cpus(&nic_id.variant);
90 	le16_to_cpus(&nic_id.major);
91 	le16_to_cpus(&nic_id.minor);
92 	dev_info(dev, "Hardware identity %04x:%04x:%04x:%04x\n",
93 		 nic_id.id, nic_id.variant, nic_id.major, nic_id.minor);
94 
95 	if (hw_ver)
96 		*hw_ver = (((nic_id.id & 0xff) << 24) |
97 			   ((nic_id.variant & 0xff) << 16) |
98 			   ((nic_id.major & 0xff) << 8) |
99 			   (nic_id.minor & 0xff));
100 
101 	priv->firmware_type = determine_firmware_type(&nic_id);
102 
103 	/* Get the firmware version */
104 	err = HERMES_READ_RECORD_PR(hw, USER_BAP, HERMES_RID_STAID, &sta_id);
105 	if (err) {
106 		dev_err(dev, "Cannot read station identity: error %d\n",
107 			err);
108 		return err;
109 	}
110 
111 	le16_to_cpus(&sta_id.id);
112 	le16_to_cpus(&sta_id.variant);
113 	le16_to_cpus(&sta_id.major);
114 	le16_to_cpus(&sta_id.minor);
115 	dev_info(dev, "Station identity  %04x:%04x:%04x:%04x\n",
116 		 sta_id.id, sta_id.variant, sta_id.major, sta_id.minor);
117 
118 	switch (sta_id.id) {
119 	case 0x15:
120 		dev_err(dev, "Primary firmware is active\n");
121 		return -ENODEV;
122 	case 0x14b:
123 		dev_err(dev, "Tertiary firmware is active\n");
124 		return -ENODEV;
125 	case 0x1f:	/* Intersil, Agere, Symbol Spectrum24 */
126 	case 0x21:	/* Symbol Spectrum24 Trilogy */
127 		break;
128 	default:
129 		dev_notice(dev, "Unknown station ID, please report\n");
130 		break;
131 	}
132 
133 	/* Default capabilities */
134 	priv->has_sensitivity = 1;
135 	priv->has_mwo = 0;
136 	priv->has_preamble = 0;
137 	priv->has_port3 = 1;
138 	priv->has_ibss = 1;
139 	priv->has_wep = 0;
140 	priv->has_big_wep = 0;
141 	priv->has_alt_txcntl = 0;
142 	priv->has_ext_scan = 0;
143 	priv->has_wpa = 0;
144 	priv->do_fw_download = 0;
145 
146 	/* Determine capabilities from the firmware version */
147 	switch (priv->firmware_type) {
148 	case FIRMWARE_TYPE_AGERE:
149 		/* Lucent Wavelan IEEE, Lucent Orinoco, Cabletron RoamAbout,
150 		   ELSA, Melco, HP, IBM, Dell 1150, Compaq 110/210 */
151 		if (fw_name)
152 			snprintf(fw_name, fw_name_len, "Lucent/Agere %d.%02d",
153 				 sta_id.major, sta_id.minor);
154 
155 		firmver = ((unsigned long)sta_id.major << 16) | sta_id.minor;
156 
157 		priv->has_ibss = (firmver >= 0x60006);
158 		priv->has_wep = (firmver >= 0x40020);
159 		priv->has_big_wep = 1; /* FIXME: this is wrong - how do we tell
160 					  Gold cards from the others? */
161 		priv->has_mwo = (firmver >= 0x60000);
162 		priv->has_pm = (firmver >= 0x40020); /* Don't work in 7.52 ? */
163 		priv->ibss_port = 1;
164 		priv->has_hostscan = (firmver >= 0x8000a);
165 		priv->do_fw_download = 1;
166 		priv->broken_monitor = (firmver >= 0x80000);
167 		priv->has_alt_txcntl = (firmver >= 0x90000); /* All 9.x ? */
168 		priv->has_ext_scan = (firmver >= 0x90000); /* All 9.x ? */
169 		priv->has_wpa = (firmver >= 0x9002a);
170 		/* Tested with Agere firmware :
171 		 *	1.16 ; 4.08 ; 4.52 ; 6.04 ; 6.16 ; 7.28 => Jean II
172 		 * Tested CableTron firmware : 4.32 => Anton */
173 		break;
174 	case FIRMWARE_TYPE_SYMBOL:
175 		/* Symbol , 3Com AirConnect, Intel, Ericsson WLAN */
176 		/* Intel MAC : 00:02:B3:* */
177 		/* 3Com MAC : 00:50:DA:* */
178 		memset(tmp, 0, sizeof(tmp));
179 		/* Get the Symbol firmware version */
180 		err = hw->ops->read_ltv_pr(hw, USER_BAP,
181 					HERMES_RID_SECONDARYVERSION_SYMBOL,
182 					SYMBOL_MAX_VER_LEN, NULL, &tmp);
183 		if (err) {
184 			dev_warn(dev, "Error %d reading Symbol firmware info. "
185 				 "Wildly guessing capabilities...\n", err);
186 			firmver = 0;
187 			tmp[0] = '\0';
188 		} else {
189 			/* The firmware revision is a string, the format is
190 			 * something like : "V2.20-01".
191 			 * Quick and dirty parsing... - Jean II
192 			 */
193 			firmver = ((tmp[1] - '0') << 16)
194 				| ((tmp[3] - '0') << 12)
195 				| ((tmp[4] - '0') << 8)
196 				| ((tmp[6] - '0') << 4)
197 				| (tmp[7] - '0');
198 
199 			tmp[SYMBOL_MAX_VER_LEN] = '\0';
200 		}
201 
202 		if (fw_name)
203 			snprintf(fw_name, fw_name_len, "Symbol %s", tmp);
204 
205 		priv->has_ibss = (firmver >= 0x20000);
206 		priv->has_wep = (firmver >= 0x15012);
207 		priv->has_big_wep = (firmver >= 0x20000);
208 		priv->has_pm = (firmver >= 0x20000 && firmver < 0x22000) ||
209 			       (firmver >= 0x29000 && firmver < 0x30000) ||
210 			       firmver >= 0x31000;
211 		priv->has_preamble = (firmver >= 0x20000);
212 		priv->ibss_port = 4;
213 
214 		/* Symbol firmware is found on various cards, but
215 		 * there has been no attempt to check firmware
216 		 * download on non-spectrum_cs based cards.
217 		 *
218 		 * Given that the Agere firmware download works
219 		 * differently, we should avoid doing a firmware
220 		 * download with the Symbol algorithm on non-spectrum
221 		 * cards.
222 		 *
223 		 * For now we can identify a spectrum_cs based card
224 		 * because it has a firmware reset function.
225 		 */
226 		priv->do_fw_download = (priv->stop_fw != NULL);
227 
228 		priv->broken_disableport = (firmver == 0x25013) ||
229 				(firmver >= 0x30000 && firmver <= 0x31000);
230 		priv->has_hostscan = (firmver >= 0x31001) ||
231 				     (firmver >= 0x29057 && firmver < 0x30000);
232 		/* Tested with Intel firmware : 0x20015 => Jean II */
233 		/* Tested with 3Com firmware : 0x15012 & 0x22001 => Jean II */
234 		break;
235 	case FIRMWARE_TYPE_INTERSIL:
236 		/* D-Link, Linksys, Adtron, ZoomAir, and many others...
237 		 * Samsung, Compaq 100/200 and Proxim are slightly
238 		 * different and less well tested */
239 		/* D-Link MAC : 00:40:05:* */
240 		/* Addtron MAC : 00:90:D1:* */
241 		if (fw_name)
242 			snprintf(fw_name, fw_name_len, "Intersil %d.%d.%d",
243 				 sta_id.major, sta_id.minor, sta_id.variant);
244 
245 		firmver = ((unsigned long)sta_id.major << 16) |
246 			((unsigned long)sta_id.minor << 8) | sta_id.variant;
247 
248 		priv->has_ibss = (firmver >= 0x000700); /* FIXME */
249 		priv->has_big_wep = priv->has_wep = (firmver >= 0x000800);
250 		priv->has_pm = (firmver >= 0x000700);
251 		priv->has_hostscan = (firmver >= 0x010301);
252 
253 		if (firmver >= 0x000800)
254 			priv->ibss_port = 0;
255 		else {
256 			dev_notice(dev, "Intersil firmware earlier than v0.8.x"
257 				   " - several features not supported\n");
258 			priv->ibss_port = 1;
259 		}
260 		break;
261 	}
262 	if (fw_name)
263 		dev_info(dev, "Firmware determined as %s\n", fw_name);
264 
265 #ifndef CONFIG_HERMES_PRISM
266 	if (priv->firmware_type == FIRMWARE_TYPE_INTERSIL) {
267 		dev_err(dev, "Support for Prism chipset is not enabled\n");
268 		return -ENODEV;
269 	}
270 #endif
271 
272 	return 0;
273 }
274 
275 /* Read settings from EEPROM into our private structure.
276  * MAC address gets dropped into callers buffer
277  * Can be called before netdev registration.
278  */
279 int orinoco_hw_read_card_settings(struct orinoco_private *priv, u8 *dev_addr)
280 {
281 	struct device *dev = priv->dev;
282 	struct hermes_idstring nickbuf;
283 	struct hermes *hw = &priv->hw;
284 	int len;
285 	int err;
286 	u16 reclen;
287 
288 	/* Get the MAC address */
289 	err = hw->ops->read_ltv_pr(hw, USER_BAP, HERMES_RID_CNFOWNMACADDR,
290 				ETH_ALEN, NULL, dev_addr);
291 	if (err) {
292 		dev_warn(dev, "Failed to read MAC address!\n");
293 		goto out;
294 	}
295 
296 	dev_dbg(dev, "MAC address %pM\n", dev_addr);
297 
298 	/* Get the station name */
299 	err = hw->ops->read_ltv_pr(hw, USER_BAP, HERMES_RID_CNFOWNNAME,
300 				sizeof(nickbuf), &reclen, &nickbuf);
301 	if (err) {
302 		dev_err(dev, "failed to read station name\n");
303 		goto out;
304 	}
305 	if (nickbuf.len)
306 		len = min(IW_ESSID_MAX_SIZE, (int)le16_to_cpu(nickbuf.len));
307 	else
308 		len = min(IW_ESSID_MAX_SIZE, 2 * reclen);
309 	memcpy(priv->nick, &nickbuf.val, len);
310 	priv->nick[len] = '\0';
311 
312 	dev_dbg(dev, "Station name \"%s\"\n", priv->nick);
313 
314 	/* Get allowed channels */
315 	err = hermes_read_wordrec_pr(hw, USER_BAP, HERMES_RID_CHANNELLIST,
316 				  &priv->channel_mask);
317 	if (err) {
318 		dev_err(dev, "Failed to read channel list!\n");
319 		goto out;
320 	}
321 
322 	/* Get initial AP density */
323 	err = hermes_read_wordrec_pr(hw, USER_BAP, HERMES_RID_CNFSYSTEMSCALE,
324 				  &priv->ap_density);
325 	if (err || priv->ap_density < 1 || priv->ap_density > 3)
326 		priv->has_sensitivity = 0;
327 
328 	/* Get initial RTS threshold */
329 	err = hermes_read_wordrec_pr(hw, USER_BAP, HERMES_RID_CNFRTSTHRESHOLD,
330 				  &priv->rts_thresh);
331 	if (err) {
332 		dev_err(dev, "Failed to read RTS threshold!\n");
333 		goto out;
334 	}
335 
336 	/* Get initial fragmentation settings */
337 	if (priv->has_mwo)
338 		err = hermes_read_wordrec_pr(hw, USER_BAP,
339 					  HERMES_RID_CNFMWOROBUST_AGERE,
340 					  &priv->mwo_robust);
341 	else
342 		err = hermes_read_wordrec_pr(hw, USER_BAP,
343 					  HERMES_RID_CNFFRAGMENTATIONTHRESHOLD,
344 					  &priv->frag_thresh);
345 	if (err) {
346 		dev_err(dev, "Failed to read fragmentation settings!\n");
347 		goto out;
348 	}
349 
350 	/* Power management setup */
351 	if (priv->has_pm) {
352 		priv->pm_on = 0;
353 		priv->pm_mcast = 1;
354 		err = hermes_read_wordrec_pr(hw, USER_BAP,
355 					  HERMES_RID_CNFMAXSLEEPDURATION,
356 					  &priv->pm_period);
357 		if (err) {
358 			dev_err(dev, "Failed to read power management "
359 				"period!\n");
360 			goto out;
361 		}
362 		err = hermes_read_wordrec_pr(hw, USER_BAP,
363 					  HERMES_RID_CNFPMHOLDOVERDURATION,
364 					  &priv->pm_timeout);
365 		if (err) {
366 			dev_err(dev, "Failed to read power management "
367 				"timeout!\n");
368 			goto out;
369 		}
370 	}
371 
372 	/* Preamble setup */
373 	if (priv->has_preamble) {
374 		err = hermes_read_wordrec_pr(hw, USER_BAP,
375 					  HERMES_RID_CNFPREAMBLE_SYMBOL,
376 					  &priv->preamble);
377 		if (err) {
378 			dev_err(dev, "Failed to read preamble setup\n");
379 			goto out;
380 		}
381 	}
382 
383 	/* Retry settings */
384 	err = hermes_read_wordrec_pr(hw, USER_BAP, HERMES_RID_SHORTRETRYLIMIT,
385 				  &priv->short_retry_limit);
386 	if (err) {
387 		dev_err(dev, "Failed to read short retry limit\n");
388 		goto out;
389 	}
390 
391 	err = hermes_read_wordrec_pr(hw, USER_BAP, HERMES_RID_LONGRETRYLIMIT,
392 				  &priv->long_retry_limit);
393 	if (err) {
394 		dev_err(dev, "Failed to read long retry limit\n");
395 		goto out;
396 	}
397 
398 	err = hermes_read_wordrec_pr(hw, USER_BAP, HERMES_RID_MAXTRANSMITLIFETIME,
399 				  &priv->retry_lifetime);
400 	if (err) {
401 		dev_err(dev, "Failed to read max retry lifetime\n");
402 		goto out;
403 	}
404 
405 out:
406 	return err;
407 }
408 
409 /* Can be called before netdev registration */
410 int orinoco_hw_allocate_fid(struct orinoco_private *priv)
411 {
412 	struct device *dev = priv->dev;
413 	struct hermes *hw = &priv->hw;
414 	int err;
415 
416 	err = hw->ops->allocate(hw, priv->nicbuf_size, &priv->txfid);
417 	if (err == -EIO && priv->nicbuf_size > TX_NICBUF_SIZE_BUG) {
418 		/* Try workaround for old Symbol firmware bug */
419 		priv->nicbuf_size = TX_NICBUF_SIZE_BUG;
420 		err = hw->ops->allocate(hw, priv->nicbuf_size, &priv->txfid);
421 
422 		dev_warn(dev, "Firmware ALLOC bug detected "
423 			 "(old Symbol firmware?). Work around %s\n",
424 			 err ? "failed!" : "ok.");
425 	}
426 
427 	return err;
428 }
429 
430 int orinoco_get_bitratemode(int bitrate, int automatic)
431 {
432 	int ratemode = -1;
433 	int i;
434 
435 	if ((bitrate != 10) && (bitrate != 20) &&
436 	    (bitrate != 55) && (bitrate != 110))
437 		return ratemode;
438 
439 	for (i = 0; i < BITRATE_TABLE_SIZE; i++) {
440 		if ((bitrate_table[i].bitrate == bitrate) &&
441 		    (bitrate_table[i].automatic == automatic)) {
442 			ratemode = i;
443 			break;
444 		}
445 	}
446 	return ratemode;
447 }
448 
449 void orinoco_get_ratemode_cfg(int ratemode, int *bitrate, int *automatic)
450 {
451 	BUG_ON((ratemode < 0) || (ratemode >= BITRATE_TABLE_SIZE));
452 
453 	*bitrate = bitrate_table[ratemode].bitrate * 100000;
454 	*automatic = bitrate_table[ratemode].automatic;
455 }
456 
457 int orinoco_hw_program_rids(struct orinoco_private *priv)
458 {
459 	struct net_device *dev = priv->ndev;
460 	struct wireless_dev *wdev = netdev_priv(dev);
461 	struct hermes *hw = &priv->hw;
462 	int err;
463 	struct hermes_idstring idbuf;
464 
465 	/* Set the MAC address */
466 	err = hw->ops->write_ltv(hw, USER_BAP, HERMES_RID_CNFOWNMACADDR,
467 				 HERMES_BYTES_TO_RECLEN(ETH_ALEN),
468 				 dev->dev_addr);
469 	if (err) {
470 		printk(KERN_ERR "%s: Error %d setting MAC address\n",
471 		       dev->name, err);
472 		return err;
473 	}
474 
475 	/* Set up the link mode */
476 	err = hermes_write_wordrec(hw, USER_BAP, HERMES_RID_CNFPORTTYPE,
477 				   priv->port_type);
478 	if (err) {
479 		printk(KERN_ERR "%s: Error %d setting port type\n",
480 		       dev->name, err);
481 		return err;
482 	}
483 	/* Set the channel/frequency */
484 	if (priv->channel != 0 && priv->iw_mode != NL80211_IFTYPE_STATION) {
485 		err = hermes_write_wordrec(hw, USER_BAP,
486 					   HERMES_RID_CNFOWNCHANNEL,
487 					   priv->channel);
488 		if (err) {
489 			printk(KERN_ERR "%s: Error %d setting channel %d\n",
490 			       dev->name, err, priv->channel);
491 			return err;
492 		}
493 	}
494 
495 	if (priv->has_ibss) {
496 		u16 createibss;
497 
498 		if ((strlen(priv->desired_essid) == 0) && (priv->createibss)) {
499 			printk(KERN_WARNING "%s: This firmware requires an "
500 			       "ESSID in IBSS-Ad-Hoc mode.\n", dev->name);
501 			/* With wvlan_cs, in this case, we would crash.
502 			 * hopefully, this driver will behave better...
503 			 * Jean II */
504 			createibss = 0;
505 		} else {
506 			createibss = priv->createibss;
507 		}
508 
509 		err = hermes_write_wordrec(hw, USER_BAP,
510 					   HERMES_RID_CNFCREATEIBSS,
511 					   createibss);
512 		if (err) {
513 			printk(KERN_ERR "%s: Error %d setting CREATEIBSS\n",
514 			       dev->name, err);
515 			return err;
516 		}
517 	}
518 
519 	/* Set the desired BSSID */
520 	err = __orinoco_hw_set_wap(priv);
521 	if (err) {
522 		printk(KERN_ERR "%s: Error %d setting AP address\n",
523 		       dev->name, err);
524 		return err;
525 	}
526 
527 	/* Set the desired ESSID */
528 	idbuf.len = cpu_to_le16(strlen(priv->desired_essid));
529 	memcpy(&idbuf.val, priv->desired_essid, sizeof(idbuf.val));
530 	/* WinXP wants partner to configure OWNSSID even in IBSS mode. (jimc) */
531 	err = hw->ops->write_ltv(hw, USER_BAP, HERMES_RID_CNFOWNSSID,
532 			HERMES_BYTES_TO_RECLEN(strlen(priv->desired_essid) + 2),
533 			&idbuf);
534 	if (err) {
535 		printk(KERN_ERR "%s: Error %d setting OWNSSID\n",
536 		       dev->name, err);
537 		return err;
538 	}
539 	err = hw->ops->write_ltv(hw, USER_BAP, HERMES_RID_CNFDESIREDSSID,
540 			HERMES_BYTES_TO_RECLEN(strlen(priv->desired_essid) + 2),
541 			&idbuf);
542 	if (err) {
543 		printk(KERN_ERR "%s: Error %d setting DESIREDSSID\n",
544 		       dev->name, err);
545 		return err;
546 	}
547 
548 	/* Set the station name */
549 	idbuf.len = cpu_to_le16(strlen(priv->nick));
550 	memcpy(&idbuf.val, priv->nick, sizeof(idbuf.val));
551 	err = hw->ops->write_ltv(hw, USER_BAP, HERMES_RID_CNFOWNNAME,
552 				 HERMES_BYTES_TO_RECLEN(strlen(priv->nick) + 2),
553 				 &idbuf);
554 	if (err) {
555 		printk(KERN_ERR "%s: Error %d setting nickname\n",
556 		       dev->name, err);
557 		return err;
558 	}
559 
560 	/* Set AP density */
561 	if (priv->has_sensitivity) {
562 		err = hermes_write_wordrec(hw, USER_BAP,
563 					   HERMES_RID_CNFSYSTEMSCALE,
564 					   priv->ap_density);
565 		if (err) {
566 			printk(KERN_WARNING "%s: Error %d setting SYSTEMSCALE. "
567 			       "Disabling sensitivity control\n",
568 			       dev->name, err);
569 
570 			priv->has_sensitivity = 0;
571 		}
572 	}
573 
574 	/* Set RTS threshold */
575 	err = hermes_write_wordrec(hw, USER_BAP, HERMES_RID_CNFRTSTHRESHOLD,
576 				   priv->rts_thresh);
577 	if (err) {
578 		printk(KERN_ERR "%s: Error %d setting RTS threshold\n",
579 		       dev->name, err);
580 		return err;
581 	}
582 
583 	/* Set fragmentation threshold or MWO robustness */
584 	if (priv->has_mwo)
585 		err = hermes_write_wordrec(hw, USER_BAP,
586 					   HERMES_RID_CNFMWOROBUST_AGERE,
587 					   priv->mwo_robust);
588 	else
589 		err = hermes_write_wordrec(hw, USER_BAP,
590 					   HERMES_RID_CNFFRAGMENTATIONTHRESHOLD,
591 					   priv->frag_thresh);
592 	if (err) {
593 		printk(KERN_ERR "%s: Error %d setting fragmentation\n",
594 		       dev->name, err);
595 		return err;
596 	}
597 
598 	/* Set bitrate */
599 	err = __orinoco_hw_set_bitrate(priv);
600 	if (err) {
601 		printk(KERN_ERR "%s: Error %d setting bitrate\n",
602 		       dev->name, err);
603 		return err;
604 	}
605 
606 	/* Set power management */
607 	if (priv->has_pm) {
608 		err = hermes_write_wordrec(hw, USER_BAP,
609 					   HERMES_RID_CNFPMENABLED,
610 					   priv->pm_on);
611 		if (err) {
612 			printk(KERN_ERR "%s: Error %d setting up PM\n",
613 			       dev->name, err);
614 			return err;
615 		}
616 
617 		err = hermes_write_wordrec(hw, USER_BAP,
618 					   HERMES_RID_CNFMULTICASTRECEIVE,
619 					   priv->pm_mcast);
620 		if (err) {
621 			printk(KERN_ERR "%s: Error %d setting up PM\n",
622 			       dev->name, err);
623 			return err;
624 		}
625 		err = hermes_write_wordrec(hw, USER_BAP,
626 					   HERMES_RID_CNFMAXSLEEPDURATION,
627 					   priv->pm_period);
628 		if (err) {
629 			printk(KERN_ERR "%s: Error %d setting up PM\n",
630 			       dev->name, err);
631 			return err;
632 		}
633 		err = hermes_write_wordrec(hw, USER_BAP,
634 					   HERMES_RID_CNFPMHOLDOVERDURATION,
635 					   priv->pm_timeout);
636 		if (err) {
637 			printk(KERN_ERR "%s: Error %d setting up PM\n",
638 			       dev->name, err);
639 			return err;
640 		}
641 	}
642 
643 	/* Set preamble - only for Symbol so far... */
644 	if (priv->has_preamble) {
645 		err = hermes_write_wordrec(hw, USER_BAP,
646 					   HERMES_RID_CNFPREAMBLE_SYMBOL,
647 					   priv->preamble);
648 		if (err) {
649 			printk(KERN_ERR "%s: Error %d setting preamble\n",
650 			       dev->name, err);
651 			return err;
652 		}
653 	}
654 
655 	/* Set up encryption */
656 	if (priv->has_wep || priv->has_wpa) {
657 		err = __orinoco_hw_setup_enc(priv);
658 		if (err) {
659 			printk(KERN_ERR "%s: Error %d activating encryption\n",
660 			       dev->name, err);
661 			return err;
662 		}
663 	}
664 
665 	if (priv->iw_mode == NL80211_IFTYPE_MONITOR) {
666 		/* Enable monitor mode */
667 		dev->type = ARPHRD_IEEE80211;
668 		err = hw->ops->cmd_wait(hw, HERMES_CMD_TEST |
669 					    HERMES_TEST_MONITOR, 0, NULL);
670 	} else {
671 		/* Disable monitor mode */
672 		dev->type = ARPHRD_ETHER;
673 		err = hw->ops->cmd_wait(hw, HERMES_CMD_TEST |
674 					    HERMES_TEST_STOP, 0, NULL);
675 	}
676 	if (err)
677 		return err;
678 
679 	/* Reset promiscuity / multicast*/
680 	priv->promiscuous = 0;
681 	priv->mc_count = 0;
682 
683 	/* Record mode change */
684 	wdev->iftype = priv->iw_mode;
685 
686 	return 0;
687 }
688 
689 /* Get tsc from the firmware */
690 int orinoco_hw_get_tkip_iv(struct orinoco_private *priv, int key, u8 *tsc)
691 {
692 	struct hermes *hw = &priv->hw;
693 	int err = 0;
694 	u8 tsc_arr[4][ORINOCO_SEQ_LEN];
695 
696 	if ((key < 0) || (key >= 4))
697 		return -EINVAL;
698 
699 	err = hw->ops->read_ltv(hw, USER_BAP, HERMES_RID_CURRENT_TKIP_IV,
700 				sizeof(tsc_arr), NULL, &tsc_arr);
701 	if (!err)
702 		memcpy(tsc, &tsc_arr[key][0], sizeof(tsc_arr[0]));
703 
704 	return err;
705 }
706 
707 int __orinoco_hw_set_bitrate(struct orinoco_private *priv)
708 {
709 	struct hermes *hw = &priv->hw;
710 	int ratemode = priv->bitratemode;
711 	int err = 0;
712 
713 	if (ratemode >= BITRATE_TABLE_SIZE) {
714 		printk(KERN_ERR "%s: BUG: Invalid bitrate mode %d\n",
715 		       priv->ndev->name, ratemode);
716 		return -EINVAL;
717 	}
718 
719 	switch (priv->firmware_type) {
720 	case FIRMWARE_TYPE_AGERE:
721 		err = hermes_write_wordrec(hw, USER_BAP,
722 				HERMES_RID_CNFTXRATECONTROL,
723 				bitrate_table[ratemode].agere_txratectrl);
724 		break;
725 	case FIRMWARE_TYPE_INTERSIL:
726 	case FIRMWARE_TYPE_SYMBOL:
727 		err = hermes_write_wordrec(hw, USER_BAP,
728 				HERMES_RID_CNFTXRATECONTROL,
729 				bitrate_table[ratemode].intersil_txratectrl);
730 		break;
731 	default:
732 		BUG();
733 	}
734 
735 	return err;
736 }
737 
738 int orinoco_hw_get_act_bitrate(struct orinoco_private *priv, int *bitrate)
739 {
740 	struct hermes *hw = &priv->hw;
741 	int i;
742 	int err = 0;
743 	u16 val;
744 
745 	err = hermes_read_wordrec(hw, USER_BAP,
746 				  HERMES_RID_CURRENTTXRATE, &val);
747 	if (err)
748 		return err;
749 
750 	switch (priv->firmware_type) {
751 	case FIRMWARE_TYPE_AGERE: /* Lucent style rate */
752 		/* Note : in Lucent firmware, the return value of
753 		 * HERMES_RID_CURRENTTXRATE is the bitrate in Mb/s,
754 		 * and therefore is totally different from the
755 		 * encoding of HERMES_RID_CNFTXRATECONTROL.
756 		 * Don't forget that 6Mb/s is really 5.5Mb/s */
757 		if (val == 6)
758 			*bitrate = 5500000;
759 		else
760 			*bitrate = val * 1000000;
761 		break;
762 	case FIRMWARE_TYPE_INTERSIL: /* Intersil style rate */
763 	case FIRMWARE_TYPE_SYMBOL: /* Symbol style rate */
764 		for (i = 0; i < BITRATE_TABLE_SIZE; i++)
765 			if (bitrate_table[i].intersil_txratectrl == val) {
766 				*bitrate = bitrate_table[i].bitrate * 100000;
767 				break;
768 			}
769 
770 		if (i >= BITRATE_TABLE_SIZE) {
771 			printk(KERN_INFO "%s: Unable to determine current bitrate (0x%04hx)\n",
772 			       priv->ndev->name, val);
773 			err = -EIO;
774 		}
775 
776 		break;
777 	default:
778 		BUG();
779 	}
780 
781 	return err;
782 }
783 
784 /* Set fixed AP address */
785 int __orinoco_hw_set_wap(struct orinoco_private *priv)
786 {
787 	int roaming_flag;
788 	int err = 0;
789 	struct hermes *hw = &priv->hw;
790 
791 	switch (priv->firmware_type) {
792 	case FIRMWARE_TYPE_AGERE:
793 		/* not supported */
794 		break;
795 	case FIRMWARE_TYPE_INTERSIL:
796 		if (priv->bssid_fixed)
797 			roaming_flag = 2;
798 		else
799 			roaming_flag = 1;
800 
801 		err = hermes_write_wordrec(hw, USER_BAP,
802 					   HERMES_RID_CNFROAMINGMODE,
803 					   roaming_flag);
804 		break;
805 	case FIRMWARE_TYPE_SYMBOL:
806 		err = HERMES_WRITE_RECORD(hw, USER_BAP,
807 					  HERMES_RID_CNFMANDATORYBSSID_SYMBOL,
808 					  &priv->desired_bssid);
809 		break;
810 	}
811 	return err;
812 }
813 
814 /* Change the WEP keys and/or the current keys.  Can be called
815  * either from __orinoco_hw_setup_enc() or directly from
816  * orinoco_ioctl_setiwencode().  In the later case the association
817  * with the AP is not broken (if the firmware can handle it),
818  * which is needed for 802.1x implementations. */
819 int __orinoco_hw_setup_wepkeys(struct orinoco_private *priv)
820 {
821 	struct hermes *hw = &priv->hw;
822 	int err = 0;
823 	int i;
824 
825 	switch (priv->firmware_type) {
826 	case FIRMWARE_TYPE_AGERE:
827 	{
828 		struct orinoco_key keys[ORINOCO_MAX_KEYS];
829 
830 		memset(&keys, 0, sizeof(keys));
831 		for (i = 0; i < ORINOCO_MAX_KEYS; i++) {
832 			int len = min(priv->keys[i].key_len,
833 				      ORINOCO_MAX_KEY_SIZE);
834 			memcpy(&keys[i].data, priv->keys[i].key, len);
835 			if (len > SMALL_KEY_SIZE)
836 				keys[i].len = cpu_to_le16(LARGE_KEY_SIZE);
837 			else if (len > 0)
838 				keys[i].len = cpu_to_le16(SMALL_KEY_SIZE);
839 			else
840 				keys[i].len = cpu_to_le16(0);
841 		}
842 
843 		err = HERMES_WRITE_RECORD(hw, USER_BAP,
844 					  HERMES_RID_CNFWEPKEYS_AGERE,
845 					  &keys);
846 		if (err)
847 			return err;
848 		err = hermes_write_wordrec(hw, USER_BAP,
849 					   HERMES_RID_CNFTXKEY_AGERE,
850 					   priv->tx_key);
851 		if (err)
852 			return err;
853 		break;
854 	}
855 	case FIRMWARE_TYPE_INTERSIL:
856 	case FIRMWARE_TYPE_SYMBOL:
857 		{
858 			int keylen;
859 
860 			/* Force uniform key length to work around
861 			 * firmware bugs */
862 			keylen = priv->keys[priv->tx_key].key_len;
863 
864 			if (keylen > LARGE_KEY_SIZE) {
865 				printk(KERN_ERR "%s: BUG: Key %d has oversize length %d.\n",
866 				       priv->ndev->name, priv->tx_key, keylen);
867 				return -E2BIG;
868 			} else if (keylen > SMALL_KEY_SIZE)
869 				keylen = LARGE_KEY_SIZE;
870 			else if (keylen > 0)
871 				keylen = SMALL_KEY_SIZE;
872 			else
873 				keylen = 0;
874 
875 			/* Write all 4 keys */
876 			for (i = 0; i < ORINOCO_MAX_KEYS; i++) {
877 				u8 key[LARGE_KEY_SIZE] = { 0 };
878 
879 				memcpy(key, priv->keys[i].key,
880 				       priv->keys[i].key_len);
881 
882 				err = hw->ops->write_ltv(hw, USER_BAP,
883 						HERMES_RID_CNFDEFAULTKEY0 + i,
884 						HERMES_BYTES_TO_RECLEN(keylen),
885 						key);
886 				if (err)
887 					return err;
888 			}
889 
890 			/* Write the index of the key used in transmission */
891 			err = hermes_write_wordrec(hw, USER_BAP,
892 						HERMES_RID_CNFWEPDEFAULTKEYID,
893 						priv->tx_key);
894 			if (err)
895 				return err;
896 		}
897 		break;
898 	}
899 
900 	return 0;
901 }
902 
903 int __orinoco_hw_setup_enc(struct orinoco_private *priv)
904 {
905 	struct hermes *hw = &priv->hw;
906 	int err = 0;
907 	int master_wep_flag;
908 	int auth_flag;
909 	int enc_flag;
910 
911 	/* Setup WEP keys */
912 	if (priv->encode_alg == ORINOCO_ALG_WEP)
913 		__orinoco_hw_setup_wepkeys(priv);
914 
915 	if (priv->wep_restrict)
916 		auth_flag = HERMES_AUTH_SHARED_KEY;
917 	else
918 		auth_flag = HERMES_AUTH_OPEN;
919 
920 	if (priv->wpa_enabled)
921 		enc_flag = 2;
922 	else if (priv->encode_alg == ORINOCO_ALG_WEP)
923 		enc_flag = 1;
924 	else
925 		enc_flag = 0;
926 
927 	switch (priv->firmware_type) {
928 	case FIRMWARE_TYPE_AGERE: /* Agere style WEP */
929 		if (priv->encode_alg == ORINOCO_ALG_WEP) {
930 			/* Enable the shared-key authentication. */
931 			err = hermes_write_wordrec(hw, USER_BAP,
932 					HERMES_RID_CNFAUTHENTICATION_AGERE,
933 					auth_flag);
934 		}
935 		err = hermes_write_wordrec(hw, USER_BAP,
936 					   HERMES_RID_CNFWEPENABLED_AGERE,
937 					   enc_flag);
938 		if (err)
939 			return err;
940 
941 		if (priv->has_wpa) {
942 			/* Set WPA key management */
943 			err = hermes_write_wordrec(hw, USER_BAP,
944 				  HERMES_RID_CNFSETWPAAUTHMGMTSUITE_AGERE,
945 				  priv->key_mgmt);
946 			if (err)
947 				return err;
948 		}
949 
950 		break;
951 
952 	case FIRMWARE_TYPE_INTERSIL: /* Intersil style WEP */
953 	case FIRMWARE_TYPE_SYMBOL: /* Symbol style WEP */
954 		if (priv->encode_alg == ORINOCO_ALG_WEP) {
955 			if (priv->wep_restrict ||
956 			    (priv->firmware_type == FIRMWARE_TYPE_SYMBOL))
957 				master_wep_flag = HERMES_WEP_PRIVACY_INVOKED |
958 						  HERMES_WEP_EXCL_UNENCRYPTED;
959 			else
960 				master_wep_flag = HERMES_WEP_PRIVACY_INVOKED;
961 
962 			err = hermes_write_wordrec(hw, USER_BAP,
963 						   HERMES_RID_CNFAUTHENTICATION,
964 						   auth_flag);
965 			if (err)
966 				return err;
967 		} else
968 			master_wep_flag = 0;
969 
970 		if (priv->iw_mode == NL80211_IFTYPE_MONITOR)
971 			master_wep_flag |= HERMES_WEP_HOST_DECRYPT;
972 
973 		/* Master WEP setting : on/off */
974 		err = hermes_write_wordrec(hw, USER_BAP,
975 					   HERMES_RID_CNFWEPFLAGS_INTERSIL,
976 					   master_wep_flag);
977 		if (err)
978 			return err;
979 
980 		break;
981 	}
982 
983 	return 0;
984 }
985 
986 /* key must be 32 bytes, including the tx and rx MIC keys.
987  * rsc must be NULL or up to 8 bytes
988  * tsc must be NULL or up to 8 bytes
989  */
990 int __orinoco_hw_set_tkip_key(struct orinoco_private *priv, int key_idx,
991 			      int set_tx, const u8 *key, size_t key_len,
992 			      const u8 *rsc, size_t rsc_len,
993 			      const u8 *tsc, size_t tsc_len)
994 {
995 	struct {
996 		__le16 idx;
997 		u8 rsc[ORINOCO_SEQ_LEN];
998 		struct {
999 			u8 key[TKIP_KEYLEN];
1000 			u8 tx_mic[MIC_KEYLEN];
1001 			u8 rx_mic[MIC_KEYLEN];
1002 		} tkip;
1003 		u8 tsc[ORINOCO_SEQ_LEN];
1004 	} __packed buf;
1005 	struct hermes *hw = &priv->hw;
1006 	int ret;
1007 	int err;
1008 	int k;
1009 	u16 xmitting;
1010 
1011 	key_idx &= 0x3;
1012 
1013 	if (set_tx)
1014 		key_idx |= 0x8000;
1015 
1016 	buf.idx = cpu_to_le16(key_idx);
1017 	if (key_len != sizeof(buf.tkip))
1018 		return -EINVAL;
1019 	memcpy(&buf.tkip, key, sizeof(buf.tkip));
1020 
1021 	if (rsc_len > sizeof(buf.rsc))
1022 		rsc_len = sizeof(buf.rsc);
1023 
1024 	if (tsc_len > sizeof(buf.tsc))
1025 		tsc_len = sizeof(buf.tsc);
1026 
1027 	memset(buf.rsc, 0, sizeof(buf.rsc));
1028 	memset(buf.tsc, 0, sizeof(buf.tsc));
1029 
1030 	if (rsc != NULL)
1031 		memcpy(buf.rsc, rsc, rsc_len);
1032 
1033 	if (tsc != NULL)
1034 		memcpy(buf.tsc, tsc, tsc_len);
1035 	else
1036 		buf.tsc[4] = 0x10;
1037 
1038 	/* Wait up to 100ms for tx queue to empty */
1039 	for (k = 100; k > 0; k--) {
1040 		udelay(1000);
1041 		ret = hermes_read_wordrec(hw, USER_BAP, HERMES_RID_TXQUEUEEMPTY,
1042 					  &xmitting);
1043 		if (ret || !xmitting)
1044 			break;
1045 	}
1046 
1047 	if (k == 0)
1048 		ret = -ETIMEDOUT;
1049 
1050 	err = HERMES_WRITE_RECORD(hw, USER_BAP,
1051 				  HERMES_RID_CNFADDDEFAULTTKIPKEY_AGERE,
1052 				  &buf);
1053 
1054 	return ret ? ret : err;
1055 }
1056 
1057 int orinoco_clear_tkip_key(struct orinoco_private *priv, int key_idx)
1058 {
1059 	struct hermes *hw = &priv->hw;
1060 	int err;
1061 
1062 	err = hermes_write_wordrec(hw, USER_BAP,
1063 				   HERMES_RID_CNFREMDEFAULTTKIPKEY_AGERE,
1064 				   key_idx);
1065 	if (err)
1066 		printk(KERN_WARNING "%s: Error %d clearing TKIP key %d\n",
1067 		       priv->ndev->name, err, key_idx);
1068 	return err;
1069 }
1070 
1071 int __orinoco_hw_set_multicast_list(struct orinoco_private *priv,
1072 				    struct net_device *dev,
1073 				    int mc_count, int promisc)
1074 {
1075 	struct hermes *hw = &priv->hw;
1076 	int err = 0;
1077 
1078 	if (promisc != priv->promiscuous) {
1079 		err = hermes_write_wordrec(hw, USER_BAP,
1080 					   HERMES_RID_CNFPROMISCUOUSMODE,
1081 					   promisc);
1082 		if (err) {
1083 			printk(KERN_ERR "%s: Error %d setting PROMISCUOUSMODE to 1.\n",
1084 			       priv->ndev->name, err);
1085 		} else
1086 			priv->promiscuous = promisc;
1087 	}
1088 
1089 	/* If we're not in promiscuous mode, then we need to set the
1090 	 * group address if either we want to multicast, or if we were
1091 	 * multicasting and want to stop */
1092 	if (!promisc && (mc_count || priv->mc_count)) {
1093 		struct netdev_hw_addr *ha;
1094 		struct hermes_multicast mclist;
1095 		int i = 0;
1096 
1097 		netdev_for_each_mc_addr(ha, dev) {
1098 			if (i == mc_count)
1099 				break;
1100 			memcpy(mclist.addr[i++], ha->addr, ETH_ALEN);
1101 		}
1102 
1103 		err = hw->ops->write_ltv(hw, USER_BAP,
1104 				   HERMES_RID_CNFGROUPADDRESSES,
1105 				   HERMES_BYTES_TO_RECLEN(mc_count * ETH_ALEN),
1106 				   &mclist);
1107 		if (err)
1108 			printk(KERN_ERR "%s: Error %d setting multicast list.\n",
1109 			       priv->ndev->name, err);
1110 		else
1111 			priv->mc_count = mc_count;
1112 	}
1113 	return err;
1114 }
1115 
1116 /* Return : < 0 -> error code ; >= 0 -> length */
1117 int orinoco_hw_get_essid(struct orinoco_private *priv, int *active,
1118 			 char buf[IW_ESSID_MAX_SIZE + 1])
1119 {
1120 	struct hermes *hw = &priv->hw;
1121 	int err = 0;
1122 	struct hermes_idstring essidbuf;
1123 	char *p = (char *)(&essidbuf.val);
1124 	int len;
1125 	unsigned long flags;
1126 
1127 	if (orinoco_lock(priv, &flags) != 0)
1128 		return -EBUSY;
1129 
1130 	if (strlen(priv->desired_essid) > 0) {
1131 		/* We read the desired SSID from the hardware rather
1132 		   than from priv->desired_essid, just in case the
1133 		   firmware is allowed to change it on us. I'm not
1134 		   sure about this */
1135 		/* My guess is that the OWNSSID should always be whatever
1136 		 * we set to the card, whereas CURRENT_SSID is the one that
1137 		 * may change... - Jean II */
1138 		u16 rid;
1139 
1140 		*active = 1;
1141 
1142 		rid = (priv->port_type == 3) ? HERMES_RID_CNFOWNSSID :
1143 			HERMES_RID_CNFDESIREDSSID;
1144 
1145 		err = hw->ops->read_ltv(hw, USER_BAP, rid, sizeof(essidbuf),
1146 					NULL, &essidbuf);
1147 		if (err)
1148 			goto fail_unlock;
1149 	} else {
1150 		*active = 0;
1151 
1152 		err = hw->ops->read_ltv(hw, USER_BAP, HERMES_RID_CURRENTSSID,
1153 					sizeof(essidbuf), NULL, &essidbuf);
1154 		if (err)
1155 			goto fail_unlock;
1156 	}
1157 
1158 	len = le16_to_cpu(essidbuf.len);
1159 	BUG_ON(len > IW_ESSID_MAX_SIZE);
1160 
1161 	memset(buf, 0, IW_ESSID_MAX_SIZE);
1162 	memcpy(buf, p, len);
1163 	err = len;
1164 
1165  fail_unlock:
1166 	orinoco_unlock(priv, &flags);
1167 
1168 	return err;
1169 }
1170 
1171 int orinoco_hw_get_freq(struct orinoco_private *priv)
1172 {
1173 	struct hermes *hw = &priv->hw;
1174 	int err = 0;
1175 	u16 channel;
1176 	int freq = 0;
1177 	unsigned long flags;
1178 
1179 	if (orinoco_lock(priv, &flags) != 0)
1180 		return -EBUSY;
1181 
1182 	err = hermes_read_wordrec(hw, USER_BAP, HERMES_RID_CURRENTCHANNEL,
1183 				  &channel);
1184 	if (err)
1185 		goto out;
1186 
1187 	/* Intersil firmware 1.3.5 returns 0 when the interface is down */
1188 	if (channel == 0) {
1189 		err = -EBUSY;
1190 		goto out;
1191 	}
1192 
1193 	if ((channel < 1) || (channel > NUM_CHANNELS)) {
1194 		printk(KERN_WARNING "%s: Channel out of range (%d)!\n",
1195 		       priv->ndev->name, channel);
1196 		err = -EBUSY;
1197 		goto out;
1198 
1199 	}
1200 	freq = ieee80211_channel_to_frequency(channel, NL80211_BAND_2GHZ);
1201 
1202  out:
1203 	orinoco_unlock(priv, &flags);
1204 
1205 	if (err > 0)
1206 		err = -EBUSY;
1207 	return err ? err : freq;
1208 }
1209 
1210 int orinoco_hw_get_bitratelist(struct orinoco_private *priv,
1211 			       int *numrates, s32 *rates, int max)
1212 {
1213 	struct hermes *hw = &priv->hw;
1214 	struct hermes_idstring list;
1215 	unsigned char *p = (unsigned char *)&list.val;
1216 	int err = 0;
1217 	int num;
1218 	int i;
1219 	unsigned long flags;
1220 
1221 	if (orinoco_lock(priv, &flags) != 0)
1222 		return -EBUSY;
1223 
1224 	err = hw->ops->read_ltv(hw, USER_BAP, HERMES_RID_SUPPORTEDDATARATES,
1225 				sizeof(list), NULL, &list);
1226 	orinoco_unlock(priv, &flags);
1227 
1228 	if (err)
1229 		return err;
1230 
1231 	num = le16_to_cpu(list.len);
1232 	*numrates = num;
1233 	num = min(num, max);
1234 
1235 	for (i = 0; i < num; i++)
1236 		rates[i] = (p[i] & 0x7f) * 500000; /* convert to bps */
1237 
1238 	return 0;
1239 }
1240 
1241 int orinoco_hw_trigger_scan(struct orinoco_private *priv,
1242 			    const struct cfg80211_ssid *ssid)
1243 {
1244 	struct net_device *dev = priv->ndev;
1245 	struct hermes *hw = &priv->hw;
1246 	unsigned long flags;
1247 	int err = 0;
1248 
1249 	if (orinoco_lock(priv, &flags) != 0)
1250 		return -EBUSY;
1251 
1252 	/* Scanning with port 0 disabled would fail */
1253 	if (!netif_running(dev)) {
1254 		err = -ENETDOWN;
1255 		goto out;
1256 	}
1257 
1258 	/* In monitor mode, the scan results are always empty.
1259 	 * Probe responses are passed to the driver as received
1260 	 * frames and could be processed in software. */
1261 	if (priv->iw_mode == NL80211_IFTYPE_MONITOR) {
1262 		err = -EOPNOTSUPP;
1263 		goto out;
1264 	}
1265 
1266 	if (priv->has_hostscan) {
1267 		switch (priv->firmware_type) {
1268 		case FIRMWARE_TYPE_SYMBOL:
1269 			err = hermes_write_wordrec(hw, USER_BAP,
1270 						HERMES_RID_CNFHOSTSCAN_SYMBOL,
1271 						HERMES_HOSTSCAN_SYMBOL_ONCE |
1272 						HERMES_HOSTSCAN_SYMBOL_BCAST);
1273 			break;
1274 		case FIRMWARE_TYPE_INTERSIL: {
1275 			__le16 req[3];
1276 
1277 			req[0] = cpu_to_le16(0x3fff);	/* All channels */
1278 			req[1] = cpu_to_le16(0x0001);	/* rate 1 Mbps */
1279 			req[2] = 0;			/* Any ESSID */
1280 			err = HERMES_WRITE_RECORD(hw, USER_BAP,
1281 						  HERMES_RID_CNFHOSTSCAN, &req);
1282 			break;
1283 		}
1284 		case FIRMWARE_TYPE_AGERE:
1285 			if (ssid->ssid_len > 0) {
1286 				struct hermes_idstring idbuf;
1287 				size_t len = ssid->ssid_len;
1288 
1289 				idbuf.len = cpu_to_le16(len);
1290 				memcpy(idbuf.val, ssid->ssid, len);
1291 
1292 				err = hw->ops->write_ltv(hw, USER_BAP,
1293 					       HERMES_RID_CNFSCANSSID_AGERE,
1294 					       HERMES_BYTES_TO_RECLEN(len + 2),
1295 					       &idbuf);
1296 			} else
1297 				err = hermes_write_wordrec(hw, USER_BAP,
1298 						   HERMES_RID_CNFSCANSSID_AGERE,
1299 						   0);	/* Any ESSID */
1300 			if (err)
1301 				break;
1302 
1303 			if (priv->has_ext_scan) {
1304 				err = hermes_write_wordrec(hw, USER_BAP,
1305 						HERMES_RID_CNFSCANCHANNELS2GHZ,
1306 						0x7FFF);
1307 				if (err)
1308 					goto out;
1309 
1310 				err = hermes_inquire(hw,
1311 						     HERMES_INQ_CHANNELINFO);
1312 			} else
1313 				err = hermes_inquire(hw, HERMES_INQ_SCAN);
1314 
1315 			break;
1316 		}
1317 	} else
1318 		err = hermes_inquire(hw, HERMES_INQ_SCAN);
1319 
1320  out:
1321 	orinoco_unlock(priv, &flags);
1322 
1323 	return err;
1324 }
1325 
1326 /* Disassociate from node with BSSID addr */
1327 int orinoco_hw_disassociate(struct orinoco_private *priv,
1328 			    u8 *addr, u16 reason_code)
1329 {
1330 	struct hermes *hw = &priv->hw;
1331 	int err;
1332 
1333 	struct {
1334 		u8 addr[ETH_ALEN];
1335 		__le16 reason_code;
1336 	} __packed buf;
1337 
1338 	/* Currently only supported by WPA enabled Agere fw */
1339 	if (!priv->has_wpa)
1340 		return -EOPNOTSUPP;
1341 
1342 	memcpy(buf.addr, addr, ETH_ALEN);
1343 	buf.reason_code = cpu_to_le16(reason_code);
1344 	err = HERMES_WRITE_RECORD(hw, USER_BAP,
1345 				  HERMES_RID_CNFDISASSOCIATE,
1346 				  &buf);
1347 	return err;
1348 }
1349 
1350 int orinoco_hw_get_current_bssid(struct orinoco_private *priv,
1351 				 u8 *addr)
1352 {
1353 	struct hermes *hw = &priv->hw;
1354 	int err;
1355 
1356 	err = hw->ops->read_ltv(hw, USER_BAP, HERMES_RID_CURRENTBSSID,
1357 				ETH_ALEN, NULL, addr);
1358 
1359 	return err;
1360 }
1361