2005-04-17 06:20:36 +08:00
|
|
|
/*
|
|
|
|
* Block driver for media (i.e., flash cards)
|
|
|
|
*
|
|
|
|
* Copyright 2002 Hewlett-Packard Company
|
2008-06-29 18:19:47 +08:00
|
|
|
* Copyright 2005-2008 Pierre Ossman
|
2005-04-17 06:20:36 +08:00
|
|
|
*
|
|
|
|
* 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 cleanup: Update gfp.h and slab.h includes to prepare for breaking implicit slab.h inclusion from percpu.h
percpu.h is included by sched.h and module.h and thus ends up being
included when building most .c files. percpu.h includes slab.h which
in turn includes gfp.h making everything defined by the two files
universally available and complicating inclusion dependencies.
percpu.h -> slab.h dependency is about to be removed. Prepare for
this change by updating users of gfp and slab facilities include those
headers directly instead of assuming availability. As this conversion
needs to touch large number of source files, the following script is
used as the basis of conversion.
http://userweb.kernel.org/~tj/misc/slabh-sweep.py
The script does the followings.
* Scan files for gfp and slab usages and update includes such that
only the necessary includes are there. ie. if only gfp is used,
gfp.h, if slab is used, slab.h.
* When the script inserts a new include, it looks at the include
blocks and try to put the new include such that its order conforms
to its surrounding. It's put in the include block which contains
core kernel includes, in the same order that the rest are ordered -
alphabetical, Christmas tree, rev-Xmas-tree or at the end if there
doesn't seem to be any matching order.
* If the script can't find a place to put a new include (mostly
because the file doesn't have fitting include block), it prints out
an error message indicating which .h file needs to be added to the
file.
The conversion was done in the following steps.
1. The initial automatic conversion of all .c files updated slightly
over 4000 files, deleting around 700 includes and adding ~480 gfp.h
and ~3000 slab.h inclusions. The script emitted errors for ~400
files.
2. Each error was manually checked. Some didn't need the inclusion,
some needed manual addition while adding it to implementation .h or
embedding .c file was more appropriate for others. This step added
inclusions to around 150 files.
3. The script was run again and the output was compared to the edits
from #2 to make sure no file was left behind.
4. Several build tests were done and a couple of problems were fixed.
e.g. lib/decompress_*.c used malloc/free() wrappers around slab
APIs requiring slab.h to be added manually.
5. The script was run on all .h files but without automatically
editing them as sprinkling gfp.h and slab.h inclusions around .h
files could easily lead to inclusion dependency hell. Most gfp.h
inclusion directives were ignored as stuff from gfp.h was usually
wildly available and often used in preprocessor macros. Each
slab.h inclusion directive was examined and added manually as
necessary.
6. percpu.h was updated not to include slab.h.
7. Build test were done on the following configurations and failures
were fixed. CONFIG_GCOV_KERNEL was turned off for all tests (as my
distributed build env didn't work with gcov compiles) and a few
more options had to be turned off depending on archs to make things
build (like ipr on powerpc/64 which failed due to missing writeq).
* x86 and x86_64 UP and SMP allmodconfig and a custom test config.
* powerpc and powerpc64 SMP allmodconfig
* sparc and sparc64 SMP allmodconfig
* ia64 SMP allmodconfig
* s390 SMP allmodconfig
* alpha SMP allmodconfig
* um on x86_64 SMP allmodconfig
8. percpu.h modifications were reverted so that it could be applied as
a separate patch and serve as bisection point.
Given the fact that I had only a couple of failures from tests on step
6, I'm fairly confident about the coverage of this conversion patch.
If there is a breakage, it's likely to be something in one of the arch
headers which should be easily discoverable easily on most builds of
the specific arch.
Signed-off-by: Tejun Heo <tj@kernel.org>
Guess-its-ok-by: Christoph Lameter <cl@linux-foundation.org>
Cc: Ingo Molnar <mingo@redhat.com>
Cc: Lee Schermerhorn <Lee.Schermerhorn@hp.com>
2010-03-24 16:04:11 +08:00
|
|
|
#include <linux/slab.h>
|
2005-04-17 06:20:36 +08:00
|
|
|
#include <linux/errno.h>
|
|
|
|
#include <linux/hdreg.h>
|
|
|
|
#include <linux/kdev_t.h>
|
|
|
|
#include <linux/blkdev.h>
|
2006-01-13 02:43:35 +08:00
|
|
|
#include <linux/mutex.h>
|
2006-10-06 15:44:03 +08:00
|
|
|
#include <linux/scatterlist.h>
|
2008-09-06 16:57:57 +08:00
|
|
|
#include <linux/string_helpers.h>
|
2011-04-27 06:56:29 +08:00
|
|
|
#include <linux/delay.h>
|
|
|
|
#include <linux/capability.h>
|
|
|
|
#include <linux/compat.h>
|
2013-05-02 20:02:38 +08:00
|
|
|
#include <linux/pm_runtime.h>
|
2016-04-07 20:36:46 +08:00
|
|
|
#include <linux/idr.h>
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2011-04-27 06:56:29 +08:00
|
|
|
#include <linux/mmc/ioctl.h>
|
2005-04-17 06:20:36 +08:00
|
|
|
#include <linux/mmc/card.h>
|
2006-06-18 20:34:37 +08:00
|
|
|
#include <linux/mmc/host.h>
|
2006-12-25 05:46:55 +08:00
|
|
|
#include <linux/mmc/mmc.h>
|
|
|
|
#include <linux/mmc/sd.h>
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2016-12-25 03:46:01 +08:00
|
|
|
#include <linux/uaccess.h>
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2006-12-24 03:03:02 +08:00
|
|
|
#include "queue.h"
|
2016-09-30 09:37:38 +08:00
|
|
|
#include "block.h"
|
2017-01-13 21:14:08 +08:00
|
|
|
#include "core.h"
|
2017-01-13 21:14:14 +08:00
|
|
|
#include "card.h"
|
2017-01-13 21:14:15 +08:00
|
|
|
#include "host.h"
|
2017-01-13 21:14:14 +08:00
|
|
|
#include "bus.h"
|
2017-01-13 21:14:08 +08:00
|
|
|
#include "mmc_ops.h"
|
2017-02-15 16:35:28 +08:00
|
|
|
#include "quirks.h"
|
2017-01-13 21:14:08 +08:00
|
|
|
#include "sd_ops.h"
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2009-02-23 20:38:41 +08:00
|
|
|
MODULE_ALIAS("mmc:block");
|
2010-09-18 09:19:57 +08:00
|
|
|
#ifdef MODULE_PARAM_PREFIX
|
|
|
|
#undef MODULE_PARAM_PREFIX
|
|
|
|
#endif
|
|
|
|
#define MODULE_PARAM_PREFIX "mmcblk."
|
|
|
|
|
2012-11-16 23:31:41 +08:00
|
|
|
#define MMC_BLK_TIMEOUT_MS (10 * 60 * 1000) /* 10 minute timeout */
|
2013-04-18 20:41:55 +08:00
|
|
|
#define MMC_SANITIZE_REQ_TIMEOUT 240000
|
|
|
|
#define MMC_EXTRACT_INDEX_FROM_ARG(x) ((x & 0x00FF0000) >> 16)
|
2011-04-13 04:06:53 +08:00
|
|
|
|
2015-11-06 23:12:26 +08:00
|
|
|
#define mmc_req_rel_wr(req) ((req->cmd_flags & REQ_FUA) && \
|
2013-02-06 16:02:46 +08:00
|
|
|
(rq_data_dir(req) == WRITE))
|
2010-09-18 09:19:57 +08:00
|
|
|
static DEFINE_MUTEX(block_mutex);
|
2009-02-23 20:38:41 +08:00
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
/*
|
2010-09-18 09:19:57 +08:00
|
|
|
* The defaults come from config options but can be overriden by module
|
|
|
|
* or bootarg options.
|
2005-04-17 06:20:36 +08:00
|
|
|
*/
|
2010-09-18 09:19:57 +08:00
|
|
|
static int perdev_minors = CONFIG_MMC_BLOCK_MINORS;
|
2007-11-22 01:45:12 +08:00
|
|
|
|
2010-09-18 09:19:57 +08:00
|
|
|
/*
|
|
|
|
* We've only got one major, so number of mmcblk devices is
|
2014-11-06 11:35:09 +08:00
|
|
|
* limited to (1 << 20) / number of minors per device. It is also
|
2016-04-07 20:36:46 +08:00
|
|
|
* limited by the MAX_DEVICES below.
|
2010-09-18 09:19:57 +08:00
|
|
|
*/
|
|
|
|
static int max_devices;
|
|
|
|
|
2014-11-06 11:35:09 +08:00
|
|
|
#define MAX_DEVICES 256
|
|
|
|
|
2016-04-07 20:36:46 +08:00
|
|
|
static DEFINE_IDA(mmc_blk_ida);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
/*
|
|
|
|
* There is one mmc_blk_data per slot.
|
|
|
|
*/
|
|
|
|
struct mmc_blk_data {
|
|
|
|
spinlock_t lock;
|
2016-06-21 01:40:44 +08:00
|
|
|
struct device *parent;
|
2005-04-17 06:20:36 +08:00
|
|
|
struct gendisk *disk;
|
|
|
|
struct mmc_queue queue;
|
2011-04-12 07:10:25 +08:00
|
|
|
struct list_head part;
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2011-05-24 04:06:36 +08:00
|
|
|
unsigned int flags;
|
|
|
|
#define MMC_BLK_CMD23 (1 << 0) /* Can do SET_BLOCK_COUNT for multiblock */
|
|
|
|
#define MMC_BLK_REL_WR (1 << 1) /* MMC Reliable write support */
|
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
unsigned int usage;
|
2006-01-04 06:38:44 +08:00
|
|
|
unsigned int read_only;
|
2011-04-12 07:10:25 +08:00
|
|
|
unsigned int part_type;
|
2011-08-29 21:42:15 +08:00
|
|
|
unsigned int reset_done;
|
|
|
|
#define MMC_BLK_READ BIT(0)
|
|
|
|
#define MMC_BLK_WRITE BIT(1)
|
|
|
|
#define MMC_BLK_DISCARD BIT(2)
|
|
|
|
#define MMC_BLK_SECDISCARD BIT(3)
|
2011-04-12 07:10:25 +08:00
|
|
|
|
|
|
|
/*
|
|
|
|
* Only set in main mmc_blk_data associated
|
2014-10-06 20:34:09 +08:00
|
|
|
* with mmc_card with dev_set_drvdata, and keeps
|
2011-04-12 07:10:25 +08:00
|
|
|
* track of the current selected device partition.
|
|
|
|
*/
|
|
|
|
unsigned int part_curr;
|
|
|
|
struct device_attribute force_ro;
|
2011-12-02 15:51:06 +08:00
|
|
|
struct device_attribute power_ro_lock;
|
|
|
|
int area_type;
|
2005-04-17 06:20:36 +08:00
|
|
|
};
|
|
|
|
|
2006-01-13 02:43:35 +08:00
|
|
|
static DEFINE_MUTEX(open_lock);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2010-09-18 09:19:57 +08:00
|
|
|
module_param(perdev_minors, int, 0444);
|
|
|
|
MODULE_PARM_DESC(perdev_minors, "Minors numbers to allocate per device");
|
|
|
|
|
2012-08-06 23:12:31 +08:00
|
|
|
static inline int mmc_blk_part_switch(struct mmc_card *card,
|
|
|
|
struct mmc_blk_data *md);
|
|
|
|
static int get_card_status(struct mmc_card *card, u32 *status, int retries);
|
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
static struct mmc_blk_data *mmc_blk_get(struct gendisk *disk)
|
|
|
|
{
|
|
|
|
struct mmc_blk_data *md;
|
|
|
|
|
2006-01-13 02:43:35 +08:00
|
|
|
mutex_lock(&open_lock);
|
2005-04-17 06:20:36 +08:00
|
|
|
md = disk->private_data;
|
|
|
|
if (md && md->usage == 0)
|
|
|
|
md = NULL;
|
|
|
|
if (md)
|
|
|
|
md->usage++;
|
2006-01-13 02:43:35 +08:00
|
|
|
mutex_unlock(&open_lock);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
return md;
|
|
|
|
}
|
|
|
|
|
2011-04-12 07:10:25 +08:00
|
|
|
static inline int mmc_get_devidx(struct gendisk *disk)
|
|
|
|
{
|
2015-10-23 01:00:41 +08:00
|
|
|
int devidx = disk->first_minor / perdev_minors;
|
2011-04-12 07:10:25 +08:00
|
|
|
return devidx;
|
|
|
|
}
|
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
static void mmc_blk_put(struct mmc_blk_data *md)
|
|
|
|
{
|
2006-01-13 02:43:35 +08:00
|
|
|
mutex_lock(&open_lock);
|
2005-04-17 06:20:36 +08:00
|
|
|
md->usage--;
|
|
|
|
if (md->usage == 0) {
|
2011-04-12 07:10:25 +08:00
|
|
|
int devidx = mmc_get_devidx(md->disk);
|
2010-01-09 06:43:00 +08:00
|
|
|
blk_cleanup_queue(md->queue.queue);
|
2017-02-02 02:44:22 +08:00
|
|
|
ida_simple_remove(&mmc_blk_ida, devidx);
|
2005-04-17 06:20:36 +08:00
|
|
|
put_disk(md->disk);
|
|
|
|
kfree(md);
|
|
|
|
}
|
2006-01-13 02:43:35 +08:00
|
|
|
mutex_unlock(&open_lock);
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
|
2011-12-02 15:51:06 +08:00
|
|
|
static ssize_t power_ro_lock_show(struct device *dev,
|
|
|
|
struct device_attribute *attr, char *buf)
|
|
|
|
{
|
|
|
|
int ret;
|
|
|
|
struct mmc_blk_data *md = mmc_blk_get(dev_to_disk(dev));
|
|
|
|
struct mmc_card *card = md->queue.card;
|
|
|
|
int locked = 0;
|
|
|
|
|
|
|
|
if (card->ext_csd.boot_ro_lock & EXT_CSD_BOOT_WP_B_PERM_WP_EN)
|
|
|
|
locked = 2;
|
|
|
|
else if (card->ext_csd.boot_ro_lock & EXT_CSD_BOOT_WP_B_PWR_WP_EN)
|
|
|
|
locked = 1;
|
|
|
|
|
|
|
|
ret = snprintf(buf, PAGE_SIZE, "%d\n", locked);
|
|
|
|
|
2015-07-16 21:50:45 +08:00
|
|
|
mmc_blk_put(md);
|
|
|
|
|
2011-12-02 15:51:06 +08:00
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
static ssize_t power_ro_lock_store(struct device *dev,
|
|
|
|
struct device_attribute *attr, const char *buf, size_t count)
|
|
|
|
{
|
|
|
|
int ret;
|
|
|
|
struct mmc_blk_data *md, *part_md;
|
|
|
|
struct mmc_card *card;
|
|
|
|
unsigned long set;
|
|
|
|
|
|
|
|
if (kstrtoul(buf, 0, &set))
|
|
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
if (set != 1)
|
|
|
|
return count;
|
|
|
|
|
|
|
|
md = mmc_blk_get(dev_to_disk(dev));
|
|
|
|
card = md->queue.card;
|
|
|
|
|
2013-05-02 20:02:38 +08:00
|
|
|
mmc_get_card(card);
|
2011-12-02 15:51:06 +08:00
|
|
|
|
|
|
|
ret = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL, EXT_CSD_BOOT_WP,
|
|
|
|
card->ext_csd.boot_ro_lock |
|
|
|
|
EXT_CSD_BOOT_WP_B_PWR_WP_EN,
|
|
|
|
card->ext_csd.part_time);
|
|
|
|
if (ret)
|
|
|
|
pr_err("%s: Locking boot partition ro until next power on failed: %d\n", md->disk->disk_name, ret);
|
|
|
|
else
|
|
|
|
card->ext_csd.boot_ro_lock |= EXT_CSD_BOOT_WP_B_PWR_WP_EN;
|
|
|
|
|
2013-05-02 20:02:38 +08:00
|
|
|
mmc_put_card(card);
|
2011-12-02 15:51:06 +08:00
|
|
|
|
|
|
|
if (!ret) {
|
|
|
|
pr_info("%s: Locking boot partition ro until next power on\n",
|
|
|
|
md->disk->disk_name);
|
|
|
|
set_disk_ro(md->disk, 1);
|
|
|
|
|
|
|
|
list_for_each_entry(part_md, &md->part, part)
|
|
|
|
if (part_md->area_type == MMC_BLK_DATA_AREA_BOOT) {
|
|
|
|
pr_info("%s: Locking boot partition ro until next power on\n", part_md->disk->disk_name);
|
|
|
|
set_disk_ro(part_md->disk, 1);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
mmc_blk_put(md);
|
|
|
|
return count;
|
|
|
|
}
|
|
|
|
|
2011-04-12 07:10:25 +08:00
|
|
|
static ssize_t force_ro_show(struct device *dev, struct device_attribute *attr,
|
|
|
|
char *buf)
|
|
|
|
{
|
|
|
|
int ret;
|
|
|
|
struct mmc_blk_data *md = mmc_blk_get(dev_to_disk(dev));
|
|
|
|
|
2014-09-22 15:12:51 +08:00
|
|
|
ret = snprintf(buf, PAGE_SIZE, "%d\n",
|
2011-04-12 07:10:25 +08:00
|
|
|
get_disk_ro(dev_to_disk(dev)) ^
|
|
|
|
md->read_only);
|
|
|
|
mmc_blk_put(md);
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
static ssize_t force_ro_store(struct device *dev, struct device_attribute *attr,
|
|
|
|
const char *buf, size_t count)
|
|
|
|
{
|
|
|
|
int ret;
|
|
|
|
char *end;
|
|
|
|
struct mmc_blk_data *md = mmc_blk_get(dev_to_disk(dev));
|
|
|
|
unsigned long set = simple_strtoul(buf, &end, 0);
|
|
|
|
if (end == buf) {
|
|
|
|
ret = -EINVAL;
|
|
|
|
goto out;
|
|
|
|
}
|
|
|
|
|
|
|
|
set_disk_ro(dev_to_disk(dev), set || md->read_only);
|
|
|
|
ret = count;
|
|
|
|
out:
|
|
|
|
mmc_blk_put(md);
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
2008-03-02 23:33:30 +08:00
|
|
|
static int mmc_blk_open(struct block_device *bdev, fmode_t mode)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
2008-03-02 23:33:30 +08:00
|
|
|
struct mmc_blk_data *md = mmc_blk_get(bdev->bd_disk);
|
2005-04-17 06:20:36 +08:00
|
|
|
int ret = -ENXIO;
|
|
|
|
|
2010-06-02 20:28:52 +08:00
|
|
|
mutex_lock(&block_mutex);
|
2005-04-17 06:20:36 +08:00
|
|
|
if (md) {
|
|
|
|
if (md->usage == 2)
|
2008-03-02 23:33:30 +08:00
|
|
|
check_disk_change(bdev);
|
2005-04-17 06:20:36 +08:00
|
|
|
ret = 0;
|
2005-09-07 06:18:52 +08:00
|
|
|
|
2008-03-02 23:33:30 +08:00
|
|
|
if ((mode & FMODE_WRITE) && md->read_only) {
|
2008-09-06 05:00:24 +08:00
|
|
|
mmc_blk_put(md);
|
2005-09-07 06:18:52 +08:00
|
|
|
ret = -EROFS;
|
2008-09-06 05:00:24 +08:00
|
|
|
}
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
2010-06-02 20:28:52 +08:00
|
|
|
mutex_unlock(&block_mutex);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
2013-05-06 09:52:57 +08:00
|
|
|
static void mmc_blk_release(struct gendisk *disk, fmode_t mode)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
2008-03-02 23:33:30 +08:00
|
|
|
struct mmc_blk_data *md = disk->private_data;
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2010-06-02 20:28:52 +08:00
|
|
|
mutex_lock(&block_mutex);
|
2005-04-17 06:20:36 +08:00
|
|
|
mmc_blk_put(md);
|
2010-06-02 20:28:52 +08:00
|
|
|
mutex_unlock(&block_mutex);
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
static int
|
2006-01-08 17:02:50 +08:00
|
|
|
mmc_blk_getgeo(struct block_device *bdev, struct hd_geometry *geo)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
2006-01-08 17:02:50 +08:00
|
|
|
geo->cylinders = get_capacity(bdev->bd_disk) / (4 * 16);
|
|
|
|
geo->heads = 4;
|
|
|
|
geo->sectors = 16;
|
|
|
|
return 0;
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
|
2011-04-27 06:56:29 +08:00
|
|
|
struct mmc_blk_ioc_data {
|
|
|
|
struct mmc_ioc_cmd ic;
|
|
|
|
unsigned char *buf;
|
|
|
|
u64 buf_bytes;
|
|
|
|
};
|
|
|
|
|
|
|
|
static struct mmc_blk_ioc_data *mmc_blk_ioctl_copy_from_user(
|
|
|
|
struct mmc_ioc_cmd __user *user)
|
|
|
|
{
|
|
|
|
struct mmc_blk_ioc_data *idata;
|
|
|
|
int err;
|
|
|
|
|
2015-11-12 19:27:11 +08:00
|
|
|
idata = kmalloc(sizeof(*idata), GFP_KERNEL);
|
2011-04-27 06:56:29 +08:00
|
|
|
if (!idata) {
|
|
|
|
err = -ENOMEM;
|
2011-05-11 12:00:43 +08:00
|
|
|
goto out;
|
2011-04-27 06:56:29 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
if (copy_from_user(&idata->ic, user, sizeof(idata->ic))) {
|
|
|
|
err = -EFAULT;
|
2011-05-11 12:00:43 +08:00
|
|
|
goto idata_err;
|
2011-04-27 06:56:29 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
idata->buf_bytes = (u64) idata->ic.blksz * idata->ic.blocks;
|
|
|
|
if (idata->buf_bytes > MMC_IOC_MAX_BYTES) {
|
|
|
|
err = -EOVERFLOW;
|
2011-05-11 12:00:43 +08:00
|
|
|
goto idata_err;
|
2011-04-27 06:56:29 +08:00
|
|
|
}
|
|
|
|
|
2016-07-08 23:27:02 +08:00
|
|
|
if (!idata->buf_bytes) {
|
|
|
|
idata->buf = NULL;
|
2011-11-23 16:05:58 +08:00
|
|
|
return idata;
|
2016-07-08 23:27:02 +08:00
|
|
|
}
|
2011-11-23 16:05:58 +08:00
|
|
|
|
2015-11-12 19:27:11 +08:00
|
|
|
idata->buf = kmalloc(idata->buf_bytes, GFP_KERNEL);
|
2011-04-27 06:56:29 +08:00
|
|
|
if (!idata->buf) {
|
|
|
|
err = -ENOMEM;
|
2011-05-11 12:00:43 +08:00
|
|
|
goto idata_err;
|
2011-04-27 06:56:29 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
if (copy_from_user(idata->buf, (void __user *)(unsigned long)
|
|
|
|
idata->ic.data_ptr, idata->buf_bytes)) {
|
|
|
|
err = -EFAULT;
|
|
|
|
goto copy_err;
|
|
|
|
}
|
|
|
|
|
|
|
|
return idata;
|
|
|
|
|
|
|
|
copy_err:
|
|
|
|
kfree(idata->buf);
|
2011-05-11 12:00:43 +08:00
|
|
|
idata_err:
|
2011-04-27 06:56:29 +08:00
|
|
|
kfree(idata);
|
2011-05-11 12:00:43 +08:00
|
|
|
out:
|
2011-04-27 06:56:29 +08:00
|
|
|
return ERR_PTR(err);
|
|
|
|
}
|
|
|
|
|
2015-09-22 17:27:53 +08:00
|
|
|
static int mmc_blk_ioctl_copy_to_user(struct mmc_ioc_cmd __user *ic_ptr,
|
|
|
|
struct mmc_blk_ioc_data *idata)
|
|
|
|
{
|
|
|
|
struct mmc_ioc_cmd *ic = &idata->ic;
|
|
|
|
|
|
|
|
if (copy_to_user(&(ic_ptr->response), ic->response,
|
|
|
|
sizeof(ic->response)))
|
|
|
|
return -EFAULT;
|
|
|
|
|
|
|
|
if (!idata->ic.write_flag) {
|
|
|
|
if (copy_to_user((void __user *)(unsigned long)ic->data_ptr,
|
|
|
|
idata->buf, idata->buf_bytes))
|
|
|
|
return -EFAULT;
|
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2012-08-06 23:12:31 +08:00
|
|
|
static int ioctl_rpmb_card_status_poll(struct mmc_card *card, u32 *status,
|
|
|
|
u32 retries_max)
|
|
|
|
{
|
|
|
|
int err;
|
|
|
|
u32 retry_count = 0;
|
|
|
|
|
|
|
|
if (!status || !retries_max)
|
|
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
do {
|
|
|
|
err = get_card_status(card, status, 5);
|
|
|
|
if (err)
|
|
|
|
break;
|
|
|
|
|
|
|
|
if (!R1_STATUS(*status) &&
|
|
|
|
(R1_CURRENT_STATE(*status) != R1_STATE_PRG))
|
|
|
|
break; /* RPMB programming operation complete */
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Rechedule to give the MMC device a chance to continue
|
|
|
|
* processing the previous command without being polled too
|
|
|
|
* frequently.
|
|
|
|
*/
|
|
|
|
usleep_range(1000, 5000);
|
|
|
|
} while (++retry_count < retries_max);
|
|
|
|
|
|
|
|
if (retry_count == retries_max)
|
|
|
|
err = -EPERM;
|
|
|
|
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
2013-04-18 20:41:55 +08:00
|
|
|
static int ioctl_do_sanitize(struct mmc_card *card)
|
|
|
|
{
|
|
|
|
int err;
|
|
|
|
|
2013-12-16 21:37:26 +08:00
|
|
|
if (!mmc_can_sanitize(card)) {
|
2013-04-18 20:41:55 +08:00
|
|
|
pr_warn("%s: %s - SANITIZE is not supported\n",
|
|
|
|
mmc_hostname(card->host), __func__);
|
|
|
|
err = -EOPNOTSUPP;
|
|
|
|
goto out;
|
|
|
|
}
|
|
|
|
|
|
|
|
pr_debug("%s: %s - SANITIZE IN PROGRESS...\n",
|
|
|
|
mmc_hostname(card->host), __func__);
|
|
|
|
|
|
|
|
err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
|
|
|
|
EXT_CSD_SANITIZE_START, 1,
|
|
|
|
MMC_SANITIZE_REQ_TIMEOUT);
|
|
|
|
|
|
|
|
if (err)
|
|
|
|
pr_err("%s: %s - EXT_CSD_SANITIZE_START failed. err=%d\n",
|
|
|
|
mmc_hostname(card->host), __func__, err);
|
|
|
|
|
|
|
|
pr_debug("%s: %s - SANITIZE COMPLETED\n", mmc_hostname(card->host),
|
|
|
|
__func__);
|
|
|
|
out:
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
2015-09-22 17:27:53 +08:00
|
|
|
static int __mmc_blk_ioctl_cmd(struct mmc_card *card, struct mmc_blk_data *md,
|
|
|
|
struct mmc_blk_ioc_data *idata)
|
2011-04-27 06:56:29 +08:00
|
|
|
{
|
2016-12-19 19:51:18 +08:00
|
|
|
struct mmc_command cmd = {};
|
|
|
|
struct mmc_data data = {};
|
|
|
|
struct mmc_request mrq = {};
|
2011-04-27 06:56:29 +08:00
|
|
|
struct scatterlist sg;
|
|
|
|
int err;
|
2012-08-06 23:12:31 +08:00
|
|
|
int is_rpmb = false;
|
|
|
|
u32 status = 0;
|
2011-04-27 06:56:29 +08:00
|
|
|
|
2015-09-22 17:27:53 +08:00
|
|
|
if (!card || !md || !idata)
|
|
|
|
return -EINVAL;
|
2011-04-27 06:56:29 +08:00
|
|
|
|
2012-08-06 23:12:31 +08:00
|
|
|
if (md->area_type & MMC_BLK_DATA_AREA_RPMB)
|
|
|
|
is_rpmb = true;
|
|
|
|
|
2011-11-23 16:05:58 +08:00
|
|
|
cmd.opcode = idata->ic.opcode;
|
|
|
|
cmd.arg = idata->ic.arg;
|
|
|
|
cmd.flags = idata->ic.flags;
|
|
|
|
|
|
|
|
if (idata->buf_bytes) {
|
|
|
|
data.sg = &sg;
|
|
|
|
data.sg_len = 1;
|
|
|
|
data.blksz = idata->ic.blksz;
|
|
|
|
data.blocks = idata->ic.blocks;
|
|
|
|
|
|
|
|
sg_init_one(data.sg, idata->buf, idata->buf_bytes);
|
|
|
|
|
|
|
|
if (idata->ic.write_flag)
|
|
|
|
data.flags = MMC_DATA_WRITE;
|
|
|
|
else
|
|
|
|
data.flags = MMC_DATA_READ;
|
|
|
|
|
|
|
|
/* data.flags must already be set before doing this. */
|
|
|
|
mmc_set_data_timeout(&data, card);
|
|
|
|
|
|
|
|
/* Allow overriding the timeout_ns for empirical tuning. */
|
|
|
|
if (idata->ic.data_timeout_ns)
|
|
|
|
data.timeout_ns = idata->ic.data_timeout_ns;
|
|
|
|
|
|
|
|
if ((cmd.flags & MMC_RSP_R1B) == MMC_RSP_R1B) {
|
|
|
|
/*
|
|
|
|
* Pretend this is a data transfer and rely on the
|
|
|
|
* host driver to compute timeout. When all host
|
|
|
|
* drivers support cmd.cmd_timeout for R1B, this
|
|
|
|
* can be changed to:
|
|
|
|
*
|
|
|
|
* mrq.data = NULL;
|
|
|
|
* cmd.cmd_timeout = idata->ic.cmd_timeout_ms;
|
|
|
|
*/
|
|
|
|
data.timeout_ns = idata->ic.cmd_timeout_ms * 1000000;
|
|
|
|
}
|
|
|
|
|
|
|
|
mrq.data = &data;
|
|
|
|
}
|
|
|
|
|
|
|
|
mrq.cmd = &cmd;
|
|
|
|
|
2012-08-06 23:12:31 +08:00
|
|
|
err = mmc_blk_part_switch(card, md);
|
|
|
|
if (err)
|
2015-09-22 17:27:53 +08:00
|
|
|
return err;
|
2012-08-06 23:12:31 +08:00
|
|
|
|
2011-04-27 06:56:29 +08:00
|
|
|
if (idata->ic.is_acmd) {
|
|
|
|
err = mmc_app_cmd(card->host, card);
|
|
|
|
if (err)
|
2015-09-22 17:27:53 +08:00
|
|
|
return err;
|
2011-04-27 06:56:29 +08:00
|
|
|
}
|
|
|
|
|
2012-08-06 23:12:31 +08:00
|
|
|
if (is_rpmb) {
|
|
|
|
err = mmc_set_blockcount(card, data.blocks,
|
|
|
|
idata->ic.write_flag & (1 << 31));
|
|
|
|
if (err)
|
2015-09-22 17:27:53 +08:00
|
|
|
return err;
|
2012-08-06 23:12:31 +08:00
|
|
|
}
|
|
|
|
|
2013-06-05 19:13:08 +08:00
|
|
|
if ((MMC_EXTRACT_INDEX_FROM_ARG(cmd.arg) == EXT_CSD_SANITIZE_START) &&
|
|
|
|
(cmd.opcode == MMC_SWITCH)) {
|
2013-04-18 20:41:55 +08:00
|
|
|
err = ioctl_do_sanitize(card);
|
|
|
|
|
|
|
|
if (err)
|
|
|
|
pr_err("%s: ioctl_do_sanitize() failed. err = %d",
|
|
|
|
__func__, err);
|
|
|
|
|
2015-09-22 17:27:53 +08:00
|
|
|
return err;
|
2013-04-18 20:41:55 +08:00
|
|
|
}
|
|
|
|
|
2011-04-27 06:56:29 +08:00
|
|
|
mmc_wait_for_req(card->host, &mrq);
|
|
|
|
|
|
|
|
if (cmd.error) {
|
|
|
|
dev_err(mmc_dev(card->host), "%s: cmd error %d\n",
|
|
|
|
__func__, cmd.error);
|
2015-09-22 17:27:53 +08:00
|
|
|
return cmd.error;
|
2011-04-27 06:56:29 +08:00
|
|
|
}
|
|
|
|
if (data.error) {
|
|
|
|
dev_err(mmc_dev(card->host), "%s: data error %d\n",
|
|
|
|
__func__, data.error);
|
2015-09-22 17:27:53 +08:00
|
|
|
return data.error;
|
2011-04-27 06:56:29 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* According to the SD specs, some commands require a delay after
|
|
|
|
* issuing the command.
|
|
|
|
*/
|
|
|
|
if (idata->ic.postsleep_min_us)
|
|
|
|
usleep_range(idata->ic.postsleep_min_us, idata->ic.postsleep_max_us);
|
|
|
|
|
2015-09-22 17:27:53 +08:00
|
|
|
memcpy(&(idata->ic.response), cmd.resp, sizeof(cmd.resp));
|
2011-04-27 06:56:29 +08:00
|
|
|
|
2012-08-06 23:12:31 +08:00
|
|
|
if (is_rpmb) {
|
|
|
|
/*
|
|
|
|
* Ensure RPMB command has completed by polling CMD13
|
|
|
|
* "Send Status".
|
|
|
|
*/
|
|
|
|
err = ioctl_rpmb_card_status_poll(card, &status, 5);
|
|
|
|
if (err)
|
|
|
|
dev_err(mmc_dev(card->host),
|
|
|
|
"%s: Card Status=0x%08X, error %d\n",
|
|
|
|
__func__, status, err);
|
|
|
|
}
|
|
|
|
|
2015-09-22 17:27:53 +08:00
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int mmc_blk_ioctl_cmd(struct block_device *bdev,
|
|
|
|
struct mmc_ioc_cmd __user *ic_ptr)
|
|
|
|
{
|
|
|
|
struct mmc_blk_ioc_data *idata;
|
|
|
|
struct mmc_blk_data *md;
|
|
|
|
struct mmc_card *card;
|
2015-09-24 09:30:33 +08:00
|
|
|
int err = 0, ioc_err = 0;
|
2015-09-22 17:27:53 +08:00
|
|
|
|
2016-03-16 18:15:47 +08:00
|
|
|
/*
|
|
|
|
* The caller must have CAP_SYS_RAWIO, and must be calling this on the
|
|
|
|
* whole block device, not on a partition. This prevents overspray
|
|
|
|
* between sibling partitions.
|
|
|
|
*/
|
|
|
|
if ((!capable(CAP_SYS_RAWIO)) || (bdev != bdev->bd_contains))
|
|
|
|
return -EPERM;
|
|
|
|
|
2015-09-22 17:27:53 +08:00
|
|
|
idata = mmc_blk_ioctl_copy_from_user(ic_ptr);
|
|
|
|
if (IS_ERR(idata))
|
|
|
|
return PTR_ERR(idata);
|
|
|
|
|
|
|
|
md = mmc_blk_get(bdev->bd_disk);
|
|
|
|
if (!md) {
|
|
|
|
err = -EINVAL;
|
|
|
|
goto cmd_err;
|
|
|
|
}
|
|
|
|
|
|
|
|
card = md->queue.card;
|
|
|
|
if (IS_ERR(card)) {
|
|
|
|
err = PTR_ERR(card);
|
|
|
|
goto cmd_done;
|
|
|
|
}
|
|
|
|
|
|
|
|
mmc_get_card(card);
|
|
|
|
|
2015-09-24 09:30:33 +08:00
|
|
|
ioc_err = __mmc_blk_ioctl_cmd(card, md, idata);
|
2015-09-22 17:27:53 +08:00
|
|
|
|
2016-05-04 19:38:12 +08:00
|
|
|
/* Always switch back to main area after RPMB access */
|
|
|
|
if (md->area_type & MMC_BLK_DATA_AREA_RPMB)
|
|
|
|
mmc_blk_part_switch(card, dev_get_drvdata(&card->dev));
|
|
|
|
|
2013-05-02 20:02:38 +08:00
|
|
|
mmc_put_card(card);
|
2011-04-27 06:56:29 +08:00
|
|
|
|
2015-09-24 09:30:33 +08:00
|
|
|
err = mmc_blk_ioctl_copy_to_user(ic_ptr, idata);
|
2015-09-22 17:27:53 +08:00
|
|
|
|
2011-04-27 06:56:29 +08:00
|
|
|
cmd_done:
|
|
|
|
mmc_blk_put(md);
|
2012-04-12 04:31:45 +08:00
|
|
|
cmd_err:
|
2011-04-27 06:56:29 +08:00
|
|
|
kfree(idata->buf);
|
|
|
|
kfree(idata);
|
2015-09-24 09:30:33 +08:00
|
|
|
return ioc_err ? ioc_err : err;
|
2011-04-27 06:56:29 +08:00
|
|
|
}
|
|
|
|
|
2015-09-22 17:27:53 +08:00
|
|
|
static int mmc_blk_ioctl_multi_cmd(struct block_device *bdev,
|
|
|
|
struct mmc_ioc_multi_cmd __user *user)
|
|
|
|
{
|
|
|
|
struct mmc_blk_ioc_data **idata = NULL;
|
|
|
|
struct mmc_ioc_cmd __user *cmds = user->cmds;
|
|
|
|
struct mmc_card *card;
|
|
|
|
struct mmc_blk_data *md;
|
2015-09-24 09:30:33 +08:00
|
|
|
int i, err = 0, ioc_err = 0;
|
2015-09-22 17:27:53 +08:00
|
|
|
__u64 num_of_cmds;
|
|
|
|
|
2016-03-16 18:15:47 +08:00
|
|
|
/*
|
|
|
|
* The caller must have CAP_SYS_RAWIO, and must be calling this on the
|
|
|
|
* whole block device, not on a partition. This prevents overspray
|
|
|
|
* between sibling partitions.
|
|
|
|
*/
|
|
|
|
if ((!capable(CAP_SYS_RAWIO)) || (bdev != bdev->bd_contains))
|
|
|
|
return -EPERM;
|
|
|
|
|
2015-09-22 17:27:53 +08:00
|
|
|
if (copy_from_user(&num_of_cmds, &user->num_of_cmds,
|
|
|
|
sizeof(num_of_cmds)))
|
|
|
|
return -EFAULT;
|
|
|
|
|
|
|
|
if (num_of_cmds > MMC_IOC_MAX_CMDS)
|
|
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
idata = kcalloc(num_of_cmds, sizeof(*idata), GFP_KERNEL);
|
|
|
|
if (!idata)
|
|
|
|
return -ENOMEM;
|
|
|
|
|
|
|
|
for (i = 0; i < num_of_cmds; i++) {
|
|
|
|
idata[i] = mmc_blk_ioctl_copy_from_user(&cmds[i]);
|
|
|
|
if (IS_ERR(idata[i])) {
|
|
|
|
err = PTR_ERR(idata[i]);
|
|
|
|
num_of_cmds = i;
|
|
|
|
goto cmd_err;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
md = mmc_blk_get(bdev->bd_disk);
|
2016-02-10 01:34:30 +08:00
|
|
|
if (!md) {
|
|
|
|
err = -EINVAL;
|
2015-09-22 17:27:53 +08:00
|
|
|
goto cmd_err;
|
2016-02-10 01:34:30 +08:00
|
|
|
}
|
2015-09-22 17:27:53 +08:00
|
|
|
|
|
|
|
card = md->queue.card;
|
|
|
|
if (IS_ERR(card)) {
|
|
|
|
err = PTR_ERR(card);
|
|
|
|
goto cmd_done;
|
|
|
|
}
|
|
|
|
|
|
|
|
mmc_get_card(card);
|
|
|
|
|
2015-09-24 09:30:33 +08:00
|
|
|
for (i = 0; i < num_of_cmds && !ioc_err; i++)
|
|
|
|
ioc_err = __mmc_blk_ioctl_cmd(card, md, idata[i]);
|
2015-09-22 17:27:53 +08:00
|
|
|
|
2016-05-04 19:38:12 +08:00
|
|
|
/* Always switch back to main area after RPMB access */
|
|
|
|
if (md->area_type & MMC_BLK_DATA_AREA_RPMB)
|
|
|
|
mmc_blk_part_switch(card, dev_get_drvdata(&card->dev));
|
|
|
|
|
2015-09-22 17:27:53 +08:00
|
|
|
mmc_put_card(card);
|
|
|
|
|
|
|
|
/* copy to user if data and response */
|
2015-09-24 09:30:33 +08:00
|
|
|
for (i = 0; i < num_of_cmds && !err; i++)
|
2015-09-22 17:27:53 +08:00
|
|
|
err = mmc_blk_ioctl_copy_to_user(&cmds[i], idata[i]);
|
|
|
|
|
|
|
|
cmd_done:
|
|
|
|
mmc_blk_put(md);
|
|
|
|
cmd_err:
|
|
|
|
for (i = 0; i < num_of_cmds; i++) {
|
|
|
|
kfree(idata[i]->buf);
|
|
|
|
kfree(idata[i]);
|
|
|
|
}
|
|
|
|
kfree(idata);
|
2015-09-24 09:30:33 +08:00
|
|
|
return ioc_err ? ioc_err : err;
|
2015-09-22 17:27:53 +08:00
|
|
|
}
|
|
|
|
|
2011-04-27 06:56:29 +08:00
|
|
|
static int mmc_blk_ioctl(struct block_device *bdev, fmode_t mode,
|
|
|
|
unsigned int cmd, unsigned long arg)
|
|
|
|
{
|
2015-09-22 17:27:53 +08:00
|
|
|
switch (cmd) {
|
|
|
|
case MMC_IOC_CMD:
|
|
|
|
return mmc_blk_ioctl_cmd(bdev,
|
|
|
|
(struct mmc_ioc_cmd __user *)arg);
|
|
|
|
case MMC_IOC_MULTI_CMD:
|
|
|
|
return mmc_blk_ioctl_multi_cmd(bdev,
|
|
|
|
(struct mmc_ioc_multi_cmd __user *)arg);
|
|
|
|
default:
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
2011-04-27 06:56:29 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
#ifdef CONFIG_COMPAT
|
|
|
|
static int mmc_blk_compat_ioctl(struct block_device *bdev, fmode_t mode,
|
|
|
|
unsigned int cmd, unsigned long arg)
|
|
|
|
{
|
|
|
|
return mmc_blk_ioctl(bdev, mode, cmd, (unsigned long) compat_ptr(arg));
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
2009-09-22 08:01:13 +08:00
|
|
|
static const struct block_device_operations mmc_bdops = {
|
2008-03-02 23:33:30 +08:00
|
|
|
.open = mmc_blk_open,
|
|
|
|
.release = mmc_blk_release,
|
2006-01-08 17:02:50 +08:00
|
|
|
.getgeo = mmc_blk_getgeo,
|
2005-04-17 06:20:36 +08:00
|
|
|
.owner = THIS_MODULE,
|
2011-04-27 06:56:29 +08:00
|
|
|
.ioctl = mmc_blk_ioctl,
|
|
|
|
#ifdef CONFIG_COMPAT
|
|
|
|
.compat_ioctl = mmc_blk_compat_ioctl,
|
|
|
|
#endif
|
2005-04-17 06:20:36 +08:00
|
|
|
};
|
|
|
|
|
2017-03-13 20:36:39 +08:00
|
|
|
static int mmc_blk_part_switch_pre(struct mmc_card *card,
|
|
|
|
unsigned int part_type)
|
|
|
|
{
|
|
|
|
int ret = 0;
|
|
|
|
|
|
|
|
if (part_type == EXT_CSD_PART_CONFIG_ACC_RPMB) {
|
|
|
|
if (card->ext_csd.cmdq_en) {
|
|
|
|
ret = mmc_cmdq_disable(card);
|
|
|
|
if (ret)
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
mmc_retune_pause(card->host);
|
|
|
|
}
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int mmc_blk_part_switch_post(struct mmc_card *card,
|
|
|
|
unsigned int part_type)
|
|
|
|
{
|
|
|
|
int ret = 0;
|
|
|
|
|
|
|
|
if (part_type == EXT_CSD_PART_CONFIG_ACC_RPMB) {
|
|
|
|
mmc_retune_unpause(card->host);
|
|
|
|
if (card->reenable_cmdq && !card->ext_csd.cmdq_en)
|
|
|
|
ret = mmc_cmdq_enable(card);
|
|
|
|
}
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
2011-04-12 07:10:25 +08:00
|
|
|
static inline int mmc_blk_part_switch(struct mmc_card *card,
|
|
|
|
struct mmc_blk_data *md)
|
|
|
|
{
|
2017-03-13 20:36:39 +08:00
|
|
|
int ret = 0;
|
2014-10-06 20:34:09 +08:00
|
|
|
struct mmc_blk_data *main_md = dev_get_drvdata(&card->dev);
|
2011-09-23 17:48:20 +08:00
|
|
|
|
2011-04-12 07:10:25 +08:00
|
|
|
if (main_md->part_curr == md->part_type)
|
|
|
|
return 0;
|
|
|
|
|
|
|
|
if (mmc_card_mmc(card)) {
|
2011-09-23 17:48:20 +08:00
|
|
|
u8 part_config = card->ext_csd.part_config;
|
|
|
|
|
2017-03-13 20:36:39 +08:00
|
|
|
ret = mmc_blk_part_switch_pre(card, md->part_type);
|
|
|
|
if (ret)
|
|
|
|
return ret;
|
2016-05-04 19:38:13 +08:00
|
|
|
|
2011-09-23 17:48:20 +08:00
|
|
|
part_config &= ~EXT_CSD_PART_CONFIG_ACC_MASK;
|
|
|
|
part_config |= md->part_type;
|
2011-04-12 07:10:25 +08:00
|
|
|
|
|
|
|
ret = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
|
2011-09-23 17:48:20 +08:00
|
|
|
EXT_CSD_PART_CONFIG, part_config,
|
2011-04-12 07:10:25 +08:00
|
|
|
card->ext_csd.part_time);
|
2016-05-04 19:38:13 +08:00
|
|
|
if (ret) {
|
2017-03-13 20:36:39 +08:00
|
|
|
mmc_blk_part_switch_post(card, md->part_type);
|
2011-04-12 07:10:25 +08:00
|
|
|
return ret;
|
2016-05-04 19:38:13 +08:00
|
|
|
}
|
2011-09-23 17:48:20 +08:00
|
|
|
|
|
|
|
card->ext_csd.part_config = part_config;
|
2016-05-04 19:38:13 +08:00
|
|
|
|
2017-03-13 20:36:39 +08:00
|
|
|
ret = mmc_blk_part_switch_post(card, main_md->part_curr);
|
2011-08-29 21:42:15 +08:00
|
|
|
}
|
2011-04-12 07:10:25 +08:00
|
|
|
|
|
|
|
main_md->part_curr = md->part_type;
|
2017-03-13 20:36:39 +08:00
|
|
|
return ret;
|
2011-04-12 07:10:25 +08:00
|
|
|
}
|
|
|
|
|
2017-02-01 20:47:57 +08:00
|
|
|
static int mmc_sd_num_wr_blocks(struct mmc_card *card, u32 *written_blocks)
|
2006-10-06 15:44:03 +08:00
|
|
|
{
|
|
|
|
int err;
|
2009-06-09 06:33:57 +08:00
|
|
|
u32 result;
|
|
|
|
__be32 *blocks;
|
2006-10-06 15:44:03 +08:00
|
|
|
|
2016-12-19 19:51:18 +08:00
|
|
|
struct mmc_request mrq = {};
|
|
|
|
struct mmc_command cmd = {};
|
|
|
|
struct mmc_data data = {};
|
2006-10-06 15:44:03 +08:00
|
|
|
|
|
|
|
struct scatterlist sg;
|
|
|
|
|
|
|
|
cmd.opcode = MMC_APP_CMD;
|
|
|
|
cmd.arg = card->rca << 16;
|
2007-08-09 00:10:23 +08:00
|
|
|
cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_AC;
|
2006-10-06 15:44:03 +08:00
|
|
|
|
|
|
|
err = mmc_wait_for_cmd(card->host, &cmd, 0);
|
2007-08-09 00:10:23 +08:00
|
|
|
if (err)
|
2017-02-01 20:47:57 +08:00
|
|
|
return err;
|
2007-08-09 00:10:23 +08:00
|
|
|
if (!mmc_host_is_spi(card->host) && !(cmd.resp[0] & R1_APP_CMD))
|
2017-02-01 20:47:57 +08:00
|
|
|
return -EIO;
|
2006-10-06 15:44:03 +08:00
|
|
|
|
|
|
|
memset(&cmd, 0, sizeof(struct mmc_command));
|
|
|
|
|
|
|
|
cmd.opcode = SD_APP_SEND_NUM_WR_BLKS;
|
|
|
|
cmd.arg = 0;
|
2007-08-09 00:10:23 +08:00
|
|
|
cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_ADTC;
|
2006-10-06 15:44:03 +08:00
|
|
|
|
|
|
|
data.blksz = 4;
|
|
|
|
data.blocks = 1;
|
|
|
|
data.flags = MMC_DATA_READ;
|
|
|
|
data.sg = &sg;
|
|
|
|
data.sg_len = 1;
|
2012-06-13 19:40:43 +08:00
|
|
|
mmc_set_data_timeout(&data, card);
|
2006-10-06 15:44:03 +08:00
|
|
|
|
|
|
|
mrq.cmd = &cmd;
|
|
|
|
mrq.data = &data;
|
|
|
|
|
2009-06-09 06:33:57 +08:00
|
|
|
blocks = kmalloc(4, GFP_KERNEL);
|
|
|
|
if (!blocks)
|
2017-02-01 20:47:57 +08:00
|
|
|
return -ENOMEM;
|
2009-06-09 06:33:57 +08:00
|
|
|
|
|
|
|
sg_init_one(&sg, blocks, 4);
|
2006-10-06 15:44:03 +08:00
|
|
|
|
|
|
|
mmc_wait_for_req(card->host, &mrq);
|
|
|
|
|
2009-06-09 06:33:57 +08:00
|
|
|
result = ntohl(*blocks);
|
|
|
|
kfree(blocks);
|
|
|
|
|
2007-07-23 04:18:46 +08:00
|
|
|
if (cmd.error || data.error)
|
2017-02-01 20:47:57 +08:00
|
|
|
return -EIO;
|
|
|
|
|
|
|
|
*written_blocks = result;
|
2006-10-06 15:44:03 +08:00
|
|
|
|
2017-02-01 20:47:57 +08:00
|
|
|
return 0;
|
2006-10-06 15:44:03 +08:00
|
|
|
}
|
|
|
|
|
2011-06-21 03:10:08 +08:00
|
|
|
static int get_card_status(struct mmc_card *card, u32 *status, int retries)
|
2008-10-16 17:55:25 +08:00
|
|
|
{
|
2016-12-19 19:51:18 +08:00
|
|
|
struct mmc_command cmd = {};
|
2008-10-16 17:55:25 +08:00
|
|
|
int err;
|
|
|
|
|
|
|
|
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;
|
2011-06-21 03:10:08 +08:00
|
|
|
err = mmc_wait_for_cmd(card->host, &cmd, retries);
|
|
|
|
if (err == 0)
|
|
|
|
*status = cmd.resp[0];
|
|
|
|
return err;
|
2008-10-16 17:55:25 +08:00
|
|
|
}
|
|
|
|
|
2014-01-29 18:01:55 +08:00
|
|
|
static int card_busy_detect(struct mmc_card *card, unsigned int timeout_ms,
|
2016-11-04 18:05:17 +08:00
|
|
|
bool hw_busy_detect, struct request *req, bool *gen_err)
|
2014-01-29 18:01:55 +08:00
|
|
|
{
|
|
|
|
unsigned long timeout = jiffies + msecs_to_jiffies(timeout_ms);
|
|
|
|
int err = 0;
|
|
|
|
u32 status;
|
|
|
|
|
|
|
|
do {
|
|
|
|
err = get_card_status(card, &status, 5);
|
|
|
|
if (err) {
|
|
|
|
pr_err("%s: error %d requesting status\n",
|
|
|
|
req->rq_disk->disk_name, err);
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (status & R1_ERROR) {
|
|
|
|
pr_err("%s: %s: error sending status cmd, status %#x\n",
|
|
|
|
req->rq_disk->disk_name, __func__, status);
|
2016-11-04 18:05:17 +08:00
|
|
|
*gen_err = true;
|
2014-01-29 18:01:55 +08:00
|
|
|
}
|
|
|
|
|
2014-01-29 20:11:27 +08:00
|
|
|
/* We may rely on the host hw to handle busy detection.*/
|
|
|
|
if ((card->host->caps & MMC_CAP_WAIT_WHILE_BUSY) &&
|
|
|
|
hw_busy_detect)
|
|
|
|
break;
|
|
|
|
|
2014-01-29 18:01:55 +08:00
|
|
|
/*
|
|
|
|
* Timeout if the device never becomes ready for data and never
|
|
|
|
* leaves the program state.
|
|
|
|
*/
|
|
|
|
if (time_after(jiffies, timeout)) {
|
|
|
|
pr_err("%s: Card stuck in programming state! %s %s\n",
|
|
|
|
mmc_hostname(card->host),
|
|
|
|
req->rq_disk->disk_name, __func__);
|
|
|
|
return -ETIMEDOUT;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Some cards mishandle the status bits,
|
|
|
|
* so make sure to check both the busy
|
|
|
|
* indication and the card state.
|
|
|
|
*/
|
|
|
|
} while (!(status & R1_READY_FOR_DATA) ||
|
|
|
|
(R1_CURRENT_STATE(status) == R1_STATE_PRG));
|
|
|
|
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
2014-01-15 04:31:35 +08:00
|
|
|
static int send_stop(struct mmc_card *card, unsigned int timeout_ms,
|
2016-11-04 18:05:17 +08:00
|
|
|
struct request *req, bool *gen_err, u32 *stop_status)
|
2014-01-15 04:31:35 +08:00
|
|
|
{
|
|
|
|
struct mmc_host *host = card->host;
|
2016-12-19 19:51:18 +08:00
|
|
|
struct mmc_command cmd = {};
|
2014-01-15 04:31:35 +08:00
|
|
|
int err;
|
|
|
|
bool use_r1b_resp = rq_data_dir(req) == WRITE;
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Normally we use R1B responses for WRITE, but in cases where the host
|
|
|
|
* has specified a max_busy_timeout we need to validate it. A failure
|
|
|
|
* means we need to prevent the host from doing hw busy detection, which
|
|
|
|
* is done by converting to a R1 response instead.
|
|
|
|
*/
|
|
|
|
if (host->max_busy_timeout && (timeout_ms > host->max_busy_timeout))
|
|
|
|
use_r1b_resp = false;
|
|
|
|
|
|
|
|
cmd.opcode = MMC_STOP_TRANSMISSION;
|
|
|
|
if (use_r1b_resp) {
|
|
|
|
cmd.flags = MMC_RSP_SPI_R1B | MMC_RSP_R1B | MMC_CMD_AC;
|
|
|
|
cmd.busy_timeout = timeout_ms;
|
|
|
|
} else {
|
|
|
|
cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_AC;
|
|
|
|
}
|
|
|
|
|
|
|
|
err = mmc_wait_for_cmd(host, &cmd, 5);
|
|
|
|
if (err)
|
|
|
|
return err;
|
|
|
|
|
|
|
|
*stop_status = cmd.resp[0];
|
|
|
|
|
|
|
|
/* No need to check card status in case of READ. */
|
|
|
|
if (rq_data_dir(req) == READ)
|
|
|
|
return 0;
|
|
|
|
|
|
|
|
if (!mmc_host_is_spi(host) &&
|
|
|
|
(*stop_status & R1_ERROR)) {
|
|
|
|
pr_err("%s: %s: general error sending stop command, resp %#x\n",
|
|
|
|
req->rq_disk->disk_name, __func__, *stop_status);
|
2016-11-04 18:05:17 +08:00
|
|
|
*gen_err = true;
|
2014-01-15 04:31:35 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
return card_busy_detect(card, timeout_ms, use_r1b_resp, req, gen_err);
|
|
|
|
}
|
|
|
|
|
2011-12-08 16:35:50 +08:00
|
|
|
#define ERR_NOMEDIUM 3
|
2011-06-21 03:10:28 +08:00
|
|
|
#define ERR_RETRY 2
|
|
|
|
#define ERR_ABORT 1
|
|
|
|
#define ERR_CONTINUE 0
|
|
|
|
|
|
|
|
static int mmc_blk_cmd_error(struct request *req, const char *name, int error,
|
|
|
|
bool status_valid, u32 status)
|
|
|
|
{
|
|
|
|
switch (error) {
|
|
|
|
case -EILSEQ:
|
|
|
|
/* response crc error, retry the r/w cmd */
|
|
|
|
pr_err("%s: %s sending %s command, card status %#x\n",
|
|
|
|
req->rq_disk->disk_name, "response CRC error",
|
|
|
|
name, status);
|
|
|
|
return ERR_RETRY;
|
|
|
|
|
|
|
|
case -ETIMEDOUT:
|
|
|
|
pr_err("%s: %s sending %s command, card status %#x\n",
|
|
|
|
req->rq_disk->disk_name, "timed out", name, status);
|
|
|
|
|
|
|
|
/* If the status cmd initially failed, retry the r/w cmd */
|
2016-05-10 17:23:13 +08:00
|
|
|
if (!status_valid) {
|
|
|
|
pr_err("%s: status not valid, retrying timeout\n",
|
|
|
|
req->rq_disk->disk_name);
|
2011-06-21 03:10:28 +08:00
|
|
|
return ERR_RETRY;
|
2016-05-10 17:23:13 +08:00
|
|
|
}
|
2011-06-21 03:10:28 +08:00
|
|
|
|
|
|
|
/*
|
|
|
|
* If it was a r/w cmd crc error, or illegal command
|
|
|
|
* (eg, issued in wrong state) then retry - we should
|
|
|
|
* have corrected the state problem above.
|
|
|
|
*/
|
2016-05-10 17:23:13 +08:00
|
|
|
if (status & (R1_COM_CRC_ERROR | R1_ILLEGAL_COMMAND)) {
|
|
|
|
pr_err("%s: command error, retrying timeout\n",
|
|
|
|
req->rq_disk->disk_name);
|
2011-06-21 03:10:28 +08:00
|
|
|
return ERR_RETRY;
|
2016-05-10 17:23:13 +08:00
|
|
|
}
|
2011-06-21 03:10:28 +08:00
|
|
|
|
|
|
|
/* Otherwise abort the command */
|
|
|
|
return ERR_ABORT;
|
|
|
|
|
|
|
|
default:
|
|
|
|
/* We don't understand the error code the driver gave us */
|
|
|
|
pr_err("%s: unknown error %d sending read/write command, card status %#x\n",
|
|
|
|
req->rq_disk->disk_name, error, status);
|
|
|
|
return ERR_ABORT;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Initial r/w and stop cmd error recovery.
|
|
|
|
* We don't know whether the card received the r/w cmd or not, so try to
|
|
|
|
* restore things back to a sane state. Essentially, we do this as follows:
|
|
|
|
* - Obtain card status. If the first attempt to obtain card status fails,
|
|
|
|
* the status word will reflect the failed status cmd, not the failed
|
|
|
|
* r/w cmd. If we fail to obtain card status, it suggests we can no
|
|
|
|
* longer communicate with the card.
|
|
|
|
* - Check the card state. If the card received the cmd but there was a
|
|
|
|
* transient problem with the response, it might still be in a data transfer
|
|
|
|
* mode. Try to send it a stop command. If this fails, we can't recover.
|
|
|
|
* - If the r/w cmd failed due to a response CRC error, it was probably
|
|
|
|
* transient, so retry the cmd.
|
|
|
|
* - If the r/w cmd timed out, but we didn't get the r/w cmd status, retry.
|
|
|
|
* - If the r/w cmd timed out, and the r/w cmd failed due to CRC error or
|
|
|
|
* illegal cmd, retry.
|
|
|
|
* Otherwise we don't understand what happened, so abort.
|
|
|
|
*/
|
|
|
|
static int mmc_blk_cmd_recovery(struct mmc_card *card, struct request *req,
|
2016-11-04 18:05:18 +08:00
|
|
|
struct mmc_blk_request *brq, bool *ecc_err, bool *gen_err)
|
2011-06-21 03:10:28 +08:00
|
|
|
{
|
|
|
|
bool prev_cmd_status_valid = true;
|
|
|
|
u32 status, stop_status = 0;
|
|
|
|
int err, retry;
|
|
|
|
|
2011-12-08 16:35:50 +08:00
|
|
|
if (mmc_card_removed(card))
|
|
|
|
return ERR_NOMEDIUM;
|
|
|
|
|
2011-06-21 03:10:28 +08:00
|
|
|
/*
|
|
|
|
* Try to get card status which indicates both the card state
|
|
|
|
* and why there was no response. If the first attempt fails,
|
|
|
|
* we can't be sure the returned status is for the r/w command.
|
|
|
|
*/
|
|
|
|
for (retry = 2; retry >= 0; retry--) {
|
|
|
|
err = get_card_status(card, &status, 0);
|
|
|
|
if (!err)
|
|
|
|
break;
|
|
|
|
|
2015-05-07 18:10:23 +08:00
|
|
|
/* Re-tune if needed */
|
|
|
|
mmc_retune_recheck(card->host);
|
|
|
|
|
2011-06-21 03:10:28 +08:00
|
|
|
prev_cmd_status_valid = false;
|
|
|
|
pr_err("%s: error %d sending status command, %sing\n",
|
|
|
|
req->rq_disk->disk_name, err, retry ? "retry" : "abort");
|
|
|
|
}
|
|
|
|
|
|
|
|
/* We couldn't get a response from the card. Give up. */
|
2011-12-08 16:35:50 +08:00
|
|
|
if (err) {
|
|
|
|
/* Check if the card is removed */
|
|
|
|
if (mmc_detect_card_removed(card->host))
|
|
|
|
return ERR_NOMEDIUM;
|
2011-06-21 03:10:28 +08:00
|
|
|
return ERR_ABORT;
|
2011-12-08 16:35:50 +08:00
|
|
|
}
|
2011-06-21 03:10:28 +08:00
|
|
|
|
2011-08-29 21:42:15 +08:00
|
|
|
/* Flag ECC errors */
|
|
|
|
if ((status & R1_CARD_ECC_FAILED) ||
|
|
|
|
(brq->stop.resp[0] & R1_CARD_ECC_FAILED) ||
|
|
|
|
(brq->cmd.resp[0] & R1_CARD_ECC_FAILED))
|
2016-11-04 18:05:18 +08:00
|
|
|
*ecc_err = true;
|
2011-08-29 21:42:15 +08:00
|
|
|
|
2013-07-07 06:35:45 +08:00
|
|
|
/* Flag General errors */
|
|
|
|
if (!mmc_host_is_spi(card->host) && rq_data_dir(req) != READ)
|
|
|
|
if ((status & R1_ERROR) ||
|
|
|
|
(brq->stop.resp[0] & R1_ERROR)) {
|
|
|
|
pr_err("%s: %s: general error sending stop or status command, stop cmd response %#x, card status %#x\n",
|
|
|
|
req->rq_disk->disk_name, __func__,
|
|
|
|
brq->stop.resp[0], status);
|
2016-11-04 18:05:17 +08:00
|
|
|
*gen_err = true;
|
2013-07-07 06:35:45 +08:00
|
|
|
}
|
|
|
|
|
2011-06-21 03:10:28 +08:00
|
|
|
/*
|
|
|
|
* Check the current card state. If it is in some data transfer
|
|
|
|
* mode, tell it to stop (and hopefully transition back to TRAN.)
|
|
|
|
*/
|
|
|
|
if (R1_CURRENT_STATE(status) == R1_STATE_DATA ||
|
|
|
|
R1_CURRENT_STATE(status) == R1_STATE_RCV) {
|
2014-01-15 04:31:35 +08:00
|
|
|
err = send_stop(card,
|
|
|
|
DIV_ROUND_UP(brq->data.timeout_ns, 1000000),
|
|
|
|
req, gen_err, &stop_status);
|
|
|
|
if (err) {
|
2011-06-21 03:10:28 +08:00
|
|
|
pr_err("%s: error %d sending stop command\n",
|
|
|
|
req->rq_disk->disk_name, err);
|
2014-01-15 04:31:35 +08:00
|
|
|
/*
|
|
|
|
* If the stop cmd also timed out, the card is probably
|
|
|
|
* not present, so abort. Other errors are bad news too.
|
|
|
|
*/
|
2011-06-21 03:10:28 +08:00
|
|
|
return ERR_ABORT;
|
2014-01-15 04:31:35 +08:00
|
|
|
}
|
|
|
|
|
2011-08-29 21:42:15 +08:00
|
|
|
if (stop_status & R1_CARD_ECC_FAILED)
|
2016-11-04 18:05:18 +08:00
|
|
|
*ecc_err = true;
|
2011-06-21 03:10:28 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
/* Check for set block count errors */
|
|
|
|
if (brq->sbc.error)
|
|
|
|
return mmc_blk_cmd_error(req, "SET_BLOCK_COUNT", brq->sbc.error,
|
|
|
|
prev_cmd_status_valid, status);
|
|
|
|
|
|
|
|
/* Check for r/w command errors */
|
|
|
|
if (brq->cmd.error)
|
|
|
|
return mmc_blk_cmd_error(req, "r/w cmd", brq->cmd.error,
|
|
|
|
prev_cmd_status_valid, status);
|
|
|
|
|
2011-08-29 21:42:15 +08:00
|
|
|
/* Data errors */
|
|
|
|
if (!brq->stop.error)
|
|
|
|
return ERR_CONTINUE;
|
|
|
|
|
2011-06-21 03:10:28 +08:00
|
|
|
/* Now for stop errors. These aren't fatal to the transfer. */
|
2014-09-17 15:50:42 +08:00
|
|
|
pr_info("%s: error %d sending stop command, original cmd response %#x, card status %#x\n",
|
2011-06-21 03:10:28 +08:00
|
|
|
req->rq_disk->disk_name, brq->stop.error,
|
|
|
|
brq->cmd.resp[0], status);
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Subsitute in our own stop status as this will give the error
|
|
|
|
* state which happened during the execution of the r/w command.
|
|
|
|
*/
|
|
|
|
if (stop_status) {
|
|
|
|
brq->stop.resp[0] = stop_status;
|
|
|
|
brq->stop.error = 0;
|
|
|
|
}
|
|
|
|
return ERR_CONTINUE;
|
|
|
|
}
|
|
|
|
|
2011-08-29 21:42:15 +08:00
|
|
|
static int mmc_blk_reset(struct mmc_blk_data *md, struct mmc_host *host,
|
|
|
|
int type)
|
|
|
|
{
|
|
|
|
int err;
|
|
|
|
|
|
|
|
if (md->reset_done & type)
|
|
|
|
return -EEXIST;
|
|
|
|
|
|
|
|
md->reset_done |= type;
|
|
|
|
err = mmc_hw_reset(host);
|
|
|
|
/* Ensure we switch back to the correct partition */
|
|
|
|
if (err != -EOPNOTSUPP) {
|
2014-10-06 20:34:09 +08:00
|
|
|
struct mmc_blk_data *main_md =
|
|
|
|
dev_get_drvdata(&host->card->dev);
|
2011-08-29 21:42:15 +08:00
|
|
|
int part_err;
|
|
|
|
|
|
|
|
main_md->part_curr = main_md->part_type;
|
|
|
|
part_err = mmc_blk_part_switch(host->card, md);
|
|
|
|
if (part_err) {
|
|
|
|
/*
|
|
|
|
* We have failed to get back into the correct
|
|
|
|
* partition, so we need to abort the whole request.
|
|
|
|
*/
|
|
|
|
return -ENODEV;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline void mmc_blk_reset_success(struct mmc_blk_data *md, int type)
|
|
|
|
{
|
|
|
|
md->reset_done &= ~type;
|
|
|
|
}
|
|
|
|
|
mmc: card: Don't access RPMB partitions for normal read/write
During kernel boot, it will try to read some logical sectors
of each block device node for the possible partition table.
But since RPMB partition is special and can not be accessed
by normal eMMC read / write CMDs, it will cause below error
messages during kernel boot:
...
mmc0: Got data interrupt 0x00000002 even though no data operation was in progress.
mmcblk0rpmb: error -110 transferring data, sector 0, nr 32, cmd response 0x900, card status 0xb00
mmcblk0rpmb: retrying using single block read
mmcblk0rpmb: timed out sending r/w cmd command, card status 0x400900
mmcblk0rpmb: timed out sending r/w cmd command, card status 0x400900
mmcblk0rpmb: timed out sending r/w cmd command, card status 0x400900
mmcblk0rpmb: timed out sending r/w cmd command, card status 0x400900
mmcblk0rpmb: timed out sending r/w cmd command, card status 0x400900
mmcblk0rpmb: timed out sending r/w cmd command, card status 0x400900
end_request: I/O error, dev mmcblk0rpmb, sector 0
Buffer I/O error on device mmcblk0rpmb, logical block 0
end_request: I/O error, dev mmcblk0rpmb, sector 8
Buffer I/O error on device mmcblk0rpmb, logical block 1
end_request: I/O error, dev mmcblk0rpmb, sector 16
Buffer I/O error on device mmcblk0rpmb, logical block 2
end_request: I/O error, dev mmcblk0rpmb, sector 24
Buffer I/O error on device mmcblk0rpmb, logical block 3
...
This patch will discard the access request in eMMC queue if
it is RPMB partition access request. By this way, it avoids
trigger above error messages.
Fixes: 090d25fe224c ("mmc: core: Expose access to RPMB partition")
Signed-off-by: Yunpeng Gao <yunpeng.gao@intel.com>
Signed-off-by: Chuanxiao Dong <chuanxiao.dong@intel.com>
Tested-by: Michael Shigorin <mike@altlinux.org>
Signed-off-by: Ulf Hansson <ulf.hansson@linaro.org>
2014-08-12 12:01:30 +08:00
|
|
|
int mmc_access_rpmb(struct mmc_queue *mq)
|
|
|
|
{
|
2016-11-18 20:36:15 +08:00
|
|
|
struct mmc_blk_data *md = mq->blkdata;
|
mmc: card: Don't access RPMB partitions for normal read/write
During kernel boot, it will try to read some logical sectors
of each block device node for the possible partition table.
But since RPMB partition is special and can not be accessed
by normal eMMC read / write CMDs, it will cause below error
messages during kernel boot:
...
mmc0: Got data interrupt 0x00000002 even though no data operation was in progress.
mmcblk0rpmb: error -110 transferring data, sector 0, nr 32, cmd response 0x900, card status 0xb00
mmcblk0rpmb: retrying using single block read
mmcblk0rpmb: timed out sending r/w cmd command, card status 0x400900
mmcblk0rpmb: timed out sending r/w cmd command, card status 0x400900
mmcblk0rpmb: timed out sending r/w cmd command, card status 0x400900
mmcblk0rpmb: timed out sending r/w cmd command, card status 0x400900
mmcblk0rpmb: timed out sending r/w cmd command, card status 0x400900
mmcblk0rpmb: timed out sending r/w cmd command, card status 0x400900
end_request: I/O error, dev mmcblk0rpmb, sector 0
Buffer I/O error on device mmcblk0rpmb, logical block 0
end_request: I/O error, dev mmcblk0rpmb, sector 8
Buffer I/O error on device mmcblk0rpmb, logical block 1
end_request: I/O error, dev mmcblk0rpmb, sector 16
Buffer I/O error on device mmcblk0rpmb, logical block 2
end_request: I/O error, dev mmcblk0rpmb, sector 24
Buffer I/O error on device mmcblk0rpmb, logical block 3
...
This patch will discard the access request in eMMC queue if
it is RPMB partition access request. By this way, it avoids
trigger above error messages.
Fixes: 090d25fe224c ("mmc: core: Expose access to RPMB partition")
Signed-off-by: Yunpeng Gao <yunpeng.gao@intel.com>
Signed-off-by: Chuanxiao Dong <chuanxiao.dong@intel.com>
Tested-by: Michael Shigorin <mike@altlinux.org>
Signed-off-by: Ulf Hansson <ulf.hansson@linaro.org>
2014-08-12 12:01:30 +08:00
|
|
|
/*
|
|
|
|
* If this is a RPMB partition access, return ture
|
|
|
|
*/
|
|
|
|
if (md && md->part_type == EXT_CSD_PART_CONFIG_ACC_RPMB)
|
|
|
|
return true;
|
|
|
|
|
|
|
|
return false;
|
|
|
|
}
|
|
|
|
|
2017-01-24 18:17:57 +08:00
|
|
|
static void mmc_blk_issue_discard_rq(struct mmc_queue *mq, struct request *req)
|
2010-08-12 05:17:47 +08:00
|
|
|
{
|
2016-11-18 20:36:15 +08:00
|
|
|
struct mmc_blk_data *md = mq->blkdata;
|
2010-08-12 05:17:47 +08:00
|
|
|
struct mmc_card *card = md->queue.card;
|
|
|
|
unsigned int from, nr, arg;
|
2011-08-29 21:42:15 +08:00
|
|
|
int err = 0, type = MMC_BLK_DISCARD;
|
2010-08-12 05:17:47 +08:00
|
|
|
|
|
|
|
if (!mmc_can_erase(card)) {
|
|
|
|
err = -EOPNOTSUPP;
|
2016-12-19 22:03:44 +08:00
|
|
|
goto fail;
|
2010-08-12 05:17:47 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
from = blk_rq_pos(req);
|
|
|
|
nr = blk_rq_sectors(req);
|
|
|
|
|
2011-10-18 08:34:04 +08:00
|
|
|
if (mmc_can_discard(card))
|
|
|
|
arg = MMC_DISCARD_ARG;
|
|
|
|
else if (mmc_can_trim(card))
|
2010-08-12 05:17:47 +08:00
|
|
|
arg = MMC_TRIM_ARG;
|
|
|
|
else
|
|
|
|
arg = MMC_ERASE_ARG;
|
2016-12-19 22:03:45 +08:00
|
|
|
do {
|
|
|
|
err = 0;
|
|
|
|
if (card->quirks & MMC_QUIRK_INAND_CMD38) {
|
|
|
|
err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
|
|
|
|
INAND_CMD38_ARG_EXT_CSD,
|
|
|
|
arg == MMC_TRIM_ARG ?
|
|
|
|
INAND_CMD38_ARG_TRIM :
|
|
|
|
INAND_CMD38_ARG_ERASE,
|
|
|
|
0);
|
|
|
|
}
|
|
|
|
if (!err)
|
|
|
|
err = mmc_erase(card, from, nr, arg);
|
|
|
|
} while (err == -EIO && !mmc_blk_reset(md, card->host, type));
|
2011-08-29 21:42:15 +08:00
|
|
|
if (!err)
|
|
|
|
mmc_blk_reset_success(md, type);
|
2016-12-19 22:03:44 +08:00
|
|
|
fail:
|
2012-06-07 18:16:58 +08:00
|
|
|
blk_end_request(req, err, blk_rq_bytes(req));
|
2010-08-12 05:17:47 +08:00
|
|
|
}
|
|
|
|
|
2017-01-24 18:17:57 +08:00
|
|
|
static void mmc_blk_issue_secdiscard_rq(struct mmc_queue *mq,
|
2010-08-12 05:17:50 +08:00
|
|
|
struct request *req)
|
|
|
|
{
|
2016-11-18 20:36:15 +08:00
|
|
|
struct mmc_blk_data *md = mq->blkdata;
|
2010-08-12 05:17:50 +08:00
|
|
|
struct mmc_card *card = md->queue.card;
|
2013-04-18 20:41:55 +08:00
|
|
|
unsigned int from, nr, arg;
|
2011-08-29 21:42:15 +08:00
|
|
|
int err = 0, type = MMC_BLK_SECDISCARD;
|
2010-08-12 05:17:50 +08:00
|
|
|
|
2013-04-18 20:41:55 +08:00
|
|
|
if (!(mmc_can_secure_erase_trim(card))) {
|
2010-08-12 05:17:50 +08:00
|
|
|
err = -EOPNOTSUPP;
|
|
|
|
goto out;
|
|
|
|
}
|
|
|
|
|
2012-04-05 19:45:48 +08:00
|
|
|
from = blk_rq_pos(req);
|
|
|
|
nr = blk_rq_sectors(req);
|
|
|
|
|
2013-04-18 20:41:55 +08:00
|
|
|
if (mmc_can_trim(card) && !mmc_erase_group_aligned(card, from, nr))
|
|
|
|
arg = MMC_SECURE_TRIM1_ARG;
|
|
|
|
else
|
|
|
|
arg = MMC_SECURE_ERASE_ARG;
|
2011-10-14 13:15:48 +08:00
|
|
|
|
2011-08-29 21:42:15 +08:00
|
|
|
retry:
|
2011-04-13 04:06:53 +08:00
|
|
|
if (card->quirks & MMC_QUIRK_INAND_CMD38) {
|
|
|
|
err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
|
|
|
|
INAND_CMD38_ARG_EXT_CSD,
|
|
|
|
arg == MMC_SECURE_TRIM1_ARG ?
|
|
|
|
INAND_CMD38_ARG_SECTRIM1 :
|
|
|
|
INAND_CMD38_ARG_SECERASE,
|
|
|
|
0);
|
|
|
|
if (err)
|
2012-04-05 19:45:48 +08:00
|
|
|
goto out_retry;
|
2011-04-13 04:06:53 +08:00
|
|
|
}
|
2012-04-05 19:45:48 +08:00
|
|
|
|
2010-08-12 05:17:50 +08:00
|
|
|
err = mmc_erase(card, from, nr, arg);
|
2012-04-05 19:45:48 +08:00
|
|
|
if (err == -EIO)
|
|
|
|
goto out_retry;
|
|
|
|
if (err)
|
|
|
|
goto out;
|
|
|
|
|
|
|
|
if (arg == MMC_SECURE_TRIM1_ARG) {
|
2011-04-13 04:06:53 +08:00
|
|
|
if (card->quirks & MMC_QUIRK_INAND_CMD38) {
|
|
|
|
err = mmc_switch(card, EXT_CSD_CMD_SET_NORMAL,
|
|
|
|
INAND_CMD38_ARG_EXT_CSD,
|
|
|
|
INAND_CMD38_ARG_SECTRIM2,
|
|
|
|
0);
|
|
|
|
if (err)
|
2012-04-05 19:45:48 +08:00
|
|
|
goto out_retry;
|
2011-04-13 04:06:53 +08:00
|
|
|
}
|
2012-04-05 19:45:48 +08:00
|
|
|
|
2010-08-12 05:17:50 +08:00
|
|
|
err = mmc_erase(card, from, nr, MMC_SECURE_TRIM2_ARG);
|
2012-04-05 19:45:48 +08:00
|
|
|
if (err == -EIO)
|
|
|
|
goto out_retry;
|
|
|
|
if (err)
|
|
|
|
goto out;
|
2011-04-13 04:06:53 +08:00
|
|
|
}
|
2012-04-05 19:45:48 +08:00
|
|
|
|
|
|
|
out_retry:
|
|
|
|
if (err && !mmc_blk_reset(md, card->host, type))
|
2011-08-29 21:42:15 +08:00
|
|
|
goto retry;
|
|
|
|
if (!err)
|
|
|
|
mmc_blk_reset_success(md, type);
|
2012-04-05 19:45:48 +08:00
|
|
|
out:
|
2012-06-07 18:16:58 +08:00
|
|
|
blk_end_request(req, err, blk_rq_bytes(req));
|
2010-08-12 05:17:50 +08:00
|
|
|
}
|
|
|
|
|
2017-01-24 18:17:57 +08:00
|
|
|
static void mmc_blk_issue_flush(struct mmc_queue *mq, struct request *req)
|
2011-04-01 07:40:00 +08:00
|
|
|
{
|
2016-11-18 20:36:15 +08:00
|
|
|
struct mmc_blk_data *md = mq->blkdata;
|
2011-10-14 13:03:21 +08:00
|
|
|
struct mmc_card *card = md->queue.card;
|
|
|
|
int ret = 0;
|
|
|
|
|
|
|
|
ret = mmc_flush_cache(card);
|
|
|
|
if (ret)
|
|
|
|
ret = -EIO;
|
2011-04-01 07:40:00 +08:00
|
|
|
|
2012-06-07 18:16:58 +08:00
|
|
|
blk_end_request_all(req, ret);
|
2011-04-01 07:40:00 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Reformat current write as a reliable write, supporting
|
|
|
|
* both legacy and the enhanced reliable write MMC cards.
|
|
|
|
* In each transfer we'll handle only as much as a single
|
|
|
|
* reliable write can handle, thus finish the request in
|
|
|
|
* partial completions.
|
|
|
|
*/
|
2011-05-24 04:06:36 +08:00
|
|
|
static inline void mmc_apply_rel_rw(struct mmc_blk_request *brq,
|
|
|
|
struct mmc_card *card,
|
|
|
|
struct request *req)
|
2011-04-01 07:40:00 +08:00
|
|
|
{
|
|
|
|
if (!(card->ext_csd.rel_param & EXT_CSD_WR_REL_PARAM_EN)) {
|
|
|
|
/* Legacy mode imposes restrictions on transfers. */
|
2017-03-13 20:36:40 +08:00
|
|
|
if (!IS_ALIGNED(blk_rq_pos(req), card->ext_csd.rel_sectors))
|
2011-04-01 07:40:00 +08:00
|
|
|
brq->data.blocks = 1;
|
|
|
|
|
|
|
|
if (brq->data.blocks > card->ext_csd.rel_sectors)
|
|
|
|
brq->data.blocks = card->ext_csd.rel_sectors;
|
|
|
|
else if (brq->data.blocks < card->ext_csd.rel_sectors)
|
|
|
|
brq->data.blocks = 1;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2011-06-21 03:10:49 +08:00
|
|
|
#define CMD_ERRORS \
|
|
|
|
(R1_OUT_OF_RANGE | /* Command argument out of range */ \
|
|
|
|
R1_ADDRESS_ERROR | /* Misaligned address */ \
|
|
|
|
R1_BLOCK_LEN_ERROR | /* Transferred block length incorrect */\
|
|
|
|
R1_WP_VIOLATION | /* Tried to write to protected block */ \
|
|
|
|
R1_CC_ERROR | /* Card controller error */ \
|
|
|
|
R1_ERROR) /* General/unknown error */
|
|
|
|
|
2016-11-04 18:05:19 +08:00
|
|
|
static enum mmc_blk_status mmc_blk_err_check(struct mmc_card *card,
|
|
|
|
struct mmc_async_req *areq)
|
2011-07-02 00:55:30 +08:00
|
|
|
{
|
2011-07-02 00:55:33 +08:00
|
|
|
struct mmc_queue_req *mq_mrq = container_of(areq, struct mmc_queue_req,
|
2017-02-01 20:47:55 +08:00
|
|
|
areq);
|
2011-07-02 00:55:33 +08:00
|
|
|
struct mmc_blk_request *brq = &mq_mrq->brq;
|
|
|
|
struct request *req = mq_mrq->req;
|
2015-05-07 18:10:24 +08:00
|
|
|
int need_retune = card->host->need_retune;
|
2016-11-04 18:05:18 +08:00
|
|
|
bool ecc_err = false;
|
2016-11-04 18:05:17 +08:00
|
|
|
bool gen_err = false;
|
2011-07-02 00:55:30 +08:00
|
|
|
|
|
|
|
/*
|
|
|
|
* sbc.error indicates a problem with the set block count
|
|
|
|
* command. No data will have been transferred.
|
|
|
|
*
|
|
|
|
* cmd.error indicates a problem with the r/w command. No
|
|
|
|
* data will have been transferred.
|
|
|
|
*
|
|
|
|
* stop.error indicates a problem with the stop command. Data
|
|
|
|
* may have been transferred, or may still be transferring.
|
|
|
|
*/
|
2011-08-29 21:42:15 +08:00
|
|
|
if (brq->sbc.error || brq->cmd.error || brq->stop.error ||
|
|
|
|
brq->data.error) {
|
2013-07-07 06:35:45 +08:00
|
|
|
switch (mmc_blk_cmd_recovery(card, req, brq, &ecc_err, &gen_err)) {
|
2011-07-02 00:55:30 +08:00
|
|
|
case ERR_RETRY:
|
|
|
|
return MMC_BLK_RETRY;
|
|
|
|
case ERR_ABORT:
|
|
|
|
return MMC_BLK_ABORT;
|
2011-12-08 16:35:50 +08:00
|
|
|
case ERR_NOMEDIUM:
|
|
|
|
return MMC_BLK_NOMEDIUM;
|
2011-07-02 00:55:30 +08:00
|
|
|
case ERR_CONTINUE:
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Check for errors relating to the execution of the
|
|
|
|
* initial command - such as address errors. No data
|
|
|
|
* has been transferred.
|
|
|
|
*/
|
|
|
|
if (brq->cmd.resp[0] & CMD_ERRORS) {
|
|
|
|
pr_err("%s: r/w command failed, status = %#x\n",
|
|
|
|
req->rq_disk->disk_name, brq->cmd.resp[0]);
|
|
|
|
return MMC_BLK_ABORT;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Everything else is either success, or a data error of some
|
|
|
|
* kind. If it was a write, we may have transitioned to
|
|
|
|
* program mode, which we have to wait for it to complete.
|
|
|
|
*/
|
|
|
|
if (!mmc_host_is_spi(card->host) && rq_data_dir(req) != READ) {
|
2014-01-29 18:01:55 +08:00
|
|
|
int err;
|
2012-11-16 23:31:41 +08:00
|
|
|
|
2013-07-07 06:35:45 +08:00
|
|
|
/* Check stop command response */
|
|
|
|
if (brq->stop.resp[0] & R1_ERROR) {
|
|
|
|
pr_err("%s: %s: general error sending stop command, stop cmd response %#x\n",
|
|
|
|
req->rq_disk->disk_name, __func__,
|
|
|
|
brq->stop.resp[0]);
|
2016-11-04 18:05:17 +08:00
|
|
|
gen_err = true;
|
2013-07-07 06:35:45 +08:00
|
|
|
}
|
|
|
|
|
2014-01-29 20:11:27 +08:00
|
|
|
err = card_busy_detect(card, MMC_BLK_TIMEOUT_MS, false, req,
|
|
|
|
&gen_err);
|
2014-01-29 18:01:55 +08:00
|
|
|
if (err)
|
|
|
|
return MMC_BLK_CMD_ERR;
|
2011-07-02 00:55:30 +08:00
|
|
|
}
|
|
|
|
|
2013-07-07 06:35:45 +08:00
|
|
|
/* if general error occurs, retry the write operation. */
|
|
|
|
if (gen_err) {
|
|
|
|
pr_warn("%s: retrying write for general error\n",
|
|
|
|
req->rq_disk->disk_name);
|
|
|
|
return MMC_BLK_RETRY;
|
|
|
|
}
|
|
|
|
|
2011-07-02 00:55:30 +08:00
|
|
|
if (brq->data.error) {
|
2015-05-07 18:10:24 +08:00
|
|
|
if (need_retune && !brq->retune_retry_done) {
|
2016-01-29 17:44:00 +08:00
|
|
|
pr_debug("%s: retrying because a re-tune was needed\n",
|
|
|
|
req->rq_disk->disk_name);
|
2015-05-07 18:10:24 +08:00
|
|
|
brq->retune_retry_done = 1;
|
|
|
|
return MMC_BLK_RETRY;
|
|
|
|
}
|
2011-07-02 00:55:30 +08:00
|
|
|
pr_err("%s: error %d transferring data, sector %u, nr %u, cmd response %#x, card status %#x\n",
|
|
|
|
req->rq_disk->disk_name, brq->data.error,
|
|
|
|
(unsigned)blk_rq_pos(req),
|
|
|
|
(unsigned)blk_rq_sectors(req),
|
|
|
|
brq->cmd.resp[0], brq->stop.resp[0]);
|
|
|
|
|
|
|
|
if (rq_data_dir(req) == READ) {
|
2011-08-29 21:42:15 +08:00
|
|
|
if (ecc_err)
|
|
|
|
return MMC_BLK_ECC_ERR;
|
2011-07-02 00:55:30 +08:00
|
|
|
return MMC_BLK_DATA_ERR;
|
|
|
|
} else {
|
|
|
|
return MMC_BLK_CMD_ERR;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2011-08-29 21:42:15 +08:00
|
|
|
if (!brq->data.bytes_xfered)
|
|
|
|
return MMC_BLK_RETRY;
|
2011-07-02 00:55:30 +08:00
|
|
|
|
2011-08-29 21:42:15 +08:00
|
|
|
if (blk_rq_bytes(req) != brq->data.bytes_xfered)
|
|
|
|
return MMC_BLK_PARTIAL;
|
|
|
|
|
|
|
|
return MMC_BLK_SUCCESS;
|
2011-07-02 00:55:30 +08:00
|
|
|
}
|
|
|
|
|
2017-03-13 20:36:41 +08:00
|
|
|
static void mmc_blk_data_prep(struct mmc_queue *mq, struct mmc_queue_req *mqrq,
|
|
|
|
int disable_multi, bool *do_rel_wr,
|
|
|
|
bool *do_data_tag)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
2017-03-13 20:36:41 +08:00
|
|
|
struct mmc_blk_data *md = mq->blkdata;
|
|
|
|
struct mmc_card *card = md->queue.card;
|
2011-07-02 00:55:29 +08:00
|
|
|
struct mmc_blk_request *brq = &mqrq->brq;
|
|
|
|
struct request *req = mqrq->req;
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2011-04-01 07:40:00 +08:00
|
|
|
/*
|
|
|
|
* Reliable writes are used to implement Forced Unit Access and
|
2015-11-06 23:12:26 +08:00
|
|
|
* are supported only on MMCs.
|
2011-04-01 07:40:00 +08:00
|
|
|
*/
|
2017-03-13 20:36:41 +08:00
|
|
|
*do_rel_wr = (req->cmd_flags & REQ_FUA) &&
|
|
|
|
rq_data_dir(req) == WRITE &&
|
|
|
|
(md->flags & MMC_BLK_REL_WR);
|
2011-04-01 07:40:00 +08:00
|
|
|
|
2011-07-02 00:55:29 +08:00
|
|
|
memset(brq, 0, sizeof(struct mmc_blk_request));
|
2017-03-13 20:36:41 +08:00
|
|
|
|
2011-07-02 00:55:29 +08:00
|
|
|
brq->mrq.data = &brq->data;
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2011-07-02 00:55:29 +08:00
|
|
|
brq->stop.opcode = MMC_STOP_TRANSMISSION;
|
|
|
|
brq->stop.arg = 0;
|
2017-03-13 20:36:41 +08:00
|
|
|
|
|
|
|
if (rq_data_dir(req) == READ) {
|
|
|
|
brq->data.flags = MMC_DATA_READ;
|
|
|
|
brq->stop.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_AC;
|
|
|
|
} else {
|
|
|
|
brq->data.flags = MMC_DATA_WRITE;
|
|
|
|
brq->stop.flags = MMC_RSP_SPI_R1B | MMC_RSP_R1B | MMC_CMD_AC;
|
|
|
|
}
|
|
|
|
|
|
|
|
brq->data.blksz = 512;
|
2011-07-02 00:55:29 +08:00
|
|
|
brq->data.blocks = blk_rq_sectors(req);
|
2009-01-01 01:21:17 +08:00
|
|
|
|
2011-07-02 00:55:29 +08:00
|
|
|
/*
|
|
|
|
* The block layer doesn't support all sector count
|
|
|
|
* restrictions, so we need to be prepared for too big
|
|
|
|
* requests.
|
|
|
|
*/
|
|
|
|
if (brq->data.blocks > card->host->max_blk_count)
|
|
|
|
brq->data.blocks = card->host->max_blk_count;
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2011-10-07 04:50:33 +08:00
|
|
|
if (brq->data.blocks > 1) {
|
|
|
|
/*
|
|
|
|
* 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;
|
|
|
|
|
2014-09-03 10:08:53 +08:00
|
|
|
/*
|
|
|
|
* Some controllers have HW issues while operating
|
|
|
|
* in multiple I/O mode
|
|
|
|
*/
|
|
|
|
if (card->host->ops->multi_io_quirk)
|
|
|
|
brq->data.blocks = card->host->ops->multi_io_quirk(card,
|
|
|
|
(rq_data_dir(req) == READ) ?
|
|
|
|
MMC_DATA_READ : MMC_DATA_WRITE,
|
|
|
|
brq->data.blocks);
|
2011-10-07 04:50:33 +08:00
|
|
|
}
|
2011-05-24 04:06:36 +08:00
|
|
|
|
2017-03-13 20:36:41 +08:00
|
|
|
if (*do_rel_wr)
|
|
|
|
mmc_apply_rel_rw(brq, card, req);
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Data tag is used only during writing meta data to speed
|
|
|
|
* up write and any subsequent read of this meta data
|
|
|
|
*/
|
|
|
|
*do_data_tag = card->ext_csd.data_tag_unit_size &&
|
|
|
|
(req->cmd_flags & REQ_META) &&
|
|
|
|
(rq_data_dir(req) == WRITE) &&
|
|
|
|
((brq->data.blocks * brq->data.blksz) >=
|
|
|
|
card->ext_csd.data_tag_unit_size);
|
|
|
|
|
|
|
|
mmc_set_data_timeout(&brq->data, card);
|
|
|
|
|
|
|
|
brq->data.sg = mqrq->sg;
|
|
|
|
brq->data.sg_len = mmc_queue_map_sg(mq, mqrq);
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Adjust the sg list so it is the same size as the
|
|
|
|
* request.
|
|
|
|
*/
|
|
|
|
if (brq->data.blocks != blk_rq_sectors(req)) {
|
|
|
|
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;
|
|
|
|
}
|
|
|
|
|
|
|
|
mqrq->areq.mrq = &brq->mrq;
|
|
|
|
|
|
|
|
mmc_queue_bounce_pre(mqrq);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void mmc_blk_rw_rq_prep(struct mmc_queue_req *mqrq,
|
|
|
|
struct mmc_card *card,
|
|
|
|
int disable_multi,
|
|
|
|
struct mmc_queue *mq)
|
|
|
|
{
|
|
|
|
u32 readcmd, writecmd;
|
|
|
|
struct mmc_blk_request *brq = &mqrq->brq;
|
|
|
|
struct request *req = mqrq->req;
|
|
|
|
struct mmc_blk_data *md = mq->blkdata;
|
|
|
|
bool do_rel_wr, do_data_tag;
|
|
|
|
|
|
|
|
mmc_blk_data_prep(mq, mqrq, disable_multi, &do_rel_wr, &do_data_tag);
|
|
|
|
|
|
|
|
brq->mrq.cmd = &brq->cmd;
|
|
|
|
|
|
|
|
brq->cmd.arg = blk_rq_pos(req);
|
|
|
|
if (!mmc_card_blockaddr(card))
|
|
|
|
brq->cmd.arg <<= 9;
|
|
|
|
brq->cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_ADTC;
|
|
|
|
|
2011-07-02 00:55:29 +08:00
|
|
|
if (brq->data.blocks > 1 || do_rel_wr) {
|
|
|
|
/* SPI multiblock writes terminate using a special
|
|
|
|
* token, not a STOP_TRANSMISSION request.
|
2011-05-24 04:06:36 +08:00
|
|
|
*/
|
2011-07-02 00:55:29 +08:00
|
|
|
if (!mmc_host_is_spi(card->host) ||
|
|
|
|
rq_data_dir(req) == READ)
|
|
|
|
brq->mrq.stop = &brq->stop;
|
|
|
|
readcmd = MMC_READ_MULTIPLE_BLOCK;
|
|
|
|
writecmd = MMC_WRITE_MULTIPLE_BLOCK;
|
|
|
|
} else {
|
|
|
|
brq->mrq.stop = NULL;
|
|
|
|
readcmd = MMC_READ_SINGLE_BLOCK;
|
|
|
|
writecmd = MMC_WRITE_BLOCK;
|
|
|
|
}
|
2017-03-13 20:36:41 +08:00
|
|
|
brq->cmd.opcode = rq_data_dir(req) == READ ? readcmd : writecmd;
|
2011-12-21 15:39:17 +08:00
|
|
|
|
2011-07-02 00:55:29 +08:00
|
|
|
/*
|
|
|
|
* Pre-defined multi-block transfers are preferable to
|
|
|
|
* open ended-ones (and necessary for reliable writes).
|
|
|
|
* However, it is not sufficient to just send CMD23,
|
|
|
|
* and avoid the final CMD12, as on an error condition
|
|
|
|
* CMD12 (stop) needs to be sent anyway. This, coupled
|
|
|
|
* with Auto-CMD23 enhancements provided by some
|
|
|
|
* hosts, means that the complexity of dealing
|
|
|
|
* with this is best left to the host. If CMD23 is
|
|
|
|
* supported by card and host, we'll fill sbc in and let
|
|
|
|
* the host deal with handling it correctly. This means
|
|
|
|
* that for hosts that don't expose MMC_CAP_CMD23, no
|
|
|
|
* change of behavior will be observed.
|
|
|
|
*
|
|
|
|
* N.B: Some MMC cards experience perf degradation.
|
|
|
|
* We'll avoid using CMD23-bounded multiblock writes for
|
|
|
|
* these, while retaining features like reliable writes.
|
|
|
|
*/
|
2011-12-21 15:39:17 +08:00
|
|
|
if ((md->flags & MMC_BLK_CMD23) && mmc_op_multi(brq->cmd.opcode) &&
|
|
|
|
(do_rel_wr || !(card->quirks & MMC_QUIRK_BLK_NO_CMD23) ||
|
|
|
|
do_data_tag)) {
|
2011-07-02 00:55:29 +08:00
|
|
|
brq->sbc.opcode = MMC_SET_BLOCK_COUNT;
|
|
|
|
brq->sbc.arg = brq->data.blocks |
|
2011-12-21 15:39:17 +08:00
|
|
|
(do_rel_wr ? (1 << 31) : 0) |
|
|
|
|
(do_data_tag ? (1 << 29) : 0);
|
2011-07-02 00:55:29 +08:00
|
|
|
brq->sbc.flags = MMC_RSP_R1 | MMC_CMD_AC;
|
|
|
|
brq->mrq.sbc = &brq->sbc;
|
|
|
|
}
|
2007-05-12 06:26:16 +08:00
|
|
|
|
2017-02-01 20:47:55 +08:00
|
|
|
mqrq->areq.err_check = mmc_blk_err_check;
|
2011-07-02 00:55:29 +08:00
|
|
|
}
|
2009-01-01 01:21:17 +08:00
|
|
|
|
2017-02-01 20:47:58 +08:00
|
|
|
static bool mmc_blk_rw_cmd_err(struct mmc_blk_data *md, struct mmc_card *card,
|
|
|
|
struct mmc_blk_request *brq, struct request *req,
|
|
|
|
bool old_req_pending)
|
2011-08-29 21:42:15 +08:00
|
|
|
{
|
2017-02-01 20:47:58 +08:00
|
|
|
bool req_pending;
|
|
|
|
|
2011-08-29 21:42:15 +08:00
|
|
|
/*
|
|
|
|
* 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
|
|
|
|
* as reported by the controller (which might be less than
|
|
|
|
* the real number of written sectors, but never more).
|
|
|
|
*/
|
|
|
|
if (mmc_card_sd(card)) {
|
|
|
|
u32 blocks;
|
2017-02-01 20:47:57 +08:00
|
|
|
int err;
|
2011-08-29 21:42:15 +08:00
|
|
|
|
2017-02-01 20:47:57 +08:00
|
|
|
err = mmc_sd_num_wr_blocks(card, &blocks);
|
2017-02-01 20:47:58 +08:00
|
|
|
if (err)
|
|
|
|
req_pending = old_req_pending;
|
|
|
|
else
|
|
|
|
req_pending = blk_end_request(req, 0, blocks << 9);
|
2016-11-29 18:09:08 +08:00
|
|
|
} else {
|
2017-02-01 20:47:58 +08:00
|
|
|
req_pending = blk_end_request(req, 0, brq->data.bytes_xfered);
|
2013-02-06 16:02:46 +08:00
|
|
|
}
|
2017-02-01 20:47:58 +08:00
|
|
|
return req_pending;
|
2013-02-06 16:02:46 +08:00
|
|
|
}
|
|
|
|
|
2017-03-13 20:36:35 +08:00
|
|
|
static void mmc_blk_rw_cmd_abort(struct mmc_queue *mq, struct mmc_card *card,
|
|
|
|
struct request *req,
|
|
|
|
struct mmc_queue_req *mqrq)
|
2017-01-24 18:17:52 +08:00
|
|
|
{
|
|
|
|
if (mmc_card_removed(card))
|
|
|
|
req->rq_flags |= RQF_QUIET;
|
2017-02-01 20:47:58 +08:00
|
|
|
while (blk_end_request(req, -EIO, blk_rq_cur_bytes(req)));
|
mmc: core: Allocate per-request data using the block layer core
The mmc_queue_req is a per-request state container the MMC core uses
to carry bounce buffers, pointers to asynchronous requests and so on.
Currently allocated as a static array of objects, then as a request
comes in, a mmc_queue_req is assigned to it, and used during the
lifetime of the request.
This is backwards compared to how other block layer drivers work:
they usally let the block core provide a per-request struct that get
allocated right beind the struct request, and which can be obtained
using the blk_mq_rq_to_pdu() helper. (The _mq_ infix in this function
name is misleading: it is used by both the old and the MQ block
layer.)
The per-request struct gets allocated to the size stored in the queue
variable .cmd_size initialized using the .init_rq_fn() and
cleaned up using .exit_rq_fn().
The block layer code makes the MMC core rely on this mechanism to
allocate the per-request mmc_queue_req state container.
Doing this make a lot of complicated queue handling go away. We only
need to keep the .qnct that keeps count of how many request are
currently being processed by the MMC layer. The MQ block layer will
replace also this once we transition to it.
Doing this refactoring is necessary to move the ioctl() operations
into custom block layer requests tagged with REQ_OP_DRV_[IN|OUT]
instead of the custom code using the BigMMCHostLock that we have
today: those require that per-request data be obtainable easily from
a request after creating a custom request with e.g.:
struct request *rq = blk_get_request(q, REQ_OP_DRV_IN, __GFP_RECLAIM);
struct mmc_queue_req *mq_rq = req_to_mq_rq(rq);
And this is not possible with the current construction, as the request
is not immediately assigned the per-request state container, but
instead it gets assigned when the request finally enters the MMC
queue, which is way too late for custom requests.
Signed-off-by: Linus Walleij <linus.walleij@linaro.org>
[Ulf: Folded in the fix to drop a call to blk_cleanup_queue()]
Signed-off-by: Ulf Hansson <ulf.hansson@linaro.org>
Tested-by: Heiner Kallweit <hkallweit1@gmail.com>
2017-05-18 17:29:32 +08:00
|
|
|
mq->qcnt--;
|
2017-01-24 18:17:52 +08:00
|
|
|
}
|
|
|
|
|
2017-02-01 20:47:54 +08:00
|
|
|
/**
|
|
|
|
* mmc_blk_rw_try_restart() - tries to restart the current async request
|
|
|
|
* @mq: the queue with the card and host to restart
|
|
|
|
* @req: a new request that want to be started after the current one
|
|
|
|
*/
|
2017-03-13 20:36:34 +08:00
|
|
|
static void mmc_blk_rw_try_restart(struct mmc_queue *mq, struct request *req,
|
|
|
|
struct mmc_queue_req *mqrq)
|
2017-01-24 18:17:53 +08:00
|
|
|
{
|
|
|
|
if (!req)
|
|
|
|
return;
|
|
|
|
|
2017-02-01 20:47:54 +08:00
|
|
|
/*
|
|
|
|
* If the card was removed, just cancel everything and return.
|
|
|
|
*/
|
|
|
|
if (mmc_card_removed(mq->card)) {
|
2017-01-24 18:17:53 +08:00
|
|
|
req->rq_flags |= RQF_QUIET;
|
|
|
|
blk_end_request_all(req, -EIO);
|
mmc: core: Allocate per-request data using the block layer core
The mmc_queue_req is a per-request state container the MMC core uses
to carry bounce buffers, pointers to asynchronous requests and so on.
Currently allocated as a static array of objects, then as a request
comes in, a mmc_queue_req is assigned to it, and used during the
lifetime of the request.
This is backwards compared to how other block layer drivers work:
they usally let the block core provide a per-request struct that get
allocated right beind the struct request, and which can be obtained
using the blk_mq_rq_to_pdu() helper. (The _mq_ infix in this function
name is misleading: it is used by both the old and the MQ block
layer.)
The per-request struct gets allocated to the size stored in the queue
variable .cmd_size initialized using the .init_rq_fn() and
cleaned up using .exit_rq_fn().
The block layer code makes the MMC core rely on this mechanism to
allocate the per-request mmc_queue_req state container.
Doing this make a lot of complicated queue handling go away. We only
need to keep the .qnct that keeps count of how many request are
currently being processed by the MMC layer. The MQ block layer will
replace also this once we transition to it.
Doing this refactoring is necessary to move the ioctl() operations
into custom block layer requests tagged with REQ_OP_DRV_[IN|OUT]
instead of the custom code using the BigMMCHostLock that we have
today: those require that per-request data be obtainable easily from
a request after creating a custom request with e.g.:
struct request *rq = blk_get_request(q, REQ_OP_DRV_IN, __GFP_RECLAIM);
struct mmc_queue_req *mq_rq = req_to_mq_rq(rq);
And this is not possible with the current construction, as the request
is not immediately assigned the per-request state container, but
instead it gets assigned when the request finally enters the MMC
queue, which is way too late for custom requests.
Signed-off-by: Linus Walleij <linus.walleij@linaro.org>
[Ulf: Folded in the fix to drop a call to blk_cleanup_queue()]
Signed-off-by: Ulf Hansson <ulf.hansson@linaro.org>
Tested-by: Heiner Kallweit <hkallweit1@gmail.com>
2017-05-18 17:29:32 +08:00
|
|
|
mq->qcnt--; /* FIXME: just set to 0? */
|
2017-02-01 20:47:54 +08:00
|
|
|
return;
|
2017-01-24 18:17:53 +08:00
|
|
|
}
|
2017-02-01 20:47:54 +08:00
|
|
|
/* Else proceed and try to restart the current async request */
|
2017-03-13 20:36:34 +08:00
|
|
|
mmc_blk_rw_rq_prep(mqrq, mq->card, 0, mq);
|
|
|
|
mmc_start_areq(mq->card->host, &mqrq->areq, NULL);
|
2017-01-24 18:17:53 +08:00
|
|
|
}
|
|
|
|
|
2017-02-01 20:47:52 +08:00
|
|
|
static void mmc_blk_issue_rw_rq(struct mmc_queue *mq, struct request *new_req)
|
2011-07-02 00:55:29 +08:00
|
|
|
{
|
2016-11-18 20:36:15 +08:00
|
|
|
struct mmc_blk_data *md = mq->blkdata;
|
2011-07-02 00:55:29 +08:00
|
|
|
struct mmc_card *card = md->queue.card;
|
2016-11-29 18:09:09 +08:00
|
|
|
struct mmc_blk_request *brq;
|
2017-02-01 20:47:58 +08:00
|
|
|
int disable_multi = 0, retry = 0, type, retune_retry_done = 0;
|
2011-07-02 00:55:30 +08:00
|
|
|
enum mmc_blk_status status;
|
2017-03-13 20:36:35 +08:00
|
|
|
struct mmc_queue_req *mqrq_cur = NULL;
|
2011-07-02 00:55:33 +08:00
|
|
|
struct mmc_queue_req *mq_rq;
|
2017-02-01 20:47:52 +08:00
|
|
|
struct request *old_req;
|
2017-01-24 18:17:56 +08:00
|
|
|
struct mmc_async_req *new_areq;
|
|
|
|
struct mmc_async_req *old_areq;
|
2017-02-01 20:47:58 +08:00
|
|
|
bool req_pending = true;
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2017-03-13 20:36:35 +08:00
|
|
|
if (new_req) {
|
mmc: core: Allocate per-request data using the block layer core
The mmc_queue_req is a per-request state container the MMC core uses
to carry bounce buffers, pointers to asynchronous requests and so on.
Currently allocated as a static array of objects, then as a request
comes in, a mmc_queue_req is assigned to it, and used during the
lifetime of the request.
This is backwards compared to how other block layer drivers work:
they usally let the block core provide a per-request struct that get
allocated right beind the struct request, and which can be obtained
using the blk_mq_rq_to_pdu() helper. (The _mq_ infix in this function
name is misleading: it is used by both the old and the MQ block
layer.)
The per-request struct gets allocated to the size stored in the queue
variable .cmd_size initialized using the .init_rq_fn() and
cleaned up using .exit_rq_fn().
The block layer code makes the MMC core rely on this mechanism to
allocate the per-request mmc_queue_req state container.
Doing this make a lot of complicated queue handling go away. We only
need to keep the .qnct that keeps count of how many request are
currently being processed by the MMC layer. The MQ block layer will
replace also this once we transition to it.
Doing this refactoring is necessary to move the ioctl() operations
into custom block layer requests tagged with REQ_OP_DRV_[IN|OUT]
instead of the custom code using the BigMMCHostLock that we have
today: those require that per-request data be obtainable easily from
a request after creating a custom request with e.g.:
struct request *rq = blk_get_request(q, REQ_OP_DRV_IN, __GFP_RECLAIM);
struct mmc_queue_req *mq_rq = req_to_mq_rq(rq);
And this is not possible with the current construction, as the request
is not immediately assigned the per-request state container, but
instead it gets assigned when the request finally enters the MMC
queue, which is way too late for custom requests.
Signed-off-by: Linus Walleij <linus.walleij@linaro.org>
[Ulf: Folded in the fix to drop a call to blk_cleanup_queue()]
Signed-off-by: Ulf Hansson <ulf.hansson@linaro.org>
Tested-by: Heiner Kallweit <hkallweit1@gmail.com>
2017-05-18 17:29:32 +08:00
|
|
|
mqrq_cur = req_to_mmc_queue_req(new_req);
|
|
|
|
mq->qcnt++;
|
2017-03-13 20:36:35 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
if (!mq->qcnt)
|
2017-01-24 18:17:57 +08:00
|
|
|
return;
|
2007-05-12 06:26:16 +08:00
|
|
|
|
2011-07-02 00:55:33 +08:00
|
|
|
do {
|
2017-02-01 20:47:52 +08:00
|
|
|
if (new_req) {
|
2012-05-17 19:02:21 +08:00
|
|
|
/*
|
|
|
|
* When 4KB native sector is enabled, only 8 blocks
|
|
|
|
* multiple read or write is allowed
|
|
|
|
*/
|
2016-05-13 15:59:24 +08:00
|
|
|
if (mmc_large_sector(card) &&
|
2017-02-01 20:47:52 +08:00
|
|
|
!IS_ALIGNED(blk_rq_sectors(new_req), 8)) {
|
2012-05-17 19:02:21 +08:00
|
|
|
pr_err("%s: Transfer size is not 4KB sector size aligned\n",
|
2017-02-01 20:47:52 +08:00
|
|
|
new_req->rq_disk->disk_name);
|
2017-03-13 20:36:35 +08:00
|
|
|
mmc_blk_rw_cmd_abort(mq, card, new_req, mqrq_cur);
|
2017-01-24 18:17:57 +08:00
|
|
|
return;
|
2012-05-17 19:02:21 +08:00
|
|
|
}
|
2013-02-06 16:02:46 +08:00
|
|
|
|
2017-03-13 20:36:34 +08:00
|
|
|
mmc_blk_rw_rq_prep(mqrq_cur, card, 0, mq);
|
|
|
|
new_areq = &mqrq_cur->areq;
|
2011-07-02 00:55:33 +08:00
|
|
|
} else
|
2017-01-24 18:17:56 +08:00
|
|
|
new_areq = NULL;
|
|
|
|
|
2017-02-01 20:47:53 +08:00
|
|
|
old_areq = mmc_start_areq(card->host, new_areq, &status);
|
2017-01-24 18:17:56 +08:00
|
|
|
if (!old_areq) {
|
2017-01-24 18:17:55 +08:00
|
|
|
/*
|
|
|
|
* We have just put the first request into the pipeline
|
|
|
|
* and there is nothing more to do until it is
|
|
|
|
* complete.
|
|
|
|
*/
|
2017-01-24 18:17:57 +08:00
|
|
|
return;
|
2013-01-15 03:28:17 +08:00
|
|
|
}
|
2011-07-02 00:55:33 +08:00
|
|
|
|
2017-01-24 18:17:55 +08:00
|
|
|
/*
|
|
|
|
* An asynchronous request has been completed and we proceed
|
|
|
|
* to handle the result of it.
|
|
|
|
*/
|
2017-02-01 20:47:55 +08:00
|
|
|
mq_rq = container_of(old_areq, struct mmc_queue_req, areq);
|
2011-07-02 00:55:33 +08:00
|
|
|
brq = &mq_rq->brq;
|
2017-02-01 20:47:52 +08:00
|
|
|
old_req = mq_rq->req;
|
|
|
|
type = rq_data_dir(old_req) == READ ? MMC_BLK_READ : MMC_BLK_WRITE;
|
2011-07-02 00:55:33 +08:00
|
|
|
mmc_queue_bounce_post(mq_rq);
|
2007-05-12 06:26:16 +08:00
|
|
|
|
2011-07-02 00:55:30 +08:00
|
|
|
switch (status) {
|
|
|
|
case MMC_BLK_SUCCESS:
|
|
|
|
case MMC_BLK_PARTIAL:
|
|
|
|
/*
|
|
|
|
* A block was successfully transferred.
|
|
|
|
*/
|
2011-08-29 21:42:15 +08:00
|
|
|
mmc_blk_reset_success(md, type);
|
2013-02-06 16:02:46 +08:00
|
|
|
|
2017-02-01 20:47:58 +08:00
|
|
|
req_pending = blk_end_request(old_req, 0,
|
|
|
|
brq->data.bytes_xfered);
|
2011-08-29 21:42:15 +08:00
|
|
|
/*
|
|
|
|
* If the blk_end_request function returns non-zero even
|
|
|
|
* though all data has been transferred and no errors
|
|
|
|
* were returned by the host controller, it's a bug.
|
|
|
|
*/
|
2017-02-01 20:47:58 +08:00
|
|
|
if (status == MMC_BLK_SUCCESS && req_pending) {
|
2011-10-11 14:14:09 +08:00
|
|
|
pr_err("%s BUG rq_tot %d d_xfer %d\n",
|
2017-02-01 20:47:52 +08:00
|
|
|
__func__, blk_rq_bytes(old_req),
|
2011-07-02 00:55:33 +08:00
|
|
|
brq->data.bytes_xfered);
|
2017-03-13 20:36:35 +08:00
|
|
|
mmc_blk_rw_cmd_abort(mq, card, old_req, mq_rq);
|
2017-01-24 18:17:57 +08:00
|
|
|
return;
|
2011-07-02 00:55:33 +08:00
|
|
|
}
|
2011-07-02 00:55:30 +08:00
|
|
|
break;
|
|
|
|
case MMC_BLK_CMD_ERR:
|
2017-02-01 20:47:58 +08:00
|
|
|
req_pending = mmc_blk_rw_cmd_err(md, card, brq, old_req, req_pending);
|
2017-02-01 20:47:51 +08:00
|
|
|
if (mmc_blk_reset(md, card->host, type)) {
|
2017-03-13 20:36:33 +08:00
|
|
|
if (req_pending)
|
2017-03-13 20:36:35 +08:00
|
|
|
mmc_blk_rw_cmd_abort(mq, card, old_req, mq_rq);
|
|
|
|
else
|
mmc: core: Allocate per-request data using the block layer core
The mmc_queue_req is a per-request state container the MMC core uses
to carry bounce buffers, pointers to asynchronous requests and so on.
Currently allocated as a static array of objects, then as a request
comes in, a mmc_queue_req is assigned to it, and used during the
lifetime of the request.
This is backwards compared to how other block layer drivers work:
they usally let the block core provide a per-request struct that get
allocated right beind the struct request, and which can be obtained
using the blk_mq_rq_to_pdu() helper. (The _mq_ infix in this function
name is misleading: it is used by both the old and the MQ block
layer.)
The per-request struct gets allocated to the size stored in the queue
variable .cmd_size initialized using the .init_rq_fn() and
cleaned up using .exit_rq_fn().
The block layer code makes the MMC core rely on this mechanism to
allocate the per-request mmc_queue_req state container.
Doing this make a lot of complicated queue handling go away. We only
need to keep the .qnct that keeps count of how many request are
currently being processed by the MMC layer. The MQ block layer will
replace also this once we transition to it.
Doing this refactoring is necessary to move the ioctl() operations
into custom block layer requests tagged with REQ_OP_DRV_[IN|OUT]
instead of the custom code using the BigMMCHostLock that we have
today: those require that per-request data be obtainable easily from
a request after creating a custom request with e.g.:
struct request *rq = blk_get_request(q, REQ_OP_DRV_IN, __GFP_RECLAIM);
struct mmc_queue_req *mq_rq = req_to_mq_rq(rq);
And this is not possible with the current construction, as the request
is not immediately assigned the per-request state container, but
instead it gets assigned when the request finally enters the MMC
queue, which is way too late for custom requests.
Signed-off-by: Linus Walleij <linus.walleij@linaro.org>
[Ulf: Folded in the fix to drop a call to blk_cleanup_queue()]
Signed-off-by: Ulf Hansson <ulf.hansson@linaro.org>
Tested-by: Heiner Kallweit <hkallweit1@gmail.com>
2017-05-18 17:29:32 +08:00
|
|
|
mq->qcnt--;
|
2017-03-13 20:36:34 +08:00
|
|
|
mmc_blk_rw_try_restart(mq, new_req, mqrq_cur);
|
2017-02-01 20:47:51 +08:00
|
|
|
return;
|
|
|
|
}
|
2017-02-01 20:47:58 +08:00
|
|
|
if (!req_pending) {
|
mmc: core: Allocate per-request data using the block layer core
The mmc_queue_req is a per-request state container the MMC core uses
to carry bounce buffers, pointers to asynchronous requests and so on.
Currently allocated as a static array of objects, then as a request
comes in, a mmc_queue_req is assigned to it, and used during the
lifetime of the request.
This is backwards compared to how other block layer drivers work:
they usally let the block core provide a per-request struct that get
allocated right beind the struct request, and which can be obtained
using the blk_mq_rq_to_pdu() helper. (The _mq_ infix in this function
name is misleading: it is used by both the old and the MQ block
layer.)
The per-request struct gets allocated to the size stored in the queue
variable .cmd_size initialized using the .init_rq_fn() and
cleaned up using .exit_rq_fn().
The block layer code makes the MMC core rely on this mechanism to
allocate the per-request mmc_queue_req state container.
Doing this make a lot of complicated queue handling go away. We only
need to keep the .qnct that keeps count of how many request are
currently being processed by the MMC layer. The MQ block layer will
replace also this once we transition to it.
Doing this refactoring is necessary to move the ioctl() operations
into custom block layer requests tagged with REQ_OP_DRV_[IN|OUT]
instead of the custom code using the BigMMCHostLock that we have
today: those require that per-request data be obtainable easily from
a request after creating a custom request with e.g.:
struct request *rq = blk_get_request(q, REQ_OP_DRV_IN, __GFP_RECLAIM);
struct mmc_queue_req *mq_rq = req_to_mq_rq(rq);
And this is not possible with the current construction, as the request
is not immediately assigned the per-request state container, but
instead it gets assigned when the request finally enters the MMC
queue, which is way too late for custom requests.
Signed-off-by: Linus Walleij <linus.walleij@linaro.org>
[Ulf: Folded in the fix to drop a call to blk_cleanup_queue()]
Signed-off-by: Ulf Hansson <ulf.hansson@linaro.org>
Tested-by: Heiner Kallweit <hkallweit1@gmail.com>
2017-05-18 17:29:32 +08:00
|
|
|
mq->qcnt--;
|
2017-03-13 20:36:34 +08:00
|
|
|
mmc_blk_rw_try_restart(mq, new_req, mqrq_cur);
|
2017-02-01 20:47:51 +08:00
|
|
|
return;
|
|
|
|
}
|
2015-05-18 20:14:15 +08:00
|
|
|
break;
|
2011-07-02 00:55:30 +08:00
|
|
|
case MMC_BLK_RETRY:
|
2015-05-07 18:10:24 +08:00
|
|
|
retune_retry_done = brq->retune_retry_done;
|
2011-07-02 00:55:30 +08:00
|
|
|
if (retry++ < 5)
|
2011-06-21 03:10:28 +08:00
|
|
|
break;
|
2011-08-29 21:42:15 +08:00
|
|
|
/* Fall through */
|
2011-07-02 00:55:30 +08:00
|
|
|
case MMC_BLK_ABORT:
|
2011-08-29 21:42:15 +08:00
|
|
|
if (!mmc_blk_reset(md, card->host, type))
|
|
|
|
break;
|
2017-03-13 20:36:35 +08:00
|
|
|
mmc_blk_rw_cmd_abort(mq, card, old_req, mq_rq);
|
2017-03-13 20:36:34 +08:00
|
|
|
mmc_blk_rw_try_restart(mq, new_req, mqrq_cur);
|
2017-02-01 20:47:51 +08:00
|
|
|
return;
|
2011-08-29 21:42:15 +08:00
|
|
|
case MMC_BLK_DATA_ERR: {
|
|
|
|
int err;
|
|
|
|
|
|
|
|
err = mmc_blk_reset(md, card->host, type);
|
|
|
|
if (!err)
|
|
|
|
break;
|
2017-02-01 20:47:51 +08:00
|
|
|
if (err == -ENODEV) {
|
2017-03-13 20:36:35 +08:00
|
|
|
mmc_blk_rw_cmd_abort(mq, card, old_req, mq_rq);
|
2017-03-13 20:36:34 +08:00
|
|
|
mmc_blk_rw_try_restart(mq, new_req, mqrq_cur);
|
2017-02-01 20:47:51 +08:00
|
|
|
return;
|
|
|
|
}
|
2011-08-29 21:42:15 +08:00
|
|
|
/* Fall through */
|
|
|
|
}
|
|
|
|
case MMC_BLK_ECC_ERR:
|
|
|
|
if (brq->data.blocks > 1) {
|
|
|
|
/* Redo read one sector at a time */
|
2014-09-13 05:56:56 +08:00
|
|
|
pr_warn("%s: retrying using single block read\n",
|
2017-02-01 20:47:52 +08:00
|
|
|
old_req->rq_disk->disk_name);
|
2011-08-29 21:42:15 +08:00
|
|
|
disable_multi = 1;
|
|
|
|
break;
|
|
|
|
}
|
2011-07-02 00:55:30 +08:00
|
|
|
/*
|
|
|
|
* After an error, we redo I/O one sector at a
|
|
|
|
* time, so we only reach here after trying to
|
|
|
|
* read a single sector.
|
|
|
|
*/
|
2017-02-01 20:47:58 +08:00
|
|
|
req_pending = blk_end_request(old_req, -EIO,
|
|
|
|
brq->data.blksz);
|
|
|
|
if (!req_pending) {
|
mmc: core: Allocate per-request data using the block layer core
The mmc_queue_req is a per-request state container the MMC core uses
to carry bounce buffers, pointers to asynchronous requests and so on.
Currently allocated as a static array of objects, then as a request
comes in, a mmc_queue_req is assigned to it, and used during the
lifetime of the request.
This is backwards compared to how other block layer drivers work:
they usally let the block core provide a per-request struct that get
allocated right beind the struct request, and which can be obtained
using the blk_mq_rq_to_pdu() helper. (The _mq_ infix in this function
name is misleading: it is used by both the old and the MQ block
layer.)
The per-request struct gets allocated to the size stored in the queue
variable .cmd_size initialized using the .init_rq_fn() and
cleaned up using .exit_rq_fn().
The block layer code makes the MMC core rely on this mechanism to
allocate the per-request mmc_queue_req state container.
Doing this make a lot of complicated queue handling go away. We only
need to keep the .qnct that keeps count of how many request are
currently being processed by the MMC layer. The MQ block layer will
replace also this once we transition to it.
Doing this refactoring is necessary to move the ioctl() operations
into custom block layer requests tagged with REQ_OP_DRV_[IN|OUT]
instead of the custom code using the BigMMCHostLock that we have
today: those require that per-request data be obtainable easily from
a request after creating a custom request with e.g.:
struct request *rq = blk_get_request(q, REQ_OP_DRV_IN, __GFP_RECLAIM);
struct mmc_queue_req *mq_rq = req_to_mq_rq(rq);
And this is not possible with the current construction, as the request
is not immediately assigned the per-request state container, but
instead it gets assigned when the request finally enters the MMC
queue, which is way too late for custom requests.
Signed-off-by: Linus Walleij <linus.walleij@linaro.org>
[Ulf: Folded in the fix to drop a call to blk_cleanup_queue()]
Signed-off-by: Ulf Hansson <ulf.hansson@linaro.org>
Tested-by: Heiner Kallweit <hkallweit1@gmail.com>
2017-05-18 17:29:32 +08:00
|
|
|
mq->qcnt--;
|
2017-03-13 20:36:34 +08:00
|
|
|
mmc_blk_rw_try_restart(mq, new_req, mqrq_cur);
|
2017-02-01 20:47:51 +08:00
|
|
|
return;
|
|
|
|
}
|
2011-07-02 00:55:30 +08:00
|
|
|
break;
|
2011-12-08 16:35:50 +08:00
|
|
|
case MMC_BLK_NOMEDIUM:
|
2017-03-13 20:36:35 +08:00
|
|
|
mmc_blk_rw_cmd_abort(mq, card, old_req, mq_rq);
|
2017-03-13 20:36:34 +08:00
|
|
|
mmc_blk_rw_try_restart(mq, new_req, mqrq_cur);
|
2017-02-01 20:47:51 +08:00
|
|
|
return;
|
2013-01-15 03:28:17 +08:00
|
|
|
default:
|
|
|
|
pr_err("%s: Unhandled return value (%d)",
|
2017-02-01 20:47:52 +08:00
|
|
|
old_req->rq_disk->disk_name, status);
|
2017-03-13 20:36:35 +08:00
|
|
|
mmc_blk_rw_cmd_abort(mq, card, old_req, mq_rq);
|
2017-03-13 20:36:34 +08:00
|
|
|
mmc_blk_rw_try_restart(mq, new_req, mqrq_cur);
|
2017-02-01 20:47:51 +08:00
|
|
|
return;
|
2011-06-21 03:10:49 +08:00
|
|
|
}
|
|
|
|
|
2017-02-01 20:47:58 +08:00
|
|
|
if (req_pending) {
|
2016-11-25 17:35:00 +08:00
|
|
|
/*
|
|
|
|
* In case of a incomplete request
|
|
|
|
* prepare it again and resend.
|
|
|
|
*/
|
|
|
|
mmc_blk_rw_rq_prep(mq_rq, card,
|
|
|
|
disable_multi, mq);
|
2017-02-01 20:47:53 +08:00
|
|
|
mmc_start_areq(card->host,
|
2017-02-01 20:47:55 +08:00
|
|
|
&mq_rq->areq, NULL);
|
2015-05-07 18:10:24 +08:00
|
|
|
mq_rq->brq.retune_retry_done = retune_retry_done;
|
2011-07-02 00:55:33 +08:00
|
|
|
}
|
2017-02-01 20:47:58 +08:00
|
|
|
} while (req_pending);
|
2017-03-13 20:36:35 +08:00
|
|
|
|
mmc: core: Allocate per-request data using the block layer core
The mmc_queue_req is a per-request state container the MMC core uses
to carry bounce buffers, pointers to asynchronous requests and so on.
Currently allocated as a static array of objects, then as a request
comes in, a mmc_queue_req is assigned to it, and used during the
lifetime of the request.
This is backwards compared to how other block layer drivers work:
they usally let the block core provide a per-request struct that get
allocated right beind the struct request, and which can be obtained
using the blk_mq_rq_to_pdu() helper. (The _mq_ infix in this function
name is misleading: it is used by both the old and the MQ block
layer.)
The per-request struct gets allocated to the size stored in the queue
variable .cmd_size initialized using the .init_rq_fn() and
cleaned up using .exit_rq_fn().
The block layer code makes the MMC core rely on this mechanism to
allocate the per-request mmc_queue_req state container.
Doing this make a lot of complicated queue handling go away. We only
need to keep the .qnct that keeps count of how many request are
currently being processed by the MMC layer. The MQ block layer will
replace also this once we transition to it.
Doing this refactoring is necessary to move the ioctl() operations
into custom block layer requests tagged with REQ_OP_DRV_[IN|OUT]
instead of the custom code using the BigMMCHostLock that we have
today: those require that per-request data be obtainable easily from
a request after creating a custom request with e.g.:
struct request *rq = blk_get_request(q, REQ_OP_DRV_IN, __GFP_RECLAIM);
struct mmc_queue_req *mq_rq = req_to_mq_rq(rq);
And this is not possible with the current construction, as the request
is not immediately assigned the per-request state container, but
instead it gets assigned when the request finally enters the MMC
queue, which is way too late for custom requests.
Signed-off-by: Linus Walleij <linus.walleij@linaro.org>
[Ulf: Folded in the fix to drop a call to blk_cleanup_queue()]
Signed-off-by: Ulf Hansson <ulf.hansson@linaro.org>
Tested-by: Heiner Kallweit <hkallweit1@gmail.com>
2017-05-18 17:29:32 +08:00
|
|
|
mq->qcnt--;
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
|
2017-01-24 18:17:57 +08:00
|
|
|
void mmc_blk_issue_rq(struct mmc_queue *mq, struct request *req)
|
2010-08-12 05:17:47 +08:00
|
|
|
{
|
2011-04-12 07:10:24 +08:00
|
|
|
int ret;
|
2016-11-18 20:36:15 +08:00
|
|
|
struct mmc_blk_data *md = mq->blkdata;
|
2011-04-12 07:10:24 +08:00
|
|
|
struct mmc_card *card = md->queue.card;
|
|
|
|
|
2017-03-13 20:36:35 +08:00
|
|
|
if (req && !mq->qcnt)
|
2011-07-02 00:55:33 +08:00
|
|
|
/* claim host only for the first request */
|
2013-05-02 20:02:38 +08:00
|
|
|
mmc_get_card(card);
|
2011-07-02 00:55:33 +08:00
|
|
|
|
2011-04-12 07:10:25 +08:00
|
|
|
ret = mmc_blk_part_switch(card, md);
|
|
|
|
if (ret) {
|
2011-09-23 17:48:20 +08:00
|
|
|
if (req) {
|
2012-06-07 18:16:58 +08:00
|
|
|
blk_end_request_all(req, -EIO);
|
2011-09-23 17:48:20 +08:00
|
|
|
}
|
2011-04-12 07:10:25 +08:00
|
|
|
goto out;
|
|
|
|
}
|
2011-04-12 07:10:24 +08:00
|
|
|
|
2016-06-06 03:32:17 +08:00
|
|
|
if (req && req_op(req) == REQ_OP_DISCARD) {
|
2011-07-02 00:55:33 +08:00
|
|
|
/* complete ongoing async transfer before issuing discard */
|
2017-03-13 20:36:35 +08:00
|
|
|
if (mq->qcnt)
|
2011-07-02 00:55:33 +08:00
|
|
|
mmc_blk_issue_rw_rq(mq, NULL);
|
2017-01-24 18:17:57 +08:00
|
|
|
mmc_blk_issue_discard_rq(mq, req);
|
2016-06-09 22:00:36 +08:00
|
|
|
} else if (req && req_op(req) == REQ_OP_SECURE_ERASE) {
|
|
|
|
/* complete ongoing async transfer before issuing secure erase*/
|
2017-03-13 20:36:35 +08:00
|
|
|
if (mq->qcnt)
|
2016-06-09 22:00:36 +08:00
|
|
|
mmc_blk_issue_rw_rq(mq, NULL);
|
2017-01-24 18:17:57 +08:00
|
|
|
mmc_blk_issue_secdiscard_rq(mq, req);
|
2016-06-06 03:32:23 +08:00
|
|
|
} else if (req && req_op(req) == REQ_OP_FLUSH) {
|
2011-07-13 16:02:16 +08:00
|
|
|
/* complete ongoing async transfer before issuing flush */
|
2017-03-13 20:36:35 +08:00
|
|
|
if (mq->qcnt)
|
2011-07-13 16:02:16 +08:00
|
|
|
mmc_blk_issue_rw_rq(mq, NULL);
|
2017-01-24 18:17:57 +08:00
|
|
|
mmc_blk_issue_flush(mq, req);
|
2010-08-12 05:17:50 +08:00
|
|
|
} else {
|
2017-01-24 18:17:57 +08:00
|
|
|
mmc_blk_issue_rw_rq(mq, req);
|
2017-03-13 20:36:32 +08:00
|
|
|
card->host->context_info.is_waiting_last_req = false;
|
2010-08-12 05:17:50 +08:00
|
|
|
}
|
2011-04-12 07:10:24 +08:00
|
|
|
|
2011-04-12 07:10:25 +08:00
|
|
|
out:
|
2017-03-13 20:36:35 +08:00
|
|
|
if (!mq->qcnt)
|
2013-05-02 20:02:38 +08:00
|
|
|
mmc_put_card(card);
|
2010-08-12 05:17:47 +08:00
|
|
|
}
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2006-01-04 06:38:44 +08:00
|
|
|
static inline int mmc_blk_readonly(struct mmc_card *card)
|
|
|
|
{
|
|
|
|
return mmc_card_readonly(card) ||
|
|
|
|
!(card->csd.cmdclass & CCC_BLOCK_WRITE);
|
|
|
|
}
|
|
|
|
|
2011-04-12 07:10:25 +08:00
|
|
|
static struct mmc_blk_data *mmc_blk_alloc_req(struct mmc_card *card,
|
|
|
|
struct device *parent,
|
|
|
|
sector_t size,
|
|
|
|
bool default_ro,
|
2011-12-02 15:51:06 +08:00
|
|
|
const char *subname,
|
|
|
|
int area_type)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
|
|
|
struct mmc_blk_data *md;
|
|
|
|
int devidx, ret;
|
|
|
|
|
2017-02-02 02:44:22 +08:00
|
|
|
devidx = ida_simple_get(&mmc_blk_ida, 0, max_devices, GFP_KERNEL);
|
|
|
|
if (devidx < 0)
|
|
|
|
return ERR_PTR(devidx);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
some kmalloc/memset ->kzalloc (tree wide)
Transform some calls to kmalloc/memset to a single kzalloc (or kcalloc).
Here is a short excerpt of the semantic patch performing
this transformation:
@@
type T2;
expression x;
identifier f,fld;
expression E;
expression E1,E2;
expression e1,e2,e3,y;
statement S;
@@
x =
- kmalloc
+ kzalloc
(E1,E2)
... when != \(x->fld=E;\|y=f(...,x,...);\|f(...,x,...);\|x=E;\|while(...) S\|for(e1;e2;e3) S\)
- memset((T2)x,0,E1);
@@
expression E1,E2,E3;
@@
- kzalloc(E1 * E2,E3)
+ kcalloc(E1,E2,E3)
[akpm@linux-foundation.org: get kcalloc args the right way around]
Signed-off-by: Yoann Padioleau <padator@wanadoo.fr>
Cc: Richard Henderson <rth@twiddle.net>
Cc: Ivan Kokshaysky <ink@jurassic.park.msu.ru>
Acked-by: Russell King <rmk@arm.linux.org.uk>
Cc: Bryan Wu <bryan.wu@analog.com>
Acked-by: Jiri Slaby <jirislaby@gmail.com>
Cc: Dave Airlie <airlied@linux.ie>
Acked-by: Roland Dreier <rolandd@cisco.com>
Cc: Jiri Kosina <jkosina@suse.cz>
Acked-by: Dmitry Torokhov <dtor@mail.ru>
Cc: Benjamin Herrenschmidt <benh@kernel.crashing.org>
Acked-by: Mauro Carvalho Chehab <mchehab@infradead.org>
Acked-by: Pierre Ossman <drzeus-list@drzeus.cx>
Cc: Jeff Garzik <jeff@garzik.org>
Cc: "David S. Miller" <davem@davemloft.net>
Acked-by: Greg KH <greg@kroah.com>
Cc: James Bottomley <James.Bottomley@steeleye.com>
Cc: "Antonino A. Daplas" <adaplas@pol.net>
Signed-off-by: Andrew Morton <akpm@linux-foundation.org>
Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
2007-07-19 16:49:03 +08:00
|
|
|
md = kzalloc(sizeof(struct mmc_blk_data), GFP_KERNEL);
|
2006-01-04 06:38:44 +08:00
|
|
|
if (!md) {
|
|
|
|
ret = -ENOMEM;
|
|
|
|
goto out;
|
|
|
|
}
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2011-12-02 15:51:06 +08:00
|
|
|
md->area_type = area_type;
|
|
|
|
|
2006-01-04 06:38:44 +08:00
|
|
|
/*
|
|
|
|
* Set the read-only status based on the supported commands
|
|
|
|
* and the write protect switch.
|
|
|
|
*/
|
|
|
|
md->read_only = mmc_blk_readonly(card);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2010-09-18 09:19:57 +08:00
|
|
|
md->disk = alloc_disk(perdev_minors);
|
2006-01-04 06:38:44 +08:00
|
|
|
if (md->disk == NULL) {
|
|
|
|
ret = -ENOMEM;
|
|
|
|
goto err_kfree;
|
|
|
|
}
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2006-01-04 06:38:44 +08:00
|
|
|
spin_lock_init(&md->lock);
|
2011-04-12 07:10:25 +08:00
|
|
|
INIT_LIST_HEAD(&md->part);
|
2006-01-04 06:38:44 +08:00
|
|
|
md->usage = 1;
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2011-06-23 18:40:28 +08:00
|
|
|
ret = mmc_init_queue(&md->queue, card, &md->lock, subname);
|
2006-01-04 06:38:44 +08:00
|
|
|
if (ret)
|
|
|
|
goto err_putdisk;
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2016-11-18 20:36:15 +08:00
|
|
|
md->queue.blkdata = md;
|
2005-12-23 07:21:38 +08:00
|
|
|
|
2007-05-14 23:27:29 +08:00
|
|
|
md->disk->major = MMC_BLOCK_MAJOR;
|
2010-09-18 09:19:57 +08:00
|
|
|
md->disk->first_minor = devidx * perdev_minors;
|
2006-01-04 06:38:44 +08:00
|
|
|
md->disk->fops = &mmc_bdops;
|
|
|
|
md->disk->private_data = md;
|
|
|
|
md->disk->queue = md->queue.queue;
|
2016-06-21 01:40:44 +08:00
|
|
|
md->parent = parent;
|
2011-04-12 07:10:25 +08:00
|
|
|
set_disk_ro(md->disk, md->read_only || default_ro);
|
2015-10-23 01:00:41 +08:00
|
|
|
md->disk->flags = GENHD_FL_EXT_DEVT;
|
2014-09-03 17:02:23 +08:00
|
|
|
if (area_type & (MMC_BLK_DATA_AREA_RPMB | MMC_BLK_DATA_AREA_BOOT))
|
2012-08-06 23:12:28 +08:00
|
|
|
md->disk->flags |= GENHD_FL_NO_PART_SCAN;
|
2006-01-04 06:38:44 +08:00
|
|
|
|
|
|
|
/*
|
|
|
|
* 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.
|
|
|
|
*/
|
|
|
|
|
2011-04-22 11:46:13 +08:00
|
|
|
snprintf(md->disk->disk_name, sizeof(md->disk->disk_name),
|
mmc: block: Use the mmc host device index as the mmcblk device index
Commit 520bd7a8b415 ("mmc: core: Optimize boot time by detecting cards
simultaneously") causes regressions for some platforms.
These platforms relies on fixed mmcblk device indexes, instead of
deploying the defacto standard with UUID/PARTUUID. In other words their
rootfs needs to be available at hardcoded paths, like /dev/mmcblk0p2.
Such guarantees have never been made by the kernel, but clearly the above
commit changes the behaviour. More precisely, because of that the order
changes of how cards becomes detected, so do their corresponding mmcblk
device indexes.
As the above commit significantly improves boot time for some platforms
(magnitude of seconds), let's avoid reverting this change but instead
restore the behaviour of how mmcblk device indexes becomes picked.
By using the same index for the mmcblk device as for the corresponding mmc
host device, the probe order of mmc host devices decides the index we get
for the mmcblk device.
For those platforms that suffers from a regression, one could expect that
this updated behaviour should be sufficient to meet their expectations of
"fixed" mmcblk device indexes.
Another side effect from this change, is that the same index is used for
the mmc host device, the mmcblk device and the mmc block queue. That
should clarify their relationship.
Reported-by: Peter Hurley <peter@hurleysoftware.com>
Reported-by: Laszlo Fiat <laszlo.fiat@gmail.com>
Cc: Linus Torvalds <torvalds@linux-foundation.org>
Fixes: 520bd7a8b415 ("mmc: core: Optimize boot time by detecting cards
simultaneously")
Cc: <stable@vger.kernel.org>
Signed-off-by: Ulf Hansson <ulf.hansson@linaro.org>
2016-04-06 22:12:08 +08:00
|
|
|
"mmcblk%u%s", card->host->index, subname ? subname : "");
|
2006-01-04 06:38:44 +08:00
|
|
|
|
2012-05-17 19:02:21 +08:00
|
|
|
if (mmc_card_mmc(card))
|
|
|
|
blk_queue_logical_block_size(md->queue.queue,
|
|
|
|
card->ext_csd.data_sector_size);
|
|
|
|
else
|
|
|
|
blk_queue_logical_block_size(md->queue.queue, 512);
|
|
|
|
|
2011-04-12 07:10:25 +08:00
|
|
|
set_capacity(md->disk, size);
|
2011-05-24 04:06:36 +08:00
|
|
|
|
2011-05-24 04:06:38 +08:00
|
|
|
if (mmc_host_cmd23(card->host)) {
|
2016-08-30 20:17:30 +08:00
|
|
|
if ((mmc_card_mmc(card) &&
|
|
|
|
card->csd.mmca_vsn >= CSD_SPEC_VER_3) ||
|
2011-05-24 04:06:38 +08:00
|
|
|
(mmc_card_sd(card) &&
|
|
|
|
card->scr.cmds & SD_SCR_CMD23_SUPPORT))
|
|
|
|
md->flags |= MMC_BLK_CMD23;
|
|
|
|
}
|
2011-05-24 04:06:36 +08:00
|
|
|
|
|
|
|
if (mmc_card_mmc(card) &&
|
|
|
|
md->flags & MMC_BLK_CMD23 &&
|
|
|
|
((card->ext_csd.rel_param & EXT_CSD_WR_REL_PARAM_EN) ||
|
|
|
|
card->ext_csd.rel_sectors)) {
|
|
|
|
md->flags |= MMC_BLK_REL_WR;
|
2016-03-31 00:17:20 +08:00
|
|
|
blk_queue_write_cache(md->queue.queue, true, true);
|
2011-05-24 04:06:36 +08:00
|
|
|
}
|
|
|
|
|
2011-04-12 07:10:25 +08:00
|
|
|
return md;
|
|
|
|
|
|
|
|
err_putdisk:
|
|
|
|
put_disk(md->disk);
|
|
|
|
err_kfree:
|
|
|
|
kfree(md);
|
|
|
|
out:
|
2017-02-02 02:44:22 +08:00
|
|
|
ida_simple_remove(&mmc_blk_ida, devidx);
|
2011-04-12 07:10:25 +08:00
|
|
|
return ERR_PTR(ret);
|
|
|
|
}
|
|
|
|
|
|
|
|
static struct mmc_blk_data *mmc_blk_alloc(struct mmc_card *card)
|
|
|
|
{
|
|
|
|
sector_t size;
|
2006-01-04 06:38:44 +08:00
|
|
|
|
2007-02-18 05:15:27 +08:00
|
|
|
if (!mmc_card_sd(card) && mmc_card_blockaddr(card)) {
|
|
|
|
/*
|
|
|
|
* The EXT_CSD sector count is in number or 512 byte
|
|
|
|
* sectors.
|
|
|
|
*/
|
2011-04-12 07:10:25 +08:00
|
|
|
size = card->ext_csd.sectors;
|
2007-02-18 05:15:27 +08:00
|
|
|
} else {
|
|
|
|
/*
|
|
|
|
* The CSD capacity field is in units of read_blkbits.
|
|
|
|
* set_capacity takes units of 512 bytes.
|
|
|
|
*/
|
2015-05-11 15:35:28 +08:00
|
|
|
size = (typeof(sector_t))card->csd.capacity
|
|
|
|
<< (card->csd.read_blkbits - 9);
|
2007-02-18 05:15:27 +08:00
|
|
|
}
|
2011-04-12 07:10:25 +08:00
|
|
|
|
2015-01-21 22:56:44 +08:00
|
|
|
return mmc_blk_alloc_req(card, &card->dev, size, false, NULL,
|
2011-12-02 15:51:06 +08:00
|
|
|
MMC_BLK_DATA_AREA_MAIN);
|
2011-04-12 07:10:25 +08:00
|
|
|
}
|
2006-01-04 06:38:44 +08:00
|
|
|
|
2011-04-12 07:10:25 +08:00
|
|
|
static int mmc_blk_alloc_part(struct mmc_card *card,
|
|
|
|
struct mmc_blk_data *md,
|
|
|
|
unsigned int part_type,
|
|
|
|
sector_t size,
|
|
|
|
bool default_ro,
|
2011-12-02 15:51:06 +08:00
|
|
|
const char *subname,
|
|
|
|
int area_type)
|
2011-04-12 07:10:25 +08:00
|
|
|
{
|
|
|
|
char cap_str[10];
|
|
|
|
struct mmc_blk_data *part_md;
|
|
|
|
|
|
|
|
part_md = mmc_blk_alloc_req(card, disk_to_dev(md->disk), size, default_ro,
|
2011-12-02 15:51:06 +08:00
|
|
|
subname, area_type);
|
2011-04-12 07:10:25 +08:00
|
|
|
if (IS_ERR(part_md))
|
|
|
|
return PTR_ERR(part_md);
|
|
|
|
part_md->part_type = part_type;
|
|
|
|
list_add(&part_md->part, &md->part);
|
|
|
|
|
sd, mmc, virtio_blk, string_helpers: fix block size units
The current string_get_size() overflows when the device size goes over
2^64 bytes because the string helper routine computes the suffix from
the size in bytes. However, the entirety of Linux thinks in terms of
blocks, not bytes, so this will artificially induce an overflow on very
large devices. Fix this by making the function string_get_size() take
blocks and the block size instead of bytes. This should allow us to
keep working until the current SCSI standard overflows.
Also fix virtio_blk and mmc (both of which were also artificially
multiplying by the block size to pass a byte side to string_get_size()).
The mathematics of this is pretty simple: we're taking a product of
size in blocks (S) and block size (B) and trying to re-express this in
exponential form: S*B = R*N^E (where N, the exponent is either 1000 or
1024) and R < N. Mathematically, S = RS*N^ES and B=RB*N^EB, so if RS*RB
< N it's easy to see that S*B = RS*RB*N^(ES+EB). However, if RS*BS > N,
we can see that this can be re-expressed as RS*BS = R*N (where R =
RS*BS/N < N) so the whole exponent becomes R*N^(ES+EB+1)
[jejb: fix incorrect 32 bit do_div spotted by kbuild test robot <fengguang.wu@intel.com>]
Acked-by: Ulf Hansson <ulf.hansson@linaro.org>
Reviewed-by: Andrew Morton <akpm@linux-foundation.org>
Signed-off-by: James Bottomley <JBottomley@Odin.com>
2015-03-06 10:47:01 +08:00
|
|
|
string_get_size((u64)get_capacity(part_md->disk), 512, STRING_UNITS_2,
|
2011-04-12 07:10:25 +08:00
|
|
|
cap_str, sizeof(cap_str));
|
2011-10-11 14:14:09 +08:00
|
|
|
pr_info("%s: %s %s partition %u %s\n",
|
2011-04-12 07:10:25 +08:00
|
|
|
part_md->disk->disk_name, mmc_card_id(card),
|
|
|
|
mmc_card_name(card), part_md->part_type, cap_str);
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2011-10-06 22:41:38 +08:00
|
|
|
/* MMC Physical partitions consist of two boot partitions and
|
|
|
|
* up to four general purpose partitions.
|
|
|
|
* For each partition enabled in EXT_CSD a block device will be allocatedi
|
|
|
|
* to provide access to the partition.
|
|
|
|
*/
|
|
|
|
|
2011-04-12 07:10:25 +08:00
|
|
|
static int mmc_blk_alloc_parts(struct mmc_card *card, struct mmc_blk_data *md)
|
|
|
|
{
|
2011-10-06 22:41:38 +08:00
|
|
|
int idx, ret = 0;
|
2011-04-12 07:10:25 +08:00
|
|
|
|
|
|
|
if (!mmc_card_mmc(card))
|
|
|
|
return 0;
|
|
|
|
|
2011-10-06 22:41:38 +08:00
|
|
|
for (idx = 0; idx < card->nr_parts; idx++) {
|
|
|
|
if (card->part[idx].size) {
|
|
|
|
ret = mmc_blk_alloc_part(card, md,
|
|
|
|
card->part[idx].part_cfg,
|
|
|
|
card->part[idx].size >> 9,
|
|
|
|
card->part[idx].force_ro,
|
2011-12-02 15:51:06 +08:00
|
|
|
card->part[idx].name,
|
|
|
|
card->part[idx].area_type);
|
2011-10-06 22:41:38 +08:00
|
|
|
if (ret)
|
|
|
|
return ret;
|
|
|
|
}
|
2011-04-12 07:10:25 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
return ret;
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
|
2011-04-12 07:10:25 +08:00
|
|
|
static void mmc_blk_remove_req(struct mmc_blk_data *md)
|
|
|
|
{
|
2011-12-02 15:51:06 +08:00
|
|
|
struct mmc_card *card;
|
|
|
|
|
2011-04-12 07:10:25 +08:00
|
|
|
if (md) {
|
2013-06-05 05:42:40 +08:00
|
|
|
/*
|
|
|
|
* Flush remaining requests and free queues. It
|
|
|
|
* is freeing the queue that stops new requests
|
|
|
|
* from being accepted.
|
|
|
|
*/
|
2013-07-24 21:17:48 +08:00
|
|
|
card = md->queue.card;
|
2013-06-05 05:42:40 +08:00
|
|
|
mmc_cleanup_queue(&md->queue);
|
2011-04-12 07:10:25 +08:00
|
|
|
if (md->disk->flags & GENHD_FL_UP) {
|
|
|
|
device_remove_file(disk_to_dev(md->disk), &md->force_ro);
|
2011-12-02 15:51:06 +08:00
|
|
|
if ((md->area_type & MMC_BLK_DATA_AREA_BOOT) &&
|
|
|
|
card->ext_csd.boot_ro_lockable)
|
|
|
|
device_remove_file(disk_to_dev(md->disk),
|
|
|
|
&md->power_ro_lock);
|
2011-04-12 07:10:25 +08:00
|
|
|
|
|
|
|
del_gendisk(md->disk);
|
|
|
|
}
|
|
|
|
mmc_blk_put(md);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
static void mmc_blk_remove_parts(struct mmc_card *card,
|
|
|
|
struct mmc_blk_data *md)
|
|
|
|
{
|
|
|
|
struct list_head *pos, *q;
|
|
|
|
struct mmc_blk_data *part_md;
|
|
|
|
|
|
|
|
list_for_each_safe(pos, q, &md->part) {
|
|
|
|
part_md = list_entry(pos, struct mmc_blk_data, part);
|
|
|
|
list_del(pos);
|
|
|
|
mmc_blk_remove_req(part_md);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
static int mmc_add_disk(struct mmc_blk_data *md)
|
|
|
|
{
|
|
|
|
int ret;
|
2011-12-02 15:51:06 +08:00
|
|
|
struct mmc_card *card = md->queue.card;
|
2011-04-12 07:10:25 +08:00
|
|
|
|
2016-06-21 01:40:44 +08:00
|
|
|
device_add_disk(md->parent, md->disk);
|
2011-04-12 07:10:25 +08:00
|
|
|
md->force_ro.show = force_ro_show;
|
|
|
|
md->force_ro.store = force_ro_store;
|
2011-04-23 23:22:58 +08:00
|
|
|
sysfs_attr_init(&md->force_ro.attr);
|
2011-04-12 07:10:25 +08:00
|
|
|
md->force_ro.attr.name = "force_ro";
|
|
|
|
md->force_ro.attr.mode = S_IRUGO | S_IWUSR;
|
|
|
|
ret = device_create_file(disk_to_dev(md->disk), &md->force_ro);
|
|
|
|
if (ret)
|
2011-12-02 15:51:06 +08:00
|
|
|
goto force_ro_fail;
|
|
|
|
|
|
|
|
if ((md->area_type & MMC_BLK_DATA_AREA_BOOT) &&
|
|
|
|
card->ext_csd.boot_ro_lockable) {
|
2012-03-20 18:00:24 +08:00
|
|
|
umode_t mode;
|
2011-12-02 15:51:06 +08:00
|
|
|
|
|
|
|
if (card->ext_csd.boot_ro_lock & EXT_CSD_BOOT_WP_B_PWR_WP_DIS)
|
|
|
|
mode = S_IRUGO;
|
|
|
|
else
|
|
|
|
mode = S_IRUGO | S_IWUSR;
|
|
|
|
|
|
|
|
md->power_ro_lock.show = power_ro_lock_show;
|
|
|
|
md->power_ro_lock.store = power_ro_lock_store;
|
2012-02-01 23:31:56 +08:00
|
|
|
sysfs_attr_init(&md->power_ro_lock.attr);
|
2011-12-02 15:51:06 +08:00
|
|
|
md->power_ro_lock.attr.mode = mode;
|
|
|
|
md->power_ro_lock.attr.name =
|
|
|
|
"ro_lock_until_next_power_on";
|
|
|
|
ret = device_create_file(disk_to_dev(md->disk),
|
|
|
|
&md->power_ro_lock);
|
|
|
|
if (ret)
|
|
|
|
goto power_ro_lock_fail;
|
|
|
|
}
|
|
|
|
return ret;
|
|
|
|
|
|
|
|
power_ro_lock_fail:
|
|
|
|
device_remove_file(disk_to_dev(md->disk), &md->force_ro);
|
|
|
|
force_ro_fail:
|
|
|
|
del_gendisk(md->disk);
|
2011-04-12 07:10:25 +08:00
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
2015-04-14 19:06:12 +08:00
|
|
|
static int mmc_blk_probe(struct mmc_card *card)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
2011-04-12 07:10:25 +08:00
|
|
|
struct mmc_blk_data *md, *part_md;
|
2008-09-06 16:57:57 +08:00
|
|
|
char cap_str[10];
|
|
|
|
|
2005-05-21 17:27:02 +08:00
|
|
|
/*
|
|
|
|
* Check that the card supports the command class(es) we need.
|
|
|
|
*/
|
|
|
|
if (!(card->csd.cmdclass & CCC_BLOCK_READ))
|
2005-04-17 06:20:36 +08:00
|
|
|
return -ENODEV;
|
|
|
|
|
2017-02-15 16:36:47 +08:00
|
|
|
mmc_fixup_device(card, mmc_blk_fixups);
|
2014-06-18 19:18:07 +08:00
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
md = mmc_blk_alloc(card);
|
mmc: core: Allocate per-request data using the block layer core
The mmc_queue_req is a per-request state container the MMC core uses
to carry bounce buffers, pointers to asynchronous requests and so on.
Currently allocated as a static array of objects, then as a request
comes in, a mmc_queue_req is assigned to it, and used during the
lifetime of the request.
This is backwards compared to how other block layer drivers work:
they usally let the block core provide a per-request struct that get
allocated right beind the struct request, and which can be obtained
using the blk_mq_rq_to_pdu() helper. (The _mq_ infix in this function
name is misleading: it is used by both the old and the MQ block
layer.)
The per-request struct gets allocated to the size stored in the queue
variable .cmd_size initialized using the .init_rq_fn() and
cleaned up using .exit_rq_fn().
The block layer code makes the MMC core rely on this mechanism to
allocate the per-request mmc_queue_req state container.
Doing this make a lot of complicated queue handling go away. We only
need to keep the .qnct that keeps count of how many request are
currently being processed by the MMC layer. The MQ block layer will
replace also this once we transition to it.
Doing this refactoring is necessary to move the ioctl() operations
into custom block layer requests tagged with REQ_OP_DRV_[IN|OUT]
instead of the custom code using the BigMMCHostLock that we have
today: those require that per-request data be obtainable easily from
a request after creating a custom request with e.g.:
struct request *rq = blk_get_request(q, REQ_OP_DRV_IN, __GFP_RECLAIM);
struct mmc_queue_req *mq_rq = req_to_mq_rq(rq);
And this is not possible with the current construction, as the request
is not immediately assigned the per-request state container, but
instead it gets assigned when the request finally enters the MMC
queue, which is way too late for custom requests.
Signed-off-by: Linus Walleij <linus.walleij@linaro.org>
[Ulf: Folded in the fix to drop a call to blk_cleanup_queue()]
Signed-off-by: Ulf Hansson <ulf.hansson@linaro.org>
Tested-by: Heiner Kallweit <hkallweit1@gmail.com>
2017-05-18 17:29:32 +08:00
|
|
|
if (IS_ERR(md))
|
2005-04-17 06:20:36 +08:00
|
|
|
return PTR_ERR(md);
|
|
|
|
|
sd, mmc, virtio_blk, string_helpers: fix block size units
The current string_get_size() overflows when the device size goes over
2^64 bytes because the string helper routine computes the suffix from
the size in bytes. However, the entirety of Linux thinks in terms of
blocks, not bytes, so this will artificially induce an overflow on very
large devices. Fix this by making the function string_get_size() take
blocks and the block size instead of bytes. This should allow us to
keep working until the current SCSI standard overflows.
Also fix virtio_blk and mmc (both of which were also artificially
multiplying by the block size to pass a byte side to string_get_size()).
The mathematics of this is pretty simple: we're taking a product of
size in blocks (S) and block size (B) and trying to re-express this in
exponential form: S*B = R*N^E (where N, the exponent is either 1000 or
1024) and R < N. Mathematically, S = RS*N^ES and B=RB*N^EB, so if RS*RB
< N it's easy to see that S*B = RS*RB*N^(ES+EB). However, if RS*BS > N,
we can see that this can be re-expressed as RS*BS = R*N (where R =
RS*BS/N < N) so the whole exponent becomes R*N^(ES+EB+1)
[jejb: fix incorrect 32 bit do_div spotted by kbuild test robot <fengguang.wu@intel.com>]
Acked-by: Ulf Hansson <ulf.hansson@linaro.org>
Reviewed-by: Andrew Morton <akpm@linux-foundation.org>
Signed-off-by: James Bottomley <JBottomley@Odin.com>
2015-03-06 10:47:01 +08:00
|
|
|
string_get_size((u64)get_capacity(md->disk), 512, STRING_UNITS_2,
|
2008-09-06 16:57:57 +08:00
|
|
|
cap_str, sizeof(cap_str));
|
2011-10-11 14:14:09 +08:00
|
|
|
pr_info("%s: %s %s %s %s\n",
|
2005-04-17 06:20:36 +08:00
|
|
|
md->disk->disk_name, mmc_card_id(card), mmc_card_name(card),
|
2008-09-06 16:57:57 +08:00
|
|
|
cap_str, md->read_only ? "(ro)" : "");
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2011-04-12 07:10:25 +08:00
|
|
|
if (mmc_blk_alloc_parts(card, md))
|
|
|
|
goto out;
|
|
|
|
|
2015-04-14 19:06:12 +08:00
|
|
|
dev_set_drvdata(&card->dev, md);
|
2011-04-12 07:11:04 +08:00
|
|
|
|
2011-04-12 07:10:25 +08:00
|
|
|
if (mmc_add_disk(md))
|
|
|
|
goto out;
|
|
|
|
|
|
|
|
list_for_each_entry(part_md, &md->part, part) {
|
|
|
|
if (mmc_add_disk(part_md))
|
|
|
|
goto out;
|
|
|
|
}
|
2013-05-02 20:02:38 +08:00
|
|
|
|
|
|
|
pm_runtime_set_autosuspend_delay(&card->dev, 3000);
|
|
|
|
pm_runtime_use_autosuspend(&card->dev);
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Don't enable runtime PM for SD-combo cards here. Leave that
|
|
|
|
* decision to be taken during the SDIO init sequence instead.
|
|
|
|
*/
|
|
|
|
if (card->type != MMC_TYPE_SD_COMBO) {
|
|
|
|
pm_runtime_set_active(&card->dev);
|
|
|
|
pm_runtime_enable(&card->dev);
|
|
|
|
}
|
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
return 0;
|
|
|
|
|
|
|
|
out:
|
2011-04-12 07:10:25 +08:00
|
|
|
mmc_blk_remove_parts(card, md);
|
|
|
|
mmc_blk_remove_req(md);
|
2012-03-22 18:47:26 +08:00
|
|
|
return 0;
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
|
2015-04-14 19:06:12 +08:00
|
|
|
static void mmc_blk_remove(struct mmc_card *card)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
2015-04-14 19:06:12 +08:00
|
|
|
struct mmc_blk_data *md = dev_get_drvdata(&card->dev);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2011-04-12 07:10:25 +08:00
|
|
|
mmc_blk_remove_parts(card, md);
|
2013-05-02 20:02:38 +08:00
|
|
|
pm_runtime_get_sync(&card->dev);
|
2011-06-23 18:40:26 +08:00
|
|
|
mmc_claim_host(card->host);
|
|
|
|
mmc_blk_part_switch(card, md);
|
|
|
|
mmc_release_host(card->host);
|
2013-05-02 20:02:38 +08:00
|
|
|
if (card->type != MMC_TYPE_SD_COMBO)
|
|
|
|
pm_runtime_disable(&card->dev);
|
|
|
|
pm_runtime_put_noidle(&card->dev);
|
2011-04-12 07:10:25 +08:00
|
|
|
mmc_blk_remove_req(md);
|
2015-04-14 19:06:12 +08:00
|
|
|
dev_set_drvdata(&card->dev, NULL);
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
|
2015-04-14 19:06:12 +08:00
|
|
|
static int _mmc_blk_suspend(struct mmc_card *card)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
2011-04-12 07:10:25 +08:00
|
|
|
struct mmc_blk_data *part_md;
|
2015-04-14 19:06:12 +08:00
|
|
|
struct mmc_blk_data *md = dev_get_drvdata(&card->dev);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
if (md) {
|
|
|
|
mmc_queue_suspend(&md->queue);
|
2011-04-12 07:10:25 +08:00
|
|
|
list_for_each_entry(part_md, &md->part, part) {
|
|
|
|
mmc_queue_suspend(&part_md->queue);
|
|
|
|
}
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2015-04-14 19:06:12 +08:00
|
|
|
static void mmc_blk_shutdown(struct mmc_card *card)
|
2013-06-10 23:03:40 +08:00
|
|
|
{
|
2015-04-14 19:06:12 +08:00
|
|
|
_mmc_blk_suspend(card);
|
2013-06-10 23:03:40 +08:00
|
|
|
}
|
|
|
|
|
2014-10-06 17:29:42 +08:00
|
|
|
#ifdef CONFIG_PM_SLEEP
|
|
|
|
static int mmc_blk_suspend(struct device *dev)
|
2013-06-10 23:03:40 +08:00
|
|
|
{
|
2015-04-14 19:06:12 +08:00
|
|
|
struct mmc_card *card = mmc_dev_to_card(dev);
|
|
|
|
|
|
|
|
return _mmc_blk_suspend(card);
|
2013-06-10 23:03:40 +08:00
|
|
|
}
|
|
|
|
|
2014-10-06 17:29:42 +08:00
|
|
|
static int mmc_blk_resume(struct device *dev)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
2011-04-12 07:10:25 +08:00
|
|
|
struct mmc_blk_data *part_md;
|
2014-10-06 20:34:09 +08:00
|
|
|
struct mmc_blk_data *md = dev_get_drvdata(dev);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
if (md) {
|
2011-04-12 07:10:25 +08:00
|
|
|
/*
|
|
|
|
* Resume involves the card going into idle state,
|
|
|
|
* so current partition is always the main one.
|
|
|
|
*/
|
|
|
|
md->part_curr = md->part_type;
|
2005-04-17 06:20:36 +08:00
|
|
|
mmc_queue_resume(&md->queue);
|
2011-04-12 07:10:25 +08:00
|
|
|
list_for_each_entry(part_md, &md->part, part) {
|
|
|
|
mmc_queue_resume(&part_md->queue);
|
|
|
|
}
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
2014-10-06 17:29:42 +08:00
|
|
|
static SIMPLE_DEV_PM_OPS(mmc_blk_pm_ops, mmc_blk_suspend, mmc_blk_resume);
|
|
|
|
|
2015-04-14 19:06:12 +08:00
|
|
|
static struct mmc_driver mmc_driver = {
|
|
|
|
.drv = {
|
|
|
|
.name = "mmcblk",
|
|
|
|
.pm = &mmc_blk_pm_ops,
|
|
|
|
},
|
2005-04-17 06:20:36 +08:00
|
|
|
.probe = mmc_blk_probe,
|
|
|
|
.remove = mmc_blk_remove,
|
2013-06-10 23:03:40 +08:00
|
|
|
.shutdown = mmc_blk_shutdown,
|
2005-04-17 06:20:36 +08:00
|
|
|
};
|
|
|
|
|
|
|
|
static int __init mmc_blk_init(void)
|
|
|
|
{
|
2008-09-13 18:02:07 +08:00
|
|
|
int res;
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2010-09-18 09:19:57 +08:00
|
|
|
if (perdev_minors != CONFIG_MMC_BLOCK_MINORS)
|
|
|
|
pr_info("mmcblk: using %d minors per device\n", perdev_minors);
|
|
|
|
|
2014-11-06 11:35:09 +08:00
|
|
|
max_devices = min(MAX_DEVICES, (1 << MINORBITS) / perdev_minors);
|
2010-09-18 09:19:57 +08:00
|
|
|
|
2007-05-14 23:27:29 +08:00
|
|
|
res = register_blkdev(MMC_BLOCK_MAJOR, "mmc");
|
|
|
|
if (res)
|
2005-04-17 06:20:36 +08:00
|
|
|
goto out;
|
|
|
|
|
2008-09-13 18:02:07 +08:00
|
|
|
res = mmc_register_driver(&mmc_driver);
|
|
|
|
if (res)
|
|
|
|
goto out2;
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2008-09-13 18:02:07 +08:00
|
|
|
return 0;
|
|
|
|
out2:
|
|
|
|
unregister_blkdev(MMC_BLOCK_MAJOR, "mmc");
|
2005-04-17 06:20:36 +08:00
|
|
|
out:
|
|
|
|
return res;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __exit mmc_blk_exit(void)
|
|
|
|
{
|
|
|
|
mmc_unregister_driver(&mmc_driver);
|
2007-05-14 23:27:29 +08:00
|
|
|
unregister_blkdev(MMC_BLOCK_MAJOR, "mmc");
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
module_init(mmc_blk_init);
|
|
|
|
module_exit(mmc_blk_exit);
|
|
|
|
|
|
|
|
MODULE_LICENSE("GPL");
|
|
|
|
MODULE_DESCRIPTION("Multimedia Card (MMC) block device driver");
|
|
|
|
|