xref: /openbmc/linux/drivers/tty/ipwireless/hardware.c (revision c900529f3d9161bfde5cca0754f83b4d3c3e0220)
1b2441318SGreg Kroah-Hartman // SPDX-License-Identifier: GPL-2.0
2282361a0SGreg Kroah-Hartman /*
3282361a0SGreg Kroah-Hartman  * IPWireless 3G PCMCIA Network Driver
4282361a0SGreg Kroah-Hartman  *
5282361a0SGreg Kroah-Hartman  * Original code
6282361a0SGreg Kroah-Hartman  *   by Stephen Blackheath <stephen@blacksapphire.com>,
7282361a0SGreg Kroah-Hartman  *      Ben Martel <benm@symmetric.co.nz>
8282361a0SGreg Kroah-Hartman  *
9282361a0SGreg Kroah-Hartman  * Copyrighted as follows:
10282361a0SGreg Kroah-Hartman  *   Copyright (C) 2004 by Symmetric Systems Ltd (NZ)
11282361a0SGreg Kroah-Hartman  *
12282361a0SGreg Kroah-Hartman  * Various driver changes and rewrites, port to new kernels
13282361a0SGreg Kroah-Hartman  *   Copyright (C) 2006-2007 Jiri Kosina
14282361a0SGreg Kroah-Hartman  *
15282361a0SGreg Kroah-Hartman  * Misc code cleanups and updates
16282361a0SGreg Kroah-Hartman  *   Copyright (C) 2007 David Sterba
17282361a0SGreg Kroah-Hartman  */
18282361a0SGreg Kroah-Hartman 
19282361a0SGreg Kroah-Hartman #include <linux/interrupt.h>
20282361a0SGreg Kroah-Hartman #include <linux/io.h>
21282361a0SGreg Kroah-Hartman #include <linux/irq.h>
22282361a0SGreg Kroah-Hartman #include <linux/kernel.h>
23282361a0SGreg Kroah-Hartman #include <linux/list.h>
24282361a0SGreg Kroah-Hartman #include <linux/slab.h>
25282361a0SGreg Kroah-Hartman 
26282361a0SGreg Kroah-Hartman #include "hardware.h"
27282361a0SGreg Kroah-Hartman #include "setup_protocol.h"
28282361a0SGreg Kroah-Hartman #include "network.h"
29282361a0SGreg Kroah-Hartman #include "main.h"
30282361a0SGreg Kroah-Hartman 
31282361a0SGreg Kroah-Hartman static void ipw_send_setup_packet(struct ipw_hardware *hw);
32282361a0SGreg Kroah-Hartman static void handle_received_SETUP_packet(struct ipw_hardware *ipw,
33282361a0SGreg Kroah-Hartman 					 unsigned int address,
34282361a0SGreg Kroah-Hartman 					 const unsigned char *data, int len,
35282361a0SGreg Kroah-Hartman 					 int is_last);
36e99e88a9SKees Cook static void ipwireless_setup_timer(struct timer_list *t);
37282361a0SGreg Kroah-Hartman static void handle_received_CTRL_packet(struct ipw_hardware *hw,
38282361a0SGreg Kroah-Hartman 		unsigned int channel_idx, const unsigned char *data, int len);
39282361a0SGreg Kroah-Hartman 
40282361a0SGreg Kroah-Hartman /*#define TIMING_DIAGNOSTICS*/
41282361a0SGreg Kroah-Hartman 
42282361a0SGreg Kroah-Hartman #ifdef TIMING_DIAGNOSTICS
43282361a0SGreg Kroah-Hartman 
44282361a0SGreg Kroah-Hartman static struct timing_stats {
45282361a0SGreg Kroah-Hartman 	unsigned long last_report_time;
46282361a0SGreg Kroah-Hartman 	unsigned long read_time;
47282361a0SGreg Kroah-Hartman 	unsigned long write_time;
48282361a0SGreg Kroah-Hartman 	unsigned long read_bytes;
49282361a0SGreg Kroah-Hartman 	unsigned long write_bytes;
50282361a0SGreg Kroah-Hartman 	unsigned long start_time;
51282361a0SGreg Kroah-Hartman };
52282361a0SGreg Kroah-Hartman 
start_timing(void)53282361a0SGreg Kroah-Hartman static void start_timing(void)
54282361a0SGreg Kroah-Hartman {
55282361a0SGreg Kroah-Hartman 	timing_stats.start_time = jiffies;
56282361a0SGreg Kroah-Hartman }
57282361a0SGreg Kroah-Hartman 
end_read_timing(unsigned length)58282361a0SGreg Kroah-Hartman static void end_read_timing(unsigned length)
59282361a0SGreg Kroah-Hartman {
60282361a0SGreg Kroah-Hartman 	timing_stats.read_time += (jiffies - start_time);
61282361a0SGreg Kroah-Hartman 	timing_stats.read_bytes += length + 2;
62282361a0SGreg Kroah-Hartman 	report_timing();
63282361a0SGreg Kroah-Hartman }
64282361a0SGreg Kroah-Hartman 
end_write_timing(unsigned length)65282361a0SGreg Kroah-Hartman static void end_write_timing(unsigned length)
66282361a0SGreg Kroah-Hartman {
67282361a0SGreg Kroah-Hartman 	timing_stats.write_time += (jiffies - start_time);
68282361a0SGreg Kroah-Hartman 	timing_stats.write_bytes += length + 2;
69282361a0SGreg Kroah-Hartman 	report_timing();
70282361a0SGreg Kroah-Hartman }
71282361a0SGreg Kroah-Hartman 
report_timing(void)72282361a0SGreg Kroah-Hartman static void report_timing(void)
73282361a0SGreg Kroah-Hartman {
74282361a0SGreg Kroah-Hartman 	unsigned long since = jiffies - timing_stats.last_report_time;
75282361a0SGreg Kroah-Hartman 
76282361a0SGreg Kroah-Hartman 	/* If it's been more than one second... */
77282361a0SGreg Kroah-Hartman 	if (since >= HZ) {
78282361a0SGreg Kroah-Hartman 		int first = (timing_stats.last_report_time == 0);
79282361a0SGreg Kroah-Hartman 
80282361a0SGreg Kroah-Hartman 		timing_stats.last_report_time = jiffies;
81282361a0SGreg Kroah-Hartman 		if (!first)
82282361a0SGreg Kroah-Hartman 			printk(KERN_INFO IPWIRELESS_PCCARD_NAME
83282361a0SGreg Kroah-Hartman 			       ": %u us elapsed - read %lu bytes in %u us, wrote %lu bytes in %u us\n",
84282361a0SGreg Kroah-Hartman 			       jiffies_to_usecs(since),
85282361a0SGreg Kroah-Hartman 			       timing_stats.read_bytes,
86282361a0SGreg Kroah-Hartman 			       jiffies_to_usecs(timing_stats.read_time),
87282361a0SGreg Kroah-Hartman 			       timing_stats.write_bytes,
88282361a0SGreg Kroah-Hartman 			       jiffies_to_usecs(timing_stats.write_time));
89282361a0SGreg Kroah-Hartman 
90282361a0SGreg Kroah-Hartman 		timing_stats.read_time = 0;
91282361a0SGreg Kroah-Hartman 		timing_stats.write_time = 0;
92282361a0SGreg Kroah-Hartman 		timing_stats.read_bytes = 0;
93282361a0SGreg Kroah-Hartman 		timing_stats.write_bytes = 0;
94282361a0SGreg Kroah-Hartman 	}
95282361a0SGreg Kroah-Hartman }
96282361a0SGreg Kroah-Hartman #else
start_timing(void)97282361a0SGreg Kroah-Hartman static void start_timing(void) { }
end_read_timing(unsigned length)98282361a0SGreg Kroah-Hartman static void end_read_timing(unsigned length) { }
end_write_timing(unsigned length)99282361a0SGreg Kroah-Hartman static void end_write_timing(unsigned length) { }
100282361a0SGreg Kroah-Hartman #endif
101282361a0SGreg Kroah-Hartman 
102282361a0SGreg Kroah-Hartman /* Imported IPW definitions */
103282361a0SGreg Kroah-Hartman 
104282361a0SGreg Kroah-Hartman #define LL_MTU_V1 318
105282361a0SGreg Kroah-Hartman #define LL_MTU_V2 250
106282361a0SGreg Kroah-Hartman #define LL_MTU_MAX (LL_MTU_V1 > LL_MTU_V2 ? LL_MTU_V1 : LL_MTU_V2)
107282361a0SGreg Kroah-Hartman 
108282361a0SGreg Kroah-Hartman #define PRIO_DATA  2
109282361a0SGreg Kroah-Hartman #define PRIO_CTRL  1
110282361a0SGreg Kroah-Hartman #define PRIO_SETUP 0
111282361a0SGreg Kroah-Hartman 
112282361a0SGreg Kroah-Hartman /* Addresses */
113282361a0SGreg Kroah-Hartman #define ADDR_SETUP_PROT 0
114282361a0SGreg Kroah-Hartman 
115282361a0SGreg Kroah-Hartman /* Protocol ids */
116282361a0SGreg Kroah-Hartman enum {
117282361a0SGreg Kroah-Hartman 	/* Identifier for the Com Data protocol */
118282361a0SGreg Kroah-Hartman 	TL_PROTOCOLID_COM_DATA = 0,
119282361a0SGreg Kroah-Hartman 
120282361a0SGreg Kroah-Hartman 	/* Identifier for the Com Control protocol */
121282361a0SGreg Kroah-Hartman 	TL_PROTOCOLID_COM_CTRL = 1,
122282361a0SGreg Kroah-Hartman 
123282361a0SGreg Kroah-Hartman 	/* Identifier for the Setup protocol */
124282361a0SGreg Kroah-Hartman 	TL_PROTOCOLID_SETUP = 2
125282361a0SGreg Kroah-Hartman };
126282361a0SGreg Kroah-Hartman 
127282361a0SGreg Kroah-Hartman /* Number of bytes in NL packet header (cannot do
128282361a0SGreg Kroah-Hartman  * sizeof(nl_packet_header) since it's a bitfield) */
129282361a0SGreg Kroah-Hartman #define NL_FIRST_PACKET_HEADER_SIZE        3
130282361a0SGreg Kroah-Hartman 
131282361a0SGreg Kroah-Hartman /* Number of bytes in NL packet header (cannot do
132282361a0SGreg Kroah-Hartman  * sizeof(nl_packet_header) since it's a bitfield) */
133282361a0SGreg Kroah-Hartman #define NL_FOLLOWING_PACKET_HEADER_SIZE    1
134282361a0SGreg Kroah-Hartman 
135282361a0SGreg Kroah-Hartman struct nl_first_packet_header {
136282361a0SGreg Kroah-Hartman 	unsigned char protocol:3;
137282361a0SGreg Kroah-Hartman 	unsigned char address:3;
138282361a0SGreg Kroah-Hartman 	unsigned char packet_rank:2;
139282361a0SGreg Kroah-Hartman 	unsigned char length_lsb;
140282361a0SGreg Kroah-Hartman 	unsigned char length_msb;
141282361a0SGreg Kroah-Hartman };
142282361a0SGreg Kroah-Hartman 
143282361a0SGreg Kroah-Hartman struct nl_packet_header {
144282361a0SGreg Kroah-Hartman 	unsigned char protocol:3;
145282361a0SGreg Kroah-Hartman 	unsigned char address:3;
146282361a0SGreg Kroah-Hartman 	unsigned char packet_rank:2;
147282361a0SGreg Kroah-Hartman };
148282361a0SGreg Kroah-Hartman 
149282361a0SGreg Kroah-Hartman /* Value of 'packet_rank' above */
150282361a0SGreg Kroah-Hartman #define NL_INTERMEDIATE_PACKET    0x0
151282361a0SGreg Kroah-Hartman #define NL_LAST_PACKET            0x1
152282361a0SGreg Kroah-Hartman #define NL_FIRST_PACKET           0x2
153282361a0SGreg Kroah-Hartman 
154282361a0SGreg Kroah-Hartman union nl_packet {
155282361a0SGreg Kroah-Hartman 	/* Network packet header of the first packet (a special case) */
156282361a0SGreg Kroah-Hartman 	struct nl_first_packet_header hdr_first;
157282361a0SGreg Kroah-Hartman 	/* Network packet header of the following packets (if any) */
158282361a0SGreg Kroah-Hartman 	struct nl_packet_header hdr;
159282361a0SGreg Kroah-Hartman 	/* Complete network packet (header + data) */
160282361a0SGreg Kroah-Hartman 	unsigned char rawpkt[LL_MTU_MAX];
161282361a0SGreg Kroah-Hartman } __attribute__ ((__packed__));
162282361a0SGreg Kroah-Hartman 
163282361a0SGreg Kroah-Hartman #define HW_VERSION_UNKNOWN -1
164282361a0SGreg Kroah-Hartman #define HW_VERSION_1 1
165282361a0SGreg Kroah-Hartman #define HW_VERSION_2 2
166282361a0SGreg Kroah-Hartman 
167282361a0SGreg Kroah-Hartman /* IPW I/O ports */
168282361a0SGreg Kroah-Hartman #define IOIER 0x00		/* Interrupt Enable Register */
169282361a0SGreg Kroah-Hartman #define IOIR  0x02		/* Interrupt Source/ACK register */
170282361a0SGreg Kroah-Hartman #define IODCR 0x04		/* Data Control Register */
171282361a0SGreg Kroah-Hartman #define IODRR 0x06		/* Data Read Register */
172282361a0SGreg Kroah-Hartman #define IODWR 0x08		/* Data Write Register */
173282361a0SGreg Kroah-Hartman #define IOESR 0x0A		/* Embedded Driver Status Register */
174282361a0SGreg Kroah-Hartman #define IORXR 0x0C		/* Rx Fifo Register (Host to Embedded) */
175282361a0SGreg Kroah-Hartman #define IOTXR 0x0E		/* Tx Fifo Register (Embedded to Host) */
176282361a0SGreg Kroah-Hartman 
177282361a0SGreg Kroah-Hartman /* I/O ports and bit definitions for version 1 of the hardware */
178282361a0SGreg Kroah-Hartman 
179282361a0SGreg Kroah-Hartman /* IER bits*/
180282361a0SGreg Kroah-Hartman #define IER_RXENABLED   0x1
181282361a0SGreg Kroah-Hartman #define IER_TXENABLED   0x2
182282361a0SGreg Kroah-Hartman 
183282361a0SGreg Kroah-Hartman /* ISR bits */
184282361a0SGreg Kroah-Hartman #define IR_RXINTR       0x1
185282361a0SGreg Kroah-Hartman #define IR_TXINTR       0x2
186282361a0SGreg Kroah-Hartman 
187282361a0SGreg Kroah-Hartman /* DCR bits */
188282361a0SGreg Kroah-Hartman #define DCR_RXDONE      0x1
189282361a0SGreg Kroah-Hartman #define DCR_TXDONE      0x2
190282361a0SGreg Kroah-Hartman #define DCR_RXRESET     0x4
191282361a0SGreg Kroah-Hartman #define DCR_TXRESET     0x8
192282361a0SGreg Kroah-Hartman 
193282361a0SGreg Kroah-Hartman /* I/O ports and bit definitions for version 2 of the hardware */
194282361a0SGreg Kroah-Hartman 
195282361a0SGreg Kroah-Hartman struct MEMCCR {
196282361a0SGreg Kroah-Hartman 	unsigned short reg_config_option;	/* PCCOR: Configuration Option Register */
197282361a0SGreg Kroah-Hartman 	unsigned short reg_config_and_status;	/* PCCSR: Configuration and Status Register */
198282361a0SGreg Kroah-Hartman 	unsigned short reg_pin_replacement;	/* PCPRR: Pin Replacemant Register */
199282361a0SGreg Kroah-Hartman 	unsigned short reg_socket_and_copy;	/* PCSCR: Socket and Copy Register */
200282361a0SGreg Kroah-Hartman 	unsigned short reg_ext_status;		/* PCESR: Extendend Status Register */
201282361a0SGreg Kroah-Hartman 	unsigned short reg_io_base;		/* PCIOB: I/O Base Register */
202282361a0SGreg Kroah-Hartman };
203282361a0SGreg Kroah-Hartman 
204282361a0SGreg Kroah-Hartman struct MEMINFREG {
205282361a0SGreg Kroah-Hartman 	unsigned short memreg_tx_old;	/* TX Register (R/W) */
206282361a0SGreg Kroah-Hartman 	unsigned short pad1;
207282361a0SGreg Kroah-Hartman 	unsigned short memreg_rx_done;	/* RXDone Register (R/W) */
208282361a0SGreg Kroah-Hartman 	unsigned short pad2;
209282361a0SGreg Kroah-Hartman 	unsigned short memreg_rx;	/* RX Register (R/W) */
210282361a0SGreg Kroah-Hartman 	unsigned short pad3;
211282361a0SGreg Kroah-Hartman 	unsigned short memreg_pc_interrupt_ack;	/* PC intr Ack Register (W) */
212282361a0SGreg Kroah-Hartman 	unsigned short pad4;
213282361a0SGreg Kroah-Hartman 	unsigned long memreg_card_present;/* Mask for Host to check (R) for
214282361a0SGreg Kroah-Hartman 					   * CARD_PRESENT_VALUE */
215282361a0SGreg Kroah-Hartman 	unsigned short memreg_tx_new;	/* TX2 (new) Register (R/W) */
216282361a0SGreg Kroah-Hartman };
217282361a0SGreg Kroah-Hartman 
218282361a0SGreg Kroah-Hartman #define CARD_PRESENT_VALUE (0xBEEFCAFEUL)
219282361a0SGreg Kroah-Hartman 
220282361a0SGreg Kroah-Hartman #define MEMTX_TX                       0x0001
221282361a0SGreg Kroah-Hartman #define MEMRX_RX                       0x0001
222282361a0SGreg Kroah-Hartman #define MEMRX_RX_DONE                  0x0001
223282361a0SGreg Kroah-Hartman #define MEMRX_PCINTACKK                0x0001
224282361a0SGreg Kroah-Hartman 
225282361a0SGreg Kroah-Hartman #define NL_NUM_OF_PRIORITIES       3
226282361a0SGreg Kroah-Hartman #define NL_NUM_OF_PROTOCOLS        3
227282361a0SGreg Kroah-Hartman #define NL_NUM_OF_ADDRESSES        NO_OF_IPW_CHANNELS
228282361a0SGreg Kroah-Hartman 
229282361a0SGreg Kroah-Hartman struct ipw_hardware {
230282361a0SGreg Kroah-Hartman 	unsigned int base_port;
231282361a0SGreg Kroah-Hartman 	short hw_version;
232282361a0SGreg Kroah-Hartman 	unsigned short ll_mtu;
233282361a0SGreg Kroah-Hartman 	spinlock_t lock;
234282361a0SGreg Kroah-Hartman 
235282361a0SGreg Kroah-Hartman 	int initializing;
236282361a0SGreg Kroah-Hartman 	int init_loops;
237282361a0SGreg Kroah-Hartman 	struct timer_list setup_timer;
238282361a0SGreg Kroah-Hartman 
239282361a0SGreg Kroah-Hartman 	/* Flag if hw is ready to send next packet */
240282361a0SGreg Kroah-Hartman 	int tx_ready;
241282361a0SGreg Kroah-Hartman 	/* Count of pending packets to be sent */
242282361a0SGreg Kroah-Hartman 	int tx_queued;
243282361a0SGreg Kroah-Hartman 	struct list_head tx_queue[NL_NUM_OF_PRIORITIES];
244282361a0SGreg Kroah-Hartman 
245282361a0SGreg Kroah-Hartman 	int rx_bytes_queued;
246282361a0SGreg Kroah-Hartman 	struct list_head rx_queue;
247282361a0SGreg Kroah-Hartman 	/* Pool of rx_packet structures that are not currently used. */
248282361a0SGreg Kroah-Hartman 	struct list_head rx_pool;
249282361a0SGreg Kroah-Hartman 	int rx_pool_size;
250282361a0SGreg Kroah-Hartman 	/* True if reception of data is blocked while userspace processes it. */
251282361a0SGreg Kroah-Hartman 	int blocking_rx;
252282361a0SGreg Kroah-Hartman 	/* True if there is RX data ready on the hardware. */
253282361a0SGreg Kroah-Hartman 	int rx_ready;
254282361a0SGreg Kroah-Hartman 	unsigned short last_memtx_serial;
255282361a0SGreg Kroah-Hartman 	/*
256282361a0SGreg Kroah-Hartman 	 * Newer versions of the V2 card firmware send serial numbers in the
257282361a0SGreg Kroah-Hartman 	 * MemTX register. 'serial_number_detected' is set true when we detect
258282361a0SGreg Kroah-Hartman 	 * a non-zero serial number (indicating the new firmware).  Thereafter,
259282361a0SGreg Kroah-Hartman 	 * the driver can safely ignore the Timer Recovery re-sends to avoid
260282361a0SGreg Kroah-Hartman 	 * out-of-sync problems.
261282361a0SGreg Kroah-Hartman 	 */
262282361a0SGreg Kroah-Hartman 	int serial_number_detected;
263282361a0SGreg Kroah-Hartman 	struct work_struct work_rx;
264282361a0SGreg Kroah-Hartman 
265282361a0SGreg Kroah-Hartman 	/* True if we are to send the set-up data to the hardware. */
266282361a0SGreg Kroah-Hartman 	int to_setup;
267282361a0SGreg Kroah-Hartman 
268282361a0SGreg Kroah-Hartman 	/* Card has been removed */
269282361a0SGreg Kroah-Hartman 	int removed;
270282361a0SGreg Kroah-Hartman 	/* Saved irq value when we disable the interrupt. */
271282361a0SGreg Kroah-Hartman 	int irq;
272282361a0SGreg Kroah-Hartman 	/* True if this driver is shutting down. */
273282361a0SGreg Kroah-Hartman 	int shutting_down;
274282361a0SGreg Kroah-Hartman 	/* Modem control lines */
275282361a0SGreg Kroah-Hartman 	unsigned int control_lines[NL_NUM_OF_ADDRESSES];
276282361a0SGreg Kroah-Hartman 	struct ipw_rx_packet *packet_assembler[NL_NUM_OF_ADDRESSES];
277282361a0SGreg Kroah-Hartman 
278282361a0SGreg Kroah-Hartman 	struct tasklet_struct tasklet;
279282361a0SGreg Kroah-Hartman 
280282361a0SGreg Kroah-Hartman 	/* The handle for the network layer, for the sending of events to it. */
281282361a0SGreg Kroah-Hartman 	struct ipw_network *network;
282282361a0SGreg Kroah-Hartman 	struct MEMINFREG __iomem *memory_info_regs;
283282361a0SGreg Kroah-Hartman 	struct MEMCCR __iomem *memregs_CCR;
284282361a0SGreg Kroah-Hartman 	void (*reboot_callback) (void *data);
285282361a0SGreg Kroah-Hartman 	void *reboot_callback_data;
286282361a0SGreg Kroah-Hartman 
287282361a0SGreg Kroah-Hartman 	unsigned short __iomem *memreg_tx;
288282361a0SGreg Kroah-Hartman };
289282361a0SGreg Kroah-Hartman 
290282361a0SGreg Kroah-Hartman /*
291282361a0SGreg Kroah-Hartman  * Packet info structure for tx packets.
292282361a0SGreg Kroah-Hartman  * Note: not all the fields defined here are required for all protocols
293282361a0SGreg Kroah-Hartman  */
294282361a0SGreg Kroah-Hartman struct ipw_tx_packet {
295282361a0SGreg Kroah-Hartman 	struct list_head queue;
296282361a0SGreg Kroah-Hartman 	/* channel idx + 1 */
297282361a0SGreg Kroah-Hartman 	unsigned char dest_addr;
298282361a0SGreg Kroah-Hartman 	/* SETUP, CTRL or DATA */
299282361a0SGreg Kroah-Hartman 	unsigned char protocol;
300282361a0SGreg Kroah-Hartman 	/* Length of data block, which starts at the end of this structure */
301282361a0SGreg Kroah-Hartman 	unsigned short length;
302282361a0SGreg Kroah-Hartman 	/* Sending state */
303282361a0SGreg Kroah-Hartman 	/* Offset of where we've sent up to so far */
304282361a0SGreg Kroah-Hartman 	unsigned long offset;
305282361a0SGreg Kroah-Hartman 	/* Count of packet fragments, starting at 0 */
306282361a0SGreg Kroah-Hartman 	int fragment_count;
307282361a0SGreg Kroah-Hartman 
308282361a0SGreg Kroah-Hartman 	/* Called after packet is sent and before is freed */
309282361a0SGreg Kroah-Hartman 	void (*packet_callback) (void *cb_data, unsigned int packet_length);
310282361a0SGreg Kroah-Hartman 	void *callback_data;
311282361a0SGreg Kroah-Hartman };
312282361a0SGreg Kroah-Hartman 
313282361a0SGreg Kroah-Hartman /* Signals from DTE */
314282361a0SGreg Kroah-Hartman #define COMCTRL_RTS	0
315282361a0SGreg Kroah-Hartman #define COMCTRL_DTR	1
316282361a0SGreg Kroah-Hartman 
317282361a0SGreg Kroah-Hartman /* Signals from DCE */
318282361a0SGreg Kroah-Hartman #define COMCTRL_CTS	2
319282361a0SGreg Kroah-Hartman #define COMCTRL_DCD	3
320282361a0SGreg Kroah-Hartman #define COMCTRL_DSR	4
321282361a0SGreg Kroah-Hartman #define COMCTRL_RI	5
322282361a0SGreg Kroah-Hartman 
323282361a0SGreg Kroah-Hartman struct ipw_control_packet_body {
324282361a0SGreg Kroah-Hartman 	/* DTE signal or DCE signal */
325282361a0SGreg Kroah-Hartman 	unsigned char sig_no;
326282361a0SGreg Kroah-Hartman 	/* 0: set signal, 1: clear signal */
327282361a0SGreg Kroah-Hartman 	unsigned char value;
328282361a0SGreg Kroah-Hartman } __attribute__ ((__packed__));
329282361a0SGreg Kroah-Hartman 
330282361a0SGreg Kroah-Hartman struct ipw_control_packet {
331282361a0SGreg Kroah-Hartman 	struct ipw_tx_packet header;
332282361a0SGreg Kroah-Hartman 	struct ipw_control_packet_body body;
333282361a0SGreg Kroah-Hartman };
334282361a0SGreg Kroah-Hartman 
335282361a0SGreg Kroah-Hartman struct ipw_rx_packet {
336282361a0SGreg Kroah-Hartman 	struct list_head queue;
337282361a0SGreg Kroah-Hartman 	unsigned int capacity;
338282361a0SGreg Kroah-Hartman 	unsigned int length;
339282361a0SGreg Kroah-Hartman 	unsigned int protocol;
340282361a0SGreg Kroah-Hartman 	unsigned int channel_idx;
341282361a0SGreg Kroah-Hartman };
342282361a0SGreg Kroah-Hartman 
data_type(const unsigned char * buf,unsigned length)343282361a0SGreg Kroah-Hartman static char *data_type(const unsigned char *buf, unsigned length)
344282361a0SGreg Kroah-Hartman {
345282361a0SGreg Kroah-Hartman 	struct nl_packet_header *hdr = (struct nl_packet_header *) buf;
346282361a0SGreg Kroah-Hartman 
347282361a0SGreg Kroah-Hartman 	if (length == 0)
348282361a0SGreg Kroah-Hartman 		return "     ";
349282361a0SGreg Kroah-Hartman 
350282361a0SGreg Kroah-Hartman 	if (hdr->packet_rank & NL_FIRST_PACKET) {
351282361a0SGreg Kroah-Hartman 		switch (hdr->protocol) {
352282361a0SGreg Kroah-Hartman 		case TL_PROTOCOLID_COM_DATA:	return "DATA ";
353282361a0SGreg Kroah-Hartman 		case TL_PROTOCOLID_COM_CTRL:	return "CTRL ";
354282361a0SGreg Kroah-Hartman 		case TL_PROTOCOLID_SETUP:	return "SETUP";
355282361a0SGreg Kroah-Hartman 		default: return "???? ";
356282361a0SGreg Kroah-Hartman 		}
357282361a0SGreg Kroah-Hartman 	} else
358282361a0SGreg Kroah-Hartman 		return "     ";
359282361a0SGreg Kroah-Hartman }
360282361a0SGreg Kroah-Hartman 
361282361a0SGreg Kroah-Hartman #define DUMP_MAX_BYTES 64
362282361a0SGreg Kroah-Hartman 
dump_data_bytes(const char * type,const unsigned char * data,unsigned length)363282361a0SGreg Kroah-Hartman static void dump_data_bytes(const char *type, const unsigned char *data,
364282361a0SGreg Kroah-Hartman 			    unsigned length)
365282361a0SGreg Kroah-Hartman {
366282361a0SGreg Kroah-Hartman 	char prefix[56];
367282361a0SGreg Kroah-Hartman 
368282361a0SGreg Kroah-Hartman 	sprintf(prefix, IPWIRELESS_PCCARD_NAME ": %s %s ",
369282361a0SGreg Kroah-Hartman 			type, data_type(data, length));
370282361a0SGreg Kroah-Hartman 	print_hex_dump_bytes(prefix, 0, (void *)data,
371282361a0SGreg Kroah-Hartman 			length < DUMP_MAX_BYTES ? length : DUMP_MAX_BYTES);
372282361a0SGreg Kroah-Hartman }
373282361a0SGreg Kroah-Hartman 
swap_packet_bitfield_to_le(unsigned char * data)374282361a0SGreg Kroah-Hartman static void swap_packet_bitfield_to_le(unsigned char *data)
375282361a0SGreg Kroah-Hartman {
376282361a0SGreg Kroah-Hartman #ifdef __BIG_ENDIAN_BITFIELD
377282361a0SGreg Kroah-Hartman 	unsigned char tmp = *data, ret = 0;
378282361a0SGreg Kroah-Hartman 
379282361a0SGreg Kroah-Hartman 	/*
380282361a0SGreg Kroah-Hartman 	 * transform bits from aa.bbb.ccc to ccc.bbb.aa
381282361a0SGreg Kroah-Hartman 	 */
3827e041abfSJoe Perches 	ret |= (tmp & 0xc0) >> 6;
3837e041abfSJoe Perches 	ret |= (tmp & 0x38) >> 1;
3847e041abfSJoe Perches 	ret |= (tmp & 0x07) << 5;
385282361a0SGreg Kroah-Hartman 	*data = ret & 0xff;
386282361a0SGreg Kroah-Hartman #endif
387282361a0SGreg Kroah-Hartman }
388282361a0SGreg Kroah-Hartman 
swap_packet_bitfield_from_le(unsigned char * data)389282361a0SGreg Kroah-Hartman static void swap_packet_bitfield_from_le(unsigned char *data)
390282361a0SGreg Kroah-Hartman {
391282361a0SGreg Kroah-Hartman #ifdef __BIG_ENDIAN_BITFIELD
392282361a0SGreg Kroah-Hartman 	unsigned char tmp = *data, ret = 0;
393282361a0SGreg Kroah-Hartman 
394282361a0SGreg Kroah-Hartman 	/*
395282361a0SGreg Kroah-Hartman 	 * transform bits from ccc.bbb.aa to aa.bbb.ccc
396282361a0SGreg Kroah-Hartman 	 */
3977e041abfSJoe Perches 	ret |= (tmp & 0xe0) >> 5;
3987e041abfSJoe Perches 	ret |= (tmp & 0x1c) << 1;
3997e041abfSJoe Perches 	ret |= (tmp & 0x03) << 6;
400282361a0SGreg Kroah-Hartman 	*data = ret & 0xff;
401282361a0SGreg Kroah-Hartman #endif
402282361a0SGreg Kroah-Hartman }
403282361a0SGreg Kroah-Hartman 
do_send_fragment(struct ipw_hardware * hw,unsigned char * data,unsigned length)404282361a0SGreg Kroah-Hartman static void do_send_fragment(struct ipw_hardware *hw, unsigned char *data,
405282361a0SGreg Kroah-Hartman 			    unsigned length)
406282361a0SGreg Kroah-Hartman {
407282361a0SGreg Kroah-Hartman 	unsigned i;
408282361a0SGreg Kroah-Hartman 	unsigned long flags;
409282361a0SGreg Kroah-Hartman 
410282361a0SGreg Kroah-Hartman 	start_timing();
411282361a0SGreg Kroah-Hartman 	BUG_ON(length > hw->ll_mtu);
412282361a0SGreg Kroah-Hartman 
413282361a0SGreg Kroah-Hartman 	if (ipwireless_debug)
414282361a0SGreg Kroah-Hartman 		dump_data_bytes("send", data, length);
415282361a0SGreg Kroah-Hartman 
416282361a0SGreg Kroah-Hartman 	spin_lock_irqsave(&hw->lock, flags);
417282361a0SGreg Kroah-Hartman 
418282361a0SGreg Kroah-Hartman 	hw->tx_ready = 0;
419282361a0SGreg Kroah-Hartman 	swap_packet_bitfield_to_le(data);
420282361a0SGreg Kroah-Hartman 
421282361a0SGreg Kroah-Hartman 	if (hw->hw_version == HW_VERSION_1) {
422282361a0SGreg Kroah-Hartman 		outw((unsigned short) length, hw->base_port + IODWR);
423282361a0SGreg Kroah-Hartman 
424282361a0SGreg Kroah-Hartman 		for (i = 0; i < length; i += 2) {
425282361a0SGreg Kroah-Hartman 			unsigned short d = data[i];
426282361a0SGreg Kroah-Hartman 			__le16 raw_data;
427282361a0SGreg Kroah-Hartman 
428282361a0SGreg Kroah-Hartman 			if (i + 1 < length)
429282361a0SGreg Kroah-Hartman 				d |= data[i + 1] << 8;
430282361a0SGreg Kroah-Hartman 			raw_data = cpu_to_le16(d);
431282361a0SGreg Kroah-Hartman 			outw(raw_data, hw->base_port + IODWR);
432282361a0SGreg Kroah-Hartman 		}
433282361a0SGreg Kroah-Hartman 
434282361a0SGreg Kroah-Hartman 		outw(DCR_TXDONE, hw->base_port + IODCR);
435282361a0SGreg Kroah-Hartman 	} else if (hw->hw_version == HW_VERSION_2) {
436282361a0SGreg Kroah-Hartman 		outw((unsigned short) length, hw->base_port);
437282361a0SGreg Kroah-Hartman 
438282361a0SGreg Kroah-Hartman 		for (i = 0; i < length; i += 2) {
439282361a0SGreg Kroah-Hartman 			unsigned short d = data[i];
440282361a0SGreg Kroah-Hartman 			__le16 raw_data;
441282361a0SGreg Kroah-Hartman 
442282361a0SGreg Kroah-Hartman 			if (i + 1 < length)
443282361a0SGreg Kroah-Hartman 				d |= data[i + 1] << 8;
444282361a0SGreg Kroah-Hartman 			raw_data = cpu_to_le16(d);
445282361a0SGreg Kroah-Hartman 			outw(raw_data, hw->base_port);
446282361a0SGreg Kroah-Hartman 		}
447282361a0SGreg Kroah-Hartman 		while ((i & 3) != 2) {
448282361a0SGreg Kroah-Hartman 			outw((unsigned short) 0xDEAD, hw->base_port);
449282361a0SGreg Kroah-Hartman 			i += 2;
450282361a0SGreg Kroah-Hartman 		}
451282361a0SGreg Kroah-Hartman 		writew(MEMRX_RX, &hw->memory_info_regs->memreg_rx);
452282361a0SGreg Kroah-Hartman 	}
453282361a0SGreg Kroah-Hartman 
454282361a0SGreg Kroah-Hartman 	spin_unlock_irqrestore(&hw->lock, flags);
455282361a0SGreg Kroah-Hartman 
456282361a0SGreg Kroah-Hartman 	end_write_timing(length);
457282361a0SGreg Kroah-Hartman }
458282361a0SGreg Kroah-Hartman 
do_send_packet(struct ipw_hardware * hw,struct ipw_tx_packet * packet)459282361a0SGreg Kroah-Hartman static void do_send_packet(struct ipw_hardware *hw, struct ipw_tx_packet *packet)
460282361a0SGreg Kroah-Hartman {
461282361a0SGreg Kroah-Hartman 	unsigned short fragment_data_len;
462282361a0SGreg Kroah-Hartman 	unsigned short data_left = packet->length - packet->offset;
463282361a0SGreg Kroah-Hartman 	unsigned short header_size;
464282361a0SGreg Kroah-Hartman 	union nl_packet pkt;
465282361a0SGreg Kroah-Hartman 
466282361a0SGreg Kroah-Hartman 	header_size =
467282361a0SGreg Kroah-Hartman 	    (packet->fragment_count == 0)
468282361a0SGreg Kroah-Hartman 	    ? NL_FIRST_PACKET_HEADER_SIZE
469282361a0SGreg Kroah-Hartman 	    : NL_FOLLOWING_PACKET_HEADER_SIZE;
470282361a0SGreg Kroah-Hartman 	fragment_data_len = hw->ll_mtu - header_size;
471282361a0SGreg Kroah-Hartman 	if (data_left < fragment_data_len)
472282361a0SGreg Kroah-Hartman 		fragment_data_len = data_left;
473282361a0SGreg Kroah-Hartman 
474282361a0SGreg Kroah-Hartman 	/*
475282361a0SGreg Kroah-Hartman 	 * hdr_first is now in machine bitfield order, which will be swapped
476282361a0SGreg Kroah-Hartman 	 * to le just before it goes to hw
477282361a0SGreg Kroah-Hartman 	 */
478282361a0SGreg Kroah-Hartman 	pkt.hdr_first.protocol = packet->protocol;
479282361a0SGreg Kroah-Hartman 	pkt.hdr_first.address = packet->dest_addr;
480282361a0SGreg Kroah-Hartman 	pkt.hdr_first.packet_rank = 0;
481282361a0SGreg Kroah-Hartman 
482282361a0SGreg Kroah-Hartman 	/* First packet? */
483282361a0SGreg Kroah-Hartman 	if (packet->fragment_count == 0) {
484282361a0SGreg Kroah-Hartman 		pkt.hdr_first.packet_rank |= NL_FIRST_PACKET;
485282361a0SGreg Kroah-Hartman 		pkt.hdr_first.length_lsb = (unsigned char) packet->length;
486282361a0SGreg Kroah-Hartman 		pkt.hdr_first.length_msb =
487282361a0SGreg Kroah-Hartman 			(unsigned char) (packet->length >> 8);
488282361a0SGreg Kroah-Hartman 	}
489282361a0SGreg Kroah-Hartman 
490282361a0SGreg Kroah-Hartman 	memcpy(pkt.rawpkt + header_size,
491282361a0SGreg Kroah-Hartman 	       ((unsigned char *) packet) + sizeof(struct ipw_tx_packet) +
492282361a0SGreg Kroah-Hartman 	       packet->offset, fragment_data_len);
493282361a0SGreg Kroah-Hartman 	packet->offset += fragment_data_len;
494282361a0SGreg Kroah-Hartman 	packet->fragment_count++;
495282361a0SGreg Kroah-Hartman 
496282361a0SGreg Kroah-Hartman 	/* Last packet? (May also be first packet.) */
497282361a0SGreg Kroah-Hartman 	if (packet->offset == packet->length)
498282361a0SGreg Kroah-Hartman 		pkt.hdr_first.packet_rank |= NL_LAST_PACKET;
499282361a0SGreg Kroah-Hartman 	do_send_fragment(hw, pkt.rawpkt, header_size + fragment_data_len);
500282361a0SGreg Kroah-Hartman 
501282361a0SGreg Kroah-Hartman 	/* If this packet has unsent data, then re-queue it. */
502282361a0SGreg Kroah-Hartman 	if (packet->offset < packet->length) {
503282361a0SGreg Kroah-Hartman 		/*
504282361a0SGreg Kroah-Hartman 		 * Re-queue it at the head of the highest priority queue so
505282361a0SGreg Kroah-Hartman 		 * it goes before all other packets
506282361a0SGreg Kroah-Hartman 		 */
507282361a0SGreg Kroah-Hartman 		unsigned long flags;
508282361a0SGreg Kroah-Hartman 
509282361a0SGreg Kroah-Hartman 		spin_lock_irqsave(&hw->lock, flags);
510282361a0SGreg Kroah-Hartman 		list_add(&packet->queue, &hw->tx_queue[0]);
511282361a0SGreg Kroah-Hartman 		hw->tx_queued++;
512282361a0SGreg Kroah-Hartman 		spin_unlock_irqrestore(&hw->lock, flags);
513282361a0SGreg Kroah-Hartman 	} else {
514282361a0SGreg Kroah-Hartman 		if (packet->packet_callback)
515282361a0SGreg Kroah-Hartman 			packet->packet_callback(packet->callback_data,
516282361a0SGreg Kroah-Hartman 					packet->length);
517282361a0SGreg Kroah-Hartman 		kfree(packet);
518282361a0SGreg Kroah-Hartman 	}
519282361a0SGreg Kroah-Hartman }
520282361a0SGreg Kroah-Hartman 
ipw_setup_hardware(struct ipw_hardware * hw)521282361a0SGreg Kroah-Hartman static void ipw_setup_hardware(struct ipw_hardware *hw)
522282361a0SGreg Kroah-Hartman {
523282361a0SGreg Kroah-Hartman 	unsigned long flags;
524282361a0SGreg Kroah-Hartman 
525282361a0SGreg Kroah-Hartman 	spin_lock_irqsave(&hw->lock, flags);
526282361a0SGreg Kroah-Hartman 	if (hw->hw_version == HW_VERSION_1) {
527282361a0SGreg Kroah-Hartman 		/* Reset RX FIFO */
528282361a0SGreg Kroah-Hartman 		outw(DCR_RXRESET, hw->base_port + IODCR);
529282361a0SGreg Kroah-Hartman 		/* SB: Reset TX FIFO */
530282361a0SGreg Kroah-Hartman 		outw(DCR_TXRESET, hw->base_port + IODCR);
531282361a0SGreg Kroah-Hartman 
532282361a0SGreg Kroah-Hartman 		/* Enable TX and RX interrupts. */
533282361a0SGreg Kroah-Hartman 		outw(IER_TXENABLED | IER_RXENABLED, hw->base_port + IOIER);
534282361a0SGreg Kroah-Hartman 	} else {
535282361a0SGreg Kroah-Hartman 		/*
536282361a0SGreg Kroah-Hartman 		 * Set INTRACK bit (bit 0), which means we must explicitly
537282361a0SGreg Kroah-Hartman 		 * acknowledge interrupts by clearing bit 2 of reg_config_and_status.
538282361a0SGreg Kroah-Hartman 		 */
539282361a0SGreg Kroah-Hartman 		unsigned short csr = readw(&hw->memregs_CCR->reg_config_and_status);
540282361a0SGreg Kroah-Hartman 
541282361a0SGreg Kroah-Hartman 		csr |= 1;
542282361a0SGreg Kroah-Hartman 		writew(csr, &hw->memregs_CCR->reg_config_and_status);
543282361a0SGreg Kroah-Hartman 	}
544282361a0SGreg Kroah-Hartman 	spin_unlock_irqrestore(&hw->lock, flags);
545282361a0SGreg Kroah-Hartman }
546282361a0SGreg Kroah-Hartman 
547282361a0SGreg Kroah-Hartman /*
548282361a0SGreg Kroah-Hartman  * If 'packet' is NULL, then this function allocates a new packet, setting its
549282361a0SGreg Kroah-Hartman  * length to 0 and ensuring it has the specified minimum amount of free space.
550282361a0SGreg Kroah-Hartman  *
551282361a0SGreg Kroah-Hartman  * If 'packet' is not NULL, then this function enlarges it if it doesn't
552282361a0SGreg Kroah-Hartman  * have the specified minimum amount of free space.
553282361a0SGreg Kroah-Hartman  *
554282361a0SGreg Kroah-Hartman  */
pool_allocate(struct ipw_hardware * hw,struct ipw_rx_packet * packet,int minimum_free_space)555282361a0SGreg Kroah-Hartman static struct ipw_rx_packet *pool_allocate(struct ipw_hardware *hw,
556282361a0SGreg Kroah-Hartman 					   struct ipw_rx_packet *packet,
557282361a0SGreg Kroah-Hartman 					   int minimum_free_space)
558282361a0SGreg Kroah-Hartman {
559282361a0SGreg Kroah-Hartman 
560282361a0SGreg Kroah-Hartman 	if (!packet) {
561282361a0SGreg Kroah-Hartman 		unsigned long flags;
562282361a0SGreg Kroah-Hartman 
563282361a0SGreg Kroah-Hartman 		spin_lock_irqsave(&hw->lock, flags);
564282361a0SGreg Kroah-Hartman 		if (!list_empty(&hw->rx_pool)) {
565282361a0SGreg Kroah-Hartman 			packet = list_first_entry(&hw->rx_pool,
566282361a0SGreg Kroah-Hartman 					struct ipw_rx_packet, queue);
567282361a0SGreg Kroah-Hartman 			hw->rx_pool_size--;
568282361a0SGreg Kroah-Hartman 			spin_unlock_irqrestore(&hw->lock, flags);
569282361a0SGreg Kroah-Hartman 			list_del(&packet->queue);
570282361a0SGreg Kroah-Hartman 		} else {
571282361a0SGreg Kroah-Hartman 			const int min_capacity =
572282361a0SGreg Kroah-Hartman 				ipwireless_ppp_mru(hw->network) + 2;
573282361a0SGreg Kroah-Hartman 			int new_capacity;
574282361a0SGreg Kroah-Hartman 
575282361a0SGreg Kroah-Hartman 			spin_unlock_irqrestore(&hw->lock, flags);
576282361a0SGreg Kroah-Hartman 			new_capacity =
577282361a0SGreg Kroah-Hartman 				(minimum_free_space > min_capacity
578282361a0SGreg Kroah-Hartman 				 ? minimum_free_space
579282361a0SGreg Kroah-Hartman 				 : min_capacity);
580282361a0SGreg Kroah-Hartman 			packet = kmalloc(sizeof(struct ipw_rx_packet)
581282361a0SGreg Kroah-Hartman 					+ new_capacity, GFP_ATOMIC);
582282361a0SGreg Kroah-Hartman 			if (!packet)
583282361a0SGreg Kroah-Hartman 				return NULL;
584282361a0SGreg Kroah-Hartman 			packet->capacity = new_capacity;
585282361a0SGreg Kroah-Hartman 		}
586282361a0SGreg Kroah-Hartman 		packet->length = 0;
587282361a0SGreg Kroah-Hartman 	}
588282361a0SGreg Kroah-Hartman 
589282361a0SGreg Kroah-Hartman 	if (packet->length + minimum_free_space > packet->capacity) {
590282361a0SGreg Kroah-Hartman 		struct ipw_rx_packet *old_packet = packet;
591282361a0SGreg Kroah-Hartman 
592282361a0SGreg Kroah-Hartman 		packet = kmalloc(sizeof(struct ipw_rx_packet) +
593282361a0SGreg Kroah-Hartman 				old_packet->length + minimum_free_space,
594282361a0SGreg Kroah-Hartman 				GFP_ATOMIC);
595282361a0SGreg Kroah-Hartman 		if (!packet) {
596282361a0SGreg Kroah-Hartman 			kfree(old_packet);
597282361a0SGreg Kroah-Hartman 			return NULL;
598282361a0SGreg Kroah-Hartman 		}
599282361a0SGreg Kroah-Hartman 		memcpy(packet, old_packet,
600282361a0SGreg Kroah-Hartman 				sizeof(struct ipw_rx_packet)
601282361a0SGreg Kroah-Hartman 					+ old_packet->length);
602282361a0SGreg Kroah-Hartman 		packet->capacity = old_packet->length + minimum_free_space;
603282361a0SGreg Kroah-Hartman 		kfree(old_packet);
604282361a0SGreg Kroah-Hartman 	}
605282361a0SGreg Kroah-Hartman 
606282361a0SGreg Kroah-Hartman 	return packet;
607282361a0SGreg Kroah-Hartman }
608282361a0SGreg Kroah-Hartman 
pool_free(struct ipw_hardware * hw,struct ipw_rx_packet * packet)609282361a0SGreg Kroah-Hartman static void pool_free(struct ipw_hardware *hw, struct ipw_rx_packet *packet)
610282361a0SGreg Kroah-Hartman {
611282361a0SGreg Kroah-Hartman 	if (hw->rx_pool_size > 6)
612282361a0SGreg Kroah-Hartman 		kfree(packet);
613282361a0SGreg Kroah-Hartman 	else {
614282361a0SGreg Kroah-Hartman 		hw->rx_pool_size++;
615282361a0SGreg Kroah-Hartman 		list_add(&packet->queue, &hw->rx_pool);
616282361a0SGreg Kroah-Hartman 	}
617282361a0SGreg Kroah-Hartman }
618282361a0SGreg Kroah-Hartman 
queue_received_packet(struct ipw_hardware * hw,unsigned int protocol,unsigned int address,const unsigned char * data,int length,int is_last)619282361a0SGreg Kroah-Hartman static void queue_received_packet(struct ipw_hardware *hw,
620282361a0SGreg Kroah-Hartman 				  unsigned int protocol,
621282361a0SGreg Kroah-Hartman 				  unsigned int address,
622282361a0SGreg Kroah-Hartman 				  const unsigned char *data, int length,
623282361a0SGreg Kroah-Hartman 				  int is_last)
624282361a0SGreg Kroah-Hartman {
625282361a0SGreg Kroah-Hartman 	unsigned int channel_idx = address - 1;
626282361a0SGreg Kroah-Hartman 	struct ipw_rx_packet *packet = NULL;
627282361a0SGreg Kroah-Hartman 	unsigned long flags;
628282361a0SGreg Kroah-Hartman 
629282361a0SGreg Kroah-Hartman 	/* Discard packet if channel index is out of range. */
630282361a0SGreg Kroah-Hartman 	if (channel_idx >= NL_NUM_OF_ADDRESSES) {
631282361a0SGreg Kroah-Hartman 		printk(KERN_INFO IPWIRELESS_PCCARD_NAME
632282361a0SGreg Kroah-Hartman 		       ": data packet has bad address %u\n", address);
633282361a0SGreg Kroah-Hartman 		return;
634282361a0SGreg Kroah-Hartman 	}
635282361a0SGreg Kroah-Hartman 
636282361a0SGreg Kroah-Hartman 	/*
637282361a0SGreg Kroah-Hartman 	 * ->packet_assembler is safe to touch unlocked, this is the only place
638282361a0SGreg Kroah-Hartman 	 */
639282361a0SGreg Kroah-Hartman 	if (protocol == TL_PROTOCOLID_COM_DATA) {
640282361a0SGreg Kroah-Hartman 		struct ipw_rx_packet **assem =
641282361a0SGreg Kroah-Hartman 			&hw->packet_assembler[channel_idx];
642282361a0SGreg Kroah-Hartman 
643282361a0SGreg Kroah-Hartman 		/*
644282361a0SGreg Kroah-Hartman 		 * Create a new packet, or assembler already contains one
645282361a0SGreg Kroah-Hartman 		 * enlarge it by 'length' bytes.
646282361a0SGreg Kroah-Hartman 		 */
647282361a0SGreg Kroah-Hartman 		(*assem) = pool_allocate(hw, *assem, length);
648282361a0SGreg Kroah-Hartman 		if (!(*assem)) {
649282361a0SGreg Kroah-Hartman 			printk(KERN_ERR IPWIRELESS_PCCARD_NAME
650d82603c6SJorrit Schippers 				": no memory for incoming data packet, dropped!\n");
651282361a0SGreg Kroah-Hartman 			return;
652282361a0SGreg Kroah-Hartman 		}
653282361a0SGreg Kroah-Hartman 		(*assem)->protocol = protocol;
654282361a0SGreg Kroah-Hartman 		(*assem)->channel_idx = channel_idx;
655282361a0SGreg Kroah-Hartman 
656282361a0SGreg Kroah-Hartman 		/* Append this packet data onto existing data. */
657282361a0SGreg Kroah-Hartman 		memcpy((unsigned char *)(*assem) +
658282361a0SGreg Kroah-Hartman 			       sizeof(struct ipw_rx_packet)
659282361a0SGreg Kroah-Hartman 				+ (*assem)->length, data, length);
660282361a0SGreg Kroah-Hartman 		(*assem)->length += length;
661282361a0SGreg Kroah-Hartman 		if (is_last) {
662282361a0SGreg Kroah-Hartman 			packet = *assem;
663282361a0SGreg Kroah-Hartman 			*assem = NULL;
664282361a0SGreg Kroah-Hartman 			/* Count queued DATA bytes only */
665282361a0SGreg Kroah-Hartman 			spin_lock_irqsave(&hw->lock, flags);
666282361a0SGreg Kroah-Hartman 			hw->rx_bytes_queued += packet->length;
667282361a0SGreg Kroah-Hartman 			spin_unlock_irqrestore(&hw->lock, flags);
668282361a0SGreg Kroah-Hartman 		}
669282361a0SGreg Kroah-Hartman 	} else {
670282361a0SGreg Kroah-Hartman 		/* If it's a CTRL packet, don't assemble, just queue it. */
671282361a0SGreg Kroah-Hartman 		packet = pool_allocate(hw, NULL, length);
672282361a0SGreg Kroah-Hartman 		if (!packet) {
673282361a0SGreg Kroah-Hartman 			printk(KERN_ERR IPWIRELESS_PCCARD_NAME
674d82603c6SJorrit Schippers 				": no memory for incoming ctrl packet, dropped!\n");
675282361a0SGreg Kroah-Hartman 			return;
676282361a0SGreg Kroah-Hartman 		}
677282361a0SGreg Kroah-Hartman 		packet->protocol = protocol;
678282361a0SGreg Kroah-Hartman 		packet->channel_idx = channel_idx;
679282361a0SGreg Kroah-Hartman 		memcpy((unsigned char *)packet + sizeof(struct ipw_rx_packet),
680282361a0SGreg Kroah-Hartman 				data, length);
681282361a0SGreg Kroah-Hartman 		packet->length = length;
682282361a0SGreg Kroah-Hartman 	}
683282361a0SGreg Kroah-Hartman 
684282361a0SGreg Kroah-Hartman 	/*
685282361a0SGreg Kroah-Hartman 	 * If this is the last packet, then send the assembled packet on to the
686282361a0SGreg Kroah-Hartman 	 * network layer.
687282361a0SGreg Kroah-Hartman 	 */
688282361a0SGreg Kroah-Hartman 	if (packet) {
689282361a0SGreg Kroah-Hartman 		spin_lock_irqsave(&hw->lock, flags);
690282361a0SGreg Kroah-Hartman 		list_add_tail(&packet->queue, &hw->rx_queue);
691282361a0SGreg Kroah-Hartman 		/* Block reception of incoming packets if queue is full. */
692282361a0SGreg Kroah-Hartman 		hw->blocking_rx =
693282361a0SGreg Kroah-Hartman 			(hw->rx_bytes_queued >= IPWIRELESS_RX_QUEUE_SIZE);
694282361a0SGreg Kroah-Hartman 
695282361a0SGreg Kroah-Hartman 		spin_unlock_irqrestore(&hw->lock, flags);
696282361a0SGreg Kroah-Hartman 		schedule_work(&hw->work_rx);
697282361a0SGreg Kroah-Hartman 	}
698282361a0SGreg Kroah-Hartman }
699282361a0SGreg Kroah-Hartman 
700282361a0SGreg Kroah-Hartman /*
701282361a0SGreg Kroah-Hartman  * Workqueue callback
702282361a0SGreg Kroah-Hartman  */
ipw_receive_data_work(struct work_struct * work_rx)703282361a0SGreg Kroah-Hartman static void ipw_receive_data_work(struct work_struct *work_rx)
704282361a0SGreg Kroah-Hartman {
705282361a0SGreg Kroah-Hartman 	struct ipw_hardware *hw =
706282361a0SGreg Kroah-Hartman 	    container_of(work_rx, struct ipw_hardware, work_rx);
707282361a0SGreg Kroah-Hartman 	unsigned long flags;
708282361a0SGreg Kroah-Hartman 
709282361a0SGreg Kroah-Hartman 	spin_lock_irqsave(&hw->lock, flags);
710282361a0SGreg Kroah-Hartman 	while (!list_empty(&hw->rx_queue)) {
711282361a0SGreg Kroah-Hartman 		struct ipw_rx_packet *packet =
712282361a0SGreg Kroah-Hartman 			list_first_entry(&hw->rx_queue,
713282361a0SGreg Kroah-Hartman 					struct ipw_rx_packet, queue);
714282361a0SGreg Kroah-Hartman 
715282361a0SGreg Kroah-Hartman 		if (hw->shutting_down)
716282361a0SGreg Kroah-Hartman 			break;
717282361a0SGreg Kroah-Hartman 		list_del(&packet->queue);
718282361a0SGreg Kroah-Hartman 
719282361a0SGreg Kroah-Hartman 		/*
720282361a0SGreg Kroah-Hartman 		 * Note: ipwireless_network_packet_received must be called in a
721282361a0SGreg Kroah-Hartman 		 * process context (i.e. via schedule_work) because the tty
722282361a0SGreg Kroah-Hartman 		 * output code can sleep in the tty_flip_buffer_push call.
723282361a0SGreg Kroah-Hartman 		 */
724282361a0SGreg Kroah-Hartman 		if (packet->protocol == TL_PROTOCOLID_COM_DATA) {
725282361a0SGreg Kroah-Hartman 			if (hw->network != NULL) {
726282361a0SGreg Kroah-Hartman 				/* If the network hasn't been disconnected. */
727282361a0SGreg Kroah-Hartman 				spin_unlock_irqrestore(&hw->lock, flags);
728282361a0SGreg Kroah-Hartman 				/*
729282361a0SGreg Kroah-Hartman 				 * This must run unlocked due to tty processing
730282361a0SGreg Kroah-Hartman 				 * and mutex locking
731282361a0SGreg Kroah-Hartman 				 */
732282361a0SGreg Kroah-Hartman 				ipwireless_network_packet_received(
733282361a0SGreg Kroah-Hartman 						hw->network,
734282361a0SGreg Kroah-Hartman 						packet->channel_idx,
735282361a0SGreg Kroah-Hartman 						(unsigned char *)packet
736282361a0SGreg Kroah-Hartman 						+ sizeof(struct ipw_rx_packet),
737282361a0SGreg Kroah-Hartman 						packet->length);
738282361a0SGreg Kroah-Hartman 				spin_lock_irqsave(&hw->lock, flags);
739282361a0SGreg Kroah-Hartman 			}
740282361a0SGreg Kroah-Hartman 			/* Count queued DATA bytes only */
741282361a0SGreg Kroah-Hartman 			hw->rx_bytes_queued -= packet->length;
742282361a0SGreg Kroah-Hartman 		} else {
743282361a0SGreg Kroah-Hartman 			/*
744282361a0SGreg Kroah-Hartman 			 * This is safe to be called locked, callchain does
745282361a0SGreg Kroah-Hartman 			 * not block
746282361a0SGreg Kroah-Hartman 			 */
747282361a0SGreg Kroah-Hartman 			handle_received_CTRL_packet(hw, packet->channel_idx,
748282361a0SGreg Kroah-Hartman 					(unsigned char *)packet
749282361a0SGreg Kroah-Hartman 					+ sizeof(struct ipw_rx_packet),
750282361a0SGreg Kroah-Hartman 					packet->length);
751282361a0SGreg Kroah-Hartman 		}
752282361a0SGreg Kroah-Hartman 		pool_free(hw, packet);
753282361a0SGreg Kroah-Hartman 		/*
754282361a0SGreg Kroah-Hartman 		 * Unblock reception of incoming packets if queue is no longer
755282361a0SGreg Kroah-Hartman 		 * full.
756282361a0SGreg Kroah-Hartman 		 */
757282361a0SGreg Kroah-Hartman 		hw->blocking_rx =
758282361a0SGreg Kroah-Hartman 			hw->rx_bytes_queued >= IPWIRELESS_RX_QUEUE_SIZE;
759282361a0SGreg Kroah-Hartman 		if (hw->shutting_down)
760282361a0SGreg Kroah-Hartman 			break;
761282361a0SGreg Kroah-Hartman 	}
762282361a0SGreg Kroah-Hartman 	spin_unlock_irqrestore(&hw->lock, flags);
763282361a0SGreg Kroah-Hartman }
764282361a0SGreg Kroah-Hartman 
handle_received_CTRL_packet(struct ipw_hardware * hw,unsigned int channel_idx,const unsigned char * data,int len)765282361a0SGreg Kroah-Hartman static void handle_received_CTRL_packet(struct ipw_hardware *hw,
766282361a0SGreg Kroah-Hartman 					unsigned int channel_idx,
767282361a0SGreg Kroah-Hartman 					const unsigned char *data, int len)
768282361a0SGreg Kroah-Hartman {
769282361a0SGreg Kroah-Hartman 	const struct ipw_control_packet_body *body =
770282361a0SGreg Kroah-Hartman 		(const struct ipw_control_packet_body *) data;
771282361a0SGreg Kroah-Hartman 	unsigned int changed_mask;
772282361a0SGreg Kroah-Hartman 
773282361a0SGreg Kroah-Hartman 	if (len != sizeof(struct ipw_control_packet_body)) {
774282361a0SGreg Kroah-Hartman 		printk(KERN_INFO IPWIRELESS_PCCARD_NAME
775282361a0SGreg Kroah-Hartman 		       ": control packet was %d bytes - wrong size!\n",
776282361a0SGreg Kroah-Hartman 		       len);
777282361a0SGreg Kroah-Hartman 		return;
778282361a0SGreg Kroah-Hartman 	}
779282361a0SGreg Kroah-Hartman 
780282361a0SGreg Kroah-Hartman 	switch (body->sig_no) {
781282361a0SGreg Kroah-Hartman 	case COMCTRL_CTS:
782282361a0SGreg Kroah-Hartman 		changed_mask = IPW_CONTROL_LINE_CTS;
783282361a0SGreg Kroah-Hartman 		break;
784282361a0SGreg Kroah-Hartman 	case COMCTRL_DCD:
785282361a0SGreg Kroah-Hartman 		changed_mask = IPW_CONTROL_LINE_DCD;
786282361a0SGreg Kroah-Hartman 		break;
787282361a0SGreg Kroah-Hartman 	case COMCTRL_DSR:
788282361a0SGreg Kroah-Hartman 		changed_mask = IPW_CONTROL_LINE_DSR;
789282361a0SGreg Kroah-Hartman 		break;
790282361a0SGreg Kroah-Hartman 	case COMCTRL_RI:
791282361a0SGreg Kroah-Hartman 		changed_mask = IPW_CONTROL_LINE_RI;
792282361a0SGreg Kroah-Hartman 		break;
793282361a0SGreg Kroah-Hartman 	default:
794282361a0SGreg Kroah-Hartman 		changed_mask = 0;
795282361a0SGreg Kroah-Hartman 	}
796282361a0SGreg Kroah-Hartman 
797282361a0SGreg Kroah-Hartman 	if (changed_mask != 0) {
798282361a0SGreg Kroah-Hartman 		if (body->value)
799282361a0SGreg Kroah-Hartman 			hw->control_lines[channel_idx] |= changed_mask;
800282361a0SGreg Kroah-Hartman 		else
801282361a0SGreg Kroah-Hartman 			hw->control_lines[channel_idx] &= ~changed_mask;
802282361a0SGreg Kroah-Hartman 		if (hw->network)
803282361a0SGreg Kroah-Hartman 			ipwireless_network_notify_control_line_change(
804282361a0SGreg Kroah-Hartman 					hw->network,
805282361a0SGreg Kroah-Hartman 					channel_idx,
806282361a0SGreg Kroah-Hartman 					hw->control_lines[channel_idx],
807282361a0SGreg Kroah-Hartman 					changed_mask);
808282361a0SGreg Kroah-Hartman 	}
809282361a0SGreg Kroah-Hartman }
810282361a0SGreg Kroah-Hartman 
handle_received_packet(struct ipw_hardware * hw,const union nl_packet * packet,unsigned short len)811282361a0SGreg Kroah-Hartman static void handle_received_packet(struct ipw_hardware *hw,
812282361a0SGreg Kroah-Hartman 				   const union nl_packet *packet,
813282361a0SGreg Kroah-Hartman 				   unsigned short len)
814282361a0SGreg Kroah-Hartman {
815282361a0SGreg Kroah-Hartman 	unsigned int protocol = packet->hdr.protocol;
816282361a0SGreg Kroah-Hartman 	unsigned int address = packet->hdr.address;
817282361a0SGreg Kroah-Hartman 	unsigned int header_length;
818282361a0SGreg Kroah-Hartman 	const unsigned char *data;
819282361a0SGreg Kroah-Hartman 	unsigned int data_len;
820282361a0SGreg Kroah-Hartman 	int is_last = packet->hdr.packet_rank & NL_LAST_PACKET;
821282361a0SGreg Kroah-Hartman 
822282361a0SGreg Kroah-Hartman 	if (packet->hdr.packet_rank & NL_FIRST_PACKET)
823282361a0SGreg Kroah-Hartman 		header_length = NL_FIRST_PACKET_HEADER_SIZE;
824282361a0SGreg Kroah-Hartman 	else
825282361a0SGreg Kroah-Hartman 		header_length = NL_FOLLOWING_PACKET_HEADER_SIZE;
826282361a0SGreg Kroah-Hartman 
827282361a0SGreg Kroah-Hartman 	data = packet->rawpkt + header_length;
828282361a0SGreg Kroah-Hartman 	data_len = len - header_length;
829282361a0SGreg Kroah-Hartman 	switch (protocol) {
830282361a0SGreg Kroah-Hartman 	case TL_PROTOCOLID_COM_DATA:
831282361a0SGreg Kroah-Hartman 	case TL_PROTOCOLID_COM_CTRL:
832282361a0SGreg Kroah-Hartman 		queue_received_packet(hw, protocol, address, data, data_len,
833282361a0SGreg Kroah-Hartman 				is_last);
834282361a0SGreg Kroah-Hartman 		break;
835282361a0SGreg Kroah-Hartman 	case TL_PROTOCOLID_SETUP:
836282361a0SGreg Kroah-Hartman 		handle_received_SETUP_packet(hw, address, data, data_len,
837282361a0SGreg Kroah-Hartman 				is_last);
838282361a0SGreg Kroah-Hartman 		break;
839282361a0SGreg Kroah-Hartman 	}
840282361a0SGreg Kroah-Hartman }
841282361a0SGreg Kroah-Hartman 
acknowledge_data_read(struct ipw_hardware * hw)842282361a0SGreg Kroah-Hartman static void acknowledge_data_read(struct ipw_hardware *hw)
843282361a0SGreg Kroah-Hartman {
844282361a0SGreg Kroah-Hartman 	if (hw->hw_version == HW_VERSION_1)
845282361a0SGreg Kroah-Hartman 		outw(DCR_RXDONE, hw->base_port + IODCR);
846282361a0SGreg Kroah-Hartman 	else
847282361a0SGreg Kroah-Hartman 		writew(MEMRX_PCINTACKK,
848282361a0SGreg Kroah-Hartman 				&hw->memory_info_regs->memreg_pc_interrupt_ack);
849282361a0SGreg Kroah-Hartman }
850282361a0SGreg Kroah-Hartman 
851282361a0SGreg Kroah-Hartman /*
852282361a0SGreg Kroah-Hartman  * Retrieve a packet from the IPW hardware.
853282361a0SGreg Kroah-Hartman  */
do_receive_packet(struct ipw_hardware * hw)854282361a0SGreg Kroah-Hartman static void do_receive_packet(struct ipw_hardware *hw)
855282361a0SGreg Kroah-Hartman {
856282361a0SGreg Kroah-Hartman 	unsigned len;
857282361a0SGreg Kroah-Hartman 	unsigned i;
858282361a0SGreg Kroah-Hartman 	unsigned char pkt[LL_MTU_MAX];
859282361a0SGreg Kroah-Hartman 
860282361a0SGreg Kroah-Hartman 	start_timing();
861282361a0SGreg Kroah-Hartman 
862282361a0SGreg Kroah-Hartman 	if (hw->hw_version == HW_VERSION_1) {
863282361a0SGreg Kroah-Hartman 		len = inw(hw->base_port + IODRR);
864282361a0SGreg Kroah-Hartman 		if (len > hw->ll_mtu) {
865282361a0SGreg Kroah-Hartman 			printk(KERN_INFO IPWIRELESS_PCCARD_NAME
866282361a0SGreg Kroah-Hartman 			       ": received a packet of %u bytes - longer than the MTU!\n", len);
867282361a0SGreg Kroah-Hartman 			outw(DCR_RXDONE | DCR_RXRESET, hw->base_port + IODCR);
868282361a0SGreg Kroah-Hartman 			return;
869282361a0SGreg Kroah-Hartman 		}
870282361a0SGreg Kroah-Hartman 
871282361a0SGreg Kroah-Hartman 		for (i = 0; i < len; i += 2) {
872282361a0SGreg Kroah-Hartman 			__le16 raw_data = inw(hw->base_port + IODRR);
873282361a0SGreg Kroah-Hartman 			unsigned short data = le16_to_cpu(raw_data);
874282361a0SGreg Kroah-Hartman 
875282361a0SGreg Kroah-Hartman 			pkt[i] = (unsigned char) data;
876282361a0SGreg Kroah-Hartman 			pkt[i + 1] = (unsigned char) (data >> 8);
877282361a0SGreg Kroah-Hartman 		}
878282361a0SGreg Kroah-Hartman 	} else {
879282361a0SGreg Kroah-Hartman 		len = inw(hw->base_port);
880282361a0SGreg Kroah-Hartman 		if (len > hw->ll_mtu) {
881282361a0SGreg Kroah-Hartman 			printk(KERN_INFO IPWIRELESS_PCCARD_NAME
882282361a0SGreg Kroah-Hartman 			       ": received a packet of %u bytes - longer than the MTU!\n", len);
883282361a0SGreg Kroah-Hartman 			writew(MEMRX_PCINTACKK,
884282361a0SGreg Kroah-Hartman 				&hw->memory_info_regs->memreg_pc_interrupt_ack);
885282361a0SGreg Kroah-Hartman 			return;
886282361a0SGreg Kroah-Hartman 		}
887282361a0SGreg Kroah-Hartman 
888282361a0SGreg Kroah-Hartman 		for (i = 0; i < len; i += 2) {
889282361a0SGreg Kroah-Hartman 			__le16 raw_data = inw(hw->base_port);
890282361a0SGreg Kroah-Hartman 			unsigned short data = le16_to_cpu(raw_data);
891282361a0SGreg Kroah-Hartman 
892282361a0SGreg Kroah-Hartman 			pkt[i] = (unsigned char) data;
893282361a0SGreg Kroah-Hartman 			pkt[i + 1] = (unsigned char) (data >> 8);
894282361a0SGreg Kroah-Hartman 		}
895282361a0SGreg Kroah-Hartman 
896282361a0SGreg Kroah-Hartman 		while ((i & 3) != 2) {
897282361a0SGreg Kroah-Hartman 			inw(hw->base_port);
898282361a0SGreg Kroah-Hartman 			i += 2;
899282361a0SGreg Kroah-Hartman 		}
900282361a0SGreg Kroah-Hartman 	}
901282361a0SGreg Kroah-Hartman 
902282361a0SGreg Kroah-Hartman 	acknowledge_data_read(hw);
903282361a0SGreg Kroah-Hartman 
904282361a0SGreg Kroah-Hartman 	swap_packet_bitfield_from_le(pkt);
905282361a0SGreg Kroah-Hartman 
906282361a0SGreg Kroah-Hartman 	if (ipwireless_debug)
907282361a0SGreg Kroah-Hartman 		dump_data_bytes("recv", pkt, len);
908282361a0SGreg Kroah-Hartman 
909282361a0SGreg Kroah-Hartman 	handle_received_packet(hw, (union nl_packet *) pkt, len);
910282361a0SGreg Kroah-Hartman 
911282361a0SGreg Kroah-Hartman 	end_read_timing(len);
912282361a0SGreg Kroah-Hartman }
913282361a0SGreg Kroah-Hartman 
get_current_packet_priority(struct ipw_hardware * hw)914282361a0SGreg Kroah-Hartman static int get_current_packet_priority(struct ipw_hardware *hw)
915282361a0SGreg Kroah-Hartman {
916282361a0SGreg Kroah-Hartman 	/*
917282361a0SGreg Kroah-Hartman 	 * If we're initializing, don't send anything of higher priority than
918282361a0SGreg Kroah-Hartman 	 * PRIO_SETUP.  The network layer therefore need not care about
919282361a0SGreg Kroah-Hartman 	 * hardware initialization - any of its stuff will simply be queued
920282361a0SGreg Kroah-Hartman 	 * until setup is complete.
921282361a0SGreg Kroah-Hartman 	 */
922282361a0SGreg Kroah-Hartman 	return (hw->to_setup || hw->initializing
923282361a0SGreg Kroah-Hartman 			? PRIO_SETUP + 1 : NL_NUM_OF_PRIORITIES);
924282361a0SGreg Kroah-Hartman }
925282361a0SGreg Kroah-Hartman 
926282361a0SGreg Kroah-Hartman /*
927282361a0SGreg Kroah-Hartman  * return 1 if something has been received from hw
928282361a0SGreg Kroah-Hartman  */
get_packets_from_hw(struct ipw_hardware * hw)929282361a0SGreg Kroah-Hartman static int get_packets_from_hw(struct ipw_hardware *hw)
930282361a0SGreg Kroah-Hartman {
931282361a0SGreg Kroah-Hartman 	int received = 0;
932282361a0SGreg Kroah-Hartman 	unsigned long flags;
933282361a0SGreg Kroah-Hartman 
934282361a0SGreg Kroah-Hartman 	spin_lock_irqsave(&hw->lock, flags);
935282361a0SGreg Kroah-Hartman 	while (hw->rx_ready && !hw->blocking_rx) {
936282361a0SGreg Kroah-Hartman 		received = 1;
937282361a0SGreg Kroah-Hartman 		hw->rx_ready--;
938282361a0SGreg Kroah-Hartman 		spin_unlock_irqrestore(&hw->lock, flags);
939282361a0SGreg Kroah-Hartman 
940282361a0SGreg Kroah-Hartman 		do_receive_packet(hw);
941282361a0SGreg Kroah-Hartman 
942282361a0SGreg Kroah-Hartman 		spin_lock_irqsave(&hw->lock, flags);
943282361a0SGreg Kroah-Hartman 	}
944282361a0SGreg Kroah-Hartman 	spin_unlock_irqrestore(&hw->lock, flags);
945282361a0SGreg Kroah-Hartman 
946282361a0SGreg Kroah-Hartman 	return received;
947282361a0SGreg Kroah-Hartman }
948282361a0SGreg Kroah-Hartman 
949282361a0SGreg Kroah-Hartman /*
950282361a0SGreg Kroah-Hartman  * Send pending packet up to given priority, prioritize SETUP data until
951282361a0SGreg Kroah-Hartman  * hardware is fully setup.
952282361a0SGreg Kroah-Hartman  *
953282361a0SGreg Kroah-Hartman  * return 1 if more packets can be sent
954282361a0SGreg Kroah-Hartman  */
send_pending_packet(struct ipw_hardware * hw,int priority_limit)955282361a0SGreg Kroah-Hartman static int send_pending_packet(struct ipw_hardware *hw, int priority_limit)
956282361a0SGreg Kroah-Hartman {
957282361a0SGreg Kroah-Hartman 	int more_to_send = 0;
958282361a0SGreg Kroah-Hartman 	unsigned long flags;
959282361a0SGreg Kroah-Hartman 
960282361a0SGreg Kroah-Hartman 	spin_lock_irqsave(&hw->lock, flags);
961282361a0SGreg Kroah-Hartman 	if (hw->tx_queued && hw->tx_ready) {
962282361a0SGreg Kroah-Hartman 		int priority;
963282361a0SGreg Kroah-Hartman 		struct ipw_tx_packet *packet = NULL;
964282361a0SGreg Kroah-Hartman 
965282361a0SGreg Kroah-Hartman 		/* Pick a packet */
966282361a0SGreg Kroah-Hartman 		for (priority = 0; priority < priority_limit; priority++) {
967282361a0SGreg Kroah-Hartman 			if (!list_empty(&hw->tx_queue[priority])) {
968282361a0SGreg Kroah-Hartman 				packet = list_first_entry(
969282361a0SGreg Kroah-Hartman 						&hw->tx_queue[priority],
970282361a0SGreg Kroah-Hartman 						struct ipw_tx_packet,
971282361a0SGreg Kroah-Hartman 						queue);
972282361a0SGreg Kroah-Hartman 
973282361a0SGreg Kroah-Hartman 				hw->tx_queued--;
974282361a0SGreg Kroah-Hartman 				list_del(&packet->queue);
975282361a0SGreg Kroah-Hartman 
976282361a0SGreg Kroah-Hartman 				break;
977282361a0SGreg Kroah-Hartman 			}
978282361a0SGreg Kroah-Hartman 		}
979282361a0SGreg Kroah-Hartman 		if (!packet) {
980282361a0SGreg Kroah-Hartman 			hw->tx_queued = 0;
981282361a0SGreg Kroah-Hartman 			spin_unlock_irqrestore(&hw->lock, flags);
982282361a0SGreg Kroah-Hartman 			return 0;
983282361a0SGreg Kroah-Hartman 		}
984282361a0SGreg Kroah-Hartman 
985282361a0SGreg Kroah-Hartman 		spin_unlock_irqrestore(&hw->lock, flags);
986282361a0SGreg Kroah-Hartman 
987282361a0SGreg Kroah-Hartman 		/* Send */
988282361a0SGreg Kroah-Hartman 		do_send_packet(hw, packet);
989282361a0SGreg Kroah-Hartman 
990282361a0SGreg Kroah-Hartman 		/* Check if more to send */
991282361a0SGreg Kroah-Hartman 		spin_lock_irqsave(&hw->lock, flags);
992282361a0SGreg Kroah-Hartman 		for (priority = 0; priority < priority_limit; priority++)
993282361a0SGreg Kroah-Hartman 			if (!list_empty(&hw->tx_queue[priority])) {
994282361a0SGreg Kroah-Hartman 				more_to_send = 1;
995282361a0SGreg Kroah-Hartman 				break;
996282361a0SGreg Kroah-Hartman 			}
997282361a0SGreg Kroah-Hartman 
998282361a0SGreg Kroah-Hartman 		if (!more_to_send)
999282361a0SGreg Kroah-Hartman 			hw->tx_queued = 0;
1000282361a0SGreg Kroah-Hartman 	}
1001282361a0SGreg Kroah-Hartman 	spin_unlock_irqrestore(&hw->lock, flags);
1002282361a0SGreg Kroah-Hartman 
1003282361a0SGreg Kroah-Hartman 	return more_to_send;
1004282361a0SGreg Kroah-Hartman }
1005282361a0SGreg Kroah-Hartman 
1006282361a0SGreg Kroah-Hartman /*
1007282361a0SGreg Kroah-Hartman  * Send and receive all queued packets.
1008282361a0SGreg Kroah-Hartman  */
ipwireless_do_tasklet(struct tasklet_struct * t)1009a42a9f6aSAllen Pais static void ipwireless_do_tasklet(struct tasklet_struct *t)
1010282361a0SGreg Kroah-Hartman {
1011a42a9f6aSAllen Pais 	struct ipw_hardware *hw = from_tasklet(hw, t, tasklet);
1012282361a0SGreg Kroah-Hartman 	unsigned long flags;
1013282361a0SGreg Kroah-Hartman 
1014282361a0SGreg Kroah-Hartman 	spin_lock_irqsave(&hw->lock, flags);
1015282361a0SGreg Kroah-Hartman 	if (hw->shutting_down) {
1016282361a0SGreg Kroah-Hartman 		spin_unlock_irqrestore(&hw->lock, flags);
1017282361a0SGreg Kroah-Hartman 		return;
1018282361a0SGreg Kroah-Hartman 	}
1019282361a0SGreg Kroah-Hartman 
1020282361a0SGreg Kroah-Hartman 	if (hw->to_setup == 1) {
1021282361a0SGreg Kroah-Hartman 		/*
1022282361a0SGreg Kroah-Hartman 		 * Initial setup data sent to hardware
1023282361a0SGreg Kroah-Hartman 		 */
1024282361a0SGreg Kroah-Hartman 		hw->to_setup = 2;
1025282361a0SGreg Kroah-Hartman 		spin_unlock_irqrestore(&hw->lock, flags);
1026282361a0SGreg Kroah-Hartman 
1027282361a0SGreg Kroah-Hartman 		ipw_setup_hardware(hw);
1028282361a0SGreg Kroah-Hartman 		ipw_send_setup_packet(hw);
1029282361a0SGreg Kroah-Hartman 
1030282361a0SGreg Kroah-Hartman 		send_pending_packet(hw, PRIO_SETUP + 1);
1031282361a0SGreg Kroah-Hartman 		get_packets_from_hw(hw);
1032282361a0SGreg Kroah-Hartman 	} else {
1033282361a0SGreg Kroah-Hartman 		int priority_limit = get_current_packet_priority(hw);
1034282361a0SGreg Kroah-Hartman 		int again;
1035282361a0SGreg Kroah-Hartman 
1036282361a0SGreg Kroah-Hartman 		spin_unlock_irqrestore(&hw->lock, flags);
1037282361a0SGreg Kroah-Hartman 
1038282361a0SGreg Kroah-Hartman 		do {
1039282361a0SGreg Kroah-Hartman 			again = send_pending_packet(hw, priority_limit);
1040282361a0SGreg Kroah-Hartman 			again |= get_packets_from_hw(hw);
1041282361a0SGreg Kroah-Hartman 		} while (again);
1042282361a0SGreg Kroah-Hartman 	}
1043282361a0SGreg Kroah-Hartman }
1044282361a0SGreg Kroah-Hartman 
1045282361a0SGreg Kroah-Hartman /*
1046282361a0SGreg Kroah-Hartman  * return true if the card is physically present.
1047282361a0SGreg Kroah-Hartman  */
is_card_present(struct ipw_hardware * hw)1048282361a0SGreg Kroah-Hartman static int is_card_present(struct ipw_hardware *hw)
1049282361a0SGreg Kroah-Hartman {
1050282361a0SGreg Kroah-Hartman 	if (hw->hw_version == HW_VERSION_1)
1051282361a0SGreg Kroah-Hartman 		return inw(hw->base_port + IOIR) != 0xFFFF;
1052282361a0SGreg Kroah-Hartman 	else
1053282361a0SGreg Kroah-Hartman 		return readl(&hw->memory_info_regs->memreg_card_present) ==
1054282361a0SGreg Kroah-Hartman 		    CARD_PRESENT_VALUE;
1055282361a0SGreg Kroah-Hartman }
1056282361a0SGreg Kroah-Hartman 
ipwireless_handle_v1_interrupt(int irq,struct ipw_hardware * hw)1057282361a0SGreg Kroah-Hartman static irqreturn_t ipwireless_handle_v1_interrupt(int irq,
1058282361a0SGreg Kroah-Hartman 						  struct ipw_hardware *hw)
1059282361a0SGreg Kroah-Hartman {
1060282361a0SGreg Kroah-Hartman 	unsigned short irqn;
1061282361a0SGreg Kroah-Hartman 
1062282361a0SGreg Kroah-Hartman 	irqn = inw(hw->base_port + IOIR);
1063282361a0SGreg Kroah-Hartman 
1064282361a0SGreg Kroah-Hartman 	/* Check if card is present */
1065282361a0SGreg Kroah-Hartman 	if (irqn == 0xFFFF)
1066282361a0SGreg Kroah-Hartman 		return IRQ_NONE;
1067282361a0SGreg Kroah-Hartman 	else if (irqn != 0) {
1068282361a0SGreg Kroah-Hartman 		unsigned short ack = 0;
1069282361a0SGreg Kroah-Hartman 		unsigned long flags;
1070282361a0SGreg Kroah-Hartman 
1071282361a0SGreg Kroah-Hartman 		/* Transmit complete. */
1072282361a0SGreg Kroah-Hartman 		if (irqn & IR_TXINTR) {
1073282361a0SGreg Kroah-Hartman 			ack |= IR_TXINTR;
1074282361a0SGreg Kroah-Hartman 			spin_lock_irqsave(&hw->lock, flags);
1075282361a0SGreg Kroah-Hartman 			hw->tx_ready = 1;
1076282361a0SGreg Kroah-Hartman 			spin_unlock_irqrestore(&hw->lock, flags);
1077282361a0SGreg Kroah-Hartman 		}
1078282361a0SGreg Kroah-Hartman 		/* Received data */
1079282361a0SGreg Kroah-Hartman 		if (irqn & IR_RXINTR) {
1080282361a0SGreg Kroah-Hartman 			ack |= IR_RXINTR;
1081282361a0SGreg Kroah-Hartman 			spin_lock_irqsave(&hw->lock, flags);
1082282361a0SGreg Kroah-Hartman 			hw->rx_ready++;
1083282361a0SGreg Kroah-Hartman 			spin_unlock_irqrestore(&hw->lock, flags);
1084282361a0SGreg Kroah-Hartman 		}
1085282361a0SGreg Kroah-Hartman 		if (ack != 0) {
1086282361a0SGreg Kroah-Hartman 			outw(ack, hw->base_port + IOIR);
1087282361a0SGreg Kroah-Hartman 			tasklet_schedule(&hw->tasklet);
1088282361a0SGreg Kroah-Hartman 		}
1089282361a0SGreg Kroah-Hartman 		return IRQ_HANDLED;
1090282361a0SGreg Kroah-Hartman 	}
1091282361a0SGreg Kroah-Hartman 	return IRQ_NONE;
1092282361a0SGreg Kroah-Hartman }
1093282361a0SGreg Kroah-Hartman 
acknowledge_pcmcia_interrupt(struct ipw_hardware * hw)1094282361a0SGreg Kroah-Hartman static void acknowledge_pcmcia_interrupt(struct ipw_hardware *hw)
1095282361a0SGreg Kroah-Hartman {
1096282361a0SGreg Kroah-Hartman 	unsigned short csr = readw(&hw->memregs_CCR->reg_config_and_status);
1097282361a0SGreg Kroah-Hartman 
1098282361a0SGreg Kroah-Hartman 	csr &= 0xfffd;
1099282361a0SGreg Kroah-Hartman 	writew(csr, &hw->memregs_CCR->reg_config_and_status);
1100282361a0SGreg Kroah-Hartman }
1101282361a0SGreg Kroah-Hartman 
ipwireless_handle_v2_v3_interrupt(int irq,struct ipw_hardware * hw)1102282361a0SGreg Kroah-Hartman static irqreturn_t ipwireless_handle_v2_v3_interrupt(int irq,
1103282361a0SGreg Kroah-Hartman 						     struct ipw_hardware *hw)
1104282361a0SGreg Kroah-Hartman {
1105282361a0SGreg Kroah-Hartman 	int tx = 0;
1106282361a0SGreg Kroah-Hartman 	int rx = 0;
1107282361a0SGreg Kroah-Hartman 	int rx_repeat = 0;
1108282361a0SGreg Kroah-Hartman 	int try_mem_tx_old;
1109282361a0SGreg Kroah-Hartman 	unsigned long flags;
1110282361a0SGreg Kroah-Hartman 
1111282361a0SGreg Kroah-Hartman 	do {
1112282361a0SGreg Kroah-Hartman 
1113282361a0SGreg Kroah-Hartman 	unsigned short memtx = readw(hw->memreg_tx);
1114282361a0SGreg Kroah-Hartman 	unsigned short memtx_serial;
1115282361a0SGreg Kroah-Hartman 	unsigned short memrxdone =
1116282361a0SGreg Kroah-Hartman 		readw(&hw->memory_info_regs->memreg_rx_done);
1117282361a0SGreg Kroah-Hartman 
1118282361a0SGreg Kroah-Hartman 	try_mem_tx_old = 0;
1119282361a0SGreg Kroah-Hartman 
1120282361a0SGreg Kroah-Hartman 	/* check whether the interrupt was generated by ipwireless card */
1121282361a0SGreg Kroah-Hartman 	if (!(memtx & MEMTX_TX) && !(memrxdone & MEMRX_RX_DONE)) {
1122282361a0SGreg Kroah-Hartman 
1123282361a0SGreg Kroah-Hartman 		/* check if the card uses memreg_tx_old register */
1124282361a0SGreg Kroah-Hartman 		if (hw->memreg_tx == &hw->memory_info_regs->memreg_tx_new) {
1125282361a0SGreg Kroah-Hartman 			memtx = readw(&hw->memory_info_regs->memreg_tx_old);
1126282361a0SGreg Kroah-Hartman 			if (memtx & MEMTX_TX) {
1127282361a0SGreg Kroah-Hartman 				printk(KERN_INFO IPWIRELESS_PCCARD_NAME
1128282361a0SGreg Kroah-Hartman 					": Using memreg_tx_old\n");
1129282361a0SGreg Kroah-Hartman 				hw->memreg_tx =
1130282361a0SGreg Kroah-Hartman 					&hw->memory_info_regs->memreg_tx_old;
1131282361a0SGreg Kroah-Hartman 			} else {
1132282361a0SGreg Kroah-Hartman 				return IRQ_NONE;
1133282361a0SGreg Kroah-Hartman 			}
1134282361a0SGreg Kroah-Hartman 		} else
1135282361a0SGreg Kroah-Hartman 			return IRQ_NONE;
1136282361a0SGreg Kroah-Hartman 	}
1137282361a0SGreg Kroah-Hartman 
1138282361a0SGreg Kroah-Hartman 	/*
1139282361a0SGreg Kroah-Hartman 	 * See if the card is physically present. Note that while it is
1140282361a0SGreg Kroah-Hartman 	 * powering up, it appears not to be present.
1141282361a0SGreg Kroah-Hartman 	 */
1142282361a0SGreg Kroah-Hartman 	if (!is_card_present(hw)) {
1143282361a0SGreg Kroah-Hartman 		acknowledge_pcmcia_interrupt(hw);
1144282361a0SGreg Kroah-Hartman 		return IRQ_HANDLED;
1145282361a0SGreg Kroah-Hartman 	}
1146282361a0SGreg Kroah-Hartman 
1147282361a0SGreg Kroah-Hartman 	memtx_serial = memtx & (unsigned short) 0xff00;
1148282361a0SGreg Kroah-Hartman 	if (memtx & MEMTX_TX) {
1149282361a0SGreg Kroah-Hartman 		writew(memtx_serial, hw->memreg_tx);
1150282361a0SGreg Kroah-Hartman 
1151282361a0SGreg Kroah-Hartman 		if (hw->serial_number_detected) {
1152282361a0SGreg Kroah-Hartman 			if (memtx_serial != hw->last_memtx_serial) {
1153282361a0SGreg Kroah-Hartman 				hw->last_memtx_serial = memtx_serial;
1154282361a0SGreg Kroah-Hartman 				spin_lock_irqsave(&hw->lock, flags);
1155282361a0SGreg Kroah-Hartman 				hw->rx_ready++;
1156282361a0SGreg Kroah-Hartman 				spin_unlock_irqrestore(&hw->lock, flags);
1157282361a0SGreg Kroah-Hartman 				rx = 1;
1158282361a0SGreg Kroah-Hartman 			} else
1159282361a0SGreg Kroah-Hartman 				/* Ignore 'Timer Recovery' duplicates. */
1160282361a0SGreg Kroah-Hartman 				rx_repeat = 1;
1161282361a0SGreg Kroah-Hartman 		} else {
1162282361a0SGreg Kroah-Hartman 			/*
1163282361a0SGreg Kroah-Hartman 			 * If a non-zero serial number is seen, then enable
1164282361a0SGreg Kroah-Hartman 			 * serial number checking.
1165282361a0SGreg Kroah-Hartman 			 */
1166282361a0SGreg Kroah-Hartman 			if (memtx_serial != 0) {
1167282361a0SGreg Kroah-Hartman 				hw->serial_number_detected = 1;
1168282361a0SGreg Kroah-Hartman 				printk(KERN_DEBUG IPWIRELESS_PCCARD_NAME
1169282361a0SGreg Kroah-Hartman 					": memreg_tx serial num detected\n");
1170282361a0SGreg Kroah-Hartman 
1171282361a0SGreg Kroah-Hartman 				spin_lock_irqsave(&hw->lock, flags);
1172282361a0SGreg Kroah-Hartman 				hw->rx_ready++;
1173282361a0SGreg Kroah-Hartman 				spin_unlock_irqrestore(&hw->lock, flags);
1174282361a0SGreg Kroah-Hartman 			}
1175282361a0SGreg Kroah-Hartman 			rx = 1;
1176282361a0SGreg Kroah-Hartman 		}
1177282361a0SGreg Kroah-Hartman 	}
1178282361a0SGreg Kroah-Hartman 	if (memrxdone & MEMRX_RX_DONE) {
1179282361a0SGreg Kroah-Hartman 		writew(0, &hw->memory_info_regs->memreg_rx_done);
1180282361a0SGreg Kroah-Hartman 		spin_lock_irqsave(&hw->lock, flags);
1181282361a0SGreg Kroah-Hartman 		hw->tx_ready = 1;
1182282361a0SGreg Kroah-Hartman 		spin_unlock_irqrestore(&hw->lock, flags);
1183282361a0SGreg Kroah-Hartman 		tx = 1;
1184282361a0SGreg Kroah-Hartman 	}
1185282361a0SGreg Kroah-Hartman 	if (tx)
1186282361a0SGreg Kroah-Hartman 		writew(MEMRX_PCINTACKK,
1187282361a0SGreg Kroah-Hartman 				&hw->memory_info_regs->memreg_pc_interrupt_ack);
1188282361a0SGreg Kroah-Hartman 
1189282361a0SGreg Kroah-Hartman 	acknowledge_pcmcia_interrupt(hw);
1190282361a0SGreg Kroah-Hartman 
1191282361a0SGreg Kroah-Hartman 	if (tx || rx)
1192282361a0SGreg Kroah-Hartman 		tasklet_schedule(&hw->tasklet);
1193282361a0SGreg Kroah-Hartman 	else if (!rx_repeat) {
1194282361a0SGreg Kroah-Hartman 		if (hw->memreg_tx == &hw->memory_info_regs->memreg_tx_new) {
1195282361a0SGreg Kroah-Hartman 			if (hw->serial_number_detected)
1196282361a0SGreg Kroah-Hartman 				printk(KERN_WARNING IPWIRELESS_PCCARD_NAME
1197282361a0SGreg Kroah-Hartman 					": spurious interrupt - new_tx mode\n");
1198282361a0SGreg Kroah-Hartman 			else {
1199282361a0SGreg Kroah-Hartman 				printk(KERN_WARNING IPWIRELESS_PCCARD_NAME
1200282361a0SGreg Kroah-Hartman 					": no valid memreg_tx value - switching to the old memreg_tx\n");
1201282361a0SGreg Kroah-Hartman 				hw->memreg_tx =
1202282361a0SGreg Kroah-Hartman 					&hw->memory_info_regs->memreg_tx_old;
1203282361a0SGreg Kroah-Hartman 				try_mem_tx_old = 1;
1204282361a0SGreg Kroah-Hartman 			}
1205282361a0SGreg Kroah-Hartman 		} else
1206282361a0SGreg Kroah-Hartman 			printk(KERN_WARNING IPWIRELESS_PCCARD_NAME
1207282361a0SGreg Kroah-Hartman 					": spurious interrupt - old_tx mode\n");
1208282361a0SGreg Kroah-Hartman 	}
1209282361a0SGreg Kroah-Hartman 
1210282361a0SGreg Kroah-Hartman 	} while (try_mem_tx_old == 1);
1211282361a0SGreg Kroah-Hartman 
1212282361a0SGreg Kroah-Hartman 	return IRQ_HANDLED;
1213282361a0SGreg Kroah-Hartman }
1214282361a0SGreg Kroah-Hartman 
ipwireless_interrupt(int irq,void * dev_id)1215282361a0SGreg Kroah-Hartman irqreturn_t ipwireless_interrupt(int irq, void *dev_id)
1216282361a0SGreg Kroah-Hartman {
1217282361a0SGreg Kroah-Hartman 	struct ipw_dev *ipw = dev_id;
1218282361a0SGreg Kroah-Hartman 
1219282361a0SGreg Kroah-Hartman 	if (ipw->hardware->hw_version == HW_VERSION_1)
1220282361a0SGreg Kroah-Hartman 		return ipwireless_handle_v1_interrupt(irq, ipw->hardware);
1221282361a0SGreg Kroah-Hartman 	else
1222282361a0SGreg Kroah-Hartman 		return ipwireless_handle_v2_v3_interrupt(irq, ipw->hardware);
1223282361a0SGreg Kroah-Hartman }
1224282361a0SGreg Kroah-Hartman 
flush_packets_to_hw(struct ipw_hardware * hw)1225282361a0SGreg Kroah-Hartman static void flush_packets_to_hw(struct ipw_hardware *hw)
1226282361a0SGreg Kroah-Hartman {
1227282361a0SGreg Kroah-Hartman 	int priority_limit;
1228282361a0SGreg Kroah-Hartman 	unsigned long flags;
1229282361a0SGreg Kroah-Hartman 
1230282361a0SGreg Kroah-Hartman 	spin_lock_irqsave(&hw->lock, flags);
1231282361a0SGreg Kroah-Hartman 	priority_limit = get_current_packet_priority(hw);
1232282361a0SGreg Kroah-Hartman 	spin_unlock_irqrestore(&hw->lock, flags);
1233282361a0SGreg Kroah-Hartman 
1234282361a0SGreg Kroah-Hartman 	while (send_pending_packet(hw, priority_limit));
1235282361a0SGreg Kroah-Hartman }
1236282361a0SGreg Kroah-Hartman 
send_packet(struct ipw_hardware * hw,int priority,struct ipw_tx_packet * packet)1237282361a0SGreg Kroah-Hartman static void send_packet(struct ipw_hardware *hw, int priority,
1238282361a0SGreg Kroah-Hartman 			struct ipw_tx_packet *packet)
1239282361a0SGreg Kroah-Hartman {
1240282361a0SGreg Kroah-Hartman 	unsigned long flags;
1241282361a0SGreg Kroah-Hartman 
1242282361a0SGreg Kroah-Hartman 	spin_lock_irqsave(&hw->lock, flags);
1243282361a0SGreg Kroah-Hartman 	list_add_tail(&packet->queue, &hw->tx_queue[priority]);
1244282361a0SGreg Kroah-Hartman 	hw->tx_queued++;
1245282361a0SGreg Kroah-Hartman 	spin_unlock_irqrestore(&hw->lock, flags);
1246282361a0SGreg Kroah-Hartman 
1247282361a0SGreg Kroah-Hartman 	flush_packets_to_hw(hw);
1248282361a0SGreg Kroah-Hartman }
1249282361a0SGreg Kroah-Hartman 
1250282361a0SGreg Kroah-Hartman /* Create data packet, non-atomic allocation */
alloc_data_packet(int data_size,unsigned char dest_addr,unsigned char protocol)1251282361a0SGreg Kroah-Hartman static void *alloc_data_packet(int data_size,
1252282361a0SGreg Kroah-Hartman 				unsigned char dest_addr,
1253282361a0SGreg Kroah-Hartman 				unsigned char protocol)
1254282361a0SGreg Kroah-Hartman {
1255282361a0SGreg Kroah-Hartman 	struct ipw_tx_packet *packet = kzalloc(
1256282361a0SGreg Kroah-Hartman 			sizeof(struct ipw_tx_packet) + data_size,
1257282361a0SGreg Kroah-Hartman 			GFP_ATOMIC);
1258282361a0SGreg Kroah-Hartman 
1259282361a0SGreg Kroah-Hartman 	if (!packet)
1260282361a0SGreg Kroah-Hartman 		return NULL;
1261282361a0SGreg Kroah-Hartman 
1262282361a0SGreg Kroah-Hartman 	INIT_LIST_HEAD(&packet->queue);
1263282361a0SGreg Kroah-Hartman 	packet->dest_addr = dest_addr;
1264282361a0SGreg Kroah-Hartman 	packet->protocol = protocol;
1265282361a0SGreg Kroah-Hartman 	packet->length = data_size;
1266282361a0SGreg Kroah-Hartman 
1267282361a0SGreg Kroah-Hartman 	return packet;
1268282361a0SGreg Kroah-Hartman }
1269282361a0SGreg Kroah-Hartman 
alloc_ctrl_packet(int header_size,unsigned char dest_addr,unsigned char protocol,unsigned char sig_no)1270282361a0SGreg Kroah-Hartman static void *alloc_ctrl_packet(int header_size,
1271282361a0SGreg Kroah-Hartman 			       unsigned char dest_addr,
1272282361a0SGreg Kroah-Hartman 			       unsigned char protocol,
1273282361a0SGreg Kroah-Hartman 			       unsigned char sig_no)
1274282361a0SGreg Kroah-Hartman {
1275282361a0SGreg Kroah-Hartman 	/*
1276282361a0SGreg Kroah-Hartman 	 * sig_no is located right after ipw_tx_packet struct in every
1277282361a0SGreg Kroah-Hartman 	 * CTRL or SETUP packets, we can use ipw_control_packet as a
1278282361a0SGreg Kroah-Hartman 	 * common struct
1279282361a0SGreg Kroah-Hartman 	 */
1280282361a0SGreg Kroah-Hartman 	struct ipw_control_packet *packet = kzalloc(header_size, GFP_ATOMIC);
1281282361a0SGreg Kroah-Hartman 
1282282361a0SGreg Kroah-Hartman 	if (!packet)
1283282361a0SGreg Kroah-Hartman 		return NULL;
1284282361a0SGreg Kroah-Hartman 
1285282361a0SGreg Kroah-Hartman 	INIT_LIST_HEAD(&packet->header.queue);
1286282361a0SGreg Kroah-Hartman 	packet->header.dest_addr = dest_addr;
1287282361a0SGreg Kroah-Hartman 	packet->header.protocol = protocol;
1288282361a0SGreg Kroah-Hartman 	packet->header.length = header_size - sizeof(struct ipw_tx_packet);
1289282361a0SGreg Kroah-Hartman 	packet->body.sig_no = sig_no;
1290282361a0SGreg Kroah-Hartman 
1291282361a0SGreg Kroah-Hartman 	return packet;
1292282361a0SGreg Kroah-Hartman }
1293282361a0SGreg Kroah-Hartman 
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)1294282361a0SGreg Kroah-Hartman int ipwireless_send_packet(struct ipw_hardware *hw, unsigned int channel_idx,
1295*69851e4aSJiri Slaby (SUSE) 			    const u8 *data, unsigned int length,
1296282361a0SGreg Kroah-Hartman 			    void (*callback) (void *cb, unsigned int length),
1297282361a0SGreg Kroah-Hartman 			    void *callback_data)
1298282361a0SGreg Kroah-Hartman {
1299282361a0SGreg Kroah-Hartman 	struct ipw_tx_packet *packet;
1300282361a0SGreg Kroah-Hartman 
1301282361a0SGreg Kroah-Hartman 	packet = alloc_data_packet(length, (channel_idx + 1),
1302282361a0SGreg Kroah-Hartman 			TL_PROTOCOLID_COM_DATA);
1303282361a0SGreg Kroah-Hartman 	if (!packet)
1304282361a0SGreg Kroah-Hartman 		return -ENOMEM;
1305282361a0SGreg Kroah-Hartman 	packet->packet_callback = callback;
1306282361a0SGreg Kroah-Hartman 	packet->callback_data = callback_data;
1307282361a0SGreg Kroah-Hartman 	memcpy((unsigned char *) packet + sizeof(struct ipw_tx_packet), data,
1308282361a0SGreg Kroah-Hartman 			length);
1309282361a0SGreg Kroah-Hartman 
1310282361a0SGreg Kroah-Hartman 	send_packet(hw, PRIO_DATA, packet);
1311282361a0SGreg Kroah-Hartman 	return 0;
1312282361a0SGreg Kroah-Hartman }
1313282361a0SGreg Kroah-Hartman 
set_control_line(struct ipw_hardware * hw,int prio,unsigned int channel_idx,int line,int state)1314282361a0SGreg Kroah-Hartman static int set_control_line(struct ipw_hardware *hw, int prio,
1315282361a0SGreg Kroah-Hartman 			   unsigned int channel_idx, int line, int state)
1316282361a0SGreg Kroah-Hartman {
1317282361a0SGreg Kroah-Hartman 	struct ipw_control_packet *packet;
1318282361a0SGreg Kroah-Hartman 	int protocolid = TL_PROTOCOLID_COM_CTRL;
1319282361a0SGreg Kroah-Hartman 
1320282361a0SGreg Kroah-Hartman 	if (prio == PRIO_SETUP)
1321282361a0SGreg Kroah-Hartman 		protocolid = TL_PROTOCOLID_SETUP;
1322282361a0SGreg Kroah-Hartman 
1323282361a0SGreg Kroah-Hartman 	packet = alloc_ctrl_packet(sizeof(struct ipw_control_packet),
1324282361a0SGreg Kroah-Hartman 			(channel_idx + 1), protocolid, line);
1325282361a0SGreg Kroah-Hartman 	if (!packet)
1326282361a0SGreg Kroah-Hartman 		return -ENOMEM;
1327282361a0SGreg Kroah-Hartman 	packet->header.length = sizeof(struct ipw_control_packet_body);
1328282361a0SGreg Kroah-Hartman 	packet->body.value = (state == 0 ? 0 : 1);
1329282361a0SGreg Kroah-Hartman 	send_packet(hw, prio, &packet->header);
1330282361a0SGreg Kroah-Hartman 	return 0;
1331282361a0SGreg Kroah-Hartman }
1332282361a0SGreg Kroah-Hartman 
1333282361a0SGreg Kroah-Hartman 
set_DTR(struct ipw_hardware * hw,int priority,unsigned int channel_idx,int state)1334282361a0SGreg Kroah-Hartman static int set_DTR(struct ipw_hardware *hw, int priority,
1335282361a0SGreg Kroah-Hartman 		   unsigned int channel_idx, int state)
1336282361a0SGreg Kroah-Hartman {
1337282361a0SGreg Kroah-Hartman 	if (state != 0)
1338282361a0SGreg Kroah-Hartman 		hw->control_lines[channel_idx] |= IPW_CONTROL_LINE_DTR;
1339282361a0SGreg Kroah-Hartman 	else
1340282361a0SGreg Kroah-Hartman 		hw->control_lines[channel_idx] &= ~IPW_CONTROL_LINE_DTR;
1341282361a0SGreg Kroah-Hartman 
1342282361a0SGreg Kroah-Hartman 	return set_control_line(hw, priority, channel_idx, COMCTRL_DTR, state);
1343282361a0SGreg Kroah-Hartman }
1344282361a0SGreg Kroah-Hartman 
set_RTS(struct ipw_hardware * hw,int priority,unsigned int channel_idx,int state)1345282361a0SGreg Kroah-Hartman static int set_RTS(struct ipw_hardware *hw, int priority,
1346282361a0SGreg Kroah-Hartman 		   unsigned int channel_idx, int state)
1347282361a0SGreg Kroah-Hartman {
1348282361a0SGreg Kroah-Hartman 	if (state != 0)
1349282361a0SGreg Kroah-Hartman 		hw->control_lines[channel_idx] |= IPW_CONTROL_LINE_RTS;
1350282361a0SGreg Kroah-Hartman 	else
1351282361a0SGreg Kroah-Hartman 		hw->control_lines[channel_idx] &= ~IPW_CONTROL_LINE_RTS;
1352282361a0SGreg Kroah-Hartman 
1353282361a0SGreg Kroah-Hartman 	return set_control_line(hw, priority, channel_idx, COMCTRL_RTS, state);
1354282361a0SGreg Kroah-Hartman }
1355282361a0SGreg Kroah-Hartman 
ipwireless_set_DTR(struct ipw_hardware * hw,unsigned int channel_idx,int state)1356282361a0SGreg Kroah-Hartman int ipwireless_set_DTR(struct ipw_hardware *hw, unsigned int channel_idx,
1357282361a0SGreg Kroah-Hartman 		       int state)
1358282361a0SGreg Kroah-Hartman {
1359282361a0SGreg Kroah-Hartman 	return set_DTR(hw, PRIO_CTRL, channel_idx, state);
1360282361a0SGreg Kroah-Hartman }
1361282361a0SGreg Kroah-Hartman 
ipwireless_set_RTS(struct ipw_hardware * hw,unsigned int channel_idx,int state)1362282361a0SGreg Kroah-Hartman int ipwireless_set_RTS(struct ipw_hardware *hw, unsigned int channel_idx,
1363282361a0SGreg Kroah-Hartman 		       int state)
1364282361a0SGreg Kroah-Hartman {
1365282361a0SGreg Kroah-Hartman 	return set_RTS(hw, PRIO_CTRL, channel_idx, state);
1366282361a0SGreg Kroah-Hartman }
1367282361a0SGreg Kroah-Hartman 
1368282361a0SGreg Kroah-Hartman struct ipw_setup_get_version_query_packet {
1369282361a0SGreg Kroah-Hartman 	struct ipw_tx_packet header;
1370282361a0SGreg Kroah-Hartman 	struct tl_setup_get_version_qry body;
1371282361a0SGreg Kroah-Hartman };
1372282361a0SGreg Kroah-Hartman 
1373282361a0SGreg Kroah-Hartman struct ipw_setup_config_packet {
1374282361a0SGreg Kroah-Hartman 	struct ipw_tx_packet header;
1375282361a0SGreg Kroah-Hartman 	struct tl_setup_config_msg body;
1376282361a0SGreg Kroah-Hartman };
1377282361a0SGreg Kroah-Hartman 
1378282361a0SGreg Kroah-Hartman struct ipw_setup_config_done_packet {
1379282361a0SGreg Kroah-Hartman 	struct ipw_tx_packet header;
1380282361a0SGreg Kroah-Hartman 	struct tl_setup_config_done_msg body;
1381282361a0SGreg Kroah-Hartman };
1382282361a0SGreg Kroah-Hartman 
1383282361a0SGreg Kroah-Hartman struct ipw_setup_open_packet {
1384282361a0SGreg Kroah-Hartman 	struct ipw_tx_packet header;
1385282361a0SGreg Kroah-Hartman 	struct tl_setup_open_msg body;
1386282361a0SGreg Kroah-Hartman };
1387282361a0SGreg Kroah-Hartman 
1388282361a0SGreg Kroah-Hartman struct ipw_setup_info_packet {
1389282361a0SGreg Kroah-Hartman 	struct ipw_tx_packet header;
1390282361a0SGreg Kroah-Hartman 	struct tl_setup_info_msg body;
1391282361a0SGreg Kroah-Hartman };
1392282361a0SGreg Kroah-Hartman 
1393282361a0SGreg Kroah-Hartman struct ipw_setup_reboot_msg_ack {
1394282361a0SGreg Kroah-Hartman 	struct ipw_tx_packet header;
1395282361a0SGreg Kroah-Hartman 	struct TlSetupRebootMsgAck body;
1396282361a0SGreg Kroah-Hartman };
1397282361a0SGreg Kroah-Hartman 
1398282361a0SGreg Kroah-Hartman /* This handles the actual initialization of the card */
__handle_setup_get_version_rsp(struct ipw_hardware * hw)1399282361a0SGreg Kroah-Hartman static void __handle_setup_get_version_rsp(struct ipw_hardware *hw)
1400282361a0SGreg Kroah-Hartman {
1401282361a0SGreg Kroah-Hartman 	struct ipw_setup_config_packet *config_packet;
1402282361a0SGreg Kroah-Hartman 	struct ipw_setup_config_done_packet *config_done_packet;
1403282361a0SGreg Kroah-Hartman 	struct ipw_setup_open_packet *open_packet;
1404282361a0SGreg Kroah-Hartman 	struct ipw_setup_info_packet *info_packet;
1405282361a0SGreg Kroah-Hartman 	int port;
1406282361a0SGreg Kroah-Hartman 	unsigned int channel_idx;
1407282361a0SGreg Kroah-Hartman 
1408282361a0SGreg Kroah-Hartman 	/* generate config packet */
1409282361a0SGreg Kroah-Hartman 	for (port = 1; port <= NL_NUM_OF_ADDRESSES; port++) {
1410282361a0SGreg Kroah-Hartman 		config_packet = alloc_ctrl_packet(
1411282361a0SGreg Kroah-Hartman 				sizeof(struct ipw_setup_config_packet),
1412282361a0SGreg Kroah-Hartman 				ADDR_SETUP_PROT,
1413282361a0SGreg Kroah-Hartman 				TL_PROTOCOLID_SETUP,
1414282361a0SGreg Kroah-Hartman 				TL_SETUP_SIGNO_CONFIG_MSG);
1415282361a0SGreg Kroah-Hartman 		if (!config_packet)
1416282361a0SGreg Kroah-Hartman 			goto exit_nomem;
1417282361a0SGreg Kroah-Hartman 		config_packet->header.length = sizeof(struct tl_setup_config_msg);
1418282361a0SGreg Kroah-Hartman 		config_packet->body.port_no = port;
1419282361a0SGreg Kroah-Hartman 		config_packet->body.prio_data = PRIO_DATA;
1420282361a0SGreg Kroah-Hartman 		config_packet->body.prio_ctrl = PRIO_CTRL;
1421282361a0SGreg Kroah-Hartman 		send_packet(hw, PRIO_SETUP, &config_packet->header);
1422282361a0SGreg Kroah-Hartman 	}
1423282361a0SGreg Kroah-Hartman 	config_done_packet = alloc_ctrl_packet(
1424282361a0SGreg Kroah-Hartman 			sizeof(struct ipw_setup_config_done_packet),
1425282361a0SGreg Kroah-Hartman 			ADDR_SETUP_PROT,
1426282361a0SGreg Kroah-Hartman 			TL_PROTOCOLID_SETUP,
1427282361a0SGreg Kroah-Hartman 			TL_SETUP_SIGNO_CONFIG_DONE_MSG);
1428282361a0SGreg Kroah-Hartman 	if (!config_done_packet)
1429282361a0SGreg Kroah-Hartman 		goto exit_nomem;
1430282361a0SGreg Kroah-Hartman 	config_done_packet->header.length = sizeof(struct tl_setup_config_done_msg);
1431282361a0SGreg Kroah-Hartman 	send_packet(hw, PRIO_SETUP, &config_done_packet->header);
1432282361a0SGreg Kroah-Hartman 
1433282361a0SGreg Kroah-Hartman 	/* generate open packet */
1434282361a0SGreg Kroah-Hartman 	for (port = 1; port <= NL_NUM_OF_ADDRESSES; port++) {
1435282361a0SGreg Kroah-Hartman 		open_packet = alloc_ctrl_packet(
1436282361a0SGreg Kroah-Hartman 				sizeof(struct ipw_setup_open_packet),
1437282361a0SGreg Kroah-Hartman 				ADDR_SETUP_PROT,
1438282361a0SGreg Kroah-Hartman 				TL_PROTOCOLID_SETUP,
1439282361a0SGreg Kroah-Hartman 				TL_SETUP_SIGNO_OPEN_MSG);
1440282361a0SGreg Kroah-Hartman 		if (!open_packet)
1441282361a0SGreg Kroah-Hartman 			goto exit_nomem;
1442282361a0SGreg Kroah-Hartman 		open_packet->header.length = sizeof(struct tl_setup_open_msg);
1443282361a0SGreg Kroah-Hartman 		open_packet->body.port_no = port;
1444282361a0SGreg Kroah-Hartman 		send_packet(hw, PRIO_SETUP, &open_packet->header);
1445282361a0SGreg Kroah-Hartman 	}
1446282361a0SGreg Kroah-Hartman 	for (channel_idx = 0;
1447282361a0SGreg Kroah-Hartman 			channel_idx < NL_NUM_OF_ADDRESSES; channel_idx++) {
1448282361a0SGreg Kroah-Hartman 		int ret;
1449282361a0SGreg Kroah-Hartman 
1450282361a0SGreg Kroah-Hartman 		ret = set_DTR(hw, PRIO_SETUP, channel_idx,
1451282361a0SGreg Kroah-Hartman 			(hw->control_lines[channel_idx] &
1452282361a0SGreg Kroah-Hartman 			 IPW_CONTROL_LINE_DTR) != 0);
1453282361a0SGreg Kroah-Hartman 		if (ret) {
1454282361a0SGreg Kroah-Hartman 			printk(KERN_ERR IPWIRELESS_PCCARD_NAME
1455282361a0SGreg Kroah-Hartman 					": error setting DTR (%d)\n", ret);
1456282361a0SGreg Kroah-Hartman 			return;
1457282361a0SGreg Kroah-Hartman 		}
1458282361a0SGreg Kroah-Hartman 
145952df3d5bSAlan 		ret = set_RTS(hw, PRIO_SETUP, channel_idx,
1460282361a0SGreg Kroah-Hartman 			(hw->control_lines [channel_idx] &
1461282361a0SGreg Kroah-Hartman 			 IPW_CONTROL_LINE_RTS) != 0);
1462282361a0SGreg Kroah-Hartman 		if (ret) {
1463282361a0SGreg Kroah-Hartman 			printk(KERN_ERR IPWIRELESS_PCCARD_NAME
1464282361a0SGreg Kroah-Hartman 					": error setting RTS (%d)\n", ret);
1465282361a0SGreg Kroah-Hartman 			return;
1466282361a0SGreg Kroah-Hartman 		}
1467282361a0SGreg Kroah-Hartman 	}
1468282361a0SGreg Kroah-Hartman 	/*
1469282361a0SGreg Kroah-Hartman 	 * For NDIS we assume that we are using sync PPP frames, for COM async.
1470282361a0SGreg Kroah-Hartman 	 * This driver uses NDIS mode too. We don't bother with translation
1471282361a0SGreg Kroah-Hartman 	 * from async -> sync PPP.
1472282361a0SGreg Kroah-Hartman 	 */
1473282361a0SGreg Kroah-Hartman 	info_packet = alloc_ctrl_packet(sizeof(struct ipw_setup_info_packet),
1474282361a0SGreg Kroah-Hartman 			ADDR_SETUP_PROT,
1475282361a0SGreg Kroah-Hartman 			TL_PROTOCOLID_SETUP,
1476282361a0SGreg Kroah-Hartman 			TL_SETUP_SIGNO_INFO_MSG);
1477282361a0SGreg Kroah-Hartman 	if (!info_packet)
1478282361a0SGreg Kroah-Hartman 		goto exit_nomem;
1479282361a0SGreg Kroah-Hartman 	info_packet->header.length = sizeof(struct tl_setup_info_msg);
1480282361a0SGreg Kroah-Hartman 	info_packet->body.driver_type = NDISWAN_DRIVER;
1481282361a0SGreg Kroah-Hartman 	info_packet->body.major_version = NDISWAN_DRIVER_MAJOR_VERSION;
1482282361a0SGreg Kroah-Hartman 	info_packet->body.minor_version = NDISWAN_DRIVER_MINOR_VERSION;
1483282361a0SGreg Kroah-Hartman 	send_packet(hw, PRIO_SETUP, &info_packet->header);
1484282361a0SGreg Kroah-Hartman 
1485282361a0SGreg Kroah-Hartman 	/* Initialization is now complete, so we clear the 'to_setup' flag */
1486282361a0SGreg Kroah-Hartman 	hw->to_setup = 0;
1487282361a0SGreg Kroah-Hartman 
1488282361a0SGreg Kroah-Hartman 	return;
1489282361a0SGreg Kroah-Hartman 
1490282361a0SGreg Kroah-Hartman exit_nomem:
1491282361a0SGreg Kroah-Hartman 	printk(KERN_ERR IPWIRELESS_PCCARD_NAME
1492282361a0SGreg Kroah-Hartman 			": not enough memory to alloc control packet\n");
1493282361a0SGreg Kroah-Hartman 	hw->to_setup = -1;
1494282361a0SGreg Kroah-Hartman }
1495282361a0SGreg Kroah-Hartman 
handle_setup_get_version_rsp(struct ipw_hardware * hw,unsigned char vers_no)1496282361a0SGreg Kroah-Hartman static void handle_setup_get_version_rsp(struct ipw_hardware *hw,
1497282361a0SGreg Kroah-Hartman 		unsigned char vers_no)
1498282361a0SGreg Kroah-Hartman {
1499282361a0SGreg Kroah-Hartman 	del_timer(&hw->setup_timer);
1500282361a0SGreg Kroah-Hartman 	hw->initializing = 0;
1501282361a0SGreg Kroah-Hartman 	printk(KERN_INFO IPWIRELESS_PCCARD_NAME ": card is ready.\n");
1502282361a0SGreg Kroah-Hartman 
1503282361a0SGreg Kroah-Hartman 	if (vers_no == TL_SETUP_VERSION)
1504282361a0SGreg Kroah-Hartman 		__handle_setup_get_version_rsp(hw);
1505282361a0SGreg Kroah-Hartman 	else
1506282361a0SGreg Kroah-Hartman 		printk(KERN_ERR IPWIRELESS_PCCARD_NAME
1507282361a0SGreg Kroah-Hartman 				": invalid hardware version no %u\n",
1508282361a0SGreg Kroah-Hartman 				(unsigned int) vers_no);
1509282361a0SGreg Kroah-Hartman }
1510282361a0SGreg Kroah-Hartman 
ipw_send_setup_packet(struct ipw_hardware * hw)1511282361a0SGreg Kroah-Hartman static void ipw_send_setup_packet(struct ipw_hardware *hw)
1512282361a0SGreg Kroah-Hartman {
1513282361a0SGreg Kroah-Hartman 	struct ipw_setup_get_version_query_packet *ver_packet;
1514282361a0SGreg Kroah-Hartman 
1515282361a0SGreg Kroah-Hartman 	ver_packet = alloc_ctrl_packet(
1516282361a0SGreg Kroah-Hartman 			sizeof(struct ipw_setup_get_version_query_packet),
1517282361a0SGreg Kroah-Hartman 			ADDR_SETUP_PROT, TL_PROTOCOLID_SETUP,
1518282361a0SGreg Kroah-Hartman 			TL_SETUP_SIGNO_GET_VERSION_QRY);
15197dd50e20SYueHaibing 	if (!ver_packet)
15207dd50e20SYueHaibing 		return;
1521282361a0SGreg Kroah-Hartman 	ver_packet->header.length = sizeof(struct tl_setup_get_version_qry);
1522282361a0SGreg Kroah-Hartman 
1523282361a0SGreg Kroah-Hartman 	/*
1524282361a0SGreg Kroah-Hartman 	 * Response is handled in handle_received_SETUP_packet
1525282361a0SGreg Kroah-Hartman 	 */
1526282361a0SGreg Kroah-Hartman 	send_packet(hw, PRIO_SETUP, &ver_packet->header);
1527282361a0SGreg Kroah-Hartman }
1528282361a0SGreg Kroah-Hartman 
handle_received_SETUP_packet(struct ipw_hardware * hw,unsigned int address,const unsigned char * data,int len,int is_last)1529282361a0SGreg Kroah-Hartman static void handle_received_SETUP_packet(struct ipw_hardware *hw,
1530282361a0SGreg Kroah-Hartman 					 unsigned int address,
1531282361a0SGreg Kroah-Hartman 					 const unsigned char *data, int len,
1532282361a0SGreg Kroah-Hartman 					 int is_last)
1533282361a0SGreg Kroah-Hartman {
1534282361a0SGreg Kroah-Hartman 	const union ipw_setup_rx_msg *rx_msg = (const union ipw_setup_rx_msg *) data;
1535282361a0SGreg Kroah-Hartman 
1536282361a0SGreg Kroah-Hartman 	if (address != ADDR_SETUP_PROT) {
1537282361a0SGreg Kroah-Hartman 		printk(KERN_INFO IPWIRELESS_PCCARD_NAME
1538282361a0SGreg Kroah-Hartman 		       ": setup packet has bad address %d\n", address);
1539282361a0SGreg Kroah-Hartman 		return;
1540282361a0SGreg Kroah-Hartman 	}
1541282361a0SGreg Kroah-Hartman 
1542282361a0SGreg Kroah-Hartman 	switch (rx_msg->sig_no) {
1543282361a0SGreg Kroah-Hartman 	case TL_SETUP_SIGNO_GET_VERSION_RSP:
1544282361a0SGreg Kroah-Hartman 		if (hw->to_setup)
1545282361a0SGreg Kroah-Hartman 			handle_setup_get_version_rsp(hw,
1546282361a0SGreg Kroah-Hartman 					rx_msg->version_rsp_msg.version);
1547282361a0SGreg Kroah-Hartman 		break;
1548282361a0SGreg Kroah-Hartman 
1549282361a0SGreg Kroah-Hartman 	case TL_SETUP_SIGNO_OPEN_MSG:
1550282361a0SGreg Kroah-Hartman 		if (ipwireless_debug) {
1551282361a0SGreg Kroah-Hartman 			unsigned int channel_idx = rx_msg->open_msg.port_no - 1;
1552282361a0SGreg Kroah-Hartman 
1553282361a0SGreg Kroah-Hartman 			printk(KERN_INFO IPWIRELESS_PCCARD_NAME
1554282361a0SGreg Kroah-Hartman 			       ": OPEN_MSG [channel %u] reply received\n",
1555282361a0SGreg Kroah-Hartman 			       channel_idx);
1556282361a0SGreg Kroah-Hartman 		}
1557282361a0SGreg Kroah-Hartman 		break;
1558282361a0SGreg Kroah-Hartman 
1559282361a0SGreg Kroah-Hartman 	case TL_SETUP_SIGNO_INFO_MSG_ACK:
1560282361a0SGreg Kroah-Hartman 		if (ipwireless_debug)
1561282361a0SGreg Kroah-Hartman 			printk(KERN_DEBUG IPWIRELESS_PCCARD_NAME
1562282361a0SGreg Kroah-Hartman 			       ": card successfully configured as NDISWAN\n");
1563282361a0SGreg Kroah-Hartman 		break;
1564282361a0SGreg Kroah-Hartman 
1565282361a0SGreg Kroah-Hartman 	case TL_SETUP_SIGNO_REBOOT_MSG:
1566282361a0SGreg Kroah-Hartman 		if (hw->to_setup)
1567282361a0SGreg Kroah-Hartman 			printk(KERN_DEBUG IPWIRELESS_PCCARD_NAME
1568282361a0SGreg Kroah-Hartman 			       ": Setup not completed - ignoring reboot msg\n");
1569282361a0SGreg Kroah-Hartman 		else {
1570282361a0SGreg Kroah-Hartman 			struct ipw_setup_reboot_msg_ack *packet;
1571282361a0SGreg Kroah-Hartman 
1572282361a0SGreg Kroah-Hartman 			printk(KERN_DEBUG IPWIRELESS_PCCARD_NAME
1573282361a0SGreg Kroah-Hartman 			       ": Acknowledging REBOOT message\n");
1574282361a0SGreg Kroah-Hartman 			packet = alloc_ctrl_packet(
1575282361a0SGreg Kroah-Hartman 					sizeof(struct ipw_setup_reboot_msg_ack),
1576282361a0SGreg Kroah-Hartman 					ADDR_SETUP_PROT, TL_PROTOCOLID_SETUP,
1577282361a0SGreg Kroah-Hartman 					TL_SETUP_SIGNO_REBOOT_MSG_ACK);
157876bbdcb3SSudip Mukherjee 			if (!packet) {
157976bbdcb3SSudip Mukherjee 				pr_err(IPWIRELESS_PCCARD_NAME
158076bbdcb3SSudip Mukherjee 				       ": Not enough memory to send reboot packet");
158176bbdcb3SSudip Mukherjee 				break;
158276bbdcb3SSudip Mukherjee 			}
1583282361a0SGreg Kroah-Hartman 			packet->header.length =
1584282361a0SGreg Kroah-Hartman 				sizeof(struct TlSetupRebootMsgAck);
1585282361a0SGreg Kroah-Hartman 			send_packet(hw, PRIO_SETUP, &packet->header);
1586282361a0SGreg Kroah-Hartman 			if (hw->reboot_callback)
1587282361a0SGreg Kroah-Hartman 				hw->reboot_callback(hw->reboot_callback_data);
1588282361a0SGreg Kroah-Hartman 		}
1589282361a0SGreg Kroah-Hartman 		break;
1590282361a0SGreg Kroah-Hartman 
1591282361a0SGreg Kroah-Hartman 	default:
1592282361a0SGreg Kroah-Hartman 		printk(KERN_INFO IPWIRELESS_PCCARD_NAME
1593282361a0SGreg Kroah-Hartman 		       ": unknown setup message %u received\n",
1594282361a0SGreg Kroah-Hartman 		       (unsigned int) rx_msg->sig_no);
1595282361a0SGreg Kroah-Hartman 	}
1596282361a0SGreg Kroah-Hartman }
1597282361a0SGreg Kroah-Hartman 
do_close_hardware(struct ipw_hardware * hw)1598282361a0SGreg Kroah-Hartman static void do_close_hardware(struct ipw_hardware *hw)
1599282361a0SGreg Kroah-Hartman {
1600282361a0SGreg Kroah-Hartman 	unsigned int irqn;
1601282361a0SGreg Kroah-Hartman 
1602282361a0SGreg Kroah-Hartman 	if (hw->hw_version == HW_VERSION_1) {
1603282361a0SGreg Kroah-Hartman 		/* Disable TX and RX interrupts. */
1604282361a0SGreg Kroah-Hartman 		outw(0, hw->base_port + IOIER);
1605282361a0SGreg Kroah-Hartman 
1606282361a0SGreg Kroah-Hartman 		/* Acknowledge any outstanding interrupt requests */
1607282361a0SGreg Kroah-Hartman 		irqn = inw(hw->base_port + IOIR);
1608282361a0SGreg Kroah-Hartman 		if (irqn & IR_TXINTR)
1609282361a0SGreg Kroah-Hartman 			outw(IR_TXINTR, hw->base_port + IOIR);
1610282361a0SGreg Kroah-Hartman 		if (irqn & IR_RXINTR)
1611282361a0SGreg Kroah-Hartman 			outw(IR_RXINTR, hw->base_port + IOIR);
1612282361a0SGreg Kroah-Hartman 
1613282361a0SGreg Kroah-Hartman 		synchronize_irq(hw->irq);
1614282361a0SGreg Kroah-Hartman 	}
1615282361a0SGreg Kroah-Hartman }
1616282361a0SGreg Kroah-Hartman 
ipwireless_hardware_create(void)1617282361a0SGreg Kroah-Hartman struct ipw_hardware *ipwireless_hardware_create(void)
1618282361a0SGreg Kroah-Hartman {
1619282361a0SGreg Kroah-Hartman 	int i;
1620282361a0SGreg Kroah-Hartman 	struct ipw_hardware *hw =
1621282361a0SGreg Kroah-Hartman 		kzalloc(sizeof(struct ipw_hardware), GFP_KERNEL);
1622282361a0SGreg Kroah-Hartman 
1623282361a0SGreg Kroah-Hartman 	if (!hw)
1624282361a0SGreg Kroah-Hartman 		return NULL;
1625282361a0SGreg Kroah-Hartman 
1626282361a0SGreg Kroah-Hartman 	hw->irq = -1;
1627282361a0SGreg Kroah-Hartman 	hw->initializing = 1;
1628282361a0SGreg Kroah-Hartman 	hw->tx_ready = 1;
1629282361a0SGreg Kroah-Hartman 	hw->rx_bytes_queued = 0;
1630282361a0SGreg Kroah-Hartman 	hw->rx_pool_size = 0;
1631282361a0SGreg Kroah-Hartman 	hw->last_memtx_serial = (unsigned short) 0xffff;
1632282361a0SGreg Kroah-Hartman 	for (i = 0; i < NL_NUM_OF_PRIORITIES; i++)
1633282361a0SGreg Kroah-Hartman 		INIT_LIST_HEAD(&hw->tx_queue[i]);
1634282361a0SGreg Kroah-Hartman 
1635282361a0SGreg Kroah-Hartman 	INIT_LIST_HEAD(&hw->rx_queue);
1636282361a0SGreg Kroah-Hartman 	INIT_LIST_HEAD(&hw->rx_pool);
1637282361a0SGreg Kroah-Hartman 	spin_lock_init(&hw->lock);
1638a42a9f6aSAllen Pais 	tasklet_setup(&hw->tasklet, ipwireless_do_tasklet);
1639282361a0SGreg Kroah-Hartman 	INIT_WORK(&hw->work_rx, ipw_receive_data_work);
1640e99e88a9SKees Cook 	timer_setup(&hw->setup_timer, ipwireless_setup_timer, 0);
1641282361a0SGreg Kroah-Hartman 
1642282361a0SGreg Kroah-Hartman 	return hw;
1643282361a0SGreg Kroah-Hartman }
1644282361a0SGreg Kroah-Hartman 
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)1645282361a0SGreg Kroah-Hartman void ipwireless_init_hardware_v1(struct ipw_hardware *hw,
1646282361a0SGreg Kroah-Hartman 		unsigned int base_port,
1647282361a0SGreg Kroah-Hartman 		void __iomem *attr_memory,
1648282361a0SGreg Kroah-Hartman 		void __iomem *common_memory,
1649282361a0SGreg Kroah-Hartman 		int is_v2_card,
1650282361a0SGreg Kroah-Hartman 		void (*reboot_callback) (void *data),
1651282361a0SGreg Kroah-Hartman 		void *reboot_callback_data)
1652282361a0SGreg Kroah-Hartman {
1653282361a0SGreg Kroah-Hartman 	if (hw->removed) {
1654282361a0SGreg Kroah-Hartman 		hw->removed = 0;
1655282361a0SGreg Kroah-Hartman 		enable_irq(hw->irq);
1656282361a0SGreg Kroah-Hartman 	}
1657282361a0SGreg Kroah-Hartman 	hw->base_port = base_port;
1658282361a0SGreg Kroah-Hartman 	hw->hw_version = (is_v2_card ? HW_VERSION_2 : HW_VERSION_1);
1659282361a0SGreg Kroah-Hartman 	hw->ll_mtu = (hw->hw_version == HW_VERSION_1 ? LL_MTU_V1 : LL_MTU_V2);
1660282361a0SGreg Kroah-Hartman 	hw->memregs_CCR = (struct MEMCCR __iomem *)
1661282361a0SGreg Kroah-Hartman 			((unsigned short __iomem *) attr_memory + 0x200);
1662282361a0SGreg Kroah-Hartman 	hw->memory_info_regs = (struct MEMINFREG __iomem *) common_memory;
1663282361a0SGreg Kroah-Hartman 	hw->memreg_tx = &hw->memory_info_regs->memreg_tx_new;
1664282361a0SGreg Kroah-Hartman 	hw->reboot_callback = reboot_callback;
1665282361a0SGreg Kroah-Hartman 	hw->reboot_callback_data = reboot_callback_data;
1666282361a0SGreg Kroah-Hartman }
1667282361a0SGreg Kroah-Hartman 
ipwireless_init_hardware_v2_v3(struct ipw_hardware * hw)1668282361a0SGreg Kroah-Hartman void ipwireless_init_hardware_v2_v3(struct ipw_hardware *hw)
1669282361a0SGreg Kroah-Hartman {
1670282361a0SGreg Kroah-Hartman 	hw->initializing = 1;
1671282361a0SGreg Kroah-Hartman 	hw->init_loops = 0;
1672282361a0SGreg Kroah-Hartman 	printk(KERN_INFO IPWIRELESS_PCCARD_NAME
1673282361a0SGreg Kroah-Hartman 	       ": waiting for card to start up...\n");
1674e99e88a9SKees Cook 	ipwireless_setup_timer(&hw->setup_timer);
1675282361a0SGreg Kroah-Hartman }
1676282361a0SGreg Kroah-Hartman 
ipwireless_setup_timer(struct timer_list * t)1677e99e88a9SKees Cook static void ipwireless_setup_timer(struct timer_list *t)
1678282361a0SGreg Kroah-Hartman {
1679e99e88a9SKees Cook 	struct ipw_hardware *hw = from_timer(hw, t, setup_timer);
1680282361a0SGreg Kroah-Hartman 
1681282361a0SGreg Kroah-Hartman 	hw->init_loops++;
1682282361a0SGreg Kroah-Hartman 
1683282361a0SGreg Kroah-Hartman 	if (hw->init_loops == TL_SETUP_MAX_VERSION_QRY &&
1684282361a0SGreg Kroah-Hartman 			hw->hw_version == HW_VERSION_2 &&
1685282361a0SGreg Kroah-Hartman 			hw->memreg_tx == &hw->memory_info_regs->memreg_tx_new) {
1686282361a0SGreg Kroah-Hartman 		printk(KERN_INFO IPWIRELESS_PCCARD_NAME
1687282361a0SGreg Kroah-Hartman 				": failed to startup using TX2, trying TX\n");
1688282361a0SGreg Kroah-Hartman 
1689282361a0SGreg Kroah-Hartman 		hw->memreg_tx = &hw->memory_info_regs->memreg_tx_old;
1690282361a0SGreg Kroah-Hartman 		hw->init_loops = 0;
1691282361a0SGreg Kroah-Hartman 	}
1692282361a0SGreg Kroah-Hartman 	/* Give up after a certain number of retries */
1693282361a0SGreg Kroah-Hartman 	if (hw->init_loops == TL_SETUP_MAX_VERSION_QRY) {
1694282361a0SGreg Kroah-Hartman 		printk(KERN_INFO IPWIRELESS_PCCARD_NAME
1695282361a0SGreg Kroah-Hartman 		       ": card failed to start up!\n");
1696282361a0SGreg Kroah-Hartman 		hw->initializing = 0;
1697282361a0SGreg Kroah-Hartman 	} else {
1698282361a0SGreg Kroah-Hartman 		/* Do not attempt to write to the board if it is not present. */
1699282361a0SGreg Kroah-Hartman 		if (is_card_present(hw)) {
1700282361a0SGreg Kroah-Hartman 			unsigned long flags;
1701282361a0SGreg Kroah-Hartman 
1702282361a0SGreg Kroah-Hartman 			spin_lock_irqsave(&hw->lock, flags);
1703282361a0SGreg Kroah-Hartman 			hw->to_setup = 1;
1704282361a0SGreg Kroah-Hartman 			hw->tx_ready = 1;
1705282361a0SGreg Kroah-Hartman 			spin_unlock_irqrestore(&hw->lock, flags);
1706282361a0SGreg Kroah-Hartman 			tasklet_schedule(&hw->tasklet);
1707282361a0SGreg Kroah-Hartman 		}
1708282361a0SGreg Kroah-Hartman 
1709282361a0SGreg Kroah-Hartman 		mod_timer(&hw->setup_timer,
1710282361a0SGreg Kroah-Hartman 			jiffies + msecs_to_jiffies(TL_SETUP_VERSION_QRY_TMO));
1711282361a0SGreg Kroah-Hartman 	}
1712282361a0SGreg Kroah-Hartman }
1713282361a0SGreg Kroah-Hartman 
1714282361a0SGreg Kroah-Hartman /*
1715282361a0SGreg Kroah-Hartman  * Stop any interrupts from executing so that, once this function returns,
1716282361a0SGreg Kroah-Hartman  * other layers of the driver can be sure they won't get any more callbacks.
1717282361a0SGreg Kroah-Hartman  * Thus must be called on a proper process context.
1718282361a0SGreg Kroah-Hartman  */
ipwireless_stop_interrupts(struct ipw_hardware * hw)1719282361a0SGreg Kroah-Hartman void ipwireless_stop_interrupts(struct ipw_hardware *hw)
1720282361a0SGreg Kroah-Hartman {
1721282361a0SGreg Kroah-Hartman 	if (!hw->shutting_down) {
1722282361a0SGreg Kroah-Hartman 		/* Tell everyone we are going down. */
1723282361a0SGreg Kroah-Hartman 		hw->shutting_down = 1;
1724282361a0SGreg Kroah-Hartman 		del_timer(&hw->setup_timer);
1725282361a0SGreg Kroah-Hartman 
1726282361a0SGreg Kroah-Hartman 		/* Prevent the hardware from sending any more interrupts */
1727282361a0SGreg Kroah-Hartman 		do_close_hardware(hw);
1728282361a0SGreg Kroah-Hartman 	}
1729282361a0SGreg Kroah-Hartman }
1730282361a0SGreg Kroah-Hartman 
ipwireless_hardware_free(struct ipw_hardware * hw)1731282361a0SGreg Kroah-Hartman void ipwireless_hardware_free(struct ipw_hardware *hw)
1732282361a0SGreg Kroah-Hartman {
1733282361a0SGreg Kroah-Hartman 	int i;
1734282361a0SGreg Kroah-Hartman 	struct ipw_rx_packet *rp, *rq;
1735282361a0SGreg Kroah-Hartman 	struct ipw_tx_packet *tp, *tq;
1736282361a0SGreg Kroah-Hartman 
1737282361a0SGreg Kroah-Hartman 	ipwireless_stop_interrupts(hw);
1738282361a0SGreg Kroah-Hartman 
173943829731STejun Heo 	flush_work(&hw->work_rx);
1740282361a0SGreg Kroah-Hartman 
1741282361a0SGreg Kroah-Hartman 	for (i = 0; i < NL_NUM_OF_ADDRESSES; i++)
1742282361a0SGreg Kroah-Hartman 		kfree(hw->packet_assembler[i]);
1743282361a0SGreg Kroah-Hartman 
1744282361a0SGreg Kroah-Hartman 	for (i = 0; i < NL_NUM_OF_PRIORITIES; i++)
1745282361a0SGreg Kroah-Hartman 		list_for_each_entry_safe(tp, tq, &hw->tx_queue[i], queue) {
1746282361a0SGreg Kroah-Hartman 			list_del(&tp->queue);
1747282361a0SGreg Kroah-Hartman 			kfree(tp);
1748282361a0SGreg Kroah-Hartman 		}
1749282361a0SGreg Kroah-Hartman 
1750282361a0SGreg Kroah-Hartman 	list_for_each_entry_safe(rp, rq, &hw->rx_queue, queue) {
1751282361a0SGreg Kroah-Hartman 		list_del(&rp->queue);
1752282361a0SGreg Kroah-Hartman 		kfree(rp);
1753282361a0SGreg Kroah-Hartman 	}
1754282361a0SGreg Kroah-Hartman 
1755282361a0SGreg Kroah-Hartman 	list_for_each_entry_safe(rp, rq, &hw->rx_pool, queue) {
1756282361a0SGreg Kroah-Hartman 		list_del(&rp->queue);
1757282361a0SGreg Kroah-Hartman 		kfree(rp);
1758282361a0SGreg Kroah-Hartman 	}
1759282361a0SGreg Kroah-Hartman 	kfree(hw);
1760282361a0SGreg Kroah-Hartman }
1761282361a0SGreg Kroah-Hartman 
1762282361a0SGreg Kroah-Hartman /*
1763282361a0SGreg Kroah-Hartman  * Associate the specified network with this hardware, so it will receive events
1764282361a0SGreg Kroah-Hartman  * from it.
1765282361a0SGreg Kroah-Hartman  */
ipwireless_associate_network(struct ipw_hardware * hw,struct ipw_network * network)1766282361a0SGreg Kroah-Hartman void ipwireless_associate_network(struct ipw_hardware *hw,
1767282361a0SGreg Kroah-Hartman 				  struct ipw_network *network)
1768282361a0SGreg Kroah-Hartman {
1769282361a0SGreg Kroah-Hartman 	hw->network = network;
1770282361a0SGreg Kroah-Hartman }
1771