1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34#include <linux/mlx4/cq.h>
35#include <linux/mlx4/qp.h>
36#include <linux/mlx4/cmd.h>
37
38#include "mlx4_en.h"
39
40static void mlx4_en_cq_event(struct mlx4_cq *cq, enum mlx4_event event)
41{
42 return;
43}
44
45
46int mlx4_en_create_cq(struct mlx4_en_priv *priv,
47 struct mlx4_en_cq **pcq,
48 int entries, int ring, enum cq_type mode,
49 int node)
50{
51 struct mlx4_en_dev *mdev = priv->mdev;
52 struct mlx4_en_cq *cq;
53 int err;
54
55 cq = kzalloc_node(sizeof(*cq), GFP_KERNEL, node);
56 if (!cq) {
57 cq = kzalloc(sizeof(*cq), GFP_KERNEL);
58 if (!cq) {
59 en_err(priv, "Failed to allocate CQ structure\n");
60 return -ENOMEM;
61 }
62 }
63
64 cq->size = entries;
65 cq->buf_size = cq->size * mdev->dev->caps.cqe_size;
66
67 cq->ring = ring;
68 cq->type = mode;
69 cq->vector = mdev->dev->caps.num_comp_vectors;
70
71
72
73
74 set_dev_node(&mdev->dev->persist->pdev->dev, node);
75 err = mlx4_alloc_hwq_res(mdev->dev, &cq->wqres,
76 cq->buf_size);
77 set_dev_node(&mdev->dev->persist->pdev->dev, mdev->dev->numa_node);
78 if (err)
79 goto err_cq;
80
81 cq->buf = (struct mlx4_cqe *)cq->wqres.buf.direct.buf;
82 *pcq = cq;
83
84 return 0;
85
86err_cq:
87 kfree(cq);
88 *pcq = NULL;
89 return err;
90}
91
92int mlx4_en_activate_cq(struct mlx4_en_priv *priv, struct mlx4_en_cq *cq,
93 int cq_idx)
94{
95 struct mlx4_en_dev *mdev = priv->mdev;
96 int err = 0;
97 int timestamp_en = 0;
98 bool assigned_eq = false;
99
100 cq->dev = mdev->pndev[priv->port];
101 cq->mcq.set_ci_db = cq->wqres.db.db;
102 cq->mcq.arm_db = cq->wqres.db.db + 1;
103 *cq->mcq.set_ci_db = 0;
104 *cq->mcq.arm_db = 0;
105 memset(cq->buf, 0, cq->buf_size);
106
107 if (cq->type == RX) {
108 if (!mlx4_is_eq_vector_valid(mdev->dev, priv->port,
109 cq->vector)) {
110 cq->vector = cpumask_first(priv->rx_ring[cq->ring]->affinity_mask);
111
112 err = mlx4_assign_eq(mdev->dev, priv->port,
113 &cq->vector);
114 if (err) {
115 mlx4_err(mdev, "Failed assigning an EQ to CQ vector %d\n",
116 cq->vector);
117 goto free_eq;
118 }
119
120 assigned_eq = true;
121 }
122
123 cq->irq_desc =
124 irq_to_desc(mlx4_eq_get_irq(mdev->dev,
125 cq->vector));
126 } else {
127
128
129 struct mlx4_en_cq *rx_cq;
130
131 cq_idx = cq_idx % priv->rx_ring_num;
132 rx_cq = priv->rx_cq[cq_idx];
133 cq->vector = rx_cq->vector;
134 }
135
136 if (cq->type == RX)
137 cq->size = priv->rx_ring[cq->ring]->actual_size;
138
139 if ((cq->type != RX && priv->hwtstamp_config.tx_type) ||
140 (cq->type == RX && priv->hwtstamp_config.rx_filter))
141 timestamp_en = 1;
142
143 err = mlx4_cq_alloc(mdev->dev, cq->size, &cq->wqres.mtt,
144 &mdev->priv_uar, cq->wqres.db.dma, &cq->mcq,
145 cq->vector, 0, timestamp_en);
146 if (err)
147 goto free_eq;
148
149 cq->mcq.comp = cq->type != RX ? mlx4_en_tx_irq : mlx4_en_rx_irq;
150 cq->mcq.event = mlx4_en_cq_event;
151
152 if (cq->type != RX)
153 netif_tx_napi_add(cq->dev, &cq->napi, mlx4_en_poll_tx_cq,
154 NAPI_POLL_WEIGHT);
155 else
156 netif_napi_add(cq->dev, &cq->napi, mlx4_en_poll_rx_cq, 64);
157
158 napi_enable(&cq->napi);
159
160 return 0;
161
162free_eq:
163 if (assigned_eq)
164 mlx4_release_eq(mdev->dev, cq->vector);
165 cq->vector = mdev->dev->caps.num_comp_vectors;
166 return err;
167}
168
169void mlx4_en_destroy_cq(struct mlx4_en_priv *priv, struct mlx4_en_cq **pcq)
170{
171 struct mlx4_en_dev *mdev = priv->mdev;
172 struct mlx4_en_cq *cq = *pcq;
173
174 mlx4_free_hwq_res(mdev->dev, &cq->wqres, cq->buf_size);
175 if (mlx4_is_eq_vector_valid(mdev->dev, priv->port, cq->vector) &&
176 cq->type == RX)
177 mlx4_release_eq(priv->mdev->dev, cq->vector);
178 cq->vector = 0;
179 cq->buf_size = 0;
180 cq->buf = NULL;
181 kfree(cq);
182 *pcq = NULL;
183}
184
185void mlx4_en_deactivate_cq(struct mlx4_en_priv *priv, struct mlx4_en_cq *cq)
186{
187 napi_disable(&cq->napi);
188 netif_napi_del(&cq->napi);
189
190 mlx4_cq_free(priv->mdev->dev, &cq->mcq);
191}
192
193
194int mlx4_en_set_cq_moder(struct mlx4_en_priv *priv, struct mlx4_en_cq *cq)
195{
196 return mlx4_cq_modify(priv->mdev->dev, &cq->mcq,
197 cq->moder_cnt, cq->moder_time);
198}
199
200int mlx4_en_arm_cq(struct mlx4_en_priv *priv, struct mlx4_en_cq *cq)
201{
202 mlx4_cq_arm(&cq->mcq, MLX4_CQ_DB_REQ_NOT, priv->mdev->uar_map,
203 &priv->mdev->uar_lock);
204
205 return 0;
206}
207
208
209