| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* | 
 | 2 |  *  linux/arch/arm/kernel/ecard.c | 
 | 3 |  * | 
 | 4 |  *  Copyright 1995-2001 Russell King | 
 | 5 |  * | 
 | 6 |  * This program is free software; you can redistribute it and/or modify | 
 | 7 |  * it under the terms of the GNU General Public License version 2 as | 
 | 8 |  * published by the Free Software Foundation. | 
 | 9 |  * | 
 | 10 |  *  Find all installed expansion cards, and handle interrupts from them. | 
 | 11 |  * | 
 | 12 |  *  Created from information from Acorns RiscOS3 PRMs | 
 | 13 |  * | 
 | 14 |  *  08-Dec-1996	RMK	Added code for the 9'th expansion card - the ether | 
 | 15 |  *			podule slot. | 
 | 16 |  *  06-May-1997	RMK	Added blacklist for cards whose loader doesn't work. | 
 | 17 |  *  12-Sep-1997	RMK	Created new handling of interrupt enables/disables | 
 | 18 |  *			- cards can now register their own routine to control | 
 | 19 |  *			interrupts (recommended). | 
 | 20 |  *  29-Sep-1997	RMK	Expansion card interrupt hardware not being re-enabled | 
 | 21 |  *			on reset from Linux. (Caused cards not to respond | 
 | 22 |  *			under RiscOS without hard reset). | 
 | 23 |  *  15-Feb-1998	RMK	Added DMA support | 
 | 24 |  *  12-Sep-1998	RMK	Added EASI support | 
 | 25 |  *  10-Jan-1999	RMK	Run loaders in a simulated RISC OS environment. | 
 | 26 |  *  17-Apr-1999	RMK	Support for EASI Type C cycles. | 
 | 27 |  */ | 
 | 28 | #define ECARD_C | 
 | 29 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 30 | #include <linux/module.h> | 
 | 31 | #include <linux/kernel.h> | 
 | 32 | #include <linux/types.h> | 
 | 33 | #include <linux/sched.h> | 
 | 34 | #include <linux/interrupt.h> | 
 | 35 | #include <linux/completion.h> | 
 | 36 | #include <linux/reboot.h> | 
 | 37 | #include <linux/mm.h> | 
 | 38 | #include <linux/slab.h> | 
 | 39 | #include <linux/proc_fs.h> | 
| Alexey Dobriyan | 9b00121 | 2008-04-29 01:01:49 -0700 | [diff] [blame] | 40 | #include <linux/seq_file.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 41 | #include <linux/device.h> | 
 | 42 | #include <linux/init.h> | 
| Arjan van de Ven | 0043170 | 2006-01-12 18:42:23 +0000 | [diff] [blame] | 43 | #include <linux/mutex.h> | 
| Eric W. Biederman | 134c99e | 2007-04-26 00:04:40 -0700 | [diff] [blame] | 44 | #include <linux/kthread.h> | 
| Russell King | 10bdaaa | 2007-05-10 18:40:51 +0100 | [diff] [blame] | 45 | #include <linux/io.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 46 |  | 
 | 47 | #include <asm/dma.h> | 
 | 48 | #include <asm/ecard.h> | 
| Russell King | a09e64f | 2008-08-05 16:14:15 +0100 | [diff] [blame] | 49 | #include <mach/hardware.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 50 | #include <asm/irq.h> | 
 | 51 | #include <asm/mmu_context.h> | 
 | 52 | #include <asm/mach/irq.h> | 
 | 53 | #include <asm/tlbflush.h> | 
 | 54 |  | 
| Russell King | c0b04d1 | 2007-05-03 10:20:47 +0100 | [diff] [blame] | 55 | #include "ecard.h" | 
 | 56 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 57 | #ifndef CONFIG_ARCH_RPC | 
 | 58 | #define HAVE_EXPMASK | 
 | 59 | #endif | 
 | 60 |  | 
 | 61 | struct ecard_request { | 
 | 62 | 	void		(*fn)(struct ecard_request *); | 
 | 63 | 	ecard_t		*ec; | 
 | 64 | 	unsigned int	address; | 
 | 65 | 	unsigned int	length; | 
 | 66 | 	unsigned int	use_loader; | 
 | 67 | 	void		*buffer; | 
 | 68 | 	struct completion *complete; | 
 | 69 | }; | 
 | 70 |  | 
 | 71 | struct expcard_blacklist { | 
 | 72 | 	unsigned short	 manufacturer; | 
 | 73 | 	unsigned short	 product; | 
 | 74 | 	const char	*type; | 
 | 75 | }; | 
 | 76 |  | 
 | 77 | static ecard_t *cards; | 
 | 78 | static ecard_t *slot_to_expcard[MAX_ECARDS]; | 
 | 79 | static unsigned int ectcr; | 
 | 80 | #ifdef HAS_EXPMASK | 
 | 81 | static unsigned int have_expmask; | 
 | 82 | #endif | 
 | 83 |  | 
 | 84 | /* List of descriptions of cards which don't have an extended | 
 | 85 |  * identification, or chunk directories containing a description. | 
 | 86 |  */ | 
 | 87 | static struct expcard_blacklist __initdata blacklist[] = { | 
 | 88 | 	{ MANU_ACORN, PROD_ACORN_ETHER1, "Acorn Ether1" } | 
 | 89 | }; | 
 | 90 |  | 
 | 91 | asmlinkage extern int | 
 | 92 | ecard_loader_reset(unsigned long base, loader_t loader); | 
 | 93 | asmlinkage extern int | 
 | 94 | ecard_loader_read(int off, unsigned long base, loader_t loader); | 
 | 95 |  | 
 | 96 | static inline unsigned short ecard_getu16(unsigned char *v) | 
 | 97 | { | 
 | 98 | 	return v[0] | v[1] << 8; | 
 | 99 | } | 
 | 100 |  | 
 | 101 | static inline signed long ecard_gets24(unsigned char *v) | 
 | 102 | { | 
 | 103 | 	return v[0] | v[1] << 8 | v[2] << 16 | ((v[2] & 0x80) ? 0xff000000 : 0); | 
 | 104 | } | 
 | 105 |  | 
 | 106 | static inline ecard_t *slot_to_ecard(unsigned int slot) | 
 | 107 | { | 
 | 108 | 	return slot < MAX_ECARDS ? slot_to_expcard[slot] : NULL; | 
 | 109 | } | 
 | 110 |  | 
 | 111 | /* ===================== Expansion card daemon ======================== */ | 
 | 112 | /* | 
 | 113 |  * Since the loader programs on the expansion cards need to be run | 
 | 114 |  * in a specific environment, create a separate task with this | 
 | 115 |  * environment up, and pass requests to this task as and when we | 
 | 116 |  * need to. | 
 | 117 |  * | 
 | 118 |  * This should allow 99% of loaders to be called from Linux. | 
 | 119 |  * | 
 | 120 |  * From a security standpoint, we trust the card vendors.  This | 
 | 121 |  * may be a misplaced trust. | 
 | 122 |  */ | 
 | 123 | static void ecard_task_reset(struct ecard_request *req) | 
 | 124 | { | 
 | 125 | 	struct expansion_card *ec = req->ec; | 
 | 126 | 	struct resource *res; | 
 | 127 |  | 
 | 128 | 	res = ec->slot_no == 8 | 
 | 129 | 		? &ec->resource[ECARD_RES_MEMC] | 
| Russell King | 5559bca | 2007-05-03 10:47:37 +0100 | [diff] [blame] | 130 | 		: ec->easi | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 131 | 		  ? &ec->resource[ECARD_RES_EASI] | 
 | 132 | 		  : &ec->resource[ECARD_RES_IOCSYNC]; | 
 | 133 |  | 
 | 134 | 	ecard_loader_reset(res->start, ec->loader); | 
 | 135 | } | 
 | 136 |  | 
 | 137 | static void ecard_task_readbytes(struct ecard_request *req) | 
 | 138 | { | 
 | 139 | 	struct expansion_card *ec = req->ec; | 
 | 140 | 	unsigned char *buf = req->buffer; | 
 | 141 | 	unsigned int len = req->length; | 
 | 142 | 	unsigned int off = req->address; | 
 | 143 |  | 
 | 144 | 	if (ec->slot_no == 8) { | 
 | 145 | 		void __iomem *base = (void __iomem *) | 
 | 146 | 				ec->resource[ECARD_RES_MEMC].start; | 
 | 147 |  | 
 | 148 | 		/* | 
 | 149 | 		 * The card maintains an index which increments the address | 
 | 150 | 		 * into a 4096-byte page on each access.  We need to keep | 
 | 151 | 		 * track of the counter. | 
 | 152 | 		 */ | 
 | 153 | 		static unsigned int index; | 
 | 154 | 		unsigned int page; | 
 | 155 |  | 
 | 156 | 		page = (off >> 12) * 4; | 
 | 157 | 		if (page > 256 * 4) | 
 | 158 | 			return; | 
 | 159 |  | 
 | 160 | 		off &= 4095; | 
 | 161 |  | 
 | 162 | 		/* | 
 | 163 | 		 * If we are reading offset 0, or our current index is | 
 | 164 | 		 * greater than the offset, reset the hardware index counter. | 
 | 165 | 		 */ | 
 | 166 | 		if (off == 0 || index > off) { | 
 | 167 | 			writeb(0, base); | 
 | 168 | 			index = 0; | 
 | 169 | 		} | 
 | 170 |  | 
 | 171 | 		/* | 
 | 172 | 		 * Increment the hardware index counter until we get to the | 
 | 173 | 		 * required offset.  The read bytes are discarded. | 
 | 174 | 		 */ | 
 | 175 | 		while (index < off) { | 
 | 176 | 			readb(base + page); | 
 | 177 | 			index += 1; | 
 | 178 | 		} | 
 | 179 |  | 
 | 180 | 		while (len--) { | 
 | 181 | 			*buf++ = readb(base + page); | 
 | 182 | 			index += 1; | 
 | 183 | 		} | 
 | 184 | 	} else { | 
| Russell King | 5559bca | 2007-05-03 10:47:37 +0100 | [diff] [blame] | 185 | 		unsigned long base = (ec->easi | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 186 | 			 ? &ec->resource[ECARD_RES_EASI] | 
 | 187 | 			 : &ec->resource[ECARD_RES_IOCSYNC])->start; | 
 | 188 | 		void __iomem *pbase = (void __iomem *)base; | 
 | 189 |  | 
 | 190 | 		if (!req->use_loader || !ec->loader) { | 
 | 191 | 			off *= 4; | 
 | 192 | 			while (len--) { | 
 | 193 | 				*buf++ = readb(pbase + off); | 
 | 194 | 				off += 4; | 
 | 195 | 			} | 
 | 196 | 		} else { | 
 | 197 | 			while(len--) { | 
 | 198 | 				/* | 
 | 199 | 				 * The following is required by some | 
 | 200 | 				 * expansion card loader programs. | 
 | 201 | 				 */ | 
 | 202 | 				*(unsigned long *)0x108 = 0; | 
 | 203 | 				*buf++ = ecard_loader_read(off++, base, | 
 | 204 | 							   ec->loader); | 
 | 205 | 			} | 
 | 206 | 		} | 
 | 207 | 	} | 
 | 208 |  | 
 | 209 | } | 
 | 210 |  | 
 | 211 | static DECLARE_WAIT_QUEUE_HEAD(ecard_wait); | 
 | 212 | static struct ecard_request *ecard_req; | 
| Arjan van de Ven | 0043170 | 2006-01-12 18:42:23 +0000 | [diff] [blame] | 213 | static DEFINE_MUTEX(ecard_mutex); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 214 |  | 
 | 215 | /* | 
 | 216 |  * Set up the expansion card daemon's page tables. | 
 | 217 |  */ | 
 | 218 | static void ecard_init_pgtables(struct mm_struct *mm) | 
 | 219 | { | 
 | 220 | 	struct vm_area_struct vma; | 
 | 221 |  | 
 | 222 | 	/* We want to set up the page tables for the following mapping: | 
 | 223 | 	 *  Virtual	Physical | 
 | 224 | 	 *  0x03000000	0x03000000 | 
 | 225 | 	 *  0x03010000	unmapped | 
 | 226 | 	 *  0x03210000	0x03210000 | 
 | 227 | 	 *  0x03400000	unmapped | 
 | 228 | 	 *  0x08000000	0x08000000 | 
 | 229 | 	 *  0x10000000	unmapped | 
 | 230 | 	 * | 
 | 231 | 	 * FIXME: we don't follow this 100% yet. | 
 | 232 | 	 */ | 
 | 233 | 	pgd_t *src_pgd, *dst_pgd; | 
 | 234 |  | 
 | 235 | 	src_pgd = pgd_offset(mm, (unsigned long)IO_BASE); | 
 | 236 | 	dst_pgd = pgd_offset(mm, IO_START); | 
 | 237 |  | 
 | 238 | 	memcpy(dst_pgd, src_pgd, sizeof(pgd_t) * (IO_SIZE / PGDIR_SIZE)); | 
 | 239 |  | 
| Russell King | 5e4cdb8 | 2011-07-07 11:40:52 +0100 | [diff] [blame] | 240 | 	src_pgd = pgd_offset(mm, (unsigned long)EASI_BASE); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 241 | 	dst_pgd = pgd_offset(mm, EASI_START); | 
 | 242 |  | 
 | 243 | 	memcpy(dst_pgd, src_pgd, sizeof(pgd_t) * (EASI_SIZE / PGDIR_SIZE)); | 
 | 244 |  | 
 | 245 | 	vma.vm_mm = mm; | 
 | 246 |  | 
 | 247 | 	flush_tlb_range(&vma, IO_START, IO_START + IO_SIZE); | 
 | 248 | 	flush_tlb_range(&vma, EASI_START, EASI_START + EASI_SIZE); | 
 | 249 | } | 
 | 250 |  | 
 | 251 | static int ecard_init_mm(void) | 
 | 252 | { | 
 | 253 | 	struct mm_struct * mm = mm_alloc(); | 
 | 254 | 	struct mm_struct *active_mm = current->active_mm; | 
 | 255 |  | 
 | 256 | 	if (!mm) | 
 | 257 | 		return -ENOMEM; | 
 | 258 |  | 
 | 259 | 	current->mm = mm; | 
 | 260 | 	current->active_mm = mm; | 
 | 261 | 	activate_mm(active_mm, mm); | 
 | 262 | 	mmdrop(active_mm); | 
 | 263 | 	ecard_init_pgtables(mm); | 
 | 264 | 	return 0; | 
 | 265 | } | 
 | 266 |  | 
 | 267 | static int | 
 | 268 | ecard_task(void * unused) | 
 | 269 | { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 270 | 	/* | 
 | 271 | 	 * Allocate a mm.  We're not a lazy-TLB kernel task since we need | 
 | 272 | 	 * to set page table entries where the user space would be.  Note | 
 | 273 | 	 * that this also creates the page tables.  Failure is not an | 
 | 274 | 	 * option here. | 
 | 275 | 	 */ | 
 | 276 | 	if (ecard_init_mm()) | 
 | 277 | 		panic("kecardd: unable to alloc mm\n"); | 
 | 278 |  | 
 | 279 | 	while (1) { | 
 | 280 | 		struct ecard_request *req; | 
 | 281 |  | 
 | 282 | 		wait_event_interruptible(ecard_wait, ecard_req != NULL); | 
 | 283 |  | 
 | 284 | 		req = xchg(&ecard_req, NULL); | 
 | 285 | 		if (req != NULL) { | 
 | 286 | 			req->fn(req); | 
 | 287 | 			complete(req->complete); | 
 | 288 | 		} | 
 | 289 | 	} | 
 | 290 | } | 
 | 291 |  | 
 | 292 | /* | 
 | 293 |  * Wake the expansion card daemon to action our request. | 
 | 294 |  * | 
 | 295 |  * FIXME: The test here is not sufficient to detect if the | 
 | 296 |  * kcardd is running. | 
 | 297 |  */ | 
 | 298 | static void ecard_call(struct ecard_request *req) | 
 | 299 | { | 
| Peter Zijlstra | 6e9a473 | 2006-09-30 23:28:10 -0700 | [diff] [blame] | 300 | 	DECLARE_COMPLETION_ONSTACK(completion); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 301 |  | 
 | 302 | 	req->complete = &completion; | 
 | 303 |  | 
| Arjan van de Ven | 0043170 | 2006-01-12 18:42:23 +0000 | [diff] [blame] | 304 | 	mutex_lock(&ecard_mutex); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 305 | 	ecard_req = req; | 
 | 306 | 	wake_up(&ecard_wait); | 
 | 307 |  | 
 | 308 | 	/* | 
 | 309 | 	 * Now wait for kecardd to run. | 
 | 310 | 	 */ | 
 | 311 | 	wait_for_completion(&completion); | 
| Arjan van de Ven | 0043170 | 2006-01-12 18:42:23 +0000 | [diff] [blame] | 312 | 	mutex_unlock(&ecard_mutex); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 313 | } | 
 | 314 |  | 
 | 315 | /* ======================= Mid-level card control ===================== */ | 
 | 316 |  | 
 | 317 | static void | 
 | 318 | ecard_readbytes(void *addr, ecard_t *ec, int off, int len, int useld) | 
 | 319 | { | 
 | 320 | 	struct ecard_request req; | 
 | 321 |  | 
 | 322 | 	req.fn		= ecard_task_readbytes; | 
 | 323 | 	req.ec		= ec; | 
 | 324 | 	req.address	= off; | 
 | 325 | 	req.length	= len; | 
 | 326 | 	req.use_loader	= useld; | 
 | 327 | 	req.buffer	= addr; | 
 | 328 |  | 
 | 329 | 	ecard_call(&req); | 
 | 330 | } | 
 | 331 |  | 
 | 332 | int ecard_readchunk(struct in_chunk_dir *cd, ecard_t *ec, int id, int num) | 
 | 333 | { | 
 | 334 | 	struct ex_chunk_dir excd; | 
 | 335 | 	int index = 16; | 
 | 336 | 	int useld = 0; | 
 | 337 |  | 
 | 338 | 	if (!ec->cid.cd) | 
 | 339 | 		return 0; | 
 | 340 |  | 
 | 341 | 	while(1) { | 
 | 342 | 		ecard_readbytes(&excd, ec, index, 8, useld); | 
 | 343 | 		index += 8; | 
 | 344 | 		if (c_id(&excd) == 0) { | 
 | 345 | 			if (!useld && ec->loader) { | 
 | 346 | 				useld = 1; | 
 | 347 | 				index = 0; | 
 | 348 | 				continue; | 
 | 349 | 			} | 
 | 350 | 			return 0; | 
 | 351 | 		} | 
 | 352 | 		if (c_id(&excd) == 0xf0) { /* link */ | 
 | 353 | 			index = c_start(&excd); | 
 | 354 | 			continue; | 
 | 355 | 		} | 
 | 356 | 		if (c_id(&excd) == 0x80) { /* loader */ | 
 | 357 | 			if (!ec->loader) { | 
| Robert P. J. Day | 5cbded5 | 2006-12-13 00:35:56 -0800 | [diff] [blame] | 358 | 				ec->loader = kmalloc(c_len(&excd), | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 359 | 							       GFP_KERNEL); | 
 | 360 | 				if (ec->loader) | 
 | 361 | 					ecard_readbytes(ec->loader, ec, | 
 | 362 | 							(int)c_start(&excd), | 
 | 363 | 							c_len(&excd), useld); | 
 | 364 | 				else | 
 | 365 | 					return 0; | 
 | 366 | 			} | 
 | 367 | 			continue; | 
 | 368 | 		} | 
 | 369 | 		if (c_id(&excd) == id && num-- == 0) | 
 | 370 | 			break; | 
 | 371 | 	} | 
 | 372 |  | 
 | 373 | 	if (c_id(&excd) & 0x80) { | 
 | 374 | 		switch (c_id(&excd) & 0x70) { | 
 | 375 | 		case 0x70: | 
 | 376 | 			ecard_readbytes((unsigned char *)excd.d.string, ec, | 
 | 377 | 					(int)c_start(&excd), c_len(&excd), | 
 | 378 | 					useld); | 
 | 379 | 			break; | 
 | 380 | 		case 0x00: | 
 | 381 | 			break; | 
 | 382 | 		} | 
 | 383 | 	} | 
 | 384 | 	cd->start_offset = c_start(&excd); | 
 | 385 | 	memcpy(cd->d.string, excd.d.string, 256); | 
 | 386 | 	return 1; | 
 | 387 | } | 
 | 388 |  | 
 | 389 | /* ======================= Interrupt control ============================ */ | 
 | 390 |  | 
 | 391 | static void ecard_def_irq_enable(ecard_t *ec, int irqnr) | 
 | 392 | { | 
 | 393 | #ifdef HAS_EXPMASK | 
 | 394 | 	if (irqnr < 4 && have_expmask) { | 
 | 395 | 		have_expmask |= 1 << irqnr; | 
 | 396 | 		__raw_writeb(have_expmask, EXPMASK_ENABLE); | 
 | 397 | 	} | 
 | 398 | #endif | 
 | 399 | } | 
 | 400 |  | 
 | 401 | static void ecard_def_irq_disable(ecard_t *ec, int irqnr) | 
 | 402 | { | 
 | 403 | #ifdef HAS_EXPMASK | 
 | 404 | 	if (irqnr < 4 && have_expmask) { | 
 | 405 | 		have_expmask &= ~(1 << irqnr); | 
 | 406 | 		__raw_writeb(have_expmask, EXPMASK_ENABLE); | 
 | 407 | 	} | 
 | 408 | #endif | 
 | 409 | } | 
 | 410 |  | 
 | 411 | static int ecard_def_irq_pending(ecard_t *ec) | 
 | 412 | { | 
 | 413 | 	return !ec->irqmask || readb(ec->irqaddr) & ec->irqmask; | 
 | 414 | } | 
 | 415 |  | 
 | 416 | static void ecard_def_fiq_enable(ecard_t *ec, int fiqnr) | 
 | 417 | { | 
 | 418 | 	panic("ecard_def_fiq_enable called - impossible"); | 
 | 419 | } | 
 | 420 |  | 
 | 421 | static void ecard_def_fiq_disable(ecard_t *ec, int fiqnr) | 
 | 422 | { | 
 | 423 | 	panic("ecard_def_fiq_disable called - impossible"); | 
 | 424 | } | 
 | 425 |  | 
 | 426 | static int ecard_def_fiq_pending(ecard_t *ec) | 
 | 427 | { | 
 | 428 | 	return !ec->fiqmask || readb(ec->fiqaddr) & ec->fiqmask; | 
 | 429 | } | 
 | 430 |  | 
 | 431 | static expansioncard_ops_t ecard_default_ops = { | 
 | 432 | 	ecard_def_irq_enable, | 
 | 433 | 	ecard_def_irq_disable, | 
 | 434 | 	ecard_def_irq_pending, | 
 | 435 | 	ecard_def_fiq_enable, | 
 | 436 | 	ecard_def_fiq_disable, | 
 | 437 | 	ecard_def_fiq_pending | 
 | 438 | }; | 
 | 439 |  | 
 | 440 | /* | 
 | 441 |  * Enable and disable interrupts from expansion cards. | 
 | 442 |  * (interrupts are disabled for these functions). | 
 | 443 |  * | 
 | 444 |  * They are not meant to be called directly, but via enable/disable_irq. | 
 | 445 |  */ | 
| Lennert Buytenhek | 4a87bac | 2010-11-29 10:21:01 +0100 | [diff] [blame] | 446 | static void ecard_irq_unmask(struct irq_data *d) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 447 | { | 
| Lennert Buytenhek | 4a87bac | 2010-11-29 10:21:01 +0100 | [diff] [blame] | 448 | 	ecard_t *ec = slot_to_ecard(d->irq - 32); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 449 |  | 
 | 450 | 	if (ec) { | 
 | 451 | 		if (!ec->ops) | 
 | 452 | 			ec->ops = &ecard_default_ops; | 
 | 453 |  | 
 | 454 | 		if (ec->claimed && ec->ops->irqenable) | 
| Lennert Buytenhek | 4a87bac | 2010-11-29 10:21:01 +0100 | [diff] [blame] | 455 | 			ec->ops->irqenable(ec, d->irq); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 456 | 		else | 
 | 457 | 			printk(KERN_ERR "ecard: rejecting request to " | 
| Lennert Buytenhek | 4a87bac | 2010-11-29 10:21:01 +0100 | [diff] [blame] | 458 | 				"enable IRQs for %d\n", d->irq); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 459 | 	} | 
 | 460 | } | 
 | 461 |  | 
| Lennert Buytenhek | 4a87bac | 2010-11-29 10:21:01 +0100 | [diff] [blame] | 462 | static void ecard_irq_mask(struct irq_data *d) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 463 | { | 
| Lennert Buytenhek | 4a87bac | 2010-11-29 10:21:01 +0100 | [diff] [blame] | 464 | 	ecard_t *ec = slot_to_ecard(d->irq - 32); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 465 |  | 
 | 466 | 	if (ec) { | 
 | 467 | 		if (!ec->ops) | 
 | 468 | 			ec->ops = &ecard_default_ops; | 
 | 469 |  | 
 | 470 | 		if (ec->ops && ec->ops->irqdisable) | 
| Lennert Buytenhek | 4a87bac | 2010-11-29 10:21:01 +0100 | [diff] [blame] | 471 | 			ec->ops->irqdisable(ec, d->irq); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 472 | 	} | 
 | 473 | } | 
 | 474 |  | 
| David Brownell | 38c677c | 2006-08-01 22:26:25 +0100 | [diff] [blame] | 475 | static struct irq_chip ecard_chip = { | 
| Lennert Buytenhek | 4a87bac | 2010-11-29 10:21:01 +0100 | [diff] [blame] | 476 | 	.name		= "ECARD", | 
 | 477 | 	.irq_ack	= ecard_irq_mask, | 
 | 478 | 	.irq_mask	= ecard_irq_mask, | 
 | 479 | 	.irq_unmask	= ecard_irq_unmask, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 480 | }; | 
 | 481 |  | 
 | 482 | void ecard_enablefiq(unsigned int fiqnr) | 
 | 483 | { | 
 | 484 | 	ecard_t *ec = slot_to_ecard(fiqnr); | 
 | 485 |  | 
 | 486 | 	if (ec) { | 
 | 487 | 		if (!ec->ops) | 
 | 488 | 			ec->ops = &ecard_default_ops; | 
 | 489 |  | 
 | 490 | 		if (ec->claimed && ec->ops->fiqenable) | 
 | 491 | 			ec->ops->fiqenable(ec, fiqnr); | 
 | 492 | 		else | 
 | 493 | 			printk(KERN_ERR "ecard: rejecting request to " | 
 | 494 | 				"enable FIQs for %d\n", fiqnr); | 
 | 495 | 	} | 
 | 496 | } | 
 | 497 |  | 
 | 498 | void ecard_disablefiq(unsigned int fiqnr) | 
 | 499 | { | 
 | 500 | 	ecard_t *ec = slot_to_ecard(fiqnr); | 
 | 501 |  | 
 | 502 | 	if (ec) { | 
 | 503 | 		if (!ec->ops) | 
 | 504 | 			ec->ops = &ecard_default_ops; | 
 | 505 |  | 
 | 506 | 		if (ec->ops->fiqdisable) | 
 | 507 | 			ec->ops->fiqdisable(ec, fiqnr); | 
 | 508 | 	} | 
 | 509 | } | 
 | 510 |  | 
 | 511 | static void ecard_dump_irq_state(void) | 
 | 512 | { | 
 | 513 | 	ecard_t *ec; | 
 | 514 |  | 
 | 515 | 	printk("Expansion card IRQ state:\n"); | 
 | 516 |  | 
 | 517 | 	for (ec = cards; ec; ec = ec->next) { | 
 | 518 | 		if (ec->slot_no == 8) | 
 | 519 | 			continue; | 
 | 520 |  | 
 | 521 | 		printk("  %d: %sclaimed, ", | 
 | 522 | 		       ec->slot_no, ec->claimed ? "" : "not "); | 
 | 523 |  | 
 | 524 | 		if (ec->ops && ec->ops->irqpending && | 
 | 525 | 		    ec->ops != &ecard_default_ops) | 
 | 526 | 			printk("irq %spending\n", | 
 | 527 | 			       ec->ops->irqpending(ec) ? "" : "not "); | 
 | 528 | 		else | 
 | 529 | 			printk("irqaddr %p, mask = %02X, status = %02X\n", | 
 | 530 | 			       ec->irqaddr, ec->irqmask, readb(ec->irqaddr)); | 
 | 531 | 	} | 
 | 532 | } | 
 | 533 |  | 
| Russell King | 10dd5ce | 2006-11-23 11:41:32 +0000 | [diff] [blame] | 534 | static void ecard_check_lockup(struct irq_desc *desc) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 535 | { | 
 | 536 | 	static unsigned long last; | 
 | 537 | 	static int lockup; | 
 | 538 |  | 
 | 539 | 	/* | 
 | 540 | 	 * If the timer interrupt has not run since the last million | 
 | 541 | 	 * unrecognised expansion card interrupts, then there is | 
 | 542 | 	 * something seriously wrong.  Disable the expansion card | 
 | 543 | 	 * interrupts so at least we can continue. | 
 | 544 | 	 * | 
 | 545 | 	 * Maybe we ought to start a timer to re-enable them some time | 
 | 546 | 	 * later? | 
 | 547 | 	 */ | 
 | 548 | 	if (last == jiffies) { | 
 | 549 | 		lockup += 1; | 
 | 550 | 		if (lockup > 1000000) { | 
 | 551 | 			printk(KERN_ERR "\nInterrupt lockup detected - " | 
 | 552 | 			       "disabling all expansion card interrupts\n"); | 
 | 553 |  | 
| Lennert Buytenhek | 4a87bac | 2010-11-29 10:21:01 +0100 | [diff] [blame] | 554 | 			desc->irq_data.chip->irq_mask(&desc->irq_data); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 555 | 			ecard_dump_irq_state(); | 
 | 556 | 		} | 
 | 557 | 	} else | 
 | 558 | 		lockup = 0; | 
 | 559 |  | 
 | 560 | 	/* | 
 | 561 | 	 * If we did not recognise the source of this interrupt, | 
 | 562 | 	 * warn the user, but don't flood the user with these messages. | 
 | 563 | 	 */ | 
 | 564 | 	if (!last || time_after(jiffies, last + 5*HZ)) { | 
 | 565 | 		last = jiffies; | 
 | 566 | 		printk(KERN_WARNING "Unrecognised interrupt from backplane\n"); | 
 | 567 | 		ecard_dump_irq_state(); | 
 | 568 | 	} | 
 | 569 | } | 
 | 570 |  | 
 | 571 | static void | 
| Russell King | 10dd5ce | 2006-11-23 11:41:32 +0000 | [diff] [blame] | 572 | ecard_irq_handler(unsigned int irq, struct irq_desc *desc) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 573 | { | 
 | 574 | 	ecard_t *ec; | 
 | 575 | 	int called = 0; | 
 | 576 |  | 
| Lennert Buytenhek | 4a87bac | 2010-11-29 10:21:01 +0100 | [diff] [blame] | 577 | 	desc->irq_data.chip->irq_mask(&desc->irq_data); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 578 | 	for (ec = cards; ec; ec = ec->next) { | 
 | 579 | 		int pending; | 
 | 580 |  | 
 | 581 | 		if (!ec->claimed || ec->irq == NO_IRQ || ec->slot_no == 8) | 
 | 582 | 			continue; | 
 | 583 |  | 
 | 584 | 		if (ec->ops && ec->ops->irqpending) | 
 | 585 | 			pending = ec->ops->irqpending(ec); | 
 | 586 | 		else | 
 | 587 | 			pending = ecard_default_ops.irqpending(ec); | 
 | 588 |  | 
 | 589 | 		if (pending) { | 
| Dmitry Baryshkov | d8aa025 | 2008-10-09 13:36:24 +0100 | [diff] [blame] | 590 | 			generic_handle_irq(ec->irq); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 591 | 			called ++; | 
 | 592 | 		} | 
 | 593 | 	} | 
| Lennert Buytenhek | 4a87bac | 2010-11-29 10:21:01 +0100 | [diff] [blame] | 594 | 	desc->irq_data.chip->irq_unmask(&desc->irq_data); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 595 |  | 
 | 596 | 	if (called == 0) | 
 | 597 | 		ecard_check_lockup(desc); | 
 | 598 | } | 
 | 599 |  | 
 | 600 | #ifdef HAS_EXPMASK | 
 | 601 | static unsigned char priority_masks[] = | 
 | 602 | { | 
 | 603 | 	0xf0, 0xf1, 0xf3, 0xf7, 0xff, 0xff, 0xff, 0xff | 
 | 604 | }; | 
 | 605 |  | 
 | 606 | static unsigned char first_set[] = | 
 | 607 | { | 
 | 608 | 	0x00, 0x00, 0x01, 0x00, 0x02, 0x00, 0x01, 0x00, | 
 | 609 | 	0x03, 0x00, 0x01, 0x00, 0x02, 0x00, 0x01, 0x00 | 
 | 610 | }; | 
 | 611 |  | 
 | 612 | static void | 
| Russell King | 10dd5ce | 2006-11-23 11:41:32 +0000 | [diff] [blame] | 613 | ecard_irqexp_handler(unsigned int irq, struct irq_desc *desc) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 614 | { | 
 | 615 | 	const unsigned int statusmask = 15; | 
 | 616 | 	unsigned int status; | 
 | 617 |  | 
 | 618 | 	status = __raw_readb(EXPMASK_STATUS) & statusmask; | 
 | 619 | 	if (status) { | 
 | 620 | 		unsigned int slot = first_set[status]; | 
 | 621 | 		ecard_t *ec = slot_to_ecard(slot); | 
 | 622 |  | 
 | 623 | 		if (ec->claimed) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 624 | 			/* | 
 | 625 | 			 * this ugly code is so that we can operate a | 
 | 626 | 			 * prioritorising system: | 
 | 627 | 			 * | 
 | 628 | 			 * Card 0 	highest priority | 
 | 629 | 			 * Card 1 | 
 | 630 | 			 * Card 2 | 
 | 631 | 			 * Card 3	lowest priority | 
 | 632 | 			 * | 
 | 633 | 			 * Serial cards should go in 0/1, ethernet/scsi in 2/3 | 
 | 634 | 			 * otherwise you will lose serial data at high speeds! | 
 | 635 | 			 */ | 
| Dmitry Baryshkov | d8aa025 | 2008-10-09 13:36:24 +0100 | [diff] [blame] | 636 | 			generic_handle_irq(ec->irq); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 637 | 		} else { | 
 | 638 | 			printk(KERN_WARNING "card%d: interrupt from unclaimed " | 
 | 639 | 			       "card???\n", slot); | 
 | 640 | 			have_expmask &= ~(1 << slot); | 
 | 641 | 			__raw_writeb(have_expmask, EXPMASK_ENABLE); | 
 | 642 | 		} | 
 | 643 | 	} else | 
 | 644 | 		printk(KERN_WARNING "Wild interrupt from backplane (masks)\n"); | 
 | 645 | } | 
 | 646 |  | 
 | 647 | static int __init ecard_probeirqhw(void) | 
 | 648 | { | 
 | 649 | 	ecard_t *ec; | 
 | 650 | 	int found; | 
 | 651 |  | 
 | 652 | 	__raw_writeb(0x00, EXPMASK_ENABLE); | 
 | 653 | 	__raw_writeb(0xff, EXPMASK_STATUS); | 
 | 654 | 	found = (__raw_readb(EXPMASK_STATUS) & 15) == 0; | 
 | 655 | 	__raw_writeb(0xff, EXPMASK_ENABLE); | 
 | 656 |  | 
 | 657 | 	if (found) { | 
 | 658 | 		printk(KERN_DEBUG "Expansion card interrupt " | 
 | 659 | 		       "management hardware found\n"); | 
 | 660 |  | 
 | 661 | 		/* for each card present, set a bit to '1' */ | 
 | 662 | 		have_expmask = 0x80000000; | 
 | 663 |  | 
 | 664 | 		for (ec = cards; ec; ec = ec->next) | 
 | 665 | 			have_expmask |= 1 << ec->slot_no; | 
 | 666 |  | 
 | 667 | 		__raw_writeb(have_expmask, EXPMASK_ENABLE); | 
 | 668 | 	} | 
 | 669 |  | 
 | 670 | 	return found; | 
 | 671 | } | 
 | 672 | #else | 
 | 673 | #define ecard_irqexp_handler NULL | 
 | 674 | #define ecard_probeirqhw() (0) | 
 | 675 | #endif | 
 | 676 |  | 
| Russell King | 1ace756 | 2011-07-07 10:56:41 +0100 | [diff] [blame] | 677 | static void __iomem *__ecard_address(ecard_t *ec, card_type_t type, card_speed_t speed) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 678 | { | 
| Russell King | 06cf0b5 | 2011-07-07 11:07:36 +0100 | [diff] [blame] | 679 | 	void __iomem *address = NULL; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 680 | 	int slot = ec->slot_no; | 
 | 681 |  | 
 | 682 | 	if (ec->slot_no == 8) | 
| Russell King | 06cf0b5 | 2011-07-07 11:07:36 +0100 | [diff] [blame] | 683 | 		return ECARD_MEMC8_BASE; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 684 |  | 
 | 685 | 	ectcr &= ~(1 << slot); | 
 | 686 |  | 
 | 687 | 	switch (type) { | 
 | 688 | 	case ECARD_MEMC: | 
 | 689 | 		if (slot < 4) | 
| Russell King | 06cf0b5 | 2011-07-07 11:07:36 +0100 | [diff] [blame] | 690 | 			address = ECARD_MEMC_BASE + (slot << 14); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 691 | 		break; | 
 | 692 |  | 
 | 693 | 	case ECARD_IOC: | 
 | 694 | 		if (slot < 4) | 
| Russell King | 06cf0b5 | 2011-07-07 11:07:36 +0100 | [diff] [blame] | 695 | 			address = ECARD_IOC_BASE + (slot << 14); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 696 | 		else | 
| Russell King | 06cf0b5 | 2011-07-07 11:07:36 +0100 | [diff] [blame] | 697 | 			address = ECARD_IOC4_BASE + ((slot - 4) << 14); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 698 | 		if (address) | 
| Russell King | 06cf0b5 | 2011-07-07 11:07:36 +0100 | [diff] [blame] | 699 | 			address += speed << 19; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 700 | 		break; | 
 | 701 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 702 | 	case ECARD_EASI: | 
| Russell King | 06cf0b5 | 2011-07-07 11:07:36 +0100 | [diff] [blame] | 703 | 		address = ECARD_EASI_BASE + (slot << 24); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 704 | 		if (speed == ECARD_FAST) | 
 | 705 | 			ectcr |= 1 << slot; | 
 | 706 | 		break; | 
| Russell King | 06cf0b5 | 2011-07-07 11:07:36 +0100 | [diff] [blame] | 707 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 708 | 	default: | 
 | 709 | 		break; | 
 | 710 | 	} | 
 | 711 |  | 
 | 712 | #ifdef IOMD_ECTCR | 
 | 713 | 	iomd_writeb(ectcr, IOMD_ECTCR); | 
 | 714 | #endif | 
| Russell King | 06cf0b5 | 2011-07-07 11:07:36 +0100 | [diff] [blame] | 715 | 	return address; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 716 | } | 
 | 717 |  | 
| Alexey Dobriyan | 9b00121 | 2008-04-29 01:01:49 -0700 | [diff] [blame] | 718 | static int ecard_prints(struct seq_file *m, ecard_t *ec) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 719 | { | 
| Alexey Dobriyan | 9b00121 | 2008-04-29 01:01:49 -0700 | [diff] [blame] | 720 | 	seq_printf(m, "  %d: %s ", ec->slot_no, ec->easi ? "EASI" : "    "); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 721 |  | 
 | 722 | 	if (ec->cid.id == 0) { | 
 | 723 | 		struct in_chunk_dir incd; | 
 | 724 |  | 
| Alexey Dobriyan | 9b00121 | 2008-04-29 01:01:49 -0700 | [diff] [blame] | 725 | 		seq_printf(m, "[%04X:%04X] ", | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 726 | 			ec->cid.manufacturer, ec->cid.product); | 
 | 727 |  | 
 | 728 | 		if (!ec->card_desc && ec->cid.cd && | 
 | 729 | 		    ecard_readchunk(&incd, ec, 0xf5, 0)) { | 
 | 730 | 			ec->card_desc = kmalloc(strlen(incd.d.string)+1, GFP_KERNEL); | 
 | 731 |  | 
 | 732 | 			if (ec->card_desc) | 
 | 733 | 				strcpy((char *)ec->card_desc, incd.d.string); | 
 | 734 | 		} | 
 | 735 |  | 
| Alexey Dobriyan | 9b00121 | 2008-04-29 01:01:49 -0700 | [diff] [blame] | 736 | 		seq_printf(m, "%s\n", ec->card_desc ? ec->card_desc : "*unknown*"); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 737 | 	} else | 
| Alexey Dobriyan | 9b00121 | 2008-04-29 01:01:49 -0700 | [diff] [blame] | 738 | 		seq_printf(m, "Simple card %d\n", ec->cid.id); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 739 |  | 
| Alexey Dobriyan | 9b00121 | 2008-04-29 01:01:49 -0700 | [diff] [blame] | 740 | 	return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 741 | } | 
 | 742 |  | 
| Alexey Dobriyan | 9b00121 | 2008-04-29 01:01:49 -0700 | [diff] [blame] | 743 | static int ecard_devices_proc_show(struct seq_file *m, void *v) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 744 | { | 
 | 745 | 	ecard_t *ec = cards; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 746 |  | 
| Alexey Dobriyan | 9b00121 | 2008-04-29 01:01:49 -0700 | [diff] [blame] | 747 | 	while (ec) { | 
 | 748 | 		ecard_prints(m, ec); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 749 | 		ec = ec->next; | 
 | 750 | 	} | 
| Alexey Dobriyan | 9b00121 | 2008-04-29 01:01:49 -0700 | [diff] [blame] | 751 | 	return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 752 | } | 
 | 753 |  | 
| Alexey Dobriyan | 9b00121 | 2008-04-29 01:01:49 -0700 | [diff] [blame] | 754 | static int ecard_devices_proc_open(struct inode *inode, struct file *file) | 
 | 755 | { | 
 | 756 | 	return single_open(file, ecard_devices_proc_show, NULL); | 
 | 757 | } | 
 | 758 |  | 
 | 759 | static const struct file_operations bus_ecard_proc_fops = { | 
 | 760 | 	.owner		= THIS_MODULE, | 
 | 761 | 	.open		= ecard_devices_proc_open, | 
 | 762 | 	.read		= seq_read, | 
 | 763 | 	.llseek		= seq_lseek, | 
 | 764 | 	.release	= single_release, | 
 | 765 | }; | 
 | 766 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 767 | static struct proc_dir_entry *proc_bus_ecard_dir = NULL; | 
 | 768 |  | 
 | 769 | static void ecard_proc_init(void) | 
 | 770 | { | 
| Alexey Dobriyan | 9c37066 | 2008-04-29 01:01:41 -0700 | [diff] [blame] | 771 | 	proc_bus_ecard_dir = proc_mkdir("bus/ecard", NULL); | 
| Alexey Dobriyan | 9b00121 | 2008-04-29 01:01:49 -0700 | [diff] [blame] | 772 | 	proc_create("devices", 0, proc_bus_ecard_dir, &bus_ecard_proc_fops); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 773 | } | 
 | 774 |  | 
 | 775 | #define ec_set_resource(ec,nr,st,sz)				\ | 
 | 776 | 	do {							\ | 
| Kay Sievers | 3f978704 | 2008-05-30 17:42:11 +0200 | [diff] [blame] | 777 | 		(ec)->resource[nr].name = dev_name(&ec->dev);	\ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 778 | 		(ec)->resource[nr].start = st;			\ | 
 | 779 | 		(ec)->resource[nr].end = (st) + (sz) - 1;	\ | 
 | 780 | 		(ec)->resource[nr].flags = IORESOURCE_MEM;	\ | 
 | 781 | 	} while (0) | 
 | 782 |  | 
 | 783 | static void __init ecard_free_card(struct expansion_card *ec) | 
 | 784 | { | 
 | 785 | 	int i; | 
 | 786 |  | 
 | 787 | 	for (i = 0; i < ECARD_NUM_RESOURCES; i++) | 
 | 788 | 		if (ec->resource[i].flags) | 
 | 789 | 			release_resource(&ec->resource[i]); | 
 | 790 |  | 
 | 791 | 	kfree(ec); | 
 | 792 | } | 
 | 793 |  | 
 | 794 | static struct expansion_card *__init ecard_alloc_card(int type, int slot) | 
 | 795 | { | 
 | 796 | 	struct expansion_card *ec; | 
 | 797 | 	unsigned long base; | 
 | 798 | 	int i; | 
 | 799 |  | 
| Russell King | d2a02b9 | 2006-03-20 19:46:41 +0000 | [diff] [blame] | 800 | 	ec = kzalloc(sizeof(ecard_t), GFP_KERNEL); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 801 | 	if (!ec) { | 
 | 802 | 		ec = ERR_PTR(-ENOMEM); | 
 | 803 | 		goto nomem; | 
 | 804 | 	} | 
 | 805 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 806 | 	ec->slot_no = slot; | 
| Russell King | 5559bca | 2007-05-03 10:47:37 +0100 | [diff] [blame] | 807 | 	ec->easi = type == ECARD_EASI; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 808 | 	ec->irq = NO_IRQ; | 
 | 809 | 	ec->fiq = NO_IRQ; | 
 | 810 | 	ec->dma = NO_DMA; | 
 | 811 | 	ec->ops = &ecard_default_ops; | 
 | 812 |  | 
| Kay Sievers | 1d559e2 | 2009-01-06 10:44:43 -0800 | [diff] [blame] | 813 | 	dev_set_name(&ec->dev, "ecard%d", slot); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 814 | 	ec->dev.parent = NULL; | 
 | 815 | 	ec->dev.bus = &ecard_bus_type; | 
 | 816 | 	ec->dev.dma_mask = &ec->dma_mask; | 
 | 817 | 	ec->dma_mask = (u64)0xffffffff; | 
| Russell King | 69f4f33 | 2007-04-02 13:53:15 +0100 | [diff] [blame] | 818 | 	ec->dev.coherent_dma_mask = ec->dma_mask; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 819 |  | 
 | 820 | 	if (slot < 4) { | 
 | 821 | 		ec_set_resource(ec, ECARD_RES_MEMC, | 
 | 822 | 				PODSLOT_MEMC_BASE + (slot << 14), | 
 | 823 | 				PODSLOT_MEMC_SIZE); | 
 | 824 | 		base = PODSLOT_IOC0_BASE + (slot << 14); | 
 | 825 | 	} else | 
 | 826 | 		base = PODSLOT_IOC4_BASE + ((slot - 4) << 14); | 
 | 827 |  | 
 | 828 | #ifdef CONFIG_ARCH_RPC | 
 | 829 | 	if (slot < 8) { | 
 | 830 | 		ec_set_resource(ec, ECARD_RES_EASI, | 
 | 831 | 				PODSLOT_EASI_BASE + (slot << 24), | 
 | 832 | 				PODSLOT_EASI_SIZE); | 
 | 833 | 	} | 
 | 834 |  | 
 | 835 | 	if (slot == 8) { | 
 | 836 | 		ec_set_resource(ec, ECARD_RES_MEMC, NETSLOT_BASE, NETSLOT_SIZE); | 
 | 837 | 	} else | 
 | 838 | #endif | 
 | 839 |  | 
 | 840 | 	for (i = 0; i <= ECARD_RES_IOCSYNC - ECARD_RES_IOCSLOW; i++) | 
 | 841 | 		ec_set_resource(ec, i + ECARD_RES_IOCSLOW, | 
 | 842 | 				base + (i << 19), PODSLOT_IOC_SIZE); | 
 | 843 |  | 
 | 844 | 	for (i = 0; i < ECARD_NUM_RESOURCES; i++) { | 
 | 845 | 		if (ec->resource[i].flags && | 
 | 846 | 		    request_resource(&iomem_resource, &ec->resource[i])) { | 
| Greg Kroah-Hartman | fc3a882 | 2008-05-02 06:02:41 +0200 | [diff] [blame] | 847 | 			dev_err(&ec->dev, "resource(s) not available\n"); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 848 | 			ec->resource[i].end -= ec->resource[i].start; | 
 | 849 | 			ec->resource[i].start = 0; | 
 | 850 | 			ec->resource[i].flags = 0; | 
 | 851 | 		} | 
 | 852 | 	} | 
 | 853 |  | 
 | 854 |  nomem: | 
 | 855 | 	return ec; | 
 | 856 | } | 
 | 857 |  | 
| Yani Ioannou | ff381d2 | 2005-05-17 06:40:51 -0400 | [diff] [blame] | 858 | static ssize_t ecard_show_irq(struct device *dev, struct device_attribute *attr, char *buf) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 859 | { | 
 | 860 | 	struct expansion_card *ec = ECARD_DEV(dev); | 
 | 861 | 	return sprintf(buf, "%u\n", ec->irq); | 
 | 862 | } | 
 | 863 |  | 
| Yani Ioannou | ff381d2 | 2005-05-17 06:40:51 -0400 | [diff] [blame] | 864 | static ssize_t ecard_show_dma(struct device *dev, struct device_attribute *attr, char *buf) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 865 | { | 
 | 866 | 	struct expansion_card *ec = ECARD_DEV(dev); | 
 | 867 | 	return sprintf(buf, "%u\n", ec->dma); | 
 | 868 | } | 
 | 869 |  | 
| Yani Ioannou | ff381d2 | 2005-05-17 06:40:51 -0400 | [diff] [blame] | 870 | static ssize_t ecard_show_resources(struct device *dev, struct device_attribute *attr, char *buf) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 871 | { | 
 | 872 | 	struct expansion_card *ec = ECARD_DEV(dev); | 
 | 873 | 	char *str = buf; | 
 | 874 | 	int i; | 
 | 875 |  | 
 | 876 | 	for (i = 0; i < ECARD_NUM_RESOURCES; i++) | 
| Russell King | c9e4143 | 2006-07-03 13:29:03 +0100 | [diff] [blame] | 877 | 		str += sprintf(str, "%08x %08x %08lx\n", | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 878 | 				ec->resource[i].start, | 
 | 879 | 				ec->resource[i].end, | 
 | 880 | 				ec->resource[i].flags); | 
 | 881 |  | 
 | 882 | 	return str - buf; | 
 | 883 | } | 
 | 884 |  | 
| Yani Ioannou | ff381d2 | 2005-05-17 06:40:51 -0400 | [diff] [blame] | 885 | static ssize_t ecard_show_vendor(struct device *dev, struct device_attribute *attr, char *buf) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 886 | { | 
 | 887 | 	struct expansion_card *ec = ECARD_DEV(dev); | 
 | 888 | 	return sprintf(buf, "%u\n", ec->cid.manufacturer); | 
 | 889 | } | 
 | 890 |  | 
| Yani Ioannou | ff381d2 | 2005-05-17 06:40:51 -0400 | [diff] [blame] | 891 | static ssize_t ecard_show_device(struct device *dev, struct device_attribute *attr, char *buf) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 892 | { | 
 | 893 | 	struct expansion_card *ec = ECARD_DEV(dev); | 
 | 894 | 	return sprintf(buf, "%u\n", ec->cid.product); | 
 | 895 | } | 
 | 896 |  | 
| Yani Ioannou | ff381d2 | 2005-05-17 06:40:51 -0400 | [diff] [blame] | 897 | static ssize_t ecard_show_type(struct device *dev, struct device_attribute *attr, char *buf) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 898 | { | 
 | 899 | 	struct expansion_card *ec = ECARD_DEV(dev); | 
| Russell King | 5559bca | 2007-05-03 10:47:37 +0100 | [diff] [blame] | 900 | 	return sprintf(buf, "%s\n", ec->easi ? "EASI" : "IOC"); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 901 | } | 
 | 902 |  | 
 | 903 | static struct device_attribute ecard_dev_attrs[] = { | 
 | 904 | 	__ATTR(device,   S_IRUGO, ecard_show_device,    NULL), | 
 | 905 | 	__ATTR(dma,      S_IRUGO, ecard_show_dma,       NULL), | 
 | 906 | 	__ATTR(irq,      S_IRUGO, ecard_show_irq,       NULL), | 
 | 907 | 	__ATTR(resource, S_IRUGO, ecard_show_resources, NULL), | 
 | 908 | 	__ATTR(type,     S_IRUGO, ecard_show_type,      NULL), | 
 | 909 | 	__ATTR(vendor,   S_IRUGO, ecard_show_vendor,    NULL), | 
 | 910 | 	__ATTR_NULL, | 
 | 911 | }; | 
 | 912 |  | 
 | 913 |  | 
 | 914 | int ecard_request_resources(struct expansion_card *ec) | 
 | 915 | { | 
 | 916 | 	int i, err = 0; | 
 | 917 |  | 
 | 918 | 	for (i = 0; i < ECARD_NUM_RESOURCES; i++) { | 
 | 919 | 		if (ecard_resource_end(ec, i) && | 
 | 920 | 		    !request_mem_region(ecard_resource_start(ec, i), | 
 | 921 | 					ecard_resource_len(ec, i), | 
 | 922 | 					ec->dev.driver->name)) { | 
 | 923 | 			err = -EBUSY; | 
 | 924 | 			break; | 
 | 925 | 		} | 
 | 926 | 	} | 
 | 927 |  | 
 | 928 | 	if (err) { | 
 | 929 | 		while (i--) | 
 | 930 | 			if (ecard_resource_end(ec, i)) | 
 | 931 | 				release_mem_region(ecard_resource_start(ec, i), | 
 | 932 | 						   ecard_resource_len(ec, i)); | 
 | 933 | 	} | 
 | 934 | 	return err; | 
 | 935 | } | 
 | 936 | EXPORT_SYMBOL(ecard_request_resources); | 
 | 937 |  | 
 | 938 | void ecard_release_resources(struct expansion_card *ec) | 
 | 939 | { | 
 | 940 | 	int i; | 
 | 941 |  | 
 | 942 | 	for (i = 0; i < ECARD_NUM_RESOURCES; i++) | 
 | 943 | 		if (ecard_resource_end(ec, i)) | 
 | 944 | 			release_mem_region(ecard_resource_start(ec, i), | 
 | 945 | 					   ecard_resource_len(ec, i)); | 
 | 946 | } | 
 | 947 | EXPORT_SYMBOL(ecard_release_resources); | 
 | 948 |  | 
| Russell King | c7b87f3 | 2007-05-10 16:46:13 +0100 | [diff] [blame] | 949 | void ecard_setirq(struct expansion_card *ec, const struct expansion_card_ops *ops, void *irq_data) | 
 | 950 | { | 
 | 951 | 	ec->irq_data = irq_data; | 
 | 952 | 	barrier(); | 
 | 953 | 	ec->ops = ops; | 
 | 954 | } | 
 | 955 | EXPORT_SYMBOL(ecard_setirq); | 
 | 956 |  | 
| Russell King | 10bdaaa | 2007-05-10 18:40:51 +0100 | [diff] [blame] | 957 | void __iomem *ecardm_iomap(struct expansion_card *ec, unsigned int res, | 
 | 958 | 			   unsigned long offset, unsigned long maxsize) | 
 | 959 | { | 
 | 960 | 	unsigned long start = ecard_resource_start(ec, res); | 
 | 961 | 	unsigned long end = ecard_resource_end(ec, res); | 
 | 962 |  | 
 | 963 | 	if (offset > (end - start)) | 
 | 964 | 		return NULL; | 
 | 965 |  | 
 | 966 | 	start += offset; | 
 | 967 | 	if (maxsize && end - start > maxsize) | 
 | 968 | 		end = start + maxsize; | 
 | 969 | 	 | 
 | 970 | 	return devm_ioremap(&ec->dev, start, end - start); | 
 | 971 | } | 
 | 972 | EXPORT_SYMBOL(ecardm_iomap); | 
 | 973 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 974 | /* | 
 | 975 |  * Probe for an expansion card. | 
 | 976 |  * | 
 | 977 |  * If bit 1 of the first byte of the card is set, then the | 
 | 978 |  * card does not exist. | 
 | 979 |  */ | 
 | 980 | static int __init | 
 | 981 | ecard_probe(int slot, card_type_t type) | 
 | 982 | { | 
 | 983 | 	ecard_t **ecp; | 
 | 984 | 	ecard_t *ec; | 
 | 985 | 	struct ex_ecid cid; | 
| Russell King | 1ace756 | 2011-07-07 10:56:41 +0100 | [diff] [blame] | 986 | 	void __iomem *addr; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 987 | 	int i, rc; | 
 | 988 |  | 
 | 989 | 	ec = ecard_alloc_card(type, slot); | 
 | 990 | 	if (IS_ERR(ec)) { | 
 | 991 | 		rc = PTR_ERR(ec); | 
 | 992 | 		goto nomem; | 
 | 993 | 	} | 
 | 994 |  | 
 | 995 | 	rc = -ENODEV; | 
| Russell King | 1ace756 | 2011-07-07 10:56:41 +0100 | [diff] [blame] | 996 | 	if ((addr = __ecard_address(ec, type, ECARD_SYNC)) == NULL) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 997 | 		goto nodev; | 
 | 998 |  | 
 | 999 | 	cid.r_zero = 1; | 
 | 1000 | 	ecard_readbytes(&cid, ec, 0, 16, 0); | 
 | 1001 | 	if (cid.r_zero) | 
 | 1002 | 		goto nodev; | 
 | 1003 |  | 
 | 1004 | 	ec->cid.id	= cid.r_id; | 
 | 1005 | 	ec->cid.cd	= cid.r_cd; | 
 | 1006 | 	ec->cid.is	= cid.r_is; | 
 | 1007 | 	ec->cid.w	= cid.r_w; | 
 | 1008 | 	ec->cid.manufacturer = ecard_getu16(cid.r_manu); | 
 | 1009 | 	ec->cid.product = ecard_getu16(cid.r_prod); | 
 | 1010 | 	ec->cid.country = cid.r_country; | 
 | 1011 | 	ec->cid.irqmask = cid.r_irqmask; | 
 | 1012 | 	ec->cid.irqoff  = ecard_gets24(cid.r_irqoff); | 
 | 1013 | 	ec->cid.fiqmask = cid.r_fiqmask; | 
 | 1014 | 	ec->cid.fiqoff  = ecard_gets24(cid.r_fiqoff); | 
 | 1015 | 	ec->fiqaddr	= | 
| Russell King | 1ace756 | 2011-07-07 10:56:41 +0100 | [diff] [blame] | 1016 | 	ec->irqaddr	= addr; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1017 |  | 
 | 1018 | 	if (ec->cid.is) { | 
 | 1019 | 		ec->irqmask = ec->cid.irqmask; | 
 | 1020 | 		ec->irqaddr += ec->cid.irqoff; | 
 | 1021 | 		ec->fiqmask = ec->cid.fiqmask; | 
 | 1022 | 		ec->fiqaddr += ec->cid.fiqoff; | 
 | 1023 | 	} else { | 
 | 1024 | 		ec->irqmask = 1; | 
 | 1025 | 		ec->fiqmask = 4; | 
 | 1026 | 	} | 
 | 1027 |  | 
| Ahmed S. Darwish | eeea82f | 2007-02-05 16:10:25 -0800 | [diff] [blame] | 1028 | 	for (i = 0; i < ARRAY_SIZE(blacklist); i++) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1029 | 		if (blacklist[i].manufacturer == ec->cid.manufacturer && | 
 | 1030 | 		    blacklist[i].product == ec->cid.product) { | 
 | 1031 | 			ec->card_desc = blacklist[i].type; | 
 | 1032 | 			break; | 
 | 1033 | 		} | 
 | 1034 |  | 
 | 1035 | 	/* | 
 | 1036 | 	 * hook the interrupt handlers | 
 | 1037 | 	 */ | 
 | 1038 | 	if (slot < 8) { | 
 | 1039 | 		ec->irq = 32 + slot; | 
| Thomas Gleixner | f38c02f | 2011-03-24 13:35:09 +0100 | [diff] [blame] | 1040 | 		irq_set_chip_and_handler(ec->irq, &ecard_chip, | 
 | 1041 | 					 handle_level_irq); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1042 | 		set_irq_flags(ec->irq, IRQF_VALID); | 
 | 1043 | 	} | 
 | 1044 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1045 | 	if (slot == 8) | 
 | 1046 | 		ec->irq = 11; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1047 | #ifdef CONFIG_ARCH_RPC | 
 | 1048 | 	/* On RiscPC, only first two slots have DMA capability */ | 
 | 1049 | 	if (slot < 2) | 
 | 1050 | 		ec->dma = 2 + slot; | 
 | 1051 | #endif | 
 | 1052 |  | 
 | 1053 | 	for (ecp = &cards; *ecp; ecp = &(*ecp)->next); | 
 | 1054 |  | 
 | 1055 | 	*ecp = ec; | 
 | 1056 | 	slot_to_expcard[slot] = ec; | 
 | 1057 |  | 
 | 1058 | 	device_register(&ec->dev); | 
 | 1059 |  | 
 | 1060 | 	return 0; | 
 | 1061 |  | 
 | 1062 |  nodev: | 
 | 1063 | 	ecard_free_card(ec); | 
 | 1064 |  nomem: | 
 | 1065 | 	return rc; | 
 | 1066 | } | 
 | 1067 |  | 
 | 1068 | /* | 
 | 1069 |  * Initialise the expansion card system. | 
 | 1070 |  * Locate all hardware - interrupt management and | 
 | 1071 |  * actual cards. | 
 | 1072 |  */ | 
 | 1073 | static int __init ecard_init(void) | 
 | 1074 | { | 
| Eric W. Biederman | 134c99e | 2007-04-26 00:04:40 -0700 | [diff] [blame] | 1075 | 	struct task_struct *task; | 
 | 1076 | 	int slot, irqhw; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1077 |  | 
| Eric W. Biederman | 134c99e | 2007-04-26 00:04:40 -0700 | [diff] [blame] | 1078 | 	task = kthread_run(ecard_task, NULL, "kecardd"); | 
 | 1079 | 	if (IS_ERR(task)) { | 
| Russell King | e6aeb47 | 2007-05-03 10:55:46 +0100 | [diff] [blame] | 1080 | 		printk(KERN_ERR "Ecard: unable to create kernel thread: %ld\n", | 
| Eric W. Biederman | 134c99e | 2007-04-26 00:04:40 -0700 | [diff] [blame] | 1081 | 		       PTR_ERR(task)); | 
 | 1082 | 		return PTR_ERR(task); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1083 | 	} | 
 | 1084 |  | 
 | 1085 | 	printk("Probing expansion cards\n"); | 
 | 1086 |  | 
 | 1087 | 	for (slot = 0; slot < 8; slot ++) { | 
 | 1088 | 		if (ecard_probe(slot, ECARD_EASI) == -ENODEV) | 
 | 1089 | 			ecard_probe(slot, ECARD_IOC); | 
 | 1090 | 	} | 
 | 1091 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1092 | 	ecard_probe(8, ECARD_IOC); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1093 |  | 
 | 1094 | 	irqhw = ecard_probeirqhw(); | 
 | 1095 |  | 
| Thomas Gleixner | 6845664a | 2011-03-24 13:25:22 +0100 | [diff] [blame] | 1096 | 	irq_set_chained_handler(IRQ_EXPANSIONCARD, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1097 | 				irqhw ? ecard_irqexp_handler : ecard_irq_handler); | 
 | 1098 |  | 
 | 1099 | 	ecard_proc_init(); | 
 | 1100 |  | 
 | 1101 | 	return 0; | 
 | 1102 | } | 
 | 1103 |  | 
 | 1104 | subsys_initcall(ecard_init); | 
 | 1105 |  | 
 | 1106 | /* | 
 | 1107 |  *	ECARD "bus" | 
 | 1108 |  */ | 
 | 1109 | static const struct ecard_id * | 
 | 1110 | ecard_match_device(const struct ecard_id *ids, struct expansion_card *ec) | 
 | 1111 | { | 
 | 1112 | 	int i; | 
 | 1113 |  | 
 | 1114 | 	for (i = 0; ids[i].manufacturer != 65535; i++) | 
 | 1115 | 		if (ec->cid.manufacturer == ids[i].manufacturer && | 
 | 1116 | 		    ec->cid.product == ids[i].product) | 
 | 1117 | 			return ids + i; | 
 | 1118 |  | 
 | 1119 | 	return NULL; | 
 | 1120 | } | 
 | 1121 |  | 
 | 1122 | static int ecard_drv_probe(struct device *dev) | 
 | 1123 | { | 
 | 1124 | 	struct expansion_card *ec = ECARD_DEV(dev); | 
 | 1125 | 	struct ecard_driver *drv = ECARD_DRV(dev->driver); | 
 | 1126 | 	const struct ecard_id *id; | 
 | 1127 | 	int ret; | 
 | 1128 |  | 
 | 1129 | 	id = ecard_match_device(drv->id_table, ec); | 
 | 1130 |  | 
| Russell King | 9ecba1f | 2008-04-19 16:01:38 +0100 | [diff] [blame] | 1131 | 	ec->claimed = 1; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1132 | 	ret = drv->probe(ec, id); | 
 | 1133 | 	if (ret) | 
| Russell King | 9ecba1f | 2008-04-19 16:01:38 +0100 | [diff] [blame] | 1134 | 		ec->claimed = 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1135 | 	return ret; | 
 | 1136 | } | 
 | 1137 |  | 
 | 1138 | static int ecard_drv_remove(struct device *dev) | 
 | 1139 | { | 
 | 1140 | 	struct expansion_card *ec = ECARD_DEV(dev); | 
 | 1141 | 	struct ecard_driver *drv = ECARD_DRV(dev->driver); | 
 | 1142 |  | 
 | 1143 | 	drv->remove(ec); | 
| Russell King | 9ecba1f | 2008-04-19 16:01:38 +0100 | [diff] [blame] | 1144 | 	ec->claimed = 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1145 |  | 
| Russell King | c7b87f3 | 2007-05-10 16:46:13 +0100 | [diff] [blame] | 1146 | 	/* | 
 | 1147 | 	 * Restore the default operations.  We ensure that the | 
 | 1148 | 	 * ops are set before we change the data. | 
 | 1149 | 	 */ | 
 | 1150 | 	ec->ops = &ecard_default_ops; | 
 | 1151 | 	barrier(); | 
 | 1152 | 	ec->irq_data = NULL; | 
 | 1153 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1154 | 	return 0; | 
 | 1155 | } | 
 | 1156 |  | 
 | 1157 | /* | 
 | 1158 |  * Before rebooting, we must make sure that the expansion card is in a | 
 | 1159 |  * sensible state, so it can be re-detected.  This means that the first | 
 | 1160 |  * page of the ROM must be visible.  We call the expansion cards reset | 
 | 1161 |  * handler, if any. | 
 | 1162 |  */ | 
 | 1163 | static void ecard_drv_shutdown(struct device *dev) | 
 | 1164 | { | 
 | 1165 | 	struct expansion_card *ec = ECARD_DEV(dev); | 
 | 1166 | 	struct ecard_driver *drv = ECARD_DRV(dev->driver); | 
 | 1167 | 	struct ecard_request req; | 
 | 1168 |  | 
| Russell King | e08b754 | 2006-01-05 14:30:57 +0000 | [diff] [blame] | 1169 | 	if (dev->driver) { | 
 | 1170 | 		if (drv->shutdown) | 
 | 1171 | 			drv->shutdown(ec); | 
| Russell King | 9ecba1f | 2008-04-19 16:01:38 +0100 | [diff] [blame] | 1172 | 		ec->claimed = 0; | 
| Russell King | e08b754 | 2006-01-05 14:30:57 +0000 | [diff] [blame] | 1173 | 	} | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1174 |  | 
 | 1175 | 	/* | 
 | 1176 | 	 * If this card has a loader, call the reset handler. | 
 | 1177 | 	 */ | 
 | 1178 | 	if (ec->loader) { | 
 | 1179 | 		req.fn = ecard_task_reset; | 
 | 1180 | 		req.ec = ec; | 
 | 1181 | 		ecard_call(&req); | 
 | 1182 | 	} | 
 | 1183 | } | 
 | 1184 |  | 
 | 1185 | int ecard_register_driver(struct ecard_driver *drv) | 
 | 1186 | { | 
 | 1187 | 	drv->drv.bus = &ecard_bus_type; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1188 |  | 
 | 1189 | 	return driver_register(&drv->drv); | 
 | 1190 | } | 
 | 1191 |  | 
 | 1192 | void ecard_remove_driver(struct ecard_driver *drv) | 
 | 1193 | { | 
 | 1194 | 	driver_unregister(&drv->drv); | 
 | 1195 | } | 
 | 1196 |  | 
 | 1197 | static int ecard_match(struct device *_dev, struct device_driver *_drv) | 
 | 1198 | { | 
 | 1199 | 	struct expansion_card *ec = ECARD_DEV(_dev); | 
 | 1200 | 	struct ecard_driver *drv = ECARD_DRV(_drv); | 
 | 1201 | 	int ret; | 
 | 1202 |  | 
 | 1203 | 	if (drv->id_table) { | 
 | 1204 | 		ret = ecard_match_device(drv->id_table, ec) != NULL; | 
 | 1205 | 	} else { | 
 | 1206 | 		ret = ec->cid.id == drv->id; | 
 | 1207 | 	} | 
 | 1208 |  | 
 | 1209 | 	return ret; | 
 | 1210 | } | 
 | 1211 |  | 
 | 1212 | struct bus_type ecard_bus_type = { | 
 | 1213 | 	.name		= "ecard", | 
 | 1214 | 	.dev_attrs	= ecard_dev_attrs, | 
 | 1215 | 	.match		= ecard_match, | 
| Russell King | e08b754 | 2006-01-05 14:30:57 +0000 | [diff] [blame] | 1216 | 	.probe		= ecard_drv_probe, | 
 | 1217 | 	.remove		= ecard_drv_remove, | 
 | 1218 | 	.shutdown	= ecard_drv_shutdown, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1219 | }; | 
 | 1220 |  | 
 | 1221 | static int ecard_bus_init(void) | 
 | 1222 | { | 
 | 1223 | 	return bus_register(&ecard_bus_type); | 
 | 1224 | } | 
 | 1225 |  | 
 | 1226 | postcore_initcall(ecard_bus_init); | 
 | 1227 |  | 
 | 1228 | EXPORT_SYMBOL(ecard_readchunk); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1229 | EXPORT_SYMBOL(ecard_register_driver); | 
 | 1230 | EXPORT_SYMBOL(ecard_remove_driver); | 
 | 1231 | EXPORT_SYMBOL(ecard_bus_type); |