eq.c 17 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659
  1. /*
  2. * Copyright (c) 2005 Mellanox Technologies. All rights reserved.
  3. * Copyright (c) 2005, 2006, 2007 Cisco Systems, Inc. All rights reserved.
  4. *
  5. * This software is available to you under a choice of one of two
  6. * licenses. You may choose to be licensed under the terms of the GNU
  7. * General Public License (GPL) Version 2, available from the file
  8. * COPYING in the main directory of this source tree, or the
  9. * OpenIB.org BSD license below:
  10. *
  11. * Redistribution and use in source and binary forms, with or
  12. * without modification, are permitted provided that the following
  13. * conditions are met:
  14. *
  15. * - Redistributions of source code must retain the above
  16. * copyright notice, this list of conditions and the following
  17. * disclaimer.
  18. *
  19. * - Redistributions in binary form must reproduce the above
  20. * copyright notice, this list of conditions and the following
  21. * disclaimer in the documentation and/or other materials
  22. * provided with the distribution.
  23. *
  24. * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
  25. * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
  26. * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
  27. * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
  28. * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
  29. * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
  30. * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
  31. * SOFTWARE.
  32. */
  33. #include <linux/init.h>
  34. #include <linux/interrupt.h>
  35. #include <linux/dma-mapping.h>
  36. #include <linux/mlx4/cmd.h>
  37. #include "mlx4.h"
  38. #include "fw.h"
  39. enum {
  40. MLX4_NUM_ASYNC_EQE = 0x100,
  41. MLX4_NUM_SPARE_EQE = 0x80,
  42. MLX4_EQ_ENTRY_SIZE = 0x20
  43. };
  44. /*
  45. * Must be packed because start is 64 bits but only aligned to 32 bits.
  46. */
  47. struct mlx4_eq_context {
  48. __be32 flags;
  49. u16 reserved1[3];
  50. __be16 page_offset;
  51. u8 log_eq_size;
  52. u8 reserved2[4];
  53. u8 eq_period;
  54. u8 reserved3;
  55. u8 eq_max_count;
  56. u8 reserved4[3];
  57. u8 intr;
  58. u8 log_page_size;
  59. u8 reserved5[2];
  60. u8 mtt_base_addr_h;
  61. __be32 mtt_base_addr_l;
  62. u32 reserved6[2];
  63. __be32 consumer_index;
  64. __be32 producer_index;
  65. u32 reserved7[4];
  66. };
  67. #define MLX4_EQ_STATUS_OK ( 0 << 28)
  68. #define MLX4_EQ_STATUS_WRITE_FAIL (10 << 28)
  69. #define MLX4_EQ_OWNER_SW ( 0 << 24)
  70. #define MLX4_EQ_OWNER_HW ( 1 << 24)
  71. #define MLX4_EQ_FLAG_EC ( 1 << 18)
  72. #define MLX4_EQ_FLAG_OI ( 1 << 17)
  73. #define MLX4_EQ_STATE_ARMED ( 9 << 8)
  74. #define MLX4_EQ_STATE_FIRED (10 << 8)
  75. #define MLX4_EQ_STATE_ALWAYS_ARMED (11 << 8)
  76. #define MLX4_ASYNC_EVENT_MASK ((1ull << MLX4_EVENT_TYPE_PATH_MIG) | \
  77. (1ull << MLX4_EVENT_TYPE_COMM_EST) | \
  78. (1ull << MLX4_EVENT_TYPE_SQ_DRAINED) | \
  79. (1ull << MLX4_EVENT_TYPE_CQ_ERROR) | \
  80. (1ull << MLX4_EVENT_TYPE_WQ_CATAS_ERROR) | \
  81. (1ull << MLX4_EVENT_TYPE_EEC_CATAS_ERROR) | \
  82. (1ull << MLX4_EVENT_TYPE_PATH_MIG_FAILED) | \
  83. (1ull << MLX4_EVENT_TYPE_WQ_INVAL_REQ_ERROR) | \
  84. (1ull << MLX4_EVENT_TYPE_WQ_ACCESS_ERROR) | \
  85. (1ull << MLX4_EVENT_TYPE_PORT_CHANGE) | \
  86. (1ull << MLX4_EVENT_TYPE_ECC_DETECT) | \
  87. (1ull << MLX4_EVENT_TYPE_SRQ_CATAS_ERROR) | \
  88. (1ull << MLX4_EVENT_TYPE_SRQ_QP_LAST_WQE) | \
  89. (1ull << MLX4_EVENT_TYPE_SRQ_LIMIT) | \
  90. (1ull << MLX4_EVENT_TYPE_CMD))
  91. struct mlx4_eqe {
  92. u8 reserved1;
  93. u8 type;
  94. u8 reserved2;
  95. u8 subtype;
  96. union {
  97. u32 raw[6];
  98. struct {
  99. __be32 cqn;
  100. } __attribute__((packed)) comp;
  101. struct {
  102. u16 reserved1;
  103. __be16 token;
  104. u32 reserved2;
  105. u8 reserved3[3];
  106. u8 status;
  107. __be64 out_param;
  108. } __attribute__((packed)) cmd;
  109. struct {
  110. __be32 qpn;
  111. } __attribute__((packed)) qp;
  112. struct {
  113. __be32 srqn;
  114. } __attribute__((packed)) srq;
  115. struct {
  116. __be32 cqn;
  117. u32 reserved1;
  118. u8 reserved2[3];
  119. u8 syndrome;
  120. } __attribute__((packed)) cq_err;
  121. struct {
  122. u32 reserved1[2];
  123. __be32 port;
  124. } __attribute__((packed)) port_change;
  125. } event;
  126. u8 reserved3[3];
  127. u8 owner;
  128. } __attribute__((packed));
  129. static void eq_set_ci(struct mlx4_eq *eq, int req_not)
  130. {
  131. __raw_writel((__force u32) cpu_to_be32((eq->cons_index & 0xffffff) |
  132. req_not << 31),
  133. eq->doorbell);
  134. /* We still want ordering, just not swabbing, so add a barrier */
  135. mb();
  136. }
  137. static struct mlx4_eqe *get_eqe(struct mlx4_eq *eq, u32 entry)
  138. {
  139. unsigned long off = (entry & (eq->nent - 1)) * MLX4_EQ_ENTRY_SIZE;
  140. return eq->page_list[off / PAGE_SIZE].buf + off % PAGE_SIZE;
  141. }
  142. static struct mlx4_eqe *next_eqe_sw(struct mlx4_eq *eq)
  143. {
  144. struct mlx4_eqe *eqe = get_eqe(eq, eq->cons_index);
  145. return !!(eqe->owner & 0x80) ^ !!(eq->cons_index & eq->nent) ? NULL : eqe;
  146. }
  147. static int mlx4_eq_int(struct mlx4_dev *dev, struct mlx4_eq *eq)
  148. {
  149. struct mlx4_eqe *eqe;
  150. int cqn;
  151. int eqes_found = 0;
  152. int set_ci = 0;
  153. while ((eqe = next_eqe_sw(eq))) {
  154. /*
  155. * Make sure we read EQ entry contents after we've
  156. * checked the ownership bit.
  157. */
  158. rmb();
  159. switch (eqe->type) {
  160. case MLX4_EVENT_TYPE_COMP:
  161. cqn = be32_to_cpu(eqe->event.comp.cqn) & 0xffffff;
  162. mlx4_cq_completion(dev, cqn);
  163. break;
  164. case MLX4_EVENT_TYPE_PATH_MIG:
  165. case MLX4_EVENT_TYPE_COMM_EST:
  166. case MLX4_EVENT_TYPE_SQ_DRAINED:
  167. case MLX4_EVENT_TYPE_SRQ_QP_LAST_WQE:
  168. case MLX4_EVENT_TYPE_WQ_CATAS_ERROR:
  169. case MLX4_EVENT_TYPE_PATH_MIG_FAILED:
  170. case MLX4_EVENT_TYPE_WQ_INVAL_REQ_ERROR:
  171. case MLX4_EVENT_TYPE_WQ_ACCESS_ERROR:
  172. mlx4_qp_event(dev, be32_to_cpu(eqe->event.qp.qpn) & 0xffffff,
  173. eqe->type);
  174. break;
  175. case MLX4_EVENT_TYPE_SRQ_LIMIT:
  176. case MLX4_EVENT_TYPE_SRQ_CATAS_ERROR:
  177. mlx4_srq_event(dev, be32_to_cpu(eqe->event.srq.srqn) & 0xffffff,
  178. eqe->type);
  179. break;
  180. case MLX4_EVENT_TYPE_CMD:
  181. mlx4_cmd_event(dev,
  182. be16_to_cpu(eqe->event.cmd.token),
  183. eqe->event.cmd.status,
  184. be64_to_cpu(eqe->event.cmd.out_param));
  185. break;
  186. case MLX4_EVENT_TYPE_PORT_CHANGE:
  187. mlx4_dispatch_event(dev,
  188. eqe->subtype == MLX4_PORT_CHANGE_SUBTYPE_ACTIVE ?
  189. MLX4_DEV_EVENT_PORT_UP :
  190. MLX4_DEV_EVENT_PORT_DOWN,
  191. be32_to_cpu(eqe->event.port_change.port) >> 28);
  192. break;
  193. case MLX4_EVENT_TYPE_CQ_ERROR:
  194. mlx4_warn(dev, "CQ %s on CQN %06x\n",
  195. eqe->event.cq_err.syndrome == 1 ?
  196. "overrun" : "access violation",
  197. be32_to_cpu(eqe->event.cq_err.cqn) & 0xffffff);
  198. mlx4_cq_event(dev, be32_to_cpu(eqe->event.cq_err.cqn),
  199. eqe->type);
  200. break;
  201. case MLX4_EVENT_TYPE_EQ_OVERFLOW:
  202. mlx4_warn(dev, "EQ overrun on EQN %d\n", eq->eqn);
  203. break;
  204. case MLX4_EVENT_TYPE_EEC_CATAS_ERROR:
  205. case MLX4_EVENT_TYPE_ECC_DETECT:
  206. default:
  207. mlx4_warn(dev, "Unhandled event %02x(%02x) on EQ %d at index %u\n",
  208. eqe->type, eqe->subtype, eq->eqn, eq->cons_index);
  209. break;
  210. };
  211. ++eq->cons_index;
  212. eqes_found = 1;
  213. ++set_ci;
  214. /*
  215. * The HCA will think the queue has overflowed if we
  216. * don't tell it we've been processing events. We
  217. * create our EQs with MLX4_NUM_SPARE_EQE extra
  218. * entries, so we must update our consumer index at
  219. * least that often.
  220. */
  221. if (unlikely(set_ci >= MLX4_NUM_SPARE_EQE)) {
  222. /*
  223. * Conditional on hca_type is OK here because
  224. * this is a rare case, not the fast path.
  225. */
  226. eq_set_ci(eq, 0);
  227. set_ci = 0;
  228. }
  229. }
  230. eq_set_ci(eq, 1);
  231. return eqes_found;
  232. }
  233. static irqreturn_t mlx4_interrupt(int irq, void *dev_ptr)
  234. {
  235. struct mlx4_dev *dev = dev_ptr;
  236. struct mlx4_priv *priv = mlx4_priv(dev);
  237. int work = 0;
  238. int i;
  239. writel(priv->eq_table.clr_mask, priv->eq_table.clr_int);
  240. for (i = 0; i < MLX4_NUM_EQ; ++i)
  241. work |= mlx4_eq_int(dev, &priv->eq_table.eq[i]);
  242. return IRQ_RETVAL(work);
  243. }
  244. static irqreturn_t mlx4_msi_x_interrupt(int irq, void *eq_ptr)
  245. {
  246. struct mlx4_eq *eq = eq_ptr;
  247. struct mlx4_dev *dev = eq->dev;
  248. mlx4_eq_int(dev, eq);
  249. /* MSI-X vectors always belong to us */
  250. return IRQ_HANDLED;
  251. }
  252. static int mlx4_MAP_EQ(struct mlx4_dev *dev, u64 event_mask, int unmap,
  253. int eq_num)
  254. {
  255. return mlx4_cmd(dev, event_mask, (unmap << 31) | eq_num,
  256. 0, MLX4_CMD_MAP_EQ, MLX4_CMD_TIME_CLASS_B);
  257. }
  258. static int mlx4_SW2HW_EQ(struct mlx4_dev *dev, struct mlx4_cmd_mailbox *mailbox,
  259. int eq_num)
  260. {
  261. return mlx4_cmd(dev, mailbox->dma, eq_num, 0, MLX4_CMD_SW2HW_EQ,
  262. MLX4_CMD_TIME_CLASS_A);
  263. }
  264. static int mlx4_HW2SW_EQ(struct mlx4_dev *dev, struct mlx4_cmd_mailbox *mailbox,
  265. int eq_num)
  266. {
  267. return mlx4_cmd_box(dev, 0, mailbox->dma, eq_num, 0, MLX4_CMD_HW2SW_EQ,
  268. MLX4_CMD_TIME_CLASS_A);
  269. }
  270. static void __iomem *mlx4_get_eq_uar(struct mlx4_dev *dev, struct mlx4_eq *eq)
  271. {
  272. struct mlx4_priv *priv = mlx4_priv(dev);
  273. int index;
  274. index = eq->eqn / 4 - dev->caps.reserved_eqs / 4;
  275. if (!priv->eq_table.uar_map[index]) {
  276. priv->eq_table.uar_map[index] =
  277. ioremap(pci_resource_start(dev->pdev, 2) +
  278. ((eq->eqn / 4) << PAGE_SHIFT),
  279. PAGE_SIZE);
  280. if (!priv->eq_table.uar_map[index]) {
  281. mlx4_err(dev, "Couldn't map EQ doorbell for EQN 0x%06x\n",
  282. eq->eqn);
  283. return NULL;
  284. }
  285. }
  286. return priv->eq_table.uar_map[index] + 0x800 + 8 * (eq->eqn % 4);
  287. }
  288. static int mlx4_create_eq(struct mlx4_dev *dev, int nent,
  289. u8 intr, struct mlx4_eq *eq)
  290. {
  291. struct mlx4_priv *priv = mlx4_priv(dev);
  292. struct mlx4_cmd_mailbox *mailbox;
  293. struct mlx4_eq_context *eq_context;
  294. int npages;
  295. u64 *dma_list = NULL;
  296. dma_addr_t t;
  297. u64 mtt_addr;
  298. int err = -ENOMEM;
  299. int i;
  300. eq->dev = dev;
  301. eq->nent = roundup_pow_of_two(max(nent, 2));
  302. npages = PAGE_ALIGN(eq->nent * MLX4_EQ_ENTRY_SIZE) / PAGE_SIZE;
  303. eq->page_list = kmalloc(npages * sizeof *eq->page_list,
  304. GFP_KERNEL);
  305. if (!eq->page_list)
  306. goto err_out;
  307. for (i = 0; i < npages; ++i)
  308. eq->page_list[i].buf = NULL;
  309. dma_list = kmalloc(npages * sizeof *dma_list, GFP_KERNEL);
  310. if (!dma_list)
  311. goto err_out_free;
  312. mailbox = mlx4_alloc_cmd_mailbox(dev);
  313. if (IS_ERR(mailbox))
  314. goto err_out_free;
  315. eq_context = mailbox->buf;
  316. for (i = 0; i < npages; ++i) {
  317. eq->page_list[i].buf = dma_alloc_coherent(&dev->pdev->dev,
  318. PAGE_SIZE, &t, GFP_KERNEL);
  319. if (!eq->page_list[i].buf)
  320. goto err_out_free_pages;
  321. dma_list[i] = t;
  322. eq->page_list[i].map = t;
  323. memset(eq->page_list[i].buf, 0, PAGE_SIZE);
  324. }
  325. eq->eqn = mlx4_bitmap_alloc(&priv->eq_table.bitmap);
  326. if (eq->eqn == -1)
  327. goto err_out_free_pages;
  328. eq->doorbell = mlx4_get_eq_uar(dev, eq);
  329. if (!eq->doorbell) {
  330. err = -ENOMEM;
  331. goto err_out_free_eq;
  332. }
  333. err = mlx4_mtt_init(dev, npages, PAGE_SHIFT, &eq->mtt);
  334. if (err)
  335. goto err_out_free_eq;
  336. err = mlx4_write_mtt(dev, &eq->mtt, 0, npages, dma_list);
  337. if (err)
  338. goto err_out_free_mtt;
  339. memset(eq_context, 0, sizeof *eq_context);
  340. eq_context->flags = cpu_to_be32(MLX4_EQ_STATUS_OK |
  341. MLX4_EQ_STATE_ARMED);
  342. eq_context->log_eq_size = ilog2(eq->nent);
  343. eq_context->intr = intr;
  344. eq_context->log_page_size = PAGE_SHIFT - MLX4_ICM_PAGE_SHIFT;
  345. mtt_addr = mlx4_mtt_addr(dev, &eq->mtt);
  346. eq_context->mtt_base_addr_h = mtt_addr >> 32;
  347. eq_context->mtt_base_addr_l = cpu_to_be32(mtt_addr & 0xffffffff);
  348. err = mlx4_SW2HW_EQ(dev, mailbox, eq->eqn);
  349. if (err) {
  350. mlx4_warn(dev, "SW2HW_EQ failed (%d)\n", err);
  351. goto err_out_free_mtt;
  352. }
  353. kfree(dma_list);
  354. mlx4_free_cmd_mailbox(dev, mailbox);
  355. eq->cons_index = 0;
  356. return err;
  357. err_out_free_mtt:
  358. mlx4_mtt_cleanup(dev, &eq->mtt);
  359. err_out_free_eq:
  360. mlx4_bitmap_free(&priv->eq_table.bitmap, eq->eqn);
  361. err_out_free_pages:
  362. for (i = 0; i < npages; ++i)
  363. if (eq->page_list[i].buf)
  364. dma_free_coherent(&dev->pdev->dev, PAGE_SIZE,
  365. eq->page_list[i].buf,
  366. eq->page_list[i].map);
  367. mlx4_free_cmd_mailbox(dev, mailbox);
  368. err_out_free:
  369. kfree(eq->page_list);
  370. kfree(dma_list);
  371. err_out:
  372. return err;
  373. }
  374. static void mlx4_free_eq(struct mlx4_dev *dev,
  375. struct mlx4_eq *eq)
  376. {
  377. struct mlx4_priv *priv = mlx4_priv(dev);
  378. struct mlx4_cmd_mailbox *mailbox;
  379. int err;
  380. int npages = PAGE_ALIGN(MLX4_EQ_ENTRY_SIZE * eq->nent) / PAGE_SIZE;
  381. int i;
  382. mailbox = mlx4_alloc_cmd_mailbox(dev);
  383. if (IS_ERR(mailbox))
  384. return;
  385. err = mlx4_HW2SW_EQ(dev, mailbox, eq->eqn);
  386. if (err)
  387. mlx4_warn(dev, "HW2SW_EQ failed (%d)\n", err);
  388. if (0) {
  389. mlx4_dbg(dev, "Dumping EQ context %02x:\n", eq->eqn);
  390. for (i = 0; i < sizeof (struct mlx4_eq_context) / 4; ++i) {
  391. if (i % 4 == 0)
  392. printk("[%02x] ", i * 4);
  393. printk(" %08x", be32_to_cpup(mailbox->buf + i * 4));
  394. if ((i + 1) % 4 == 0)
  395. printk("\n");
  396. }
  397. }
  398. mlx4_mtt_cleanup(dev, &eq->mtt);
  399. for (i = 0; i < npages; ++i)
  400. pci_free_consistent(dev->pdev, PAGE_SIZE,
  401. eq->page_list[i].buf,
  402. eq->page_list[i].map);
  403. kfree(eq->page_list);
  404. mlx4_bitmap_free(&priv->eq_table.bitmap, eq->eqn);
  405. mlx4_free_cmd_mailbox(dev, mailbox);
  406. }
  407. static void mlx4_free_irqs(struct mlx4_dev *dev)
  408. {
  409. struct mlx4_eq_table *eq_table = &mlx4_priv(dev)->eq_table;
  410. int i;
  411. if (eq_table->have_irq)
  412. free_irq(dev->pdev->irq, dev);
  413. for (i = 0; i < MLX4_NUM_EQ; ++i)
  414. if (eq_table->eq[i].have_irq)
  415. free_irq(eq_table->eq[i].irq, eq_table->eq + i);
  416. }
  417. static int mlx4_map_clr_int(struct mlx4_dev *dev)
  418. {
  419. struct mlx4_priv *priv = mlx4_priv(dev);
  420. priv->clr_base = ioremap(pci_resource_start(dev->pdev, priv->fw.clr_int_bar) +
  421. priv->fw.clr_int_base, MLX4_CLR_INT_SIZE);
  422. if (!priv->clr_base) {
  423. mlx4_err(dev, "Couldn't map interrupt clear register, aborting.\n");
  424. return -ENOMEM;
  425. }
  426. return 0;
  427. }
  428. static void mlx4_unmap_clr_int(struct mlx4_dev *dev)
  429. {
  430. struct mlx4_priv *priv = mlx4_priv(dev);
  431. iounmap(priv->clr_base);
  432. }
  433. int mlx4_map_eq_icm(struct mlx4_dev *dev, u64 icm_virt)
  434. {
  435. struct mlx4_priv *priv = mlx4_priv(dev);
  436. int ret;
  437. /*
  438. * We assume that mapping one page is enough for the whole EQ
  439. * context table. This is fine with all current HCAs, because
  440. * we only use 32 EQs and each EQ uses 64 bytes of context
  441. * memory, or 1 KB total.
  442. */
  443. priv->eq_table.icm_virt = icm_virt;
  444. priv->eq_table.icm_page = alloc_page(GFP_HIGHUSER);
  445. if (!priv->eq_table.icm_page)
  446. return -ENOMEM;
  447. priv->eq_table.icm_dma = pci_map_page(dev->pdev, priv->eq_table.icm_page, 0,
  448. PAGE_SIZE, PCI_DMA_BIDIRECTIONAL);
  449. if (pci_dma_mapping_error(priv->eq_table.icm_dma)) {
  450. __free_page(priv->eq_table.icm_page);
  451. return -ENOMEM;
  452. }
  453. ret = mlx4_MAP_ICM_page(dev, priv->eq_table.icm_dma, icm_virt);
  454. if (ret) {
  455. pci_unmap_page(dev->pdev, priv->eq_table.icm_dma, PAGE_SIZE,
  456. PCI_DMA_BIDIRECTIONAL);
  457. __free_page(priv->eq_table.icm_page);
  458. }
  459. return ret;
  460. }
  461. void mlx4_unmap_eq_icm(struct mlx4_dev *dev)
  462. {
  463. struct mlx4_priv *priv = mlx4_priv(dev);
  464. mlx4_UNMAP_ICM(dev, priv->eq_table.icm_virt, 1);
  465. pci_unmap_page(dev->pdev, priv->eq_table.icm_dma, PAGE_SIZE,
  466. PCI_DMA_BIDIRECTIONAL);
  467. __free_page(priv->eq_table.icm_page);
  468. }
  469. int mlx4_init_eq_table(struct mlx4_dev *dev)
  470. {
  471. struct mlx4_priv *priv = mlx4_priv(dev);
  472. int err;
  473. int i;
  474. err = mlx4_bitmap_init(&priv->eq_table.bitmap, dev->caps.num_eqs,
  475. dev->caps.num_eqs - 1, dev->caps.reserved_eqs);
  476. if (err)
  477. return err;
  478. for (i = 0; i < ARRAY_SIZE(priv->eq_table.uar_map); ++i)
  479. priv->eq_table.uar_map[i] = NULL;
  480. err = mlx4_map_clr_int(dev);
  481. if (err)
  482. goto err_out_free;
  483. priv->eq_table.clr_mask =
  484. swab32(1 << (priv->eq_table.inta_pin & 31));
  485. priv->eq_table.clr_int = priv->clr_base +
  486. (priv->eq_table.inta_pin < 32 ? 4 : 0);
  487. err = mlx4_create_eq(dev, dev->caps.num_cqs + MLX4_NUM_SPARE_EQE,
  488. (dev->flags & MLX4_FLAG_MSI_X) ? MLX4_EQ_COMP : 0,
  489. &priv->eq_table.eq[MLX4_EQ_COMP]);
  490. if (err)
  491. goto err_out_unmap;
  492. err = mlx4_create_eq(dev, MLX4_NUM_ASYNC_EQE + MLX4_NUM_SPARE_EQE,
  493. (dev->flags & MLX4_FLAG_MSI_X) ? MLX4_EQ_ASYNC : 0,
  494. &priv->eq_table.eq[MLX4_EQ_ASYNC]);
  495. if (err)
  496. goto err_out_comp;
  497. if (dev->flags & MLX4_FLAG_MSI_X) {
  498. static const char *eq_name[] = {
  499. [MLX4_EQ_COMP] = DRV_NAME " (comp)",
  500. [MLX4_EQ_ASYNC] = DRV_NAME " (async)"
  501. };
  502. for (i = 0; i < MLX4_NUM_EQ; ++i) {
  503. err = request_irq(priv->eq_table.eq[i].irq,
  504. mlx4_msi_x_interrupt,
  505. 0, eq_name[i], priv->eq_table.eq + i);
  506. if (err)
  507. goto err_out_async;
  508. priv->eq_table.eq[i].have_irq = 1;
  509. }
  510. } else {
  511. err = request_irq(dev->pdev->irq, mlx4_interrupt,
  512. IRQF_SHARED, DRV_NAME, dev);
  513. if (err)
  514. goto err_out_async;
  515. priv->eq_table.have_irq = 1;
  516. }
  517. err = mlx4_MAP_EQ(dev, MLX4_ASYNC_EVENT_MASK, 0,
  518. priv->eq_table.eq[MLX4_EQ_ASYNC].eqn);
  519. if (err)
  520. mlx4_warn(dev, "MAP_EQ for async EQ %d failed (%d)\n",
  521. priv->eq_table.eq[MLX4_EQ_ASYNC].eqn, err);
  522. for (i = 0; i < MLX4_NUM_EQ; ++i)
  523. eq_set_ci(&priv->eq_table.eq[i], 1);
  524. return 0;
  525. err_out_async:
  526. mlx4_free_eq(dev, &priv->eq_table.eq[MLX4_EQ_ASYNC]);
  527. err_out_comp:
  528. mlx4_free_eq(dev, &priv->eq_table.eq[MLX4_EQ_COMP]);
  529. err_out_unmap:
  530. mlx4_unmap_clr_int(dev);
  531. mlx4_free_irqs(dev);
  532. err_out_free:
  533. mlx4_bitmap_cleanup(&priv->eq_table.bitmap);
  534. return err;
  535. }
  536. void mlx4_cleanup_eq_table(struct mlx4_dev *dev)
  537. {
  538. struct mlx4_priv *priv = mlx4_priv(dev);
  539. int i;
  540. mlx4_MAP_EQ(dev, MLX4_ASYNC_EVENT_MASK, 1,
  541. priv->eq_table.eq[MLX4_EQ_ASYNC].eqn);
  542. mlx4_free_irqs(dev);
  543. for (i = 0; i < MLX4_NUM_EQ; ++i)
  544. mlx4_free_eq(dev, &priv->eq_table.eq[i]);
  545. mlx4_unmap_clr_int(dev);
  546. for (i = 0; i < ARRAY_SIZE(priv->eq_table.uar_map); ++i)
  547. if (priv->eq_table.uar_map[i])
  548. iounmap(priv->eq_table.uar_map[i]);
  549. mlx4_bitmap_cleanup(&priv->eq_table.bitmap);
  550. }