]> git.proxmox.com Git - mirror_ubuntu-eoan-kernel.git/blame - drivers/infiniband/hw/ehca/ehca_irq.c
projects / mirror_ubuntu-eoan-kernel.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
include cleanup: Update gfp.h and slab.h includes to prepare for breaking implicit...
[mirror_ubuntu-eoan-kernel.git] / drivers / infiniband / hw / ehca / ehca_irq.c
CommitLineData
fab97220
HS		 1/*
2 * IBM eServer eHCA Infiniband device driver for Linux on POWER
3 *
4 * Functions for EQs, NEQs and interrupts
5 *
6 * Authors: Heiko J Schick <schickhj@de.ibm.com>
7 * Khadija Souissi <souissi@de.ibm.com>
28db6beb
JF		 8 * Hoang-Nam Nguyen <hnguyen@de.ibm.com>
9 * Joachim Fenkes <fenkes@de.ibm.com>
fab97220
HS		 10 *
11 * Copyright (c) 2005 IBM Corporation
12 *
13 * All rights reserved.
14 *
15 * This source code is distributed under a dual license of GPL v2.0 and OpenIB
16 * BSD.
17 *
18 * OpenIB BSD License
19 *
20 * Redistribution and use in source and binary forms, with or without
21 * modification, are permitted provided that the following conditions are met:
22 *
23 * Redistributions of source code must retain the above copyright notice, this
24 * list of conditions and the following disclaimer.
25 *
26 * Redistributions in binary form must reproduce the above copyright notice,
27 * this list of conditions and the following disclaimer in the documentation
28 * and/or other materials
29 * provided with the distribution.
30 *
31 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
32 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
33 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
34 * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
35 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
36 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
37 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
38 * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER
39 * IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
40 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
41 * POSSIBILITY OF SUCH DAMAGE.
42 */
43
5a0e3ad6
TH		 44#include <linux/slab.h>
45
fab97220
HS		 46#include "ehca_classes.h"
47#include "ehca_irq.h"
48#include "ehca_iverbs.h"
49#include "ehca_tools.h"
50#include "hcp_if.h"
51#include "hipz_fns.h"
7e28db5d 52#include "ipz_pt_fn.h"
fab97220 53
2b94397a
HNN		 54#define EQE_COMPLETION_EVENT EHCA_BMASK_IBM( 1, 1)
55#define EQE_CQ_QP_NUMBER EHCA_BMASK_IBM( 8, 31)
56#define EQE_EE_IDENTIFIER EHCA_BMASK_IBM( 2, 7)
57#define EQE_CQ_NUMBER EHCA_BMASK_IBM( 8, 31)
58#define EQE_QP_NUMBER EHCA_BMASK_IBM( 8, 31)
59#define EQE_QP_TOKEN EHCA_BMASK_IBM(32, 63)
60#define EQE_CQ_TOKEN EHCA_BMASK_IBM(32, 63)
61
62#define NEQE_COMPLETION_EVENT EHCA_BMASK_IBM( 1, 1)
63#define NEQE_EVENT_CODE EHCA_BMASK_IBM( 2, 7)
64#define NEQE_PORT_NUMBER EHCA_BMASK_IBM( 8, 15)
65#define NEQE_PORT_AVAILABILITY EHCA_BMASK_IBM(16, 16)
66#define NEQE_DISRUPTIVE EHCA_BMASK_IBM(16, 16)
e57d62a1 67#define NEQE_SPECIFIC_EVENT EHCA_BMASK_IBM(16, 23)
2b94397a
HNN		 68
69#define ERROR_DATA_LENGTH EHCA_BMASK_IBM(52, 63)
70#define ERROR_DATA_TYPE EHCA_BMASK_IBM( 0, 7)
fab97220 71
fab97220
HS		 72static void queue_comp_task(struct ehca_cq *__cq);
73
2b94397a 74static struct ehca_comp_pool *pool;
fab97220 75
fab97220
HS		 76static inline void comp_event_callback(struct ehca_cq *cq)
77{
78 if (!cq->ib_cq.comp_handler)
79 return;
80
81 spin_lock(&cq->cb_lock);
82 cq->ib_cq.comp_handler(&cq->ib_cq, cq->ib_cq.cq_context);
83 spin_unlock(&cq->cb_lock);
84
85 return;
86}
87
2b94397a
HNN		 88static void print_error_data(struct ehca_shca *shca, void *data,
89 u64 *rblock, int length)
fab97220
HS		 90{
91 u64 type = EHCA_BMASK_GET(ERROR_DATA_TYPE, rblock[2]);
92 u64 resource = rblock[1];
93
94 switch (type) {
95 case 0x1: /* Queue Pair */
96 {
2b94397a 97 struct ehca_qp *qp = (struct ehca_qp *)data;
fab97220
HS		 98
99 /* only print error data if AER is set */
100 if (rblock[6] == 0)
101 return;
102
103 ehca_err(&shca->ib_device,
3750f605 104 "QP 0x%x (resource=%llx) has errors.",
fab97220
HS		 105 qp->ib_qp.qp_num, resource);
106 break;
107 }
108 case 0x4: /* Completion Queue */
109 {
2b94397a 110 struct ehca_cq *cq = (struct ehca_cq *)data;
fab97220
HS		 111
112 ehca_err(&shca->ib_device,
3750f605 113 "CQ 0x%x (resource=%llx) has errors.",
fab97220
HS		 114 cq->cq_number, resource);
115 break;
116 }
117 default:
118 ehca_err(&shca->ib_device,
3750f605 119 "Unknown error type: %llx on %s.",
fab97220
HS		 120 type, shca->ib_device.name);
121 break;
122 }
123
3750f605 124 ehca_err(&shca->ib_device, "Error data is available: %llx.", resource);
fab97220
HS		 125 ehca_err(&shca->ib_device, "EHCA ----- error data begin "
126 "---------------------------------------------------");
3750f605 127 ehca_dmp(rblock, length, "resource=%llx", resource);
fab97220
HS		 128 ehca_err(&shca->ib_device, "EHCA ----- error data end "
129 "----------------------------------------------------");
130
131 return;
132}
133
134int ehca_error_data(struct ehca_shca *shca, void *data,
135 u64 resource)
136{
137
138 unsigned long ret;
139 u64 *rblock;
140 unsigned long block_count;
141
f2d91361 142 rblock = ehca_alloc_fw_ctrlblock(GFP_ATOMIC);
fab97220
HS		 143 if (!rblock) {
144 ehca_err(&shca->ib_device, "Cannot allocate rblock memory.");
145 ret = -ENOMEM;
146 goto error_data1;
147 }
148
7e28db5d 149 /* rblock must be 4K aligned and should be 4K large */
fab97220
HS		 150 ret = hipz_h_error_data(shca->ipz_hca_handle,
151 resource,
152 rblock,
153 &block_count);
154
7e28db5d 155 if (ret == H_R_STATE)
fab97220 156 ehca_err(&shca->ib_device,
3750f605 157 "No error data is available: %llx.", resource);
fab97220
HS		 158 else if (ret == H_SUCCESS) {
159 int length;
160
161 length = EHCA_BMASK_GET(ERROR_DATA_LENGTH, rblock[0]);
162
7e28db5d
HNN		 163 if (length > EHCA_PAGESIZE)
164 length = EHCA_PAGESIZE;
fab97220
HS		 165
166 print_error_data(shca, data, rblock, length);
7e28db5d 167 } else
fab97220 168 ehca_err(&shca->ib_device,
3750f605 169 "Error data could not be fetched: %llx", resource);
fab97220 170
7e28db5d 171 ehca_free_fw_ctrlblock(rblock);
fab97220
HS		 172
173error_data1:
174 return ret;
175
176}
177
5ff70cac
JF		 178static void dispatch_qp_event(struct ehca_shca *shca, struct ehca_qp *qp,
179 enum ib_event_type event_type)
fab97220
HS		 180{
181 struct ib_event event;
fab97220 182
5b673b71
JF		 183 /* PATH_MIG without the QP ever having been armed is false alarm */
184 if (event_type == IB_EVENT_PATH_MIG && !qp->mig_armed)
185 return;
186
633a5aed 187 event.device = &shca->ib_device;
5ff70cac 188 event.event = event_type;
fab97220 189
633a5aed
HNN		 190 if (qp->ext_type == EQPT_SRQ) {
191 if (!qp->ib_srq.event_handler)
192 return;
fab97220 193
633a5aed
HNN		 194 event.element.srq = &qp->ib_srq;
195 qp->ib_srq.event_handler(&event, qp->ib_srq.srq_context);
196 } else {
197 if (!qp->ib_qp.event_handler)
198 return;
199
633a5aed
HNN		 200 event.element.qp = &qp->ib_qp;
201 qp->ib_qp.event_handler(&event, qp->ib_qp.qp_context);
202 }
5ff70cac
JF		 203}
204
205static void qp_event_callback(struct ehca_shca *shca, u64 eqe,
206 enum ib_event_type event_type, int fatal)
207{
208 struct ehca_qp *qp;
209 u32 token = EHCA_BMASK_GET(EQE_QP_TOKEN, eqe);
210
211 read_lock(&ehca_qp_idr_lock);
212 qp = idr_find(&ehca_qp_idr, token);
12137c59
SR		 213 if (qp)
214 atomic_inc(&qp->nr_events);
5ff70cac
JF		 215 read_unlock(&ehca_qp_idr_lock);
216
217 if (!qp)
218 return;
219
220 if (fatal)
221 ehca_error_data(shca, qp, qp->ipz_qp_handle.handle);
222
223 dispatch_qp_event(shca, qp, fatal && qp->ext_type == EQPT_SRQ ?
224 IB_EVENT_SRQ_ERR : event_type);
225
226 /*
227 * eHCA only processes one WQE at a time for SRQ base QPs,
228 * so the last WQE has been processed as soon as the QP enters
229 * error state.
230 */
231 if (fatal && qp->ext_type == EQPT_SRQBASE)
232 dispatch_qp_event(shca, qp, IB_EVENT_QP_LAST_WQE_REACHED);
fab97220 233
12137c59
SR		 234 if (atomic_dec_and_test(&qp->nr_events))
235 wake_up(&qp->wait_completion);
fab97220
HS		 236 return;
237}
238
239static void cq_event_callback(struct ehca_shca *shca,
78d8d5f9 240 u64 eqe)
fab97220
HS		 241{
242 struct ehca_cq *cq;
fab97220
HS		 243 u32 token = EHCA_BMASK_GET(EQE_CQ_TOKEN, eqe);
244
26ed687f 245 read_lock(&ehca_cq_idr_lock);
fab97220 246 cq = idr_find(&ehca_cq_idr, token);
28db6beb
JF		 247 if (cq)
248 atomic_inc(&cq->nr_events);
26ed687f 249 read_unlock(&ehca_cq_idr_lock);
fab97220
HS		 250
251 if (!cq)
252 return;
253
254 ehca_error_data(shca, cq, cq->ipz_cq_handle.handle);
255
28db6beb
JF		 256 if (atomic_dec_and_test(&cq->nr_events))
257 wake_up(&cq->wait_completion);
258
fab97220
HS		 259 return;
260}
261
262static void parse_identifier(struct ehca_shca *shca, u64 eqe)
263{
264 u8 identifier = EHCA_BMASK_GET(EQE_EE_IDENTIFIER, eqe);
265
266 switch (identifier) {
267 case 0x02: /* path migrated */
633a5aed 268 qp_event_callback(shca, eqe, IB_EVENT_PATH_MIG, 0);
fab97220
HS		 269 break;
270 case 0x03: /* communication established */
633a5aed 271 qp_event_callback(shca, eqe, IB_EVENT_COMM_EST, 0);
fab97220
HS		 272 break;
273 case 0x04: /* send queue drained */
633a5aed 274 qp_event_callback(shca, eqe, IB_EVENT_SQ_DRAINED, 0);
fab97220
HS		 275 break;
276 case 0x05: /* QP error */
277 case 0x06: /* QP error */
633a5aed 278 qp_event_callback(shca, eqe, IB_EVENT_QP_FATAL, 1);
fab97220
HS		 279 break;
280 case 0x07: /* CQ error */
281 case 0x08: /* CQ error */
282 cq_event_callback(shca, eqe);
283 break;
284 case 0x09: /* MRMWPTE error */
285 ehca_err(&shca->ib_device, "MRMWPTE error.");
286 break;
287 case 0x0A: /* port event */
288 ehca_err(&shca->ib_device, "Port event.");
289 break;
290 case 0x0B: /* MR access error */
291 ehca_err(&shca->ib_device, "MR access error.");
292 break;
293 case 0x0C: /* EQ error */
294 ehca_err(&shca->ib_device, "EQ error.");
295 break;
296 case 0x0D: /* P/Q_Key mismatch */
297 ehca_err(&shca->ib_device, "P/Q_Key mismatch.");
298 break;
299 case 0x10: /* sampling complete */
300 ehca_err(&shca->ib_device, "Sampling complete.");
301 break;
302 case 0x11: /* unaffiliated access error */
303 ehca_err(&shca->ib_device, "Unaffiliated access error.");
304 break;
e90d0b3d
JF		 305 case 0x12: /* path migrating */
306 ehca_err(&shca->ib_device, "Path migrating.");
fab97220
HS		 307 break;
308 case 0x13: /* interface trace stopped */
309 ehca_err(&shca->ib_device, "Interface trace stopped.");
310 break;
311 case 0x14: /* first error capture info available */
633a5aed
HNN		 312 ehca_info(&shca->ib_device, "First error capture available");
313 break;
314 case 0x15: /* SRQ limit reached */
315 qp_event_callback(shca, eqe, IB_EVENT_SRQ_LIMIT_REACHED, 0);
316 break;
fab97220
HS		 317 default:
318 ehca_err(&shca->ib_device, "Unknown identifier: %x on %s.",
319 identifier, shca->ib_device.name);
320 break;
321 }
322
323 return;
324}
325
8705ce5b
JF		 326static void dispatch_port_event(struct ehca_shca *shca, int port_num,
327 enum ib_event_type type, const char *msg)
fab97220
HS		 328{
329 struct ib_event event;
8705ce5b
JF		 330
331 ehca_info(&shca->ib_device, "port %d %s.", port_num, msg);
332 event.device = &shca->ib_device;
333 event.event = type;
334 event.element.port_num = port_num;
335 ib_dispatch_event(&event);
336}
337
338static void notify_port_conf_change(struct ehca_shca *shca, int port_num)
339{
340 struct ehca_sma_attr new_attr;
341 struct ehca_sma_attr *old_attr = &shca->sport[port_num - 1].saved_attr;
342
343 ehca_query_sma_attr(shca, port_num, &new_attr);
344
345 if (new_attr.sm_sl != old_attr->sm_sl ||
346 new_attr.sm_lid != old_attr->sm_lid)
347 dispatch_port_event(shca, port_num, IB_EVENT_SM_CHANGE,
348 "SM changed");
349
350 if (new_attr.lid != old_attr->lid ||
351 new_attr.lmc != old_attr->lmc)
352 dispatch_port_event(shca, port_num, IB_EVENT_LID_CHANGE,
353 "LID changed");
354
355 if (new_attr.pkey_tbl_len != old_attr->pkey_tbl_len ||
356 memcmp(new_attr.pkeys, old_attr->pkeys,
357 sizeof(u16) * new_attr.pkey_tbl_len))
358 dispatch_port_event(shca, port_num, IB_EVENT_PKEY_CHANGE,
359 "P_Key changed");
360
361 *old_attr = new_attr;
362}
363
fad96ab6
SR		 364/* replay modify_qp for sqps -- return 0 if all is well, 1 if AQP1 destroyed */
365static int replay_modify_qp(struct ehca_sport *sport)
366{
367 int aqp1_destroyed;
368 unsigned long flags;
369
370 spin_lock_irqsave(&sport->mod_sqp_lock, flags);
371
372 aqp1_destroyed = !sport->ibqp_sqp[IB_QPT_GSI];
373
374 if (sport->ibqp_sqp[IB_QPT_SMI])
375 ehca_recover_sqp(sport->ibqp_sqp[IB_QPT_SMI]);
376 if (!aqp1_destroyed)
377 ehca_recover_sqp(sport->ibqp_sqp[IB_QPT_GSI]);
378
379 spin_unlock_irqrestore(&sport->mod_sqp_lock, flags);
380
381 return aqp1_destroyed;
382}
383
8705ce5b
JF		 384static void parse_ec(struct ehca_shca *shca, u64 eqe)
385{
fab97220
HS		 386 u8 ec = EHCA_BMASK_GET(NEQE_EVENT_CODE, eqe);
387 u8 port = EHCA_BMASK_GET(NEQE_PORT_NUMBER, eqe);
e57d62a1 388 u8 spec_event;
bbdd267e 389 struct ehca_sport *sport = &shca->sport[port - 1];
fab97220
HS		 390
391 switch (ec) {
392 case 0x30: /* port availability change */
393 if (EHCA_BMASK_GET(NEQE_PORT_AVAILABILITY, eqe)) {
fad96ab6
SR		 394 /* only replay modify_qp calls in autodetect mode;
395 * if AQP1 was destroyed, the port is already down
396 * again and we can drop the event.
397 */
398 if (ehca_nr_ports < 0)
399 if (replay_modify_qp(sport))
400 break;
bbdd267e
HNN		 401
402 sport->port_state = IB_PORT_ACTIVE;
8705ce5b
JF		 403 dispatch_port_event(shca, port, IB_EVENT_PORT_ACTIVE,
404 "is active");
fad96ab6 405 ehca_query_sma_attr(shca, port, &sport->saved_attr);
fab97220 406 } else {
bbdd267e 407 sport->port_state = IB_PORT_DOWN;
8705ce5b
JF		 408 dispatch_port_event(shca, port, IB_EVENT_PORT_ERR,
409 "is inactive");
fab97220
HS		 410 }
411 break;
412 case 0x31:
413 /* port configuration change
414 * disruptive change is caused by
415 * LID, PKEY or SM change
416 */
8705ce5b
JF		 417 if (EHCA_BMASK_GET(NEQE_DISRUPTIVE, eqe)) {
418 ehca_warn(&shca->ib_device, "disruptive port "
419 "%d configuration change", port);
420
bbdd267e 421 sport->port_state = IB_PORT_DOWN;
8705ce5b
JF		 422 dispatch_port_event(shca, port, IB_EVENT_PORT_ERR,
423 "is inactive");
424
bbdd267e 425 sport->port_state = IB_PORT_ACTIVE;
8705ce5b
JF		 426 dispatch_port_event(shca, port, IB_EVENT_PORT_ACTIVE,
427 "is active");
528b03f7
JF		 428 ehca_query_sma_attr(shca, port,
429 &sport->saved_attr);
8705ce5b
JF		 430 } else
431 notify_port_conf_change(shca, port);
fab97220
HS		 432 break;
433 case 0x32: /* adapter malfunction */
434 ehca_err(&shca->ib_device, "Adapter malfunction.");
435 break;
436 case 0x33: /* trace stopped */
437 ehca_err(&shca->ib_device, "Traced stopped.");
438 break;
e57d62a1
HNN		 439 case 0x34: /* util async event */
440 spec_event = EHCA_BMASK_GET(NEQE_SPECIFIC_EVENT, eqe);
441 if (spec_event == 0x80) /* client reregister required */
442 dispatch_port_event(shca, port,
443 IB_EVENT_CLIENT_REREGISTER,
444 "client reregister req.");
445 else
446 ehca_warn(&shca->ib_device, "Unknown util async "
447 "event %x on port %x", spec_event, port);
448 break;
fab97220
HS		 449 default:
450 ehca_err(&shca->ib_device, "Unknown event code: %x on %s.",
451 ec, shca->ib_device.name);
452 break;
453 }
454
455 return;
456}
457
458static inline void reset_eq_pending(struct ehca_cq *cq)
459{
460 u64 CQx_EP;
461 struct h_galpa gal = cq->galpas.kernel;
462
463 hipz_galpa_store_cq(gal, cqx_ep, 0x0);
464 CQx_EP = hipz_galpa_load(gal, CQTEMM_OFFSET(cqx_ep));
465
466 return;
467}
468
7d12e780 469irqreturn_t ehca_interrupt_neq(int irq, void *dev_id)
fab97220
HS		 470{
471 struct ehca_shca *shca = (struct ehca_shca*)dev_id;
472
473 tasklet_hi_schedule(&shca->neq.interrupt_task);
474
475 return IRQ_HANDLED;
476}
477
478void ehca_tasklet_neq(unsigned long data)
479{
480 struct ehca_shca *shca = (struct ehca_shca*)data;
481 struct ehca_eqe *eqe;
482 u64 ret;
483
5b891a93 484 eqe = ehca_poll_eq(shca, &shca->neq);
fab97220
HS		 485
486 while (eqe) {
487 if (!EHCA_BMASK_GET(NEQE_COMPLETION_EVENT, eqe->entry))
488 parse_ec(shca, eqe->entry);
489
5b891a93 490 eqe = ehca_poll_eq(shca, &shca->neq);
fab97220
HS		 491 }
492
493 ret = hipz_h_reset_event(shca->ipz_hca_handle,
494 shca->neq.ipz_eq_handle, 0xFFFFFFFFFFFFFFFFL);
495
496 if (ret != H_SUCCESS)
497 ehca_err(&shca->ib_device, "Can't clear notification events.");
498
499 return;
500}
501
7d12e780 502irqreturn_t ehca_interrupt_eq(int irq, void *dev_id)
fab97220
HS		 503{
504 struct ehca_shca *shca = (struct ehca_shca*)dev_id;
505
506 tasklet_hi_schedule(&shca->eq.interrupt_task);
507
508 return IRQ_HANDLED;
509}
510
fab97220 511
78d8d5f9
HNN		 512static inline void process_eqe(struct ehca_shca *shca, struct ehca_eqe *eqe)
513{
514 u64 eqe_value;
515 u32 token;
78d8d5f9 516 struct ehca_cq *cq;
31726798 517
78d8d5f9 518 eqe_value = eqe->entry;
3750f605 519 ehca_dbg(&shca->ib_device, "eqe_value=%llx", eqe_value);
78d8d5f9 520 if (EHCA_BMASK_GET(EQE_COMPLETION_EVENT, eqe_value)) {
31726798 521 ehca_dbg(&shca->ib_device, "Got completion event");
78d8d5f9 522 token = EHCA_BMASK_GET(EQE_CQ_TOKEN, eqe_value);
26ed687f 523 read_lock(&ehca_cq_idr_lock);
78d8d5f9 524 cq = idr_find(&ehca_cq_idr, token);
28db6beb
JF		 525 if (cq)
526 atomic_inc(&cq->nr_events);
26ed687f 527 read_unlock(&ehca_cq_idr_lock);
78d8d5f9 528 if (cq == NULL) {
78d8d5f9
HNN		 529 ehca_err(&shca->ib_device,
530 "Invalid eqe for non-existing cq token=%x",
531 token);
532 return;
533 }
534 reset_eq_pending(cq);
31726798 535 if (ehca_scaling_code)
4fd30060 536 queue_comp_task(cq);
31726798 537 else {
4fd30060 538 comp_event_callback(cq);
28db6beb 539 if (atomic_dec_and_test(&cq->nr_events))
31726798 540 wake_up(&cq->wait_completion);
4fd30060 541 }
78d8d5f9 542 } else {
31726798 543 ehca_dbg(&shca->ib_device, "Got non completion event");
78d8d5f9
HNN		 544 parse_identifier(shca, eqe_value);
545 }
546}
fab97220 547
78d8d5f9
HNN		 548void ehca_process_eq(struct ehca_shca *shca, int is_irq)
549{
550 struct ehca_eq *eq = &shca->eq;
551 struct ehca_eqe_cache_entry *eqe_cache = eq->eqe_cache;
6f7bc01a 552 u64 eqe_value, ret;
78d8d5f9
HNN		 553 int eqe_cnt, i;
554 int eq_empty = 0;
555
25ef7563 556 spin_lock(&eq->irq_spinlock);
78d8d5f9
HNN		 557 if (is_irq) {
558 const int max_query_cnt = 100;
559 int query_cnt = 0;
560 int int_state = 1;
561 do {
562 int_state = hipz_h_query_int_state(
563 shca->ipz_hca_handle, eq->ist);
564 query_cnt++;
565 iosync();
566 } while (int_state && query_cnt < max_query_cnt);
567 if (unlikely((query_cnt == max_query_cnt)))
568 ehca_dbg(&shca->ib_device, "int_state=%x query_cnt=%x",
569 int_state, query_cnt);
570 }
fab97220 571
78d8d5f9
HNN		 572 /* read out all eqes */
573 eqe_cnt = 0;
574 do {
575 u32 token;
5b891a93 576 eqe_cache[eqe_cnt].eqe = ehca_poll_eq(shca, eq);
78d8d5f9
HNN		 577 if (!eqe_cache[eqe_cnt].eqe)
578 break;
579 eqe_value = eqe_cache[eqe_cnt].eqe->entry;
580 if (EHCA_BMASK_GET(EQE_COMPLETION_EVENT, eqe_value)) {
581 token = EHCA_BMASK_GET(EQE_CQ_TOKEN, eqe_value);
26ed687f 582 read_lock(&ehca_cq_idr_lock);
78d8d5f9 583 eqe_cache[eqe_cnt].cq = idr_find(&ehca_cq_idr, token);
28db6beb
JF		 584 if (eqe_cache[eqe_cnt].cq)
585 atomic_inc(&eqe_cache[eqe_cnt].cq->nr_events);
26ed687f 586 read_unlock(&ehca_cq_idr_lock);
78d8d5f9 587 if (!eqe_cache[eqe_cnt].cq) {
78d8d5f9
HNN		 588 ehca_err(&shca->ib_device,
589 "Invalid eqe for non-existing cq "
590 "token=%x", token);
591 continue;
592 }
78d8d5f9
HNN		 593 } else
594 eqe_cache[eqe_cnt].cq = NULL;
595 eqe_cnt++;
596 } while (eqe_cnt < EHCA_EQE_CACHE_SIZE);
597 if (!eqe_cnt) {
598 if (is_irq)
599 ehca_dbg(&shca->ib_device,
600 "No eqe found for irq event");
601 goto unlock_irq_spinlock;
6f7bc01a
SR		 602 } else if (!is_irq) {
603 ret = hipz_h_eoi(eq->ist);
604 if (ret != H_SUCCESS)
605 ehca_err(&shca->ib_device,
3750f605 606 "bad return code EOI -rc = %lld\n", ret);
78d8d5f9 607 ehca_dbg(&shca->ib_device, "deadman found %x eqe", eqe_cnt);
6f7bc01a 608 }
78d8d5f9
HNN		 609 if (unlikely(eqe_cnt == EHCA_EQE_CACHE_SIZE))
610 ehca_dbg(&shca->ib_device, "too many eqes for one irq event");
611 /* enable irq for new packets */
612 for (i = 0; i < eqe_cnt; i++) {
613 if (eq->eqe_cache[i].cq)
614 reset_eq_pending(eq->eqe_cache[i].cq);
615 }
616 /* check eq */
617 spin_lock(&eq->spinlock);
618 eq_empty = (!ipz_eqit_eq_peek_valid(&shca->eq.ipz_queue));
619 spin_unlock(&eq->spinlock);
620 /* call completion handler for cached eqes */
621 for (i = 0; i < eqe_cnt; i++)
622 if (eq->eqe_cache[i].cq) {
31726798 623 if (ehca_scaling_code)
4fd30060 624 queue_comp_task(eq->eqe_cache[i].cq);
31726798
HNN		 625 else {
626 struct ehca_cq *cq = eq->eqe_cache[i].cq;
627 comp_event_callback(cq);
28db6beb 628 if (atomic_dec_and_test(&cq->nr_events))
31726798 629 wake_up(&cq->wait_completion);
31726798 630 }
78d8d5f9
HNN		 631 } else {
632 ehca_dbg(&shca->ib_device, "Got non completion event");
633 parse_identifier(shca, eq->eqe_cache[i].eqe->entry);
fab97220 634 }
78d8d5f9
HNN		 635 /* poll eq if not empty */
636 if (eq_empty)
637 goto unlock_irq_spinlock;
638 do {
639 struct ehca_eqe *eqe;
5b891a93 640 eqe = ehca_poll_eq(shca, &shca->eq);
78d8d5f9
HNN		 641 if (!eqe)
642 break;
643 process_eqe(shca, eqe);
78d8d5f9
HNN		 644 } while (1);
645
646unlock_irq_spinlock:
25ef7563 647 spin_unlock(&eq->irq_spinlock);
78d8d5f9 648}
fab97220 649
78d8d5f9
HNN		 650void ehca_tasklet_eq(unsigned long data)
651{
652 ehca_process_eq((struct ehca_shca*)data, 1);
fab97220
HS		 653}
654
2b94397a 655static inline int find_next_online_cpu(struct ehca_comp_pool *pool)
fab97220 656{
8b16cef3
HNN		 657 int cpu;
658 unsigned long flags;
fab97220 659
8b16cef3 660 WARN_ON_ONCE(!in_interrupt());
4da27d6d 661 if (ehca_debug_level >= 3)
b29179c3 662 ehca_dmp(cpu_online_mask, cpumask_size(), "");
fab97220 663
8b16cef3 664 spin_lock_irqsave(&pool->last_cpu_lock, flags);
b29179c3 665 cpu = cpumask_next(pool->last_cpu, cpu_online_mask);
5d7bfd0c 666 if (cpu >= nr_cpu_ids)
b29179c3 667 cpu = cpumask_first(cpu_online_mask);
8b16cef3
HNN		 668 pool->last_cpu = cpu;
669 spin_unlock_irqrestore(&pool->last_cpu_lock, flags);
fab97220 670
8b16cef3 671 return cpu;
fab97220
HS		 672}
673
674static void __queue_comp_task(struct ehca_cq *__cq,
675 struct ehca_cpu_comp_task *cct)
676{
8b16cef3 677 unsigned long flags;
fab97220 678
8b16cef3
HNN		 679 spin_lock_irqsave(&cct->task_lock, flags);
680 spin_lock(&__cq->task_lock);
fab97220
HS		 681
682 if (__cq->nr_callbacks == 0) {
683 __cq->nr_callbacks++;
684 list_add_tail(&__cq->entry, &cct->cq_list);
685 cct->cq_jobs++;
686 wake_up(&cct->wait_queue);
31726798 687 } else
fab97220
HS		 688 __cq->nr_callbacks++;
689
8b16cef3
HNN		 690 spin_unlock(&__cq->task_lock);
691 spin_unlock_irqrestore(&cct->task_lock, flags);
fab97220
HS		 692}
693
694static void queue_comp_task(struct ehca_cq *__cq)
695{
fab97220
HS		 696 int cpu_id;
697 struct ehca_cpu_comp_task *cct;
31726798
HNN		 698 int cq_jobs;
699 unsigned long flags;
fab97220 700
fab97220 701 cpu_id = find_next_online_cpu(pool);
fab97220
HS		 702 BUG_ON(!cpu_online(cpu_id));
703
704 cct = per_cpu_ptr(pool->cpu_comp_tasks, cpu_id);
8b16cef3 705 BUG_ON(!cct);
fab97220 706
31726798
HNN		 707 spin_lock_irqsave(&cct->task_lock, flags);
708 cq_jobs = cct->cq_jobs;
709 spin_unlock_irqrestore(&cct->task_lock, flags);
710 if (cq_jobs > 0) {
fab97220
HS		 711 cpu_id = find_next_online_cpu(pool);
712 cct = per_cpu_ptr(pool->cpu_comp_tasks, cpu_id);
8b16cef3 713 BUG_ON(!cct);
fab97220
HS		 714 }
715
716 __queue_comp_task(__cq, cct);
fab97220
HS		 717}
718
2b94397a 719static void run_comp_task(struct ehca_cpu_comp_task *cct)
fab97220
HS		 720{
721 struct ehca_cq *cq;
8b16cef3 722 unsigned long flags;
fab97220 723
8b16cef3 724 spin_lock_irqsave(&cct->task_lock, flags);
fab97220
HS		 725
726 while (!list_empty(&cct->cq_list)) {
727 cq = list_entry(cct->cq_list.next, struct ehca_cq, entry);
8b16cef3 728 spin_unlock_irqrestore(&cct->task_lock, flags);
fab97220 729
28db6beb
JF		 730 comp_event_callback(cq);
731 if (atomic_dec_and_test(&cq->nr_events))
31726798 732 wake_up(&cq->wait_completion);
31726798
HNN		 733
734 spin_lock_irqsave(&cct->task_lock, flags);
8b16cef3 735 spin_lock(&cq->task_lock);
fab97220 736 cq->nr_callbacks--;
31726798 737 if (!cq->nr_callbacks) {
fab97220
HS		 738 list_del_init(cct->cq_list.next);
739 cct->cq_jobs--;
740 }
8b16cef3 741 spin_unlock(&cq->task_lock);
fab97220
HS		 742 }
743
8b16cef3 744 spin_unlock_irqrestore(&cct->task_lock, flags);
fab97220
HS		 745}
746
747static int comp_task(void *__cct)
748{
2b94397a 749 struct ehca_cpu_comp_task *cct = __cct;
8b16cef3 750 int cql_empty;
fab97220
HS		 751 DECLARE_WAITQUEUE(wait, current);
752
753 set_current_state(TASK_INTERRUPTIBLE);
2b94397a 754 while (!kthread_should_stop()) {
fab97220
HS		 755 add_wait_queue(&cct->wait_queue, &wait);
756
8b16cef3
HNN		 757 spin_lock_irq(&cct->task_lock);
758 cql_empty = list_empty(&cct->cq_list);
759 spin_unlock_irq(&cct->task_lock);
760 if (cql_empty)
fab97220
HS		 761 schedule();
762 else
763 __set_current_state(TASK_RUNNING);
764
765 remove_wait_queue(&cct->wait_queue, &wait);
766
8b16cef3
HNN		 767 spin_lock_irq(&cct->task_lock);
768 cql_empty = list_empty(&cct->cq_list);
769 spin_unlock_irq(&cct->task_lock);
770 if (!cql_empty)
fab97220
HS		 771 run_comp_task(__cct);
772
773 set_current_state(TASK_INTERRUPTIBLE);
774 }
775 __set_current_state(TASK_RUNNING);
776
777 return 0;
778}
779
780static struct task_struct *create_comp_task(struct ehca_comp_pool *pool,
781 int cpu)
782{
783 struct ehca_cpu_comp_task *cct;
784
785 cct = per_cpu_ptr(pool->cpu_comp_tasks, cpu);
786 spin_lock_init(&cct->task_lock);
787 INIT_LIST_HEAD(&cct->cq_list);
788 init_waitqueue_head(&cct->wait_queue);
789 cct->task = kthread_create(comp_task, cct, "ehca_comp/%d", cpu);
790
791 return cct->task;
792}
793
794static void destroy_comp_task(struct ehca_comp_pool *pool,
795 int cpu)
796{
797 struct ehca_cpu_comp_task *cct;
798 struct task_struct *task;
799 unsigned long flags_cct;
800
801 cct = per_cpu_ptr(pool->cpu_comp_tasks, cpu);
802
803 spin_lock_irqsave(&cct->task_lock, flags_cct);
804
805 task = cct->task;
806 cct->task = NULL;
807 cct->cq_jobs = 0;
808
809 spin_unlock_irqrestore(&cct->task_lock, flags_cct);
810
811 if (task)
812 kthread_stop(task);
fab97220
HS		 813}
814
9faa559c 815static void __cpuinit take_over_work(struct ehca_comp_pool *pool, int cpu)
fab97220
HS		 816{
817 struct ehca_cpu_comp_task *cct = per_cpu_ptr(pool->cpu_comp_tasks, cpu);
818 LIST_HEAD(list);
819 struct ehca_cq *cq;
820 unsigned long flags_cct;
821
822 spin_lock_irqsave(&cct->task_lock, flags_cct);
823
824 list_splice_init(&cct->cq_list, &list);
825
2b94397a 826 while (!list_empty(&list)) {
78d8d5f9 827 cq = list_entry(cct->cq_list.next, struct ehca_cq, entry);
fab97220 828
78d8d5f9 829 list_del(&cq->entry);
ca0c9584 830 __queue_comp_task(cq, this_cpu_ptr(pool->cpu_comp_tasks));
fab97220
HS		 831 }
832
833 spin_unlock_irqrestore(&cct->task_lock, flags_cct);
834
835}
836
9faa559c
SS		 837static int __cpuinit comp_pool_callback(struct notifier_block *nfb,
838 unsigned long action,
839 void *hcpu)
fab97220
HS		 840{
841 unsigned int cpu = (unsigned long)hcpu;
842 struct ehca_cpu_comp_task *cct;
843
844 switch (action) {
845 case CPU_UP_PREPARE:
8bb78442 846 case CPU_UP_PREPARE_FROZEN:
fab97220 847 ehca_gen_dbg("CPU: %x (CPU_PREPARE)", cpu);
2b94397a 848 if (!create_comp_task(pool, cpu)) {
fab97220
HS		 849 ehca_gen_err("Can't create comp_task for cpu: %x", cpu);
850 return NOTIFY_BAD;
851 }
852 break;
853 case CPU_UP_CANCELED:
8bb78442 854 case CPU_UP_CANCELED_FROZEN:
fab97220
HS		 855 ehca_gen_dbg("CPU: %x (CPU_CANCELED)", cpu);
856 cct = per_cpu_ptr(pool->cpu_comp_tasks, cpu);
b29179c3 857 kthread_bind(cct->task, cpumask_any(cpu_online_mask));
fab97220
HS		 858 destroy_comp_task(pool, cpu);
859 break;
860 case CPU_ONLINE:
8bb78442 861 case CPU_ONLINE_FROZEN:
fab97220
HS		 862 ehca_gen_dbg("CPU: %x (CPU_ONLINE)", cpu);
863 cct = per_cpu_ptr(pool->cpu_comp_tasks, cpu);
864 kthread_bind(cct->task, cpu);
865 wake_up_process(cct->task);
866 break;
867 case CPU_DOWN_PREPARE:
8bb78442 868 case CPU_DOWN_PREPARE_FROZEN:
fab97220
HS		 869 ehca_gen_dbg("CPU: %x (CPU_DOWN_PREPARE)", cpu);
870 break;
871 case CPU_DOWN_FAILED:
8bb78442 872 case CPU_DOWN_FAILED_FROZEN:
fab97220
HS		 873 ehca_gen_dbg("CPU: %x (CPU_DOWN_FAILED)", cpu);
874 break;
875 case CPU_DEAD:
8bb78442 876 case CPU_DEAD_FROZEN:
fab97220
HS		 877 ehca_gen_dbg("CPU: %x (CPU_DEAD)", cpu);
878 destroy_comp_task(pool, cpu);
879 take_over_work(pool, cpu);
880 break;
881 }
882
883 return NOTIFY_OK;
884}
9faa559c
SS		 885
886static struct notifier_block comp_pool_callback_nb __cpuinitdata = {
887 .notifier_call = comp_pool_callback,
888 .priority = 0,
889};
fab97220 890
fab97220
HS		 891int ehca_create_comp_pool(void)
892{
fab97220
HS		 893 int cpu;
894 struct task_struct *task;
895
4fd30060
HNN		 896 if (!ehca_scaling_code)
897 return 0;
898
fab97220
HS		 899 pool = kzalloc(sizeof(struct ehca_comp_pool), GFP_KERNEL);
900 if (pool == NULL)
901 return -ENOMEM;
902
903 spin_lock_init(&pool->last_cpu_lock);
b29179c3 904 pool->last_cpu = cpumask_any(cpu_online_mask);
fab97220
HS		 905
906 pool->cpu_comp_tasks = alloc_percpu(struct ehca_cpu_comp_task);
907 if (pool->cpu_comp_tasks == NULL) {
908 kfree(pool);
909 return -EINVAL;
910 }
911
912 for_each_online_cpu(cpu) {
913 task = create_comp_task(pool, cpu);
914 if (task) {
915 kthread_bind(task, cpu);
916 wake_up_process(task);
917 }
918 }
919
9faa559c 920 register_hotcpu_notifier(&comp_pool_callback_nb);
4fd30060
HNN		 921
922 printk(KERN_INFO "eHCA scaling code enabled\n");
fab97220
HS		 923
924 return 0;
925}
926
927void ehca_destroy_comp_pool(void)
928{
fab97220
HS		 929 int i;
930
4fd30060
HNN		 931 if (!ehca_scaling_code)
932 return;
933
9faa559c 934 unregister_hotcpu_notifier(&comp_pool_callback_nb);
fab97220 935
259c4ddd
RR		 936 for_each_online_cpu(i)
937 destroy_comp_task(pool, i);
938
65e5c026
AM		 939 free_percpu(pool->cpu_comp_tasks);
940 kfree(pool);
fab97220 941}
Ubuntu Eoan Linux kernel mirror