sdio.c 58 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240
  1. /*
  2. * Marvell Wireless LAN device driver: SDIO specific handling
  3. *
  4. * Copyright (C) 2011-2014, Marvell International Ltd.
  5. *
  6. * This software file (the "File") is distributed by Marvell International
  7. * Ltd. under the terms of the GNU General Public License Version 2, June 1991
  8. * (the "License"). You may use, redistribute and/or modify this File in
  9. * accordance with the terms and conditions of the License, a copy of which
  10. * is available by writing to the Free Software Foundation, Inc.,
  11. * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA or on the
  12. * worldwide web at http://www.gnu.org/licenses/old-licenses/gpl-2.0.txt.
  13. *
  14. * THE FILE IS DISTRIBUTED AS-IS, WITHOUT WARRANTY OF ANY KIND, AND THE
  15. * IMPLIED WARRANTIES OF MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE
  16. * ARE EXPRESSLY DISCLAIMED. The License provides additional details about
  17. * this warranty disclaimer.
  18. */
  19. #include <linux/firmware.h>
  20. #include "decl.h"
  21. #include "ioctl.h"
  22. #include "util.h"
  23. #include "fw.h"
  24. #include "main.h"
  25. #include "wmm.h"
  26. #include "11n.h"
  27. #include "sdio.h"
  28. #define SDIO_VERSION "1.0"
  29. /* The mwifiex_sdio_remove() callback function is called when
  30. * user removes this module from kernel space or ejects
  31. * the card from the slot. The driver handles these 2 cases
  32. * differently.
  33. * If the user is removing the module, the few commands (FUNC_SHUTDOWN,
  34. * HS_CANCEL etc.) are sent to the firmware.
  35. * If the card is removed, there is no need to send these command.
  36. *
  37. * The variable 'user_rmmod' is used to distinguish these two
  38. * scenarios. This flag is initialized as FALSE in case the card
  39. * is removed, and will be set to TRUE for module removal when
  40. * module_exit function is called.
  41. */
  42. static u8 user_rmmod;
  43. static struct mwifiex_if_ops sdio_ops;
  44. static struct semaphore add_remove_card_sem;
  45. static struct memory_type_mapping mem_type_mapping_tbl[] = {
  46. {"ITCM", NULL, 0, 0xF0},
  47. {"DTCM", NULL, 0, 0xF1},
  48. {"SQRAM", NULL, 0, 0xF2},
  49. {"APU", NULL, 0, 0xF3},
  50. {"CIU", NULL, 0, 0xF4},
  51. {"ICU", NULL, 0, 0xF5},
  52. {"MAC", NULL, 0, 0xF6},
  53. {"EXT7", NULL, 0, 0xF7},
  54. {"EXT8", NULL, 0, 0xF8},
  55. {"EXT9", NULL, 0, 0xF9},
  56. {"EXT10", NULL, 0, 0xFA},
  57. {"EXT11", NULL, 0, 0xFB},
  58. {"EXT12", NULL, 0, 0xFC},
  59. {"EXT13", NULL, 0, 0xFD},
  60. {"EXTLAST", NULL, 0, 0xFE},
  61. };
  62. /*
  63. * SDIO probe.
  64. *
  65. * This function probes an mwifiex device and registers it. It allocates
  66. * the card structure, enables SDIO function number and initiates the
  67. * device registration and initialization procedure by adding a logical
  68. * interface.
  69. */
  70. static int
  71. mwifiex_sdio_probe(struct sdio_func *func, const struct sdio_device_id *id)
  72. {
  73. int ret;
  74. struct sdio_mmc_card *card = NULL;
  75. pr_debug("info: vendor=0x%4.04X device=0x%4.04X class=%d function=%d\n",
  76. func->vendor, func->device, func->class, func->num);
  77. card = kzalloc(sizeof(struct sdio_mmc_card), GFP_KERNEL);
  78. if (!card)
  79. return -ENOMEM;
  80. card->func = func;
  81. func->card->quirks |= MMC_QUIRK_BLKSZ_FOR_BYTE_MODE;
  82. if (id->driver_data) {
  83. struct mwifiex_sdio_device *data = (void *)id->driver_data;
  84. card->firmware = data->firmware;
  85. card->reg = data->reg;
  86. card->max_ports = data->max_ports;
  87. card->mp_agg_pkt_limit = data->mp_agg_pkt_limit;
  88. card->supports_sdio_new_mode = data->supports_sdio_new_mode;
  89. card->has_control_mask = data->has_control_mask;
  90. card->tx_buf_size = data->tx_buf_size;
  91. card->mp_tx_agg_buf_size = data->mp_tx_agg_buf_size;
  92. card->mp_rx_agg_buf_size = data->mp_rx_agg_buf_size;
  93. card->supports_fw_dump = data->supports_fw_dump;
  94. }
  95. sdio_claim_host(func);
  96. ret = sdio_enable_func(func);
  97. sdio_release_host(func);
  98. if (ret) {
  99. pr_err("%s: failed to enable function\n", __func__);
  100. kfree(card);
  101. return -EIO;
  102. }
  103. if (mwifiex_add_card(card, &add_remove_card_sem, &sdio_ops,
  104. MWIFIEX_SDIO)) {
  105. pr_err("%s: add card failed\n", __func__);
  106. kfree(card);
  107. sdio_claim_host(func);
  108. ret = sdio_disable_func(func);
  109. sdio_release_host(func);
  110. ret = -1;
  111. }
  112. return ret;
  113. }
  114. /*
  115. * SDIO resume.
  116. *
  117. * Kernel needs to suspend all functions separately. Therefore all
  118. * registered functions must have drivers with suspend and resume
  119. * methods. Failing that the kernel simply removes the whole card.
  120. *
  121. * If already not resumed, this function turns on the traffic and
  122. * sends a host sleep cancel request to the firmware.
  123. */
  124. static int mwifiex_sdio_resume(struct device *dev)
  125. {
  126. struct sdio_func *func = dev_to_sdio_func(dev);
  127. struct sdio_mmc_card *card;
  128. struct mwifiex_adapter *adapter;
  129. mmc_pm_flag_t pm_flag = 0;
  130. if (func) {
  131. pm_flag = sdio_get_host_pm_caps(func);
  132. card = sdio_get_drvdata(func);
  133. if (!card || !card->adapter) {
  134. pr_err("resume: invalid card or adapter\n");
  135. return 0;
  136. }
  137. } else {
  138. pr_err("resume: sdio_func is not specified\n");
  139. return 0;
  140. }
  141. adapter = card->adapter;
  142. if (!adapter->is_suspended) {
  143. dev_warn(adapter->dev, "device already resumed\n");
  144. return 0;
  145. }
  146. adapter->is_suspended = false;
  147. /* Disable Host Sleep */
  148. mwifiex_cancel_hs(mwifiex_get_priv(adapter, MWIFIEX_BSS_ROLE_STA),
  149. MWIFIEX_ASYNC_CMD);
  150. return 0;
  151. }
  152. /*
  153. * SDIO remove.
  154. *
  155. * This function removes the interface and frees up the card structure.
  156. */
  157. static void
  158. mwifiex_sdio_remove(struct sdio_func *func)
  159. {
  160. struct sdio_mmc_card *card;
  161. struct mwifiex_adapter *adapter;
  162. struct mwifiex_private *priv;
  163. pr_debug("info: SDIO func num=%d\n", func->num);
  164. card = sdio_get_drvdata(func);
  165. if (!card)
  166. return;
  167. adapter = card->adapter;
  168. if (!adapter || !adapter->priv_num)
  169. return;
  170. cancel_work_sync(&adapter->iface_work);
  171. if (user_rmmod) {
  172. if (adapter->is_suspended)
  173. mwifiex_sdio_resume(adapter->dev);
  174. mwifiex_deauthenticate_all(adapter);
  175. priv = mwifiex_get_priv(adapter, MWIFIEX_BSS_ROLE_ANY);
  176. mwifiex_disable_auto_ds(priv);
  177. mwifiex_init_shutdown_fw(priv, MWIFIEX_FUNC_SHUTDOWN);
  178. }
  179. mwifiex_remove_card(card->adapter, &add_remove_card_sem);
  180. }
  181. /*
  182. * SDIO suspend.
  183. *
  184. * Kernel needs to suspend all functions separately. Therefore all
  185. * registered functions must have drivers with suspend and resume
  186. * methods. Failing that the kernel simply removes the whole card.
  187. *
  188. * If already not suspended, this function allocates and sends a host
  189. * sleep activate request to the firmware and turns off the traffic.
  190. */
  191. static int mwifiex_sdio_suspend(struct device *dev)
  192. {
  193. struct sdio_func *func = dev_to_sdio_func(dev);
  194. struct sdio_mmc_card *card;
  195. struct mwifiex_adapter *adapter;
  196. mmc_pm_flag_t pm_flag = 0;
  197. int ret = 0;
  198. if (func) {
  199. pm_flag = sdio_get_host_pm_caps(func);
  200. pr_debug("cmd: %s: suspend: PM flag = 0x%x\n",
  201. sdio_func_id(func), pm_flag);
  202. if (!(pm_flag & MMC_PM_KEEP_POWER)) {
  203. pr_err("%s: cannot remain alive while host is"
  204. " suspended\n", sdio_func_id(func));
  205. return -ENOSYS;
  206. }
  207. card = sdio_get_drvdata(func);
  208. if (!card || !card->adapter) {
  209. pr_err("suspend: invalid card or adapter\n");
  210. return 0;
  211. }
  212. } else {
  213. pr_err("suspend: sdio_func is not specified\n");
  214. return 0;
  215. }
  216. adapter = card->adapter;
  217. /* Enable the Host Sleep */
  218. if (!mwifiex_enable_hs(adapter)) {
  219. dev_err(adapter->dev, "cmd: failed to suspend\n");
  220. adapter->hs_enabling = false;
  221. return -EFAULT;
  222. }
  223. dev_dbg(adapter->dev, "cmd: suspend with MMC_PM_KEEP_POWER\n");
  224. ret = sdio_set_host_pm_flags(func, MMC_PM_KEEP_POWER);
  225. /* Indicate device suspended */
  226. adapter->is_suspended = true;
  227. adapter->hs_enabling = false;
  228. return ret;
  229. }
  230. /* Device ID for SD8786 */
  231. #define SDIO_DEVICE_ID_MARVELL_8786 (0x9116)
  232. /* Device ID for SD8787 */
  233. #define SDIO_DEVICE_ID_MARVELL_8787 (0x9119)
  234. /* Device ID for SD8797 */
  235. #define SDIO_DEVICE_ID_MARVELL_8797 (0x9129)
  236. /* Device ID for SD8897 */
  237. #define SDIO_DEVICE_ID_MARVELL_8897 (0x912d)
  238. /* Device ID for SD8887 */
  239. #define SDIO_DEVICE_ID_MARVELL_8887 (0x9135)
  240. /* WLAN IDs */
  241. static const struct sdio_device_id mwifiex_ids[] = {
  242. {SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL, SDIO_DEVICE_ID_MARVELL_8786),
  243. .driver_data = (unsigned long) &mwifiex_sdio_sd8786},
  244. {SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL, SDIO_DEVICE_ID_MARVELL_8787),
  245. .driver_data = (unsigned long) &mwifiex_sdio_sd8787},
  246. {SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL, SDIO_DEVICE_ID_MARVELL_8797),
  247. .driver_data = (unsigned long) &mwifiex_sdio_sd8797},
  248. {SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL, SDIO_DEVICE_ID_MARVELL_8897),
  249. .driver_data = (unsigned long) &mwifiex_sdio_sd8897},
  250. {SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL, SDIO_DEVICE_ID_MARVELL_8887),
  251. .driver_data = (unsigned long)&mwifiex_sdio_sd8887},
  252. {},
  253. };
  254. MODULE_DEVICE_TABLE(sdio, mwifiex_ids);
  255. static const struct dev_pm_ops mwifiex_sdio_pm_ops = {
  256. .suspend = mwifiex_sdio_suspend,
  257. .resume = mwifiex_sdio_resume,
  258. };
  259. static struct sdio_driver mwifiex_sdio = {
  260. .name = "mwifiex_sdio",
  261. .id_table = mwifiex_ids,
  262. .probe = mwifiex_sdio_probe,
  263. .remove = mwifiex_sdio_remove,
  264. .drv = {
  265. .owner = THIS_MODULE,
  266. .pm = &mwifiex_sdio_pm_ops,
  267. }
  268. };
  269. /* Write data into SDIO card register. Caller claims SDIO device. */
  270. static int
  271. mwifiex_write_reg_locked(struct sdio_func *func, u32 reg, u8 data)
  272. {
  273. int ret = -1;
  274. sdio_writeb(func, data, reg, &ret);
  275. return ret;
  276. }
  277. /*
  278. * This function writes data into SDIO card register.
  279. */
  280. static int
  281. mwifiex_write_reg(struct mwifiex_adapter *adapter, u32 reg, u8 data)
  282. {
  283. struct sdio_mmc_card *card = adapter->card;
  284. int ret;
  285. sdio_claim_host(card->func);
  286. ret = mwifiex_write_reg_locked(card->func, reg, data);
  287. sdio_release_host(card->func);
  288. return ret;
  289. }
  290. /*
  291. * This function reads data from SDIO card register.
  292. */
  293. static int
  294. mwifiex_read_reg(struct mwifiex_adapter *adapter, u32 reg, u8 *data)
  295. {
  296. struct sdio_mmc_card *card = adapter->card;
  297. int ret = -1;
  298. u8 val;
  299. sdio_claim_host(card->func);
  300. val = sdio_readb(card->func, reg, &ret);
  301. sdio_release_host(card->func);
  302. *data = val;
  303. return ret;
  304. }
  305. /*
  306. * This function writes multiple data into SDIO card memory.
  307. *
  308. * This does not work in suspended mode.
  309. */
  310. static int
  311. mwifiex_write_data_sync(struct mwifiex_adapter *adapter,
  312. u8 *buffer, u32 pkt_len, u32 port)
  313. {
  314. struct sdio_mmc_card *card = adapter->card;
  315. int ret;
  316. u8 blk_mode =
  317. (port & MWIFIEX_SDIO_BYTE_MODE_MASK) ? BYTE_MODE : BLOCK_MODE;
  318. u32 blk_size = (blk_mode == BLOCK_MODE) ? MWIFIEX_SDIO_BLOCK_SIZE : 1;
  319. u32 blk_cnt =
  320. (blk_mode ==
  321. BLOCK_MODE) ? (pkt_len /
  322. MWIFIEX_SDIO_BLOCK_SIZE) : pkt_len;
  323. u32 ioport = (port & MWIFIEX_SDIO_IO_PORT_MASK);
  324. if (adapter->is_suspended) {
  325. dev_err(adapter->dev,
  326. "%s: not allowed while suspended\n", __func__);
  327. return -1;
  328. }
  329. sdio_claim_host(card->func);
  330. ret = sdio_writesb(card->func, ioport, buffer, blk_cnt * blk_size);
  331. sdio_release_host(card->func);
  332. return ret;
  333. }
  334. /*
  335. * This function reads multiple data from SDIO card memory.
  336. */
  337. static int mwifiex_read_data_sync(struct mwifiex_adapter *adapter, u8 *buffer,
  338. u32 len, u32 port, u8 claim)
  339. {
  340. struct sdio_mmc_card *card = adapter->card;
  341. int ret;
  342. u8 blk_mode = (port & MWIFIEX_SDIO_BYTE_MODE_MASK) ? BYTE_MODE
  343. : BLOCK_MODE;
  344. u32 blk_size = (blk_mode == BLOCK_MODE) ? MWIFIEX_SDIO_BLOCK_SIZE : 1;
  345. u32 blk_cnt = (blk_mode == BLOCK_MODE) ? (len / MWIFIEX_SDIO_BLOCK_SIZE)
  346. : len;
  347. u32 ioport = (port & MWIFIEX_SDIO_IO_PORT_MASK);
  348. if (claim)
  349. sdio_claim_host(card->func);
  350. ret = sdio_readsb(card->func, buffer, ioport, blk_cnt * blk_size);
  351. if (claim)
  352. sdio_release_host(card->func);
  353. return ret;
  354. }
  355. /*
  356. * This function wakes up the card.
  357. *
  358. * A host power up command is written to the card configuration
  359. * register to wake up the card.
  360. */
  361. static int mwifiex_pm_wakeup_card(struct mwifiex_adapter *adapter)
  362. {
  363. dev_dbg(adapter->dev, "event: wakeup device...\n");
  364. return mwifiex_write_reg(adapter, CONFIGURATION_REG, HOST_POWER_UP);
  365. }
  366. /*
  367. * This function is called after the card has woken up.
  368. *
  369. * The card configuration register is reset.
  370. */
  371. static int mwifiex_pm_wakeup_card_complete(struct mwifiex_adapter *adapter)
  372. {
  373. dev_dbg(adapter->dev, "cmd: wakeup device completed\n");
  374. return mwifiex_write_reg(adapter, CONFIGURATION_REG, 0);
  375. }
  376. /*
  377. * This function is used to initialize IO ports for the
  378. * chipsets supporting SDIO new mode eg SD8897.
  379. */
  380. static int mwifiex_init_sdio_new_mode(struct mwifiex_adapter *adapter)
  381. {
  382. u8 reg;
  383. struct sdio_mmc_card *card = adapter->card;
  384. adapter->ioport = MEM_PORT;
  385. /* enable sdio new mode */
  386. if (mwifiex_read_reg(adapter, card->reg->card_cfg_2_1_reg, &reg))
  387. return -1;
  388. if (mwifiex_write_reg(adapter, card->reg->card_cfg_2_1_reg,
  389. reg | CMD53_NEW_MODE))
  390. return -1;
  391. /* Configure cmd port and enable reading rx length from the register */
  392. if (mwifiex_read_reg(adapter, card->reg->cmd_cfg_0, &reg))
  393. return -1;
  394. if (mwifiex_write_reg(adapter, card->reg->cmd_cfg_0,
  395. reg | CMD_PORT_RD_LEN_EN))
  396. return -1;
  397. /* Enable Dnld/Upld ready auto reset for cmd port after cmd53 is
  398. * completed
  399. */
  400. if (mwifiex_read_reg(adapter, card->reg->cmd_cfg_1, &reg))
  401. return -1;
  402. if (mwifiex_write_reg(adapter, card->reg->cmd_cfg_1,
  403. reg | CMD_PORT_AUTO_EN))
  404. return -1;
  405. return 0;
  406. }
  407. /* This function initializes the IO ports.
  408. *
  409. * The following operations are performed -
  410. * - Read the IO ports (0, 1 and 2)
  411. * - Set host interrupt Reset-To-Read to clear
  412. * - Set auto re-enable interrupt
  413. */
  414. static int mwifiex_init_sdio_ioport(struct mwifiex_adapter *adapter)
  415. {
  416. u8 reg;
  417. struct sdio_mmc_card *card = adapter->card;
  418. adapter->ioport = 0;
  419. if (card->supports_sdio_new_mode) {
  420. if (mwifiex_init_sdio_new_mode(adapter))
  421. return -1;
  422. goto cont;
  423. }
  424. /* Read the IO port */
  425. if (!mwifiex_read_reg(adapter, card->reg->io_port_0_reg, &reg))
  426. adapter->ioport |= (reg & 0xff);
  427. else
  428. return -1;
  429. if (!mwifiex_read_reg(adapter, card->reg->io_port_1_reg, &reg))
  430. adapter->ioport |= ((reg & 0xff) << 8);
  431. else
  432. return -1;
  433. if (!mwifiex_read_reg(adapter, card->reg->io_port_2_reg, &reg))
  434. adapter->ioport |= ((reg & 0xff) << 16);
  435. else
  436. return -1;
  437. cont:
  438. pr_debug("info: SDIO FUNC1 IO port: %#x\n", adapter->ioport);
  439. /* Set Host interrupt reset to read to clear */
  440. if (!mwifiex_read_reg(adapter, card->reg->host_int_rsr_reg, &reg))
  441. mwifiex_write_reg(adapter, card->reg->host_int_rsr_reg,
  442. reg | card->reg->sdio_int_mask);
  443. else
  444. return -1;
  445. /* Dnld/Upld ready set to auto reset */
  446. if (!mwifiex_read_reg(adapter, card->reg->card_misc_cfg_reg, &reg))
  447. mwifiex_write_reg(adapter, card->reg->card_misc_cfg_reg,
  448. reg | AUTO_RE_ENABLE_INT);
  449. else
  450. return -1;
  451. return 0;
  452. }
  453. /*
  454. * This function sends data to the card.
  455. */
  456. static int mwifiex_write_data_to_card(struct mwifiex_adapter *adapter,
  457. u8 *payload, u32 pkt_len, u32 port)
  458. {
  459. u32 i = 0;
  460. int ret;
  461. do {
  462. ret = mwifiex_write_data_sync(adapter, payload, pkt_len, port);
  463. if (ret) {
  464. i++;
  465. dev_err(adapter->dev, "host_to_card, write iomem"
  466. " (%d) failed: %d\n", i, ret);
  467. if (mwifiex_write_reg(adapter, CONFIGURATION_REG, 0x04))
  468. dev_err(adapter->dev, "write CFG reg failed\n");
  469. ret = -1;
  470. if (i > MAX_WRITE_IOMEM_RETRY)
  471. return ret;
  472. }
  473. } while (ret == -1);
  474. return ret;
  475. }
  476. /*
  477. * This function gets the read port.
  478. *
  479. * If control port bit is set in MP read bitmap, the control port
  480. * is returned, otherwise the current read port is returned and
  481. * the value is increased (provided it does not reach the maximum
  482. * limit, in which case it is reset to 1)
  483. */
  484. static int mwifiex_get_rd_port(struct mwifiex_adapter *adapter, u8 *port)
  485. {
  486. struct sdio_mmc_card *card = adapter->card;
  487. const struct mwifiex_sdio_card_reg *reg = card->reg;
  488. u32 rd_bitmap = card->mp_rd_bitmap;
  489. dev_dbg(adapter->dev, "data: mp_rd_bitmap=0x%08x\n", rd_bitmap);
  490. if (card->supports_sdio_new_mode) {
  491. if (!(rd_bitmap & reg->data_port_mask))
  492. return -1;
  493. } else {
  494. if (!(rd_bitmap & (CTRL_PORT_MASK | reg->data_port_mask)))
  495. return -1;
  496. }
  497. if ((card->has_control_mask) &&
  498. (card->mp_rd_bitmap & CTRL_PORT_MASK)) {
  499. card->mp_rd_bitmap &= (u32) (~CTRL_PORT_MASK);
  500. *port = CTRL_PORT;
  501. dev_dbg(adapter->dev, "data: port=%d mp_rd_bitmap=0x%08x\n",
  502. *port, card->mp_rd_bitmap);
  503. return 0;
  504. }
  505. if (!(card->mp_rd_bitmap & (1 << card->curr_rd_port)))
  506. return -1;
  507. /* We are now handling the SDIO data ports */
  508. card->mp_rd_bitmap &= (u32)(~(1 << card->curr_rd_port));
  509. *port = card->curr_rd_port;
  510. if (++card->curr_rd_port == card->max_ports)
  511. card->curr_rd_port = reg->start_rd_port;
  512. dev_dbg(adapter->dev,
  513. "data: port=%d mp_rd_bitmap=0x%08x -> 0x%08x\n",
  514. *port, rd_bitmap, card->mp_rd_bitmap);
  515. return 0;
  516. }
  517. /*
  518. * This function gets the write port for data.
  519. *
  520. * The current write port is returned if available and the value is
  521. * increased (provided it does not reach the maximum limit, in which
  522. * case it is reset to 1)
  523. */
  524. static int mwifiex_get_wr_port_data(struct mwifiex_adapter *adapter, u32 *port)
  525. {
  526. struct sdio_mmc_card *card = adapter->card;
  527. const struct mwifiex_sdio_card_reg *reg = card->reg;
  528. u32 wr_bitmap = card->mp_wr_bitmap;
  529. dev_dbg(adapter->dev, "data: mp_wr_bitmap=0x%08x\n", wr_bitmap);
  530. if (!(wr_bitmap & card->mp_data_port_mask)) {
  531. adapter->data_sent = true;
  532. return -EBUSY;
  533. }
  534. if (card->mp_wr_bitmap & (1 << card->curr_wr_port)) {
  535. card->mp_wr_bitmap &= (u32) (~(1 << card->curr_wr_port));
  536. *port = card->curr_wr_port;
  537. if (++card->curr_wr_port == card->mp_end_port)
  538. card->curr_wr_port = reg->start_wr_port;
  539. } else {
  540. adapter->data_sent = true;
  541. return -EBUSY;
  542. }
  543. if ((card->has_control_mask) && (*port == CTRL_PORT)) {
  544. dev_err(adapter->dev,
  545. "invalid data port=%d cur port=%d mp_wr_bitmap=0x%08x -> 0x%08x\n",
  546. *port, card->curr_wr_port, wr_bitmap,
  547. card->mp_wr_bitmap);
  548. return -1;
  549. }
  550. dev_dbg(adapter->dev, "data: port=%d mp_wr_bitmap=0x%08x -> 0x%08x\n",
  551. *port, wr_bitmap, card->mp_wr_bitmap);
  552. return 0;
  553. }
  554. /*
  555. * This function polls the card status.
  556. */
  557. static int
  558. mwifiex_sdio_poll_card_status(struct mwifiex_adapter *adapter, u8 bits)
  559. {
  560. struct sdio_mmc_card *card = adapter->card;
  561. u32 tries;
  562. u8 cs;
  563. for (tries = 0; tries < MAX_POLL_TRIES; tries++) {
  564. if (mwifiex_read_reg(adapter, card->reg->poll_reg, &cs))
  565. break;
  566. else if ((cs & bits) == bits)
  567. return 0;
  568. usleep_range(10, 20);
  569. }
  570. dev_err(adapter->dev, "poll card status failed, tries = %d\n", tries);
  571. return -1;
  572. }
  573. /*
  574. * This function reads the firmware status.
  575. */
  576. static int
  577. mwifiex_sdio_read_fw_status(struct mwifiex_adapter *adapter, u16 *dat)
  578. {
  579. struct sdio_mmc_card *card = adapter->card;
  580. const struct mwifiex_sdio_card_reg *reg = card->reg;
  581. u8 fws0, fws1;
  582. if (mwifiex_read_reg(adapter, reg->status_reg_0, &fws0))
  583. return -1;
  584. if (mwifiex_read_reg(adapter, reg->status_reg_1, &fws1))
  585. return -1;
  586. *dat = (u16) ((fws1 << 8) | fws0);
  587. return 0;
  588. }
  589. /*
  590. * This function disables the host interrupt.
  591. *
  592. * The host interrupt mask is read, the disable bit is reset and
  593. * written back to the card host interrupt mask register.
  594. */
  595. static void mwifiex_sdio_disable_host_int(struct mwifiex_adapter *adapter)
  596. {
  597. struct sdio_mmc_card *card = adapter->card;
  598. struct sdio_func *func = card->func;
  599. sdio_claim_host(func);
  600. mwifiex_write_reg_locked(func, card->reg->host_int_mask_reg, 0);
  601. sdio_release_irq(func);
  602. sdio_release_host(func);
  603. }
  604. /*
  605. * This function reads the interrupt status from card.
  606. */
  607. static void mwifiex_interrupt_status(struct mwifiex_adapter *adapter)
  608. {
  609. struct sdio_mmc_card *card = adapter->card;
  610. u8 sdio_ireg;
  611. unsigned long flags;
  612. if (mwifiex_read_data_sync(adapter, card->mp_regs,
  613. card->reg->max_mp_regs,
  614. REG_PORT | MWIFIEX_SDIO_BYTE_MODE_MASK, 0)) {
  615. dev_err(adapter->dev, "read mp_regs failed\n");
  616. return;
  617. }
  618. sdio_ireg = card->mp_regs[card->reg->host_int_status_reg];
  619. if (sdio_ireg) {
  620. /*
  621. * DN_LD_HOST_INT_STATUS and/or UP_LD_HOST_INT_STATUS
  622. * For SDIO new mode CMD port interrupts
  623. * DN_LD_CMD_PORT_HOST_INT_STATUS and/or
  624. * UP_LD_CMD_PORT_HOST_INT_STATUS
  625. * Clear the interrupt status register
  626. */
  627. dev_dbg(adapter->dev, "int: sdio_ireg = %#x\n", sdio_ireg);
  628. spin_lock_irqsave(&adapter->int_lock, flags);
  629. adapter->int_status |= sdio_ireg;
  630. spin_unlock_irqrestore(&adapter->int_lock, flags);
  631. }
  632. }
  633. /*
  634. * SDIO interrupt handler.
  635. *
  636. * This function reads the interrupt status from firmware and handles
  637. * the interrupt in current thread (ksdioirqd) right away.
  638. */
  639. static void
  640. mwifiex_sdio_interrupt(struct sdio_func *func)
  641. {
  642. struct mwifiex_adapter *adapter;
  643. struct sdio_mmc_card *card;
  644. card = sdio_get_drvdata(func);
  645. if (!card || !card->adapter) {
  646. pr_debug("int: func=%p card=%p adapter=%p\n",
  647. func, card, card ? card->adapter : NULL);
  648. return;
  649. }
  650. adapter = card->adapter;
  651. if (!adapter->pps_uapsd_mode && adapter->ps_state == PS_STATE_SLEEP)
  652. adapter->ps_state = PS_STATE_AWAKE;
  653. mwifiex_interrupt_status(adapter);
  654. mwifiex_main_process(adapter);
  655. }
  656. /*
  657. * This function enables the host interrupt.
  658. *
  659. * The host interrupt enable mask is written to the card
  660. * host interrupt mask register.
  661. */
  662. static int mwifiex_sdio_enable_host_int(struct mwifiex_adapter *adapter)
  663. {
  664. struct sdio_mmc_card *card = adapter->card;
  665. struct sdio_func *func = card->func;
  666. int ret;
  667. sdio_claim_host(func);
  668. /* Request the SDIO IRQ */
  669. ret = sdio_claim_irq(func, mwifiex_sdio_interrupt);
  670. if (ret) {
  671. dev_err(adapter->dev, "claim irq failed: ret=%d\n", ret);
  672. goto out;
  673. }
  674. /* Simply write the mask to the register */
  675. ret = mwifiex_write_reg_locked(func, card->reg->host_int_mask_reg,
  676. card->reg->host_int_enable);
  677. if (ret) {
  678. dev_err(adapter->dev, "enable host interrupt failed\n");
  679. sdio_release_irq(func);
  680. }
  681. out:
  682. sdio_release_host(func);
  683. return ret;
  684. }
  685. /*
  686. * This function sends a data buffer to the card.
  687. */
  688. static int mwifiex_sdio_card_to_host(struct mwifiex_adapter *adapter,
  689. u32 *type, u8 *buffer,
  690. u32 npayload, u32 ioport)
  691. {
  692. int ret;
  693. u32 nb;
  694. if (!buffer) {
  695. dev_err(adapter->dev, "%s: buffer is NULL\n", __func__);
  696. return -1;
  697. }
  698. ret = mwifiex_read_data_sync(adapter, buffer, npayload, ioport, 1);
  699. if (ret) {
  700. dev_err(adapter->dev, "%s: read iomem failed: %d\n", __func__,
  701. ret);
  702. return -1;
  703. }
  704. nb = le16_to_cpu(*(__le16 *) (buffer));
  705. if (nb > npayload) {
  706. dev_err(adapter->dev, "%s: invalid packet, nb=%d npayload=%d\n",
  707. __func__, nb, npayload);
  708. return -1;
  709. }
  710. *type = le16_to_cpu(*(__le16 *) (buffer + 2));
  711. return ret;
  712. }
  713. /*
  714. * This function downloads the firmware to the card.
  715. *
  716. * Firmware is downloaded to the card in blocks. Every block download
  717. * is tested for CRC errors, and retried a number of times before
  718. * returning failure.
  719. */
  720. static int mwifiex_prog_fw_w_helper(struct mwifiex_adapter *adapter,
  721. struct mwifiex_fw_image *fw)
  722. {
  723. struct sdio_mmc_card *card = adapter->card;
  724. const struct mwifiex_sdio_card_reg *reg = card->reg;
  725. int ret;
  726. u8 *firmware = fw->fw_buf;
  727. u32 firmware_len = fw->fw_len;
  728. u32 offset = 0;
  729. u8 base0, base1;
  730. u8 *fwbuf;
  731. u16 len = 0;
  732. u32 txlen, tx_blocks = 0, tries;
  733. u32 i = 0;
  734. if (!firmware_len) {
  735. dev_err(adapter->dev,
  736. "firmware image not found! Terminating download\n");
  737. return -1;
  738. }
  739. dev_dbg(adapter->dev, "info: downloading FW image (%d bytes)\n",
  740. firmware_len);
  741. /* Assume that the allocated buffer is 8-byte aligned */
  742. fwbuf = kzalloc(MWIFIEX_UPLD_SIZE, GFP_KERNEL);
  743. if (!fwbuf)
  744. return -ENOMEM;
  745. /* Perform firmware data transfer */
  746. do {
  747. /* The host polls for the DN_LD_CARD_RDY and CARD_IO_READY
  748. bits */
  749. ret = mwifiex_sdio_poll_card_status(adapter, CARD_IO_READY |
  750. DN_LD_CARD_RDY);
  751. if (ret) {
  752. dev_err(adapter->dev, "FW download with helper:"
  753. " poll status timeout @ %d\n", offset);
  754. goto done;
  755. }
  756. /* More data? */
  757. if (offset >= firmware_len)
  758. break;
  759. for (tries = 0; tries < MAX_POLL_TRIES; tries++) {
  760. ret = mwifiex_read_reg(adapter, reg->base_0_reg,
  761. &base0);
  762. if (ret) {
  763. dev_err(adapter->dev,
  764. "dev BASE0 register read failed: "
  765. "base0=%#04X(%d). Terminating dnld\n",
  766. base0, base0);
  767. goto done;
  768. }
  769. ret = mwifiex_read_reg(adapter, reg->base_1_reg,
  770. &base1);
  771. if (ret) {
  772. dev_err(adapter->dev,
  773. "dev BASE1 register read failed: "
  774. "base1=%#04X(%d). Terminating dnld\n",
  775. base1, base1);
  776. goto done;
  777. }
  778. len = (u16) (((base1 & 0xff) << 8) | (base0 & 0xff));
  779. if (len)
  780. break;
  781. usleep_range(10, 20);
  782. }
  783. if (!len) {
  784. break;
  785. } else if (len > MWIFIEX_UPLD_SIZE) {
  786. dev_err(adapter->dev,
  787. "FW dnld failed @ %d, invalid length %d\n",
  788. offset, len);
  789. ret = -1;
  790. goto done;
  791. }
  792. txlen = len;
  793. if (len & BIT(0)) {
  794. i++;
  795. if (i > MAX_WRITE_IOMEM_RETRY) {
  796. dev_err(adapter->dev,
  797. "FW dnld failed @ %d, over max retry\n",
  798. offset);
  799. ret = -1;
  800. goto done;
  801. }
  802. dev_err(adapter->dev, "CRC indicated by the helper:"
  803. " len = 0x%04X, txlen = %d\n", len, txlen);
  804. len &= ~BIT(0);
  805. /* Setting this to 0 to resend from same offset */
  806. txlen = 0;
  807. } else {
  808. i = 0;
  809. /* Set blocksize to transfer - checking for last
  810. block */
  811. if (firmware_len - offset < txlen)
  812. txlen = firmware_len - offset;
  813. tx_blocks = (txlen + MWIFIEX_SDIO_BLOCK_SIZE - 1)
  814. / MWIFIEX_SDIO_BLOCK_SIZE;
  815. /* Copy payload to buffer */
  816. memmove(fwbuf, &firmware[offset], txlen);
  817. }
  818. ret = mwifiex_write_data_sync(adapter, fwbuf, tx_blocks *
  819. MWIFIEX_SDIO_BLOCK_SIZE,
  820. adapter->ioport);
  821. if (ret) {
  822. dev_err(adapter->dev,
  823. "FW download, write iomem (%d) failed @ %d\n",
  824. i, offset);
  825. if (mwifiex_write_reg(adapter, CONFIGURATION_REG, 0x04))
  826. dev_err(adapter->dev, "write CFG reg failed\n");
  827. ret = -1;
  828. goto done;
  829. }
  830. offset += txlen;
  831. } while (true);
  832. dev_dbg(adapter->dev, "info: FW download over, size %d bytes\n",
  833. offset);
  834. ret = 0;
  835. done:
  836. kfree(fwbuf);
  837. return ret;
  838. }
  839. /*
  840. * This function checks the firmware status in card.
  841. *
  842. * The winner interface is also determined by this function.
  843. */
  844. static int mwifiex_check_fw_status(struct mwifiex_adapter *adapter,
  845. u32 poll_num)
  846. {
  847. struct sdio_mmc_card *card = adapter->card;
  848. int ret = 0;
  849. u16 firmware_stat;
  850. u32 tries;
  851. u8 winner_status;
  852. /* Wait for firmware initialization event */
  853. for (tries = 0; tries < poll_num; tries++) {
  854. ret = mwifiex_sdio_read_fw_status(adapter, &firmware_stat);
  855. if (ret)
  856. continue;
  857. if (firmware_stat == FIRMWARE_READY_SDIO) {
  858. ret = 0;
  859. break;
  860. } else {
  861. msleep(100);
  862. ret = -1;
  863. }
  864. }
  865. if (ret) {
  866. if (mwifiex_read_reg
  867. (adapter, card->reg->status_reg_0, &winner_status))
  868. winner_status = 0;
  869. if (winner_status)
  870. adapter->winner = 0;
  871. else
  872. adapter->winner = 1;
  873. }
  874. return ret;
  875. }
  876. /*
  877. * This function decodes a received packet.
  878. *
  879. * Based on the type, the packet is treated as either a data, or
  880. * a command response, or an event, and the correct handler
  881. * function is invoked.
  882. */
  883. static int mwifiex_decode_rx_packet(struct mwifiex_adapter *adapter,
  884. struct sk_buff *skb, u32 upld_typ)
  885. {
  886. u8 *cmd_buf;
  887. __le16 *curr_ptr = (__le16 *)skb->data;
  888. u16 pkt_len = le16_to_cpu(*curr_ptr);
  889. skb_trim(skb, pkt_len);
  890. skb_pull(skb, INTF_HEADER_LEN);
  891. switch (upld_typ) {
  892. case MWIFIEX_TYPE_DATA:
  893. dev_dbg(adapter->dev, "info: --- Rx: Data packet ---\n");
  894. if (adapter->rx_work_enabled) {
  895. skb_queue_tail(&adapter->rx_data_q, skb);
  896. adapter->data_received = true;
  897. atomic_inc(&adapter->rx_pending);
  898. } else {
  899. mwifiex_handle_rx_packet(adapter, skb);
  900. }
  901. break;
  902. case MWIFIEX_TYPE_CMD:
  903. dev_dbg(adapter->dev, "info: --- Rx: Cmd Response ---\n");
  904. /* take care of curr_cmd = NULL case */
  905. if (!adapter->curr_cmd) {
  906. cmd_buf = adapter->upld_buf;
  907. if (adapter->ps_state == PS_STATE_SLEEP_CFM)
  908. mwifiex_process_sleep_confirm_resp(adapter,
  909. skb->data,
  910. skb->len);
  911. memcpy(cmd_buf, skb->data,
  912. min_t(u32, MWIFIEX_SIZE_OF_CMD_BUFFER,
  913. skb->len));
  914. dev_kfree_skb_any(skb);
  915. } else {
  916. adapter->cmd_resp_received = true;
  917. adapter->curr_cmd->resp_skb = skb;
  918. }
  919. break;
  920. case MWIFIEX_TYPE_EVENT:
  921. dev_dbg(adapter->dev, "info: --- Rx: Event ---\n");
  922. adapter->event_cause = le32_to_cpu(*(__le32 *) skb->data);
  923. if ((skb->len > 0) && (skb->len < MAX_EVENT_SIZE))
  924. memcpy(adapter->event_body,
  925. skb->data + MWIFIEX_EVENT_HEADER_LEN,
  926. skb->len);
  927. /* event cause has been saved to adapter->event_cause */
  928. adapter->event_received = true;
  929. adapter->event_skb = skb;
  930. break;
  931. default:
  932. dev_err(adapter->dev, "unknown upload type %#x\n", upld_typ);
  933. dev_kfree_skb_any(skb);
  934. break;
  935. }
  936. return 0;
  937. }
  938. /*
  939. * This function transfers received packets from card to driver, performing
  940. * aggregation if required.
  941. *
  942. * For data received on control port, or if aggregation is disabled, the
  943. * received buffers are uploaded as separate packets. However, if aggregation
  944. * is enabled and required, the buffers are copied onto an aggregation buffer,
  945. * provided there is space left, processed and finally uploaded.
  946. */
  947. static int mwifiex_sdio_card_to_host_mp_aggr(struct mwifiex_adapter *adapter,
  948. struct sk_buff *skb, u8 port)
  949. {
  950. struct sdio_mmc_card *card = adapter->card;
  951. s32 f_do_rx_aggr = 0;
  952. s32 f_do_rx_cur = 0;
  953. s32 f_aggr_cur = 0;
  954. struct sk_buff *skb_deaggr;
  955. u32 pind;
  956. u32 pkt_len, pkt_type, mport;
  957. u8 *curr_ptr;
  958. u32 rx_len = skb->len;
  959. if ((card->has_control_mask) && (port == CTRL_PORT)) {
  960. /* Read the command Resp without aggr */
  961. dev_dbg(adapter->dev, "info: %s: no aggregation for cmd "
  962. "response\n", __func__);
  963. f_do_rx_cur = 1;
  964. goto rx_curr_single;
  965. }
  966. if (!card->mpa_rx.enabled) {
  967. dev_dbg(adapter->dev, "info: %s: rx aggregation disabled\n",
  968. __func__);
  969. f_do_rx_cur = 1;
  970. goto rx_curr_single;
  971. }
  972. if ((!card->has_control_mask && (card->mp_rd_bitmap &
  973. card->reg->data_port_mask)) ||
  974. (card->has_control_mask && (card->mp_rd_bitmap &
  975. (~((u32) CTRL_PORT_MASK))))) {
  976. /* Some more data RX pending */
  977. dev_dbg(adapter->dev, "info: %s: not last packet\n", __func__);
  978. if (MP_RX_AGGR_IN_PROGRESS(card)) {
  979. if (MP_RX_AGGR_BUF_HAS_ROOM(card, skb->len)) {
  980. f_aggr_cur = 1;
  981. } else {
  982. /* No room in Aggr buf, do rx aggr now */
  983. f_do_rx_aggr = 1;
  984. f_do_rx_cur = 1;
  985. }
  986. } else {
  987. /* Rx aggr not in progress */
  988. f_aggr_cur = 1;
  989. }
  990. } else {
  991. /* No more data RX pending */
  992. dev_dbg(adapter->dev, "info: %s: last packet\n", __func__);
  993. if (MP_RX_AGGR_IN_PROGRESS(card)) {
  994. f_do_rx_aggr = 1;
  995. if (MP_RX_AGGR_BUF_HAS_ROOM(card, skb->len))
  996. f_aggr_cur = 1;
  997. else
  998. /* No room in Aggr buf, do rx aggr now */
  999. f_do_rx_cur = 1;
  1000. } else {
  1001. f_do_rx_cur = 1;
  1002. }
  1003. }
  1004. if (f_aggr_cur) {
  1005. dev_dbg(adapter->dev, "info: current packet aggregation\n");
  1006. /* Curr pkt can be aggregated */
  1007. mp_rx_aggr_setup(card, skb, port);
  1008. if (MP_RX_AGGR_PKT_LIMIT_REACHED(card) ||
  1009. mp_rx_aggr_port_limit_reached(card)) {
  1010. dev_dbg(adapter->dev, "info: %s: aggregated packet "
  1011. "limit reached\n", __func__);
  1012. /* No more pkts allowed in Aggr buf, rx it */
  1013. f_do_rx_aggr = 1;
  1014. }
  1015. }
  1016. if (f_do_rx_aggr) {
  1017. /* do aggr RX now */
  1018. dev_dbg(adapter->dev, "info: do_rx_aggr: num of packets: %d\n",
  1019. card->mpa_rx.pkt_cnt);
  1020. if (card->supports_sdio_new_mode) {
  1021. int i;
  1022. u32 port_count;
  1023. for (i = 0, port_count = 0; i < card->max_ports; i++)
  1024. if (card->mpa_rx.ports & BIT(i))
  1025. port_count++;
  1026. /* Reading data from "start_port + 0" to "start_port +
  1027. * port_count -1", so decrease the count by 1
  1028. */
  1029. port_count--;
  1030. mport = (adapter->ioport | SDIO_MPA_ADDR_BASE |
  1031. (port_count << 8)) + card->mpa_rx.start_port;
  1032. } else {
  1033. mport = (adapter->ioport | SDIO_MPA_ADDR_BASE |
  1034. (card->mpa_rx.ports << 4)) +
  1035. card->mpa_rx.start_port;
  1036. }
  1037. if (mwifiex_read_data_sync(adapter, card->mpa_rx.buf,
  1038. card->mpa_rx.buf_len, mport, 1))
  1039. goto error;
  1040. curr_ptr = card->mpa_rx.buf;
  1041. for (pind = 0; pind < card->mpa_rx.pkt_cnt; pind++) {
  1042. /* get curr PKT len & type */
  1043. pkt_len = le16_to_cpu(*(__le16 *) &curr_ptr[0]);
  1044. pkt_type = le16_to_cpu(*(__le16 *) &curr_ptr[2]);
  1045. /* copy pkt to deaggr buf */
  1046. skb_deaggr = card->mpa_rx.skb_arr[pind];
  1047. if ((pkt_type == MWIFIEX_TYPE_DATA) && (pkt_len <=
  1048. card->mpa_rx.len_arr[pind])) {
  1049. memcpy(skb_deaggr->data, curr_ptr, pkt_len);
  1050. skb_trim(skb_deaggr, pkt_len);
  1051. /* Process de-aggr packet */
  1052. mwifiex_decode_rx_packet(adapter, skb_deaggr,
  1053. pkt_type);
  1054. } else {
  1055. dev_err(adapter->dev, "wrong aggr pkt:"
  1056. " type=%d len=%d max_len=%d\n",
  1057. pkt_type, pkt_len,
  1058. card->mpa_rx.len_arr[pind]);
  1059. dev_kfree_skb_any(skb_deaggr);
  1060. }
  1061. curr_ptr += card->mpa_rx.len_arr[pind];
  1062. }
  1063. MP_RX_AGGR_BUF_RESET(card);
  1064. }
  1065. rx_curr_single:
  1066. if (f_do_rx_cur) {
  1067. dev_dbg(adapter->dev, "info: RX: port: %d, rx_len: %d\n",
  1068. port, rx_len);
  1069. if (mwifiex_sdio_card_to_host(adapter, &pkt_type,
  1070. skb->data, skb->len,
  1071. adapter->ioport + port))
  1072. goto error;
  1073. mwifiex_decode_rx_packet(adapter, skb, pkt_type);
  1074. }
  1075. return 0;
  1076. error:
  1077. if (MP_RX_AGGR_IN_PROGRESS(card)) {
  1078. /* Multiport-aggregation transfer failed - cleanup */
  1079. for (pind = 0; pind < card->mpa_rx.pkt_cnt; pind++) {
  1080. /* copy pkt to deaggr buf */
  1081. skb_deaggr = card->mpa_rx.skb_arr[pind];
  1082. dev_kfree_skb_any(skb_deaggr);
  1083. }
  1084. MP_RX_AGGR_BUF_RESET(card);
  1085. }
  1086. if (f_do_rx_cur)
  1087. /* Single transfer pending. Free curr buff also */
  1088. dev_kfree_skb_any(skb);
  1089. return -1;
  1090. }
  1091. /*
  1092. * This function checks the current interrupt status.
  1093. *
  1094. * The following interrupts are checked and handled by this function -
  1095. * - Data sent
  1096. * - Command sent
  1097. * - Packets received
  1098. *
  1099. * Since the firmware does not generate download ready interrupt if the
  1100. * port updated is command port only, command sent interrupt checking
  1101. * should be done manually, and for every SDIO interrupt.
  1102. *
  1103. * In case of Rx packets received, the packets are uploaded from card to
  1104. * host and processed accordingly.
  1105. */
  1106. static int mwifiex_process_int_status(struct mwifiex_adapter *adapter)
  1107. {
  1108. struct sdio_mmc_card *card = adapter->card;
  1109. const struct mwifiex_sdio_card_reg *reg = card->reg;
  1110. int ret = 0;
  1111. u8 sdio_ireg;
  1112. struct sk_buff *skb;
  1113. u8 port = CTRL_PORT;
  1114. u32 len_reg_l, len_reg_u;
  1115. u32 rx_blocks;
  1116. u16 rx_len;
  1117. unsigned long flags;
  1118. u32 bitmap;
  1119. u8 cr;
  1120. spin_lock_irqsave(&adapter->int_lock, flags);
  1121. sdio_ireg = adapter->int_status;
  1122. adapter->int_status = 0;
  1123. spin_unlock_irqrestore(&adapter->int_lock, flags);
  1124. if (!sdio_ireg)
  1125. return ret;
  1126. /* Following interrupt is only for SDIO new mode */
  1127. if (sdio_ireg & DN_LD_CMD_PORT_HOST_INT_STATUS && adapter->cmd_sent)
  1128. adapter->cmd_sent = false;
  1129. /* Following interrupt is only for SDIO new mode */
  1130. if (sdio_ireg & UP_LD_CMD_PORT_HOST_INT_STATUS) {
  1131. u32 pkt_type;
  1132. /* read the len of control packet */
  1133. rx_len = card->mp_regs[reg->cmd_rd_len_1] << 8;
  1134. rx_len |= (u16)card->mp_regs[reg->cmd_rd_len_0];
  1135. rx_blocks = DIV_ROUND_UP(rx_len, MWIFIEX_SDIO_BLOCK_SIZE);
  1136. if (rx_len <= INTF_HEADER_LEN ||
  1137. (rx_blocks * MWIFIEX_SDIO_BLOCK_SIZE) >
  1138. MWIFIEX_RX_DATA_BUF_SIZE)
  1139. return -1;
  1140. rx_len = (u16) (rx_blocks * MWIFIEX_SDIO_BLOCK_SIZE);
  1141. skb = dev_alloc_skb(rx_len);
  1142. if (!skb)
  1143. return -1;
  1144. skb_put(skb, rx_len);
  1145. if (mwifiex_sdio_card_to_host(adapter, &pkt_type, skb->data,
  1146. skb->len, adapter->ioport |
  1147. CMD_PORT_SLCT)) {
  1148. dev_err(adapter->dev,
  1149. "%s: failed to card_to_host", __func__);
  1150. dev_kfree_skb_any(skb);
  1151. goto term_cmd;
  1152. }
  1153. if ((pkt_type != MWIFIEX_TYPE_CMD) &&
  1154. (pkt_type != MWIFIEX_TYPE_EVENT))
  1155. dev_err(adapter->dev,
  1156. "%s:Received wrong packet on cmd port",
  1157. __func__);
  1158. mwifiex_decode_rx_packet(adapter, skb, pkt_type);
  1159. }
  1160. if (sdio_ireg & DN_LD_HOST_INT_STATUS) {
  1161. bitmap = (u32) card->mp_regs[reg->wr_bitmap_l];
  1162. bitmap |= ((u32) card->mp_regs[reg->wr_bitmap_u]) << 8;
  1163. if (card->supports_sdio_new_mode) {
  1164. bitmap |=
  1165. ((u32) card->mp_regs[reg->wr_bitmap_1l]) << 16;
  1166. bitmap |=
  1167. ((u32) card->mp_regs[reg->wr_bitmap_1u]) << 24;
  1168. }
  1169. card->mp_wr_bitmap = bitmap;
  1170. dev_dbg(adapter->dev, "int: DNLD: wr_bitmap=0x%x\n",
  1171. card->mp_wr_bitmap);
  1172. if (adapter->data_sent &&
  1173. (card->mp_wr_bitmap & card->mp_data_port_mask)) {
  1174. dev_dbg(adapter->dev,
  1175. "info: <--- Tx DONE Interrupt --->\n");
  1176. adapter->data_sent = false;
  1177. }
  1178. }
  1179. /* As firmware will not generate download ready interrupt if the port
  1180. updated is command port only, cmd_sent should be done for any SDIO
  1181. interrupt. */
  1182. if (card->has_control_mask && adapter->cmd_sent) {
  1183. /* Check if firmware has attach buffer at command port and
  1184. update just that in wr_bit_map. */
  1185. card->mp_wr_bitmap |=
  1186. (u32) card->mp_regs[reg->wr_bitmap_l] & CTRL_PORT_MASK;
  1187. if (card->mp_wr_bitmap & CTRL_PORT_MASK)
  1188. adapter->cmd_sent = false;
  1189. }
  1190. dev_dbg(adapter->dev, "info: cmd_sent=%d data_sent=%d\n",
  1191. adapter->cmd_sent, adapter->data_sent);
  1192. if (sdio_ireg & UP_LD_HOST_INT_STATUS) {
  1193. bitmap = (u32) card->mp_regs[reg->rd_bitmap_l];
  1194. bitmap |= ((u32) card->mp_regs[reg->rd_bitmap_u]) << 8;
  1195. if (card->supports_sdio_new_mode) {
  1196. bitmap |=
  1197. ((u32) card->mp_regs[reg->rd_bitmap_1l]) << 16;
  1198. bitmap |=
  1199. ((u32) card->mp_regs[reg->rd_bitmap_1u]) << 24;
  1200. }
  1201. card->mp_rd_bitmap = bitmap;
  1202. dev_dbg(adapter->dev, "int: UPLD: rd_bitmap=0x%x\n",
  1203. card->mp_rd_bitmap);
  1204. while (true) {
  1205. ret = mwifiex_get_rd_port(adapter, &port);
  1206. if (ret) {
  1207. dev_dbg(adapter->dev,
  1208. "info: no more rd_port available\n");
  1209. break;
  1210. }
  1211. len_reg_l = reg->rd_len_p0_l + (port << 1);
  1212. len_reg_u = reg->rd_len_p0_u + (port << 1);
  1213. rx_len = ((u16) card->mp_regs[len_reg_u]) << 8;
  1214. rx_len |= (u16) card->mp_regs[len_reg_l];
  1215. dev_dbg(adapter->dev, "info: RX: port=%d rx_len=%u\n",
  1216. port, rx_len);
  1217. rx_blocks =
  1218. (rx_len + MWIFIEX_SDIO_BLOCK_SIZE -
  1219. 1) / MWIFIEX_SDIO_BLOCK_SIZE;
  1220. if (rx_len <= INTF_HEADER_LEN ||
  1221. (rx_blocks * MWIFIEX_SDIO_BLOCK_SIZE) >
  1222. MWIFIEX_RX_DATA_BUF_SIZE) {
  1223. dev_err(adapter->dev, "invalid rx_len=%d\n",
  1224. rx_len);
  1225. return -1;
  1226. }
  1227. rx_len = (u16) (rx_blocks * MWIFIEX_SDIO_BLOCK_SIZE);
  1228. skb = dev_alloc_skb(rx_len);
  1229. if (!skb) {
  1230. dev_err(adapter->dev, "%s: failed to alloc skb",
  1231. __func__);
  1232. return -1;
  1233. }
  1234. skb_put(skb, rx_len);
  1235. dev_dbg(adapter->dev, "info: rx_len = %d skb->len = %d\n",
  1236. rx_len, skb->len);
  1237. if (mwifiex_sdio_card_to_host_mp_aggr(adapter, skb,
  1238. port)) {
  1239. dev_err(adapter->dev, "card_to_host_mpa failed:"
  1240. " int status=%#x\n", sdio_ireg);
  1241. goto term_cmd;
  1242. }
  1243. }
  1244. }
  1245. return 0;
  1246. term_cmd:
  1247. /* terminate cmd */
  1248. if (mwifiex_read_reg(adapter, CONFIGURATION_REG, &cr))
  1249. dev_err(adapter->dev, "read CFG reg failed\n");
  1250. else
  1251. dev_dbg(adapter->dev, "info: CFG reg val = %d\n", cr);
  1252. if (mwifiex_write_reg(adapter, CONFIGURATION_REG, (cr | 0x04)))
  1253. dev_err(adapter->dev, "write CFG reg failed\n");
  1254. else
  1255. dev_dbg(adapter->dev, "info: write success\n");
  1256. if (mwifiex_read_reg(adapter, CONFIGURATION_REG, &cr))
  1257. dev_err(adapter->dev, "read CFG reg failed\n");
  1258. else
  1259. dev_dbg(adapter->dev, "info: CFG reg val =%x\n", cr);
  1260. return -1;
  1261. }
  1262. /*
  1263. * This function aggregates transmission buffers in driver and downloads
  1264. * the aggregated packet to card.
  1265. *
  1266. * The individual packets are aggregated by copying into an aggregation
  1267. * buffer and then downloaded to the card. Previous unsent packets in the
  1268. * aggregation buffer are pre-copied first before new packets are added.
  1269. * Aggregation is done till there is space left in the aggregation buffer,
  1270. * or till new packets are available.
  1271. *
  1272. * The function will only download the packet to the card when aggregation
  1273. * stops, otherwise it will just aggregate the packet in aggregation buffer
  1274. * and return.
  1275. */
  1276. static int mwifiex_host_to_card_mp_aggr(struct mwifiex_adapter *adapter,
  1277. u8 *payload, u32 pkt_len, u32 port,
  1278. u32 next_pkt_len)
  1279. {
  1280. struct sdio_mmc_card *card = adapter->card;
  1281. int ret = 0;
  1282. s32 f_send_aggr_buf = 0;
  1283. s32 f_send_cur_buf = 0;
  1284. s32 f_precopy_cur_buf = 0;
  1285. s32 f_postcopy_cur_buf = 0;
  1286. u32 mport;
  1287. if (!card->mpa_tx.enabled ||
  1288. (card->has_control_mask && (port == CTRL_PORT)) ||
  1289. (card->supports_sdio_new_mode && (port == CMD_PORT_SLCT))) {
  1290. dev_dbg(adapter->dev, "info: %s: tx aggregation disabled\n",
  1291. __func__);
  1292. f_send_cur_buf = 1;
  1293. goto tx_curr_single;
  1294. }
  1295. if (next_pkt_len) {
  1296. /* More pkt in TX queue */
  1297. dev_dbg(adapter->dev, "info: %s: more packets in queue.\n",
  1298. __func__);
  1299. if (MP_TX_AGGR_IN_PROGRESS(card)) {
  1300. if (MP_TX_AGGR_BUF_HAS_ROOM(card, pkt_len)) {
  1301. f_precopy_cur_buf = 1;
  1302. if (!(card->mp_wr_bitmap &
  1303. (1 << card->curr_wr_port)) ||
  1304. !MP_TX_AGGR_BUF_HAS_ROOM(
  1305. card, pkt_len + next_pkt_len))
  1306. f_send_aggr_buf = 1;
  1307. } else {
  1308. /* No room in Aggr buf, send it */
  1309. f_send_aggr_buf = 1;
  1310. if (!(card->mp_wr_bitmap &
  1311. (1 << card->curr_wr_port)))
  1312. f_send_cur_buf = 1;
  1313. else
  1314. f_postcopy_cur_buf = 1;
  1315. }
  1316. } else {
  1317. if (MP_TX_AGGR_BUF_HAS_ROOM(card, pkt_len) &&
  1318. (card->mp_wr_bitmap & (1 << card->curr_wr_port)))
  1319. f_precopy_cur_buf = 1;
  1320. else
  1321. f_send_cur_buf = 1;
  1322. }
  1323. } else {
  1324. /* Last pkt in TX queue */
  1325. dev_dbg(adapter->dev, "info: %s: Last packet in Tx Queue.\n",
  1326. __func__);
  1327. if (MP_TX_AGGR_IN_PROGRESS(card)) {
  1328. /* some packs in Aggr buf already */
  1329. f_send_aggr_buf = 1;
  1330. if (MP_TX_AGGR_BUF_HAS_ROOM(card, pkt_len))
  1331. f_precopy_cur_buf = 1;
  1332. else
  1333. /* No room in Aggr buf, send it */
  1334. f_send_cur_buf = 1;
  1335. } else {
  1336. f_send_cur_buf = 1;
  1337. }
  1338. }
  1339. if (f_precopy_cur_buf) {
  1340. dev_dbg(adapter->dev, "data: %s: precopy current buffer\n",
  1341. __func__);
  1342. MP_TX_AGGR_BUF_PUT(card, payload, pkt_len, port);
  1343. if (MP_TX_AGGR_PKT_LIMIT_REACHED(card) ||
  1344. mp_tx_aggr_port_limit_reached(card))
  1345. /* No more pkts allowed in Aggr buf, send it */
  1346. f_send_aggr_buf = 1;
  1347. }
  1348. if (f_send_aggr_buf) {
  1349. dev_dbg(adapter->dev, "data: %s: send aggr buffer: %d %d\n",
  1350. __func__,
  1351. card->mpa_tx.start_port, card->mpa_tx.ports);
  1352. if (card->supports_sdio_new_mode) {
  1353. u32 port_count;
  1354. int i;
  1355. for (i = 0, port_count = 0; i < card->max_ports; i++)
  1356. if (card->mpa_tx.ports & BIT(i))
  1357. port_count++;
  1358. /* Writing data from "start_port + 0" to "start_port +
  1359. * port_count -1", so decrease the count by 1
  1360. */
  1361. port_count--;
  1362. mport = (adapter->ioport | SDIO_MPA_ADDR_BASE |
  1363. (port_count << 8)) + card->mpa_tx.start_port;
  1364. } else {
  1365. mport = (adapter->ioport | SDIO_MPA_ADDR_BASE |
  1366. (card->mpa_tx.ports << 4)) +
  1367. card->mpa_tx.start_port;
  1368. }
  1369. ret = mwifiex_write_data_to_card(adapter, card->mpa_tx.buf,
  1370. card->mpa_tx.buf_len, mport);
  1371. MP_TX_AGGR_BUF_RESET(card);
  1372. }
  1373. tx_curr_single:
  1374. if (f_send_cur_buf) {
  1375. dev_dbg(adapter->dev, "data: %s: send current buffer %d\n",
  1376. __func__, port);
  1377. ret = mwifiex_write_data_to_card(adapter, payload, pkt_len,
  1378. adapter->ioport + port);
  1379. }
  1380. if (f_postcopy_cur_buf) {
  1381. dev_dbg(adapter->dev, "data: %s: postcopy current buffer\n",
  1382. __func__);
  1383. MP_TX_AGGR_BUF_PUT(card, payload, pkt_len, port);
  1384. }
  1385. return ret;
  1386. }
  1387. /*
  1388. * This function downloads data from driver to card.
  1389. *
  1390. * Both commands and data packets are transferred to the card by this
  1391. * function.
  1392. *
  1393. * This function adds the SDIO specific header to the front of the buffer
  1394. * before transferring. The header contains the length of the packet and
  1395. * the type. The firmware handles the packets based upon this set type.
  1396. */
  1397. static int mwifiex_sdio_host_to_card(struct mwifiex_adapter *adapter,
  1398. u8 type, struct sk_buff *skb,
  1399. struct mwifiex_tx_param *tx_param)
  1400. {
  1401. struct sdio_mmc_card *card = adapter->card;
  1402. int ret;
  1403. u32 buf_block_len;
  1404. u32 blk_size;
  1405. u32 port = CTRL_PORT;
  1406. u8 *payload = (u8 *)skb->data;
  1407. u32 pkt_len = skb->len;
  1408. /* Allocate buffer and copy payload */
  1409. blk_size = MWIFIEX_SDIO_BLOCK_SIZE;
  1410. buf_block_len = (pkt_len + blk_size - 1) / blk_size;
  1411. *(__le16 *)&payload[0] = cpu_to_le16((u16)pkt_len);
  1412. *(__le16 *)&payload[2] = cpu_to_le16(type);
  1413. /*
  1414. * This is SDIO specific header
  1415. * u16 length,
  1416. * u16 type (MWIFIEX_TYPE_DATA = 0, MWIFIEX_TYPE_CMD = 1,
  1417. * MWIFIEX_TYPE_EVENT = 3)
  1418. */
  1419. if (type == MWIFIEX_TYPE_DATA) {
  1420. ret = mwifiex_get_wr_port_data(adapter, &port);
  1421. if (ret) {
  1422. dev_err(adapter->dev, "%s: no wr_port available\n",
  1423. __func__);
  1424. return ret;
  1425. }
  1426. } else {
  1427. adapter->cmd_sent = true;
  1428. /* Type must be MWIFIEX_TYPE_CMD */
  1429. if (pkt_len <= INTF_HEADER_LEN ||
  1430. pkt_len > MWIFIEX_UPLD_SIZE)
  1431. dev_err(adapter->dev, "%s: payload=%p, nb=%d\n",
  1432. __func__, payload, pkt_len);
  1433. if (card->supports_sdio_new_mode)
  1434. port = CMD_PORT_SLCT;
  1435. }
  1436. /* Transfer data to card */
  1437. pkt_len = buf_block_len * blk_size;
  1438. if (tx_param)
  1439. ret = mwifiex_host_to_card_mp_aggr(adapter, payload, pkt_len,
  1440. port, tx_param->next_pkt_len
  1441. );
  1442. else
  1443. ret = mwifiex_host_to_card_mp_aggr(adapter, payload, pkt_len,
  1444. port, 0);
  1445. if (ret) {
  1446. if (type == MWIFIEX_TYPE_CMD)
  1447. adapter->cmd_sent = false;
  1448. if (type == MWIFIEX_TYPE_DATA) {
  1449. adapter->data_sent = false;
  1450. /* restore curr_wr_port in error cases */
  1451. card->curr_wr_port = port;
  1452. card->mp_wr_bitmap |= (u32)(1 << card->curr_wr_port);
  1453. }
  1454. } else {
  1455. if (type == MWIFIEX_TYPE_DATA) {
  1456. if (!(card->mp_wr_bitmap & (1 << card->curr_wr_port)))
  1457. adapter->data_sent = true;
  1458. else
  1459. adapter->data_sent = false;
  1460. }
  1461. }
  1462. return ret;
  1463. }
  1464. /*
  1465. * This function allocates the MPA Tx and Rx buffers.
  1466. */
  1467. static int mwifiex_alloc_sdio_mpa_buffers(struct mwifiex_adapter *adapter,
  1468. u32 mpa_tx_buf_size, u32 mpa_rx_buf_size)
  1469. {
  1470. struct sdio_mmc_card *card = adapter->card;
  1471. int ret = 0;
  1472. card->mpa_tx.buf = kzalloc(mpa_tx_buf_size, GFP_KERNEL);
  1473. if (!card->mpa_tx.buf) {
  1474. ret = -1;
  1475. goto error;
  1476. }
  1477. card->mpa_tx.buf_size = mpa_tx_buf_size;
  1478. card->mpa_rx.buf = kzalloc(mpa_rx_buf_size, GFP_KERNEL);
  1479. if (!card->mpa_rx.buf) {
  1480. ret = -1;
  1481. goto error;
  1482. }
  1483. card->mpa_rx.buf_size = mpa_rx_buf_size;
  1484. error:
  1485. if (ret) {
  1486. kfree(card->mpa_tx.buf);
  1487. kfree(card->mpa_rx.buf);
  1488. }
  1489. return ret;
  1490. }
  1491. /*
  1492. * This function unregisters the SDIO device.
  1493. *
  1494. * The SDIO IRQ is released, the function is disabled and driver
  1495. * data is set to null.
  1496. */
  1497. static void
  1498. mwifiex_unregister_dev(struct mwifiex_adapter *adapter)
  1499. {
  1500. struct sdio_mmc_card *card = adapter->card;
  1501. if (adapter->card) {
  1502. sdio_claim_host(card->func);
  1503. sdio_disable_func(card->func);
  1504. sdio_release_host(card->func);
  1505. }
  1506. }
  1507. /*
  1508. * This function registers the SDIO device.
  1509. *
  1510. * SDIO IRQ is claimed, block size is set and driver data is initialized.
  1511. */
  1512. static int mwifiex_register_dev(struct mwifiex_adapter *adapter)
  1513. {
  1514. int ret;
  1515. struct sdio_mmc_card *card = adapter->card;
  1516. struct sdio_func *func = card->func;
  1517. /* save adapter pointer in card */
  1518. card->adapter = adapter;
  1519. adapter->tx_buf_size = card->tx_buf_size;
  1520. sdio_claim_host(func);
  1521. /* Set block size */
  1522. ret = sdio_set_block_size(card->func, MWIFIEX_SDIO_BLOCK_SIZE);
  1523. sdio_release_host(func);
  1524. if (ret) {
  1525. pr_err("cannot set SDIO block size\n");
  1526. return ret;
  1527. }
  1528. adapter->dev = &func->dev;
  1529. strcpy(adapter->fw_name, card->firmware);
  1530. adapter->mem_type_mapping_tbl = mem_type_mapping_tbl;
  1531. adapter->num_mem_types = ARRAY_SIZE(mem_type_mapping_tbl);
  1532. return 0;
  1533. }
  1534. /*
  1535. * This function initializes the SDIO driver.
  1536. *
  1537. * The following initializations steps are followed -
  1538. * - Read the Host interrupt status register to acknowledge
  1539. * the first interrupt got from bootloader
  1540. * - Disable host interrupt mask register
  1541. * - Get SDIO port
  1542. * - Initialize SDIO variables in card
  1543. * - Allocate MP registers
  1544. * - Allocate MPA Tx and Rx buffers
  1545. */
  1546. static int mwifiex_init_sdio(struct mwifiex_adapter *adapter)
  1547. {
  1548. struct sdio_mmc_card *card = adapter->card;
  1549. const struct mwifiex_sdio_card_reg *reg = card->reg;
  1550. int ret;
  1551. u8 sdio_ireg;
  1552. sdio_set_drvdata(card->func, card);
  1553. /*
  1554. * Read the host_int_status_reg for ACK the first interrupt got
  1555. * from the bootloader. If we don't do this we get a interrupt
  1556. * as soon as we register the irq.
  1557. */
  1558. mwifiex_read_reg(adapter, card->reg->host_int_status_reg, &sdio_ireg);
  1559. /* Get SDIO ioport */
  1560. mwifiex_init_sdio_ioport(adapter);
  1561. /* Initialize SDIO variables in card */
  1562. card->mp_rd_bitmap = 0;
  1563. card->mp_wr_bitmap = 0;
  1564. card->curr_rd_port = reg->start_rd_port;
  1565. card->curr_wr_port = reg->start_wr_port;
  1566. card->mp_data_port_mask = reg->data_port_mask;
  1567. card->mpa_tx.buf_len = 0;
  1568. card->mpa_tx.pkt_cnt = 0;
  1569. card->mpa_tx.start_port = 0;
  1570. card->mpa_tx.enabled = 1;
  1571. card->mpa_tx.pkt_aggr_limit = card->mp_agg_pkt_limit;
  1572. card->mpa_rx.buf_len = 0;
  1573. card->mpa_rx.pkt_cnt = 0;
  1574. card->mpa_rx.start_port = 0;
  1575. card->mpa_rx.enabled = 1;
  1576. card->mpa_rx.pkt_aggr_limit = card->mp_agg_pkt_limit;
  1577. /* Allocate buffers for SDIO MP-A */
  1578. card->mp_regs = kzalloc(reg->max_mp_regs, GFP_KERNEL);
  1579. if (!card->mp_regs)
  1580. return -ENOMEM;
  1581. /* Allocate skb pointer buffers */
  1582. card->mpa_rx.skb_arr = kzalloc((sizeof(void *)) *
  1583. card->mp_agg_pkt_limit, GFP_KERNEL);
  1584. card->mpa_rx.len_arr = kzalloc(sizeof(*card->mpa_rx.len_arr) *
  1585. card->mp_agg_pkt_limit, GFP_KERNEL);
  1586. ret = mwifiex_alloc_sdio_mpa_buffers(adapter,
  1587. card->mp_tx_agg_buf_size,
  1588. card->mp_rx_agg_buf_size);
  1589. if (ret) {
  1590. dev_err(adapter->dev, "failed to alloc sdio mp-a buffers\n");
  1591. kfree(card->mp_regs);
  1592. return -1;
  1593. }
  1594. return ret;
  1595. }
  1596. /*
  1597. * This function resets the MPA Tx and Rx buffers.
  1598. */
  1599. static void mwifiex_cleanup_mpa_buf(struct mwifiex_adapter *adapter)
  1600. {
  1601. struct sdio_mmc_card *card = adapter->card;
  1602. MP_TX_AGGR_BUF_RESET(card);
  1603. MP_RX_AGGR_BUF_RESET(card);
  1604. }
  1605. /*
  1606. * This function cleans up the allocated card buffers.
  1607. *
  1608. * The following are freed by this function -
  1609. * - MP registers
  1610. * - MPA Tx buffer
  1611. * - MPA Rx buffer
  1612. */
  1613. static void mwifiex_cleanup_sdio(struct mwifiex_adapter *adapter)
  1614. {
  1615. struct sdio_mmc_card *card = adapter->card;
  1616. kfree(card->mp_regs);
  1617. kfree(card->mpa_rx.skb_arr);
  1618. kfree(card->mpa_rx.len_arr);
  1619. kfree(card->mpa_tx.buf);
  1620. kfree(card->mpa_rx.buf);
  1621. sdio_set_drvdata(card->func, NULL);
  1622. kfree(card);
  1623. }
  1624. /*
  1625. * This function updates the MP end port in card.
  1626. */
  1627. static void
  1628. mwifiex_update_mp_end_port(struct mwifiex_adapter *adapter, u16 port)
  1629. {
  1630. struct sdio_mmc_card *card = adapter->card;
  1631. const struct mwifiex_sdio_card_reg *reg = card->reg;
  1632. int i;
  1633. card->mp_end_port = port;
  1634. card->mp_data_port_mask = reg->data_port_mask;
  1635. if (reg->start_wr_port) {
  1636. for (i = 1; i <= card->max_ports - card->mp_end_port; i++)
  1637. card->mp_data_port_mask &=
  1638. ~(1 << (card->max_ports - i));
  1639. }
  1640. card->curr_wr_port = reg->start_wr_port;
  1641. dev_dbg(adapter->dev, "cmd: mp_end_port %d, data port mask 0x%x\n",
  1642. port, card->mp_data_port_mask);
  1643. }
  1644. static void mwifiex_sdio_card_reset_work(struct mwifiex_adapter *adapter)
  1645. {
  1646. struct sdio_mmc_card *card = adapter->card;
  1647. struct mmc_host *target = card->func->card->host;
  1648. /* The actual reset operation must be run outside of driver thread.
  1649. * This is because mmc_remove_host() will cause the device to be
  1650. * instantly destroyed, and the driver then needs to end its thread,
  1651. * leading to a deadlock.
  1652. *
  1653. * We run it in a totally independent workqueue.
  1654. */
  1655. pr_err("Resetting card...\n");
  1656. mmc_remove_host(target);
  1657. /* 20ms delay is based on experiment with sdhci controller */
  1658. mdelay(20);
  1659. target->rescan_entered = 0; /* rescan non-removable cards */
  1660. mmc_add_host(target);
  1661. }
  1662. /* This function read/write firmware */
  1663. static enum
  1664. rdwr_status mwifiex_sdio_rdwr_firmware(struct mwifiex_adapter *adapter,
  1665. u8 doneflag)
  1666. {
  1667. struct sdio_mmc_card *card = adapter->card;
  1668. int ret, tries;
  1669. u8 ctrl_data = 0;
  1670. sdio_writeb(card->func, FW_DUMP_HOST_READY, card->reg->fw_dump_ctrl,
  1671. &ret);
  1672. if (ret) {
  1673. dev_err(adapter->dev, "SDIO Write ERR\n");
  1674. return RDWR_STATUS_FAILURE;
  1675. }
  1676. for (tries = 0; tries < MAX_POLL_TRIES; tries++) {
  1677. ctrl_data = sdio_readb(card->func, card->reg->fw_dump_ctrl,
  1678. &ret);
  1679. if (ret) {
  1680. dev_err(adapter->dev, "SDIO read err\n");
  1681. return RDWR_STATUS_FAILURE;
  1682. }
  1683. if (ctrl_data == FW_DUMP_DONE)
  1684. break;
  1685. if (doneflag && ctrl_data == doneflag)
  1686. return RDWR_STATUS_DONE;
  1687. if (ctrl_data != FW_DUMP_HOST_READY) {
  1688. dev_info(adapter->dev,
  1689. "The ctrl reg was changed, re-try again!\n");
  1690. sdio_writeb(card->func, FW_DUMP_HOST_READY,
  1691. card->reg->fw_dump_ctrl, &ret);
  1692. if (ret) {
  1693. dev_err(adapter->dev, "SDIO write err\n");
  1694. return RDWR_STATUS_FAILURE;
  1695. }
  1696. }
  1697. usleep_range(100, 200);
  1698. }
  1699. if (ctrl_data == FW_DUMP_HOST_READY) {
  1700. dev_err(adapter->dev, "Fail to pull ctrl_data\n");
  1701. return RDWR_STATUS_FAILURE;
  1702. }
  1703. return RDWR_STATUS_SUCCESS;
  1704. }
  1705. /* This function dump firmware memory to file */
  1706. static void mwifiex_sdio_fw_dump_work(struct work_struct *work)
  1707. {
  1708. struct mwifiex_adapter *adapter =
  1709. container_of(work, struct mwifiex_adapter, iface_work);
  1710. struct sdio_mmc_card *card = adapter->card;
  1711. int ret = 0;
  1712. unsigned int reg, reg_start, reg_end;
  1713. u8 *dbg_ptr, *end_ptr, dump_num, idx, i, read_reg, doneflag = 0;
  1714. enum rdwr_status stat;
  1715. u32 memory_size;
  1716. static char *env[] = { "DRIVER=mwifiex_sdio", "EVENT=fw_dump", NULL };
  1717. if (!card->supports_fw_dump)
  1718. return;
  1719. for (idx = 0; idx < ARRAY_SIZE(mem_type_mapping_tbl); idx++) {
  1720. struct memory_type_mapping *entry = &mem_type_mapping_tbl[idx];
  1721. if (entry->mem_ptr) {
  1722. vfree(entry->mem_ptr);
  1723. entry->mem_ptr = NULL;
  1724. }
  1725. entry->mem_size = 0;
  1726. }
  1727. mwifiex_pm_wakeup_card(adapter);
  1728. sdio_claim_host(card->func);
  1729. dev_info(adapter->dev, "== mwifiex firmware dump start ==\n");
  1730. stat = mwifiex_sdio_rdwr_firmware(adapter, doneflag);
  1731. if (stat == RDWR_STATUS_FAILURE)
  1732. goto done;
  1733. reg = card->reg->fw_dump_start;
  1734. /* Read the number of the memories which will dump */
  1735. dump_num = sdio_readb(card->func, reg, &ret);
  1736. if (ret) {
  1737. dev_err(adapter->dev, "SDIO read memory length err\n");
  1738. goto done;
  1739. }
  1740. /* Read the length of every memory which will dump */
  1741. for (idx = 0; idx < dump_num; idx++) {
  1742. struct memory_type_mapping *entry = &mem_type_mapping_tbl[idx];
  1743. stat = mwifiex_sdio_rdwr_firmware(adapter, doneflag);
  1744. if (stat == RDWR_STATUS_FAILURE)
  1745. goto done;
  1746. memory_size = 0;
  1747. reg = card->reg->fw_dump_start;
  1748. for (i = 0; i < 4; i++) {
  1749. read_reg = sdio_readb(card->func, reg, &ret);
  1750. if (ret) {
  1751. dev_err(adapter->dev, "SDIO read err\n");
  1752. goto done;
  1753. }
  1754. memory_size |= (read_reg << i*8);
  1755. reg++;
  1756. }
  1757. if (memory_size == 0) {
  1758. dev_info(adapter->dev, "Firmware dump Finished!\n");
  1759. break;
  1760. }
  1761. dev_info(adapter->dev,
  1762. "%s_SIZE=0x%x\n", entry->mem_name, memory_size);
  1763. entry->mem_ptr = vmalloc(memory_size + 1);
  1764. entry->mem_size = memory_size;
  1765. if (!entry->mem_ptr) {
  1766. dev_err(adapter->dev, "Vmalloc %s failed\n",
  1767. entry->mem_name);
  1768. goto done;
  1769. }
  1770. dbg_ptr = entry->mem_ptr;
  1771. end_ptr = dbg_ptr + memory_size;
  1772. doneflag = entry->done_flag;
  1773. dev_info(adapter->dev, "Start %s output, please wait...\n",
  1774. entry->mem_name);
  1775. do {
  1776. stat = mwifiex_sdio_rdwr_firmware(adapter, doneflag);
  1777. if (stat == RDWR_STATUS_FAILURE)
  1778. goto done;
  1779. reg_start = card->reg->fw_dump_start;
  1780. reg_end = card->reg->fw_dump_end;
  1781. for (reg = reg_start; reg <= reg_end; reg++) {
  1782. *dbg_ptr = sdio_readb(card->func, reg, &ret);
  1783. if (ret) {
  1784. dev_err(adapter->dev,
  1785. "SDIO read err\n");
  1786. goto done;
  1787. }
  1788. if (dbg_ptr < end_ptr)
  1789. dbg_ptr++;
  1790. else
  1791. dev_err(adapter->dev,
  1792. "Allocated buf not enough\n");
  1793. }
  1794. if (stat != RDWR_STATUS_DONE)
  1795. continue;
  1796. dev_info(adapter->dev, "%s done: size=0x%tx\n",
  1797. entry->mem_name, dbg_ptr - entry->mem_ptr);
  1798. break;
  1799. } while (1);
  1800. }
  1801. dev_info(adapter->dev, "== mwifiex firmware dump end ==\n");
  1802. kobject_uevent_env(&adapter->wiphy->dev.kobj, KOBJ_CHANGE, env);
  1803. done:
  1804. sdio_release_host(card->func);
  1805. adapter->curr_mem_idx = 0;
  1806. }
  1807. static void mwifiex_sdio_work(struct work_struct *work)
  1808. {
  1809. struct mwifiex_adapter *adapter =
  1810. container_of(work, struct mwifiex_adapter, iface_work);
  1811. if (test_and_clear_bit(MWIFIEX_IFACE_WORK_CARD_RESET,
  1812. &adapter->iface_work_flags))
  1813. mwifiex_sdio_card_reset_work(adapter);
  1814. if (test_and_clear_bit(MWIFIEX_IFACE_WORK_FW_DUMP,
  1815. &adapter->iface_work_flags))
  1816. mwifiex_sdio_fw_dump_work(work);
  1817. }
  1818. /* This function resets the card */
  1819. static void mwifiex_sdio_card_reset(struct mwifiex_adapter *adapter)
  1820. {
  1821. if (test_bit(MWIFIEX_IFACE_WORK_CARD_RESET, &adapter->iface_work_flags))
  1822. return;
  1823. set_bit(MWIFIEX_IFACE_WORK_CARD_RESET, &adapter->iface_work_flags);
  1824. schedule_work(&adapter->iface_work);
  1825. }
  1826. /* This function dumps FW information */
  1827. static void mwifiex_sdio_fw_dump(struct mwifiex_adapter *adapter)
  1828. {
  1829. if (test_bit(MWIFIEX_IFACE_WORK_FW_DUMP, &adapter->iface_work_flags))
  1830. return;
  1831. set_bit(MWIFIEX_IFACE_WORK_FW_DUMP, &adapter->iface_work_flags);
  1832. schedule_work(&adapter->iface_work);
  1833. }
  1834. static struct mwifiex_if_ops sdio_ops = {
  1835. .init_if = mwifiex_init_sdio,
  1836. .cleanup_if = mwifiex_cleanup_sdio,
  1837. .check_fw_status = mwifiex_check_fw_status,
  1838. .prog_fw = mwifiex_prog_fw_w_helper,
  1839. .register_dev = mwifiex_register_dev,
  1840. .unregister_dev = mwifiex_unregister_dev,
  1841. .enable_int = mwifiex_sdio_enable_host_int,
  1842. .disable_int = mwifiex_sdio_disable_host_int,
  1843. .process_int_status = mwifiex_process_int_status,
  1844. .host_to_card = mwifiex_sdio_host_to_card,
  1845. .wakeup = mwifiex_pm_wakeup_card,
  1846. .wakeup_complete = mwifiex_pm_wakeup_card_complete,
  1847. /* SDIO specific */
  1848. .update_mp_end_port = mwifiex_update_mp_end_port,
  1849. .cleanup_mpa_buf = mwifiex_cleanup_mpa_buf,
  1850. .cmdrsp_complete = mwifiex_sdio_cmdrsp_complete,
  1851. .event_complete = mwifiex_sdio_event_complete,
  1852. .card_reset = mwifiex_sdio_card_reset,
  1853. .iface_work = mwifiex_sdio_work,
  1854. .fw_dump = mwifiex_sdio_fw_dump,
  1855. };
  1856. /*
  1857. * This function initializes the SDIO driver.
  1858. *
  1859. * This initiates the semaphore and registers the device with
  1860. * SDIO bus.
  1861. */
  1862. static int
  1863. mwifiex_sdio_init_module(void)
  1864. {
  1865. sema_init(&add_remove_card_sem, 1);
  1866. /* Clear the flag in case user removes the card. */
  1867. user_rmmod = 0;
  1868. return sdio_register_driver(&mwifiex_sdio);
  1869. }
  1870. /*
  1871. * This function cleans up the SDIO driver.
  1872. *
  1873. * The following major steps are followed for cleanup -
  1874. * - Resume the device if its suspended
  1875. * - Disconnect the device if connected
  1876. * - Shutdown the firmware
  1877. * - Unregister the device from SDIO bus.
  1878. */
  1879. static void
  1880. mwifiex_sdio_cleanup_module(void)
  1881. {
  1882. if (!down_interruptible(&add_remove_card_sem))
  1883. up(&add_remove_card_sem);
  1884. /* Set the flag as user is removing this module. */
  1885. user_rmmod = 1;
  1886. sdio_unregister_driver(&mwifiex_sdio);
  1887. }
  1888. module_init(mwifiex_sdio_init_module);
  1889. module_exit(mwifiex_sdio_cleanup_module);
  1890. MODULE_AUTHOR("Marvell International Ltd.");
  1891. MODULE_DESCRIPTION("Marvell WiFi-Ex SDIO Driver version " SDIO_VERSION);
  1892. MODULE_VERSION(SDIO_VERSION);
  1893. MODULE_LICENSE("GPL v2");
  1894. MODULE_FIRMWARE(SD8786_DEFAULT_FW_NAME);
  1895. MODULE_FIRMWARE(SD8787_DEFAULT_FW_NAME);
  1896. MODULE_FIRMWARE(SD8797_DEFAULT_FW_NAME);
  1897. MODULE_FIRMWARE(SD8897_DEFAULT_FW_NAME);
  1898. MODULE_FIRMWARE(SD8887_DEFAULT_FW_NAME);