block.c revision 23af60398af2f5033e2f53665538a09f498dbc03
11da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 21da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Block driver for media (i.e., flash cards) 31da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 41da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Copyright 2002 Hewlett-Packard Company 5979ce7208a679b8d012450610d5d5aa75aab3af9Pierre Ossman * Copyright 2005-2008 Pierre Ossman 61da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 71da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Use consistent with the GNU GPL is permitted, 81da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * provided that this copyright notice is 91da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * preserved in its entirety in all copies and derived works. 101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * HEWLETT-PACKARD COMPANY MAKES NO WARRANTIES, EXPRESSED OR IMPLIED, 121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * AS TO THE USEFULNESS OR CORRECTNESS OF THIS CODE OR ITS 131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * FITNESS FOR ANY PARTICULAR PURPOSE. 141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Many thanks to Alessandro Rubini and Jonathan Corbet! 161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Author: Andrew Christian 181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 28 May 2002 191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/moduleparam.h> 211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/module.h> 221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/init.h> 231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/kernel.h> 251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/fs.h> 261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/errno.h> 271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/hdreg.h> 281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/kdev_t.h> 291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/blkdev.h> 30a621aaed690b9439141c555941b6af53873f6ff1Arjan van de Ven#include <linux/mutex.h> 31ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman#include <linux/scatterlist.h> 321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/mmc/card.h> 34385e3227d4d83ab13d7767c4bb3593b0256bf246Pierre Ossman#include <linux/mmc/host.h> 35da7fbe58d2d347e95af699ddf04d885be6362bbePierre Ossman#include <linux/mmc/mmc.h> 36da7fbe58d2d347e95af699ddf04d885be6362bbePierre Ossman#include <linux/mmc/sd.h> 371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/system.h> 391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/uaccess.h> 401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4198ac2162699f7e9880683cb954891817f20b607cPierre Ossman#include "queue.h" 421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * max 8 partitions per card 451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define MMC_SHIFT 3 471dff314451fa24d6b107aa05393d3169e56a7e0aDavid Woodhouse#define MMC_NUM_MINORS (256 >> MMC_SHIFT) 481dff314451fa24d6b107aa05393d3169e56a7e0aDavid Woodhouse 49203c80187eba037f2d6562e0d5847014746726ddBen Collinsstatic DECLARE_BITMAP(dev_use, MMC_NUM_MINORS); 501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * There is one mmc_blk_data per slot. 531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstruct mmc_blk_data { 551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spinlock_t lock; 561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct gendisk *disk; 571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct mmc_queue queue; 581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int usage; 601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int block_bits; 61a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King unsigned int read_only; 621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 64a621aaed690b9439141c555941b6af53873f6ff1Arjan van de Venstatic DEFINE_MUTEX(open_lock); 651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct mmc_blk_data *mmc_blk_get(struct gendisk *disk) 671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct mmc_blk_data *md; 691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 70a621aaed690b9439141c555941b6af53873f6ff1Arjan van de Ven mutex_lock(&open_lock); 711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds md = disk->private_data; 721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (md && md->usage == 0) 731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds md = NULL; 741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (md) 751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds md->usage++; 76a621aaed690b9439141c555941b6af53873f6ff1Arjan van de Ven mutex_unlock(&open_lock); 771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return md; 791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void mmc_blk_put(struct mmc_blk_data *md) 821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 83a621aaed690b9439141c555941b6af53873f6ff1Arjan van de Ven mutex_lock(&open_lock); 841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds md->usage--; 851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (md->usage == 0) { 861dff314451fa24d6b107aa05393d3169e56a7e0aDavid Woodhouse int devidx = md->disk->first_minor >> MMC_SHIFT; 871dff314451fa24d6b107aa05393d3169e56a7e0aDavid Woodhouse __clear_bit(devidx, dev_use); 881dff314451fa24d6b107aa05393d3169e56a7e0aDavid Woodhouse 891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds put_disk(md->disk); 901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kfree(md); 911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 92a621aaed690b9439141c555941b6af53873f6ff1Arjan van de Ven mutex_unlock(&open_lock); 931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int mmc_blk_open(struct inode *inode, struct file *filp) 961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct mmc_blk_data *md; 981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret = -ENXIO; 991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds md = mmc_blk_get(inode->i_bdev->bd_disk); 1011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (md) { 1021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (md->usage == 2) 1031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds check_disk_change(inode->i_bdev); 1041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = 0; 105a00fc09029f02ca833cf90e5d5625f08c4ac4f51Pierre Ossman 106a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King if ((filp->f_mode & FMODE_WRITE) && md->read_only) 107a00fc09029f02ca833cf90e5d5625f08c4ac4f51Pierre Ossman ret = -EROFS; 1081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 1111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int mmc_blk_release(struct inode *inode, struct file *filp) 1141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct mmc_blk_data *md = inode->i_bdev->bd_disk->private_data; 1161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mmc_blk_put(md); 1181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 1191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int 122a885c8c4316e1c1d2d2c8755da3f3d14f852528dChristoph Hellwigmmc_blk_getgeo(struct block_device *bdev, struct hd_geometry *geo) 1231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 124a885c8c4316e1c1d2d2c8755da3f3d14f852528dChristoph Hellwig geo->cylinders = get_capacity(bdev->bd_disk) / (4 * 16); 125a885c8c4316e1c1d2d2c8755da3f3d14f852528dChristoph Hellwig geo->heads = 4; 126a885c8c4316e1c1d2d2c8755da3f3d14f852528dChristoph Hellwig geo->sectors = 16; 127a885c8c4316e1c1d2d2c8755da3f3d14f852528dChristoph Hellwig return 0; 1281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct block_device_operations mmc_bdops = { 1311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .open = mmc_blk_open, 1321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .release = mmc_blk_release, 133a885c8c4316e1c1d2d2c8755da3f3d14f852528dChristoph Hellwig .getgeo = mmc_blk_getgeo, 1341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .owner = THIS_MODULE, 1351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 1361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstruct mmc_blk_request { 1381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct mmc_request mrq; 1391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct mmc_command cmd; 1401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct mmc_command stop; 1411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct mmc_data data; 1421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 1431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 144ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossmanstatic u32 mmc_sd_num_wr_blocks(struct mmc_card *card) 145ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman{ 146ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman int err; 147ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman u32 blocks; 148ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman 149ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman struct mmc_request mrq; 150ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman struct mmc_command cmd; 151ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman struct mmc_data data; 152ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman unsigned int timeout_us; 153ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman 154ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman struct scatterlist sg; 155ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman 156ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman memset(&cmd, 0, sizeof(struct mmc_command)); 157ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman 158ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman cmd.opcode = MMC_APP_CMD; 159ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman cmd.arg = card->rca << 16; 1607213d175e3b6f6db60f843b72e88857a350e146aDavid Brownell cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_AC; 161ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman 162ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman err = mmc_wait_for_cmd(card->host, &cmd, 0); 1637213d175e3b6f6db60f843b72e88857a350e146aDavid Brownell if (err) 1647213d175e3b6f6db60f843b72e88857a350e146aDavid Brownell return (u32)-1; 1657213d175e3b6f6db60f843b72e88857a350e146aDavid Brownell if (!mmc_host_is_spi(card->host) && !(cmd.resp[0] & R1_APP_CMD)) 166ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman return (u32)-1; 167ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman 168ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman memset(&cmd, 0, sizeof(struct mmc_command)); 169ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman 170ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman cmd.opcode = SD_APP_SEND_NUM_WR_BLKS; 171ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman cmd.arg = 0; 1727213d175e3b6f6db60f843b72e88857a350e146aDavid Brownell cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_ADTC; 173ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman 174ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman memset(&data, 0, sizeof(struct mmc_data)); 175ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman 176ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman data.timeout_ns = card->csd.tacc_ns * 100; 177ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman data.timeout_clks = card->csd.tacc_clks * 100; 178ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman 179ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman timeout_us = data.timeout_ns / 1000; 180ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman timeout_us += data.timeout_clks * 1000 / 181ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman (card->host->ios.clock / 1000); 182ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman 183ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman if (timeout_us > 100000) { 184ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman data.timeout_ns = 100000000; 185ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman data.timeout_clks = 0; 186ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman } 187ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman 188ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman data.blksz = 4; 189ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman data.blocks = 1; 190ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman data.flags = MMC_DATA_READ; 191ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman data.sg = &sg; 192ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman data.sg_len = 1; 193ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman 194ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman memset(&mrq, 0, sizeof(struct mmc_request)); 195ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman 196ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman mrq.cmd = &cmd; 197ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman mrq.data = &data; 198ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman 199ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman sg_init_one(&sg, &blocks, 4); 200ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman 201ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman mmc_wait_for_req(card->host, &mrq); 202ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman 20317b0429dde9ab60f9cee8e07ab28c7dc6cfe6efdPierre Ossman if (cmd.error || data.error) 204ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman return (u32)-1; 205ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman 206ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman blocks = ntohl(blocks); 207ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman 208ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman return blocks; 209ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman} 210ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman 2111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int mmc_blk_issue_rq(struct mmc_queue *mq, struct request *req) 2121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct mmc_blk_data *md = mq->data; 2141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct mmc_card *card = md->queue.card; 215176f00ffed3ef94a198326fbf6a5db64f1cf73adPierre Ossman struct mmc_blk_request brq; 21614d836e7499c53a1f6a65086c3d11600e871a971Alex Dubov int ret = 1, sg_pos, data_size; 2171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 218b855885e3b60cf6f9452848712a62517b94583ebPierre Ossman mmc_claim_host(card->host); 2191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds do { 2211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct mmc_command cmd; 222db53f28b3a6d9338cca1b7e917dc063ac99e1871Russell King u32 readcmd, writecmd; 2231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memset(&brq, 0, sizeof(struct mmc_blk_request)); 2251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds brq.mrq.cmd = &brq.cmd; 2261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds brq.mrq.data = &brq.data; 2271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 228fba68bd2dab1ac99af3c5a963ec9581cfa9f1725Philip Langdale brq.cmd.arg = req->sector; 229fba68bd2dab1ac99af3c5a963ec9581cfa9f1725Philip Langdale if (!mmc_card_blockaddr(card)) 230fba68bd2dab1ac99af3c5a963ec9581cfa9f1725Philip Langdale brq.cmd.arg <<= 9; 2317213d175e3b6f6db60f843b72e88857a350e146aDavid Brownell brq.cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_ADTC; 2322c171bf13423dc5293188cea7f6c2da1720926e2Pavel Pisa brq.data.blksz = 1 << md->block_bits; 2331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds brq.stop.opcode = MMC_STOP_TRANSMISSION; 2341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds brq.stop.arg = 0; 2357213d175e3b6f6db60f843b72e88857a350e146aDavid Brownell brq.stop.flags = MMC_RSP_SPI_R1B | MMC_RSP_R1B | MMC_CMD_AC; 23655db890a838c7b37256241b1fc53d6344aa79cc0Pierre Ossman brq.data.blocks = req->nr_sectors >> (md->block_bits - 9); 23755db890a838c7b37256241b1fc53d6344aa79cc0Pierre Ossman if (brq.data.blocks > card->host->max_blk_count) 23855db890a838c7b37256241b1fc53d6344aa79cc0Pierre Ossman brq.data.blocks = card->host->max_blk_count; 2391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 240788ee7b09883515f3a72a8f2a980df5e94f37e2cRussell King if (brq.data.blocks > 1) { 2417213d175e3b6f6db60f843b72e88857a350e146aDavid Brownell /* SPI multiblock writes terminate using a special 2427213d175e3b6f6db60f843b72e88857a350e146aDavid Brownell * token, not a STOP_TRANSMISSION request. 2437213d175e3b6f6db60f843b72e88857a350e146aDavid Brownell */ 2447213d175e3b6f6db60f843b72e88857a350e146aDavid Brownell if (!mmc_host_is_spi(card->host) 2457213d175e3b6f6db60f843b72e88857a350e146aDavid Brownell || rq_data_dir(req) == READ) 2467213d175e3b6f6db60f843b72e88857a350e146aDavid Brownell brq.mrq.stop = &brq.stop; 247db53f28b3a6d9338cca1b7e917dc063ac99e1871Russell King readcmd = MMC_READ_MULTIPLE_BLOCK; 248db53f28b3a6d9338cca1b7e917dc063ac99e1871Russell King writecmd = MMC_WRITE_MULTIPLE_BLOCK; 249788ee7b09883515f3a72a8f2a980df5e94f37e2cRussell King } else { 250788ee7b09883515f3a72a8f2a980df5e94f37e2cRussell King brq.mrq.stop = NULL; 251db53f28b3a6d9338cca1b7e917dc063ac99e1871Russell King readcmd = MMC_READ_SINGLE_BLOCK; 252db53f28b3a6d9338cca1b7e917dc063ac99e1871Russell King writecmd = MMC_WRITE_BLOCK; 253db53f28b3a6d9338cca1b7e917dc063ac99e1871Russell King } 254db53f28b3a6d9338cca1b7e917dc063ac99e1871Russell King 255db53f28b3a6d9338cca1b7e917dc063ac99e1871Russell King if (rq_data_dir(req) == READ) { 256db53f28b3a6d9338cca1b7e917dc063ac99e1871Russell King brq.cmd.opcode = readcmd; 257db53f28b3a6d9338cca1b7e917dc063ac99e1871Russell King brq.data.flags |= MMC_DATA_READ; 258db53f28b3a6d9338cca1b7e917dc063ac99e1871Russell King } else { 259db53f28b3a6d9338cca1b7e917dc063ac99e1871Russell King brq.cmd.opcode = writecmd; 260db53f28b3a6d9338cca1b7e917dc063ac99e1871Russell King brq.data.flags |= MMC_DATA_WRITE; 261788ee7b09883515f3a72a8f2a980df5e94f37e2cRussell King } 2621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 263b146d26a61e0feab2f12a98ae83fd352830899c0Pierre Ossman mmc_set_data_timeout(&brq.data, card); 264b146d26a61e0feab2f12a98ae83fd352830899c0Pierre Ossman 2651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds brq.data.sg = mq->sg; 26698ccf14909ba02a41c5925b0b2c92aeeef23d3b9Pierre Ossman brq.data.sg_len = mmc_queue_map_sg(mq); 26798ccf14909ba02a41c5925b0b2c92aeeef23d3b9Pierre Ossman 26898ccf14909ba02a41c5925b0b2c92aeeef23d3b9Pierre Ossman mmc_queue_bounce_pre(mq); 2691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27014d836e7499c53a1f6a65086c3d11600e871a971Alex Dubov if (brq.data.blocks != 27114d836e7499c53a1f6a65086c3d11600e871a971Alex Dubov (req->nr_sectors >> (md->block_bits - 9))) { 27214d836e7499c53a1f6a65086c3d11600e871a971Alex Dubov data_size = brq.data.blocks * brq.data.blksz; 27314d836e7499c53a1f6a65086c3d11600e871a971Alex Dubov for (sg_pos = 0; sg_pos < brq.data.sg_len; sg_pos++) { 27414d836e7499c53a1f6a65086c3d11600e871a971Alex Dubov data_size -= mq->sg[sg_pos].length; 27514d836e7499c53a1f6a65086c3d11600e871a971Alex Dubov if (data_size <= 0) { 27614d836e7499c53a1f6a65086c3d11600e871a971Alex Dubov mq->sg[sg_pos].length += data_size; 27714d836e7499c53a1f6a65086c3d11600e871a971Alex Dubov sg_pos++; 27814d836e7499c53a1f6a65086c3d11600e871a971Alex Dubov break; 27914d836e7499c53a1f6a65086c3d11600e871a971Alex Dubov } 28014d836e7499c53a1f6a65086c3d11600e871a971Alex Dubov } 28114d836e7499c53a1f6a65086c3d11600e871a971Alex Dubov brq.data.sg_len = sg_pos; 28214d836e7499c53a1f6a65086c3d11600e871a971Alex Dubov } 28314d836e7499c53a1f6a65086c3d11600e871a971Alex Dubov 2841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mmc_wait_for_req(card->host, &brq.mrq); 28598ccf14909ba02a41c5925b0b2c92aeeef23d3b9Pierre Ossman 28698ccf14909ba02a41c5925b0b2c92aeeef23d3b9Pierre Ossman mmc_queue_bounce_post(mq); 28798ccf14909ba02a41c5925b0b2c92aeeef23d3b9Pierre Ossman 288979ce7208a679b8d012450610d5d5aa75aab3af9Pierre Ossman /* 289979ce7208a679b8d012450610d5d5aa75aab3af9Pierre Ossman * Check for errors here, but don't jump to cmd_err 290979ce7208a679b8d012450610d5d5aa75aab3af9Pierre Ossman * until later as we need to wait for the card to leave 291979ce7208a679b8d012450610d5d5aa75aab3af9Pierre Ossman * programming mode even when things go wrong. 292979ce7208a679b8d012450610d5d5aa75aab3af9Pierre Ossman */ 2931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (brq.cmd.error) { 2941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_ERR "%s: error %d sending read/write command\n", 2951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds req->rq_disk->disk_name, brq.cmd.error); 2961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 2971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (brq.data.error) { 2991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_ERR "%s: error %d transferring data\n", 3001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds req->rq_disk->disk_name, brq.data.error); 3011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (brq.stop.error) { 3041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_ERR "%s: error %d sending stop command\n", 3051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds req->rq_disk->disk_name, brq.stop.error); 3061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3087213d175e3b6f6db60f843b72e88857a350e146aDavid Brownell if (!mmc_host_is_spi(card->host) && rq_data_dir(req) != READ) { 3092ed6d22cec37d9a3df4c5bacf1160dee7700106eRussell King do { 3102ed6d22cec37d9a3df4c5bacf1160dee7700106eRussell King int err; 3112ed6d22cec37d9a3df4c5bacf1160dee7700106eRussell King 3122ed6d22cec37d9a3df4c5bacf1160dee7700106eRussell King cmd.opcode = MMC_SEND_STATUS; 3132ed6d22cec37d9a3df4c5bacf1160dee7700106eRussell King cmd.arg = card->rca << 16; 3142ed6d22cec37d9a3df4c5bacf1160dee7700106eRussell King cmd.flags = MMC_RSP_R1 | MMC_CMD_AC; 3152ed6d22cec37d9a3df4c5bacf1160dee7700106eRussell King err = mmc_wait_for_cmd(card->host, &cmd, 5); 3162ed6d22cec37d9a3df4c5bacf1160dee7700106eRussell King if (err) { 3172ed6d22cec37d9a3df4c5bacf1160dee7700106eRussell King printk(KERN_ERR "%s: error %d requesting status\n", 3182ed6d22cec37d9a3df4c5bacf1160dee7700106eRussell King req->rq_disk->disk_name, err); 3192ed6d22cec37d9a3df4c5bacf1160dee7700106eRussell King goto cmd_err; 3202ed6d22cec37d9a3df4c5bacf1160dee7700106eRussell King } 321d198f101989d9bb950327f0d043f6203bb862343Pierre Ossman /* 322d198f101989d9bb950327f0d043f6203bb862343Pierre Ossman * Some cards mishandle the status bits, 323d198f101989d9bb950327f0d043f6203bb862343Pierre Ossman * so make sure to check both the busy 324d198f101989d9bb950327f0d043f6203bb862343Pierre Ossman * indication and the card state. 325d198f101989d9bb950327f0d043f6203bb862343Pierre Ossman */ 326d198f101989d9bb950327f0d043f6203bb862343Pierre Ossman } while (!(cmd.resp[0] & R1_READY_FOR_DATA) || 327d198f101989d9bb950327f0d043f6203bb862343Pierre Ossman (R1_CURRENT_STATE(cmd.resp[0]) == 7)); 3281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if 0 3302ed6d22cec37d9a3df4c5bacf1160dee7700106eRussell King if (cmd.resp[0] & ~0x00000900) 3312ed6d22cec37d9a3df4c5bacf1160dee7700106eRussell King printk(KERN_ERR "%s: status = %08x\n", 3322ed6d22cec37d9a3df4c5bacf1160dee7700106eRussell King req->rq_disk->disk_name, cmd.resp[0]); 3332ed6d22cec37d9a3df4c5bacf1160dee7700106eRussell King if (mmc_decode_status(cmd.resp)) 3342ed6d22cec37d9a3df4c5bacf1160dee7700106eRussell King goto cmd_err; 3351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 3362ed6d22cec37d9a3df4c5bacf1160dee7700106eRussell King } 3371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 338979ce7208a679b8d012450610d5d5aa75aab3af9Pierre Ossman if (brq.cmd.error || brq.data.error || brq.stop.error) 339979ce7208a679b8d012450610d5d5aa75aab3af9Pierre Ossman goto cmd_err; 340979ce7208a679b8d012450610d5d5aa75aab3af9Pierre Ossman 3411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 3421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * A block was successfully transferred. 3431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 3441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irq(&md->lock); 345fd539832c7d3a242269374dbcae2cd54da150930Kiyoshi Ueda ret = __blk_end_request(req, 0, brq.data.bytes_xfered); 3461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&md->lock); 3471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } while (ret); 3481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 349b855885e3b60cf6f9452848712a62517b94583ebPierre Ossman mmc_release_host(card->host); 3501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 1; 3521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cmd_err: 354ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman /* 355ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman * If this is an SD card and we're writing, we can first 356ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman * mark the known good sectors as ok. 357ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman * 358ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman * If the card is not SD, we can still ok written sectors 35923af60398af2f5033e2f53665538a09f498dbc03Pierre Ossman * as reported by the controller (which might be less than 36023af60398af2f5033e2f53665538a09f498dbc03Pierre Ossman * the real number of written sectors, but never more). 361176f00ffed3ef94a198326fbf6a5db64f1cf73adPierre Ossman * 362176f00ffed3ef94a198326fbf6a5db64f1cf73adPierre Ossman * For reads we just fail the entire chunk as that should 363176f00ffed3ef94a198326fbf6a5db64f1cf73adPierre Ossman * be safe in all cases. 3641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 36523af60398af2f5033e2f53665538a09f498dbc03Pierre Ossman if (rq_data_dir(req) != READ) { 36623af60398af2f5033e2f53665538a09f498dbc03Pierre Ossman if (mmc_card_sd(card)) { 36723af60398af2f5033e2f53665538a09f498dbc03Pierre Ossman u32 blocks; 36823af60398af2f5033e2f53665538a09f498dbc03Pierre Ossman unsigned int bytes; 36923af60398af2f5033e2f53665538a09f498dbc03Pierre Ossman 37023af60398af2f5033e2f53665538a09f498dbc03Pierre Ossman blocks = mmc_sd_num_wr_blocks(card); 37123af60398af2f5033e2f53665538a09f498dbc03Pierre Ossman if (blocks != (u32)-1) { 37223af60398af2f5033e2f53665538a09f498dbc03Pierre Ossman if (card->csd.write_partial) 37323af60398af2f5033e2f53665538a09f498dbc03Pierre Ossman bytes = blocks << md->block_bits; 37423af60398af2f5033e2f53665538a09f498dbc03Pierre Ossman else 37523af60398af2f5033e2f53665538a09f498dbc03Pierre Ossman bytes = blocks << 9; 37623af60398af2f5033e2f53665538a09f498dbc03Pierre Ossman spin_lock_irq(&md->lock); 37723af60398af2f5033e2f53665538a09f498dbc03Pierre Ossman ret = __blk_end_request(req, 0, bytes); 37823af60398af2f5033e2f53665538a09f498dbc03Pierre Ossman spin_unlock_irq(&md->lock); 37923af60398af2f5033e2f53665538a09f498dbc03Pierre Ossman } 38023af60398af2f5033e2f53665538a09f498dbc03Pierre Ossman } else { 381ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman spin_lock_irq(&md->lock); 38223af60398af2f5033e2f53665538a09f498dbc03Pierre Ossman ret = __blk_end_request(req, 0, brq.data.bytes_xfered); 383ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman spin_unlock_irq(&md->lock); 384ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman } 385176f00ffed3ef94a198326fbf6a5db64f1cf73adPierre Ossman } 386176f00ffed3ef94a198326fbf6a5db64f1cf73adPierre Ossman 387b855885e3b60cf6f9452848712a62517b94583ebPierre Ossman mmc_release_host(card->host); 388ec5a19dd935eb3793e1f6ed491e8035b3d7b1df9Pierre Ossman 3891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irq(&md->lock); 390fd539832c7d3a242269374dbcae2cd54da150930Kiyoshi Ueda while (ret) 391fd539832c7d3a242269374dbcae2cd54da150930Kiyoshi Ueda ret = __blk_end_request(req, -EIO, blk_rq_cur_bytes(req)); 3921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(&md->lock); 3931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 3951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 3961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 398a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell Kingstatic inline int mmc_blk_readonly(struct mmc_card *card) 399a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King{ 400a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King return mmc_card_readonly(card) || 401a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King !(card->csd.cmdclass & CCC_BLOCK_WRITE); 402a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King} 403a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King 4041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct mmc_blk_data *mmc_blk_alloc(struct mmc_card *card) 4051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 4061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct mmc_blk_data *md; 4071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int devidx, ret; 4081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds devidx = find_first_zero_bit(dev_use, MMC_NUM_MINORS); 4101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (devidx >= MMC_NUM_MINORS) 4111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ERR_PTR(-ENOSPC); 4121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds __set_bit(devidx, dev_use); 4131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 414dd00cc486ab1c17049a535413d1751ef3482141cYoann Padioleau md = kzalloc(sizeof(struct mmc_blk_data), GFP_KERNEL); 415a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King if (!md) { 416a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King ret = -ENOMEM; 417a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King goto out; 418a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King } 4191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 421a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King /* 422a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King * Set the read-only status based on the supported commands 423a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King * and the write protect switch. 424a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King */ 425a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King md->read_only = mmc_blk_readonly(card); 4261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 427a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King /* 4286fe9febb8af2f82f9caace1aa1c00cd8de7469acPierre Ossman * Both SD and MMC specifications state (although a bit 4296fe9febb8af2f82f9caace1aa1c00cd8de7469acPierre Ossman * unclearly in the MMC case) that a block size of 512 4306fe9febb8af2f82f9caace1aa1c00cd8de7469acPierre Ossman * bytes must always be supported by the card. 431a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King */ 4326fe9febb8af2f82f9caace1aa1c00cd8de7469acPierre Ossman md->block_bits = 9; 4331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 434a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King md->disk = alloc_disk(1 << MMC_SHIFT); 435a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King if (md->disk == NULL) { 436a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King ret = -ENOMEM; 437a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King goto err_kfree; 438a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King } 4391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 440a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King spin_lock_init(&md->lock); 441a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King md->usage = 1; 4421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 443a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King ret = mmc_init_queue(&md->queue, card, &md->lock); 444a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King if (ret) 445a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King goto err_putdisk; 4461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 447a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King md->queue.issue_fn = mmc_blk_issue_rq; 448a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King md->queue.data = md; 449d2b18394259ef621fd2a6322aa9934198fd87a6aRussell King 450fe6b4c8840c5e23fe9b8696450cee8f2e8cebffdPierre Ossman md->disk->major = MMC_BLOCK_MAJOR; 451a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King md->disk->first_minor = devidx << MMC_SHIFT; 452a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King md->disk->fops = &mmc_bdops; 453a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King md->disk->private_data = md; 454a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King md->disk->queue = md->queue.queue; 455a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King md->disk->driverfs_dev = &card->dev; 456a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King 457a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King /* 458a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King * As discussed on lkml, GENHD_FL_REMOVABLE should: 459a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King * 460a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King * - be set for removable media with permanent block devices 461a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King * - be unset for removable block devices with permanent media 462a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King * 463a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King * Since MMC block devices clearly fall under the second 464a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King * case, we do not set GENHD_FL_REMOVABLE. Userspace 465a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King * should use the block device creation/destruction hotplug 466a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King * messages to tell when the card is present. 467a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King */ 468a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King 469a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King sprintf(md->disk->disk_name, "mmcblk%d", devidx); 470a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King 471a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King blk_queue_hardsect_size(md->queue.queue, 1 << md->block_bits); 472a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King 47385a18ad93ec66888d85758630019b10a84257f3cPierre Ossman if (!mmc_card_sd(card) && mmc_card_blockaddr(card)) { 47485a18ad93ec66888d85758630019b10a84257f3cPierre Ossman /* 47585a18ad93ec66888d85758630019b10a84257f3cPierre Ossman * The EXT_CSD sector count is in number or 512 byte 47685a18ad93ec66888d85758630019b10a84257f3cPierre Ossman * sectors. 47785a18ad93ec66888d85758630019b10a84257f3cPierre Ossman */ 47885a18ad93ec66888d85758630019b10a84257f3cPierre Ossman set_capacity(md->disk, card->ext_csd.sectors); 47985a18ad93ec66888d85758630019b10a84257f3cPierre Ossman } else { 48085a18ad93ec66888d85758630019b10a84257f3cPierre Ossman /* 48185a18ad93ec66888d85758630019b10a84257f3cPierre Ossman * The CSD capacity field is in units of read_blkbits. 48285a18ad93ec66888d85758630019b10a84257f3cPierre Ossman * set_capacity takes units of 512 bytes. 48385a18ad93ec66888d85758630019b10a84257f3cPierre Ossman */ 48485a18ad93ec66888d85758630019b10a84257f3cPierre Ossman set_capacity(md->disk, 48585a18ad93ec66888d85758630019b10a84257f3cPierre Ossman card->csd.capacity << (card->csd.read_blkbits - 9)); 48685a18ad93ec66888d85758630019b10a84257f3cPierre Ossman } 4871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return md; 488a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King 489a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King err_putdisk: 490a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King put_disk(md->disk); 491a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King err_kfree: 492a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King kfree(md); 493a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King out: 494a6f6c96b65d7f65a7a7bf5cbe874eda182a6b2ccRussell King return ERR_PTR(ret); 4951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 4961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int 4981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmmc_blk_set_blksize(struct mmc_blk_data *md, struct mmc_card *card) 4991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 5001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct mmc_command cmd; 5011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int err; 5021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 503fba68bd2dab1ac99af3c5a963ec9581cfa9f1725Philip Langdale /* Block-addressed cards ignore MMC_SET_BLOCKLEN. */ 504fba68bd2dab1ac99af3c5a963ec9581cfa9f1725Philip Langdale if (mmc_card_blockaddr(card)) 505fba68bd2dab1ac99af3c5a963ec9581cfa9f1725Philip Langdale return 0; 506fba68bd2dab1ac99af3c5a963ec9581cfa9f1725Philip Langdale 507b855885e3b60cf6f9452848712a62517b94583ebPierre Ossman mmc_claim_host(card->host); 5081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cmd.opcode = MMC_SET_BLOCKLEN; 509d2b18394259ef621fd2a6322aa9934198fd87a6aRussell King cmd.arg = 1 << md->block_bits; 5107213d175e3b6f6db60f843b72e88857a350e146aDavid Brownell cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_AC; 5111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = mmc_wait_for_cmd(card->host, &cmd, 5); 512b855885e3b60cf6f9452848712a62517b94583ebPierre Ossman mmc_release_host(card->host); 5131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (err) { 5151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_ERR "%s: unable to set block size to %d: %d\n", 5161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds md->disk->disk_name, cmd.arg, err); 5171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 5181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 5211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int mmc_blk_probe(struct mmc_card *card) 5241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 5251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct mmc_blk_data *md; 5261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int err; 5271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 528912490db699d83cb3d03570b63df7448677a3f56Pierre Ossman /* 529912490db699d83cb3d03570b63df7448677a3f56Pierre Ossman * Check that the card supports the command class(es) we need. 530912490db699d83cb3d03570b63df7448677a3f56Pierre Ossman */ 531912490db699d83cb3d03570b63df7448677a3f56Pierre Ossman if (!(card->csd.cmdclass & CCC_BLOCK_READ)) 5321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENODEV; 5331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds md = mmc_blk_alloc(card); 5351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (IS_ERR(md)) 5361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return PTR_ERR(md); 5371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = mmc_blk_set_blksize(md, card); 5391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (err) 5401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out; 5411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 54251828abc17a4ae0f7fb3879e00a30da7bdc7ca20Andrew Morton printk(KERN_INFO "%s: %s %s %lluKiB %s\n", 5431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds md->disk->disk_name, mmc_card_id(card), mmc_card_name(card), 54451828abc17a4ae0f7fb3879e00a30da7bdc7ca20Andrew Morton (unsigned long long)(get_capacity(md->disk) >> 1), 54551828abc17a4ae0f7fb3879e00a30da7bdc7ca20Andrew Morton md->read_only ? "(ro)" : ""); 5461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mmc_set_drvdata(card, md); 5481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds add_disk(md->disk); 5491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 5501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out: 5521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mmc_blk_put(md); 5531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return err; 5551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void mmc_blk_remove(struct mmc_card *card) 5581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 5591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct mmc_blk_data *md = mmc_get_drvdata(card); 5601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (md) { 56289b4e133afea9fce333054b94d89953583a55c19Pierre Ossman /* Stop new requests from getting into the queue */ 5631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds del_gendisk(md->disk); 5641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 56589b4e133afea9fce333054b94d89953583a55c19Pierre Ossman /* Then flush out any already in there */ 56689b4e133afea9fce333054b94d89953583a55c19Pierre Ossman mmc_cleanup_queue(&md->queue); 5671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mmc_blk_put(md); 5691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mmc_set_drvdata(card, NULL); 5711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#ifdef CONFIG_PM 5741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int mmc_blk_suspend(struct mmc_card *card, pm_message_t state) 5751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 5761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct mmc_blk_data *md = mmc_get_drvdata(card); 5771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (md) { 5791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mmc_queue_suspend(&md->queue); 5801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 5821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int mmc_blk_resume(struct mmc_card *card) 5851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 5861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct mmc_blk_data *md = mmc_get_drvdata(card); 5871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (md) { 5891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mmc_blk_set_blksize(md, card); 5901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mmc_queue_resume(&md->queue); 5911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 5931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#else 5951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define mmc_blk_suspend NULL 5961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define mmc_blk_resume NULL 5971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 5981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct mmc_driver mmc_driver = { 6001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .drv = { 6011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .name = "mmcblk", 6021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds }, 6031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .probe = mmc_blk_probe, 6041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .remove = mmc_blk_remove, 6051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .suspend = mmc_blk_suspend, 6061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .resume = mmc_blk_resume, 6071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 6081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int __init mmc_blk_init(void) 6101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 6111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int res = -ENOMEM; 6121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 613fe6b4c8840c5e23fe9b8696450cee8f2e8cebffdPierre Ossman res = register_blkdev(MMC_BLOCK_MAJOR, "mmc"); 614fe6b4c8840c5e23fe9b8696450cee8f2e8cebffdPierre Ossman if (res) 6151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out; 6161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return mmc_register_driver(&mmc_driver); 6181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out: 6201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return res; 6211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void __exit mmc_blk_exit(void) 6241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 6251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mmc_unregister_driver(&mmc_driver); 626fe6b4c8840c5e23fe9b8696450cee8f2e8cebffdPierre Ossman unregister_blkdev(MMC_BLOCK_MAJOR, "mmc"); 6271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmodule_init(mmc_blk_init); 6301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmodule_exit(mmc_blk_exit); 6311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_LICENSE("GPL"); 6331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_DESCRIPTION("Multimedia Card (MMC) block device driver"); 6341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 635