ahb.c 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896
  1. /*
  2. * Copyright (c) 2016-2017 Qualcomm Atheros, Inc. All rights reserved.
  3. * Copyright (c) 2015 The Linux Foundation. All rights reserved.
  4. *
  5. * Permission to use, copy, modify, and/or distribute this software for any
  6. * purpose with or without fee is hereby granted, provided that the above
  7. * copyright notice and this permission notice appear in all copies.
  8. *
  9. * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
  10. * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
  11. * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
  12. * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  13. * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
  14. * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
  15. * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  16. */
  17. #include <linux/module.h>
  18. #include <linux/of.h>
  19. #include <linux/of_device.h>
  20. #include <linux/clk.h>
  21. #include <linux/reset.h>
  22. #include "core.h"
  23. #include "debug.h"
  24. #include "pci.h"
  25. #include "ahb.h"
  26. static const struct of_device_id ath10k_ahb_of_match[] = {
  27. { .compatible = "qcom,ipq4019-wifi",
  28. .data = (void *)ATH10K_HW_QCA4019
  29. },
  30. { }
  31. };
  32. MODULE_DEVICE_TABLE(of, ath10k_ahb_of_match);
  33. #define QCA4019_SRAM_ADDR 0x000C0000
  34. #define QCA4019_SRAM_LEN 0x00040000 /* 256 kb */
  35. static inline struct ath10k_ahb *ath10k_ahb_priv(struct ath10k *ar)
  36. {
  37. return &((struct ath10k_pci *)ar->drv_priv)->ahb[0];
  38. }
  39. static void ath10k_ahb_write32(struct ath10k *ar, u32 offset, u32 value)
  40. {
  41. struct ath10k_ahb *ar_ahb = ath10k_ahb_priv(ar);
  42. iowrite32(value, ar_ahb->mem + offset);
  43. }
  44. static u32 ath10k_ahb_read32(struct ath10k *ar, u32 offset)
  45. {
  46. struct ath10k_ahb *ar_ahb = ath10k_ahb_priv(ar);
  47. return ioread32(ar_ahb->mem + offset);
  48. }
  49. static u32 ath10k_ahb_gcc_read32(struct ath10k *ar, u32 offset)
  50. {
  51. struct ath10k_ahb *ar_ahb = ath10k_ahb_priv(ar);
  52. return ioread32(ar_ahb->gcc_mem + offset);
  53. }
  54. static void ath10k_ahb_tcsr_write32(struct ath10k *ar, u32 offset, u32 value)
  55. {
  56. struct ath10k_ahb *ar_ahb = ath10k_ahb_priv(ar);
  57. iowrite32(value, ar_ahb->tcsr_mem + offset);
  58. }
  59. static u32 ath10k_ahb_tcsr_read32(struct ath10k *ar, u32 offset)
  60. {
  61. struct ath10k_ahb *ar_ahb = ath10k_ahb_priv(ar);
  62. return ioread32(ar_ahb->tcsr_mem + offset);
  63. }
  64. static u32 ath10k_ahb_soc_read32(struct ath10k *ar, u32 addr)
  65. {
  66. return ath10k_ahb_read32(ar, RTC_SOC_BASE_ADDRESS + addr);
  67. }
  68. static int ath10k_ahb_get_num_banks(struct ath10k *ar)
  69. {
  70. if (ar->hw_rev == ATH10K_HW_QCA4019)
  71. return 1;
  72. ath10k_warn(ar, "unknown number of banks, assuming 1\n");
  73. return 1;
  74. }
  75. static int ath10k_ahb_clock_init(struct ath10k *ar)
  76. {
  77. struct ath10k_ahb *ar_ahb = ath10k_ahb_priv(ar);
  78. struct device *dev;
  79. dev = &ar_ahb->pdev->dev;
  80. ar_ahb->cmd_clk = devm_clk_get(dev, "wifi_wcss_cmd");
  81. if (IS_ERR_OR_NULL(ar_ahb->cmd_clk)) {
  82. ath10k_err(ar, "failed to get cmd clk: %ld\n",
  83. PTR_ERR(ar_ahb->cmd_clk));
  84. return ar_ahb->cmd_clk ? PTR_ERR(ar_ahb->cmd_clk) : -ENODEV;
  85. }
  86. ar_ahb->ref_clk = devm_clk_get(dev, "wifi_wcss_ref");
  87. if (IS_ERR_OR_NULL(ar_ahb->ref_clk)) {
  88. ath10k_err(ar, "failed to get ref clk: %ld\n",
  89. PTR_ERR(ar_ahb->ref_clk));
  90. return ar_ahb->ref_clk ? PTR_ERR(ar_ahb->ref_clk) : -ENODEV;
  91. }
  92. ar_ahb->rtc_clk = devm_clk_get(dev, "wifi_wcss_rtc");
  93. if (IS_ERR_OR_NULL(ar_ahb->rtc_clk)) {
  94. ath10k_err(ar, "failed to get rtc clk: %ld\n",
  95. PTR_ERR(ar_ahb->rtc_clk));
  96. return ar_ahb->rtc_clk ? PTR_ERR(ar_ahb->rtc_clk) : -ENODEV;
  97. }
  98. return 0;
  99. }
  100. static void ath10k_ahb_clock_deinit(struct ath10k *ar)
  101. {
  102. struct ath10k_ahb *ar_ahb = ath10k_ahb_priv(ar);
  103. ar_ahb->cmd_clk = NULL;
  104. ar_ahb->ref_clk = NULL;
  105. ar_ahb->rtc_clk = NULL;
  106. }
  107. static int ath10k_ahb_clock_enable(struct ath10k *ar)
  108. {
  109. struct ath10k_ahb *ar_ahb = ath10k_ahb_priv(ar);
  110. int ret;
  111. if (IS_ERR_OR_NULL(ar_ahb->cmd_clk) ||
  112. IS_ERR_OR_NULL(ar_ahb->ref_clk) ||
  113. IS_ERR_OR_NULL(ar_ahb->rtc_clk)) {
  114. ath10k_err(ar, "clock(s) is/are not initialized\n");
  115. ret = -EIO;
  116. goto out;
  117. }
  118. ret = clk_prepare_enable(ar_ahb->cmd_clk);
  119. if (ret) {
  120. ath10k_err(ar, "failed to enable cmd clk: %d\n", ret);
  121. goto out;
  122. }
  123. ret = clk_prepare_enable(ar_ahb->ref_clk);
  124. if (ret) {
  125. ath10k_err(ar, "failed to enable ref clk: %d\n", ret);
  126. goto err_cmd_clk_disable;
  127. }
  128. ret = clk_prepare_enable(ar_ahb->rtc_clk);
  129. if (ret) {
  130. ath10k_err(ar, "failed to enable rtc clk: %d\n", ret);
  131. goto err_ref_clk_disable;
  132. }
  133. return 0;
  134. err_ref_clk_disable:
  135. clk_disable_unprepare(ar_ahb->ref_clk);
  136. err_cmd_clk_disable:
  137. clk_disable_unprepare(ar_ahb->cmd_clk);
  138. out:
  139. return ret;
  140. }
  141. static void ath10k_ahb_clock_disable(struct ath10k *ar)
  142. {
  143. struct ath10k_ahb *ar_ahb = ath10k_ahb_priv(ar);
  144. clk_disable_unprepare(ar_ahb->cmd_clk);
  145. clk_disable_unprepare(ar_ahb->ref_clk);
  146. clk_disable_unprepare(ar_ahb->rtc_clk);
  147. }
  148. static int ath10k_ahb_rst_ctrl_init(struct ath10k *ar)
  149. {
  150. struct ath10k_ahb *ar_ahb = ath10k_ahb_priv(ar);
  151. struct device *dev;
  152. dev = &ar_ahb->pdev->dev;
  153. ar_ahb->core_cold_rst = devm_reset_control_get_exclusive(dev,
  154. "wifi_core_cold");
  155. if (IS_ERR(ar_ahb->core_cold_rst)) {
  156. ath10k_err(ar, "failed to get core cold rst ctrl: %ld\n",
  157. PTR_ERR(ar_ahb->core_cold_rst));
  158. return PTR_ERR(ar_ahb->core_cold_rst);
  159. }
  160. ar_ahb->radio_cold_rst = devm_reset_control_get_exclusive(dev,
  161. "wifi_radio_cold");
  162. if (IS_ERR(ar_ahb->radio_cold_rst)) {
  163. ath10k_err(ar, "failed to get radio cold rst ctrl: %ld\n",
  164. PTR_ERR(ar_ahb->radio_cold_rst));
  165. return PTR_ERR(ar_ahb->radio_cold_rst);
  166. }
  167. ar_ahb->radio_warm_rst = devm_reset_control_get_exclusive(dev,
  168. "wifi_radio_warm");
  169. if (IS_ERR(ar_ahb->radio_warm_rst)) {
  170. ath10k_err(ar, "failed to get radio warm rst ctrl: %ld\n",
  171. PTR_ERR(ar_ahb->radio_warm_rst));
  172. return PTR_ERR(ar_ahb->radio_warm_rst);
  173. }
  174. ar_ahb->radio_srif_rst = devm_reset_control_get_exclusive(dev,
  175. "wifi_radio_srif");
  176. if (IS_ERR(ar_ahb->radio_srif_rst)) {
  177. ath10k_err(ar, "failed to get radio srif rst ctrl: %ld\n",
  178. PTR_ERR(ar_ahb->radio_srif_rst));
  179. return PTR_ERR(ar_ahb->radio_srif_rst);
  180. }
  181. ar_ahb->cpu_init_rst = devm_reset_control_get_exclusive(dev,
  182. "wifi_cpu_init");
  183. if (IS_ERR(ar_ahb->cpu_init_rst)) {
  184. ath10k_err(ar, "failed to get cpu init rst ctrl: %ld\n",
  185. PTR_ERR(ar_ahb->cpu_init_rst));
  186. return PTR_ERR(ar_ahb->cpu_init_rst);
  187. }
  188. return 0;
  189. }
  190. static void ath10k_ahb_rst_ctrl_deinit(struct ath10k *ar)
  191. {
  192. struct ath10k_ahb *ar_ahb = ath10k_ahb_priv(ar);
  193. ar_ahb->core_cold_rst = NULL;
  194. ar_ahb->radio_cold_rst = NULL;
  195. ar_ahb->radio_warm_rst = NULL;
  196. ar_ahb->radio_srif_rst = NULL;
  197. ar_ahb->cpu_init_rst = NULL;
  198. }
  199. static int ath10k_ahb_release_reset(struct ath10k *ar)
  200. {
  201. struct ath10k_ahb *ar_ahb = ath10k_ahb_priv(ar);
  202. int ret;
  203. if (IS_ERR_OR_NULL(ar_ahb->radio_cold_rst) ||
  204. IS_ERR_OR_NULL(ar_ahb->radio_warm_rst) ||
  205. IS_ERR_OR_NULL(ar_ahb->radio_srif_rst) ||
  206. IS_ERR_OR_NULL(ar_ahb->cpu_init_rst)) {
  207. ath10k_err(ar, "rst ctrl(s) is/are not initialized\n");
  208. return -EINVAL;
  209. }
  210. ret = reset_control_deassert(ar_ahb->radio_cold_rst);
  211. if (ret) {
  212. ath10k_err(ar, "failed to deassert radio cold rst: %d\n", ret);
  213. return ret;
  214. }
  215. ret = reset_control_deassert(ar_ahb->radio_warm_rst);
  216. if (ret) {
  217. ath10k_err(ar, "failed to deassert radio warm rst: %d\n", ret);
  218. return ret;
  219. }
  220. ret = reset_control_deassert(ar_ahb->radio_srif_rst);
  221. if (ret) {
  222. ath10k_err(ar, "failed to deassert radio srif rst: %d\n", ret);
  223. return ret;
  224. }
  225. ret = reset_control_deassert(ar_ahb->cpu_init_rst);
  226. if (ret) {
  227. ath10k_err(ar, "failed to deassert cpu init rst: %d\n", ret);
  228. return ret;
  229. }
  230. return 0;
  231. }
  232. static void ath10k_ahb_halt_axi_bus(struct ath10k *ar, u32 haltreq_reg,
  233. u32 haltack_reg)
  234. {
  235. unsigned long timeout;
  236. u32 val;
  237. /* Issue halt axi bus request */
  238. val = ath10k_ahb_tcsr_read32(ar, haltreq_reg);
  239. val |= AHB_AXI_BUS_HALT_REQ;
  240. ath10k_ahb_tcsr_write32(ar, haltreq_reg, val);
  241. /* Wait for axi bus halted ack */
  242. timeout = jiffies + msecs_to_jiffies(ATH10K_AHB_AXI_BUS_HALT_TIMEOUT);
  243. do {
  244. val = ath10k_ahb_tcsr_read32(ar, haltack_reg);
  245. if (val & AHB_AXI_BUS_HALT_ACK)
  246. break;
  247. mdelay(1);
  248. } while (time_before(jiffies, timeout));
  249. if (!(val & AHB_AXI_BUS_HALT_ACK)) {
  250. ath10k_err(ar, "failed to halt axi bus: %d\n", val);
  251. return;
  252. }
  253. ath10k_dbg(ar, ATH10K_DBG_AHB, "axi bus halted\n");
  254. }
  255. static void ath10k_ahb_halt_chip(struct ath10k *ar)
  256. {
  257. struct ath10k_ahb *ar_ahb = ath10k_ahb_priv(ar);
  258. u32 core_id, glb_cfg_reg, haltreq_reg, haltack_reg;
  259. u32 val;
  260. int ret;
  261. if (IS_ERR_OR_NULL(ar_ahb->core_cold_rst) ||
  262. IS_ERR_OR_NULL(ar_ahb->radio_cold_rst) ||
  263. IS_ERR_OR_NULL(ar_ahb->radio_warm_rst) ||
  264. IS_ERR_OR_NULL(ar_ahb->radio_srif_rst) ||
  265. IS_ERR_OR_NULL(ar_ahb->cpu_init_rst)) {
  266. ath10k_err(ar, "rst ctrl(s) is/are not initialized\n");
  267. return;
  268. }
  269. core_id = ath10k_ahb_read32(ar, ATH10K_AHB_WLAN_CORE_ID_REG);
  270. switch (core_id) {
  271. case 0:
  272. glb_cfg_reg = ATH10K_AHB_TCSR_WIFI0_GLB_CFG;
  273. haltreq_reg = ATH10K_AHB_TCSR_WCSS0_HALTREQ;
  274. haltack_reg = ATH10K_AHB_TCSR_WCSS0_HALTACK;
  275. break;
  276. case 1:
  277. glb_cfg_reg = ATH10K_AHB_TCSR_WIFI1_GLB_CFG;
  278. haltreq_reg = ATH10K_AHB_TCSR_WCSS1_HALTREQ;
  279. haltack_reg = ATH10K_AHB_TCSR_WCSS1_HALTACK;
  280. break;
  281. default:
  282. ath10k_err(ar, "invalid core id %d found, skipping reset sequence\n",
  283. core_id);
  284. return;
  285. }
  286. ath10k_ahb_halt_axi_bus(ar, haltreq_reg, haltack_reg);
  287. val = ath10k_ahb_tcsr_read32(ar, glb_cfg_reg);
  288. val |= TCSR_WIFIX_GLB_CFG_DISABLE_CORE_CLK;
  289. ath10k_ahb_tcsr_write32(ar, glb_cfg_reg, val);
  290. ret = reset_control_assert(ar_ahb->core_cold_rst);
  291. if (ret)
  292. ath10k_err(ar, "failed to assert core cold rst: %d\n", ret);
  293. msleep(1);
  294. ret = reset_control_assert(ar_ahb->radio_cold_rst);
  295. if (ret)
  296. ath10k_err(ar, "failed to assert radio cold rst: %d\n", ret);
  297. msleep(1);
  298. ret = reset_control_assert(ar_ahb->radio_warm_rst);
  299. if (ret)
  300. ath10k_err(ar, "failed to assert radio warm rst: %d\n", ret);
  301. msleep(1);
  302. ret = reset_control_assert(ar_ahb->radio_srif_rst);
  303. if (ret)
  304. ath10k_err(ar, "failed to assert radio srif rst: %d\n", ret);
  305. msleep(1);
  306. ret = reset_control_assert(ar_ahb->cpu_init_rst);
  307. if (ret)
  308. ath10k_err(ar, "failed to assert cpu init rst: %d\n", ret);
  309. msleep(10);
  310. /* Clear halt req and core clock disable req before
  311. * deasserting wifi core reset.
  312. */
  313. val = ath10k_ahb_tcsr_read32(ar, haltreq_reg);
  314. val &= ~AHB_AXI_BUS_HALT_REQ;
  315. ath10k_ahb_tcsr_write32(ar, haltreq_reg, val);
  316. val = ath10k_ahb_tcsr_read32(ar, glb_cfg_reg);
  317. val &= ~TCSR_WIFIX_GLB_CFG_DISABLE_CORE_CLK;
  318. ath10k_ahb_tcsr_write32(ar, glb_cfg_reg, val);
  319. ret = reset_control_deassert(ar_ahb->core_cold_rst);
  320. if (ret)
  321. ath10k_err(ar, "failed to deassert core cold rst: %d\n", ret);
  322. ath10k_dbg(ar, ATH10K_DBG_AHB, "core %d reset done\n", core_id);
  323. }
  324. static irqreturn_t ath10k_ahb_interrupt_handler(int irq, void *arg)
  325. {
  326. struct ath10k *ar = arg;
  327. if (!ath10k_pci_irq_pending(ar))
  328. return IRQ_NONE;
  329. ath10k_pci_disable_and_clear_legacy_irq(ar);
  330. ath10k_pci_irq_msi_fw_mask(ar);
  331. napi_schedule(&ar->napi);
  332. return IRQ_HANDLED;
  333. }
  334. static int ath10k_ahb_request_irq_legacy(struct ath10k *ar)
  335. {
  336. struct ath10k_pci *ar_pci = ath10k_pci_priv(ar);
  337. struct ath10k_ahb *ar_ahb = ath10k_ahb_priv(ar);
  338. int ret;
  339. ret = request_irq(ar_ahb->irq,
  340. ath10k_ahb_interrupt_handler,
  341. IRQF_SHARED, "ath10k_ahb", ar);
  342. if (ret) {
  343. ath10k_warn(ar, "failed to request legacy irq %d: %d\n",
  344. ar_ahb->irq, ret);
  345. return ret;
  346. }
  347. ar_pci->oper_irq_mode = ATH10K_PCI_IRQ_LEGACY;
  348. return 0;
  349. }
  350. static void ath10k_ahb_release_irq_legacy(struct ath10k *ar)
  351. {
  352. struct ath10k_ahb *ar_ahb = ath10k_ahb_priv(ar);
  353. free_irq(ar_ahb->irq, ar);
  354. }
  355. static void ath10k_ahb_irq_disable(struct ath10k *ar)
  356. {
  357. ath10k_ce_disable_interrupts(ar);
  358. ath10k_pci_disable_and_clear_legacy_irq(ar);
  359. }
  360. static int ath10k_ahb_resource_init(struct ath10k *ar)
  361. {
  362. struct ath10k_ahb *ar_ahb = ath10k_ahb_priv(ar);
  363. struct platform_device *pdev;
  364. struct resource *res;
  365. int ret;
  366. pdev = ar_ahb->pdev;
  367. res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  368. if (!res) {
  369. ath10k_err(ar, "failed to get memory resource\n");
  370. ret = -ENXIO;
  371. goto out;
  372. }
  373. ar_ahb->mem = devm_ioremap_resource(&pdev->dev, res);
  374. if (IS_ERR(ar_ahb->mem)) {
  375. ath10k_err(ar, "mem ioremap error\n");
  376. ret = PTR_ERR(ar_ahb->mem);
  377. goto out;
  378. }
  379. ar_ahb->mem_len = resource_size(res);
  380. ar_ahb->gcc_mem = ioremap_nocache(ATH10K_GCC_REG_BASE,
  381. ATH10K_GCC_REG_SIZE);
  382. if (!ar_ahb->gcc_mem) {
  383. ath10k_err(ar, "gcc mem ioremap error\n");
  384. ret = -ENOMEM;
  385. goto err_mem_unmap;
  386. }
  387. ar_ahb->tcsr_mem = ioremap_nocache(ATH10K_TCSR_REG_BASE,
  388. ATH10K_TCSR_REG_SIZE);
  389. if (!ar_ahb->tcsr_mem) {
  390. ath10k_err(ar, "tcsr mem ioremap error\n");
  391. ret = -ENOMEM;
  392. goto err_gcc_mem_unmap;
  393. }
  394. ret = dma_set_mask(&pdev->dev, DMA_BIT_MASK(32));
  395. if (ret) {
  396. ath10k_err(ar, "failed to set 32-bit dma mask: %d\n", ret);
  397. goto err_tcsr_mem_unmap;
  398. }
  399. ret = dma_set_coherent_mask(&pdev->dev, DMA_BIT_MASK(32));
  400. if (ret) {
  401. ath10k_err(ar, "failed to set 32-bit consistent dma: %d\n",
  402. ret);
  403. goto err_tcsr_mem_unmap;
  404. }
  405. ret = ath10k_ahb_clock_init(ar);
  406. if (ret)
  407. goto err_tcsr_mem_unmap;
  408. ret = ath10k_ahb_rst_ctrl_init(ar);
  409. if (ret)
  410. goto err_clock_deinit;
  411. ar_ahb->irq = platform_get_irq_byname(pdev, "legacy");
  412. if (ar_ahb->irq < 0) {
  413. ath10k_err(ar, "failed to get irq number: %d\n", ar_ahb->irq);
  414. ret = ar_ahb->irq;
  415. goto err_clock_deinit;
  416. }
  417. ath10k_dbg(ar, ATH10K_DBG_BOOT, "irq: %d\n", ar_ahb->irq);
  418. ath10k_dbg(ar, ATH10K_DBG_BOOT, "mem: 0x%pK mem_len: %lu gcc mem: 0x%pK tcsr_mem: 0x%pK\n",
  419. ar_ahb->mem, ar_ahb->mem_len,
  420. ar_ahb->gcc_mem, ar_ahb->tcsr_mem);
  421. return 0;
  422. err_clock_deinit:
  423. ath10k_ahb_clock_deinit(ar);
  424. err_tcsr_mem_unmap:
  425. iounmap(ar_ahb->tcsr_mem);
  426. err_gcc_mem_unmap:
  427. ar_ahb->tcsr_mem = NULL;
  428. iounmap(ar_ahb->gcc_mem);
  429. err_mem_unmap:
  430. ar_ahb->gcc_mem = NULL;
  431. devm_iounmap(&pdev->dev, ar_ahb->mem);
  432. out:
  433. ar_ahb->mem = NULL;
  434. return ret;
  435. }
  436. static void ath10k_ahb_resource_deinit(struct ath10k *ar)
  437. {
  438. struct ath10k_ahb *ar_ahb = ath10k_ahb_priv(ar);
  439. struct device *dev;
  440. dev = &ar_ahb->pdev->dev;
  441. if (ar_ahb->mem)
  442. devm_iounmap(dev, ar_ahb->mem);
  443. if (ar_ahb->gcc_mem)
  444. iounmap(ar_ahb->gcc_mem);
  445. if (ar_ahb->tcsr_mem)
  446. iounmap(ar_ahb->tcsr_mem);
  447. ar_ahb->mem = NULL;
  448. ar_ahb->gcc_mem = NULL;
  449. ar_ahb->tcsr_mem = NULL;
  450. ath10k_ahb_clock_deinit(ar);
  451. ath10k_ahb_rst_ctrl_deinit(ar);
  452. }
  453. static int ath10k_ahb_prepare_device(struct ath10k *ar)
  454. {
  455. u32 val;
  456. int ret;
  457. ret = ath10k_ahb_clock_enable(ar);
  458. if (ret) {
  459. ath10k_err(ar, "failed to enable clocks\n");
  460. return ret;
  461. }
  462. /* Clock for the target is supplied from outside of target (ie,
  463. * external clock module controlled by the host). Target needs
  464. * to know what frequency target cpu is configured which is needed
  465. * for target internal use. Read target cpu frequency info from
  466. * gcc register and write into target's scratch register where
  467. * target expects this information.
  468. */
  469. val = ath10k_ahb_gcc_read32(ar, ATH10K_AHB_GCC_FEPLL_PLL_DIV);
  470. ath10k_ahb_write32(ar, ATH10K_AHB_WIFI_SCRATCH_5_REG, val);
  471. ret = ath10k_ahb_release_reset(ar);
  472. if (ret)
  473. goto err_clk_disable;
  474. ath10k_ahb_irq_disable(ar);
  475. ath10k_ahb_write32(ar, FW_INDICATOR_ADDRESS, FW_IND_HOST_READY);
  476. ret = ath10k_pci_wait_for_target_init(ar);
  477. if (ret)
  478. goto err_halt_chip;
  479. return 0;
  480. err_halt_chip:
  481. ath10k_ahb_halt_chip(ar);
  482. err_clk_disable:
  483. ath10k_ahb_clock_disable(ar);
  484. return ret;
  485. }
  486. static int ath10k_ahb_chip_reset(struct ath10k *ar)
  487. {
  488. int ret;
  489. ath10k_ahb_halt_chip(ar);
  490. ath10k_ahb_clock_disable(ar);
  491. ret = ath10k_ahb_prepare_device(ar);
  492. if (ret)
  493. return ret;
  494. return 0;
  495. }
  496. static int ath10k_ahb_wake_target_cpu(struct ath10k *ar)
  497. {
  498. u32 addr, val;
  499. addr = SOC_CORE_BASE_ADDRESS | CORE_CTRL_ADDRESS;
  500. val = ath10k_ahb_read32(ar, addr);
  501. val |= ATH10K_AHB_CORE_CTRL_CPU_INTR_MASK;
  502. ath10k_ahb_write32(ar, addr, val);
  503. return 0;
  504. }
  505. static int ath10k_ahb_hif_start(struct ath10k *ar)
  506. {
  507. ath10k_dbg(ar, ATH10K_DBG_BOOT, "boot ahb hif start\n");
  508. napi_enable(&ar->napi);
  509. ath10k_ce_enable_interrupts(ar);
  510. ath10k_pci_enable_legacy_irq(ar);
  511. ath10k_pci_rx_post(ar);
  512. return 0;
  513. }
  514. static void ath10k_ahb_hif_stop(struct ath10k *ar)
  515. {
  516. struct ath10k_ahb *ar_ahb = ath10k_ahb_priv(ar);
  517. ath10k_dbg(ar, ATH10K_DBG_BOOT, "boot ahb hif stop\n");
  518. ath10k_ahb_irq_disable(ar);
  519. synchronize_irq(ar_ahb->irq);
  520. napi_synchronize(&ar->napi);
  521. napi_disable(&ar->napi);
  522. ath10k_pci_flush(ar);
  523. }
  524. static int ath10k_ahb_hif_power_up(struct ath10k *ar)
  525. {
  526. int ret;
  527. ath10k_dbg(ar, ATH10K_DBG_BOOT, "boot ahb hif power up\n");
  528. ret = ath10k_ahb_chip_reset(ar);
  529. if (ret) {
  530. ath10k_err(ar, "failed to reset chip: %d\n", ret);
  531. goto out;
  532. }
  533. ret = ath10k_pci_init_pipes(ar);
  534. if (ret) {
  535. ath10k_err(ar, "failed to initialize CE: %d\n", ret);
  536. goto out;
  537. }
  538. ret = ath10k_pci_init_config(ar);
  539. if (ret) {
  540. ath10k_err(ar, "failed to setup init config: %d\n", ret);
  541. goto err_ce_deinit;
  542. }
  543. ret = ath10k_ahb_wake_target_cpu(ar);
  544. if (ret) {
  545. ath10k_err(ar, "could not wake up target CPU: %d\n", ret);
  546. goto err_ce_deinit;
  547. }
  548. return 0;
  549. err_ce_deinit:
  550. ath10k_pci_ce_deinit(ar);
  551. out:
  552. return ret;
  553. }
  554. static u32 ath10k_ahb_qca4019_targ_cpu_to_ce_addr(struct ath10k *ar, u32 addr)
  555. {
  556. u32 val = 0, region = addr & 0xfffff;
  557. val = ath10k_pci_read32(ar, PCIE_BAR_REG_ADDRESS);
  558. if (region >= QCA4019_SRAM_ADDR && region <=
  559. (QCA4019_SRAM_ADDR + QCA4019_SRAM_LEN)) {
  560. /* SRAM contents for QCA4019 can be directly accessed and
  561. * no conversions are required
  562. */
  563. val |= region;
  564. } else {
  565. val |= 0x100000 | region;
  566. }
  567. return val;
  568. }
  569. static const struct ath10k_hif_ops ath10k_ahb_hif_ops = {
  570. .tx_sg = ath10k_pci_hif_tx_sg,
  571. .diag_read = ath10k_pci_hif_diag_read,
  572. .diag_write = ath10k_pci_diag_write_mem,
  573. .exchange_bmi_msg = ath10k_pci_hif_exchange_bmi_msg,
  574. .start = ath10k_ahb_hif_start,
  575. .stop = ath10k_ahb_hif_stop,
  576. .map_service_to_pipe = ath10k_pci_hif_map_service_to_pipe,
  577. .get_default_pipe = ath10k_pci_hif_get_default_pipe,
  578. .send_complete_check = ath10k_pci_hif_send_complete_check,
  579. .get_free_queue_number = ath10k_pci_hif_get_free_queue_number,
  580. .power_up = ath10k_ahb_hif_power_up,
  581. .power_down = ath10k_pci_hif_power_down,
  582. .read32 = ath10k_ahb_read32,
  583. .write32 = ath10k_ahb_write32,
  584. };
  585. static const struct ath10k_bus_ops ath10k_ahb_bus_ops = {
  586. .read32 = ath10k_ahb_read32,
  587. .write32 = ath10k_ahb_write32,
  588. .get_num_banks = ath10k_ahb_get_num_banks,
  589. };
  590. static int ath10k_ahb_probe(struct platform_device *pdev)
  591. {
  592. struct ath10k *ar;
  593. struct ath10k_ahb *ar_ahb;
  594. struct ath10k_pci *ar_pci;
  595. const struct of_device_id *of_id;
  596. enum ath10k_hw_rev hw_rev;
  597. size_t size;
  598. int ret;
  599. u32 chip_id;
  600. of_id = of_match_device(ath10k_ahb_of_match, &pdev->dev);
  601. if (!of_id) {
  602. dev_err(&pdev->dev, "failed to find matching device tree id\n");
  603. return -EINVAL;
  604. }
  605. hw_rev = (enum ath10k_hw_rev)of_id->data;
  606. size = sizeof(*ar_pci) + sizeof(*ar_ahb);
  607. ar = ath10k_core_create(size, &pdev->dev, ATH10K_BUS_AHB,
  608. hw_rev, &ath10k_ahb_hif_ops);
  609. if (!ar) {
  610. dev_err(&pdev->dev, "failed to allocate core\n");
  611. return -ENOMEM;
  612. }
  613. ath10k_dbg(ar, ATH10K_DBG_BOOT, "ahb probe\n");
  614. ar_pci = ath10k_pci_priv(ar);
  615. ar_ahb = ath10k_ahb_priv(ar);
  616. ar_ahb->pdev = pdev;
  617. platform_set_drvdata(pdev, ar);
  618. ret = ath10k_ahb_resource_init(ar);
  619. if (ret)
  620. goto err_core_destroy;
  621. ar->dev_id = 0;
  622. ar_pci->mem = ar_ahb->mem;
  623. ar_pci->mem_len = ar_ahb->mem_len;
  624. ar_pci->ar = ar;
  625. ar_pci->ce.bus_ops = &ath10k_ahb_bus_ops;
  626. ar_pci->targ_cpu_to_ce_addr = ath10k_ahb_qca4019_targ_cpu_to_ce_addr;
  627. ar->ce_priv = &ar_pci->ce;
  628. ret = ath10k_pci_setup_resource(ar);
  629. if (ret) {
  630. ath10k_err(ar, "failed to setup resource: %d\n", ret);
  631. goto err_resource_deinit;
  632. }
  633. ath10k_pci_init_napi(ar);
  634. ret = ath10k_ahb_request_irq_legacy(ar);
  635. if (ret)
  636. goto err_free_pipes;
  637. ret = ath10k_ahb_prepare_device(ar);
  638. if (ret)
  639. goto err_free_irq;
  640. ath10k_pci_ce_deinit(ar);
  641. chip_id = ath10k_ahb_soc_read32(ar, SOC_CHIP_ID_ADDRESS);
  642. if (chip_id == 0xffffffff) {
  643. ath10k_err(ar, "failed to get chip id\n");
  644. ret = -ENODEV;
  645. goto err_halt_device;
  646. }
  647. ret = ath10k_core_register(ar, chip_id);
  648. if (ret) {
  649. ath10k_err(ar, "failed to register driver core: %d\n", ret);
  650. goto err_halt_device;
  651. }
  652. return 0;
  653. err_halt_device:
  654. ath10k_ahb_halt_chip(ar);
  655. ath10k_ahb_clock_disable(ar);
  656. err_free_irq:
  657. ath10k_ahb_release_irq_legacy(ar);
  658. err_free_pipes:
  659. ath10k_pci_free_pipes(ar);
  660. err_resource_deinit:
  661. ath10k_ahb_resource_deinit(ar);
  662. err_core_destroy:
  663. ath10k_core_destroy(ar);
  664. platform_set_drvdata(pdev, NULL);
  665. return ret;
  666. }
  667. static int ath10k_ahb_remove(struct platform_device *pdev)
  668. {
  669. struct ath10k *ar = platform_get_drvdata(pdev);
  670. struct ath10k_ahb *ar_ahb;
  671. if (!ar)
  672. return -EINVAL;
  673. ar_ahb = ath10k_ahb_priv(ar);
  674. if (!ar_ahb)
  675. return -EINVAL;
  676. ath10k_dbg(ar, ATH10K_DBG_AHB, "ahb remove\n");
  677. ath10k_core_unregister(ar);
  678. ath10k_ahb_irq_disable(ar);
  679. ath10k_ahb_release_irq_legacy(ar);
  680. ath10k_pci_release_resource(ar);
  681. ath10k_ahb_halt_chip(ar);
  682. ath10k_ahb_clock_disable(ar);
  683. ath10k_ahb_resource_deinit(ar);
  684. ath10k_core_destroy(ar);
  685. platform_set_drvdata(pdev, NULL);
  686. return 0;
  687. }
  688. static struct platform_driver ath10k_ahb_driver = {
  689. .driver = {
  690. .name = "ath10k_ahb",
  691. .of_match_table = ath10k_ahb_of_match,
  692. },
  693. .probe = ath10k_ahb_probe,
  694. .remove = ath10k_ahb_remove,
  695. };
  696. int ath10k_ahb_init(void)
  697. {
  698. int ret;
  699. ret = platform_driver_register(&ath10k_ahb_driver);
  700. if (ret)
  701. printk(KERN_ERR "failed to register ath10k ahb driver: %d\n",
  702. ret);
  703. return ret;
  704. }
  705. void ath10k_ahb_exit(void)
  706. {
  707. platform_driver_unregister(&ath10k_ahb_driver);
  708. }