pcmciamtd.c 19.7 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32
/*
 * pcmciamtd.c - MTD driver for PCMCIA flash memory cards
 *
 * Author: Simon Evans <spse@secret.org.uk>
 *
 * Copyright (C) 2002 Simon Evans
 *
 * Licence: GPL
 *
 */

#include <linux/module.h>
#include <linux/slab.h>
#include <linux/timer.h>
#include <linux/init.h>
#include <asm/io.h>
#include <asm/system.h>

#include <pcmcia/cistpl.h>
#include <pcmcia/ds.h>

#include <linux/mtd/map.h>
#include <linux/mtd/mtd.h>

#define info(format, arg...) printk(KERN_INFO "pcmciamtd: " format "\n" , ## arg)

#define DRIVER_DESC	"PCMCIA Flash memory card driver"

/* Size of the PCMCIA address space: 26 bits = 64 MB */
#define MAX_PCMCIA_ADDR	0x4000000

struct pcmciamtd_dev {
33
	struct pcmcia_device	*p_dev;
L
Linus Torvalds 已提交
34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66
	caddr_t		win_base;	/* ioremapped address of PCMCIA window */
	unsigned int	win_size;	/* size of window */
	unsigned int	offset;		/* offset into card the window currently points at */
	struct map_info	pcmcia_map;
	struct mtd_info	*mtd_info;
	int		vpp;
	char		mtd_name[sizeof(struct cistpl_vers_1_t)];
};


/* Module parameters */

/* 2 = do 16-bit transfers, 1 = do 8-bit transfers */
static int bankwidth = 2;

/* Speed of memory accesses, in ns */
static int mem_speed;

/* Force the size of an SRAM card */
static int force_size;

/* Force Vpp */
static int vpp;

/* Set Vpp */
static int setvpp;

/* Force card to be treated as FLASH, ROM or RAM */
static int mem_type;

MODULE_LICENSE("GPL");
MODULE_AUTHOR("Simon Evans <spse@secret.org.uk>");
MODULE_DESCRIPTION(DRIVER_DESC);
R
Rusty Russell 已提交
67
module_param(bankwidth, int, 0);
L
Linus Torvalds 已提交
68
MODULE_PARM_DESC(bankwidth, "Set bankwidth (1=8 bit, 2=16 bit, default=2)");
R
Rusty Russell 已提交
69
module_param(mem_speed, int, 0);
L
Linus Torvalds 已提交
70
MODULE_PARM_DESC(mem_speed, "Set memory access speed in ns");
R
Rusty Russell 已提交
71
module_param(force_size, int, 0);
L
Linus Torvalds 已提交
72
MODULE_PARM_DESC(force_size, "Force size of card in MiB (1-64)");
R
Rusty Russell 已提交
73
module_param(setvpp, int, 0);
L
Linus Torvalds 已提交
74
MODULE_PARM_DESC(setvpp, "Set Vpp (0=Never, 1=On writes, 2=Always on, default=0)");
R
Rusty Russell 已提交
75
module_param(vpp, int, 0);
L
Linus Torvalds 已提交
76
MODULE_PARM_DESC(vpp, "Vpp value in 1/10ths eg 33=3.3V 120=12V (Dangerous)");
R
Rusty Russell 已提交
77
module_param(mem_type, int, 0);
L
Linus Torvalds 已提交
78 79 80
MODULE_PARM_DESC(mem_type, "Set Memory type (0=Flash, 1=RAM, 2=ROM, default=0)");


81 82 83
/* read/write{8,16} copy_{from,to} routines with window remapping
 * to access whole card
 */
L
Linus Torvalds 已提交
84 85 86
static caddr_t remap_window(struct map_info *map, unsigned long to)
{
	struct pcmciamtd_dev *dev = (struct pcmciamtd_dev *)map->map_priv_1;
87
	struct resource *win = (struct resource *) map->map_priv_2;
D
Dominik Brodowski 已提交
88
	unsigned int offset;
L
Linus Torvalds 已提交
89 90
	int ret;

91
	if (!pcmcia_dev_present(dev->p_dev)) {
92
		pr_debug("device removed\n");
L
Linus Torvalds 已提交
93 94 95
		return 0;
	}

D
Dominik Brodowski 已提交
96 97
	offset = to & ~(dev->win_size-1);
	if (offset != dev->offset) {
98
		pr_debug("Remapping window from 0x%8.8x to 0x%8.8x\n",
D
Dominik Brodowski 已提交
99 100
		      dev->offset, offset);
		ret = pcmcia_map_mem_page(dev->p_dev, win, offset);
101
		if (ret != 0)
L
Linus Torvalds 已提交
102
			return NULL;
D
Dominik Brodowski 已提交
103
		dev->offset = offset;
L
Linus Torvalds 已提交
104 105 106 107 108 109 110 111 112 113 114 115 116 117 118
	}
	return dev->win_base + (to & (dev->win_size-1));
}


static map_word pcmcia_read8_remap(struct map_info *map, unsigned long ofs)
{
	caddr_t addr;
	map_word d = {{0}};

	addr = remap_window(map, ofs);
	if(!addr)
		return d;

	d.x[0] = readb(addr);
119
	pr_debug("ofs = 0x%08lx (%p) data = 0x%02lx\n", ofs, addr, d.x[0]);
L
Linus Torvalds 已提交
120 121 122 123 124 125 126 127 128 129 130 131 132 133
	return d;
}


static map_word pcmcia_read16_remap(struct map_info *map, unsigned long ofs)
{
	caddr_t addr;
	map_word d = {{0}};

	addr = remap_window(map, ofs);
	if(!addr)
		return d;

	d.x[0] = readw(addr);
134
	pr_debug("ofs = 0x%08lx (%p) data = 0x%04lx\n", ofs, addr, d.x[0]);
L
Linus Torvalds 已提交
135 136 137 138 139 140 141 142 143
	return d;
}


static void pcmcia_copy_from_remap(struct map_info *map, void *to, unsigned long from, ssize_t len)
{
	struct pcmciamtd_dev *dev = (struct pcmciamtd_dev *)map->map_priv_1;
	unsigned long win_size = dev->win_size;

144
	pr_debug("to = %p from = %lu len = %zd\n", to, from, len);
L
Linus Torvalds 已提交
145 146 147 148 149 150
	while(len) {
		int toread = win_size - (from & (win_size-1));
		caddr_t addr;

		if(toread > len)
			toread = len;
151

L
Linus Torvalds 已提交
152 153 154 155
		addr = remap_window(map, from);
		if(!addr)
			return;

156
		pr_debug("memcpy from %p to %p len = %d\n", addr, to, toread);
L
Linus Torvalds 已提交
157 158 159 160 161 162 163 164 165 166 167 168 169 170 171
		memcpy_fromio(to, addr, toread);
		len -= toread;
		to += toread;
		from += toread;
	}
}


static void pcmcia_write8_remap(struct map_info *map, map_word d, unsigned long adr)
{
	caddr_t addr = remap_window(map, adr);

	if(!addr)
		return;

172
	pr_debug("adr = 0x%08lx (%p)  data = 0x%02lx\n", adr, addr, d.x[0]);
L
Linus Torvalds 已提交
173 174 175 176 177 178 179 180 181 182
	writeb(d.x[0], addr);
}


static void pcmcia_write16_remap(struct map_info *map, map_word d, unsigned long adr)
{
	caddr_t addr = remap_window(map, adr);
	if(!addr)
		return;

183
	pr_debug("adr = 0x%08lx (%p)  data = 0x%04lx\n", adr, addr, d.x[0]);
L
Linus Torvalds 已提交
184 185 186 187 188 189 190 191 192
	writew(d.x[0], addr);
}


static void pcmcia_copy_to_remap(struct map_info *map, unsigned long to, const void *from, ssize_t len)
{
	struct pcmciamtd_dev *dev = (struct pcmciamtd_dev *)map->map_priv_1;
	unsigned long win_size = dev->win_size;

193
	pr_debug("to = %lu from = %p len = %zd\n", to, from, len);
L
Linus Torvalds 已提交
194 195 196 197 198 199 200 201 202 203 204
	while(len) {
		int towrite = win_size - (to & (win_size-1));
		caddr_t addr;

		if(towrite > len)
			towrite = len;

		addr = remap_window(map, to);
		if(!addr)
			return;

205
		pr_debug("memcpy from %p to %p len = %d\n", from, addr, towrite);
L
Linus Torvalds 已提交
206 207 208 209 210 211 212 213 214 215
		memcpy_toio(addr, from, towrite);
		len -= towrite;
		to += towrite;
		from += towrite;
	}
}


/* read/write{8,16} copy_{from,to} routines with direct access */

216
#define DEV_REMOVED(x)  (!(pcmcia_dev_present(((struct pcmciamtd_dev *)map->map_priv_1)->p_dev)))
L
Linus Torvalds 已提交
217 218 219 220 221 222 223 224 225 226

static map_word pcmcia_read8(struct map_info *map, unsigned long ofs)
{
	caddr_t win_base = (caddr_t)map->map_priv_2;
	map_word d = {{0}};

	if(DEV_REMOVED(map))
		return d;

	d.x[0] = readb(win_base + ofs);
227
	pr_debug("ofs = 0x%08lx (%p) data = 0x%02lx\n",
228
	      ofs, win_base + ofs, d.x[0]);
L
Linus Torvalds 已提交
229 230 231 232 233 234 235 236 237 238 239 240 241
	return d;
}


static map_word pcmcia_read16(struct map_info *map, unsigned long ofs)
{
	caddr_t win_base = (caddr_t)map->map_priv_2;
	map_word d = {{0}};

	if(DEV_REMOVED(map))
		return d;

	d.x[0] = readw(win_base + ofs);
242
	pr_debug("ofs = 0x%08lx (%p) data = 0x%04lx\n",
243
	      ofs, win_base + ofs, d.x[0]);
L
Linus Torvalds 已提交
244 245 246 247 248 249 250 251 252 253 254
	return d;
}


static void pcmcia_copy_from(struct map_info *map, void *to, unsigned long from, ssize_t len)
{
	caddr_t win_base = (caddr_t)map->map_priv_2;

	if(DEV_REMOVED(map))
		return;

255
	pr_debug("to = %p from = %lu len = %zd\n", to, from, len);
L
Linus Torvalds 已提交
256 257 258 259
	memcpy_fromio(to, win_base + from, len);
}


260
static void pcmcia_write8(struct map_info *map, map_word d, unsigned long adr)
L
Linus Torvalds 已提交
261 262 263 264 265 266
{
	caddr_t win_base = (caddr_t)map->map_priv_2;

	if(DEV_REMOVED(map))
		return;

267
	pr_debug("adr = 0x%08lx (%p)  data = 0x%02lx\n",
268
	      adr, win_base + adr, d.x[0]);
269
	writeb(d.x[0], win_base + adr);
L
Linus Torvalds 已提交
270 271 272
}


273
static void pcmcia_write16(struct map_info *map, map_word d, unsigned long adr)
L
Linus Torvalds 已提交
274 275 276 277 278 279
{
	caddr_t win_base = (caddr_t)map->map_priv_2;

	if(DEV_REMOVED(map))
		return;

280
	pr_debug("adr = 0x%08lx (%p)  data = 0x%04lx\n",
281
	      adr, win_base + adr, d.x[0]);
282
	writew(d.x[0], win_base + adr);
L
Linus Torvalds 已提交
283 284 285 286 287 288 289 290 291 292
}


static void pcmcia_copy_to(struct map_info *map, unsigned long to, const void *from, ssize_t len)
{
	caddr_t win_base = (caddr_t)map->map_priv_2;

	if(DEV_REMOVED(map))
		return;

293
	pr_debug("to = %lu from = %p len = %zd\n", to, from, len);
L
Linus Torvalds 已提交
294 295 296 297
	memcpy_toio(win_base + to, from, len);
}


298 299
static DEFINE_SPINLOCK(pcmcia_vpp_lock);
static int pcmcia_vpp_refcnt;
L
Linus Torvalds 已提交
300 301 302
static void pcmciamtd_set_vpp(struct map_info *map, int on)
{
	struct pcmciamtd_dev *dev = (struct pcmciamtd_dev *)map->map_priv_1;
303
	struct pcmcia_device *link = dev->p_dev;
304
	unsigned long flags;
L
Linus Torvalds 已提交
305

306
	pr_debug("dev = %p on = %d vpp = %d\n\n", dev, on, dev->vpp);
307 308 309 310 311 312 313 314 315
	spin_lock_irqsave(&pcmcia_vpp_lock, flags);
	if (on) {
		if (++pcmcia_vpp_refcnt == 1)   /* first nested 'on' */
			pcmcia_fixup_vpp(link, dev->vpp);
	} else {
		if (--pcmcia_vpp_refcnt == 0)   /* last nested 'off' */
			pcmcia_fixup_vpp(link, 0);
	}
	spin_unlock_irqrestore(&pcmcia_vpp_lock, flags);
L
Linus Torvalds 已提交
316 317 318
}


319
static void pcmciamtd_release(struct pcmcia_device *link)
L
Linus Torvalds 已提交
320 321 322
{
	struct pcmciamtd_dev *dev = link->priv;

323
	pr_debug("link = 0x%p\n", link);
L
Linus Torvalds 已提交
324

325
	if (link->resource[2]->end) {
L
Linus Torvalds 已提交
326 327 328 329 330
		if(dev->win_base) {
			iounmap(dev->win_base);
			dev->win_base = NULL;
		}
	}
331
	pcmcia_disable_device(link);
L
Linus Torvalds 已提交
332 333 334
}


335 336 337
static int pcmciamtd_cistpl_format(struct pcmcia_device *p_dev,
				tuple_t *tuple,
				void *priv_data)
L
Linus Torvalds 已提交
338 339
{
	cisparse_t parse;
340

341 342 343
	if (!pcmcia_parse_tuple(tuple, &parse)) {
		cistpl_format_t *t = &parse.format;
		(void)t; /* Shut up, gcc */
344
		pr_debug("Format type: %u, Error Detection: %u, offset = %u, length =%u\n",
345 346 347 348
			t->type, t->edc, t->offset, t->length);
	}
	return -ENOSPC;
}
349

350 351 352 353 354 355
static int pcmciamtd_cistpl_jedec(struct pcmcia_device *p_dev,
				tuple_t *tuple,
				void *priv_data)
{
	cisparse_t parse;
	int i;
356

357 358 359
	if (!pcmcia_parse_tuple(tuple, &parse)) {
		cistpl_jedec_t *t = &parse.jedec;
		for (i = 0; i < t->nid; i++)
360
			pr_debug("JEDEC: 0x%02x 0x%02x\n",
361
			      t->id[i].mfr, t->id[i].info);
362 363 364
	}
	return -ENOSPC;
}
365

366 367 368 369 370 371 372 373 374 375 376 377
static int pcmciamtd_cistpl_device(struct pcmcia_device *p_dev,
				tuple_t *tuple,
				void *priv_data)
{
	struct pcmciamtd_dev *dev = priv_data;
	cisparse_t parse;
	cistpl_device_t *t = &parse.device;
	int i;

	if (pcmcia_parse_tuple(tuple, &parse))
		return -EINVAL;

378
	pr_debug("Common memory:\n");
379 380 381
	dev->pcmcia_map.size = t->dev[0].size;
	/* from here on: DEBUG only */
	for (i = 0; i < t->ndev; i++) {
382 383 384 385
		pr_debug("Region %d, type = %u\n", i, t->dev[i].type);
		pr_debug("Region %d, wp = %u\n", i, t->dev[i].wp);
		pr_debug("Region %d, speed = %u ns\n", i, t->dev[i].speed);
		pr_debug("Region %d, size = %u bytes\n", i, t->dev[i].size);
386 387 388
	}
	return 0;
}
389

390 391 392 393 394 395 396 397 398 399 400 401 402 403 404
static int pcmciamtd_cistpl_geo(struct pcmcia_device *p_dev,
				tuple_t *tuple,
				void *priv_data)
{
	struct pcmciamtd_dev *dev = priv_data;
	cisparse_t parse;
	cistpl_device_geo_t *t = &parse.device_geo;
	int i;

	if (pcmcia_parse_tuple(tuple, &parse))
		return -EINVAL;

	dev->pcmcia_map.bankwidth = t->geo[0].buswidth;
	/* from here on: DEBUG only */
	for (i = 0; i < t->ngeo; i++) {
405 406 407 408 409 410
		pr_debug("region: %d bankwidth = %u\n", i, t->geo[i].buswidth);
		pr_debug("region: %d erase_block = %u\n", i, t->geo[i].erase_block);
		pr_debug("region: %d read_block = %u\n", i, t->geo[i].read_block);
		pr_debug("region: %d write_block = %u\n", i, t->geo[i].write_block);
		pr_debug("region: %d partition = %u\n", i, t->geo[i].partition);
		pr_debug("region: %d interleave = %u\n", i, t->geo[i].interleave);
411 412 413
	}
	return 0;
}
414 415


416
static void card_settings(struct pcmciamtd_dev *dev, struct pcmcia_device *p_dev, int *new_name)
417 418 419 420 421 422 423 424 425 426
{
	int i;

	if (p_dev->prod_id[0]) {
		dev->mtd_name[0] = '\0';
		for (i = 0; i < 4; i++) {
			if (i)
				strcat(dev->mtd_name, " ");
			if (p_dev->prod_id[i])
				strcat(dev->mtd_name, p_dev->prod_id[i]);
L
Linus Torvalds 已提交
427
		}
428
		pr_debug("Found name: %s\n", dev->mtd_name);
L
Linus Torvalds 已提交
429
	}
430 431 432 433 434 435

	pcmcia_loop_tuple(p_dev, CISTPL_FORMAT, pcmciamtd_cistpl_format, NULL);
	pcmcia_loop_tuple(p_dev, CISTPL_JEDEC_C, pcmciamtd_cistpl_jedec, NULL);
	pcmcia_loop_tuple(p_dev, CISTPL_DEVICE, pcmciamtd_cistpl_device, dev);
	pcmcia_loop_tuple(p_dev, CISTPL_DEVICE_GEO, pcmciamtd_cistpl_geo, dev);

L
Linus Torvalds 已提交
436 437 438 439 440 441 442 443
	if(!dev->pcmcia_map.size)
		dev->pcmcia_map.size = MAX_PCMCIA_ADDR;

	if(!dev->pcmcia_map.bankwidth)
		dev->pcmcia_map.bankwidth = 2;

	if(force_size) {
		dev->pcmcia_map.size = force_size << 20;
444
		pr_debug("size forced to %dM\n", force_size);
L
Linus Torvalds 已提交
445 446 447 448
	}

	if(bankwidth) {
		dev->pcmcia_map.bankwidth = bankwidth;
449
		pr_debug("bankwidth forced to %d\n", bankwidth);
450
	}
L
Linus Torvalds 已提交
451 452 453 454 455 456 457

	dev->pcmcia_map.name = dev->mtd_name;
	if(!dev->mtd_name[0]) {
		strcpy(dev->mtd_name, "PCMCIA Memory card");
		*new_name = 1;
	}

458
	pr_debug("Device: Size: %lu Width:%d Name: %s\n",
459 460
	      dev->pcmcia_map.size,
	      dev->pcmcia_map.bankwidth << 3, dev->mtd_name);
L
Linus Torvalds 已提交
461 462 463
}


464
static int pcmciamtd_config(struct pcmcia_device *link)
L
Linus Torvalds 已提交
465 466 467 468
{
	struct pcmciamtd_dev *dev = link->priv;
	struct mtd_info *mtd = NULL;
	int ret;
469
	int i, j = 0;
L
Linus Torvalds 已提交
470 471 472
	static char *probes[] = { "jedec_probe", "cfi_probe" };
	int new_name = 0;

473
	pr_debug("link=0x%p\n", link);
L
Linus Torvalds 已提交
474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489

	card_settings(dev, link, &new_name);

	dev->pcmcia_map.phys = NO_XIP;
	dev->pcmcia_map.copy_from = pcmcia_copy_from_remap;
	dev->pcmcia_map.copy_to = pcmcia_copy_to_remap;
	if (dev->pcmcia_map.bankwidth == 1) {
		dev->pcmcia_map.read = pcmcia_read8_remap;
		dev->pcmcia_map.write = pcmcia_write8_remap;
	} else {
		dev->pcmcia_map.read = pcmcia_read16_remap;
		dev->pcmcia_map.write = pcmcia_write16_remap;
	}
	if(setvpp == 1)
		dev->pcmcia_map.set_vpp = pcmciamtd_set_vpp;

490
	/* Request a memory window for PCMCIA. Some architeures can map windows
L
Lucas De Marchi 已提交
491
	 * up to the maximum that PCMCIA can support (64MiB) - this is ideal and
492 493 494
	 * we aim for a window the size of the whole card - otherwise we try
	 * smaller windows until we succeed
	 */
L
Linus Torvalds 已提交
495

496 497 498 499 500 501
	link->resource[2]->flags |=  WIN_MEMORY_TYPE_CM | WIN_ENABLE;
	link->resource[2]->flags |= (dev->pcmcia_map.bankwidth == 1) ?
					WIN_DATA_WIDTH_8 : WIN_DATA_WIDTH_16;
	link->resource[2]->start = 0;
	link->resource[2]->end = (force_size) ? force_size << 20 :
					MAX_PCMCIA_ADDR;
L
Linus Torvalds 已提交
502 503 504 505
	dev->win_size = 0;

	do {
		int ret;
506
		pr_debug("requesting window with size = %luKiB memspeed = %d\n",
507 508 509
			(unsigned long) resource_size(link->resource[2]) >> 10,
			mem_speed);
		ret = pcmcia_request_window(link, link->resource[2], mem_speed);
510
		pr_debug("ret = %d dev->win_size = %d\n", ret, dev->win_size);
L
Linus Torvalds 已提交
511
		if(ret) {
512 513 514 515 516
			j++;
			link->resource[2]->start = 0;
			link->resource[2]->end = (force_size) ?
					force_size << 20 : MAX_PCMCIA_ADDR;
			link->resource[2]->end >>= j;
L
Linus Torvalds 已提交
517
		} else {
518
			pr_debug("Got window of size %luKiB\n", (unsigned long)
519 520
				resource_size(link->resource[2]) >> 10);
			dev->win_size = resource_size(link->resource[2]);
L
Linus Torvalds 已提交
521 522
			break;
		}
523
	} while (link->resource[2]->end >= 0x1000);
L
Linus Torvalds 已提交
524

525
	pr_debug("dev->win_size = %d\n", dev->win_size);
L
Linus Torvalds 已提交
526 527

	if(!dev->win_size) {
528
		dev_err(&dev->p_dev->dev, "Cannot allocate memory window\n");
L
Linus Torvalds 已提交
529
		pcmciamtd_release(link);
530
		return -ENODEV;
L
Linus Torvalds 已提交
531
	}
532
	pr_debug("Allocated a window of %dKiB\n", dev->win_size >> 10);
533

L
Linus Torvalds 已提交
534
	/* Get write protect status */
535 536
	dev->win_base = ioremap(link->resource[2]->start,
				resource_size(link->resource[2]));
L
Linus Torvalds 已提交
537
	if(!dev->win_base) {
538 539
		dev_err(&dev->p_dev->dev, "ioremap(%pR) failed\n",
			link->resource[2]);
L
Linus Torvalds 已提交
540
		pcmciamtd_release(link);
541
		return -ENODEV;
L
Linus Torvalds 已提交
542
	}
543
	pr_debug("mapped window dev = %p @ %pR, base = %p\n",
544
	      dev, link->resource[2], dev->win_base);
L
Linus Torvalds 已提交
545 546 547

	dev->offset = 0;
	dev->pcmcia_map.map_priv_1 = (unsigned long)dev;
548
	dev->pcmcia_map.map_priv_2 = (unsigned long)link->resource[2];
L
Linus Torvalds 已提交
549

550
	dev->vpp = (vpp) ? vpp : link->socket->socket.Vpp;
L
Linus Torvalds 已提交
551
	if(setvpp == 2) {
552
		link->vpp = dev->vpp;
L
Linus Torvalds 已提交
553
	} else {
554
		link->vpp = 0;
L
Linus Torvalds 已提交
555 556
	}

557
	link->config_index = 0;
558
	pr_debug("Setting Configuration\n");
559
	ret = pcmcia_enable_device(link);
D
Dominik Brodowski 已提交
560
	if (ret != 0) {
561 562 563 564
		if (dev->win_base) {
			iounmap(dev->win_base);
			dev->win_base = NULL;
		}
565
		return -ENODEV;
L
Linus Torvalds 已提交
566 567 568 569 570 571 572
	}

	if(mem_type == 1) {
		mtd = do_map_probe("map_ram", &dev->pcmcia_map);
	} else if(mem_type == 2) {
		mtd = do_map_probe("map_rom", &dev->pcmcia_map);
	} else {
573
		for(i = 0; i < ARRAY_SIZE(probes); i++) {
574
			pr_debug("Trying %s\n", probes[i]);
L
Linus Torvalds 已提交
575 576 577
			mtd = do_map_probe(probes[i], &dev->pcmcia_map);
			if(mtd)
				break;
578

579
			pr_debug("FAILED: %s\n", probes[i]);
L
Linus Torvalds 已提交
580 581
		}
	}
582

L
Linus Torvalds 已提交
583
	if(!mtd) {
584
		pr_debug("Can not find an MTD\n");
L
Linus Torvalds 已提交
585
		pcmciamtd_release(link);
586
		return -ENODEV;
L
Linus Torvalds 已提交
587 588 589 590 591 592 593 594
	}

	dev->mtd_info = mtd;
	mtd->owner = THIS_MODULE;

	if(new_name) {
		int size = 0;
		char unit = ' ';
595 596 597
		/* Since we are using a default name, make it better by adding
		 * in the size
		 */
L
Linus Torvalds 已提交
598 599 600 601 602 603 604 605 606 607 608 609 610
		if(mtd->size < 1048576) { /* <1MiB in size, show size in KiB */
			size = mtd->size >> 10;
			unit = 'K';
		} else {
			size = mtd->size >> 20;
			unit = 'M';
		}
		snprintf(dev->mtd_name, sizeof(dev->mtd_name), "%d%ciB %s", size, unit, "PCMCIA Memory card");
	}

	/* If the memory found is fits completely into the mapped PCMCIA window,
	   use the faster non-remapping read/write functions */
	if(mtd->size <= dev->win_size) {
611
		pr_debug("Using non remapping memory functions\n");
L
Linus Torvalds 已提交
612 613 614 615 616 617 618 619 620 621 622 623
		dev->pcmcia_map.map_priv_2 = (unsigned long)dev->win_base;
		if (dev->pcmcia_map.bankwidth == 1) {
			dev->pcmcia_map.read = pcmcia_read8;
			dev->pcmcia_map.write = pcmcia_write8;
		} else {
			dev->pcmcia_map.read = pcmcia_read16;
			dev->pcmcia_map.write = pcmcia_write16;
		}
		dev->pcmcia_map.copy_from = pcmcia_copy_from;
		dev->pcmcia_map.copy_to = pcmcia_copy_to;
	}

624
	if (mtd_device_register(mtd, NULL, 0)) {
L
Linus Torvalds 已提交
625 626
		map_destroy(mtd);
		dev->mtd_info = NULL;
627 628
		dev_err(&dev->p_dev->dev,
			"Could not register the MTD device\n");
L
Linus Torvalds 已提交
629
		pcmciamtd_release(link);
630
		return -ENODEV;
L
Linus Torvalds 已提交
631
	}
632
	dev_info(&dev->p_dev->dev, "mtd%d: %s\n", mtd->index, mtd->name);
633
	return 0;
L
Linus Torvalds 已提交
634 635 636
}


637 638
static int pcmciamtd_suspend(struct pcmcia_device *dev)
{
639
	pr_debug("EVENT_PM_RESUME\n");
640 641 642 643 644 645 646 647

	/* get_lock(link); */

	return 0;
}

static int pcmciamtd_resume(struct pcmcia_device *dev)
{
648
	pr_debug("EVENT_PM_SUSPEND\n");
649 650 651 652 653 654

	/* free_lock(link); */

	return 0;
}

L
Linus Torvalds 已提交
655

656
static void pcmciamtd_detach(struct pcmcia_device *link)
L
Linus Torvalds 已提交
657
{
658
	struct pcmciamtd_dev *dev = link->priv;
659

660
	pr_debug("link=0x%p\n", link);
L
Linus Torvalds 已提交
661

662
	if(dev->mtd_info) {
663
		mtd_device_unregister(dev->mtd_info);
664 665
		dev_info(&dev->p_dev->dev, "mtd%d: Removing\n",
			 dev->mtd_info->index);
666
		map_destroy(dev->mtd_info);
L
Linus Torvalds 已提交
667
	}
668 669

	pcmciamtd_release(link);
L
Linus Torvalds 已提交
670 671 672
}


673
static int pcmciamtd_probe(struct pcmcia_device *link)
L
Linus Torvalds 已提交
674 675 676 677
{
	struct pcmciamtd_dev *dev;

	/* Create new memory card device */
678
	dev = kzalloc(sizeof(*dev), GFP_KERNEL);
679
	if (!dev) return -ENOMEM;
680
	pr_debug("dev=0x%p\n", dev);
L
Linus Torvalds 已提交
681

682
	dev->p_dev = link;
L
Linus Torvalds 已提交
683 684
	link->priv = dev;

685
	return pcmciamtd_config(link);
L
Linus Torvalds 已提交
686 687
}

688
static const struct pcmcia_device_id pcmciamtd_ids[] = {
689 690 691 692 693 694 695 696 697 698 699 700 701
	PCMCIA_DEVICE_FUNC_ID(1),
	PCMCIA_DEVICE_PROD_ID123("IO DATA", "PCS-2M", "2MB SRAM", 0x547e66dc, 0x1fed36cd, 0x36eadd21),
	PCMCIA_DEVICE_PROD_ID12("IBM", "2MB SRAM", 0xb569a6e5, 0x36eadd21),
	PCMCIA_DEVICE_PROD_ID12("IBM", "4MB FLASH", 0xb569a6e5, 0x8bc54d2a),
	PCMCIA_DEVICE_PROD_ID12("IBM", "8MB FLASH", 0xb569a6e5, 0x6df1be3e),
	PCMCIA_DEVICE_PROD_ID12("Intel", "S2E20SW", 0x816cc815, 0xd14c9dcf),
	PCMCIA_DEVICE_PROD_ID12("Intel", "S2E8 SW", 0x816cc815, 0xa2d7dedb),
	PCMCIA_DEVICE_PROD_ID12("intel", "SERIES2-02 ", 0x40ade711, 0x145cea5c),
	PCMCIA_DEVICE_PROD_ID12("intel", "SERIES2-04 ", 0x40ade711, 0x42064dda),
	PCMCIA_DEVICE_PROD_ID12("intel", "SERIES2-20 ", 0x40ade711, 0x25ee5cb0),
	PCMCIA_DEVICE_PROD_ID12("intel", "VALUE SERIES 100 ", 0x40ade711, 0xdf8506d8),
	PCMCIA_DEVICE_PROD_ID12("KINGMAX TECHNOLOGY INC.", "SRAM 256K Bytes", 0x54d0c69c, 0xad12c29c),
	PCMCIA_DEVICE_PROD_ID12("Maxtor", "MAXFL MobileMax Flash Memory Card", 0xb68968c8, 0x2dfb47b0),
702
	PCMCIA_DEVICE_PROD_ID123("M-Systems", "M-SYS Flash Memory Card", "(c) M-Systems", 0x7ed2ad87, 0x675dc3fb, 0x7aef3965),
D
Dominik Brodowski 已提交
703
	PCMCIA_DEVICE_PROD_ID12("PRETEC", "  2MB SRAM CARD", 0xebf91155, 0x805360ca),
704 705
	PCMCIA_DEVICE_PROD_ID12("SEIKO EPSON", "WWB101EN20", 0xf9876baf, 0xad0b207b),
	PCMCIA_DEVICE_PROD_ID12("SEIKO EPSON", "WWB513EN20", 0xf9876baf, 0xe8d884ad),
706
	PCMCIA_DEVICE_PROD_ID12("SMART Modular Technologies", " 4MB FLASH Card", 0x96fd8277, 0x737a5b05),
707 708 709 710 711 712 713 714 715 716
	PCMCIA_DEVICE_PROD_ID12("Starfish, Inc.", "REX-3000", 0x05ddca47, 0xe7d67bca),
	PCMCIA_DEVICE_PROD_ID12("Starfish, Inc.", "REX-4100", 0x05ddca47, 0x7bc32944),
	/* the following was commented out in pcmcia-cs-3.2.7 */
	/* PCMCIA_DEVICE_PROD_ID12("RATOC Systems,Inc.", "SmartMedia ADAPTER PC Card", 0xf4a2fefe, 0x5885b2ae), */
#ifdef CONFIG_MTD_PCMCIA_ANONYMOUS
	{ .match_flags = PCMCIA_DEV_ID_MATCH_ANONYMOUS, },
#endif
	PCMCIA_DEVICE_NULL
};
MODULE_DEVICE_TABLE(pcmcia, pcmciamtd_ids);
L
Linus Torvalds 已提交
717 718

static struct pcmcia_driver pcmciamtd_driver = {
719
	.name		= "pcmciamtd",
720
	.probe		= pcmciamtd_probe,
721
	.remove		= pcmciamtd_detach,
722 723
	.owner		= THIS_MODULE,
	.id_table	= pcmciamtd_ids,
724 725
	.suspend	= pcmciamtd_suspend,
	.resume		= pcmciamtd_resume,
L
Linus Torvalds 已提交
726 727 728 729 730 731 732 733 734 735 736 737 738 739 740 741 742 743 744 745 746 747 748
};


static int __init init_pcmciamtd(void)
{
	if(bankwidth && bankwidth != 1 && bankwidth != 2) {
		info("bad bankwidth (%d), using default", bankwidth);
		bankwidth = 2;
	}
	if(force_size && (force_size < 1 || force_size > 64)) {
		info("bad force_size (%d), using default", force_size);
		force_size = 0;
	}
	if(mem_type && mem_type != 1 && mem_type != 2) {
		info("bad mem_type (%d), using default", mem_type);
		mem_type = 0;
	}
	return pcmcia_register_driver(&pcmciamtd_driver);
}


static void __exit exit_pcmciamtd(void)
{
749
	pr_debug(DRIVER_DESC " unloading");
L
Linus Torvalds 已提交
750 751 752 753 754
	pcmcia_unregister_driver(&pcmciamtd_driver);
}

module_init(init_pcmciamtd);
module_exit(exit_pcmciamtd);