1 // SPDX-License-Identifier: GPL-2.0+ 2 /* 3 * Copyright (c) 2001-2002 by David Brownell 4 */ 5 6 /* this file is part of ehci-hcd.c */ 7 8 #ifdef CONFIG_DYNAMIC_DEBUG 9 10 /* 11 * check the values in the HCSPARAMS register 12 * (host controller _Structural_ parameters) 13 * see EHCI spec, Table 2-4 for each value 14 */ 15 static void dbg_hcs_params(struct ehci_hcd *ehci, char *label) 16 { 17 u32 params = ehci_readl(ehci, &ehci->caps->hcs_params); 18 19 ehci_dbg(ehci, 20 "%s hcs_params 0x%x dbg=%d%s cc=%d pcc=%d%s%s ports=%d\n", 21 label, params, 22 HCS_DEBUG_PORT(params), 23 HCS_INDICATOR(params) ? " ind" : "", 24 HCS_N_CC(params), 25 HCS_N_PCC(params), 26 HCS_PORTROUTED(params) ? "" : " ordered", 27 HCS_PPC(params) ? "" : " !ppc", 28 HCS_N_PORTS(params)); 29 /* Port routing, per EHCI 0.95 Spec, Section 2.2.5 */ 30 if (HCS_PORTROUTED(params)) { 31 int i; 32 char buf[46], tmp[7], byte; 33 34 buf[0] = 0; 35 for (i = 0; i < HCS_N_PORTS(params); i++) { 36 /* FIXME MIPS won't readb() ... */ 37 byte = readb(&ehci->caps->portroute[(i >> 1)]); 38 sprintf(tmp, "%d ", 39 (i & 0x1) ? byte & 0xf : (byte >> 4) & 0xf); 40 strcat(buf, tmp); 41 } 42 ehci_dbg(ehci, "%s portroute %s\n", label, buf); 43 } 44 } 45 46 /* 47 * check the values in the HCCPARAMS register 48 * (host controller _Capability_ parameters) 49 * see EHCI Spec, Table 2-5 for each value 50 */ 51 static void dbg_hcc_params(struct ehci_hcd *ehci, char *label) 52 { 53 u32 params = ehci_readl(ehci, &ehci->caps->hcc_params); 54 55 if (HCC_ISOC_CACHE(params)) { 56 ehci_dbg(ehci, 57 "%s hcc_params %04x caching frame %s%s%s\n", 58 label, params, 59 HCC_PGM_FRAMELISTLEN(params) ? "256/512/1024" : "1024", 60 HCC_CANPARK(params) ? " park" : "", 61 HCC_64BIT_ADDR(params) ? " 64 bit addr" : ""); 62 } else { 63 ehci_dbg(ehci, 64 "%s hcc_params %04x thresh %d uframes %s%s%s%s%s%s%s\n", 65 label, 66 params, 67 HCC_ISOC_THRES(params), 68 HCC_PGM_FRAMELISTLEN(params) ? "256/512/1024" : "1024", 69 HCC_CANPARK(params) ? " park" : "", 70 HCC_64BIT_ADDR(params) ? " 64 bit addr" : "", 71 HCC_LPM(params) ? " LPM" : "", 72 HCC_PER_PORT_CHANGE_EVENT(params) ? " ppce" : "", 73 HCC_HW_PREFETCH(params) ? " hw prefetch" : "", 74 HCC_32FRAME_PERIODIC_LIST(params) ? 75 " 32 periodic list" : ""); 76 } 77 } 78 79 static void __maybe_unused 80 dbg_qtd(const char *label, struct ehci_hcd *ehci, struct ehci_qtd *qtd) 81 { 82 ehci_dbg(ehci, "%s td %p n%08x %08x t%08x p0=%08x\n", label, qtd, 83 hc32_to_cpup(ehci, &qtd->hw_next), 84 hc32_to_cpup(ehci, &qtd->hw_alt_next), 85 hc32_to_cpup(ehci, &qtd->hw_token), 86 hc32_to_cpup(ehci, &qtd->hw_buf[0])); 87 if (qtd->hw_buf[1]) 88 ehci_dbg(ehci, " p1=%08x p2=%08x p3=%08x p4=%08x\n", 89 hc32_to_cpup(ehci, &qtd->hw_buf[1]), 90 hc32_to_cpup(ehci, &qtd->hw_buf[2]), 91 hc32_to_cpup(ehci, &qtd->hw_buf[3]), 92 hc32_to_cpup(ehci, &qtd->hw_buf[4])); 93 } 94 95 static void __maybe_unused 96 dbg_qh(const char *label, struct ehci_hcd *ehci, struct ehci_qh *qh) 97 { 98 struct ehci_qh_hw *hw = qh->hw; 99 100 ehci_dbg(ehci, "%s qh %p n%08x info %x %x qtd %x\n", label, 101 qh, hw->hw_next, hw->hw_info1, hw->hw_info2, hw->hw_current); 102 dbg_qtd("overlay", ehci, (struct ehci_qtd *) &hw->hw_qtd_next); 103 } 104 105 static void __maybe_unused 106 dbg_itd(const char *label, struct ehci_hcd *ehci, struct ehci_itd *itd) 107 { 108 ehci_dbg(ehci, "%s [%d] itd %p, next %08x, urb %p\n", 109 label, itd->frame, itd, hc32_to_cpu(ehci, itd->hw_next), 110 itd->urb); 111 ehci_dbg(ehci, 112 " trans: %08x %08x %08x %08x %08x %08x %08x %08x\n", 113 hc32_to_cpu(ehci, itd->hw_transaction[0]), 114 hc32_to_cpu(ehci, itd->hw_transaction[1]), 115 hc32_to_cpu(ehci, itd->hw_transaction[2]), 116 hc32_to_cpu(ehci, itd->hw_transaction[3]), 117 hc32_to_cpu(ehci, itd->hw_transaction[4]), 118 hc32_to_cpu(ehci, itd->hw_transaction[5]), 119 hc32_to_cpu(ehci, itd->hw_transaction[6]), 120 hc32_to_cpu(ehci, itd->hw_transaction[7])); 121 ehci_dbg(ehci, 122 " buf: %08x %08x %08x %08x %08x %08x %08x\n", 123 hc32_to_cpu(ehci, itd->hw_bufp[0]), 124 hc32_to_cpu(ehci, itd->hw_bufp[1]), 125 hc32_to_cpu(ehci, itd->hw_bufp[2]), 126 hc32_to_cpu(ehci, itd->hw_bufp[3]), 127 hc32_to_cpu(ehci, itd->hw_bufp[4]), 128 hc32_to_cpu(ehci, itd->hw_bufp[5]), 129 hc32_to_cpu(ehci, itd->hw_bufp[6])); 130 ehci_dbg(ehci, " index: %d %d %d %d %d %d %d %d\n", 131 itd->index[0], itd->index[1], itd->index[2], 132 itd->index[3], itd->index[4], itd->index[5], 133 itd->index[6], itd->index[7]); 134 } 135 136 static void __maybe_unused 137 dbg_sitd(const char *label, struct ehci_hcd *ehci, struct ehci_sitd *sitd) 138 { 139 ehci_dbg(ehci, "%s [%d] sitd %p, next %08x, urb %p\n", 140 label, sitd->frame, sitd, hc32_to_cpu(ehci, sitd->hw_next), 141 sitd->urb); 142 ehci_dbg(ehci, 143 " addr %08x sched %04x result %08x buf %08x %08x\n", 144 hc32_to_cpu(ehci, sitd->hw_fullspeed_ep), 145 hc32_to_cpu(ehci, sitd->hw_uframe), 146 hc32_to_cpu(ehci, sitd->hw_results), 147 hc32_to_cpu(ehci, sitd->hw_buf[0]), 148 hc32_to_cpu(ehci, sitd->hw_buf[1])); 149 } 150 151 static int __maybe_unused 152 dbg_status_buf(char *buf, unsigned len, const char *label, u32 status) 153 { 154 return scnprintf(buf, len, 155 "%s%sstatus %04x%s%s%s%s%s%s%s%s%s%s%s", 156 label, label[0] ? " " : "", status, 157 (status & STS_PPCE_MASK) ? " PPCE" : "", 158 (status & STS_ASS) ? " Async" : "", 159 (status & STS_PSS) ? " Periodic" : "", 160 (status & STS_RECL) ? " Recl" : "", 161 (status & STS_HALT) ? " Halt" : "", 162 (status & STS_IAA) ? " IAA" : "", 163 (status & STS_FATAL) ? " FATAL" : "", 164 (status & STS_FLR) ? " FLR" : "", 165 (status & STS_PCD) ? " PCD" : "", 166 (status & STS_ERR) ? " ERR" : "", 167 (status & STS_INT) ? " INT" : ""); 168 } 169 170 static int __maybe_unused 171 dbg_intr_buf(char *buf, unsigned len, const char *label, u32 enable) 172 { 173 return scnprintf(buf, len, 174 "%s%sintrenable %02x%s%s%s%s%s%s%s", 175 label, label[0] ? " " : "", enable, 176 (enable & STS_PPCE_MASK) ? " PPCE" : "", 177 (enable & STS_IAA) ? " IAA" : "", 178 (enable & STS_FATAL) ? " FATAL" : "", 179 (enable & STS_FLR) ? " FLR" : "", 180 (enable & STS_PCD) ? " PCD" : "", 181 (enable & STS_ERR) ? " ERR" : "", 182 (enable & STS_INT) ? " INT" : ""); 183 } 184 185 static const char *const fls_strings[] = { "1024", "512", "256", "??" }; 186 187 static int 188 dbg_command_buf(char *buf, unsigned len, const char *label, u32 command) 189 { 190 return scnprintf(buf, len, 191 "%s%scommand %07x %s%s%s%s%s%s=%d ithresh=%d%s%s%s%s " 192 "period=%s%s %s", 193 label, label[0] ? " " : "", command, 194 (command & CMD_HIRD) ? " HIRD" : "", 195 (command & CMD_PPCEE) ? " PPCEE" : "", 196 (command & CMD_FSP) ? " FSP" : "", 197 (command & CMD_ASPE) ? " ASPE" : "", 198 (command & CMD_PSPE) ? " PSPE" : "", 199 (command & CMD_PARK) ? " park" : "(park)", 200 CMD_PARK_CNT(command), 201 (command >> 16) & 0x3f, 202 (command & CMD_LRESET) ? " LReset" : "", 203 (command & CMD_IAAD) ? " IAAD" : "", 204 (command & CMD_ASE) ? " Async" : "", 205 (command & CMD_PSE) ? " Periodic" : "", 206 fls_strings[(command >> 2) & 0x3], 207 (command & CMD_RESET) ? " Reset" : "", 208 (command & CMD_RUN) ? "RUN" : "HALT"); 209 } 210 211 static int 212 dbg_port_buf(char *buf, unsigned len, const char *label, int port, u32 status) 213 { 214 char *sig; 215 216 /* signaling state */ 217 switch (status & (3 << 10)) { 218 case 0 << 10: 219 sig = "se0"; 220 break; 221 case 1 << 10: /* low speed */ 222 sig = "k"; 223 break; 224 case 2 << 10: 225 sig = "j"; 226 break; 227 default: 228 sig = "?"; 229 break; 230 } 231 232 return scnprintf(buf, len, 233 "%s%sport:%d status %06x %d %s%s%s%s%s%s " 234 "sig=%s%s%s%s%s%s%s%s%s%s%s", 235 label, label[0] ? " " : "", port, status, 236 status >> 25, /*device address */ 237 (status & PORT_SSTS) >> 23 == PORTSC_SUSPEND_STS_ACK ? 238 " ACK" : "", 239 (status & PORT_SSTS) >> 23 == PORTSC_SUSPEND_STS_NYET ? 240 " NYET" : "", 241 (status & PORT_SSTS) >> 23 == PORTSC_SUSPEND_STS_STALL ? 242 " STALL" : "", 243 (status & PORT_SSTS) >> 23 == PORTSC_SUSPEND_STS_ERR ? 244 " ERR" : "", 245 (status & PORT_POWER) ? " POWER" : "", 246 (status & PORT_OWNER) ? " OWNER" : "", 247 sig, 248 (status & PORT_LPM) ? " LPM" : "", 249 (status & PORT_RESET) ? " RESET" : "", 250 (status & PORT_SUSPEND) ? " SUSPEND" : "", 251 (status & PORT_RESUME) ? " RESUME" : "", 252 (status & PORT_OCC) ? " OCC" : "", 253 (status & PORT_OC) ? " OC" : "", 254 (status & PORT_PEC) ? " PEC" : "", 255 (status & PORT_PE) ? " PE" : "", 256 (status & PORT_CSC) ? " CSC" : "", 257 (status & PORT_CONNECT) ? " CONNECT" : ""); 258 } 259 260 static inline void 261 dbg_status(struct ehci_hcd *ehci, const char *label, u32 status) 262 { 263 char buf[80]; 264 265 dbg_status_buf(buf, sizeof(buf), label, status); 266 ehci_dbg(ehci, "%s\n", buf); 267 } 268 269 static inline void 270 dbg_cmd(struct ehci_hcd *ehci, const char *label, u32 command) 271 { 272 char buf[80]; 273 274 dbg_command_buf(buf, sizeof(buf), label, command); 275 ehci_dbg(ehci, "%s\n", buf); 276 } 277 278 static inline void 279 dbg_port(struct ehci_hcd *ehci, const char *label, int port, u32 status) 280 { 281 char buf[80]; 282 283 dbg_port_buf(buf, sizeof(buf), label, port, status); 284 ehci_dbg(ehci, "%s\n", buf); 285 } 286 287 /*-------------------------------------------------------------------------*/ 288 289 /* troubleshooting help: expose state in debugfs */ 290 291 static int debug_async_open(struct inode *, struct file *); 292 static int debug_bandwidth_open(struct inode *, struct file *); 293 static int debug_periodic_open(struct inode *, struct file *); 294 static int debug_registers_open(struct inode *, struct file *); 295 296 static ssize_t debug_output(struct file*, char __user*, size_t, loff_t*); 297 static int debug_close(struct inode *, struct file *); 298 299 static const struct file_operations debug_async_fops = { 300 .owner = THIS_MODULE, 301 .open = debug_async_open, 302 .read = debug_output, 303 .release = debug_close, 304 .llseek = default_llseek, 305 }; 306 307 static const struct file_operations debug_bandwidth_fops = { 308 .owner = THIS_MODULE, 309 .open = debug_bandwidth_open, 310 .read = debug_output, 311 .release = debug_close, 312 .llseek = default_llseek, 313 }; 314 315 static const struct file_operations debug_periodic_fops = { 316 .owner = THIS_MODULE, 317 .open = debug_periodic_open, 318 .read = debug_output, 319 .release = debug_close, 320 .llseek = default_llseek, 321 }; 322 323 static const struct file_operations debug_registers_fops = { 324 .owner = THIS_MODULE, 325 .open = debug_registers_open, 326 .read = debug_output, 327 .release = debug_close, 328 .llseek = default_llseek, 329 }; 330 331 static struct dentry *ehci_debug_root; 332 333 struct debug_buffer { 334 ssize_t (*fill_func)(struct debug_buffer *); /* fill method */ 335 struct usb_bus *bus; 336 struct mutex mutex; /* protect filling of buffer */ 337 size_t count; /* number of characters filled into buffer */ 338 char *output_buf; 339 size_t alloc_size; 340 }; 341 342 static inline char speed_char(u32 info1) 343 { 344 switch (info1 & (3 << 12)) { 345 case QH_FULL_SPEED: 346 return 'f'; 347 case QH_LOW_SPEED: 348 return 'l'; 349 case QH_HIGH_SPEED: 350 return 'h'; 351 default: 352 return '?'; 353 } 354 } 355 356 static inline char token_mark(struct ehci_hcd *ehci, __hc32 token) 357 { 358 __u32 v = hc32_to_cpu(ehci, token); 359 360 if (v & QTD_STS_ACTIVE) 361 return '*'; 362 if (v & QTD_STS_HALT) 363 return '-'; 364 if (!IS_SHORT_READ(v)) 365 return ' '; 366 /* tries to advance through hw_alt_next */ 367 return '/'; 368 } 369 370 static void qh_lines(struct ehci_hcd *ehci, struct ehci_qh *qh, 371 char **nextp, unsigned *sizep) 372 { 373 u32 scratch; 374 u32 hw_curr; 375 struct list_head *entry; 376 struct ehci_qtd *td; 377 unsigned temp; 378 unsigned size = *sizep; 379 char *next = *nextp; 380 char mark; 381 __le32 list_end = EHCI_LIST_END(ehci); 382 struct ehci_qh_hw *hw = qh->hw; 383 384 if (hw->hw_qtd_next == list_end) /* NEC does this */ 385 mark = '@'; 386 else 387 mark = token_mark(ehci, hw->hw_token); 388 if (mark == '/') { /* qh_alt_next controls qh advance? */ 389 if ((hw->hw_alt_next & QTD_MASK(ehci)) 390 == ehci->async->hw->hw_alt_next) 391 mark = '#'; /* blocked */ 392 else if (hw->hw_alt_next == list_end) 393 mark = '.'; /* use hw_qtd_next */ 394 /* else alt_next points to some other qtd */ 395 } 396 scratch = hc32_to_cpup(ehci, &hw->hw_info1); 397 hw_curr = (mark == '*') ? hc32_to_cpup(ehci, &hw->hw_current) : 0; 398 temp = scnprintf(next, size, 399 "qh/%p dev%d %cs ep%d %08x %08x (%08x%c %s nak%d)" 400 " [cur %08x next %08x buf[0] %08x]", 401 qh, scratch & 0x007f, 402 speed_char (scratch), 403 (scratch >> 8) & 0x000f, 404 scratch, hc32_to_cpup(ehci, &hw->hw_info2), 405 hc32_to_cpup(ehci, &hw->hw_token), mark, 406 (cpu_to_hc32(ehci, QTD_TOGGLE) & hw->hw_token) 407 ? "data1" : "data0", 408 (hc32_to_cpup(ehci, &hw->hw_alt_next) >> 1) & 0x0f, 409 hc32_to_cpup(ehci, &hw->hw_current), 410 hc32_to_cpup(ehci, &hw->hw_qtd_next), 411 hc32_to_cpup(ehci, &hw->hw_buf[0])); 412 size -= temp; 413 next += temp; 414 415 /* hc may be modifying the list as we read it ... */ 416 list_for_each(entry, &qh->qtd_list) { 417 char *type; 418 419 td = list_entry(entry, struct ehci_qtd, qtd_list); 420 scratch = hc32_to_cpup(ehci, &td->hw_token); 421 mark = ' '; 422 if (hw_curr == td->qtd_dma) { 423 mark = '*'; 424 } else if (hw->hw_qtd_next == cpu_to_hc32(ehci, td->qtd_dma)) { 425 mark = '+'; 426 } else if (QTD_LENGTH(scratch)) { 427 if (td->hw_alt_next == ehci->async->hw->hw_alt_next) 428 mark = '#'; 429 else if (td->hw_alt_next != list_end) 430 mark = '/'; 431 } 432 switch ((scratch >> 8) & 0x03) { 433 case 0: 434 type = "out"; 435 break; 436 case 1: 437 type = "in"; 438 break; 439 case 2: 440 type = "setup"; 441 break; 442 default: 443 type = "?"; 444 break; 445 } 446 temp = scnprintf(next, size, 447 "\n\t%p%c%s len=%d %08x urb %p" 448 " [td %08x buf[0] %08x]", 449 td, mark, type, 450 (scratch >> 16) & 0x7fff, 451 scratch, 452 td->urb, 453 (u32) td->qtd_dma, 454 hc32_to_cpup(ehci, &td->hw_buf[0])); 455 size -= temp; 456 next += temp; 457 if (temp == size) 458 goto done; 459 } 460 461 temp = scnprintf(next, size, "\n"); 462 size -= temp; 463 next += temp; 464 465 done: 466 *sizep = size; 467 *nextp = next; 468 } 469 470 static ssize_t fill_async_buffer(struct debug_buffer *buf) 471 { 472 struct usb_hcd *hcd; 473 struct ehci_hcd *ehci; 474 unsigned long flags; 475 unsigned temp, size; 476 char *next; 477 struct ehci_qh *qh; 478 479 hcd = bus_to_hcd(buf->bus); 480 ehci = hcd_to_ehci(hcd); 481 next = buf->output_buf; 482 size = buf->alloc_size; 483 484 *next = 0; 485 486 /* 487 * dumps a snapshot of the async schedule. 488 * usually empty except for long-term bulk reads, or head. 489 * one QH per line, and TDs we know about 490 */ 491 spin_lock_irqsave(&ehci->lock, flags); 492 for (qh = ehci->async->qh_next.qh; size > 0 && qh; qh = qh->qh_next.qh) 493 qh_lines(ehci, qh, &next, &size); 494 if (!list_empty(&ehci->async_unlink) && size > 0) { 495 temp = scnprintf(next, size, "\nunlink =\n"); 496 size -= temp; 497 next += temp; 498 499 list_for_each_entry(qh, &ehci->async_unlink, unlink_node) { 500 if (size <= 0) 501 break; 502 qh_lines(ehci, qh, &next, &size); 503 } 504 } 505 spin_unlock_irqrestore(&ehci->lock, flags); 506 507 return strlen(buf->output_buf); 508 } 509 510 static ssize_t fill_bandwidth_buffer(struct debug_buffer *buf) 511 { 512 struct ehci_hcd *ehci; 513 struct ehci_tt *tt; 514 struct ehci_per_sched *ps; 515 unsigned temp, size; 516 char *next; 517 unsigned i; 518 u8 *bw; 519 u16 *bf; 520 u8 budget[EHCI_BANDWIDTH_SIZE]; 521 522 ehci = hcd_to_ehci(bus_to_hcd(buf->bus)); 523 next = buf->output_buf; 524 size = buf->alloc_size; 525 526 *next = 0; 527 528 spin_lock_irq(&ehci->lock); 529 530 /* Dump the HS bandwidth table */ 531 temp = scnprintf(next, size, 532 "HS bandwidth allocation (us per microframe)\n"); 533 size -= temp; 534 next += temp; 535 for (i = 0; i < EHCI_BANDWIDTH_SIZE; i += 8) { 536 bw = &ehci->bandwidth[i]; 537 temp = scnprintf(next, size, 538 "%2u: %4u%4u%4u%4u%4u%4u%4u%4u\n", 539 i, bw[0], bw[1], bw[2], bw[3], 540 bw[4], bw[5], bw[6], bw[7]); 541 size -= temp; 542 next += temp; 543 } 544 545 /* Dump all the FS/LS tables */ 546 list_for_each_entry(tt, &ehci->tt_list, tt_list) { 547 temp = scnprintf(next, size, 548 "\nTT %s port %d FS/LS bandwidth allocation (us per frame)\n", 549 dev_name(&tt->usb_tt->hub->dev), 550 tt->tt_port + !!tt->usb_tt->multi); 551 size -= temp; 552 next += temp; 553 554 bf = tt->bandwidth; 555 temp = scnprintf(next, size, 556 " %5u%5u%5u%5u%5u%5u%5u%5u\n", 557 bf[0], bf[1], bf[2], bf[3], 558 bf[4], bf[5], bf[6], bf[7]); 559 size -= temp; 560 next += temp; 561 562 temp = scnprintf(next, size, 563 "FS/LS budget (us per microframe)\n"); 564 size -= temp; 565 next += temp; 566 compute_tt_budget(budget, tt); 567 for (i = 0; i < EHCI_BANDWIDTH_SIZE; i += 8) { 568 bw = &budget[i]; 569 temp = scnprintf(next, size, 570 "%2u: %4u%4u%4u%4u%4u%4u%4u%4u\n", 571 i, bw[0], bw[1], bw[2], bw[3], 572 bw[4], bw[5], bw[6], bw[7]); 573 size -= temp; 574 next += temp; 575 } 576 list_for_each_entry(ps, &tt->ps_list, ps_list) { 577 temp = scnprintf(next, size, 578 "%s ep %02x: %4u @ %2u.%u+%u mask %04x\n", 579 dev_name(&ps->udev->dev), 580 ps->ep->desc.bEndpointAddress, 581 ps->tt_usecs, 582 ps->bw_phase, ps->phase_uf, 583 ps->bw_period, ps->cs_mask); 584 size -= temp; 585 next += temp; 586 } 587 } 588 spin_unlock_irq(&ehci->lock); 589 590 return next - buf->output_buf; 591 } 592 593 static unsigned output_buf_tds_dir(char *buf, struct ehci_hcd *ehci, 594 struct ehci_qh_hw *hw, struct ehci_qh *qh, unsigned size) 595 { 596 u32 scratch = hc32_to_cpup(ehci, &hw->hw_info1); 597 struct ehci_qtd *qtd; 598 char *type = ""; 599 unsigned temp = 0; 600 601 /* count tds, get ep direction */ 602 list_for_each_entry(qtd, &qh->qtd_list, qtd_list) { 603 temp++; 604 switch ((hc32_to_cpu(ehci, qtd->hw_token) >> 8) & 0x03) { 605 case 0: 606 type = "out"; 607 continue; 608 case 1: 609 type = "in"; 610 continue; 611 } 612 } 613 614 return scnprintf(buf, size, " (%c%d ep%d%s [%d/%d] q%d p%d)", 615 speed_char(scratch), scratch & 0x007f, 616 (scratch >> 8) & 0x000f, type, qh->ps.usecs, 617 qh->ps.c_usecs, temp, 0x7ff & (scratch >> 16)); 618 } 619 620 #define DBG_SCHED_LIMIT 64 621 static ssize_t fill_periodic_buffer(struct debug_buffer *buf) 622 { 623 struct usb_hcd *hcd; 624 struct ehci_hcd *ehci; 625 unsigned long flags; 626 union ehci_shadow p, *seen; 627 unsigned temp, size, seen_count; 628 char *next; 629 unsigned i; 630 __hc32 tag; 631 632 seen = kmalloc_array(DBG_SCHED_LIMIT, sizeof(*seen), GFP_ATOMIC); 633 if (!seen) 634 return 0; 635 seen_count = 0; 636 637 hcd = bus_to_hcd(buf->bus); 638 ehci = hcd_to_ehci(hcd); 639 next = buf->output_buf; 640 size = buf->alloc_size; 641 642 temp = scnprintf(next, size, "size = %d\n", ehci->periodic_size); 643 size -= temp; 644 next += temp; 645 646 /* 647 * dump a snapshot of the periodic schedule. 648 * iso changes, interrupt usually doesn't. 649 */ 650 spin_lock_irqsave(&ehci->lock, flags); 651 for (i = 0; i < ehci->periodic_size; i++) { 652 p = ehci->pshadow[i]; 653 if (likely(!p.ptr)) 654 continue; 655 tag = Q_NEXT_TYPE(ehci, ehci->periodic[i]); 656 657 temp = scnprintf(next, size, "%4d: ", i); 658 size -= temp; 659 next += temp; 660 661 do { 662 struct ehci_qh_hw *hw; 663 664 switch (hc32_to_cpu(ehci, tag)) { 665 case Q_TYPE_QH: 666 hw = p.qh->hw; 667 temp = scnprintf(next, size, " qh%d-%04x/%p", 668 p.qh->ps.period, 669 hc32_to_cpup(ehci, 670 &hw->hw_info2) 671 /* uframe masks */ 672 & (QH_CMASK | QH_SMASK), 673 p.qh); 674 size -= temp; 675 next += temp; 676 /* don't repeat what follows this qh */ 677 for (temp = 0; temp < seen_count; temp++) { 678 if (seen[temp].ptr != p.ptr) 679 continue; 680 if (p.qh->qh_next.ptr) { 681 temp = scnprintf(next, size, 682 " ..."); 683 size -= temp; 684 next += temp; 685 } 686 break; 687 } 688 /* show more info the first time around */ 689 if (temp == seen_count) { 690 temp = output_buf_tds_dir(next, ehci, 691 hw, p.qh, size); 692 693 if (seen_count < DBG_SCHED_LIMIT) 694 seen[seen_count++].qh = p.qh; 695 } else { 696 temp = 0; 697 } 698 tag = Q_NEXT_TYPE(ehci, hw->hw_next); 699 p = p.qh->qh_next; 700 break; 701 case Q_TYPE_FSTN: 702 temp = scnprintf(next, size, 703 " fstn-%8x/%p", p.fstn->hw_prev, 704 p.fstn); 705 tag = Q_NEXT_TYPE(ehci, p.fstn->hw_next); 706 p = p.fstn->fstn_next; 707 break; 708 case Q_TYPE_ITD: 709 temp = scnprintf(next, size, 710 " itd/%p", p.itd); 711 tag = Q_NEXT_TYPE(ehci, p.itd->hw_next); 712 p = p.itd->itd_next; 713 break; 714 case Q_TYPE_SITD: 715 temp = scnprintf(next, size, 716 " sitd%d-%04x/%p", 717 p.sitd->stream->ps.period, 718 hc32_to_cpup(ehci, &p.sitd->hw_uframe) 719 & 0x0000ffff, 720 p.sitd); 721 tag = Q_NEXT_TYPE(ehci, p.sitd->hw_next); 722 p = p.sitd->sitd_next; 723 break; 724 } 725 size -= temp; 726 next += temp; 727 } while (p.ptr); 728 729 temp = scnprintf(next, size, "\n"); 730 size -= temp; 731 next += temp; 732 } 733 spin_unlock_irqrestore(&ehci->lock, flags); 734 kfree(seen); 735 736 return buf->alloc_size - size; 737 } 738 #undef DBG_SCHED_LIMIT 739 740 static const char *rh_state_string(struct ehci_hcd *ehci) 741 { 742 switch (ehci->rh_state) { 743 case EHCI_RH_HALTED: 744 return "halted"; 745 case EHCI_RH_SUSPENDED: 746 return "suspended"; 747 case EHCI_RH_RUNNING: 748 return "running"; 749 case EHCI_RH_STOPPING: 750 return "stopping"; 751 } 752 return "?"; 753 } 754 755 static ssize_t fill_registers_buffer(struct debug_buffer *buf) 756 { 757 struct usb_hcd *hcd; 758 struct ehci_hcd *ehci; 759 unsigned long flags; 760 unsigned temp, size, i; 761 char *next, scratch[80]; 762 static char fmt[] = "%*s\n"; 763 static char label[] = ""; 764 765 hcd = bus_to_hcd(buf->bus); 766 ehci = hcd_to_ehci(hcd); 767 next = buf->output_buf; 768 size = buf->alloc_size; 769 770 spin_lock_irqsave(&ehci->lock, flags); 771 772 if (!HCD_HW_ACCESSIBLE(hcd)) { 773 size = scnprintf(next, size, 774 "bus %s, device %s\n" 775 "%s\n" 776 "SUSPENDED (no register access)\n", 777 hcd->self.controller->bus->name, 778 dev_name(hcd->self.controller), 779 hcd->product_desc); 780 goto done; 781 } 782 783 /* Capability Registers */ 784 i = HC_VERSION(ehci, ehci_readl(ehci, &ehci->caps->hc_capbase)); 785 temp = scnprintf(next, size, 786 "bus %s, device %s\n" 787 "%s\n" 788 "EHCI %x.%02x, rh state %s\n", 789 hcd->self.controller->bus->name, 790 dev_name(hcd->self.controller), 791 hcd->product_desc, 792 i >> 8, i & 0x0ff, rh_state_string(ehci)); 793 size -= temp; 794 next += temp; 795 796 #ifdef CONFIG_USB_PCI 797 /* EHCI 0.96 and later may have "extended capabilities" */ 798 if (dev_is_pci(hcd->self.controller)) { 799 struct pci_dev *pdev; 800 u32 offset, cap, cap2; 801 unsigned count = 256 / 4; 802 803 pdev = to_pci_dev(ehci_to_hcd(ehci)->self.controller); 804 offset = HCC_EXT_CAPS(ehci_readl(ehci, 805 &ehci->caps->hcc_params)); 806 while (offset && count--) { 807 pci_read_config_dword(pdev, offset, &cap); 808 switch (cap & 0xff) { 809 case 1: 810 temp = scnprintf(next, size, 811 "ownership %08x%s%s\n", cap, 812 (cap & (1 << 24)) ? " linux" : "", 813 (cap & (1 << 16)) ? " firmware" : ""); 814 size -= temp; 815 next += temp; 816 817 offset += 4; 818 pci_read_config_dword(pdev, offset, &cap2); 819 temp = scnprintf(next, size, 820 "SMI sts/enable 0x%08x\n", cap2); 821 size -= temp; 822 next += temp; 823 break; 824 case 0: /* illegal reserved capability */ 825 cap = 0; 826 fallthrough; 827 default: /* unknown */ 828 break; 829 } 830 offset = (cap >> 8) & 0xff; 831 } 832 } 833 #endif 834 835 /* FIXME interpret both types of params */ 836 i = ehci_readl(ehci, &ehci->caps->hcs_params); 837 temp = scnprintf(next, size, "structural params 0x%08x\n", i); 838 size -= temp; 839 next += temp; 840 841 i = ehci_readl(ehci, &ehci->caps->hcc_params); 842 temp = scnprintf(next, size, "capability params 0x%08x\n", i); 843 size -= temp; 844 next += temp; 845 846 /* Operational Registers */ 847 temp = dbg_status_buf(scratch, sizeof(scratch), label, 848 ehci_readl(ehci, &ehci->regs->status)); 849 temp = scnprintf(next, size, fmt, temp, scratch); 850 size -= temp; 851 next += temp; 852 853 temp = dbg_command_buf(scratch, sizeof(scratch), label, 854 ehci_readl(ehci, &ehci->regs->command)); 855 temp = scnprintf(next, size, fmt, temp, scratch); 856 size -= temp; 857 next += temp; 858 859 temp = dbg_intr_buf(scratch, sizeof(scratch), label, 860 ehci_readl(ehci, &ehci->regs->intr_enable)); 861 temp = scnprintf(next, size, fmt, temp, scratch); 862 size -= temp; 863 next += temp; 864 865 temp = scnprintf(next, size, "uframe %04x\n", 866 ehci_read_frame_index(ehci)); 867 size -= temp; 868 next += temp; 869 870 for (i = 1; i <= HCS_N_PORTS(ehci->hcs_params); i++) { 871 temp = dbg_port_buf(scratch, sizeof(scratch), label, i, 872 ehci_readl(ehci, 873 &ehci->regs->port_status[i - 1])); 874 temp = scnprintf(next, size, fmt, temp, scratch); 875 size -= temp; 876 next += temp; 877 if (i == HCS_DEBUG_PORT(ehci->hcs_params) && ehci->debug) { 878 temp = scnprintf(next, size, 879 " debug control %08x\n", 880 ehci_readl(ehci, 881 &ehci->debug->control)); 882 size -= temp; 883 next += temp; 884 } 885 } 886 887 if (!list_empty(&ehci->async_unlink)) { 888 temp = scnprintf(next, size, "async unlink qh %p\n", 889 list_first_entry(&ehci->async_unlink, 890 struct ehci_qh, unlink_node)); 891 size -= temp; 892 next += temp; 893 } 894 895 #ifdef EHCI_STATS 896 temp = scnprintf(next, size, 897 "irq normal %ld err %ld iaa %ld (lost %ld)\n", 898 ehci->stats.normal, ehci->stats.error, ehci->stats.iaa, 899 ehci->stats.lost_iaa); 900 size -= temp; 901 next += temp; 902 903 temp = scnprintf(next, size, "complete %ld unlink %ld\n", 904 ehci->stats.complete, ehci->stats.unlink); 905 size -= temp; 906 next += temp; 907 #endif 908 909 done: 910 spin_unlock_irqrestore(&ehci->lock, flags); 911 912 return buf->alloc_size - size; 913 } 914 915 static struct debug_buffer *alloc_buffer(struct usb_bus *bus, 916 ssize_t (*fill_func)(struct debug_buffer *)) 917 { 918 struct debug_buffer *buf; 919 920 buf = kzalloc(sizeof(*buf), GFP_KERNEL); 921 922 if (buf) { 923 buf->bus = bus; 924 buf->fill_func = fill_func; 925 mutex_init(&buf->mutex); 926 buf->alloc_size = PAGE_SIZE; 927 } 928 929 return buf; 930 } 931 932 static int fill_buffer(struct debug_buffer *buf) 933 { 934 int ret = 0; 935 936 if (!buf->output_buf) 937 buf->output_buf = vmalloc(buf->alloc_size); 938 939 if (!buf->output_buf) { 940 ret = -ENOMEM; 941 goto out; 942 } 943 944 ret = buf->fill_func(buf); 945 946 if (ret >= 0) { 947 buf->count = ret; 948 ret = 0; 949 } 950 951 out: 952 return ret; 953 } 954 955 static ssize_t debug_output(struct file *file, char __user *user_buf, 956 size_t len, loff_t *offset) 957 { 958 struct debug_buffer *buf = file->private_data; 959 int ret = 0; 960 961 mutex_lock(&buf->mutex); 962 if (buf->count == 0) { 963 ret = fill_buffer(buf); 964 if (ret != 0) { 965 mutex_unlock(&buf->mutex); 966 goto out; 967 } 968 } 969 mutex_unlock(&buf->mutex); 970 971 ret = simple_read_from_buffer(user_buf, len, offset, 972 buf->output_buf, buf->count); 973 974 out: 975 return ret; 976 } 977 978 static int debug_close(struct inode *inode, struct file *file) 979 { 980 struct debug_buffer *buf = file->private_data; 981 982 if (buf) { 983 vfree(buf->output_buf); 984 kfree(buf); 985 } 986 987 return 0; 988 } 989 990 static int debug_async_open(struct inode *inode, struct file *file) 991 { 992 file->private_data = alloc_buffer(inode->i_private, fill_async_buffer); 993 994 return file->private_data ? 0 : -ENOMEM; 995 } 996 997 static int debug_bandwidth_open(struct inode *inode, struct file *file) 998 { 999 file->private_data = alloc_buffer(inode->i_private, 1000 fill_bandwidth_buffer); 1001 1002 return file->private_data ? 0 : -ENOMEM; 1003 } 1004 1005 static int debug_periodic_open(struct inode *inode, struct file *file) 1006 { 1007 struct debug_buffer *buf; 1008 1009 buf = alloc_buffer(inode->i_private, fill_periodic_buffer); 1010 if (!buf) 1011 return -ENOMEM; 1012 1013 buf->alloc_size = (sizeof(void *) == 4 ? 6 : 8) * PAGE_SIZE; 1014 file->private_data = buf; 1015 return 0; 1016 } 1017 1018 static int debug_registers_open(struct inode *inode, struct file *file) 1019 { 1020 file->private_data = alloc_buffer(inode->i_private, 1021 fill_registers_buffer); 1022 1023 return file->private_data ? 0 : -ENOMEM; 1024 } 1025 1026 static inline void create_debug_files(struct ehci_hcd *ehci) 1027 { 1028 struct usb_bus *bus = &ehci_to_hcd(ehci)->self; 1029 1030 ehci->debug_dir = debugfs_create_dir(bus->bus_name, ehci_debug_root); 1031 1032 debugfs_create_file("async", S_IRUGO, ehci->debug_dir, bus, 1033 &debug_async_fops); 1034 debugfs_create_file("bandwidth", S_IRUGO, ehci->debug_dir, bus, 1035 &debug_bandwidth_fops); 1036 debugfs_create_file("periodic", S_IRUGO, ehci->debug_dir, bus, 1037 &debug_periodic_fops); 1038 debugfs_create_file("registers", S_IRUGO, ehci->debug_dir, bus, 1039 &debug_registers_fops); 1040 } 1041 1042 static inline void remove_debug_files(struct ehci_hcd *ehci) 1043 { 1044 debugfs_remove_recursive(ehci->debug_dir); 1045 } 1046 1047 #else /* CONFIG_DYNAMIC_DEBUG */ 1048 1049 static inline void dbg_hcs_params(struct ehci_hcd *ehci, char *label) { } 1050 static inline void dbg_hcc_params(struct ehci_hcd *ehci, char *label) { } 1051 1052 static inline void __maybe_unused dbg_qh(const char *label, 1053 struct ehci_hcd *ehci, struct ehci_qh *qh) { } 1054 1055 static inline int __maybe_unused dbg_status_buf(const char *buf, 1056 unsigned int len, const char *label, u32 status) 1057 { return 0; } 1058 1059 static inline int __maybe_unused dbg_command_buf(const char *buf, 1060 unsigned int len, const char *label, u32 command) 1061 { return 0; } 1062 1063 static inline int __maybe_unused dbg_intr_buf(const char *buf, 1064 unsigned int len, const char *label, u32 enable) 1065 { return 0; } 1066 1067 static inline int __maybe_unused dbg_port_buf(char *buf, 1068 unsigned int len, const char *label, int port, u32 status) 1069 { return 0; } 1070 1071 static inline void dbg_status(struct ehci_hcd *ehci, const char *label, 1072 u32 status) { } 1073 static inline void dbg_cmd(struct ehci_hcd *ehci, const char *label, 1074 u32 command) { } 1075 static inline void dbg_port(struct ehci_hcd *ehci, const char *label, 1076 int port, u32 status) { } 1077 1078 static inline void create_debug_files(struct ehci_hcd *bus) { } 1079 static inline void remove_debug_files(struct ehci_hcd *bus) { } 1080 1081 #endif /* CONFIG_DYNAMIC_DEBUG */ 1082