lkml.org 
[lkml]   [2011]   [Jan]   [12]   [last100]   RSS Feed
Views: [wrap][no wrap]   [headers]  [forward] 
 
Messages in this thread
    Patch in this message
    /
    From
    Subject[PATCH 2/5] mmc: Add a block request prepare function
    Date
    Break out code from mmc_blk_issue_rw_rq to create a
    block request prepare function. This doesn't change
    any functionallity.

    Signed-off-by: Per Forlin <per.forlin@linaro.org>
    ---
    drivers/mmc/card/block.c | 173 +++++++++++++++++++++++++---------------------
    1 files changed, 94 insertions(+), 79 deletions(-)

    diff --git a/drivers/mmc/card/block.c b/drivers/mmc/card/block.c
    index be51bde..3f98b15 100644
    --- a/drivers/mmc/card/block.c
    +++ b/drivers/mmc/card/block.c
    @@ -331,97 +331,112 @@ out:
    return err ? 0 : 1;
    }

    -static int mmc_blk_issue_rw_rq(struct mmc_queue *mq, struct request *req)
    +static void mmc_blk_issue_rw_rq_prep(struct mmc_blk_request *brq,
    + struct mmc_queue_req *mqrq,
    + struct request *req,
    + struct mmc_card *card,
    + int disable_multi,
    + struct mmc_queue *mq)
    {
    - struct mmc_blk_data *md = mq->data;
    - struct mmc_card *card = md->queue.card;
    - struct mmc_blk_request brq;
    - int ret = 1, disable_multi = 0;
    + u32 readcmd, writecmd;

    - mmc_claim_host(card->host);

    - do {
    - struct mmc_command cmd;
    - u32 readcmd, writecmd, status = 0;
    -
    - memset(&brq, 0, sizeof(struct mmc_blk_request));
    - brq.mrq.cmd = &brq.cmd;
    - brq.mrq.data = &brq.data;
    -
    - 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;
    - brq.data.blksz = 512;
    - brq.stop.opcode = MMC_STOP_TRANSMISSION;
    - brq.stop.arg = 0;
    - brq.stop.flags = MMC_RSP_SPI_R1B | MMC_RSP_R1B | MMC_CMD_AC;
    - brq.data.blocks = blk_rq_sectors(req);
    + memset(brq, 0, sizeof(struct mmc_blk_request));

    - /*
    - * 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;
    + brq->mrq.cmd = &brq->cmd;
    + brq->mrq.data = &brq->data;

    - /*
    - * After a read error, we redo the request one sector at a time
    - * in order to accurately determine which sectors can be read
    - * successfully.
    - */
    - if (disable_multi && brq.data.blocks > 1)
    - brq.data.blocks = 1;
    -
    - if (brq.data.blocks > 1) {
    - /* SPI multiblock writes terminate using a special
    - * token, not a STOP_TRANSMISSION request.
    - */
    - if (!mmc_host_is_spi(card->host)
    - || rq_data_dir(req) == READ)
    - brq.mrq.stop = &brq.stop;
    - readcmd = MMC_READ_MULTIPLE_BLOCK;
    - writecmd = MMC_WRITE_MULTIPLE_BLOCK;
    - } else {
    - brq.mrq.stop = NULL;
    - readcmd = MMC_READ_SINGLE_BLOCK;
    - writecmd = MMC_WRITE_BLOCK;
    - }
    - if (rq_data_dir(req) == READ) {
    - brq.cmd.opcode = readcmd;
    - brq.data.flags |= MMC_DATA_READ;
    - } else {
    - brq.cmd.opcode = writecmd;
    - brq.data.flags |= MMC_DATA_WRITE;
    - }
    + 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;
    + brq->data.blksz = 512;
    + brq->stop.opcode = MMC_STOP_TRANSMISSION;
    + brq->stop.arg = 0;
    + brq->stop.flags = MMC_RSP_SPI_R1B | MMC_RSP_R1B | MMC_CMD_AC;
    + brq->data.blocks = blk_rq_sectors(req);

    - mmc_set_data_timeout(&brq.data, card);
    + /*
    + * 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;

    - brq.data.sg = mq->mqrq_cur->sg;
    - brq.data.sg_len = mmc_queue_map_sg(mq, mq->mqrq_cur);
    + /*
    + * After a read error, we redo the request one sector at a time
    + * in order to accurately determine which sectors can be read
    + * successfully.
    + */
    + if (disable_multi && brq->data.blocks > 1)
    + brq->data.blocks = 1;

    - /*
    - * Adjust the sg list so it is the same size as the
    - * request.
    +
    + if (brq->data.blocks > 1) {
    + /* SPI multiblock writes terminate using a special
    + * token, not a STOP_TRANSMISSION 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;
    - }
    + 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;
    + }
    + if (rq_data_dir(req) == READ) {
    + brq->cmd.opcode = readcmd;
    + brq->data.flags |= MMC_DATA_READ;
    + } else {
    + brq->cmd.opcode = writecmd;
    + brq->data.flags |= MMC_DATA_WRITE;
    + }
    +
    + 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;
    + brq->data.sg_len = i;
    }
    + }
    +
    + mmc_queue_bounce_pre(mqrq);
    +}

    - mmc_queue_bounce_pre(mq->mqrq_cur);
    +static int mmc_blk_issue_rw_rq(struct mmc_queue *mq, struct request *req)
    +{
    + struct mmc_blk_data *md = mq->data;
    + struct mmc_card *card = md->queue.card;
    + struct mmc_blk_request brq;
    + int ret = 1, disable_multi = 0;
    +
    + mmc_claim_host(card->host);
    +
    + do {
    + struct mmc_command cmd;
    + u32 status = 0;

    + mmc_blk_issue_rw_rq_prep(&brq, mq->mqrq_cur, req, card,
    + disable_multi, mq);
    mmc_wait_for_req(card->host, &brq.mrq);

    mmc_queue_bounce_post(mq->mqrq_cur);
    --
    1.7.1


    \
     
     \ /
      Last update: 2011-01-12 19:19    [W:2.404 / U:0.156 seconds]
    ©2003-2020 Jasper Spaans|hosted at Digital Ocean and TransIP|Read the blog|Advertise on this site