toshsd.c 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717
  1. /*
  2. * Toshiba PCI Secure Digital Host Controller Interface driver
  3. *
  4. * Copyright (C) 2014 Ondrej Zary
  5. * Copyright (C) 2007 Richard Betts, All Rights Reserved.
  6. *
  7. * Based on asic3_mmc.c, copyright (c) 2005 SDG Systems, LLC and,
  8. * sdhci.c, copyright (C) 2005-2006 Pierre Ossman
  9. *
  10. * This program is free software; you can redistribute it and/or modify
  11. * it under the terms of the GNU General Public License as published by
  12. * the Free Software Foundation; either version 2 of the License, or (at
  13. * your option) any later version.
  14. */
  15. #include <linux/delay.h>
  16. #include <linux/device.h>
  17. #include <linux/module.h>
  18. #include <linux/pci.h>
  19. #include <linux/scatterlist.h>
  20. #include <linux/interrupt.h>
  21. #include <linux/io.h>
  22. #include <linux/pm.h>
  23. #include <linux/mmc/host.h>
  24. #include <linux/mmc/mmc.h>
  25. #include "toshsd.h"
  26. #define DRIVER_NAME "toshsd"
  27. static const struct pci_device_id pci_ids[] = {
  28. { PCI_DEVICE(PCI_VENDOR_ID_TOSHIBA, 0x0805) },
  29. { /* end: all zeroes */ },
  30. };
  31. MODULE_DEVICE_TABLE(pci, pci_ids);
  32. static void toshsd_init(struct toshsd_host *host)
  33. {
  34. /* enable clock */
  35. pci_write_config_byte(host->pdev, SD_PCICFG_CLKSTOP,
  36. SD_PCICFG_CLKSTOP_ENABLE_ALL);
  37. pci_write_config_byte(host->pdev, SD_PCICFG_CARDDETECT, 2);
  38. /* reset */
  39. iowrite16(0, host->ioaddr + SD_SOFTWARERESET); /* assert */
  40. mdelay(2);
  41. iowrite16(1, host->ioaddr + SD_SOFTWARERESET); /* deassert */
  42. mdelay(2);
  43. /* Clear card registers */
  44. iowrite16(0, host->ioaddr + SD_CARDCLOCKCTRL);
  45. iowrite32(0, host->ioaddr + SD_CARDSTATUS);
  46. iowrite32(0, host->ioaddr + SD_ERRORSTATUS0);
  47. iowrite16(0, host->ioaddr + SD_STOPINTERNAL);
  48. /* SDIO clock? */
  49. iowrite16(0x100, host->ioaddr + SDIO_BASE + SDIO_CLOCKNWAITCTRL);
  50. /* enable LED */
  51. pci_write_config_byte(host->pdev, SD_PCICFG_SDLED_ENABLE1,
  52. SD_PCICFG_LED_ENABLE1_START);
  53. pci_write_config_byte(host->pdev, SD_PCICFG_SDLED_ENABLE2,
  54. SD_PCICFG_LED_ENABLE2_START);
  55. /* set interrupt masks */
  56. iowrite32(~(u32)(SD_CARD_RESP_END | SD_CARD_RW_END
  57. | SD_CARD_CARD_REMOVED_0 | SD_CARD_CARD_INSERTED_0
  58. | SD_BUF_READ_ENABLE | SD_BUF_WRITE_ENABLE
  59. | SD_BUF_CMD_TIMEOUT),
  60. host->ioaddr + SD_INTMASKCARD);
  61. iowrite16(0x1000, host->ioaddr + SD_TRANSACTIONCTRL);
  62. }
  63. /* Set MMC clock / power.
  64. * Note: This controller uses a simple divider scheme therefore it cannot run
  65. * SD/MMC cards at full speed (24/20MHz). HCLK (=33MHz PCI clock?) is too high
  66. * and the next slowest is 16MHz (div=2).
  67. */
  68. static void __toshsd_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)
  69. {
  70. struct toshsd_host *host = mmc_priv(mmc);
  71. if (ios->clock) {
  72. u16 clk;
  73. int div = 1;
  74. while (ios->clock < HCLK / div)
  75. div *= 2;
  76. clk = div >> 2;
  77. if (div == 1) { /* disable the divider */
  78. pci_write_config_byte(host->pdev, SD_PCICFG_CLKMODE,
  79. SD_PCICFG_CLKMODE_DIV_DISABLE);
  80. clk |= SD_CARDCLK_DIV_DISABLE;
  81. } else
  82. pci_write_config_byte(host->pdev, SD_PCICFG_CLKMODE, 0);
  83. clk |= SD_CARDCLK_ENABLE_CLOCK;
  84. iowrite16(clk, host->ioaddr + SD_CARDCLOCKCTRL);
  85. mdelay(10);
  86. } else
  87. iowrite16(0, host->ioaddr + SD_CARDCLOCKCTRL);
  88. switch (ios->power_mode) {
  89. case MMC_POWER_OFF:
  90. pci_write_config_byte(host->pdev, SD_PCICFG_POWER1,
  91. SD_PCICFG_PWR1_OFF);
  92. mdelay(1);
  93. break;
  94. case MMC_POWER_UP:
  95. break;
  96. case MMC_POWER_ON:
  97. pci_write_config_byte(host->pdev, SD_PCICFG_POWER1,
  98. SD_PCICFG_PWR1_33V);
  99. pci_write_config_byte(host->pdev, SD_PCICFG_POWER2,
  100. SD_PCICFG_PWR2_AUTO);
  101. mdelay(20);
  102. break;
  103. }
  104. switch (ios->bus_width) {
  105. case MMC_BUS_WIDTH_1:
  106. iowrite16(SD_CARDOPT_REQUIRED | SD_CARDOPT_DATA_RESP_TIMEOUT(14)
  107. | SD_CARDOPT_C2_MODULE_ABSENT
  108. | SD_CARDOPT_DATA_XFR_WIDTH_1,
  109. host->ioaddr + SD_CARDOPTIONSETUP);
  110. break;
  111. case MMC_BUS_WIDTH_4:
  112. iowrite16(SD_CARDOPT_REQUIRED | SD_CARDOPT_DATA_RESP_TIMEOUT(14)
  113. | SD_CARDOPT_C2_MODULE_ABSENT
  114. | SD_CARDOPT_DATA_XFR_WIDTH_4,
  115. host->ioaddr + SD_CARDOPTIONSETUP);
  116. break;
  117. }
  118. }
  119. static void toshsd_set_led(struct toshsd_host *host, unsigned char state)
  120. {
  121. iowrite16(state, host->ioaddr + SDIO_BASE + SDIO_LEDCTRL);
  122. }
  123. static void toshsd_finish_request(struct toshsd_host *host)
  124. {
  125. struct mmc_request *mrq = host->mrq;
  126. /* Write something to end the command */
  127. host->mrq = NULL;
  128. host->cmd = NULL;
  129. host->data = NULL;
  130. toshsd_set_led(host, 0);
  131. mmc_request_done(host->mmc, mrq);
  132. }
  133. static irqreturn_t toshsd_thread_irq(int irq, void *dev_id)
  134. {
  135. struct toshsd_host *host = dev_id;
  136. struct mmc_data *data = host->data;
  137. struct sg_mapping_iter *sg_miter = &host->sg_miter;
  138. unsigned short *buf;
  139. int count;
  140. unsigned long flags;
  141. if (!data) {
  142. dev_warn(&host->pdev->dev, "Spurious Data IRQ\n");
  143. if (host->cmd) {
  144. host->cmd->error = -EIO;
  145. toshsd_finish_request(host);
  146. }
  147. return IRQ_NONE;
  148. }
  149. spin_lock_irqsave(&host->lock, flags);
  150. if (!sg_miter_next(sg_miter))
  151. return IRQ_HANDLED;
  152. buf = sg_miter->addr;
  153. /* Ensure we dont read more than one block. The chip will interrupt us
  154. * When the next block is available.
  155. */
  156. count = sg_miter->length;
  157. if (count > data->blksz)
  158. count = data->blksz;
  159. dev_dbg(&host->pdev->dev, "count: %08x, flags %08x\n", count,
  160. data->flags);
  161. /* Transfer the data */
  162. if (data->flags & MMC_DATA_READ)
  163. ioread32_rep(host->ioaddr + SD_DATAPORT, buf, count >> 2);
  164. else
  165. iowrite32_rep(host->ioaddr + SD_DATAPORT, buf, count >> 2);
  166. sg_miter->consumed = count;
  167. sg_miter_stop(sg_miter);
  168. spin_unlock_irqrestore(&host->lock, flags);
  169. return IRQ_HANDLED;
  170. }
  171. static void toshsd_cmd_irq(struct toshsd_host *host)
  172. {
  173. struct mmc_command *cmd = host->cmd;
  174. u8 *buf;
  175. u16 data;
  176. if (!host->cmd) {
  177. dev_warn(&host->pdev->dev, "Spurious CMD irq\n");
  178. return;
  179. }
  180. buf = (u8 *)cmd->resp;
  181. host->cmd = NULL;
  182. if (cmd->flags & MMC_RSP_PRESENT && cmd->flags & MMC_RSP_136) {
  183. /* R2 */
  184. buf[12] = 0xff;
  185. data = ioread16(host->ioaddr + SD_RESPONSE0);
  186. buf[13] = data & 0xff;
  187. buf[14] = data >> 8;
  188. data = ioread16(host->ioaddr + SD_RESPONSE1);
  189. buf[15] = data & 0xff;
  190. buf[8] = data >> 8;
  191. data = ioread16(host->ioaddr + SD_RESPONSE2);
  192. buf[9] = data & 0xff;
  193. buf[10] = data >> 8;
  194. data = ioread16(host->ioaddr + SD_RESPONSE3);
  195. buf[11] = data & 0xff;
  196. buf[4] = data >> 8;
  197. data = ioread16(host->ioaddr + SD_RESPONSE4);
  198. buf[5] = data & 0xff;
  199. buf[6] = data >> 8;
  200. data = ioread16(host->ioaddr + SD_RESPONSE5);
  201. buf[7] = data & 0xff;
  202. buf[0] = data >> 8;
  203. data = ioread16(host->ioaddr + SD_RESPONSE6);
  204. buf[1] = data & 0xff;
  205. buf[2] = data >> 8;
  206. data = ioread16(host->ioaddr + SD_RESPONSE7);
  207. buf[3] = data & 0xff;
  208. } else if (cmd->flags & MMC_RSP_PRESENT) {
  209. /* R1, R1B, R3, R6, R7 */
  210. data = ioread16(host->ioaddr + SD_RESPONSE0);
  211. buf[0] = data & 0xff;
  212. buf[1] = data >> 8;
  213. data = ioread16(host->ioaddr + SD_RESPONSE1);
  214. buf[2] = data & 0xff;
  215. buf[3] = data >> 8;
  216. }
  217. dev_dbg(&host->pdev->dev, "Command IRQ complete %d %d %x\n",
  218. cmd->opcode, cmd->error, cmd->flags);
  219. /* If there is data to handle we will
  220. * finish the request in the mmc_data_end_irq handler.*/
  221. if (host->data)
  222. return;
  223. toshsd_finish_request(host);
  224. }
  225. static void toshsd_data_end_irq(struct toshsd_host *host)
  226. {
  227. struct mmc_data *data = host->data;
  228. host->data = NULL;
  229. if (!data) {
  230. dev_warn(&host->pdev->dev, "Spurious data end IRQ\n");
  231. return;
  232. }
  233. if (data->error == 0)
  234. data->bytes_xfered = data->blocks * data->blksz;
  235. else
  236. data->bytes_xfered = 0;
  237. dev_dbg(&host->pdev->dev, "Completed data request xfr=%d\n",
  238. data->bytes_xfered);
  239. iowrite16(0, host->ioaddr + SD_STOPINTERNAL);
  240. toshsd_finish_request(host);
  241. }
  242. static irqreturn_t toshsd_irq(int irq, void *dev_id)
  243. {
  244. struct toshsd_host *host = dev_id;
  245. u32 int_reg, int_mask, int_status, detail;
  246. int error = 0, ret = IRQ_HANDLED;
  247. spin_lock(&host->lock);
  248. int_status = ioread32(host->ioaddr + SD_CARDSTATUS);
  249. int_mask = ioread32(host->ioaddr + SD_INTMASKCARD);
  250. int_reg = int_status & ~int_mask & ~IRQ_DONT_CARE_BITS;
  251. dev_dbg(&host->pdev->dev, "IRQ status:%x mask:%x\n",
  252. int_status, int_mask);
  253. /* nothing to do: it's not our IRQ */
  254. if (!int_reg) {
  255. ret = IRQ_NONE;
  256. goto irq_end;
  257. }
  258. if (int_reg & SD_BUF_CMD_TIMEOUT) {
  259. error = -ETIMEDOUT;
  260. dev_dbg(&host->pdev->dev, "Timeout\n");
  261. } else if (int_reg & SD_BUF_CRC_ERR) {
  262. error = -EILSEQ;
  263. dev_err(&host->pdev->dev, "BadCRC\n");
  264. } else if (int_reg & (SD_BUF_ILLEGAL_ACCESS
  265. | SD_BUF_CMD_INDEX_ERR
  266. | SD_BUF_STOP_BIT_END_ERR
  267. | SD_BUF_OVERFLOW
  268. | SD_BUF_UNDERFLOW
  269. | SD_BUF_DATA_TIMEOUT)) {
  270. dev_err(&host->pdev->dev, "Buffer status error: { %s%s%s%s%s%s}\n",
  271. int_reg & SD_BUF_ILLEGAL_ACCESS ? "ILLEGAL_ACC " : "",
  272. int_reg & SD_BUF_CMD_INDEX_ERR ? "CMD_INDEX " : "",
  273. int_reg & SD_BUF_STOP_BIT_END_ERR ? "STOPBIT_END " : "",
  274. int_reg & SD_BUF_OVERFLOW ? "OVERFLOW " : "",
  275. int_reg & SD_BUF_UNDERFLOW ? "UNDERFLOW " : "",
  276. int_reg & SD_BUF_DATA_TIMEOUT ? "DATA_TIMEOUT " : "");
  277. detail = ioread32(host->ioaddr + SD_ERRORSTATUS0);
  278. dev_err(&host->pdev->dev, "detail error status { %s%s%s%s%s%s%s%s%s%s%s%s%s}\n",
  279. detail & SD_ERR0_RESP_CMD_ERR ? "RESP_CMD " : "",
  280. detail & SD_ERR0_RESP_NON_CMD12_END_BIT_ERR ? "RESP_END_BIT " : "",
  281. detail & SD_ERR0_RESP_CMD12_END_BIT_ERR ? "RESP_END_BIT " : "",
  282. detail & SD_ERR0_READ_DATA_END_BIT_ERR ? "READ_DATA_END_BIT " : "",
  283. detail & SD_ERR0_WRITE_CRC_STATUS_END_BIT_ERR ? "WRITE_CMD_END_BIT " : "",
  284. detail & SD_ERR0_RESP_NON_CMD12_CRC_ERR ? "RESP_CRC " : "",
  285. detail & SD_ERR0_RESP_CMD12_CRC_ERR ? "RESP_CRC " : "",
  286. detail & SD_ERR0_READ_DATA_CRC_ERR ? "READ_DATA_CRC " : "",
  287. detail & SD_ERR0_WRITE_CMD_CRC_ERR ? "WRITE_CMD_CRC " : "",
  288. detail & SD_ERR1_NO_CMD_RESP ? "NO_CMD_RESP " : "",
  289. detail & SD_ERR1_TIMEOUT_READ_DATA ? "READ_DATA_TIMEOUT " : "",
  290. detail & SD_ERR1_TIMEOUT_CRS_STATUS ? "CRS_STATUS_TIMEOUT " : "",
  291. detail & SD_ERR1_TIMEOUT_CRC_BUSY ? "CRC_BUSY_TIMEOUT " : "");
  292. error = -EIO;
  293. }
  294. if (error) {
  295. if (host->cmd)
  296. host->cmd->error = error;
  297. if (error == -ETIMEDOUT) {
  298. iowrite32(int_status &
  299. ~(SD_BUF_CMD_TIMEOUT | SD_CARD_RESP_END),
  300. host->ioaddr + SD_CARDSTATUS);
  301. } else {
  302. toshsd_init(host);
  303. __toshsd_set_ios(host->mmc, &host->mmc->ios);
  304. goto irq_end;
  305. }
  306. }
  307. /* Card insert/remove. The mmc controlling code is stateless. */
  308. if (int_reg & (SD_CARD_CARD_INSERTED_0 | SD_CARD_CARD_REMOVED_0)) {
  309. iowrite32(int_status &
  310. ~(SD_CARD_CARD_REMOVED_0 | SD_CARD_CARD_INSERTED_0),
  311. host->ioaddr + SD_CARDSTATUS);
  312. if (int_reg & SD_CARD_CARD_INSERTED_0)
  313. toshsd_init(host);
  314. mmc_detect_change(host->mmc, 1);
  315. }
  316. /* Data transfer */
  317. if (int_reg & (SD_BUF_READ_ENABLE | SD_BUF_WRITE_ENABLE)) {
  318. iowrite32(int_status &
  319. ~(SD_BUF_WRITE_ENABLE | SD_BUF_READ_ENABLE),
  320. host->ioaddr + SD_CARDSTATUS);
  321. ret = IRQ_WAKE_THREAD;
  322. goto irq_end;
  323. }
  324. /* Command completion */
  325. if (int_reg & SD_CARD_RESP_END) {
  326. iowrite32(int_status & ~(SD_CARD_RESP_END),
  327. host->ioaddr + SD_CARDSTATUS);
  328. toshsd_cmd_irq(host);
  329. }
  330. /* Data transfer completion */
  331. if (int_reg & SD_CARD_RW_END) {
  332. iowrite32(int_status & ~(SD_CARD_RW_END),
  333. host->ioaddr + SD_CARDSTATUS);
  334. toshsd_data_end_irq(host);
  335. }
  336. irq_end:
  337. spin_unlock(&host->lock);
  338. return ret;
  339. }
  340. static void toshsd_start_cmd(struct toshsd_host *host, struct mmc_command *cmd)
  341. {
  342. struct mmc_data *data = host->data;
  343. int c = cmd->opcode;
  344. dev_dbg(&host->pdev->dev, "Command opcode: %d\n", cmd->opcode);
  345. if (cmd->opcode == MMC_STOP_TRANSMISSION) {
  346. iowrite16(SD_STOPINT_ISSUE_CMD12,
  347. host->ioaddr + SD_STOPINTERNAL);
  348. cmd->resp[0] = cmd->opcode;
  349. cmd->resp[1] = 0;
  350. cmd->resp[2] = 0;
  351. cmd->resp[3] = 0;
  352. toshsd_finish_request(host);
  353. return;
  354. }
  355. switch (mmc_resp_type(cmd)) {
  356. case MMC_RSP_NONE:
  357. c |= SD_CMD_RESP_TYPE_NONE;
  358. break;
  359. case MMC_RSP_R1:
  360. c |= SD_CMD_RESP_TYPE_EXT_R1;
  361. break;
  362. case MMC_RSP_R1B:
  363. c |= SD_CMD_RESP_TYPE_EXT_R1B;
  364. break;
  365. case MMC_RSP_R2:
  366. c |= SD_CMD_RESP_TYPE_EXT_R2;
  367. break;
  368. case MMC_RSP_R3:
  369. c |= SD_CMD_RESP_TYPE_EXT_R3;
  370. break;
  371. default:
  372. dev_err(&host->pdev->dev, "Unknown response type %d\n",
  373. mmc_resp_type(cmd));
  374. break;
  375. }
  376. host->cmd = cmd;
  377. if (cmd->opcode == MMC_APP_CMD)
  378. c |= SD_CMD_TYPE_ACMD;
  379. if (cmd->opcode == MMC_GO_IDLE_STATE)
  380. c |= (3 << 8); /* removed from ipaq-asic3.h for some reason */
  381. if (data) {
  382. c |= SD_CMD_DATA_PRESENT;
  383. if (data->blocks > 1) {
  384. iowrite16(SD_STOPINT_AUTO_ISSUE_CMD12,
  385. host->ioaddr + SD_STOPINTERNAL);
  386. c |= SD_CMD_MULTI_BLOCK;
  387. }
  388. if (data->flags & MMC_DATA_READ)
  389. c |= SD_CMD_TRANSFER_READ;
  390. /* MMC_DATA_WRITE does not require a bit to be set */
  391. }
  392. /* Send the command */
  393. iowrite32(cmd->arg, host->ioaddr + SD_ARG0);
  394. iowrite16(c, host->ioaddr + SD_CMD);
  395. }
  396. static void toshsd_start_data(struct toshsd_host *host, struct mmc_data *data)
  397. {
  398. unsigned int flags = SG_MITER_ATOMIC;
  399. dev_dbg(&host->pdev->dev, "setup data transfer: blocksize %08x nr_blocks %d, offset: %08x\n",
  400. data->blksz, data->blocks, data->sg->offset);
  401. host->data = data;
  402. if (data->flags & MMC_DATA_READ)
  403. flags |= SG_MITER_TO_SG;
  404. else
  405. flags |= SG_MITER_FROM_SG;
  406. sg_miter_start(&host->sg_miter, data->sg, data->sg_len, flags);
  407. /* Set transfer length and blocksize */
  408. iowrite16(data->blocks, host->ioaddr + SD_BLOCKCOUNT);
  409. iowrite16(data->blksz, host->ioaddr + SD_CARDXFERDATALEN);
  410. }
  411. /* Process requests from the MMC layer */
  412. static void toshsd_request(struct mmc_host *mmc, struct mmc_request *mrq)
  413. {
  414. struct toshsd_host *host = mmc_priv(mmc);
  415. unsigned long flags;
  416. /* abort if card not present */
  417. if (!(ioread16(host->ioaddr + SD_CARDSTATUS) & SD_CARD_PRESENT_0)) {
  418. mrq->cmd->error = -ENOMEDIUM;
  419. mmc_request_done(mmc, mrq);
  420. return;
  421. }
  422. spin_lock_irqsave(&host->lock, flags);
  423. WARN_ON(host->mrq != NULL);
  424. host->mrq = mrq;
  425. if (mrq->data)
  426. toshsd_start_data(host, mrq->data);
  427. toshsd_set_led(host, 1);
  428. toshsd_start_cmd(host, mrq->cmd);
  429. spin_unlock_irqrestore(&host->lock, flags);
  430. }
  431. static void toshsd_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)
  432. {
  433. struct toshsd_host *host = mmc_priv(mmc);
  434. unsigned long flags;
  435. spin_lock_irqsave(&host->lock, flags);
  436. __toshsd_set_ios(mmc, ios);
  437. spin_unlock_irqrestore(&host->lock, flags);
  438. }
  439. static int toshsd_get_ro(struct mmc_host *mmc)
  440. {
  441. struct toshsd_host *host = mmc_priv(mmc);
  442. /* active low */
  443. return !(ioread16(host->ioaddr + SD_CARDSTATUS) & SD_CARD_WRITE_PROTECT);
  444. }
  445. static int toshsd_get_cd(struct mmc_host *mmc)
  446. {
  447. struct toshsd_host *host = mmc_priv(mmc);
  448. return !!(ioread16(host->ioaddr + SD_CARDSTATUS) & SD_CARD_PRESENT_0);
  449. }
  450. static struct mmc_host_ops toshsd_ops = {
  451. .request = toshsd_request,
  452. .set_ios = toshsd_set_ios,
  453. .get_ro = toshsd_get_ro,
  454. .get_cd = toshsd_get_cd,
  455. };
  456. static void toshsd_powerdown(struct toshsd_host *host)
  457. {
  458. /* mask all interrupts */
  459. iowrite32(0xffffffff, host->ioaddr + SD_INTMASKCARD);
  460. /* disable card clock */
  461. iowrite16(0x000, host->ioaddr + SDIO_BASE + SDIO_CLOCKNWAITCTRL);
  462. iowrite16(0, host->ioaddr + SD_CARDCLOCKCTRL);
  463. /* power down card */
  464. pci_write_config_byte(host->pdev, SD_PCICFG_POWER1, SD_PCICFG_PWR1_OFF);
  465. /* disable clock */
  466. pci_write_config_byte(host->pdev, SD_PCICFG_CLKSTOP, 0);
  467. }
  468. #ifdef CONFIG_PM_SLEEP
  469. static int toshsd_pm_suspend(struct device *dev)
  470. {
  471. struct pci_dev *pdev = to_pci_dev(dev);
  472. struct toshsd_host *host = pci_get_drvdata(pdev);
  473. toshsd_powerdown(host);
  474. pci_save_state(pdev);
  475. pci_enable_wake(pdev, PCI_D3hot, 0);
  476. pci_disable_device(pdev);
  477. pci_set_power_state(pdev, PCI_D3hot);
  478. return 0;
  479. }
  480. static int toshsd_pm_resume(struct device *dev)
  481. {
  482. struct pci_dev *pdev = to_pci_dev(dev);
  483. struct toshsd_host *host = pci_get_drvdata(pdev);
  484. int ret;
  485. pci_set_power_state(pdev, PCI_D0);
  486. pci_restore_state(pdev);
  487. ret = pci_enable_device(pdev);
  488. if (ret)
  489. return ret;
  490. toshsd_init(host);
  491. return 0;
  492. }
  493. #endif /* CONFIG_PM_SLEEP */
  494. static int toshsd_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
  495. {
  496. int ret;
  497. struct toshsd_host *host;
  498. struct mmc_host *mmc;
  499. resource_size_t base;
  500. ret = pci_enable_device(pdev);
  501. if (ret)
  502. return ret;
  503. mmc = mmc_alloc_host(sizeof(struct toshsd_host), &pdev->dev);
  504. if (!mmc) {
  505. ret = -ENOMEM;
  506. goto err;
  507. }
  508. host = mmc_priv(mmc);
  509. host->mmc = mmc;
  510. host->pdev = pdev;
  511. pci_set_drvdata(pdev, host);
  512. ret = pci_request_regions(pdev, DRIVER_NAME);
  513. if (ret)
  514. goto free;
  515. host->ioaddr = pci_iomap(pdev, 0, 0);
  516. if (!host->ioaddr) {
  517. ret = -ENOMEM;
  518. goto release;
  519. }
  520. /* Set MMC host parameters */
  521. mmc->ops = &toshsd_ops;
  522. mmc->caps = MMC_CAP_4_BIT_DATA;
  523. mmc->ocr_avail = MMC_VDD_32_33;
  524. mmc->f_min = HCLK / 512;
  525. mmc->f_max = HCLK;
  526. spin_lock_init(&host->lock);
  527. toshsd_init(host);
  528. ret = request_threaded_irq(pdev->irq, toshsd_irq, toshsd_thread_irq,
  529. IRQF_SHARED, DRIVER_NAME, host);
  530. if (ret)
  531. goto unmap;
  532. mmc_add_host(mmc);
  533. base = pci_resource_start(pdev, 0);
  534. dev_dbg(&pdev->dev, "MMIO %pa, IRQ %d\n", &base, pdev->irq);
  535. pm_suspend_ignore_children(&pdev->dev, 1);
  536. return 0;
  537. unmap:
  538. pci_iounmap(pdev, host->ioaddr);
  539. release:
  540. pci_release_regions(pdev);
  541. free:
  542. mmc_free_host(mmc);
  543. pci_set_drvdata(pdev, NULL);
  544. err:
  545. pci_disable_device(pdev);
  546. return ret;
  547. }
  548. static void toshsd_remove(struct pci_dev *pdev)
  549. {
  550. struct toshsd_host *host = pci_get_drvdata(pdev);
  551. mmc_remove_host(host->mmc);
  552. toshsd_powerdown(host);
  553. free_irq(pdev->irq, host);
  554. pci_iounmap(pdev, host->ioaddr);
  555. pci_release_regions(pdev);
  556. mmc_free_host(host->mmc);
  557. pci_set_drvdata(pdev, NULL);
  558. pci_disable_device(pdev);
  559. }
  560. static const struct dev_pm_ops toshsd_pm_ops = {
  561. SET_SYSTEM_SLEEP_PM_OPS(toshsd_pm_suspend, toshsd_pm_resume)
  562. };
  563. static struct pci_driver toshsd_driver = {
  564. .name = DRIVER_NAME,
  565. .id_table = pci_ids,
  566. .probe = toshsd_probe,
  567. .remove = toshsd_remove,
  568. .driver.pm = &toshsd_pm_ops,
  569. };
  570. static int __init toshsd_drv_init(void)
  571. {
  572. return pci_register_driver(&toshsd_driver);
  573. }
  574. static void __exit toshsd_drv_exit(void)
  575. {
  576. pci_unregister_driver(&toshsd_driver);
  577. }
  578. module_init(toshsd_drv_init);
  579. module_exit(toshsd_drv_exit);
  580. MODULE_AUTHOR("Ondrej Zary, Richard Betts");
  581. MODULE_DESCRIPTION("Toshiba PCI Secure Digital Host Controller Interface driver");
  582. MODULE_LICENSE("GPL");