123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710 |
- /*
- * Toshiba PCI Secure Digital Host Controller Interface driver
- *
- * Copyright (C) 2014 Ondrej Zary
- * Copyright (C) 2007 Richard Betts, All Rights Reserved.
- *
- * Based on asic3_mmc.c, copyright (c) 2005 SDG Systems, LLC and,
- * sdhci.c, copyright (C) 2005-2006 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/delay.h>
- #include <linux/device.h>
- #include <linux/module.h>
- #include <linux/pci.h>
- #include <linux/scatterlist.h>
- #include <linux/interrupt.h>
- #include <linux/io.h>
- #include <linux/pm.h>
- #include <linux/pm_runtime.h>
- #include <linux/mmc/host.h>
- #include <linux/mmc/mmc.h>
- #include "toshsd.h"
- #define DRIVER_NAME "toshsd"
- static const struct pci_device_id pci_ids[] = {
- { PCI_DEVICE(PCI_VENDOR_ID_TOSHIBA, 0x0805) },
- { /* end: all zeroes */ },
- };
- MODULE_DEVICE_TABLE(pci, pci_ids);
- static void toshsd_init(struct toshsd_host *host)
- {
- /* enable clock */
- pci_write_config_byte(host->pdev, SD_PCICFG_CLKSTOP,
- SD_PCICFG_CLKSTOP_ENABLE_ALL);
- pci_write_config_byte(host->pdev, SD_PCICFG_CARDDETECT, 2);
- /* reset */
- iowrite16(0, host->ioaddr + SD_SOFTWARERESET); /* assert */
- mdelay(2);
- iowrite16(1, host->ioaddr + SD_SOFTWARERESET); /* deassert */
- mdelay(2);
- /* Clear card registers */
- iowrite16(0, host->ioaddr + SD_CARDCLOCKCTRL);
- iowrite32(0, host->ioaddr + SD_CARDSTATUS);
- iowrite32(0, host->ioaddr + SD_ERRORSTATUS0);
- iowrite16(0, host->ioaddr + SD_STOPINTERNAL);
- /* SDIO clock? */
- iowrite16(0x100, host->ioaddr + SDIO_BASE + SDIO_CLOCKNWAITCTRL);
- /* enable LED */
- pci_write_config_byte(host->pdev, SD_PCICFG_SDLED_ENABLE1,
- SD_PCICFG_LED_ENABLE1_START);
- pci_write_config_byte(host->pdev, SD_PCICFG_SDLED_ENABLE2,
- SD_PCICFG_LED_ENABLE2_START);
- /* set interrupt masks */
- iowrite32(~(u32)(SD_CARD_RESP_END | SD_CARD_RW_END
- | SD_CARD_CARD_REMOVED_0 | SD_CARD_CARD_INSERTED_0
- | SD_BUF_READ_ENABLE | SD_BUF_WRITE_ENABLE
- | SD_BUF_CMD_TIMEOUT),
- host->ioaddr + SD_INTMASKCARD);
- iowrite16(0x1000, host->ioaddr + SD_TRANSACTIONCTRL);
- }
- /* Set MMC clock / power.
- * Note: This controller uses a simple divider scheme therefore it cannot run
- * SD/MMC cards at full speed (24/20MHz). HCLK (=33MHz PCI clock?) is too high
- * and the next slowest is 16MHz (div=2).
- */
- static void __toshsd_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)
- {
- struct toshsd_host *host = mmc_priv(mmc);
- if (ios->clock) {
- u16 clk;
- int div = 1;
- while (ios->clock < HCLK / div)
- div *= 2;
- clk = div >> 2;
- if (div == 1) { /* disable the divider */
- pci_write_config_byte(host->pdev, SD_PCICFG_CLKMODE,
- SD_PCICFG_CLKMODE_DIV_DISABLE);
- clk |= SD_CARDCLK_DIV_DISABLE;
- } else
- pci_write_config_byte(host->pdev, SD_PCICFG_CLKMODE, 0);
- clk |= SD_CARDCLK_ENABLE_CLOCK;
- iowrite16(clk, host->ioaddr + SD_CARDCLOCKCTRL);
- mdelay(10);
- } else
- iowrite16(0, host->ioaddr + SD_CARDCLOCKCTRL);
- switch (ios->power_mode) {
- case MMC_POWER_OFF:
- pci_write_config_byte(host->pdev, SD_PCICFG_POWER1,
- SD_PCICFG_PWR1_OFF);
- mdelay(1);
- break;
- case MMC_POWER_UP:
- break;
- case MMC_POWER_ON:
- pci_write_config_byte(host->pdev, SD_PCICFG_POWER1,
- SD_PCICFG_PWR1_33V);
- pci_write_config_byte(host->pdev, SD_PCICFG_POWER2,
- SD_PCICFG_PWR2_AUTO);
- mdelay(20);
- break;
- }
- switch (ios->bus_width) {
- case MMC_BUS_WIDTH_1:
- iowrite16(SD_CARDOPT_REQUIRED | SD_CARDOPT_DATA_RESP_TIMEOUT(14)
- | SD_CARDOPT_C2_MODULE_ABSENT
- | SD_CARDOPT_DATA_XFR_WIDTH_1,
- host->ioaddr + SD_CARDOPTIONSETUP);
- break;
- case MMC_BUS_WIDTH_4:
- iowrite16(SD_CARDOPT_REQUIRED | SD_CARDOPT_DATA_RESP_TIMEOUT(14)
- | SD_CARDOPT_C2_MODULE_ABSENT
- | SD_CARDOPT_DATA_XFR_WIDTH_4,
- host->ioaddr + SD_CARDOPTIONSETUP);
- break;
- }
- }
- static void toshsd_set_led(struct toshsd_host *host, unsigned char state)
- {
- iowrite16(state, host->ioaddr + SDIO_BASE + SDIO_LEDCTRL);
- }
- static void toshsd_finish_request(struct toshsd_host *host)
- {
- struct mmc_request *mrq = host->mrq;
- /* Write something to end the command */
- host->mrq = NULL;
- host->cmd = NULL;
- host->data = NULL;
- toshsd_set_led(host, 0);
- mmc_request_done(host->mmc, mrq);
- }
- static irqreturn_t toshsd_thread_irq(int irq, void *dev_id)
- {
- struct toshsd_host *host = dev_id;
- struct mmc_data *data = host->data;
- struct sg_mapping_iter *sg_miter = &host->sg_miter;
- unsigned short *buf;
- int count;
- unsigned long flags;
- if (!data) {
- dev_warn(&host->pdev->dev, "Spurious Data IRQ\n");
- if (host->cmd) {
- host->cmd->error = -EIO;
- toshsd_finish_request(host);
- }
- return IRQ_NONE;
- }
- spin_lock_irqsave(&host->lock, flags);
- if (!sg_miter_next(sg_miter))
- goto done;
- buf = sg_miter->addr;
- /* Ensure we dont read more than one block. The chip will interrupt us
- * When the next block is available.
- */
- count = sg_miter->length;
- if (count > data->blksz)
- count = data->blksz;
- dev_dbg(&host->pdev->dev, "count: %08x, flags %08x\n", count,
- data->flags);
- /* Transfer the data */
- if (data->flags & MMC_DATA_READ)
- ioread32_rep(host->ioaddr + SD_DATAPORT, buf, count >> 2);
- else
- iowrite32_rep(host->ioaddr + SD_DATAPORT, buf, count >> 2);
- sg_miter->consumed = count;
- sg_miter_stop(sg_miter);
- done:
- spin_unlock_irqrestore(&host->lock, flags);
- return IRQ_HANDLED;
- }
- static void toshsd_cmd_irq(struct toshsd_host *host)
- {
- struct mmc_command *cmd = host->cmd;
- u8 *buf;
- u16 data;
- if (!host->cmd) {
- dev_warn(&host->pdev->dev, "Spurious CMD irq\n");
- return;
- }
- buf = (u8 *)cmd->resp;
- host->cmd = NULL;
- if (cmd->flags & MMC_RSP_PRESENT && cmd->flags & MMC_RSP_136) {
- /* R2 */
- buf[12] = 0xff;
- data = ioread16(host->ioaddr + SD_RESPONSE0);
- buf[13] = data & 0xff;
- buf[14] = data >> 8;
- data = ioread16(host->ioaddr + SD_RESPONSE1);
- buf[15] = data & 0xff;
- buf[8] = data >> 8;
- data = ioread16(host->ioaddr + SD_RESPONSE2);
- buf[9] = data & 0xff;
- buf[10] = data >> 8;
- data = ioread16(host->ioaddr + SD_RESPONSE3);
- buf[11] = data & 0xff;
- buf[4] = data >> 8;
- data = ioread16(host->ioaddr + SD_RESPONSE4);
- buf[5] = data & 0xff;
- buf[6] = data >> 8;
- data = ioread16(host->ioaddr + SD_RESPONSE5);
- buf[7] = data & 0xff;
- buf[0] = data >> 8;
- data = ioread16(host->ioaddr + SD_RESPONSE6);
- buf[1] = data & 0xff;
- buf[2] = data >> 8;
- data = ioread16(host->ioaddr + SD_RESPONSE7);
- buf[3] = data & 0xff;
- } else if (cmd->flags & MMC_RSP_PRESENT) {
- /* R1, R1B, R3, R6, R7 */
- data = ioread16(host->ioaddr + SD_RESPONSE0);
- buf[0] = data & 0xff;
- buf[1] = data >> 8;
- data = ioread16(host->ioaddr + SD_RESPONSE1);
- buf[2] = data & 0xff;
- buf[3] = data >> 8;
- }
- dev_dbg(&host->pdev->dev, "Command IRQ complete %d %d %x\n",
- cmd->opcode, cmd->error, cmd->flags);
- /* If there is data to handle we will
- * finish the request in the mmc_data_end_irq handler.*/
- if (host->data)
- return;
- toshsd_finish_request(host);
- }
- static void toshsd_data_end_irq(struct toshsd_host *host)
- {
- struct mmc_data *data = host->data;
- host->data = NULL;
- if (!data) {
- dev_warn(&host->pdev->dev, "Spurious data end IRQ\n");
- return;
- }
- if (data->error == 0)
- data->bytes_xfered = data->blocks * data->blksz;
- else
- data->bytes_xfered = 0;
- dev_dbg(&host->pdev->dev, "Completed data request xfr=%d\n",
- data->bytes_xfered);
- iowrite16(0, host->ioaddr + SD_STOPINTERNAL);
- toshsd_finish_request(host);
- }
- static irqreturn_t toshsd_irq(int irq, void *dev_id)
- {
- struct toshsd_host *host = dev_id;
- u32 int_reg, int_mask, int_status, detail;
- int error = 0, ret = IRQ_HANDLED;
- spin_lock(&host->lock);
- int_status = ioread32(host->ioaddr + SD_CARDSTATUS);
- int_mask = ioread32(host->ioaddr + SD_INTMASKCARD);
- int_reg = int_status & ~int_mask & ~IRQ_DONT_CARE_BITS;
- dev_dbg(&host->pdev->dev, "IRQ status:%x mask:%x\n",
- int_status, int_mask);
- /* nothing to do: it's not our IRQ */
- if (!int_reg) {
- ret = IRQ_NONE;
- goto irq_end;
- }
- if (int_reg & SD_BUF_CMD_TIMEOUT) {
- error = -ETIMEDOUT;
- dev_dbg(&host->pdev->dev, "Timeout\n");
- } else if (int_reg & SD_BUF_CRC_ERR) {
- error = -EILSEQ;
- dev_err(&host->pdev->dev, "BadCRC\n");
- } else if (int_reg & (SD_BUF_ILLEGAL_ACCESS
- | SD_BUF_CMD_INDEX_ERR
- | SD_BUF_STOP_BIT_END_ERR
- | SD_BUF_OVERFLOW
- | SD_BUF_UNDERFLOW
- | SD_BUF_DATA_TIMEOUT)) {
- dev_err(&host->pdev->dev, "Buffer status error: { %s%s%s%s%s%s}\n",
- int_reg & SD_BUF_ILLEGAL_ACCESS ? "ILLEGAL_ACC " : "",
- int_reg & SD_BUF_CMD_INDEX_ERR ? "CMD_INDEX " : "",
- int_reg & SD_BUF_STOP_BIT_END_ERR ? "STOPBIT_END " : "",
- int_reg & SD_BUF_OVERFLOW ? "OVERFLOW " : "",
- int_reg & SD_BUF_UNDERFLOW ? "UNDERFLOW " : "",
- int_reg & SD_BUF_DATA_TIMEOUT ? "DATA_TIMEOUT " : "");
- detail = ioread32(host->ioaddr + SD_ERRORSTATUS0);
- dev_err(&host->pdev->dev, "detail error status { %s%s%s%s%s%s%s%s%s%s%s%s%s}\n",
- detail & SD_ERR0_RESP_CMD_ERR ? "RESP_CMD " : "",
- detail & SD_ERR0_RESP_NON_CMD12_END_BIT_ERR ? "RESP_END_BIT " : "",
- detail & SD_ERR0_RESP_CMD12_END_BIT_ERR ? "RESP_END_BIT " : "",
- detail & SD_ERR0_READ_DATA_END_BIT_ERR ? "READ_DATA_END_BIT " : "",
- detail & SD_ERR0_WRITE_CRC_STATUS_END_BIT_ERR ? "WRITE_CMD_END_BIT " : "",
- detail & SD_ERR0_RESP_NON_CMD12_CRC_ERR ? "RESP_CRC " : "",
- detail & SD_ERR0_RESP_CMD12_CRC_ERR ? "RESP_CRC " : "",
- detail & SD_ERR0_READ_DATA_CRC_ERR ? "READ_DATA_CRC " : "",
- detail & SD_ERR0_WRITE_CMD_CRC_ERR ? "WRITE_CMD_CRC " : "",
- detail & SD_ERR1_NO_CMD_RESP ? "NO_CMD_RESP " : "",
- detail & SD_ERR1_TIMEOUT_READ_DATA ? "READ_DATA_TIMEOUT " : "",
- detail & SD_ERR1_TIMEOUT_CRS_STATUS ? "CRS_STATUS_TIMEOUT " : "",
- detail & SD_ERR1_TIMEOUT_CRC_BUSY ? "CRC_BUSY_TIMEOUT " : "");
- error = -EIO;
- }
- if (error) {
- if (host->cmd)
- host->cmd->error = error;
- if (error == -ETIMEDOUT) {
- iowrite32(int_status &
- ~(SD_BUF_CMD_TIMEOUT | SD_CARD_RESP_END),
- host->ioaddr + SD_CARDSTATUS);
- } else {
- toshsd_init(host);
- __toshsd_set_ios(host->mmc, &host->mmc->ios);
- goto irq_end;
- }
- }
- /* Card insert/remove. The mmc controlling code is stateless. */
- if (int_reg & (SD_CARD_CARD_INSERTED_0 | SD_CARD_CARD_REMOVED_0)) {
- iowrite32(int_status &
- ~(SD_CARD_CARD_REMOVED_0 | SD_CARD_CARD_INSERTED_0),
- host->ioaddr + SD_CARDSTATUS);
- if (int_reg & SD_CARD_CARD_INSERTED_0)
- toshsd_init(host);
- mmc_detect_change(host->mmc, 1);
- }
- /* Data transfer */
- if (int_reg & (SD_BUF_READ_ENABLE | SD_BUF_WRITE_ENABLE)) {
- iowrite32(int_status &
- ~(SD_BUF_WRITE_ENABLE | SD_BUF_READ_ENABLE),
- host->ioaddr + SD_CARDSTATUS);
- ret = IRQ_WAKE_THREAD;
- goto irq_end;
- }
- /* Command completion */
- if (int_reg & SD_CARD_RESP_END) {
- iowrite32(int_status & ~(SD_CARD_RESP_END),
- host->ioaddr + SD_CARDSTATUS);
- toshsd_cmd_irq(host);
- }
- /* Data transfer completion */
- if (int_reg & SD_CARD_RW_END) {
- iowrite32(int_status & ~(SD_CARD_RW_END),
- host->ioaddr + SD_CARDSTATUS);
- toshsd_data_end_irq(host);
- }
- irq_end:
- spin_unlock(&host->lock);
- return ret;
- }
- static void toshsd_start_cmd(struct toshsd_host *host, struct mmc_command *cmd)
- {
- struct mmc_data *data = host->data;
- int c = cmd->opcode;
- dev_dbg(&host->pdev->dev, "Command opcode: %d\n", cmd->opcode);
- if (cmd->opcode == MMC_STOP_TRANSMISSION) {
- iowrite16(SD_STOPINT_ISSUE_CMD12,
- host->ioaddr + SD_STOPINTERNAL);
- cmd->resp[0] = cmd->opcode;
- cmd->resp[1] = 0;
- cmd->resp[2] = 0;
- cmd->resp[3] = 0;
- toshsd_finish_request(host);
- return;
- }
- switch (mmc_resp_type(cmd)) {
- case MMC_RSP_NONE:
- c |= SD_CMD_RESP_TYPE_NONE;
- break;
- case MMC_RSP_R1:
- c |= SD_CMD_RESP_TYPE_EXT_R1;
- break;
- case MMC_RSP_R1B:
- c |= SD_CMD_RESP_TYPE_EXT_R1B;
- break;
- case MMC_RSP_R2:
- c |= SD_CMD_RESP_TYPE_EXT_R2;
- break;
- case MMC_RSP_R3:
- c |= SD_CMD_RESP_TYPE_EXT_R3;
- break;
- default:
- dev_err(&host->pdev->dev, "Unknown response type %d\n",
- mmc_resp_type(cmd));
- break;
- }
- host->cmd = cmd;
- if (cmd->opcode == MMC_APP_CMD)
- c |= SD_CMD_TYPE_ACMD;
- if (cmd->opcode == MMC_GO_IDLE_STATE)
- c |= (3 << 8); /* removed from ipaq-asic3.h for some reason */
- if (data) {
- c |= SD_CMD_DATA_PRESENT;
- if (data->blocks > 1) {
- iowrite16(SD_STOPINT_AUTO_ISSUE_CMD12,
- host->ioaddr + SD_STOPINTERNAL);
- c |= SD_CMD_MULTI_BLOCK;
- }
- if (data->flags & MMC_DATA_READ)
- c |= SD_CMD_TRANSFER_READ;
- /* MMC_DATA_WRITE does not require a bit to be set */
- }
- /* Send the command */
- iowrite32(cmd->arg, host->ioaddr + SD_ARG0);
- iowrite16(c, host->ioaddr + SD_CMD);
- }
- static void toshsd_start_data(struct toshsd_host *host, struct mmc_data *data)
- {
- unsigned int flags = SG_MITER_ATOMIC;
- dev_dbg(&host->pdev->dev, "setup data transfer: blocksize %08x nr_blocks %d, offset: %08x\n",
- data->blksz, data->blocks, data->sg->offset);
- host->data = data;
- if (data->flags & MMC_DATA_READ)
- flags |= SG_MITER_TO_SG;
- else
- flags |= SG_MITER_FROM_SG;
- sg_miter_start(&host->sg_miter, data->sg, data->sg_len, flags);
- /* Set transfer length and blocksize */
- iowrite16(data->blocks, host->ioaddr + SD_BLOCKCOUNT);
- iowrite16(data->blksz, host->ioaddr + SD_CARDXFERDATALEN);
- }
- /* Process requests from the MMC layer */
- static void toshsd_request(struct mmc_host *mmc, struct mmc_request *mrq)
- {
- struct toshsd_host *host = mmc_priv(mmc);
- unsigned long flags;
- /* abort if card not present */
- if (!(ioread16(host->ioaddr + SD_CARDSTATUS) & SD_CARD_PRESENT_0)) {
- mrq->cmd->error = -ENOMEDIUM;
- mmc_request_done(mmc, mrq);
- return;
- }
- spin_lock_irqsave(&host->lock, flags);
- WARN_ON(host->mrq != NULL);
- host->mrq = mrq;
- if (mrq->data)
- toshsd_start_data(host, mrq->data);
- toshsd_set_led(host, 1);
- toshsd_start_cmd(host, mrq->cmd);
- spin_unlock_irqrestore(&host->lock, flags);
- }
- static void toshsd_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)
- {
- struct toshsd_host *host = mmc_priv(mmc);
- unsigned long flags;
- spin_lock_irqsave(&host->lock, flags);
- __toshsd_set_ios(mmc, ios);
- spin_unlock_irqrestore(&host->lock, flags);
- }
- static int toshsd_get_ro(struct mmc_host *mmc)
- {
- struct toshsd_host *host = mmc_priv(mmc);
- /* active low */
- return !(ioread16(host->ioaddr + SD_CARDSTATUS) & SD_CARD_WRITE_PROTECT);
- }
- static int toshsd_get_cd(struct mmc_host *mmc)
- {
- struct toshsd_host *host = mmc_priv(mmc);
- return !!(ioread16(host->ioaddr + SD_CARDSTATUS) & SD_CARD_PRESENT_0);
- }
- static struct mmc_host_ops toshsd_ops = {
- .request = toshsd_request,
- .set_ios = toshsd_set_ios,
- .get_ro = toshsd_get_ro,
- .get_cd = toshsd_get_cd,
- };
- static void toshsd_powerdown(struct toshsd_host *host)
- {
- /* mask all interrupts */
- iowrite32(0xffffffff, host->ioaddr + SD_INTMASKCARD);
- /* disable card clock */
- iowrite16(0x000, host->ioaddr + SDIO_BASE + SDIO_CLOCKNWAITCTRL);
- iowrite16(0, host->ioaddr + SD_CARDCLOCKCTRL);
- /* power down card */
- pci_write_config_byte(host->pdev, SD_PCICFG_POWER1, SD_PCICFG_PWR1_OFF);
- /* disable clock */
- pci_write_config_byte(host->pdev, SD_PCICFG_CLKSTOP, 0);
- }
- #ifdef CONFIG_PM_SLEEP
- static int toshsd_pm_suspend(struct device *dev)
- {
- struct pci_dev *pdev = to_pci_dev(dev);
- struct toshsd_host *host = pci_get_drvdata(pdev);
- toshsd_powerdown(host);
- pci_save_state(pdev);
- pci_enable_wake(pdev, PCI_D3hot, 0);
- pci_disable_device(pdev);
- pci_set_power_state(pdev, PCI_D3hot);
- return 0;
- }
- static int toshsd_pm_resume(struct device *dev)
- {
- struct pci_dev *pdev = to_pci_dev(dev);
- struct toshsd_host *host = pci_get_drvdata(pdev);
- int ret;
- pci_set_power_state(pdev, PCI_D0);
- pci_restore_state(pdev);
- ret = pci_enable_device(pdev);
- if (ret)
- return ret;
- toshsd_init(host);
- return 0;
- }
- #endif /* CONFIG_PM_SLEEP */
- static int toshsd_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
- {
- int ret;
- struct toshsd_host *host;
- struct mmc_host *mmc;
- resource_size_t base;
- ret = pci_enable_device(pdev);
- if (ret)
- return ret;
- mmc = mmc_alloc_host(sizeof(struct toshsd_host), &pdev->dev);
- if (!mmc) {
- ret = -ENOMEM;
- goto err;
- }
- host = mmc_priv(mmc);
- host->mmc = mmc;
- host->pdev = pdev;
- pci_set_drvdata(pdev, host);
- ret = pci_request_regions(pdev, DRIVER_NAME);
- if (ret)
- goto free;
- host->ioaddr = pci_iomap(pdev, 0, 0);
- if (!host->ioaddr) {
- ret = -ENOMEM;
- goto release;
- }
- /* Set MMC host parameters */
- mmc->ops = &toshsd_ops;
- mmc->caps = MMC_CAP_4_BIT_DATA;
- mmc->ocr_avail = MMC_VDD_32_33;
- mmc->f_min = HCLK / 512;
- mmc->f_max = HCLK;
- spin_lock_init(&host->lock);
- toshsd_init(host);
- ret = request_threaded_irq(pdev->irq, toshsd_irq, toshsd_thread_irq,
- IRQF_SHARED, DRIVER_NAME, host);
- if (ret)
- goto unmap;
- mmc_add_host(mmc);
- base = pci_resource_start(pdev, 0);
- dev_dbg(&pdev->dev, "MMIO %pa, IRQ %d\n", &base, pdev->irq);
- pm_suspend_ignore_children(&pdev->dev, 1);
- return 0;
- unmap:
- pci_iounmap(pdev, host->ioaddr);
- release:
- pci_release_regions(pdev);
- free:
- mmc_free_host(mmc);
- pci_set_drvdata(pdev, NULL);
- err:
- pci_disable_device(pdev);
- return ret;
- }
- static void toshsd_remove(struct pci_dev *pdev)
- {
- struct toshsd_host *host = pci_get_drvdata(pdev);
- mmc_remove_host(host->mmc);
- toshsd_powerdown(host);
- free_irq(pdev->irq, host);
- pci_iounmap(pdev, host->ioaddr);
- pci_release_regions(pdev);
- mmc_free_host(host->mmc);
- pci_set_drvdata(pdev, NULL);
- pci_disable_device(pdev);
- }
- static const struct dev_pm_ops toshsd_pm_ops = {
- SET_SYSTEM_SLEEP_PM_OPS(toshsd_pm_suspend, toshsd_pm_resume)
- };
- static struct pci_driver toshsd_driver = {
- .name = DRIVER_NAME,
- .id_table = pci_ids,
- .probe = toshsd_probe,
- .remove = toshsd_remove,
- .driver.pm = &toshsd_pm_ops,
- };
- module_pci_driver(toshsd_driver);
- MODULE_AUTHOR("Ondrej Zary, Richard Betts");
- MODULE_DESCRIPTION("Toshiba PCI Secure Digital Host Controller Interface driver");
- MODULE_LICENSE("GPL");
|