omap_hsmmc.c 16 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653
  1. /*
  2. * (C) Copyright 2008
  3. * Texas Instruments, <www.ti.com>
  4. * Sukumar Ghorai <s-ghorai@ti.com>
  5. *
  6. * See file CREDITS for list of people who contributed to this
  7. * project.
  8. *
  9. * This program is free software; you can redistribute it and/or
  10. * modify it under the terms of the GNU General Public License as
  11. * published by the Free Software Foundation's version 2 of
  12. * the License.
  13. *
  14. * This program is distributed in the hope that it will be useful,
  15. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  16. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  17. * GNU General Public License for more details.
  18. *
  19. * You should have received a copy of the GNU General Public License
  20. * along with this program; if not, write to the Free Software
  21. * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  22. * MA 02111-1307 USA
  23. */
  24. #include <config.h>
  25. #include <common.h>
  26. #include <mmc.h>
  27. #include <part.h>
  28. #include <i2c.h>
  29. #include <twl4030.h>
  30. #include <twl6030.h>
  31. #include <palmas.h>
  32. #include <asm/gpio.h>
  33. #include <asm/io.h>
  34. #include <asm/arch/mmc_host_def.h>
  35. #include <asm/arch/sys_proto.h>
  36. /* common definitions for all OMAPs */
  37. #define SYSCTL_SRC (1 << 25)
  38. #define SYSCTL_SRD (1 << 26)
  39. struct omap_hsmmc_data {
  40. struct hsmmc *base_addr;
  41. int cd_gpio;
  42. int wp_gpio;
  43. };
  44. /* If we fail after 1 second wait, something is really bad */
  45. #define MAX_RETRY_MS 1000
  46. static int mmc_read_data(struct hsmmc *mmc_base, char *buf, unsigned int size);
  47. static int mmc_write_data(struct hsmmc *mmc_base, const char *buf,
  48. unsigned int siz);
  49. static struct mmc hsmmc_dev[3];
  50. static struct omap_hsmmc_data hsmmc_dev_data[3];
  51. #if (defined(CONFIG_OMAP_GPIO) && !defined(CONFIG_SPL_BUILD)) || \
  52. (defined(CONFIG_SPL_BUILD) && defined(CONFIG_SPL_GPIO_SUPPORT))
  53. static int omap_mmc_setup_gpio_in(int gpio, const char *label)
  54. {
  55. if (!gpio_is_valid(gpio))
  56. return -1;
  57. if (gpio_request(gpio, label) < 0)
  58. return -1;
  59. if (gpio_direction_input(gpio) < 0)
  60. return -1;
  61. return gpio;
  62. }
  63. static int omap_mmc_getcd(struct mmc *mmc)
  64. {
  65. int cd_gpio = ((struct omap_hsmmc_data *)mmc->priv)->cd_gpio;
  66. return gpio_get_value(cd_gpio);
  67. }
  68. static int omap_mmc_getwp(struct mmc *mmc)
  69. {
  70. int wp_gpio = ((struct omap_hsmmc_data *)mmc->priv)->wp_gpio;
  71. return gpio_get_value(wp_gpio);
  72. }
  73. #else
  74. static inline int omap_mmc_setup_gpio_in(int gpio, const char *label)
  75. {
  76. return -1;
  77. }
  78. #define omap_mmc_getcd NULL
  79. #define omap_mmc_getwp NULL
  80. #endif
  81. #if defined(CONFIG_OMAP44XX) && defined(CONFIG_TWL6030_POWER)
  82. static void omap4_vmmc_pbias_config(struct mmc *mmc)
  83. {
  84. u32 value = 0;
  85. value = readl((*ctrl)->control_pbiaslite);
  86. value &= ~(MMC1_PBIASLITE_PWRDNZ | MMC1_PWRDNZ);
  87. writel(value, (*ctrl)->control_pbiaslite);
  88. /* set VMMC to 3V */
  89. twl6030_power_mmc_init();
  90. value = readl((*ctrl)->control_pbiaslite);
  91. value |= MMC1_PBIASLITE_VMODE | MMC1_PBIASLITE_PWRDNZ | MMC1_PWRDNZ;
  92. writel(value, (*ctrl)->control_pbiaslite);
  93. }
  94. #endif
  95. #if defined(CONFIG_OMAP54XX) && defined(CONFIG_PALMAS_POWER)
  96. static void omap5_pbias_config(struct mmc *mmc)
  97. {
  98. u32 value = 0;
  99. value = readl((*ctrl)->control_pbias);
  100. value &= ~SDCARD_PWRDNZ;
  101. writel(value, (*ctrl)->control_pbias);
  102. udelay(10); /* wait 10 us */
  103. value &= ~SDCARD_BIAS_PWRDNZ;
  104. writel(value, (*ctrl)->control_pbias);
  105. palmas_mmc1_poweron_ldo();
  106. value = readl((*ctrl)->control_pbias);
  107. value |= SDCARD_BIAS_PWRDNZ;
  108. writel(value, (*ctrl)->control_pbias);
  109. udelay(150); /* wait 150 us */
  110. value |= SDCARD_PWRDNZ;
  111. writel(value, (*ctrl)->control_pbias);
  112. udelay(150); /* wait 150 us */
  113. }
  114. #endif
  115. unsigned char mmc_board_init(struct mmc *mmc)
  116. {
  117. #if defined(CONFIG_OMAP34XX)
  118. t2_t *t2_base = (t2_t *)T2_BASE;
  119. struct prcm *prcm_base = (struct prcm *)PRCM_BASE;
  120. u32 pbias_lite;
  121. pbias_lite = readl(&t2_base->pbias_lite);
  122. pbias_lite &= ~(PBIASLITEPWRDNZ1 | PBIASLITEPWRDNZ0);
  123. writel(pbias_lite, &t2_base->pbias_lite);
  124. #endif
  125. #if defined(CONFIG_TWL4030_POWER)
  126. twl4030_power_mmc_init();
  127. mdelay(100); /* ramp-up delay from Linux code */
  128. #endif
  129. #if defined(CONFIG_OMAP34XX)
  130. writel(pbias_lite | PBIASLITEPWRDNZ1 |
  131. PBIASSPEEDCTRL0 | PBIASLITEPWRDNZ0,
  132. &t2_base->pbias_lite);
  133. writel(readl(&t2_base->devconf0) | MMCSDIO1ADPCLKISEL,
  134. &t2_base->devconf0);
  135. writel(readl(&t2_base->devconf1) | MMCSDIO2ADPCLKISEL,
  136. &t2_base->devconf1);
  137. /* Change from default of 52MHz to 26MHz if necessary */
  138. if (!(mmc->host_caps & MMC_MODE_HS_52MHz))
  139. writel(readl(&t2_base->ctl_prog_io1) & ~CTLPROGIO1SPEEDCTRL,
  140. &t2_base->ctl_prog_io1);
  141. writel(readl(&prcm_base->fclken1_core) |
  142. EN_MMC1 | EN_MMC2 | EN_MMC3,
  143. &prcm_base->fclken1_core);
  144. writel(readl(&prcm_base->iclken1_core) |
  145. EN_MMC1 | EN_MMC2 | EN_MMC3,
  146. &prcm_base->iclken1_core);
  147. #endif
  148. #if defined(CONFIG_OMAP44XX) && defined(CONFIG_TWL6030_POWER)
  149. /* PBIAS config needed for MMC1 only */
  150. if (mmc->block_dev.dev == 0)
  151. omap4_vmmc_pbias_config(mmc);
  152. #endif
  153. #if defined(CONFIG_OMAP54XX) && defined(CONFIG_PALMAS_POWER)
  154. if (mmc->block_dev.dev == 0)
  155. omap5_pbias_config(mmc);
  156. #endif
  157. return 0;
  158. }
  159. void mmc_init_stream(struct hsmmc *mmc_base)
  160. {
  161. ulong start;
  162. writel(readl(&mmc_base->con) | INIT_INITSTREAM, &mmc_base->con);
  163. writel(MMC_CMD0, &mmc_base->cmd);
  164. start = get_timer(0);
  165. while (!(readl(&mmc_base->stat) & CC_MASK)) {
  166. if (get_timer(0) - start > MAX_RETRY_MS) {
  167. printf("%s: timedout waiting for cc!\n", __func__);
  168. return;
  169. }
  170. }
  171. writel(CC_MASK, &mmc_base->stat)
  172. ;
  173. writel(MMC_CMD0, &mmc_base->cmd)
  174. ;
  175. start = get_timer(0);
  176. while (!(readl(&mmc_base->stat) & CC_MASK)) {
  177. if (get_timer(0) - start > MAX_RETRY_MS) {
  178. printf("%s: timedout waiting for cc2!\n", __func__);
  179. return;
  180. }
  181. }
  182. writel(readl(&mmc_base->con) & ~INIT_INITSTREAM, &mmc_base->con);
  183. }
  184. static int mmc_init_setup(struct mmc *mmc)
  185. {
  186. struct hsmmc *mmc_base;
  187. unsigned int reg_val;
  188. unsigned int dsor;
  189. ulong start;
  190. mmc_base = ((struct omap_hsmmc_data *)mmc->priv)->base_addr;
  191. mmc_board_init(mmc);
  192. writel(readl(&mmc_base->sysconfig) | MMC_SOFTRESET,
  193. &mmc_base->sysconfig);
  194. start = get_timer(0);
  195. while ((readl(&mmc_base->sysstatus) & RESETDONE) == 0) {
  196. if (get_timer(0) - start > MAX_RETRY_MS) {
  197. printf("%s: timedout waiting for cc2!\n", __func__);
  198. return TIMEOUT;
  199. }
  200. }
  201. writel(readl(&mmc_base->sysctl) | SOFTRESETALL, &mmc_base->sysctl);
  202. start = get_timer(0);
  203. while ((readl(&mmc_base->sysctl) & SOFTRESETALL) != 0x0) {
  204. if (get_timer(0) - start > MAX_RETRY_MS) {
  205. printf("%s: timedout waiting for softresetall!\n",
  206. __func__);
  207. return TIMEOUT;
  208. }
  209. }
  210. writel(DTW_1_BITMODE | SDBP_PWROFF | SDVS_3V0, &mmc_base->hctl);
  211. writel(readl(&mmc_base->capa) | VS30_3V0SUP | VS18_1V8SUP,
  212. &mmc_base->capa);
  213. reg_val = readl(&mmc_base->con) & RESERVED_MASK;
  214. writel(CTPL_MMC_SD | reg_val | WPP_ACTIVEHIGH | CDP_ACTIVEHIGH |
  215. MIT_CTO | DW8_1_4BITMODE | MODE_FUNC | STR_BLOCK |
  216. HR_NOHOSTRESP | INIT_NOINIT | NOOPENDRAIN, &mmc_base->con);
  217. dsor = 240;
  218. mmc_reg_out(&mmc_base->sysctl, (ICE_MASK | DTO_MASK | CEN_MASK),
  219. (ICE_STOP | DTO_15THDTO | CEN_DISABLE));
  220. mmc_reg_out(&mmc_base->sysctl, ICE_MASK | CLKD_MASK,
  221. (dsor << CLKD_OFFSET) | ICE_OSCILLATE);
  222. start = get_timer(0);
  223. while ((readl(&mmc_base->sysctl) & ICS_MASK) == ICS_NOTREADY) {
  224. if (get_timer(0) - start > MAX_RETRY_MS) {
  225. printf("%s: timedout waiting for ics!\n", __func__);
  226. return TIMEOUT;
  227. }
  228. }
  229. writel(readl(&mmc_base->sysctl) | CEN_ENABLE, &mmc_base->sysctl);
  230. writel(readl(&mmc_base->hctl) | SDBP_PWRON, &mmc_base->hctl);
  231. writel(IE_BADA | IE_CERR | IE_DEB | IE_DCRC | IE_DTO | IE_CIE |
  232. IE_CEB | IE_CCRC | IE_CTO | IE_BRR | IE_BWR | IE_TC | IE_CC,
  233. &mmc_base->ie);
  234. mmc_init_stream(mmc_base);
  235. return 0;
  236. }
  237. /*
  238. * MMC controller internal finite state machine reset
  239. *
  240. * Used to reset command or data internal state machines, using respectively
  241. * SRC or SRD bit of SYSCTL register
  242. */
  243. static void mmc_reset_controller_fsm(struct hsmmc *mmc_base, u32 bit)
  244. {
  245. ulong start;
  246. mmc_reg_out(&mmc_base->sysctl, bit, bit);
  247. start = get_timer(0);
  248. while ((readl(&mmc_base->sysctl) & bit) != 0) {
  249. if (get_timer(0) - start > MAX_RETRY_MS) {
  250. printf("%s: timedout waiting for sysctl %x to clear\n",
  251. __func__, bit);
  252. return;
  253. }
  254. }
  255. }
  256. static int mmc_send_cmd(struct mmc *mmc, struct mmc_cmd *cmd,
  257. struct mmc_data *data)
  258. {
  259. struct hsmmc *mmc_base;
  260. unsigned int flags, mmc_stat;
  261. ulong start;
  262. mmc_base = ((struct omap_hsmmc_data *)mmc->priv)->base_addr;
  263. start = get_timer(0);
  264. while ((readl(&mmc_base->pstate) & (DATI_MASK | CMDI_MASK)) != 0) {
  265. if (get_timer(0) - start > MAX_RETRY_MS) {
  266. printf("%s: timedout waiting on cmd inhibit to clear\n",
  267. __func__);
  268. return TIMEOUT;
  269. }
  270. }
  271. writel(0xFFFFFFFF, &mmc_base->stat);
  272. start = get_timer(0);
  273. while (readl(&mmc_base->stat)) {
  274. if (get_timer(0) - start > MAX_RETRY_MS) {
  275. printf("%s: timedout waiting for STAT (%x) to clear\n",
  276. __func__, readl(&mmc_base->stat));
  277. return TIMEOUT;
  278. }
  279. }
  280. /*
  281. * CMDREG
  282. * CMDIDX[13:8] : Command index
  283. * DATAPRNT[5] : Data Present Select
  284. * ENCMDIDX[4] : Command Index Check Enable
  285. * ENCMDCRC[3] : Command CRC Check Enable
  286. * RSPTYP[1:0]
  287. * 00 = No Response
  288. * 01 = Length 136
  289. * 10 = Length 48
  290. * 11 = Length 48 Check busy after response
  291. */
  292. /* Delay added before checking the status of frq change
  293. * retry not supported by mmc.c(core file)
  294. */
  295. if (cmd->cmdidx == SD_CMD_APP_SEND_SCR)
  296. udelay(50000); /* wait 50 ms */
  297. if (!(cmd->resp_type & MMC_RSP_PRESENT))
  298. flags = 0;
  299. else if (cmd->resp_type & MMC_RSP_136)
  300. flags = RSP_TYPE_LGHT136 | CICE_NOCHECK;
  301. else if (cmd->resp_type & MMC_RSP_BUSY)
  302. flags = RSP_TYPE_LGHT48B;
  303. else
  304. flags = RSP_TYPE_LGHT48;
  305. /* enable default flags */
  306. flags = flags | (CMD_TYPE_NORMAL | CICE_NOCHECK | CCCE_NOCHECK |
  307. MSBS_SGLEBLK | ACEN_DISABLE | BCE_DISABLE | DE_DISABLE);
  308. if (cmd->resp_type & MMC_RSP_CRC)
  309. flags |= CCCE_CHECK;
  310. if (cmd->resp_type & MMC_RSP_OPCODE)
  311. flags |= CICE_CHECK;
  312. if (data) {
  313. if ((cmd->cmdidx == MMC_CMD_READ_MULTIPLE_BLOCK) ||
  314. (cmd->cmdidx == MMC_CMD_WRITE_MULTIPLE_BLOCK)) {
  315. flags |= (MSBS_MULTIBLK | BCE_ENABLE);
  316. data->blocksize = 512;
  317. writel(data->blocksize | (data->blocks << 16),
  318. &mmc_base->blk);
  319. } else
  320. writel(data->blocksize | NBLK_STPCNT, &mmc_base->blk);
  321. if (data->flags & MMC_DATA_READ)
  322. flags |= (DP_DATA | DDIR_READ);
  323. else
  324. flags |= (DP_DATA | DDIR_WRITE);
  325. }
  326. writel(cmd->cmdarg, &mmc_base->arg);
  327. writel((cmd->cmdidx << 24) | flags, &mmc_base->cmd);
  328. start = get_timer(0);
  329. do {
  330. mmc_stat = readl(&mmc_base->stat);
  331. if (get_timer(0) - start > MAX_RETRY_MS) {
  332. printf("%s : timeout: No status update\n", __func__);
  333. return TIMEOUT;
  334. }
  335. } while (!mmc_stat);
  336. if ((mmc_stat & IE_CTO) != 0) {
  337. mmc_reset_controller_fsm(mmc_base, SYSCTL_SRC);
  338. return TIMEOUT;
  339. } else if ((mmc_stat & ERRI_MASK) != 0)
  340. return -1;
  341. if (mmc_stat & CC_MASK) {
  342. writel(CC_MASK, &mmc_base->stat);
  343. if (cmd->resp_type & MMC_RSP_PRESENT) {
  344. if (cmd->resp_type & MMC_RSP_136) {
  345. /* response type 2 */
  346. cmd->response[3] = readl(&mmc_base->rsp10);
  347. cmd->response[2] = readl(&mmc_base->rsp32);
  348. cmd->response[1] = readl(&mmc_base->rsp54);
  349. cmd->response[0] = readl(&mmc_base->rsp76);
  350. } else
  351. /* response types 1, 1b, 3, 4, 5, 6 */
  352. cmd->response[0] = readl(&mmc_base->rsp10);
  353. }
  354. }
  355. if (data && (data->flags & MMC_DATA_READ)) {
  356. mmc_read_data(mmc_base, data->dest,
  357. data->blocksize * data->blocks);
  358. } else if (data && (data->flags & MMC_DATA_WRITE)) {
  359. mmc_write_data(mmc_base, data->src,
  360. data->blocksize * data->blocks);
  361. }
  362. return 0;
  363. }
  364. static int mmc_read_data(struct hsmmc *mmc_base, char *buf, unsigned int size)
  365. {
  366. unsigned int *output_buf = (unsigned int *)buf;
  367. unsigned int mmc_stat;
  368. unsigned int count;
  369. /*
  370. * Start Polled Read
  371. */
  372. count = (size > MMCSD_SECTOR_SIZE) ? MMCSD_SECTOR_SIZE : size;
  373. count /= 4;
  374. while (size) {
  375. ulong start = get_timer(0);
  376. do {
  377. mmc_stat = readl(&mmc_base->stat);
  378. if (get_timer(0) - start > MAX_RETRY_MS) {
  379. printf("%s: timedout waiting for status!\n",
  380. __func__);
  381. return TIMEOUT;
  382. }
  383. } while (mmc_stat == 0);
  384. if ((mmc_stat & (IE_DTO | IE_DCRC | IE_DEB)) != 0)
  385. mmc_reset_controller_fsm(mmc_base, SYSCTL_SRD);
  386. if ((mmc_stat & ERRI_MASK) != 0)
  387. return 1;
  388. if (mmc_stat & BRR_MASK) {
  389. unsigned int k;
  390. writel(readl(&mmc_base->stat) | BRR_MASK,
  391. &mmc_base->stat);
  392. for (k = 0; k < count; k++) {
  393. *output_buf = readl(&mmc_base->data);
  394. output_buf++;
  395. }
  396. size -= (count*4);
  397. }
  398. if (mmc_stat & BWR_MASK)
  399. writel(readl(&mmc_base->stat) | BWR_MASK,
  400. &mmc_base->stat);
  401. if (mmc_stat & TC_MASK) {
  402. writel(readl(&mmc_base->stat) | TC_MASK,
  403. &mmc_base->stat);
  404. break;
  405. }
  406. }
  407. return 0;
  408. }
  409. static int mmc_write_data(struct hsmmc *mmc_base, const char *buf,
  410. unsigned int size)
  411. {
  412. unsigned int *input_buf = (unsigned int *)buf;
  413. unsigned int mmc_stat;
  414. unsigned int count;
  415. /*
  416. * Start Polled Read
  417. */
  418. count = (size > MMCSD_SECTOR_SIZE) ? MMCSD_SECTOR_SIZE : size;
  419. count /= 4;
  420. while (size) {
  421. ulong start = get_timer(0);
  422. do {
  423. mmc_stat = readl(&mmc_base->stat);
  424. if (get_timer(0) - start > MAX_RETRY_MS) {
  425. printf("%s: timedout waiting for status!\n",
  426. __func__);
  427. return TIMEOUT;
  428. }
  429. } while (mmc_stat == 0);
  430. if ((mmc_stat & (IE_DTO | IE_DCRC | IE_DEB)) != 0)
  431. mmc_reset_controller_fsm(mmc_base, SYSCTL_SRD);
  432. if ((mmc_stat & ERRI_MASK) != 0)
  433. return 1;
  434. if (mmc_stat & BWR_MASK) {
  435. unsigned int k;
  436. writel(readl(&mmc_base->stat) | BWR_MASK,
  437. &mmc_base->stat);
  438. for (k = 0; k < count; k++) {
  439. writel(*input_buf, &mmc_base->data);
  440. input_buf++;
  441. }
  442. size -= (count*4);
  443. }
  444. if (mmc_stat & BRR_MASK)
  445. writel(readl(&mmc_base->stat) | BRR_MASK,
  446. &mmc_base->stat);
  447. if (mmc_stat & TC_MASK) {
  448. writel(readl(&mmc_base->stat) | TC_MASK,
  449. &mmc_base->stat);
  450. break;
  451. }
  452. }
  453. return 0;
  454. }
  455. static void mmc_set_ios(struct mmc *mmc)
  456. {
  457. struct hsmmc *mmc_base;
  458. unsigned int dsor = 0;
  459. ulong start;
  460. mmc_base = ((struct omap_hsmmc_data *)mmc->priv)->base_addr;
  461. /* configue bus width */
  462. switch (mmc->bus_width) {
  463. case 8:
  464. writel(readl(&mmc_base->con) | DTW_8_BITMODE,
  465. &mmc_base->con);
  466. break;
  467. case 4:
  468. writel(readl(&mmc_base->con) & ~DTW_8_BITMODE,
  469. &mmc_base->con);
  470. writel(readl(&mmc_base->hctl) | DTW_4_BITMODE,
  471. &mmc_base->hctl);
  472. break;
  473. case 1:
  474. default:
  475. writel(readl(&mmc_base->con) & ~DTW_8_BITMODE,
  476. &mmc_base->con);
  477. writel(readl(&mmc_base->hctl) & ~DTW_4_BITMODE,
  478. &mmc_base->hctl);
  479. break;
  480. }
  481. /* configure clock with 96Mhz system clock.
  482. */
  483. if (mmc->clock != 0) {
  484. dsor = (MMC_CLOCK_REFERENCE * 1000000 / mmc->clock);
  485. if ((MMC_CLOCK_REFERENCE * 1000000) / dsor > mmc->clock)
  486. dsor++;
  487. }
  488. mmc_reg_out(&mmc_base->sysctl, (ICE_MASK | DTO_MASK | CEN_MASK),
  489. (ICE_STOP | DTO_15THDTO | CEN_DISABLE));
  490. mmc_reg_out(&mmc_base->sysctl, ICE_MASK | CLKD_MASK,
  491. (dsor << CLKD_OFFSET) | ICE_OSCILLATE);
  492. start = get_timer(0);
  493. while ((readl(&mmc_base->sysctl) & ICS_MASK) == ICS_NOTREADY) {
  494. if (get_timer(0) - start > MAX_RETRY_MS) {
  495. printf("%s: timedout waiting for ics!\n", __func__);
  496. return;
  497. }
  498. }
  499. writel(readl(&mmc_base->sysctl) | CEN_ENABLE, &mmc_base->sysctl);
  500. }
  501. int omap_mmc_init(int dev_index, uint host_caps_mask, uint f_max, int cd_gpio,
  502. int wp_gpio)
  503. {
  504. struct mmc *mmc = &hsmmc_dev[dev_index];
  505. struct omap_hsmmc_data *priv_data = &hsmmc_dev_data[dev_index];
  506. sprintf(mmc->name, "OMAP SD/MMC");
  507. mmc->send_cmd = mmc_send_cmd;
  508. mmc->set_ios = mmc_set_ios;
  509. mmc->init = mmc_init_setup;
  510. mmc->priv = priv_data;
  511. switch (dev_index) {
  512. case 0:
  513. priv_data->base_addr = (struct hsmmc *)OMAP_HSMMC1_BASE;
  514. break;
  515. #ifdef OMAP_HSMMC2_BASE
  516. case 1:
  517. priv_data->base_addr = (struct hsmmc *)OMAP_HSMMC2_BASE;
  518. break;
  519. #endif
  520. #ifdef OMAP_HSMMC3_BASE
  521. case 2:
  522. priv_data->base_addr = (struct hsmmc *)OMAP_HSMMC3_BASE;
  523. break;
  524. #endif
  525. default:
  526. priv_data->base_addr = (struct hsmmc *)OMAP_HSMMC1_BASE;
  527. return 1;
  528. }
  529. priv_data->cd_gpio = omap_mmc_setup_gpio_in(cd_gpio, "mmc_cd");
  530. if (priv_data->cd_gpio != -1)
  531. mmc->getcd = omap_mmc_getcd;
  532. priv_data->wp_gpio = omap_mmc_setup_gpio_in(wp_gpio, "mmc_wp");
  533. if (priv_data->wp_gpio != -1)
  534. mmc->getwp = omap_mmc_getwp;
  535. mmc->voltages = MMC_VDD_32_33 | MMC_VDD_33_34 | MMC_VDD_165_195;
  536. mmc->host_caps = (MMC_MODE_4BIT | MMC_MODE_HS_52MHz | MMC_MODE_HS |
  537. MMC_MODE_HC) & ~host_caps_mask;
  538. mmc->f_min = 400000;
  539. if (f_max != 0)
  540. mmc->f_max = f_max;
  541. else {
  542. if (mmc->host_caps & MMC_MODE_HS) {
  543. if (mmc->host_caps & MMC_MODE_HS_52MHz)
  544. mmc->f_max = 52000000;
  545. else
  546. mmc->f_max = 26000000;
  547. } else
  548. mmc->f_max = 20000000;
  549. }
  550. mmc->b_max = 0;
  551. #if defined(CONFIG_OMAP34XX)
  552. /*
  553. * Silicon revs 2.1 and older do not support multiblock transfers.
  554. */
  555. if ((get_cpu_family() == CPU_OMAP34XX) && (get_cpu_rev() <= CPU_3XX_ES21))
  556. mmc->b_max = 1;
  557. #endif
  558. mmc_register(mmc);
  559. return 0;
  560. }