block.c 15.2 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, disable_multi = 0;
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

254 255 256 257 258 259 260 261
		/*
		 * After a read error, we redo the request one sector at a time
		 * in order to accurately determine which sectors can be read
		 * successfully.
		 */
		if (disable_multi && brq.data.blocks > 1)
			brq.data.blocks = 1;

Russell King's avatar
Russell King committed
262
		if (brq.data.blocks > 1) {
David Brownell's avatar
David Brownell committed
263 264 265 266 267 268
			/* 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;
269 270
			readcmd = MMC_READ_MULTIPLE_BLOCK;
			writecmd = MMC_WRITE_MULTIPLE_BLOCK;
Russell King's avatar
Russell King committed
271 272
		} else {
			brq.mrq.stop = NULL;
273 274 275 276 277 278 279 280 281 282
			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
283
		}
Linus Torvalds's avatar
Linus Torvalds committed
284

285 286
		mmc_set_data_timeout(&brq.data, card);

Linus Torvalds's avatar
Linus Torvalds committed
287
		brq.data.sg = mq->sg;
288 289
		brq.data.sg_len = mmc_queue_map_sg(mq);

290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308
		/*
		 * Adjust the sg list so it is the same size as the
		 * request.
		 */
		if (brq.data.blocks != req->nr_sectors) {
			int i, data_size = brq.data.blocks << 9;
			struct scatterlist *sg;

			for_each_sg(brq.data.sg, sg, brq.data.sg_len, i) {
				data_size -= sg->length;
				if (data_size <= 0) {
					sg->length += data_size;
					i++;
					break;
				}
			}
			brq.data.sg_len = i;
		}

309
		mmc_queue_bounce_pre(mq);
Linus Torvalds's avatar
Linus Torvalds committed
310 311

		mmc_wait_for_req(card->host, &brq.mrq);
312 313 314

		mmc_queue_bounce_post(mq);

315 316 317 318 319
		/*
		 * 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.
		 */
320 321 322 323 324 325 326 327
		if (brq.cmd.error || brq.data.error || brq.stop.error) {
			if (brq.data.blocks > 1 && rq_data_dir(req) == READ) {
				/* Redo read one sector at a time */
				printk(KERN_WARNING "%s: retrying using single "
				       "block read\n", req->rq_disk->disk_name);
				disable_multi = 1;
				continue;
			}
328
			status = get_card_status(card, req);
329
		}
330

Linus Torvalds's avatar
Linus Torvalds committed
331
		if (brq.cmd.error) {
332 333 334 335
			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
336 337 338
		}

		if (brq.data.error) {
339 340 341 342 343 344 345 346
			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
347 348 349
		}

		if (brq.stop.error) {
350 351 352 353
			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
354 355
		}

David Brownell's avatar
David Brownell committed
356
		if (!mmc_host_is_spi(card->host) && rq_data_dir(req) != READ) {
357 358 359 360 361 362 363 364 365 366 367 368
			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;
				}
369 370 371 372 373 374 375
				/*
				 * 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
376 377

#if 0
378 379 380 381 382
			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
383
#endif
384
		}
Linus Torvalds's avatar
Linus Torvalds committed
385

386 387 388 389 390 391 392 393 394 395 396 397
		if (brq.cmd.error || brq.stop.error || brq.data.error) {
			if (rq_data_dir(req) == READ) {
				/*
				 * After an error, we redo I/O one sector at a
				 * time, so we only reach here after trying to
				 * read a single sector.
				 */
				spin_lock_irq(&md->lock);
				ret = __blk_end_request(req, -EIO, brq.data.blksz);
				spin_unlock_irq(&md->lock);
				continue;
			}
398
			goto cmd_err;
399
		}
400

Linus Torvalds's avatar
Linus Torvalds committed
401 402 403 404
		/*
		 * A block was successfully transferred.
		 */
		spin_lock_irq(&md->lock);
405
		ret = __blk_end_request(req, 0, brq.data.bytes_xfered);
Linus Torvalds's avatar
Linus Torvalds committed
406 407 408
		spin_unlock_irq(&md->lock);
	} while (ret);

409
	mmc_release_host(card->host);
Linus Torvalds's avatar
Linus Torvalds committed
410 411 412 413

	return 1;

 cmd_err:
414 415 416 417 418
 	/*
 	 * 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
419 420
	 * as reported by the controller (which might be less than
	 * the real number of written sectors, but never more).
Linus Torvalds's avatar
Linus Torvalds committed
421
	 */
422 423
	if (mmc_card_sd(card)) {
		u32 blocks;
424

425 426
		blocks = mmc_sd_num_wr_blocks(card);
		if (blocks != (u32)-1) {
427
			spin_lock_irq(&md->lock);
428
			ret = __blk_end_request(req, 0, blocks << 9);
429 430
			spin_unlock_irq(&md->lock);
		}
431 432 433 434
	} else {
		spin_lock_irq(&md->lock);
		ret = __blk_end_request(req, 0, brq.data.bytes_xfered);
		spin_unlock_irq(&md->lock);
435 436
	}

437
	mmc_release_host(card->host);
438

Linus Torvalds's avatar
Linus Torvalds committed
439
	spin_lock_irq(&md->lock);
440 441
	while (ret)
		ret = __blk_end_request(req, -EIO, blk_rq_cur_bytes(req));
Linus Torvalds's avatar
Linus Torvalds committed
442 443 444 445 446 447
	spin_unlock_irq(&md->lock);

	return 0;
}


448 449 450 451 452 453
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
454 455 456 457 458 459 460 461 462 463
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);

464
	md = kzalloc(sizeof(struct mmc_blk_data), GFP_KERNEL);
465 466 467 468
	if (!md) {
		ret = -ENOMEM;
		goto out;
	}
Linus Torvalds's avatar
Linus Torvalds committed
469 470


471 472 473 474 475
	/*
	 * 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
476

477 478 479 480 481
	md->disk = alloc_disk(1 << MMC_SHIFT);
	if (md->disk == NULL) {
		ret = -ENOMEM;
		goto err_kfree;
	}
Linus Torvalds's avatar
Linus Torvalds committed
482

483 484
	spin_lock_init(&md->lock);
	md->usage = 1;
Linus Torvalds's avatar
Linus Torvalds committed
485

486 487 488
	ret = mmc_init_queue(&md->queue, card, &md->lock);
	if (ret)
		goto err_putdisk;
Linus Torvalds's avatar
Linus Torvalds committed
489

490 491
	md->queue.issue_fn = mmc_blk_issue_rq;
	md->queue.data = md;
492

493
	md->disk->major	= MMC_BLOCK_MAJOR;
494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513
	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);

514
	blk_queue_hardsect_size(md->queue.queue, 512);
515

Pierre Ossman's avatar
Pierre Ossman committed
516 517 518 519 520 521 522 523 524 525 526 527 528 529
	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
530
	return md;
531 532 533 534 535 536 537

 err_putdisk:
	put_disk(md->disk);
 err_kfree:
	kfree(md);
 out:
	return ERR_PTR(ret);
Linus Torvalds's avatar
Linus Torvalds committed
538 539 540 541 542 543 544 545
}

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

546 547 548 549
	/* Block-addressed cards ignore MMC_SET_BLOCKLEN. */
	if (mmc_card_blockaddr(card))
		return 0;

550
	mmc_claim_host(card->host);
Linus Torvalds's avatar
Linus Torvalds committed
551
	cmd.opcode = MMC_SET_BLOCKLEN;
552
	cmd.arg = 512;
David Brownell's avatar
David Brownell committed
553
	cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_AC;
Linus Torvalds's avatar
Linus Torvalds committed
554
	err = mmc_wait_for_cmd(card->host, &cmd, 5);
555
	mmc_release_host(card->host);
Linus Torvalds's avatar
Linus Torvalds committed
556 557 558 559 560 561 562 563 564 565 566 567 568 569 570

	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;

571 572
	char cap_str[10];

573 574 575 576
	/*
	 * 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
577 578 579 580 581 582 583 584 585 586
		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;

587
	string_get_size((u64)get_capacity(md->disk) << 9, STRING_UNITS_2,
588 589
			cap_str, sizeof(cap_str));
	printk(KERN_INFO "%s: %s %s %s %s\n",
Linus Torvalds's avatar
Linus Torvalds committed
590
		md->disk->disk_name, mmc_card_id(card), mmc_card_name(card),
591
		cap_str, md->read_only ? "(ro)" : "");
Linus Torvalds's avatar
Linus Torvalds committed
592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607

	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) {
608
		/* Stop new requests from getting into the queue */
Linus Torvalds's avatar
Linus Torvalds committed
609 610
		del_gendisk(md->disk);

611 612
		/* Then flush out any already in there */
		mmc_cleanup_queue(&md->queue);
Linus Torvalds's avatar
Linus Torvalds committed
613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656

		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)
{
657
	int res;
Linus Torvalds's avatar
Linus Torvalds committed
658

659 660
	res = register_blkdev(MMC_BLOCK_MAJOR, "mmc");
	if (res)
Linus Torvalds's avatar
Linus Torvalds committed
661 662
		goto out;

663 664 665
	res = mmc_register_driver(&mmc_driver);
	if (res)
		goto out2;
Linus Torvalds's avatar
Linus Torvalds committed
666

667 668 669
	return 0;
 out2:
	unregister_blkdev(MMC_BLOCK_MAJOR, "mmc");
Linus Torvalds's avatar
Linus Torvalds committed
670 671 672 673 674 675 676
 out:
	return res;
}

static void __exit mmc_blk_exit(void)
{
	mmc_unregister_driver(&mmc_driver);
677
	unregister_blkdev(MMC_BLOCK_MAJOR, "mmc");
Linus Torvalds's avatar
Linus Torvalds committed
678 679 680 681 682 683 684 685
}

module_init(mmc_blk_init);
module_exit(mmc_blk_exit);

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