sdio.c 58 KB

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