1 // SPDX-License-Identifier: GPL-2.0 2 /* 3 * UHCI-specific debugging code. Invaluable when something 4 * goes wrong, but don't get in my face. 5 * 6 * Kernel visible pointers are surrounded in []s and bus 7 * visible pointers are surrounded in ()s 8 * 9 * (C) Copyright 1999 Linus Torvalds 10 * (C) Copyright 1999-2001 Johannes Erdfelt 11 */ 12 13 #include <linux/slab.h> 14 #include <linux/kernel.h> 15 #include <linux/debugfs.h> 16 #include <asm/io.h> 17 18 #include "uhci-hcd.h" 19 20 #define EXTRA_SPACE 1024 21 22 static struct dentry *uhci_debugfs_root; 23 24 #ifdef CONFIG_DYNAMIC_DEBUG 25 26 /* Handle REALLY large printks so we don't overflow buffers */ lprintk(char * buf)27 static void lprintk(char *buf) 28 { 29 char *p; 30 31 /* Just write one line at a time */ 32 while (buf) { 33 p = strchr(buf, '\n'); 34 if (p) 35 *p = 0; 36 printk(KERN_DEBUG "%s\n", buf); 37 buf = p; 38 if (buf) 39 buf++; 40 } 41 } 42 uhci_show_td(struct uhci_hcd * uhci,struct uhci_td * td,char * buf,int len,int space)43 static int uhci_show_td(struct uhci_hcd *uhci, struct uhci_td *td, char *buf, 44 int len, int space) 45 { 46 char *out = buf; 47 char *spid; 48 u32 status, token; 49 50 status = td_status(uhci, td); 51 out += sprintf(out, "%*s[%p] link (%08x) ", space, "", td, 52 hc32_to_cpu(uhci, td->link)); 53 out += sprintf(out, "e%d %s%s%s%s%s%s%s%s%s%sLength=%x ", 54 ((status >> 27) & 3), 55 (status & TD_CTRL_SPD) ? "SPD " : "", 56 (status & TD_CTRL_LS) ? "LS " : "", 57 (status & TD_CTRL_IOC) ? "IOC " : "", 58 (status & TD_CTRL_ACTIVE) ? "Active " : "", 59 (status & TD_CTRL_STALLED) ? "Stalled " : "", 60 (status & TD_CTRL_DBUFERR) ? "DataBufErr " : "", 61 (status & TD_CTRL_BABBLE) ? "Babble " : "", 62 (status & TD_CTRL_NAK) ? "NAK " : "", 63 (status & TD_CTRL_CRCTIMEO) ? "CRC/Timeo " : "", 64 (status & TD_CTRL_BITSTUFF) ? "BitStuff " : "", 65 status & 0x7ff); 66 if (out - buf > len) 67 goto done; 68 69 token = td_token(uhci, td); 70 switch (uhci_packetid(token)) { 71 case USB_PID_SETUP: 72 spid = "SETUP"; 73 break; 74 case USB_PID_OUT: 75 spid = "OUT"; 76 break; 77 case USB_PID_IN: 78 spid = "IN"; 79 break; 80 default: 81 spid = "?"; 82 break; 83 } 84 85 out += sprintf(out, "MaxLen=%x DT%d EndPt=%x Dev=%x, PID=%x(%s) ", 86 token >> 21, 87 ((token >> 19) & 1), 88 (token >> 15) & 15, 89 (token >> 8) & 127, 90 (token & 0xff), 91 spid); 92 out += sprintf(out, "(buf=%08x)\n", hc32_to_cpu(uhci, td->buffer)); 93 94 done: 95 if (out - buf > len) 96 out += sprintf(out, " ...\n"); 97 return out - buf; 98 } 99 uhci_show_urbp(struct uhci_hcd * uhci,struct urb_priv * urbp,char * buf,int len,int space)100 static int uhci_show_urbp(struct uhci_hcd *uhci, struct urb_priv *urbp, 101 char *buf, int len, int space) 102 { 103 char *out = buf; 104 struct uhci_td *td; 105 int i, nactive, ninactive; 106 char *ptype; 107 108 109 out += sprintf(out, "urb_priv [%p] ", urbp); 110 out += sprintf(out, "urb [%p] ", urbp->urb); 111 out += sprintf(out, "qh [%p] ", urbp->qh); 112 out += sprintf(out, "Dev=%d ", usb_pipedevice(urbp->urb->pipe)); 113 out += sprintf(out, "EP=%x(%s) ", usb_pipeendpoint(urbp->urb->pipe), 114 (usb_pipein(urbp->urb->pipe) ? "IN" : "OUT")); 115 if (out - buf > len) 116 goto done; 117 118 switch (usb_pipetype(urbp->urb->pipe)) { 119 case PIPE_ISOCHRONOUS: ptype = "ISO"; break; 120 case PIPE_INTERRUPT: ptype = "INT"; break; 121 case PIPE_BULK: ptype = "BLK"; break; 122 default: 123 case PIPE_CONTROL: ptype = "CTL"; break; 124 } 125 126 out += sprintf(out, "%s%s", ptype, (urbp->fsbr ? " FSBR" : "")); 127 out += sprintf(out, " Actlen=%d%s", urbp->urb->actual_length, 128 (urbp->qh->type == USB_ENDPOINT_XFER_CONTROL ? 129 "-8" : "")); 130 131 if (urbp->urb->unlinked) 132 out += sprintf(out, " Unlinked=%d", urbp->urb->unlinked); 133 out += sprintf(out, "\n"); 134 135 if (out - buf > len) 136 goto done; 137 138 i = nactive = ninactive = 0; 139 list_for_each_entry(td, &urbp->td_list, list) { 140 if (urbp->qh->type != USB_ENDPOINT_XFER_ISOC && 141 (++i <= 10 || debug > 2)) { 142 out += sprintf(out, "%*s%d: ", space + 2, "", i); 143 out += uhci_show_td(uhci, td, out, 144 len - (out - buf), 0); 145 if (out - buf > len) 146 goto tail; 147 } else { 148 if (td_status(uhci, td) & TD_CTRL_ACTIVE) 149 ++nactive; 150 else 151 ++ninactive; 152 } 153 } 154 if (nactive + ninactive > 0) 155 out += sprintf(out, 156 "%*s[skipped %d inactive and %d active TDs]\n", 157 space, "", ninactive, nactive); 158 done: 159 if (out - buf > len) 160 out += sprintf(out, " ...\n"); 161 tail: 162 return out - buf; 163 } 164 uhci_show_qh(struct uhci_hcd * uhci,struct uhci_qh * qh,char * buf,int len,int space)165 static int uhci_show_qh(struct uhci_hcd *uhci, 166 struct uhci_qh *qh, char *buf, int len, int space) 167 { 168 char *out = buf; 169 int i, nurbs; 170 __hc32 element = qh_element(qh); 171 char *qtype; 172 173 switch (qh->type) { 174 case USB_ENDPOINT_XFER_ISOC: qtype = "ISO"; break; 175 case USB_ENDPOINT_XFER_INT: qtype = "INT"; break; 176 case USB_ENDPOINT_XFER_BULK: qtype = "BLK"; break; 177 case USB_ENDPOINT_XFER_CONTROL: qtype = "CTL"; break; 178 default: qtype = "Skel" ; break; 179 } 180 181 out += sprintf(out, "%*s[%p] %s QH link (%08x) element (%08x)\n", 182 space, "", qh, qtype, 183 hc32_to_cpu(uhci, qh->link), 184 hc32_to_cpu(uhci, element)); 185 if (qh->type == USB_ENDPOINT_XFER_ISOC) 186 out += sprintf(out, 187 "%*s period %d phase %d load %d us, frame %x desc [%p]\n", 188 space, "", qh->period, qh->phase, qh->load, 189 qh->iso_frame, qh->iso_packet_desc); 190 else if (qh->type == USB_ENDPOINT_XFER_INT) 191 out += sprintf(out, "%*s period %d phase %d load %d us\n", 192 space, "", qh->period, qh->phase, qh->load); 193 if (out - buf > len) 194 goto done; 195 196 if (element & UHCI_PTR_QH(uhci)) 197 out += sprintf(out, "%*s Element points to QH (bug?)\n", space, ""); 198 199 if (element & UHCI_PTR_DEPTH(uhci)) 200 out += sprintf(out, "%*s Depth traverse\n", space, ""); 201 202 if (element & cpu_to_hc32(uhci, 8)) 203 out += sprintf(out, "%*s Bit 3 set (bug?)\n", space, ""); 204 205 if (!(element & ~(UHCI_PTR_QH(uhci) | UHCI_PTR_DEPTH(uhci)))) 206 out += sprintf(out, "%*s Element is NULL (bug?)\n", space, ""); 207 208 if (out - buf > len) 209 goto done; 210 211 if (list_empty(&qh->queue)) { 212 out += sprintf(out, "%*s queue is empty\n", space, ""); 213 if (qh == uhci->skel_async_qh) { 214 out += uhci_show_td(uhci, uhci->term_td, out, 215 len - (out - buf), 0); 216 if (out - buf > len) 217 goto tail; 218 } 219 } else { 220 struct urb_priv *urbp = list_entry(qh->queue.next, 221 struct urb_priv, node); 222 struct uhci_td *td = list_entry(urbp->td_list.next, 223 struct uhci_td, list); 224 225 if (element != LINK_TO_TD(uhci, td)) 226 out += sprintf(out, "%*s Element != First TD\n", 227 space, ""); 228 i = nurbs = 0; 229 list_for_each_entry(urbp, &qh->queue, node) { 230 if (++i <= 10) { 231 out += uhci_show_urbp(uhci, urbp, out, 232 len - (out - buf), space + 2); 233 if (out - buf > len) 234 goto tail; 235 } 236 else 237 ++nurbs; 238 } 239 if (nurbs > 0) 240 out += sprintf(out, "%*s Skipped %d URBs\n", 241 space, "", nurbs); 242 } 243 244 if (out - buf > len) 245 goto done; 246 247 if (qh->dummy_td) { 248 out += sprintf(out, "%*s Dummy TD\n", space, ""); 249 out += uhci_show_td(uhci, qh->dummy_td, out, 250 len - (out - buf), 0); 251 if (out - buf > len) 252 goto tail; 253 } 254 255 done: 256 if (out - buf > len) 257 out += sprintf(out, " ...\n"); 258 tail: 259 return out - buf; 260 } 261 uhci_show_sc(int port,unsigned short status,char * buf)262 static int uhci_show_sc(int port, unsigned short status, char *buf) 263 { 264 return sprintf(buf, " stat%d = %04x %s%s%s%s%s%s%s%s%s%s\n", 265 port, 266 status, 267 (status & USBPORTSC_SUSP) ? " Suspend" : "", 268 (status & USBPORTSC_OCC) ? " OverCurrentChange" : "", 269 (status & USBPORTSC_OC) ? " OverCurrent" : "", 270 (status & USBPORTSC_PR) ? " Reset" : "", 271 (status & USBPORTSC_LSDA) ? " LowSpeed" : "", 272 (status & USBPORTSC_RD) ? " ResumeDetect" : "", 273 (status & USBPORTSC_PEC) ? " EnableChange" : "", 274 (status & USBPORTSC_PE) ? " Enabled" : "", 275 (status & USBPORTSC_CSC) ? " ConnectChange" : "", 276 (status & USBPORTSC_CCS) ? " Connected" : ""); 277 } 278 uhci_show_root_hub_state(struct uhci_hcd * uhci,char * buf)279 static int uhci_show_root_hub_state(struct uhci_hcd *uhci, char *buf) 280 { 281 char *rh_state; 282 283 switch (uhci->rh_state) { 284 case UHCI_RH_RESET: 285 rh_state = "reset"; break; 286 case UHCI_RH_SUSPENDED: 287 rh_state = "suspended"; break; 288 case UHCI_RH_AUTO_STOPPED: 289 rh_state = "auto-stopped"; break; 290 case UHCI_RH_RESUMING: 291 rh_state = "resuming"; break; 292 case UHCI_RH_SUSPENDING: 293 rh_state = "suspending"; break; 294 case UHCI_RH_RUNNING: 295 rh_state = "running"; break; 296 case UHCI_RH_RUNNING_NODEVS: 297 rh_state = "running, no devs"; break; 298 default: 299 rh_state = "?"; break; 300 } 301 return sprintf(buf, "Root-hub state: %s FSBR: %d\n", 302 rh_state, uhci->fsbr_is_on); 303 } 304 uhci_show_status(struct uhci_hcd * uhci,char * buf,int len)305 static int uhci_show_status(struct uhci_hcd *uhci, char *buf, int len) 306 { 307 char *out = buf; 308 unsigned short usbcmd, usbstat, usbint, usbfrnum; 309 unsigned int flbaseadd; 310 unsigned char sof; 311 unsigned short portsc1, portsc2; 312 313 314 usbcmd = uhci_readw(uhci, USBCMD); 315 usbstat = uhci_readw(uhci, USBSTS); 316 usbint = uhci_readw(uhci, USBINTR); 317 usbfrnum = uhci_readw(uhci, USBFRNUM); 318 flbaseadd = uhci_readl(uhci, USBFLBASEADD); 319 sof = uhci_readb(uhci, USBSOF); 320 portsc1 = uhci_readw(uhci, USBPORTSC1); 321 portsc2 = uhci_readw(uhci, USBPORTSC2); 322 323 out += sprintf(out, " usbcmd = %04x %s%s%s%s%s%s%s%s\n", 324 usbcmd, 325 (usbcmd & USBCMD_MAXP) ? "Maxp64 " : "Maxp32 ", 326 (usbcmd & USBCMD_CF) ? "CF " : "", 327 (usbcmd & USBCMD_SWDBG) ? "SWDBG " : "", 328 (usbcmd & USBCMD_FGR) ? "FGR " : "", 329 (usbcmd & USBCMD_EGSM) ? "EGSM " : "", 330 (usbcmd & USBCMD_GRESET) ? "GRESET " : "", 331 (usbcmd & USBCMD_HCRESET) ? "HCRESET " : "", 332 (usbcmd & USBCMD_RS) ? "RS " : ""); 333 if (out - buf > len) 334 goto done; 335 336 out += sprintf(out, " usbstat = %04x %s%s%s%s%s%s\n", 337 usbstat, 338 (usbstat & USBSTS_HCH) ? "HCHalted " : "", 339 (usbstat & USBSTS_HCPE) ? "HostControllerProcessError " : "", 340 (usbstat & USBSTS_HSE) ? "HostSystemError " : "", 341 (usbstat & USBSTS_RD) ? "ResumeDetect " : "", 342 (usbstat & USBSTS_ERROR) ? "USBError " : "", 343 (usbstat & USBSTS_USBINT) ? "USBINT " : ""); 344 if (out - buf > len) 345 goto done; 346 347 out += sprintf(out, " usbint = %04x\n", usbint); 348 out += sprintf(out, " usbfrnum = (%d)%03x\n", (usbfrnum >> 10) & 1, 349 0xfff & (4*(unsigned int)usbfrnum)); 350 out += sprintf(out, " flbaseadd = %08x\n", flbaseadd); 351 out += sprintf(out, " sof = %02x\n", sof); 352 if (out - buf > len) 353 goto done; 354 355 out += uhci_show_sc(1, portsc1, out); 356 if (out - buf > len) 357 goto done; 358 359 out += uhci_show_sc(2, portsc2, out); 360 if (out - buf > len) 361 goto done; 362 363 out += sprintf(out, 364 "Most recent frame: %x (%d) Last ISO frame: %x (%d)\n", 365 uhci->frame_number, uhci->frame_number & 1023, 366 uhci->last_iso_frame, uhci->last_iso_frame & 1023); 367 368 done: 369 if (out - buf > len) 370 out += sprintf(out, " ...\n"); 371 return out - buf; 372 } 373 uhci_sprint_schedule(struct uhci_hcd * uhci,char * buf,int len)374 static int uhci_sprint_schedule(struct uhci_hcd *uhci, char *buf, int len) 375 { 376 char *out = buf; 377 int i, j; 378 struct uhci_qh *qh; 379 struct uhci_td *td; 380 struct list_head *tmp, *head; 381 int nframes, nerrs; 382 __hc32 link; 383 __hc32 fsbr_link; 384 385 static const char * const qh_names[] = { 386 "unlink", "iso", "int128", "int64", "int32", "int16", 387 "int8", "int4", "int2", "async", "term" 388 }; 389 390 out += uhci_show_root_hub_state(uhci, out); 391 if (out - buf > len) 392 goto done; 393 out += sprintf(out, "HC status\n"); 394 out += uhci_show_status(uhci, out, len - (out - buf)); 395 if (out - buf > len) 396 goto tail; 397 398 out += sprintf(out, "Periodic load table\n"); 399 for (i = 0; i < MAX_PHASE; ++i) { 400 out += sprintf(out, "\t%d", uhci->load[i]); 401 if (i % 8 == 7) 402 *out++ = '\n'; 403 } 404 out += sprintf(out, "Total: %d, #INT: %d, #ISO: %d\n", 405 uhci->total_load, 406 uhci_to_hcd(uhci)->self.bandwidth_int_reqs, 407 uhci_to_hcd(uhci)->self.bandwidth_isoc_reqs); 408 if (debug <= 1) 409 goto tail; 410 411 out += sprintf(out, "Frame List\n"); 412 nframes = 10; 413 nerrs = 0; 414 for (i = 0; i < UHCI_NUMFRAMES; ++i) { 415 __hc32 qh_dma; 416 417 if (out - buf > len) 418 goto done; 419 j = 0; 420 td = uhci->frame_cpu[i]; 421 link = uhci->frame[i]; 422 if (!td) 423 goto check_link; 424 425 if (nframes > 0) { 426 out += sprintf(out, "- Frame %d -> (%08x)\n", 427 i, hc32_to_cpu(uhci, link)); 428 j = 1; 429 } 430 431 head = &td->fl_list; 432 tmp = head; 433 do { 434 td = list_entry(tmp, struct uhci_td, fl_list); 435 tmp = tmp->next; 436 if (link != LINK_TO_TD(uhci, td)) { 437 if (nframes > 0) { 438 out += sprintf(out, 439 " link does not match list entry!\n"); 440 if (out - buf > len) 441 goto done; 442 } else 443 ++nerrs; 444 } 445 if (nframes > 0) { 446 out += uhci_show_td(uhci, td, out, 447 len - (out - buf), 4); 448 if (out - buf > len) 449 goto tail; 450 } 451 link = td->link; 452 } while (tmp != head); 453 454 check_link: 455 qh_dma = uhci_frame_skel_link(uhci, i); 456 if (link != qh_dma) { 457 if (nframes > 0) { 458 if (!j) { 459 out += sprintf(out, 460 "- Frame %d -> (%08x)\n", 461 i, hc32_to_cpu(uhci, link)); 462 j = 1; 463 } 464 out += sprintf(out, 465 " link does not match QH (%08x)!\n", 466 hc32_to_cpu(uhci, qh_dma)); 467 if (out - buf > len) 468 goto done; 469 } else 470 ++nerrs; 471 } 472 nframes -= j; 473 } 474 if (nerrs > 0) 475 out += sprintf(out, "Skipped %d bad links\n", nerrs); 476 477 out += sprintf(out, "Skeleton QHs\n"); 478 479 if (out - buf > len) 480 goto done; 481 482 fsbr_link = 0; 483 for (i = 0; i < UHCI_NUM_SKELQH; ++i) { 484 int cnt = 0; 485 486 qh = uhci->skelqh[i]; 487 out += sprintf(out, "- skel_%s_qh\n", qh_names[i]); 488 out += uhci_show_qh(uhci, qh, out, len - (out - buf), 4); 489 if (out - buf > len) 490 goto tail; 491 492 /* Last QH is the Terminating QH, it's different */ 493 if (i == SKEL_TERM) { 494 if (qh_element(qh) != LINK_TO_TD(uhci, uhci->term_td)) { 495 out += sprintf(out, 496 " skel_term_qh element is not set to term_td!\n"); 497 if (out - buf > len) 498 goto done; 499 } 500 link = fsbr_link; 501 if (!link) 502 link = LINK_TO_QH(uhci, uhci->skel_term_qh); 503 goto check_qh_link; 504 } 505 506 head = &qh->node; 507 tmp = head->next; 508 509 while (tmp != head) { 510 qh = list_entry(tmp, struct uhci_qh, node); 511 tmp = tmp->next; 512 if (++cnt <= 10) { 513 out += uhci_show_qh(uhci, qh, out, 514 len - (out - buf), 4); 515 if (out - buf > len) 516 goto tail; 517 } 518 if (!fsbr_link && qh->skel >= SKEL_FSBR) 519 fsbr_link = LINK_TO_QH(uhci, qh); 520 } 521 if ((cnt -= 10) > 0) 522 out += sprintf(out, " Skipped %d QHs\n", cnt); 523 524 link = UHCI_PTR_TERM(uhci); 525 if (i <= SKEL_ISO) 526 ; 527 else if (i < SKEL_ASYNC) 528 link = LINK_TO_QH(uhci, uhci->skel_async_qh); 529 else if (!uhci->fsbr_is_on) 530 ; 531 else 532 link = LINK_TO_QH(uhci, uhci->skel_term_qh); 533 check_qh_link: 534 if (qh->link != link) 535 out += sprintf(out, 536 " last QH not linked to next skeleton!\n"); 537 538 if (out - buf > len) 539 goto done; 540 } 541 542 done: 543 if (out - buf > len) 544 out += sprintf(out, " ...\n"); 545 tail: 546 return out - buf; 547 } 548 549 #ifdef CONFIG_DEBUG_FS 550 551 #define MAX_OUTPUT (64 * 1024) 552 553 struct uhci_debug { 554 int size; 555 char *data; 556 }; 557 uhci_debug_open(struct inode * inode,struct file * file)558 static int uhci_debug_open(struct inode *inode, struct file *file) 559 { 560 struct uhci_hcd *uhci = inode->i_private; 561 struct uhci_debug *up; 562 unsigned long flags; 563 564 up = kmalloc(sizeof(*up), GFP_KERNEL); 565 if (!up) 566 return -ENOMEM; 567 568 up->data = kmalloc(MAX_OUTPUT, GFP_KERNEL); 569 if (!up->data) { 570 kfree(up); 571 return -ENOMEM; 572 } 573 574 up->size = 0; 575 spin_lock_irqsave(&uhci->lock, flags); 576 if (uhci->is_initialized) 577 up->size = uhci_sprint_schedule(uhci, up->data, 578 MAX_OUTPUT - EXTRA_SPACE); 579 spin_unlock_irqrestore(&uhci->lock, flags); 580 581 file->private_data = up; 582 583 return 0; 584 } 585 uhci_debug_lseek(struct file * file,loff_t off,int whence)586 static loff_t uhci_debug_lseek(struct file *file, loff_t off, int whence) 587 { 588 struct uhci_debug *up = file->private_data; 589 return no_seek_end_llseek_size(file, off, whence, up->size); 590 } 591 uhci_debug_read(struct file * file,char __user * buf,size_t nbytes,loff_t * ppos)592 static ssize_t uhci_debug_read(struct file *file, char __user *buf, 593 size_t nbytes, loff_t *ppos) 594 { 595 struct uhci_debug *up = file->private_data; 596 return simple_read_from_buffer(buf, nbytes, ppos, up->data, up->size); 597 } 598 uhci_debug_release(struct inode * inode,struct file * file)599 static int uhci_debug_release(struct inode *inode, struct file *file) 600 { 601 struct uhci_debug *up = file->private_data; 602 603 kfree(up->data); 604 kfree(up); 605 606 return 0; 607 } 608 609 static const struct file_operations uhci_debug_operations = { 610 .owner = THIS_MODULE, 611 .open = uhci_debug_open, 612 .llseek = uhci_debug_lseek, 613 .read = uhci_debug_read, 614 .release = uhci_debug_release, 615 }; 616 #define UHCI_DEBUG_OPS 617 618 #endif /* CONFIG_DEBUG_FS */ 619 620 #else /* CONFIG_DYNAMIC_DEBUG*/ 621 lprintk(char * buf)622 static inline void lprintk(char *buf) 623 {} 624 uhci_show_qh(struct uhci_hcd * uhci,struct uhci_qh * qh,char * buf,int len,int space)625 static inline int uhci_show_qh(struct uhci_hcd *uhci, 626 struct uhci_qh *qh, char *buf, int len, int space) 627 { 628 return 0; 629 } 630 uhci_sprint_schedule(struct uhci_hcd * uhci,char * buf,int len)631 static inline int uhci_sprint_schedule(struct uhci_hcd *uhci, 632 char *buf, int len) 633 { 634 return 0; 635 } 636 637 #endif 638