ahb.c 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875
  1. /*
  2. * Copyright (c) 2016 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. static inline struct ath10k_ahb *ath10k_ahb_priv(struct ath10k *ar)
  34. {
  35. return &((struct ath10k_pci *)ar->drv_priv)->ahb[0];
  36. }
  37. static void ath10k_ahb_write32(struct ath10k *ar, u32 offset, u32 value)
  38. {
  39. struct ath10k_ahb *ar_ahb = ath10k_ahb_priv(ar);
  40. iowrite32(value, ar_ahb->mem + offset);
  41. }
  42. static u32 ath10k_ahb_read32(struct ath10k *ar, u32 offset)
  43. {
  44. struct ath10k_ahb *ar_ahb = ath10k_ahb_priv(ar);
  45. return ioread32(ar_ahb->mem + offset);
  46. }
  47. static u32 ath10k_ahb_gcc_read32(struct ath10k *ar, u32 offset)
  48. {
  49. struct ath10k_ahb *ar_ahb = ath10k_ahb_priv(ar);
  50. return ioread32(ar_ahb->gcc_mem + offset);
  51. }
  52. static void ath10k_ahb_tcsr_write32(struct ath10k *ar, u32 offset, u32 value)
  53. {
  54. struct ath10k_ahb *ar_ahb = ath10k_ahb_priv(ar);
  55. iowrite32(value, ar_ahb->tcsr_mem + offset);
  56. }
  57. static u32 ath10k_ahb_tcsr_read32(struct ath10k *ar, u32 offset)
  58. {
  59. struct ath10k_ahb *ar_ahb = ath10k_ahb_priv(ar);
  60. return ioread32(ar_ahb->tcsr_mem + offset);
  61. }
  62. static u32 ath10k_ahb_soc_read32(struct ath10k *ar, u32 addr)
  63. {
  64. return ath10k_ahb_read32(ar, RTC_SOC_BASE_ADDRESS + addr);
  65. }
  66. static int ath10k_ahb_get_num_banks(struct ath10k *ar)
  67. {
  68. if (ar->hw_rev == ATH10K_HW_QCA4019)
  69. return 1;
  70. ath10k_warn(ar, "unknown number of banks, assuming 1\n");
  71. return 1;
  72. }
  73. static int ath10k_ahb_clock_init(struct ath10k *ar)
  74. {
  75. struct ath10k_ahb *ar_ahb = ath10k_ahb_priv(ar);
  76. struct device *dev;
  77. dev = &ar_ahb->pdev->dev;
  78. ar_ahb->cmd_clk = devm_clk_get(dev, "wifi_wcss_cmd");
  79. if (IS_ERR_OR_NULL(ar_ahb->cmd_clk)) {
  80. ath10k_err(ar, "failed to get cmd clk: %ld\n",
  81. PTR_ERR(ar_ahb->cmd_clk));
  82. return ar_ahb->cmd_clk ? PTR_ERR(ar_ahb->cmd_clk) : -ENODEV;
  83. }
  84. ar_ahb->ref_clk = devm_clk_get(dev, "wifi_wcss_ref");
  85. if (IS_ERR_OR_NULL(ar_ahb->ref_clk)) {
  86. ath10k_err(ar, "failed to get ref clk: %ld\n",
  87. PTR_ERR(ar_ahb->ref_clk));
  88. return ar_ahb->ref_clk ? PTR_ERR(ar_ahb->ref_clk) : -ENODEV;
  89. }
  90. ar_ahb->rtc_clk = devm_clk_get(dev, "wifi_wcss_rtc");
  91. if (IS_ERR_OR_NULL(ar_ahb->rtc_clk)) {
  92. ath10k_err(ar, "failed to get rtc clk: %ld\n",
  93. PTR_ERR(ar_ahb->rtc_clk));
  94. return ar_ahb->rtc_clk ? PTR_ERR(ar_ahb->rtc_clk) : -ENODEV;
  95. }
  96. return 0;
  97. }
  98. static void ath10k_ahb_clock_deinit(struct ath10k *ar)
  99. {
  100. struct ath10k_ahb *ar_ahb = ath10k_ahb_priv(ar);
  101. ar_ahb->cmd_clk = NULL;
  102. ar_ahb->ref_clk = NULL;
  103. ar_ahb->rtc_clk = NULL;
  104. }
  105. static int ath10k_ahb_clock_enable(struct ath10k *ar)
  106. {
  107. struct ath10k_ahb *ar_ahb = ath10k_ahb_priv(ar);
  108. struct device *dev;
  109. int ret;
  110. dev = &ar_ahb->pdev->dev;
  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. if (!IS_ERR_OR_NULL(ar_ahb->cmd_clk))
  145. clk_disable_unprepare(ar_ahb->cmd_clk);
  146. if (!IS_ERR_OR_NULL(ar_ahb->ref_clk))
  147. clk_disable_unprepare(ar_ahb->ref_clk);
  148. if (!IS_ERR_OR_NULL(ar_ahb->rtc_clk))
  149. clk_disable_unprepare(ar_ahb->rtc_clk);
  150. }
  151. static int ath10k_ahb_rst_ctrl_init(struct ath10k *ar)
  152. {
  153. struct ath10k_ahb *ar_ahb = ath10k_ahb_priv(ar);
  154. struct device *dev;
  155. dev = &ar_ahb->pdev->dev;
  156. ar_ahb->core_cold_rst = devm_reset_control_get(dev, "wifi_core_cold");
  157. if (IS_ERR(ar_ahb->core_cold_rst)) {
  158. ath10k_err(ar, "failed to get core cold rst ctrl: %ld\n",
  159. PTR_ERR(ar_ahb->core_cold_rst));
  160. return PTR_ERR(ar_ahb->core_cold_rst);
  161. }
  162. ar_ahb->radio_cold_rst = devm_reset_control_get(dev, "wifi_radio_cold");
  163. if (IS_ERR(ar_ahb->radio_cold_rst)) {
  164. ath10k_err(ar, "failed to get radio cold rst ctrl: %ld\n",
  165. PTR_ERR(ar_ahb->radio_cold_rst));
  166. return PTR_ERR(ar_ahb->radio_cold_rst);
  167. }
  168. ar_ahb->radio_warm_rst = devm_reset_control_get(dev, "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(dev, "wifi_radio_srif");
  175. if (IS_ERR(ar_ahb->radio_srif_rst)) {
  176. ath10k_err(ar, "failed to get radio srif rst ctrl: %ld\n",
  177. PTR_ERR(ar_ahb->radio_srif_rst));
  178. return PTR_ERR(ar_ahb->radio_srif_rst);
  179. }
  180. ar_ahb->cpu_init_rst = devm_reset_control_get(dev, "wifi_cpu_init");
  181. if (IS_ERR(ar_ahb->cpu_init_rst)) {
  182. ath10k_err(ar, "failed to get cpu init rst ctrl: %ld\n",
  183. PTR_ERR(ar_ahb->cpu_init_rst));
  184. return PTR_ERR(ar_ahb->cpu_init_rst);
  185. }
  186. return 0;
  187. }
  188. static void ath10k_ahb_rst_ctrl_deinit(struct ath10k *ar)
  189. {
  190. struct ath10k_ahb *ar_ahb = ath10k_ahb_priv(ar);
  191. ar_ahb->core_cold_rst = NULL;
  192. ar_ahb->radio_cold_rst = NULL;
  193. ar_ahb->radio_warm_rst = NULL;
  194. ar_ahb->radio_srif_rst = NULL;
  195. ar_ahb->cpu_init_rst = NULL;
  196. }
  197. static int ath10k_ahb_release_reset(struct ath10k *ar)
  198. {
  199. struct ath10k_ahb *ar_ahb = ath10k_ahb_priv(ar);
  200. int ret;
  201. if (IS_ERR_OR_NULL(ar_ahb->radio_cold_rst) ||
  202. IS_ERR_OR_NULL(ar_ahb->radio_warm_rst) ||
  203. IS_ERR_OR_NULL(ar_ahb->radio_srif_rst) ||
  204. IS_ERR_OR_NULL(ar_ahb->cpu_init_rst)) {
  205. ath10k_err(ar, "rst ctrl(s) is/are not initialized\n");
  206. return -EINVAL;
  207. }
  208. ret = reset_control_deassert(ar_ahb->radio_cold_rst);
  209. if (ret) {
  210. ath10k_err(ar, "failed to deassert radio cold rst: %d\n", ret);
  211. return ret;
  212. }
  213. ret = reset_control_deassert(ar_ahb->radio_warm_rst);
  214. if (ret) {
  215. ath10k_err(ar, "failed to deassert radio warm rst: %d\n", ret);
  216. return ret;
  217. }
  218. ret = reset_control_deassert(ar_ahb->radio_srif_rst);
  219. if (ret) {
  220. ath10k_err(ar, "failed to deassert radio srif rst: %d\n", ret);
  221. return ret;
  222. }
  223. ret = reset_control_deassert(ar_ahb->cpu_init_rst);
  224. if (ret) {
  225. ath10k_err(ar, "failed to deassert cpu init rst: %d\n", ret);
  226. return ret;
  227. }
  228. return 0;
  229. }
  230. static void ath10k_ahb_halt_axi_bus(struct ath10k *ar, u32 haltreq_reg,
  231. u32 haltack_reg)
  232. {
  233. unsigned long timeout;
  234. u32 val;
  235. /* Issue halt axi bus request */
  236. val = ath10k_ahb_tcsr_read32(ar, haltreq_reg);
  237. val |= AHB_AXI_BUS_HALT_REQ;
  238. ath10k_ahb_tcsr_write32(ar, haltreq_reg, val);
  239. /* Wait for axi bus halted ack */
  240. timeout = jiffies + msecs_to_jiffies(ATH10K_AHB_AXI_BUS_HALT_TIMEOUT);
  241. do {
  242. val = ath10k_ahb_tcsr_read32(ar, haltack_reg);
  243. if (val & AHB_AXI_BUS_HALT_ACK)
  244. break;
  245. mdelay(1);
  246. } while (time_before(jiffies, timeout));
  247. if (!(val & AHB_AXI_BUS_HALT_ACK)) {
  248. ath10k_err(ar, "failed to halt axi bus: %d\n", val);
  249. return;
  250. }
  251. ath10k_dbg(ar, ATH10K_DBG_AHB, "axi bus halted\n");
  252. }
  253. static void ath10k_ahb_halt_chip(struct ath10k *ar)
  254. {
  255. struct ath10k_ahb *ar_ahb = ath10k_ahb_priv(ar);
  256. u32 core_id, glb_cfg_reg, haltreq_reg, haltack_reg;
  257. u32 val;
  258. int ret;
  259. if (IS_ERR_OR_NULL(ar_ahb->core_cold_rst) ||
  260. IS_ERR_OR_NULL(ar_ahb->radio_cold_rst) ||
  261. IS_ERR_OR_NULL(ar_ahb->radio_warm_rst) ||
  262. IS_ERR_OR_NULL(ar_ahb->radio_srif_rst) ||
  263. IS_ERR_OR_NULL(ar_ahb->cpu_init_rst)) {
  264. ath10k_err(ar, "rst ctrl(s) is/are not initialized\n");
  265. return;
  266. }
  267. core_id = ath10k_ahb_read32(ar, ATH10K_AHB_WLAN_CORE_ID_REG);
  268. switch (core_id) {
  269. case 0:
  270. glb_cfg_reg = ATH10K_AHB_TCSR_WIFI0_GLB_CFG;
  271. haltreq_reg = ATH10K_AHB_TCSR_WCSS0_HALTREQ;
  272. haltack_reg = ATH10K_AHB_TCSR_WCSS0_HALTACK;
  273. break;
  274. case 1:
  275. glb_cfg_reg = ATH10K_AHB_TCSR_WIFI1_GLB_CFG;
  276. haltreq_reg = ATH10K_AHB_TCSR_WCSS1_HALTREQ;
  277. haltack_reg = ATH10K_AHB_TCSR_WCSS1_HALTACK;
  278. break;
  279. default:
  280. ath10k_err(ar, "invalid core id %d found, skipping reset sequence\n",
  281. core_id);
  282. return;
  283. }
  284. ath10k_ahb_halt_axi_bus(ar, haltreq_reg, haltack_reg);
  285. val = ath10k_ahb_tcsr_read32(ar, glb_cfg_reg);
  286. val |= TCSR_WIFIX_GLB_CFG_DISABLE_CORE_CLK;
  287. ath10k_ahb_tcsr_write32(ar, glb_cfg_reg, val);
  288. ret = reset_control_assert(ar_ahb->core_cold_rst);
  289. if (ret)
  290. ath10k_err(ar, "failed to assert core cold rst: %d\n", ret);
  291. msleep(1);
  292. ret = reset_control_assert(ar_ahb->radio_cold_rst);
  293. if (ret)
  294. ath10k_err(ar, "failed to assert radio cold rst: %d\n", ret);
  295. msleep(1);
  296. ret = reset_control_assert(ar_ahb->radio_warm_rst);
  297. if (ret)
  298. ath10k_err(ar, "failed to assert radio warm rst: %d\n", ret);
  299. msleep(1);
  300. ret = reset_control_assert(ar_ahb->radio_srif_rst);
  301. if (ret)
  302. ath10k_err(ar, "failed to assert radio srif rst: %d\n", ret);
  303. msleep(1);
  304. ret = reset_control_assert(ar_ahb->cpu_init_rst);
  305. if (ret)
  306. ath10k_err(ar, "failed to assert cpu init rst: %d\n", ret);
  307. msleep(10);
  308. /* Clear halt req and core clock disable req before
  309. * deasserting wifi core reset.
  310. */
  311. val = ath10k_ahb_tcsr_read32(ar, haltreq_reg);
  312. val &= ~AHB_AXI_BUS_HALT_REQ;
  313. ath10k_ahb_tcsr_write32(ar, haltreq_reg, val);
  314. val = ath10k_ahb_tcsr_read32(ar, glb_cfg_reg);
  315. val &= ~TCSR_WIFIX_GLB_CFG_DISABLE_CORE_CLK;
  316. ath10k_ahb_tcsr_write32(ar, glb_cfg_reg, val);
  317. ret = reset_control_deassert(ar_ahb->core_cold_rst);
  318. if (ret)
  319. ath10k_err(ar, "failed to deassert core cold rst: %d\n", ret);
  320. ath10k_dbg(ar, ATH10K_DBG_AHB, "core %d reset done\n", core_id);
  321. }
  322. static irqreturn_t ath10k_ahb_interrupt_handler(int irq, void *arg)
  323. {
  324. struct ath10k *ar = arg;
  325. if (!ath10k_pci_irq_pending(ar))
  326. return IRQ_NONE;
  327. ath10k_pci_disable_and_clear_legacy_irq(ar);
  328. ath10k_pci_irq_msi_fw_mask(ar);
  329. napi_schedule(&ar->napi);
  330. return IRQ_HANDLED;
  331. }
  332. static int ath10k_ahb_request_irq_legacy(struct ath10k *ar)
  333. {
  334. struct ath10k_pci *ar_pci = ath10k_pci_priv(ar);
  335. struct ath10k_ahb *ar_ahb = ath10k_ahb_priv(ar);
  336. int ret;
  337. ret = request_irq(ar_ahb->irq,
  338. ath10k_ahb_interrupt_handler,
  339. IRQF_SHARED, "ath10k_ahb", ar);
  340. if (ret) {
  341. ath10k_warn(ar, "failed to request legacy irq %d: %d\n",
  342. ar_ahb->irq, ret);
  343. return ret;
  344. }
  345. ar_pci->oper_irq_mode = ATH10K_PCI_IRQ_LEGACY;
  346. return 0;
  347. }
  348. static void ath10k_ahb_release_irq_legacy(struct ath10k *ar)
  349. {
  350. struct ath10k_ahb *ar_ahb = ath10k_ahb_priv(ar);
  351. free_irq(ar_ahb->irq, ar);
  352. }
  353. static void ath10k_ahb_irq_disable(struct ath10k *ar)
  354. {
  355. ath10k_ce_disable_interrupts(ar);
  356. ath10k_pci_disable_and_clear_legacy_irq(ar);
  357. }
  358. static int ath10k_ahb_resource_init(struct ath10k *ar)
  359. {
  360. struct ath10k_ahb *ar_ahb = ath10k_ahb_priv(ar);
  361. struct platform_device *pdev;
  362. struct device *dev;
  363. struct resource *res;
  364. int ret;
  365. pdev = ar_ahb->pdev;
  366. dev = &pdev->dev;
  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. ath10k_ce_enable_interrupts(ar);
  509. ath10k_pci_enable_legacy_irq(ar);
  510. ath10k_pci_rx_post(ar);
  511. return 0;
  512. }
  513. static void ath10k_ahb_hif_stop(struct ath10k *ar)
  514. {
  515. struct ath10k_ahb *ar_ahb = ath10k_ahb_priv(ar);
  516. ath10k_dbg(ar, ATH10K_DBG_BOOT, "boot ahb hif stop\n");
  517. ath10k_ahb_irq_disable(ar);
  518. synchronize_irq(ar_ahb->irq);
  519. ath10k_pci_flush(ar);
  520. napi_synchronize(&ar->napi);
  521. napi_disable(&ar->napi);
  522. }
  523. static int ath10k_ahb_hif_power_up(struct ath10k *ar)
  524. {
  525. int ret;
  526. ath10k_dbg(ar, ATH10K_DBG_BOOT, "boot ahb hif power up\n");
  527. ret = ath10k_ahb_chip_reset(ar);
  528. if (ret) {
  529. ath10k_err(ar, "failed to reset chip: %d\n", ret);
  530. goto out;
  531. }
  532. ret = ath10k_pci_init_pipes(ar);
  533. if (ret) {
  534. ath10k_err(ar, "failed to initialize CE: %d\n", ret);
  535. goto out;
  536. }
  537. ret = ath10k_pci_init_config(ar);
  538. if (ret) {
  539. ath10k_err(ar, "failed to setup init config: %d\n", ret);
  540. goto err_ce_deinit;
  541. }
  542. ret = ath10k_ahb_wake_target_cpu(ar);
  543. if (ret) {
  544. ath10k_err(ar, "could not wake up target CPU: %d\n", ret);
  545. goto err_ce_deinit;
  546. }
  547. napi_enable(&ar->napi);
  548. return 0;
  549. err_ce_deinit:
  550. ath10k_pci_ce_deinit(ar);
  551. out:
  552. return ret;
  553. }
  554. static const struct ath10k_hif_ops ath10k_ahb_hif_ops = {
  555. .tx_sg = ath10k_pci_hif_tx_sg,
  556. .diag_read = ath10k_pci_hif_diag_read,
  557. .diag_write = ath10k_pci_diag_write_mem,
  558. .exchange_bmi_msg = ath10k_pci_hif_exchange_bmi_msg,
  559. .start = ath10k_ahb_hif_start,
  560. .stop = ath10k_ahb_hif_stop,
  561. .map_service_to_pipe = ath10k_pci_hif_map_service_to_pipe,
  562. .get_default_pipe = ath10k_pci_hif_get_default_pipe,
  563. .send_complete_check = ath10k_pci_hif_send_complete_check,
  564. .get_free_queue_number = ath10k_pci_hif_get_free_queue_number,
  565. .power_up = ath10k_ahb_hif_power_up,
  566. .power_down = ath10k_pci_hif_power_down,
  567. .read32 = ath10k_ahb_read32,
  568. .write32 = ath10k_ahb_write32,
  569. };
  570. static const struct ath10k_bus_ops ath10k_ahb_bus_ops = {
  571. .read32 = ath10k_ahb_read32,
  572. .write32 = ath10k_ahb_write32,
  573. .get_num_banks = ath10k_ahb_get_num_banks,
  574. };
  575. static int ath10k_ahb_probe(struct platform_device *pdev)
  576. {
  577. struct ath10k *ar;
  578. struct ath10k_ahb *ar_ahb;
  579. struct ath10k_pci *ar_pci;
  580. const struct of_device_id *of_id;
  581. enum ath10k_hw_rev hw_rev;
  582. size_t size;
  583. int ret;
  584. u32 chip_id;
  585. of_id = of_match_device(ath10k_ahb_of_match, &pdev->dev);
  586. if (!of_id) {
  587. dev_err(&pdev->dev, "failed to find matching device tree id\n");
  588. return -EINVAL;
  589. }
  590. hw_rev = (enum ath10k_hw_rev)of_id->data;
  591. size = sizeof(*ar_pci) + sizeof(*ar_ahb);
  592. ar = ath10k_core_create(size, &pdev->dev, ATH10K_BUS_AHB,
  593. hw_rev, &ath10k_ahb_hif_ops);
  594. if (!ar) {
  595. dev_err(&pdev->dev, "failed to allocate core\n");
  596. return -ENOMEM;
  597. }
  598. ath10k_dbg(ar, ATH10K_DBG_BOOT, "ahb probe\n");
  599. ar_pci = ath10k_pci_priv(ar);
  600. ar_ahb = ath10k_ahb_priv(ar);
  601. ar_ahb->pdev = pdev;
  602. platform_set_drvdata(pdev, ar);
  603. ret = ath10k_ahb_resource_init(ar);
  604. if (ret)
  605. goto err_core_destroy;
  606. ar->dev_id = 0;
  607. ar_pci->mem = ar_ahb->mem;
  608. ar_pci->mem_len = ar_ahb->mem_len;
  609. ar_pci->ar = ar;
  610. ar_pci->bus_ops = &ath10k_ahb_bus_ops;
  611. ret = ath10k_pci_setup_resource(ar);
  612. if (ret) {
  613. ath10k_err(ar, "failed to setup resource: %d\n", ret);
  614. goto err_resource_deinit;
  615. }
  616. ath10k_pci_init_napi(ar);
  617. ret = ath10k_ahb_request_irq_legacy(ar);
  618. if (ret)
  619. goto err_free_pipes;
  620. ret = ath10k_ahb_prepare_device(ar);
  621. if (ret)
  622. goto err_free_irq;
  623. ath10k_pci_ce_deinit(ar);
  624. chip_id = ath10k_ahb_soc_read32(ar, SOC_CHIP_ID_ADDRESS);
  625. if (chip_id == 0xffffffff) {
  626. ath10k_err(ar, "failed to get chip id\n");
  627. ret = -ENODEV;
  628. goto err_halt_device;
  629. }
  630. ret = ath10k_core_register(ar, chip_id);
  631. if (ret) {
  632. ath10k_err(ar, "failed to register driver core: %d\n", ret);
  633. goto err_halt_device;
  634. }
  635. return 0;
  636. err_halt_device:
  637. ath10k_ahb_halt_chip(ar);
  638. ath10k_ahb_clock_disable(ar);
  639. err_free_irq:
  640. ath10k_ahb_release_irq_legacy(ar);
  641. err_free_pipes:
  642. ath10k_pci_free_pipes(ar);
  643. err_resource_deinit:
  644. ath10k_ahb_resource_deinit(ar);
  645. err_core_destroy:
  646. ath10k_core_destroy(ar);
  647. platform_set_drvdata(pdev, NULL);
  648. return ret;
  649. }
  650. static int ath10k_ahb_remove(struct platform_device *pdev)
  651. {
  652. struct ath10k *ar = platform_get_drvdata(pdev);
  653. struct ath10k_ahb *ar_ahb;
  654. if (!ar)
  655. return -EINVAL;
  656. ar_ahb = ath10k_ahb_priv(ar);
  657. if (!ar_ahb)
  658. return -EINVAL;
  659. ath10k_dbg(ar, ATH10K_DBG_AHB, "ahb remove\n");
  660. ath10k_core_unregister(ar);
  661. ath10k_ahb_irq_disable(ar);
  662. ath10k_ahb_release_irq_legacy(ar);
  663. ath10k_pci_release_resource(ar);
  664. ath10k_ahb_halt_chip(ar);
  665. ath10k_ahb_clock_disable(ar);
  666. ath10k_ahb_resource_deinit(ar);
  667. ath10k_core_destroy(ar);
  668. platform_set_drvdata(pdev, NULL);
  669. return 0;
  670. }
  671. static struct platform_driver ath10k_ahb_driver = {
  672. .driver = {
  673. .name = "ath10k_ahb",
  674. .of_match_table = ath10k_ahb_of_match,
  675. },
  676. .probe = ath10k_ahb_probe,
  677. .remove = ath10k_ahb_remove,
  678. };
  679. int ath10k_ahb_init(void)
  680. {
  681. int ret;
  682. ret = platform_driver_register(&ath10k_ahb_driver);
  683. if (ret)
  684. printk(KERN_ERR "failed to register ath10k ahb driver: %d\n",
  685. ret);
  686. return ret;
  687. }
  688. void ath10k_ahb_exit(void)
  689. {
  690. platform_driver_unregister(&ath10k_ahb_driver);
  691. }