Merge git://git.kernel.org/pub/scm/linux/kernel/git/herbert/crypto-2.6
[firefly-linux-kernel-4.4.55.git] / drivers / net / ethernet / mellanox / mlx4 / eq.c
1 /*
2  * Copyright (c) 2005, 2006, 2007, 2008 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
34 #include <linux/init.h>
35 #include <linux/interrupt.h>
36 #include <linux/slab.h>
37 #include <linux/export.h>
38 #include <linux/mm.h>
39 #include <linux/dma-mapping.h>
40
41 #include <linux/mlx4/cmd.h>
42
43 #include "mlx4.h"
44 #include "fw.h"
45
46 enum {
47         MLX4_IRQNAME_SIZE       = 32
48 };
49
50 enum {
51         MLX4_NUM_ASYNC_EQE      = 0x100,
52         MLX4_NUM_SPARE_EQE      = 0x80,
53         MLX4_EQ_ENTRY_SIZE      = 0x20
54 };
55
56 #define MLX4_EQ_STATUS_OK          ( 0 << 28)
57 #define MLX4_EQ_STATUS_WRITE_FAIL  (10 << 28)
58 #define MLX4_EQ_OWNER_SW           ( 0 << 24)
59 #define MLX4_EQ_OWNER_HW           ( 1 << 24)
60 #define MLX4_EQ_FLAG_EC            ( 1 << 18)
61 #define MLX4_EQ_FLAG_OI            ( 1 << 17)
62 #define MLX4_EQ_STATE_ARMED        ( 9 <<  8)
63 #define MLX4_EQ_STATE_FIRED        (10 <<  8)
64 #define MLX4_EQ_STATE_ALWAYS_ARMED (11 <<  8)
65
66 #define MLX4_ASYNC_EVENT_MASK ((1ull << MLX4_EVENT_TYPE_PATH_MIG)           | \
67                                (1ull << MLX4_EVENT_TYPE_COMM_EST)           | \
68                                (1ull << MLX4_EVENT_TYPE_SQ_DRAINED)         | \
69                                (1ull << MLX4_EVENT_TYPE_CQ_ERROR)           | \
70                                (1ull << MLX4_EVENT_TYPE_WQ_CATAS_ERROR)     | \
71                                (1ull << MLX4_EVENT_TYPE_EEC_CATAS_ERROR)    | \
72                                (1ull << MLX4_EVENT_TYPE_PATH_MIG_FAILED)    | \
73                                (1ull << MLX4_EVENT_TYPE_WQ_INVAL_REQ_ERROR) | \
74                                (1ull << MLX4_EVENT_TYPE_WQ_ACCESS_ERROR)    | \
75                                (1ull << MLX4_EVENT_TYPE_PORT_CHANGE)        | \
76                                (1ull << MLX4_EVENT_TYPE_ECC_DETECT)         | \
77                                (1ull << MLX4_EVENT_TYPE_SRQ_CATAS_ERROR)    | \
78                                (1ull << MLX4_EVENT_TYPE_SRQ_QP_LAST_WQE)    | \
79                                (1ull << MLX4_EVENT_TYPE_SRQ_LIMIT)          | \
80                                (1ull << MLX4_EVENT_TYPE_CMD)                | \
81                                (1ull << MLX4_EVENT_TYPE_COMM_CHANNEL)       | \
82                                (1ull << MLX4_EVENT_TYPE_FLR_EVENT))
83
84 static void eq_set_ci(struct mlx4_eq *eq, int req_not)
85 {
86         __raw_writel((__force u32) cpu_to_be32((eq->cons_index & 0xffffff) |
87                                                req_not << 31),
88                      eq->doorbell);
89         /* We still want ordering, just not swabbing, so add a barrier */
90         mb();
91 }
92
93 static struct mlx4_eqe *get_eqe(struct mlx4_eq *eq, u32 entry)
94 {
95         unsigned long off = (entry & (eq->nent - 1)) * MLX4_EQ_ENTRY_SIZE;
96         return eq->page_list[off / PAGE_SIZE].buf + off % PAGE_SIZE;
97 }
98
99 static struct mlx4_eqe *next_eqe_sw(struct mlx4_eq *eq)
100 {
101         struct mlx4_eqe *eqe = get_eqe(eq, eq->cons_index);
102         return !!(eqe->owner & 0x80) ^ !!(eq->cons_index & eq->nent) ? NULL : eqe;
103 }
104
105 static struct mlx4_eqe *next_slave_event_eqe(struct mlx4_slave_event_eq *slave_eq)
106 {
107         struct mlx4_eqe *eqe =
108                 &slave_eq->event_eqe[slave_eq->cons & (SLAVE_EVENT_EQ_SIZE - 1)];
109         return (!!(eqe->owner & 0x80) ^
110                 !!(slave_eq->cons & SLAVE_EVENT_EQ_SIZE)) ?
111                 eqe : NULL;
112 }
113
114 void mlx4_gen_slave_eqe(struct work_struct *work)
115 {
116         struct mlx4_mfunc_master_ctx *master =
117                 container_of(work, struct mlx4_mfunc_master_ctx,
118                              slave_event_work);
119         struct mlx4_mfunc *mfunc =
120                 container_of(master, struct mlx4_mfunc, master);
121         struct mlx4_priv *priv = container_of(mfunc, struct mlx4_priv, mfunc);
122         struct mlx4_dev *dev = &priv->dev;
123         struct mlx4_slave_event_eq *slave_eq = &mfunc->master.slave_eq;
124         struct mlx4_eqe *eqe;
125         u8 slave;
126         int i;
127
128         for (eqe = next_slave_event_eqe(slave_eq); eqe;
129               eqe = next_slave_event_eqe(slave_eq)) {
130                 slave = eqe->slave_id;
131
132                 /* All active slaves need to receive the event */
133                 if (slave == ALL_SLAVES) {
134                         for (i = 0; i < dev->num_slaves; i++) {
135                                 if (i != dev->caps.function &&
136                                     master->slave_state[i].active)
137                                         if (mlx4_GEN_EQE(dev, i, eqe))
138                                                 mlx4_warn(dev, "Failed to "
139                                                           " generate event "
140                                                           "for slave %d\n", i);
141                         }
142                 } else {
143                         if (mlx4_GEN_EQE(dev, slave, eqe))
144                                 mlx4_warn(dev, "Failed to generate event "
145                                                "for slave %d\n", slave);
146                 }
147                 ++slave_eq->cons;
148         }
149 }
150
151
152 static void slave_event(struct mlx4_dev *dev, u8 slave, struct mlx4_eqe *eqe)
153 {
154         struct mlx4_priv *priv = mlx4_priv(dev);
155         struct mlx4_slave_event_eq *slave_eq = &priv->mfunc.master.slave_eq;
156         struct mlx4_eqe *s_eqe =
157                 &slave_eq->event_eqe[slave_eq->prod & (SLAVE_EVENT_EQ_SIZE - 1)];
158
159         if ((!!(s_eqe->owner & 0x80)) ^
160             (!!(slave_eq->prod & SLAVE_EVENT_EQ_SIZE))) {
161                 mlx4_warn(dev, "Master failed to generate an EQE for slave: %d. "
162                           "No free EQE on slave events queue\n", slave);
163                 return;
164         }
165
166         memcpy(s_eqe, eqe, sizeof(struct mlx4_eqe) - 1);
167         s_eqe->slave_id = slave;
168         /* ensure all information is written before setting the ownersip bit */
169         wmb();
170         s_eqe->owner = !!(slave_eq->prod & SLAVE_EVENT_EQ_SIZE) ? 0x0 : 0x80;
171         ++slave_eq->prod;
172
173         queue_work(priv->mfunc.master.comm_wq,
174                    &priv->mfunc.master.slave_event_work);
175 }
176
177 static void mlx4_slave_event(struct mlx4_dev *dev, int slave,
178                              struct mlx4_eqe *eqe)
179 {
180         struct mlx4_priv *priv = mlx4_priv(dev);
181         struct mlx4_slave_state *s_slave =
182                 &priv->mfunc.master.slave_state[slave];
183
184         if (!s_slave->active) {
185                 /*mlx4_warn(dev, "Trying to pass event to inactive slave\n");*/
186                 return;
187         }
188
189         slave_event(dev, slave, eqe);
190 }
191
192 void mlx4_master_handle_slave_flr(struct work_struct *work)
193 {
194         struct mlx4_mfunc_master_ctx *master =
195                 container_of(work, struct mlx4_mfunc_master_ctx,
196                              slave_flr_event_work);
197         struct mlx4_mfunc *mfunc =
198                 container_of(master, struct mlx4_mfunc, master);
199         struct mlx4_priv *priv =
200                 container_of(mfunc, struct mlx4_priv, mfunc);
201         struct mlx4_dev *dev = &priv->dev;
202         struct mlx4_slave_state *slave_state = priv->mfunc.master.slave_state;
203         int i;
204         int err;
205
206         mlx4_dbg(dev, "mlx4_handle_slave_flr\n");
207
208         for (i = 0 ; i < dev->num_slaves; i++) {
209
210                 if (MLX4_COMM_CMD_FLR == slave_state[i].last_cmd) {
211                         mlx4_dbg(dev, "mlx4_handle_slave_flr: "
212                                  "clean slave: %d\n", i);
213
214                         mlx4_delete_all_resources_for_slave(dev, i);
215                         /*return the slave to running mode*/
216                         spin_lock(&priv->mfunc.master.slave_state_lock);
217                         slave_state[i].last_cmd = MLX4_COMM_CMD_RESET;
218                         slave_state[i].is_slave_going_down = 0;
219                         spin_unlock(&priv->mfunc.master.slave_state_lock);
220                         /*notify the FW:*/
221                         err = mlx4_cmd(dev, 0, i, 0, MLX4_CMD_INFORM_FLR_DONE,
222                                        MLX4_CMD_TIME_CLASS_A, MLX4_CMD_WRAPPED);
223                         if (err)
224                                 mlx4_warn(dev, "Failed to notify FW on "
225                                           "FLR done (slave:%d)\n", i);
226                 }
227         }
228 }
229
230 static int mlx4_eq_int(struct mlx4_dev *dev, struct mlx4_eq *eq)
231 {
232         struct mlx4_priv *priv = mlx4_priv(dev);
233         struct mlx4_eqe *eqe;
234         int cqn;
235         int eqes_found = 0;
236         int set_ci = 0;
237         int port;
238         int slave = 0;
239         int ret;
240         u32 flr_slave;
241         u8 update_slave_state;
242         int i;
243
244         while ((eqe = next_eqe_sw(eq))) {
245                 /*
246                  * Make sure we read EQ entry contents after we've
247                  * checked the ownership bit.
248                  */
249                 rmb();
250
251                 switch (eqe->type) {
252                 case MLX4_EVENT_TYPE_COMP:
253                         cqn = be32_to_cpu(eqe->event.comp.cqn) & 0xffffff;
254                         mlx4_cq_completion(dev, cqn);
255                         break;
256
257                 case MLX4_EVENT_TYPE_PATH_MIG:
258                 case MLX4_EVENT_TYPE_COMM_EST:
259                 case MLX4_EVENT_TYPE_SQ_DRAINED:
260                 case MLX4_EVENT_TYPE_SRQ_QP_LAST_WQE:
261                 case MLX4_EVENT_TYPE_WQ_CATAS_ERROR:
262                 case MLX4_EVENT_TYPE_PATH_MIG_FAILED:
263                 case MLX4_EVENT_TYPE_WQ_INVAL_REQ_ERROR:
264                 case MLX4_EVENT_TYPE_WQ_ACCESS_ERROR:
265                         mlx4_dbg(dev, "event %d arrived\n", eqe->type);
266                         if (mlx4_is_master(dev)) {
267                                 /* forward only to slave owning the QP */
268                                 ret = mlx4_get_slave_from_resource_id(dev,
269                                                 RES_QP,
270                                                 be32_to_cpu(eqe->event.qp.qpn)
271                                                 & 0xffffff, &slave);
272                                 if (ret && ret != -ENOENT) {
273                                         mlx4_dbg(dev, "QP event %02x(%02x) on "
274                                                  "EQ %d at index %u: could "
275                                                  "not get slave id (%d)\n",
276                                                  eqe->type, eqe->subtype,
277                                                  eq->eqn, eq->cons_index, ret);
278                                         break;
279                                 }
280
281                                 if (!ret && slave != dev->caps.function) {
282                                         mlx4_slave_event(dev, slave, eqe);
283                                         break;
284                                 }
285
286                         }
287                         mlx4_qp_event(dev, be32_to_cpu(eqe->event.qp.qpn) &
288                                       0xffffff, eqe->type);
289                         break;
290
291                 case MLX4_EVENT_TYPE_SRQ_LIMIT:
292                         mlx4_warn(dev, "%s: MLX4_EVENT_TYPE_SRQ_LIMIT\n",
293                                   __func__);
294                 case MLX4_EVENT_TYPE_SRQ_CATAS_ERROR:
295                         if (mlx4_is_master(dev)) {
296                                 /* forward only to slave owning the SRQ */
297                                 ret = mlx4_get_slave_from_resource_id(dev,
298                                                 RES_SRQ,
299                                                 be32_to_cpu(eqe->event.srq.srqn)
300                                                 & 0xffffff,
301                                                 &slave);
302                                 if (ret && ret != -ENOENT) {
303                                         mlx4_warn(dev, "SRQ event %02x(%02x) "
304                                                   "on EQ %d at index %u: could"
305                                                   " not get slave id (%d)\n",
306                                                   eqe->type, eqe->subtype,
307                                                   eq->eqn, eq->cons_index, ret);
308                                         break;
309                                 }
310                                 mlx4_warn(dev, "%s: slave:%d, srq_no:0x%x,"
311                                           " event: %02x(%02x)\n", __func__,
312                                           slave,
313                                           be32_to_cpu(eqe->event.srq.srqn),
314                                           eqe->type, eqe->subtype);
315
316                                 if (!ret && slave != dev->caps.function) {
317                                         mlx4_warn(dev, "%s: sending event "
318                                                   "%02x(%02x) to slave:%d\n",
319                                                    __func__, eqe->type,
320                                                   eqe->subtype, slave);
321                                         mlx4_slave_event(dev, slave, eqe);
322                                         break;
323                                 }
324                         }
325                         mlx4_srq_event(dev, be32_to_cpu(eqe->event.srq.srqn) &
326                                        0xffffff, eqe->type);
327                         break;
328
329                 case MLX4_EVENT_TYPE_CMD:
330                         mlx4_cmd_event(dev,
331                                        be16_to_cpu(eqe->event.cmd.token),
332                                        eqe->event.cmd.status,
333                                        be64_to_cpu(eqe->event.cmd.out_param));
334                         break;
335
336                 case MLX4_EVENT_TYPE_PORT_CHANGE:
337                         port = be32_to_cpu(eqe->event.port_change.port) >> 28;
338                         if (eqe->subtype == MLX4_PORT_CHANGE_SUBTYPE_DOWN) {
339                                 mlx4_dispatch_event(dev,
340                                                     MLX4_DEV_EVENT_PORT_DOWN,
341                                                     port);
342                                 mlx4_priv(dev)->sense.do_sense_port[port] = 1;
343                                 if (mlx4_is_master(dev))
344                                         /*change the state of all slave's port
345                                         * to down:*/
346                                         for (i = 0; i < dev->num_slaves; i++) {
347                                                 mlx4_dbg(dev, "%s: Sending "
348                                                          "MLX4_PORT_CHANGE_SUBTYPE_DOWN"
349                                                          " to slave: %d, port:%d\n",
350                                                          __func__, i, port);
351                                                 if (i == dev->caps.function)
352                                                         continue;
353                                                 mlx4_slave_event(dev, i, eqe);
354                                         }
355                         } else {
356                                 mlx4_dispatch_event(dev,
357                                                     MLX4_DEV_EVENT_PORT_UP,
358                                                     port);
359                                 mlx4_priv(dev)->sense.do_sense_port[port] = 0;
360
361                                 if (mlx4_is_master(dev)) {
362                                         for (i = 0; i < dev->num_slaves; i++) {
363                                                 if (i == dev->caps.function)
364                                                         continue;
365                                                 mlx4_slave_event(dev, i, eqe);
366                                         }
367                                 }
368                         }
369                         break;
370
371                 case MLX4_EVENT_TYPE_CQ_ERROR:
372                         mlx4_warn(dev, "CQ %s on CQN %06x\n",
373                                   eqe->event.cq_err.syndrome == 1 ?
374                                   "overrun" : "access violation",
375                                   be32_to_cpu(eqe->event.cq_err.cqn) & 0xffffff);
376                         if (mlx4_is_master(dev)) {
377                                 ret = mlx4_get_slave_from_resource_id(dev,
378                                         RES_CQ,
379                                         be32_to_cpu(eqe->event.cq_err.cqn)
380                                         & 0xffffff, &slave);
381                                 if (ret && ret != -ENOENT) {
382                                         mlx4_dbg(dev, "CQ event %02x(%02x) on "
383                                                  "EQ %d at index %u: could "
384                                                   "not get slave id (%d)\n",
385                                                   eqe->type, eqe->subtype,
386                                                   eq->eqn, eq->cons_index, ret);
387                                         break;
388                                 }
389
390                                 if (!ret && slave != dev->caps.function) {
391                                         mlx4_slave_event(dev, slave, eqe);
392                                         break;
393                                 }
394                         }
395                         mlx4_cq_event(dev,
396                                       be32_to_cpu(eqe->event.cq_err.cqn)
397                                       & 0xffffff,
398                                       eqe->type);
399                         break;
400
401                 case MLX4_EVENT_TYPE_EQ_OVERFLOW:
402                         mlx4_warn(dev, "EQ overrun on EQN %d\n", eq->eqn);
403                         break;
404
405                 case MLX4_EVENT_TYPE_COMM_CHANNEL:
406                         if (!mlx4_is_master(dev)) {
407                                 mlx4_warn(dev, "Received comm channel event "
408                                                "for non master device\n");
409                                 break;
410                         }
411                         memcpy(&priv->mfunc.master.comm_arm_bit_vector,
412                                eqe->event.comm_channel_arm.bit_vec,
413                                sizeof eqe->event.comm_channel_arm.bit_vec);
414                         queue_work(priv->mfunc.master.comm_wq,
415                                    &priv->mfunc.master.comm_work);
416                         break;
417
418                 case MLX4_EVENT_TYPE_FLR_EVENT:
419                         flr_slave = be32_to_cpu(eqe->event.flr_event.slave_id);
420                         if (!mlx4_is_master(dev)) {
421                                 mlx4_warn(dev, "Non-master function received"
422                                                "FLR event\n");
423                                 break;
424                         }
425
426                         mlx4_dbg(dev, "FLR event for slave: %d\n", flr_slave);
427
428                         if (flr_slave > dev->num_slaves) {
429                                 mlx4_warn(dev,
430                                           "Got FLR for unknown function: %d\n",
431                                           flr_slave);
432                                 update_slave_state = 0;
433                         } else
434                                 update_slave_state = 1;
435
436                         spin_lock(&priv->mfunc.master.slave_state_lock);
437                         if (update_slave_state) {
438                                 priv->mfunc.master.slave_state[flr_slave].active = false;
439                                 priv->mfunc.master.slave_state[flr_slave].last_cmd = MLX4_COMM_CMD_FLR;
440                                 priv->mfunc.master.slave_state[flr_slave].is_slave_going_down = 1;
441                         }
442                         spin_unlock(&priv->mfunc.master.slave_state_lock);
443                         queue_work(priv->mfunc.master.comm_wq,
444                                    &priv->mfunc.master.slave_flr_event_work);
445                         break;
446                 case MLX4_EVENT_TYPE_EEC_CATAS_ERROR:
447                 case MLX4_EVENT_TYPE_ECC_DETECT:
448                 default:
449                         mlx4_warn(dev, "Unhandled event %02x(%02x) on EQ %d at "
450                                   "index %u. owner=%x, nent=0x%x, slave=%x, "
451                                   "ownership=%s\n",
452                                   eqe->type, eqe->subtype, eq->eqn,
453                                   eq->cons_index, eqe->owner, eq->nent,
454                                   eqe->slave_id,
455                                   !!(eqe->owner & 0x80) ^
456                                   !!(eq->cons_index & eq->nent) ? "HW" : "SW");
457                         break;
458                 };
459
460                 ++eq->cons_index;
461                 eqes_found = 1;
462                 ++set_ci;
463
464                 /*
465                  * The HCA will think the queue has overflowed if we
466                  * don't tell it we've been processing events.  We
467                  * create our EQs with MLX4_NUM_SPARE_EQE extra
468                  * entries, so we must update our consumer index at
469                  * least that often.
470                  */
471                 if (unlikely(set_ci >= MLX4_NUM_SPARE_EQE)) {
472                         eq_set_ci(eq, 0);
473                         set_ci = 0;
474                 }
475         }
476
477         eq_set_ci(eq, 1);
478
479         return eqes_found;
480 }
481
482 static irqreturn_t mlx4_interrupt(int irq, void *dev_ptr)
483 {
484         struct mlx4_dev *dev = dev_ptr;
485         struct mlx4_priv *priv = mlx4_priv(dev);
486         int work = 0;
487         int i;
488
489         writel(priv->eq_table.clr_mask, priv->eq_table.clr_int);
490
491         for (i = 0; i < dev->caps.num_comp_vectors + 1; ++i)
492                 work |= mlx4_eq_int(dev, &priv->eq_table.eq[i]);
493
494         return IRQ_RETVAL(work);
495 }
496
497 static irqreturn_t mlx4_msi_x_interrupt(int irq, void *eq_ptr)
498 {
499         struct mlx4_eq  *eq  = eq_ptr;
500         struct mlx4_dev *dev = eq->dev;
501
502         mlx4_eq_int(dev, eq);
503
504         /* MSI-X vectors always belong to us */
505         return IRQ_HANDLED;
506 }
507
508 int mlx4_MAP_EQ_wrapper(struct mlx4_dev *dev, int slave,
509                         struct mlx4_vhcr *vhcr,
510                         struct mlx4_cmd_mailbox *inbox,
511                         struct mlx4_cmd_mailbox *outbox,
512                         struct mlx4_cmd_info *cmd)
513 {
514         struct mlx4_priv *priv = mlx4_priv(dev);
515         struct mlx4_slave_event_eq_info *event_eq =
516                 priv->mfunc.master.slave_state[slave].event_eq;
517         u32 in_modifier = vhcr->in_modifier;
518         u32 eqn = in_modifier & 0x1FF;
519         u64 in_param =  vhcr->in_param;
520         int err = 0;
521         int i;
522
523         if (slave == dev->caps.function)
524                 err = mlx4_cmd(dev, in_param, (in_modifier & 0x80000000) | eqn,
525                                0, MLX4_CMD_MAP_EQ, MLX4_CMD_TIME_CLASS_B,
526                                MLX4_CMD_NATIVE);
527         if (!err)
528                 for (i = 0; i < MLX4_EVENT_TYPES_NUM; ++i)
529                         if (in_param & (1LL << i))
530                                 event_eq[i].eqn = in_modifier >> 31 ? -1 : eqn;
531
532         return err;
533 }
534
535 static int mlx4_MAP_EQ(struct mlx4_dev *dev, u64 event_mask, int unmap,
536                         int eq_num)
537 {
538         return mlx4_cmd(dev, event_mask, (unmap << 31) | eq_num,
539                         0, MLX4_CMD_MAP_EQ, MLX4_CMD_TIME_CLASS_B,
540                         MLX4_CMD_WRAPPED);
541 }
542
543 static int mlx4_SW2HW_EQ(struct mlx4_dev *dev, struct mlx4_cmd_mailbox *mailbox,
544                          int eq_num)
545 {
546         return mlx4_cmd(dev, mailbox->dma, eq_num, 0,
547                         MLX4_CMD_SW2HW_EQ, MLX4_CMD_TIME_CLASS_A,
548                         MLX4_CMD_WRAPPED);
549 }
550
551 static int mlx4_HW2SW_EQ(struct mlx4_dev *dev, struct mlx4_cmd_mailbox *mailbox,
552                          int eq_num)
553 {
554         return mlx4_cmd_box(dev, 0, mailbox->dma, eq_num,
555                             0, MLX4_CMD_HW2SW_EQ, MLX4_CMD_TIME_CLASS_A,
556                             MLX4_CMD_WRAPPED);
557 }
558
559 static int mlx4_num_eq_uar(struct mlx4_dev *dev)
560 {
561         /*
562          * Each UAR holds 4 EQ doorbells.  To figure out how many UARs
563          * we need to map, take the difference of highest index and
564          * the lowest index we'll use and add 1.
565          */
566         return (dev->caps.num_comp_vectors + 1 + dev->caps.reserved_eqs +
567                  dev->caps.comp_pool)/4 - dev->caps.reserved_eqs/4 + 1;
568 }
569
570 static void __iomem *mlx4_get_eq_uar(struct mlx4_dev *dev, struct mlx4_eq *eq)
571 {
572         struct mlx4_priv *priv = mlx4_priv(dev);
573         int index;
574
575         index = eq->eqn / 4 - dev->caps.reserved_eqs / 4;
576
577         if (!priv->eq_table.uar_map[index]) {
578                 priv->eq_table.uar_map[index] =
579                         ioremap(pci_resource_start(dev->pdev, 2) +
580                                 ((eq->eqn / 4) << PAGE_SHIFT),
581                                 PAGE_SIZE);
582                 if (!priv->eq_table.uar_map[index]) {
583                         mlx4_err(dev, "Couldn't map EQ doorbell for EQN 0x%06x\n",
584                                  eq->eqn);
585                         return NULL;
586                 }
587         }
588
589         return priv->eq_table.uar_map[index] + 0x800 + 8 * (eq->eqn % 4);
590 }
591
592 static int mlx4_create_eq(struct mlx4_dev *dev, int nent,
593                           u8 intr, struct mlx4_eq *eq)
594 {
595         struct mlx4_priv *priv = mlx4_priv(dev);
596         struct mlx4_cmd_mailbox *mailbox;
597         struct mlx4_eq_context *eq_context;
598         int npages;
599         u64 *dma_list = NULL;
600         dma_addr_t t;
601         u64 mtt_addr;
602         int err = -ENOMEM;
603         int i;
604
605         eq->dev   = dev;
606         eq->nent  = roundup_pow_of_two(max(nent, 2));
607         npages = PAGE_ALIGN(eq->nent * MLX4_EQ_ENTRY_SIZE) / PAGE_SIZE;
608
609         eq->page_list = kmalloc(npages * sizeof *eq->page_list,
610                                 GFP_KERNEL);
611         if (!eq->page_list)
612                 goto err_out;
613
614         for (i = 0; i < npages; ++i)
615                 eq->page_list[i].buf = NULL;
616
617         dma_list = kmalloc(npages * sizeof *dma_list, GFP_KERNEL);
618         if (!dma_list)
619                 goto err_out_free;
620
621         mailbox = mlx4_alloc_cmd_mailbox(dev);
622         if (IS_ERR(mailbox))
623                 goto err_out_free;
624         eq_context = mailbox->buf;
625
626         for (i = 0; i < npages; ++i) {
627                 eq->page_list[i].buf = dma_alloc_coherent(&dev->pdev->dev,
628                                                           PAGE_SIZE, &t, GFP_KERNEL);
629                 if (!eq->page_list[i].buf)
630                         goto err_out_free_pages;
631
632                 dma_list[i] = t;
633                 eq->page_list[i].map = t;
634
635                 memset(eq->page_list[i].buf, 0, PAGE_SIZE);
636         }
637
638         eq->eqn = mlx4_bitmap_alloc(&priv->eq_table.bitmap);
639         if (eq->eqn == -1)
640                 goto err_out_free_pages;
641
642         eq->doorbell = mlx4_get_eq_uar(dev, eq);
643         if (!eq->doorbell) {
644                 err = -ENOMEM;
645                 goto err_out_free_eq;
646         }
647
648         err = mlx4_mtt_init(dev, npages, PAGE_SHIFT, &eq->mtt);
649         if (err)
650                 goto err_out_free_eq;
651
652         err = mlx4_write_mtt(dev, &eq->mtt, 0, npages, dma_list);
653         if (err)
654                 goto err_out_free_mtt;
655
656         memset(eq_context, 0, sizeof *eq_context);
657         eq_context->flags         = cpu_to_be32(MLX4_EQ_STATUS_OK   |
658                                                 MLX4_EQ_STATE_ARMED);
659         eq_context->log_eq_size   = ilog2(eq->nent);
660         eq_context->intr          = intr;
661         eq_context->log_page_size = PAGE_SHIFT - MLX4_ICM_PAGE_SHIFT;
662
663         mtt_addr = mlx4_mtt_addr(dev, &eq->mtt);
664         eq_context->mtt_base_addr_h = mtt_addr >> 32;
665         eq_context->mtt_base_addr_l = cpu_to_be32(mtt_addr & 0xffffffff);
666
667         err = mlx4_SW2HW_EQ(dev, mailbox, eq->eqn);
668         if (err) {
669                 mlx4_warn(dev, "SW2HW_EQ failed (%d)\n", err);
670                 goto err_out_free_mtt;
671         }
672
673         kfree(dma_list);
674         mlx4_free_cmd_mailbox(dev, mailbox);
675
676         eq->cons_index = 0;
677
678         return err;
679
680 err_out_free_mtt:
681         mlx4_mtt_cleanup(dev, &eq->mtt);
682
683 err_out_free_eq:
684         mlx4_bitmap_free(&priv->eq_table.bitmap, eq->eqn);
685
686 err_out_free_pages:
687         for (i = 0; i < npages; ++i)
688                 if (eq->page_list[i].buf)
689                         dma_free_coherent(&dev->pdev->dev, PAGE_SIZE,
690                                           eq->page_list[i].buf,
691                                           eq->page_list[i].map);
692
693         mlx4_free_cmd_mailbox(dev, mailbox);
694
695 err_out_free:
696         kfree(eq->page_list);
697         kfree(dma_list);
698
699 err_out:
700         return err;
701 }
702
703 static void mlx4_free_eq(struct mlx4_dev *dev,
704                          struct mlx4_eq *eq)
705 {
706         struct mlx4_priv *priv = mlx4_priv(dev);
707         struct mlx4_cmd_mailbox *mailbox;
708         int err;
709         int npages = PAGE_ALIGN(MLX4_EQ_ENTRY_SIZE * eq->nent) / PAGE_SIZE;
710         int i;
711
712         mailbox = mlx4_alloc_cmd_mailbox(dev);
713         if (IS_ERR(mailbox))
714                 return;
715
716         err = mlx4_HW2SW_EQ(dev, mailbox, eq->eqn);
717         if (err)
718                 mlx4_warn(dev, "HW2SW_EQ failed (%d)\n", err);
719
720         if (0) {
721                 mlx4_dbg(dev, "Dumping EQ context %02x:\n", eq->eqn);
722                 for (i = 0; i < sizeof (struct mlx4_eq_context) / 4; ++i) {
723                         if (i % 4 == 0)
724                                 pr_cont("[%02x] ", i * 4);
725                         pr_cont(" %08x", be32_to_cpup(mailbox->buf + i * 4));
726                         if ((i + 1) % 4 == 0)
727                                 pr_cont("\n");
728                 }
729         }
730
731         mlx4_mtt_cleanup(dev, &eq->mtt);
732         for (i = 0; i < npages; ++i)
733                 dma_free_coherent(&dev->pdev->dev, PAGE_SIZE,
734                                     eq->page_list[i].buf,
735                                     eq->page_list[i].map);
736
737         kfree(eq->page_list);
738         mlx4_bitmap_free(&priv->eq_table.bitmap, eq->eqn);
739         mlx4_free_cmd_mailbox(dev, mailbox);
740 }
741
742 static void mlx4_free_irqs(struct mlx4_dev *dev)
743 {
744         struct mlx4_eq_table *eq_table = &mlx4_priv(dev)->eq_table;
745         struct mlx4_priv *priv = mlx4_priv(dev);
746         int     i, vec;
747
748         if (eq_table->have_irq)
749                 free_irq(dev->pdev->irq, dev);
750
751         for (i = 0; i < dev->caps.num_comp_vectors + 1; ++i)
752                 if (eq_table->eq[i].have_irq) {
753                         free_irq(eq_table->eq[i].irq, eq_table->eq + i);
754                         eq_table->eq[i].have_irq = 0;
755                 }
756
757         for (i = 0; i < dev->caps.comp_pool; i++) {
758                 /*
759                  * Freeing the assigned irq's
760                  * all bits should be 0, but we need to validate
761                  */
762                 if (priv->msix_ctl.pool_bm & 1ULL << i) {
763                         /* NO need protecting*/
764                         vec = dev->caps.num_comp_vectors + 1 + i;
765                         free_irq(priv->eq_table.eq[vec].irq,
766                                  &priv->eq_table.eq[vec]);
767                 }
768         }
769
770
771         kfree(eq_table->irq_names);
772 }
773
774 static int mlx4_map_clr_int(struct mlx4_dev *dev)
775 {
776         struct mlx4_priv *priv = mlx4_priv(dev);
777
778         priv->clr_base = ioremap(pci_resource_start(dev->pdev, priv->fw.clr_int_bar) +
779                                  priv->fw.clr_int_base, MLX4_CLR_INT_SIZE);
780         if (!priv->clr_base) {
781                 mlx4_err(dev, "Couldn't map interrupt clear register, aborting.\n");
782                 return -ENOMEM;
783         }
784
785         return 0;
786 }
787
788 static void mlx4_unmap_clr_int(struct mlx4_dev *dev)
789 {
790         struct mlx4_priv *priv = mlx4_priv(dev);
791
792         iounmap(priv->clr_base);
793 }
794
795 int mlx4_alloc_eq_table(struct mlx4_dev *dev)
796 {
797         struct mlx4_priv *priv = mlx4_priv(dev);
798
799         priv->eq_table.eq = kcalloc(dev->caps.num_eqs - dev->caps.reserved_eqs,
800                                     sizeof *priv->eq_table.eq, GFP_KERNEL);
801         if (!priv->eq_table.eq)
802                 return -ENOMEM;
803
804         return 0;
805 }
806
807 void mlx4_free_eq_table(struct mlx4_dev *dev)
808 {
809         kfree(mlx4_priv(dev)->eq_table.eq);
810 }
811
812 int mlx4_init_eq_table(struct mlx4_dev *dev)
813 {
814         struct mlx4_priv *priv = mlx4_priv(dev);
815         int err;
816         int i;
817
818         priv->eq_table.uar_map = kcalloc(sizeof *priv->eq_table.uar_map,
819                                          mlx4_num_eq_uar(dev), GFP_KERNEL);
820         if (!priv->eq_table.uar_map) {
821                 err = -ENOMEM;
822                 goto err_out_free;
823         }
824
825         err = mlx4_bitmap_init(&priv->eq_table.bitmap, dev->caps.num_eqs,
826                                dev->caps.num_eqs - 1, dev->caps.reserved_eqs, 0);
827         if (err)
828                 goto err_out_free;
829
830         for (i = 0; i < mlx4_num_eq_uar(dev); ++i)
831                 priv->eq_table.uar_map[i] = NULL;
832
833         if (!mlx4_is_slave(dev)) {
834                 err = mlx4_map_clr_int(dev);
835                 if (err)
836                         goto err_out_bitmap;
837
838                 priv->eq_table.clr_mask =
839                         swab32(1 << (priv->eq_table.inta_pin & 31));
840                 priv->eq_table.clr_int  = priv->clr_base +
841                         (priv->eq_table.inta_pin < 32 ? 4 : 0);
842         }
843
844         priv->eq_table.irq_names =
845                 kmalloc(MLX4_IRQNAME_SIZE * (dev->caps.num_comp_vectors + 1 +
846                                              dev->caps.comp_pool),
847                         GFP_KERNEL);
848         if (!priv->eq_table.irq_names) {
849                 err = -ENOMEM;
850                 goto err_out_bitmap;
851         }
852
853         for (i = 0; i < dev->caps.num_comp_vectors; ++i) {
854                 err = mlx4_create_eq(dev, dev->caps.num_cqs -
855                                           dev->caps.reserved_cqs +
856                                           MLX4_NUM_SPARE_EQE,
857                                      (dev->flags & MLX4_FLAG_MSI_X) ? i : 0,
858                                      &priv->eq_table.eq[i]);
859                 if (err) {
860                         --i;
861                         goto err_out_unmap;
862                 }
863         }
864
865         err = mlx4_create_eq(dev, MLX4_NUM_ASYNC_EQE + MLX4_NUM_SPARE_EQE,
866                              (dev->flags & MLX4_FLAG_MSI_X) ? dev->caps.num_comp_vectors : 0,
867                              &priv->eq_table.eq[dev->caps.num_comp_vectors]);
868         if (err)
869                 goto err_out_comp;
870
871         /*if additional completion vectors poolsize is 0 this loop will not run*/
872         for (i = dev->caps.num_comp_vectors + 1;
873               i < dev->caps.num_comp_vectors + dev->caps.comp_pool + 1; ++i) {
874
875                 err = mlx4_create_eq(dev, dev->caps.num_cqs -
876                                           dev->caps.reserved_cqs +
877                                           MLX4_NUM_SPARE_EQE,
878                                      (dev->flags & MLX4_FLAG_MSI_X) ? i : 0,
879                                      &priv->eq_table.eq[i]);
880                 if (err) {
881                         --i;
882                         goto err_out_unmap;
883                 }
884         }
885
886
887         if (dev->flags & MLX4_FLAG_MSI_X) {
888                 const char *eq_name;
889
890                 for (i = 0; i < dev->caps.num_comp_vectors + 1; ++i) {
891                         if (i < dev->caps.num_comp_vectors) {
892                                 snprintf(priv->eq_table.irq_names +
893                                          i * MLX4_IRQNAME_SIZE,
894                                          MLX4_IRQNAME_SIZE,
895                                          "mlx4-comp-%d@pci:%s", i,
896                                          pci_name(dev->pdev));
897                         } else {
898                                 snprintf(priv->eq_table.irq_names +
899                                          i * MLX4_IRQNAME_SIZE,
900                                          MLX4_IRQNAME_SIZE,
901                                          "mlx4-async@pci:%s",
902                                          pci_name(dev->pdev));
903                         }
904
905                         eq_name = priv->eq_table.irq_names +
906                                   i * MLX4_IRQNAME_SIZE;
907                         err = request_irq(priv->eq_table.eq[i].irq,
908                                           mlx4_msi_x_interrupt, 0, eq_name,
909                                           priv->eq_table.eq + i);
910                         if (err)
911                                 goto err_out_async;
912
913                         priv->eq_table.eq[i].have_irq = 1;
914                 }
915         } else {
916                 snprintf(priv->eq_table.irq_names,
917                          MLX4_IRQNAME_SIZE,
918                          DRV_NAME "@pci:%s",
919                          pci_name(dev->pdev));
920                 err = request_irq(dev->pdev->irq, mlx4_interrupt,
921                                   IRQF_SHARED, priv->eq_table.irq_names, dev);
922                 if (err)
923                         goto err_out_async;
924
925                 priv->eq_table.have_irq = 1;
926         }
927
928         err = mlx4_MAP_EQ(dev, MLX4_ASYNC_EVENT_MASK, 0,
929                           priv->eq_table.eq[dev->caps.num_comp_vectors].eqn);
930         if (err)
931                 mlx4_warn(dev, "MAP_EQ for async EQ %d failed (%d)\n",
932                            priv->eq_table.eq[dev->caps.num_comp_vectors].eqn, err);
933
934         for (i = 0; i < dev->caps.num_comp_vectors + 1; ++i)
935                 eq_set_ci(&priv->eq_table.eq[i], 1);
936
937         return 0;
938
939 err_out_async:
940         mlx4_free_eq(dev, &priv->eq_table.eq[dev->caps.num_comp_vectors]);
941
942 err_out_comp:
943         i = dev->caps.num_comp_vectors - 1;
944
945 err_out_unmap:
946         while (i >= 0) {
947                 mlx4_free_eq(dev, &priv->eq_table.eq[i]);
948                 --i;
949         }
950         if (!mlx4_is_slave(dev))
951                 mlx4_unmap_clr_int(dev);
952         mlx4_free_irqs(dev);
953
954 err_out_bitmap:
955         mlx4_bitmap_cleanup(&priv->eq_table.bitmap);
956
957 err_out_free:
958         kfree(priv->eq_table.uar_map);
959
960         return err;
961 }
962
963 void mlx4_cleanup_eq_table(struct mlx4_dev *dev)
964 {
965         struct mlx4_priv *priv = mlx4_priv(dev);
966         int i;
967
968         mlx4_MAP_EQ(dev, MLX4_ASYNC_EVENT_MASK, 1,
969                     priv->eq_table.eq[dev->caps.num_comp_vectors].eqn);
970
971         mlx4_free_irqs(dev);
972
973         for (i = 0; i < dev->caps.num_comp_vectors + dev->caps.comp_pool + 1; ++i)
974                 mlx4_free_eq(dev, &priv->eq_table.eq[i]);
975
976         if (!mlx4_is_slave(dev))
977                 mlx4_unmap_clr_int(dev);
978
979         for (i = 0; i < mlx4_num_eq_uar(dev); ++i)
980                 if (priv->eq_table.uar_map[i])
981                         iounmap(priv->eq_table.uar_map[i]);
982
983         mlx4_bitmap_cleanup(&priv->eq_table.bitmap);
984
985         kfree(priv->eq_table.uar_map);
986 }
987
988 /* A test that verifies that we can accept interrupts on all
989  * the irq vectors of the device.
990  * Interrupts are checked using the NOP command.
991  */
992 int mlx4_test_interrupts(struct mlx4_dev *dev)
993 {
994         struct mlx4_priv *priv = mlx4_priv(dev);
995         int i;
996         int err;
997
998         err = mlx4_NOP(dev);
999         /* When not in MSI_X, there is only one irq to check */
1000         if (!(dev->flags & MLX4_FLAG_MSI_X) || mlx4_is_slave(dev))
1001                 return err;
1002
1003         /* A loop over all completion vectors, for each vector we will check
1004          * whether it works by mapping command completions to that vector
1005          * and performing a NOP command
1006          */
1007         for(i = 0; !err && (i < dev->caps.num_comp_vectors); ++i) {
1008                 /* Temporary use polling for command completions */
1009                 mlx4_cmd_use_polling(dev);
1010
1011                 /* Map the new eq to handle all asyncronous events */
1012                 err = mlx4_MAP_EQ(dev, MLX4_ASYNC_EVENT_MASK, 0,
1013                                   priv->eq_table.eq[i].eqn);
1014                 if (err) {
1015                         mlx4_warn(dev, "Failed mapping eq for interrupt test\n");
1016                         mlx4_cmd_use_events(dev);
1017                         break;
1018                 }
1019
1020                 /* Go back to using events */
1021                 mlx4_cmd_use_events(dev);
1022                 err = mlx4_NOP(dev);
1023         }
1024
1025         /* Return to default */
1026         mlx4_MAP_EQ(dev, MLX4_ASYNC_EVENT_MASK, 0,
1027                     priv->eq_table.eq[dev->caps.num_comp_vectors].eqn);
1028         return err;
1029 }
1030 EXPORT_SYMBOL(mlx4_test_interrupts);
1031
1032 int mlx4_assign_eq(struct mlx4_dev *dev, char* name, int * vector)
1033 {
1034
1035         struct mlx4_priv *priv = mlx4_priv(dev);
1036         int vec = 0, err = 0, i;
1037
1038         spin_lock(&priv->msix_ctl.pool_lock);
1039         for (i = 0; !vec && i < dev->caps.comp_pool; i++) {
1040                 if (~priv->msix_ctl.pool_bm & 1ULL << i) {
1041                         priv->msix_ctl.pool_bm |= 1ULL << i;
1042                         vec = dev->caps.num_comp_vectors + 1 + i;
1043                         snprintf(priv->eq_table.irq_names +
1044                                         vec * MLX4_IRQNAME_SIZE,
1045                                         MLX4_IRQNAME_SIZE, "%s", name);
1046                         err = request_irq(priv->eq_table.eq[vec].irq,
1047                                           mlx4_msi_x_interrupt, 0,
1048                                           &priv->eq_table.irq_names[vec<<5],
1049                                           priv->eq_table.eq + vec);
1050                         if (err) {
1051                                 /*zero out bit by fliping it*/
1052                                 priv->msix_ctl.pool_bm ^= 1 << i;
1053                                 vec = 0;
1054                                 continue;
1055                                 /*we dont want to break here*/
1056                         }
1057                         eq_set_ci(&priv->eq_table.eq[vec], 1);
1058                 }
1059         }
1060         spin_unlock(&priv->msix_ctl.pool_lock);
1061
1062         if (vec) {
1063                 *vector = vec;
1064         } else {
1065                 *vector = 0;
1066                 err = (i == dev->caps.comp_pool) ? -ENOSPC : err;
1067         }
1068         return err;
1069 }
1070 EXPORT_SYMBOL(mlx4_assign_eq);
1071
1072 void mlx4_release_eq(struct mlx4_dev *dev, int vec)
1073 {
1074         struct mlx4_priv *priv = mlx4_priv(dev);
1075         /*bm index*/
1076         int i = vec - dev->caps.num_comp_vectors - 1;
1077
1078         if (likely(i >= 0)) {
1079                 /*sanity check , making sure were not trying to free irq's
1080                   Belonging to a legacy EQ*/
1081                 spin_lock(&priv->msix_ctl.pool_lock);
1082                 if (priv->msix_ctl.pool_bm & 1ULL << i) {
1083                         free_irq(priv->eq_table.eq[vec].irq,
1084                                  &priv->eq_table.eq[vec]);
1085                         priv->msix_ctl.pool_bm &= ~(1ULL << i);
1086                 }
1087                 spin_unlock(&priv->msix_ctl.pool_lock);
1088         }
1089
1090 }
1091 EXPORT_SYMBOL(mlx4_release_eq);
1092