rsi_91x_sdio.c 37 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452
  1. /**
  2. * Copyright (c) 2014 Redpine Signals Inc.
  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
  11. * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  12. * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
  13. * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
  14. * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  15. *
  16. */
  17. #include <linux/module.h>
  18. #include "rsi_sdio.h"
  19. #include "rsi_common.h"
  20. #include "rsi_coex.h"
  21. #include "rsi_hal.h"
  22. /* Default operating mode is wlan STA + BT */
  23. static u16 dev_oper_mode = DEV_OPMODE_STA_BT_DUAL;
  24. module_param(dev_oper_mode, ushort, 0444);
  25. MODULE_PARM_DESC(dev_oper_mode,
  26. "1[Wi-Fi], 4[BT], 8[BT LE], 5[Wi-Fi STA + BT classic]\n"
  27. "9[Wi-Fi STA + BT LE], 13[Wi-Fi STA + BT classic + BT LE]\n"
  28. "6[AP + BT classic], 14[AP + BT classic + BT LE]");
  29. /**
  30. * rsi_sdio_set_cmd52_arg() - This function prepares cmd 52 read/write arg.
  31. * @rw: Read/write
  32. * @func: function number
  33. * @raw: indicates whether to perform read after write
  34. * @address: address to which to read/write
  35. * @writedata: data to write
  36. *
  37. * Return: argument
  38. */
  39. static u32 rsi_sdio_set_cmd52_arg(bool rw,
  40. u8 func,
  41. u8 raw,
  42. u32 address,
  43. u8 writedata)
  44. {
  45. return ((rw & 1) << 31) | ((func & 0x7) << 28) |
  46. ((raw & 1) << 27) | (1 << 26) |
  47. ((address & 0x1FFFF) << 9) | (1 << 8) |
  48. (writedata & 0xFF);
  49. }
  50. /**
  51. * rsi_cmd52writebyte() - This function issues cmd52 byte write onto the card.
  52. * @card: Pointer to the mmc_card.
  53. * @address: Address to write.
  54. * @byte: Data to write.
  55. *
  56. * Return: Write status.
  57. */
  58. static int rsi_cmd52writebyte(struct mmc_card *card,
  59. u32 address,
  60. u8 byte)
  61. {
  62. struct mmc_command io_cmd;
  63. u32 arg;
  64. memset(&io_cmd, 0, sizeof(io_cmd));
  65. arg = rsi_sdio_set_cmd52_arg(1, 0, 0, address, byte);
  66. io_cmd.opcode = SD_IO_RW_DIRECT;
  67. io_cmd.arg = arg;
  68. io_cmd.flags = MMC_RSP_R5 | MMC_CMD_AC;
  69. return mmc_wait_for_cmd(card->host, &io_cmd, 0);
  70. }
  71. /**
  72. * rsi_cmd52readbyte() - This function issues cmd52 byte read onto the card.
  73. * @card: Pointer to the mmc_card.
  74. * @address: Address to read from.
  75. * @byte: Variable to store read value.
  76. *
  77. * Return: Read status.
  78. */
  79. static int rsi_cmd52readbyte(struct mmc_card *card,
  80. u32 address,
  81. u8 *byte)
  82. {
  83. struct mmc_command io_cmd;
  84. u32 arg;
  85. int err;
  86. memset(&io_cmd, 0, sizeof(io_cmd));
  87. arg = rsi_sdio_set_cmd52_arg(0, 0, 0, address, 0);
  88. io_cmd.opcode = SD_IO_RW_DIRECT;
  89. io_cmd.arg = arg;
  90. io_cmd.flags = MMC_RSP_R5 | MMC_CMD_AC;
  91. err = mmc_wait_for_cmd(card->host, &io_cmd, 0);
  92. if ((!err) && (byte))
  93. *byte = io_cmd.resp[0] & 0xFF;
  94. return err;
  95. }
  96. /**
  97. * rsi_issue_sdiocommand() - This function issues sdio commands.
  98. * @func: Pointer to the sdio_func structure.
  99. * @opcode: Opcode value.
  100. * @arg: Arguments to pass.
  101. * @flags: Flags which are set.
  102. * @resp: Pointer to store response.
  103. *
  104. * Return: err: command status as 0 or -1.
  105. */
  106. static int rsi_issue_sdiocommand(struct sdio_func *func,
  107. u32 opcode,
  108. u32 arg,
  109. u32 flags,
  110. u32 *resp)
  111. {
  112. struct mmc_command cmd;
  113. struct mmc_host *host;
  114. int err;
  115. host = func->card->host;
  116. memset(&cmd, 0, sizeof(struct mmc_command));
  117. cmd.opcode = opcode;
  118. cmd.arg = arg;
  119. cmd.flags = flags;
  120. err = mmc_wait_for_cmd(host, &cmd, 3);
  121. if ((!err) && (resp))
  122. *resp = cmd.resp[0];
  123. return err;
  124. }
  125. /**
  126. * rsi_handle_interrupt() - This function is called upon the occurence
  127. * of an interrupt.
  128. * @function: Pointer to the sdio_func structure.
  129. *
  130. * Return: None.
  131. */
  132. static void rsi_handle_interrupt(struct sdio_func *function)
  133. {
  134. struct rsi_hw *adapter = sdio_get_drvdata(function);
  135. struct rsi_91x_sdiodev *dev =
  136. (struct rsi_91x_sdiodev *)adapter->rsi_dev;
  137. if (adapter->priv->fsm_state == FSM_FW_NOT_LOADED)
  138. return;
  139. dev->sdio_irq_task = current;
  140. rsi_interrupt_handler(adapter);
  141. dev->sdio_irq_task = NULL;
  142. }
  143. /**
  144. * rsi_reset_card() - This function resets and re-initializes the card.
  145. * @pfunction: Pointer to the sdio_func structure.
  146. *
  147. * Return: None.
  148. */
  149. static void rsi_reset_card(struct sdio_func *pfunction)
  150. {
  151. int ret = 0;
  152. int err;
  153. struct mmc_card *card = pfunction->card;
  154. struct mmc_host *host = card->host;
  155. s32 bit = (fls(host->ocr_avail) - 1);
  156. u8 cmd52_resp;
  157. u32 clock, resp, i;
  158. u16 rca;
  159. /* Reset 9110 chip */
  160. ret = rsi_cmd52writebyte(pfunction->card,
  161. SDIO_CCCR_ABORT,
  162. (1 << 3));
  163. /* Card will not send any response as it is getting reset immediately
  164. * Hence expect a timeout status from host controller
  165. */
  166. if (ret != -ETIMEDOUT)
  167. rsi_dbg(ERR_ZONE, "%s: Reset failed : %d\n", __func__, ret);
  168. /* Wait for few milli seconds to get rid of residue charges if any */
  169. msleep(20);
  170. /* Initialize the SDIO card */
  171. host->ios.vdd = bit;
  172. host->ios.chip_select = MMC_CS_DONTCARE;
  173. host->ios.bus_mode = MMC_BUSMODE_OPENDRAIN;
  174. host->ios.power_mode = MMC_POWER_UP;
  175. host->ios.bus_width = MMC_BUS_WIDTH_1;
  176. host->ios.timing = MMC_TIMING_LEGACY;
  177. host->ops->set_ios(host, &host->ios);
  178. /*
  179. * This delay should be sufficient to allow the power supply
  180. * to reach the minimum voltage.
  181. */
  182. msleep(20);
  183. host->ios.clock = host->f_min;
  184. host->ios.power_mode = MMC_POWER_ON;
  185. host->ops->set_ios(host, &host->ios);
  186. /*
  187. * This delay must be at least 74 clock sizes, or 1 ms, or the
  188. * time required to reach a stable voltage.
  189. */
  190. msleep(20);
  191. /* Issue CMD0. Goto idle state */
  192. host->ios.chip_select = MMC_CS_HIGH;
  193. host->ops->set_ios(host, &host->ios);
  194. msleep(20);
  195. err = rsi_issue_sdiocommand(pfunction,
  196. MMC_GO_IDLE_STATE,
  197. 0,
  198. (MMC_RSP_NONE | MMC_CMD_BC),
  199. NULL);
  200. host->ios.chip_select = MMC_CS_DONTCARE;
  201. host->ops->set_ios(host, &host->ios);
  202. msleep(20);
  203. host->use_spi_crc = 0;
  204. if (err)
  205. rsi_dbg(ERR_ZONE, "%s: CMD0 failed : %d\n", __func__, err);
  206. /* Issue CMD5, arg = 0 */
  207. err = rsi_issue_sdiocommand(pfunction, SD_IO_SEND_OP_COND, 0,
  208. (MMC_RSP_R4 | MMC_CMD_BCR), &resp);
  209. if (err)
  210. rsi_dbg(ERR_ZONE, "%s: CMD5 failed : %d\n", __func__, err);
  211. card->ocr = resp;
  212. /* Issue CMD5, arg = ocr. Wait till card is ready */
  213. for (i = 0; i < 100; i++) {
  214. err = rsi_issue_sdiocommand(pfunction, SD_IO_SEND_OP_COND,
  215. card->ocr,
  216. (MMC_RSP_R4 | MMC_CMD_BCR), &resp);
  217. if (err) {
  218. rsi_dbg(ERR_ZONE, "%s: CMD5 failed : %d\n",
  219. __func__, err);
  220. break;
  221. }
  222. if (resp & MMC_CARD_BUSY)
  223. break;
  224. msleep(20);
  225. }
  226. if ((i == 100) || (err)) {
  227. rsi_dbg(ERR_ZONE, "%s: card in not ready : %d %d\n",
  228. __func__, i, err);
  229. return;
  230. }
  231. /* Issue CMD3, get RCA */
  232. err = rsi_issue_sdiocommand(pfunction,
  233. SD_SEND_RELATIVE_ADDR,
  234. 0,
  235. (MMC_RSP_R6 | MMC_CMD_BCR),
  236. &resp);
  237. if (err) {
  238. rsi_dbg(ERR_ZONE, "%s: CMD3 failed : %d\n", __func__, err);
  239. return;
  240. }
  241. rca = resp >> 16;
  242. host->ios.bus_mode = MMC_BUSMODE_PUSHPULL;
  243. host->ops->set_ios(host, &host->ios);
  244. /* Issue CMD7, select card */
  245. err = rsi_issue_sdiocommand(pfunction,
  246. MMC_SELECT_CARD,
  247. (rca << 16),
  248. (MMC_RSP_R1 | MMC_CMD_AC),
  249. NULL);
  250. if (err) {
  251. rsi_dbg(ERR_ZONE, "%s: CMD7 failed : %d\n", __func__, err);
  252. return;
  253. }
  254. /* Enable high speed */
  255. if (card->host->caps & MMC_CAP_SD_HIGHSPEED) {
  256. rsi_dbg(ERR_ZONE, "%s: Set high speed mode\n", __func__);
  257. err = rsi_cmd52readbyte(card, SDIO_CCCR_SPEED, &cmd52_resp);
  258. if (err) {
  259. rsi_dbg(ERR_ZONE, "%s: CCCR speed reg read failed: %d\n",
  260. __func__, err);
  261. } else {
  262. err = rsi_cmd52writebyte(card,
  263. SDIO_CCCR_SPEED,
  264. (cmd52_resp | SDIO_SPEED_EHS));
  265. if (err) {
  266. rsi_dbg(ERR_ZONE,
  267. "%s: CCR speed regwrite failed %d\n",
  268. __func__, err);
  269. return;
  270. }
  271. host->ios.timing = MMC_TIMING_SD_HS;
  272. host->ops->set_ios(host, &host->ios);
  273. }
  274. }
  275. /* Set clock */
  276. if (mmc_card_hs(card))
  277. clock = 50000000;
  278. else
  279. clock = card->cis.max_dtr;
  280. if (clock > host->f_max)
  281. clock = host->f_max;
  282. host->ios.clock = clock;
  283. host->ops->set_ios(host, &host->ios);
  284. if (card->host->caps & MMC_CAP_4_BIT_DATA) {
  285. /* CMD52: Set bus width & disable card detect resistor */
  286. err = rsi_cmd52writebyte(card,
  287. SDIO_CCCR_IF,
  288. (SDIO_BUS_CD_DISABLE |
  289. SDIO_BUS_WIDTH_4BIT));
  290. if (err) {
  291. rsi_dbg(ERR_ZONE, "%s: Set bus mode failed : %d\n",
  292. __func__, err);
  293. return;
  294. }
  295. host->ios.bus_width = MMC_BUS_WIDTH_4;
  296. host->ops->set_ios(host, &host->ios);
  297. }
  298. }
  299. /**
  300. * rsi_setclock() - This function sets the clock frequency.
  301. * @adapter: Pointer to the adapter structure.
  302. * @freq: Clock frequency.
  303. *
  304. * Return: None.
  305. */
  306. static void rsi_setclock(struct rsi_hw *adapter, u32 freq)
  307. {
  308. struct rsi_91x_sdiodev *dev =
  309. (struct rsi_91x_sdiodev *)adapter->rsi_dev;
  310. struct mmc_host *host = dev->pfunction->card->host;
  311. u32 clock;
  312. clock = freq * 1000;
  313. if (clock > host->f_max)
  314. clock = host->f_max;
  315. host->ios.clock = clock;
  316. host->ops->set_ios(host, &host->ios);
  317. }
  318. /**
  319. * rsi_setblocklength() - This function sets the host block length.
  320. * @adapter: Pointer to the adapter structure.
  321. * @length: Block length to be set.
  322. *
  323. * Return: status: 0 on success, -1 on failure.
  324. */
  325. static int rsi_setblocklength(struct rsi_hw *adapter, u32 length)
  326. {
  327. struct rsi_91x_sdiodev *dev =
  328. (struct rsi_91x_sdiodev *)adapter->rsi_dev;
  329. int status;
  330. rsi_dbg(INIT_ZONE, "%s: Setting the block length\n", __func__);
  331. status = sdio_set_block_size(dev->pfunction, length);
  332. dev->pfunction->max_blksize = 256;
  333. adapter->block_size = dev->pfunction->max_blksize;
  334. rsi_dbg(INFO_ZONE,
  335. "%s: Operational blk length is %d\n", __func__, length);
  336. return status;
  337. }
  338. /**
  339. * rsi_setupcard() - This function queries and sets the card's features.
  340. * @adapter: Pointer to the adapter structure.
  341. *
  342. * Return: status: 0 on success, -1 on failure.
  343. */
  344. static int rsi_setupcard(struct rsi_hw *adapter)
  345. {
  346. struct rsi_91x_sdiodev *dev =
  347. (struct rsi_91x_sdiodev *)adapter->rsi_dev;
  348. int status = 0;
  349. rsi_setclock(adapter, 50000);
  350. dev->tx_blk_size = 256;
  351. status = rsi_setblocklength(adapter, dev->tx_blk_size);
  352. if (status)
  353. rsi_dbg(ERR_ZONE,
  354. "%s: Unable to set block length\n", __func__);
  355. return status;
  356. }
  357. /**
  358. * rsi_sdio_read_register() - This function reads one byte of information
  359. * from a register.
  360. * @adapter: Pointer to the adapter structure.
  361. * @addr: Address of the register.
  362. * @data: Pointer to the data that stores the data read.
  363. *
  364. * Return: 0 on success, -1 on failure.
  365. */
  366. int rsi_sdio_read_register(struct rsi_hw *adapter,
  367. u32 addr,
  368. u8 *data)
  369. {
  370. struct rsi_91x_sdiodev *dev =
  371. (struct rsi_91x_sdiodev *)adapter->rsi_dev;
  372. u8 fun_num = 0;
  373. int status;
  374. if (likely(dev->sdio_irq_task != current))
  375. sdio_claim_host(dev->pfunction);
  376. if (fun_num == 0)
  377. *data = sdio_f0_readb(dev->pfunction, addr, &status);
  378. else
  379. *data = sdio_readb(dev->pfunction, addr, &status);
  380. if (likely(dev->sdio_irq_task != current))
  381. sdio_release_host(dev->pfunction);
  382. return status;
  383. }
  384. /**
  385. * rsi_sdio_write_register() - This function writes one byte of information
  386. * into a register.
  387. * @adapter: Pointer to the adapter structure.
  388. * @function: Function Number.
  389. * @addr: Address of the register.
  390. * @data: Pointer to the data tha has to be written.
  391. *
  392. * Return: 0 on success, -1 on failure.
  393. */
  394. int rsi_sdio_write_register(struct rsi_hw *adapter,
  395. u8 function,
  396. u32 addr,
  397. u8 *data)
  398. {
  399. struct rsi_91x_sdiodev *dev =
  400. (struct rsi_91x_sdiodev *)adapter->rsi_dev;
  401. int status = 0;
  402. if (likely(dev->sdio_irq_task != current))
  403. sdio_claim_host(dev->pfunction);
  404. if (function == 0)
  405. sdio_f0_writeb(dev->pfunction, *data, addr, &status);
  406. else
  407. sdio_writeb(dev->pfunction, *data, addr, &status);
  408. if (likely(dev->sdio_irq_task != current))
  409. sdio_release_host(dev->pfunction);
  410. return status;
  411. }
  412. /**
  413. * rsi_sdio_ack_intr() - This function acks the interrupt received.
  414. * @adapter: Pointer to the adapter structure.
  415. * @int_bit: Interrupt bit to write into register.
  416. *
  417. * Return: None.
  418. */
  419. void rsi_sdio_ack_intr(struct rsi_hw *adapter, u8 int_bit)
  420. {
  421. int status;
  422. status = rsi_sdio_write_register(adapter,
  423. 1,
  424. (SDIO_FUN1_INTR_CLR_REG |
  425. RSI_SD_REQUEST_MASTER),
  426. &int_bit);
  427. if (status)
  428. rsi_dbg(ERR_ZONE, "%s: unable to send ack\n", __func__);
  429. }
  430. /**
  431. * rsi_sdio_read_register_multiple() - This function read multiple bytes of
  432. * information from the SD card.
  433. * @adapter: Pointer to the adapter structure.
  434. * @addr: Address of the register.
  435. * @count: Number of multiple bytes to be read.
  436. * @data: Pointer to the read data.
  437. *
  438. * Return: 0 on success, -1 on failure.
  439. */
  440. static int rsi_sdio_read_register_multiple(struct rsi_hw *adapter,
  441. u32 addr,
  442. u8 *data,
  443. u16 count)
  444. {
  445. struct rsi_91x_sdiodev *dev =
  446. (struct rsi_91x_sdiodev *)adapter->rsi_dev;
  447. u32 status;
  448. if (likely(dev->sdio_irq_task != current))
  449. sdio_claim_host(dev->pfunction);
  450. status = sdio_readsb(dev->pfunction, data, addr, count);
  451. if (likely(dev->sdio_irq_task != current))
  452. sdio_release_host(dev->pfunction);
  453. if (status != 0)
  454. rsi_dbg(ERR_ZONE, "%s: Synch Cmd53 read failed\n", __func__);
  455. return status;
  456. }
  457. /**
  458. * rsi_sdio_write_register_multiple() - This function writes multiple bytes of
  459. * information to the SD card.
  460. * @adapter: Pointer to the adapter structure.
  461. * @addr: Address of the register.
  462. * @data: Pointer to the data that has to be written.
  463. * @count: Number of multiple bytes to be written.
  464. *
  465. * Return: 0 on success, -1 on failure.
  466. */
  467. int rsi_sdio_write_register_multiple(struct rsi_hw *adapter,
  468. u32 addr,
  469. u8 *data,
  470. u16 count)
  471. {
  472. struct rsi_91x_sdiodev *dev =
  473. (struct rsi_91x_sdiodev *)adapter->rsi_dev;
  474. int status;
  475. if (dev->write_fail > 1) {
  476. rsi_dbg(ERR_ZONE, "%s: Stopping card writes\n", __func__);
  477. return 0;
  478. } else if (dev->write_fail == 1) {
  479. /**
  480. * Assuming it is a CRC failure, we want to allow another
  481. * card write
  482. */
  483. rsi_dbg(ERR_ZONE, "%s: Continue card writes\n", __func__);
  484. dev->write_fail++;
  485. }
  486. if (likely(dev->sdio_irq_task != current))
  487. sdio_claim_host(dev->pfunction);
  488. status = sdio_writesb(dev->pfunction, addr, data, count);
  489. if (likely(dev->sdio_irq_task != current))
  490. sdio_release_host(dev->pfunction);
  491. if (status) {
  492. rsi_dbg(ERR_ZONE, "%s: Synch Cmd53 write failed %d\n",
  493. __func__, status);
  494. dev->write_fail = 2;
  495. } else {
  496. memcpy(dev->prev_desc, data, FRAME_DESC_SZ);
  497. }
  498. return status;
  499. }
  500. static int rsi_sdio_load_data_master_write(struct rsi_hw *adapter,
  501. u32 base_address,
  502. u32 instructions_sz,
  503. u16 block_size,
  504. u8 *ta_firmware)
  505. {
  506. u32 num_blocks, offset, i;
  507. u16 msb_address, lsb_address;
  508. u8 *temp_buf;
  509. int status;
  510. num_blocks = instructions_sz / block_size;
  511. msb_address = base_address >> 16;
  512. rsi_dbg(INFO_ZONE, "ins_size: %d, num_blocks: %d\n",
  513. instructions_sz, num_blocks);
  514. temp_buf = kmalloc(block_size, GFP_KERNEL);
  515. if (!temp_buf)
  516. return -ENOMEM;
  517. /* Loading DM ms word in the sdio slave */
  518. status = rsi_sdio_master_access_msword(adapter, msb_address);
  519. if (status < 0) {
  520. rsi_dbg(ERR_ZONE, "%s: Unable to set ms word reg\n", __func__);
  521. goto out_free;
  522. }
  523. for (offset = 0, i = 0; i < num_blocks; i++, offset += block_size) {
  524. memcpy(temp_buf, ta_firmware + offset, block_size);
  525. lsb_address = (u16)base_address;
  526. status = rsi_sdio_write_register_multiple
  527. (adapter,
  528. lsb_address | RSI_SD_REQUEST_MASTER,
  529. temp_buf, block_size);
  530. if (status < 0) {
  531. rsi_dbg(ERR_ZONE, "%s: failed to write\n", __func__);
  532. goto out_free;
  533. }
  534. rsi_dbg(INFO_ZONE, "%s: loading block: %d\n", __func__, i);
  535. base_address += block_size;
  536. if ((base_address >> 16) != msb_address) {
  537. msb_address += 1;
  538. /* Loading DM ms word in the sdio slave */
  539. status = rsi_sdio_master_access_msword(adapter,
  540. msb_address);
  541. if (status < 0) {
  542. rsi_dbg(ERR_ZONE,
  543. "%s: Unable to set ms word reg\n",
  544. __func__);
  545. goto out_free;
  546. }
  547. }
  548. }
  549. if (instructions_sz % block_size) {
  550. memset(temp_buf, 0, block_size);
  551. memcpy(temp_buf, ta_firmware + offset,
  552. instructions_sz % block_size);
  553. lsb_address = (u16)base_address;
  554. status = rsi_sdio_write_register_multiple
  555. (adapter,
  556. lsb_address | RSI_SD_REQUEST_MASTER,
  557. temp_buf,
  558. instructions_sz % block_size);
  559. if (status < 0)
  560. goto out_free;
  561. rsi_dbg(INFO_ZONE,
  562. "Written Last Block in Address 0x%x Successfully\n",
  563. offset | RSI_SD_REQUEST_MASTER);
  564. }
  565. status = 0;
  566. out_free:
  567. kfree(temp_buf);
  568. return status;
  569. }
  570. #define FLASH_SIZE_ADDR 0x04000016
  571. static int rsi_sdio_master_reg_read(struct rsi_hw *adapter, u32 addr,
  572. u32 *read_buf, u16 size)
  573. {
  574. u32 addr_on_bus, *data;
  575. u16 ms_addr;
  576. int status;
  577. data = kzalloc(RSI_MASTER_REG_BUF_SIZE, GFP_KERNEL);
  578. if (!data)
  579. return -ENOMEM;
  580. data = PTR_ALIGN(data, 8);
  581. ms_addr = (addr >> 16);
  582. status = rsi_sdio_master_access_msword(adapter, ms_addr);
  583. if (status < 0) {
  584. rsi_dbg(ERR_ZONE,
  585. "%s: Unable to set ms word to common reg\n",
  586. __func__);
  587. goto err;
  588. }
  589. addr &= 0xFFFF;
  590. addr_on_bus = (addr & 0xFF000000);
  591. if ((addr_on_bus == (FLASH_SIZE_ADDR & 0xFF000000)) ||
  592. (addr_on_bus == 0x0))
  593. addr_on_bus = (addr & ~(0x3));
  594. else
  595. addr_on_bus = addr;
  596. /* Bring TA out of reset */
  597. status = rsi_sdio_read_register_multiple
  598. (adapter,
  599. (addr_on_bus | RSI_SD_REQUEST_MASTER),
  600. (u8 *)data, 4);
  601. if (status < 0) {
  602. rsi_dbg(ERR_ZONE, "%s: AHB register read failed\n", __func__);
  603. goto err;
  604. }
  605. if (size == 2) {
  606. if ((addr & 0x3) == 0)
  607. *read_buf = *data;
  608. else
  609. *read_buf = (*data >> 16);
  610. *read_buf = (*read_buf & 0xFFFF);
  611. } else if (size == 1) {
  612. if ((addr & 0x3) == 0)
  613. *read_buf = *data;
  614. else if ((addr & 0x3) == 1)
  615. *read_buf = (*data >> 8);
  616. else if ((addr & 0x3) == 2)
  617. *read_buf = (*data >> 16);
  618. else
  619. *read_buf = (*data >> 24);
  620. *read_buf = (*read_buf & 0xFF);
  621. } else {
  622. *read_buf = *data;
  623. }
  624. err:
  625. kfree(data);
  626. return status;
  627. }
  628. static int rsi_sdio_master_reg_write(struct rsi_hw *adapter,
  629. unsigned long addr,
  630. unsigned long data, u16 size)
  631. {
  632. unsigned long *data_aligned;
  633. int status;
  634. data_aligned = kzalloc(RSI_MASTER_REG_BUF_SIZE, GFP_KERNEL);
  635. if (!data_aligned)
  636. return -ENOMEM;
  637. data_aligned = PTR_ALIGN(data_aligned, 8);
  638. if (size == 2) {
  639. *data_aligned = ((data << 16) | (data & 0xFFFF));
  640. } else if (size == 1) {
  641. u32 temp_data = data & 0xFF;
  642. *data_aligned = ((temp_data << 24) | (temp_data << 16) |
  643. (temp_data << 8) | temp_data);
  644. } else {
  645. *data_aligned = data;
  646. }
  647. size = 4;
  648. status = rsi_sdio_master_access_msword(adapter, (addr >> 16));
  649. if (status < 0) {
  650. rsi_dbg(ERR_ZONE,
  651. "%s: Unable to set ms word to common reg\n",
  652. __func__);
  653. kfree(data_aligned);
  654. return -EIO;
  655. }
  656. addr = addr & 0xFFFF;
  657. /* Bring TA out of reset */
  658. status = rsi_sdio_write_register_multiple
  659. (adapter,
  660. (addr | RSI_SD_REQUEST_MASTER),
  661. (u8 *)data_aligned, size);
  662. if (status < 0)
  663. rsi_dbg(ERR_ZONE,
  664. "%s: Unable to do AHB reg write\n", __func__);
  665. kfree(data_aligned);
  666. return status;
  667. }
  668. /**
  669. * rsi_sdio_host_intf_write_pkt() - This function writes the packet to device.
  670. * @adapter: Pointer to the adapter structure.
  671. * @pkt: Pointer to the data to be written on to the device.
  672. * @len: length of the data to be written on to the device.
  673. *
  674. * Return: 0 on success, -1 on failure.
  675. */
  676. static int rsi_sdio_host_intf_write_pkt(struct rsi_hw *adapter,
  677. u8 *pkt,
  678. u32 len)
  679. {
  680. struct rsi_91x_sdiodev *dev =
  681. (struct rsi_91x_sdiodev *)adapter->rsi_dev;
  682. u32 block_size = dev->tx_blk_size;
  683. u32 num_blocks, address, length;
  684. u32 queueno;
  685. int status;
  686. queueno = ((pkt[1] >> 4) & 0xf);
  687. if (queueno == RSI_BT_MGMT_Q || queueno == RSI_BT_DATA_Q)
  688. queueno = RSI_BT_Q;
  689. num_blocks = len / block_size;
  690. if (len % block_size)
  691. num_blocks++;
  692. address = (num_blocks * block_size | (queueno << 12));
  693. length = num_blocks * block_size;
  694. status = rsi_sdio_write_register_multiple(adapter,
  695. address,
  696. (u8 *)pkt,
  697. length);
  698. if (status)
  699. rsi_dbg(ERR_ZONE, "%s: Unable to write onto the card: %d\n",
  700. __func__, status);
  701. rsi_dbg(DATA_TX_ZONE, "%s: Successfully written onto card\n", __func__);
  702. return status;
  703. }
  704. /**
  705. * rsi_sdio_host_intf_read_pkt() - This function reads the packet
  706. from the device.
  707. * @adapter: Pointer to the adapter data structure.
  708. * @pkt: Pointer to the packet data to be read from the the device.
  709. * @length: Length of the data to be read from the device.
  710. *
  711. * Return: 0 on success, -1 on failure.
  712. */
  713. int rsi_sdio_host_intf_read_pkt(struct rsi_hw *adapter,
  714. u8 *pkt,
  715. u32 length)
  716. {
  717. int status = -EINVAL;
  718. if (!length) {
  719. rsi_dbg(ERR_ZONE, "%s: Pkt size is zero\n", __func__);
  720. return status;
  721. }
  722. status = rsi_sdio_read_register_multiple(adapter,
  723. length,
  724. (u8 *)pkt,
  725. length); /*num of bytes*/
  726. if (status)
  727. rsi_dbg(ERR_ZONE, "%s: Failed to read frame: %d\n", __func__,
  728. status);
  729. return status;
  730. }
  731. /**
  732. * rsi_init_sdio_interface() - This function does init specific to SDIO.
  733. *
  734. * @adapter: Pointer to the adapter data structure.
  735. * @pkt: Pointer to the packet data to be read from the the device.
  736. *
  737. * Return: 0 on success, -1 on failure.
  738. */
  739. static int rsi_init_sdio_interface(struct rsi_hw *adapter,
  740. struct sdio_func *pfunction)
  741. {
  742. struct rsi_91x_sdiodev *rsi_91x_dev;
  743. int status = -ENOMEM;
  744. rsi_91x_dev = kzalloc(sizeof(*rsi_91x_dev), GFP_KERNEL);
  745. if (!rsi_91x_dev)
  746. return status;
  747. adapter->rsi_dev = rsi_91x_dev;
  748. sdio_claim_host(pfunction);
  749. pfunction->enable_timeout = 100;
  750. status = sdio_enable_func(pfunction);
  751. if (status) {
  752. rsi_dbg(ERR_ZONE, "%s: Failed to enable interface\n", __func__);
  753. sdio_release_host(pfunction);
  754. return status;
  755. }
  756. rsi_dbg(INIT_ZONE, "%s: Enabled the interface\n", __func__);
  757. rsi_91x_dev->pfunction = pfunction;
  758. adapter->device = &pfunction->dev;
  759. sdio_set_drvdata(pfunction, adapter);
  760. status = rsi_setupcard(adapter);
  761. if (status) {
  762. rsi_dbg(ERR_ZONE, "%s: Failed to setup card\n", __func__);
  763. goto fail;
  764. }
  765. rsi_dbg(INIT_ZONE, "%s: Setup card succesfully\n", __func__);
  766. status = rsi_init_sdio_slave_regs(adapter);
  767. if (status) {
  768. rsi_dbg(ERR_ZONE, "%s: Failed to init slave regs\n", __func__);
  769. goto fail;
  770. }
  771. sdio_release_host(pfunction);
  772. adapter->determine_event_timeout = rsi_sdio_determine_event_timeout;
  773. adapter->check_hw_queue_status = rsi_sdio_check_buffer_status;
  774. #ifdef CONFIG_RSI_DEBUGFS
  775. adapter->num_debugfs_entries = MAX_DEBUGFS_ENTRIES;
  776. #endif
  777. return status;
  778. fail:
  779. sdio_disable_func(pfunction);
  780. sdio_release_host(pfunction);
  781. return status;
  782. }
  783. static int rsi_sdio_reinit_device(struct rsi_hw *adapter)
  784. {
  785. struct rsi_91x_sdiodev *sdev = adapter->rsi_dev;
  786. struct sdio_func *pfunction = sdev->pfunction;
  787. int ii;
  788. for (ii = 0; ii < NUM_SOFT_QUEUES; ii++)
  789. skb_queue_purge(&adapter->priv->tx_queue[ii]);
  790. /* Initialize device again */
  791. sdio_claim_host(pfunction);
  792. sdio_release_irq(pfunction);
  793. rsi_reset_card(pfunction);
  794. sdio_enable_func(pfunction);
  795. rsi_setupcard(adapter);
  796. rsi_init_sdio_slave_regs(adapter);
  797. sdio_claim_irq(pfunction, rsi_handle_interrupt);
  798. rsi_hal_device_init(adapter);
  799. sdio_release_host(pfunction);
  800. return 0;
  801. }
  802. static struct rsi_host_intf_ops sdio_host_intf_ops = {
  803. .write_pkt = rsi_sdio_host_intf_write_pkt,
  804. .read_pkt = rsi_sdio_host_intf_read_pkt,
  805. .master_access_msword = rsi_sdio_master_access_msword,
  806. .read_reg_multiple = rsi_sdio_read_register_multiple,
  807. .write_reg_multiple = rsi_sdio_write_register_multiple,
  808. .master_reg_read = rsi_sdio_master_reg_read,
  809. .master_reg_write = rsi_sdio_master_reg_write,
  810. .load_data_master_write = rsi_sdio_load_data_master_write,
  811. .reinit_device = rsi_sdio_reinit_device,
  812. };
  813. /**
  814. * rsi_probe() - This function is called by kernel when the driver provided
  815. * Vendor and device IDs are matched. All the initialization
  816. * work is done here.
  817. * @pfunction: Pointer to the sdio_func structure.
  818. * @id: Pointer to sdio_device_id structure.
  819. *
  820. * Return: 0 on success, 1 on failure.
  821. */
  822. static int rsi_probe(struct sdio_func *pfunction,
  823. const struct sdio_device_id *id)
  824. {
  825. struct rsi_hw *adapter;
  826. struct rsi_91x_sdiodev *sdev;
  827. int status;
  828. rsi_dbg(INIT_ZONE, "%s: Init function called\n", __func__);
  829. adapter = rsi_91x_init(dev_oper_mode);
  830. if (!adapter) {
  831. rsi_dbg(ERR_ZONE, "%s: Failed to init os intf ops\n",
  832. __func__);
  833. return -EINVAL;
  834. }
  835. adapter->rsi_host_intf = RSI_HOST_INTF_SDIO;
  836. adapter->host_intf_ops = &sdio_host_intf_ops;
  837. if (rsi_init_sdio_interface(adapter, pfunction)) {
  838. rsi_dbg(ERR_ZONE, "%s: Failed to init sdio interface\n",
  839. __func__);
  840. status = -EIO;
  841. goto fail_free_adapter;
  842. }
  843. sdev = (struct rsi_91x_sdiodev *)adapter->rsi_dev;
  844. rsi_init_event(&sdev->rx_thread.event);
  845. status = rsi_create_kthread(adapter->priv, &sdev->rx_thread,
  846. rsi_sdio_rx_thread, "SDIO-RX-Thread");
  847. if (status) {
  848. rsi_dbg(ERR_ZONE, "%s: Unable to init rx thrd\n", __func__);
  849. goto fail_kill_thread;
  850. }
  851. skb_queue_head_init(&sdev->rx_q.head);
  852. sdev->rx_q.num_rx_pkts = 0;
  853. sdio_claim_host(pfunction);
  854. if (sdio_claim_irq(pfunction, rsi_handle_interrupt)) {
  855. rsi_dbg(ERR_ZONE, "%s: Failed to request IRQ\n", __func__);
  856. sdio_release_host(pfunction);
  857. status = -EIO;
  858. goto fail_claim_irq;
  859. }
  860. sdio_release_host(pfunction);
  861. rsi_dbg(INIT_ZONE, "%s: Registered Interrupt handler\n", __func__);
  862. if (rsi_hal_device_init(adapter)) {
  863. rsi_dbg(ERR_ZONE, "%s: Failed in device init\n", __func__);
  864. status = -EINVAL;
  865. goto fail_dev_init;
  866. }
  867. rsi_dbg(INFO_ZONE, "===> RSI Device Init Done <===\n");
  868. if (rsi_sdio_master_access_msword(adapter, MISC_CFG_BASE_ADDR)) {
  869. rsi_dbg(ERR_ZONE, "%s: Unable to set ms word reg\n", __func__);
  870. status = -EIO;
  871. goto fail_dev_init;
  872. }
  873. adapter->priv->hibernate_resume = false;
  874. adapter->priv->reinit_hw = false;
  875. return 0;
  876. fail_dev_init:
  877. sdio_claim_host(pfunction);
  878. sdio_release_irq(pfunction);
  879. sdio_release_host(pfunction);
  880. fail_claim_irq:
  881. rsi_kill_thread(&sdev->rx_thread);
  882. fail_kill_thread:
  883. sdio_claim_host(pfunction);
  884. sdio_disable_func(pfunction);
  885. sdio_release_host(pfunction);
  886. fail_free_adapter:
  887. rsi_91x_deinit(adapter);
  888. rsi_dbg(ERR_ZONE, "%s: Failed in probe...Exiting\n", __func__);
  889. return status;
  890. }
  891. static void ulp_read_write(struct rsi_hw *adapter, u16 addr, u32 data,
  892. u16 len_in_bits)
  893. {
  894. rsi_sdio_master_reg_write(adapter, RSI_GSPI_DATA_REG1,
  895. ((addr << 6) | ((data >> 16) & 0xffff)), 2);
  896. rsi_sdio_master_reg_write(adapter, RSI_GSPI_DATA_REG0,
  897. (data & 0xffff), 2);
  898. rsi_sdio_master_reg_write(adapter, RSI_GSPI_CTRL_REG0,
  899. RSI_GSPI_CTRL_REG0_VALUE, 2);
  900. rsi_sdio_master_reg_write(adapter, RSI_GSPI_CTRL_REG1,
  901. ((len_in_bits - 1) | RSI_GSPI_TRIG), 2);
  902. msleep(20);
  903. }
  904. /*This function resets and re-initializes the chip.*/
  905. static void rsi_reset_chip(struct rsi_hw *adapter)
  906. {
  907. __le32 data;
  908. u8 sdio_interrupt_status = 0;
  909. u8 request = 1;
  910. int ret;
  911. rsi_dbg(INFO_ZONE, "Writing disable to wakeup register\n");
  912. ret = rsi_sdio_write_register(adapter, 0, SDIO_WAKEUP_REG, &request);
  913. if (ret < 0) {
  914. rsi_dbg(ERR_ZONE,
  915. "%s: Failed to write SDIO wakeup register\n", __func__);
  916. return;
  917. }
  918. msleep(20);
  919. ret = rsi_sdio_read_register(adapter, RSI_FN1_INT_REGISTER,
  920. &sdio_interrupt_status);
  921. if (ret < 0) {
  922. rsi_dbg(ERR_ZONE, "%s: Failed to Read Intr Status Register\n",
  923. __func__);
  924. return;
  925. }
  926. rsi_dbg(INFO_ZONE, "%s: Intr Status Register value = %d\n",
  927. __func__, sdio_interrupt_status);
  928. /* Put Thread-Arch processor on hold */
  929. if (rsi_sdio_master_access_msword(adapter, TA_BASE_ADDR)) {
  930. rsi_dbg(ERR_ZONE,
  931. "%s: Unable to set ms word to common reg\n",
  932. __func__);
  933. return;
  934. }
  935. data = TA_HOLD_THREAD_VALUE;
  936. if (rsi_sdio_write_register_multiple(adapter, TA_HOLD_THREAD_REG |
  937. RSI_SD_REQUEST_MASTER,
  938. (u8 *)&data, 4)) {
  939. rsi_dbg(ERR_ZONE,
  940. "%s: Unable to hold Thread-Arch processor threads\n",
  941. __func__);
  942. return;
  943. }
  944. /* This msleep will ensure Thread-Arch processor to go to hold
  945. * and any pending dma transfers to rf spi in device to finish.
  946. */
  947. msleep(100);
  948. ulp_read_write(adapter, RSI_ULP_RESET_REG, RSI_ULP_WRITE_0, 32);
  949. ulp_read_write(adapter, RSI_WATCH_DOG_TIMER_1, RSI_ULP_WRITE_2, 32);
  950. ulp_read_write(adapter, RSI_WATCH_DOG_TIMER_2, RSI_ULP_WRITE_0, 32);
  951. ulp_read_write(adapter, RSI_WATCH_DOG_DELAY_TIMER_1, RSI_ULP_WRITE_50,
  952. 32);
  953. ulp_read_write(adapter, RSI_WATCH_DOG_DELAY_TIMER_2, RSI_ULP_WRITE_0,
  954. 32);
  955. ulp_read_write(adapter, RSI_WATCH_DOG_TIMER_ENABLE,
  956. RSI_ULP_TIMER_ENABLE, 32);
  957. /* This msleep will be sufficient for the ulp
  958. * read write operations to complete for chip reset.
  959. */
  960. msleep(500);
  961. }
  962. /**
  963. * rsi_disconnect() - This function performs the reverse of the probe function.
  964. * @pfunction: Pointer to the sdio_func structure.
  965. *
  966. * Return: void.
  967. */
  968. static void rsi_disconnect(struct sdio_func *pfunction)
  969. {
  970. struct rsi_hw *adapter = sdio_get_drvdata(pfunction);
  971. struct rsi_91x_sdiodev *dev;
  972. if (!adapter)
  973. return;
  974. dev = (struct rsi_91x_sdiodev *)adapter->rsi_dev;
  975. rsi_kill_thread(&dev->rx_thread);
  976. sdio_claim_host(pfunction);
  977. sdio_release_irq(pfunction);
  978. sdio_release_host(pfunction);
  979. mdelay(10);
  980. rsi_mac80211_detach(adapter);
  981. mdelay(10);
  982. /* Reset Chip */
  983. rsi_reset_chip(adapter);
  984. /* Resetting to take care of the case, where-in driver is re-loaded */
  985. sdio_claim_host(pfunction);
  986. rsi_reset_card(pfunction);
  987. sdio_disable_func(pfunction);
  988. sdio_release_host(pfunction);
  989. dev->write_fail = 2;
  990. rsi_91x_deinit(adapter);
  991. rsi_dbg(ERR_ZONE, "##### RSI SDIO device disconnected #####\n");
  992. }
  993. #ifdef CONFIG_PM
  994. static int rsi_set_sdio_pm_caps(struct rsi_hw *adapter)
  995. {
  996. struct rsi_91x_sdiodev *dev =
  997. (struct rsi_91x_sdiodev *)adapter->rsi_dev;
  998. struct sdio_func *func = dev->pfunction;
  999. int ret;
  1000. ret = sdio_set_host_pm_flags(func, MMC_PM_KEEP_POWER);
  1001. if (ret)
  1002. rsi_dbg(ERR_ZONE, "Set sdio keep pwr flag failed: %d\n", ret);
  1003. return ret;
  1004. }
  1005. static int rsi_sdio_disable_interrupts(struct sdio_func *pfunc)
  1006. {
  1007. struct rsi_hw *adapter = sdio_get_drvdata(pfunc);
  1008. u8 isr_status = 0, data = 0;
  1009. int ret;
  1010. unsigned long t1;
  1011. rsi_dbg(INFO_ZONE, "Waiting for interrupts to be cleared..");
  1012. t1 = jiffies;
  1013. do {
  1014. rsi_sdio_read_register(adapter, RSI_FN1_INT_REGISTER,
  1015. &isr_status);
  1016. rsi_dbg(INFO_ZONE, ".");
  1017. } while ((isr_status) && (jiffies_to_msecs(jiffies - t1) < 20));
  1018. rsi_dbg(INFO_ZONE, "Interrupts cleared\n");
  1019. sdio_claim_host(pfunc);
  1020. ret = rsi_cmd52readbyte(pfunc->card, RSI_INT_ENABLE_REGISTER, &data);
  1021. if (ret < 0) {
  1022. rsi_dbg(ERR_ZONE,
  1023. "%s: Failed to read int enable register\n",
  1024. __func__);
  1025. goto done;
  1026. }
  1027. data &= RSI_INT_ENABLE_MASK;
  1028. ret = rsi_cmd52writebyte(pfunc->card, RSI_INT_ENABLE_REGISTER, data);
  1029. if (ret < 0) {
  1030. rsi_dbg(ERR_ZONE,
  1031. "%s: Failed to write to int enable register\n",
  1032. __func__);
  1033. goto done;
  1034. }
  1035. ret = rsi_cmd52readbyte(pfunc->card, RSI_INT_ENABLE_REGISTER, &data);
  1036. if (ret < 0) {
  1037. rsi_dbg(ERR_ZONE,
  1038. "%s: Failed to read int enable register\n",
  1039. __func__);
  1040. goto done;
  1041. }
  1042. rsi_dbg(INFO_ZONE, "int enable reg content = %x\n", data);
  1043. done:
  1044. sdio_release_host(pfunc);
  1045. return ret;
  1046. }
  1047. static int rsi_sdio_enable_interrupts(struct sdio_func *pfunc)
  1048. {
  1049. u8 data;
  1050. int ret;
  1051. struct rsi_hw *adapter = sdio_get_drvdata(pfunc);
  1052. struct rsi_common *common = adapter->priv;
  1053. sdio_claim_host(pfunc);
  1054. ret = rsi_cmd52readbyte(pfunc->card, RSI_INT_ENABLE_REGISTER, &data);
  1055. if (ret < 0) {
  1056. rsi_dbg(ERR_ZONE,
  1057. "%s: Failed to read int enable register\n", __func__);
  1058. goto done;
  1059. }
  1060. data |= ~RSI_INT_ENABLE_MASK & 0xff;
  1061. ret = rsi_cmd52writebyte(pfunc->card, RSI_INT_ENABLE_REGISTER, data);
  1062. if (ret < 0) {
  1063. rsi_dbg(ERR_ZONE,
  1064. "%s: Failed to write to int enable register\n",
  1065. __func__);
  1066. goto done;
  1067. }
  1068. if ((common->wow_flags & RSI_WOW_ENABLED) &&
  1069. (common->wow_flags & RSI_WOW_NO_CONNECTION))
  1070. rsi_dbg(ERR_ZONE,
  1071. "##### Device can not wake up through WLAN\n");
  1072. ret = rsi_cmd52readbyte(pfunc->card, RSI_INT_ENABLE_REGISTER, &data);
  1073. if (ret < 0) {
  1074. rsi_dbg(ERR_ZONE,
  1075. "%s: Failed to read int enable register\n", __func__);
  1076. goto done;
  1077. }
  1078. rsi_dbg(INFO_ZONE, "int enable reg content = %x\n", data);
  1079. done:
  1080. sdio_release_host(pfunc);
  1081. return ret;
  1082. }
  1083. static int rsi_suspend(struct device *dev)
  1084. {
  1085. int ret;
  1086. struct sdio_func *pfunction = dev_to_sdio_func(dev);
  1087. struct rsi_hw *adapter = sdio_get_drvdata(pfunction);
  1088. struct rsi_common *common;
  1089. if (!adapter) {
  1090. rsi_dbg(ERR_ZONE, "Device is not ready\n");
  1091. return -ENODEV;
  1092. }
  1093. common = adapter->priv;
  1094. rsi_sdio_disable_interrupts(pfunction);
  1095. ret = rsi_set_sdio_pm_caps(adapter);
  1096. if (ret)
  1097. rsi_dbg(INFO_ZONE,
  1098. "Setting power management caps failed\n");
  1099. common->fsm_state = FSM_CARD_NOT_READY;
  1100. return 0;
  1101. }
  1102. static int rsi_resume(struct device *dev)
  1103. {
  1104. struct sdio_func *pfunction = dev_to_sdio_func(dev);
  1105. struct rsi_hw *adapter = sdio_get_drvdata(pfunction);
  1106. struct rsi_common *common = adapter->priv;
  1107. common->fsm_state = FSM_MAC_INIT_DONE;
  1108. rsi_sdio_enable_interrupts(pfunction);
  1109. return 0;
  1110. }
  1111. static int rsi_freeze(struct device *dev)
  1112. {
  1113. int ret;
  1114. struct sdio_func *pfunction = dev_to_sdio_func(dev);
  1115. struct rsi_hw *adapter = sdio_get_drvdata(pfunction);
  1116. struct rsi_common *common;
  1117. struct rsi_91x_sdiodev *sdev;
  1118. rsi_dbg(INFO_ZONE, "SDIO Bus freeze ===>\n");
  1119. if (!adapter) {
  1120. rsi_dbg(ERR_ZONE, "Device is not ready\n");
  1121. return -ENODEV;
  1122. }
  1123. common = adapter->priv;
  1124. sdev = (struct rsi_91x_sdiodev *)adapter->rsi_dev;
  1125. if ((common->wow_flags & RSI_WOW_ENABLED) &&
  1126. (common->wow_flags & RSI_WOW_NO_CONNECTION))
  1127. rsi_dbg(ERR_ZONE,
  1128. "##### Device can not wake up through WLAN\n");
  1129. ret = rsi_sdio_disable_interrupts(pfunction);
  1130. if (sdev->write_fail)
  1131. rsi_dbg(INFO_ZONE, "###### Device is not ready #######\n");
  1132. ret = rsi_set_sdio_pm_caps(adapter);
  1133. if (ret)
  1134. rsi_dbg(INFO_ZONE, "Setting power management caps failed\n");
  1135. rsi_dbg(INFO_ZONE, "***** RSI module freezed *****\n");
  1136. return 0;
  1137. }
  1138. static int rsi_thaw(struct device *dev)
  1139. {
  1140. struct sdio_func *pfunction = dev_to_sdio_func(dev);
  1141. struct rsi_hw *adapter = sdio_get_drvdata(pfunction);
  1142. struct rsi_common *common = adapter->priv;
  1143. rsi_dbg(ERR_ZONE, "SDIO Bus thaw =====>\n");
  1144. common->hibernate_resume = true;
  1145. common->fsm_state = FSM_CARD_NOT_READY;
  1146. common->iface_down = true;
  1147. rsi_sdio_enable_interrupts(pfunction);
  1148. rsi_dbg(INFO_ZONE, "***** RSI module thaw done *****\n");
  1149. return 0;
  1150. }
  1151. static void rsi_shutdown(struct device *dev)
  1152. {
  1153. struct sdio_func *pfunction = dev_to_sdio_func(dev);
  1154. struct rsi_hw *adapter = sdio_get_drvdata(pfunction);
  1155. struct rsi_91x_sdiodev *sdev =
  1156. (struct rsi_91x_sdiodev *)adapter->rsi_dev;
  1157. struct ieee80211_hw *hw = adapter->hw;
  1158. struct cfg80211_wowlan *wowlan = hw->wiphy->wowlan_config;
  1159. rsi_dbg(ERR_ZONE, "SDIO Bus shutdown =====>\n");
  1160. if (rsi_config_wowlan(adapter, wowlan))
  1161. rsi_dbg(ERR_ZONE, "Failed to configure WoWLAN\n");
  1162. rsi_sdio_disable_interrupts(sdev->pfunction);
  1163. if (sdev->write_fail)
  1164. rsi_dbg(INFO_ZONE, "###### Device is not ready #######\n");
  1165. if (rsi_set_sdio_pm_caps(adapter))
  1166. rsi_dbg(INFO_ZONE, "Setting power management caps failed\n");
  1167. rsi_dbg(INFO_ZONE, "***** RSI module shut down *****\n");
  1168. }
  1169. static int rsi_restore(struct device *dev)
  1170. {
  1171. struct sdio_func *pfunction = dev_to_sdio_func(dev);
  1172. struct rsi_hw *adapter = sdio_get_drvdata(pfunction);
  1173. struct rsi_common *common = adapter->priv;
  1174. rsi_dbg(INFO_ZONE, "SDIO Bus restore ======>\n");
  1175. common->hibernate_resume = true;
  1176. common->fsm_state = FSM_FW_NOT_LOADED;
  1177. common->iface_down = true;
  1178. adapter->sc_nvifs = 0;
  1179. ieee80211_restart_hw(adapter->hw);
  1180. common->wow_flags = 0;
  1181. common->iface_down = false;
  1182. rsi_dbg(INFO_ZONE, "RSI module restored\n");
  1183. return 0;
  1184. }
  1185. static const struct dev_pm_ops rsi_pm_ops = {
  1186. .suspend = rsi_suspend,
  1187. .resume = rsi_resume,
  1188. .freeze = rsi_freeze,
  1189. .thaw = rsi_thaw,
  1190. .restore = rsi_restore,
  1191. };
  1192. #endif
  1193. static const struct sdio_device_id rsi_dev_table[] = {
  1194. { SDIO_DEVICE(0x303, 0x100) },
  1195. { SDIO_DEVICE(0x041B, 0x0301) },
  1196. { SDIO_DEVICE(0x041B, 0x0201) },
  1197. { SDIO_DEVICE(0x041B, 0x9330) },
  1198. { /* Blank */},
  1199. };
  1200. static struct sdio_driver rsi_driver = {
  1201. .name = "RSI-SDIO WLAN",
  1202. .probe = rsi_probe,
  1203. .remove = rsi_disconnect,
  1204. .id_table = rsi_dev_table,
  1205. #ifdef CONFIG_PM
  1206. .drv = {
  1207. .pm = &rsi_pm_ops,
  1208. .shutdown = rsi_shutdown,
  1209. }
  1210. #endif
  1211. };
  1212. /**
  1213. * rsi_module_init() - This function registers the sdio module.
  1214. * @void: Void.
  1215. *
  1216. * Return: 0 on success.
  1217. */
  1218. static int rsi_module_init(void)
  1219. {
  1220. int ret;
  1221. ret = sdio_register_driver(&rsi_driver);
  1222. rsi_dbg(INIT_ZONE, "%s: Registering driver\n", __func__);
  1223. return ret;
  1224. }
  1225. /**
  1226. * rsi_module_exit() - This function unregisters the sdio module.
  1227. * @void: Void.
  1228. *
  1229. * Return: None.
  1230. */
  1231. static void rsi_module_exit(void)
  1232. {
  1233. sdio_unregister_driver(&rsi_driver);
  1234. rsi_dbg(INFO_ZONE, "%s: Unregistering driver\n", __func__);
  1235. }
  1236. module_init(rsi_module_init);
  1237. module_exit(rsi_module_exit);
  1238. MODULE_AUTHOR("Redpine Signals Inc");
  1239. MODULE_DESCRIPTION("Common SDIO layer for RSI drivers");
  1240. MODULE_SUPPORTED_DEVICE("RSI-91x");
  1241. MODULE_DEVICE_TABLE(sdio, rsi_dev_table);
  1242. MODULE_FIRMWARE(FIRMWARE_RSI9113);
  1243. MODULE_VERSION("0.1");
  1244. MODULE_LICENSE("Dual BSD/GPL");