| /* |
| * linux/drivers/mmc/sdio_ops.c |
| * |
| * Copyright 2006-2007 Pierre Ossman |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License as published by |
| * the Free Software Foundation; either version 2 of the License, or (at |
| * your option) any later version. |
| */ |
| |
| #include <linux/mmc/host.h> |
| #include <linux/mmc/card.h> |
| #include <linux/mmc/mmc.h> |
| #include <linux/mmc/sdio.h> |
| |
| #include "core.h" |
| |
| int mmc_send_io_op_cond(struct mmc_host *host, u32 ocr, u32 *rocr) |
| { |
| struct mmc_command cmd; |
| int i, err = 0; |
| |
| BUG_ON(!host); |
| |
| memset(&cmd, 0, sizeof(struct mmc_command)); |
| |
| cmd.opcode = SD_IO_SEND_OP_COND; |
| cmd.arg = ocr; |
| cmd.flags = MMC_RSP_R4 | MMC_CMD_BCR; |
| |
| for (i = 100; i; i--) { |
| err = mmc_wait_for_cmd(host, &cmd, MMC_CMD_RETRIES); |
| if (err) |
| break; |
| |
| if (cmd.resp[0] & MMC_CARD_BUSY || ocr == 0) |
| break; |
| |
| err = -ETIMEDOUT; |
| |
| mmc_delay(10); |
| } |
| |
| if (rocr) |
| *rocr = cmd.resp[0]; |
| |
| return err; |
| } |
| |
| int mmc_io_rw_direct(struct mmc_card *card, int write, unsigned fn, |
| unsigned addr, u8 in, u8* out) |
| { |
| struct mmc_command cmd; |
| int err; |
| |
| BUG_ON(!card); |
| BUG_ON(fn > 7); |
| |
| memset(&cmd, 0, sizeof(struct mmc_command)); |
| |
| cmd.opcode = SD_IO_RW_DIRECT; |
| cmd.arg = write ? 0x80000000 : 0x00000000; |
| cmd.arg |= fn << 28; |
| cmd.arg |= (write && out) ? 0x08000000 : 0x00000000; |
| cmd.arg |= addr << 9; |
| cmd.arg |= in; |
| cmd.flags = MMC_RSP_R5 | MMC_CMD_AC; |
| |
| err = mmc_wait_for_cmd(card->host, &cmd, 0); |
| if (err) |
| return err; |
| |
| if (cmd.resp[0] & R5_ERROR) |
| return -EIO; |
| if (cmd.resp[0] & R5_FUNCTION_NUMBER) |
| return -EINVAL; |
| if (cmd.resp[0] & R5_OUT_OF_RANGE) |
| return -ERANGE; |
| |
| if (out) |
| *out = cmd.resp[0] & 0xFF; |
| |
| return 0; |
| } |
| |