2 * Block driver for media (i.e., flash cards)
4 * Copyright 2002 Hewlett-Packard Company
5 * Copyright 2005-2008 Pierre Ossman
7 * Use consistent with the GNU GPL is permitted,
8 * provided that this copyright notice is
9 * preserved in its entirety in all copies and derived works.
11 * HEWLETT-PACKARD COMPANY MAKES NO WARRANTIES, EXPRESSED OR IMPLIED,
12 * AS TO THE USEFULNESS OR CORRECTNESS OF THIS CODE OR ITS
13 * FITNESS FOR ANY PARTICULAR PURPOSE.
15 * Many thanks to Alessandro Rubini and Jonathan Corbet!
17 * Author: Andrew Christian
20 #include <linux/moduleparam.h>
21 #include <linux/module.h>
22 #include <linux/init.h>
24 #include <linux/kernel.h>
26 #include <linux/slab.h>
27 #include <linux/errno.h>
28 #include <linux/hdreg.h>
29 #include <linux/kdev_t.h>
30 #include <linux/blkdev.h>
31 #include <linux/mutex.h>
32 #include <linux/scatterlist.h>
33 #include <linux/string_helpers.h>
34 #include <linux/delay.h>
35 #include <linux/capability.h>
36 #include <linux/compat.h>
38 #include <linux/mmc/ioctl.h>
39 #include <linux/mmc/card.h>
40 #include <linux/mmc/host.h>
41 #include <linux/mmc/mmc.h>
42 #include <linux/mmc/sd.h>
44 #include <asm/uaccess.h>
48 MODULE_ALIAS("mmc:block");
49 #ifdef MODULE_PARAM_PREFIX
50 #undef MODULE_PARAM_PREFIX
52 #define MODULE_PARAM_PREFIX "mmcblk."
54 #define INAND_CMD38_ARG_EXT_CSD 113
55 #define INAND_CMD38_ARG_ERASE 0x00
56 #define INAND_CMD38_ARG_TRIM 0x01
57 #define INAND_CMD38_ARG_SECERASE 0x80
58 #define INAND_CMD38_ARG_SECTRIM1 0x81
59 #define INAND_CMD38_ARG_SECTRIM2 0x88
61 static DEFINE_MUTEX(block_mutex
);
64 * The defaults come from config options but can be overriden by module
67 static int perdev_minors
= CONFIG_MMC_BLOCK_MINORS
;
70 * We've only got one major, so number of mmcblk devices is
71 * limited to 256 / number of minors per device.
73 static int max_devices
;
75 /* 256 minors, so at most 256 separate devices */
76 static DECLARE_BITMAP(dev_use
, 256);
77 static DECLARE_BITMAP(name_use
, 256);
80 * There is one mmc_blk_data per slot.
85 struct mmc_queue queue
;
86 struct list_head part
;
89 #define MMC_BLK_CMD23 (1 << 0) /* Can do SET_BLOCK_COUNT for multiblock */
90 #define MMC_BLK_REL_WR (1 << 1) /* MMC Reliable write support */
93 unsigned int read_only
;
94 unsigned int part_type
;
95 unsigned int name_idx
;
96 unsigned int reset_done
;
97 #define MMC_BLK_READ BIT(0)
98 #define MMC_BLK_WRITE BIT(1)
99 #define MMC_BLK_DISCARD BIT(2)
100 #define MMC_BLK_SECDISCARD BIT(3)
103 * Only set in main mmc_blk_data associated
104 * with mmc_card with mmc_set_drvdata, and keeps
105 * track of the current selected device partition.
107 unsigned int part_curr
;
108 struct device_attribute force_ro
;
109 struct device_attribute power_ro_lock
;
113 static DEFINE_MUTEX(open_lock
);
115 enum mmc_blk_status
{
126 module_param(perdev_minors
, int, 0444);
127 MODULE_PARM_DESC(perdev_minors
, "Minors numbers to allocate per device");
129 static struct mmc_blk_data
*mmc_blk_get(struct gendisk
*disk
)
131 struct mmc_blk_data
*md
;
133 mutex_lock(&open_lock
);
134 md
= disk
->private_data
;
135 if (md
&& md
->usage
== 0)
139 mutex_unlock(&open_lock
);
144 static inline int mmc_get_devidx(struct gendisk
*disk
)
146 int devmaj
= MAJOR(disk_devt(disk
));
147 int devidx
= MINOR(disk_devt(disk
)) / perdev_minors
;
150 devidx
= disk
->first_minor
/ perdev_minors
;
154 static void mmc_blk_put(struct mmc_blk_data
*md
)
156 mutex_lock(&open_lock
);
158 if (md
->usage
== 0) {
159 int devidx
= mmc_get_devidx(md
->disk
);
160 blk_cleanup_queue(md
->queue
.queue
);
162 __clear_bit(devidx
, dev_use
);
167 mutex_unlock(&open_lock
);
170 static ssize_t
power_ro_lock_show(struct device
*dev
,
171 struct device_attribute
*attr
, char *buf
)
174 struct mmc_blk_data
*md
= mmc_blk_get(dev_to_disk(dev
));
175 struct mmc_card
*card
= md
->queue
.card
;
178 if (card
->ext_csd
.boot_ro_lock
& EXT_CSD_BOOT_WP_B_PERM_WP_EN
)
180 else if (card
->ext_csd
.boot_ro_lock
& EXT_CSD_BOOT_WP_B_PWR_WP_EN
)
183 ret
= snprintf(buf
, PAGE_SIZE
, "%d\n", locked
);
188 static ssize_t
power_ro_lock_store(struct device
*dev
,
189 struct device_attribute
*attr
, const char *buf
, size_t count
)
192 struct mmc_blk_data
*md
, *part_md
;
193 struct mmc_card
*card
;
196 if (kstrtoul(buf
, 0, &set
))
202 md
= mmc_blk_get(dev_to_disk(dev
));
203 card
= md
->queue
.card
;
205 mmc_claim_host(card
->host
);
207 ret
= mmc_switch(card
, EXT_CSD_CMD_SET_NORMAL
, EXT_CSD_BOOT_WP
,
208 card
->ext_csd
.boot_ro_lock
|
209 EXT_CSD_BOOT_WP_B_PWR_WP_EN
,
210 card
->ext_csd
.part_time
);
212 pr_err("%s: Locking boot partition ro until next power on failed: %d\n", md
->disk
->disk_name
, ret
);
214 card
->ext_csd
.boot_ro_lock
|= EXT_CSD_BOOT_WP_B_PWR_WP_EN
;
216 mmc_release_host(card
->host
);
219 pr_info("%s: Locking boot partition ro until next power on\n",
220 md
->disk
->disk_name
);
221 set_disk_ro(md
->disk
, 1);
223 list_for_each_entry(part_md
, &md
->part
, part
)
224 if (part_md
->area_type
== MMC_BLK_DATA_AREA_BOOT
) {
225 pr_info("%s: Locking boot partition ro until next power on\n", part_md
->disk
->disk_name
);
226 set_disk_ro(part_md
->disk
, 1);
234 static ssize_t
force_ro_show(struct device
*dev
, struct device_attribute
*attr
,
238 struct mmc_blk_data
*md
= mmc_blk_get(dev_to_disk(dev
));
240 ret
= snprintf(buf
, PAGE_SIZE
, "%d",
241 get_disk_ro(dev_to_disk(dev
)) ^
247 static ssize_t
force_ro_store(struct device
*dev
, struct device_attribute
*attr
,
248 const char *buf
, size_t count
)
252 struct mmc_blk_data
*md
= mmc_blk_get(dev_to_disk(dev
));
253 unsigned long set
= simple_strtoul(buf
, &end
, 0);
259 set_disk_ro(dev_to_disk(dev
), set
|| md
->read_only
);
266 static int mmc_blk_open(struct block_device
*bdev
, fmode_t mode
)
268 struct mmc_blk_data
*md
= mmc_blk_get(bdev
->bd_disk
);
271 mutex_lock(&block_mutex
);
274 check_disk_change(bdev
);
277 if ((mode
& FMODE_WRITE
) && md
->read_only
) {
282 mutex_unlock(&block_mutex
);
287 static int mmc_blk_release(struct gendisk
*disk
, fmode_t mode
)
289 struct mmc_blk_data
*md
= disk
->private_data
;
291 mutex_lock(&block_mutex
);
293 mutex_unlock(&block_mutex
);
298 mmc_blk_getgeo(struct block_device
*bdev
, struct hd_geometry
*geo
)
300 geo
->cylinders
= get_capacity(bdev
->bd_disk
) / (4 * 16);
306 struct mmc_blk_ioc_data
{
307 struct mmc_ioc_cmd ic
;
312 static struct mmc_blk_ioc_data
*mmc_blk_ioctl_copy_from_user(
313 struct mmc_ioc_cmd __user
*user
)
315 struct mmc_blk_ioc_data
*idata
;
318 idata
= kzalloc(sizeof(*idata
), GFP_KERNEL
);
324 if (copy_from_user(&idata
->ic
, user
, sizeof(idata
->ic
))) {
329 idata
->buf_bytes
= (u64
) idata
->ic
.blksz
* idata
->ic
.blocks
;
330 if (idata
->buf_bytes
> MMC_IOC_MAX_BYTES
) {
335 if (!idata
->buf_bytes
)
338 idata
->buf
= kzalloc(idata
->buf_bytes
, GFP_KERNEL
);
344 if (copy_from_user(idata
->buf
, (void __user
*)(unsigned long)
345 idata
->ic
.data_ptr
, idata
->buf_bytes
)) {
360 static int mmc_blk_ioctl_cmd(struct block_device
*bdev
,
361 struct mmc_ioc_cmd __user
*ic_ptr
)
363 struct mmc_blk_ioc_data
*idata
;
364 struct mmc_blk_data
*md
;
365 struct mmc_card
*card
;
366 struct mmc_command cmd
= {0};
367 struct mmc_data data
= {0};
368 struct mmc_request mrq
= {NULL
};
369 struct scatterlist sg
;
373 * The caller must have CAP_SYS_RAWIO, and must be calling this on the
374 * whole block device, not on a partition. This prevents overspray
375 * between sibling partitions.
377 if ((!capable(CAP_SYS_RAWIO
)) || (bdev
!= bdev
->bd_contains
))
380 idata
= mmc_blk_ioctl_copy_from_user(ic_ptr
);
382 return PTR_ERR(idata
);
384 md
= mmc_blk_get(bdev
->bd_disk
);
390 card
= md
->queue
.card
;
396 cmd
.opcode
= idata
->ic
.opcode
;
397 cmd
.arg
= idata
->ic
.arg
;
398 cmd
.flags
= idata
->ic
.flags
;
400 if (idata
->buf_bytes
) {
403 data
.blksz
= idata
->ic
.blksz
;
404 data
.blocks
= idata
->ic
.blocks
;
406 sg_init_one(data
.sg
, idata
->buf
, idata
->buf_bytes
);
408 if (idata
->ic
.write_flag
)
409 data
.flags
= MMC_DATA_WRITE
;
411 data
.flags
= MMC_DATA_READ
;
413 /* data.flags must already be set before doing this. */
414 mmc_set_data_timeout(&data
, card
);
416 /* Allow overriding the timeout_ns for empirical tuning. */
417 if (idata
->ic
.data_timeout_ns
)
418 data
.timeout_ns
= idata
->ic
.data_timeout_ns
;
420 if ((cmd
.flags
& MMC_RSP_R1B
) == MMC_RSP_R1B
) {
422 * Pretend this is a data transfer and rely on the
423 * host driver to compute timeout. When all host
424 * drivers support cmd.cmd_timeout for R1B, this
428 * cmd.cmd_timeout = idata->ic.cmd_timeout_ms;
430 data
.timeout_ns
= idata
->ic
.cmd_timeout_ms
* 1000000;
438 mmc_claim_host(card
->host
);
440 if (idata
->ic
.is_acmd
) {
441 err
= mmc_app_cmd(card
->host
, card
);
446 mmc_wait_for_req(card
->host
, &mrq
);
449 dev_err(mmc_dev(card
->host
), "%s: cmd error %d\n",
450 __func__
, cmd
.error
);
455 dev_err(mmc_dev(card
->host
), "%s: data error %d\n",
456 __func__
, data
.error
);
462 * According to the SD specs, some commands require a delay after
463 * issuing the command.
465 if (idata
->ic
.postsleep_min_us
)
466 usleep_range(idata
->ic
.postsleep_min_us
, idata
->ic
.postsleep_max_us
);
468 if (copy_to_user(&(ic_ptr
->response
), cmd
.resp
, sizeof(cmd
.resp
))) {
473 if (!idata
->ic
.write_flag
) {
474 if (copy_to_user((void __user
*)(unsigned long) idata
->ic
.data_ptr
,
475 idata
->buf
, idata
->buf_bytes
)) {
482 mmc_release_host(card
->host
);
492 static int mmc_blk_ioctl(struct block_device
*bdev
, fmode_t mode
,
493 unsigned int cmd
, unsigned long arg
)
496 if (cmd
== MMC_IOC_CMD
)
497 ret
= mmc_blk_ioctl_cmd(bdev
, (struct mmc_ioc_cmd __user
*)arg
);
502 static int mmc_blk_compat_ioctl(struct block_device
*bdev
, fmode_t mode
,
503 unsigned int cmd
, unsigned long arg
)
505 return mmc_blk_ioctl(bdev
, mode
, cmd
, (unsigned long) compat_ptr(arg
));
509 static const struct block_device_operations mmc_bdops
= {
510 .open
= mmc_blk_open
,
511 .release
= mmc_blk_release
,
512 .getgeo
= mmc_blk_getgeo
,
513 .owner
= THIS_MODULE
,
514 .ioctl
= mmc_blk_ioctl
,
516 .compat_ioctl
= mmc_blk_compat_ioctl
,
520 static inline int mmc_blk_part_switch(struct mmc_card
*card
,
521 struct mmc_blk_data
*md
)
524 struct mmc_blk_data
*main_md
= mmc_get_drvdata(card
);
526 if (main_md
->part_curr
== md
->part_type
)
529 if (mmc_card_mmc(card
)) {
530 u8 part_config
= card
->ext_csd
.part_config
;
532 part_config
&= ~EXT_CSD_PART_CONFIG_ACC_MASK
;
533 part_config
|= md
->part_type
;
535 ret
= mmc_switch(card
, EXT_CSD_CMD_SET_NORMAL
,
536 EXT_CSD_PART_CONFIG
, part_config
,
537 card
->ext_csd
.part_time
);
541 card
->ext_csd
.part_config
= part_config
;
544 main_md
->part_curr
= md
->part_type
;
548 static u32
mmc_sd_num_wr_blocks(struct mmc_card
*card
)
554 struct mmc_request mrq
= {NULL
};
555 struct mmc_command cmd
= {0};
556 struct mmc_data data
= {0};
557 unsigned int timeout_us
;
559 struct scatterlist sg
;
561 cmd
.opcode
= MMC_APP_CMD
;
562 cmd
.arg
= card
->rca
<< 16;
563 cmd
.flags
= MMC_RSP_SPI_R1
| MMC_RSP_R1
| MMC_CMD_AC
;
565 err
= mmc_wait_for_cmd(card
->host
, &cmd
, 0);
568 if (!mmc_host_is_spi(card
->host
) && !(cmd
.resp
[0] & R1_APP_CMD
))
571 memset(&cmd
, 0, sizeof(struct mmc_command
));
573 cmd
.opcode
= SD_APP_SEND_NUM_WR_BLKS
;
575 cmd
.flags
= MMC_RSP_SPI_R1
| MMC_RSP_R1
| MMC_CMD_ADTC
;
577 data
.timeout_ns
= card
->csd
.tacc_ns
* 100;
578 data
.timeout_clks
= card
->csd
.tacc_clks
* 100;
580 timeout_us
= data
.timeout_ns
/ 1000;
581 timeout_us
+= data
.timeout_clks
* 1000 /
582 (card
->host
->ios
.clock
/ 1000);
584 if (timeout_us
> 100000) {
585 data
.timeout_ns
= 100000000;
586 data
.timeout_clks
= 0;
591 data
.flags
= MMC_DATA_READ
;
598 blocks
= kmalloc(4, GFP_KERNEL
);
602 sg_init_one(&sg
, blocks
, 4);
604 mmc_wait_for_req(card
->host
, &mrq
);
606 result
= ntohl(*blocks
);
609 if (cmd
.error
|| data
.error
)
615 static int send_stop(struct mmc_card
*card
, u32
*status
)
617 struct mmc_command cmd
= {0};
620 cmd
.opcode
= MMC_STOP_TRANSMISSION
;
621 cmd
.flags
= MMC_RSP_SPI_R1B
| MMC_RSP_R1B
| MMC_CMD_AC
;
622 err
= mmc_wait_for_cmd(card
->host
, &cmd
, 5);
624 *status
= cmd
.resp
[0];
628 static int get_card_status(struct mmc_card
*card
, u32
*status
, int retries
)
630 struct mmc_command cmd
= {0};
633 cmd
.opcode
= MMC_SEND_STATUS
;
634 if (!mmc_host_is_spi(card
->host
))
635 cmd
.arg
= card
->rca
<< 16;
636 cmd
.flags
= MMC_RSP_SPI_R2
| MMC_RSP_R1
| MMC_CMD_AC
;
637 err
= mmc_wait_for_cmd(card
->host
, &cmd
, retries
);
639 *status
= cmd
.resp
[0];
643 #define ERR_NOMEDIUM 3
646 #define ERR_CONTINUE 0
648 static int mmc_blk_cmd_error(struct request
*req
, const char *name
, int error
,
649 bool status_valid
, u32 status
)
653 /* response crc error, retry the r/w cmd */
654 pr_err("%s: %s sending %s command, card status %#x\n",
655 req
->rq_disk
->disk_name
, "response CRC error",
660 pr_err("%s: %s sending %s command, card status %#x\n",
661 req
->rq_disk
->disk_name
, "timed out", name
, status
);
663 /* If the status cmd initially failed, retry the r/w cmd */
668 * If it was a r/w cmd crc error, or illegal command
669 * (eg, issued in wrong state) then retry - we should
670 * have corrected the state problem above.
672 if (status
& (R1_COM_CRC_ERROR
| R1_ILLEGAL_COMMAND
))
675 /* Otherwise abort the command */
679 /* We don't understand the error code the driver gave us */
680 pr_err("%s: unknown error %d sending read/write command, card status %#x\n",
681 req
->rq_disk
->disk_name
, error
, status
);
687 * Initial r/w and stop cmd error recovery.
688 * We don't know whether the card received the r/w cmd or not, so try to
689 * restore things back to a sane state. Essentially, we do this as follows:
690 * - Obtain card status. If the first attempt to obtain card status fails,
691 * the status word will reflect the failed status cmd, not the failed
692 * r/w cmd. If we fail to obtain card status, it suggests we can no
693 * longer communicate with the card.
694 * - Check the card state. If the card received the cmd but there was a
695 * transient problem with the response, it might still be in a data transfer
696 * mode. Try to send it a stop command. If this fails, we can't recover.
697 * - If the r/w cmd failed due to a response CRC error, it was probably
698 * transient, so retry the cmd.
699 * - If the r/w cmd timed out, but we didn't get the r/w cmd status, retry.
700 * - If the r/w cmd timed out, and the r/w cmd failed due to CRC error or
701 * illegal cmd, retry.
702 * Otherwise we don't understand what happened, so abort.
704 static int mmc_blk_cmd_recovery(struct mmc_card
*card
, struct request
*req
,
705 struct mmc_blk_request
*brq
, int *ecc_err
)
707 bool prev_cmd_status_valid
= true;
708 u32 status
, stop_status
= 0;
711 if (mmc_card_removed(card
))
715 * Try to get card status which indicates both the card state
716 * and why there was no response. If the first attempt fails,
717 * we can't be sure the returned status is for the r/w command.
719 for (retry
= 2; retry
>= 0; retry
--) {
720 err
= get_card_status(card
, &status
, 0);
724 prev_cmd_status_valid
= false;
725 pr_err("%s: error %d sending status command, %sing\n",
726 req
->rq_disk
->disk_name
, err
, retry
? "retry" : "abort");
729 /* We couldn't get a response from the card. Give up. */
731 /* Check if the card is removed */
732 if (mmc_detect_card_removed(card
->host
))
737 /* Flag ECC errors */
738 if ((status
& R1_CARD_ECC_FAILED
) ||
739 (brq
->stop
.resp
[0] & R1_CARD_ECC_FAILED
) ||
740 (brq
->cmd
.resp
[0] & R1_CARD_ECC_FAILED
))
744 * Check the current card state. If it is in some data transfer
745 * mode, tell it to stop (and hopefully transition back to TRAN.)
747 if (R1_CURRENT_STATE(status
) == R1_STATE_DATA
||
748 R1_CURRENT_STATE(status
) == R1_STATE_RCV
) {
749 err
= send_stop(card
, &stop_status
);
751 pr_err("%s: error %d sending stop command\n",
752 req
->rq_disk
->disk_name
, err
);
755 * If the stop cmd also timed out, the card is probably
756 * not present, so abort. Other errors are bad news too.
760 if (stop_status
& R1_CARD_ECC_FAILED
)
764 /* Check for set block count errors */
766 return mmc_blk_cmd_error(req
, "SET_BLOCK_COUNT", brq
->sbc
.error
,
767 prev_cmd_status_valid
, status
);
769 /* Check for r/w command errors */
771 return mmc_blk_cmd_error(req
, "r/w cmd", brq
->cmd
.error
,
772 prev_cmd_status_valid
, status
);
775 if (!brq
->stop
.error
)
778 /* Now for stop errors. These aren't fatal to the transfer. */
779 pr_err("%s: error %d sending stop command, original cmd response %#x, card status %#x\n",
780 req
->rq_disk
->disk_name
, brq
->stop
.error
,
781 brq
->cmd
.resp
[0], status
);
784 * Subsitute in our own stop status as this will give the error
785 * state which happened during the execution of the r/w command.
788 brq
->stop
.resp
[0] = stop_status
;
794 static int mmc_blk_reset(struct mmc_blk_data
*md
, struct mmc_host
*host
,
799 if (md
->reset_done
& type
)
802 md
->reset_done
|= type
;
803 err
= mmc_hw_reset(host
);
804 /* Ensure we switch back to the correct partition */
805 if (err
!= -EOPNOTSUPP
) {
806 struct mmc_blk_data
*main_md
= mmc_get_drvdata(host
->card
);
809 main_md
->part_curr
= main_md
->part_type
;
810 part_err
= mmc_blk_part_switch(host
->card
, md
);
813 * We have failed to get back into the correct
814 * partition, so we need to abort the whole request.
822 static inline void mmc_blk_reset_success(struct mmc_blk_data
*md
, int type
)
824 md
->reset_done
&= ~type
;
827 static int mmc_blk_issue_discard_rq(struct mmc_queue
*mq
, struct request
*req
)
829 struct mmc_blk_data
*md
= mq
->data
;
830 struct mmc_card
*card
= md
->queue
.card
;
831 unsigned int from
, nr
, arg
;
832 int err
= 0, type
= MMC_BLK_DISCARD
;
834 if (!mmc_can_erase(card
)) {
839 from
= blk_rq_pos(req
);
840 nr
= blk_rq_sectors(req
);
842 if (mmc_can_discard(card
))
843 arg
= MMC_DISCARD_ARG
;
844 else if (mmc_can_trim(card
))
849 if (card
->quirks
& MMC_QUIRK_INAND_CMD38
) {
850 err
= mmc_switch(card
, EXT_CSD_CMD_SET_NORMAL
,
851 INAND_CMD38_ARG_EXT_CSD
,
852 arg
== MMC_TRIM_ARG
?
853 INAND_CMD38_ARG_TRIM
:
854 INAND_CMD38_ARG_ERASE
,
859 err
= mmc_erase(card
, from
, nr
, arg
);
861 if (err
== -EIO
&& !mmc_blk_reset(md
, card
->host
, type
))
864 mmc_blk_reset_success(md
, type
);
865 spin_lock_irq(&md
->lock
);
866 __blk_end_request(req
, err
, blk_rq_bytes(req
));
867 spin_unlock_irq(&md
->lock
);
872 static int mmc_blk_issue_secdiscard_rq(struct mmc_queue
*mq
,
875 struct mmc_blk_data
*md
= mq
->data
;
876 struct mmc_card
*card
= md
->queue
.card
;
877 unsigned int from
, nr
, arg
, trim_arg
, erase_arg
;
878 int err
= 0, type
= MMC_BLK_SECDISCARD
;
880 if (!(mmc_can_secure_erase_trim(card
) || mmc_can_sanitize(card
))) {
885 from
= blk_rq_pos(req
);
886 nr
= blk_rq_sectors(req
);
888 /* The sanitize operation is supported at v4.5 only */
889 if (mmc_can_sanitize(card
)) {
890 erase_arg
= MMC_ERASE_ARG
;
891 trim_arg
= MMC_TRIM_ARG
;
893 erase_arg
= MMC_SECURE_ERASE_ARG
;
894 trim_arg
= MMC_SECURE_TRIM1_ARG
;
897 if (mmc_erase_group_aligned(card
, from
, nr
))
899 else if (mmc_can_trim(card
))
906 if (card
->quirks
& MMC_QUIRK_INAND_CMD38
) {
907 err
= mmc_switch(card
, EXT_CSD_CMD_SET_NORMAL
,
908 INAND_CMD38_ARG_EXT_CSD
,
909 arg
== MMC_SECURE_TRIM1_ARG
?
910 INAND_CMD38_ARG_SECTRIM1
:
911 INAND_CMD38_ARG_SECERASE
,
917 err
= mmc_erase(card
, from
, nr
, arg
);
923 if (arg
== MMC_SECURE_TRIM1_ARG
) {
924 if (card
->quirks
& MMC_QUIRK_INAND_CMD38
) {
925 err
= mmc_switch(card
, EXT_CSD_CMD_SET_NORMAL
,
926 INAND_CMD38_ARG_EXT_CSD
,
927 INAND_CMD38_ARG_SECTRIM2
,
933 err
= mmc_erase(card
, from
, nr
, MMC_SECURE_TRIM2_ARG
);
940 if (mmc_can_sanitize(card
))
941 err
= mmc_switch(card
, EXT_CSD_CMD_SET_NORMAL
,
942 EXT_CSD_SANITIZE_START
, 1, 0);
944 if (err
&& !mmc_blk_reset(md
, card
->host
, type
))
947 mmc_blk_reset_success(md
, type
);
949 spin_lock_irq(&md
->lock
);
950 __blk_end_request(req
, err
, blk_rq_bytes(req
));
951 spin_unlock_irq(&md
->lock
);
956 static int mmc_blk_issue_flush(struct mmc_queue
*mq
, struct request
*req
)
958 struct mmc_blk_data
*md
= mq
->data
;
959 struct mmc_card
*card
= md
->queue
.card
;
962 ret
= mmc_flush_cache(card
);
966 spin_lock_irq(&md
->lock
);
967 __blk_end_request_all(req
, ret
);
968 spin_unlock_irq(&md
->lock
);
974 * Reformat current write as a reliable write, supporting
975 * both legacy and the enhanced reliable write MMC cards.
976 * In each transfer we'll handle only as much as a single
977 * reliable write can handle, thus finish the request in
978 * partial completions.
980 static inline void mmc_apply_rel_rw(struct mmc_blk_request
*brq
,
981 struct mmc_card
*card
,
984 if (!(card
->ext_csd
.rel_param
& EXT_CSD_WR_REL_PARAM_EN
)) {
985 /* Legacy mode imposes restrictions on transfers. */
986 if (!IS_ALIGNED(brq
->cmd
.arg
, card
->ext_csd
.rel_sectors
))
987 brq
->data
.blocks
= 1;
989 if (brq
->data
.blocks
> card
->ext_csd
.rel_sectors
)
990 brq
->data
.blocks
= card
->ext_csd
.rel_sectors
;
991 else if (brq
->data
.blocks
< card
->ext_csd
.rel_sectors
)
992 brq
->data
.blocks
= 1;
997 (R1_OUT_OF_RANGE | /* Command argument out of range */ \
998 R1_ADDRESS_ERROR | /* Misaligned address */ \
999 R1_BLOCK_LEN_ERROR | /* Transferred block length incorrect */\
1000 R1_WP_VIOLATION | /* Tried to write to protected block */ \
1001 R1_CC_ERROR | /* Card controller error */ \
1002 R1_ERROR) /* General/unknown error */
1004 static int mmc_blk_err_check(struct mmc_card
*card
,
1005 struct mmc_async_req
*areq
)
1007 struct mmc_queue_req
*mq_mrq
= container_of(areq
, struct mmc_queue_req
,
1009 struct mmc_blk_request
*brq
= &mq_mrq
->brq
;
1010 struct request
*req
= mq_mrq
->req
;
1014 * sbc.error indicates a problem with the set block count
1015 * command. No data will have been transferred.
1017 * cmd.error indicates a problem with the r/w command. No
1018 * data will have been transferred.
1020 * stop.error indicates a problem with the stop command. Data
1021 * may have been transferred, or may still be transferring.
1023 if (brq
->sbc
.error
|| brq
->cmd
.error
|| brq
->stop
.error
||
1025 switch (mmc_blk_cmd_recovery(card
, req
, brq
, &ecc_err
)) {
1027 return MMC_BLK_RETRY
;
1029 return MMC_BLK_ABORT
;
1031 return MMC_BLK_NOMEDIUM
;
1038 * Check for errors relating to the execution of the
1039 * initial command - such as address errors. No data
1040 * has been transferred.
1042 if (brq
->cmd
.resp
[0] & CMD_ERRORS
) {
1043 pr_err("%s: r/w command failed, status = %#x\n",
1044 req
->rq_disk
->disk_name
, brq
->cmd
.resp
[0]);
1045 return MMC_BLK_ABORT
;
1049 * Everything else is either success, or a data error of some
1050 * kind. If it was a write, we may have transitioned to
1051 * program mode, which we have to wait for it to complete.
1053 if (!mmc_host_is_spi(card
->host
) && rq_data_dir(req
) != READ
) {
1056 int err
= get_card_status(card
, &status
, 5);
1058 pr_err("%s: error %d requesting status\n",
1059 req
->rq_disk
->disk_name
, err
);
1060 return MMC_BLK_CMD_ERR
;
1063 * Some cards mishandle the status bits,
1064 * so make sure to check both the busy
1065 * indication and the card state.
1067 } while (!(status
& R1_READY_FOR_DATA
) ||
1068 (R1_CURRENT_STATE(status
) == R1_STATE_PRG
));
1071 if (brq
->data
.error
) {
1072 pr_err("%s: error %d transferring data, sector %u, nr %u, cmd response %#x, card status %#x\n",
1073 req
->rq_disk
->disk_name
, brq
->data
.error
,
1074 (unsigned)blk_rq_pos(req
),
1075 (unsigned)blk_rq_sectors(req
),
1076 brq
->cmd
.resp
[0], brq
->stop
.resp
[0]);
1078 if (rq_data_dir(req
) == READ
) {
1080 return MMC_BLK_ECC_ERR
;
1081 return MMC_BLK_DATA_ERR
;
1083 return MMC_BLK_CMD_ERR
;
1087 if (!brq
->data
.bytes_xfered
)
1088 return MMC_BLK_RETRY
;
1090 if (blk_rq_bytes(req
) != brq
->data
.bytes_xfered
)
1091 return MMC_BLK_PARTIAL
;
1093 return MMC_BLK_SUCCESS
;
1096 static void mmc_blk_rw_rq_prep(struct mmc_queue_req
*mqrq
,
1097 struct mmc_card
*card
,
1099 struct mmc_queue
*mq
)
1101 u32 readcmd
, writecmd
;
1102 struct mmc_blk_request
*brq
= &mqrq
->brq
;
1103 struct request
*req
= mqrq
->req
;
1104 struct mmc_blk_data
*md
= mq
->data
;
1108 * Reliable writes are used to implement Forced Unit Access and
1109 * REQ_META accesses, and are supported only on MMCs.
1111 * XXX: this really needs a good explanation of why REQ_META
1112 * is treated special.
1114 bool do_rel_wr
= ((req
->cmd_flags
& REQ_FUA
) ||
1115 (req
->cmd_flags
& REQ_META
)) &&
1116 (rq_data_dir(req
) == WRITE
) &&
1117 (md
->flags
& MMC_BLK_REL_WR
);
1119 memset(brq
, 0, sizeof(struct mmc_blk_request
));
1120 brq
->mrq
.cmd
= &brq
->cmd
;
1121 brq
->mrq
.data
= &brq
->data
;
1123 brq
->cmd
.arg
= blk_rq_pos(req
);
1124 if (!mmc_card_blockaddr(card
))
1126 brq
->cmd
.flags
= MMC_RSP_SPI_R1
| MMC_RSP_R1
| MMC_CMD_ADTC
;
1127 brq
->data
.blksz
= 512;
1128 brq
->stop
.opcode
= MMC_STOP_TRANSMISSION
;
1130 brq
->stop
.flags
= MMC_RSP_SPI_R1B
| MMC_RSP_R1B
| MMC_CMD_AC
;
1131 brq
->data
.blocks
= blk_rq_sectors(req
);
1134 * The block layer doesn't support all sector count
1135 * restrictions, so we need to be prepared for too big
1138 if (brq
->data
.blocks
> card
->host
->max_blk_count
)
1139 brq
->data
.blocks
= card
->host
->max_blk_count
;
1141 if (brq
->data
.blocks
> 1) {
1143 * After a read error, we redo the request one sector
1144 * at a time in order to accurately determine which
1145 * sectors can be read successfully.
1148 brq
->data
.blocks
= 1;
1150 /* Some controllers can't do multiblock reads due to hw bugs */
1151 if (card
->host
->caps2
& MMC_CAP2_NO_MULTI_READ
&&
1152 rq_data_dir(req
) == READ
)
1153 brq
->data
.blocks
= 1;
1156 if (brq
->data
.blocks
> 1 || do_rel_wr
) {
1157 /* SPI multiblock writes terminate using a special
1158 * token, not a STOP_TRANSMISSION request.
1160 if (!mmc_host_is_spi(card
->host
) ||
1161 rq_data_dir(req
) == READ
)
1162 brq
->mrq
.stop
= &brq
->stop
;
1163 readcmd
= MMC_READ_MULTIPLE_BLOCK
;
1164 writecmd
= MMC_WRITE_MULTIPLE_BLOCK
;
1166 brq
->mrq
.stop
= NULL
;
1167 readcmd
= MMC_READ_SINGLE_BLOCK
;
1168 writecmd
= MMC_WRITE_BLOCK
;
1170 if (rq_data_dir(req
) == READ
) {
1171 brq
->cmd
.opcode
= readcmd
;
1172 brq
->data
.flags
|= MMC_DATA_READ
;
1174 brq
->cmd
.opcode
= writecmd
;
1175 brq
->data
.flags
|= MMC_DATA_WRITE
;
1179 mmc_apply_rel_rw(brq
, card
, req
);
1182 * Data tag is used only during writing meta data to speed
1183 * up write and any subsequent read of this meta data
1185 do_data_tag
= (card
->ext_csd
.data_tag_unit_size
) &&
1186 (req
->cmd_flags
& REQ_META
) &&
1187 (rq_data_dir(req
) == WRITE
) &&
1188 ((brq
->data
.blocks
* brq
->data
.blksz
) >=
1189 card
->ext_csd
.data_tag_unit_size
);
1192 * Pre-defined multi-block transfers are preferable to
1193 * open ended-ones (and necessary for reliable writes).
1194 * However, it is not sufficient to just send CMD23,
1195 * and avoid the final CMD12, as on an error condition
1196 * CMD12 (stop) needs to be sent anyway. This, coupled
1197 * with Auto-CMD23 enhancements provided by some
1198 * hosts, means that the complexity of dealing
1199 * with this is best left to the host. If CMD23 is
1200 * supported by card and host, we'll fill sbc in and let
1201 * the host deal with handling it correctly. This means
1202 * that for hosts that don't expose MMC_CAP_CMD23, no
1203 * change of behavior will be observed.
1205 * N.B: Some MMC cards experience perf degradation.
1206 * We'll avoid using CMD23-bounded multiblock writes for
1207 * these, while retaining features like reliable writes.
1209 if ((md
->flags
& MMC_BLK_CMD23
) && mmc_op_multi(brq
->cmd
.opcode
) &&
1210 (do_rel_wr
|| !(card
->quirks
& MMC_QUIRK_BLK_NO_CMD23
) ||
1212 brq
->sbc
.opcode
= MMC_SET_BLOCK_COUNT
;
1213 brq
->sbc
.arg
= brq
->data
.blocks
|
1214 (do_rel_wr
? (1 << 31) : 0) |
1215 (do_data_tag
? (1 << 29) : 0);
1216 brq
->sbc
.flags
= MMC_RSP_R1
| MMC_CMD_AC
;
1217 brq
->mrq
.sbc
= &brq
->sbc
;
1220 mmc_set_data_timeout(&brq
->data
, card
);
1222 brq
->data
.sg
= mqrq
->sg
;
1223 brq
->data
.sg_len
= mmc_queue_map_sg(mq
, mqrq
);
1226 * Adjust the sg list so it is the same size as the
1229 if (brq
->data
.blocks
!= blk_rq_sectors(req
)) {
1230 int i
, data_size
= brq
->data
.blocks
<< 9;
1231 struct scatterlist
*sg
;
1233 for_each_sg(brq
->data
.sg
, sg
, brq
->data
.sg_len
, i
) {
1234 data_size
-= sg
->length
;
1235 if (data_size
<= 0) {
1236 sg
->length
+= data_size
;
1241 brq
->data
.sg_len
= i
;
1244 mqrq
->mmc_active
.mrq
= &brq
->mrq
;
1245 mqrq
->mmc_active
.err_check
= mmc_blk_err_check
;
1247 mmc_queue_bounce_pre(mqrq
);
1250 static int mmc_blk_cmd_err(struct mmc_blk_data
*md
, struct mmc_card
*card
,
1251 struct mmc_blk_request
*brq
, struct request
*req
,
1255 * If this is an SD card and we're writing, we can first
1256 * mark the known good sectors as ok.
1258 * If the card is not SD, we can still ok written sectors
1259 * as reported by the controller (which might be less than
1260 * the real number of written sectors, but never more).
1262 if (mmc_card_sd(card
)) {
1265 blocks
= mmc_sd_num_wr_blocks(card
);
1266 if (blocks
!= (u32
)-1) {
1267 spin_lock_irq(&md
->lock
);
1268 ret
= __blk_end_request(req
, 0, blocks
<< 9);
1269 spin_unlock_irq(&md
->lock
);
1272 spin_lock_irq(&md
->lock
);
1273 ret
= __blk_end_request(req
, 0, brq
->data
.bytes_xfered
);
1274 spin_unlock_irq(&md
->lock
);
1279 static int mmc_blk_issue_rw_rq(struct mmc_queue
*mq
, struct request
*rqc
)
1281 struct mmc_blk_data
*md
= mq
->data
;
1282 struct mmc_card
*card
= md
->queue
.card
;
1283 struct mmc_blk_request
*brq
= &mq
->mqrq_cur
->brq
;
1284 int ret
= 1, disable_multi
= 0, retry
= 0, type
;
1285 enum mmc_blk_status status
;
1286 struct mmc_queue_req
*mq_rq
;
1287 struct request
*req
= rqc
;
1288 struct mmc_async_req
*areq
;
1290 if (!rqc
&& !mq
->mqrq_prev
->req
)
1296 * When 4KB native sector is enabled, only 8 blocks
1297 * multiple read or write is allowed
1299 if ((brq
->data
.blocks
& 0x07) &&
1300 (card
->ext_csd
.data_sector_size
== 4096)) {
1301 pr_err("%s: Transfer size is not 4KB sector size aligned\n",
1302 req
->rq_disk
->disk_name
);
1305 mmc_blk_rw_rq_prep(mq
->mqrq_cur
, card
, 0, mq
);
1306 areq
= &mq
->mqrq_cur
->mmc_active
;
1309 areq
= mmc_start_req(card
->host
, areq
, (int *) &status
);
1313 mq_rq
= container_of(areq
, struct mmc_queue_req
, mmc_active
);
1316 type
= rq_data_dir(req
) == READ
? MMC_BLK_READ
: MMC_BLK_WRITE
;
1317 mmc_queue_bounce_post(mq_rq
);
1320 case MMC_BLK_SUCCESS
:
1321 case MMC_BLK_PARTIAL
:
1323 * A block was successfully transferred.
1325 mmc_blk_reset_success(md
, type
);
1326 spin_lock_irq(&md
->lock
);
1327 ret
= __blk_end_request(req
, 0,
1328 brq
->data
.bytes_xfered
);
1329 spin_unlock_irq(&md
->lock
);
1331 * If the blk_end_request function returns non-zero even
1332 * though all data has been transferred and no errors
1333 * were returned by the host controller, it's a bug.
1335 if (status
== MMC_BLK_SUCCESS
&& ret
) {
1336 pr_err("%s BUG rq_tot %d d_xfer %d\n",
1337 __func__
, blk_rq_bytes(req
),
1338 brq
->data
.bytes_xfered
);
1343 case MMC_BLK_CMD_ERR
:
1344 ret
= mmc_blk_cmd_err(md
, card
, brq
, req
, ret
);
1345 if (!mmc_blk_reset(md
, card
->host
, type
))
1353 if (!mmc_blk_reset(md
, card
->host
, type
))
1356 case MMC_BLK_DATA_ERR
: {
1359 err
= mmc_blk_reset(md
, card
->host
, type
);
1366 case MMC_BLK_ECC_ERR
:
1367 if (brq
->data
.blocks
> 1) {
1368 /* Redo read one sector at a time */
1369 pr_warning("%s: retrying using single block read\n",
1370 req
->rq_disk
->disk_name
);
1375 * After an error, we redo I/O one sector at a
1376 * time, so we only reach here after trying to
1377 * read a single sector.
1379 spin_lock_irq(&md
->lock
);
1380 ret
= __blk_end_request(req
, -EIO
,
1382 spin_unlock_irq(&md
->lock
);
1386 case MMC_BLK_NOMEDIUM
:
1392 * In case of a incomplete request
1393 * prepare it again and resend.
1395 mmc_blk_rw_rq_prep(mq_rq
, card
, disable_multi
, mq
);
1396 mmc_start_req(card
->host
, &mq_rq
->mmc_active
, NULL
);
1403 spin_lock_irq(&md
->lock
);
1404 if (mmc_card_removed(card
))
1405 req
->cmd_flags
|= REQ_QUIET
;
1407 ret
= __blk_end_request(req
, -EIO
, blk_rq_cur_bytes(req
));
1408 spin_unlock_irq(&md
->lock
);
1412 mmc_blk_rw_rq_prep(mq
->mqrq_cur
, card
, 0, mq
);
1413 mmc_start_req(card
->host
, &mq
->mqrq_cur
->mmc_active
, NULL
);
1419 static int mmc_blk_issue_rq(struct mmc_queue
*mq
, struct request
*req
)
1422 struct mmc_blk_data
*md
= mq
->data
;
1423 struct mmc_card
*card
= md
->queue
.card
;
1425 if (req
&& !mq
->mqrq_prev
->req
)
1426 /* claim host only for the first request */
1427 mmc_claim_host(card
->host
);
1429 ret
= mmc_blk_part_switch(card
, md
);
1432 spin_lock_irq(&md
->lock
);
1433 __blk_end_request_all(req
, -EIO
);
1434 spin_unlock_irq(&md
->lock
);
1440 if (req
&& req
->cmd_flags
& REQ_DISCARD
) {
1441 /* complete ongoing async transfer before issuing discard */
1442 if (card
->host
->areq
)
1443 mmc_blk_issue_rw_rq(mq
, NULL
);
1444 if (req
->cmd_flags
& REQ_SECURE
)
1445 ret
= mmc_blk_issue_secdiscard_rq(mq
, req
);
1447 ret
= mmc_blk_issue_discard_rq(mq
, req
);
1448 } else if (req
&& req
->cmd_flags
& REQ_FLUSH
) {
1449 /* complete ongoing async transfer before issuing flush */
1450 if (card
->host
->areq
)
1451 mmc_blk_issue_rw_rq(mq
, NULL
);
1452 ret
= mmc_blk_issue_flush(mq
, req
);
1454 ret
= mmc_blk_issue_rw_rq(mq
, req
);
1459 /* release host only when there are no more requests */
1460 mmc_release_host(card
->host
);
1464 static inline int mmc_blk_readonly(struct mmc_card
*card
)
1466 return mmc_card_readonly(card
) ||
1467 !(card
->csd
.cmdclass
& CCC_BLOCK_WRITE
);
1470 static struct mmc_blk_data
*mmc_blk_alloc_req(struct mmc_card
*card
,
1471 struct device
*parent
,
1474 const char *subname
,
1477 struct mmc_blk_data
*md
;
1480 devidx
= find_first_zero_bit(dev_use
, max_devices
);
1481 if (devidx
>= max_devices
)
1482 return ERR_PTR(-ENOSPC
);
1483 __set_bit(devidx
, dev_use
);
1485 md
= kzalloc(sizeof(struct mmc_blk_data
), GFP_KERNEL
);
1492 * !subname implies we are creating main mmc_blk_data that will be
1493 * associated with mmc_card with mmc_set_drvdata. Due to device
1494 * partitions, devidx will not coincide with a per-physical card
1495 * index anymore so we keep track of a name index.
1498 md
->name_idx
= find_first_zero_bit(name_use
, max_devices
);
1499 __set_bit(md
->name_idx
, name_use
);
1501 md
->name_idx
= ((struct mmc_blk_data
*)
1502 dev_to_disk(parent
)->private_data
)->name_idx
;
1504 md
->area_type
= area_type
;
1507 * Set the read-only status based on the supported commands
1508 * and the write protect switch.
1510 md
->read_only
= mmc_blk_readonly(card
);
1512 md
->disk
= alloc_disk(perdev_minors
);
1513 if (md
->disk
== NULL
) {
1518 spin_lock_init(&md
->lock
);
1519 INIT_LIST_HEAD(&md
->part
);
1522 ret
= mmc_init_queue(&md
->queue
, card
, &md
->lock
, subname
);
1526 md
->queue
.issue_fn
= mmc_blk_issue_rq
;
1527 md
->queue
.data
= md
;
1529 md
->disk
->major
= MMC_BLOCK_MAJOR
;
1530 md
->disk
->first_minor
= devidx
* perdev_minors
;
1531 md
->disk
->fops
= &mmc_bdops
;
1532 md
->disk
->private_data
= md
;
1533 md
->disk
->queue
= md
->queue
.queue
;
1534 md
->disk
->driverfs_dev
= parent
;
1535 set_disk_ro(md
->disk
, md
->read_only
|| default_ro
);
1538 * As discussed on lkml, GENHD_FL_REMOVABLE should:
1540 * - be set for removable media with permanent block devices
1541 * - be unset for removable block devices with permanent media
1543 * Since MMC block devices clearly fall under the second
1544 * case, we do not set GENHD_FL_REMOVABLE. Userspace
1545 * should use the block device creation/destruction hotplug
1546 * messages to tell when the card is present.
1549 snprintf(md
->disk
->disk_name
, sizeof(md
->disk
->disk_name
),
1550 "mmcblk%d%s", md
->name_idx
, subname
? subname
: "");
1552 if (mmc_card_mmc(card
))
1553 blk_queue_logical_block_size(md
->queue
.queue
,
1554 card
->ext_csd
.data_sector_size
);
1556 blk_queue_logical_block_size(md
->queue
.queue
, 512);
1558 set_capacity(md
->disk
, size
);
1560 if (mmc_host_cmd23(card
->host
)) {
1561 if (mmc_card_mmc(card
) ||
1562 (mmc_card_sd(card
) &&
1563 card
->scr
.cmds
& SD_SCR_CMD23_SUPPORT
))
1564 md
->flags
|= MMC_BLK_CMD23
;
1567 if (mmc_card_mmc(card
) &&
1568 md
->flags
& MMC_BLK_CMD23
&&
1569 ((card
->ext_csd
.rel_param
& EXT_CSD_WR_REL_PARAM_EN
) ||
1570 card
->ext_csd
.rel_sectors
)) {
1571 md
->flags
|= MMC_BLK_REL_WR
;
1572 blk_queue_flush(md
->queue
.queue
, REQ_FLUSH
| REQ_FUA
);
1582 return ERR_PTR(ret
);
1585 static struct mmc_blk_data
*mmc_blk_alloc(struct mmc_card
*card
)
1588 struct mmc_blk_data
*md
;
1590 if (!mmc_card_sd(card
) && mmc_card_blockaddr(card
)) {
1592 * The EXT_CSD sector count is in number or 512 byte
1595 size
= card
->ext_csd
.sectors
;
1598 * The CSD capacity field is in units of read_blkbits.
1599 * set_capacity takes units of 512 bytes.
1601 size
= card
->csd
.capacity
<< (card
->csd
.read_blkbits
- 9);
1604 md
= mmc_blk_alloc_req(card
, &card
->dev
, size
, false, NULL
,
1605 MMC_BLK_DATA_AREA_MAIN
);
1609 static int mmc_blk_alloc_part(struct mmc_card
*card
,
1610 struct mmc_blk_data
*md
,
1611 unsigned int part_type
,
1614 const char *subname
,
1618 struct mmc_blk_data
*part_md
;
1620 part_md
= mmc_blk_alloc_req(card
, disk_to_dev(md
->disk
), size
, default_ro
,
1621 subname
, area_type
);
1622 if (IS_ERR(part_md
))
1623 return PTR_ERR(part_md
);
1624 part_md
->part_type
= part_type
;
1625 list_add(&part_md
->part
, &md
->part
);
1627 string_get_size((u64
)get_capacity(part_md
->disk
) << 9, STRING_UNITS_2
,
1628 cap_str
, sizeof(cap_str
));
1629 pr_info("%s: %s %s partition %u %s\n",
1630 part_md
->disk
->disk_name
, mmc_card_id(card
),
1631 mmc_card_name(card
), part_md
->part_type
, cap_str
);
1635 /* MMC Physical partitions consist of two boot partitions and
1636 * up to four general purpose partitions.
1637 * For each partition enabled in EXT_CSD a block device will be allocatedi
1638 * to provide access to the partition.
1641 static int mmc_blk_alloc_parts(struct mmc_card
*card
, struct mmc_blk_data
*md
)
1645 if (!mmc_card_mmc(card
))
1648 for (idx
= 0; idx
< card
->nr_parts
; idx
++) {
1649 if (card
->part
[idx
].size
) {
1650 ret
= mmc_blk_alloc_part(card
, md
,
1651 card
->part
[idx
].part_cfg
,
1652 card
->part
[idx
].size
>> 9,
1653 card
->part
[idx
].force_ro
,
1654 card
->part
[idx
].name
,
1655 card
->part
[idx
].area_type
);
1664 static void mmc_blk_remove_req(struct mmc_blk_data
*md
)
1666 struct mmc_card
*card
;
1669 card
= md
->queue
.card
;
1670 if (md
->disk
->flags
& GENHD_FL_UP
) {
1671 device_remove_file(disk_to_dev(md
->disk
), &md
->force_ro
);
1672 if ((md
->area_type
& MMC_BLK_DATA_AREA_BOOT
) &&
1673 card
->ext_csd
.boot_ro_lockable
)
1674 device_remove_file(disk_to_dev(md
->disk
),
1675 &md
->power_ro_lock
);
1677 /* Stop new requests from getting into the queue */
1678 del_gendisk(md
->disk
);
1681 /* Then flush out any already in there */
1682 mmc_cleanup_queue(&md
->queue
);
1687 static void mmc_blk_remove_parts(struct mmc_card
*card
,
1688 struct mmc_blk_data
*md
)
1690 struct list_head
*pos
, *q
;
1691 struct mmc_blk_data
*part_md
;
1693 __clear_bit(md
->name_idx
, name_use
);
1694 list_for_each_safe(pos
, q
, &md
->part
) {
1695 part_md
= list_entry(pos
, struct mmc_blk_data
, part
);
1697 mmc_blk_remove_req(part_md
);
1701 static int mmc_add_disk(struct mmc_blk_data
*md
)
1704 struct mmc_card
*card
= md
->queue
.card
;
1707 md
->force_ro
.show
= force_ro_show
;
1708 md
->force_ro
.store
= force_ro_store
;
1709 sysfs_attr_init(&md
->force_ro
.attr
);
1710 md
->force_ro
.attr
.name
= "force_ro";
1711 md
->force_ro
.attr
.mode
= S_IRUGO
| S_IWUSR
;
1712 ret
= device_create_file(disk_to_dev(md
->disk
), &md
->force_ro
);
1716 if ((md
->area_type
& MMC_BLK_DATA_AREA_BOOT
) &&
1717 card
->ext_csd
.boot_ro_lockable
) {
1720 if (card
->ext_csd
.boot_ro_lock
& EXT_CSD_BOOT_WP_B_PWR_WP_DIS
)
1723 mode
= S_IRUGO
| S_IWUSR
;
1725 md
->power_ro_lock
.show
= power_ro_lock_show
;
1726 md
->power_ro_lock
.store
= power_ro_lock_store
;
1727 sysfs_attr_init(&md
->power_ro_lock
.attr
);
1728 md
->power_ro_lock
.attr
.mode
= mode
;
1729 md
->power_ro_lock
.attr
.name
=
1730 "ro_lock_until_next_power_on";
1731 ret
= device_create_file(disk_to_dev(md
->disk
),
1732 &md
->power_ro_lock
);
1734 goto power_ro_lock_fail
;
1739 device_remove_file(disk_to_dev(md
->disk
), &md
->force_ro
);
1741 del_gendisk(md
->disk
);
1746 #define CID_MANFID_SANDISK 0x2
1747 #define CID_MANFID_TOSHIBA 0x11
1748 #define CID_MANFID_MICRON 0x13
1750 static const struct mmc_fixup blk_fixups
[] =
1752 MMC_FIXUP("SEM02G", CID_MANFID_SANDISK
, 0x100, add_quirk
,
1753 MMC_QUIRK_INAND_CMD38
),
1754 MMC_FIXUP("SEM04G", CID_MANFID_SANDISK
, 0x100, add_quirk
,
1755 MMC_QUIRK_INAND_CMD38
),
1756 MMC_FIXUP("SEM08G", CID_MANFID_SANDISK
, 0x100, add_quirk
,
1757 MMC_QUIRK_INAND_CMD38
),
1758 MMC_FIXUP("SEM16G", CID_MANFID_SANDISK
, 0x100, add_quirk
,
1759 MMC_QUIRK_INAND_CMD38
),
1760 MMC_FIXUP("SEM32G", CID_MANFID_SANDISK
, 0x100, add_quirk
,
1761 MMC_QUIRK_INAND_CMD38
),
1764 * Some MMC cards experience performance degradation with CMD23
1765 * instead of CMD12-bounded multiblock transfers. For now we'll
1766 * black list what's bad...
1767 * - Certain Toshiba cards.
1769 * N.B. This doesn't affect SD cards.
1771 MMC_FIXUP("MMC08G", CID_MANFID_TOSHIBA
, CID_OEMID_ANY
, add_quirk_mmc
,
1772 MMC_QUIRK_BLK_NO_CMD23
),
1773 MMC_FIXUP("MMC16G", CID_MANFID_TOSHIBA
, CID_OEMID_ANY
, add_quirk_mmc
,
1774 MMC_QUIRK_BLK_NO_CMD23
),
1775 MMC_FIXUP("MMC32G", CID_MANFID_TOSHIBA
, CID_OEMID_ANY
, add_quirk_mmc
,
1776 MMC_QUIRK_BLK_NO_CMD23
),
1779 * Some Micron MMC cards needs longer data read timeout than
1782 MMC_FIXUP(CID_NAME_ANY
, CID_MANFID_MICRON
, 0x200, add_quirk_mmc
,
1783 MMC_QUIRK_LONG_READ_TIME
),
1788 static int mmc_blk_probe(struct mmc_card
*card
)
1790 struct mmc_blk_data
*md
, *part_md
;
1794 * Check that the card supports the command class(es) we need.
1796 if (!(card
->csd
.cmdclass
& CCC_BLOCK_READ
))
1799 md
= mmc_blk_alloc(card
);
1803 string_get_size((u64
)get_capacity(md
->disk
) << 9, STRING_UNITS_2
,
1804 cap_str
, sizeof(cap_str
));
1805 pr_info("%s: %s %s %s %s\n",
1806 md
->disk
->disk_name
, mmc_card_id(card
), mmc_card_name(card
),
1807 cap_str
, md
->read_only
? "(ro)" : "");
1809 if (mmc_blk_alloc_parts(card
, md
))
1812 mmc_set_drvdata(card
, md
);
1813 mmc_fixup_device(card
, blk_fixups
);
1815 if (mmc_add_disk(md
))
1818 list_for_each_entry(part_md
, &md
->part
, part
) {
1819 if (mmc_add_disk(part_md
))
1825 mmc_blk_remove_parts(card
, md
);
1826 mmc_blk_remove_req(md
);
1830 static void mmc_blk_remove(struct mmc_card
*card
)
1832 struct mmc_blk_data
*md
= mmc_get_drvdata(card
);
1834 mmc_blk_remove_parts(card
, md
);
1835 mmc_claim_host(card
->host
);
1836 mmc_blk_part_switch(card
, md
);
1837 mmc_release_host(card
->host
);
1838 mmc_blk_remove_req(md
);
1839 mmc_set_drvdata(card
, NULL
);
1843 static int mmc_blk_suspend(struct mmc_card
*card
)
1845 struct mmc_blk_data
*part_md
;
1846 struct mmc_blk_data
*md
= mmc_get_drvdata(card
);
1849 mmc_queue_suspend(&md
->queue
);
1850 list_for_each_entry(part_md
, &md
->part
, part
) {
1851 mmc_queue_suspend(&part_md
->queue
);
1857 static int mmc_blk_resume(struct mmc_card
*card
)
1859 struct mmc_blk_data
*part_md
;
1860 struct mmc_blk_data
*md
= mmc_get_drvdata(card
);
1864 * Resume involves the card going into idle state,
1865 * so current partition is always the main one.
1867 md
->part_curr
= md
->part_type
;
1868 mmc_queue_resume(&md
->queue
);
1869 list_for_each_entry(part_md
, &md
->part
, part
) {
1870 mmc_queue_resume(&part_md
->queue
);
1876 #define mmc_blk_suspend NULL
1877 #define mmc_blk_resume NULL
1880 static struct mmc_driver mmc_driver
= {
1884 .probe
= mmc_blk_probe
,
1885 .remove
= mmc_blk_remove
,
1886 .suspend
= mmc_blk_suspend
,
1887 .resume
= mmc_blk_resume
,
1890 static int __init
mmc_blk_init(void)
1894 if (perdev_minors
!= CONFIG_MMC_BLOCK_MINORS
)
1895 pr_info("mmcblk: using %d minors per device\n", perdev_minors
);
1897 max_devices
= 256 / perdev_minors
;
1899 res
= register_blkdev(MMC_BLOCK_MAJOR
, "mmc");
1903 res
= mmc_register_driver(&mmc_driver
);
1909 unregister_blkdev(MMC_BLOCK_MAJOR
, "mmc");
1914 static void __exit
mmc_blk_exit(void)
1916 mmc_unregister_driver(&mmc_driver
);
1917 unregister_blkdev(MMC_BLOCK_MAJOR
, "mmc");
1920 module_init(mmc_blk_init
);
1921 module_exit(mmc_blk_exit
);
1923 MODULE_LICENSE("GPL");
1924 MODULE_DESCRIPTION("Multimedia Card (MMC) block device driver");