bcmsdh_sdmmc.c 17 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700
  1. /*
  2. * Copyright (c) 2010 Broadcom Corporation
  3. *
  4. * Permission to use, copy, modify, and/or distribute this software for any
  5. * purpose with or without fee is hereby granted, provided that the above
  6. * copyright notice and this permission notice appear in all copies.
  7. *
  8. * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
  9. * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
  10. * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY
  11. * SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  12. * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION
  13. * OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN
  14. * CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  15. */
  16. #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  17. #include <linux/types.h>
  18. #include <linux/netdevice.h>
  19. #include <linux/mmc/sdio.h>
  20. #include <linux/mmc/core.h>
  21. #include <linux/mmc/sdio_func.h>
  22. #include <linux/mmc/sdio_ids.h>
  23. #include <linux/mmc/card.h>
  24. #include <linux/suspend.h>
  25. #include <linux/errno.h>
  26. #include <linux/sched.h> /* request_irq() */
  27. #include <linux/module.h>
  28. #include <linux/platform_device.h>
  29. #include <net/cfg80211.h>
  30. #include <defs.h>
  31. #include <brcm_hw_ids.h>
  32. #include <brcmu_utils.h>
  33. #include <brcmu_wifi.h>
  34. #include "sdio_host.h"
  35. #include "dhd_dbg.h"
  36. #include "dhd_bus.h"
  37. #define SDIO_VENDOR_ID_BROADCOM 0x02d0
  38. #define DMA_ALIGN_MASK 0x03
  39. #define SDIO_DEVICE_ID_BROADCOM_4329 0x4329
  40. #define SDIO_DEVICE_ID_BROADCOM_4330 0x4330
  41. #define SDIO_FUNC1_BLOCKSIZE 64
  42. #define SDIO_FUNC2_BLOCKSIZE 512
  43. /* devices we support, null terminated */
  44. static const struct sdio_device_id brcmf_sdmmc_ids[] = {
  45. {SDIO_DEVICE(SDIO_VENDOR_ID_BROADCOM, SDIO_DEVICE_ID_BROADCOM_4329)},
  46. {SDIO_DEVICE(SDIO_VENDOR_ID_BROADCOM, SDIO_DEVICE_ID_BROADCOM_4330)},
  47. { /* end: all zeroes */ },
  48. };
  49. MODULE_DEVICE_TABLE(sdio, brcmf_sdmmc_ids);
  50. #ifdef CONFIG_BRCMFMAC_SDIO_OOB
  51. static struct list_head oobirq_lh;
  52. struct brcmf_sdio_oobirq {
  53. unsigned int irq;
  54. unsigned long flags;
  55. struct list_head list;
  56. };
  57. #endif /* CONFIG_BRCMFMAC_SDIO_OOB */
  58. static bool
  59. brcmf_pm_resume_error(struct brcmf_sdio_dev *sdiodev)
  60. {
  61. bool is_err = false;
  62. #ifdef CONFIG_PM_SLEEP
  63. is_err = atomic_read(&sdiodev->suspend);
  64. #endif
  65. return is_err;
  66. }
  67. static void
  68. brcmf_pm_resume_wait(struct brcmf_sdio_dev *sdiodev, wait_queue_head_t *wq)
  69. {
  70. #ifdef CONFIG_PM_SLEEP
  71. int retry = 0;
  72. while (atomic_read(&sdiodev->suspend) && retry++ != 30)
  73. wait_event_timeout(*wq, false, HZ/100);
  74. #endif
  75. }
  76. static inline int brcmf_sdioh_f0_write_byte(struct brcmf_sdio_dev *sdiodev,
  77. uint regaddr, u8 *byte)
  78. {
  79. struct sdio_func *sdfunc = sdiodev->func[0];
  80. int err_ret;
  81. /*
  82. * Can only directly write to some F0 registers.
  83. * Handle F2 enable/disable and Abort command
  84. * as a special case.
  85. */
  86. if (regaddr == SDIO_CCCR_IOEx) {
  87. sdfunc = sdiodev->func[2];
  88. if (sdfunc) {
  89. sdio_claim_host(sdfunc);
  90. if (*byte & SDIO_FUNC_ENABLE_2) {
  91. /* Enable Function 2 */
  92. err_ret = sdio_enable_func(sdfunc);
  93. if (err_ret)
  94. brcmf_dbg(ERROR,
  95. "enable F2 failed:%d\n",
  96. err_ret);
  97. } else {
  98. /* Disable Function 2 */
  99. err_ret = sdio_disable_func(sdfunc);
  100. if (err_ret)
  101. brcmf_dbg(ERROR,
  102. "Disable F2 failed:%d\n",
  103. err_ret);
  104. }
  105. sdio_release_host(sdfunc);
  106. }
  107. } else if ((regaddr == SDIO_CCCR_ABORT) ||
  108. (regaddr == SDIO_CCCR_IENx)) {
  109. sdfunc = kmemdup(sdiodev->func[0], sizeof(struct sdio_func),
  110. GFP_KERNEL);
  111. if (!sdfunc)
  112. return -ENOMEM;
  113. sdfunc->num = 0;
  114. sdio_claim_host(sdfunc);
  115. sdio_writeb(sdfunc, *byte, regaddr, &err_ret);
  116. sdio_release_host(sdfunc);
  117. kfree(sdfunc);
  118. } else if (regaddr < 0xF0) {
  119. brcmf_dbg(ERROR, "F0 Wr:0x%02x: write disallowed\n", regaddr);
  120. err_ret = -EPERM;
  121. } else {
  122. sdio_claim_host(sdfunc);
  123. sdio_f0_writeb(sdfunc, *byte, regaddr, &err_ret);
  124. sdio_release_host(sdfunc);
  125. }
  126. return err_ret;
  127. }
  128. int brcmf_sdioh_request_byte(struct brcmf_sdio_dev *sdiodev, uint rw, uint func,
  129. uint regaddr, u8 *byte)
  130. {
  131. int err_ret;
  132. brcmf_dbg(INFO, "rw=%d, func=%d, addr=0x%05x\n", rw, func, regaddr);
  133. brcmf_pm_resume_wait(sdiodev, &sdiodev->request_byte_wait);
  134. if (brcmf_pm_resume_error(sdiodev))
  135. return -EIO;
  136. if (rw && func == 0) {
  137. /* handle F0 separately */
  138. err_ret = brcmf_sdioh_f0_write_byte(sdiodev, regaddr, byte);
  139. } else {
  140. sdio_claim_host(sdiodev->func[func]);
  141. if (rw) /* CMD52 Write */
  142. sdio_writeb(sdiodev->func[func], *byte, regaddr,
  143. &err_ret);
  144. else if (func == 0) {
  145. *byte = sdio_f0_readb(sdiodev->func[func], regaddr,
  146. &err_ret);
  147. } else {
  148. *byte = sdio_readb(sdiodev->func[func], regaddr,
  149. &err_ret);
  150. }
  151. sdio_release_host(sdiodev->func[func]);
  152. }
  153. if (err_ret)
  154. brcmf_dbg(ERROR, "Failed to %s byte F%d:@0x%05x=%02x, Err: %d\n",
  155. rw ? "write" : "read", func, regaddr, *byte, err_ret);
  156. return err_ret;
  157. }
  158. int brcmf_sdioh_request_word(struct brcmf_sdio_dev *sdiodev,
  159. uint rw, uint func, uint addr, u32 *word,
  160. uint nbytes)
  161. {
  162. int err_ret = -EIO;
  163. if (func == 0) {
  164. brcmf_dbg(ERROR, "Only CMD52 allowed to F0\n");
  165. return -EINVAL;
  166. }
  167. brcmf_dbg(INFO, "rw=%d, func=%d, addr=0x%05x, nbytes=%d\n",
  168. rw, func, addr, nbytes);
  169. brcmf_pm_resume_wait(sdiodev, &sdiodev->request_word_wait);
  170. if (brcmf_pm_resume_error(sdiodev))
  171. return -EIO;
  172. /* Claim host controller */
  173. sdio_claim_host(sdiodev->func[func]);
  174. if (rw) { /* CMD52 Write */
  175. if (nbytes == 4)
  176. sdio_writel(sdiodev->func[func], *word, addr,
  177. &err_ret);
  178. else if (nbytes == 2)
  179. sdio_writew(sdiodev->func[func], (*word & 0xFFFF),
  180. addr, &err_ret);
  181. else
  182. brcmf_dbg(ERROR, "Invalid nbytes: %d\n", nbytes);
  183. } else { /* CMD52 Read */
  184. if (nbytes == 4)
  185. *word = sdio_readl(sdiodev->func[func], addr, &err_ret);
  186. else if (nbytes == 2)
  187. *word = sdio_readw(sdiodev->func[func], addr,
  188. &err_ret) & 0xFFFF;
  189. else
  190. brcmf_dbg(ERROR, "Invalid nbytes: %d\n", nbytes);
  191. }
  192. /* Release host controller */
  193. sdio_release_host(sdiodev->func[func]);
  194. if (err_ret)
  195. brcmf_dbg(ERROR, "Failed to %s word, Err: 0x%08x\n",
  196. rw ? "write" : "read", err_ret);
  197. return err_ret;
  198. }
  199. /* precondition: host controller is claimed */
  200. static int
  201. brcmf_sdioh_request_data(struct brcmf_sdio_dev *sdiodev, uint write, bool fifo,
  202. uint func, uint addr, struct sk_buff *pkt, uint pktlen)
  203. {
  204. int err_ret = 0;
  205. if ((write) && (!fifo)) {
  206. err_ret = sdio_memcpy_toio(sdiodev->func[func], addr,
  207. ((u8 *) (pkt->data)), pktlen);
  208. } else if (write) {
  209. err_ret = sdio_memcpy_toio(sdiodev->func[func], addr,
  210. ((u8 *) (pkt->data)), pktlen);
  211. } else if (fifo) {
  212. err_ret = sdio_readsb(sdiodev->func[func],
  213. ((u8 *) (pkt->data)), addr, pktlen);
  214. } else {
  215. err_ret = sdio_memcpy_fromio(sdiodev->func[func],
  216. ((u8 *) (pkt->data)),
  217. addr, pktlen);
  218. }
  219. return err_ret;
  220. }
  221. /*
  222. * This function takes a queue of packets. The packets on the queue
  223. * are assumed to be properly aligned by the caller.
  224. */
  225. int
  226. brcmf_sdioh_request_chain(struct brcmf_sdio_dev *sdiodev, uint fix_inc,
  227. uint write, uint func, uint addr,
  228. struct sk_buff_head *pktq)
  229. {
  230. bool fifo = (fix_inc == SDIOH_DATA_FIX);
  231. u32 SGCount = 0;
  232. int err_ret = 0;
  233. struct sk_buff *pkt;
  234. brcmf_dbg(TRACE, "Enter\n");
  235. brcmf_pm_resume_wait(sdiodev, &sdiodev->request_chain_wait);
  236. if (brcmf_pm_resume_error(sdiodev))
  237. return -EIO;
  238. /* Claim host controller */
  239. sdio_claim_host(sdiodev->func[func]);
  240. skb_queue_walk(pktq, pkt) {
  241. uint pkt_len = pkt->len;
  242. pkt_len += 3;
  243. pkt_len &= 0xFFFFFFFC;
  244. err_ret = brcmf_sdioh_request_data(sdiodev, write, fifo, func,
  245. addr, pkt, pkt_len);
  246. if (err_ret) {
  247. brcmf_dbg(ERROR, "%s FAILED %p[%d], addr=0x%05x, pkt_len=%d, ERR=0x%08x\n",
  248. write ? "TX" : "RX", pkt, SGCount, addr,
  249. pkt_len, err_ret);
  250. } else {
  251. brcmf_dbg(TRACE, "%s xfr'd %p[%d], addr=0x%05x, len=%d\n",
  252. write ? "TX" : "RX", pkt, SGCount, addr,
  253. pkt_len);
  254. }
  255. if (!fifo)
  256. addr += pkt_len;
  257. SGCount++;
  258. }
  259. /* Release host controller */
  260. sdio_release_host(sdiodev->func[func]);
  261. brcmf_dbg(TRACE, "Exit\n");
  262. return err_ret;
  263. }
  264. /*
  265. * This function takes a single DMA-able packet.
  266. */
  267. int brcmf_sdioh_request_buffer(struct brcmf_sdio_dev *sdiodev,
  268. uint fix_inc, uint write, uint func, uint addr,
  269. struct sk_buff *pkt)
  270. {
  271. int status;
  272. uint pkt_len;
  273. bool fifo = (fix_inc == SDIOH_DATA_FIX);
  274. brcmf_dbg(TRACE, "Enter\n");
  275. if (pkt == NULL)
  276. return -EINVAL;
  277. pkt_len = pkt->len;
  278. brcmf_pm_resume_wait(sdiodev, &sdiodev->request_buffer_wait);
  279. if (brcmf_pm_resume_error(sdiodev))
  280. return -EIO;
  281. /* Claim host controller */
  282. sdio_claim_host(sdiodev->func[func]);
  283. pkt_len += 3;
  284. pkt_len &= (uint)~3;
  285. status = brcmf_sdioh_request_data(sdiodev, write, fifo, func,
  286. addr, pkt, pkt_len);
  287. if (status) {
  288. brcmf_dbg(ERROR, "%s FAILED %p, addr=0x%05x, pkt_len=%d, ERR=0x%08x\n",
  289. write ? "TX" : "RX", pkt, addr, pkt_len, status);
  290. } else {
  291. brcmf_dbg(TRACE, "%s xfr'd %p, addr=0x%05x, len=%d\n",
  292. write ? "TX" : "RX", pkt, addr, pkt_len);
  293. }
  294. /* Release host controller */
  295. sdio_release_host(sdiodev->func[func]);
  296. return status;
  297. }
  298. static int brcmf_sdioh_get_cisaddr(struct brcmf_sdio_dev *sdiodev, u32 regaddr)
  299. {
  300. /* read 24 bits and return valid 17 bit addr */
  301. int i, ret;
  302. u32 scratch, regdata;
  303. __le32 scratch_le;
  304. u8 *ptr = (u8 *)&scratch_le;
  305. for (i = 0; i < 3; i++) {
  306. regdata = brcmf_sdio_regrl(sdiodev, regaddr, &ret);
  307. if (ret != 0)
  308. brcmf_dbg(ERROR, "Can't read!\n");
  309. *ptr++ = (u8) regdata;
  310. regaddr++;
  311. }
  312. /* Only the lower 17-bits are valid */
  313. scratch = le32_to_cpu(scratch_le);
  314. scratch &= 0x0001FFFF;
  315. return scratch;
  316. }
  317. static int brcmf_sdioh_enablefuncs(struct brcmf_sdio_dev *sdiodev)
  318. {
  319. int err_ret;
  320. u32 fbraddr;
  321. u8 func;
  322. brcmf_dbg(TRACE, "\n");
  323. /* Get the Card's common CIS address */
  324. sdiodev->func_cis_ptr[0] = brcmf_sdioh_get_cisaddr(sdiodev,
  325. SDIO_CCCR_CIS);
  326. brcmf_dbg(INFO, "Card's Common CIS Ptr = 0x%x\n",
  327. sdiodev->func_cis_ptr[0]);
  328. /* Get the Card's function CIS (for each function) */
  329. for (fbraddr = SDIO_FBR_BASE(1), func = 1;
  330. func <= sdiodev->num_funcs; func++, fbraddr += SDIOD_FBR_SIZE) {
  331. sdiodev->func_cis_ptr[func] =
  332. brcmf_sdioh_get_cisaddr(sdiodev, SDIO_FBR_CIS + fbraddr);
  333. brcmf_dbg(INFO, "Function %d CIS Ptr = 0x%x\n",
  334. func, sdiodev->func_cis_ptr[func]);
  335. }
  336. /* Enable Function 1 */
  337. sdio_claim_host(sdiodev->func[1]);
  338. err_ret = sdio_enable_func(sdiodev->func[1]);
  339. sdio_release_host(sdiodev->func[1]);
  340. if (err_ret)
  341. brcmf_dbg(ERROR, "Failed to enable F1 Err: 0x%08x\n", err_ret);
  342. return false;
  343. }
  344. /*
  345. * Public entry points & extern's
  346. */
  347. int brcmf_sdioh_attach(struct brcmf_sdio_dev *sdiodev)
  348. {
  349. int err_ret = 0;
  350. brcmf_dbg(TRACE, "\n");
  351. sdiodev->num_funcs = 2;
  352. sdio_claim_host(sdiodev->func[1]);
  353. err_ret = sdio_set_block_size(sdiodev->func[1], SDIO_FUNC1_BLOCKSIZE);
  354. sdio_release_host(sdiodev->func[1]);
  355. if (err_ret) {
  356. brcmf_dbg(ERROR, "Failed to set F1 blocksize\n");
  357. goto out;
  358. }
  359. sdio_claim_host(sdiodev->func[2]);
  360. err_ret = sdio_set_block_size(sdiodev->func[2], SDIO_FUNC2_BLOCKSIZE);
  361. sdio_release_host(sdiodev->func[2]);
  362. if (err_ret) {
  363. brcmf_dbg(ERROR, "Failed to set F2 blocksize\n");
  364. goto out;
  365. }
  366. brcmf_sdioh_enablefuncs(sdiodev);
  367. out:
  368. brcmf_dbg(TRACE, "Done\n");
  369. return err_ret;
  370. }
  371. void brcmf_sdioh_detach(struct brcmf_sdio_dev *sdiodev)
  372. {
  373. brcmf_dbg(TRACE, "\n");
  374. /* Disable Function 2 */
  375. sdio_claim_host(sdiodev->func[2]);
  376. sdio_disable_func(sdiodev->func[2]);
  377. sdio_release_host(sdiodev->func[2]);
  378. /* Disable Function 1 */
  379. sdio_claim_host(sdiodev->func[1]);
  380. sdio_disable_func(sdiodev->func[1]);
  381. sdio_release_host(sdiodev->func[1]);
  382. }
  383. #ifdef CONFIG_BRCMFMAC_SDIO_OOB
  384. static int brcmf_sdio_getintrcfg(struct brcmf_sdio_dev *sdiodev)
  385. {
  386. struct brcmf_sdio_oobirq *oobirq_entry;
  387. if (list_empty(&oobirq_lh)) {
  388. brcmf_dbg(ERROR, "no valid oob irq resource\n");
  389. return -ENXIO;
  390. }
  391. oobirq_entry = list_first_entry(&oobirq_lh, struct brcmf_sdio_oobirq,
  392. list);
  393. sdiodev->irq = oobirq_entry->irq;
  394. sdiodev->irq_flags = oobirq_entry->flags;
  395. list_del(&oobirq_entry->list);
  396. kfree(oobirq_entry);
  397. return 0;
  398. }
  399. #else
  400. static inline int brcmf_sdio_getintrcfg(struct brcmf_sdio_dev *sdiodev)
  401. {
  402. return 0;
  403. }
  404. #endif /* CONFIG_BRCMFMAC_SDIO_OOB */
  405. static int brcmf_ops_sdio_probe(struct sdio_func *func,
  406. const struct sdio_device_id *id)
  407. {
  408. int ret = 0;
  409. struct brcmf_sdio_dev *sdiodev;
  410. struct brcmf_bus *bus_if;
  411. brcmf_dbg(TRACE, "Enter\n");
  412. brcmf_dbg(TRACE, "func->class=%x\n", func->class);
  413. brcmf_dbg(TRACE, "sdio_vendor: 0x%04x\n", func->vendor);
  414. brcmf_dbg(TRACE, "sdio_device: 0x%04x\n", func->device);
  415. brcmf_dbg(TRACE, "Function#: 0x%04x\n", func->num);
  416. if (func->num == 1) {
  417. if (dev_get_drvdata(&func->card->dev)) {
  418. brcmf_dbg(ERROR, "card private drvdata occupied\n");
  419. return -ENXIO;
  420. }
  421. bus_if = kzalloc(sizeof(struct brcmf_bus), GFP_KERNEL);
  422. if (!bus_if)
  423. return -ENOMEM;
  424. sdiodev = kzalloc(sizeof(struct brcmf_sdio_dev), GFP_KERNEL);
  425. if (!sdiodev) {
  426. kfree(bus_if);
  427. return -ENOMEM;
  428. }
  429. sdiodev->func[0] = func;
  430. sdiodev->func[1] = func;
  431. sdiodev->bus_if = bus_if;
  432. bus_if->bus_priv.sdio = sdiodev;
  433. bus_if->type = SDIO_BUS;
  434. bus_if->align = BRCMF_SDALIGN;
  435. dev_set_drvdata(&func->card->dev, sdiodev);
  436. atomic_set(&sdiodev->suspend, false);
  437. init_waitqueue_head(&sdiodev->request_byte_wait);
  438. init_waitqueue_head(&sdiodev->request_word_wait);
  439. init_waitqueue_head(&sdiodev->request_chain_wait);
  440. init_waitqueue_head(&sdiodev->request_buffer_wait);
  441. }
  442. if (func->num == 2) {
  443. sdiodev = dev_get_drvdata(&func->card->dev);
  444. if ((!sdiodev) || (sdiodev->func[1]->card != func->card))
  445. return -ENODEV;
  446. ret = brcmf_sdio_getintrcfg(sdiodev);
  447. if (ret)
  448. return ret;
  449. sdiodev->func[2] = func;
  450. bus_if = sdiodev->bus_if;
  451. sdiodev->dev = &func->dev;
  452. dev_set_drvdata(&func->dev, bus_if);
  453. brcmf_dbg(TRACE, "F2 found, calling brcmf_sdio_probe...\n");
  454. ret = brcmf_sdio_probe(sdiodev);
  455. }
  456. return ret;
  457. }
  458. static void brcmf_ops_sdio_remove(struct sdio_func *func)
  459. {
  460. struct brcmf_bus *bus_if;
  461. struct brcmf_sdio_dev *sdiodev;
  462. brcmf_dbg(TRACE, "Enter\n");
  463. brcmf_dbg(INFO, "func->class=%x\n", func->class);
  464. brcmf_dbg(INFO, "sdio_vendor: 0x%04x\n", func->vendor);
  465. brcmf_dbg(INFO, "sdio_device: 0x%04x\n", func->device);
  466. brcmf_dbg(INFO, "Function#: 0x%04x\n", func->num);
  467. if (func->num == 2) {
  468. bus_if = dev_get_drvdata(&func->dev);
  469. sdiodev = bus_if->bus_priv.sdio;
  470. brcmf_dbg(TRACE, "F2 found, calling brcmf_sdio_remove...\n");
  471. brcmf_sdio_remove(sdiodev);
  472. dev_set_drvdata(&func->card->dev, NULL);
  473. dev_set_drvdata(&func->dev, NULL);
  474. kfree(bus_if);
  475. kfree(sdiodev);
  476. }
  477. }
  478. #ifdef CONFIG_PM_SLEEP
  479. static int brcmf_sdio_suspend(struct device *dev)
  480. {
  481. mmc_pm_flag_t sdio_flags;
  482. struct sdio_func *func = dev_to_sdio_func(dev);
  483. struct brcmf_sdio_dev *sdiodev = dev_get_drvdata(&func->card->dev);
  484. int ret = 0;
  485. brcmf_dbg(TRACE, "\n");
  486. atomic_set(&sdiodev->suspend, true);
  487. sdio_flags = sdio_get_host_pm_caps(sdiodev->func[1]);
  488. if (!(sdio_flags & MMC_PM_KEEP_POWER)) {
  489. brcmf_dbg(ERROR, "Host can't keep power while suspended\n");
  490. return -EINVAL;
  491. }
  492. ret = sdio_set_host_pm_flags(sdiodev->func[1], MMC_PM_KEEP_POWER);
  493. if (ret) {
  494. brcmf_dbg(ERROR, "Failed to set pm_flags\n");
  495. return ret;
  496. }
  497. brcmf_sdio_wdtmr_enable(sdiodev, false);
  498. return ret;
  499. }
  500. static int brcmf_sdio_resume(struct device *dev)
  501. {
  502. struct sdio_func *func = dev_to_sdio_func(dev);
  503. struct brcmf_sdio_dev *sdiodev = dev_get_drvdata(&func->card->dev);
  504. brcmf_sdio_wdtmr_enable(sdiodev, true);
  505. atomic_set(&sdiodev->suspend, false);
  506. return 0;
  507. }
  508. static const struct dev_pm_ops brcmf_sdio_pm_ops = {
  509. .suspend = brcmf_sdio_suspend,
  510. .resume = brcmf_sdio_resume,
  511. };
  512. #endif /* CONFIG_PM_SLEEP */
  513. static struct sdio_driver brcmf_sdmmc_driver = {
  514. .probe = brcmf_ops_sdio_probe,
  515. .remove = brcmf_ops_sdio_remove,
  516. .name = "brcmfmac",
  517. .id_table = brcmf_sdmmc_ids,
  518. #ifdef CONFIG_PM_SLEEP
  519. .drv = {
  520. .pm = &brcmf_sdio_pm_ops,
  521. },
  522. #endif /* CONFIG_PM_SLEEP */
  523. };
  524. #ifdef CONFIG_BRCMFMAC_SDIO_OOB
  525. static int brcmf_sdio_pd_probe(struct platform_device *pdev)
  526. {
  527. struct resource *res;
  528. struct brcmf_sdio_oobirq *oobirq_entry;
  529. int i, ret;
  530. INIT_LIST_HEAD(&oobirq_lh);
  531. for (i = 0; ; i++) {
  532. res = platform_get_resource(pdev, IORESOURCE_IRQ, i);
  533. if (!res)
  534. break;
  535. oobirq_entry = kzalloc(sizeof(struct brcmf_sdio_oobirq),
  536. GFP_KERNEL);
  537. oobirq_entry->irq = res->start;
  538. oobirq_entry->flags = res->flags & IRQF_TRIGGER_MASK;
  539. list_add_tail(&oobirq_entry->list, &oobirq_lh);
  540. }
  541. if (i == 0)
  542. return -ENXIO;
  543. ret = sdio_register_driver(&brcmf_sdmmc_driver);
  544. if (ret)
  545. brcmf_dbg(ERROR, "sdio_register_driver failed: %d\n", ret);
  546. return ret;
  547. }
  548. static struct platform_driver brcmf_sdio_pd = {
  549. .probe = brcmf_sdio_pd_probe,
  550. .driver = {
  551. .name = "brcmf_sdio_pd"
  552. }
  553. };
  554. void brcmf_sdio_exit(void)
  555. {
  556. brcmf_dbg(TRACE, "Enter\n");
  557. sdio_unregister_driver(&brcmf_sdmmc_driver);
  558. platform_driver_unregister(&brcmf_sdio_pd);
  559. }
  560. void brcmf_sdio_init(void)
  561. {
  562. int ret;
  563. brcmf_dbg(TRACE, "Enter\n");
  564. ret = platform_driver_register(&brcmf_sdio_pd);
  565. if (ret)
  566. brcmf_dbg(ERROR, "platform_driver_register failed: %d\n", ret);
  567. }
  568. #else
  569. void brcmf_sdio_exit(void)
  570. {
  571. brcmf_dbg(TRACE, "Enter\n");
  572. sdio_unregister_driver(&brcmf_sdmmc_driver);
  573. }
  574. void brcmf_sdio_init(void)
  575. {
  576. int ret;
  577. brcmf_dbg(TRACE, "Enter\n");
  578. ret = sdio_register_driver(&brcmf_sdmmc_driver);
  579. if (ret)
  580. brcmf_dbg(ERROR, "sdio_register_driver failed: %d\n", ret);
  581. }
  582. #endif /* CONFIG_BRCMFMAC_SDIO_OOB */