1 /* 2 * Copyright (c) 2013 Intel Corporation. All rights reserved. 3 * Copyright (c) 2006, 2007, 2008, 2009 QLogic Corporation. All rights reserved. 4 * Copyright (c) 2003, 2004, 2005, 2006 PathScale, Inc. All rights reserved. 5 * 6 * This software is available to you under a choice of one of two 7 * licenses. You may choose to be licensed under the terms of the GNU 8 * General Public License (GPL) Version 2, available from the file 9 * COPYING in the main directory of this source tree, or the 10 * OpenIB.org BSD license below: 11 * 12 * Redistribution and use in source and binary forms, with or 13 * without modification, are permitted provided that the following 14 * conditions are met: 15 * 16 * - Redistributions of source code must retain the above 17 * copyright notice, this list of conditions and the following 18 * disclaimer. 19 * 20 * - Redistributions in binary form must reproduce the above 21 * copyright notice, this list of conditions and the following 22 * disclaimer in the documentation and/or other materials 23 * provided with the distribution. 24 * 25 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, 26 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF 27 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND 28 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS 29 * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN 30 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN 31 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE 32 * SOFTWARE. 33 */ 34 35 #include <linux/spinlock.h> 36 #include <linux/pci.h> 37 #include <linux/io.h> 38 #include <linux/delay.h> 39 #include <linux/netdevice.h> 40 #include <linux/vmalloc.h> 41 #include <linux/module.h> 42 #include <linux/prefetch.h> 43 44 #include "qib.h" 45 46 /* 47 * The size has to be longer than this string, so we can append 48 * board/chip information to it in the init code. 49 */ 50 const char ib_qib_version[] = QIB_DRIVER_VERSION "\n"; 51 52 DEFINE_MUTEX(qib_mutex); /* general driver use */ 53 54 unsigned qib_ibmtu; 55 module_param_named(ibmtu, qib_ibmtu, uint, S_IRUGO); 56 MODULE_PARM_DESC(ibmtu, "Set max IB MTU (0=2KB, 1=256, 2=512, ... 5=4096"); 57 58 unsigned qib_compat_ddr_negotiate = 1; 59 module_param_named(compat_ddr_negotiate, qib_compat_ddr_negotiate, uint, 60 S_IWUSR | S_IRUGO); 61 MODULE_PARM_DESC(compat_ddr_negotiate, 62 "Attempt pre-IBTA 1.2 DDR speed negotiation"); 63 64 MODULE_LICENSE("Dual BSD/GPL"); 65 MODULE_AUTHOR("Intel <ibsupport@intel.com>"); 66 MODULE_DESCRIPTION("Intel IB driver"); 67 68 /* 69 * QIB_PIO_MAXIBHDR is the max IB header size allowed for in our 70 * PIO send buffers. This is well beyond anything currently 71 * defined in the InfiniBand spec. 72 */ 73 #define QIB_PIO_MAXIBHDR 128 74 75 /* 76 * QIB_MAX_PKT_RCV is the max # if packets processed per receive interrupt. 77 */ 78 #define QIB_MAX_PKT_RECV 64 79 80 struct qlogic_ib_stats qib_stats; 81 82 struct pci_dev *qib_get_pci_dev(struct rvt_dev_info *rdi) 83 { 84 struct qib_ibdev *ibdev = container_of(rdi, struct qib_ibdev, rdi); 85 struct qib_devdata *dd = container_of(ibdev, 86 struct qib_devdata, verbs_dev); 87 return dd->pcidev; 88 } 89 90 /* 91 * Return count of units with at least one port ACTIVE. 92 */ 93 int qib_count_active_units(void) 94 { 95 struct qib_devdata *dd; 96 struct qib_pportdata *ppd; 97 unsigned long index, flags; 98 int pidx, nunits_active = 0; 99 100 xa_lock_irqsave(&qib_dev_table, flags); 101 xa_for_each(&qib_dev_table, index, dd) { 102 if (!(dd->flags & QIB_PRESENT) || !dd->kregbase) 103 continue; 104 for (pidx = 0; pidx < dd->num_pports; ++pidx) { 105 ppd = dd->pport + pidx; 106 if (ppd->lid && (ppd->lflags & (QIBL_LINKINIT | 107 QIBL_LINKARMED | QIBL_LINKACTIVE))) { 108 nunits_active++; 109 break; 110 } 111 } 112 } 113 xa_unlock_irqrestore(&qib_dev_table, flags); 114 return nunits_active; 115 } 116 117 /* 118 * Return count of all units, optionally return in arguments 119 * the number of usable (present) units, and the number of 120 * ports that are up. 121 */ 122 int qib_count_units(int *npresentp, int *nupp) 123 { 124 int nunits = 0, npresent = 0, nup = 0; 125 struct qib_devdata *dd; 126 unsigned long index, flags; 127 int pidx; 128 struct qib_pportdata *ppd; 129 130 xa_lock_irqsave(&qib_dev_table, flags); 131 xa_for_each(&qib_dev_table, index, dd) { 132 nunits++; 133 if ((dd->flags & QIB_PRESENT) && dd->kregbase) 134 npresent++; 135 for (pidx = 0; pidx < dd->num_pports; ++pidx) { 136 ppd = dd->pport + pidx; 137 if (ppd->lid && (ppd->lflags & (QIBL_LINKINIT | 138 QIBL_LINKARMED | QIBL_LINKACTIVE))) 139 nup++; 140 } 141 } 142 xa_unlock_irqrestore(&qib_dev_table, flags); 143 144 if (npresentp) 145 *npresentp = npresent; 146 if (nupp) 147 *nupp = nup; 148 149 return nunits; 150 } 151 152 /** 153 * qib_wait_linkstate - wait for an IB link state change to occur 154 * @ppd: the qlogic_ib device 155 * @state: the state to wait for 156 * @msecs: the number of milliseconds to wait 157 * 158 * wait up to msecs milliseconds for IB link state change to occur for 159 * now, take the easy polling route. Currently used only by 160 * qib_set_linkstate. Returns 0 if state reached, otherwise 161 * -ETIMEDOUT state can have multiple states set, for any of several 162 * transitions. 163 */ 164 int qib_wait_linkstate(struct qib_pportdata *ppd, u32 state, int msecs) 165 { 166 int ret; 167 unsigned long flags; 168 169 spin_lock_irqsave(&ppd->lflags_lock, flags); 170 if (ppd->state_wanted) { 171 spin_unlock_irqrestore(&ppd->lflags_lock, flags); 172 ret = -EBUSY; 173 goto bail; 174 } 175 ppd->state_wanted = state; 176 spin_unlock_irqrestore(&ppd->lflags_lock, flags); 177 wait_event_interruptible_timeout(ppd->state_wait, 178 (ppd->lflags & state), 179 msecs_to_jiffies(msecs)); 180 spin_lock_irqsave(&ppd->lflags_lock, flags); 181 ppd->state_wanted = 0; 182 spin_unlock_irqrestore(&ppd->lflags_lock, flags); 183 184 if (!(ppd->lflags & state)) 185 ret = -ETIMEDOUT; 186 else 187 ret = 0; 188 bail: 189 return ret; 190 } 191 192 int qib_set_linkstate(struct qib_pportdata *ppd, u8 newstate) 193 { 194 u32 lstate; 195 int ret; 196 struct qib_devdata *dd = ppd->dd; 197 unsigned long flags; 198 199 switch (newstate) { 200 case QIB_IB_LINKDOWN_ONLY: 201 dd->f_set_ib_cfg(ppd, QIB_IB_CFG_LSTATE, 202 IB_LINKCMD_DOWN | IB_LINKINITCMD_NOP); 203 /* don't wait */ 204 ret = 0; 205 goto bail; 206 207 case QIB_IB_LINKDOWN: 208 dd->f_set_ib_cfg(ppd, QIB_IB_CFG_LSTATE, 209 IB_LINKCMD_DOWN | IB_LINKINITCMD_POLL); 210 /* don't wait */ 211 ret = 0; 212 goto bail; 213 214 case QIB_IB_LINKDOWN_SLEEP: 215 dd->f_set_ib_cfg(ppd, QIB_IB_CFG_LSTATE, 216 IB_LINKCMD_DOWN | IB_LINKINITCMD_SLEEP); 217 /* don't wait */ 218 ret = 0; 219 goto bail; 220 221 case QIB_IB_LINKDOWN_DISABLE: 222 dd->f_set_ib_cfg(ppd, QIB_IB_CFG_LSTATE, 223 IB_LINKCMD_DOWN | IB_LINKINITCMD_DISABLE); 224 /* don't wait */ 225 ret = 0; 226 goto bail; 227 228 case QIB_IB_LINKARM: 229 if (ppd->lflags & QIBL_LINKARMED) { 230 ret = 0; 231 goto bail; 232 } 233 if (!(ppd->lflags & (QIBL_LINKINIT | QIBL_LINKACTIVE))) { 234 ret = -EINVAL; 235 goto bail; 236 } 237 /* 238 * Since the port can be ACTIVE when we ask for ARMED, 239 * clear QIBL_LINKV so we can wait for a transition. 240 * If the link isn't ARMED, then something else happened 241 * and there is no point waiting for ARMED. 242 */ 243 spin_lock_irqsave(&ppd->lflags_lock, flags); 244 ppd->lflags &= ~QIBL_LINKV; 245 spin_unlock_irqrestore(&ppd->lflags_lock, flags); 246 dd->f_set_ib_cfg(ppd, QIB_IB_CFG_LSTATE, 247 IB_LINKCMD_ARMED | IB_LINKINITCMD_NOP); 248 lstate = QIBL_LINKV; 249 break; 250 251 case QIB_IB_LINKACTIVE: 252 if (ppd->lflags & QIBL_LINKACTIVE) { 253 ret = 0; 254 goto bail; 255 } 256 if (!(ppd->lflags & QIBL_LINKARMED)) { 257 ret = -EINVAL; 258 goto bail; 259 } 260 dd->f_set_ib_cfg(ppd, QIB_IB_CFG_LSTATE, 261 IB_LINKCMD_ACTIVE | IB_LINKINITCMD_NOP); 262 lstate = QIBL_LINKACTIVE; 263 break; 264 265 default: 266 ret = -EINVAL; 267 goto bail; 268 } 269 ret = qib_wait_linkstate(ppd, lstate, 10); 270 271 bail: 272 return ret; 273 } 274 275 /* 276 * Get address of eager buffer from it's index (allocated in chunks, not 277 * contiguous). 278 */ 279 static inline void *qib_get_egrbuf(const struct qib_ctxtdata *rcd, u32 etail) 280 { 281 const u32 chunk = etail >> rcd->rcvegrbufs_perchunk_shift; 282 const u32 idx = etail & ((u32)rcd->rcvegrbufs_perchunk - 1); 283 284 return rcd->rcvegrbuf[chunk] + (idx << rcd->dd->rcvegrbufsize_shift); 285 } 286 287 /* 288 * Returns 1 if error was a CRC, else 0. 289 * Needed for some chip's synthesized error counters. 290 */ 291 static u32 qib_rcv_hdrerr(struct qib_ctxtdata *rcd, struct qib_pportdata *ppd, 292 u32 ctxt, u32 eflags, u32 l, u32 etail, 293 __le32 *rhf_addr, struct qib_message_header *rhdr) 294 { 295 u32 ret = 0; 296 297 if (eflags & (QLOGIC_IB_RHF_H_ICRCERR | QLOGIC_IB_RHF_H_VCRCERR)) 298 ret = 1; 299 else if (eflags == QLOGIC_IB_RHF_H_TIDERR) { 300 /* For TIDERR and RC QPs premptively schedule a NAK */ 301 struct ib_header *hdr = (struct ib_header *)rhdr; 302 struct ib_other_headers *ohdr = NULL; 303 struct qib_ibport *ibp = &ppd->ibport_data; 304 struct qib_devdata *dd = ppd->dd; 305 struct rvt_dev_info *rdi = &dd->verbs_dev.rdi; 306 struct rvt_qp *qp = NULL; 307 u32 tlen = qib_hdrget_length_in_bytes(rhf_addr); 308 u16 lid = be16_to_cpu(hdr->lrh[1]); 309 int lnh = be16_to_cpu(hdr->lrh[0]) & 3; 310 u32 qp_num; 311 u32 opcode; 312 u32 psn; 313 int diff; 314 315 /* Sanity check packet */ 316 if (tlen < 24) 317 goto drop; 318 319 if (lid < be16_to_cpu(IB_MULTICAST_LID_BASE)) { 320 lid &= ~((1 << ppd->lmc) - 1); 321 if (unlikely(lid != ppd->lid)) 322 goto drop; 323 } 324 325 /* Check for GRH */ 326 if (lnh == QIB_LRH_BTH) 327 ohdr = &hdr->u.oth; 328 else if (lnh == QIB_LRH_GRH) { 329 u32 vtf; 330 331 ohdr = &hdr->u.l.oth; 332 if (hdr->u.l.grh.next_hdr != IB_GRH_NEXT_HDR) 333 goto drop; 334 vtf = be32_to_cpu(hdr->u.l.grh.version_tclass_flow); 335 if ((vtf >> IB_GRH_VERSION_SHIFT) != IB_GRH_VERSION) 336 goto drop; 337 } else 338 goto drop; 339 340 /* Get opcode and PSN from packet */ 341 opcode = be32_to_cpu(ohdr->bth[0]); 342 opcode >>= 24; 343 psn = be32_to_cpu(ohdr->bth[2]); 344 345 /* Get the destination QP number. */ 346 qp_num = be32_to_cpu(ohdr->bth[1]) & RVT_QPN_MASK; 347 if (qp_num != QIB_MULTICAST_QPN) { 348 int ruc_res; 349 350 rcu_read_lock(); 351 qp = rvt_lookup_qpn(rdi, &ibp->rvp, qp_num); 352 if (!qp) { 353 rcu_read_unlock(); 354 goto drop; 355 } 356 357 /* 358 * Handle only RC QPs - for other QP types drop error 359 * packet. 360 */ 361 spin_lock(&qp->r_lock); 362 363 /* Check for valid receive state. */ 364 if (!(ib_rvt_state_ops[qp->state] & 365 RVT_PROCESS_RECV_OK)) { 366 ibp->rvp.n_pkt_drops++; 367 goto unlock; 368 } 369 370 switch (qp->ibqp.qp_type) { 371 case IB_QPT_RC: 372 ruc_res = 373 qib_ruc_check_hdr( 374 ibp, hdr, 375 lnh == QIB_LRH_GRH, 376 qp, 377 be32_to_cpu(ohdr->bth[0])); 378 if (ruc_res) 379 goto unlock; 380 381 /* Only deal with RDMA Writes for now */ 382 if (opcode < 383 IB_OPCODE_RC_RDMA_READ_RESPONSE_FIRST) { 384 diff = qib_cmp24(psn, qp->r_psn); 385 if (!qp->r_nak_state && diff >= 0) { 386 ibp->rvp.n_rc_seqnak++; 387 qp->r_nak_state = 388 IB_NAK_PSN_ERROR; 389 /* Use the expected PSN. */ 390 qp->r_ack_psn = qp->r_psn; 391 /* 392 * Wait to send the sequence 393 * NAK until all packets 394 * in the receive queue have 395 * been processed. 396 * Otherwise, we end up 397 * propagating congestion. 398 */ 399 if (list_empty(&qp->rspwait)) { 400 qp->r_flags |= 401 RVT_R_RSP_NAK; 402 rvt_get_qp(qp); 403 list_add_tail( 404 &qp->rspwait, 405 &rcd->qp_wait_list); 406 } 407 } /* Out of sequence NAK */ 408 } /* QP Request NAKs */ 409 break; 410 case IB_QPT_SMI: 411 case IB_QPT_GSI: 412 case IB_QPT_UD: 413 case IB_QPT_UC: 414 default: 415 /* For now don't handle any other QP types */ 416 break; 417 } 418 419 unlock: 420 spin_unlock(&qp->r_lock); 421 rcu_read_unlock(); 422 } /* Unicast QP */ 423 } /* Valid packet with TIDErr */ 424 425 drop: 426 return ret; 427 } 428 429 /* 430 * qib_kreceive - receive a packet 431 * @rcd: the qlogic_ib context 432 * @llic: gets count of good packets needed to clear lli, 433 * (used with chips that need need to track crcs for lli) 434 * 435 * called from interrupt handler for errors or receive interrupt 436 * Returns number of CRC error packets, needed by some chips for 437 * local link integrity tracking. crcs are adjusted down by following 438 * good packets, if any, and count of good packets is also tracked. 439 */ 440 u32 qib_kreceive(struct qib_ctxtdata *rcd, u32 *llic, u32 *npkts) 441 { 442 struct qib_devdata *dd = rcd->dd; 443 struct qib_pportdata *ppd = rcd->ppd; 444 __le32 *rhf_addr; 445 void *ebuf; 446 const u32 rsize = dd->rcvhdrentsize; /* words */ 447 const u32 maxcnt = dd->rcvhdrcnt * rsize; /* words */ 448 u32 etail = -1, l, hdrqtail; 449 struct qib_message_header *hdr; 450 u32 eflags, etype, tlen, i = 0, updegr = 0, crcs = 0; 451 int last; 452 u64 lval; 453 struct rvt_qp *qp, *nqp; 454 455 l = rcd->head; 456 rhf_addr = (__le32 *) rcd->rcvhdrq + l + dd->rhf_offset; 457 if (dd->flags & QIB_NODMA_RTAIL) { 458 u32 seq = qib_hdrget_seq(rhf_addr); 459 460 if (seq != rcd->seq_cnt) 461 goto bail; 462 hdrqtail = 0; 463 } else { 464 hdrqtail = qib_get_rcvhdrtail(rcd); 465 if (l == hdrqtail) 466 goto bail; 467 smp_rmb(); /* prevent speculative reads of dma'ed hdrq */ 468 } 469 470 for (last = 0, i = 1; !last; i += !last) { 471 hdr = dd->f_get_msgheader(dd, rhf_addr); 472 eflags = qib_hdrget_err_flags(rhf_addr); 473 etype = qib_hdrget_rcv_type(rhf_addr); 474 /* total length */ 475 tlen = qib_hdrget_length_in_bytes(rhf_addr); 476 ebuf = NULL; 477 if ((dd->flags & QIB_NODMA_RTAIL) ? 478 qib_hdrget_use_egr_buf(rhf_addr) : 479 (etype != RCVHQ_RCV_TYPE_EXPECTED)) { 480 etail = qib_hdrget_index(rhf_addr); 481 updegr = 1; 482 if (tlen > sizeof(*hdr) || 483 etype >= RCVHQ_RCV_TYPE_NON_KD) { 484 ebuf = qib_get_egrbuf(rcd, etail); 485 prefetch_range(ebuf, tlen - sizeof(*hdr)); 486 } 487 } 488 if (!eflags) { 489 u16 lrh_len = be16_to_cpu(hdr->lrh[2]) << 2; 490 491 if (lrh_len != tlen) { 492 qib_stats.sps_lenerrs++; 493 goto move_along; 494 } 495 } 496 if (etype == RCVHQ_RCV_TYPE_NON_KD && !eflags && 497 ebuf == NULL && 498 tlen > (dd->rcvhdrentsize - 2 + 1 - 499 qib_hdrget_offset(rhf_addr)) << 2) { 500 goto move_along; 501 } 502 503 /* 504 * Both tiderr and qibhdrerr are set for all plain IB 505 * packets; only qibhdrerr should be set. 506 */ 507 if (unlikely(eflags)) 508 crcs += qib_rcv_hdrerr(rcd, ppd, rcd->ctxt, eflags, l, 509 etail, rhf_addr, hdr); 510 else if (etype == RCVHQ_RCV_TYPE_NON_KD) { 511 qib_ib_rcv(rcd, hdr, ebuf, tlen); 512 if (crcs) 513 crcs--; 514 else if (llic && *llic) 515 --*llic; 516 } 517 move_along: 518 l += rsize; 519 if (l >= maxcnt) 520 l = 0; 521 if (i == QIB_MAX_PKT_RECV) 522 last = 1; 523 524 rhf_addr = (__le32 *) rcd->rcvhdrq + l + dd->rhf_offset; 525 if (dd->flags & QIB_NODMA_RTAIL) { 526 u32 seq = qib_hdrget_seq(rhf_addr); 527 528 if (++rcd->seq_cnt > 13) 529 rcd->seq_cnt = 1; 530 if (seq != rcd->seq_cnt) 531 last = 1; 532 } else if (l == hdrqtail) 533 last = 1; 534 /* 535 * Update head regs etc., every 16 packets, if not last pkt, 536 * to help prevent rcvhdrq overflows, when many packets 537 * are processed and queue is nearly full. 538 * Don't request an interrupt for intermediate updates. 539 */ 540 lval = l; 541 if (!last && !(i & 0xf)) { 542 dd->f_update_usrhead(rcd, lval, updegr, etail, i); 543 updegr = 0; 544 } 545 } 546 547 rcd->head = l; 548 549 /* 550 * Iterate over all QPs waiting to respond. 551 * The list won't change since the IRQ is only run on one CPU. 552 */ 553 list_for_each_entry_safe(qp, nqp, &rcd->qp_wait_list, rspwait) { 554 list_del_init(&qp->rspwait); 555 if (qp->r_flags & RVT_R_RSP_NAK) { 556 qp->r_flags &= ~RVT_R_RSP_NAK; 557 qib_send_rc_ack(qp); 558 } 559 if (qp->r_flags & RVT_R_RSP_SEND) { 560 unsigned long flags; 561 562 qp->r_flags &= ~RVT_R_RSP_SEND; 563 spin_lock_irqsave(&qp->s_lock, flags); 564 if (ib_rvt_state_ops[qp->state] & 565 RVT_PROCESS_OR_FLUSH_SEND) 566 qib_schedule_send(qp); 567 spin_unlock_irqrestore(&qp->s_lock, flags); 568 } 569 rvt_put_qp(qp); 570 } 571 572 bail: 573 /* Report number of packets consumed */ 574 if (npkts) 575 *npkts = i; 576 577 /* 578 * Always write head at end, and setup rcv interrupt, even 579 * if no packets were processed. 580 */ 581 lval = (u64)rcd->head | dd->rhdrhead_intr_off; 582 dd->f_update_usrhead(rcd, lval, updegr, etail, i); 583 return crcs; 584 } 585 586 /** 587 * qib_set_mtu - set the MTU 588 * @ppd: the perport data 589 * @arg: the new MTU 590 * 591 * We can handle "any" incoming size, the issue here is whether we 592 * need to restrict our outgoing size. For now, we don't do any 593 * sanity checking on this, and we don't deal with what happens to 594 * programs that are already running when the size changes. 595 * NOTE: changing the MTU will usually cause the IBC to go back to 596 * link INIT state... 597 */ 598 int qib_set_mtu(struct qib_pportdata *ppd, u16 arg) 599 { 600 u32 piosize; 601 int ret, chk; 602 603 if (arg != 256 && arg != 512 && arg != 1024 && arg != 2048 && 604 arg != 4096) { 605 ret = -EINVAL; 606 goto bail; 607 } 608 chk = ib_mtu_enum_to_int(qib_ibmtu); 609 if (chk > 0 && arg > chk) { 610 ret = -EINVAL; 611 goto bail; 612 } 613 614 piosize = ppd->ibmaxlen; 615 ppd->ibmtu = arg; 616 617 if (arg >= (piosize - QIB_PIO_MAXIBHDR)) { 618 /* Only if it's not the initial value (or reset to it) */ 619 if (piosize != ppd->init_ibmaxlen) { 620 if (arg > piosize && arg <= ppd->init_ibmaxlen) 621 piosize = ppd->init_ibmaxlen - 2 * sizeof(u32); 622 ppd->ibmaxlen = piosize; 623 } 624 } else if ((arg + QIB_PIO_MAXIBHDR) != ppd->ibmaxlen) { 625 piosize = arg + QIB_PIO_MAXIBHDR - 2 * sizeof(u32); 626 ppd->ibmaxlen = piosize; 627 } 628 629 ppd->dd->f_set_ib_cfg(ppd, QIB_IB_CFG_MTU, 0); 630 631 ret = 0; 632 633 bail: 634 return ret; 635 } 636 637 int qib_set_lid(struct qib_pportdata *ppd, u32 lid, u8 lmc) 638 { 639 struct qib_devdata *dd = ppd->dd; 640 641 ppd->lid = lid; 642 ppd->lmc = lmc; 643 644 dd->f_set_ib_cfg(ppd, QIB_IB_CFG_LIDLMC, 645 lid | (~((1U << lmc) - 1)) << 16); 646 647 qib_devinfo(dd->pcidev, "IB%u:%u got a lid: 0x%x\n", 648 dd->unit, ppd->port, lid); 649 650 return 0; 651 } 652 653 /* 654 * Following deal with the "obviously simple" task of overriding the state 655 * of the LEDS, which normally indicate link physical and logical status. 656 * The complications arise in dealing with different hardware mappings 657 * and the board-dependent routine being called from interrupts. 658 * and then there's the requirement to _flash_ them. 659 */ 660 #define LED_OVER_FREQ_SHIFT 8 661 #define LED_OVER_FREQ_MASK (0xFF<<LED_OVER_FREQ_SHIFT) 662 /* Below is "non-zero" to force override, but both actual LEDs are off */ 663 #define LED_OVER_BOTH_OFF (8) 664 665 static void qib_run_led_override(struct timer_list *t) 666 { 667 struct qib_pportdata *ppd = from_timer(ppd, t, 668 led_override_timer); 669 struct qib_devdata *dd = ppd->dd; 670 int timeoff; 671 int ph_idx; 672 673 if (!(dd->flags & QIB_INITTED)) 674 return; 675 676 ph_idx = ppd->led_override_phase++ & 1; 677 ppd->led_override = ppd->led_override_vals[ph_idx]; 678 timeoff = ppd->led_override_timeoff; 679 680 dd->f_setextled(ppd, 1); 681 /* 682 * don't re-fire the timer if user asked for it to be off; we let 683 * it fire one more time after they turn it off to simplify 684 */ 685 if (ppd->led_override_vals[0] || ppd->led_override_vals[1]) 686 mod_timer(&ppd->led_override_timer, jiffies + timeoff); 687 } 688 689 void qib_set_led_override(struct qib_pportdata *ppd, unsigned int val) 690 { 691 struct qib_devdata *dd = ppd->dd; 692 int timeoff, freq; 693 694 if (!(dd->flags & QIB_INITTED)) 695 return; 696 697 /* First check if we are blinking. If not, use 1HZ polling */ 698 timeoff = HZ; 699 freq = (val & LED_OVER_FREQ_MASK) >> LED_OVER_FREQ_SHIFT; 700 701 if (freq) { 702 /* For blink, set each phase from one nybble of val */ 703 ppd->led_override_vals[0] = val & 0xF; 704 ppd->led_override_vals[1] = (val >> 4) & 0xF; 705 timeoff = (HZ << 4)/freq; 706 } else { 707 /* Non-blink set both phases the same. */ 708 ppd->led_override_vals[0] = val & 0xF; 709 ppd->led_override_vals[1] = val & 0xF; 710 } 711 ppd->led_override_timeoff = timeoff; 712 713 /* 714 * If the timer has not already been started, do so. Use a "quick" 715 * timeout so the function will be called soon, to look at our request. 716 */ 717 if (atomic_inc_return(&ppd->led_override_timer_active) == 1) { 718 /* Need to start timer */ 719 timer_setup(&ppd->led_override_timer, qib_run_led_override, 0); 720 ppd->led_override_timer.expires = jiffies + 1; 721 add_timer(&ppd->led_override_timer); 722 } else { 723 if (ppd->led_override_vals[0] || ppd->led_override_vals[1]) 724 mod_timer(&ppd->led_override_timer, jiffies + 1); 725 atomic_dec(&ppd->led_override_timer_active); 726 } 727 } 728 729 /** 730 * qib_reset_device - reset the chip if possible 731 * @unit: the device to reset 732 * 733 * Whether or not reset is successful, we attempt to re-initialize the chip 734 * (that is, much like a driver unload/reload). We clear the INITTED flag 735 * so that the various entry points will fail until we reinitialize. For 736 * now, we only allow this if no user contexts are open that use chip resources 737 */ 738 int qib_reset_device(int unit) 739 { 740 int ret, i; 741 struct qib_devdata *dd = qib_lookup(unit); 742 struct qib_pportdata *ppd; 743 unsigned long flags; 744 int pidx; 745 746 if (!dd) { 747 ret = -ENODEV; 748 goto bail; 749 } 750 751 qib_devinfo(dd->pcidev, "Reset on unit %u requested\n", unit); 752 753 if (!dd->kregbase || !(dd->flags & QIB_PRESENT)) { 754 qib_devinfo(dd->pcidev, 755 "Invalid unit number %u or not initialized or not present\n", 756 unit); 757 ret = -ENXIO; 758 goto bail; 759 } 760 761 spin_lock_irqsave(&dd->uctxt_lock, flags); 762 if (dd->rcd) 763 for (i = dd->first_user_ctxt; i < dd->cfgctxts; i++) { 764 if (!dd->rcd[i] || !dd->rcd[i]->cnt) 765 continue; 766 spin_unlock_irqrestore(&dd->uctxt_lock, flags); 767 ret = -EBUSY; 768 goto bail; 769 } 770 spin_unlock_irqrestore(&dd->uctxt_lock, flags); 771 772 for (pidx = 0; pidx < dd->num_pports; ++pidx) { 773 ppd = dd->pport + pidx; 774 if (atomic_read(&ppd->led_override_timer_active)) { 775 /* Need to stop LED timer, _then_ shut off LEDs */ 776 del_timer_sync(&ppd->led_override_timer); 777 atomic_set(&ppd->led_override_timer_active, 0); 778 } 779 780 /* Shut off LEDs after we are sure timer is not running */ 781 ppd->led_override = LED_OVER_BOTH_OFF; 782 dd->f_setextled(ppd, 0); 783 if (dd->flags & QIB_HAS_SEND_DMA) 784 qib_teardown_sdma(ppd); 785 } 786 787 ret = dd->f_reset(dd); 788 if (ret == 1) 789 ret = qib_init(dd, 1); 790 else 791 ret = -EAGAIN; 792 if (ret) 793 qib_dev_err(dd, 794 "Reinitialize unit %u after reset failed with %d\n", 795 unit, ret); 796 else 797 qib_devinfo(dd->pcidev, 798 "Reinitialized unit %u after resetting\n", 799 unit); 800 801 bail: 802 return ret; 803 } 804