block.c 14.1 KB
Newer Older
Linus Torvalds's avatar
Linus Torvalds committed
1 2 3 4
/*
 * Block driver for media (i.e., flash cards)
 *
 * Copyright 2002 Hewlett-Packard Company
5
 * Copyright 2005-2008 Pierre Ossman
Linus Torvalds's avatar
Linus Torvalds committed
6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29
 *
 * Use consistent with the GNU GPL is permitted,
 * provided that this copyright notice is
 * preserved in its entirety in all copies and derived works.
 *
 * HEWLETT-PACKARD COMPANY MAKES NO WARRANTIES, EXPRESSED OR IMPLIED,
 * AS TO THE USEFULNESS OR CORRECTNESS OF THIS CODE OR ITS
 * FITNESS FOR ANY PARTICULAR PURPOSE.
 *
 * Many thanks to Alessandro Rubini and Jonathan Corbet!
 *
 * Author:  Andrew Christian
 *          28 May 2002
 */
#include <linux/moduleparam.h>
#include <linux/module.h>
#include <linux/init.h>

#include <linux/kernel.h>
#include <linux/fs.h>
#include <linux/errno.h>
#include <linux/hdreg.h>
#include <linux/kdev_t.h>
#include <linux/blkdev.h>
30
#include <linux/mutex.h>
31
#include <linux/scatterlist.h>
32
#include <linux/string_helpers.h>
Linus Torvalds's avatar
Linus Torvalds committed
33 34

#include <linux/mmc/card.h>
35
#include <linux/mmc/host.h>
Pierre Ossman's avatar
Pierre Ossman committed
36 37
#include <linux/mmc/mmc.h>
#include <linux/mmc/sd.h>
Linus Torvalds's avatar
Linus Torvalds committed
38 39 40 41

#include <asm/system.h>
#include <asm/uaccess.h>

42
#include "queue.h"
Linus Torvalds's avatar
Linus Torvalds committed
43 44 45 46 47

/*
 * max 8 partitions per card
 */
#define MMC_SHIFT	3
48 49
#define MMC_NUM_MINORS	(256 >> MMC_SHIFT)

50
static DECLARE_BITMAP(dev_use, MMC_NUM_MINORS);
Linus Torvalds's avatar
Linus Torvalds committed
51 52 53 54 55 56 57 58 59 60

/*
 * There is one mmc_blk_data per slot.
 */
struct mmc_blk_data {
	spinlock_t	lock;
	struct gendisk	*disk;
	struct mmc_queue queue;

	unsigned int	usage;
61
	unsigned int	read_only;
Linus Torvalds's avatar
Linus Torvalds committed
62 63
};

64
static DEFINE_MUTEX(open_lock);
Linus Torvalds's avatar
Linus Torvalds committed
65 66 67 68 69

static struct mmc_blk_data *mmc_blk_get(struct gendisk *disk)
{
	struct mmc_blk_data *md;

70
	mutex_lock(&open_lock);
Linus Torvalds's avatar
Linus Torvalds committed
71 72 73 74 75
	md = disk->private_data;
	if (md && md->usage == 0)
		md = NULL;
	if (md)
		md->usage++;
76
	mutex_unlock(&open_lock);
Linus Torvalds's avatar
Linus Torvalds committed
77 78 79 80 81 82

	return md;
}

static void mmc_blk_put(struct mmc_blk_data *md)
{
83
	mutex_lock(&open_lock);
Linus Torvalds's avatar
Linus Torvalds committed
84 85
	md->usage--;
	if (md->usage == 0) {
86
		int devidx = MINOR(disk_devt(md->disk)) >> MMC_SHIFT;
87 88
		__clear_bit(devidx, dev_use);

Linus Torvalds's avatar
Linus Torvalds committed
89 90 91
		put_disk(md->disk);
		kfree(md);
	}
92
	mutex_unlock(&open_lock);
Linus Torvalds's avatar
Linus Torvalds committed
93 94
}

Al Viro's avatar
Al Viro committed
95
static int mmc_blk_open(struct block_device *bdev, fmode_t mode)
Linus Torvalds's avatar
Linus Torvalds committed
96
{
Al Viro's avatar
Al Viro committed
97
	struct mmc_blk_data *md = mmc_blk_get(bdev->bd_disk);
Linus Torvalds's avatar
Linus Torvalds committed
98 99 100 101
	int ret = -ENXIO;

	if (md) {
		if (md->usage == 2)
Al Viro's avatar
Al Viro committed
102
			check_disk_change(bdev);
Linus Torvalds's avatar
Linus Torvalds committed
103
		ret = 0;
Pierre Ossman's avatar
Pierre Ossman committed
104

Al Viro's avatar
Al Viro committed
105
		if ((mode & FMODE_WRITE) && md->read_only) {
106
			mmc_blk_put(md);
Pierre Ossman's avatar
Pierre Ossman committed
107
			ret = -EROFS;
108
		}
Linus Torvalds's avatar
Linus Torvalds committed
109 110 111 112 113
	}

	return ret;
}

Al Viro's avatar
Al Viro committed
114
static int mmc_blk_release(struct gendisk *disk, fmode_t mode)
Linus Torvalds's avatar
Linus Torvalds committed
115
{
Al Viro's avatar
Al Viro committed
116
	struct mmc_blk_data *md = disk->private_data;
Linus Torvalds's avatar
Linus Torvalds committed
117 118 119 120 121 122

	mmc_blk_put(md);
	return 0;
}

static int
123
mmc_blk_getgeo(struct block_device *bdev, struct hd_geometry *geo)
Linus Torvalds's avatar
Linus Torvalds committed
124
{
125 126 127 128
	geo->cylinders = get_capacity(bdev->bd_disk) / (4 * 16);
	geo->heads = 4;
	geo->sectors = 16;
	return 0;
Linus Torvalds's avatar
Linus Torvalds committed
129 130 131
}

static struct block_device_operations mmc_bdops = {
Al Viro's avatar
Al Viro committed
132 133
	.open			= mmc_blk_open,
	.release		= mmc_blk_release,
134
	.getgeo			= mmc_blk_getgeo,
Linus Torvalds's avatar
Linus Torvalds committed
135 136 137 138 139 140 141 142 143 144
	.owner			= THIS_MODULE,
};

struct mmc_blk_request {
	struct mmc_request	mrq;
	struct mmc_command	cmd;
	struct mmc_command	stop;
	struct mmc_data		data;
};

145 146 147
static u32 mmc_sd_num_wr_blocks(struct mmc_card *card)
{
	int err;
148
	__be32 blocks;
149 150 151 152 153 154 155 156 157 158 159 160

	struct mmc_request mrq;
	struct mmc_command cmd;
	struct mmc_data data;
	unsigned int timeout_us;

	struct scatterlist sg;

	memset(&cmd, 0, sizeof(struct mmc_command));

	cmd.opcode = MMC_APP_CMD;
	cmd.arg = card->rca << 16;
David Brownell's avatar
David Brownell committed
161
	cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_AC;
162 163

	err = mmc_wait_for_cmd(card->host, &cmd, 0);
David Brownell's avatar
David Brownell committed
164 165 166
	if (err)
		return (u32)-1;
	if (!mmc_host_is_spi(card->host) && !(cmd.resp[0] & R1_APP_CMD))
167 168 169 170 171 172
		return (u32)-1;

	memset(&cmd, 0, sizeof(struct mmc_command));

	cmd.opcode = SD_APP_SEND_NUM_WR_BLKS;
	cmd.arg = 0;
David Brownell's avatar
David Brownell committed
173
	cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_ADTC;
174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203

	memset(&data, 0, sizeof(struct mmc_data));

	data.timeout_ns = card->csd.tacc_ns * 100;
	data.timeout_clks = card->csd.tacc_clks * 100;

	timeout_us = data.timeout_ns / 1000;
	timeout_us += data.timeout_clks * 1000 /
		(card->host->ios.clock / 1000);

	if (timeout_us > 100000) {
		data.timeout_ns = 100000000;
		data.timeout_clks = 0;
	}

	data.blksz = 4;
	data.blocks = 1;
	data.flags = MMC_DATA_READ;
	data.sg = &sg;
	data.sg_len = 1;

	memset(&mrq, 0, sizeof(struct mmc_request));

	mrq.cmd = &cmd;
	mrq.data = &data;

	sg_init_one(&sg, &blocks, 4);

	mmc_wait_for_req(card->host, &mrq);

Pierre Ossman's avatar
Pierre Ossman committed
204
	if (cmd.error || data.error)
205 206
		return (u32)-1;

207
	return ntohl(blocks);
208 209
}

210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226
static u32 get_card_status(struct mmc_card *card, struct request *req)
{
	struct mmc_command cmd;
	int err;

	memset(&cmd, 0, sizeof(struct mmc_command));
	cmd.opcode = MMC_SEND_STATUS;
	if (!mmc_host_is_spi(card->host))
		cmd.arg = card->rca << 16;
	cmd.flags = MMC_RSP_SPI_R2 | MMC_RSP_R1 | MMC_CMD_AC;
	err = mmc_wait_for_cmd(card->host, &cmd, 0);
	if (err)
		printk(KERN_ERR "%s: error %d sending status comand",
		       req->rq_disk->disk_name, err);
	return cmd.resp[0];
}

Linus Torvalds's avatar
Linus Torvalds committed
227 228 229 230
static int mmc_blk_issue_rq(struct mmc_queue *mq, struct request *req)
{
	struct mmc_blk_data *md = mq->data;
	struct mmc_card *card = md->queue.card;
231
	struct mmc_blk_request brq;
232
	int ret = 1;
Linus Torvalds's avatar
Linus Torvalds committed
233

234
	mmc_claim_host(card->host);
Linus Torvalds's avatar
Linus Torvalds committed
235 236 237

	do {
		struct mmc_command cmd;
238
		u32 readcmd, writecmd, status = 0;
Linus Torvalds's avatar
Linus Torvalds committed
239 240 241 242 243

		memset(&brq, 0, sizeof(struct mmc_blk_request));
		brq.mrq.cmd = &brq.cmd;
		brq.mrq.data = &brq.data;

244 245 246
		brq.cmd.arg = req->sector;
		if (!mmc_card_blockaddr(card))
			brq.cmd.arg <<= 9;
David Brownell's avatar
David Brownell committed
247
		brq.cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_ADTC;
248
		brq.data.blksz = 512;
Linus Torvalds's avatar
Linus Torvalds committed
249 250
		brq.stop.opcode = MMC_STOP_TRANSMISSION;
		brq.stop.arg = 0;
David Brownell's avatar
David Brownell committed
251
		brq.stop.flags = MMC_RSP_SPI_R1B | MMC_RSP_R1B | MMC_CMD_AC;
252
		brq.data.blocks = req->nr_sectors;
Linus Torvalds's avatar
Linus Torvalds committed
253

Russell King's avatar
Russell King committed
254
		if (brq.data.blocks > 1) {
David Brownell's avatar
David Brownell committed
255 256 257 258 259 260
			/* SPI multiblock writes terminate using a special
			 * token, not a STOP_TRANSMISSION request.
			 */
			if (!mmc_host_is_spi(card->host)
					|| rq_data_dir(req) == READ)
				brq.mrq.stop = &brq.stop;
261 262
			readcmd = MMC_READ_MULTIPLE_BLOCK;
			writecmd = MMC_WRITE_MULTIPLE_BLOCK;
Russell King's avatar
Russell King committed
263 264
		} else {
			brq.mrq.stop = NULL;
265 266 267 268 269 270 271 272 273 274
			readcmd = MMC_READ_SINGLE_BLOCK;
			writecmd = MMC_WRITE_BLOCK;
		}

		if (rq_data_dir(req) == READ) {
			brq.cmd.opcode = readcmd;
			brq.data.flags |= MMC_DATA_READ;
		} else {
			brq.cmd.opcode = writecmd;
			brq.data.flags |= MMC_DATA_WRITE;
Russell King's avatar
Russell King committed
275
		}
Linus Torvalds's avatar
Linus Torvalds committed
276

277 278
		mmc_set_data_timeout(&brq.data, card);

Linus Torvalds's avatar
Linus Torvalds committed
279
		brq.data.sg = mq->sg;
280 281 282
		brq.data.sg_len = mmc_queue_map_sg(mq);

		mmc_queue_bounce_pre(mq);
Linus Torvalds's avatar
Linus Torvalds committed
283 284

		mmc_wait_for_req(card->host, &brq.mrq);
285 286 287

		mmc_queue_bounce_post(mq);

288 289 290 291 292
		/*
		 * Check for errors here, but don't jump to cmd_err
		 * until later as we need to wait for the card to leave
		 * programming mode even when things go wrong.
		 */
293 294 295
		if (brq.cmd.error || brq.data.error || brq.stop.error)
			status = get_card_status(card, req);

Linus Torvalds's avatar
Linus Torvalds committed
296
		if (brq.cmd.error) {
297 298 299 300
			printk(KERN_ERR "%s: error %d sending read/write "
			       "command, response %#x, card status %#x\n",
			       req->rq_disk->disk_name, brq.cmd.error,
			       brq.cmd.resp[0], status);
Linus Torvalds's avatar
Linus Torvalds committed
301 302 303
		}

		if (brq.data.error) {
304 305 306 307 308 309 310 311
			if (brq.data.error == -ETIMEDOUT && brq.mrq.stop)
				/* 'Stop' response contains card status */
				status = brq.mrq.stop->resp[0];
			printk(KERN_ERR "%s: error %d transferring data,"
			       " sector %u, nr %u, card status %#x\n",
			       req->rq_disk->disk_name, brq.data.error,
			       (unsigned)req->sector,
			       (unsigned)req->nr_sectors, status);
Linus Torvalds's avatar
Linus Torvalds committed
312 313 314
		}

		if (brq.stop.error) {
315 316 317 318
			printk(KERN_ERR "%s: error %d sending stop command, "
			       "response %#x, card status %#x\n",
			       req->rq_disk->disk_name, brq.stop.error,
			       brq.stop.resp[0], status);
Linus Torvalds's avatar
Linus Torvalds committed
319 320
		}

David Brownell's avatar
David Brownell committed
321
		if (!mmc_host_is_spi(card->host) && rq_data_dir(req) != READ) {
322 323 324 325 326 327 328 329 330 331 332 333
			do {
				int err;

				cmd.opcode = MMC_SEND_STATUS;
				cmd.arg = card->rca << 16;
				cmd.flags = MMC_RSP_R1 | MMC_CMD_AC;
				err = mmc_wait_for_cmd(card->host, &cmd, 5);
				if (err) {
					printk(KERN_ERR "%s: error %d requesting status\n",
					       req->rq_disk->disk_name, err);
					goto cmd_err;
				}
334 335 336 337 338 339 340
				/*
				 * Some cards mishandle the status bits,
				 * so make sure to check both the busy
				 * indication and the card state.
				 */
			} while (!(cmd.resp[0] & R1_READY_FOR_DATA) ||
				(R1_CURRENT_STATE(cmd.resp[0]) == 7));
Linus Torvalds's avatar
Linus Torvalds committed
341 342

#if 0
343 344 345 346 347
			if (cmd.resp[0] & ~0x00000900)
				printk(KERN_ERR "%s: status = %08x\n",
				       req->rq_disk->disk_name, cmd.resp[0]);
			if (mmc_decode_status(cmd.resp))
				goto cmd_err;
Linus Torvalds's avatar
Linus Torvalds committed
348
#endif
349
		}
Linus Torvalds's avatar
Linus Torvalds committed
350

351 352 353
		if (brq.cmd.error || brq.data.error || brq.stop.error)
			goto cmd_err;

Linus Torvalds's avatar
Linus Torvalds committed
354 355 356 357
		/*
		 * A block was successfully transferred.
		 */
		spin_lock_irq(&md->lock);
358
		ret = __blk_end_request(req, 0, brq.data.bytes_xfered);
Linus Torvalds's avatar
Linus Torvalds committed
359 360 361
		spin_unlock_irq(&md->lock);
	} while (ret);

362
	mmc_release_host(card->host);
Linus Torvalds's avatar
Linus Torvalds committed
363 364 365 366

	return 1;

 cmd_err:
367 368 369 370 371
 	/*
 	 * If this is an SD card and we're writing, we can first
 	 * mark the known good sectors as ok.
 	 *
	 * If the card is not SD, we can still ok written sectors
372 373
	 * as reported by the controller (which might be less than
	 * the real number of written sectors, but never more).
374 375 376
	 *
	 * For reads we just fail the entire chunk as that should
	 * be safe in all cases.
Linus Torvalds's avatar
Linus Torvalds committed
377
	 */
378 379 380 381 382 383 384
	if (rq_data_dir(req) != READ) {
		if (mmc_card_sd(card)) {
			u32 blocks;

			blocks = mmc_sd_num_wr_blocks(card);
			if (blocks != (u32)-1) {
				spin_lock_irq(&md->lock);
385
				ret = __blk_end_request(req, 0, blocks << 9);
386 387 388
				spin_unlock_irq(&md->lock);
			}
		} else {
389
			spin_lock_irq(&md->lock);
390
			ret = __blk_end_request(req, 0, brq.data.bytes_xfered);
391 392
			spin_unlock_irq(&md->lock);
		}
393 394
	}

395
	mmc_release_host(card->host);
396

Linus Torvalds's avatar
Linus Torvalds committed
397
	spin_lock_irq(&md->lock);
398 399
	while (ret)
		ret = __blk_end_request(req, -EIO, blk_rq_cur_bytes(req));
Linus Torvalds's avatar
Linus Torvalds committed
400 401 402 403 404 405
	spin_unlock_irq(&md->lock);

	return 0;
}


406 407 408 409 410 411
static inline int mmc_blk_readonly(struct mmc_card *card)
{
	return mmc_card_readonly(card) ||
	       !(card->csd.cmdclass & CCC_BLOCK_WRITE);
}

Linus Torvalds's avatar
Linus Torvalds committed
412 413 414 415 416 417 418 419 420 421
static struct mmc_blk_data *mmc_blk_alloc(struct mmc_card *card)
{
	struct mmc_blk_data *md;
	int devidx, ret;

	devidx = find_first_zero_bit(dev_use, MMC_NUM_MINORS);
	if (devidx >= MMC_NUM_MINORS)
		return ERR_PTR(-ENOSPC);
	__set_bit(devidx, dev_use);

422
	md = kzalloc(sizeof(struct mmc_blk_data), GFP_KERNEL);
423 424 425 426
	if (!md) {
		ret = -ENOMEM;
		goto out;
	}
Linus Torvalds's avatar
Linus Torvalds committed
427 428


429 430 431 432 433
	/*
	 * Set the read-only status based on the supported commands
	 * and the write protect switch.
	 */
	md->read_only = mmc_blk_readonly(card);
Linus Torvalds's avatar
Linus Torvalds committed
434

435 436 437 438 439
	md->disk = alloc_disk(1 << MMC_SHIFT);
	if (md->disk == NULL) {
		ret = -ENOMEM;
		goto err_kfree;
	}
Linus Torvalds's avatar
Linus Torvalds committed
440

441 442
	spin_lock_init(&md->lock);
	md->usage = 1;
Linus Torvalds's avatar
Linus Torvalds committed
443

444 445 446
	ret = mmc_init_queue(&md->queue, card, &md->lock);
	if (ret)
		goto err_putdisk;
Linus Torvalds's avatar
Linus Torvalds committed
447

448 449
	md->queue.issue_fn = mmc_blk_issue_rq;
	md->queue.data = md;
450

451
	md->disk->major	= MMC_BLOCK_MAJOR;
452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471
	md->disk->first_minor = devidx << MMC_SHIFT;
	md->disk->fops = &mmc_bdops;
	md->disk->private_data = md;
	md->disk->queue = md->queue.queue;
	md->disk->driverfs_dev = &card->dev;

	/*
	 * As discussed on lkml, GENHD_FL_REMOVABLE should:
	 *
	 * - be set for removable media with permanent block devices
	 * - be unset for removable block devices with permanent media
	 *
	 * Since MMC block devices clearly fall under the second
	 * case, we do not set GENHD_FL_REMOVABLE.  Userspace
	 * should use the block device creation/destruction hotplug
	 * messages to tell when the card is present.
	 */

	sprintf(md->disk->disk_name, "mmcblk%d", devidx);

472
	blk_queue_hardsect_size(md->queue.queue, 512);
473

Pierre Ossman's avatar
Pierre Ossman committed
474 475 476 477 478 479 480 481 482 483 484 485 486 487
	if (!mmc_card_sd(card) && mmc_card_blockaddr(card)) {
		/*
		 * The EXT_CSD sector count is in number or 512 byte
		 * sectors.
		 */
		set_capacity(md->disk, card->ext_csd.sectors);
	} else {
		/*
		 * The CSD capacity field is in units of read_blkbits.
		 * set_capacity takes units of 512 bytes.
		 */
		set_capacity(md->disk,
			card->csd.capacity << (card->csd.read_blkbits - 9));
	}
Linus Torvalds's avatar
Linus Torvalds committed
488
	return md;
489 490 491 492 493 494 495

 err_putdisk:
	put_disk(md->disk);
 err_kfree:
	kfree(md);
 out:
	return ERR_PTR(ret);
Linus Torvalds's avatar
Linus Torvalds committed
496 497 498 499 500 501 502 503
}

static int
mmc_blk_set_blksize(struct mmc_blk_data *md, struct mmc_card *card)
{
	struct mmc_command cmd;
	int err;

504 505 506 507
	/* Block-addressed cards ignore MMC_SET_BLOCKLEN. */
	if (mmc_card_blockaddr(card))
		return 0;

508
	mmc_claim_host(card->host);
Linus Torvalds's avatar
Linus Torvalds committed
509
	cmd.opcode = MMC_SET_BLOCKLEN;
510
	cmd.arg = 512;
David Brownell's avatar
David Brownell committed
511
	cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_AC;
Linus Torvalds's avatar
Linus Torvalds committed
512
	err = mmc_wait_for_cmd(card->host, &cmd, 5);
513
	mmc_release_host(card->host);
Linus Torvalds's avatar
Linus Torvalds committed
514 515 516 517 518 519 520 521 522 523 524 525 526 527 528

	if (err) {
		printk(KERN_ERR "%s: unable to set block size to %d: %d\n",
			md->disk->disk_name, cmd.arg, err);
		return -EINVAL;
	}

	return 0;
}

static int mmc_blk_probe(struct mmc_card *card)
{
	struct mmc_blk_data *md;
	int err;

529 530
	char cap_str[10];

531 532 533 534
	/*
	 * Check that the card supports the command class(es) we need.
	 */
	if (!(card->csd.cmdclass & CCC_BLOCK_READ))
Linus Torvalds's avatar
Linus Torvalds committed
535 536 537 538 539 540 541 542 543 544
		return -ENODEV;

	md = mmc_blk_alloc(card);
	if (IS_ERR(md))
		return PTR_ERR(md);

	err = mmc_blk_set_blksize(md, card);
	if (err)
		goto out;

545 546 547
	string_get_size(get_capacity(md->disk) << 9, STRING_UNITS_2,
			cap_str, sizeof(cap_str));
	printk(KERN_INFO "%s: %s %s %s %s\n",
Linus Torvalds's avatar
Linus Torvalds committed
548
		md->disk->disk_name, mmc_card_id(card), mmc_card_name(card),
549
		cap_str, md->read_only ? "(ro)" : "");
Linus Torvalds's avatar
Linus Torvalds committed
550 551 552 553 554 555 556 557 558 559 560 561 562 563 564 565

	mmc_set_drvdata(card, md);
	add_disk(md->disk);
	return 0;

 out:
	mmc_blk_put(md);

	return err;
}

static void mmc_blk_remove(struct mmc_card *card)
{
	struct mmc_blk_data *md = mmc_get_drvdata(card);

	if (md) {
566
		/* Stop new requests from getting into the queue */
Linus Torvalds's avatar
Linus Torvalds committed
567 568
		del_gendisk(md->disk);

569 570
		/* Then flush out any already in there */
		mmc_cleanup_queue(&md->queue);
Linus Torvalds's avatar
Linus Torvalds committed
571 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614

		mmc_blk_put(md);
	}
	mmc_set_drvdata(card, NULL);
}

#ifdef CONFIG_PM
static int mmc_blk_suspend(struct mmc_card *card, pm_message_t state)
{
	struct mmc_blk_data *md = mmc_get_drvdata(card);

	if (md) {
		mmc_queue_suspend(&md->queue);
	}
	return 0;
}

static int mmc_blk_resume(struct mmc_card *card)
{
	struct mmc_blk_data *md = mmc_get_drvdata(card);

	if (md) {
		mmc_blk_set_blksize(md, card);
		mmc_queue_resume(&md->queue);
	}
	return 0;
}
#else
#define	mmc_blk_suspend	NULL
#define mmc_blk_resume	NULL
#endif

static struct mmc_driver mmc_driver = {
	.drv		= {
		.name	= "mmcblk",
	},
	.probe		= mmc_blk_probe,
	.remove		= mmc_blk_remove,
	.suspend	= mmc_blk_suspend,
	.resume		= mmc_blk_resume,
};

static int __init mmc_blk_init(void)
{
615
	int res;
Linus Torvalds's avatar
Linus Torvalds committed
616

617 618
	res = register_blkdev(MMC_BLOCK_MAJOR, "mmc");
	if (res)
Linus Torvalds's avatar
Linus Torvalds committed
619 620
		goto out;

621 622 623
	res = mmc_register_driver(&mmc_driver);
	if (res)
		goto out2;
Linus Torvalds's avatar
Linus Torvalds committed
624

625 626 627
	return 0;
 out2:
	unregister_blkdev(MMC_BLOCK_MAJOR, "mmc");
Linus Torvalds's avatar
Linus Torvalds committed
628 629 630 631 632 633 634
 out:
	return res;
}

static void __exit mmc_blk_exit(void)
{
	mmc_unregister_driver(&mmc_driver);
635
	unregister_blkdev(MMC_BLOCK_MAJOR, "mmc");
Linus Torvalds's avatar
Linus Torvalds committed
636 637 638 639 640 641 642 643
}

module_init(mmc_blk_init);
module_exit(mmc_blk_exit);

MODULE_LICENSE("GPL");
MODULE_DESCRIPTION("Multimedia Card (MMC) block device driver");