core.c 45 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921
  1. /*
  2. * linux/drivers/mmc/core/core.c
  3. *
  4. * Copyright (C) 2003-2004 Russell King, All Rights Reserved.
  5. * SD support Copyright (C) 2004 Ian Molton, All Rights Reserved.
  6. * Copyright (C) 2005-2008 Pierre Ossman, All Rights Reserved.
  7. * MMCv4 support Copyright (C) 2006 Philip Langdale, All Rights Reserved.
  8. *
  9. * This program is free software; you can redistribute it and/or modify
  10. * it under the terms of the GNU General Public License version 2 as
  11. * published by the Free Software Foundation.
  12. */
  13. #include <linux/module.h>
  14. #include <linux/init.h>
  15. #include <linux/interrupt.h>
  16. #include <linux/completion.h>
  17. #include <linux/device.h>
  18. #include <linux/delay.h>
  19. #include <linux/pagemap.h>
  20. #include <linux/err.h>
  21. #include <linux/leds.h>
  22. #include <linux/scatterlist.h>
  23. #include <linux/log2.h>
  24. #include <linux/regulator/consumer.h>
  25. #include <linux/pm_runtime.h>
  26. #include <linux/mmc/card.h>
  27. #include <linux/mmc/host.h>
  28. #include <linux/mmc/mmc.h>
  29. #include <linux/mmc/sd.h>
  30. #include "core.h"
  31. #include "bus.h"
  32. #include "host.h"
  33. #include "sdio_bus.h"
  34. #include "mmc_ops.h"
  35. #include "sd_ops.h"
  36. #include "sdio_ops.h"
  37. static struct workqueue_struct *workqueue;
  38. /*
  39. * Enabling software CRCs on the data blocks can be a significant (30%)
  40. * performance cost, and for other reasons may not always be desired.
  41. * So we allow it it to be disabled.
  42. */
  43. int use_spi_crc = 1;
  44. module_param(use_spi_crc, bool, 0);
  45. /*
  46. * We normally treat cards as removed during suspend if they are not
  47. * known to be on a non-removable bus, to avoid the risk of writing
  48. * back data to a different card after resume. Allow this to be
  49. * overridden if necessary.
  50. */
  51. #ifdef CONFIG_MMC_UNSAFE_RESUME
  52. int mmc_assume_removable;
  53. #else
  54. int mmc_assume_removable = 1;
  55. #endif
  56. EXPORT_SYMBOL(mmc_assume_removable);
  57. module_param_named(removable, mmc_assume_removable, bool, 0644);
  58. MODULE_PARM_DESC(
  59. removable,
  60. "MMC/SD cards are removable and may be removed during suspend");
  61. /*
  62. * Internal function. Schedule delayed work in the MMC work queue.
  63. */
  64. static int mmc_schedule_delayed_work(struct delayed_work *work,
  65. unsigned long delay)
  66. {
  67. return queue_delayed_work(workqueue, work, delay);
  68. }
  69. /*
  70. * Internal function. Flush all scheduled work from the MMC work queue.
  71. */
  72. static void mmc_flush_scheduled_work(void)
  73. {
  74. flush_workqueue(workqueue);
  75. }
  76. /**
  77. * mmc_request_done - finish processing an MMC request
  78. * @host: MMC host which completed request
  79. * @mrq: MMC request which request
  80. *
  81. * MMC drivers should call this function when they have completed
  82. * their processing of a request.
  83. */
  84. void mmc_request_done(struct mmc_host *host, struct mmc_request *mrq)
  85. {
  86. struct mmc_command *cmd = mrq->cmd;
  87. int err = cmd->error;
  88. if (err && cmd->retries && mmc_host_is_spi(host)) {
  89. if (cmd->resp[0] & R1_SPI_ILLEGAL_COMMAND)
  90. cmd->retries = 0;
  91. }
  92. if (err && cmd->retries) {
  93. pr_debug("%s: req failed (CMD%u): %d, retrying...\n",
  94. mmc_hostname(host), cmd->opcode, err);
  95. cmd->retries--;
  96. cmd->error = 0;
  97. host->ops->request(host, mrq);
  98. } else {
  99. led_trigger_event(host->led, LED_OFF);
  100. pr_debug("%s: req done (CMD%u): %d: %08x %08x %08x %08x\n",
  101. mmc_hostname(host), cmd->opcode, err,
  102. cmd->resp[0], cmd->resp[1],
  103. cmd->resp[2], cmd->resp[3]);
  104. if (mrq->data) {
  105. pr_debug("%s: %d bytes transferred: %d\n",
  106. mmc_hostname(host),
  107. mrq->data->bytes_xfered, mrq->data->error);
  108. }
  109. if (mrq->stop) {
  110. pr_debug("%s: (CMD%u): %d: %08x %08x %08x %08x\n",
  111. mmc_hostname(host), mrq->stop->opcode,
  112. mrq->stop->error,
  113. mrq->stop->resp[0], mrq->stop->resp[1],
  114. mrq->stop->resp[2], mrq->stop->resp[3]);
  115. }
  116. if (mrq->done)
  117. mrq->done(mrq);
  118. mmc_host_clk_gate(host);
  119. }
  120. }
  121. EXPORT_SYMBOL(mmc_request_done);
  122. static void
  123. mmc_start_request(struct mmc_host *host, struct mmc_request *mrq)
  124. {
  125. #ifdef CONFIG_MMC_DEBUG
  126. unsigned int i, sz;
  127. struct scatterlist *sg;
  128. #endif
  129. pr_debug("%s: starting CMD%u arg %08x flags %08x\n",
  130. mmc_hostname(host), mrq->cmd->opcode,
  131. mrq->cmd->arg, mrq->cmd->flags);
  132. if (mrq->data) {
  133. pr_debug("%s: blksz %d blocks %d flags %08x "
  134. "tsac %d ms nsac %d\n",
  135. mmc_hostname(host), mrq->data->blksz,
  136. mrq->data->blocks, mrq->data->flags,
  137. mrq->data->timeout_ns / 1000000,
  138. mrq->data->timeout_clks);
  139. }
  140. if (mrq->stop) {
  141. pr_debug("%s: CMD%u arg %08x flags %08x\n",
  142. mmc_hostname(host), mrq->stop->opcode,
  143. mrq->stop->arg, mrq->stop->flags);
  144. }
  145. WARN_ON(!host->claimed);
  146. mrq->cmd->error = 0;
  147. mrq->cmd->mrq = mrq;
  148. if (mrq->data) {
  149. BUG_ON(mrq->data->blksz > host->max_blk_size);
  150. BUG_ON(mrq->data->blocks > host->max_blk_count);
  151. BUG_ON(mrq->data->blocks * mrq->data->blksz >
  152. host->max_req_size);
  153. #ifdef CONFIG_MMC_DEBUG
  154. sz = 0;
  155. for_each_sg(mrq->data->sg, sg, mrq->data->sg_len, i)
  156. sz += sg->length;
  157. BUG_ON(sz != mrq->data->blocks * mrq->data->blksz);
  158. #endif
  159. mrq->cmd->data = mrq->data;
  160. mrq->data->error = 0;
  161. mrq->data->mrq = mrq;
  162. if (mrq->stop) {
  163. mrq->data->stop = mrq->stop;
  164. mrq->stop->error = 0;
  165. mrq->stop->mrq = mrq;
  166. }
  167. }
  168. mmc_host_clk_ungate(host);
  169. led_trigger_event(host->led, LED_FULL);
  170. host->ops->request(host, mrq);
  171. }
  172. static void mmc_wait_done(struct mmc_request *mrq)
  173. {
  174. complete(mrq->done_data);
  175. }
  176. /**
  177. * mmc_wait_for_req - start a request and wait for completion
  178. * @host: MMC host to start command
  179. * @mrq: MMC request to start
  180. *
  181. * Start a new MMC custom command request for a host, and wait
  182. * for the command to complete. Does not attempt to parse the
  183. * response.
  184. */
  185. void mmc_wait_for_req(struct mmc_host *host, struct mmc_request *mrq)
  186. {
  187. DECLARE_COMPLETION_ONSTACK(complete);
  188. mrq->done_data = &complete;
  189. mrq->done = mmc_wait_done;
  190. mmc_start_request(host, mrq);
  191. wait_for_completion(&complete);
  192. }
  193. EXPORT_SYMBOL(mmc_wait_for_req);
  194. /**
  195. * mmc_wait_for_cmd - start a command and wait for completion
  196. * @host: MMC host to start command
  197. * @cmd: MMC command to start
  198. * @retries: maximum number of retries
  199. *
  200. * Start a new MMC command for a host, and wait for the command
  201. * to complete. Return any error that occurred while the command
  202. * was executing. Do not attempt to parse the response.
  203. */
  204. int mmc_wait_for_cmd(struct mmc_host *host, struct mmc_command *cmd, int retries)
  205. {
  206. struct mmc_request mrq = {0};
  207. WARN_ON(!host->claimed);
  208. memset(cmd->resp, 0, sizeof(cmd->resp));
  209. cmd->retries = retries;
  210. mrq.cmd = cmd;
  211. cmd->data = NULL;
  212. mmc_wait_for_req(host, &mrq);
  213. return cmd->error;
  214. }
  215. EXPORT_SYMBOL(mmc_wait_for_cmd);
  216. /**
  217. * mmc_set_data_timeout - set the timeout for a data command
  218. * @data: data phase for command
  219. * @card: the MMC card associated with the data transfer
  220. *
  221. * Computes the data timeout parameters according to the
  222. * correct algorithm given the card type.
  223. */
  224. void mmc_set_data_timeout(struct mmc_data *data, const struct mmc_card *card)
  225. {
  226. unsigned int mult;
  227. /*
  228. * SDIO cards only define an upper 1 s limit on access.
  229. */
  230. if (mmc_card_sdio(card)) {
  231. data->timeout_ns = 1000000000;
  232. data->timeout_clks = 0;
  233. return;
  234. }
  235. /*
  236. * SD cards use a 100 multiplier rather than 10
  237. */
  238. mult = mmc_card_sd(card) ? 100 : 10;
  239. /*
  240. * Scale up the multiplier (and therefore the timeout) by
  241. * the r2w factor for writes.
  242. */
  243. if (data->flags & MMC_DATA_WRITE)
  244. mult <<= card->csd.r2w_factor;
  245. data->timeout_ns = card->csd.tacc_ns * mult;
  246. data->timeout_clks = card->csd.tacc_clks * mult;
  247. /*
  248. * SD cards also have an upper limit on the timeout.
  249. */
  250. if (mmc_card_sd(card)) {
  251. unsigned int timeout_us, limit_us;
  252. timeout_us = data->timeout_ns / 1000;
  253. if (mmc_host_clk_rate(card->host))
  254. timeout_us += data->timeout_clks * 1000 /
  255. (mmc_host_clk_rate(card->host) / 1000);
  256. if (data->flags & MMC_DATA_WRITE)
  257. /*
  258. * The limit is really 250 ms, but that is
  259. * insufficient for some crappy cards.
  260. */
  261. limit_us = 300000;
  262. else
  263. limit_us = 100000;
  264. /*
  265. * SDHC cards always use these fixed values.
  266. */
  267. if (timeout_us > limit_us || mmc_card_blockaddr(card)) {
  268. data->timeout_ns = limit_us * 1000;
  269. data->timeout_clks = 0;
  270. }
  271. }
  272. /*
  273. * Some cards need very high timeouts if driven in SPI mode.
  274. * The worst observed timeout was 900ms after writing a
  275. * continuous stream of data until the internal logic
  276. * overflowed.
  277. */
  278. if (mmc_host_is_spi(card->host)) {
  279. if (data->flags & MMC_DATA_WRITE) {
  280. if (data->timeout_ns < 1000000000)
  281. data->timeout_ns = 1000000000; /* 1s */
  282. } else {
  283. if (data->timeout_ns < 100000000)
  284. data->timeout_ns = 100000000; /* 100ms */
  285. }
  286. }
  287. }
  288. EXPORT_SYMBOL(mmc_set_data_timeout);
  289. /**
  290. * mmc_align_data_size - pads a transfer size to a more optimal value
  291. * @card: the MMC card associated with the data transfer
  292. * @sz: original transfer size
  293. *
  294. * Pads the original data size with a number of extra bytes in
  295. * order to avoid controller bugs and/or performance hits
  296. * (e.g. some controllers revert to PIO for certain sizes).
  297. *
  298. * Returns the improved size, which might be unmodified.
  299. *
  300. * Note that this function is only relevant when issuing a
  301. * single scatter gather entry.
  302. */
  303. unsigned int mmc_align_data_size(struct mmc_card *card, unsigned int sz)
  304. {
  305. /*
  306. * FIXME: We don't have a system for the controller to tell
  307. * the core about its problems yet, so for now we just 32-bit
  308. * align the size.
  309. */
  310. sz = ((sz + 3) / 4) * 4;
  311. return sz;
  312. }
  313. EXPORT_SYMBOL(mmc_align_data_size);
  314. /**
  315. * mmc_host_enable - enable a host.
  316. * @host: mmc host to enable
  317. *
  318. * Hosts that support power saving can use the 'enable' and 'disable'
  319. * methods to exit and enter power saving states. For more information
  320. * see comments for struct mmc_host_ops.
  321. */
  322. int mmc_host_enable(struct mmc_host *host)
  323. {
  324. if (!(host->caps & MMC_CAP_DISABLE))
  325. return 0;
  326. if (host->en_dis_recurs)
  327. return 0;
  328. if (host->nesting_cnt++)
  329. return 0;
  330. cancel_delayed_work_sync(&host->disable);
  331. if (host->enabled)
  332. return 0;
  333. if (host->ops->enable) {
  334. int err;
  335. host->en_dis_recurs = 1;
  336. err = host->ops->enable(host);
  337. host->en_dis_recurs = 0;
  338. if (err) {
  339. pr_debug("%s: enable error %d\n",
  340. mmc_hostname(host), err);
  341. return err;
  342. }
  343. }
  344. host->enabled = 1;
  345. return 0;
  346. }
  347. EXPORT_SYMBOL(mmc_host_enable);
  348. static int mmc_host_do_disable(struct mmc_host *host, int lazy)
  349. {
  350. if (host->ops->disable) {
  351. int err;
  352. host->en_dis_recurs = 1;
  353. err = host->ops->disable(host, lazy);
  354. host->en_dis_recurs = 0;
  355. if (err < 0) {
  356. pr_debug("%s: disable error %d\n",
  357. mmc_hostname(host), err);
  358. return err;
  359. }
  360. if (err > 0) {
  361. unsigned long delay = msecs_to_jiffies(err);
  362. mmc_schedule_delayed_work(&host->disable, delay);
  363. }
  364. }
  365. host->enabled = 0;
  366. return 0;
  367. }
  368. /**
  369. * mmc_host_disable - disable a host.
  370. * @host: mmc host to disable
  371. *
  372. * Hosts that support power saving can use the 'enable' and 'disable'
  373. * methods to exit and enter power saving states. For more information
  374. * see comments for struct mmc_host_ops.
  375. */
  376. int mmc_host_disable(struct mmc_host *host)
  377. {
  378. int err;
  379. if (!(host->caps & MMC_CAP_DISABLE))
  380. return 0;
  381. if (host->en_dis_recurs)
  382. return 0;
  383. if (--host->nesting_cnt)
  384. return 0;
  385. if (!host->enabled)
  386. return 0;
  387. err = mmc_host_do_disable(host, 0);
  388. return err;
  389. }
  390. EXPORT_SYMBOL(mmc_host_disable);
  391. /**
  392. * __mmc_claim_host - exclusively claim a host
  393. * @host: mmc host to claim
  394. * @abort: whether or not the operation should be aborted
  395. *
  396. * Claim a host for a set of operations. If @abort is non null and
  397. * dereference a non-zero value then this will return prematurely with
  398. * that non-zero value without acquiring the lock. Returns zero
  399. * with the lock held otherwise.
  400. */
  401. int __mmc_claim_host(struct mmc_host *host, atomic_t *abort)
  402. {
  403. DECLARE_WAITQUEUE(wait, current);
  404. unsigned long flags;
  405. int stop;
  406. might_sleep();
  407. add_wait_queue(&host->wq, &wait);
  408. spin_lock_irqsave(&host->lock, flags);
  409. while (1) {
  410. set_current_state(TASK_UNINTERRUPTIBLE);
  411. stop = abort ? atomic_read(abort) : 0;
  412. if (stop || !host->claimed || host->claimer == current)
  413. break;
  414. spin_unlock_irqrestore(&host->lock, flags);
  415. schedule();
  416. spin_lock_irqsave(&host->lock, flags);
  417. }
  418. set_current_state(TASK_RUNNING);
  419. if (!stop) {
  420. host->claimed = 1;
  421. host->claimer = current;
  422. host->claim_cnt += 1;
  423. } else
  424. wake_up(&host->wq);
  425. spin_unlock_irqrestore(&host->lock, flags);
  426. remove_wait_queue(&host->wq, &wait);
  427. if (!stop)
  428. mmc_host_enable(host);
  429. return stop;
  430. }
  431. EXPORT_SYMBOL(__mmc_claim_host);
  432. /**
  433. * mmc_try_claim_host - try exclusively to claim a host
  434. * @host: mmc host to claim
  435. *
  436. * Returns %1 if the host is claimed, %0 otherwise.
  437. */
  438. int mmc_try_claim_host(struct mmc_host *host)
  439. {
  440. int claimed_host = 0;
  441. unsigned long flags;
  442. spin_lock_irqsave(&host->lock, flags);
  443. if (!host->claimed || host->claimer == current) {
  444. host->claimed = 1;
  445. host->claimer = current;
  446. host->claim_cnt += 1;
  447. claimed_host = 1;
  448. }
  449. spin_unlock_irqrestore(&host->lock, flags);
  450. return claimed_host;
  451. }
  452. EXPORT_SYMBOL(mmc_try_claim_host);
  453. /**
  454. * mmc_do_release_host - release a claimed host
  455. * @host: mmc host to release
  456. *
  457. * If you successfully claimed a host, this function will
  458. * release it again.
  459. */
  460. void mmc_do_release_host(struct mmc_host *host)
  461. {
  462. unsigned long flags;
  463. spin_lock_irqsave(&host->lock, flags);
  464. if (--host->claim_cnt) {
  465. /* Release for nested claim */
  466. spin_unlock_irqrestore(&host->lock, flags);
  467. } else {
  468. host->claimed = 0;
  469. host->claimer = NULL;
  470. spin_unlock_irqrestore(&host->lock, flags);
  471. wake_up(&host->wq);
  472. }
  473. }
  474. EXPORT_SYMBOL(mmc_do_release_host);
  475. void mmc_host_deeper_disable(struct work_struct *work)
  476. {
  477. struct mmc_host *host =
  478. container_of(work, struct mmc_host, disable.work);
  479. /* If the host is claimed then we do not want to disable it anymore */
  480. if (!mmc_try_claim_host(host))
  481. return;
  482. mmc_host_do_disable(host, 1);
  483. mmc_do_release_host(host);
  484. }
  485. /**
  486. * mmc_host_lazy_disable - lazily disable a host.
  487. * @host: mmc host to disable
  488. *
  489. * Hosts that support power saving can use the 'enable' and 'disable'
  490. * methods to exit and enter power saving states. For more information
  491. * see comments for struct mmc_host_ops.
  492. */
  493. int mmc_host_lazy_disable(struct mmc_host *host)
  494. {
  495. if (!(host->caps & MMC_CAP_DISABLE))
  496. return 0;
  497. if (host->en_dis_recurs)
  498. return 0;
  499. if (--host->nesting_cnt)
  500. return 0;
  501. if (!host->enabled)
  502. return 0;
  503. if (host->disable_delay) {
  504. mmc_schedule_delayed_work(&host->disable,
  505. msecs_to_jiffies(host->disable_delay));
  506. return 0;
  507. } else
  508. return mmc_host_do_disable(host, 1);
  509. }
  510. EXPORT_SYMBOL(mmc_host_lazy_disable);
  511. /**
  512. * mmc_release_host - release a host
  513. * @host: mmc host to release
  514. *
  515. * Release a MMC host, allowing others to claim the host
  516. * for their operations.
  517. */
  518. void mmc_release_host(struct mmc_host *host)
  519. {
  520. WARN_ON(!host->claimed);
  521. mmc_host_lazy_disable(host);
  522. mmc_do_release_host(host);
  523. }
  524. EXPORT_SYMBOL(mmc_release_host);
  525. /*
  526. * Internal function that does the actual ios call to the host driver,
  527. * optionally printing some debug output.
  528. */
  529. static inline void mmc_set_ios(struct mmc_host *host)
  530. {
  531. struct mmc_ios *ios = &host->ios;
  532. pr_debug("%s: clock %uHz busmode %u powermode %u cs %u Vdd %u "
  533. "width %u timing %u\n",
  534. mmc_hostname(host), ios->clock, ios->bus_mode,
  535. ios->power_mode, ios->chip_select, ios->vdd,
  536. ios->bus_width, ios->timing);
  537. if (ios->clock > 0)
  538. mmc_set_ungated(host);
  539. host->ops->set_ios(host, ios);
  540. }
  541. /*
  542. * Control chip select pin on a host.
  543. */
  544. void mmc_set_chip_select(struct mmc_host *host, int mode)
  545. {
  546. host->ios.chip_select = mode;
  547. mmc_set_ios(host);
  548. }
  549. /*
  550. * Sets the host clock to the highest possible frequency that
  551. * is below "hz".
  552. */
  553. void mmc_set_clock(struct mmc_host *host, unsigned int hz)
  554. {
  555. WARN_ON(hz < host->f_min);
  556. if (hz > host->f_max)
  557. hz = host->f_max;
  558. host->ios.clock = hz;
  559. mmc_set_ios(host);
  560. }
  561. #ifdef CONFIG_MMC_CLKGATE
  562. /*
  563. * This gates the clock by setting it to 0 Hz.
  564. */
  565. void mmc_gate_clock(struct mmc_host *host)
  566. {
  567. unsigned long flags;
  568. spin_lock_irqsave(&host->clk_lock, flags);
  569. host->clk_old = host->ios.clock;
  570. host->ios.clock = 0;
  571. host->clk_gated = true;
  572. spin_unlock_irqrestore(&host->clk_lock, flags);
  573. mmc_set_ios(host);
  574. }
  575. /*
  576. * This restores the clock from gating by using the cached
  577. * clock value.
  578. */
  579. void mmc_ungate_clock(struct mmc_host *host)
  580. {
  581. /*
  582. * We should previously have gated the clock, so the clock shall
  583. * be 0 here! The clock may however be 0 during initialization,
  584. * when some request operations are performed before setting
  585. * the frequency. When ungate is requested in that situation
  586. * we just ignore the call.
  587. */
  588. if (host->clk_old) {
  589. BUG_ON(host->ios.clock);
  590. /* This call will also set host->clk_gated to false */
  591. mmc_set_clock(host, host->clk_old);
  592. }
  593. }
  594. void mmc_set_ungated(struct mmc_host *host)
  595. {
  596. unsigned long flags;
  597. /*
  598. * We've been given a new frequency while the clock is gated,
  599. * so make sure we regard this as ungating it.
  600. */
  601. spin_lock_irqsave(&host->clk_lock, flags);
  602. host->clk_gated = false;
  603. spin_unlock_irqrestore(&host->clk_lock, flags);
  604. }
  605. #else
  606. void mmc_set_ungated(struct mmc_host *host)
  607. {
  608. }
  609. #endif
  610. /*
  611. * Change the bus mode (open drain/push-pull) of a host.
  612. */
  613. void mmc_set_bus_mode(struct mmc_host *host, unsigned int mode)
  614. {
  615. host->ios.bus_mode = mode;
  616. mmc_set_ios(host);
  617. }
  618. /*
  619. * Change data bus width of a host.
  620. */
  621. void mmc_set_bus_width(struct mmc_host *host, unsigned int width)
  622. {
  623. host->ios.bus_width = width;
  624. mmc_set_ios(host);
  625. }
  626. /**
  627. * mmc_vdd_to_ocrbitnum - Convert a voltage to the OCR bit number
  628. * @vdd: voltage (mV)
  629. * @low_bits: prefer low bits in boundary cases
  630. *
  631. * This function returns the OCR bit number according to the provided @vdd
  632. * value. If conversion is not possible a negative errno value returned.
  633. *
  634. * Depending on the @low_bits flag the function prefers low or high OCR bits
  635. * on boundary voltages. For example,
  636. * with @low_bits = true, 3300 mV translates to ilog2(MMC_VDD_32_33);
  637. * with @low_bits = false, 3300 mV translates to ilog2(MMC_VDD_33_34);
  638. *
  639. * Any value in the [1951:1999] range translates to the ilog2(MMC_VDD_20_21).
  640. */
  641. static int mmc_vdd_to_ocrbitnum(int vdd, bool low_bits)
  642. {
  643. const int max_bit = ilog2(MMC_VDD_35_36);
  644. int bit;
  645. if (vdd < 1650 || vdd > 3600)
  646. return -EINVAL;
  647. if (vdd >= 1650 && vdd <= 1950)
  648. return ilog2(MMC_VDD_165_195);
  649. if (low_bits)
  650. vdd -= 1;
  651. /* Base 2000 mV, step 100 mV, bit's base 8. */
  652. bit = (vdd - 2000) / 100 + 8;
  653. if (bit > max_bit)
  654. return max_bit;
  655. return bit;
  656. }
  657. /**
  658. * mmc_vddrange_to_ocrmask - Convert a voltage range to the OCR mask
  659. * @vdd_min: minimum voltage value (mV)
  660. * @vdd_max: maximum voltage value (mV)
  661. *
  662. * This function returns the OCR mask bits according to the provided @vdd_min
  663. * and @vdd_max values. If conversion is not possible the function returns 0.
  664. *
  665. * Notes wrt boundary cases:
  666. * This function sets the OCR bits for all boundary voltages, for example
  667. * [3300:3400] range is translated to MMC_VDD_32_33 | MMC_VDD_33_34 |
  668. * MMC_VDD_34_35 mask.
  669. */
  670. u32 mmc_vddrange_to_ocrmask(int vdd_min, int vdd_max)
  671. {
  672. u32 mask = 0;
  673. if (vdd_max < vdd_min)
  674. return 0;
  675. /* Prefer high bits for the boundary vdd_max values. */
  676. vdd_max = mmc_vdd_to_ocrbitnum(vdd_max, false);
  677. if (vdd_max < 0)
  678. return 0;
  679. /* Prefer low bits for the boundary vdd_min values. */
  680. vdd_min = mmc_vdd_to_ocrbitnum(vdd_min, true);
  681. if (vdd_min < 0)
  682. return 0;
  683. /* Fill the mask, from max bit to min bit. */
  684. while (vdd_max >= vdd_min)
  685. mask |= 1 << vdd_max--;
  686. return mask;
  687. }
  688. EXPORT_SYMBOL(mmc_vddrange_to_ocrmask);
  689. #ifdef CONFIG_REGULATOR
  690. /**
  691. * mmc_regulator_get_ocrmask - return mask of supported voltages
  692. * @supply: regulator to use
  693. *
  694. * This returns either a negative errno, or a mask of voltages that
  695. * can be provided to MMC/SD/SDIO devices using the specified voltage
  696. * regulator. This would normally be called before registering the
  697. * MMC host adapter.
  698. */
  699. int mmc_regulator_get_ocrmask(struct regulator *supply)
  700. {
  701. int result = 0;
  702. int count;
  703. int i;
  704. count = regulator_count_voltages(supply);
  705. if (count < 0)
  706. return count;
  707. for (i = 0; i < count; i++) {
  708. int vdd_uV;
  709. int vdd_mV;
  710. vdd_uV = regulator_list_voltage(supply, i);
  711. if (vdd_uV <= 0)
  712. continue;
  713. vdd_mV = vdd_uV / 1000;
  714. result |= mmc_vddrange_to_ocrmask(vdd_mV, vdd_mV);
  715. }
  716. return result;
  717. }
  718. EXPORT_SYMBOL(mmc_regulator_get_ocrmask);
  719. /**
  720. * mmc_regulator_set_ocr - set regulator to match host->ios voltage
  721. * @mmc: the host to regulate
  722. * @supply: regulator to use
  723. * @vdd_bit: zero for power off, else a bit number (host->ios.vdd)
  724. *
  725. * Returns zero on success, else negative errno.
  726. *
  727. * MMC host drivers may use this to enable or disable a regulator using
  728. * a particular supply voltage. This would normally be called from the
  729. * set_ios() method.
  730. */
  731. int mmc_regulator_set_ocr(struct mmc_host *mmc,
  732. struct regulator *supply,
  733. unsigned short vdd_bit)
  734. {
  735. int result = 0;
  736. int min_uV, max_uV;
  737. if (vdd_bit) {
  738. int tmp;
  739. int voltage;
  740. /* REVISIT mmc_vddrange_to_ocrmask() may have set some
  741. * bits this regulator doesn't quite support ... don't
  742. * be too picky, most cards and regulators are OK with
  743. * a 0.1V range goof (it's a small error percentage).
  744. */
  745. tmp = vdd_bit - ilog2(MMC_VDD_165_195);
  746. if (tmp == 0) {
  747. min_uV = 1650 * 1000;
  748. max_uV = 1950 * 1000;
  749. } else {
  750. min_uV = 1900 * 1000 + tmp * 100 * 1000;
  751. max_uV = min_uV + 100 * 1000;
  752. }
  753. /* avoid needless changes to this voltage; the regulator
  754. * might not allow this operation
  755. */
  756. voltage = regulator_get_voltage(supply);
  757. if (voltage < 0)
  758. result = voltage;
  759. else if (voltage < min_uV || voltage > max_uV)
  760. result = regulator_set_voltage(supply, min_uV, max_uV);
  761. else
  762. result = 0;
  763. if (result == 0 && !mmc->regulator_enabled) {
  764. result = regulator_enable(supply);
  765. if (!result)
  766. mmc->regulator_enabled = true;
  767. }
  768. } else if (mmc->regulator_enabled) {
  769. result = regulator_disable(supply);
  770. if (result == 0)
  771. mmc->regulator_enabled = false;
  772. }
  773. if (result)
  774. dev_err(mmc_dev(mmc),
  775. "could not set regulator OCR (%d)\n", result);
  776. return result;
  777. }
  778. EXPORT_SYMBOL(mmc_regulator_set_ocr);
  779. #endif /* CONFIG_REGULATOR */
  780. /*
  781. * Mask off any voltages we don't support and select
  782. * the lowest voltage
  783. */
  784. u32 mmc_select_voltage(struct mmc_host *host, u32 ocr)
  785. {
  786. int bit;
  787. ocr &= host->ocr_avail;
  788. bit = ffs(ocr);
  789. if (bit) {
  790. bit -= 1;
  791. ocr &= 3 << bit;
  792. host->ios.vdd = bit;
  793. mmc_set_ios(host);
  794. } else {
  795. pr_warning("%s: host doesn't support card's voltages\n",
  796. mmc_hostname(host));
  797. ocr = 0;
  798. }
  799. return ocr;
  800. }
  801. int mmc_set_signal_voltage(struct mmc_host *host, int signal_voltage, bool cmd11)
  802. {
  803. struct mmc_command cmd = {0};
  804. int err = 0;
  805. BUG_ON(!host);
  806. /*
  807. * Send CMD11 only if the request is to switch the card to
  808. * 1.8V signalling.
  809. */
  810. if ((signal_voltage != MMC_SIGNAL_VOLTAGE_330) && cmd11) {
  811. cmd.opcode = SD_SWITCH_VOLTAGE;
  812. cmd.arg = 0;
  813. cmd.flags = MMC_RSP_R1 | MMC_CMD_AC;
  814. err = mmc_wait_for_cmd(host, &cmd, 0);
  815. if (err)
  816. return err;
  817. if (!mmc_host_is_spi(host) && (cmd.resp[0] & R1_ERROR))
  818. return -EIO;
  819. }
  820. host->ios.signal_voltage = signal_voltage;
  821. if (host->ops->start_signal_voltage_switch)
  822. err = host->ops->start_signal_voltage_switch(host, &host->ios);
  823. return err;
  824. }
  825. /*
  826. * Select timing parameters for host.
  827. */
  828. void mmc_set_timing(struct mmc_host *host, unsigned int timing)
  829. {
  830. host->ios.timing = timing;
  831. mmc_set_ios(host);
  832. }
  833. /*
  834. * Select appropriate driver type for host.
  835. */
  836. void mmc_set_driver_type(struct mmc_host *host, unsigned int drv_type)
  837. {
  838. host->ios.drv_type = drv_type;
  839. mmc_set_ios(host);
  840. }
  841. /*
  842. * Apply power to the MMC stack. This is a two-stage process.
  843. * First, we enable power to the card without the clock running.
  844. * We then wait a bit for the power to stabilise. Finally,
  845. * enable the bus drivers and clock to the card.
  846. *
  847. * We must _NOT_ enable the clock prior to power stablising.
  848. *
  849. * If a host does all the power sequencing itself, ignore the
  850. * initial MMC_POWER_UP stage.
  851. */
  852. static void mmc_power_up(struct mmc_host *host)
  853. {
  854. int bit;
  855. /* If ocr is set, we use it */
  856. if (host->ocr)
  857. bit = ffs(host->ocr) - 1;
  858. else
  859. bit = fls(host->ocr_avail) - 1;
  860. host->ios.vdd = bit;
  861. if (mmc_host_is_spi(host)) {
  862. host->ios.chip_select = MMC_CS_HIGH;
  863. host->ios.bus_mode = MMC_BUSMODE_PUSHPULL;
  864. } else {
  865. host->ios.chip_select = MMC_CS_DONTCARE;
  866. host->ios.bus_mode = MMC_BUSMODE_OPENDRAIN;
  867. }
  868. host->ios.power_mode = MMC_POWER_UP;
  869. host->ios.bus_width = MMC_BUS_WIDTH_1;
  870. host->ios.timing = MMC_TIMING_LEGACY;
  871. mmc_set_ios(host);
  872. /*
  873. * This delay should be sufficient to allow the power supply
  874. * to reach the minimum voltage.
  875. */
  876. mmc_delay(10);
  877. host->ios.clock = host->f_init;
  878. host->ios.power_mode = MMC_POWER_ON;
  879. mmc_set_ios(host);
  880. /*
  881. * This delay must be at least 74 clock sizes, or 1 ms, or the
  882. * time required to reach a stable voltage.
  883. */
  884. mmc_delay(10);
  885. }
  886. static void mmc_power_off(struct mmc_host *host)
  887. {
  888. host->ios.clock = 0;
  889. host->ios.vdd = 0;
  890. /*
  891. * Reset ocr mask to be the highest possible voltage supported for
  892. * this mmc host. This value will be used at next power up.
  893. */
  894. host->ocr = 1 << (fls(host->ocr_avail) - 1);
  895. if (!mmc_host_is_spi(host)) {
  896. host->ios.bus_mode = MMC_BUSMODE_OPENDRAIN;
  897. host->ios.chip_select = MMC_CS_DONTCARE;
  898. }
  899. host->ios.power_mode = MMC_POWER_OFF;
  900. host->ios.bus_width = MMC_BUS_WIDTH_1;
  901. host->ios.timing = MMC_TIMING_LEGACY;
  902. mmc_set_ios(host);
  903. }
  904. /*
  905. * Cleanup when the last reference to the bus operator is dropped.
  906. */
  907. static void __mmc_release_bus(struct mmc_host *host)
  908. {
  909. BUG_ON(!host);
  910. BUG_ON(host->bus_refs);
  911. BUG_ON(!host->bus_dead);
  912. host->bus_ops = NULL;
  913. }
  914. /*
  915. * Increase reference count of bus operator
  916. */
  917. static inline void mmc_bus_get(struct mmc_host *host)
  918. {
  919. unsigned long flags;
  920. spin_lock_irqsave(&host->lock, flags);
  921. host->bus_refs++;
  922. spin_unlock_irqrestore(&host->lock, flags);
  923. }
  924. /*
  925. * Decrease reference count of bus operator and free it if
  926. * it is the last reference.
  927. */
  928. static inline void mmc_bus_put(struct mmc_host *host)
  929. {
  930. unsigned long flags;
  931. spin_lock_irqsave(&host->lock, flags);
  932. host->bus_refs--;
  933. if ((host->bus_refs == 0) && host->bus_ops)
  934. __mmc_release_bus(host);
  935. spin_unlock_irqrestore(&host->lock, flags);
  936. }
  937. /*
  938. * Assign a mmc bus handler to a host. Only one bus handler may control a
  939. * host at any given time.
  940. */
  941. void mmc_attach_bus(struct mmc_host *host, const struct mmc_bus_ops *ops)
  942. {
  943. unsigned long flags;
  944. BUG_ON(!host);
  945. BUG_ON(!ops);
  946. WARN_ON(!host->claimed);
  947. spin_lock_irqsave(&host->lock, flags);
  948. BUG_ON(host->bus_ops);
  949. BUG_ON(host->bus_refs);
  950. host->bus_ops = ops;
  951. host->bus_refs = 1;
  952. host->bus_dead = 0;
  953. spin_unlock_irqrestore(&host->lock, flags);
  954. }
  955. /*
  956. * Remove the current bus handler from a host. Assumes that there are
  957. * no interesting cards left, so the bus is powered down.
  958. */
  959. void mmc_detach_bus(struct mmc_host *host)
  960. {
  961. unsigned long flags;
  962. BUG_ON(!host);
  963. WARN_ON(!host->claimed);
  964. WARN_ON(!host->bus_ops);
  965. spin_lock_irqsave(&host->lock, flags);
  966. host->bus_dead = 1;
  967. spin_unlock_irqrestore(&host->lock, flags);
  968. mmc_power_off(host);
  969. mmc_bus_put(host);
  970. }
  971. /**
  972. * mmc_detect_change - process change of state on a MMC socket
  973. * @host: host which changed state.
  974. * @delay: optional delay to wait before detection (jiffies)
  975. *
  976. * MMC drivers should call this when they detect a card has been
  977. * inserted or removed. The MMC layer will confirm that any
  978. * present card is still functional, and initialize any newly
  979. * inserted.
  980. */
  981. void mmc_detect_change(struct mmc_host *host, unsigned long delay)
  982. {
  983. #ifdef CONFIG_MMC_DEBUG
  984. unsigned long flags;
  985. spin_lock_irqsave(&host->lock, flags);
  986. WARN_ON(host->removed);
  987. spin_unlock_irqrestore(&host->lock, flags);
  988. #endif
  989. mmc_schedule_delayed_work(&host->detect, delay);
  990. }
  991. EXPORT_SYMBOL(mmc_detect_change);
  992. void mmc_init_erase(struct mmc_card *card)
  993. {
  994. unsigned int sz;
  995. if (is_power_of_2(card->erase_size))
  996. card->erase_shift = ffs(card->erase_size) - 1;
  997. else
  998. card->erase_shift = 0;
  999. /*
  1000. * It is possible to erase an arbitrarily large area of an SD or MMC
  1001. * card. That is not desirable because it can take a long time
  1002. * (minutes) potentially delaying more important I/O, and also the
  1003. * timeout calculations become increasingly hugely over-estimated.
  1004. * Consequently, 'pref_erase' is defined as a guide to limit erases
  1005. * to that size and alignment.
  1006. *
  1007. * For SD cards that define Allocation Unit size, limit erases to one
  1008. * Allocation Unit at a time. For MMC cards that define High Capacity
  1009. * Erase Size, whether it is switched on or not, limit to that size.
  1010. * Otherwise just have a stab at a good value. For modern cards it
  1011. * will end up being 4MiB. Note that if the value is too small, it
  1012. * can end up taking longer to erase.
  1013. */
  1014. if (mmc_card_sd(card) && card->ssr.au) {
  1015. card->pref_erase = card->ssr.au;
  1016. card->erase_shift = ffs(card->ssr.au) - 1;
  1017. } else if (card->ext_csd.hc_erase_size) {
  1018. card->pref_erase = card->ext_csd.hc_erase_size;
  1019. } else {
  1020. sz = (card->csd.capacity << (card->csd.read_blkbits - 9)) >> 11;
  1021. if (sz < 128)
  1022. card->pref_erase = 512 * 1024 / 512;
  1023. else if (sz < 512)
  1024. card->pref_erase = 1024 * 1024 / 512;
  1025. else if (sz < 1024)
  1026. card->pref_erase = 2 * 1024 * 1024 / 512;
  1027. else
  1028. card->pref_erase = 4 * 1024 * 1024 / 512;
  1029. if (card->pref_erase < card->erase_size)
  1030. card->pref_erase = card->erase_size;
  1031. else {
  1032. sz = card->pref_erase % card->erase_size;
  1033. if (sz)
  1034. card->pref_erase += card->erase_size - sz;
  1035. }
  1036. }
  1037. }
  1038. static unsigned int mmc_mmc_erase_timeout(struct mmc_card *card,
  1039. unsigned int arg, unsigned int qty)
  1040. {
  1041. unsigned int erase_timeout;
  1042. if (card->ext_csd.erase_group_def & 1) {
  1043. /* High Capacity Erase Group Size uses HC timeouts */
  1044. if (arg == MMC_TRIM_ARG)
  1045. erase_timeout = card->ext_csd.trim_timeout;
  1046. else
  1047. erase_timeout = card->ext_csd.hc_erase_timeout;
  1048. } else {
  1049. /* CSD Erase Group Size uses write timeout */
  1050. unsigned int mult = (10 << card->csd.r2w_factor);
  1051. unsigned int timeout_clks = card->csd.tacc_clks * mult;
  1052. unsigned int timeout_us;
  1053. /* Avoid overflow: e.g. tacc_ns=80000000 mult=1280 */
  1054. if (card->csd.tacc_ns < 1000000)
  1055. timeout_us = (card->csd.tacc_ns * mult) / 1000;
  1056. else
  1057. timeout_us = (card->csd.tacc_ns / 1000) * mult;
  1058. /*
  1059. * ios.clock is only a target. The real clock rate might be
  1060. * less but not that much less, so fudge it by multiplying by 2.
  1061. */
  1062. timeout_clks <<= 1;
  1063. timeout_us += (timeout_clks * 1000) /
  1064. (card->host->ios.clock / 1000);
  1065. erase_timeout = timeout_us / 1000;
  1066. /*
  1067. * Theoretically, the calculation could underflow so round up
  1068. * to 1ms in that case.
  1069. */
  1070. if (!erase_timeout)
  1071. erase_timeout = 1;
  1072. }
  1073. /* Multiplier for secure operations */
  1074. if (arg & MMC_SECURE_ARGS) {
  1075. if (arg == MMC_SECURE_ERASE_ARG)
  1076. erase_timeout *= card->ext_csd.sec_erase_mult;
  1077. else
  1078. erase_timeout *= card->ext_csd.sec_trim_mult;
  1079. }
  1080. erase_timeout *= qty;
  1081. /*
  1082. * Ensure at least a 1 second timeout for SPI as per
  1083. * 'mmc_set_data_timeout()'
  1084. */
  1085. if (mmc_host_is_spi(card->host) && erase_timeout < 1000)
  1086. erase_timeout = 1000;
  1087. return erase_timeout;
  1088. }
  1089. static unsigned int mmc_sd_erase_timeout(struct mmc_card *card,
  1090. unsigned int arg,
  1091. unsigned int qty)
  1092. {
  1093. unsigned int erase_timeout;
  1094. if (card->ssr.erase_timeout) {
  1095. /* Erase timeout specified in SD Status Register (SSR) */
  1096. erase_timeout = card->ssr.erase_timeout * qty +
  1097. card->ssr.erase_offset;
  1098. } else {
  1099. /*
  1100. * Erase timeout not specified in SD Status Register (SSR) so
  1101. * use 250ms per write block.
  1102. */
  1103. erase_timeout = 250 * qty;
  1104. }
  1105. /* Must not be less than 1 second */
  1106. if (erase_timeout < 1000)
  1107. erase_timeout = 1000;
  1108. return erase_timeout;
  1109. }
  1110. static unsigned int mmc_erase_timeout(struct mmc_card *card,
  1111. unsigned int arg,
  1112. unsigned int qty)
  1113. {
  1114. if (mmc_card_sd(card))
  1115. return mmc_sd_erase_timeout(card, arg, qty);
  1116. else
  1117. return mmc_mmc_erase_timeout(card, arg, qty);
  1118. }
  1119. static int mmc_do_erase(struct mmc_card *card, unsigned int from,
  1120. unsigned int to, unsigned int arg)
  1121. {
  1122. struct mmc_command cmd = {0};
  1123. unsigned int qty = 0;
  1124. int err;
  1125. /*
  1126. * qty is used to calculate the erase timeout which depends on how many
  1127. * erase groups (or allocation units in SD terminology) are affected.
  1128. * We count erasing part of an erase group as one erase group.
  1129. * For SD, the allocation units are always a power of 2. For MMC, the
  1130. * erase group size is almost certainly also power of 2, but it does not
  1131. * seem to insist on that in the JEDEC standard, so we fall back to
  1132. * division in that case. SD may not specify an allocation unit size,
  1133. * in which case the timeout is based on the number of write blocks.
  1134. *
  1135. * Note that the timeout for secure trim 2 will only be correct if the
  1136. * number of erase groups specified is the same as the total of all
  1137. * preceding secure trim 1 commands. Since the power may have been
  1138. * lost since the secure trim 1 commands occurred, it is generally
  1139. * impossible to calculate the secure trim 2 timeout correctly.
  1140. */
  1141. if (card->erase_shift)
  1142. qty += ((to >> card->erase_shift) -
  1143. (from >> card->erase_shift)) + 1;
  1144. else if (mmc_card_sd(card))
  1145. qty += to - from + 1;
  1146. else
  1147. qty += ((to / card->erase_size) -
  1148. (from / card->erase_size)) + 1;
  1149. if (!mmc_card_blockaddr(card)) {
  1150. from <<= 9;
  1151. to <<= 9;
  1152. }
  1153. if (mmc_card_sd(card))
  1154. cmd.opcode = SD_ERASE_WR_BLK_START;
  1155. else
  1156. cmd.opcode = MMC_ERASE_GROUP_START;
  1157. cmd.arg = from;
  1158. cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_AC;
  1159. err = mmc_wait_for_cmd(card->host, &cmd, 0);
  1160. if (err) {
  1161. printk(KERN_ERR "mmc_erase: group start error %d, "
  1162. "status %#x\n", err, cmd.resp[0]);
  1163. err = -EINVAL;
  1164. goto out;
  1165. }
  1166. memset(&cmd, 0, sizeof(struct mmc_command));
  1167. if (mmc_card_sd(card))
  1168. cmd.opcode = SD_ERASE_WR_BLK_END;
  1169. else
  1170. cmd.opcode = MMC_ERASE_GROUP_END;
  1171. cmd.arg = to;
  1172. cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_AC;
  1173. err = mmc_wait_for_cmd(card->host, &cmd, 0);
  1174. if (err) {
  1175. printk(KERN_ERR "mmc_erase: group end error %d, status %#x\n",
  1176. err, cmd.resp[0]);
  1177. err = -EINVAL;
  1178. goto out;
  1179. }
  1180. memset(&cmd, 0, sizeof(struct mmc_command));
  1181. cmd.opcode = MMC_ERASE;
  1182. cmd.arg = arg;
  1183. cmd.flags = MMC_RSP_SPI_R1B | MMC_RSP_R1B | MMC_CMD_AC;
  1184. cmd.cmd_timeout_ms = mmc_erase_timeout(card, arg, qty);
  1185. err = mmc_wait_for_cmd(card->host, &cmd, 0);
  1186. if (err) {
  1187. printk(KERN_ERR "mmc_erase: erase error %d, status %#x\n",
  1188. err, cmd.resp[0]);
  1189. err = -EIO;
  1190. goto out;
  1191. }
  1192. if (mmc_host_is_spi(card->host))
  1193. goto out;
  1194. do {
  1195. memset(&cmd, 0, sizeof(struct mmc_command));
  1196. cmd.opcode = MMC_SEND_STATUS;
  1197. cmd.arg = card->rca << 16;
  1198. cmd.flags = MMC_RSP_R1 | MMC_CMD_AC;
  1199. /* Do not retry else we can't see errors */
  1200. err = mmc_wait_for_cmd(card->host, &cmd, 0);
  1201. if (err || (cmd.resp[0] & 0xFDF92000)) {
  1202. printk(KERN_ERR "error %d requesting status %#x\n",
  1203. err, cmd.resp[0]);
  1204. err = -EIO;
  1205. goto out;
  1206. }
  1207. } while (!(cmd.resp[0] & R1_READY_FOR_DATA) ||
  1208. R1_CURRENT_STATE(cmd.resp[0]) == 7);
  1209. out:
  1210. return err;
  1211. }
  1212. /**
  1213. * mmc_erase - erase sectors.
  1214. * @card: card to erase
  1215. * @from: first sector to erase
  1216. * @nr: number of sectors to erase
  1217. * @arg: erase command argument (SD supports only %MMC_ERASE_ARG)
  1218. *
  1219. * Caller must claim host before calling this function.
  1220. */
  1221. int mmc_erase(struct mmc_card *card, unsigned int from, unsigned int nr,
  1222. unsigned int arg)
  1223. {
  1224. unsigned int rem, to = from + nr;
  1225. if (!(card->host->caps & MMC_CAP_ERASE) ||
  1226. !(card->csd.cmdclass & CCC_ERASE))
  1227. return -EOPNOTSUPP;
  1228. if (!card->erase_size)
  1229. return -EOPNOTSUPP;
  1230. if (mmc_card_sd(card) && arg != MMC_ERASE_ARG)
  1231. return -EOPNOTSUPP;
  1232. if ((arg & MMC_SECURE_ARGS) &&
  1233. !(card->ext_csd.sec_feature_support & EXT_CSD_SEC_ER_EN))
  1234. return -EOPNOTSUPP;
  1235. if ((arg & MMC_TRIM_ARGS) &&
  1236. !(card->ext_csd.sec_feature_support & EXT_CSD_SEC_GB_CL_EN))
  1237. return -EOPNOTSUPP;
  1238. if (arg == MMC_SECURE_ERASE_ARG) {
  1239. if (from % card->erase_size || nr % card->erase_size)
  1240. return -EINVAL;
  1241. }
  1242. if (arg == MMC_ERASE_ARG) {
  1243. rem = from % card->erase_size;
  1244. if (rem) {
  1245. rem = card->erase_size - rem;
  1246. from += rem;
  1247. if (nr > rem)
  1248. nr -= rem;
  1249. else
  1250. return 0;
  1251. }
  1252. rem = nr % card->erase_size;
  1253. if (rem)
  1254. nr -= rem;
  1255. }
  1256. if (nr == 0)
  1257. return 0;
  1258. to = from + nr;
  1259. if (to <= from)
  1260. return -EINVAL;
  1261. /* 'from' and 'to' are inclusive */
  1262. to -= 1;
  1263. return mmc_do_erase(card, from, to, arg);
  1264. }
  1265. EXPORT_SYMBOL(mmc_erase);
  1266. int mmc_can_erase(struct mmc_card *card)
  1267. {
  1268. if ((card->host->caps & MMC_CAP_ERASE) &&
  1269. (card->csd.cmdclass & CCC_ERASE) && card->erase_size)
  1270. return 1;
  1271. return 0;
  1272. }
  1273. EXPORT_SYMBOL(mmc_can_erase);
  1274. int mmc_can_trim(struct mmc_card *card)
  1275. {
  1276. if (card->ext_csd.sec_feature_support & EXT_CSD_SEC_GB_CL_EN)
  1277. return 1;
  1278. return 0;
  1279. }
  1280. EXPORT_SYMBOL(mmc_can_trim);
  1281. int mmc_can_secure_erase_trim(struct mmc_card *card)
  1282. {
  1283. if (card->ext_csd.sec_feature_support & EXT_CSD_SEC_ER_EN)
  1284. return 1;
  1285. return 0;
  1286. }
  1287. EXPORT_SYMBOL(mmc_can_secure_erase_trim);
  1288. int mmc_erase_group_aligned(struct mmc_card *card, unsigned int from,
  1289. unsigned int nr)
  1290. {
  1291. if (!card->erase_size)
  1292. return 0;
  1293. if (from % card->erase_size || nr % card->erase_size)
  1294. return 0;
  1295. return 1;
  1296. }
  1297. EXPORT_SYMBOL(mmc_erase_group_aligned);
  1298. int mmc_set_blocklen(struct mmc_card *card, unsigned int blocklen)
  1299. {
  1300. struct mmc_command cmd = {0};
  1301. if (mmc_card_blockaddr(card) || mmc_card_ddr_mode(card))
  1302. return 0;
  1303. cmd.opcode = MMC_SET_BLOCKLEN;
  1304. cmd.arg = blocklen;
  1305. cmd.flags = MMC_RSP_SPI_R1 | MMC_RSP_R1 | MMC_CMD_AC;
  1306. return mmc_wait_for_cmd(card->host, &cmd, 5);
  1307. }
  1308. EXPORT_SYMBOL(mmc_set_blocklen);
  1309. static int mmc_rescan_try_freq(struct mmc_host *host, unsigned freq)
  1310. {
  1311. host->f_init = freq;
  1312. #ifdef CONFIG_MMC_DEBUG
  1313. pr_info("%s: %s: trying to init card at %u Hz\n",
  1314. mmc_hostname(host), __func__, host->f_init);
  1315. #endif
  1316. mmc_power_up(host);
  1317. /*
  1318. * sdio_reset sends CMD52 to reset card. Since we do not know
  1319. * if the card is being re-initialized, just send it. CMD52
  1320. * should be ignored by SD/eMMC cards.
  1321. */
  1322. sdio_reset(host);
  1323. mmc_go_idle(host);
  1324. mmc_send_if_cond(host, host->ocr_avail);
  1325. /* Order's important: probe SDIO, then SD, then MMC */
  1326. if (!mmc_attach_sdio(host))
  1327. return 0;
  1328. if (!mmc_attach_sd(host))
  1329. return 0;
  1330. if (!mmc_attach_mmc(host))
  1331. return 0;
  1332. mmc_power_off(host);
  1333. return -EIO;
  1334. }
  1335. void mmc_rescan(struct work_struct *work)
  1336. {
  1337. static const unsigned freqs[] = { 400000, 300000, 200000, 100000 };
  1338. struct mmc_host *host =
  1339. container_of(work, struct mmc_host, detect.work);
  1340. int i;
  1341. if (host->rescan_disable)
  1342. return;
  1343. mmc_bus_get(host);
  1344. /*
  1345. * if there is a _removable_ card registered, check whether it is
  1346. * still present
  1347. */
  1348. if (host->bus_ops && host->bus_ops->detect && !host->bus_dead
  1349. && !(host->caps & MMC_CAP_NONREMOVABLE))
  1350. host->bus_ops->detect(host);
  1351. /*
  1352. * Let mmc_bus_put() free the bus/bus_ops if we've found that
  1353. * the card is no longer present.
  1354. */
  1355. mmc_bus_put(host);
  1356. mmc_bus_get(host);
  1357. /* if there still is a card present, stop here */
  1358. if (host->bus_ops != NULL) {
  1359. mmc_bus_put(host);
  1360. goto out;
  1361. }
  1362. /*
  1363. * Only we can add a new handler, so it's safe to
  1364. * release the lock here.
  1365. */
  1366. mmc_bus_put(host);
  1367. if (host->ops->get_cd && host->ops->get_cd(host) == 0)
  1368. goto out;
  1369. mmc_claim_host(host);
  1370. for (i = 0; i < ARRAY_SIZE(freqs); i++) {
  1371. if (!mmc_rescan_try_freq(host, max(freqs[i], host->f_min)))
  1372. break;
  1373. if (freqs[i] <= host->f_min)
  1374. break;
  1375. }
  1376. mmc_release_host(host);
  1377. out:
  1378. if (host->caps & MMC_CAP_NEEDS_POLL)
  1379. mmc_schedule_delayed_work(&host->detect, HZ);
  1380. }
  1381. void mmc_start_host(struct mmc_host *host)
  1382. {
  1383. mmc_power_off(host);
  1384. mmc_detect_change(host, 0);
  1385. }
  1386. void mmc_stop_host(struct mmc_host *host)
  1387. {
  1388. #ifdef CONFIG_MMC_DEBUG
  1389. unsigned long flags;
  1390. spin_lock_irqsave(&host->lock, flags);
  1391. host->removed = 1;
  1392. spin_unlock_irqrestore(&host->lock, flags);
  1393. #endif
  1394. if (host->caps & MMC_CAP_DISABLE)
  1395. cancel_delayed_work(&host->disable);
  1396. cancel_delayed_work_sync(&host->detect);
  1397. mmc_flush_scheduled_work();
  1398. /* clear pm flags now and let card drivers set them as needed */
  1399. host->pm_flags = 0;
  1400. mmc_bus_get(host);
  1401. if (host->bus_ops && !host->bus_dead) {
  1402. if (host->bus_ops->remove)
  1403. host->bus_ops->remove(host);
  1404. mmc_claim_host(host);
  1405. mmc_detach_bus(host);
  1406. mmc_release_host(host);
  1407. mmc_bus_put(host);
  1408. return;
  1409. }
  1410. mmc_bus_put(host);
  1411. BUG_ON(host->card);
  1412. mmc_power_off(host);
  1413. }
  1414. int mmc_power_save_host(struct mmc_host *host)
  1415. {
  1416. int ret = 0;
  1417. mmc_bus_get(host);
  1418. if (!host->bus_ops || host->bus_dead || !host->bus_ops->power_restore) {
  1419. mmc_bus_put(host);
  1420. return -EINVAL;
  1421. }
  1422. if (host->bus_ops->power_save)
  1423. ret = host->bus_ops->power_save(host);
  1424. mmc_bus_put(host);
  1425. mmc_power_off(host);
  1426. return ret;
  1427. }
  1428. EXPORT_SYMBOL(mmc_power_save_host);
  1429. int mmc_power_restore_host(struct mmc_host *host)
  1430. {
  1431. int ret;
  1432. mmc_bus_get(host);
  1433. if (!host->bus_ops || host->bus_dead || !host->bus_ops->power_restore) {
  1434. mmc_bus_put(host);
  1435. return -EINVAL;
  1436. }
  1437. mmc_power_up(host);
  1438. ret = host->bus_ops->power_restore(host);
  1439. mmc_bus_put(host);
  1440. return ret;
  1441. }
  1442. EXPORT_SYMBOL(mmc_power_restore_host);
  1443. int mmc_card_awake(struct mmc_host *host)
  1444. {
  1445. int err = -ENOSYS;
  1446. mmc_bus_get(host);
  1447. if (host->bus_ops && !host->bus_dead && host->bus_ops->awake)
  1448. err = host->bus_ops->awake(host);
  1449. mmc_bus_put(host);
  1450. return err;
  1451. }
  1452. EXPORT_SYMBOL(mmc_card_awake);
  1453. int mmc_card_sleep(struct mmc_host *host)
  1454. {
  1455. int err = -ENOSYS;
  1456. mmc_bus_get(host);
  1457. if (host->bus_ops && !host->bus_dead && host->bus_ops->awake)
  1458. err = host->bus_ops->sleep(host);
  1459. mmc_bus_put(host);
  1460. return err;
  1461. }
  1462. EXPORT_SYMBOL(mmc_card_sleep);
  1463. int mmc_card_can_sleep(struct mmc_host *host)
  1464. {
  1465. struct mmc_card *card = host->card;
  1466. if (card && mmc_card_mmc(card) && card->ext_csd.rev >= 3)
  1467. return 1;
  1468. return 0;
  1469. }
  1470. EXPORT_SYMBOL(mmc_card_can_sleep);
  1471. #ifdef CONFIG_PM
  1472. /**
  1473. * mmc_suspend_host - suspend a host
  1474. * @host: mmc host
  1475. */
  1476. int mmc_suspend_host(struct mmc_host *host)
  1477. {
  1478. int err = 0;
  1479. if (host->caps & MMC_CAP_DISABLE)
  1480. cancel_delayed_work(&host->disable);
  1481. cancel_delayed_work(&host->detect);
  1482. mmc_flush_scheduled_work();
  1483. mmc_bus_get(host);
  1484. if (host->bus_ops && !host->bus_dead) {
  1485. if (host->bus_ops->suspend)
  1486. err = host->bus_ops->suspend(host);
  1487. if (err == -ENOSYS || !host->bus_ops->resume) {
  1488. /*
  1489. * We simply "remove" the card in this case.
  1490. * It will be redetected on resume.
  1491. */
  1492. if (host->bus_ops->remove)
  1493. host->bus_ops->remove(host);
  1494. mmc_claim_host(host);
  1495. mmc_detach_bus(host);
  1496. mmc_release_host(host);
  1497. host->pm_flags = 0;
  1498. err = 0;
  1499. }
  1500. }
  1501. mmc_bus_put(host);
  1502. if (!err && !mmc_card_keep_power(host))
  1503. mmc_power_off(host);
  1504. return err;
  1505. }
  1506. EXPORT_SYMBOL(mmc_suspend_host);
  1507. /**
  1508. * mmc_resume_host - resume a previously suspended host
  1509. * @host: mmc host
  1510. */
  1511. int mmc_resume_host(struct mmc_host *host)
  1512. {
  1513. int err = 0;
  1514. mmc_bus_get(host);
  1515. if (host->bus_ops && !host->bus_dead) {
  1516. if (!mmc_card_keep_power(host)) {
  1517. mmc_power_up(host);
  1518. mmc_select_voltage(host, host->ocr);
  1519. /*
  1520. * Tell runtime PM core we just powered up the card,
  1521. * since it still believes the card is powered off.
  1522. * Note that currently runtime PM is only enabled
  1523. * for SDIO cards that are MMC_CAP_POWER_OFF_CARD
  1524. */
  1525. if (mmc_card_sdio(host->card) &&
  1526. (host->caps & MMC_CAP_POWER_OFF_CARD)) {
  1527. pm_runtime_disable(&host->card->dev);
  1528. pm_runtime_set_active(&host->card->dev);
  1529. pm_runtime_enable(&host->card->dev);
  1530. }
  1531. }
  1532. BUG_ON(!host->bus_ops->resume);
  1533. err = host->bus_ops->resume(host);
  1534. if (err) {
  1535. printk(KERN_WARNING "%s: error %d during resume "
  1536. "(card was removed?)\n",
  1537. mmc_hostname(host), err);
  1538. err = 0;
  1539. }
  1540. }
  1541. host->pm_flags &= ~MMC_PM_KEEP_POWER;
  1542. mmc_bus_put(host);
  1543. return err;
  1544. }
  1545. EXPORT_SYMBOL(mmc_resume_host);
  1546. /* Do the card removal on suspend if card is assumed removeable
  1547. * Do that in pm notifier while userspace isn't yet frozen, so we will be able
  1548. to sync the card.
  1549. */
  1550. int mmc_pm_notify(struct notifier_block *notify_block,
  1551. unsigned long mode, void *unused)
  1552. {
  1553. struct mmc_host *host = container_of(
  1554. notify_block, struct mmc_host, pm_notify);
  1555. unsigned long flags;
  1556. switch (mode) {
  1557. case PM_HIBERNATION_PREPARE:
  1558. case PM_SUSPEND_PREPARE:
  1559. spin_lock_irqsave(&host->lock, flags);
  1560. host->rescan_disable = 1;
  1561. spin_unlock_irqrestore(&host->lock, flags);
  1562. cancel_delayed_work_sync(&host->detect);
  1563. if (!host->bus_ops || host->bus_ops->suspend)
  1564. break;
  1565. mmc_claim_host(host);
  1566. if (host->bus_ops->remove)
  1567. host->bus_ops->remove(host);
  1568. mmc_detach_bus(host);
  1569. mmc_release_host(host);
  1570. host->pm_flags = 0;
  1571. break;
  1572. case PM_POST_SUSPEND:
  1573. case PM_POST_HIBERNATION:
  1574. case PM_POST_RESTORE:
  1575. spin_lock_irqsave(&host->lock, flags);
  1576. host->rescan_disable = 0;
  1577. spin_unlock_irqrestore(&host->lock, flags);
  1578. mmc_detect_change(host, 0);
  1579. }
  1580. return 0;
  1581. }
  1582. #endif
  1583. static int __init mmc_init(void)
  1584. {
  1585. int ret;
  1586. workqueue = alloc_ordered_workqueue("kmmcd", 0);
  1587. if (!workqueue)
  1588. return -ENOMEM;
  1589. ret = mmc_register_bus();
  1590. if (ret)
  1591. goto destroy_workqueue;
  1592. ret = mmc_register_host_class();
  1593. if (ret)
  1594. goto unregister_bus;
  1595. ret = sdio_register_bus();
  1596. if (ret)
  1597. goto unregister_host_class;
  1598. return 0;
  1599. unregister_host_class:
  1600. mmc_unregister_host_class();
  1601. unregister_bus:
  1602. mmc_unregister_bus();
  1603. destroy_workqueue:
  1604. destroy_workqueue(workqueue);
  1605. return ret;
  1606. }
  1607. static void __exit mmc_exit(void)
  1608. {
  1609. sdio_unregister_bus();
  1610. mmc_unregister_host_class();
  1611. mmc_unregister_bus();
  1612. destroy_workqueue(workqueue);
  1613. }
  1614. subsys_initcall(mmc_init);
  1615. module_exit(mmc_exit);
  1616. MODULE_LICENSE("GPL");