btmrvl_sdio.c 41 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * Marvell BT-over-SDIO driver: SDIO interface related functions.
  4. *
  5. * Copyright (C) 2009, Marvell International Ltd.
  6. **/
  7. #include <linux/firmware.h>
  8. #include <linux/slab.h>
  9. #include <linux/suspend.h>
  10. #include <linux/mmc/sdio_ids.h>
  11. #include <linux/mmc/sdio_func.h>
  12. #include <linux/module.h>
  13. #include <linux/devcoredump.h>
  14. #include <net/bluetooth/bluetooth.h>
  15. #include <net/bluetooth/hci_core.h>
  16. #include "btmrvl_drv.h"
  17. #include "btmrvl_sdio.h"
  18. #define VERSION "1.0"
  19. static struct memory_type_mapping mem_type_mapping_tbl[] = {
  20. {"ITCM", NULL, 0, 0xF0},
  21. {"DTCM", NULL, 0, 0xF1},
  22. {"SQRAM", NULL, 0, 0xF2},
  23. {"APU", NULL, 0, 0xF3},
  24. {"CIU", NULL, 0, 0xF4},
  25. {"ICU", NULL, 0, 0xF5},
  26. {"MAC", NULL, 0, 0xF6},
  27. {"EXT7", NULL, 0, 0xF7},
  28. {"EXT8", NULL, 0, 0xF8},
  29. {"EXT9", NULL, 0, 0xF9},
  30. {"EXT10", NULL, 0, 0xFA},
  31. {"EXT11", NULL, 0, 0xFB},
  32. {"EXT12", NULL, 0, 0xFC},
  33. {"EXT13", NULL, 0, 0xFD},
  34. {"EXTLAST", NULL, 0, 0xFE},
  35. };
  36. static const struct of_device_id btmrvl_sdio_of_match_table[] __maybe_unused = {
  37. { .compatible = "marvell,sd8897-bt" },
  38. { .compatible = "marvell,sd8997-bt" },
  39. { }
  40. };
  41. static irqreturn_t btmrvl_wake_irq_bt(int irq, void *priv)
  42. {
  43. struct btmrvl_sdio_card *card = priv;
  44. struct device *dev = &card->func->dev;
  45. struct btmrvl_plt_wake_cfg *cfg = card->plt_wake_cfg;
  46. dev_info(dev, "wake by bt\n");
  47. cfg->wake_by_bt = true;
  48. disable_irq_nosync(irq);
  49. pm_wakeup_event(dev, 0);
  50. pm_system_wakeup();
  51. return IRQ_HANDLED;
  52. }
  53. /* This function parses device tree node using mmc subnode devicetree API.
  54. * The device node is saved in card->plt_of_node.
  55. * If the device tree node exists and includes interrupts attributes, this
  56. * function will request platform specific wakeup interrupt.
  57. */
  58. static int btmrvl_sdio_probe_of(struct device *dev,
  59. struct btmrvl_sdio_card *card)
  60. {
  61. struct btmrvl_plt_wake_cfg *cfg;
  62. int ret;
  63. if (!dev->of_node ||
  64. !of_match_node(btmrvl_sdio_of_match_table, dev->of_node)) {
  65. dev_info(dev, "sdio device tree data not available\n");
  66. return -1;
  67. }
  68. card->plt_of_node = dev->of_node;
  69. card->plt_wake_cfg = devm_kzalloc(dev, sizeof(*card->plt_wake_cfg),
  70. GFP_KERNEL);
  71. cfg = card->plt_wake_cfg;
  72. if (cfg && card->plt_of_node) {
  73. cfg->irq_bt = irq_of_parse_and_map(card->plt_of_node, 0);
  74. if (!cfg->irq_bt) {
  75. dev_err(dev, "fail to parse irq_bt from device tree\n");
  76. cfg->irq_bt = -1;
  77. } else {
  78. ret = devm_request_irq(dev, cfg->irq_bt,
  79. btmrvl_wake_irq_bt,
  80. IRQF_NO_AUTOEN, "bt_wake", card);
  81. if (ret) {
  82. dev_err(dev,
  83. "Failed to request irq_bt %d (%d)\n",
  84. cfg->irq_bt, ret);
  85. }
  86. /* Configure wakeup (enabled by default) */
  87. ret = devm_device_init_wakeup(dev);
  88. if (ret)
  89. return dev_err_probe(dev, ret, "Failed to init wakeup\n");
  90. }
  91. }
  92. return 0;
  93. }
  94. /* The btmrvl_sdio_remove() callback function is called
  95. * when user removes this module from kernel space or ejects
  96. * the card from the slot. The driver handles these 2 cases
  97. * differently.
  98. * If the user is removing the module, a MODULE_SHUTDOWN_REQ
  99. * command is sent to firmware and interrupt will be disabled.
  100. * If the card is removed, there is no need to send command
  101. * or disable interrupt.
  102. *
  103. * The variable 'user_rmmod' is used to distinguish these two
  104. * scenarios. This flag is initialized as FALSE in case the card
  105. * is removed, and will be set to TRUE for module removal when
  106. * module_exit function is called.
  107. */
  108. static u8 user_rmmod;
  109. static u8 sdio_ireg;
  110. static const struct btmrvl_sdio_card_reg btmrvl_reg_8688 = {
  111. .cfg = 0x03,
  112. .host_int_mask = 0x04,
  113. .host_intstatus = 0x05,
  114. .card_status = 0x20,
  115. .sq_read_base_addr_a0 = 0x10,
  116. .sq_read_base_addr_a1 = 0x11,
  117. .card_fw_status0 = 0x40,
  118. .card_fw_status1 = 0x41,
  119. .card_rx_len = 0x42,
  120. .card_rx_unit = 0x43,
  121. .io_port_0 = 0x00,
  122. .io_port_1 = 0x01,
  123. .io_port_2 = 0x02,
  124. .int_read_to_clear = false,
  125. };
  126. static const struct btmrvl_sdio_card_reg btmrvl_reg_87xx = {
  127. .cfg = 0x00,
  128. .host_int_mask = 0x02,
  129. .host_intstatus = 0x03,
  130. .card_status = 0x30,
  131. .sq_read_base_addr_a0 = 0x40,
  132. .sq_read_base_addr_a1 = 0x41,
  133. .card_revision = 0x5c,
  134. .card_fw_status0 = 0x60,
  135. .card_fw_status1 = 0x61,
  136. .card_rx_len = 0x62,
  137. .card_rx_unit = 0x63,
  138. .io_port_0 = 0x78,
  139. .io_port_1 = 0x79,
  140. .io_port_2 = 0x7a,
  141. .int_read_to_clear = false,
  142. };
  143. static const struct btmrvl_sdio_card_reg btmrvl_reg_8887 = {
  144. .cfg = 0x00,
  145. .host_int_mask = 0x08,
  146. .host_intstatus = 0x0C,
  147. .card_status = 0x5C,
  148. .sq_read_base_addr_a0 = 0x6C,
  149. .sq_read_base_addr_a1 = 0x6D,
  150. .card_revision = 0xC8,
  151. .card_fw_status0 = 0x88,
  152. .card_fw_status1 = 0x89,
  153. .card_rx_len = 0x8A,
  154. .card_rx_unit = 0x8B,
  155. .io_port_0 = 0xE4,
  156. .io_port_1 = 0xE5,
  157. .io_port_2 = 0xE6,
  158. .int_read_to_clear = true,
  159. .host_int_rsr = 0x04,
  160. .card_misc_cfg = 0xD8,
  161. };
  162. static const struct btmrvl_sdio_card_reg btmrvl_reg_8897 = {
  163. .cfg = 0x00,
  164. .host_int_mask = 0x02,
  165. .host_intstatus = 0x03,
  166. .card_status = 0x50,
  167. .sq_read_base_addr_a0 = 0x60,
  168. .sq_read_base_addr_a1 = 0x61,
  169. .card_revision = 0xbc,
  170. .card_fw_status0 = 0xc0,
  171. .card_fw_status1 = 0xc1,
  172. .card_rx_len = 0xc2,
  173. .card_rx_unit = 0xc3,
  174. .io_port_0 = 0xd8,
  175. .io_port_1 = 0xd9,
  176. .io_port_2 = 0xda,
  177. .int_read_to_clear = true,
  178. .host_int_rsr = 0x01,
  179. .card_misc_cfg = 0xcc,
  180. .fw_dump_ctrl = 0xe2,
  181. .fw_dump_start = 0xe3,
  182. .fw_dump_end = 0xea,
  183. };
  184. static const struct btmrvl_sdio_card_reg btmrvl_reg_89xx = {
  185. .cfg = 0x00,
  186. .host_int_mask = 0x08,
  187. .host_intstatus = 0x0c,
  188. .card_status = 0x5c,
  189. .sq_read_base_addr_a0 = 0xf8,
  190. .sq_read_base_addr_a1 = 0xf9,
  191. .card_revision = 0xc8,
  192. .card_fw_status0 = 0xe8,
  193. .card_fw_status1 = 0xe9,
  194. .card_rx_len = 0xea,
  195. .card_rx_unit = 0xeb,
  196. .io_port_0 = 0xe4,
  197. .io_port_1 = 0xe5,
  198. .io_port_2 = 0xe6,
  199. .int_read_to_clear = true,
  200. .host_int_rsr = 0x04,
  201. .card_misc_cfg = 0xd8,
  202. .fw_dump_ctrl = 0xf0,
  203. .fw_dump_start = 0xf1,
  204. .fw_dump_end = 0xf8,
  205. };
  206. static const struct btmrvl_sdio_device btmrvl_sdio_sd8688 = {
  207. .helper = "mrvl/sd8688_helper.bin",
  208. .firmware = "mrvl/sd8688.bin",
  209. .reg = &btmrvl_reg_8688,
  210. .support_pscan_win_report = false,
  211. .sd_blksz_fw_dl = 64,
  212. .supports_fw_dump = false,
  213. };
  214. static const struct btmrvl_sdio_device btmrvl_sdio_sd8787 = {
  215. .helper = NULL,
  216. .firmware = "mrvl/sd8787_uapsta.bin",
  217. .reg = &btmrvl_reg_87xx,
  218. .support_pscan_win_report = false,
  219. .sd_blksz_fw_dl = 256,
  220. .supports_fw_dump = false,
  221. };
  222. static const struct btmrvl_sdio_device btmrvl_sdio_sd8797 = {
  223. .helper = NULL,
  224. .firmware = "mrvl/sd8797_uapsta.bin",
  225. .reg = &btmrvl_reg_87xx,
  226. .support_pscan_win_report = false,
  227. .sd_blksz_fw_dl = 256,
  228. .supports_fw_dump = false,
  229. };
  230. static const struct btmrvl_sdio_device btmrvl_sdio_sd8887 = {
  231. .helper = NULL,
  232. .firmware = "mrvl/sd8887_uapsta.bin",
  233. .reg = &btmrvl_reg_8887,
  234. .support_pscan_win_report = true,
  235. .sd_blksz_fw_dl = 256,
  236. .supports_fw_dump = false,
  237. };
  238. static const struct btmrvl_sdio_device btmrvl_sdio_sd8897 = {
  239. .helper = NULL,
  240. .firmware = "mrvl/sd8897_uapsta.bin",
  241. .reg = &btmrvl_reg_8897,
  242. .support_pscan_win_report = true,
  243. .sd_blksz_fw_dl = 256,
  244. .supports_fw_dump = true,
  245. };
  246. static const struct btmrvl_sdio_device btmrvl_sdio_sd8977 = {
  247. .helper = NULL,
  248. .firmware = "mrvl/sdsd8977_combo_v2.bin",
  249. .reg = &btmrvl_reg_89xx,
  250. .support_pscan_win_report = true,
  251. .sd_blksz_fw_dl = 256,
  252. .supports_fw_dump = true,
  253. };
  254. static const struct btmrvl_sdio_device btmrvl_sdio_sd8987 = {
  255. .helper = NULL,
  256. .firmware = "mrvl/sd8987_uapsta.bin",
  257. .reg = &btmrvl_reg_89xx,
  258. .support_pscan_win_report = true,
  259. .sd_blksz_fw_dl = 256,
  260. .supports_fw_dump = true,
  261. };
  262. static const struct btmrvl_sdio_device btmrvl_sdio_sd8997 = {
  263. .helper = NULL,
  264. .firmware = "mrvl/sdsd8997_combo_v4.bin",
  265. .reg = &btmrvl_reg_89xx,
  266. .support_pscan_win_report = true,
  267. .sd_blksz_fw_dl = 256,
  268. .supports_fw_dump = true,
  269. };
  270. static const struct sdio_device_id btmrvl_sdio_ids[] = {
  271. /* Marvell SD8688 Bluetooth device */
  272. { SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL, SDIO_DEVICE_ID_MARVELL_8688_BT),
  273. .driver_data = (unsigned long)&btmrvl_sdio_sd8688 },
  274. /* Marvell SD8787 Bluetooth device */
  275. { SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL, SDIO_DEVICE_ID_MARVELL_8787_BT),
  276. .driver_data = (unsigned long)&btmrvl_sdio_sd8787 },
  277. /* Marvell SD8787 Bluetooth AMP device */
  278. { SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL, SDIO_DEVICE_ID_MARVELL_8787_BT_AMP),
  279. .driver_data = (unsigned long)&btmrvl_sdio_sd8787 },
  280. /* Marvell SD8797 Bluetooth device */
  281. { SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL, SDIO_DEVICE_ID_MARVELL_8797_BT),
  282. .driver_data = (unsigned long)&btmrvl_sdio_sd8797 },
  283. /* Marvell SD8887 Bluetooth device */
  284. { SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL, SDIO_DEVICE_ID_MARVELL_8887_BT),
  285. .driver_data = (unsigned long)&btmrvl_sdio_sd8887 },
  286. /* Marvell SD8897 Bluetooth device */
  287. { SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL, SDIO_DEVICE_ID_MARVELL_8897_BT),
  288. .driver_data = (unsigned long)&btmrvl_sdio_sd8897 },
  289. /* Marvell SD8977 Bluetooth device */
  290. { SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL, SDIO_DEVICE_ID_MARVELL_8977_BT),
  291. .driver_data = (unsigned long)&btmrvl_sdio_sd8977 },
  292. /* Marvell SD8987 Bluetooth device */
  293. { SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL, SDIO_DEVICE_ID_MARVELL_8987_BT),
  294. .driver_data = (unsigned long)&btmrvl_sdio_sd8987 },
  295. /* Marvell SD8997 Bluetooth device */
  296. { SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL, SDIO_DEVICE_ID_MARVELL_8997_BT),
  297. .driver_data = (unsigned long)&btmrvl_sdio_sd8997 },
  298. { } /* Terminating entry */
  299. };
  300. MODULE_DEVICE_TABLE(sdio, btmrvl_sdio_ids);
  301. static int btmrvl_sdio_get_rx_unit(struct btmrvl_sdio_card *card)
  302. {
  303. u8 reg;
  304. int ret;
  305. reg = sdio_readb(card->func, card->reg->card_rx_unit, &ret);
  306. if (!ret)
  307. card->rx_unit = reg;
  308. return ret;
  309. }
  310. static int btmrvl_sdio_read_fw_status(struct btmrvl_sdio_card *card, u16 *dat)
  311. {
  312. u8 fws0, fws1;
  313. int ret;
  314. *dat = 0;
  315. fws0 = sdio_readb(card->func, card->reg->card_fw_status0, &ret);
  316. if (ret)
  317. return -EIO;
  318. fws1 = sdio_readb(card->func, card->reg->card_fw_status1, &ret);
  319. if (ret)
  320. return -EIO;
  321. *dat = (((u16) fws1) << 8) | fws0;
  322. return 0;
  323. }
  324. static int btmrvl_sdio_read_rx_len(struct btmrvl_sdio_card *card, u16 *dat)
  325. {
  326. u8 reg;
  327. int ret;
  328. reg = sdio_readb(card->func, card->reg->card_rx_len, &ret);
  329. if (!ret)
  330. *dat = (u16) reg << card->rx_unit;
  331. return ret;
  332. }
  333. static int btmrvl_sdio_enable_host_int_mask(struct btmrvl_sdio_card *card,
  334. u8 mask)
  335. {
  336. int ret;
  337. sdio_writeb(card->func, mask, card->reg->host_int_mask, &ret);
  338. if (ret) {
  339. BT_ERR("Unable to enable the host interrupt!");
  340. ret = -EIO;
  341. }
  342. return ret;
  343. }
  344. static int btmrvl_sdio_disable_host_int_mask(struct btmrvl_sdio_card *card,
  345. u8 mask)
  346. {
  347. u8 host_int_mask;
  348. int ret;
  349. host_int_mask = sdio_readb(card->func, card->reg->host_int_mask, &ret);
  350. if (ret)
  351. return -EIO;
  352. host_int_mask &= ~mask;
  353. sdio_writeb(card->func, host_int_mask, card->reg->host_int_mask, &ret);
  354. if (ret < 0) {
  355. BT_ERR("Unable to disable the host interrupt!");
  356. return -EIO;
  357. }
  358. return 0;
  359. }
  360. static int btmrvl_sdio_poll_card_status(struct btmrvl_sdio_card *card, u8 bits)
  361. {
  362. unsigned int tries;
  363. u8 status;
  364. int ret;
  365. for (tries = 0; tries < MAX_POLL_TRIES * 1000; tries++) {
  366. status = sdio_readb(card->func, card->reg->card_status, &ret);
  367. if (ret)
  368. goto failed;
  369. if ((status & bits) == bits)
  370. return ret;
  371. udelay(1);
  372. }
  373. ret = -ETIMEDOUT;
  374. failed:
  375. BT_ERR("FAILED! ret=%d", ret);
  376. return ret;
  377. }
  378. static int btmrvl_sdio_verify_fw_download(struct btmrvl_sdio_card *card,
  379. int pollnum)
  380. {
  381. u16 firmwarestat;
  382. int tries, ret;
  383. /* Wait for firmware to become ready */
  384. for (tries = 0; tries < pollnum; tries++) {
  385. sdio_claim_host(card->func);
  386. ret = btmrvl_sdio_read_fw_status(card, &firmwarestat);
  387. sdio_release_host(card->func);
  388. if (ret < 0)
  389. continue;
  390. if (firmwarestat == FIRMWARE_READY)
  391. return 0;
  392. msleep(100);
  393. }
  394. return -ETIMEDOUT;
  395. }
  396. static int btmrvl_sdio_download_helper(struct btmrvl_sdio_card *card)
  397. {
  398. const struct firmware *fw_helper = NULL;
  399. const u8 *helper = NULL;
  400. int ret;
  401. void *tmphlprbuf = NULL;
  402. int tmphlprbufsz, hlprblknow, helperlen;
  403. u8 *helperbuf;
  404. u32 tx_len;
  405. ret = request_firmware(&fw_helper, card->helper,
  406. &card->func->dev);
  407. if ((ret < 0) || !fw_helper) {
  408. BT_ERR("request_firmware(helper) failed, error code = %d",
  409. ret);
  410. ret = -ENOENT;
  411. goto done;
  412. }
  413. helper = fw_helper->data;
  414. helperlen = fw_helper->size;
  415. BT_DBG("Downloading helper image (%d bytes), block size %d bytes",
  416. helperlen, SDIO_BLOCK_SIZE);
  417. tmphlprbufsz = ALIGN_SZ(BTM_UPLD_SIZE, BTSDIO_DMA_ALIGN);
  418. tmphlprbuf = kzalloc(tmphlprbufsz, GFP_KERNEL);
  419. if (!tmphlprbuf) {
  420. BT_ERR("Unable to allocate buffer for helper."
  421. " Terminating download");
  422. ret = -ENOMEM;
  423. goto done;
  424. }
  425. helperbuf = (u8 *) ALIGN_ADDR(tmphlprbuf, BTSDIO_DMA_ALIGN);
  426. /* Perform helper data transfer */
  427. tx_len = (FIRMWARE_TRANSFER_NBLOCK * SDIO_BLOCK_SIZE)
  428. - SDIO_HEADER_LEN;
  429. hlprblknow = 0;
  430. do {
  431. ret = btmrvl_sdio_poll_card_status(card,
  432. CARD_IO_READY | DN_LD_CARD_RDY);
  433. if (ret < 0) {
  434. BT_ERR("Helper download poll status timeout @ %d",
  435. hlprblknow);
  436. goto done;
  437. }
  438. /* Check if there is more data? */
  439. if (hlprblknow >= helperlen)
  440. break;
  441. if (helperlen - hlprblknow < tx_len)
  442. tx_len = helperlen - hlprblknow;
  443. /* Little-endian */
  444. helperbuf[0] = ((tx_len & 0x000000ff) >> 0);
  445. helperbuf[1] = ((tx_len & 0x0000ff00) >> 8);
  446. helperbuf[2] = ((tx_len & 0x00ff0000) >> 16);
  447. helperbuf[3] = ((tx_len & 0xff000000) >> 24);
  448. memcpy(&helperbuf[SDIO_HEADER_LEN], &helper[hlprblknow],
  449. tx_len);
  450. /* Now send the data */
  451. ret = sdio_writesb(card->func, card->ioport, helperbuf,
  452. FIRMWARE_TRANSFER_NBLOCK * SDIO_BLOCK_SIZE);
  453. if (ret < 0) {
  454. BT_ERR("IO error during helper download @ %d",
  455. hlprblknow);
  456. goto done;
  457. }
  458. hlprblknow += tx_len;
  459. } while (true);
  460. BT_DBG("Transferring helper image EOF block");
  461. memset(helperbuf, 0x0, SDIO_BLOCK_SIZE);
  462. ret = sdio_writesb(card->func, card->ioport, helperbuf,
  463. SDIO_BLOCK_SIZE);
  464. if (ret < 0) {
  465. BT_ERR("IO error in writing helper image EOF block");
  466. goto done;
  467. }
  468. ret = 0;
  469. done:
  470. kfree(tmphlprbuf);
  471. release_firmware(fw_helper);
  472. return ret;
  473. }
  474. static int btmrvl_sdio_download_fw_w_helper(struct btmrvl_sdio_card *card)
  475. {
  476. const struct firmware *fw_firmware = NULL;
  477. const u8 *firmware = NULL;
  478. int firmwarelen, tmpfwbufsz, ret;
  479. unsigned int tries, offset;
  480. u8 base0, base1;
  481. void *tmpfwbuf = NULL;
  482. u8 *fwbuf;
  483. u16 len, blksz_dl = card->sd_blksz_fw_dl;
  484. int txlen = 0, tx_blocks = 0, count = 0;
  485. ret = request_firmware(&fw_firmware, card->firmware,
  486. &card->func->dev);
  487. if ((ret < 0) || !fw_firmware) {
  488. BT_ERR("request_firmware(firmware) failed, error code = %d",
  489. ret);
  490. ret = -ENOENT;
  491. goto done;
  492. }
  493. firmware = fw_firmware->data;
  494. firmwarelen = fw_firmware->size;
  495. BT_DBG("Downloading FW image (%d bytes)", firmwarelen);
  496. tmpfwbufsz = ALIGN_SZ(BTM_UPLD_SIZE, BTSDIO_DMA_ALIGN);
  497. tmpfwbuf = kzalloc(tmpfwbufsz, GFP_KERNEL);
  498. if (!tmpfwbuf) {
  499. BT_ERR("Unable to allocate buffer for firmware."
  500. " Terminating download");
  501. ret = -ENOMEM;
  502. goto done;
  503. }
  504. /* Ensure aligned firmware buffer */
  505. fwbuf = (u8 *) ALIGN_ADDR(tmpfwbuf, BTSDIO_DMA_ALIGN);
  506. /* Perform firmware data transfer */
  507. offset = 0;
  508. do {
  509. ret = btmrvl_sdio_poll_card_status(card,
  510. CARD_IO_READY | DN_LD_CARD_RDY);
  511. if (ret < 0) {
  512. BT_ERR("FW download with helper poll status"
  513. " timeout @ %d", offset);
  514. goto done;
  515. }
  516. /* Check if there is more data ? */
  517. if (offset >= firmwarelen)
  518. break;
  519. for (tries = 0; tries < MAX_POLL_TRIES; tries++) {
  520. base0 = sdio_readb(card->func,
  521. card->reg->sq_read_base_addr_a0, &ret);
  522. if (ret) {
  523. BT_ERR("BASE0 register read failed:"
  524. " base0 = 0x%04X(%d)."
  525. " Terminating download",
  526. base0, base0);
  527. ret = -EIO;
  528. goto done;
  529. }
  530. base1 = sdio_readb(card->func,
  531. card->reg->sq_read_base_addr_a1, &ret);
  532. if (ret) {
  533. BT_ERR("BASE1 register read failed:"
  534. " base1 = 0x%04X(%d)."
  535. " Terminating download",
  536. base1, base1);
  537. ret = -EIO;
  538. goto done;
  539. }
  540. len = (((u16) base1) << 8) | base0;
  541. if (len)
  542. break;
  543. udelay(10);
  544. }
  545. if (!len)
  546. break;
  547. else if (len > BTM_UPLD_SIZE) {
  548. BT_ERR("FW download failure @%d, invalid length %d",
  549. offset, len);
  550. ret = -EINVAL;
  551. goto done;
  552. }
  553. txlen = len;
  554. if (len & BIT(0)) {
  555. count++;
  556. if (count > MAX_WRITE_IOMEM_RETRY) {
  557. BT_ERR("FW download failure @%d, "
  558. "over max retry count", offset);
  559. ret = -EIO;
  560. goto done;
  561. }
  562. BT_ERR("FW CRC error indicated by the helper: "
  563. "len = 0x%04X, txlen = %d", len, txlen);
  564. len &= ~BIT(0);
  565. /* Set txlen to 0 so as to resend from same offset */
  566. txlen = 0;
  567. } else {
  568. count = 0;
  569. /* Last block ? */
  570. if (firmwarelen - offset < txlen)
  571. txlen = firmwarelen - offset;
  572. tx_blocks = DIV_ROUND_UP(txlen, blksz_dl);
  573. memcpy(fwbuf, &firmware[offset], txlen);
  574. }
  575. ret = sdio_writesb(card->func, card->ioport, fwbuf,
  576. tx_blocks * blksz_dl);
  577. if (ret < 0) {
  578. BT_ERR("FW download, writesb(%d) failed @%d",
  579. count, offset);
  580. sdio_writeb(card->func, HOST_CMD53_FIN,
  581. card->reg->cfg, &ret);
  582. if (ret)
  583. BT_ERR("writeb failed (CFG)");
  584. }
  585. offset += txlen;
  586. } while (true);
  587. BT_INFO("FW download over, size %d bytes", offset);
  588. ret = 0;
  589. done:
  590. kfree(tmpfwbuf);
  591. release_firmware(fw_firmware);
  592. return ret;
  593. }
  594. static int btmrvl_sdio_card_to_host(struct btmrvl_private *priv)
  595. {
  596. u16 buf_len = 0;
  597. int ret, num_blocks, blksz;
  598. struct sk_buff *skb = NULL;
  599. u32 type;
  600. u8 *payload;
  601. struct hci_dev *hdev = priv->btmrvl_dev.hcidev;
  602. struct btmrvl_sdio_card *card = priv->btmrvl_dev.card;
  603. if (!card || !card->func) {
  604. BT_ERR("card or function is NULL!");
  605. ret = -EINVAL;
  606. goto exit;
  607. }
  608. /* Read the length of data to be transferred */
  609. ret = btmrvl_sdio_read_rx_len(card, &buf_len);
  610. if (ret < 0) {
  611. BT_ERR("read rx_len failed");
  612. ret = -EIO;
  613. goto exit;
  614. }
  615. blksz = SDIO_BLOCK_SIZE;
  616. num_blocks = DIV_ROUND_UP(buf_len, blksz);
  617. if (buf_len <= SDIO_HEADER_LEN
  618. || (num_blocks * blksz) > ALLOC_BUF_SIZE) {
  619. BT_ERR("invalid packet length: %d", buf_len);
  620. ret = -EINVAL;
  621. goto exit;
  622. }
  623. /* Allocate buffer */
  624. skb = bt_skb_alloc(num_blocks * blksz + BTSDIO_DMA_ALIGN, GFP_KERNEL);
  625. if (!skb) {
  626. BT_ERR("No free skb");
  627. ret = -ENOMEM;
  628. goto exit;
  629. }
  630. if ((unsigned long) skb->data & (BTSDIO_DMA_ALIGN - 1)) {
  631. skb_put(skb, (unsigned long) skb->data &
  632. (BTSDIO_DMA_ALIGN - 1));
  633. skb_pull(skb, (unsigned long) skb->data &
  634. (BTSDIO_DMA_ALIGN - 1));
  635. }
  636. payload = skb->data;
  637. ret = sdio_readsb(card->func, payload, card->ioport,
  638. num_blocks * blksz);
  639. if (ret < 0) {
  640. BT_ERR("readsb failed: %d", ret);
  641. ret = -EIO;
  642. goto exit;
  643. }
  644. /* This is SDIO specific header length: byte[2][1][0], type: byte[3]
  645. * (HCI_COMMAND = 1, ACL_DATA = 2, SCO_DATA = 3, 0xFE = Vendor)
  646. */
  647. buf_len = payload[0];
  648. buf_len |= payload[1] << 8;
  649. buf_len |= payload[2] << 16;
  650. if (buf_len > blksz * num_blocks) {
  651. BT_ERR("Skip incorrect packet: hdrlen %d buffer %d",
  652. buf_len, blksz * num_blocks);
  653. ret = -EIO;
  654. goto exit;
  655. }
  656. type = payload[3];
  657. switch (type) {
  658. case HCI_ACLDATA_PKT:
  659. case HCI_SCODATA_PKT:
  660. case HCI_EVENT_PKT:
  661. hci_skb_pkt_type(skb) = type;
  662. skb_put(skb, buf_len);
  663. skb_pull(skb, SDIO_HEADER_LEN);
  664. if (type == HCI_EVENT_PKT) {
  665. if (btmrvl_check_evtpkt(priv, skb))
  666. hci_recv_frame(hdev, skb);
  667. } else {
  668. hci_recv_frame(hdev, skb);
  669. }
  670. hdev->stat.byte_rx += buf_len;
  671. break;
  672. case MRVL_VENDOR_PKT:
  673. hci_skb_pkt_type(skb) = HCI_VENDOR_PKT;
  674. skb_put(skb, buf_len);
  675. skb_pull(skb, SDIO_HEADER_LEN);
  676. if (btmrvl_process_event(priv, skb))
  677. hci_recv_frame(hdev, skb);
  678. hdev->stat.byte_rx += buf_len;
  679. break;
  680. default:
  681. BT_ERR("Unknown packet type:%d", type);
  682. BT_ERR("hex: %*ph", blksz * num_blocks, payload);
  683. kfree_skb(skb);
  684. skb = NULL;
  685. break;
  686. }
  687. exit:
  688. if (ret) {
  689. hdev->stat.err_rx++;
  690. kfree_skb(skb);
  691. }
  692. return ret;
  693. }
  694. static int btmrvl_sdio_process_int_status(struct btmrvl_private *priv)
  695. {
  696. ulong flags;
  697. u8 ireg;
  698. struct btmrvl_sdio_card *card = priv->btmrvl_dev.card;
  699. spin_lock_irqsave(&priv->driver_lock, flags);
  700. ireg = sdio_ireg;
  701. sdio_ireg = 0;
  702. spin_unlock_irqrestore(&priv->driver_lock, flags);
  703. sdio_claim_host(card->func);
  704. if (ireg & DN_LD_HOST_INT_STATUS) {
  705. if (priv->btmrvl_dev.tx_dnld_rdy)
  706. BT_DBG("tx_done already received: "
  707. " int_status=0x%x", ireg);
  708. else
  709. priv->btmrvl_dev.tx_dnld_rdy = true;
  710. }
  711. if (ireg & UP_LD_HOST_INT_STATUS)
  712. btmrvl_sdio_card_to_host(priv);
  713. sdio_release_host(card->func);
  714. return 0;
  715. }
  716. static int btmrvl_sdio_read_to_clear(struct btmrvl_sdio_card *card, u8 *ireg)
  717. {
  718. struct btmrvl_adapter *adapter = card->priv->adapter;
  719. int ret;
  720. ret = sdio_readsb(card->func, adapter->hw_regs, 0, SDIO_BLOCK_SIZE);
  721. if (ret) {
  722. BT_ERR("sdio_readsb: read int hw_regs failed: %d", ret);
  723. return ret;
  724. }
  725. *ireg = adapter->hw_regs[card->reg->host_intstatus];
  726. BT_DBG("hw_regs[%#x]=%#x", card->reg->host_intstatus, *ireg);
  727. return 0;
  728. }
  729. static int btmrvl_sdio_write_to_clear(struct btmrvl_sdio_card *card, u8 *ireg)
  730. {
  731. int ret;
  732. *ireg = sdio_readb(card->func, card->reg->host_intstatus, &ret);
  733. if (ret) {
  734. BT_ERR("sdio_readb: read int status failed: %d", ret);
  735. return ret;
  736. }
  737. if (*ireg) {
  738. /*
  739. * DN_LD_HOST_INT_STATUS and/or UP_LD_HOST_INT_STATUS
  740. * Clear the interrupt status register and re-enable the
  741. * interrupt.
  742. */
  743. BT_DBG("int_status = 0x%x", *ireg);
  744. sdio_writeb(card->func, ~(*ireg) & (DN_LD_HOST_INT_STATUS |
  745. UP_LD_HOST_INT_STATUS),
  746. card->reg->host_intstatus, &ret);
  747. if (ret) {
  748. BT_ERR("sdio_writeb: clear int status failed: %d", ret);
  749. return ret;
  750. }
  751. }
  752. return 0;
  753. }
  754. static void btmrvl_sdio_interrupt(struct sdio_func *func)
  755. {
  756. struct btmrvl_private *priv;
  757. struct btmrvl_sdio_card *card;
  758. ulong flags;
  759. u8 ireg = 0;
  760. int ret;
  761. card = sdio_get_drvdata(func);
  762. if (!card || !card->priv) {
  763. BT_ERR("sbi_interrupt(%p) card or priv is NULL, card=%p",
  764. func, card);
  765. return;
  766. }
  767. priv = card->priv;
  768. if (priv->surprise_removed)
  769. return;
  770. if (card->reg->int_read_to_clear)
  771. ret = btmrvl_sdio_read_to_clear(card, &ireg);
  772. else
  773. ret = btmrvl_sdio_write_to_clear(card, &ireg);
  774. if (ret)
  775. return;
  776. spin_lock_irqsave(&priv->driver_lock, flags);
  777. sdio_ireg |= ireg;
  778. spin_unlock_irqrestore(&priv->driver_lock, flags);
  779. btmrvl_interrupt(priv);
  780. }
  781. static int btmrvl_sdio_register_dev(struct btmrvl_sdio_card *card)
  782. {
  783. struct sdio_func *func;
  784. u8 reg;
  785. int ret;
  786. if (!card || !card->func) {
  787. BT_ERR("Error: card or function is NULL!");
  788. ret = -EINVAL;
  789. goto failed;
  790. }
  791. func = card->func;
  792. sdio_claim_host(func);
  793. ret = sdio_enable_func(func);
  794. if (ret) {
  795. BT_ERR("sdio_enable_func() failed: ret=%d", ret);
  796. ret = -EIO;
  797. goto release_host;
  798. }
  799. ret = sdio_claim_irq(func, btmrvl_sdio_interrupt);
  800. if (ret) {
  801. BT_ERR("sdio_claim_irq failed: ret=%d", ret);
  802. ret = -EIO;
  803. goto disable_func;
  804. }
  805. ret = sdio_set_block_size(card->func, SDIO_BLOCK_SIZE);
  806. if (ret) {
  807. BT_ERR("cannot set SDIO block size");
  808. ret = -EIO;
  809. goto release_irq;
  810. }
  811. reg = sdio_readb(func, card->reg->io_port_0, &ret);
  812. if (ret < 0) {
  813. ret = -EIO;
  814. goto release_irq;
  815. }
  816. card->ioport = reg;
  817. reg = sdio_readb(func, card->reg->io_port_1, &ret);
  818. if (ret < 0) {
  819. ret = -EIO;
  820. goto release_irq;
  821. }
  822. card->ioport |= (reg << 8);
  823. reg = sdio_readb(func, card->reg->io_port_2, &ret);
  824. if (ret < 0) {
  825. ret = -EIO;
  826. goto release_irq;
  827. }
  828. card->ioport |= (reg << 16);
  829. BT_DBG("SDIO FUNC%d IO port: 0x%x", func->num, card->ioport);
  830. if (card->reg->int_read_to_clear) {
  831. reg = sdio_readb(func, card->reg->host_int_rsr, &ret);
  832. if (ret < 0) {
  833. ret = -EIO;
  834. goto release_irq;
  835. }
  836. sdio_writeb(func, reg | 0x3f, card->reg->host_int_rsr, &ret);
  837. if (ret < 0) {
  838. ret = -EIO;
  839. goto release_irq;
  840. }
  841. reg = sdio_readb(func, card->reg->card_misc_cfg, &ret);
  842. if (ret < 0) {
  843. ret = -EIO;
  844. goto release_irq;
  845. }
  846. sdio_writeb(func, reg | 0x10, card->reg->card_misc_cfg, &ret);
  847. if (ret < 0) {
  848. ret = -EIO;
  849. goto release_irq;
  850. }
  851. }
  852. sdio_set_drvdata(func, card);
  853. sdio_release_host(func);
  854. return 0;
  855. release_irq:
  856. sdio_release_irq(func);
  857. disable_func:
  858. sdio_disable_func(func);
  859. release_host:
  860. sdio_release_host(func);
  861. failed:
  862. return ret;
  863. }
  864. static int btmrvl_sdio_unregister_dev(struct btmrvl_sdio_card *card)
  865. {
  866. if (card && card->func) {
  867. sdio_claim_host(card->func);
  868. sdio_release_irq(card->func);
  869. sdio_disable_func(card->func);
  870. sdio_release_host(card->func);
  871. sdio_set_drvdata(card->func, NULL);
  872. }
  873. return 0;
  874. }
  875. static int btmrvl_sdio_enable_host_int(struct btmrvl_sdio_card *card)
  876. {
  877. int ret;
  878. if (!card || !card->func)
  879. return -EINVAL;
  880. sdio_claim_host(card->func);
  881. ret = btmrvl_sdio_enable_host_int_mask(card, HIM_ENABLE);
  882. btmrvl_sdio_get_rx_unit(card);
  883. sdio_release_host(card->func);
  884. return ret;
  885. }
  886. static int btmrvl_sdio_disable_host_int(struct btmrvl_sdio_card *card)
  887. {
  888. int ret;
  889. if (!card || !card->func)
  890. return -EINVAL;
  891. sdio_claim_host(card->func);
  892. ret = btmrvl_sdio_disable_host_int_mask(card, HIM_DISABLE);
  893. sdio_release_host(card->func);
  894. return ret;
  895. }
  896. static int btmrvl_sdio_host_to_card(struct btmrvl_private *priv,
  897. u8 *payload, u16 nb)
  898. {
  899. struct btmrvl_sdio_card *card = priv->btmrvl_dev.card;
  900. int ret = 0;
  901. int blksz;
  902. int i = 0;
  903. u8 *buf = NULL;
  904. void *tmpbuf = NULL;
  905. int tmpbufsz;
  906. if (!card || !card->func) {
  907. BT_ERR("card or function is NULL!");
  908. return -EINVAL;
  909. }
  910. blksz = DIV_ROUND_UP(nb, SDIO_BLOCK_SIZE) * SDIO_BLOCK_SIZE;
  911. buf = payload;
  912. if ((unsigned long) payload & (BTSDIO_DMA_ALIGN - 1) ||
  913. nb < blksz) {
  914. tmpbufsz = ALIGN_SZ(blksz, BTSDIO_DMA_ALIGN) +
  915. BTSDIO_DMA_ALIGN;
  916. tmpbuf = kzalloc(tmpbufsz, GFP_KERNEL);
  917. if (!tmpbuf)
  918. return -ENOMEM;
  919. buf = (u8 *) ALIGN_ADDR(tmpbuf, BTSDIO_DMA_ALIGN);
  920. memcpy(buf, payload, nb);
  921. }
  922. sdio_claim_host(card->func);
  923. do {
  924. /* Transfer data to card */
  925. ret = sdio_writesb(card->func, card->ioport, buf,
  926. blksz);
  927. if (ret < 0) {
  928. i++;
  929. BT_ERR("i=%d writesb failed: %d", i, ret);
  930. BT_ERR("hex: %*ph", nb, payload);
  931. ret = -EIO;
  932. if (i > MAX_WRITE_IOMEM_RETRY)
  933. goto exit;
  934. }
  935. } while (ret);
  936. priv->btmrvl_dev.tx_dnld_rdy = false;
  937. exit:
  938. sdio_release_host(card->func);
  939. kfree(tmpbuf);
  940. return ret;
  941. }
  942. static int btmrvl_sdio_download_fw(struct btmrvl_sdio_card *card)
  943. {
  944. int ret;
  945. u8 fws0;
  946. int pollnum = MAX_POLL_TRIES;
  947. if (!card || !card->func) {
  948. BT_ERR("card or function is NULL!");
  949. return -EINVAL;
  950. }
  951. if (!btmrvl_sdio_verify_fw_download(card, 1)) {
  952. BT_DBG("Firmware already downloaded!");
  953. return 0;
  954. }
  955. sdio_claim_host(card->func);
  956. /* Check if other function driver is downloading the firmware */
  957. fws0 = sdio_readb(card->func, card->reg->card_fw_status0, &ret);
  958. if (ret) {
  959. BT_ERR("Failed to read FW downloading status!");
  960. ret = -EIO;
  961. goto done;
  962. }
  963. if (fws0) {
  964. BT_DBG("BT not the winner (%#x). Skip FW downloading", fws0);
  965. /* Give other function more time to download the firmware */
  966. pollnum *= 10;
  967. } else {
  968. if (card->helper) {
  969. ret = btmrvl_sdio_download_helper(card);
  970. if (ret) {
  971. BT_ERR("Failed to download helper!");
  972. ret = -EIO;
  973. goto done;
  974. }
  975. }
  976. if (btmrvl_sdio_download_fw_w_helper(card)) {
  977. BT_ERR("Failed to download firmware!");
  978. ret = -EIO;
  979. goto done;
  980. }
  981. }
  982. /*
  983. * winner or not, with this test the FW synchronizes when the
  984. * module can continue its initialization
  985. */
  986. if (btmrvl_sdio_verify_fw_download(card, pollnum)) {
  987. BT_ERR("FW failed to be active in time!");
  988. ret = -ETIMEDOUT;
  989. goto done;
  990. }
  991. sdio_release_host(card->func);
  992. return 0;
  993. done:
  994. sdio_release_host(card->func);
  995. return ret;
  996. }
  997. static int btmrvl_sdio_wakeup_fw(struct btmrvl_private *priv)
  998. {
  999. struct btmrvl_sdio_card *card = priv->btmrvl_dev.card;
  1000. int ret = 0;
  1001. if (!card || !card->func) {
  1002. BT_ERR("card or function is NULL!");
  1003. return -EINVAL;
  1004. }
  1005. sdio_claim_host(card->func);
  1006. sdio_writeb(card->func, HOST_POWER_UP, card->reg->cfg, &ret);
  1007. sdio_release_host(card->func);
  1008. BT_DBG("wake up firmware");
  1009. return ret;
  1010. }
  1011. static void btmrvl_sdio_dump_regs(struct btmrvl_private *priv)
  1012. {
  1013. struct btmrvl_sdio_card *card = priv->btmrvl_dev.card;
  1014. int ret = 0;
  1015. unsigned int reg, reg_start, reg_end;
  1016. char buf[256], *ptr;
  1017. u8 loop, func, data;
  1018. int MAX_LOOP = 2;
  1019. btmrvl_sdio_wakeup_fw(priv);
  1020. sdio_claim_host(card->func);
  1021. for (loop = 0; loop < MAX_LOOP; loop++) {
  1022. memset(buf, 0, sizeof(buf));
  1023. ptr = buf;
  1024. if (loop == 0) {
  1025. /* Read the registers of SDIO function0 */
  1026. func = loop;
  1027. reg_start = 0;
  1028. reg_end = 9;
  1029. } else {
  1030. func = 2;
  1031. reg_start = 0;
  1032. reg_end = 0x09;
  1033. }
  1034. ptr += sprintf(ptr, "SDIO Func%d (%#x-%#x): ",
  1035. func, reg_start, reg_end);
  1036. for (reg = reg_start; reg <= reg_end; reg++) {
  1037. if (func == 0)
  1038. data = sdio_f0_readb(card->func, reg, &ret);
  1039. else
  1040. data = sdio_readb(card->func, reg, &ret);
  1041. if (!ret) {
  1042. ptr += sprintf(ptr, "%02x ", data);
  1043. } else {
  1044. ptr += sprintf(ptr, "ERR");
  1045. break;
  1046. }
  1047. }
  1048. BT_INFO("%s", buf);
  1049. }
  1050. sdio_release_host(card->func);
  1051. }
  1052. /* This function read/write firmware */
  1053. static enum
  1054. rdwr_status btmrvl_sdio_rdwr_firmware(struct btmrvl_private *priv,
  1055. u8 doneflag)
  1056. {
  1057. struct btmrvl_sdio_card *card = priv->btmrvl_dev.card;
  1058. int ret, tries;
  1059. u8 ctrl_data = 0;
  1060. sdio_writeb(card->func, FW_DUMP_HOST_READY, card->reg->fw_dump_ctrl,
  1061. &ret);
  1062. if (ret) {
  1063. BT_ERR("SDIO write err");
  1064. return RDWR_STATUS_FAILURE;
  1065. }
  1066. for (tries = 0; tries < MAX_POLL_TRIES; tries++) {
  1067. ctrl_data = sdio_readb(card->func, card->reg->fw_dump_ctrl,
  1068. &ret);
  1069. if (ret) {
  1070. BT_ERR("SDIO read err");
  1071. return RDWR_STATUS_FAILURE;
  1072. }
  1073. if (ctrl_data == FW_DUMP_DONE)
  1074. break;
  1075. if (doneflag && ctrl_data == doneflag)
  1076. return RDWR_STATUS_DONE;
  1077. if (ctrl_data != FW_DUMP_HOST_READY) {
  1078. BT_INFO("The ctrl reg was changed, re-try again!");
  1079. sdio_writeb(card->func, FW_DUMP_HOST_READY,
  1080. card->reg->fw_dump_ctrl, &ret);
  1081. if (ret) {
  1082. BT_ERR("SDIO write err");
  1083. return RDWR_STATUS_FAILURE;
  1084. }
  1085. }
  1086. usleep_range(100, 200);
  1087. }
  1088. if (ctrl_data == FW_DUMP_HOST_READY) {
  1089. BT_ERR("Fail to pull ctrl_data");
  1090. return RDWR_STATUS_FAILURE;
  1091. }
  1092. return RDWR_STATUS_SUCCESS;
  1093. }
  1094. /* This function dump sdio register and memory data */
  1095. static void btmrvl_sdio_coredump(struct device *dev)
  1096. {
  1097. struct sdio_func *func = dev_to_sdio_func(dev);
  1098. struct btmrvl_sdio_card *card;
  1099. struct btmrvl_private *priv;
  1100. int ret = 0;
  1101. unsigned int reg, reg_start, reg_end;
  1102. enum rdwr_status stat;
  1103. u8 *dbg_ptr, *end_ptr, *fw_dump_data, *fw_dump_ptr;
  1104. u8 dump_num = 0, idx, i, read_reg, doneflag = 0;
  1105. u32 memory_size, fw_dump_len = 0;
  1106. int size = 0;
  1107. card = sdio_get_drvdata(func);
  1108. priv = card->priv;
  1109. /* dump sdio register first */
  1110. btmrvl_sdio_dump_regs(priv);
  1111. if (!card->supports_fw_dump) {
  1112. BT_ERR("Firmware dump not supported for this card!");
  1113. return;
  1114. }
  1115. for (idx = 0; idx < ARRAY_SIZE(mem_type_mapping_tbl); idx++) {
  1116. struct memory_type_mapping *entry = &mem_type_mapping_tbl[idx];
  1117. if (entry->mem_ptr) {
  1118. vfree(entry->mem_ptr);
  1119. entry->mem_ptr = NULL;
  1120. }
  1121. entry->mem_size = 0;
  1122. }
  1123. btmrvl_sdio_wakeup_fw(priv);
  1124. sdio_claim_host(card->func);
  1125. BT_INFO("== btmrvl firmware dump start ==");
  1126. stat = btmrvl_sdio_rdwr_firmware(priv, doneflag);
  1127. if (stat == RDWR_STATUS_FAILURE)
  1128. goto done;
  1129. reg = card->reg->fw_dump_start;
  1130. /* Read the number of the memories which will dump */
  1131. dump_num = sdio_readb(card->func, reg, &ret);
  1132. if (ret) {
  1133. BT_ERR("SDIO read memory length err");
  1134. goto done;
  1135. }
  1136. /* Read the length of every memory which will dump */
  1137. for (idx = 0; idx < dump_num; idx++) {
  1138. struct memory_type_mapping *entry = &mem_type_mapping_tbl[idx];
  1139. stat = btmrvl_sdio_rdwr_firmware(priv, doneflag);
  1140. if (stat == RDWR_STATUS_FAILURE)
  1141. goto done;
  1142. memory_size = 0;
  1143. reg = card->reg->fw_dump_start;
  1144. for (i = 0; i < 4; i++) {
  1145. read_reg = sdio_readb(card->func, reg, &ret);
  1146. if (ret) {
  1147. BT_ERR("SDIO read err");
  1148. goto done;
  1149. }
  1150. memory_size |= (read_reg << i*8);
  1151. reg++;
  1152. }
  1153. if (memory_size == 0) {
  1154. BT_INFO("Firmware dump finished!");
  1155. sdio_writeb(card->func, FW_DUMP_READ_DONE,
  1156. card->reg->fw_dump_ctrl, &ret);
  1157. if (ret) {
  1158. BT_ERR("SDIO Write MEMDUMP_FINISH ERR");
  1159. goto done;
  1160. }
  1161. break;
  1162. }
  1163. BT_INFO("%s_SIZE=0x%x", entry->mem_name, memory_size);
  1164. entry->mem_ptr = vzalloc(memory_size + 1);
  1165. entry->mem_size = memory_size;
  1166. if (!entry->mem_ptr) {
  1167. BT_ERR("Vzalloc %s failed", entry->mem_name);
  1168. goto done;
  1169. }
  1170. fw_dump_len += (strlen("========Start dump ") +
  1171. strlen(entry->mem_name) +
  1172. strlen("========\n") +
  1173. (memory_size + 1) +
  1174. strlen("\n========End dump========\n"));
  1175. dbg_ptr = entry->mem_ptr;
  1176. end_ptr = dbg_ptr + memory_size;
  1177. doneflag = entry->done_flag;
  1178. BT_INFO("Start %s output, please wait...",
  1179. entry->mem_name);
  1180. do {
  1181. stat = btmrvl_sdio_rdwr_firmware(priv, doneflag);
  1182. if (stat == RDWR_STATUS_FAILURE)
  1183. goto done;
  1184. reg_start = card->reg->fw_dump_start;
  1185. reg_end = card->reg->fw_dump_end;
  1186. for (reg = reg_start; reg <= reg_end; reg++) {
  1187. *dbg_ptr = sdio_readb(card->func, reg, &ret);
  1188. if (ret) {
  1189. BT_ERR("SDIO read err");
  1190. goto done;
  1191. }
  1192. if (dbg_ptr < end_ptr)
  1193. dbg_ptr++;
  1194. else
  1195. BT_ERR("Allocated buffer not enough");
  1196. }
  1197. if (stat == RDWR_STATUS_DONE) {
  1198. BT_INFO("%s done: size=0x%tx",
  1199. entry->mem_name,
  1200. dbg_ptr - entry->mem_ptr);
  1201. break;
  1202. }
  1203. } while (1);
  1204. }
  1205. BT_INFO("== btmrvl firmware dump end ==");
  1206. done:
  1207. sdio_release_host(card->func);
  1208. if (fw_dump_len == 0)
  1209. return;
  1210. fw_dump_data = vzalloc(fw_dump_len + 1);
  1211. if (!fw_dump_data) {
  1212. BT_ERR("Vzalloc fw_dump_data fail!");
  1213. return;
  1214. }
  1215. fw_dump_ptr = fw_dump_data;
  1216. /* Dump all the memory data into single file, a userspace script will
  1217. * be used to split all the memory data to multiple files
  1218. */
  1219. BT_INFO("== btmrvl firmware dump to /sys/class/devcoredump start");
  1220. for (idx = 0; idx < dump_num; idx++) {
  1221. struct memory_type_mapping *entry = &mem_type_mapping_tbl[idx];
  1222. if (entry->mem_ptr) {
  1223. size += scnprintf(fw_dump_ptr + size,
  1224. fw_dump_len + 1 - size,
  1225. "========Start dump %s========\n",
  1226. entry->mem_name);
  1227. memcpy(fw_dump_ptr + size, entry->mem_ptr,
  1228. entry->mem_size);
  1229. size += entry->mem_size;
  1230. size += scnprintf(fw_dump_ptr + size,
  1231. fw_dump_len + 1 - size,
  1232. "\n========End dump========\n");
  1233. vfree(mem_type_mapping_tbl[idx].mem_ptr);
  1234. mem_type_mapping_tbl[idx].mem_ptr = NULL;
  1235. }
  1236. }
  1237. /* fw_dump_data will be free in device coredump release function
  1238. * after 5 min
  1239. */
  1240. dev_coredumpv(&card->func->dev, fw_dump_data, fw_dump_len, GFP_KERNEL);
  1241. BT_INFO("== btmrvl firmware dump to /sys/class/devcoredump end");
  1242. }
  1243. static int btmrvl_sdio_probe(struct sdio_func *func,
  1244. const struct sdio_device_id *id)
  1245. {
  1246. int ret = 0;
  1247. struct btmrvl_private *priv = NULL;
  1248. struct btmrvl_sdio_card *card = NULL;
  1249. BT_INFO("vendor=0x%x, device=0x%x, class=%d, fn=%d",
  1250. id->vendor, id->device, id->class, func->num);
  1251. card = devm_kzalloc(&func->dev, sizeof(*card), GFP_KERNEL);
  1252. if (!card)
  1253. return -ENOMEM;
  1254. card->func = func;
  1255. if (id->driver_data) {
  1256. struct btmrvl_sdio_device *data = (void *) id->driver_data;
  1257. card->helper = data->helper;
  1258. card->firmware = data->firmware;
  1259. card->reg = data->reg;
  1260. card->sd_blksz_fw_dl = data->sd_blksz_fw_dl;
  1261. card->support_pscan_win_report = data->support_pscan_win_report;
  1262. card->supports_fw_dump = data->supports_fw_dump;
  1263. }
  1264. if (btmrvl_sdio_register_dev(card) < 0) {
  1265. BT_ERR("Failed to register BT device!");
  1266. return -ENODEV;
  1267. }
  1268. /* Disable the interrupts on the card */
  1269. btmrvl_sdio_disable_host_int(card);
  1270. if (btmrvl_sdio_download_fw(card)) {
  1271. BT_ERR("Downloading firmware failed!");
  1272. ret = -ENODEV;
  1273. goto unreg_dev;
  1274. }
  1275. btmrvl_sdio_enable_host_int(card);
  1276. /* Device tree node parsing and platform specific configuration*/
  1277. btmrvl_sdio_probe_of(&func->dev, card);
  1278. priv = btmrvl_add_card(card);
  1279. if (!priv) {
  1280. BT_ERR("Initializing card failed!");
  1281. ret = -ENODEV;
  1282. goto disable_host_int;
  1283. }
  1284. card->priv = priv;
  1285. /* Initialize the interface specific function pointers */
  1286. priv->hw_host_to_card = btmrvl_sdio_host_to_card;
  1287. priv->hw_wakeup_firmware = btmrvl_sdio_wakeup_fw;
  1288. priv->hw_process_int_status = btmrvl_sdio_process_int_status;
  1289. if (btmrvl_register_hdev(priv)) {
  1290. BT_ERR("Register hdev failed!");
  1291. ret = -ENODEV;
  1292. goto disable_host_int;
  1293. }
  1294. return 0;
  1295. disable_host_int:
  1296. btmrvl_sdio_disable_host_int(card);
  1297. unreg_dev:
  1298. btmrvl_sdio_unregister_dev(card);
  1299. return ret;
  1300. }
  1301. static void btmrvl_sdio_remove(struct sdio_func *func)
  1302. {
  1303. struct btmrvl_sdio_card *card;
  1304. if (func) {
  1305. card = sdio_get_drvdata(func);
  1306. if (card) {
  1307. /* Send SHUTDOWN command & disable interrupt
  1308. * if user removes the module.
  1309. */
  1310. if (user_rmmod) {
  1311. btmrvl_send_module_cfg_cmd(card->priv,
  1312. MODULE_SHUTDOWN_REQ);
  1313. btmrvl_sdio_disable_host_int(card);
  1314. }
  1315. BT_DBG("unregister dev");
  1316. card->priv->surprise_removed = true;
  1317. btmrvl_sdio_unregister_dev(card);
  1318. btmrvl_remove_card(card->priv);
  1319. }
  1320. }
  1321. }
  1322. static int btmrvl_sdio_suspend(struct device *dev)
  1323. {
  1324. struct sdio_func *func = dev_to_sdio_func(dev);
  1325. struct btmrvl_sdio_card *card;
  1326. struct btmrvl_private *priv;
  1327. mmc_pm_flag_t pm_flags;
  1328. struct hci_dev *hcidev;
  1329. if (func) {
  1330. pm_flags = sdio_get_host_pm_caps(func);
  1331. BT_DBG("%s: suspend: PM flags = 0x%x", sdio_func_id(func),
  1332. pm_flags);
  1333. if (!(pm_flags & MMC_PM_KEEP_POWER)) {
  1334. BT_ERR("%s: cannot remain alive while suspended",
  1335. sdio_func_id(func));
  1336. return -ENOSYS;
  1337. }
  1338. card = sdio_get_drvdata(func);
  1339. if (!card || !card->priv) {
  1340. BT_ERR("card or priv structure is not valid");
  1341. return 0;
  1342. }
  1343. } else {
  1344. BT_ERR("sdio_func is not specified");
  1345. return 0;
  1346. }
  1347. /* Enable platform specific wakeup interrupt */
  1348. if (card->plt_wake_cfg && card->plt_wake_cfg->irq_bt >= 0 &&
  1349. device_may_wakeup(dev)) {
  1350. card->plt_wake_cfg->wake_by_bt = false;
  1351. enable_irq(card->plt_wake_cfg->irq_bt);
  1352. enable_irq_wake(card->plt_wake_cfg->irq_bt);
  1353. }
  1354. priv = card->priv;
  1355. priv->adapter->is_suspending = true;
  1356. hcidev = priv->btmrvl_dev.hcidev;
  1357. BT_DBG("%s: SDIO suspend", hcidev->name);
  1358. hci_suspend_dev(hcidev);
  1359. if (priv->adapter->hs_state != HS_ACTIVATED) {
  1360. if (btmrvl_enable_hs(priv)) {
  1361. BT_ERR("HS not activated, suspend failed!");
  1362. /* Disable platform specific wakeup interrupt */
  1363. if (card->plt_wake_cfg &&
  1364. card->plt_wake_cfg->irq_bt >= 0 &&
  1365. device_may_wakeup(dev)) {
  1366. disable_irq_wake(card->plt_wake_cfg->irq_bt);
  1367. disable_irq(card->plt_wake_cfg->irq_bt);
  1368. }
  1369. priv->adapter->is_suspending = false;
  1370. return -EBUSY;
  1371. }
  1372. }
  1373. priv->adapter->is_suspending = false;
  1374. priv->adapter->is_suspended = true;
  1375. /* We will keep the power when hs enabled successfully */
  1376. if (priv->adapter->hs_state == HS_ACTIVATED) {
  1377. BT_DBG("suspend with MMC_PM_KEEP_POWER");
  1378. return sdio_set_host_pm_flags(func, MMC_PM_KEEP_POWER);
  1379. }
  1380. BT_DBG("suspend without MMC_PM_KEEP_POWER");
  1381. return 0;
  1382. }
  1383. static int btmrvl_sdio_resume(struct device *dev)
  1384. {
  1385. struct sdio_func *func = dev_to_sdio_func(dev);
  1386. struct btmrvl_sdio_card *card;
  1387. struct btmrvl_private *priv;
  1388. mmc_pm_flag_t pm_flags;
  1389. struct hci_dev *hcidev;
  1390. if (func) {
  1391. pm_flags = sdio_get_host_pm_caps(func);
  1392. BT_DBG("%s: resume: PM flags = 0x%x", sdio_func_id(func),
  1393. pm_flags);
  1394. card = sdio_get_drvdata(func);
  1395. if (!card || !card->priv) {
  1396. BT_ERR("card or priv structure is not valid");
  1397. return 0;
  1398. }
  1399. } else {
  1400. BT_ERR("sdio_func is not specified");
  1401. return 0;
  1402. }
  1403. priv = card->priv;
  1404. if (!priv->adapter->is_suspended) {
  1405. BT_DBG("device already resumed");
  1406. return 0;
  1407. }
  1408. priv->hw_wakeup_firmware(priv);
  1409. priv->adapter->hs_state = HS_DEACTIVATED;
  1410. hcidev = priv->btmrvl_dev.hcidev;
  1411. BT_DBG("%s: HS DEACTIVATED in resume!", hcidev->name);
  1412. priv->adapter->is_suspended = false;
  1413. BT_DBG("%s: SDIO resume", hcidev->name);
  1414. hci_resume_dev(hcidev);
  1415. /* Disable platform specific wakeup interrupt */
  1416. if (card->plt_wake_cfg && card->plt_wake_cfg->irq_bt >= 0 &&
  1417. device_may_wakeup(dev)) {
  1418. disable_irq_wake(card->plt_wake_cfg->irq_bt);
  1419. disable_irq(card->plt_wake_cfg->irq_bt);
  1420. if (card->plt_wake_cfg->wake_by_bt)
  1421. /* Undo our disable, since interrupt handler already
  1422. * did this.
  1423. */
  1424. enable_irq(card->plt_wake_cfg->irq_bt);
  1425. }
  1426. return 0;
  1427. }
  1428. static const struct dev_pm_ops btmrvl_sdio_pm_ops = {
  1429. .suspend = btmrvl_sdio_suspend,
  1430. .resume = btmrvl_sdio_resume,
  1431. };
  1432. static struct sdio_driver bt_mrvl_sdio = {
  1433. .name = "btmrvl_sdio",
  1434. .id_table = btmrvl_sdio_ids,
  1435. .probe = btmrvl_sdio_probe,
  1436. .remove = btmrvl_sdio_remove,
  1437. .drv = {
  1438. .coredump = btmrvl_sdio_coredump,
  1439. .pm = &btmrvl_sdio_pm_ops,
  1440. }
  1441. };
  1442. static int __init btmrvl_sdio_init_module(void)
  1443. {
  1444. if (sdio_register_driver(&bt_mrvl_sdio) != 0) {
  1445. BT_ERR("SDIO Driver Registration Failed");
  1446. return -ENODEV;
  1447. }
  1448. /* Clear the flag in case user removes the card. */
  1449. user_rmmod = 0;
  1450. return 0;
  1451. }
  1452. static void __exit btmrvl_sdio_exit_module(void)
  1453. {
  1454. /* Set the flag as user is removing this module. */
  1455. user_rmmod = 1;
  1456. sdio_unregister_driver(&bt_mrvl_sdio);
  1457. }
  1458. module_init(btmrvl_sdio_init_module);
  1459. module_exit(btmrvl_sdio_exit_module);
  1460. MODULE_AUTHOR("Marvell International Ltd.");
  1461. MODULE_DESCRIPTION("Marvell BT-over-SDIO driver ver " VERSION);
  1462. MODULE_VERSION(VERSION);
  1463. MODULE_LICENSE("GPL v2");
  1464. MODULE_FIRMWARE("mrvl/sd8688_helper.bin");
  1465. MODULE_FIRMWARE("mrvl/sd8688.bin");
  1466. MODULE_FIRMWARE("mrvl/sd8787_uapsta.bin");
  1467. MODULE_FIRMWARE("mrvl/sd8797_uapsta.bin");
  1468. MODULE_FIRMWARE("mrvl/sd8887_uapsta.bin");
  1469. MODULE_FIRMWARE("mrvl/sd8897_uapsta.bin");
  1470. MODULE_FIRMWARE("mrvl/sdsd8977_combo_v2.bin");
  1471. MODULE_FIRMWARE("mrvl/sd8987_uapsta.bin");
  1472. MODULE_FIRMWARE("mrvl/sdsd8997_combo_v4.bin");