/* * 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 #include #include #include #include #include #include #include #include #include #include #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: %08lx\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");