1 // SPDX-License-Identifier: GPL-2.0-only
2 /*=============================================================================
3  *
4  * A  PCMCIA client driver for the Raylink wireless LAN card.
5  * The starting point for this module was the skeleton.c in the
6  * PCMCIA 2.9.12 package written by David Hinds, dahinds@users.sourceforge.net
7  *
8  * Copyright (c) 1998  Corey Thomas (corey@world.std.com)
9  *
10  * Changes:
11  * Arnaldo Carvalho de Melo <acme@conectiva.com.br> - 08/08/2000
12  * - reorganize kmallocs in ray_attach, checking all for failure
13  *   and releasing the previous allocations if one fails
14  *
15  * Daniele Bellucci <bellucda@tiscali.it> - 07/10/2003
16  * - Audit copy_to_user in ioctl(SIOCGIWESSID)
17  *
18 =============================================================================*/
19 
20 #include <linux/module.h>
21 #include <linux/kernel.h>
22 #include <linux/proc_fs.h>
23 #include <linux/ptrace.h>
24 #include <linux/seq_file.h>
25 #include <linux/string.h>
26 #include <linux/timer.h>
27 #include <linux/init.h>
28 #include <linux/netdevice.h>
29 #include <linux/etherdevice.h>
30 #include <linux/if_arp.h>
31 #include <linux/ioport.h>
32 #include <linux/skbuff.h>
33 #include <linux/ieee80211.h>
34 
35 #include <pcmcia/cistpl.h>
36 #include <pcmcia/cisreg.h>
37 #include <pcmcia/ds.h>
38 
39 #include <linux/wireless.h>
40 #include <net/iw_handler.h>
41 
42 #include <asm/io.h>
43 #include <asm/byteorder.h>
44 #include <linux/uaccess.h>
45 
46 /* Warning : these stuff will slow down the driver... */
47 #define WIRELESS_SPY		/* Enable spying addresses */
48 /* Definitions we need for spy */
49 typedef struct iw_statistics iw_stats;
50 typedef u_char mac_addr[ETH_ALEN];	/* Hardware address */
51 
52 #include "rayctl.h"
53 #include "ray_cs.h"
54 
55 
56 /** Prototypes based on PCMCIA skeleton driver *******************************/
57 static int ray_config(struct pcmcia_device *link);
58 static void ray_release(struct pcmcia_device *link);
59 static void ray_detach(struct pcmcia_device *p_dev);
60 
61 /***** Prototypes indicated by device structure ******************************/
62 static int ray_dev_close(struct net_device *dev);
63 static int ray_dev_config(struct net_device *dev, struct ifmap *map);
64 static struct net_device_stats *ray_get_stats(struct net_device *dev);
65 static int ray_dev_init(struct net_device *dev);
66 
67 static int ray_open(struct net_device *dev);
68 static netdev_tx_t ray_dev_start_xmit(struct sk_buff *skb,
69 					    struct net_device *dev);
70 static void set_multicast_list(struct net_device *dev);
71 static void ray_update_multi_list(struct net_device *dev, int all);
72 static int translate_frame(ray_dev_t *local, struct tx_msg __iomem *ptx,
73 			   unsigned char *data, int len);
74 static void ray_build_header(ray_dev_t *local, struct tx_msg __iomem *ptx,
75 			     UCHAR msg_type, unsigned char *data);
76 static void untranslate(ray_dev_t *local, struct sk_buff *skb, int len);
77 static iw_stats *ray_get_wireless_stats(struct net_device *dev);
78 static const struct iw_handler_def ray_handler_def;
79 
80 /***** Prototypes for raylink functions **************************************/
81 static void authenticate(ray_dev_t *local);
82 static int build_auth_frame(ray_dev_t *local, UCHAR *dest, int auth_type);
83 static void authenticate_timeout(struct timer_list *t);
84 static int get_free_ccs(ray_dev_t *local);
85 static int get_free_tx_ccs(ray_dev_t *local);
86 static void init_startup_params(ray_dev_t *local);
87 static int parse_addr(char *in_str, UCHAR *out);
88 static int ray_hw_xmit(unsigned char *data, int len, struct net_device *dev, UCHAR type);
89 static int ray_init(struct net_device *dev);
90 static int interrupt_ecf(ray_dev_t *local, int ccs);
91 static void ray_reset(struct net_device *dev);
92 static void ray_update_parm(struct net_device *dev, UCHAR objid, UCHAR *value, int len);
93 static void verify_dl_startup(struct timer_list *t);
94 
95 /* Prototypes for interrpt time functions **********************************/
96 static irqreturn_t ray_interrupt(int reg, void *dev_id);
97 static void clear_interrupt(ray_dev_t *local);
98 static void rx_deauthenticate(ray_dev_t *local, struct rcs __iomem *prcs,
99 			      unsigned int pkt_addr, int rx_len);
100 static int copy_from_rx_buff(ray_dev_t *local, UCHAR *dest, int pkt_addr, int len);
101 static void ray_rx(struct net_device *dev, ray_dev_t *local, struct rcs __iomem *prcs);
102 static void release_frag_chain(ray_dev_t *local, struct rcs __iomem *prcs);
103 static void rx_authenticate(ray_dev_t *local, struct rcs __iomem *prcs,
104 			    unsigned int pkt_addr, int rx_len);
105 static void rx_data(struct net_device *dev, struct rcs __iomem *prcs,
106 		    unsigned int pkt_addr, int rx_len);
107 static void associate(ray_dev_t *local);
108 
109 /* Card command functions */
110 static int dl_startup_params(struct net_device *dev);
111 static void join_net(struct timer_list *t);
112 static void start_net(struct timer_list *t);
113 
114 /*===========================================================================*/
115 /* Parameters that can be set with 'insmod' */
116 
117 /* ADHOC=0, Infrastructure=1 */
118 static int net_type = ADHOC;
119 
120 /* Hop dwell time in Kus (1024 us units defined by 802.11) */
121 static int hop_dwell = 128;
122 
123 /* Beacon period in Kus */
124 static int beacon_period = 256;
125 
126 /* power save mode (0 = off, 1 = save power) */
127 static int psm;
128 
129 /* String for network's Extended Service Set ID. 32 Characters max */
130 static char *essid;
131 
132 /* Default to encapsulation unless translation requested */
133 static bool translate = true;
134 
135 static int country = USA;
136 
137 static int sniffer;
138 
139 static int bc;
140 
141 /* 48 bit physical card address if overriding card's real physical
142  * address is required.  Since IEEE 802.11 addresses are 48 bits
143  * like ethernet, an int can't be used, so a string is used. To
144  * allow use of addresses starting with a decimal digit, the first
145  * character must be a letter and will be ignored. This letter is
146  * followed by up to 12 hex digits which are the address.  If less
147  * than 12 digits are used, the address will be left filled with 0's.
148  * Note that bit 0 of the first byte is the broadcast bit, and evil
149  * things will happen if it is not 0 in a card address.
150  */
151 static char *phy_addr = NULL;
152 
153 static unsigned int ray_mem_speed = 500;
154 
155 /* WARNING: THIS DRIVER IS NOT CAPABLE OF HANDLING MULTIPLE DEVICES! */
156 static struct pcmcia_device *this_device = NULL;
157 
158 MODULE_AUTHOR("Corey Thomas <corey@world.std.com>");
159 MODULE_DESCRIPTION("Raylink/WebGear wireless LAN driver");
160 MODULE_LICENSE("GPL");
161 
162 module_param(net_type, int, 0);
163 module_param(hop_dwell, int, 0);
164 module_param(beacon_period, int, 0);
165 module_param(psm, int, 0);
166 module_param(essid, charp, 0);
167 module_param(translate, bool, 0);
168 module_param(country, int, 0);
169 module_param(sniffer, int, 0);
170 module_param(bc, int, 0);
171 module_param(phy_addr, charp, 0);
172 module_param(ray_mem_speed, int, 0);
173 
174 static const UCHAR b5_default_startup_parms[] = {
175 	0, 0,			/* Adhoc station */
176 	'L', 'I', 'N', 'U', 'X', 0, 0, 0,	/* 32 char ESSID */
177 	0, 0, 0, 0, 0, 0, 0, 0,
178 	0, 0, 0, 0, 0, 0, 0, 0,
179 	0, 0, 0, 0, 0, 0, 0, 0,
180 	1, 0,			/* Active scan, CA Mode */
181 	0, 0, 0, 0, 0, 0,	/* No default MAC addr  */
182 	0x7f, 0xff,		/* Frag threshold */
183 	0x00, 0x80,		/* Hop time 128 Kus */
184 	0x01, 0x00,		/* Beacon period 256 Kus */
185 	0x01, 0x07, 0xa3,	/* DTIM, retries, ack timeout */
186 	0x1d, 0x82, 0x4e,	/* SIFS, DIFS, PIFS */
187 	0x7f, 0xff,		/* RTS threshold */
188 	0x04, 0xe2, 0x38, 0xA4,	/* scan_dwell, max_scan_dwell */
189 	0x05,			/* assoc resp timeout thresh */
190 	0x08, 0x02, 0x08,	/* adhoc, infra, super cycle max */
191 	0,			/* Promiscuous mode */
192 	0x0c, 0x0bd,		/* Unique word */
193 	0x32,			/* Slot time */
194 	0xff, 0xff,		/* roam-low snr, low snr count */
195 	0x05, 0xff,		/* Infra, adhoc missed bcn thresh */
196 	0x01, 0x0b, 0x4f,	/* USA, hop pattern, hop pat length */
197 /* b4 - b5 differences start here */
198 	0x00, 0x3f,		/* CW max */
199 	0x00, 0x0f,		/* CW min */
200 	0x04, 0x08,		/* Noise gain, limit offset */
201 	0x28, 0x28,		/* det rssi, med busy offsets */
202 	7,			/* det sync thresh */
203 	0, 2, 2,		/* test mode, min, max */
204 	0,			/* allow broadcast SSID probe resp */
205 	0, 0,			/* privacy must start, can join */
206 	2, 0, 0, 0, 0, 0, 0, 0	/* basic rate set */
207 };
208 
209 static const UCHAR b4_default_startup_parms[] = {
210 	0, 0,			/* Adhoc station */
211 	'L', 'I', 'N', 'U', 'X', 0, 0, 0,	/* 32 char ESSID */
212 	0, 0, 0, 0, 0, 0, 0, 0,
213 	0, 0, 0, 0, 0, 0, 0, 0,
214 	0, 0, 0, 0, 0, 0, 0, 0,
215 	1, 0,			/* Active scan, CA Mode */
216 	0, 0, 0, 0, 0, 0,	/* No default MAC addr  */
217 	0x7f, 0xff,		/* Frag threshold */
218 	0x02, 0x00,		/* Hop time */
219 	0x00, 0x01,		/* Beacon period */
220 	0x01, 0x07, 0xa3,	/* DTIM, retries, ack timeout */
221 	0x1d, 0x82, 0xce,	/* SIFS, DIFS, PIFS */
222 	0x7f, 0xff,		/* RTS threshold */
223 	0xfb, 0x1e, 0xc7, 0x5c,	/* scan_dwell, max_scan_dwell */
224 	0x05,			/* assoc resp timeout thresh */
225 	0x04, 0x02, 0x4,	/* adhoc, infra, super cycle max */
226 	0,			/* Promiscuous mode */
227 	0x0c, 0x0bd,		/* Unique word */
228 	0x4e,			/* Slot time (TBD seems wrong) */
229 	0xff, 0xff,		/* roam-low snr, low snr count */
230 	0x05, 0xff,		/* Infra, adhoc missed bcn thresh */
231 	0x01, 0x0b, 0x4e,	/* USA, hop pattern, hop pat length */
232 /* b4 - b5 differences start here */
233 	0x3f, 0x0f,		/* CW max, min */
234 	0x04, 0x08,		/* Noise gain, limit offset */
235 	0x28, 0x28,		/* det rssi, med busy offsets */
236 	7,			/* det sync thresh */
237 	0, 2, 2,		/* test mode, min, max */
238 	0,			/* rx/tx delay */
239 	0, 0, 0, 0, 0, 0,	/* current BSS id */
240 	0			/* hop set */
241 };
242 
243 /*===========================================================================*/
244 static const u8 eth2_llc[] = { 0xaa, 0xaa, 3, 0, 0, 0 };
245 
246 static const char hop_pattern_length[] = { 1,
247 	USA_HOP_MOD, EUROPE_HOP_MOD,
248 	JAPAN_HOP_MOD, KOREA_HOP_MOD,
249 	SPAIN_HOP_MOD, FRANCE_HOP_MOD,
250 	ISRAEL_HOP_MOD, AUSTRALIA_HOP_MOD,
251 	JAPAN_TEST_HOP_MOD
252 };
253 
254 static const char rcsid[] =
255     "Raylink/WebGear wireless LAN - Corey <Thomas corey@world.std.com>";
256 
257 static const struct net_device_ops ray_netdev_ops = {
258 	.ndo_init 		= ray_dev_init,
259 	.ndo_open 		= ray_open,
260 	.ndo_stop 		= ray_dev_close,
261 	.ndo_start_xmit		= ray_dev_start_xmit,
262 	.ndo_set_config		= ray_dev_config,
263 	.ndo_get_stats		= ray_get_stats,
264 	.ndo_set_rx_mode	= set_multicast_list,
265 	.ndo_set_mac_address 	= eth_mac_addr,
266 	.ndo_validate_addr	= eth_validate_addr,
267 };
268 
ray_probe(struct pcmcia_device * p_dev)269 static int ray_probe(struct pcmcia_device *p_dev)
270 {
271 	ray_dev_t *local;
272 	struct net_device *dev;
273 	int ret;
274 
275 	dev_dbg(&p_dev->dev, "ray_attach()\n");
276 
277 	/* Allocate space for private device-specific data */
278 	dev = alloc_etherdev(sizeof(ray_dev_t));
279 	if (!dev)
280 		return -ENOMEM;
281 
282 	local = netdev_priv(dev);
283 	local->finder = p_dev;
284 
285 	/* The io structure describes IO port mapping. None used here */
286 	p_dev->resource[0]->end = 0;
287 	p_dev->resource[0]->flags |= IO_DATA_PATH_WIDTH_8;
288 
289 	/* General socket configuration */
290 	p_dev->config_flags |= CONF_ENABLE_IRQ;
291 	p_dev->config_index = 1;
292 
293 	p_dev->priv = dev;
294 
295 	local->finder = p_dev;
296 	local->card_status = CARD_INSERTED;
297 	local->authentication_state = UNAUTHENTICATED;
298 	local->num_multi = 0;
299 	dev_dbg(&p_dev->dev, "ray_attach p_dev = %p,  dev = %p,  local = %p, intr = %p\n",
300 	      p_dev, dev, local, &ray_interrupt);
301 
302 	/* Raylink entries in the device structure */
303 	dev->netdev_ops = &ray_netdev_ops;
304 	dev->wireless_handlers = &ray_handler_def;
305 #ifdef WIRELESS_SPY
306 	local->wireless_data.spy_data = &local->spy_data;
307 	dev->wireless_data = &local->wireless_data;
308 #endif /* WIRELESS_SPY */
309 
310 
311 	dev_dbg(&p_dev->dev, "ray_cs ray_attach calling ether_setup.)\n");
312 	netif_stop_queue(dev);
313 
314 	timer_setup(&local->timer, NULL, 0);
315 
316 	this_device = p_dev;
317 	ret = ray_config(p_dev);
318 	if (ret)
319 		goto err_free_dev;
320 
321 	return 0;
322 
323 err_free_dev:
324 	free_netdev(dev);
325 	return ret;
326 }
327 
ray_detach(struct pcmcia_device * link)328 static void ray_detach(struct pcmcia_device *link)
329 {
330 	struct net_device *dev;
331 
332 	dev_dbg(&link->dev, "ray_detach\n");
333 
334 	this_device = NULL;
335 	dev = link->priv;
336 
337 	ray_release(link);
338 
339 	if (link->priv) {
340 		unregister_netdev(dev);
341 		free_netdev(dev);
342 	}
343 	dev_dbg(&link->dev, "ray_cs ray_detach ending\n");
344 } /* ray_detach */
345 
346 #define MAX_TUPLE_SIZE 128
ray_config(struct pcmcia_device * link)347 static int ray_config(struct pcmcia_device *link)
348 {
349 	int ret = 0;
350 	int i;
351 	struct net_device *dev = (struct net_device *)link->priv;
352 	ray_dev_t *local = netdev_priv(dev);
353 
354 	dev_dbg(&link->dev, "ray_config\n");
355 
356 	/* Determine card type and firmware version */
357 	printk(KERN_INFO "ray_cs Detected: %s%s%s%s\n",
358 	       link->prod_id[0] ? link->prod_id[0] : " ",
359 	       link->prod_id[1] ? link->prod_id[1] : " ",
360 	       link->prod_id[2] ? link->prod_id[2] : " ",
361 	       link->prod_id[3] ? link->prod_id[3] : " ");
362 
363 	/* Now allocate an interrupt line.  Note that this does not
364 	   actually assign a handler to the interrupt.
365 	 */
366 	ret = pcmcia_request_irq(link, ray_interrupt);
367 	if (ret)
368 		goto failed;
369 	dev->irq = link->irq;
370 
371 	ret = pcmcia_enable_device(link);
372 	if (ret)
373 		goto failed;
374 
375 /*** Set up 32k window for shared memory (transmit and control) ************/
376 	link->resource[2]->flags |= WIN_DATA_WIDTH_8 | WIN_MEMORY_TYPE_CM | WIN_ENABLE | WIN_USE_WAIT;
377 	link->resource[2]->start = 0;
378 	link->resource[2]->end = 0x8000;
379 	ret = pcmcia_request_window(link, link->resource[2], ray_mem_speed);
380 	if (ret)
381 		goto failed;
382 	ret = pcmcia_map_mem_page(link, link->resource[2], 0);
383 	if (ret)
384 		goto failed;
385 	local->sram = ioremap(link->resource[2]->start,
386 			resource_size(link->resource[2]));
387 	if (!local->sram)
388 		goto failed;
389 
390 /*** Set up 16k window for shared memory (receive buffer) ***************/
391 	link->resource[3]->flags |=
392 	    WIN_DATA_WIDTH_8 | WIN_MEMORY_TYPE_CM | WIN_ENABLE | WIN_USE_WAIT;
393 	link->resource[3]->start = 0;
394 	link->resource[3]->end = 0x4000;
395 	ret = pcmcia_request_window(link, link->resource[3], ray_mem_speed);
396 	if (ret)
397 		goto failed;
398 	ret = pcmcia_map_mem_page(link, link->resource[3], 0x8000);
399 	if (ret)
400 		goto failed;
401 	local->rmem = ioremap(link->resource[3]->start,
402 			resource_size(link->resource[3]));
403 	if (!local->rmem)
404 		goto failed;
405 
406 /*** Set up window for attribute memory ***********************************/
407 	link->resource[4]->flags |=
408 	    WIN_DATA_WIDTH_8 | WIN_MEMORY_TYPE_AM | WIN_ENABLE | WIN_USE_WAIT;
409 	link->resource[4]->start = 0;
410 	link->resource[4]->end = 0x1000;
411 	ret = pcmcia_request_window(link, link->resource[4], ray_mem_speed);
412 	if (ret)
413 		goto failed;
414 	ret = pcmcia_map_mem_page(link, link->resource[4], 0);
415 	if (ret)
416 		goto failed;
417 	local->amem = ioremap(link->resource[4]->start,
418 			resource_size(link->resource[4]));
419 	if (!local->amem)
420 		goto failed;
421 
422 	dev_dbg(&link->dev, "ray_config sram=%p\n", local->sram);
423 	dev_dbg(&link->dev, "ray_config rmem=%p\n", local->rmem);
424 	dev_dbg(&link->dev, "ray_config amem=%p\n", local->amem);
425 	if (ray_init(dev) < 0) {
426 		ray_release(link);
427 		return -ENODEV;
428 	}
429 
430 	SET_NETDEV_DEV(dev, &link->dev);
431 	i = register_netdev(dev);
432 	if (i != 0) {
433 		printk("ray_config register_netdev() failed\n");
434 		ray_release(link);
435 		return i;
436 	}
437 
438 	printk(KERN_INFO "%s: RayLink, irq %d, hw_addr %pM\n",
439 	       dev->name, dev->irq, dev->dev_addr);
440 
441 	return 0;
442 
443 failed:
444 	ray_release(link);
445 	return -ENODEV;
446 } /* ray_config */
447 
ccs_base(ray_dev_t * dev)448 static inline struct ccs __iomem *ccs_base(ray_dev_t *dev)
449 {
450 	return dev->sram + CCS_BASE;
451 }
452 
rcs_base(ray_dev_t * dev)453 static inline struct rcs __iomem *rcs_base(ray_dev_t *dev)
454 {
455 	/*
456 	 * This looks nonsensical, since there is a separate
457 	 * RCS_BASE. But the difference between a "struct rcs"
458 	 * and a "struct ccs" ends up being in the _index_ off
459 	 * the base, so the base pointer is the same for both
460 	 * ccs/rcs.
461 	 */
462 	return dev->sram + CCS_BASE;
463 }
464 
465 /*===========================================================================*/
ray_init(struct net_device * dev)466 static int ray_init(struct net_device *dev)
467 {
468 	int i;
469 	struct ccs __iomem *pccs;
470 	ray_dev_t *local = netdev_priv(dev);
471 	struct pcmcia_device *link = local->finder;
472 	dev_dbg(&link->dev, "ray_init(0x%p)\n", dev);
473 	if (!(pcmcia_dev_present(link))) {
474 		dev_dbg(&link->dev, "ray_init - device not present\n");
475 		return -1;
476 	}
477 
478 	local->net_type = net_type;
479 	local->sta_type = TYPE_STA;
480 
481 	/* Copy the startup results to local memory */
482 	memcpy_fromio(&local->startup_res, local->sram + ECF_TO_HOST_BASE,
483 		      sizeof(struct startup_res_6));
484 
485 	/* Check Power up test status and get mac address from card */
486 	if (local->startup_res.startup_word != 0x80) {
487 		printk(KERN_INFO "ray_init ERROR card status = %2x\n",
488 		       local->startup_res.startup_word);
489 		local->card_status = CARD_INIT_ERROR;
490 		return -1;
491 	}
492 
493 	local->fw_ver = local->startup_res.firmware_version[0];
494 	local->fw_bld = local->startup_res.firmware_version[1];
495 	local->fw_var = local->startup_res.firmware_version[2];
496 	dev_dbg(&link->dev, "ray_init firmware version %d.%d\n", local->fw_ver,
497 	      local->fw_bld);
498 
499 	local->tib_length = 0x20;
500 	if ((local->fw_ver == 5) && (local->fw_bld >= 30))
501 		local->tib_length = local->startup_res.tib_length;
502 	dev_dbg(&link->dev, "ray_init tib_length = 0x%02x\n", local->tib_length);
503 	/* Initialize CCS's to buffer free state */
504 	pccs = ccs_base(local);
505 	for (i = 0; i < NUMBER_OF_CCS; i++) {
506 		writeb(CCS_BUFFER_FREE, &(pccs++)->buffer_status);
507 	}
508 	init_startup_params(local);
509 
510 	/* copy mac address to startup parameters */
511 	if (!parse_addr(phy_addr, local->sparm.b4.a_mac_addr)) {
512 		memcpy(&local->sparm.b4.a_mac_addr,
513 		       &local->startup_res.station_addr, ADDRLEN);
514 	}
515 
516 	clear_interrupt(local);	/* Clear any interrupt from the card */
517 	local->card_status = CARD_AWAITING_PARAM;
518 	dev_dbg(&link->dev, "ray_init ending\n");
519 	return 0;
520 } /* ray_init */
521 
522 /*===========================================================================*/
523 /* Download startup parameters to the card and command it to read them       */
dl_startup_params(struct net_device * dev)524 static int dl_startup_params(struct net_device *dev)
525 {
526 	int ccsindex;
527 	ray_dev_t *local = netdev_priv(dev);
528 	struct ccs __iomem *pccs;
529 	struct pcmcia_device *link = local->finder;
530 
531 	dev_dbg(&link->dev, "dl_startup_params entered\n");
532 	if (!(pcmcia_dev_present(link))) {
533 		dev_dbg(&link->dev, "ray_cs dl_startup_params - device not present\n");
534 		return -1;
535 	}
536 
537 	/* Copy parameters to host to ECF area */
538 	if (local->fw_ver == 0x55)
539 		memcpy_toio(local->sram + HOST_TO_ECF_BASE, &local->sparm.b4,
540 			    sizeof(struct b4_startup_params));
541 	else
542 		memcpy_toio(local->sram + HOST_TO_ECF_BASE, &local->sparm.b5,
543 			    sizeof(struct b5_startup_params));
544 
545 	/* Fill in the CCS fields for the ECF */
546 	if ((ccsindex = get_free_ccs(local)) < 0)
547 		return -1;
548 	local->dl_param_ccs = ccsindex;
549 	pccs = ccs_base(local) + ccsindex;
550 	writeb(CCS_DOWNLOAD_STARTUP_PARAMS, &pccs->cmd);
551 	dev_dbg(&link->dev, "dl_startup_params start ccsindex = %d\n",
552 	      local->dl_param_ccs);
553 	/* Interrupt the firmware to process the command */
554 	if (interrupt_ecf(local, ccsindex)) {
555 		printk(KERN_INFO "ray dl_startup_params failed - "
556 		       "ECF not ready for intr\n");
557 		local->card_status = CARD_DL_PARAM_ERROR;
558 		writeb(CCS_BUFFER_FREE, &(pccs++)->buffer_status);
559 		return -2;
560 	}
561 	local->card_status = CARD_DL_PARAM;
562 	/* Start kernel timer to wait for dl startup to complete. */
563 	local->timer.expires = jiffies + HZ / 2;
564 	local->timer.function = verify_dl_startup;
565 	add_timer(&local->timer);
566 	dev_dbg(&link->dev,
567 	      "ray_cs dl_startup_params started timer for verify_dl_startup\n");
568 	return 0;
569 } /* dl_startup_params */
570 
571 /*===========================================================================*/
init_startup_params(ray_dev_t * local)572 static void init_startup_params(ray_dev_t *local)
573 {
574 	int i;
575 
576 	if (country > JAPAN_TEST)
577 		country = USA;
578 	else if (country < USA)
579 		country = USA;
580 	/* structure for hop time and beacon period is defined here using
581 	 * New 802.11D6.1 format.  Card firmware is still using old format
582 	 * until version 6.
583 	 *    Before                    After
584 	 *    a_hop_time ms byte        a_hop_time ms byte
585 	 *    a_hop_time 2s byte        a_hop_time ls byte
586 	 *    a_hop_time ls byte        a_beacon_period ms byte
587 	 *    a_beacon_period           a_beacon_period ls byte
588 	 *
589 	 *    a_hop_time = uS           a_hop_time = KuS
590 	 *    a_beacon_period = hops    a_beacon_period = KuS
591 	 *//* 64ms = 010000 */
592 	if (local->fw_ver == 0x55) {
593 		memcpy(&local->sparm.b4, b4_default_startup_parms,
594 		       sizeof(struct b4_startup_params));
595 		/* Translate sane kus input values to old build 4/5 format */
596 		/* i = hop time in uS truncated to 3 bytes */
597 		i = (hop_dwell * 1024) & 0xffffff;
598 		local->sparm.b4.a_hop_time[0] = (i >> 16) & 0xff;
599 		local->sparm.b4.a_hop_time[1] = (i >> 8) & 0xff;
600 		local->sparm.b4.a_beacon_period[0] = 0;
601 		local->sparm.b4.a_beacon_period[1] =
602 		    ((beacon_period / hop_dwell) - 1) & 0xff;
603 		local->sparm.b4.a_curr_country_code = country;
604 		local->sparm.b4.a_hop_pattern_length =
605 		    hop_pattern_length[(int)country] - 1;
606 		if (bc) {
607 			local->sparm.b4.a_ack_timeout = 0x50;
608 			local->sparm.b4.a_sifs = 0x3f;
609 		}
610 	} else { /* Version 5 uses real kus values */
611 		memcpy((UCHAR *) &local->sparm.b5, b5_default_startup_parms,
612 		       sizeof(struct b5_startup_params));
613 
614 		local->sparm.b5.a_hop_time[0] = (hop_dwell >> 8) & 0xff;
615 		local->sparm.b5.a_hop_time[1] = hop_dwell & 0xff;
616 		local->sparm.b5.a_beacon_period[0] =
617 		    (beacon_period >> 8) & 0xff;
618 		local->sparm.b5.a_beacon_period[1] = beacon_period & 0xff;
619 		if (psm)
620 			local->sparm.b5.a_power_mgt_state = 1;
621 		local->sparm.b5.a_curr_country_code = country;
622 		local->sparm.b5.a_hop_pattern_length =
623 		    hop_pattern_length[(int)country];
624 	}
625 
626 	local->sparm.b4.a_network_type = net_type & 0x01;
627 	local->sparm.b4.a_acting_as_ap_status = TYPE_STA;
628 
629 	if (essid != NULL)
630 		strscpy(local->sparm.b4.a_current_ess_id, essid, ESSID_SIZE);
631 } /* init_startup_params */
632 
633 /*===========================================================================*/
verify_dl_startup(struct timer_list * t)634 static void verify_dl_startup(struct timer_list *t)
635 {
636 	ray_dev_t *local = from_timer(local, t, timer);
637 	struct ccs __iomem *pccs = ccs_base(local) + local->dl_param_ccs;
638 	UCHAR status;
639 	struct pcmcia_device *link = local->finder;
640 
641 	if (!(pcmcia_dev_present(link))) {
642 		dev_dbg(&link->dev, "ray_cs verify_dl_startup - device not present\n");
643 		return;
644 	}
645 #if 0
646 	{
647 		int i;
648 		printk(KERN_DEBUG
649 		       "verify_dl_startup parameters sent via ccs %d:\n",
650 		       local->dl_param_ccs);
651 		for (i = 0; i < sizeof(struct b5_startup_params); i++) {
652 			printk(" %2x",
653 			       (unsigned int)readb(local->sram +
654 						   HOST_TO_ECF_BASE + i));
655 		}
656 		printk("\n");
657 	}
658 #endif
659 
660 	status = readb(&pccs->buffer_status);
661 	if (status != CCS_BUFFER_FREE) {
662 		printk(KERN_INFO
663 		       "Download startup params failed.  Status = %d\n",
664 		       status);
665 		local->card_status = CARD_DL_PARAM_ERROR;
666 		return;
667 	}
668 	if (local->sparm.b4.a_network_type == ADHOC)
669 		start_net(&local->timer);
670 	else
671 		join_net(&local->timer);
672 } /* end verify_dl_startup */
673 
674 /*===========================================================================*/
675 /* Command card to start a network */
start_net(struct timer_list * t)676 static void start_net(struct timer_list *t)
677 {
678 	ray_dev_t *local = from_timer(local, t, timer);
679 	struct ccs __iomem *pccs;
680 	int ccsindex;
681 	struct pcmcia_device *link = local->finder;
682 	if (!(pcmcia_dev_present(link))) {
683 		dev_dbg(&link->dev, "ray_cs start_net - device not present\n");
684 		return;
685 	}
686 	/* Fill in the CCS fields for the ECF */
687 	if ((ccsindex = get_free_ccs(local)) < 0)
688 		return;
689 	pccs = ccs_base(local) + ccsindex;
690 	writeb(CCS_START_NETWORK, &pccs->cmd);
691 	writeb(0, &pccs->var.start_network.update_param);
692 	/* Interrupt the firmware to process the command */
693 	if (interrupt_ecf(local, ccsindex)) {
694 		dev_dbg(&link->dev, "ray start net failed - card not ready for intr\n");
695 		writeb(CCS_BUFFER_FREE, &(pccs++)->buffer_status);
696 		return;
697 	}
698 	local->card_status = CARD_DOING_ACQ;
699 } /* end start_net */
700 
701 /*===========================================================================*/
702 /* Command card to join a network */
join_net(struct timer_list * t)703 static void join_net(struct timer_list *t)
704 {
705 	ray_dev_t *local = from_timer(local, t, timer);
706 
707 	struct ccs __iomem *pccs;
708 	int ccsindex;
709 	struct pcmcia_device *link = local->finder;
710 
711 	if (!(pcmcia_dev_present(link))) {
712 		dev_dbg(&link->dev, "ray_cs join_net - device not present\n");
713 		return;
714 	}
715 	/* Fill in the CCS fields for the ECF */
716 	if ((ccsindex = get_free_ccs(local)) < 0)
717 		return;
718 	pccs = ccs_base(local) + ccsindex;
719 	writeb(CCS_JOIN_NETWORK, &pccs->cmd);
720 	writeb(0, &pccs->var.join_network.update_param);
721 	writeb(0, &pccs->var.join_network.net_initiated);
722 	/* Interrupt the firmware to process the command */
723 	if (interrupt_ecf(local, ccsindex)) {
724 		dev_dbg(&link->dev, "ray join net failed - card not ready for intr\n");
725 		writeb(CCS_BUFFER_FREE, &(pccs++)->buffer_status);
726 		return;
727 	}
728 	local->card_status = CARD_DOING_ACQ;
729 }
730 
731 
ray_release(struct pcmcia_device * link)732 static void ray_release(struct pcmcia_device *link)
733 {
734 	struct net_device *dev = link->priv;
735 	ray_dev_t *local = netdev_priv(dev);
736 
737 	dev_dbg(&link->dev, "ray_release\n");
738 
739 	del_timer_sync(&local->timer);
740 
741 	if (local->sram)
742 		iounmap(local->sram);
743 	if (local->rmem)
744 		iounmap(local->rmem);
745 	if (local->amem)
746 		iounmap(local->amem);
747 	pcmcia_disable_device(link);
748 
749 	dev_dbg(&link->dev, "ray_release ending\n");
750 }
751 
ray_suspend(struct pcmcia_device * link)752 static int ray_suspend(struct pcmcia_device *link)
753 {
754 	struct net_device *dev = link->priv;
755 
756 	if (link->open)
757 		netif_device_detach(dev);
758 
759 	return 0;
760 }
761 
ray_resume(struct pcmcia_device * link)762 static int ray_resume(struct pcmcia_device *link)
763 {
764 	struct net_device *dev = link->priv;
765 
766 	if (link->open) {
767 		ray_reset(dev);
768 		netif_device_attach(dev);
769 	}
770 
771 	return 0;
772 }
773 
774 /*===========================================================================*/
ray_dev_init(struct net_device * dev)775 static int ray_dev_init(struct net_device *dev)
776 {
777 #ifdef RAY_IMMEDIATE_INIT
778 	int i;
779 #endif /* RAY_IMMEDIATE_INIT */
780 	ray_dev_t *local = netdev_priv(dev);
781 	struct pcmcia_device *link = local->finder;
782 
783 	dev_dbg(&link->dev, "ray_dev_init(dev=%p)\n", dev);
784 	if (!(pcmcia_dev_present(link))) {
785 		dev_dbg(&link->dev, "ray_dev_init - device not present\n");
786 		return -1;
787 	}
788 #ifdef RAY_IMMEDIATE_INIT
789 	/* Download startup parameters */
790 	if ((i = dl_startup_params(dev)) < 0) {
791 		printk(KERN_INFO "ray_dev_init dl_startup_params failed - "
792 		       "returns 0x%x\n", i);
793 		return -1;
794 	}
795 #else /* RAY_IMMEDIATE_INIT */
796 	/* Postpone the card init so that we can still configure the card,
797 	 * for example using the Wireless Extensions. The init will happen
798 	 * in ray_open() - Jean II */
799 	dev_dbg(&link->dev,
800 	      "ray_dev_init: postponing card init to ray_open() ; Status = %d\n",
801 	      local->card_status);
802 #endif /* RAY_IMMEDIATE_INIT */
803 
804 	/* copy mac and broadcast addresses to linux device */
805 	eth_hw_addr_set(dev, local->sparm.b4.a_mac_addr);
806 	eth_broadcast_addr(dev->broadcast);
807 
808 	dev_dbg(&link->dev, "ray_dev_init ending\n");
809 	return 0;
810 }
811 
812 /*===========================================================================*/
ray_dev_config(struct net_device * dev,struct ifmap * map)813 static int ray_dev_config(struct net_device *dev, struct ifmap *map)
814 {
815 	ray_dev_t *local = netdev_priv(dev);
816 	struct pcmcia_device *link = local->finder;
817 	/* Dummy routine to satisfy device structure */
818 	dev_dbg(&link->dev, "ray_dev_config(dev=%p,ifmap=%p)\n", dev, map);
819 	if (!(pcmcia_dev_present(link))) {
820 		dev_dbg(&link->dev, "ray_dev_config - device not present\n");
821 		return -1;
822 	}
823 
824 	return 0;
825 }
826 
827 /*===========================================================================*/
ray_dev_start_xmit(struct sk_buff * skb,struct net_device * dev)828 static netdev_tx_t ray_dev_start_xmit(struct sk_buff *skb,
829 					    struct net_device *dev)
830 {
831 	ray_dev_t *local = netdev_priv(dev);
832 	struct pcmcia_device *link = local->finder;
833 	short length = skb->len;
834 
835 	if (!pcmcia_dev_present(link)) {
836 		dev_dbg(&link->dev, "ray_dev_start_xmit - device not present\n");
837 		dev_kfree_skb(skb);
838 		return NETDEV_TX_OK;
839 	}
840 
841 	dev_dbg(&link->dev, "ray_dev_start_xmit(skb=%p, dev=%p)\n", skb, dev);
842 	if (local->authentication_state == NEED_TO_AUTH) {
843 		dev_dbg(&link->dev, "ray_cs Sending authentication request.\n");
844 		if (!build_auth_frame(local, local->auth_id, OPEN_AUTH_REQUEST)) {
845 			local->authentication_state = AUTHENTICATED;
846 			netif_stop_queue(dev);
847 			return NETDEV_TX_BUSY;
848 		}
849 	}
850 
851 	if (length < ETH_ZLEN) {
852 		if (skb_padto(skb, ETH_ZLEN))
853 			return NETDEV_TX_OK;
854 		length = ETH_ZLEN;
855 	}
856 	switch (ray_hw_xmit(skb->data, length, dev, DATA_TYPE)) {
857 	case XMIT_NO_CCS:
858 	case XMIT_NEED_AUTH:
859 		netif_stop_queue(dev);
860 		return NETDEV_TX_BUSY;
861 	case XMIT_NO_INTR:
862 	case XMIT_MSG_BAD:
863 	case XMIT_OK:
864 	default:
865 		dev_kfree_skb(skb);
866 	}
867 
868 	return NETDEV_TX_OK;
869 } /* ray_dev_start_xmit */
870 
871 /*===========================================================================*/
ray_hw_xmit(unsigned char * data,int len,struct net_device * dev,UCHAR msg_type)872 static int ray_hw_xmit(unsigned char *data, int len, struct net_device *dev,
873 		       UCHAR msg_type)
874 {
875 	ray_dev_t *local = netdev_priv(dev);
876 	struct ccs __iomem *pccs;
877 	int ccsindex;
878 	int offset;
879 	struct tx_msg __iomem *ptx;	/* Address of xmit buffer in PC space */
880 	short int addr;		/* Address of xmit buffer in card space */
881 
882 	pr_debug("ray_hw_xmit(data=%p, len=%d, dev=%p)\n", data, len, dev);
883 	if (len + TX_HEADER_LENGTH > TX_BUF_SIZE) {
884 		printk(KERN_INFO "ray_hw_xmit packet too large: %d bytes\n",
885 		       len);
886 		return XMIT_MSG_BAD;
887 	}
888 	switch (ccsindex = get_free_tx_ccs(local)) {
889 	case ECCSBUSY:
890 		pr_debug("ray_hw_xmit tx_ccs table busy\n");
891 		fallthrough;
892 	case ECCSFULL:
893 		pr_debug("ray_hw_xmit No free tx ccs\n");
894 		fallthrough;
895 	case ECARDGONE:
896 		netif_stop_queue(dev);
897 		return XMIT_NO_CCS;
898 	default:
899 		break;
900 	}
901 	addr = TX_BUF_BASE + (ccsindex << 11);
902 
903 	if (msg_type == DATA_TYPE) {
904 		local->stats.tx_bytes += len;
905 		local->stats.tx_packets++;
906 	}
907 
908 	ptx = local->sram + addr;
909 
910 	ray_build_header(local, ptx, msg_type, data);
911 	if (translate) {
912 		offset = translate_frame(local, ptx, data, len);
913 	} else { /* Encapsulate frame */
914 		/* TBD TIB length will move address of ptx->var */
915 		memcpy_toio(&ptx->var, data, len);
916 		offset = 0;
917 	}
918 
919 	/* fill in the CCS */
920 	pccs = ccs_base(local) + ccsindex;
921 	len += TX_HEADER_LENGTH + offset;
922 	writeb(CCS_TX_REQUEST, &pccs->cmd);
923 	writeb(addr >> 8, &pccs->var.tx_request.tx_data_ptr[0]);
924 	writeb(local->tib_length, &pccs->var.tx_request.tx_data_ptr[1]);
925 	writeb(len >> 8, &pccs->var.tx_request.tx_data_length[0]);
926 	writeb(len & 0xff, &pccs->var.tx_request.tx_data_length[1]);
927 /* TBD still need psm_cam? */
928 	writeb(PSM_CAM, &pccs->var.tx_request.pow_sav_mode);
929 	writeb(local->net_default_tx_rate, &pccs->var.tx_request.tx_rate);
930 	writeb(0, &pccs->var.tx_request.antenna);
931 	pr_debug("ray_hw_xmit default_tx_rate = 0x%x\n",
932 	      local->net_default_tx_rate);
933 
934 	/* Interrupt the firmware to process the command */
935 	if (interrupt_ecf(local, ccsindex)) {
936 		pr_debug("ray_hw_xmit failed - ECF not ready for intr\n");
937 /* TBD very inefficient to copy packet to buffer, and then not
938    send it, but the alternative is to queue the messages and that
939    won't be done for a while.  Maybe set tbusy until a CCS is free?
940 */
941 		writeb(CCS_BUFFER_FREE, &pccs->buffer_status);
942 		return XMIT_NO_INTR;
943 	}
944 	return XMIT_OK;
945 } /* end ray_hw_xmit */
946 
947 /*===========================================================================*/
translate_frame(ray_dev_t * local,struct tx_msg __iomem * ptx,unsigned char * data,int len)948 static int translate_frame(ray_dev_t *local, struct tx_msg __iomem *ptx,
949 			   unsigned char *data, int len)
950 {
951 	__be16 proto = ((struct ethhdr *)data)->h_proto;
952 	if (ntohs(proto) >= ETH_P_802_3_MIN) { /* DIX II ethernet frame */
953 		pr_debug("ray_cs translate_frame DIX II\n");
954 		/* Copy LLC header to card buffer */
955 		memcpy_toio(&ptx->var, eth2_llc, sizeof(eth2_llc));
956 		memcpy_toio(((void __iomem *)&ptx->var) + sizeof(eth2_llc),
957 			    (UCHAR *) &proto, 2);
958 		if (proto == htons(ETH_P_AARP) || proto == htons(ETH_P_IPX)) {
959 			/* This is the selective translation table, only 2 entries */
960 			writeb(0xf8,
961 			       &((struct snaphdr_t __iomem *)ptx->var)->org[2]);
962 		}
963 		/* Copy body of ethernet packet without ethernet header */
964 		memcpy_toio((void __iomem *)&ptx->var +
965 			    sizeof(struct snaphdr_t), data + ETH_HLEN,
966 			    len - ETH_HLEN);
967 		return (int)sizeof(struct snaphdr_t) - ETH_HLEN;
968 	} else { /* already  802 type, and proto is length */
969 		pr_debug("ray_cs translate_frame 802\n");
970 		if (proto == htons(0xffff)) { /* evil netware IPX 802.3 without LLC */
971 			pr_debug("ray_cs translate_frame evil IPX\n");
972 			memcpy_toio(&ptx->var, data + ETH_HLEN, len - ETH_HLEN);
973 			return 0 - ETH_HLEN;
974 		}
975 		memcpy_toio(&ptx->var, data + ETH_HLEN, len - ETH_HLEN);
976 		return 0 - ETH_HLEN;
977 	}
978 	/* TBD do other frame types */
979 } /* end translate_frame */
980 
981 /*===========================================================================*/
ray_build_header(ray_dev_t * local,struct tx_msg __iomem * ptx,UCHAR msg_type,unsigned char * data)982 static void ray_build_header(ray_dev_t *local, struct tx_msg __iomem *ptx,
983 			     UCHAR msg_type, unsigned char *data)
984 {
985 	writeb(PROTOCOL_VER | msg_type, &ptx->mac.frame_ctl_1);
986 /*** IEEE 802.11 Address field assignments *************
987 		TODS	FROMDS	addr_1		addr_2		addr_3	addr_4
988 Adhoc		0	0	dest		src (terminal)	BSSID	N/A
989 AP to Terminal	0	1	dest		AP(BSSID)	source	N/A
990 Terminal to AP	1	0	AP(BSSID)	src (terminal)	dest	N/A
991 AP to AP	1	1	dest AP		src AP		dest	source
992 *******************************************************/
993 	if (local->net_type == ADHOC) {
994 		writeb(0, &ptx->mac.frame_ctl_2);
995 		memcpy_toio(ptx->mac.addr_1, ((struct ethhdr *)data)->h_dest,
996 			    ADDRLEN);
997 		memcpy_toio(ptx->mac.addr_2, ((struct ethhdr *)data)->h_source,
998 			    ADDRLEN);
999 		memcpy_toio(ptx->mac.addr_3, local->bss_id, ADDRLEN);
1000 	} else { /* infrastructure */
1001 
1002 		if (local->sparm.b4.a_acting_as_ap_status) {
1003 			writeb(FC2_FROM_DS, &ptx->mac.frame_ctl_2);
1004 			memcpy_toio(ptx->mac.addr_1,
1005 				    ((struct ethhdr *)data)->h_dest, ADDRLEN);
1006 			memcpy_toio(ptx->mac.addr_2, local->bss_id, 6);
1007 			memcpy_toio(ptx->mac.addr_3,
1008 				    ((struct ethhdr *)data)->h_source, ADDRLEN);
1009 		} else { /* Terminal */
1010 
1011 			writeb(FC2_TO_DS, &ptx->mac.frame_ctl_2);
1012 			memcpy_toio(ptx->mac.addr_1, local->bss_id, ADDRLEN);
1013 			memcpy_toio(ptx->mac.addr_2,
1014 				    ((struct ethhdr *)data)->h_source, ADDRLEN);
1015 			memcpy_toio(ptx->mac.addr_3,
1016 				    ((struct ethhdr *)data)->h_dest, ADDRLEN);
1017 		}
1018 	}
1019 } /* end encapsulate_frame */
1020 
1021 /*====================================================================*/
1022 
1023 /*------------------------------------------------------------------*/
1024 /*
1025  * Wireless Handler : get protocol name
1026  */
ray_get_name(struct net_device * dev,struct iw_request_info * info,union iwreq_data * wrqu,char * extra)1027 static int ray_get_name(struct net_device *dev, struct iw_request_info *info,
1028 			union iwreq_data *wrqu, char *extra)
1029 {
1030 	strcpy(wrqu->name, "IEEE 802.11-FH");
1031 	return 0;
1032 }
1033 
1034 /*------------------------------------------------------------------*/
1035 /*
1036  * Wireless Handler : set frequency
1037  */
ray_set_freq(struct net_device * dev,struct iw_request_info * info,union iwreq_data * wrqu,char * extra)1038 static int ray_set_freq(struct net_device *dev, struct iw_request_info *info,
1039 			union iwreq_data *wrqu, char *extra)
1040 {
1041 	ray_dev_t *local = netdev_priv(dev);
1042 	int err = -EINPROGRESS;	/* Call commit handler */
1043 
1044 	/* Reject if card is already initialised */
1045 	if (local->card_status != CARD_AWAITING_PARAM)
1046 		return -EBUSY;
1047 
1048 	/* Setting by channel number */
1049 	if ((wrqu->freq.m > USA_HOP_MOD) || (wrqu->freq.e > 0))
1050 		err = -EOPNOTSUPP;
1051 	else
1052 		local->sparm.b5.a_hop_pattern = wrqu->freq.m;
1053 
1054 	return err;
1055 }
1056 
1057 /*------------------------------------------------------------------*/
1058 /*
1059  * Wireless Handler : get frequency
1060  */
ray_get_freq(struct net_device * dev,struct iw_request_info * info,union iwreq_data * wrqu,char * extra)1061 static int ray_get_freq(struct net_device *dev, struct iw_request_info *info,
1062 			union iwreq_data *wrqu, char *extra)
1063 {
1064 	ray_dev_t *local = netdev_priv(dev);
1065 
1066 	wrqu->freq.m = local->sparm.b5.a_hop_pattern;
1067 	wrqu->freq.e = 0;
1068 	return 0;
1069 }
1070 
1071 /*------------------------------------------------------------------*/
1072 /*
1073  * Wireless Handler : set ESSID
1074  */
ray_set_essid(struct net_device * dev,struct iw_request_info * info,union iwreq_data * wrqu,char * extra)1075 static int ray_set_essid(struct net_device *dev, struct iw_request_info *info,
1076 			 union iwreq_data *wrqu, char *extra)
1077 {
1078 	ray_dev_t *local = netdev_priv(dev);
1079 
1080 	/* Reject if card is already initialised */
1081 	if (local->card_status != CARD_AWAITING_PARAM)
1082 		return -EBUSY;
1083 
1084 	/* Check if we asked for `any' */
1085 	if (wrqu->essid.flags == 0)
1086 		/* Corey : can you do that ? */
1087 		return -EOPNOTSUPP;
1088 
1089 	/* Check the size of the string */
1090 	if (wrqu->essid.length > IW_ESSID_MAX_SIZE)
1091 		return -E2BIG;
1092 
1093 	/* Set the ESSID in the card */
1094 	memset(local->sparm.b5.a_current_ess_id, 0, IW_ESSID_MAX_SIZE);
1095 	memcpy(local->sparm.b5.a_current_ess_id, extra, wrqu->essid.length);
1096 
1097 	return -EINPROGRESS;	/* Call commit handler */
1098 }
1099 
1100 /*------------------------------------------------------------------*/
1101 /*
1102  * Wireless Handler : get ESSID
1103  */
ray_get_essid(struct net_device * dev,struct iw_request_info * info,union iwreq_data * wrqu,char * extra)1104 static int ray_get_essid(struct net_device *dev, struct iw_request_info *info,
1105 			 union iwreq_data *wrqu, char *extra)
1106 {
1107 	ray_dev_t *local = netdev_priv(dev);
1108 	UCHAR tmp[IW_ESSID_MAX_SIZE + 1];
1109 
1110 	/* Get the essid that was set */
1111 	memcpy(extra, local->sparm.b5.a_current_ess_id, IW_ESSID_MAX_SIZE);
1112 	memcpy(tmp, local->sparm.b5.a_current_ess_id, IW_ESSID_MAX_SIZE);
1113 	tmp[IW_ESSID_MAX_SIZE] = '\0';
1114 
1115 	/* Push it out ! */
1116 	wrqu->essid.length = strlen(tmp);
1117 	wrqu->essid.flags = 1;	/* active */
1118 
1119 	return 0;
1120 }
1121 
1122 /*------------------------------------------------------------------*/
1123 /*
1124  * Wireless Handler : get AP address
1125  */
ray_get_wap(struct net_device * dev,struct iw_request_info * info,union iwreq_data * wrqu,char * extra)1126 static int ray_get_wap(struct net_device *dev, struct iw_request_info *info,
1127 		       union iwreq_data *wrqu, char *extra)
1128 {
1129 	ray_dev_t *local = netdev_priv(dev);
1130 
1131 	memcpy(wrqu->ap_addr.sa_data, local->bss_id, ETH_ALEN);
1132 	wrqu->ap_addr.sa_family = ARPHRD_ETHER;
1133 
1134 	return 0;
1135 }
1136 
1137 /*------------------------------------------------------------------*/
1138 /*
1139  * Wireless Handler : set Bit-Rate
1140  */
ray_set_rate(struct net_device * dev,struct iw_request_info * info,union iwreq_data * wrqu,char * extra)1141 static int ray_set_rate(struct net_device *dev, struct iw_request_info *info,
1142 			union iwreq_data *wrqu, char *extra)
1143 {
1144 	ray_dev_t *local = netdev_priv(dev);
1145 
1146 	/* Reject if card is already initialised */
1147 	if (local->card_status != CARD_AWAITING_PARAM)
1148 		return -EBUSY;
1149 
1150 	/* Check if rate is in range */
1151 	if ((wrqu->bitrate.value != 1000000) && (wrqu->bitrate.value != 2000000))
1152 		return -EINVAL;
1153 
1154 	/* Hack for 1.5 Mb/s instead of 2 Mb/s */
1155 	if ((local->fw_ver == 0x55) &&	/* Please check */
1156 	    (wrqu->bitrate.value == 2000000))
1157 		local->net_default_tx_rate = 3;
1158 	else
1159 		local->net_default_tx_rate = wrqu->bitrate.value / 500000;
1160 
1161 	return 0;
1162 }
1163 
1164 /*------------------------------------------------------------------*/
1165 /*
1166  * Wireless Handler : get Bit-Rate
1167  */
ray_get_rate(struct net_device * dev,struct iw_request_info * info,union iwreq_data * wrqu,char * extra)1168 static int ray_get_rate(struct net_device *dev, struct iw_request_info *info,
1169 			union iwreq_data *wrqu, char *extra)
1170 {
1171 	ray_dev_t *local = netdev_priv(dev);
1172 
1173 	if (local->net_default_tx_rate == 3)
1174 		wrqu->bitrate.value = 2000000;	/* Hum... */
1175 	else
1176 		wrqu->bitrate.value = local->net_default_tx_rate * 500000;
1177 	wrqu->bitrate.fixed = 0;	/* We are in auto mode */
1178 
1179 	return 0;
1180 }
1181 
1182 /*------------------------------------------------------------------*/
1183 /*
1184  * Wireless Handler : set RTS threshold
1185  */
ray_set_rts(struct net_device * dev,struct iw_request_info * info,union iwreq_data * wrqu,char * extra)1186 static int ray_set_rts(struct net_device *dev, struct iw_request_info *info,
1187 		       union iwreq_data *wrqu, char *extra)
1188 {
1189 	ray_dev_t *local = netdev_priv(dev);
1190 	int rthr = wrqu->rts.value;
1191 
1192 	/* Reject if card is already initialised */
1193 	if (local->card_status != CARD_AWAITING_PARAM)
1194 		return -EBUSY;
1195 
1196 	/* if(wrq->u.rts.fixed == 0) we should complain */
1197 	if (wrqu->rts.disabled)
1198 		rthr = 32767;
1199 	else {
1200 		if ((rthr < 0) || (rthr > 2347))   /* What's the max packet size ??? */
1201 			return -EINVAL;
1202 	}
1203 	local->sparm.b5.a_rts_threshold[0] = (rthr >> 8) & 0xFF;
1204 	local->sparm.b5.a_rts_threshold[1] = rthr & 0xFF;
1205 
1206 	return -EINPROGRESS;	/* Call commit handler */
1207 }
1208 
1209 /*------------------------------------------------------------------*/
1210 /*
1211  * Wireless Handler : get RTS threshold
1212  */
ray_get_rts(struct net_device * dev,struct iw_request_info * info,union iwreq_data * wrqu,char * extra)1213 static int ray_get_rts(struct net_device *dev, struct iw_request_info *info,
1214 		       union iwreq_data *wrqu, char *extra)
1215 {
1216 	ray_dev_t *local = netdev_priv(dev);
1217 
1218 	wrqu->rts.value = (local->sparm.b5.a_rts_threshold[0] << 8)
1219 	    + local->sparm.b5.a_rts_threshold[1];
1220 	wrqu->rts.disabled = (wrqu->rts.value == 32767);
1221 	wrqu->rts.fixed = 1;
1222 
1223 	return 0;
1224 }
1225 
1226 /*------------------------------------------------------------------*/
1227 /*
1228  * Wireless Handler : set Fragmentation threshold
1229  */
ray_set_frag(struct net_device * dev,struct iw_request_info * info,union iwreq_data * wrqu,char * extra)1230 static int ray_set_frag(struct net_device *dev, struct iw_request_info *info,
1231 			union iwreq_data *wrqu, char *extra)
1232 {
1233 	ray_dev_t *local = netdev_priv(dev);
1234 	int fthr = wrqu->frag.value;
1235 
1236 	/* Reject if card is already initialised */
1237 	if (local->card_status != CARD_AWAITING_PARAM)
1238 		return -EBUSY;
1239 
1240 	/* if(wrq->u.frag.fixed == 0) should complain */
1241 	if (wrqu->frag.disabled)
1242 		fthr = 32767;
1243 	else {
1244 		if ((fthr < 256) || (fthr > 2347))	/* To check out ! */
1245 			return -EINVAL;
1246 	}
1247 	local->sparm.b5.a_frag_threshold[0] = (fthr >> 8) & 0xFF;
1248 	local->sparm.b5.a_frag_threshold[1] = fthr & 0xFF;
1249 
1250 	return -EINPROGRESS;	/* Call commit handler */
1251 }
1252 
1253 /*------------------------------------------------------------------*/
1254 /*
1255  * Wireless Handler : get Fragmentation threshold
1256  */
ray_get_frag(struct net_device * dev,struct iw_request_info * info,union iwreq_data * wrqu,char * extra)1257 static int ray_get_frag(struct net_device *dev, struct iw_request_info *info,
1258 			union iwreq_data *wrqu, char *extra)
1259 {
1260 	ray_dev_t *local = netdev_priv(dev);
1261 
1262 	wrqu->frag.value = (local->sparm.b5.a_frag_threshold[0] << 8)
1263 	    + local->sparm.b5.a_frag_threshold[1];
1264 	wrqu->frag.disabled = (wrqu->frag.value == 32767);
1265 	wrqu->frag.fixed = 1;
1266 
1267 	return 0;
1268 }
1269 
1270 /*------------------------------------------------------------------*/
1271 /*
1272  * Wireless Handler : set Mode of Operation
1273  */
ray_set_mode(struct net_device * dev,struct iw_request_info * info,union iwreq_data * wrqu,char * extra)1274 static int ray_set_mode(struct net_device *dev, struct iw_request_info *info,
1275 			union iwreq_data *wrqu, char *extra)
1276 {
1277 	ray_dev_t *local = netdev_priv(dev);
1278 	int err = -EINPROGRESS;	/* Call commit handler */
1279 	char card_mode = 1;
1280 
1281 	/* Reject if card is already initialised */
1282 	if (local->card_status != CARD_AWAITING_PARAM)
1283 		return -EBUSY;
1284 
1285 	switch (wrqu->mode) {
1286 	case IW_MODE_ADHOC:
1287 		card_mode = 0;
1288 		fallthrough;
1289 	case IW_MODE_INFRA:
1290 		local->sparm.b5.a_network_type = card_mode;
1291 		break;
1292 	default:
1293 		err = -EINVAL;
1294 	}
1295 
1296 	return err;
1297 }
1298 
1299 /*------------------------------------------------------------------*/
1300 /*
1301  * Wireless Handler : get Mode of Operation
1302  */
ray_get_mode(struct net_device * dev,struct iw_request_info * info,union iwreq_data * wrqu,char * extra)1303 static int ray_get_mode(struct net_device *dev, struct iw_request_info *info,
1304 			union iwreq_data *wrqu, char *extra)
1305 {
1306 	ray_dev_t *local = netdev_priv(dev);
1307 
1308 	if (local->sparm.b5.a_network_type)
1309 		wrqu->mode = IW_MODE_INFRA;
1310 	else
1311 		wrqu->mode = IW_MODE_ADHOC;
1312 
1313 	return 0;
1314 }
1315 
1316 /*------------------------------------------------------------------*/
1317 /*
1318  * Wireless Handler : get range info
1319  */
ray_get_range(struct net_device * dev,struct iw_request_info * info,union iwreq_data * wrqu,char * extra)1320 static int ray_get_range(struct net_device *dev, struct iw_request_info *info,
1321 			 union iwreq_data *wrqu, char *extra)
1322 {
1323 	struct iw_range *range = (struct iw_range *)extra;
1324 
1325 	memset(range, 0, sizeof(struct iw_range));
1326 
1327 	/* Set the length (very important for backward compatibility) */
1328 	wrqu->data.length = sizeof(struct iw_range);
1329 
1330 	/* Set the Wireless Extension versions */
1331 	range->we_version_compiled = WIRELESS_EXT;
1332 	range->we_version_source = 9;
1333 
1334 	/* Set information in the range struct */
1335 	range->throughput = 1.1 * 1000 * 1000;	/* Put the right number here */
1336 	range->num_channels = hop_pattern_length[(int)country];
1337 	range->num_frequency = 0;
1338 	range->max_qual.qual = 0;
1339 	range->max_qual.level = 255;	/* What's the correct value ? */
1340 	range->max_qual.noise = 255;	/* Idem */
1341 	range->num_bitrates = 2;
1342 	range->bitrate[0] = 1000000;	/* 1 Mb/s */
1343 	range->bitrate[1] = 2000000;	/* 2 Mb/s */
1344 	return 0;
1345 }
1346 
1347 /*------------------------------------------------------------------*/
1348 /*
1349  * Wireless Private Handler : set framing mode
1350  */
ray_set_framing(struct net_device * dev,struct iw_request_info * info,union iwreq_data * wrqu,char * extra)1351 static int ray_set_framing(struct net_device *dev, struct iw_request_info *info,
1352 			   union iwreq_data *wrqu, char *extra)
1353 {
1354 	translate = !!*(extra);	/* Set framing mode */
1355 
1356 	return 0;
1357 }
1358 
1359 /*------------------------------------------------------------------*/
1360 /*
1361  * Wireless Private Handler : get framing mode
1362  */
ray_get_framing(struct net_device * dev,struct iw_request_info * info,union iwreq_data * wrqu,char * extra)1363 static int ray_get_framing(struct net_device *dev, struct iw_request_info *info,
1364 			   union iwreq_data *wrqu, char *extra)
1365 {
1366 	*(extra) = translate;
1367 
1368 	return 0;
1369 }
1370 
1371 /*------------------------------------------------------------------*/
1372 /*
1373  * Wireless Private Handler : get country
1374  */
ray_get_country(struct net_device * dev,struct iw_request_info * info,union iwreq_data * wrqu,char * extra)1375 static int ray_get_country(struct net_device *dev, struct iw_request_info *info,
1376 			   union iwreq_data *wrqu, char *extra)
1377 {
1378 	*(extra) = country;
1379 
1380 	return 0;
1381 }
1382 
1383 /*------------------------------------------------------------------*/
1384 /*
1385  * Commit handler : called after a bunch of SET operations
1386  */
ray_commit(struct net_device * dev,struct iw_request_info * info,union iwreq_data * wrqu,char * extra)1387 static int ray_commit(struct net_device *dev, struct iw_request_info *info,
1388 		      union iwreq_data *wrqu, char *extra)
1389 {
1390 	return 0;
1391 }
1392 
1393 /*------------------------------------------------------------------*/
1394 /*
1395  * Stats handler : return Wireless Stats
1396  */
ray_get_wireless_stats(struct net_device * dev)1397 static iw_stats *ray_get_wireless_stats(struct net_device *dev)
1398 {
1399 	ray_dev_t *local = netdev_priv(dev);
1400 	struct pcmcia_device *link = local->finder;
1401 	struct status __iomem *p = local->sram + STATUS_BASE;
1402 
1403 	local->wstats.status = local->card_status;
1404 #ifdef WIRELESS_SPY
1405 	if ((local->spy_data.spy_number > 0)
1406 	    && (local->sparm.b5.a_network_type == 0)) {
1407 		/* Get it from the first node in spy list */
1408 		local->wstats.qual.qual = local->spy_data.spy_stat[0].qual;
1409 		local->wstats.qual.level = local->spy_data.spy_stat[0].level;
1410 		local->wstats.qual.noise = local->spy_data.spy_stat[0].noise;
1411 		local->wstats.qual.updated =
1412 		    local->spy_data.spy_stat[0].updated;
1413 	}
1414 #endif /* WIRELESS_SPY */
1415 
1416 	if (pcmcia_dev_present(link)) {
1417 		local->wstats.qual.noise = readb(&p->rxnoise);
1418 		local->wstats.qual.updated |= 4;
1419 	}
1420 
1421 	return &local->wstats;
1422 } /* end ray_get_wireless_stats */
1423 
1424 /*------------------------------------------------------------------*/
1425 /*
1426  * Structures to export the Wireless Handlers
1427  */
1428 
1429 static const iw_handler ray_handler[] = {
1430 	IW_HANDLER(SIOCSIWCOMMIT, ray_commit),
1431 	IW_HANDLER(SIOCGIWNAME, ray_get_name),
1432 	IW_HANDLER(SIOCSIWFREQ, ray_set_freq),
1433 	IW_HANDLER(SIOCGIWFREQ, ray_get_freq),
1434 	IW_HANDLER(SIOCSIWMODE, ray_set_mode),
1435 	IW_HANDLER(SIOCGIWMODE, ray_get_mode),
1436 	IW_HANDLER(SIOCGIWRANGE, ray_get_range),
1437 #ifdef WIRELESS_SPY
1438 	IW_HANDLER(SIOCSIWSPY, iw_handler_set_spy),
1439 	IW_HANDLER(SIOCGIWSPY, iw_handler_get_spy),
1440 	IW_HANDLER(SIOCSIWTHRSPY, iw_handler_set_thrspy),
1441 	IW_HANDLER(SIOCGIWTHRSPY, iw_handler_get_thrspy),
1442 #endif /* WIRELESS_SPY */
1443 	IW_HANDLER(SIOCGIWAP, ray_get_wap),
1444 	IW_HANDLER(SIOCSIWESSID, ray_set_essid),
1445 	IW_HANDLER(SIOCGIWESSID, ray_get_essid),
1446 	IW_HANDLER(SIOCSIWRATE, ray_set_rate),
1447 	IW_HANDLER(SIOCGIWRATE, ray_get_rate),
1448 	IW_HANDLER(SIOCSIWRTS, ray_set_rts),
1449 	IW_HANDLER(SIOCGIWRTS, ray_get_rts),
1450 	IW_HANDLER(SIOCSIWFRAG, ray_set_frag),
1451 	IW_HANDLER(SIOCGIWFRAG, ray_get_frag),
1452 };
1453 
1454 #define SIOCSIPFRAMING	SIOCIWFIRSTPRIV	/* Set framing mode */
1455 #define SIOCGIPFRAMING	SIOCIWFIRSTPRIV + 1	/* Get framing mode */
1456 #define SIOCGIPCOUNTRY	SIOCIWFIRSTPRIV + 3	/* Get country code */
1457 
1458 static const iw_handler ray_private_handler[] = {
1459 	[0] = ray_set_framing,
1460 	[1] = ray_get_framing,
1461 	[3] = ray_get_country,
1462 };
1463 
1464 static const struct iw_priv_args ray_private_args[] = {
1465 /* cmd,		set_args,	get_args,	name */
1466 	{SIOCSIPFRAMING, IW_PRIV_TYPE_BYTE | IW_PRIV_SIZE_FIXED | 1, 0,
1467 	 "set_framing"},
1468 	{SIOCGIPFRAMING, 0, IW_PRIV_TYPE_BYTE | IW_PRIV_SIZE_FIXED | 1,
1469 	 "get_framing"},
1470 	{SIOCGIPCOUNTRY, 0, IW_PRIV_TYPE_BYTE | IW_PRIV_SIZE_FIXED | 1,
1471 	 "get_country"},
1472 };
1473 
1474 static const struct iw_handler_def ray_handler_def = {
1475 	.num_standard = ARRAY_SIZE(ray_handler),
1476 	.num_private = ARRAY_SIZE(ray_private_handler),
1477 	.num_private_args = ARRAY_SIZE(ray_private_args),
1478 	.standard = ray_handler,
1479 	.private = ray_private_handler,
1480 	.private_args = ray_private_args,
1481 	.get_wireless_stats = ray_get_wireless_stats,
1482 };
1483 
1484 /*===========================================================================*/
ray_open(struct net_device * dev)1485 static int ray_open(struct net_device *dev)
1486 {
1487 	ray_dev_t *local = netdev_priv(dev);
1488 	struct pcmcia_device *link;
1489 	link = local->finder;
1490 
1491 	dev_dbg(&link->dev, "ray_open('%s')\n", dev->name);
1492 
1493 	if (link->open == 0)
1494 		local->num_multi = 0;
1495 	link->open++;
1496 
1497 	/* If the card is not started, time to start it ! - Jean II */
1498 	if (local->card_status == CARD_AWAITING_PARAM) {
1499 		int i;
1500 
1501 		dev_dbg(&link->dev, "ray_open: doing init now !\n");
1502 
1503 		/* Download startup parameters */
1504 		if ((i = dl_startup_params(dev)) < 0) {
1505 			printk(KERN_INFO
1506 			       "ray_dev_init dl_startup_params failed - "
1507 			       "returns 0x%x\n", i);
1508 			return -1;
1509 		}
1510 	}
1511 
1512 	if (sniffer)
1513 		netif_stop_queue(dev);
1514 	else
1515 		netif_start_queue(dev);
1516 
1517 	dev_dbg(&link->dev, "ray_open ending\n");
1518 	return 0;
1519 } /* end ray_open */
1520 
1521 /*===========================================================================*/
ray_dev_close(struct net_device * dev)1522 static int ray_dev_close(struct net_device *dev)
1523 {
1524 	ray_dev_t *local = netdev_priv(dev);
1525 	struct pcmcia_device *link;
1526 	link = local->finder;
1527 
1528 	dev_dbg(&link->dev, "ray_dev_close('%s')\n", dev->name);
1529 
1530 	link->open--;
1531 	netif_stop_queue(dev);
1532 
1533 	/* In here, we should stop the hardware (stop card from beeing active)
1534 	 * and set local->card_status to CARD_AWAITING_PARAM, so that while the
1535 	 * card is closed we can chage its configuration.
1536 	 * Probably also need a COR reset to get sane state - Jean II */
1537 
1538 	return 0;
1539 } /* end ray_dev_close */
1540 
1541 /*===========================================================================*/
ray_reset(struct net_device * dev)1542 static void ray_reset(struct net_device *dev)
1543 {
1544 	pr_debug("ray_reset entered\n");
1545 }
1546 
1547 /*===========================================================================*/
1548 /* Cause a firmware interrupt if it is ready for one                         */
1549 /* Return nonzero if not ready                                               */
interrupt_ecf(ray_dev_t * local,int ccs)1550 static int interrupt_ecf(ray_dev_t *local, int ccs)
1551 {
1552 	int i = 50;
1553 	struct pcmcia_device *link = local->finder;
1554 
1555 	if (!(pcmcia_dev_present(link))) {
1556 		dev_dbg(&link->dev, "ray_cs interrupt_ecf - device not present\n");
1557 		return -1;
1558 	}
1559 	dev_dbg(&link->dev, "interrupt_ecf(local=%p, ccs = 0x%x\n", local, ccs);
1560 
1561 	while (i &&
1562 	       (readb(local->amem + CIS_OFFSET + ECF_INTR_OFFSET) &
1563 		ECF_INTR_SET))
1564 		i--;
1565 	if (i == 0) {
1566 		dev_dbg(&link->dev, "ray_cs interrupt_ecf card not ready for interrupt\n");
1567 		return -1;
1568 	}
1569 	/* Fill the mailbox, then kick the card */
1570 	writeb(ccs, local->sram + SCB_BASE);
1571 	writeb(ECF_INTR_SET, local->amem + CIS_OFFSET + ECF_INTR_OFFSET);
1572 	return 0;
1573 } /* interrupt_ecf */
1574 
1575 /*===========================================================================*/
1576 /* Get next free transmit CCS                                                */
1577 /* Return - index of current tx ccs                                          */
get_free_tx_ccs(ray_dev_t * local)1578 static int get_free_tx_ccs(ray_dev_t *local)
1579 {
1580 	int i;
1581 	struct ccs __iomem *pccs = ccs_base(local);
1582 	struct pcmcia_device *link = local->finder;
1583 
1584 	if (!(pcmcia_dev_present(link))) {
1585 		dev_dbg(&link->dev, "ray_cs get_free_tx_ccs - device not present\n");
1586 		return ECARDGONE;
1587 	}
1588 
1589 	if (test_and_set_bit(0, &local->tx_ccs_lock)) {
1590 		dev_dbg(&link->dev, "ray_cs tx_ccs_lock busy\n");
1591 		return ECCSBUSY;
1592 	}
1593 
1594 	for (i = 0; i < NUMBER_OF_TX_CCS; i++) {
1595 		if (readb(&(pccs + i)->buffer_status) == CCS_BUFFER_FREE) {
1596 			writeb(CCS_BUFFER_BUSY, &(pccs + i)->buffer_status);
1597 			writeb(CCS_END_LIST, &(pccs + i)->link);
1598 			local->tx_ccs_lock = 0;
1599 			return i;
1600 		}
1601 	}
1602 	local->tx_ccs_lock = 0;
1603 	dev_dbg(&link->dev, "ray_cs ERROR no free tx CCS for raylink card\n");
1604 	return ECCSFULL;
1605 } /* get_free_tx_ccs */
1606 
1607 /*===========================================================================*/
1608 /* Get next free CCS                                                         */
1609 /* Return - index of current ccs                                             */
get_free_ccs(ray_dev_t * local)1610 static int get_free_ccs(ray_dev_t *local)
1611 {
1612 	int i;
1613 	struct ccs __iomem *pccs = ccs_base(local);
1614 	struct pcmcia_device *link = local->finder;
1615 
1616 	if (!(pcmcia_dev_present(link))) {
1617 		dev_dbg(&link->dev, "ray_cs get_free_ccs - device not present\n");
1618 		return ECARDGONE;
1619 	}
1620 	if (test_and_set_bit(0, &local->ccs_lock)) {
1621 		dev_dbg(&link->dev, "ray_cs ccs_lock busy\n");
1622 		return ECCSBUSY;
1623 	}
1624 
1625 	for (i = NUMBER_OF_TX_CCS; i < NUMBER_OF_CCS; i++) {
1626 		if (readb(&(pccs + i)->buffer_status) == CCS_BUFFER_FREE) {
1627 			writeb(CCS_BUFFER_BUSY, &(pccs + i)->buffer_status);
1628 			writeb(CCS_END_LIST, &(pccs + i)->link);
1629 			local->ccs_lock = 0;
1630 			return i;
1631 		}
1632 	}
1633 	local->ccs_lock = 0;
1634 	dev_dbg(&link->dev, "ray_cs ERROR no free CCS for raylink card\n");
1635 	return ECCSFULL;
1636 } /* get_free_ccs */
1637 
1638 /*===========================================================================*/
authenticate_timeout(struct timer_list * t)1639 static void authenticate_timeout(struct timer_list *t)
1640 {
1641 	ray_dev_t *local = from_timer(local, t, timer);
1642 	del_timer(&local->timer);
1643 	printk(KERN_INFO "ray_cs Authentication with access point failed"
1644 	       " - timeout\n");
1645 	join_net(&local->timer);
1646 }
1647 
1648 /*===========================================================================*/
parse_addr(char * in_str,UCHAR * out)1649 static int parse_addr(char *in_str, UCHAR *out)
1650 {
1651 	int i, k;
1652 	int len;
1653 
1654 	if (in_str == NULL)
1655 		return 0;
1656 	len = strnlen(in_str, ADDRLEN * 2 + 1) - 1;
1657 	if (len < 1)
1658 		return 0;
1659 	memset(out, 0, ADDRLEN);
1660 
1661 	i = 5;
1662 
1663 	while (len > 0) {
1664 		if ((k = hex_to_bin(in_str[len--])) != -1)
1665 			out[i] = k;
1666 		else
1667 			return 0;
1668 
1669 		if (len == 0)
1670 			break;
1671 		if ((k = hex_to_bin(in_str[len--])) != -1)
1672 			out[i] += k << 4;
1673 		else
1674 			return 0;
1675 		if (!i--)
1676 			break;
1677 	}
1678 	return 1;
1679 }
1680 
1681 /*===========================================================================*/
ray_get_stats(struct net_device * dev)1682 static struct net_device_stats *ray_get_stats(struct net_device *dev)
1683 {
1684 	ray_dev_t *local = netdev_priv(dev);
1685 	struct pcmcia_device *link = local->finder;
1686 	struct status __iomem *p = local->sram + STATUS_BASE;
1687 	if (!(pcmcia_dev_present(link))) {
1688 		dev_dbg(&link->dev, "ray_cs net_device_stats - device not present\n");
1689 		return &local->stats;
1690 	}
1691 	if (readb(&p->mrx_overflow_for_host)) {
1692 		local->stats.rx_over_errors += swab16(readw(&p->mrx_overflow));
1693 		writeb(0, &p->mrx_overflow);
1694 		writeb(0, &p->mrx_overflow_for_host);
1695 	}
1696 	if (readb(&p->mrx_checksum_error_for_host)) {
1697 		local->stats.rx_crc_errors +=
1698 		    swab16(readw(&p->mrx_checksum_error));
1699 		writeb(0, &p->mrx_checksum_error);
1700 		writeb(0, &p->mrx_checksum_error_for_host);
1701 	}
1702 	if (readb(&p->rx_hec_error_for_host)) {
1703 		local->stats.rx_frame_errors += swab16(readw(&p->rx_hec_error));
1704 		writeb(0, &p->rx_hec_error);
1705 		writeb(0, &p->rx_hec_error_for_host);
1706 	}
1707 	return &local->stats;
1708 }
1709 
1710 /*===========================================================================*/
ray_update_parm(struct net_device * dev,UCHAR objid,UCHAR * value,int len)1711 static void ray_update_parm(struct net_device *dev, UCHAR objid, UCHAR *value,
1712 			    int len)
1713 {
1714 	ray_dev_t *local = netdev_priv(dev);
1715 	struct pcmcia_device *link = local->finder;
1716 	int ccsindex;
1717 	int i;
1718 	struct ccs __iomem *pccs;
1719 
1720 	if (!(pcmcia_dev_present(link))) {
1721 		dev_dbg(&link->dev, "ray_update_parm - device not present\n");
1722 		return;
1723 	}
1724 
1725 	if ((ccsindex = get_free_ccs(local)) < 0) {
1726 		dev_dbg(&link->dev, "ray_update_parm - No free ccs\n");
1727 		return;
1728 	}
1729 	pccs = ccs_base(local) + ccsindex;
1730 	writeb(CCS_UPDATE_PARAMS, &pccs->cmd);
1731 	writeb(objid, &pccs->var.update_param.object_id);
1732 	writeb(1, &pccs->var.update_param.number_objects);
1733 	writeb(0, &pccs->var.update_param.failure_cause);
1734 	for (i = 0; i < len; i++) {
1735 		writeb(value[i], local->sram + HOST_TO_ECF_BASE);
1736 	}
1737 	/* Interrupt the firmware to process the command */
1738 	if (interrupt_ecf(local, ccsindex)) {
1739 		dev_dbg(&link->dev, "ray_cs associate failed - ECF not ready for intr\n");
1740 		writeb(CCS_BUFFER_FREE, &(pccs++)->buffer_status);
1741 	}
1742 }
1743 
1744 /*===========================================================================*/
ray_update_multi_list(struct net_device * dev,int all)1745 static void ray_update_multi_list(struct net_device *dev, int all)
1746 {
1747 	int ccsindex;
1748 	struct ccs __iomem *pccs;
1749 	ray_dev_t *local = netdev_priv(dev);
1750 	struct pcmcia_device *link = local->finder;
1751 	void __iomem *p = local->sram + HOST_TO_ECF_BASE;
1752 
1753 	if (!(pcmcia_dev_present(link))) {
1754 		dev_dbg(&link->dev, "ray_update_multi_list - device not present\n");
1755 		return;
1756 	} else
1757 		dev_dbg(&link->dev, "ray_update_multi_list(%p)\n", dev);
1758 	if ((ccsindex = get_free_ccs(local)) < 0) {
1759 		dev_dbg(&link->dev, "ray_update_multi - No free ccs\n");
1760 		return;
1761 	}
1762 	pccs = ccs_base(local) + ccsindex;
1763 	writeb(CCS_UPDATE_MULTICAST_LIST, &pccs->cmd);
1764 
1765 	if (all) {
1766 		writeb(0xff, &pccs->var);
1767 		local->num_multi = 0xff;
1768 	} else {
1769 		struct netdev_hw_addr *ha;
1770 		int i = 0;
1771 
1772 		/* Copy the kernel's list of MC addresses to card */
1773 		netdev_for_each_mc_addr(ha, dev) {
1774 			memcpy_toio(p, ha->addr, ETH_ALEN);
1775 			dev_dbg(&link->dev, "ray_update_multi add addr %pm\n",
1776 				ha->addr);
1777 			p += ETH_ALEN;
1778 			i++;
1779 		}
1780 		if (i > 256 / ADDRLEN)
1781 			i = 256 / ADDRLEN;
1782 		writeb((UCHAR) i, &pccs->var);
1783 		dev_dbg(&link->dev, "ray_cs update_multi %d addresses in list\n", i);
1784 		/* Interrupt the firmware to process the command */
1785 		local->num_multi = i;
1786 	}
1787 	if (interrupt_ecf(local, ccsindex)) {
1788 		dev_dbg(&link->dev,
1789 		      "ray_cs update_multi failed - ECF not ready for intr\n");
1790 		writeb(CCS_BUFFER_FREE, &(pccs++)->buffer_status);
1791 	}
1792 } /* end ray_update_multi_list */
1793 
1794 /*===========================================================================*/
set_multicast_list(struct net_device * dev)1795 static void set_multicast_list(struct net_device *dev)
1796 {
1797 	ray_dev_t *local = netdev_priv(dev);
1798 	UCHAR promisc;
1799 
1800 	pr_debug("ray_cs set_multicast_list(%p)\n", dev);
1801 
1802 	if (dev->flags & IFF_PROMISC) {
1803 		if (local->sparm.b5.a_promiscuous_mode == 0) {
1804 			pr_debug("ray_cs set_multicast_list promisc on\n");
1805 			local->sparm.b5.a_promiscuous_mode = 1;
1806 			promisc = 1;
1807 			ray_update_parm(dev, OBJID_promiscuous_mode,
1808 					&promisc, sizeof(promisc));
1809 		}
1810 	} else {
1811 		if (local->sparm.b5.a_promiscuous_mode == 1) {
1812 			pr_debug("ray_cs set_multicast_list promisc off\n");
1813 			local->sparm.b5.a_promiscuous_mode = 0;
1814 			promisc = 0;
1815 			ray_update_parm(dev, OBJID_promiscuous_mode,
1816 					&promisc, sizeof(promisc));
1817 		}
1818 	}
1819 
1820 	if (dev->flags & IFF_ALLMULTI)
1821 		ray_update_multi_list(dev, 1);
1822 	else {
1823 		if (local->num_multi != netdev_mc_count(dev))
1824 			ray_update_multi_list(dev, 0);
1825 	}
1826 } /* end set_multicast_list */
1827 
1828 /*=============================================================================
1829  * All routines below here are run at interrupt time.
1830 =============================================================================*/
ray_interrupt(int irq,void * dev_id)1831 static irqreturn_t ray_interrupt(int irq, void *dev_id)
1832 {
1833 	struct net_device *dev = (struct net_device *)dev_id;
1834 	struct pcmcia_device *link;
1835 	ray_dev_t *local;
1836 	struct ccs __iomem *pccs;
1837 	struct rcs __iomem *prcs;
1838 	UCHAR rcsindex;
1839 	UCHAR tmp;
1840 	UCHAR cmd;
1841 	UCHAR status;
1842 	UCHAR memtmp[ESSID_SIZE + 1];
1843 
1844 
1845 	if (dev == NULL)	/* Note that we want interrupts with dev->start == 0 */
1846 		return IRQ_NONE;
1847 
1848 	pr_debug("ray_cs: interrupt for *dev=%p\n", dev);
1849 
1850 	local = netdev_priv(dev);
1851 	link = local->finder;
1852 	if (!pcmcia_dev_present(link)) {
1853 		pr_debug(
1854 			"ray_cs interrupt from device not present or suspended.\n");
1855 		return IRQ_NONE;
1856 	}
1857 	rcsindex = readb(&((struct scb __iomem *)(local->sram))->rcs_index);
1858 
1859 	if (rcsindex >= (NUMBER_OF_CCS + NUMBER_OF_RCS)) {
1860 		dev_dbg(&link->dev, "ray_cs interrupt bad rcsindex = 0x%x\n", rcsindex);
1861 		clear_interrupt(local);
1862 		return IRQ_HANDLED;
1863 	}
1864 	if (rcsindex < NUMBER_OF_CCS) { /* If it's a returned CCS */
1865 		pccs = ccs_base(local) + rcsindex;
1866 		cmd = readb(&pccs->cmd);
1867 		status = readb(&pccs->buffer_status);
1868 		switch (cmd) {
1869 		case CCS_DOWNLOAD_STARTUP_PARAMS:	/* Happens in firmware someday */
1870 			del_timer(&local->timer);
1871 			if (status == CCS_COMMAND_COMPLETE) {
1872 				dev_dbg(&link->dev,
1873 				      "ray_cs interrupt download_startup_parameters OK\n");
1874 			} else {
1875 				dev_dbg(&link->dev,
1876 				      "ray_cs interrupt download_startup_parameters fail\n");
1877 			}
1878 			break;
1879 		case CCS_UPDATE_PARAMS:
1880 			dev_dbg(&link->dev, "ray_cs interrupt update params done\n");
1881 			if (status != CCS_COMMAND_COMPLETE) {
1882 				tmp =
1883 				    readb(&pccs->var.update_param.
1884 					  failure_cause);
1885 				dev_dbg(&link->dev,
1886 				      "ray_cs interrupt update params failed - reason %d\n",
1887 				      tmp);
1888 			}
1889 			break;
1890 		case CCS_REPORT_PARAMS:
1891 			dev_dbg(&link->dev, "ray_cs interrupt report params done\n");
1892 			break;
1893 		case CCS_UPDATE_MULTICAST_LIST:	/* Note that this CCS isn't returned */
1894 			dev_dbg(&link->dev,
1895 			      "ray_cs interrupt CCS Update Multicast List done\n");
1896 			break;
1897 		case CCS_UPDATE_POWER_SAVINGS_MODE:
1898 			dev_dbg(&link->dev,
1899 			      "ray_cs interrupt update power save mode done\n");
1900 			break;
1901 		case CCS_START_NETWORK:
1902 		case CCS_JOIN_NETWORK:
1903 			memcpy(memtmp, local->sparm.b4.a_current_ess_id,
1904 								ESSID_SIZE);
1905 			memtmp[ESSID_SIZE] = '\0';
1906 
1907 			if (status == CCS_COMMAND_COMPLETE) {
1908 				if (readb
1909 				    (&pccs->var.start_network.net_initiated) ==
1910 				    1) {
1911 					dev_dbg(&link->dev,
1912 					      "ray_cs interrupt network \"%s\" started\n",
1913 					      memtmp);
1914 				} else {
1915 					dev_dbg(&link->dev,
1916 					      "ray_cs interrupt network \"%s\" joined\n",
1917 					      memtmp);
1918 				}
1919 				memcpy_fromio(&local->bss_id,
1920 					      pccs->var.start_network.bssid,
1921 					      ADDRLEN);
1922 
1923 				if (local->fw_ver == 0x55)
1924 					local->net_default_tx_rate = 3;
1925 				else
1926 					local->net_default_tx_rate =
1927 					    readb(&pccs->var.start_network.
1928 						  net_default_tx_rate);
1929 				local->encryption =
1930 				    readb(&pccs->var.start_network.encryption);
1931 				if (!sniffer && (local->net_type == INFRA)
1932 				    && !(local->sparm.b4.a_acting_as_ap_status)) {
1933 					authenticate(local);
1934 				}
1935 				local->card_status = CARD_ACQ_COMPLETE;
1936 			} else {
1937 				local->card_status = CARD_ACQ_FAILED;
1938 
1939 				del_timer(&local->timer);
1940 				local->timer.expires = jiffies + HZ * 5;
1941 				if (status == CCS_START_NETWORK) {
1942 					dev_dbg(&link->dev,
1943 					      "ray_cs interrupt network \"%s\" start failed\n",
1944 					      memtmp);
1945 					local->timer.function = start_net;
1946 				} else {
1947 					dev_dbg(&link->dev,
1948 					      "ray_cs interrupt network \"%s\" join failed\n",
1949 					      memtmp);
1950 					local->timer.function = join_net;
1951 				}
1952 				add_timer(&local->timer);
1953 			}
1954 			break;
1955 		case CCS_START_ASSOCIATION:
1956 			if (status == CCS_COMMAND_COMPLETE) {
1957 				local->card_status = CARD_ASSOC_COMPLETE;
1958 				dev_dbg(&link->dev, "ray_cs association successful\n");
1959 			} else {
1960 				dev_dbg(&link->dev, "ray_cs association failed,\n");
1961 				local->card_status = CARD_ASSOC_FAILED;
1962 				join_net(&local->timer);
1963 			}
1964 			break;
1965 		case CCS_TX_REQUEST:
1966 			if (status == CCS_COMMAND_COMPLETE) {
1967 				dev_dbg(&link->dev,
1968 				      "ray_cs interrupt tx request complete\n");
1969 			} else {
1970 				dev_dbg(&link->dev,
1971 				      "ray_cs interrupt tx request failed\n");
1972 			}
1973 			if (!sniffer)
1974 				netif_start_queue(dev);
1975 			netif_wake_queue(dev);
1976 			break;
1977 		case CCS_TEST_MEMORY:
1978 			dev_dbg(&link->dev, "ray_cs interrupt mem test done\n");
1979 			break;
1980 		case CCS_SHUTDOWN:
1981 			dev_dbg(&link->dev,
1982 			      "ray_cs interrupt Unexpected CCS returned - Shutdown\n");
1983 			break;
1984 		case CCS_DUMP_MEMORY:
1985 			dev_dbg(&link->dev, "ray_cs interrupt dump memory done\n");
1986 			break;
1987 		case CCS_START_TIMER:
1988 			dev_dbg(&link->dev,
1989 			      "ray_cs interrupt DING - raylink timer expired\n");
1990 			break;
1991 		default:
1992 			dev_dbg(&link->dev,
1993 			      "ray_cs interrupt Unexpected CCS 0x%x returned 0x%x\n",
1994 			      rcsindex, cmd);
1995 		}
1996 		writeb(CCS_BUFFER_FREE, &pccs->buffer_status);
1997 	} else { /* It's an RCS */
1998 
1999 		prcs = rcs_base(local) + rcsindex;
2000 
2001 		switch (readb(&prcs->interrupt_id)) {
2002 		case PROCESS_RX_PACKET:
2003 			ray_rx(dev, local, prcs);
2004 			break;
2005 		case REJOIN_NET_COMPLETE:
2006 			dev_dbg(&link->dev, "ray_cs interrupt rejoin net complete\n");
2007 			local->card_status = CARD_ACQ_COMPLETE;
2008 			/* do we need to clear tx buffers CCS's? */
2009 			if (local->sparm.b4.a_network_type == ADHOC) {
2010 				if (!sniffer)
2011 					netif_start_queue(dev);
2012 			} else {
2013 				memcpy_fromio(&local->bss_id,
2014 					      prcs->var.rejoin_net_complete.
2015 					      bssid, ADDRLEN);
2016 				dev_dbg(&link->dev, "ray_cs new BSSID = %pm\n",
2017 					local->bss_id);
2018 				if (!sniffer)
2019 					authenticate(local);
2020 			}
2021 			break;
2022 		case ROAMING_INITIATED:
2023 			dev_dbg(&link->dev, "ray_cs interrupt roaming initiated\n");
2024 			netif_stop_queue(dev);
2025 			local->card_status = CARD_DOING_ACQ;
2026 			break;
2027 		case JAPAN_CALL_SIGN_RXD:
2028 			dev_dbg(&link->dev, "ray_cs interrupt japan call sign rx\n");
2029 			break;
2030 		default:
2031 			dev_dbg(&link->dev,
2032 			      "ray_cs Unexpected interrupt for RCS 0x%x cmd = 0x%x\n",
2033 			      rcsindex,
2034 			      (unsigned int)readb(&prcs->interrupt_id));
2035 			break;
2036 		}
2037 		writeb(CCS_BUFFER_FREE, &prcs->buffer_status);
2038 	}
2039 	clear_interrupt(local);
2040 	return IRQ_HANDLED;
2041 } /* ray_interrupt */
2042 
2043 /*===========================================================================*/
ray_rx(struct net_device * dev,ray_dev_t * local,struct rcs __iomem * prcs)2044 static void ray_rx(struct net_device *dev, ray_dev_t *local,
2045 		   struct rcs __iomem *prcs)
2046 {
2047 	int rx_len;
2048 	unsigned int pkt_addr;
2049 	void __iomem *pmsg;
2050 	pr_debug("ray_rx process rx packet\n");
2051 
2052 	/* Calculate address of packet within Rx buffer */
2053 	pkt_addr = ((readb(&prcs->var.rx_packet.rx_data_ptr[0]) << 8)
2054 		    + readb(&prcs->var.rx_packet.rx_data_ptr[1])) & RX_BUFF_END;
2055 	/* Length of first packet fragment */
2056 	rx_len = (readb(&prcs->var.rx_packet.rx_data_length[0]) << 8)
2057 	    + readb(&prcs->var.rx_packet.rx_data_length[1]);
2058 
2059 	local->last_rsl = readb(&prcs->var.rx_packet.rx_sig_lev);
2060 	pmsg = local->rmem + pkt_addr;
2061 	switch (readb(pmsg)) {
2062 	case DATA_TYPE:
2063 		pr_debug("ray_rx data type\n");
2064 		rx_data(dev, prcs, pkt_addr, rx_len);
2065 		break;
2066 	case AUTHENTIC_TYPE:
2067 		pr_debug("ray_rx authentic type\n");
2068 		if (sniffer)
2069 			rx_data(dev, prcs, pkt_addr, rx_len);
2070 		else
2071 			rx_authenticate(local, prcs, pkt_addr, rx_len);
2072 		break;
2073 	case DEAUTHENTIC_TYPE:
2074 		pr_debug("ray_rx deauth type\n");
2075 		if (sniffer)
2076 			rx_data(dev, prcs, pkt_addr, rx_len);
2077 		else
2078 			rx_deauthenticate(local, prcs, pkt_addr, rx_len);
2079 		break;
2080 	case NULL_MSG_TYPE:
2081 		pr_debug("ray_cs rx NULL msg\n");
2082 		break;
2083 	case BEACON_TYPE:
2084 		pr_debug("ray_rx beacon type\n");
2085 		if (sniffer)
2086 			rx_data(dev, prcs, pkt_addr, rx_len);
2087 
2088 		copy_from_rx_buff(local, (UCHAR *) &local->last_bcn, pkt_addr,
2089 				  rx_len < sizeof(struct beacon_rx) ?
2090 				  rx_len : sizeof(struct beacon_rx));
2091 
2092 		local->beacon_rxed = 1;
2093 		/* Get the statistics so the card counters never overflow */
2094 		ray_get_stats(dev);
2095 		break;
2096 	default:
2097 		pr_debug("ray_cs unknown pkt type %2x\n",
2098 		      (unsigned int)readb(pmsg));
2099 		break;
2100 	}
2101 
2102 } /* end ray_rx */
2103 
2104 /*===========================================================================*/
rx_data(struct net_device * dev,struct rcs __iomem * prcs,unsigned int pkt_addr,int rx_len)2105 static void rx_data(struct net_device *dev, struct rcs __iomem *prcs,
2106 		    unsigned int pkt_addr, int rx_len)
2107 {
2108 	struct sk_buff *skb = NULL;
2109 	struct rcs __iomem *prcslink = prcs;
2110 	ray_dev_t *local = netdev_priv(dev);
2111 	UCHAR *rx_ptr;
2112 	int total_len;
2113 	int tmp;
2114 #ifdef WIRELESS_SPY
2115 	int siglev = local->last_rsl;
2116 	u_char linksrcaddr[ETH_ALEN];	/* Other end of the wireless link */
2117 #endif
2118 
2119 	if (!sniffer) {
2120 		if (translate) {
2121 /* TBD length needs fixing for translated header */
2122 			if (rx_len < (ETH_HLEN + RX_MAC_HEADER_LENGTH) ||
2123 			    rx_len >
2124 			    (dev->mtu + RX_MAC_HEADER_LENGTH + ETH_HLEN +
2125 			     FCS_LEN)) {
2126 				pr_debug(
2127 				      "ray_cs invalid packet length %d received\n",
2128 				      rx_len);
2129 				return;
2130 			}
2131 		} else { /* encapsulated ethernet */
2132 
2133 			if (rx_len < (ETH_HLEN + RX_MAC_HEADER_LENGTH) ||
2134 			    rx_len >
2135 			    (dev->mtu + RX_MAC_HEADER_LENGTH + ETH_HLEN +
2136 			     FCS_LEN)) {
2137 				pr_debug(
2138 				      "ray_cs invalid packet length %d received\n",
2139 				      rx_len);
2140 				return;
2141 			}
2142 		}
2143 	}
2144 	pr_debug("ray_cs rx_data packet\n");
2145 	/* If fragmented packet, verify sizes of fragments add up */
2146 	if (readb(&prcs->var.rx_packet.next_frag_rcs_index) != 0xFF) {
2147 		pr_debug("ray_cs rx'ed fragment\n");
2148 		tmp = (readb(&prcs->var.rx_packet.totalpacketlength[0]) << 8)
2149 		    + readb(&prcs->var.rx_packet.totalpacketlength[1]);
2150 		total_len = tmp;
2151 		prcslink = prcs;
2152 		do {
2153 			tmp -=
2154 			    (readb(&prcslink->var.rx_packet.rx_data_length[0])
2155 			     << 8)
2156 			    + readb(&prcslink->var.rx_packet.rx_data_length[1]);
2157 			if (readb(&prcslink->var.rx_packet.next_frag_rcs_index)
2158 			    == 0xFF || tmp < 0)
2159 				break;
2160 			prcslink = rcs_base(local)
2161 			    + readb(&prcslink->link_field);
2162 		} while (1);
2163 
2164 		if (tmp < 0) {
2165 			pr_debug(
2166 			      "ray_cs rx_data fragment lengths don't add up\n");
2167 			local->stats.rx_dropped++;
2168 			release_frag_chain(local, prcs);
2169 			return;
2170 		}
2171 	} else { /* Single unfragmented packet */
2172 		total_len = rx_len;
2173 	}
2174 
2175 	skb = dev_alloc_skb(total_len + 5);
2176 	if (skb == NULL) {
2177 		pr_debug("ray_cs rx_data could not allocate skb\n");
2178 		local->stats.rx_dropped++;
2179 		if (readb(&prcs->var.rx_packet.next_frag_rcs_index) != 0xFF)
2180 			release_frag_chain(local, prcs);
2181 		return;
2182 	}
2183 	skb_reserve(skb, 2);	/* Align IP on 16 byte (TBD check this) */
2184 
2185 	pr_debug("ray_cs rx_data total_len = %x, rx_len = %x\n", total_len,
2186 	      rx_len);
2187 
2188 /************************/
2189 	/* Reserve enough room for the whole damn packet. */
2190 	rx_ptr = skb_put(skb, total_len);
2191 	/* Copy the whole packet to sk_buff */
2192 	rx_ptr +=
2193 	    copy_from_rx_buff(local, rx_ptr, pkt_addr & RX_BUFF_END, rx_len);
2194 	/* Get source address */
2195 #ifdef WIRELESS_SPY
2196 	skb_copy_from_linear_data_offset(skb,
2197 					 offsetof(struct mac_header, addr_2),
2198 					 linksrcaddr, ETH_ALEN);
2199 #endif
2200 	/* Now, deal with encapsulation/translation/sniffer */
2201 	if (!sniffer) {
2202 		if (!translate) {
2203 			/* Encapsulated ethernet, so just lop off 802.11 MAC header */
2204 /* TBD reserve            skb_reserve( skb, RX_MAC_HEADER_LENGTH); */
2205 			skb_pull(skb, RX_MAC_HEADER_LENGTH);
2206 		} else {
2207 			/* Do translation */
2208 			untranslate(local, skb, total_len);
2209 		}
2210 	} else { /* sniffer mode, so just pass whole packet */
2211 	}
2212 
2213 /************************/
2214 	/* Now pick up the rest of the fragments if any */
2215 	tmp = 17;
2216 	if (readb(&prcs->var.rx_packet.next_frag_rcs_index) != 0xFF) {
2217 		prcslink = prcs;
2218 		pr_debug("ray_cs rx_data in fragment loop\n");
2219 		do {
2220 			prcslink = rcs_base(local)
2221 			    +
2222 			    readb(&prcslink->var.rx_packet.next_frag_rcs_index);
2223 			rx_len =
2224 			    ((readb(&prcslink->var.rx_packet.rx_data_length[0])
2225 			      << 8)
2226 			     +
2227 			     readb(&prcslink->var.rx_packet.rx_data_length[1]))
2228 			    & RX_BUFF_END;
2229 			pkt_addr =
2230 			    ((readb(&prcslink->var.rx_packet.rx_data_ptr[0]) <<
2231 			      8)
2232 			     + readb(&prcslink->var.rx_packet.rx_data_ptr[1]))
2233 			    & RX_BUFF_END;
2234 
2235 			rx_ptr +=
2236 			    copy_from_rx_buff(local, rx_ptr, pkt_addr, rx_len);
2237 
2238 		} while (tmp-- &&
2239 			 readb(&prcslink->var.rx_packet.next_frag_rcs_index) !=
2240 			 0xFF);
2241 		release_frag_chain(local, prcs);
2242 	}
2243 
2244 	skb->protocol = eth_type_trans(skb, dev);
2245 	netif_rx(skb);
2246 	local->stats.rx_packets++;
2247 	local->stats.rx_bytes += total_len;
2248 
2249 	/* Gather signal strength per address */
2250 #ifdef WIRELESS_SPY
2251 	/* For the Access Point or the node having started the ad-hoc net
2252 	 * note : ad-hoc work only in some specific configurations, but we
2253 	 * kludge in ray_get_wireless_stats... */
2254 	if (!memcmp(linksrcaddr, local->bss_id, ETH_ALEN)) {
2255 		/* Update statistics */
2256 		/*local->wstats.qual.qual = none ? */
2257 		local->wstats.qual.level = siglev;
2258 		/*local->wstats.qual.noise = none ? */
2259 		local->wstats.qual.updated = 0x2;
2260 	}
2261 	/* Now, update the spy stuff */
2262 	{
2263 		struct iw_quality wstats;
2264 		wstats.level = siglev;
2265 		/* wstats.noise = none ? */
2266 		/* wstats.qual = none ? */
2267 		wstats.updated = 0x2;
2268 		/* Update spy records */
2269 		wireless_spy_update(dev, linksrcaddr, &wstats);
2270 	}
2271 #endif /* WIRELESS_SPY */
2272 } /* end rx_data */
2273 
2274 /*===========================================================================*/
untranslate(ray_dev_t * local,struct sk_buff * skb,int len)2275 static void untranslate(ray_dev_t *local, struct sk_buff *skb, int len)
2276 {
2277 	snaphdr_t *psnap = (snaphdr_t *) (skb->data + RX_MAC_HEADER_LENGTH);
2278 	struct ieee80211_hdr *pmac = (struct ieee80211_hdr *)skb->data;
2279 	__be16 type = *(__be16 *) psnap->ethertype;
2280 	int delta;
2281 	struct ethhdr *peth;
2282 	UCHAR srcaddr[ADDRLEN];
2283 	UCHAR destaddr[ADDRLEN];
2284 	static const UCHAR org_bridge[3] = { 0, 0, 0xf8 };
2285 	static const UCHAR org_1042[3] = { 0, 0, 0 };
2286 
2287 	memcpy(destaddr, ieee80211_get_DA(pmac), ADDRLEN);
2288 	memcpy(srcaddr, ieee80211_get_SA(pmac), ADDRLEN);
2289 
2290 #if 0
2291 	if {
2292 		print_hex_dump(KERN_DEBUG, "skb->data before untranslate: ",
2293 			       DUMP_PREFIX_NONE, 16, 1,
2294 			       skb->data, 64, true);
2295 		printk(KERN_DEBUG
2296 		       "type = %08x, xsap = %02x%02x%02x, org = %02x02x02x\n",
2297 		       ntohs(type), psnap->dsap, psnap->ssap, psnap->ctrl,
2298 		       psnap->org[0], psnap->org[1], psnap->org[2]);
2299 		printk(KERN_DEBUG "untranslate skb->data = %p\n", skb->data);
2300 	}
2301 #endif
2302 
2303 	if (psnap->dsap != 0xaa || psnap->ssap != 0xaa || psnap->ctrl != 3) {
2304 		/* not a snap type so leave it alone */
2305 		pr_debug("ray_cs untranslate NOT SNAP %02x %02x %02x\n",
2306 		      psnap->dsap, psnap->ssap, psnap->ctrl);
2307 
2308 		delta = RX_MAC_HEADER_LENGTH - ETH_HLEN;
2309 		peth = (struct ethhdr *)(skb->data + delta);
2310 		peth->h_proto = htons(len - RX_MAC_HEADER_LENGTH);
2311 	} else { /* Its a SNAP */
2312 		if (memcmp(psnap->org, org_bridge, 3) == 0) {
2313 		/* EtherII and nuke the LLC */
2314 			pr_debug("ray_cs untranslate Bridge encap\n");
2315 			delta = RX_MAC_HEADER_LENGTH
2316 			    + sizeof(struct snaphdr_t) - ETH_HLEN;
2317 			peth = (struct ethhdr *)(skb->data + delta);
2318 			peth->h_proto = type;
2319 		} else if (memcmp(psnap->org, org_1042, 3) == 0) {
2320 			switch (ntohs(type)) {
2321 			case ETH_P_IPX:
2322 			case ETH_P_AARP:
2323 				pr_debug("ray_cs untranslate RFC IPX/AARP\n");
2324 				delta = RX_MAC_HEADER_LENGTH - ETH_HLEN;
2325 				peth = (struct ethhdr *)(skb->data + delta);
2326 				peth->h_proto =
2327 				    htons(len - RX_MAC_HEADER_LENGTH);
2328 				break;
2329 			default:
2330 				pr_debug("ray_cs untranslate RFC default\n");
2331 				delta = RX_MAC_HEADER_LENGTH +
2332 				    sizeof(struct snaphdr_t) - ETH_HLEN;
2333 				peth = (struct ethhdr *)(skb->data + delta);
2334 				peth->h_proto = type;
2335 				break;
2336 			}
2337 		} else {
2338 			printk("ray_cs untranslate very confused by packet\n");
2339 			delta = RX_MAC_HEADER_LENGTH - ETH_HLEN;
2340 			peth = (struct ethhdr *)(skb->data + delta);
2341 			peth->h_proto = type;
2342 		}
2343 	}
2344 /* TBD reserve  skb_reserve(skb, delta); */
2345 	skb_pull(skb, delta);
2346 	pr_debug("untranslate after skb_pull(%d), skb->data = %p\n", delta,
2347 	      skb->data);
2348 	memcpy(peth->h_dest, destaddr, ADDRLEN);
2349 	memcpy(peth->h_source, srcaddr, ADDRLEN);
2350 #if 0
2351 	{
2352 		int i;
2353 		printk(KERN_DEBUG "skb->data after untranslate:");
2354 		for (i = 0; i < 64; i++)
2355 			printk("%02x ", skb->data[i]);
2356 		printk("\n");
2357 	}
2358 #endif
2359 } /* end untranslate */
2360 
2361 /*===========================================================================*/
2362 /* Copy data from circular receive buffer to PC memory.
2363  * dest     = destination address in PC memory
2364  * pkt_addr = source address in receive buffer
2365  * len      = length of packet to copy
2366  */
copy_from_rx_buff(ray_dev_t * local,UCHAR * dest,int pkt_addr,int length)2367 static int copy_from_rx_buff(ray_dev_t *local, UCHAR *dest, int pkt_addr,
2368 			     int length)
2369 {
2370 	int wrap_bytes = (pkt_addr + length) - (RX_BUFF_END + 1);
2371 	if (wrap_bytes <= 0) {
2372 		memcpy_fromio(dest, local->rmem + pkt_addr, length);
2373 	} else { /* Packet wrapped in circular buffer */
2374 
2375 		memcpy_fromio(dest, local->rmem + pkt_addr,
2376 			      length - wrap_bytes);
2377 		memcpy_fromio(dest + length - wrap_bytes, local->rmem,
2378 			      wrap_bytes);
2379 	}
2380 	return length;
2381 }
2382 
2383 /*===========================================================================*/
release_frag_chain(ray_dev_t * local,struct rcs __iomem * prcs)2384 static void release_frag_chain(ray_dev_t *local, struct rcs __iomem *prcs)
2385 {
2386 	struct rcs __iomem *prcslink = prcs;
2387 	int tmp = 17;
2388 	unsigned rcsindex = readb(&prcs->var.rx_packet.next_frag_rcs_index);
2389 
2390 	while (tmp--) {
2391 		writeb(CCS_BUFFER_FREE, &prcslink->buffer_status);
2392 		if (rcsindex >= (NUMBER_OF_CCS + NUMBER_OF_RCS)) {
2393 			pr_debug("ray_cs interrupt bad rcsindex = 0x%x\n",
2394 			      rcsindex);
2395 			break;
2396 		}
2397 		prcslink = rcs_base(local) + rcsindex;
2398 		rcsindex = readb(&prcslink->var.rx_packet.next_frag_rcs_index);
2399 	}
2400 	writeb(CCS_BUFFER_FREE, &prcslink->buffer_status);
2401 }
2402 
2403 /*===========================================================================*/
authenticate(ray_dev_t * local)2404 static void authenticate(ray_dev_t *local)
2405 {
2406 	struct pcmcia_device *link = local->finder;
2407 	dev_dbg(&link->dev, "ray_cs Starting authentication.\n");
2408 	if (!(pcmcia_dev_present(link))) {
2409 		dev_dbg(&link->dev, "ray_cs authenticate - device not present\n");
2410 		return;
2411 	}
2412 
2413 	del_timer(&local->timer);
2414 	if (build_auth_frame(local, local->bss_id, OPEN_AUTH_REQUEST)) {
2415 		local->timer.function = join_net;
2416 	} else {
2417 		local->timer.function = authenticate_timeout;
2418 	}
2419 	local->timer.expires = jiffies + HZ * 2;
2420 	add_timer(&local->timer);
2421 	local->authentication_state = AWAITING_RESPONSE;
2422 } /* end authenticate */
2423 
2424 /*===========================================================================*/
rx_authenticate(ray_dev_t * local,struct rcs __iomem * prcs,unsigned int pkt_addr,int rx_len)2425 static void rx_authenticate(ray_dev_t *local, struct rcs __iomem *prcs,
2426 			    unsigned int pkt_addr, int rx_len)
2427 {
2428 	UCHAR buff[256];
2429 	struct ray_rx_msg *msg = (struct ray_rx_msg *) buff;
2430 
2431 	del_timer(&local->timer);
2432 
2433 	copy_from_rx_buff(local, buff, pkt_addr, rx_len & 0xff);
2434 	/* if we are trying to get authenticated */
2435 	if (local->sparm.b4.a_network_type == ADHOC) {
2436 		pr_debug("ray_cs rx_auth var= %6ph\n", msg->var);
2437 		if (msg->var[2] == 1) {
2438 			pr_debug("ray_cs Sending authentication response.\n");
2439 			if (!build_auth_frame
2440 			    (local, msg->mac.addr_2, OPEN_AUTH_RESPONSE)) {
2441 				local->authentication_state = NEED_TO_AUTH;
2442 				memcpy(local->auth_id, msg->mac.addr_2,
2443 				       ADDRLEN);
2444 			}
2445 		}
2446 	} else { /* Infrastructure network */
2447 
2448 		if (local->authentication_state == AWAITING_RESPONSE) {
2449 			/* Verify authentication sequence #2 and success */
2450 			if (msg->var[2] == 2) {
2451 				if ((msg->var[3] | msg->var[4]) == 0) {
2452 					pr_debug("Authentication successful\n");
2453 					local->card_status = CARD_AUTH_COMPLETE;
2454 					associate(local);
2455 					local->authentication_state =
2456 					    AUTHENTICATED;
2457 				} else {
2458 					pr_debug("Authentication refused\n");
2459 					local->card_status = CARD_AUTH_REFUSED;
2460 					join_net(&local->timer);
2461 					local->authentication_state =
2462 					    UNAUTHENTICATED;
2463 				}
2464 			}
2465 		}
2466 	}
2467 
2468 } /* end rx_authenticate */
2469 
2470 /*===========================================================================*/
associate(ray_dev_t * local)2471 static void associate(ray_dev_t *local)
2472 {
2473 	struct ccs __iomem *pccs;
2474 	struct pcmcia_device *link = local->finder;
2475 	struct net_device *dev = link->priv;
2476 	int ccsindex;
2477 	if (!(pcmcia_dev_present(link))) {
2478 		dev_dbg(&link->dev, "ray_cs associate - device not present\n");
2479 		return;
2480 	}
2481 	/* If no tx buffers available, return */
2482 	if ((ccsindex = get_free_ccs(local)) < 0) {
2483 /* TBD should never be here but... what if we are? */
2484 		dev_dbg(&link->dev, "ray_cs associate - No free ccs\n");
2485 		return;
2486 	}
2487 	dev_dbg(&link->dev, "ray_cs Starting association with access point\n");
2488 	pccs = ccs_base(local) + ccsindex;
2489 	/* fill in the CCS */
2490 	writeb(CCS_START_ASSOCIATION, &pccs->cmd);
2491 	/* Interrupt the firmware to process the command */
2492 	if (interrupt_ecf(local, ccsindex)) {
2493 		dev_dbg(&link->dev, "ray_cs associate failed - ECF not ready for intr\n");
2494 		writeb(CCS_BUFFER_FREE, &(pccs++)->buffer_status);
2495 
2496 		del_timer(&local->timer);
2497 		local->timer.expires = jiffies + HZ * 2;
2498 		local->timer.function = join_net;
2499 		add_timer(&local->timer);
2500 		local->card_status = CARD_ASSOC_FAILED;
2501 		return;
2502 	}
2503 	if (!sniffer)
2504 		netif_start_queue(dev);
2505 
2506 } /* end associate */
2507 
2508 /*===========================================================================*/
rx_deauthenticate(ray_dev_t * local,struct rcs __iomem * prcs,unsigned int pkt_addr,int rx_len)2509 static void rx_deauthenticate(ray_dev_t *local, struct rcs __iomem *prcs,
2510 			      unsigned int pkt_addr, int rx_len)
2511 {
2512 /*  UCHAR buff[256];
2513     struct ray_rx_msg *msg = (struct ray_rx_msg *) buff;
2514 */
2515 	pr_debug("Deauthentication frame received\n");
2516 	local->authentication_state = UNAUTHENTICATED;
2517 	/* Need to reauthenticate or rejoin depending on reason code */
2518 /*  copy_from_rx_buff(local, buff, pkt_addr, rx_len & 0xff);
2519  */
2520 }
2521 
2522 /*===========================================================================*/
clear_interrupt(ray_dev_t * local)2523 static void clear_interrupt(ray_dev_t *local)
2524 {
2525 	writeb(0, local->amem + CIS_OFFSET + HCS_INTR_OFFSET);
2526 }
2527 
2528 /*===========================================================================*/
2529 #ifdef CONFIG_PROC_FS
2530 #define MAXDATA (PAGE_SIZE - 80)
2531 
2532 static const char *card_status[] = {
2533 	"Card inserted - uninitialized",	/* 0 */
2534 	"Card not downloaded",			/* 1 */
2535 	"Waiting for download parameters",	/* 2 */
2536 	"Card doing acquisition",		/* 3 */
2537 	"Acquisition complete",			/* 4 */
2538 	"Authentication complete",		/* 5 */
2539 	"Association complete",			/* 6 */
2540 	"???", "???", "???", "???",		/* 7 8 9 10 undefined */
2541 	"Card init error",			/* 11 */
2542 	"Download parameters error",		/* 12 */
2543 	"???",					/* 13 */
2544 	"Acquisition failed",			/* 14 */
2545 	"Authentication refused",		/* 15 */
2546 	"Association failed"			/* 16 */
2547 };
2548 
2549 static const char *nettype[] = { "Adhoc", "Infra " };
2550 static const char *framing[] = { "Encapsulation", "Translation" }
2551 
2552 ;
2553 /*===========================================================================*/
ray_cs_proc_show(struct seq_file * m,void * v)2554 static int ray_cs_proc_show(struct seq_file *m, void *v)
2555 {
2556 /* Print current values which are not available via other means
2557  * eg ifconfig
2558  */
2559 	int i;
2560 	struct pcmcia_device *link;
2561 	struct net_device *dev;
2562 	ray_dev_t *local;
2563 	UCHAR *p;
2564 	struct freq_hop_element *pfh;
2565 	UCHAR c[33];
2566 
2567 	link = this_device;
2568 	if (!link)
2569 		return 0;
2570 	dev = (struct net_device *)link->priv;
2571 	if (!dev)
2572 		return 0;
2573 	local = netdev_priv(dev);
2574 	if (!local)
2575 		return 0;
2576 
2577 	seq_puts(m, "Raylink Wireless LAN driver status\n");
2578 	seq_printf(m, "%s\n", rcsid);
2579 	/* build 4 does not report version, and field is 0x55 after memtest */
2580 	seq_puts(m, "Firmware version     = ");
2581 	if (local->fw_ver == 0x55)
2582 		seq_puts(m, "4 - Use dump_cis for more details\n");
2583 	else
2584 		seq_printf(m, "%2d.%02d.%02d\n",
2585 			   local->fw_ver, local->fw_bld, local->fw_var);
2586 
2587 	for (i = 0; i < 32; i++)
2588 		c[i] = local->sparm.b5.a_current_ess_id[i];
2589 	c[32] = 0;
2590 	seq_printf(m, "%s network ESSID = \"%s\"\n",
2591 		   nettype[local->sparm.b5.a_network_type], c);
2592 
2593 	p = local->bss_id;
2594 	seq_printf(m, "BSSID                = %pM\n", p);
2595 
2596 	seq_printf(m, "Country code         = %d\n",
2597 		   local->sparm.b5.a_curr_country_code);
2598 
2599 	i = local->card_status;
2600 	if (i < 0)
2601 		i = 10;
2602 	if (i > 16)
2603 		i = 10;
2604 	seq_printf(m, "Card status          = %s\n", card_status[i]);
2605 
2606 	seq_printf(m, "Framing mode         = %s\n", framing[translate]);
2607 
2608 	seq_printf(m, "Last pkt signal lvl  = %d\n", local->last_rsl);
2609 
2610 	if (local->beacon_rxed) {
2611 		/* Pull some fields out of last beacon received */
2612 		seq_printf(m, "Beacon Interval      = %d Kus\n",
2613 			   local->last_bcn.beacon_intvl[0]
2614 			   + 256 * local->last_bcn.beacon_intvl[1]);
2615 
2616 		p = local->last_bcn.elements;
2617 		if (p[0] == C_ESSID_ELEMENT_ID)
2618 			p += p[1] + 2;
2619 		else {
2620 			seq_printf(m,
2621 				   "Parse beacon failed at essid element id = %d\n",
2622 				   p[0]);
2623 			return 0;
2624 		}
2625 
2626 		if (p[0] == C_SUPPORTED_RATES_ELEMENT_ID) {
2627 			seq_puts(m, "Supported rate codes = ");
2628 			for (i = 2; i < p[1] + 2; i++)
2629 				seq_printf(m, "0x%02x ", p[i]);
2630 			seq_putc(m, '\n');
2631 			p += p[1] + 2;
2632 		} else {
2633 			seq_puts(m, "Parse beacon failed at rates element\n");
2634 			return 0;
2635 		}
2636 
2637 		if (p[0] == C_FH_PARAM_SET_ELEMENT_ID) {
2638 			pfh = (struct freq_hop_element *)p;
2639 			seq_printf(m, "Hop dwell            = %d Kus\n",
2640 				   pfh->dwell_time[0] +
2641 				   256 * pfh->dwell_time[1]);
2642 			seq_printf(m, "Hop set              = %d\n",
2643 				   pfh->hop_set);
2644 			seq_printf(m, "Hop pattern          = %d\n",
2645 				   pfh->hop_pattern);
2646 			seq_printf(m, "Hop index            = %d\n",
2647 				   pfh->hop_index);
2648 			p += p[1] + 2;
2649 		} else {
2650 			seq_puts(m,
2651 				 "Parse beacon failed at FH param element\n");
2652 			return 0;
2653 		}
2654 	} else {
2655 		seq_puts(m, "No beacons received\n");
2656 	}
2657 	return 0;
2658 }
2659 #endif
2660 /*===========================================================================*/
build_auth_frame(ray_dev_t * local,UCHAR * dest,int auth_type)2661 static int build_auth_frame(ray_dev_t *local, UCHAR *dest, int auth_type)
2662 {
2663 	int addr;
2664 	struct ccs __iomem *pccs;
2665 	struct tx_msg __iomem *ptx;
2666 	int ccsindex;
2667 
2668 	/* If no tx buffers available, return */
2669 	if ((ccsindex = get_free_tx_ccs(local)) < 0) {
2670 		pr_debug("ray_cs send authenticate - No free tx ccs\n");
2671 		return -1;
2672 	}
2673 
2674 	pccs = ccs_base(local) + ccsindex;
2675 
2676 	/* Address in card space */
2677 	addr = TX_BUF_BASE + (ccsindex << 11);
2678 	/* fill in the CCS */
2679 	writeb(CCS_TX_REQUEST, &pccs->cmd);
2680 	writeb(addr >> 8, pccs->var.tx_request.tx_data_ptr);
2681 	writeb(0x20, pccs->var.tx_request.tx_data_ptr + 1);
2682 	writeb(TX_AUTHENTICATE_LENGTH_MSB, pccs->var.tx_request.tx_data_length);
2683 	writeb(TX_AUTHENTICATE_LENGTH_LSB,
2684 	       pccs->var.tx_request.tx_data_length + 1);
2685 	writeb(0, &pccs->var.tx_request.pow_sav_mode);
2686 
2687 	ptx = local->sram + addr;
2688 	/* fill in the mac header */
2689 	writeb(PROTOCOL_VER | AUTHENTIC_TYPE, &ptx->mac.frame_ctl_1);
2690 	writeb(0, &ptx->mac.frame_ctl_2);
2691 
2692 	memcpy_toio(ptx->mac.addr_1, dest, ADDRLEN);
2693 	memcpy_toio(ptx->mac.addr_2, local->sparm.b4.a_mac_addr, ADDRLEN);
2694 	memcpy_toio(ptx->mac.addr_3, local->bss_id, ADDRLEN);
2695 
2696 	/* Fill in msg body with protocol 00 00, sequence 01 00 ,status 00 00 */
2697 	memset_io(ptx->var, 0, 6);
2698 	writeb(auth_type & 0xff, ptx->var + 2);
2699 
2700 	/* Interrupt the firmware to process the command */
2701 	if (interrupt_ecf(local, ccsindex)) {
2702 		pr_debug(
2703 		      "ray_cs send authentication request failed - ECF not ready for intr\n");
2704 		writeb(CCS_BUFFER_FREE, &(pccs++)->buffer_status);
2705 		return -1;
2706 	}
2707 	return 0;
2708 } /* End build_auth_frame */
2709 
2710 /*===========================================================================*/
2711 #ifdef CONFIG_PROC_FS
ray_cs_essid_proc_write(struct file * file,const char __user * buffer,size_t count,loff_t * pos)2712 static ssize_t ray_cs_essid_proc_write(struct file *file,
2713 		const char __user *buffer, size_t count, loff_t *pos)
2714 {
2715 	static char proc_essid[33];
2716 	unsigned int len = count;
2717 
2718 	if (len > 32)
2719 		len = 32;
2720 	memset(proc_essid, 0, 33);
2721 	if (copy_from_user(proc_essid, buffer, len))
2722 		return -EFAULT;
2723 	essid = proc_essid;
2724 	return count;
2725 }
2726 
2727 static const struct proc_ops ray_cs_essid_proc_ops = {
2728 	.proc_write	= ray_cs_essid_proc_write,
2729 	.proc_lseek	= noop_llseek,
2730 };
2731 
int_proc_write(struct file * file,const char __user * buffer,size_t count,loff_t * pos)2732 static ssize_t int_proc_write(struct file *file, const char __user *buffer,
2733 			      size_t count, loff_t *pos)
2734 {
2735 	static char proc_number[10];
2736 	char *p;
2737 	int nr, len;
2738 
2739 	if (!count)
2740 		return 0;
2741 
2742 	if (count > 9)
2743 		return -EINVAL;
2744 	if (copy_from_user(proc_number, buffer, count))
2745 		return -EFAULT;
2746 	p = proc_number;
2747 	nr = 0;
2748 	len = count;
2749 	do {
2750 		unsigned int c = *p - '0';
2751 		if (c > 9)
2752 			return -EINVAL;
2753 		nr = nr * 10 + c;
2754 		p++;
2755 	} while (--len);
2756 	*(int *)pde_data(file_inode(file)) = nr;
2757 	return count;
2758 }
2759 
2760 static const struct proc_ops int_proc_ops = {
2761 	.proc_write	= int_proc_write,
2762 	.proc_lseek	= noop_llseek,
2763 };
2764 #endif
2765 
2766 static const struct pcmcia_device_id ray_ids[] = {
2767 	PCMCIA_DEVICE_MANF_CARD(0x01a6, 0x0000),
2768 	PCMCIA_DEVICE_NULL,
2769 };
2770 
2771 MODULE_DEVICE_TABLE(pcmcia, ray_ids);
2772 
2773 static struct pcmcia_driver ray_driver = {
2774 	.owner = THIS_MODULE,
2775 	.name = "ray_cs",
2776 	.probe = ray_probe,
2777 	.remove = ray_detach,
2778 	.id_table = ray_ids,
2779 	.suspend = ray_suspend,
2780 	.resume = ray_resume,
2781 };
2782 
init_ray_cs(void)2783 static int __init init_ray_cs(void)
2784 {
2785 	int rc;
2786 
2787 	pr_debug("%s\n", rcsid);
2788 	rc = pcmcia_register_driver(&ray_driver);
2789 	pr_debug("raylink init_module register_pcmcia_driver returns 0x%x\n",
2790 	      rc);
2791 	if (rc)
2792 		return rc;
2793 
2794 #ifdef CONFIG_PROC_FS
2795 	proc_mkdir("driver/ray_cs", NULL);
2796 
2797 	proc_create_single("driver/ray_cs/ray_cs", 0, NULL, ray_cs_proc_show);
2798 	proc_create("driver/ray_cs/essid", 0200, NULL, &ray_cs_essid_proc_ops);
2799 	proc_create_data("driver/ray_cs/net_type", 0200, NULL, &int_proc_ops,
2800 			 &net_type);
2801 	proc_create_data("driver/ray_cs/translate", 0200, NULL, &int_proc_ops,
2802 			 &translate);
2803 #endif
2804 	translate = !!translate;
2805 	return 0;
2806 } /* init_ray_cs */
2807 
2808 /*===========================================================================*/
2809 
exit_ray_cs(void)2810 static void __exit exit_ray_cs(void)
2811 {
2812 	pr_debug("ray_cs: cleanup_module\n");
2813 
2814 #ifdef CONFIG_PROC_FS
2815 	remove_proc_subtree("driver/ray_cs", NULL);
2816 #endif
2817 
2818 	pcmcia_unregister_driver(&ray_driver);
2819 } /* exit_ray_cs */
2820 
2821 module_init(init_ray_cs);
2822 module_exit(exit_ray_cs);
2823 
2824 /*===========================================================================*/
2825