1
0

pcie.c 36 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494
  1. /*
  2. * Copyright (c) 2015-2016 Quantenna Communications, Inc.
  3. * All rights reserved.
  4. *
  5. * This program is free software; you can redistribute it and/or
  6. * modify it under the terms of the GNU General Public License
  7. * as published by the Free Software Foundation; either version 2
  8. * of the License, or (at your option) any later version.
  9. *
  10. * This program is distributed in the hope that it will be useful,
  11. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  12. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  13. * GNU General Public License for more details.
  14. *
  15. */
  16. #include <linux/kernel.h>
  17. #include <linux/module.h>
  18. #include <linux/firmware.h>
  19. #include <linux/pci.h>
  20. #include <linux/vmalloc.h>
  21. #include <linux/delay.h>
  22. #include <linux/interrupt.h>
  23. #include <linux/sched.h>
  24. #include <linux/completion.h>
  25. #include <linux/crc32.h>
  26. #include <linux/spinlock.h>
  27. #include <linux/circ_buf.h>
  28. #include <linux/log2.h>
  29. #include "qtn_hw_ids.h"
  30. #include "pcie_bus_priv.h"
  31. #include "core.h"
  32. #include "bus.h"
  33. #include "debug.h"
  34. static bool use_msi = true;
  35. module_param(use_msi, bool, 0644);
  36. MODULE_PARM_DESC(use_msi, "set 0 to use legacy interrupt");
  37. static unsigned int tx_bd_size_param = 32;
  38. module_param(tx_bd_size_param, uint, 0644);
  39. MODULE_PARM_DESC(tx_bd_size_param, "Tx descriptors queue size, power of two");
  40. static unsigned int rx_bd_size_param = 256;
  41. module_param(rx_bd_size_param, uint, 0644);
  42. MODULE_PARM_DESC(rx_bd_size_param, "Rx descriptors queue size, power of two");
  43. static u8 flashboot = 1;
  44. module_param(flashboot, byte, 0644);
  45. MODULE_PARM_DESC(flashboot, "set to 0 to use FW binary file on FS");
  46. #define DRV_NAME "qtnfmac_pearl_pcie"
  47. static inline void qtnf_non_posted_write(u32 val, void __iomem *basereg)
  48. {
  49. writel(val, basereg);
  50. /* flush posted write */
  51. readl(basereg);
  52. }
  53. static inline void qtnf_init_hdp_irqs(struct qtnf_pcie_bus_priv *priv)
  54. {
  55. unsigned long flags;
  56. spin_lock_irqsave(&priv->irq_lock, flags);
  57. priv->pcie_irq_mask = (PCIE_HDP_INT_RX_BITS | PCIE_HDP_INT_TX_BITS);
  58. spin_unlock_irqrestore(&priv->irq_lock, flags);
  59. }
  60. static inline void qtnf_enable_hdp_irqs(struct qtnf_pcie_bus_priv *priv)
  61. {
  62. unsigned long flags;
  63. spin_lock_irqsave(&priv->irq_lock, flags);
  64. writel(priv->pcie_irq_mask, PCIE_HDP_INT_EN(priv->pcie_reg_base));
  65. spin_unlock_irqrestore(&priv->irq_lock, flags);
  66. }
  67. static inline void qtnf_disable_hdp_irqs(struct qtnf_pcie_bus_priv *priv)
  68. {
  69. unsigned long flags;
  70. spin_lock_irqsave(&priv->irq_lock, flags);
  71. writel(0x0, PCIE_HDP_INT_EN(priv->pcie_reg_base));
  72. spin_unlock_irqrestore(&priv->irq_lock, flags);
  73. }
  74. static inline void qtnf_en_rxdone_irq(struct qtnf_pcie_bus_priv *priv)
  75. {
  76. unsigned long flags;
  77. spin_lock_irqsave(&priv->irq_lock, flags);
  78. priv->pcie_irq_mask |= PCIE_HDP_INT_RX_BITS;
  79. writel(priv->pcie_irq_mask, PCIE_HDP_INT_EN(priv->pcie_reg_base));
  80. spin_unlock_irqrestore(&priv->irq_lock, flags);
  81. }
  82. static inline void qtnf_dis_rxdone_irq(struct qtnf_pcie_bus_priv *priv)
  83. {
  84. unsigned long flags;
  85. spin_lock_irqsave(&priv->irq_lock, flags);
  86. priv->pcie_irq_mask &= ~PCIE_HDP_INT_RX_BITS;
  87. writel(priv->pcie_irq_mask, PCIE_HDP_INT_EN(priv->pcie_reg_base));
  88. spin_unlock_irqrestore(&priv->irq_lock, flags);
  89. }
  90. static inline void qtnf_en_txdone_irq(struct qtnf_pcie_bus_priv *priv)
  91. {
  92. unsigned long flags;
  93. spin_lock_irqsave(&priv->irq_lock, flags);
  94. priv->pcie_irq_mask |= PCIE_HDP_INT_TX_BITS;
  95. writel(priv->pcie_irq_mask, PCIE_HDP_INT_EN(priv->pcie_reg_base));
  96. spin_unlock_irqrestore(&priv->irq_lock, flags);
  97. }
  98. static inline void qtnf_dis_txdone_irq(struct qtnf_pcie_bus_priv *priv)
  99. {
  100. unsigned long flags;
  101. spin_lock_irqsave(&priv->irq_lock, flags);
  102. priv->pcie_irq_mask &= ~PCIE_HDP_INT_TX_BITS;
  103. writel(priv->pcie_irq_mask, PCIE_HDP_INT_EN(priv->pcie_reg_base));
  104. spin_unlock_irqrestore(&priv->irq_lock, flags);
  105. }
  106. static void qtnf_pcie_init_irq(struct qtnf_pcie_bus_priv *priv)
  107. {
  108. struct pci_dev *pdev = priv->pdev;
  109. /* fall back to legacy INTx interrupts by default */
  110. priv->msi_enabled = 0;
  111. /* check if MSI capability is available */
  112. if (use_msi) {
  113. if (!pci_enable_msi(pdev)) {
  114. pr_debug("MSI interrupt enabled\n");
  115. priv->msi_enabled = 1;
  116. } else {
  117. pr_warn("failed to enable MSI interrupts");
  118. }
  119. }
  120. if (!priv->msi_enabled) {
  121. pr_warn("legacy PCIE interrupts enabled\n");
  122. pci_intx(pdev, 1);
  123. }
  124. }
  125. static void qtnf_deassert_intx(struct qtnf_pcie_bus_priv *priv)
  126. {
  127. void __iomem *reg = priv->sysctl_bar + PEARL_PCIE_CFG0_OFFSET;
  128. u32 cfg;
  129. cfg = readl(reg);
  130. cfg &= ~PEARL_ASSERT_INTX;
  131. qtnf_non_posted_write(cfg, reg);
  132. }
  133. static void qtnf_reset_card(struct qtnf_pcie_bus_priv *priv)
  134. {
  135. const u32 data = QTN_PEARL_IPC_IRQ_WORD(QTN_PEARL_LHOST_EP_RESET);
  136. void __iomem *reg = priv->sysctl_bar +
  137. QTN_PEARL_SYSCTL_LHOST_IRQ_OFFSET;
  138. qtnf_non_posted_write(data, reg);
  139. msleep(QTN_EP_RESET_WAIT_MS);
  140. pci_restore_state(priv->pdev);
  141. }
  142. static void qtnf_ipc_gen_ep_int(void *arg)
  143. {
  144. const struct qtnf_pcie_bus_priv *priv = arg;
  145. const u32 data = QTN_PEARL_IPC_IRQ_WORD(QTN_PEARL_LHOST_IPC_IRQ);
  146. void __iomem *reg = priv->sysctl_bar +
  147. QTN_PEARL_SYSCTL_LHOST_IRQ_OFFSET;
  148. qtnf_non_posted_write(data, reg);
  149. }
  150. static void __iomem *qtnf_map_bar(struct qtnf_pcie_bus_priv *priv, u8 index)
  151. {
  152. void __iomem *vaddr;
  153. dma_addr_t busaddr;
  154. size_t len;
  155. int ret;
  156. ret = pcim_iomap_regions(priv->pdev, 1 << index, DRV_NAME);
  157. if (ret)
  158. return IOMEM_ERR_PTR(ret);
  159. busaddr = pci_resource_start(priv->pdev, index);
  160. len = pci_resource_len(priv->pdev, index);
  161. vaddr = pcim_iomap_table(priv->pdev)[index];
  162. if (!vaddr)
  163. return IOMEM_ERR_PTR(-ENOMEM);
  164. pr_debug("BAR%u vaddr=0x%p busaddr=%pad len=%u\n",
  165. index, vaddr, &busaddr, (int)len);
  166. return vaddr;
  167. }
  168. static void qtnf_pcie_control_rx_callback(void *arg, const u8 *buf, size_t len)
  169. {
  170. struct qtnf_pcie_bus_priv *priv = arg;
  171. struct qtnf_bus *bus = pci_get_drvdata(priv->pdev);
  172. struct sk_buff *skb;
  173. if (unlikely(len == 0)) {
  174. pr_warn("zero length packet received\n");
  175. return;
  176. }
  177. skb = __dev_alloc_skb(len, GFP_KERNEL);
  178. if (unlikely(!skb)) {
  179. pr_err("failed to allocate skb\n");
  180. return;
  181. }
  182. skb_put_data(skb, buf, len);
  183. qtnf_trans_handle_rx_ctl_packet(bus, skb);
  184. }
  185. static int qtnf_pcie_init_shm_ipc(struct qtnf_pcie_bus_priv *priv)
  186. {
  187. struct qtnf_shm_ipc_region __iomem *ipc_tx_reg;
  188. struct qtnf_shm_ipc_region __iomem *ipc_rx_reg;
  189. const struct qtnf_shm_ipc_int ipc_int = { qtnf_ipc_gen_ep_int, priv };
  190. const struct qtnf_shm_ipc_rx_callback rx_callback = {
  191. qtnf_pcie_control_rx_callback, priv };
  192. ipc_tx_reg = &priv->bda->bda_shm_reg1;
  193. ipc_rx_reg = &priv->bda->bda_shm_reg2;
  194. qtnf_shm_ipc_init(&priv->shm_ipc_ep_in, QTNF_SHM_IPC_OUTBOUND,
  195. ipc_tx_reg, priv->workqueue,
  196. &ipc_int, &rx_callback);
  197. qtnf_shm_ipc_init(&priv->shm_ipc_ep_out, QTNF_SHM_IPC_INBOUND,
  198. ipc_rx_reg, priv->workqueue,
  199. &ipc_int, &rx_callback);
  200. return 0;
  201. }
  202. static void qtnf_pcie_free_shm_ipc(struct qtnf_pcie_bus_priv *priv)
  203. {
  204. qtnf_shm_ipc_free(&priv->shm_ipc_ep_in);
  205. qtnf_shm_ipc_free(&priv->shm_ipc_ep_out);
  206. }
  207. static int qtnf_pcie_init_memory(struct qtnf_pcie_bus_priv *priv)
  208. {
  209. int ret = -ENOMEM;
  210. priv->sysctl_bar = qtnf_map_bar(priv, QTN_SYSCTL_BAR);
  211. if (IS_ERR(priv->sysctl_bar)) {
  212. pr_err("failed to map BAR%u\n", QTN_SYSCTL_BAR);
  213. return ret;
  214. }
  215. priv->dmareg_bar = qtnf_map_bar(priv, QTN_DMA_BAR);
  216. if (IS_ERR(priv->dmareg_bar)) {
  217. pr_err("failed to map BAR%u\n", QTN_DMA_BAR);
  218. return ret;
  219. }
  220. priv->epmem_bar = qtnf_map_bar(priv, QTN_SHMEM_BAR);
  221. if (IS_ERR(priv->epmem_bar)) {
  222. pr_err("failed to map BAR%u\n", QTN_SHMEM_BAR);
  223. return ret;
  224. }
  225. priv->pcie_reg_base = priv->dmareg_bar;
  226. priv->bda = priv->epmem_bar;
  227. writel(priv->msi_enabled, &priv->bda->bda_rc_msi_enabled);
  228. return 0;
  229. }
  230. static void qtnf_tune_pcie_mps(struct qtnf_pcie_bus_priv *priv)
  231. {
  232. struct pci_dev *pdev = priv->pdev;
  233. struct pci_dev *parent;
  234. int mps_p, mps_o, mps_m, mps;
  235. int ret;
  236. /* current mps */
  237. mps_o = pcie_get_mps(pdev);
  238. /* maximum supported mps */
  239. mps_m = 128 << pdev->pcie_mpss;
  240. /* suggested new mps value */
  241. mps = mps_m;
  242. if (pdev->bus && pdev->bus->self) {
  243. /* parent (bus) mps */
  244. parent = pdev->bus->self;
  245. if (pci_is_pcie(parent)) {
  246. mps_p = pcie_get_mps(parent);
  247. mps = min(mps_m, mps_p);
  248. }
  249. }
  250. ret = pcie_set_mps(pdev, mps);
  251. if (ret) {
  252. pr_err("failed to set mps to %d, keep using current %d\n",
  253. mps, mps_o);
  254. priv->mps = mps_o;
  255. return;
  256. }
  257. pr_debug("set mps to %d (was %d, max %d)\n", mps, mps_o, mps_m);
  258. priv->mps = mps;
  259. }
  260. static int qtnf_is_state(__le32 __iomem *reg, u32 state)
  261. {
  262. u32 s = readl(reg);
  263. return s & state;
  264. }
  265. static void qtnf_set_state(__le32 __iomem *reg, u32 state)
  266. {
  267. u32 s = readl(reg);
  268. qtnf_non_posted_write(state | s, reg);
  269. }
  270. static void qtnf_clear_state(__le32 __iomem *reg, u32 state)
  271. {
  272. u32 s = readl(reg);
  273. qtnf_non_posted_write(s & ~state, reg);
  274. }
  275. static int qtnf_poll_state(__le32 __iomem *reg, u32 state, u32 delay_in_ms)
  276. {
  277. u32 timeout = 0;
  278. while ((qtnf_is_state(reg, state) == 0)) {
  279. usleep_range(1000, 1200);
  280. if (++timeout > delay_in_ms)
  281. return -1;
  282. }
  283. return 0;
  284. }
  285. static int alloc_skb_array(struct qtnf_pcie_bus_priv *priv)
  286. {
  287. struct sk_buff **vaddr;
  288. int len;
  289. len = priv->tx_bd_num * sizeof(*priv->tx_skb) +
  290. priv->rx_bd_num * sizeof(*priv->rx_skb);
  291. vaddr = devm_kzalloc(&priv->pdev->dev, len, GFP_KERNEL);
  292. if (!vaddr)
  293. return -ENOMEM;
  294. priv->tx_skb = vaddr;
  295. vaddr += priv->tx_bd_num;
  296. priv->rx_skb = vaddr;
  297. return 0;
  298. }
  299. static int alloc_bd_table(struct qtnf_pcie_bus_priv *priv)
  300. {
  301. dma_addr_t paddr;
  302. void *vaddr;
  303. int len;
  304. len = priv->tx_bd_num * sizeof(struct qtnf_tx_bd) +
  305. priv->rx_bd_num * sizeof(struct qtnf_rx_bd);
  306. vaddr = dmam_alloc_coherent(&priv->pdev->dev, len, &paddr, GFP_KERNEL);
  307. if (!vaddr)
  308. return -ENOMEM;
  309. /* tx bd */
  310. memset(vaddr, 0, len);
  311. priv->bd_table_vaddr = vaddr;
  312. priv->bd_table_paddr = paddr;
  313. priv->bd_table_len = len;
  314. priv->tx_bd_vbase = vaddr;
  315. priv->tx_bd_pbase = paddr;
  316. pr_debug("TX descriptor table: vaddr=0x%p paddr=%pad\n", vaddr, &paddr);
  317. priv->tx_bd_r_index = 0;
  318. priv->tx_bd_w_index = 0;
  319. /* rx bd */
  320. vaddr = ((struct qtnf_tx_bd *)vaddr) + priv->tx_bd_num;
  321. paddr += priv->tx_bd_num * sizeof(struct qtnf_tx_bd);
  322. priv->rx_bd_vbase = vaddr;
  323. priv->rx_bd_pbase = paddr;
  324. #ifdef CONFIG_ARCH_DMA_ADDR_T_64BIT
  325. writel(QTN_HOST_HI32(paddr),
  326. PCIE_HDP_TX_HOST_Q_BASE_H(priv->pcie_reg_base));
  327. #endif
  328. writel(QTN_HOST_LO32(paddr),
  329. PCIE_HDP_TX_HOST_Q_BASE_L(priv->pcie_reg_base));
  330. writel(priv->rx_bd_num | (sizeof(struct qtnf_rx_bd)) << 16,
  331. PCIE_HDP_TX_HOST_Q_SZ_CTRL(priv->pcie_reg_base));
  332. pr_debug("RX descriptor table: vaddr=0x%p paddr=%pad\n", vaddr, &paddr);
  333. return 0;
  334. }
  335. static int skb2rbd_attach(struct qtnf_pcie_bus_priv *priv, u16 index)
  336. {
  337. struct qtnf_rx_bd *rxbd;
  338. struct sk_buff *skb;
  339. dma_addr_t paddr;
  340. skb = __netdev_alloc_skb_ip_align(NULL, SKB_BUF_SIZE, GFP_ATOMIC);
  341. if (!skb) {
  342. priv->rx_skb[index] = NULL;
  343. return -ENOMEM;
  344. }
  345. priv->rx_skb[index] = skb;
  346. rxbd = &priv->rx_bd_vbase[index];
  347. paddr = pci_map_single(priv->pdev, skb->data,
  348. SKB_BUF_SIZE, PCI_DMA_FROMDEVICE);
  349. if (pci_dma_mapping_error(priv->pdev, paddr)) {
  350. pr_err("skb DMA mapping error: %pad\n", &paddr);
  351. return -ENOMEM;
  352. }
  353. /* keep rx skb paddrs in rx buffer descriptors for cleanup purposes */
  354. rxbd->addr = cpu_to_le32(QTN_HOST_LO32(paddr));
  355. rxbd->addr_h = cpu_to_le32(QTN_HOST_HI32(paddr));
  356. rxbd->info = 0x0;
  357. priv->rx_bd_w_index = index;
  358. /* sync up all descriptor updates */
  359. wmb();
  360. #ifdef CONFIG_ARCH_DMA_ADDR_T_64BIT
  361. writel(QTN_HOST_HI32(paddr),
  362. PCIE_HDP_HHBM_BUF_PTR_H(priv->pcie_reg_base));
  363. #endif
  364. writel(QTN_HOST_LO32(paddr),
  365. PCIE_HDP_HHBM_BUF_PTR(priv->pcie_reg_base));
  366. writel(index, PCIE_HDP_TX_HOST_Q_WR_PTR(priv->pcie_reg_base));
  367. return 0;
  368. }
  369. static int alloc_rx_buffers(struct qtnf_pcie_bus_priv *priv)
  370. {
  371. u16 i;
  372. int ret = 0;
  373. memset(priv->rx_bd_vbase, 0x0,
  374. priv->rx_bd_num * sizeof(struct qtnf_rx_bd));
  375. for (i = 0; i < priv->rx_bd_num; i++) {
  376. ret = skb2rbd_attach(priv, i);
  377. if (ret)
  378. break;
  379. }
  380. return ret;
  381. }
  382. /* all rx/tx activity should have ceased before calling this function */
  383. static void qtnf_free_xfer_buffers(struct qtnf_pcie_bus_priv *priv)
  384. {
  385. struct qtnf_tx_bd *txbd;
  386. struct qtnf_rx_bd *rxbd;
  387. struct sk_buff *skb;
  388. dma_addr_t paddr;
  389. int i;
  390. /* free rx buffers */
  391. for (i = 0; i < priv->rx_bd_num; i++) {
  392. if (priv->rx_skb && priv->rx_skb[i]) {
  393. rxbd = &priv->rx_bd_vbase[i];
  394. skb = priv->rx_skb[i];
  395. paddr = QTN_HOST_ADDR(le32_to_cpu(rxbd->addr_h),
  396. le32_to_cpu(rxbd->addr));
  397. pci_unmap_single(priv->pdev, paddr, SKB_BUF_SIZE,
  398. PCI_DMA_FROMDEVICE);
  399. dev_kfree_skb_any(skb);
  400. priv->rx_skb[i] = NULL;
  401. }
  402. }
  403. /* free tx buffers */
  404. for (i = 0; i < priv->tx_bd_num; i++) {
  405. if (priv->tx_skb && priv->tx_skb[i]) {
  406. txbd = &priv->tx_bd_vbase[i];
  407. skb = priv->tx_skb[i];
  408. paddr = QTN_HOST_ADDR(le32_to_cpu(txbd->addr_h),
  409. le32_to_cpu(txbd->addr));
  410. pci_unmap_single(priv->pdev, paddr, skb->len,
  411. PCI_DMA_TODEVICE);
  412. dev_kfree_skb_any(skb);
  413. priv->tx_skb[i] = NULL;
  414. }
  415. }
  416. }
  417. static int qtnf_hhbm_init(struct qtnf_pcie_bus_priv *priv)
  418. {
  419. u32 val;
  420. val = readl(PCIE_HHBM_CONFIG(priv->pcie_reg_base));
  421. val |= HHBM_CONFIG_SOFT_RESET;
  422. writel(val, PCIE_HHBM_CONFIG(priv->pcie_reg_base));
  423. usleep_range(50, 100);
  424. val &= ~HHBM_CONFIG_SOFT_RESET;
  425. #ifdef CONFIG_ARCH_DMA_ADDR_T_64BIT
  426. val |= HHBM_64BIT;
  427. #endif
  428. writel(val, PCIE_HHBM_CONFIG(priv->pcie_reg_base));
  429. writel(priv->rx_bd_num, PCIE_HHBM_Q_LIMIT_REG(priv->pcie_reg_base));
  430. return 0;
  431. }
  432. static int qtnf_pcie_init_xfer(struct qtnf_pcie_bus_priv *priv)
  433. {
  434. int ret;
  435. u32 val;
  436. priv->tx_bd_num = tx_bd_size_param;
  437. priv->rx_bd_num = rx_bd_size_param;
  438. priv->rx_bd_w_index = 0;
  439. priv->rx_bd_r_index = 0;
  440. if (!priv->tx_bd_num || !is_power_of_2(priv->tx_bd_num)) {
  441. pr_err("tx_bd_size_param %u is not power of two\n",
  442. priv->tx_bd_num);
  443. return -EINVAL;
  444. }
  445. val = priv->tx_bd_num * sizeof(struct qtnf_tx_bd);
  446. if (val > PCIE_HHBM_MAX_SIZE) {
  447. pr_err("tx_bd_size_param %u is too large\n",
  448. priv->tx_bd_num);
  449. return -EINVAL;
  450. }
  451. if (!priv->rx_bd_num || !is_power_of_2(priv->rx_bd_num)) {
  452. pr_err("rx_bd_size_param %u is not power of two\n",
  453. priv->rx_bd_num);
  454. return -EINVAL;
  455. }
  456. val = priv->rx_bd_num * sizeof(dma_addr_t);
  457. if (val > PCIE_HHBM_MAX_SIZE) {
  458. pr_err("rx_bd_size_param %u is too large\n",
  459. priv->rx_bd_num);
  460. return -EINVAL;
  461. }
  462. ret = qtnf_hhbm_init(priv);
  463. if (ret) {
  464. pr_err("failed to init h/w queues\n");
  465. return ret;
  466. }
  467. ret = alloc_skb_array(priv);
  468. if (ret) {
  469. pr_err("failed to allocate skb array\n");
  470. return ret;
  471. }
  472. ret = alloc_bd_table(priv);
  473. if (ret) {
  474. pr_err("failed to allocate bd table\n");
  475. return ret;
  476. }
  477. ret = alloc_rx_buffers(priv);
  478. if (ret) {
  479. pr_err("failed to allocate rx buffers\n");
  480. return ret;
  481. }
  482. return ret;
  483. }
  484. static void qtnf_pcie_data_tx_reclaim(struct qtnf_pcie_bus_priv *priv)
  485. {
  486. struct qtnf_tx_bd *txbd;
  487. struct sk_buff *skb;
  488. unsigned long flags;
  489. dma_addr_t paddr;
  490. u32 tx_done_index;
  491. int count = 0;
  492. int i;
  493. spin_lock_irqsave(&priv->tx_reclaim_lock, flags);
  494. tx_done_index = readl(PCIE_HDP_RX0DMA_CNT(priv->pcie_reg_base))
  495. & (priv->tx_bd_num - 1);
  496. i = priv->tx_bd_r_index;
  497. while (CIRC_CNT(tx_done_index, i, priv->tx_bd_num)) {
  498. skb = priv->tx_skb[i];
  499. if (likely(skb)) {
  500. txbd = &priv->tx_bd_vbase[i];
  501. paddr = QTN_HOST_ADDR(le32_to_cpu(txbd->addr_h),
  502. le32_to_cpu(txbd->addr));
  503. pci_unmap_single(priv->pdev, paddr, skb->len,
  504. PCI_DMA_TODEVICE);
  505. if (skb->dev) {
  506. qtnf_update_tx_stats(skb->dev, skb);
  507. if (unlikely(priv->tx_stopped)) {
  508. qtnf_wake_all_queues(skb->dev);
  509. priv->tx_stopped = 0;
  510. }
  511. }
  512. dev_kfree_skb_any(skb);
  513. }
  514. priv->tx_skb[i] = NULL;
  515. count++;
  516. if (++i >= priv->tx_bd_num)
  517. i = 0;
  518. }
  519. priv->tx_reclaim_done += count;
  520. priv->tx_reclaim_req++;
  521. priv->tx_bd_r_index = i;
  522. spin_unlock_irqrestore(&priv->tx_reclaim_lock, flags);
  523. }
  524. static int qtnf_tx_queue_ready(struct qtnf_pcie_bus_priv *priv)
  525. {
  526. if (!CIRC_SPACE(priv->tx_bd_w_index, priv->tx_bd_r_index,
  527. priv->tx_bd_num)) {
  528. qtnf_pcie_data_tx_reclaim(priv);
  529. if (!CIRC_SPACE(priv->tx_bd_w_index, priv->tx_bd_r_index,
  530. priv->tx_bd_num)) {
  531. pr_warn_ratelimited("reclaim full Tx queue\n");
  532. priv->tx_full_count++;
  533. return 0;
  534. }
  535. }
  536. return 1;
  537. }
  538. static int qtnf_pcie_data_tx(struct qtnf_bus *bus, struct sk_buff *skb)
  539. {
  540. struct qtnf_pcie_bus_priv *priv = (void *)get_bus_priv(bus);
  541. dma_addr_t txbd_paddr, skb_paddr;
  542. struct qtnf_tx_bd *txbd;
  543. unsigned long flags;
  544. int len, i;
  545. u32 info;
  546. int ret = 0;
  547. spin_lock_irqsave(&priv->tx0_lock, flags);
  548. if (!qtnf_tx_queue_ready(priv)) {
  549. if (skb->dev) {
  550. netif_tx_stop_all_queues(skb->dev);
  551. priv->tx_stopped = 1;
  552. }
  553. spin_unlock_irqrestore(&priv->tx0_lock, flags);
  554. return NETDEV_TX_BUSY;
  555. }
  556. i = priv->tx_bd_w_index;
  557. priv->tx_skb[i] = skb;
  558. len = skb->len;
  559. skb_paddr = pci_map_single(priv->pdev, skb->data,
  560. skb->len, PCI_DMA_TODEVICE);
  561. if (pci_dma_mapping_error(priv->pdev, skb_paddr)) {
  562. pr_err("skb DMA mapping error: %pad\n", &skb_paddr);
  563. ret = -ENOMEM;
  564. goto tx_done;
  565. }
  566. txbd = &priv->tx_bd_vbase[i];
  567. txbd->addr = cpu_to_le32(QTN_HOST_LO32(skb_paddr));
  568. txbd->addr_h = cpu_to_le32(QTN_HOST_HI32(skb_paddr));
  569. info = (len & QTN_PCIE_TX_DESC_LEN_MASK) << QTN_PCIE_TX_DESC_LEN_SHIFT;
  570. txbd->info = cpu_to_le32(info);
  571. /* sync up all descriptor updates before passing them to EP */
  572. dma_wmb();
  573. /* write new TX descriptor to PCIE_RX_FIFO on EP */
  574. txbd_paddr = priv->tx_bd_pbase + i * sizeof(struct qtnf_tx_bd);
  575. #ifdef CONFIG_ARCH_DMA_ADDR_T_64BIT
  576. writel(QTN_HOST_HI32(txbd_paddr),
  577. PCIE_HDP_HOST_WR_DESC0_H(priv->pcie_reg_base));
  578. #endif
  579. writel(QTN_HOST_LO32(txbd_paddr),
  580. PCIE_HDP_HOST_WR_DESC0(priv->pcie_reg_base));
  581. if (++i >= priv->tx_bd_num)
  582. i = 0;
  583. priv->tx_bd_w_index = i;
  584. tx_done:
  585. if (ret && skb) {
  586. pr_err_ratelimited("drop skb\n");
  587. if (skb->dev)
  588. skb->dev->stats.tx_dropped++;
  589. dev_kfree_skb_any(skb);
  590. }
  591. priv->tx_done_count++;
  592. spin_unlock_irqrestore(&priv->tx0_lock, flags);
  593. qtnf_pcie_data_tx_reclaim(priv);
  594. return NETDEV_TX_OK;
  595. }
  596. static int qtnf_pcie_control_tx(struct qtnf_bus *bus, struct sk_buff *skb)
  597. {
  598. struct qtnf_pcie_bus_priv *priv = (void *)get_bus_priv(bus);
  599. int ret;
  600. ret = qtnf_shm_ipc_send(&priv->shm_ipc_ep_in, skb->data, skb->len);
  601. if (ret == -ETIMEDOUT) {
  602. pr_err("EP firmware is dead\n");
  603. bus->fw_state = QTNF_FW_STATE_EP_DEAD;
  604. }
  605. return ret;
  606. }
  607. static irqreturn_t qtnf_interrupt(int irq, void *data)
  608. {
  609. struct qtnf_bus *bus = (struct qtnf_bus *)data;
  610. struct qtnf_pcie_bus_priv *priv = (void *)get_bus_priv(bus);
  611. u32 status;
  612. priv->pcie_irq_count++;
  613. status = readl(PCIE_HDP_INT_STATUS(priv->pcie_reg_base));
  614. qtnf_shm_ipc_irq_handler(&priv->shm_ipc_ep_in);
  615. qtnf_shm_ipc_irq_handler(&priv->shm_ipc_ep_out);
  616. if (!(status & priv->pcie_irq_mask))
  617. goto irq_done;
  618. if (status & PCIE_HDP_INT_RX_BITS)
  619. priv->pcie_irq_rx_count++;
  620. if (status & PCIE_HDP_INT_TX_BITS)
  621. priv->pcie_irq_tx_count++;
  622. if (status & PCIE_HDP_INT_HHBM_UF)
  623. priv->pcie_irq_uf_count++;
  624. if (status & PCIE_HDP_INT_RX_BITS) {
  625. qtnf_dis_rxdone_irq(priv);
  626. napi_schedule(&bus->mux_napi);
  627. }
  628. if (status & PCIE_HDP_INT_TX_BITS) {
  629. qtnf_dis_txdone_irq(priv);
  630. tasklet_hi_schedule(&priv->reclaim_tq);
  631. }
  632. irq_done:
  633. /* H/W workaround: clean all bits, not only enabled */
  634. qtnf_non_posted_write(~0U, PCIE_HDP_INT_STATUS(priv->pcie_reg_base));
  635. if (!priv->msi_enabled)
  636. qtnf_deassert_intx(priv);
  637. return IRQ_HANDLED;
  638. }
  639. static int qtnf_rx_data_ready(struct qtnf_pcie_bus_priv *priv)
  640. {
  641. u16 index = priv->rx_bd_r_index;
  642. struct qtnf_rx_bd *rxbd;
  643. u32 descw;
  644. rxbd = &priv->rx_bd_vbase[index];
  645. descw = le32_to_cpu(rxbd->info);
  646. if (descw & QTN_TXDONE_MASK)
  647. return 1;
  648. return 0;
  649. }
  650. static int qtnf_rx_poll(struct napi_struct *napi, int budget)
  651. {
  652. struct qtnf_bus *bus = container_of(napi, struct qtnf_bus, mux_napi);
  653. struct qtnf_pcie_bus_priv *priv = (void *)get_bus_priv(bus);
  654. struct net_device *ndev = NULL;
  655. struct sk_buff *skb = NULL;
  656. int processed = 0;
  657. struct qtnf_rx_bd *rxbd;
  658. dma_addr_t skb_paddr;
  659. int consume;
  660. u32 descw;
  661. u32 psize;
  662. u16 r_idx;
  663. u16 w_idx;
  664. int ret;
  665. while (processed < budget) {
  666. if (!qtnf_rx_data_ready(priv))
  667. goto rx_out;
  668. r_idx = priv->rx_bd_r_index;
  669. rxbd = &priv->rx_bd_vbase[r_idx];
  670. descw = le32_to_cpu(rxbd->info);
  671. skb = priv->rx_skb[r_idx];
  672. psize = QTN_GET_LEN(descw);
  673. consume = 1;
  674. if (!(descw & QTN_TXDONE_MASK)) {
  675. pr_warn("skip invalid rxbd[%d]\n", r_idx);
  676. consume = 0;
  677. }
  678. if (!skb) {
  679. pr_warn("skip missing rx_skb[%d]\n", r_idx);
  680. consume = 0;
  681. }
  682. if (skb && (skb_tailroom(skb) < psize)) {
  683. pr_err("skip packet with invalid length: %u > %u\n",
  684. psize, skb_tailroom(skb));
  685. consume = 0;
  686. }
  687. if (skb) {
  688. skb_paddr = QTN_HOST_ADDR(le32_to_cpu(rxbd->addr_h),
  689. le32_to_cpu(rxbd->addr));
  690. pci_unmap_single(priv->pdev, skb_paddr, SKB_BUF_SIZE,
  691. PCI_DMA_FROMDEVICE);
  692. }
  693. if (consume) {
  694. skb_put(skb, psize);
  695. ndev = qtnf_classify_skb(bus, skb);
  696. if (likely(ndev)) {
  697. qtnf_update_rx_stats(ndev, skb);
  698. skb->protocol = eth_type_trans(skb, ndev);
  699. napi_gro_receive(napi, skb);
  700. } else {
  701. pr_debug("drop untagged skb\n");
  702. bus->mux_dev.stats.rx_dropped++;
  703. dev_kfree_skb_any(skb);
  704. }
  705. } else {
  706. if (skb) {
  707. bus->mux_dev.stats.rx_dropped++;
  708. dev_kfree_skb_any(skb);
  709. }
  710. }
  711. priv->rx_skb[r_idx] = NULL;
  712. if (++r_idx >= priv->rx_bd_num)
  713. r_idx = 0;
  714. priv->rx_bd_r_index = r_idx;
  715. /* repalce processed buffer by a new one */
  716. w_idx = priv->rx_bd_w_index;
  717. while (CIRC_SPACE(priv->rx_bd_w_index, priv->rx_bd_r_index,
  718. priv->rx_bd_num) > 0) {
  719. if (++w_idx >= priv->rx_bd_num)
  720. w_idx = 0;
  721. ret = skb2rbd_attach(priv, w_idx);
  722. if (ret) {
  723. pr_err("failed to allocate new rx_skb[%d]\n",
  724. w_idx);
  725. break;
  726. }
  727. }
  728. processed++;
  729. }
  730. rx_out:
  731. if (processed < budget) {
  732. napi_complete(napi);
  733. qtnf_en_rxdone_irq(priv);
  734. }
  735. return processed;
  736. }
  737. static void
  738. qtnf_pcie_data_tx_timeout(struct qtnf_bus *bus, struct net_device *ndev)
  739. {
  740. struct qtnf_pcie_bus_priv *priv = (void *)get_bus_priv(bus);
  741. tasklet_hi_schedule(&priv->reclaim_tq);
  742. }
  743. static void qtnf_pcie_data_rx_start(struct qtnf_bus *bus)
  744. {
  745. struct qtnf_pcie_bus_priv *priv = (void *)get_bus_priv(bus);
  746. qtnf_enable_hdp_irqs(priv);
  747. napi_enable(&bus->mux_napi);
  748. }
  749. static void qtnf_pcie_data_rx_stop(struct qtnf_bus *bus)
  750. {
  751. struct qtnf_pcie_bus_priv *priv = (void *)get_bus_priv(bus);
  752. napi_disable(&bus->mux_napi);
  753. qtnf_disable_hdp_irqs(priv);
  754. }
  755. static const struct qtnf_bus_ops qtnf_pcie_bus_ops = {
  756. /* control path methods */
  757. .control_tx = qtnf_pcie_control_tx,
  758. /* data path methods */
  759. .data_tx = qtnf_pcie_data_tx,
  760. .data_tx_timeout = qtnf_pcie_data_tx_timeout,
  761. .data_rx_start = qtnf_pcie_data_rx_start,
  762. .data_rx_stop = qtnf_pcie_data_rx_stop,
  763. };
  764. static int qtnf_dbg_mps_show(struct seq_file *s, void *data)
  765. {
  766. struct qtnf_bus *bus = dev_get_drvdata(s->private);
  767. struct qtnf_pcie_bus_priv *priv = get_bus_priv(bus);
  768. seq_printf(s, "%d\n", priv->mps);
  769. return 0;
  770. }
  771. static int qtnf_dbg_msi_show(struct seq_file *s, void *data)
  772. {
  773. struct qtnf_bus *bus = dev_get_drvdata(s->private);
  774. struct qtnf_pcie_bus_priv *priv = get_bus_priv(bus);
  775. seq_printf(s, "%u\n", priv->msi_enabled);
  776. return 0;
  777. }
  778. static int qtnf_dbg_irq_stats(struct seq_file *s, void *data)
  779. {
  780. struct qtnf_bus *bus = dev_get_drvdata(s->private);
  781. struct qtnf_pcie_bus_priv *priv = get_bus_priv(bus);
  782. u32 reg = readl(PCIE_HDP_INT_EN(priv->pcie_reg_base));
  783. u32 status;
  784. seq_printf(s, "pcie_irq_count(%u)\n", priv->pcie_irq_count);
  785. seq_printf(s, "pcie_irq_tx_count(%u)\n", priv->pcie_irq_tx_count);
  786. status = reg & PCIE_HDP_INT_TX_BITS;
  787. seq_printf(s, "pcie_irq_tx_status(%s)\n",
  788. (status == PCIE_HDP_INT_TX_BITS) ? "EN" : "DIS");
  789. seq_printf(s, "pcie_irq_rx_count(%u)\n", priv->pcie_irq_rx_count);
  790. status = reg & PCIE_HDP_INT_RX_BITS;
  791. seq_printf(s, "pcie_irq_rx_status(%s)\n",
  792. (status == PCIE_HDP_INT_RX_BITS) ? "EN" : "DIS");
  793. seq_printf(s, "pcie_irq_uf_count(%u)\n", priv->pcie_irq_uf_count);
  794. status = reg & PCIE_HDP_INT_HHBM_UF;
  795. seq_printf(s, "pcie_irq_hhbm_uf_status(%s)\n",
  796. (status == PCIE_HDP_INT_HHBM_UF) ? "EN" : "DIS");
  797. return 0;
  798. }
  799. static int qtnf_dbg_hdp_stats(struct seq_file *s, void *data)
  800. {
  801. struct qtnf_bus *bus = dev_get_drvdata(s->private);
  802. struct qtnf_pcie_bus_priv *priv = get_bus_priv(bus);
  803. seq_printf(s, "tx_full_count(%u)\n", priv->tx_full_count);
  804. seq_printf(s, "tx_done_count(%u)\n", priv->tx_done_count);
  805. seq_printf(s, "tx_reclaim_done(%u)\n", priv->tx_reclaim_done);
  806. seq_printf(s, "tx_reclaim_req(%u)\n", priv->tx_reclaim_req);
  807. seq_printf(s, "tx_bd_r_index(%u)\n", priv->tx_bd_r_index);
  808. seq_printf(s, "tx_bd_p_index(%u)\n",
  809. readl(PCIE_HDP_RX0DMA_CNT(priv->pcie_reg_base))
  810. & (priv->tx_bd_num - 1));
  811. seq_printf(s, "tx_bd_w_index(%u)\n", priv->tx_bd_w_index);
  812. seq_printf(s, "tx queue len(%u)\n",
  813. CIRC_CNT(priv->tx_bd_w_index, priv->tx_bd_r_index,
  814. priv->tx_bd_num));
  815. seq_printf(s, "rx_bd_r_index(%u)\n", priv->rx_bd_r_index);
  816. seq_printf(s, "rx_bd_p_index(%u)\n",
  817. readl(PCIE_HDP_TX0DMA_CNT(priv->pcie_reg_base))
  818. & (priv->rx_bd_num - 1));
  819. seq_printf(s, "rx_bd_w_index(%u)\n", priv->rx_bd_w_index);
  820. seq_printf(s, "rx alloc queue len(%u)\n",
  821. CIRC_SPACE(priv->rx_bd_w_index, priv->rx_bd_r_index,
  822. priv->rx_bd_num));
  823. return 0;
  824. }
  825. static int qtnf_dbg_shm_stats(struct seq_file *s, void *data)
  826. {
  827. struct qtnf_bus *bus = dev_get_drvdata(s->private);
  828. struct qtnf_pcie_bus_priv *priv = get_bus_priv(bus);
  829. seq_printf(s, "shm_ipc_ep_in.tx_packet_count(%zu)\n",
  830. priv->shm_ipc_ep_in.tx_packet_count);
  831. seq_printf(s, "shm_ipc_ep_in.rx_packet_count(%zu)\n",
  832. priv->shm_ipc_ep_in.rx_packet_count);
  833. seq_printf(s, "shm_ipc_ep_out.tx_packet_count(%zu)\n",
  834. priv->shm_ipc_ep_out.tx_timeout_count);
  835. seq_printf(s, "shm_ipc_ep_out.rx_packet_count(%zu)\n",
  836. priv->shm_ipc_ep_out.rx_packet_count);
  837. return 0;
  838. }
  839. static int qtnf_ep_fw_send(struct qtnf_pcie_bus_priv *priv, uint32_t size,
  840. int blk, const u8 *pblk, const u8 *fw)
  841. {
  842. struct pci_dev *pdev = priv->pdev;
  843. struct qtnf_bus *bus = pci_get_drvdata(pdev);
  844. struct qtnf_pcie_fw_hdr *hdr;
  845. u8 *pdata;
  846. int hds = sizeof(*hdr);
  847. struct sk_buff *skb = NULL;
  848. int len = 0;
  849. int ret;
  850. skb = __dev_alloc_skb(QTN_PCIE_FW_BUFSZ, GFP_KERNEL);
  851. if (!skb)
  852. return -ENOMEM;
  853. skb->len = QTN_PCIE_FW_BUFSZ;
  854. skb->dev = NULL;
  855. hdr = (struct qtnf_pcie_fw_hdr *)skb->data;
  856. memcpy(hdr->boardflg, QTN_PCIE_BOARDFLG, strlen(QTN_PCIE_BOARDFLG));
  857. hdr->fwsize = cpu_to_le32(size);
  858. hdr->seqnum = cpu_to_le32(blk);
  859. if (blk)
  860. hdr->type = cpu_to_le32(QTN_FW_DSUB);
  861. else
  862. hdr->type = cpu_to_le32(QTN_FW_DBEGIN);
  863. pdata = skb->data + hds;
  864. len = QTN_PCIE_FW_BUFSZ - hds;
  865. if (pblk >= (fw + size - len)) {
  866. len = fw + size - pblk;
  867. hdr->type = cpu_to_le32(QTN_FW_DEND);
  868. }
  869. hdr->pktlen = cpu_to_le32(len);
  870. memcpy(pdata, pblk, len);
  871. hdr->crc = cpu_to_le32(~crc32(0, pdata, len));
  872. ret = qtnf_pcie_data_tx(bus, skb);
  873. return (ret == NETDEV_TX_OK) ? len : 0;
  874. }
  875. static int
  876. qtnf_ep_fw_load(struct qtnf_pcie_bus_priv *priv, const u8 *fw, u32 fw_size)
  877. {
  878. int blk_size = QTN_PCIE_FW_BUFSZ - sizeof(struct qtnf_pcie_fw_hdr);
  879. int blk_count = fw_size / blk_size + ((fw_size % blk_size) ? 1 : 0);
  880. const u8 *pblk = fw;
  881. int threshold = 0;
  882. int blk = 0;
  883. int len;
  884. pr_debug("FW upload started: fw_addr=0x%p size=%d\n", fw, fw_size);
  885. while (blk < blk_count) {
  886. if (++threshold > 10000) {
  887. pr_err("FW upload failed: too many retries\n");
  888. return -ETIMEDOUT;
  889. }
  890. len = qtnf_ep_fw_send(priv, fw_size, blk, pblk, fw);
  891. if (len <= 0)
  892. continue;
  893. if (!((blk + 1) & QTN_PCIE_FW_DLMASK) ||
  894. (blk == (blk_count - 1))) {
  895. qtnf_set_state(&priv->bda->bda_rc_state,
  896. QTN_RC_FW_SYNC);
  897. if (qtnf_poll_state(&priv->bda->bda_ep_state,
  898. QTN_EP_FW_SYNC,
  899. QTN_FW_DL_TIMEOUT_MS)) {
  900. pr_err("FW upload failed: SYNC timed out\n");
  901. return -ETIMEDOUT;
  902. }
  903. qtnf_clear_state(&priv->bda->bda_ep_state,
  904. QTN_EP_FW_SYNC);
  905. if (qtnf_is_state(&priv->bda->bda_ep_state,
  906. QTN_EP_FW_RETRY)) {
  907. if (blk == (blk_count - 1)) {
  908. int last_round =
  909. blk_count & QTN_PCIE_FW_DLMASK;
  910. blk -= last_round;
  911. pblk -= ((last_round - 1) *
  912. blk_size + len);
  913. } else {
  914. blk -= QTN_PCIE_FW_DLMASK;
  915. pblk -= QTN_PCIE_FW_DLMASK * blk_size;
  916. }
  917. qtnf_clear_state(&priv->bda->bda_ep_state,
  918. QTN_EP_FW_RETRY);
  919. pr_warn("FW upload retry: block #%d\n", blk);
  920. continue;
  921. }
  922. qtnf_pcie_data_tx_reclaim(priv);
  923. }
  924. pblk += len;
  925. blk++;
  926. }
  927. pr_debug("FW upload completed: totally sent %d blocks\n", blk);
  928. return 0;
  929. }
  930. static void qtnf_fw_work_handler(struct work_struct *work)
  931. {
  932. struct qtnf_bus *bus = container_of(work, struct qtnf_bus, fw_work);
  933. struct qtnf_pcie_bus_priv *priv = (void *)get_bus_priv(bus);
  934. struct pci_dev *pdev = priv->pdev;
  935. const struct firmware *fw;
  936. int ret;
  937. u32 state = QTN_RC_FW_LOADRDY | QTN_RC_FW_QLINK;
  938. if (flashboot) {
  939. state |= QTN_RC_FW_FLASHBOOT;
  940. } else {
  941. ret = request_firmware(&fw, bus->fwname, &pdev->dev);
  942. if (ret < 0) {
  943. pr_err("failed to get firmware %s\n", bus->fwname);
  944. goto fw_load_fail;
  945. }
  946. }
  947. qtnf_set_state(&priv->bda->bda_rc_state, state);
  948. if (qtnf_poll_state(&priv->bda->bda_ep_state, QTN_EP_FW_LOADRDY,
  949. QTN_FW_DL_TIMEOUT_MS)) {
  950. pr_err("card is not ready\n");
  951. if (!flashboot)
  952. release_firmware(fw);
  953. goto fw_load_fail;
  954. }
  955. qtnf_clear_state(&priv->bda->bda_ep_state, QTN_EP_FW_LOADRDY);
  956. if (flashboot) {
  957. pr_info("booting firmware from flash\n");
  958. } else {
  959. pr_info("starting firmware upload: %s\n", bus->fwname);
  960. ret = qtnf_ep_fw_load(priv, fw->data, fw->size);
  961. release_firmware(fw);
  962. if (ret) {
  963. pr_err("firmware upload error\n");
  964. goto fw_load_fail;
  965. }
  966. }
  967. if (qtnf_poll_state(&priv->bda->bda_ep_state, QTN_EP_FW_DONE,
  968. QTN_FW_DL_TIMEOUT_MS)) {
  969. pr_err("firmware bringup timed out\n");
  970. goto fw_load_fail;
  971. }
  972. bus->fw_state = QTNF_FW_STATE_FW_DNLD_DONE;
  973. pr_info("firmware is up and running\n");
  974. if (qtnf_poll_state(&priv->bda->bda_ep_state,
  975. QTN_EP_FW_QLINK_DONE, QTN_FW_QLINK_TIMEOUT_MS)) {
  976. pr_err("firmware runtime failure\n");
  977. goto fw_load_fail;
  978. }
  979. ret = qtnf_core_attach(bus);
  980. if (ret) {
  981. pr_err("failed to attach core\n");
  982. goto fw_load_fail;
  983. }
  984. qtnf_debugfs_init(bus, DRV_NAME);
  985. qtnf_debugfs_add_entry(bus, "mps", qtnf_dbg_mps_show);
  986. qtnf_debugfs_add_entry(bus, "msi_enabled", qtnf_dbg_msi_show);
  987. qtnf_debugfs_add_entry(bus, "hdp_stats", qtnf_dbg_hdp_stats);
  988. qtnf_debugfs_add_entry(bus, "irq_stats", qtnf_dbg_irq_stats);
  989. qtnf_debugfs_add_entry(bus, "shm_stats", qtnf_dbg_shm_stats);
  990. goto fw_load_exit;
  991. fw_load_fail:
  992. bus->fw_state = QTNF_FW_STATE_DETACHED;
  993. fw_load_exit:
  994. complete(&bus->firmware_init_complete);
  995. put_device(&pdev->dev);
  996. }
  997. static void qtnf_bringup_fw_async(struct qtnf_bus *bus)
  998. {
  999. struct qtnf_pcie_bus_priv *priv = (void *)get_bus_priv(bus);
  1000. struct pci_dev *pdev = priv->pdev;
  1001. get_device(&pdev->dev);
  1002. INIT_WORK(&bus->fw_work, qtnf_fw_work_handler);
  1003. schedule_work(&bus->fw_work);
  1004. }
  1005. static void qtnf_reclaim_tasklet_fn(unsigned long data)
  1006. {
  1007. struct qtnf_pcie_bus_priv *priv = (void *)data;
  1008. qtnf_pcie_data_tx_reclaim(priv);
  1009. qtnf_en_txdone_irq(priv);
  1010. }
  1011. static int qtnf_pcie_probe(struct pci_dev *pdev, const struct pci_device_id *id)
  1012. {
  1013. struct qtnf_pcie_bus_priv *pcie_priv;
  1014. struct qtnf_bus *bus;
  1015. int ret;
  1016. bus = devm_kzalloc(&pdev->dev,
  1017. sizeof(*bus) + sizeof(*pcie_priv), GFP_KERNEL);
  1018. if (!bus)
  1019. return -ENOMEM;
  1020. pcie_priv = get_bus_priv(bus);
  1021. pci_set_drvdata(pdev, bus);
  1022. bus->bus_ops = &qtnf_pcie_bus_ops;
  1023. bus->dev = &pdev->dev;
  1024. bus->fw_state = QTNF_FW_STATE_RESET;
  1025. pcie_priv->pdev = pdev;
  1026. strcpy(bus->fwname, QTN_PCI_PEARL_FW_NAME);
  1027. init_completion(&bus->firmware_init_complete);
  1028. mutex_init(&bus->bus_lock);
  1029. spin_lock_init(&pcie_priv->tx0_lock);
  1030. spin_lock_init(&pcie_priv->irq_lock);
  1031. spin_lock_init(&pcie_priv->tx_reclaim_lock);
  1032. /* init stats */
  1033. pcie_priv->tx_full_count = 0;
  1034. pcie_priv->tx_done_count = 0;
  1035. pcie_priv->pcie_irq_count = 0;
  1036. pcie_priv->pcie_irq_rx_count = 0;
  1037. pcie_priv->pcie_irq_tx_count = 0;
  1038. pcie_priv->pcie_irq_uf_count = 0;
  1039. pcie_priv->tx_reclaim_done = 0;
  1040. pcie_priv->tx_reclaim_req = 0;
  1041. tasklet_init(&pcie_priv->reclaim_tq, qtnf_reclaim_tasklet_fn,
  1042. (unsigned long)pcie_priv);
  1043. init_dummy_netdev(&bus->mux_dev);
  1044. netif_napi_add(&bus->mux_dev, &bus->mux_napi,
  1045. qtnf_rx_poll, 10);
  1046. pcie_priv->workqueue = create_singlethread_workqueue("QTNF_PEARL_PCIE");
  1047. if (!pcie_priv->workqueue) {
  1048. pr_err("failed to alloc bus workqueue\n");
  1049. ret = -ENODEV;
  1050. goto err_init;
  1051. }
  1052. if (!pci_is_pcie(pdev)) {
  1053. pr_err("device %s is not PCI Express\n", pci_name(pdev));
  1054. ret = -EIO;
  1055. goto err_base;
  1056. }
  1057. qtnf_tune_pcie_mps(pcie_priv);
  1058. ret = pcim_enable_device(pdev);
  1059. if (ret) {
  1060. pr_err("failed to init PCI device %x\n", pdev->device);
  1061. goto err_base;
  1062. } else {
  1063. pr_debug("successful init of PCI device %x\n", pdev->device);
  1064. }
  1065. #ifdef CONFIG_ARCH_DMA_ADDR_T_64BIT
  1066. ret = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(64));
  1067. #else
  1068. ret = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(32));
  1069. #endif
  1070. if (ret) {
  1071. pr_err("PCIE DMA coherent mask init failed\n");
  1072. goto err_base;
  1073. }
  1074. pci_set_master(pdev);
  1075. qtnf_pcie_init_irq(pcie_priv);
  1076. ret = qtnf_pcie_init_memory(pcie_priv);
  1077. if (ret < 0) {
  1078. pr_err("PCIE memory init failed\n");
  1079. goto err_base;
  1080. }
  1081. pci_save_state(pdev);
  1082. ret = qtnf_pcie_init_shm_ipc(pcie_priv);
  1083. if (ret < 0) {
  1084. pr_err("PCIE SHM IPC init failed\n");
  1085. goto err_base;
  1086. }
  1087. ret = qtnf_pcie_init_xfer(pcie_priv);
  1088. if (ret) {
  1089. pr_err("PCIE xfer init failed\n");
  1090. goto err_ipc;
  1091. }
  1092. /* init default irq settings */
  1093. qtnf_init_hdp_irqs(pcie_priv);
  1094. /* start with disabled irqs */
  1095. qtnf_disable_hdp_irqs(pcie_priv);
  1096. ret = devm_request_irq(&pdev->dev, pdev->irq, &qtnf_interrupt, 0,
  1097. "qtnf_pcie_irq", (void *)bus);
  1098. if (ret) {
  1099. pr_err("failed to request pcie irq %d\n", pdev->irq);
  1100. goto err_xfer;
  1101. }
  1102. qtnf_bringup_fw_async(bus);
  1103. return 0;
  1104. err_xfer:
  1105. qtnf_free_xfer_buffers(pcie_priv);
  1106. err_ipc:
  1107. qtnf_pcie_free_shm_ipc(pcie_priv);
  1108. err_base:
  1109. flush_workqueue(pcie_priv->workqueue);
  1110. destroy_workqueue(pcie_priv->workqueue);
  1111. netif_napi_del(&bus->mux_napi);
  1112. err_init:
  1113. tasklet_kill(&pcie_priv->reclaim_tq);
  1114. pci_set_drvdata(pdev, NULL);
  1115. return ret;
  1116. }
  1117. static void qtnf_pcie_remove(struct pci_dev *pdev)
  1118. {
  1119. struct qtnf_pcie_bus_priv *priv;
  1120. struct qtnf_bus *bus;
  1121. bus = pci_get_drvdata(pdev);
  1122. if (!bus)
  1123. return;
  1124. wait_for_completion(&bus->firmware_init_complete);
  1125. if (bus->fw_state == QTNF_FW_STATE_ACTIVE ||
  1126. bus->fw_state == QTNF_FW_STATE_EP_DEAD)
  1127. qtnf_core_detach(bus);
  1128. priv = get_bus_priv(bus);
  1129. netif_napi_del(&bus->mux_napi);
  1130. flush_workqueue(priv->workqueue);
  1131. destroy_workqueue(priv->workqueue);
  1132. tasklet_kill(&priv->reclaim_tq);
  1133. qtnf_free_xfer_buffers(priv);
  1134. qtnf_debugfs_remove(bus);
  1135. qtnf_pcie_free_shm_ipc(priv);
  1136. qtnf_reset_card(priv);
  1137. }
  1138. #ifdef CONFIG_PM_SLEEP
  1139. static int qtnf_pcie_suspend(struct device *dev)
  1140. {
  1141. return -EOPNOTSUPP;
  1142. }
  1143. static int qtnf_pcie_resume(struct device *dev)
  1144. {
  1145. return 0;
  1146. }
  1147. #endif /* CONFIG_PM_SLEEP */
  1148. #ifdef CONFIG_PM_SLEEP
  1149. /* Power Management Hooks */
  1150. static SIMPLE_DEV_PM_OPS(qtnf_pcie_pm_ops, qtnf_pcie_suspend,
  1151. qtnf_pcie_resume);
  1152. #endif
  1153. static const struct pci_device_id qtnf_pcie_devid_table[] = {
  1154. {
  1155. PCIE_VENDOR_ID_QUANTENNA, PCIE_DEVICE_ID_QTN_PEARL,
  1156. PCI_ANY_ID, PCI_ANY_ID, 0, 0,
  1157. },
  1158. { },
  1159. };
  1160. MODULE_DEVICE_TABLE(pci, qtnf_pcie_devid_table);
  1161. static struct pci_driver qtnf_pcie_drv_data = {
  1162. .name = DRV_NAME,
  1163. .id_table = qtnf_pcie_devid_table,
  1164. .probe = qtnf_pcie_probe,
  1165. .remove = qtnf_pcie_remove,
  1166. #ifdef CONFIG_PM_SLEEP
  1167. .driver = {
  1168. .pm = &qtnf_pcie_pm_ops,
  1169. },
  1170. #endif
  1171. };
  1172. static int __init qtnf_pcie_register(void)
  1173. {
  1174. pr_info("register Quantenna QSR10g FullMAC PCIE driver\n");
  1175. return pci_register_driver(&qtnf_pcie_drv_data);
  1176. }
  1177. static void __exit qtnf_pcie_exit(void)
  1178. {
  1179. pr_info("unregister Quantenna QSR10g FullMAC PCIE driver\n");
  1180. pci_unregister_driver(&qtnf_pcie_drv_data);
  1181. }
  1182. module_init(qtnf_pcie_register);
  1183. module_exit(qtnf_pcie_exit);
  1184. MODULE_AUTHOR("Quantenna Communications");
  1185. MODULE_DESCRIPTION("Quantenna QSR10g PCIe bus driver for 802.11 wireless LAN.");
  1186. MODULE_LICENSE("GPL");