1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  * IPWireless 3G PCMCIA Network Driver
4  *
5  * Original code
6  *   by Stephen Blackheath <stephen@blacksapphire.com>,
7  *      Ben Martel <benm@symmetric.co.nz>
8  *
9  * Copyrighted as follows:
10  *   Copyright (C) 2004 by Symmetric Systems Ltd (NZ)
11  *
12  * Various driver changes and rewrites, port to new kernels
13  *   Copyright (C) 2006-2007 Jiri Kosina
14  *
15  * Misc code cleanups and updates
16  *   Copyright (C) 2007 David Sterba
17  */
18 
19 #include <linux/interrupt.h>
20 #include <linux/io.h>
21 #include <linux/irq.h>
22 #include <linux/kernel.h>
23 #include <linux/list.h>
24 #include <linux/slab.h>
25 
26 #include "hardware.h"
27 #include "setup_protocol.h"
28 #include "network.h"
29 #include "main.h"
30 
31 static void ipw_send_setup_packet(struct ipw_hardware *hw);
32 static void handle_received_SETUP_packet(struct ipw_hardware *ipw,
33 					 unsigned int address,
34 					 const unsigned char *data, int len,
35 					 int is_last);
36 static void ipwireless_setup_timer(struct timer_list *t);
37 static void handle_received_CTRL_packet(struct ipw_hardware *hw,
38 		unsigned int channel_idx, const unsigned char *data, int len);
39 
40 /*#define TIMING_DIAGNOSTICS*/
41 
42 #ifdef TIMING_DIAGNOSTICS
43 
44 static struct timing_stats {
45 	unsigned long last_report_time;
46 	unsigned long read_time;
47 	unsigned long write_time;
48 	unsigned long read_bytes;
49 	unsigned long write_bytes;
50 	unsigned long start_time;
51 };
52 
start_timing(void)53 static void start_timing(void)
54 {
55 	timing_stats.start_time = jiffies;
56 }
57 
end_read_timing(unsigned length)58 static void end_read_timing(unsigned length)
59 {
60 	timing_stats.read_time += (jiffies - start_time);
61 	timing_stats.read_bytes += length + 2;
62 	report_timing();
63 }
64 
end_write_timing(unsigned length)65 static void end_write_timing(unsigned length)
66 {
67 	timing_stats.write_time += (jiffies - start_time);
68 	timing_stats.write_bytes += length + 2;
69 	report_timing();
70 }
71 
report_timing(void)72 static void report_timing(void)
73 {
74 	unsigned long since = jiffies - timing_stats.last_report_time;
75 
76 	/* If it's been more than one second... */
77 	if (since >= HZ) {
78 		int first = (timing_stats.last_report_time == 0);
79 
80 		timing_stats.last_report_time = jiffies;
81 		if (!first)
82 			printk(KERN_INFO IPWIRELESS_PCCARD_NAME
83 			       ": %u us elapsed - read %lu bytes in %u us, wrote %lu bytes in %u us\n",
84 			       jiffies_to_usecs(since),
85 			       timing_stats.read_bytes,
86 			       jiffies_to_usecs(timing_stats.read_time),
87 			       timing_stats.write_bytes,
88 			       jiffies_to_usecs(timing_stats.write_time));
89 
90 		timing_stats.read_time = 0;
91 		timing_stats.write_time = 0;
92 		timing_stats.read_bytes = 0;
93 		timing_stats.write_bytes = 0;
94 	}
95 }
96 #else
start_timing(void)97 static void start_timing(void) { }
end_read_timing(unsigned length)98 static void end_read_timing(unsigned length) { }
end_write_timing(unsigned length)99 static void end_write_timing(unsigned length) { }
100 #endif
101 
102 /* Imported IPW definitions */
103 
104 #define LL_MTU_V1 318
105 #define LL_MTU_V2 250
106 #define LL_MTU_MAX (LL_MTU_V1 > LL_MTU_V2 ? LL_MTU_V1 : LL_MTU_V2)
107 
108 #define PRIO_DATA  2
109 #define PRIO_CTRL  1
110 #define PRIO_SETUP 0
111 
112 /* Addresses */
113 #define ADDR_SETUP_PROT 0
114 
115 /* Protocol ids */
116 enum {
117 	/* Identifier for the Com Data protocol */
118 	TL_PROTOCOLID_COM_DATA = 0,
119 
120 	/* Identifier for the Com Control protocol */
121 	TL_PROTOCOLID_COM_CTRL = 1,
122 
123 	/* Identifier for the Setup protocol */
124 	TL_PROTOCOLID_SETUP = 2
125 };
126 
127 /* Number of bytes in NL packet header (cannot do
128  * sizeof(nl_packet_header) since it's a bitfield) */
129 #define NL_FIRST_PACKET_HEADER_SIZE        3
130 
131 /* Number of bytes in NL packet header (cannot do
132  * sizeof(nl_packet_header) since it's a bitfield) */
133 #define NL_FOLLOWING_PACKET_HEADER_SIZE    1
134 
135 struct nl_first_packet_header {
136 	unsigned char protocol:3;
137 	unsigned char address:3;
138 	unsigned char packet_rank:2;
139 	unsigned char length_lsb;
140 	unsigned char length_msb;
141 };
142 
143 struct nl_packet_header {
144 	unsigned char protocol:3;
145 	unsigned char address:3;
146 	unsigned char packet_rank:2;
147 };
148 
149 /* Value of 'packet_rank' above */
150 #define NL_INTERMEDIATE_PACKET    0x0
151 #define NL_LAST_PACKET            0x1
152 #define NL_FIRST_PACKET           0x2
153 
154 union nl_packet {
155 	/* Network packet header of the first packet (a special case) */
156 	struct nl_first_packet_header hdr_first;
157 	/* Network packet header of the following packets (if any) */
158 	struct nl_packet_header hdr;
159 	/* Complete network packet (header + data) */
160 	unsigned char rawpkt[LL_MTU_MAX];
161 } __attribute__ ((__packed__));
162 
163 #define HW_VERSION_UNKNOWN -1
164 #define HW_VERSION_1 1
165 #define HW_VERSION_2 2
166 
167 /* IPW I/O ports */
168 #define IOIER 0x00		/* Interrupt Enable Register */
169 #define IOIR  0x02		/* Interrupt Source/ACK register */
170 #define IODCR 0x04		/* Data Control Register */
171 #define IODRR 0x06		/* Data Read Register */
172 #define IODWR 0x08		/* Data Write Register */
173 #define IOESR 0x0A		/* Embedded Driver Status Register */
174 #define IORXR 0x0C		/* Rx Fifo Register (Host to Embedded) */
175 #define IOTXR 0x0E		/* Tx Fifo Register (Embedded to Host) */
176 
177 /* I/O ports and bit definitions for version 1 of the hardware */
178 
179 /* IER bits*/
180 #define IER_RXENABLED   0x1
181 #define IER_TXENABLED   0x2
182 
183 /* ISR bits */
184 #define IR_RXINTR       0x1
185 #define IR_TXINTR       0x2
186 
187 /* DCR bits */
188 #define DCR_RXDONE      0x1
189 #define DCR_TXDONE      0x2
190 #define DCR_RXRESET     0x4
191 #define DCR_TXRESET     0x8
192 
193 /* I/O ports and bit definitions for version 2 of the hardware */
194 
195 struct MEMCCR {
196 	unsigned short reg_config_option;	/* PCCOR: Configuration Option Register */
197 	unsigned short reg_config_and_status;	/* PCCSR: Configuration and Status Register */
198 	unsigned short reg_pin_replacement;	/* PCPRR: Pin Replacemant Register */
199 	unsigned short reg_socket_and_copy;	/* PCSCR: Socket and Copy Register */
200 	unsigned short reg_ext_status;		/* PCESR: Extendend Status Register */
201 	unsigned short reg_io_base;		/* PCIOB: I/O Base Register */
202 };
203 
204 struct MEMINFREG {
205 	unsigned short memreg_tx_old;	/* TX Register (R/W) */
206 	unsigned short pad1;
207 	unsigned short memreg_rx_done;	/* RXDone Register (R/W) */
208 	unsigned short pad2;
209 	unsigned short memreg_rx;	/* RX Register (R/W) */
210 	unsigned short pad3;
211 	unsigned short memreg_pc_interrupt_ack;	/* PC intr Ack Register (W) */
212 	unsigned short pad4;
213 	unsigned long memreg_card_present;/* Mask for Host to check (R) for
214 					   * CARD_PRESENT_VALUE */
215 	unsigned short memreg_tx_new;	/* TX2 (new) Register (R/W) */
216 };
217 
218 #define CARD_PRESENT_VALUE (0xBEEFCAFEUL)
219 
220 #define MEMTX_TX                       0x0001
221 #define MEMRX_RX                       0x0001
222 #define MEMRX_RX_DONE                  0x0001
223 #define MEMRX_PCINTACKK                0x0001
224 
225 #define NL_NUM_OF_PRIORITIES       3
226 #define NL_NUM_OF_PROTOCOLS        3
227 #define NL_NUM_OF_ADDRESSES        NO_OF_IPW_CHANNELS
228 
229 struct ipw_hardware {
230 	unsigned int base_port;
231 	short hw_version;
232 	unsigned short ll_mtu;
233 	spinlock_t lock;
234 
235 	int initializing;
236 	int init_loops;
237 	struct timer_list setup_timer;
238 
239 	/* Flag if hw is ready to send next packet */
240 	int tx_ready;
241 	/* Count of pending packets to be sent */
242 	int tx_queued;
243 	struct list_head tx_queue[NL_NUM_OF_PRIORITIES];
244 
245 	int rx_bytes_queued;
246 	struct list_head rx_queue;
247 	/* Pool of rx_packet structures that are not currently used. */
248 	struct list_head rx_pool;
249 	int rx_pool_size;
250 	/* True if reception of data is blocked while userspace processes it. */
251 	int blocking_rx;
252 	/* True if there is RX data ready on the hardware. */
253 	int rx_ready;
254 	unsigned short last_memtx_serial;
255 	/*
256 	 * Newer versions of the V2 card firmware send serial numbers in the
257 	 * MemTX register. 'serial_number_detected' is set true when we detect
258 	 * a non-zero serial number (indicating the new firmware).  Thereafter,
259 	 * the driver can safely ignore the Timer Recovery re-sends to avoid
260 	 * out-of-sync problems.
261 	 */
262 	int serial_number_detected;
263 	struct work_struct work_rx;
264 
265 	/* True if we are to send the set-up data to the hardware. */
266 	int to_setup;
267 
268 	/* Card has been removed */
269 	int removed;
270 	/* Saved irq value when we disable the interrupt. */
271 	int irq;
272 	/* True if this driver is shutting down. */
273 	int shutting_down;
274 	/* Modem control lines */
275 	unsigned int control_lines[NL_NUM_OF_ADDRESSES];
276 	struct ipw_rx_packet *packet_assembler[NL_NUM_OF_ADDRESSES];
277 
278 	struct tasklet_struct tasklet;
279 
280 	/* The handle for the network layer, for the sending of events to it. */
281 	struct ipw_network *network;
282 	struct MEMINFREG __iomem *memory_info_regs;
283 	struct MEMCCR __iomem *memregs_CCR;
284 	void (*reboot_callback) (void *data);
285 	void *reboot_callback_data;
286 
287 	unsigned short __iomem *memreg_tx;
288 };
289 
290 /*
291  * Packet info structure for tx packets.
292  * Note: not all the fields defined here are required for all protocols
293  */
294 struct ipw_tx_packet {
295 	struct list_head queue;
296 	/* channel idx + 1 */
297 	unsigned char dest_addr;
298 	/* SETUP, CTRL or DATA */
299 	unsigned char protocol;
300 	/* Length of data block, which starts at the end of this structure */
301 	unsigned short length;
302 	/* Sending state */
303 	/* Offset of where we've sent up to so far */
304 	unsigned long offset;
305 	/* Count of packet fragments, starting at 0 */
306 	int fragment_count;
307 
308 	/* Called after packet is sent and before is freed */
309 	void (*packet_callback) (void *cb_data, unsigned int packet_length);
310 	void *callback_data;
311 };
312 
313 /* Signals from DTE */
314 #define COMCTRL_RTS	0
315 #define COMCTRL_DTR	1
316 
317 /* Signals from DCE */
318 #define COMCTRL_CTS	2
319 #define COMCTRL_DCD	3
320 #define COMCTRL_DSR	4
321 #define COMCTRL_RI	5
322 
323 struct ipw_control_packet_body {
324 	/* DTE signal or DCE signal */
325 	unsigned char sig_no;
326 	/* 0: set signal, 1: clear signal */
327 	unsigned char value;
328 } __attribute__ ((__packed__));
329 
330 struct ipw_control_packet {
331 	struct ipw_tx_packet header;
332 	struct ipw_control_packet_body body;
333 };
334 
335 struct ipw_rx_packet {
336 	struct list_head queue;
337 	unsigned int capacity;
338 	unsigned int length;
339 	unsigned int protocol;
340 	unsigned int channel_idx;
341 };
342 
data_type(const unsigned char * buf,unsigned length)343 static char *data_type(const unsigned char *buf, unsigned length)
344 {
345 	struct nl_packet_header *hdr = (struct nl_packet_header *) buf;
346 
347 	if (length == 0)
348 		return "     ";
349 
350 	if (hdr->packet_rank & NL_FIRST_PACKET) {
351 		switch (hdr->protocol) {
352 		case TL_PROTOCOLID_COM_DATA:	return "DATA ";
353 		case TL_PROTOCOLID_COM_CTRL:	return "CTRL ";
354 		case TL_PROTOCOLID_SETUP:	return "SETUP";
355 		default: return "???? ";
356 		}
357 	} else
358 		return "     ";
359 }
360 
361 #define DUMP_MAX_BYTES 64
362 
dump_data_bytes(const char * type,const unsigned char * data,unsigned length)363 static void dump_data_bytes(const char *type, const unsigned char *data,
364 			    unsigned length)
365 {
366 	char prefix[56];
367 
368 	sprintf(prefix, IPWIRELESS_PCCARD_NAME ": %s %s ",
369 			type, data_type(data, length));
370 	print_hex_dump_bytes(prefix, 0, (void *)data,
371 			length < DUMP_MAX_BYTES ? length : DUMP_MAX_BYTES);
372 }
373 
swap_packet_bitfield_to_le(unsigned char * data)374 static void swap_packet_bitfield_to_le(unsigned char *data)
375 {
376 #ifdef __BIG_ENDIAN_BITFIELD
377 	unsigned char tmp = *data, ret = 0;
378 
379 	/*
380 	 * transform bits from aa.bbb.ccc to ccc.bbb.aa
381 	 */
382 	ret |= (tmp & 0xc0) >> 6;
383 	ret |= (tmp & 0x38) >> 1;
384 	ret |= (tmp & 0x07) << 5;
385 	*data = ret & 0xff;
386 #endif
387 }
388 
swap_packet_bitfield_from_le(unsigned char * data)389 static void swap_packet_bitfield_from_le(unsigned char *data)
390 {
391 #ifdef __BIG_ENDIAN_BITFIELD
392 	unsigned char tmp = *data, ret = 0;
393 
394 	/*
395 	 * transform bits from ccc.bbb.aa to aa.bbb.ccc
396 	 */
397 	ret |= (tmp & 0xe0) >> 5;
398 	ret |= (tmp & 0x1c) << 1;
399 	ret |= (tmp & 0x03) << 6;
400 	*data = ret & 0xff;
401 #endif
402 }
403 
do_send_fragment(struct ipw_hardware * hw,unsigned char * data,unsigned length)404 static void do_send_fragment(struct ipw_hardware *hw, unsigned char *data,
405 			    unsigned length)
406 {
407 	unsigned i;
408 	unsigned long flags;
409 
410 	start_timing();
411 	BUG_ON(length > hw->ll_mtu);
412 
413 	if (ipwireless_debug)
414 		dump_data_bytes("send", data, length);
415 
416 	spin_lock_irqsave(&hw->lock, flags);
417 
418 	hw->tx_ready = 0;
419 	swap_packet_bitfield_to_le(data);
420 
421 	if (hw->hw_version == HW_VERSION_1) {
422 		outw((unsigned short) length, hw->base_port + IODWR);
423 
424 		for (i = 0; i < length; i += 2) {
425 			unsigned short d = data[i];
426 			__le16 raw_data;
427 
428 			if (i + 1 < length)
429 				d |= data[i + 1] << 8;
430 			raw_data = cpu_to_le16(d);
431 			outw(raw_data, hw->base_port + IODWR);
432 		}
433 
434 		outw(DCR_TXDONE, hw->base_port + IODCR);
435 	} else if (hw->hw_version == HW_VERSION_2) {
436 		outw((unsigned short) length, hw->base_port);
437 
438 		for (i = 0; i < length; i += 2) {
439 			unsigned short d = data[i];
440 			__le16 raw_data;
441 
442 			if (i + 1 < length)
443 				d |= data[i + 1] << 8;
444 			raw_data = cpu_to_le16(d);
445 			outw(raw_data, hw->base_port);
446 		}
447 		while ((i & 3) != 2) {
448 			outw((unsigned short) 0xDEAD, hw->base_port);
449 			i += 2;
450 		}
451 		writew(MEMRX_RX, &hw->memory_info_regs->memreg_rx);
452 	}
453 
454 	spin_unlock_irqrestore(&hw->lock, flags);
455 
456 	end_write_timing(length);
457 }
458 
do_send_packet(struct ipw_hardware * hw,struct ipw_tx_packet * packet)459 static void do_send_packet(struct ipw_hardware *hw, struct ipw_tx_packet *packet)
460 {
461 	unsigned short fragment_data_len;
462 	unsigned short data_left = packet->length - packet->offset;
463 	unsigned short header_size;
464 	union nl_packet pkt;
465 
466 	header_size =
467 	    (packet->fragment_count == 0)
468 	    ? NL_FIRST_PACKET_HEADER_SIZE
469 	    : NL_FOLLOWING_PACKET_HEADER_SIZE;
470 	fragment_data_len = hw->ll_mtu - header_size;
471 	if (data_left < fragment_data_len)
472 		fragment_data_len = data_left;
473 
474 	/*
475 	 * hdr_first is now in machine bitfield order, which will be swapped
476 	 * to le just before it goes to hw
477 	 */
478 	pkt.hdr_first.protocol = packet->protocol;
479 	pkt.hdr_first.address = packet->dest_addr;
480 	pkt.hdr_first.packet_rank = 0;
481 
482 	/* First packet? */
483 	if (packet->fragment_count == 0) {
484 		pkt.hdr_first.packet_rank |= NL_FIRST_PACKET;
485 		pkt.hdr_first.length_lsb = (unsigned char) packet->length;
486 		pkt.hdr_first.length_msb =
487 			(unsigned char) (packet->length >> 8);
488 	}
489 
490 	memcpy(pkt.rawpkt + header_size,
491 	       ((unsigned char *) packet) + sizeof(struct ipw_tx_packet) +
492 	       packet->offset, fragment_data_len);
493 	packet->offset += fragment_data_len;
494 	packet->fragment_count++;
495 
496 	/* Last packet? (May also be first packet.) */
497 	if (packet->offset == packet->length)
498 		pkt.hdr_first.packet_rank |= NL_LAST_PACKET;
499 	do_send_fragment(hw, pkt.rawpkt, header_size + fragment_data_len);
500 
501 	/* If this packet has unsent data, then re-queue it. */
502 	if (packet->offset < packet->length) {
503 		/*
504 		 * Re-queue it at the head of the highest priority queue so
505 		 * it goes before all other packets
506 		 */
507 		unsigned long flags;
508 
509 		spin_lock_irqsave(&hw->lock, flags);
510 		list_add(&packet->queue, &hw->tx_queue[0]);
511 		hw->tx_queued++;
512 		spin_unlock_irqrestore(&hw->lock, flags);
513 	} else {
514 		if (packet->packet_callback)
515 			packet->packet_callback(packet->callback_data,
516 					packet->length);
517 		kfree(packet);
518 	}
519 }
520 
ipw_setup_hardware(struct ipw_hardware * hw)521 static void ipw_setup_hardware(struct ipw_hardware *hw)
522 {
523 	unsigned long flags;
524 
525 	spin_lock_irqsave(&hw->lock, flags);
526 	if (hw->hw_version == HW_VERSION_1) {
527 		/* Reset RX FIFO */
528 		outw(DCR_RXRESET, hw->base_port + IODCR);
529 		/* SB: Reset TX FIFO */
530 		outw(DCR_TXRESET, hw->base_port + IODCR);
531 
532 		/* Enable TX and RX interrupts. */
533 		outw(IER_TXENABLED | IER_RXENABLED, hw->base_port + IOIER);
534 	} else {
535 		/*
536 		 * Set INTRACK bit (bit 0), which means we must explicitly
537 		 * acknowledge interrupts by clearing bit 2 of reg_config_and_status.
538 		 */
539 		unsigned short csr = readw(&hw->memregs_CCR->reg_config_and_status);
540 
541 		csr |= 1;
542 		writew(csr, &hw->memregs_CCR->reg_config_and_status);
543 	}
544 	spin_unlock_irqrestore(&hw->lock, flags);
545 }
546 
547 /*
548  * If 'packet' is NULL, then this function allocates a new packet, setting its
549  * length to 0 and ensuring it has the specified minimum amount of free space.
550  *
551  * If 'packet' is not NULL, then this function enlarges it if it doesn't
552  * have the specified minimum amount of free space.
553  *
554  */
pool_allocate(struct ipw_hardware * hw,struct ipw_rx_packet * packet,int minimum_free_space)555 static struct ipw_rx_packet *pool_allocate(struct ipw_hardware *hw,
556 					   struct ipw_rx_packet *packet,
557 					   int minimum_free_space)
558 {
559 
560 	if (!packet) {
561 		unsigned long flags;
562 
563 		spin_lock_irqsave(&hw->lock, flags);
564 		if (!list_empty(&hw->rx_pool)) {
565 			packet = list_first_entry(&hw->rx_pool,
566 					struct ipw_rx_packet, queue);
567 			hw->rx_pool_size--;
568 			spin_unlock_irqrestore(&hw->lock, flags);
569 			list_del(&packet->queue);
570 		} else {
571 			const int min_capacity =
572 				ipwireless_ppp_mru(hw->network) + 2;
573 			int new_capacity;
574 
575 			spin_unlock_irqrestore(&hw->lock, flags);
576 			new_capacity =
577 				(minimum_free_space > min_capacity
578 				 ? minimum_free_space
579 				 : min_capacity);
580 			packet = kmalloc(sizeof(struct ipw_rx_packet)
581 					+ new_capacity, GFP_ATOMIC);
582 			if (!packet)
583 				return NULL;
584 			packet->capacity = new_capacity;
585 		}
586 		packet->length = 0;
587 	}
588 
589 	if (packet->length + minimum_free_space > packet->capacity) {
590 		struct ipw_rx_packet *old_packet = packet;
591 
592 		packet = kmalloc(sizeof(struct ipw_rx_packet) +
593 				old_packet->length + minimum_free_space,
594 				GFP_ATOMIC);
595 		if (!packet) {
596 			kfree(old_packet);
597 			return NULL;
598 		}
599 		memcpy(packet, old_packet,
600 				sizeof(struct ipw_rx_packet)
601 					+ old_packet->length);
602 		packet->capacity = old_packet->length + minimum_free_space;
603 		kfree(old_packet);
604 	}
605 
606 	return packet;
607 }
608 
pool_free(struct ipw_hardware * hw,struct ipw_rx_packet * packet)609 static void pool_free(struct ipw_hardware *hw, struct ipw_rx_packet *packet)
610 {
611 	if (hw->rx_pool_size > 6)
612 		kfree(packet);
613 	else {
614 		hw->rx_pool_size++;
615 		list_add(&packet->queue, &hw->rx_pool);
616 	}
617 }
618 
queue_received_packet(struct ipw_hardware * hw,unsigned int protocol,unsigned int address,const unsigned char * data,int length,int is_last)619 static void queue_received_packet(struct ipw_hardware *hw,
620 				  unsigned int protocol,
621 				  unsigned int address,
622 				  const unsigned char *data, int length,
623 				  int is_last)
624 {
625 	unsigned int channel_idx = address - 1;
626 	struct ipw_rx_packet *packet = NULL;
627 	unsigned long flags;
628 
629 	/* Discard packet if channel index is out of range. */
630 	if (channel_idx >= NL_NUM_OF_ADDRESSES) {
631 		printk(KERN_INFO IPWIRELESS_PCCARD_NAME
632 		       ": data packet has bad address %u\n", address);
633 		return;
634 	}
635 
636 	/*
637 	 * ->packet_assembler is safe to touch unlocked, this is the only place
638 	 */
639 	if (protocol == TL_PROTOCOLID_COM_DATA) {
640 		struct ipw_rx_packet **assem =
641 			&hw->packet_assembler[channel_idx];
642 
643 		/*
644 		 * Create a new packet, or assembler already contains one
645 		 * enlarge it by 'length' bytes.
646 		 */
647 		(*assem) = pool_allocate(hw, *assem, length);
648 		if (!(*assem)) {
649 			printk(KERN_ERR IPWIRELESS_PCCARD_NAME
650 				": no memory for incoming data packet, dropped!\n");
651 			return;
652 		}
653 		(*assem)->protocol = protocol;
654 		(*assem)->channel_idx = channel_idx;
655 
656 		/* Append this packet data onto existing data. */
657 		memcpy((unsigned char *)(*assem) +
658 			       sizeof(struct ipw_rx_packet)
659 				+ (*assem)->length, data, length);
660 		(*assem)->length += length;
661 		if (is_last) {
662 			packet = *assem;
663 			*assem = NULL;
664 			/* Count queued DATA bytes only */
665 			spin_lock_irqsave(&hw->lock, flags);
666 			hw->rx_bytes_queued += packet->length;
667 			spin_unlock_irqrestore(&hw->lock, flags);
668 		}
669 	} else {
670 		/* If it's a CTRL packet, don't assemble, just queue it. */
671 		packet = pool_allocate(hw, NULL, length);
672 		if (!packet) {
673 			printk(KERN_ERR IPWIRELESS_PCCARD_NAME
674 				": no memory for incoming ctrl packet, dropped!\n");
675 			return;
676 		}
677 		packet->protocol = protocol;
678 		packet->channel_idx = channel_idx;
679 		memcpy((unsigned char *)packet + sizeof(struct ipw_rx_packet),
680 				data, length);
681 		packet->length = length;
682 	}
683 
684 	/*
685 	 * If this is the last packet, then send the assembled packet on to the
686 	 * network layer.
687 	 */
688 	if (packet) {
689 		spin_lock_irqsave(&hw->lock, flags);
690 		list_add_tail(&packet->queue, &hw->rx_queue);
691 		/* Block reception of incoming packets if queue is full. */
692 		hw->blocking_rx =
693 			(hw->rx_bytes_queued >= IPWIRELESS_RX_QUEUE_SIZE);
694 
695 		spin_unlock_irqrestore(&hw->lock, flags);
696 		schedule_work(&hw->work_rx);
697 	}
698 }
699 
700 /*
701  * Workqueue callback
702  */
ipw_receive_data_work(struct work_struct * work_rx)703 static void ipw_receive_data_work(struct work_struct *work_rx)
704 {
705 	struct ipw_hardware *hw =
706 	    container_of(work_rx, struct ipw_hardware, work_rx);
707 	unsigned long flags;
708 
709 	spin_lock_irqsave(&hw->lock, flags);
710 	while (!list_empty(&hw->rx_queue)) {
711 		struct ipw_rx_packet *packet =
712 			list_first_entry(&hw->rx_queue,
713 					struct ipw_rx_packet, queue);
714 
715 		if (hw->shutting_down)
716 			break;
717 		list_del(&packet->queue);
718 
719 		/*
720 		 * Note: ipwireless_network_packet_received must be called in a
721 		 * process context (i.e. via schedule_work) because the tty
722 		 * output code can sleep in the tty_flip_buffer_push call.
723 		 */
724 		if (packet->protocol == TL_PROTOCOLID_COM_DATA) {
725 			if (hw->network != NULL) {
726 				/* If the network hasn't been disconnected. */
727 				spin_unlock_irqrestore(&hw->lock, flags);
728 				/*
729 				 * This must run unlocked due to tty processing
730 				 * and mutex locking
731 				 */
732 				ipwireless_network_packet_received(
733 						hw->network,
734 						packet->channel_idx,
735 						(unsigned char *)packet
736 						+ sizeof(struct ipw_rx_packet),
737 						packet->length);
738 				spin_lock_irqsave(&hw->lock, flags);
739 			}
740 			/* Count queued DATA bytes only */
741 			hw->rx_bytes_queued -= packet->length;
742 		} else {
743 			/*
744 			 * This is safe to be called locked, callchain does
745 			 * not block
746 			 */
747 			handle_received_CTRL_packet(hw, packet->channel_idx,
748 					(unsigned char *)packet
749 					+ sizeof(struct ipw_rx_packet),
750 					packet->length);
751 		}
752 		pool_free(hw, packet);
753 		/*
754 		 * Unblock reception of incoming packets if queue is no longer
755 		 * full.
756 		 */
757 		hw->blocking_rx =
758 			hw->rx_bytes_queued >= IPWIRELESS_RX_QUEUE_SIZE;
759 		if (hw->shutting_down)
760 			break;
761 	}
762 	spin_unlock_irqrestore(&hw->lock, flags);
763 }
764 
handle_received_CTRL_packet(struct ipw_hardware * hw,unsigned int channel_idx,const unsigned char * data,int len)765 static void handle_received_CTRL_packet(struct ipw_hardware *hw,
766 					unsigned int channel_idx,
767 					const unsigned char *data, int len)
768 {
769 	const struct ipw_control_packet_body *body =
770 		(const struct ipw_control_packet_body *) data;
771 	unsigned int changed_mask;
772 
773 	if (len != sizeof(struct ipw_control_packet_body)) {
774 		printk(KERN_INFO IPWIRELESS_PCCARD_NAME
775 		       ": control packet was %d bytes - wrong size!\n",
776 		       len);
777 		return;
778 	}
779 
780 	switch (body->sig_no) {
781 	case COMCTRL_CTS:
782 		changed_mask = IPW_CONTROL_LINE_CTS;
783 		break;
784 	case COMCTRL_DCD:
785 		changed_mask = IPW_CONTROL_LINE_DCD;
786 		break;
787 	case COMCTRL_DSR:
788 		changed_mask = IPW_CONTROL_LINE_DSR;
789 		break;
790 	case COMCTRL_RI:
791 		changed_mask = IPW_CONTROL_LINE_RI;
792 		break;
793 	default:
794 		changed_mask = 0;
795 	}
796 
797 	if (changed_mask != 0) {
798 		if (body->value)
799 			hw->control_lines[channel_idx] |= changed_mask;
800 		else
801 			hw->control_lines[channel_idx] &= ~changed_mask;
802 		if (hw->network)
803 			ipwireless_network_notify_control_line_change(
804 					hw->network,
805 					channel_idx,
806 					hw->control_lines[channel_idx],
807 					changed_mask);
808 	}
809 }
810 
handle_received_packet(struct ipw_hardware * hw,const union nl_packet * packet,unsigned short len)811 static void handle_received_packet(struct ipw_hardware *hw,
812 				   const union nl_packet *packet,
813 				   unsigned short len)
814 {
815 	unsigned int protocol = packet->hdr.protocol;
816 	unsigned int address = packet->hdr.address;
817 	unsigned int header_length;
818 	const unsigned char *data;
819 	unsigned int data_len;
820 	int is_last = packet->hdr.packet_rank & NL_LAST_PACKET;
821 
822 	if (packet->hdr.packet_rank & NL_FIRST_PACKET)
823 		header_length = NL_FIRST_PACKET_HEADER_SIZE;
824 	else
825 		header_length = NL_FOLLOWING_PACKET_HEADER_SIZE;
826 
827 	data = packet->rawpkt + header_length;
828 	data_len = len - header_length;
829 	switch (protocol) {
830 	case TL_PROTOCOLID_COM_DATA:
831 	case TL_PROTOCOLID_COM_CTRL:
832 		queue_received_packet(hw, protocol, address, data, data_len,
833 				is_last);
834 		break;
835 	case TL_PROTOCOLID_SETUP:
836 		handle_received_SETUP_packet(hw, address, data, data_len,
837 				is_last);
838 		break;
839 	}
840 }
841 
acknowledge_data_read(struct ipw_hardware * hw)842 static void acknowledge_data_read(struct ipw_hardware *hw)
843 {
844 	if (hw->hw_version == HW_VERSION_1)
845 		outw(DCR_RXDONE, hw->base_port + IODCR);
846 	else
847 		writew(MEMRX_PCINTACKK,
848 				&hw->memory_info_regs->memreg_pc_interrupt_ack);
849 }
850 
851 /*
852  * Retrieve a packet from the IPW hardware.
853  */
do_receive_packet(struct ipw_hardware * hw)854 static void do_receive_packet(struct ipw_hardware *hw)
855 {
856 	unsigned len;
857 	unsigned i;
858 	unsigned char pkt[LL_MTU_MAX];
859 
860 	start_timing();
861 
862 	if (hw->hw_version == HW_VERSION_1) {
863 		len = inw(hw->base_port + IODRR);
864 		if (len > hw->ll_mtu) {
865 			printk(KERN_INFO IPWIRELESS_PCCARD_NAME
866 			       ": received a packet of %u bytes - longer than the MTU!\n", len);
867 			outw(DCR_RXDONE | DCR_RXRESET, hw->base_port + IODCR);
868 			return;
869 		}
870 
871 		for (i = 0; i < len; i += 2) {
872 			__le16 raw_data = inw(hw->base_port + IODRR);
873 			unsigned short data = le16_to_cpu(raw_data);
874 
875 			pkt[i] = (unsigned char) data;
876 			pkt[i + 1] = (unsigned char) (data >> 8);
877 		}
878 	} else {
879 		len = inw(hw->base_port);
880 		if (len > hw->ll_mtu) {
881 			printk(KERN_INFO IPWIRELESS_PCCARD_NAME
882 			       ": received a packet of %u bytes - longer than the MTU!\n", len);
883 			writew(MEMRX_PCINTACKK,
884 				&hw->memory_info_regs->memreg_pc_interrupt_ack);
885 			return;
886 		}
887 
888 		for (i = 0; i < len; i += 2) {
889 			__le16 raw_data = inw(hw->base_port);
890 			unsigned short data = le16_to_cpu(raw_data);
891 
892 			pkt[i] = (unsigned char) data;
893 			pkt[i + 1] = (unsigned char) (data >> 8);
894 		}
895 
896 		while ((i & 3) != 2) {
897 			inw(hw->base_port);
898 			i += 2;
899 		}
900 	}
901 
902 	acknowledge_data_read(hw);
903 
904 	swap_packet_bitfield_from_le(pkt);
905 
906 	if (ipwireless_debug)
907 		dump_data_bytes("recv", pkt, len);
908 
909 	handle_received_packet(hw, (union nl_packet *) pkt, len);
910 
911 	end_read_timing(len);
912 }
913 
get_current_packet_priority(struct ipw_hardware * hw)914 static int get_current_packet_priority(struct ipw_hardware *hw)
915 {
916 	/*
917 	 * If we're initializing, don't send anything of higher priority than
918 	 * PRIO_SETUP.  The network layer therefore need not care about
919 	 * hardware initialization - any of its stuff will simply be queued
920 	 * until setup is complete.
921 	 */
922 	return (hw->to_setup || hw->initializing
923 			? PRIO_SETUP + 1 : NL_NUM_OF_PRIORITIES);
924 }
925 
926 /*
927  * return 1 if something has been received from hw
928  */
get_packets_from_hw(struct ipw_hardware * hw)929 static int get_packets_from_hw(struct ipw_hardware *hw)
930 {
931 	int received = 0;
932 	unsigned long flags;
933 
934 	spin_lock_irqsave(&hw->lock, flags);
935 	while (hw->rx_ready && !hw->blocking_rx) {
936 		received = 1;
937 		hw->rx_ready--;
938 		spin_unlock_irqrestore(&hw->lock, flags);
939 
940 		do_receive_packet(hw);
941 
942 		spin_lock_irqsave(&hw->lock, flags);
943 	}
944 	spin_unlock_irqrestore(&hw->lock, flags);
945 
946 	return received;
947 }
948 
949 /*
950  * Send pending packet up to given priority, prioritize SETUP data until
951  * hardware is fully setup.
952  *
953  * return 1 if more packets can be sent
954  */
send_pending_packet(struct ipw_hardware * hw,int priority_limit)955 static int send_pending_packet(struct ipw_hardware *hw, int priority_limit)
956 {
957 	int more_to_send = 0;
958 	unsigned long flags;
959 
960 	spin_lock_irqsave(&hw->lock, flags);
961 	if (hw->tx_queued && hw->tx_ready) {
962 		int priority;
963 		struct ipw_tx_packet *packet = NULL;
964 
965 		/* Pick a packet */
966 		for (priority = 0; priority < priority_limit; priority++) {
967 			if (!list_empty(&hw->tx_queue[priority])) {
968 				packet = list_first_entry(
969 						&hw->tx_queue[priority],
970 						struct ipw_tx_packet,
971 						queue);
972 
973 				hw->tx_queued--;
974 				list_del(&packet->queue);
975 
976 				break;
977 			}
978 		}
979 		if (!packet) {
980 			hw->tx_queued = 0;
981 			spin_unlock_irqrestore(&hw->lock, flags);
982 			return 0;
983 		}
984 
985 		spin_unlock_irqrestore(&hw->lock, flags);
986 
987 		/* Send */
988 		do_send_packet(hw, packet);
989 
990 		/* Check if more to send */
991 		spin_lock_irqsave(&hw->lock, flags);
992 		for (priority = 0; priority < priority_limit; priority++)
993 			if (!list_empty(&hw->tx_queue[priority])) {
994 				more_to_send = 1;
995 				break;
996 			}
997 
998 		if (!more_to_send)
999 			hw->tx_queued = 0;
1000 	}
1001 	spin_unlock_irqrestore(&hw->lock, flags);
1002 
1003 	return more_to_send;
1004 }
1005 
1006 /*
1007  * Send and receive all queued packets.
1008  */
ipwireless_do_tasklet(struct tasklet_struct * t)1009 static void ipwireless_do_tasklet(struct tasklet_struct *t)
1010 {
1011 	struct ipw_hardware *hw = from_tasklet(hw, t, tasklet);
1012 	unsigned long flags;
1013 
1014 	spin_lock_irqsave(&hw->lock, flags);
1015 	if (hw->shutting_down) {
1016 		spin_unlock_irqrestore(&hw->lock, flags);
1017 		return;
1018 	}
1019 
1020 	if (hw->to_setup == 1) {
1021 		/*
1022 		 * Initial setup data sent to hardware
1023 		 */
1024 		hw->to_setup = 2;
1025 		spin_unlock_irqrestore(&hw->lock, flags);
1026 
1027 		ipw_setup_hardware(hw);
1028 		ipw_send_setup_packet(hw);
1029 
1030 		send_pending_packet(hw, PRIO_SETUP + 1);
1031 		get_packets_from_hw(hw);
1032 	} else {
1033 		int priority_limit = get_current_packet_priority(hw);
1034 		int again;
1035 
1036 		spin_unlock_irqrestore(&hw->lock, flags);
1037 
1038 		do {
1039 			again = send_pending_packet(hw, priority_limit);
1040 			again |= get_packets_from_hw(hw);
1041 		} while (again);
1042 	}
1043 }
1044 
1045 /*
1046  * return true if the card is physically present.
1047  */
is_card_present(struct ipw_hardware * hw)1048 static int is_card_present(struct ipw_hardware *hw)
1049 {
1050 	if (hw->hw_version == HW_VERSION_1)
1051 		return inw(hw->base_port + IOIR) != 0xFFFF;
1052 	else
1053 		return readl(&hw->memory_info_regs->memreg_card_present) ==
1054 		    CARD_PRESENT_VALUE;
1055 }
1056 
ipwireless_handle_v1_interrupt(int irq,struct ipw_hardware * hw)1057 static irqreturn_t ipwireless_handle_v1_interrupt(int irq,
1058 						  struct ipw_hardware *hw)
1059 {
1060 	unsigned short irqn;
1061 
1062 	irqn = inw(hw->base_port + IOIR);
1063 
1064 	/* Check if card is present */
1065 	if (irqn == 0xFFFF)
1066 		return IRQ_NONE;
1067 	else if (irqn != 0) {
1068 		unsigned short ack = 0;
1069 		unsigned long flags;
1070 
1071 		/* Transmit complete. */
1072 		if (irqn & IR_TXINTR) {
1073 			ack |= IR_TXINTR;
1074 			spin_lock_irqsave(&hw->lock, flags);
1075 			hw->tx_ready = 1;
1076 			spin_unlock_irqrestore(&hw->lock, flags);
1077 		}
1078 		/* Received data */
1079 		if (irqn & IR_RXINTR) {
1080 			ack |= IR_RXINTR;
1081 			spin_lock_irqsave(&hw->lock, flags);
1082 			hw->rx_ready++;
1083 			spin_unlock_irqrestore(&hw->lock, flags);
1084 		}
1085 		if (ack != 0) {
1086 			outw(ack, hw->base_port + IOIR);
1087 			tasklet_schedule(&hw->tasklet);
1088 		}
1089 		return IRQ_HANDLED;
1090 	}
1091 	return IRQ_NONE;
1092 }
1093 
acknowledge_pcmcia_interrupt(struct ipw_hardware * hw)1094 static void acknowledge_pcmcia_interrupt(struct ipw_hardware *hw)
1095 {
1096 	unsigned short csr = readw(&hw->memregs_CCR->reg_config_and_status);
1097 
1098 	csr &= 0xfffd;
1099 	writew(csr, &hw->memregs_CCR->reg_config_and_status);
1100 }
1101 
ipwireless_handle_v2_v3_interrupt(int irq,struct ipw_hardware * hw)1102 static irqreturn_t ipwireless_handle_v2_v3_interrupt(int irq,
1103 						     struct ipw_hardware *hw)
1104 {
1105 	int tx = 0;
1106 	int rx = 0;
1107 	int rx_repeat = 0;
1108 	int try_mem_tx_old;
1109 	unsigned long flags;
1110 
1111 	do {
1112 
1113 	unsigned short memtx = readw(hw->memreg_tx);
1114 	unsigned short memtx_serial;
1115 	unsigned short memrxdone =
1116 		readw(&hw->memory_info_regs->memreg_rx_done);
1117 
1118 	try_mem_tx_old = 0;
1119 
1120 	/* check whether the interrupt was generated by ipwireless card */
1121 	if (!(memtx & MEMTX_TX) && !(memrxdone & MEMRX_RX_DONE)) {
1122 
1123 		/* check if the card uses memreg_tx_old register */
1124 		if (hw->memreg_tx == &hw->memory_info_regs->memreg_tx_new) {
1125 			memtx = readw(&hw->memory_info_regs->memreg_tx_old);
1126 			if (memtx & MEMTX_TX) {
1127 				printk(KERN_INFO IPWIRELESS_PCCARD_NAME
1128 					": Using memreg_tx_old\n");
1129 				hw->memreg_tx =
1130 					&hw->memory_info_regs->memreg_tx_old;
1131 			} else {
1132 				return IRQ_NONE;
1133 			}
1134 		} else
1135 			return IRQ_NONE;
1136 	}
1137 
1138 	/*
1139 	 * See if the card is physically present. Note that while it is
1140 	 * powering up, it appears not to be present.
1141 	 */
1142 	if (!is_card_present(hw)) {
1143 		acknowledge_pcmcia_interrupt(hw);
1144 		return IRQ_HANDLED;
1145 	}
1146 
1147 	memtx_serial = memtx & (unsigned short) 0xff00;
1148 	if (memtx & MEMTX_TX) {
1149 		writew(memtx_serial, hw->memreg_tx);
1150 
1151 		if (hw->serial_number_detected) {
1152 			if (memtx_serial != hw->last_memtx_serial) {
1153 				hw->last_memtx_serial = memtx_serial;
1154 				spin_lock_irqsave(&hw->lock, flags);
1155 				hw->rx_ready++;
1156 				spin_unlock_irqrestore(&hw->lock, flags);
1157 				rx = 1;
1158 			} else
1159 				/* Ignore 'Timer Recovery' duplicates. */
1160 				rx_repeat = 1;
1161 		} else {
1162 			/*
1163 			 * If a non-zero serial number is seen, then enable
1164 			 * serial number checking.
1165 			 */
1166 			if (memtx_serial != 0) {
1167 				hw->serial_number_detected = 1;
1168 				printk(KERN_DEBUG IPWIRELESS_PCCARD_NAME
1169 					": memreg_tx serial num detected\n");
1170 
1171 				spin_lock_irqsave(&hw->lock, flags);
1172 				hw->rx_ready++;
1173 				spin_unlock_irqrestore(&hw->lock, flags);
1174 			}
1175 			rx = 1;
1176 		}
1177 	}
1178 	if (memrxdone & MEMRX_RX_DONE) {
1179 		writew(0, &hw->memory_info_regs->memreg_rx_done);
1180 		spin_lock_irqsave(&hw->lock, flags);
1181 		hw->tx_ready = 1;
1182 		spin_unlock_irqrestore(&hw->lock, flags);
1183 		tx = 1;
1184 	}
1185 	if (tx)
1186 		writew(MEMRX_PCINTACKK,
1187 				&hw->memory_info_regs->memreg_pc_interrupt_ack);
1188 
1189 	acknowledge_pcmcia_interrupt(hw);
1190 
1191 	if (tx || rx)
1192 		tasklet_schedule(&hw->tasklet);
1193 	else if (!rx_repeat) {
1194 		if (hw->memreg_tx == &hw->memory_info_regs->memreg_tx_new) {
1195 			if (hw->serial_number_detected)
1196 				printk(KERN_WARNING IPWIRELESS_PCCARD_NAME
1197 					": spurious interrupt - new_tx mode\n");
1198 			else {
1199 				printk(KERN_WARNING IPWIRELESS_PCCARD_NAME
1200 					": no valid memreg_tx value - switching to the old memreg_tx\n");
1201 				hw->memreg_tx =
1202 					&hw->memory_info_regs->memreg_tx_old;
1203 				try_mem_tx_old = 1;
1204 			}
1205 		} else
1206 			printk(KERN_WARNING IPWIRELESS_PCCARD_NAME
1207 					": spurious interrupt - old_tx mode\n");
1208 	}
1209 
1210 	} while (try_mem_tx_old == 1);
1211 
1212 	return IRQ_HANDLED;
1213 }
1214 
ipwireless_interrupt(int irq,void * dev_id)1215 irqreturn_t ipwireless_interrupt(int irq, void *dev_id)
1216 {
1217 	struct ipw_dev *ipw = dev_id;
1218 
1219 	if (ipw->hardware->hw_version == HW_VERSION_1)
1220 		return ipwireless_handle_v1_interrupt(irq, ipw->hardware);
1221 	else
1222 		return ipwireless_handle_v2_v3_interrupt(irq, ipw->hardware);
1223 }
1224 
flush_packets_to_hw(struct ipw_hardware * hw)1225 static void flush_packets_to_hw(struct ipw_hardware *hw)
1226 {
1227 	int priority_limit;
1228 	unsigned long flags;
1229 
1230 	spin_lock_irqsave(&hw->lock, flags);
1231 	priority_limit = get_current_packet_priority(hw);
1232 	spin_unlock_irqrestore(&hw->lock, flags);
1233 
1234 	while (send_pending_packet(hw, priority_limit));
1235 }
1236 
send_packet(struct ipw_hardware * hw,int priority,struct ipw_tx_packet * packet)1237 static void send_packet(struct ipw_hardware *hw, int priority,
1238 			struct ipw_tx_packet *packet)
1239 {
1240 	unsigned long flags;
1241 
1242 	spin_lock_irqsave(&hw->lock, flags);
1243 	list_add_tail(&packet->queue, &hw->tx_queue[priority]);
1244 	hw->tx_queued++;
1245 	spin_unlock_irqrestore(&hw->lock, flags);
1246 
1247 	flush_packets_to_hw(hw);
1248 }
1249 
1250 /* Create data packet, non-atomic allocation */
alloc_data_packet(int data_size,unsigned char dest_addr,unsigned char protocol)1251 static void *alloc_data_packet(int data_size,
1252 				unsigned char dest_addr,
1253 				unsigned char protocol)
1254 {
1255 	struct ipw_tx_packet *packet = kzalloc(
1256 			sizeof(struct ipw_tx_packet) + data_size,
1257 			GFP_ATOMIC);
1258 
1259 	if (!packet)
1260 		return NULL;
1261 
1262 	INIT_LIST_HEAD(&packet->queue);
1263 	packet->dest_addr = dest_addr;
1264 	packet->protocol = protocol;
1265 	packet->length = data_size;
1266 
1267 	return packet;
1268 }
1269 
alloc_ctrl_packet(int header_size,unsigned char dest_addr,unsigned char protocol,unsigned char sig_no)1270 static void *alloc_ctrl_packet(int header_size,
1271 			       unsigned char dest_addr,
1272 			       unsigned char protocol,
1273 			       unsigned char sig_no)
1274 {
1275 	/*
1276 	 * sig_no is located right after ipw_tx_packet struct in every
1277 	 * CTRL or SETUP packets, we can use ipw_control_packet as a
1278 	 * common struct
1279 	 */
1280 	struct ipw_control_packet *packet = kzalloc(header_size, GFP_ATOMIC);
1281 
1282 	if (!packet)
1283 		return NULL;
1284 
1285 	INIT_LIST_HEAD(&packet->header.queue);
1286 	packet->header.dest_addr = dest_addr;
1287 	packet->header.protocol = protocol;
1288 	packet->header.length = header_size - sizeof(struct ipw_tx_packet);
1289 	packet->body.sig_no = sig_no;
1290 
1291 	return packet;
1292 }
1293 
ipwireless_send_packet(struct ipw_hardware * hw,unsigned int channel_idx,const u8 * data,unsigned int length,void (* callback)(void * cb,unsigned int length),void * callback_data)1294 int ipwireless_send_packet(struct ipw_hardware *hw, unsigned int channel_idx,
1295 			    const u8 *data, unsigned int length,
1296 			    void (*callback) (void *cb, unsigned int length),
1297 			    void *callback_data)
1298 {
1299 	struct ipw_tx_packet *packet;
1300 
1301 	packet = alloc_data_packet(length, (channel_idx + 1),
1302 			TL_PROTOCOLID_COM_DATA);
1303 	if (!packet)
1304 		return -ENOMEM;
1305 	packet->packet_callback = callback;
1306 	packet->callback_data = callback_data;
1307 	memcpy((unsigned char *) packet + sizeof(struct ipw_tx_packet), data,
1308 			length);
1309 
1310 	send_packet(hw, PRIO_DATA, packet);
1311 	return 0;
1312 }
1313 
set_control_line(struct ipw_hardware * hw,int prio,unsigned int channel_idx,int line,int state)1314 static int set_control_line(struct ipw_hardware *hw, int prio,
1315 			   unsigned int channel_idx, int line, int state)
1316 {
1317 	struct ipw_control_packet *packet;
1318 	int protocolid = TL_PROTOCOLID_COM_CTRL;
1319 
1320 	if (prio == PRIO_SETUP)
1321 		protocolid = TL_PROTOCOLID_SETUP;
1322 
1323 	packet = alloc_ctrl_packet(sizeof(struct ipw_control_packet),
1324 			(channel_idx + 1), protocolid, line);
1325 	if (!packet)
1326 		return -ENOMEM;
1327 	packet->header.length = sizeof(struct ipw_control_packet_body);
1328 	packet->body.value = (state == 0 ? 0 : 1);
1329 	send_packet(hw, prio, &packet->header);
1330 	return 0;
1331 }
1332 
1333 
set_DTR(struct ipw_hardware * hw,int priority,unsigned int channel_idx,int state)1334 static int set_DTR(struct ipw_hardware *hw, int priority,
1335 		   unsigned int channel_idx, int state)
1336 {
1337 	if (state != 0)
1338 		hw->control_lines[channel_idx] |= IPW_CONTROL_LINE_DTR;
1339 	else
1340 		hw->control_lines[channel_idx] &= ~IPW_CONTROL_LINE_DTR;
1341 
1342 	return set_control_line(hw, priority, channel_idx, COMCTRL_DTR, state);
1343 }
1344 
set_RTS(struct ipw_hardware * hw,int priority,unsigned int channel_idx,int state)1345 static int set_RTS(struct ipw_hardware *hw, int priority,
1346 		   unsigned int channel_idx, int state)
1347 {
1348 	if (state != 0)
1349 		hw->control_lines[channel_idx] |= IPW_CONTROL_LINE_RTS;
1350 	else
1351 		hw->control_lines[channel_idx] &= ~IPW_CONTROL_LINE_RTS;
1352 
1353 	return set_control_line(hw, priority, channel_idx, COMCTRL_RTS, state);
1354 }
1355 
ipwireless_set_DTR(struct ipw_hardware * hw,unsigned int channel_idx,int state)1356 int ipwireless_set_DTR(struct ipw_hardware *hw, unsigned int channel_idx,
1357 		       int state)
1358 {
1359 	return set_DTR(hw, PRIO_CTRL, channel_idx, state);
1360 }
1361 
ipwireless_set_RTS(struct ipw_hardware * hw,unsigned int channel_idx,int state)1362 int ipwireless_set_RTS(struct ipw_hardware *hw, unsigned int channel_idx,
1363 		       int state)
1364 {
1365 	return set_RTS(hw, PRIO_CTRL, channel_idx, state);
1366 }
1367 
1368 struct ipw_setup_get_version_query_packet {
1369 	struct ipw_tx_packet header;
1370 	struct tl_setup_get_version_qry body;
1371 };
1372 
1373 struct ipw_setup_config_packet {
1374 	struct ipw_tx_packet header;
1375 	struct tl_setup_config_msg body;
1376 };
1377 
1378 struct ipw_setup_config_done_packet {
1379 	struct ipw_tx_packet header;
1380 	struct tl_setup_config_done_msg body;
1381 };
1382 
1383 struct ipw_setup_open_packet {
1384 	struct ipw_tx_packet header;
1385 	struct tl_setup_open_msg body;
1386 };
1387 
1388 struct ipw_setup_info_packet {
1389 	struct ipw_tx_packet header;
1390 	struct tl_setup_info_msg body;
1391 };
1392 
1393 struct ipw_setup_reboot_msg_ack {
1394 	struct ipw_tx_packet header;
1395 	struct TlSetupRebootMsgAck body;
1396 };
1397 
1398 /* This handles the actual initialization of the card */
__handle_setup_get_version_rsp(struct ipw_hardware * hw)1399 static void __handle_setup_get_version_rsp(struct ipw_hardware *hw)
1400 {
1401 	struct ipw_setup_config_packet *config_packet;
1402 	struct ipw_setup_config_done_packet *config_done_packet;
1403 	struct ipw_setup_open_packet *open_packet;
1404 	struct ipw_setup_info_packet *info_packet;
1405 	int port;
1406 	unsigned int channel_idx;
1407 
1408 	/* generate config packet */
1409 	for (port = 1; port <= NL_NUM_OF_ADDRESSES; port++) {
1410 		config_packet = alloc_ctrl_packet(
1411 				sizeof(struct ipw_setup_config_packet),
1412 				ADDR_SETUP_PROT,
1413 				TL_PROTOCOLID_SETUP,
1414 				TL_SETUP_SIGNO_CONFIG_MSG);
1415 		if (!config_packet)
1416 			goto exit_nomem;
1417 		config_packet->header.length = sizeof(struct tl_setup_config_msg);
1418 		config_packet->body.port_no = port;
1419 		config_packet->body.prio_data = PRIO_DATA;
1420 		config_packet->body.prio_ctrl = PRIO_CTRL;
1421 		send_packet(hw, PRIO_SETUP, &config_packet->header);
1422 	}
1423 	config_done_packet = alloc_ctrl_packet(
1424 			sizeof(struct ipw_setup_config_done_packet),
1425 			ADDR_SETUP_PROT,
1426 			TL_PROTOCOLID_SETUP,
1427 			TL_SETUP_SIGNO_CONFIG_DONE_MSG);
1428 	if (!config_done_packet)
1429 		goto exit_nomem;
1430 	config_done_packet->header.length = sizeof(struct tl_setup_config_done_msg);
1431 	send_packet(hw, PRIO_SETUP, &config_done_packet->header);
1432 
1433 	/* generate open packet */
1434 	for (port = 1; port <= NL_NUM_OF_ADDRESSES; port++) {
1435 		open_packet = alloc_ctrl_packet(
1436 				sizeof(struct ipw_setup_open_packet),
1437 				ADDR_SETUP_PROT,
1438 				TL_PROTOCOLID_SETUP,
1439 				TL_SETUP_SIGNO_OPEN_MSG);
1440 		if (!open_packet)
1441 			goto exit_nomem;
1442 		open_packet->header.length = sizeof(struct tl_setup_open_msg);
1443 		open_packet->body.port_no = port;
1444 		send_packet(hw, PRIO_SETUP, &open_packet->header);
1445 	}
1446 	for (channel_idx = 0;
1447 			channel_idx < NL_NUM_OF_ADDRESSES; channel_idx++) {
1448 		int ret;
1449 
1450 		ret = set_DTR(hw, PRIO_SETUP, channel_idx,
1451 			(hw->control_lines[channel_idx] &
1452 			 IPW_CONTROL_LINE_DTR) != 0);
1453 		if (ret) {
1454 			printk(KERN_ERR IPWIRELESS_PCCARD_NAME
1455 					": error setting DTR (%d)\n", ret);
1456 			return;
1457 		}
1458 
1459 		ret = set_RTS(hw, PRIO_SETUP, channel_idx,
1460 			(hw->control_lines [channel_idx] &
1461 			 IPW_CONTROL_LINE_RTS) != 0);
1462 		if (ret) {
1463 			printk(KERN_ERR IPWIRELESS_PCCARD_NAME
1464 					": error setting RTS (%d)\n", ret);
1465 			return;
1466 		}
1467 	}
1468 	/*
1469 	 * For NDIS we assume that we are using sync PPP frames, for COM async.
1470 	 * This driver uses NDIS mode too. We don't bother with translation
1471 	 * from async -> sync PPP.
1472 	 */
1473 	info_packet = alloc_ctrl_packet(sizeof(struct ipw_setup_info_packet),
1474 			ADDR_SETUP_PROT,
1475 			TL_PROTOCOLID_SETUP,
1476 			TL_SETUP_SIGNO_INFO_MSG);
1477 	if (!info_packet)
1478 		goto exit_nomem;
1479 	info_packet->header.length = sizeof(struct tl_setup_info_msg);
1480 	info_packet->body.driver_type = NDISWAN_DRIVER;
1481 	info_packet->body.major_version = NDISWAN_DRIVER_MAJOR_VERSION;
1482 	info_packet->body.minor_version = NDISWAN_DRIVER_MINOR_VERSION;
1483 	send_packet(hw, PRIO_SETUP, &info_packet->header);
1484 
1485 	/* Initialization is now complete, so we clear the 'to_setup' flag */
1486 	hw->to_setup = 0;
1487 
1488 	return;
1489 
1490 exit_nomem:
1491 	printk(KERN_ERR IPWIRELESS_PCCARD_NAME
1492 			": not enough memory to alloc control packet\n");
1493 	hw->to_setup = -1;
1494 }
1495 
handle_setup_get_version_rsp(struct ipw_hardware * hw,unsigned char vers_no)1496 static void handle_setup_get_version_rsp(struct ipw_hardware *hw,
1497 		unsigned char vers_no)
1498 {
1499 	del_timer(&hw->setup_timer);
1500 	hw->initializing = 0;
1501 	printk(KERN_INFO IPWIRELESS_PCCARD_NAME ": card is ready.\n");
1502 
1503 	if (vers_no == TL_SETUP_VERSION)
1504 		__handle_setup_get_version_rsp(hw);
1505 	else
1506 		printk(KERN_ERR IPWIRELESS_PCCARD_NAME
1507 				": invalid hardware version no %u\n",
1508 				(unsigned int) vers_no);
1509 }
1510 
ipw_send_setup_packet(struct ipw_hardware * hw)1511 static void ipw_send_setup_packet(struct ipw_hardware *hw)
1512 {
1513 	struct ipw_setup_get_version_query_packet *ver_packet;
1514 
1515 	ver_packet = alloc_ctrl_packet(
1516 			sizeof(struct ipw_setup_get_version_query_packet),
1517 			ADDR_SETUP_PROT, TL_PROTOCOLID_SETUP,
1518 			TL_SETUP_SIGNO_GET_VERSION_QRY);
1519 	if (!ver_packet)
1520 		return;
1521 	ver_packet->header.length = sizeof(struct tl_setup_get_version_qry);
1522 
1523 	/*
1524 	 * Response is handled in handle_received_SETUP_packet
1525 	 */
1526 	send_packet(hw, PRIO_SETUP, &ver_packet->header);
1527 }
1528 
handle_received_SETUP_packet(struct ipw_hardware * hw,unsigned int address,const unsigned char * data,int len,int is_last)1529 static void handle_received_SETUP_packet(struct ipw_hardware *hw,
1530 					 unsigned int address,
1531 					 const unsigned char *data, int len,
1532 					 int is_last)
1533 {
1534 	const union ipw_setup_rx_msg *rx_msg = (const union ipw_setup_rx_msg *) data;
1535 
1536 	if (address != ADDR_SETUP_PROT) {
1537 		printk(KERN_INFO IPWIRELESS_PCCARD_NAME
1538 		       ": setup packet has bad address %d\n", address);
1539 		return;
1540 	}
1541 
1542 	switch (rx_msg->sig_no) {
1543 	case TL_SETUP_SIGNO_GET_VERSION_RSP:
1544 		if (hw->to_setup)
1545 			handle_setup_get_version_rsp(hw,
1546 					rx_msg->version_rsp_msg.version);
1547 		break;
1548 
1549 	case TL_SETUP_SIGNO_OPEN_MSG:
1550 		if (ipwireless_debug) {
1551 			unsigned int channel_idx = rx_msg->open_msg.port_no - 1;
1552 
1553 			printk(KERN_INFO IPWIRELESS_PCCARD_NAME
1554 			       ": OPEN_MSG [channel %u] reply received\n",
1555 			       channel_idx);
1556 		}
1557 		break;
1558 
1559 	case TL_SETUP_SIGNO_INFO_MSG_ACK:
1560 		if (ipwireless_debug)
1561 			printk(KERN_DEBUG IPWIRELESS_PCCARD_NAME
1562 			       ": card successfully configured as NDISWAN\n");
1563 		break;
1564 
1565 	case TL_SETUP_SIGNO_REBOOT_MSG:
1566 		if (hw->to_setup)
1567 			printk(KERN_DEBUG IPWIRELESS_PCCARD_NAME
1568 			       ": Setup not completed - ignoring reboot msg\n");
1569 		else {
1570 			struct ipw_setup_reboot_msg_ack *packet;
1571 
1572 			printk(KERN_DEBUG IPWIRELESS_PCCARD_NAME
1573 			       ": Acknowledging REBOOT message\n");
1574 			packet = alloc_ctrl_packet(
1575 					sizeof(struct ipw_setup_reboot_msg_ack),
1576 					ADDR_SETUP_PROT, TL_PROTOCOLID_SETUP,
1577 					TL_SETUP_SIGNO_REBOOT_MSG_ACK);
1578 			if (!packet) {
1579 				pr_err(IPWIRELESS_PCCARD_NAME
1580 				       ": Not enough memory to send reboot packet");
1581 				break;
1582 			}
1583 			packet->header.length =
1584 				sizeof(struct TlSetupRebootMsgAck);
1585 			send_packet(hw, PRIO_SETUP, &packet->header);
1586 			if (hw->reboot_callback)
1587 				hw->reboot_callback(hw->reboot_callback_data);
1588 		}
1589 		break;
1590 
1591 	default:
1592 		printk(KERN_INFO IPWIRELESS_PCCARD_NAME
1593 		       ": unknown setup message %u received\n",
1594 		       (unsigned int) rx_msg->sig_no);
1595 	}
1596 }
1597 
do_close_hardware(struct ipw_hardware * hw)1598 static void do_close_hardware(struct ipw_hardware *hw)
1599 {
1600 	unsigned int irqn;
1601 
1602 	if (hw->hw_version == HW_VERSION_1) {
1603 		/* Disable TX and RX interrupts. */
1604 		outw(0, hw->base_port + IOIER);
1605 
1606 		/* Acknowledge any outstanding interrupt requests */
1607 		irqn = inw(hw->base_port + IOIR);
1608 		if (irqn & IR_TXINTR)
1609 			outw(IR_TXINTR, hw->base_port + IOIR);
1610 		if (irqn & IR_RXINTR)
1611 			outw(IR_RXINTR, hw->base_port + IOIR);
1612 
1613 		synchronize_irq(hw->irq);
1614 	}
1615 }
1616 
ipwireless_hardware_create(void)1617 struct ipw_hardware *ipwireless_hardware_create(void)
1618 {
1619 	int i;
1620 	struct ipw_hardware *hw =
1621 		kzalloc(sizeof(struct ipw_hardware), GFP_KERNEL);
1622 
1623 	if (!hw)
1624 		return NULL;
1625 
1626 	hw->irq = -1;
1627 	hw->initializing = 1;
1628 	hw->tx_ready = 1;
1629 	hw->rx_bytes_queued = 0;
1630 	hw->rx_pool_size = 0;
1631 	hw->last_memtx_serial = (unsigned short) 0xffff;
1632 	for (i = 0; i < NL_NUM_OF_PRIORITIES; i++)
1633 		INIT_LIST_HEAD(&hw->tx_queue[i]);
1634 
1635 	INIT_LIST_HEAD(&hw->rx_queue);
1636 	INIT_LIST_HEAD(&hw->rx_pool);
1637 	spin_lock_init(&hw->lock);
1638 	tasklet_setup(&hw->tasklet, ipwireless_do_tasklet);
1639 	INIT_WORK(&hw->work_rx, ipw_receive_data_work);
1640 	timer_setup(&hw->setup_timer, ipwireless_setup_timer, 0);
1641 
1642 	return hw;
1643 }
1644 
ipwireless_init_hardware_v1(struct ipw_hardware * hw,unsigned int base_port,void __iomem * attr_memory,void __iomem * common_memory,int is_v2_card,void (* reboot_callback)(void * data),void * reboot_callback_data)1645 void ipwireless_init_hardware_v1(struct ipw_hardware *hw,
1646 		unsigned int base_port,
1647 		void __iomem *attr_memory,
1648 		void __iomem *common_memory,
1649 		int is_v2_card,
1650 		void (*reboot_callback) (void *data),
1651 		void *reboot_callback_data)
1652 {
1653 	if (hw->removed) {
1654 		hw->removed = 0;
1655 		enable_irq(hw->irq);
1656 	}
1657 	hw->base_port = base_port;
1658 	hw->hw_version = (is_v2_card ? HW_VERSION_2 : HW_VERSION_1);
1659 	hw->ll_mtu = (hw->hw_version == HW_VERSION_1 ? LL_MTU_V1 : LL_MTU_V2);
1660 	hw->memregs_CCR = (struct MEMCCR __iomem *)
1661 			((unsigned short __iomem *) attr_memory + 0x200);
1662 	hw->memory_info_regs = (struct MEMINFREG __iomem *) common_memory;
1663 	hw->memreg_tx = &hw->memory_info_regs->memreg_tx_new;
1664 	hw->reboot_callback = reboot_callback;
1665 	hw->reboot_callback_data = reboot_callback_data;
1666 }
1667 
ipwireless_init_hardware_v2_v3(struct ipw_hardware * hw)1668 void ipwireless_init_hardware_v2_v3(struct ipw_hardware *hw)
1669 {
1670 	hw->initializing = 1;
1671 	hw->init_loops = 0;
1672 	printk(KERN_INFO IPWIRELESS_PCCARD_NAME
1673 	       ": waiting for card to start up...\n");
1674 	ipwireless_setup_timer(&hw->setup_timer);
1675 }
1676 
ipwireless_setup_timer(struct timer_list * t)1677 static void ipwireless_setup_timer(struct timer_list *t)
1678 {
1679 	struct ipw_hardware *hw = from_timer(hw, t, setup_timer);
1680 
1681 	hw->init_loops++;
1682 
1683 	if (hw->init_loops == TL_SETUP_MAX_VERSION_QRY &&
1684 			hw->hw_version == HW_VERSION_2 &&
1685 			hw->memreg_tx == &hw->memory_info_regs->memreg_tx_new) {
1686 		printk(KERN_INFO IPWIRELESS_PCCARD_NAME
1687 				": failed to startup using TX2, trying TX\n");
1688 
1689 		hw->memreg_tx = &hw->memory_info_regs->memreg_tx_old;
1690 		hw->init_loops = 0;
1691 	}
1692 	/* Give up after a certain number of retries */
1693 	if (hw->init_loops == TL_SETUP_MAX_VERSION_QRY) {
1694 		printk(KERN_INFO IPWIRELESS_PCCARD_NAME
1695 		       ": card failed to start up!\n");
1696 		hw->initializing = 0;
1697 	} else {
1698 		/* Do not attempt to write to the board if it is not present. */
1699 		if (is_card_present(hw)) {
1700 			unsigned long flags;
1701 
1702 			spin_lock_irqsave(&hw->lock, flags);
1703 			hw->to_setup = 1;
1704 			hw->tx_ready = 1;
1705 			spin_unlock_irqrestore(&hw->lock, flags);
1706 			tasklet_schedule(&hw->tasklet);
1707 		}
1708 
1709 		mod_timer(&hw->setup_timer,
1710 			jiffies + msecs_to_jiffies(TL_SETUP_VERSION_QRY_TMO));
1711 	}
1712 }
1713 
1714 /*
1715  * Stop any interrupts from executing so that, once this function returns,
1716  * other layers of the driver can be sure they won't get any more callbacks.
1717  * Thus must be called on a proper process context.
1718  */
ipwireless_stop_interrupts(struct ipw_hardware * hw)1719 void ipwireless_stop_interrupts(struct ipw_hardware *hw)
1720 {
1721 	if (!hw->shutting_down) {
1722 		/* Tell everyone we are going down. */
1723 		hw->shutting_down = 1;
1724 		del_timer(&hw->setup_timer);
1725 
1726 		/* Prevent the hardware from sending any more interrupts */
1727 		do_close_hardware(hw);
1728 	}
1729 }
1730 
ipwireless_hardware_free(struct ipw_hardware * hw)1731 void ipwireless_hardware_free(struct ipw_hardware *hw)
1732 {
1733 	int i;
1734 	struct ipw_rx_packet *rp, *rq;
1735 	struct ipw_tx_packet *tp, *tq;
1736 
1737 	ipwireless_stop_interrupts(hw);
1738 
1739 	flush_work(&hw->work_rx);
1740 
1741 	for (i = 0; i < NL_NUM_OF_ADDRESSES; i++)
1742 		kfree(hw->packet_assembler[i]);
1743 
1744 	for (i = 0; i < NL_NUM_OF_PRIORITIES; i++)
1745 		list_for_each_entry_safe(tp, tq, &hw->tx_queue[i], queue) {
1746 			list_del(&tp->queue);
1747 			kfree(tp);
1748 		}
1749 
1750 	list_for_each_entry_safe(rp, rq, &hw->rx_queue, queue) {
1751 		list_del(&rp->queue);
1752 		kfree(rp);
1753 	}
1754 
1755 	list_for_each_entry_safe(rp, rq, &hw->rx_pool, queue) {
1756 		list_del(&rp->queue);
1757 		kfree(rp);
1758 	}
1759 	kfree(hw);
1760 }
1761 
1762 /*
1763  * Associate the specified network with this hardware, so it will receive events
1764  * from it.
1765  */
ipwireless_associate_network(struct ipw_hardware * hw,struct ipw_network * network)1766 void ipwireless_associate_network(struct ipw_hardware *hw,
1767 				  struct ipw_network *network)
1768 {
1769 	hw->network = network;
1770 }
1771