rtsx_pci_sdmmc.c 32 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306
  1. /* Realtek PCI-Express SD/MMC Card Interface driver
  2. *
  3. * Copyright(c) 2009-2013 Realtek Semiconductor Corp. All rights reserved.
  4. *
  5. * This program is free software; you can redistribute it and/or modify it
  6. * under the terms of the GNU General Public License as published by the
  7. * Free Software Foundation; either version 2, or (at your option) any
  8. * later version.
  9. *
  10. * This program is distributed in the hope that it will be useful, but
  11. * WITHOUT ANY WARRANTY; without even the implied warranty of
  12. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  13. * General Public License for more details.
  14. *
  15. * You should have received a copy of the GNU General Public License along
  16. * with this program; if not, see <http://www.gnu.org/licenses/>.
  17. *
  18. * Author:
  19. * Wei WANG <wei_wang@realsil.com.cn>
  20. */
  21. #include <linux/module.h>
  22. #include <linux/slab.h>
  23. #include <linux/highmem.h>
  24. #include <linux/delay.h>
  25. #include <linux/platform_device.h>
  26. #include <linux/mmc/host.h>
  27. #include <linux/mmc/mmc.h>
  28. #include <linux/mmc/sd.h>
  29. #include <linux/mmc/card.h>
  30. #include <linux/mfd/rtsx_pci.h>
  31. #include <asm/unaligned.h>
  32. struct realtek_pci_sdmmc {
  33. struct platform_device *pdev;
  34. struct rtsx_pcr *pcr;
  35. struct mmc_host *mmc;
  36. struct mmc_request *mrq;
  37. struct mutex host_mutex;
  38. u8 ssc_depth;
  39. unsigned int clock;
  40. bool vpclk;
  41. bool double_clk;
  42. bool eject;
  43. bool initial_mode;
  44. int power_state;
  45. #define SDMMC_POWER_ON 1
  46. #define SDMMC_POWER_OFF 0
  47. };
  48. static inline struct device *sdmmc_dev(struct realtek_pci_sdmmc *host)
  49. {
  50. return &(host->pdev->dev);
  51. }
  52. static inline void sd_clear_error(struct realtek_pci_sdmmc *host)
  53. {
  54. rtsx_pci_write_register(host->pcr, CARD_STOP,
  55. SD_STOP | SD_CLR_ERR, SD_STOP | SD_CLR_ERR);
  56. }
  57. #ifdef DEBUG
  58. static void sd_print_debug_regs(struct realtek_pci_sdmmc *host)
  59. {
  60. struct rtsx_pcr *pcr = host->pcr;
  61. u16 i;
  62. u8 *ptr;
  63. /* Print SD host internal registers */
  64. rtsx_pci_init_cmd(pcr);
  65. for (i = 0xFDA0; i <= 0xFDAE; i++)
  66. rtsx_pci_add_cmd(pcr, READ_REG_CMD, i, 0, 0);
  67. for (i = 0xFD52; i <= 0xFD69; i++)
  68. rtsx_pci_add_cmd(pcr, READ_REG_CMD, i, 0, 0);
  69. rtsx_pci_send_cmd(pcr, 100);
  70. ptr = rtsx_pci_get_cmd_data(pcr);
  71. for (i = 0xFDA0; i <= 0xFDAE; i++)
  72. dev_dbg(sdmmc_dev(host), "0x%04X: 0x%02x\n", i, *(ptr++));
  73. for (i = 0xFD52; i <= 0xFD69; i++)
  74. dev_dbg(sdmmc_dev(host), "0x%04X: 0x%02x\n", i, *(ptr++));
  75. }
  76. #else
  77. #define sd_print_debug_regs(host)
  78. #endif /* DEBUG */
  79. static int sd_read_data(struct realtek_pci_sdmmc *host, u8 *cmd, u16 byte_cnt,
  80. u8 *buf, int buf_len, int timeout)
  81. {
  82. struct rtsx_pcr *pcr = host->pcr;
  83. int err, i;
  84. u8 trans_mode;
  85. dev_dbg(sdmmc_dev(host), "%s: SD/MMC CMD%d\n", __func__, cmd[0] - 0x40);
  86. if (!buf)
  87. buf_len = 0;
  88. if ((cmd[0] & 0x3F) == MMC_SEND_TUNING_BLOCK)
  89. trans_mode = SD_TM_AUTO_TUNING;
  90. else
  91. trans_mode = SD_TM_NORMAL_READ;
  92. rtsx_pci_init_cmd(pcr);
  93. for (i = 0; i < 5; i++)
  94. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, SD_CMD0 + i, 0xFF, cmd[i]);
  95. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, SD_BYTE_CNT_L, 0xFF, (u8)byte_cnt);
  96. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, SD_BYTE_CNT_H,
  97. 0xFF, (u8)(byte_cnt >> 8));
  98. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, SD_BLOCK_CNT_L, 0xFF, 1);
  99. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, SD_BLOCK_CNT_H, 0xFF, 0);
  100. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, SD_CFG2, 0xFF,
  101. SD_CALCULATE_CRC7 | SD_CHECK_CRC16 |
  102. SD_NO_WAIT_BUSY_END | SD_CHECK_CRC7 | SD_RSP_LEN_6);
  103. if (trans_mode != SD_TM_AUTO_TUNING)
  104. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD,
  105. CARD_DATA_SOURCE, 0x01, PINGPONG_BUFFER);
  106. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, SD_TRANSFER,
  107. 0xFF, trans_mode | SD_TRANSFER_START);
  108. rtsx_pci_add_cmd(pcr, CHECK_REG_CMD, SD_TRANSFER,
  109. SD_TRANSFER_END, SD_TRANSFER_END);
  110. err = rtsx_pci_send_cmd(pcr, timeout);
  111. if (err < 0) {
  112. sd_print_debug_regs(host);
  113. dev_dbg(sdmmc_dev(host),
  114. "rtsx_pci_send_cmd fail (err = %d)\n", err);
  115. return err;
  116. }
  117. if (buf && buf_len) {
  118. err = rtsx_pci_read_ppbuf(pcr, buf, buf_len);
  119. if (err < 0) {
  120. dev_dbg(sdmmc_dev(host),
  121. "rtsx_pci_read_ppbuf fail (err = %d)\n", err);
  122. return err;
  123. }
  124. }
  125. return 0;
  126. }
  127. static int sd_write_data(struct realtek_pci_sdmmc *host, u8 *cmd, u16 byte_cnt,
  128. u8 *buf, int buf_len, int timeout)
  129. {
  130. struct rtsx_pcr *pcr = host->pcr;
  131. int err, i;
  132. u8 trans_mode;
  133. if (!buf)
  134. buf_len = 0;
  135. if (buf && buf_len) {
  136. err = rtsx_pci_write_ppbuf(pcr, buf, buf_len);
  137. if (err < 0) {
  138. dev_dbg(sdmmc_dev(host),
  139. "rtsx_pci_write_ppbuf fail (err = %d)\n", err);
  140. return err;
  141. }
  142. }
  143. trans_mode = cmd ? SD_TM_AUTO_WRITE_2 : SD_TM_AUTO_WRITE_3;
  144. rtsx_pci_init_cmd(pcr);
  145. if (cmd) {
  146. dev_dbg(sdmmc_dev(host), "%s: SD/MMC CMD %d\n", __func__,
  147. cmd[0] - 0x40);
  148. for (i = 0; i < 5; i++)
  149. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD,
  150. SD_CMD0 + i, 0xFF, cmd[i]);
  151. }
  152. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, SD_BYTE_CNT_L, 0xFF, (u8)byte_cnt);
  153. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, SD_BYTE_CNT_H,
  154. 0xFF, (u8)(byte_cnt >> 8));
  155. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, SD_BLOCK_CNT_L, 0xFF, 1);
  156. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, SD_BLOCK_CNT_H, 0xFF, 0);
  157. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, SD_CFG2, 0xFF,
  158. SD_CALCULATE_CRC7 | SD_CHECK_CRC16 |
  159. SD_NO_WAIT_BUSY_END | SD_CHECK_CRC7 | SD_RSP_LEN_6);
  160. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, SD_TRANSFER, 0xFF,
  161. trans_mode | SD_TRANSFER_START);
  162. rtsx_pci_add_cmd(pcr, CHECK_REG_CMD, SD_TRANSFER,
  163. SD_TRANSFER_END, SD_TRANSFER_END);
  164. err = rtsx_pci_send_cmd(pcr, timeout);
  165. if (err < 0) {
  166. sd_print_debug_regs(host);
  167. dev_dbg(sdmmc_dev(host),
  168. "rtsx_pci_send_cmd fail (err = %d)\n", err);
  169. return err;
  170. }
  171. return 0;
  172. }
  173. static void sd_send_cmd_get_rsp(struct realtek_pci_sdmmc *host,
  174. struct mmc_command *cmd)
  175. {
  176. struct rtsx_pcr *pcr = host->pcr;
  177. u8 cmd_idx = (u8)cmd->opcode;
  178. u32 arg = cmd->arg;
  179. int err = 0;
  180. int timeout = 100;
  181. int i;
  182. u8 *ptr;
  183. int stat_idx = 0;
  184. u8 rsp_type;
  185. int rsp_len = 5;
  186. bool clock_toggled = false;
  187. dev_dbg(sdmmc_dev(host), "%s: SD/MMC CMD %d, arg = 0x%08x\n",
  188. __func__, cmd_idx, arg);
  189. /* Response type:
  190. * R0
  191. * R1, R5, R6, R7
  192. * R1b
  193. * R2
  194. * R3, R4
  195. */
  196. switch (mmc_resp_type(cmd)) {
  197. case MMC_RSP_NONE:
  198. rsp_type = SD_RSP_TYPE_R0;
  199. rsp_len = 0;
  200. break;
  201. case MMC_RSP_R1:
  202. rsp_type = SD_RSP_TYPE_R1;
  203. break;
  204. case MMC_RSP_R1 & ~MMC_RSP_CRC:
  205. rsp_type = SD_RSP_TYPE_R1 | SD_NO_CHECK_CRC7;
  206. break;
  207. case MMC_RSP_R1B:
  208. rsp_type = SD_RSP_TYPE_R1b;
  209. break;
  210. case MMC_RSP_R2:
  211. rsp_type = SD_RSP_TYPE_R2;
  212. rsp_len = 16;
  213. break;
  214. case MMC_RSP_R3:
  215. rsp_type = SD_RSP_TYPE_R3;
  216. break;
  217. default:
  218. dev_dbg(sdmmc_dev(host), "cmd->flag is not valid\n");
  219. err = -EINVAL;
  220. goto out;
  221. }
  222. if (rsp_type == SD_RSP_TYPE_R1b)
  223. timeout = 3000;
  224. if (cmd->opcode == SD_SWITCH_VOLTAGE) {
  225. err = rtsx_pci_write_register(pcr, SD_BUS_STAT,
  226. 0xFF, SD_CLK_TOGGLE_EN);
  227. if (err < 0)
  228. goto out;
  229. clock_toggled = true;
  230. }
  231. rtsx_pci_init_cmd(pcr);
  232. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, SD_CMD0, 0xFF, 0x40 | cmd_idx);
  233. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, SD_CMD1, 0xFF, (u8)(arg >> 24));
  234. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, SD_CMD2, 0xFF, (u8)(arg >> 16));
  235. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, SD_CMD3, 0xFF, (u8)(arg >> 8));
  236. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, SD_CMD4, 0xFF, (u8)arg);
  237. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, SD_CFG2, 0xFF, rsp_type);
  238. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, CARD_DATA_SOURCE,
  239. 0x01, PINGPONG_BUFFER);
  240. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, SD_TRANSFER,
  241. 0xFF, SD_TM_CMD_RSP | SD_TRANSFER_START);
  242. rtsx_pci_add_cmd(pcr, CHECK_REG_CMD, SD_TRANSFER,
  243. SD_TRANSFER_END | SD_STAT_IDLE,
  244. SD_TRANSFER_END | SD_STAT_IDLE);
  245. if (rsp_type == SD_RSP_TYPE_R2) {
  246. /* Read data from ping-pong buffer */
  247. for (i = PPBUF_BASE2; i < PPBUF_BASE2 + 16; i++)
  248. rtsx_pci_add_cmd(pcr, READ_REG_CMD, (u16)i, 0, 0);
  249. stat_idx = 16;
  250. } else if (rsp_type != SD_RSP_TYPE_R0) {
  251. /* Read data from SD_CMDx registers */
  252. for (i = SD_CMD0; i <= SD_CMD4; i++)
  253. rtsx_pci_add_cmd(pcr, READ_REG_CMD, (u16)i, 0, 0);
  254. stat_idx = 5;
  255. }
  256. rtsx_pci_add_cmd(pcr, READ_REG_CMD, SD_STAT1, 0, 0);
  257. err = rtsx_pci_send_cmd(pcr, timeout);
  258. if (err < 0) {
  259. sd_print_debug_regs(host);
  260. sd_clear_error(host);
  261. dev_dbg(sdmmc_dev(host),
  262. "rtsx_pci_send_cmd error (err = %d)\n", err);
  263. goto out;
  264. }
  265. if (rsp_type == SD_RSP_TYPE_R0) {
  266. err = 0;
  267. goto out;
  268. }
  269. /* Eliminate returned value of CHECK_REG_CMD */
  270. ptr = rtsx_pci_get_cmd_data(pcr) + 1;
  271. /* Check (Start,Transmission) bit of Response */
  272. if ((ptr[0] & 0xC0) != 0) {
  273. err = -EILSEQ;
  274. dev_dbg(sdmmc_dev(host), "Invalid response bit\n");
  275. goto out;
  276. }
  277. /* Check CRC7 */
  278. if (!(rsp_type & SD_NO_CHECK_CRC7)) {
  279. if (ptr[stat_idx] & SD_CRC7_ERR) {
  280. err = -EILSEQ;
  281. dev_dbg(sdmmc_dev(host), "CRC7 error\n");
  282. goto out;
  283. }
  284. }
  285. if (rsp_type == SD_RSP_TYPE_R2) {
  286. for (i = 0; i < 4; i++) {
  287. cmd->resp[i] = get_unaligned_be32(ptr + 1 + i * 4);
  288. dev_dbg(sdmmc_dev(host), "cmd->resp[%d] = 0x%08x\n",
  289. i, cmd->resp[i]);
  290. }
  291. } else {
  292. cmd->resp[0] = get_unaligned_be32(ptr + 1);
  293. dev_dbg(sdmmc_dev(host), "cmd->resp[0] = 0x%08x\n",
  294. cmd->resp[0]);
  295. }
  296. out:
  297. cmd->error = err;
  298. if (err && clock_toggled)
  299. rtsx_pci_write_register(pcr, SD_BUS_STAT,
  300. SD_CLK_TOGGLE_EN | SD_CLK_FORCE_STOP, 0);
  301. }
  302. static int sd_rw_multi(struct realtek_pci_sdmmc *host, struct mmc_request *mrq)
  303. {
  304. struct rtsx_pcr *pcr = host->pcr;
  305. struct mmc_host *mmc = host->mmc;
  306. struct mmc_card *card = mmc->card;
  307. struct mmc_data *data = mrq->data;
  308. int uhs = mmc_card_uhs(card);
  309. int read = (data->flags & MMC_DATA_READ) ? 1 : 0;
  310. u8 cfg2, trans_mode;
  311. int err;
  312. size_t data_len = data->blksz * data->blocks;
  313. if (read) {
  314. cfg2 = SD_CALCULATE_CRC7 | SD_CHECK_CRC16 |
  315. SD_NO_WAIT_BUSY_END | SD_CHECK_CRC7 | SD_RSP_LEN_0;
  316. trans_mode = SD_TM_AUTO_READ_3;
  317. } else {
  318. cfg2 = SD_NO_CALCULATE_CRC7 | SD_CHECK_CRC16 |
  319. SD_NO_WAIT_BUSY_END | SD_NO_CHECK_CRC7 | SD_RSP_LEN_0;
  320. trans_mode = SD_TM_AUTO_WRITE_3;
  321. }
  322. if (!uhs)
  323. cfg2 |= SD_NO_CHECK_WAIT_CRC_TO;
  324. rtsx_pci_init_cmd(pcr);
  325. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, SD_BYTE_CNT_L, 0xFF, 0x00);
  326. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, SD_BYTE_CNT_H, 0xFF, 0x02);
  327. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, SD_BLOCK_CNT_L,
  328. 0xFF, (u8)data->blocks);
  329. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, SD_BLOCK_CNT_H,
  330. 0xFF, (u8)(data->blocks >> 8));
  331. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, IRQSTAT0,
  332. DMA_DONE_INT, DMA_DONE_INT);
  333. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, DMATC3,
  334. 0xFF, (u8)(data_len >> 24));
  335. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, DMATC2,
  336. 0xFF, (u8)(data_len >> 16));
  337. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, DMATC1,
  338. 0xFF, (u8)(data_len >> 8));
  339. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, DMATC0, 0xFF, (u8)data_len);
  340. if (read) {
  341. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, DMACTL,
  342. 0x03 | DMA_PACK_SIZE_MASK,
  343. DMA_DIR_FROM_CARD | DMA_EN | DMA_512);
  344. } else {
  345. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, DMACTL,
  346. 0x03 | DMA_PACK_SIZE_MASK,
  347. DMA_DIR_TO_CARD | DMA_EN | DMA_512);
  348. }
  349. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, CARD_DATA_SOURCE,
  350. 0x01, RING_BUFFER);
  351. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, SD_CFG2, 0xFF, cfg2);
  352. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, SD_TRANSFER, 0xFF,
  353. trans_mode | SD_TRANSFER_START);
  354. rtsx_pci_add_cmd(pcr, CHECK_REG_CMD, SD_TRANSFER,
  355. SD_TRANSFER_END, SD_TRANSFER_END);
  356. rtsx_pci_send_cmd_no_wait(pcr);
  357. err = rtsx_pci_transfer_data(pcr, data->sg, data->sg_len, read, 10000);
  358. if (err < 0) {
  359. sd_clear_error(host);
  360. return err;
  361. }
  362. return 0;
  363. }
  364. static inline void sd_enable_initial_mode(struct realtek_pci_sdmmc *host)
  365. {
  366. rtsx_pci_write_register(host->pcr, SD_CFG1,
  367. SD_CLK_DIVIDE_MASK, SD_CLK_DIVIDE_128);
  368. }
  369. static inline void sd_disable_initial_mode(struct realtek_pci_sdmmc *host)
  370. {
  371. rtsx_pci_write_register(host->pcr, SD_CFG1,
  372. SD_CLK_DIVIDE_MASK, SD_CLK_DIVIDE_0);
  373. }
  374. static void sd_normal_rw(struct realtek_pci_sdmmc *host,
  375. struct mmc_request *mrq)
  376. {
  377. struct mmc_command *cmd = mrq->cmd;
  378. struct mmc_data *data = mrq->data;
  379. u8 _cmd[5], *buf;
  380. _cmd[0] = 0x40 | (u8)cmd->opcode;
  381. put_unaligned_be32(cmd->arg, (u32 *)(&_cmd[1]));
  382. buf = kzalloc(data->blksz, GFP_NOIO);
  383. if (!buf) {
  384. cmd->error = -ENOMEM;
  385. return;
  386. }
  387. if (data->flags & MMC_DATA_READ) {
  388. if (host->initial_mode)
  389. sd_disable_initial_mode(host);
  390. cmd->error = sd_read_data(host, _cmd, (u16)data->blksz, buf,
  391. data->blksz, 200);
  392. if (host->initial_mode)
  393. sd_enable_initial_mode(host);
  394. sg_copy_from_buffer(data->sg, data->sg_len, buf, data->blksz);
  395. } else {
  396. sg_copy_to_buffer(data->sg, data->sg_len, buf, data->blksz);
  397. cmd->error = sd_write_data(host, _cmd, (u16)data->blksz, buf,
  398. data->blksz, 200);
  399. }
  400. kfree(buf);
  401. }
  402. static int sd_change_phase(struct realtek_pci_sdmmc *host,
  403. u8 sample_point, bool rx)
  404. {
  405. struct rtsx_pcr *pcr = host->pcr;
  406. int err;
  407. dev_dbg(sdmmc_dev(host), "%s(%s): sample_point = %d\n",
  408. __func__, rx ? "RX" : "TX", sample_point);
  409. rtsx_pci_init_cmd(pcr);
  410. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, CLK_CTL, CHANGE_CLK, CHANGE_CLK);
  411. if (rx)
  412. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD,
  413. SD_VPRX_CTL, 0x1F, sample_point);
  414. else
  415. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD,
  416. SD_VPTX_CTL, 0x1F, sample_point);
  417. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, SD_VPCLK0_CTL, PHASE_NOT_RESET, 0);
  418. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, SD_VPCLK0_CTL,
  419. PHASE_NOT_RESET, PHASE_NOT_RESET);
  420. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, CLK_CTL, CHANGE_CLK, 0);
  421. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, SD_CFG1, SD_ASYNC_FIFO_NOT_RST, 0);
  422. err = rtsx_pci_send_cmd(pcr, 100);
  423. if (err < 0)
  424. return err;
  425. return 0;
  426. }
  427. static inline u32 test_phase_bit(u32 phase_map, unsigned int bit)
  428. {
  429. bit %= RTSX_PHASE_MAX;
  430. return phase_map & (1 << bit);
  431. }
  432. static int sd_get_phase_len(u32 phase_map, unsigned int start_bit)
  433. {
  434. int i;
  435. for (i = 0; i < RTSX_PHASE_MAX; i++) {
  436. if (test_phase_bit(phase_map, start_bit + i) == 0)
  437. return i;
  438. }
  439. return RTSX_PHASE_MAX;
  440. }
  441. static u8 sd_search_final_phase(struct realtek_pci_sdmmc *host, u32 phase_map)
  442. {
  443. int start = 0, len = 0;
  444. int start_final = 0, len_final = 0;
  445. u8 final_phase = 0xFF;
  446. if (phase_map == 0) {
  447. dev_err(sdmmc_dev(host), "phase error: [map:%x]\n", phase_map);
  448. return final_phase;
  449. }
  450. while (start < RTSX_PHASE_MAX) {
  451. len = sd_get_phase_len(phase_map, start);
  452. if (len_final < len) {
  453. start_final = start;
  454. len_final = len;
  455. }
  456. start += len ? len : 1;
  457. }
  458. final_phase = (start_final + len_final / 2) % RTSX_PHASE_MAX;
  459. dev_dbg(sdmmc_dev(host), "phase: [map:%x] [maxlen:%d] [final:%d]\n",
  460. phase_map, len_final, final_phase);
  461. return final_phase;
  462. }
  463. static void sd_wait_data_idle(struct realtek_pci_sdmmc *host)
  464. {
  465. int err, i;
  466. u8 val = 0;
  467. for (i = 0; i < 100; i++) {
  468. err = rtsx_pci_read_register(host->pcr, SD_DATA_STATE, &val);
  469. if (val & SD_DATA_IDLE)
  470. return;
  471. udelay(100);
  472. }
  473. }
  474. static int sd_tuning_rx_cmd(struct realtek_pci_sdmmc *host,
  475. u8 opcode, u8 sample_point)
  476. {
  477. int err;
  478. u8 cmd[5] = {0};
  479. err = sd_change_phase(host, sample_point, true);
  480. if (err < 0)
  481. return err;
  482. cmd[0] = 0x40 | opcode;
  483. err = sd_read_data(host, cmd, 0x40, NULL, 0, 100);
  484. if (err < 0) {
  485. /* Wait till SD DATA IDLE */
  486. sd_wait_data_idle(host);
  487. sd_clear_error(host);
  488. return err;
  489. }
  490. return 0;
  491. }
  492. static int sd_tuning_phase(struct realtek_pci_sdmmc *host,
  493. u8 opcode, u32 *phase_map)
  494. {
  495. int err, i;
  496. u32 raw_phase_map = 0;
  497. for (i = 0; i < RTSX_PHASE_MAX; i++) {
  498. err = sd_tuning_rx_cmd(host, opcode, (u8)i);
  499. if (err == 0)
  500. raw_phase_map |= 1 << i;
  501. }
  502. if (phase_map)
  503. *phase_map = raw_phase_map;
  504. return 0;
  505. }
  506. static int sd_tuning_rx(struct realtek_pci_sdmmc *host, u8 opcode)
  507. {
  508. int err, i;
  509. u32 raw_phase_map[RX_TUNING_CNT] = {0}, phase_map;
  510. u8 final_phase;
  511. for (i = 0; i < RX_TUNING_CNT; i++) {
  512. err = sd_tuning_phase(host, opcode, &(raw_phase_map[i]));
  513. if (err < 0)
  514. return err;
  515. if (raw_phase_map[i] == 0)
  516. break;
  517. }
  518. phase_map = 0xFFFFFFFF;
  519. for (i = 0; i < RX_TUNING_CNT; i++) {
  520. dev_dbg(sdmmc_dev(host), "RX raw_phase_map[%d] = 0x%08x\n",
  521. i, raw_phase_map[i]);
  522. phase_map &= raw_phase_map[i];
  523. }
  524. dev_dbg(sdmmc_dev(host), "RX phase_map = 0x%08x\n", phase_map);
  525. if (phase_map) {
  526. final_phase = sd_search_final_phase(host, phase_map);
  527. if (final_phase == 0xFF)
  528. return -EINVAL;
  529. err = sd_change_phase(host, final_phase, true);
  530. if (err < 0)
  531. return err;
  532. } else {
  533. return -EINVAL;
  534. }
  535. return 0;
  536. }
  537. static void sdmmc_request(struct mmc_host *mmc, struct mmc_request *mrq)
  538. {
  539. struct realtek_pci_sdmmc *host = mmc_priv(mmc);
  540. struct rtsx_pcr *pcr = host->pcr;
  541. struct mmc_command *cmd = mrq->cmd;
  542. struct mmc_data *data = mrq->data;
  543. unsigned int data_size = 0;
  544. int err;
  545. if (host->eject) {
  546. cmd->error = -ENOMEDIUM;
  547. goto finish;
  548. }
  549. err = rtsx_pci_card_exclusive_check(host->pcr, RTSX_SD_CARD);
  550. if (err) {
  551. cmd->error = err;
  552. goto finish;
  553. }
  554. mutex_lock(&pcr->pcr_mutex);
  555. rtsx_pci_start_run(pcr);
  556. rtsx_pci_switch_clock(pcr, host->clock, host->ssc_depth,
  557. host->initial_mode, host->double_clk, host->vpclk);
  558. rtsx_pci_write_register(pcr, CARD_SELECT, 0x07, SD_MOD_SEL);
  559. rtsx_pci_write_register(pcr, CARD_SHARE_MODE,
  560. CARD_SHARE_MASK, CARD_SHARE_48_SD);
  561. mutex_lock(&host->host_mutex);
  562. host->mrq = mrq;
  563. mutex_unlock(&host->host_mutex);
  564. if (mrq->data)
  565. data_size = data->blocks * data->blksz;
  566. if (!data_size || mmc_op_multi(cmd->opcode) ||
  567. (cmd->opcode == MMC_READ_SINGLE_BLOCK) ||
  568. (cmd->opcode == MMC_WRITE_BLOCK)) {
  569. sd_send_cmd_get_rsp(host, cmd);
  570. if (!cmd->error && data_size) {
  571. sd_rw_multi(host, mrq);
  572. if (mmc_op_multi(cmd->opcode) && mrq->stop)
  573. sd_send_cmd_get_rsp(host, mrq->stop);
  574. }
  575. } else {
  576. sd_normal_rw(host, mrq);
  577. }
  578. if (mrq->data) {
  579. if (cmd->error || data->error)
  580. data->bytes_xfered = 0;
  581. else
  582. data->bytes_xfered = data->blocks * data->blksz;
  583. }
  584. mutex_unlock(&pcr->pcr_mutex);
  585. finish:
  586. if (cmd->error)
  587. dev_dbg(sdmmc_dev(host), "cmd->error = %d\n", cmd->error);
  588. mutex_lock(&host->host_mutex);
  589. host->mrq = NULL;
  590. mutex_unlock(&host->host_mutex);
  591. mmc_request_done(mmc, mrq);
  592. }
  593. static int sd_set_bus_width(struct realtek_pci_sdmmc *host,
  594. unsigned char bus_width)
  595. {
  596. int err = 0;
  597. u8 width[] = {
  598. [MMC_BUS_WIDTH_1] = SD_BUS_WIDTH_1BIT,
  599. [MMC_BUS_WIDTH_4] = SD_BUS_WIDTH_4BIT,
  600. [MMC_BUS_WIDTH_8] = SD_BUS_WIDTH_8BIT,
  601. };
  602. if (bus_width <= MMC_BUS_WIDTH_8)
  603. err = rtsx_pci_write_register(host->pcr, SD_CFG1,
  604. 0x03, width[bus_width]);
  605. return err;
  606. }
  607. static int sd_power_on(struct realtek_pci_sdmmc *host)
  608. {
  609. struct rtsx_pcr *pcr = host->pcr;
  610. int err;
  611. if (host->power_state == SDMMC_POWER_ON)
  612. return 0;
  613. rtsx_pci_init_cmd(pcr);
  614. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, CARD_SELECT, 0x07, SD_MOD_SEL);
  615. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, CARD_SHARE_MODE,
  616. CARD_SHARE_MASK, CARD_SHARE_48_SD);
  617. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, CARD_CLK_EN,
  618. SD_CLK_EN, SD_CLK_EN);
  619. err = rtsx_pci_send_cmd(pcr, 100);
  620. if (err < 0)
  621. return err;
  622. err = rtsx_pci_card_pull_ctl_enable(pcr, RTSX_SD_CARD);
  623. if (err < 0)
  624. return err;
  625. err = rtsx_pci_card_power_on(pcr, RTSX_SD_CARD);
  626. if (err < 0)
  627. return err;
  628. err = rtsx_pci_write_register(pcr, CARD_OE, SD_OUTPUT_EN, SD_OUTPUT_EN);
  629. if (err < 0)
  630. return err;
  631. host->power_state = SDMMC_POWER_ON;
  632. return 0;
  633. }
  634. static int sd_power_off(struct realtek_pci_sdmmc *host)
  635. {
  636. struct rtsx_pcr *pcr = host->pcr;
  637. int err;
  638. host->power_state = SDMMC_POWER_OFF;
  639. rtsx_pci_init_cmd(pcr);
  640. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, CARD_CLK_EN, SD_CLK_EN, 0);
  641. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, CARD_OE, SD_OUTPUT_EN, 0);
  642. err = rtsx_pci_send_cmd(pcr, 100);
  643. if (err < 0)
  644. return err;
  645. err = rtsx_pci_card_power_off(pcr, RTSX_SD_CARD);
  646. if (err < 0)
  647. return err;
  648. return rtsx_pci_card_pull_ctl_disable(pcr, RTSX_SD_CARD);
  649. }
  650. static int sd_set_power_mode(struct realtek_pci_sdmmc *host,
  651. unsigned char power_mode)
  652. {
  653. int err;
  654. if (power_mode == MMC_POWER_OFF)
  655. err = sd_power_off(host);
  656. else
  657. err = sd_power_on(host);
  658. return err;
  659. }
  660. static int sd_set_timing(struct realtek_pci_sdmmc *host, unsigned char timing)
  661. {
  662. struct rtsx_pcr *pcr = host->pcr;
  663. int err = 0;
  664. rtsx_pci_init_cmd(pcr);
  665. switch (timing) {
  666. case MMC_TIMING_UHS_SDR104:
  667. case MMC_TIMING_UHS_SDR50:
  668. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, SD_CFG1,
  669. 0x0C | SD_ASYNC_FIFO_NOT_RST,
  670. SD_30_MODE | SD_ASYNC_FIFO_NOT_RST);
  671. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, CLK_CTL,
  672. CLK_LOW_FREQ, CLK_LOW_FREQ);
  673. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, CARD_CLK_SOURCE, 0xFF,
  674. CRC_VAR_CLK0 | SD30_FIX_CLK | SAMPLE_VAR_CLK1);
  675. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, CLK_CTL, CLK_LOW_FREQ, 0);
  676. break;
  677. case MMC_TIMING_MMC_DDR52:
  678. case MMC_TIMING_UHS_DDR50:
  679. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, SD_CFG1,
  680. 0x0C | SD_ASYNC_FIFO_NOT_RST,
  681. SD_DDR_MODE | SD_ASYNC_FIFO_NOT_RST);
  682. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, CLK_CTL,
  683. CLK_LOW_FREQ, CLK_LOW_FREQ);
  684. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, CARD_CLK_SOURCE, 0xFF,
  685. CRC_VAR_CLK0 | SD30_FIX_CLK | SAMPLE_VAR_CLK1);
  686. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, CLK_CTL, CLK_LOW_FREQ, 0);
  687. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, SD_PUSH_POINT_CTL,
  688. DDR_VAR_TX_CMD_DAT, DDR_VAR_TX_CMD_DAT);
  689. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, SD_SAMPLE_POINT_CTL,
  690. DDR_VAR_RX_DAT | DDR_VAR_RX_CMD,
  691. DDR_VAR_RX_DAT | DDR_VAR_RX_CMD);
  692. break;
  693. case MMC_TIMING_MMC_HS:
  694. case MMC_TIMING_SD_HS:
  695. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, SD_CFG1,
  696. 0x0C, SD_20_MODE);
  697. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, CLK_CTL,
  698. CLK_LOW_FREQ, CLK_LOW_FREQ);
  699. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, CARD_CLK_SOURCE, 0xFF,
  700. CRC_FIX_CLK | SD30_VAR_CLK0 | SAMPLE_VAR_CLK1);
  701. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, CLK_CTL, CLK_LOW_FREQ, 0);
  702. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, SD_PUSH_POINT_CTL,
  703. SD20_TX_SEL_MASK, SD20_TX_14_AHEAD);
  704. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, SD_SAMPLE_POINT_CTL,
  705. SD20_RX_SEL_MASK, SD20_RX_14_DELAY);
  706. break;
  707. default:
  708. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD,
  709. SD_CFG1, 0x0C, SD_20_MODE);
  710. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, CLK_CTL,
  711. CLK_LOW_FREQ, CLK_LOW_FREQ);
  712. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, CARD_CLK_SOURCE, 0xFF,
  713. CRC_FIX_CLK | SD30_VAR_CLK0 | SAMPLE_VAR_CLK1);
  714. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, CLK_CTL, CLK_LOW_FREQ, 0);
  715. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD,
  716. SD_PUSH_POINT_CTL, 0xFF, 0);
  717. rtsx_pci_add_cmd(pcr, WRITE_REG_CMD, SD_SAMPLE_POINT_CTL,
  718. SD20_RX_SEL_MASK, SD20_RX_POS_EDGE);
  719. break;
  720. }
  721. err = rtsx_pci_send_cmd(pcr, 100);
  722. return err;
  723. }
  724. static void sdmmc_set_ios(struct mmc_host *mmc, struct mmc_ios *ios)
  725. {
  726. struct realtek_pci_sdmmc *host = mmc_priv(mmc);
  727. struct rtsx_pcr *pcr = host->pcr;
  728. if (host->eject)
  729. return;
  730. if (rtsx_pci_card_exclusive_check(host->pcr, RTSX_SD_CARD))
  731. return;
  732. mutex_lock(&pcr->pcr_mutex);
  733. rtsx_pci_start_run(pcr);
  734. sd_set_bus_width(host, ios->bus_width);
  735. sd_set_power_mode(host, ios->power_mode);
  736. sd_set_timing(host, ios->timing);
  737. host->vpclk = false;
  738. host->double_clk = true;
  739. switch (ios->timing) {
  740. case MMC_TIMING_UHS_SDR104:
  741. case MMC_TIMING_UHS_SDR50:
  742. host->ssc_depth = RTSX_SSC_DEPTH_2M;
  743. host->vpclk = true;
  744. host->double_clk = false;
  745. break;
  746. case MMC_TIMING_MMC_DDR52:
  747. case MMC_TIMING_UHS_DDR50:
  748. case MMC_TIMING_UHS_SDR25:
  749. host->ssc_depth = RTSX_SSC_DEPTH_1M;
  750. break;
  751. default:
  752. host->ssc_depth = RTSX_SSC_DEPTH_500K;
  753. break;
  754. }
  755. host->initial_mode = (ios->clock <= 1000000) ? true : false;
  756. host->clock = ios->clock;
  757. rtsx_pci_switch_clock(pcr, ios->clock, host->ssc_depth,
  758. host->initial_mode, host->double_clk, host->vpclk);
  759. mutex_unlock(&pcr->pcr_mutex);
  760. }
  761. static int sdmmc_get_ro(struct mmc_host *mmc)
  762. {
  763. struct realtek_pci_sdmmc *host = mmc_priv(mmc);
  764. struct rtsx_pcr *pcr = host->pcr;
  765. int ro = 0;
  766. u32 val;
  767. if (host->eject)
  768. return -ENOMEDIUM;
  769. mutex_lock(&pcr->pcr_mutex);
  770. rtsx_pci_start_run(pcr);
  771. /* Check SD mechanical write-protect switch */
  772. val = rtsx_pci_readl(pcr, RTSX_BIPR);
  773. dev_dbg(sdmmc_dev(host), "%s: RTSX_BIPR = 0x%08x\n", __func__, val);
  774. if (val & SD_WRITE_PROTECT)
  775. ro = 1;
  776. mutex_unlock(&pcr->pcr_mutex);
  777. return ro;
  778. }
  779. static int sdmmc_get_cd(struct mmc_host *mmc)
  780. {
  781. struct realtek_pci_sdmmc *host = mmc_priv(mmc);
  782. struct rtsx_pcr *pcr = host->pcr;
  783. int cd = 0;
  784. u32 val;
  785. if (host->eject)
  786. return -ENOMEDIUM;
  787. mutex_lock(&pcr->pcr_mutex);
  788. rtsx_pci_start_run(pcr);
  789. /* Check SD card detect */
  790. val = rtsx_pci_card_exist(pcr);
  791. dev_dbg(sdmmc_dev(host), "%s: RTSX_BIPR = 0x%08x\n", __func__, val);
  792. if (val & SD_EXIST)
  793. cd = 1;
  794. mutex_unlock(&pcr->pcr_mutex);
  795. return cd;
  796. }
  797. static int sd_wait_voltage_stable_1(struct realtek_pci_sdmmc *host)
  798. {
  799. struct rtsx_pcr *pcr = host->pcr;
  800. int err;
  801. u8 stat;
  802. /* Reference to Signal Voltage Switch Sequence in SD spec.
  803. * Wait for a period of time so that the card can drive SD_CMD and
  804. * SD_DAT[3:0] to low after sending back CMD11 response.
  805. */
  806. mdelay(1);
  807. /* SD_CMD, SD_DAT[3:0] should be driven to low by card;
  808. * If either one of SD_CMD,SD_DAT[3:0] is not low,
  809. * abort the voltage switch sequence;
  810. */
  811. err = rtsx_pci_read_register(pcr, SD_BUS_STAT, &stat);
  812. if (err < 0)
  813. return err;
  814. if (stat & (SD_CMD_STATUS | SD_DAT3_STATUS | SD_DAT2_STATUS |
  815. SD_DAT1_STATUS | SD_DAT0_STATUS))
  816. return -EINVAL;
  817. /* Stop toggle SD clock */
  818. err = rtsx_pci_write_register(pcr, SD_BUS_STAT,
  819. 0xFF, SD_CLK_FORCE_STOP);
  820. if (err < 0)
  821. return err;
  822. return 0;
  823. }
  824. static int sd_wait_voltage_stable_2(struct realtek_pci_sdmmc *host)
  825. {
  826. struct rtsx_pcr *pcr = host->pcr;
  827. int err;
  828. u8 stat, mask, val;
  829. /* Wait 1.8V output of voltage regulator in card stable */
  830. msleep(50);
  831. /* Toggle SD clock again */
  832. err = rtsx_pci_write_register(pcr, SD_BUS_STAT, 0xFF, SD_CLK_TOGGLE_EN);
  833. if (err < 0)
  834. return err;
  835. /* Wait for a period of time so that the card can drive
  836. * SD_DAT[3:0] to high at 1.8V
  837. */
  838. msleep(20);
  839. /* SD_CMD, SD_DAT[3:0] should be pulled high by host */
  840. err = rtsx_pci_read_register(pcr, SD_BUS_STAT, &stat);
  841. if (err < 0)
  842. return err;
  843. mask = SD_CMD_STATUS | SD_DAT3_STATUS | SD_DAT2_STATUS |
  844. SD_DAT1_STATUS | SD_DAT0_STATUS;
  845. val = SD_CMD_STATUS | SD_DAT3_STATUS | SD_DAT2_STATUS |
  846. SD_DAT1_STATUS | SD_DAT0_STATUS;
  847. if ((stat & mask) != val) {
  848. dev_dbg(sdmmc_dev(host),
  849. "%s: SD_BUS_STAT = 0x%x\n", __func__, stat);
  850. rtsx_pci_write_register(pcr, SD_BUS_STAT,
  851. SD_CLK_TOGGLE_EN | SD_CLK_FORCE_STOP, 0);
  852. rtsx_pci_write_register(pcr, CARD_CLK_EN, 0xFF, 0);
  853. return -EINVAL;
  854. }
  855. return 0;
  856. }
  857. static int sdmmc_switch_voltage(struct mmc_host *mmc, struct mmc_ios *ios)
  858. {
  859. struct realtek_pci_sdmmc *host = mmc_priv(mmc);
  860. struct rtsx_pcr *pcr = host->pcr;
  861. int err = 0;
  862. u8 voltage;
  863. dev_dbg(sdmmc_dev(host), "%s: signal_voltage = %d\n",
  864. __func__, ios->signal_voltage);
  865. if (host->eject)
  866. return -ENOMEDIUM;
  867. err = rtsx_pci_card_exclusive_check(host->pcr, RTSX_SD_CARD);
  868. if (err)
  869. return err;
  870. mutex_lock(&pcr->pcr_mutex);
  871. rtsx_pci_start_run(pcr);
  872. if (ios->signal_voltage == MMC_SIGNAL_VOLTAGE_330)
  873. voltage = OUTPUT_3V3;
  874. else
  875. voltage = OUTPUT_1V8;
  876. if (voltage == OUTPUT_1V8) {
  877. err = sd_wait_voltage_stable_1(host);
  878. if (err < 0)
  879. goto out;
  880. }
  881. err = rtsx_pci_switch_output_voltage(pcr, voltage);
  882. if (err < 0)
  883. goto out;
  884. if (voltage == OUTPUT_1V8) {
  885. err = sd_wait_voltage_stable_2(host);
  886. if (err < 0)
  887. goto out;
  888. }
  889. out:
  890. /* Stop toggle SD clock in idle */
  891. err = rtsx_pci_write_register(pcr, SD_BUS_STAT,
  892. SD_CLK_TOGGLE_EN | SD_CLK_FORCE_STOP, 0);
  893. mutex_unlock(&pcr->pcr_mutex);
  894. return err;
  895. }
  896. static int sdmmc_execute_tuning(struct mmc_host *mmc, u32 opcode)
  897. {
  898. struct realtek_pci_sdmmc *host = mmc_priv(mmc);
  899. struct rtsx_pcr *pcr = host->pcr;
  900. int err = 0;
  901. if (host->eject)
  902. return -ENOMEDIUM;
  903. err = rtsx_pci_card_exclusive_check(host->pcr, RTSX_SD_CARD);
  904. if (err)
  905. return err;
  906. mutex_lock(&pcr->pcr_mutex);
  907. rtsx_pci_start_run(pcr);
  908. /* Set initial TX phase */
  909. switch (mmc->ios.timing) {
  910. case MMC_TIMING_UHS_SDR104:
  911. err = sd_change_phase(host, SDR104_TX_PHASE(pcr), false);
  912. break;
  913. case MMC_TIMING_UHS_SDR50:
  914. err = sd_change_phase(host, SDR50_TX_PHASE(pcr), false);
  915. break;
  916. case MMC_TIMING_UHS_DDR50:
  917. err = sd_change_phase(host, DDR50_TX_PHASE(pcr), false);
  918. break;
  919. default:
  920. err = 0;
  921. }
  922. if (err)
  923. goto out;
  924. /* Tuning RX phase */
  925. if ((mmc->ios.timing == MMC_TIMING_UHS_SDR104) ||
  926. (mmc->ios.timing == MMC_TIMING_UHS_SDR50))
  927. err = sd_tuning_rx(host, opcode);
  928. else if (mmc->ios.timing == MMC_TIMING_UHS_DDR50)
  929. err = sd_change_phase(host, DDR50_RX_PHASE(pcr), true);
  930. out:
  931. mutex_unlock(&pcr->pcr_mutex);
  932. return err;
  933. }
  934. static const struct mmc_host_ops realtek_pci_sdmmc_ops = {
  935. .request = sdmmc_request,
  936. .set_ios = sdmmc_set_ios,
  937. .get_ro = sdmmc_get_ro,
  938. .get_cd = sdmmc_get_cd,
  939. .start_signal_voltage_switch = sdmmc_switch_voltage,
  940. .execute_tuning = sdmmc_execute_tuning,
  941. };
  942. static void init_extra_caps(struct realtek_pci_sdmmc *host)
  943. {
  944. struct mmc_host *mmc = host->mmc;
  945. struct rtsx_pcr *pcr = host->pcr;
  946. dev_dbg(sdmmc_dev(host), "pcr->extra_caps = 0x%x\n", pcr->extra_caps);
  947. if (pcr->extra_caps & EXTRA_CAPS_SD_SDR50)
  948. mmc->caps |= MMC_CAP_UHS_SDR50;
  949. if (pcr->extra_caps & EXTRA_CAPS_SD_SDR104)
  950. mmc->caps |= MMC_CAP_UHS_SDR104;
  951. if (pcr->extra_caps & EXTRA_CAPS_SD_DDR50)
  952. mmc->caps |= MMC_CAP_UHS_DDR50;
  953. if (pcr->extra_caps & EXTRA_CAPS_MMC_HSDDR)
  954. mmc->caps |= MMC_CAP_1_8V_DDR;
  955. if (pcr->extra_caps & EXTRA_CAPS_MMC_8BIT)
  956. mmc->caps |= MMC_CAP_8_BIT_DATA;
  957. }
  958. static void realtek_init_host(struct realtek_pci_sdmmc *host)
  959. {
  960. struct mmc_host *mmc = host->mmc;
  961. mmc->f_min = 250000;
  962. mmc->f_max = 208000000;
  963. mmc->ocr_avail = MMC_VDD_32_33 | MMC_VDD_33_34 | MMC_VDD_165_195;
  964. mmc->caps = MMC_CAP_4_BIT_DATA | MMC_CAP_SD_HIGHSPEED |
  965. MMC_CAP_MMC_HIGHSPEED | MMC_CAP_BUS_WIDTH_TEST |
  966. MMC_CAP_UHS_SDR12 | MMC_CAP_UHS_SDR25;
  967. mmc->max_current_330 = 400;
  968. mmc->max_current_180 = 800;
  969. mmc->ops = &realtek_pci_sdmmc_ops;
  970. init_extra_caps(host);
  971. mmc->max_segs = 256;
  972. mmc->max_seg_size = 65536;
  973. mmc->max_blk_size = 512;
  974. mmc->max_blk_count = 65535;
  975. mmc->max_req_size = 524288;
  976. }
  977. static void rtsx_pci_sdmmc_card_event(struct platform_device *pdev)
  978. {
  979. struct realtek_pci_sdmmc *host = platform_get_drvdata(pdev);
  980. mmc_detect_change(host->mmc, 0);
  981. }
  982. static int rtsx_pci_sdmmc_drv_probe(struct platform_device *pdev)
  983. {
  984. struct mmc_host *mmc;
  985. struct realtek_pci_sdmmc *host;
  986. struct rtsx_pcr *pcr;
  987. struct pcr_handle *handle = pdev->dev.platform_data;
  988. if (!handle)
  989. return -ENXIO;
  990. pcr = handle->pcr;
  991. if (!pcr)
  992. return -ENXIO;
  993. dev_dbg(&(pdev->dev), ": Realtek PCI-E SDMMC controller found\n");
  994. mmc = mmc_alloc_host(sizeof(*host), &pdev->dev);
  995. if (!mmc)
  996. return -ENOMEM;
  997. host = mmc_priv(mmc);
  998. host->pcr = pcr;
  999. host->mmc = mmc;
  1000. host->pdev = pdev;
  1001. host->power_state = SDMMC_POWER_OFF;
  1002. platform_set_drvdata(pdev, host);
  1003. pcr->slots[RTSX_SD_CARD].p_dev = pdev;
  1004. pcr->slots[RTSX_SD_CARD].card_event = rtsx_pci_sdmmc_card_event;
  1005. mutex_init(&host->host_mutex);
  1006. realtek_init_host(host);
  1007. mmc_add_host(mmc);
  1008. return 0;
  1009. }
  1010. static int rtsx_pci_sdmmc_drv_remove(struct platform_device *pdev)
  1011. {
  1012. struct realtek_pci_sdmmc *host = platform_get_drvdata(pdev);
  1013. struct rtsx_pcr *pcr;
  1014. struct mmc_host *mmc;
  1015. if (!host)
  1016. return 0;
  1017. pcr = host->pcr;
  1018. pcr->slots[RTSX_SD_CARD].p_dev = NULL;
  1019. pcr->slots[RTSX_SD_CARD].card_event = NULL;
  1020. mmc = host->mmc;
  1021. mutex_lock(&host->host_mutex);
  1022. if (host->mrq) {
  1023. dev_dbg(&(pdev->dev),
  1024. "%s: Controller removed during transfer\n",
  1025. mmc_hostname(mmc));
  1026. rtsx_pci_complete_unfinished_transfer(pcr);
  1027. host->mrq->cmd->error = -ENOMEDIUM;
  1028. if (host->mrq->stop)
  1029. host->mrq->stop->error = -ENOMEDIUM;
  1030. mmc_request_done(mmc, host->mrq);
  1031. }
  1032. mutex_unlock(&host->host_mutex);
  1033. mmc_remove_host(mmc);
  1034. host->eject = true;
  1035. mmc_free_host(mmc);
  1036. dev_dbg(&(pdev->dev),
  1037. ": Realtek PCI-E SDMMC controller has been removed\n");
  1038. return 0;
  1039. }
  1040. static struct platform_device_id rtsx_pci_sdmmc_ids[] = {
  1041. {
  1042. .name = DRV_NAME_RTSX_PCI_SDMMC,
  1043. }, {
  1044. /* sentinel */
  1045. }
  1046. };
  1047. MODULE_DEVICE_TABLE(platform, rtsx_pci_sdmmc_ids);
  1048. static struct platform_driver rtsx_pci_sdmmc_driver = {
  1049. .probe = rtsx_pci_sdmmc_drv_probe,
  1050. .remove = rtsx_pci_sdmmc_drv_remove,
  1051. .id_table = rtsx_pci_sdmmc_ids,
  1052. .driver = {
  1053. .owner = THIS_MODULE,
  1054. .name = DRV_NAME_RTSX_PCI_SDMMC,
  1055. },
  1056. };
  1057. module_platform_driver(rtsx_pci_sdmmc_driver);
  1058. MODULE_LICENSE("GPL");
  1059. MODULE_AUTHOR("Wei WANG <wei_wang@realsil.com.cn>");
  1060. MODULE_DESCRIPTION("Realtek PCI-E SD/MMC Card Host Driver");