eq.c 17 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657
  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, eqe->type, eqe->subtype,
  188. be32_to_cpu(eqe->event.port_change.port) >> 28);
  189. break;
  190. case MLX4_EVENT_TYPE_CQ_ERROR:
  191. mlx4_warn(dev, "CQ %s on CQN %06x\n",
  192. eqe->event.cq_err.syndrome == 1 ?
  193. "overrun" : "access violation",
  194. be32_to_cpu(eqe->event.cq_err.cqn) & 0xffffff);
  195. mlx4_cq_event(dev, be32_to_cpu(eqe->event.cq_err.cqn),
  196. eqe->type);
  197. break;
  198. case MLX4_EVENT_TYPE_EQ_OVERFLOW:
  199. mlx4_warn(dev, "EQ overrun on EQN %d\n", eq->eqn);
  200. break;
  201. case MLX4_EVENT_TYPE_EEC_CATAS_ERROR:
  202. case MLX4_EVENT_TYPE_ECC_DETECT:
  203. default:
  204. mlx4_warn(dev, "Unhandled event %02x(%02x) on EQ %d at index %u\n",
  205. eqe->type, eqe->subtype, eq->eqn, eq->cons_index);
  206. break;
  207. };
  208. ++eq->cons_index;
  209. eqes_found = 1;
  210. ++set_ci;
  211. /*
  212. * The HCA will think the queue has overflowed if we
  213. * don't tell it we've been processing events. We
  214. * create our EQs with MLX4_NUM_SPARE_EQE extra
  215. * entries, so we must update our consumer index at
  216. * least that often.
  217. */
  218. if (unlikely(set_ci >= MLX4_NUM_SPARE_EQE)) {
  219. /*
  220. * Conditional on hca_type is OK here because
  221. * this is a rare case, not the fast path.
  222. */
  223. eq_set_ci(eq, 0);
  224. set_ci = 0;
  225. }
  226. }
  227. eq_set_ci(eq, 1);
  228. return eqes_found;
  229. }
  230. static irqreturn_t mlx4_interrupt(int irq, void *dev_ptr)
  231. {
  232. struct mlx4_dev *dev = dev_ptr;
  233. struct mlx4_priv *priv = mlx4_priv(dev);
  234. int work = 0;
  235. int i;
  236. writel(priv->eq_table.clr_mask, priv->eq_table.clr_int);
  237. for (i = 0; i < MLX4_NUM_EQ; ++i)
  238. work |= mlx4_eq_int(dev, &priv->eq_table.eq[i]);
  239. return IRQ_RETVAL(work);
  240. }
  241. static irqreturn_t mlx4_msi_x_interrupt(int irq, void *eq_ptr)
  242. {
  243. struct mlx4_eq *eq = eq_ptr;
  244. struct mlx4_dev *dev = eq->dev;
  245. mlx4_eq_int(dev, eq);
  246. /* MSI-X vectors always belong to us */
  247. return IRQ_HANDLED;
  248. }
  249. static int mlx4_MAP_EQ(struct mlx4_dev *dev, u64 event_mask, int unmap,
  250. int eq_num)
  251. {
  252. return mlx4_cmd(dev, event_mask, (unmap << 31) | eq_num,
  253. 0, MLX4_CMD_MAP_EQ, MLX4_CMD_TIME_CLASS_B);
  254. }
  255. static int mlx4_SW2HW_EQ(struct mlx4_dev *dev, struct mlx4_cmd_mailbox *mailbox,
  256. int eq_num)
  257. {
  258. return mlx4_cmd(dev, mailbox->dma, eq_num, 0, MLX4_CMD_SW2HW_EQ,
  259. MLX4_CMD_TIME_CLASS_A);
  260. }
  261. static int mlx4_HW2SW_EQ(struct mlx4_dev *dev, struct mlx4_cmd_mailbox *mailbox,
  262. int eq_num)
  263. {
  264. return mlx4_cmd_box(dev, 0, mailbox->dma, eq_num, 0, MLX4_CMD_HW2SW_EQ,
  265. MLX4_CMD_TIME_CLASS_A);
  266. }
  267. static void __devinit __iomem *mlx4_get_eq_uar(struct mlx4_dev *dev,
  268. struct mlx4_eq *eq)
  269. {
  270. struct mlx4_priv *priv = mlx4_priv(dev);
  271. int index;
  272. index = eq->eqn / 4 - dev->caps.reserved_eqs / 4;
  273. if (!priv->eq_table.uar_map[index]) {
  274. priv->eq_table.uar_map[index] =
  275. ioremap(pci_resource_start(dev->pdev, 2) +
  276. ((eq->eqn / 4) << PAGE_SHIFT),
  277. PAGE_SIZE);
  278. if (!priv->eq_table.uar_map[index]) {
  279. mlx4_err(dev, "Couldn't map EQ doorbell for EQN 0x%06x\n",
  280. eq->eqn);
  281. return NULL;
  282. }
  283. }
  284. return priv->eq_table.uar_map[index] + 0x800 + 8 * (eq->eqn % 4);
  285. }
  286. static int __devinit mlx4_create_eq(struct mlx4_dev *dev, int nent,
  287. u8 intr, struct mlx4_eq *eq)
  288. {
  289. struct mlx4_priv *priv = mlx4_priv(dev);
  290. struct mlx4_cmd_mailbox *mailbox;
  291. struct mlx4_eq_context *eq_context;
  292. int npages;
  293. u64 *dma_list = NULL;
  294. dma_addr_t t;
  295. u64 mtt_addr;
  296. int err = -ENOMEM;
  297. int i;
  298. eq->dev = dev;
  299. eq->nent = roundup_pow_of_two(max(nent, 2));
  300. npages = PAGE_ALIGN(eq->nent * MLX4_EQ_ENTRY_SIZE) / PAGE_SIZE;
  301. eq->page_list = kmalloc(npages * sizeof *eq->page_list,
  302. GFP_KERNEL);
  303. if (!eq->page_list)
  304. goto err_out;
  305. for (i = 0; i < npages; ++i)
  306. eq->page_list[i].buf = NULL;
  307. dma_list = kmalloc(npages * sizeof *dma_list, GFP_KERNEL);
  308. if (!dma_list)
  309. goto err_out_free;
  310. mailbox = mlx4_alloc_cmd_mailbox(dev);
  311. if (IS_ERR(mailbox))
  312. goto err_out_free;
  313. eq_context = mailbox->buf;
  314. for (i = 0; i < npages; ++i) {
  315. eq->page_list[i].buf = dma_alloc_coherent(&dev->pdev->dev,
  316. PAGE_SIZE, &t, GFP_KERNEL);
  317. if (!eq->page_list[i].buf)
  318. goto err_out_free_pages;
  319. dma_list[i] = t;
  320. eq->page_list[i].map = t;
  321. memset(eq->page_list[i].buf, 0, PAGE_SIZE);
  322. }
  323. eq->eqn = mlx4_bitmap_alloc(&priv->eq_table.bitmap);
  324. if (eq->eqn == -1)
  325. goto err_out_free_pages;
  326. eq->doorbell = mlx4_get_eq_uar(dev, eq);
  327. if (!eq->doorbell) {
  328. err = -ENOMEM;
  329. goto err_out_free_eq;
  330. }
  331. err = mlx4_mtt_init(dev, npages, PAGE_SHIFT, &eq->mtt);
  332. if (err)
  333. goto err_out_free_eq;
  334. err = mlx4_write_mtt(dev, &eq->mtt, 0, npages, dma_list);
  335. if (err)
  336. goto err_out_free_mtt;
  337. memset(eq_context, 0, sizeof *eq_context);
  338. eq_context->flags = cpu_to_be32(MLX4_EQ_STATUS_OK |
  339. MLX4_EQ_STATE_ARMED);
  340. eq_context->log_eq_size = ilog2(eq->nent);
  341. eq_context->intr = intr;
  342. eq_context->log_page_size = PAGE_SHIFT - MLX4_ICM_PAGE_SHIFT;
  343. mtt_addr = mlx4_mtt_addr(dev, &eq->mtt);
  344. eq_context->mtt_base_addr_h = mtt_addr >> 32;
  345. eq_context->mtt_base_addr_l = cpu_to_be32(mtt_addr & 0xffffffff);
  346. err = mlx4_SW2HW_EQ(dev, mailbox, eq->eqn);
  347. if (err) {
  348. mlx4_warn(dev, "SW2HW_EQ failed (%d)\n", err);
  349. goto err_out_free_mtt;
  350. }
  351. kfree(dma_list);
  352. mlx4_free_cmd_mailbox(dev, mailbox);
  353. eq->cons_index = 0;
  354. return err;
  355. err_out_free_mtt:
  356. mlx4_mtt_cleanup(dev, &eq->mtt);
  357. err_out_free_eq:
  358. mlx4_bitmap_free(&priv->eq_table.bitmap, eq->eqn);
  359. err_out_free_pages:
  360. for (i = 0; i < npages; ++i)
  361. if (eq->page_list[i].buf)
  362. dma_free_coherent(&dev->pdev->dev, PAGE_SIZE,
  363. eq->page_list[i].buf,
  364. eq->page_list[i].map);
  365. mlx4_free_cmd_mailbox(dev, mailbox);
  366. err_out_free:
  367. kfree(eq->page_list);
  368. kfree(dma_list);
  369. err_out:
  370. return err;
  371. }
  372. static void mlx4_free_eq(struct mlx4_dev *dev,
  373. struct mlx4_eq *eq)
  374. {
  375. struct mlx4_priv *priv = mlx4_priv(dev);
  376. struct mlx4_cmd_mailbox *mailbox;
  377. int err;
  378. int npages = PAGE_ALIGN(MLX4_EQ_ENTRY_SIZE * eq->nent) / PAGE_SIZE;
  379. int i;
  380. mailbox = mlx4_alloc_cmd_mailbox(dev);
  381. if (IS_ERR(mailbox))
  382. return;
  383. err = mlx4_HW2SW_EQ(dev, mailbox, eq->eqn);
  384. if (err)
  385. mlx4_warn(dev, "HW2SW_EQ failed (%d)\n", err);
  386. if (0) {
  387. mlx4_dbg(dev, "Dumping EQ context %02x:\n", eq->eqn);
  388. for (i = 0; i < sizeof (struct mlx4_eq_context) / 4; ++i) {
  389. if (i % 4 == 0)
  390. printk("[%02x] ", i * 4);
  391. printk(" %08x", be32_to_cpup(mailbox->buf + i * 4));
  392. if ((i + 1) % 4 == 0)
  393. printk("\n");
  394. }
  395. }
  396. mlx4_mtt_cleanup(dev, &eq->mtt);
  397. for (i = 0; i < npages; ++i)
  398. pci_free_consistent(dev->pdev, PAGE_SIZE,
  399. eq->page_list[i].buf,
  400. eq->page_list[i].map);
  401. kfree(eq->page_list);
  402. mlx4_bitmap_free(&priv->eq_table.bitmap, eq->eqn);
  403. mlx4_free_cmd_mailbox(dev, mailbox);
  404. }
  405. static void mlx4_free_irqs(struct mlx4_dev *dev)
  406. {
  407. struct mlx4_eq_table *eq_table = &mlx4_priv(dev)->eq_table;
  408. int i;
  409. if (eq_table->have_irq)
  410. free_irq(dev->pdev->irq, dev);
  411. for (i = 0; i < MLX4_NUM_EQ; ++i)
  412. if (eq_table->eq[i].have_irq)
  413. free_irq(eq_table->eq[i].irq, eq_table->eq + i);
  414. }
  415. static int __devinit mlx4_map_clr_int(struct mlx4_dev *dev)
  416. {
  417. struct mlx4_priv *priv = mlx4_priv(dev);
  418. priv->clr_base = ioremap(pci_resource_start(dev->pdev, priv->fw.clr_int_bar) +
  419. priv->fw.clr_int_base, MLX4_CLR_INT_SIZE);
  420. if (!priv->clr_base) {
  421. mlx4_err(dev, "Couldn't map interrupt clear register, aborting.\n");
  422. return -ENOMEM;
  423. }
  424. return 0;
  425. }
  426. static void mlx4_unmap_clr_int(struct mlx4_dev *dev)
  427. {
  428. struct mlx4_priv *priv = mlx4_priv(dev);
  429. iounmap(priv->clr_base);
  430. }
  431. int __devinit mlx4_map_eq_icm(struct mlx4_dev *dev, u64 icm_virt)
  432. {
  433. struct mlx4_priv *priv = mlx4_priv(dev);
  434. int ret;
  435. /*
  436. * We assume that mapping one page is enough for the whole EQ
  437. * context table. This is fine with all current HCAs, because
  438. * we only use 32 EQs and each EQ uses 64 bytes of context
  439. * memory, or 1 KB total.
  440. */
  441. priv->eq_table.icm_virt = icm_virt;
  442. priv->eq_table.icm_page = alloc_page(GFP_HIGHUSER);
  443. if (!priv->eq_table.icm_page)
  444. return -ENOMEM;
  445. priv->eq_table.icm_dma = pci_map_page(dev->pdev, priv->eq_table.icm_page, 0,
  446. PAGE_SIZE, PCI_DMA_BIDIRECTIONAL);
  447. if (pci_dma_mapping_error(priv->eq_table.icm_dma)) {
  448. __free_page(priv->eq_table.icm_page);
  449. return -ENOMEM;
  450. }
  451. ret = mlx4_MAP_ICM_page(dev, priv->eq_table.icm_dma, icm_virt);
  452. if (ret) {
  453. pci_unmap_page(dev->pdev, priv->eq_table.icm_dma, PAGE_SIZE,
  454. PCI_DMA_BIDIRECTIONAL);
  455. __free_page(priv->eq_table.icm_page);
  456. }
  457. return ret;
  458. }
  459. void mlx4_unmap_eq_icm(struct mlx4_dev *dev)
  460. {
  461. struct mlx4_priv *priv = mlx4_priv(dev);
  462. mlx4_UNMAP_ICM(dev, priv->eq_table.icm_virt, 1);
  463. pci_unmap_page(dev->pdev, priv->eq_table.icm_dma, PAGE_SIZE,
  464. PCI_DMA_BIDIRECTIONAL);
  465. __free_page(priv->eq_table.icm_page);
  466. }
  467. int __devinit mlx4_init_eq_table(struct mlx4_dev *dev)
  468. {
  469. struct mlx4_priv *priv = mlx4_priv(dev);
  470. int err;
  471. int i;
  472. err = mlx4_bitmap_init(&priv->eq_table.bitmap, dev->caps.num_eqs,
  473. dev->caps.num_eqs - 1, dev->caps.reserved_eqs);
  474. if (err)
  475. return err;
  476. for (i = 0; i < ARRAY_SIZE(priv->eq_table.uar_map); ++i)
  477. priv->eq_table.uar_map[i] = NULL;
  478. err = mlx4_map_clr_int(dev);
  479. if (err)
  480. goto err_out_free;
  481. priv->eq_table.clr_mask =
  482. swab32(1 << (priv->eq_table.inta_pin & 31));
  483. priv->eq_table.clr_int = priv->clr_base +
  484. (priv->eq_table.inta_pin < 32 ? 4 : 0);
  485. err = mlx4_create_eq(dev, dev->caps.num_cqs + MLX4_NUM_SPARE_EQE,
  486. (dev->flags & MLX4_FLAG_MSI_X) ? MLX4_EQ_COMP : 0,
  487. &priv->eq_table.eq[MLX4_EQ_COMP]);
  488. if (err)
  489. goto err_out_unmap;
  490. err = mlx4_create_eq(dev, MLX4_NUM_ASYNC_EQE + MLX4_NUM_SPARE_EQE,
  491. (dev->flags & MLX4_FLAG_MSI_X) ? MLX4_EQ_ASYNC : 0,
  492. &priv->eq_table.eq[MLX4_EQ_ASYNC]);
  493. if (err)
  494. goto err_out_comp;
  495. if (dev->flags & MLX4_FLAG_MSI_X) {
  496. static const char *eq_name[] = {
  497. [MLX4_EQ_COMP] = DRV_NAME " (comp)",
  498. [MLX4_EQ_ASYNC] = DRV_NAME " (async)"
  499. };
  500. for (i = 0; i < MLX4_NUM_EQ; ++i) {
  501. err = request_irq(priv->eq_table.eq[i].irq,
  502. mlx4_msi_x_interrupt,
  503. 0, eq_name[i], priv->eq_table.eq + i);
  504. if (err)
  505. goto err_out_async;
  506. priv->eq_table.eq[i].have_irq = 1;
  507. }
  508. } else {
  509. err = request_irq(dev->pdev->irq, mlx4_interrupt,
  510. IRQF_SHARED, DRV_NAME, dev);
  511. if (err)
  512. goto err_out_async;
  513. priv->eq_table.have_irq = 1;
  514. }
  515. err = mlx4_MAP_EQ(dev, MLX4_ASYNC_EVENT_MASK, 0,
  516. priv->eq_table.eq[MLX4_EQ_ASYNC].eqn);
  517. if (err)
  518. mlx4_warn(dev, "MAP_EQ for async EQ %d failed (%d)\n",
  519. priv->eq_table.eq[MLX4_EQ_ASYNC].eqn, err);
  520. for (i = 0; i < MLX4_NUM_EQ; ++i)
  521. eq_set_ci(&priv->eq_table.eq[i], 1);
  522. return 0;
  523. err_out_async:
  524. mlx4_free_eq(dev, &priv->eq_table.eq[MLX4_EQ_ASYNC]);
  525. err_out_comp:
  526. mlx4_free_eq(dev, &priv->eq_table.eq[MLX4_EQ_COMP]);
  527. err_out_unmap:
  528. mlx4_unmap_clr_int(dev);
  529. mlx4_free_irqs(dev);
  530. err_out_free:
  531. mlx4_bitmap_cleanup(&priv->eq_table.bitmap);
  532. return err;
  533. }
  534. void mlx4_cleanup_eq_table(struct mlx4_dev *dev)
  535. {
  536. struct mlx4_priv *priv = mlx4_priv(dev);
  537. int i;
  538. mlx4_MAP_EQ(dev, MLX4_ASYNC_EVENT_MASK, 1,
  539. priv->eq_table.eq[MLX4_EQ_ASYNC].eqn);
  540. mlx4_free_irqs(dev);
  541. for (i = 0; i < MLX4_NUM_EQ; ++i)
  542. mlx4_free_eq(dev, &priv->eq_table.eq[i]);
  543. mlx4_unmap_clr_int(dev);
  544. for (i = 0; i < ARRAY_SIZE(priv->eq_table.uar_map); ++i)
  545. if (priv->eq_table.uar_map[i])
  546. iounmap(priv->eq_table.uar_map[i]);
  547. mlx4_bitmap_cleanup(&priv->eq_table.bitmap);
  548. }