1 /* 2 * OHCI HCD (Host Controller Driver) for USB. 3 * 4 * (C) Copyright 1999 Roman Weissgaerber <weissg@vienna.at> 5 * (C) Copyright 2000-2002 David Brownell <dbrownell@users.sourceforge.net> 6 * 7 * This file is licenced under the GPL. 8 */ 9 10 /*-------------------------------------------------------------------------*/ 11 12 #define edstring(ed_type) ({ char *temp; \ 13 switch (ed_type) { \ 14 case PIPE_CONTROL: temp = "ctrl"; break; \ 15 case PIPE_BULK: temp = "bulk"; break; \ 16 case PIPE_INTERRUPT: temp = "intr"; break; \ 17 default: temp = "isoc"; break; \ 18 } temp;}) 19 #define pipestring(pipe) edstring(usb_pipetype(pipe)) 20 21 22 #define ohci_dbg_sw(ohci, next, size, format, arg...) \ 23 do { \ 24 if (next != NULL) { \ 25 unsigned s_len; \ 26 s_len = scnprintf (*next, *size, format, ## arg ); \ 27 *size -= s_len; *next += s_len; \ 28 } else \ 29 ohci_dbg(ohci,format, ## arg ); \ 30 } while (0); 31 32 /* Version for use where "next" is the address of a local variable */ 33 #define ohci_dbg_nosw(ohci, next, size, format, arg...) \ 34 do { \ 35 unsigned s_len; \ 36 s_len = scnprintf(*next, *size, format, ## arg); \ 37 *size -= s_len; *next += s_len; \ 38 } while (0); 39 40 41 static void ohci_dump_intr_mask ( 42 struct ohci_hcd *ohci, 43 char *label, 44 u32 mask, 45 char **next, 46 unsigned *size) 47 { 48 ohci_dbg_sw (ohci, next, size, "%s 0x%08x%s%s%s%s%s%s%s%s%s\n", 49 label, 50 mask, 51 (mask & OHCI_INTR_MIE) ? " MIE" : "", 52 (mask & OHCI_INTR_OC) ? " OC" : "", 53 (mask & OHCI_INTR_RHSC) ? " RHSC" : "", 54 (mask & OHCI_INTR_FNO) ? " FNO" : "", 55 (mask & OHCI_INTR_UE) ? " UE" : "", 56 (mask & OHCI_INTR_RD) ? " RD" : "", 57 (mask & OHCI_INTR_SF) ? " SF" : "", 58 (mask & OHCI_INTR_WDH) ? " WDH" : "", 59 (mask & OHCI_INTR_SO) ? " SO" : "" 60 ); 61 } 62 63 static void maybe_print_eds ( 64 struct ohci_hcd *ohci, 65 char *label, 66 u32 value, 67 char **next, 68 unsigned *size) 69 { 70 if (value) 71 ohci_dbg_sw (ohci, next, size, "%s %08x\n", label, value); 72 } 73 74 static char *hcfs2string (int state) 75 { 76 switch (state) { 77 case OHCI_USB_RESET: return "reset"; 78 case OHCI_USB_RESUME: return "resume"; 79 case OHCI_USB_OPER: return "operational"; 80 case OHCI_USB_SUSPEND: return "suspend"; 81 } 82 return "?"; 83 } 84 85 static const char *rh_state_string(struct ohci_hcd *ohci) 86 { 87 switch (ohci->rh_state) { 88 case OHCI_RH_HALTED: 89 return "halted"; 90 case OHCI_RH_SUSPENDED: 91 return "suspended"; 92 case OHCI_RH_RUNNING: 93 return "running"; 94 } 95 return "?"; 96 } 97 98 // dump control and status registers 99 static void 100 ohci_dump_status (struct ohci_hcd *controller, char **next, unsigned *size) 101 { 102 struct ohci_regs __iomem *regs = controller->regs; 103 u32 temp; 104 105 temp = ohci_readl (controller, ®s->revision) & 0xff; 106 ohci_dbg_sw (controller, next, size, 107 "OHCI %d.%d, %s legacy support registers, rh state %s\n", 108 0x03 & (temp >> 4), (temp & 0x0f), 109 (temp & 0x0100) ? "with" : "NO", 110 rh_state_string(controller)); 111 112 temp = ohci_readl (controller, ®s->control); 113 ohci_dbg_sw (controller, next, size, 114 "control 0x%03x%s%s%s HCFS=%s%s%s%s%s CBSR=%d\n", 115 temp, 116 (temp & OHCI_CTRL_RWE) ? " RWE" : "", 117 (temp & OHCI_CTRL_RWC) ? " RWC" : "", 118 (temp & OHCI_CTRL_IR) ? " IR" : "", 119 hcfs2string (temp & OHCI_CTRL_HCFS), 120 (temp & OHCI_CTRL_BLE) ? " BLE" : "", 121 (temp & OHCI_CTRL_CLE) ? " CLE" : "", 122 (temp & OHCI_CTRL_IE) ? " IE" : "", 123 (temp & OHCI_CTRL_PLE) ? " PLE" : "", 124 temp & OHCI_CTRL_CBSR 125 ); 126 127 temp = ohci_readl (controller, ®s->cmdstatus); 128 ohci_dbg_sw (controller, next, size, 129 "cmdstatus 0x%05x SOC=%d%s%s%s%s\n", temp, 130 (temp & OHCI_SOC) >> 16, 131 (temp & OHCI_OCR) ? " OCR" : "", 132 (temp & OHCI_BLF) ? " BLF" : "", 133 (temp & OHCI_CLF) ? " CLF" : "", 134 (temp & OHCI_HCR) ? " HCR" : "" 135 ); 136 137 ohci_dump_intr_mask (controller, "intrstatus", 138 ohci_readl (controller, ®s->intrstatus), 139 next, size); 140 ohci_dump_intr_mask (controller, "intrenable", 141 ohci_readl (controller, ®s->intrenable), 142 next, size); 143 // intrdisable always same as intrenable 144 145 maybe_print_eds (controller, "ed_periodcurrent", 146 ohci_readl (controller, ®s->ed_periodcurrent), 147 next, size); 148 149 maybe_print_eds (controller, "ed_controlhead", 150 ohci_readl (controller, ®s->ed_controlhead), 151 next, size); 152 maybe_print_eds (controller, "ed_controlcurrent", 153 ohci_readl (controller, ®s->ed_controlcurrent), 154 next, size); 155 156 maybe_print_eds (controller, "ed_bulkhead", 157 ohci_readl (controller, ®s->ed_bulkhead), 158 next, size); 159 maybe_print_eds (controller, "ed_bulkcurrent", 160 ohci_readl (controller, ®s->ed_bulkcurrent), 161 next, size); 162 163 maybe_print_eds (controller, "donehead", 164 ohci_readl (controller, ®s->donehead), next, size); 165 } 166 167 #define dbg_port_sw(hc,num,value,next,size) \ 168 ohci_dbg_sw (hc, next, size, \ 169 "roothub.portstatus [%d] " \ 170 "0x%08x%s%s%s%s%s%s%s%s%s%s%s%s\n", \ 171 num, temp, \ 172 (temp & RH_PS_PRSC) ? " PRSC" : "", \ 173 (temp & RH_PS_OCIC) ? " OCIC" : "", \ 174 (temp & RH_PS_PSSC) ? " PSSC" : "", \ 175 (temp & RH_PS_PESC) ? " PESC" : "", \ 176 (temp & RH_PS_CSC) ? " CSC" : "", \ 177 \ 178 (temp & RH_PS_LSDA) ? " LSDA" : "", \ 179 (temp & RH_PS_PPS) ? " PPS" : "", \ 180 (temp & RH_PS_PRS) ? " PRS" : "", \ 181 (temp & RH_PS_POCI) ? " POCI" : "", \ 182 (temp & RH_PS_PSS) ? " PSS" : "", \ 183 \ 184 (temp & RH_PS_PES) ? " PES" : "", \ 185 (temp & RH_PS_CCS) ? " CCS" : "" \ 186 ); 187 188 189 static void 190 ohci_dump_roothub ( 191 struct ohci_hcd *controller, 192 int verbose, 193 char **next, 194 unsigned *size) 195 { 196 u32 temp, i; 197 198 temp = roothub_a (controller); 199 if (temp == ~(u32)0) 200 return; 201 202 if (verbose) { 203 ohci_dbg_sw (controller, next, size, 204 "roothub.a %08x POTPGT=%d%s%s%s%s%s NDP=%d(%d)\n", temp, 205 ((temp & RH_A_POTPGT) >> 24) & 0xff, 206 (temp & RH_A_NOCP) ? " NOCP" : "", 207 (temp & RH_A_OCPM) ? " OCPM" : "", 208 (temp & RH_A_DT) ? " DT" : "", 209 (temp & RH_A_NPS) ? " NPS" : "", 210 (temp & RH_A_PSM) ? " PSM" : "", 211 (temp & RH_A_NDP), controller->num_ports 212 ); 213 temp = roothub_b (controller); 214 ohci_dbg_sw (controller, next, size, 215 "roothub.b %08x PPCM=%04x DR=%04x\n", 216 temp, 217 (temp & RH_B_PPCM) >> 16, 218 (temp & RH_B_DR) 219 ); 220 temp = roothub_status (controller); 221 ohci_dbg_sw (controller, next, size, 222 "roothub.status %08x%s%s%s%s%s%s\n", 223 temp, 224 (temp & RH_HS_CRWE) ? " CRWE" : "", 225 (temp & RH_HS_OCIC) ? " OCIC" : "", 226 (temp & RH_HS_LPSC) ? " LPSC" : "", 227 (temp & RH_HS_DRWE) ? " DRWE" : "", 228 (temp & RH_HS_OCI) ? " OCI" : "", 229 (temp & RH_HS_LPS) ? " LPS" : "" 230 ); 231 } 232 233 for (i = 0; i < controller->num_ports; i++) { 234 temp = roothub_portstatus (controller, i); 235 dbg_port_sw (controller, i, temp, next, size); 236 } 237 } 238 239 static void ohci_dump (struct ohci_hcd *controller, int verbose) 240 { 241 ohci_dbg (controller, "OHCI controller state\n"); 242 243 // dumps some of the state we know about 244 ohci_dump_status (controller, NULL, NULL); 245 if (controller->hcca) 246 ohci_dbg (controller, 247 "hcca frame #%04x\n", ohci_frame_no(controller)); 248 ohci_dump_roothub (controller, 1, NULL, NULL); 249 } 250 251 static const char data0 [] = "DATA0"; 252 static const char data1 [] = "DATA1"; 253 254 static void ohci_dump_td (const struct ohci_hcd *ohci, const char *label, 255 const struct td *td) 256 { 257 u32 tmp = hc32_to_cpup (ohci, &td->hwINFO); 258 259 ohci_dbg (ohci, "%s td %p%s; urb %p index %d; hw next td %08x\n", 260 label, td, 261 (tmp & TD_DONE) ? " (DONE)" : "", 262 td->urb, td->index, 263 hc32_to_cpup (ohci, &td->hwNextTD)); 264 if ((tmp & TD_ISO) == 0) { 265 const char *toggle, *pid; 266 u32 cbp, be; 267 268 switch (tmp & TD_T) { 269 case TD_T_DATA0: toggle = data0; break; 270 case TD_T_DATA1: toggle = data1; break; 271 case TD_T_TOGGLE: toggle = "(CARRY)"; break; 272 default: toggle = "(?)"; break; 273 } 274 switch (tmp & TD_DP) { 275 case TD_DP_SETUP: pid = "SETUP"; break; 276 case TD_DP_IN: pid = "IN"; break; 277 case TD_DP_OUT: pid = "OUT"; break; 278 default: pid = "(bad pid)"; break; 279 } 280 ohci_dbg (ohci, " info %08x CC=%x %s DI=%d %s %s\n", tmp, 281 TD_CC_GET(tmp), /* EC, */ toggle, 282 (tmp & TD_DI) >> 21, pid, 283 (tmp & TD_R) ? "R" : ""); 284 cbp = hc32_to_cpup (ohci, &td->hwCBP); 285 be = hc32_to_cpup (ohci, &td->hwBE); 286 ohci_dbg (ohci, " cbp %08x be %08x (len %d)\n", cbp, be, 287 cbp ? (be + 1 - cbp) : 0); 288 } else { 289 unsigned i; 290 ohci_dbg (ohci, " info %08x CC=%x FC=%d DI=%d SF=%04x\n", tmp, 291 TD_CC_GET(tmp), 292 (tmp >> 24) & 0x07, 293 (tmp & TD_DI) >> 21, 294 tmp & 0x0000ffff); 295 ohci_dbg (ohci, " bp0 %08x be %08x\n", 296 hc32_to_cpup (ohci, &td->hwCBP) & ~0x0fff, 297 hc32_to_cpup (ohci, &td->hwBE)); 298 for (i = 0; i < MAXPSW; i++) { 299 u16 psw = ohci_hwPSW (ohci, td, i); 300 int cc = (psw >> 12) & 0x0f; 301 ohci_dbg (ohci, " psw [%d] = %2x, CC=%x %s=%d\n", i, 302 psw, cc, 303 (cc >= 0x0e) ? "OFFSET" : "SIZE", 304 psw & 0x0fff); 305 } 306 } 307 } 308 309 /* caller MUST own hcd spinlock if verbose is set! */ 310 static void __maybe_unused 311 ohci_dump_ed (const struct ohci_hcd *ohci, const char *label, 312 const struct ed *ed, int verbose) 313 { 314 u32 tmp = hc32_to_cpu (ohci, ed->hwINFO); 315 char *type = ""; 316 317 ohci_dbg (ohci, "%s, ed %p state 0x%x type %s; next ed %08x\n", 318 label, 319 ed, ed->state, edstring (ed->type), 320 hc32_to_cpup (ohci, &ed->hwNextED)); 321 switch (tmp & (ED_IN|ED_OUT)) { 322 case ED_OUT: type = "-OUT"; break; 323 case ED_IN: type = "-IN"; break; 324 /* else from TDs ... control */ 325 } 326 ohci_dbg (ohci, 327 " info %08x MAX=%d%s%s%s%s EP=%d%s DEV=%d\n", tmp, 328 0x03ff & (tmp >> 16), 329 (tmp & ED_DEQUEUE) ? " DQ" : "", 330 (tmp & ED_ISO) ? " ISO" : "", 331 (tmp & ED_SKIP) ? " SKIP" : "", 332 (tmp & ED_LOWSPEED) ? " LOW" : "", 333 0x000f & (tmp >> 7), 334 type, 335 0x007f & tmp); 336 tmp = hc32_to_cpup (ohci, &ed->hwHeadP); 337 ohci_dbg (ohci, " tds: head %08x %s%s tail %08x%s\n", 338 tmp, 339 (tmp & ED_C) ? data1 : data0, 340 (tmp & ED_H) ? " HALT" : "", 341 hc32_to_cpup (ohci, &ed->hwTailP), 342 verbose ? "" : " (not listing)"); 343 if (verbose) { 344 struct list_head *tmp; 345 346 /* use ed->td_list because HC concurrently modifies 347 * hwNextTD as it accumulates ed_donelist. 348 */ 349 list_for_each (tmp, &ed->td_list) { 350 struct td *td; 351 td = list_entry (tmp, struct td, td_list); 352 ohci_dump_td (ohci, " ->", td); 353 } 354 } 355 } 356 357 /*-------------------------------------------------------------------------*/ 358 359 static int debug_async_open(struct inode *, struct file *); 360 static int debug_periodic_open(struct inode *, struct file *); 361 static int debug_registers_open(struct inode *, struct file *); 362 static int debug_async_open(struct inode *, struct file *); 363 static ssize_t debug_output(struct file*, char __user*, size_t, loff_t*); 364 static int debug_close(struct inode *, struct file *); 365 366 static const struct file_operations debug_async_fops = { 367 .owner = THIS_MODULE, 368 .open = debug_async_open, 369 .read = debug_output, 370 .release = debug_close, 371 .llseek = default_llseek, 372 }; 373 static const struct file_operations debug_periodic_fops = { 374 .owner = THIS_MODULE, 375 .open = debug_periodic_open, 376 .read = debug_output, 377 .release = debug_close, 378 .llseek = default_llseek, 379 }; 380 static const struct file_operations debug_registers_fops = { 381 .owner = THIS_MODULE, 382 .open = debug_registers_open, 383 .read = debug_output, 384 .release = debug_close, 385 .llseek = default_llseek, 386 }; 387 388 static struct dentry *ohci_debug_root; 389 390 struct debug_buffer { 391 ssize_t (*fill_func)(struct debug_buffer *); /* fill method */ 392 struct ohci_hcd *ohci; 393 struct mutex mutex; /* protect filling of buffer */ 394 size_t count; /* number of characters filled into buffer */ 395 char *page; 396 }; 397 398 static ssize_t 399 show_list (struct ohci_hcd *ohci, char *buf, size_t count, struct ed *ed) 400 { 401 unsigned temp, size = count; 402 403 if (!ed) 404 return 0; 405 406 /* print first --> last */ 407 while (ed->ed_prev) 408 ed = ed->ed_prev; 409 410 /* dump a snapshot of the bulk or control schedule */ 411 while (ed) { 412 u32 info = hc32_to_cpu (ohci, ed->hwINFO); 413 u32 headp = hc32_to_cpu (ohci, ed->hwHeadP); 414 struct list_head *entry; 415 struct td *td; 416 417 temp = scnprintf (buf, size, 418 "ed/%p %cs dev%d ep%d%s max %d %08x%s%s %s", 419 ed, 420 (info & ED_LOWSPEED) ? 'l' : 'f', 421 info & 0x7f, 422 (info >> 7) & 0xf, 423 (info & ED_IN) ? "in" : "out", 424 0x03ff & (info >> 16), 425 info, 426 (info & ED_SKIP) ? " s" : "", 427 (headp & ED_H) ? " H" : "", 428 (headp & ED_C) ? data1 : data0); 429 size -= temp; 430 buf += temp; 431 432 list_for_each (entry, &ed->td_list) { 433 u32 cbp, be; 434 435 td = list_entry (entry, struct td, td_list); 436 info = hc32_to_cpup (ohci, &td->hwINFO); 437 cbp = hc32_to_cpup (ohci, &td->hwCBP); 438 be = hc32_to_cpup (ohci, &td->hwBE); 439 temp = scnprintf (buf, size, 440 "\n\ttd %p %s %d cc=%x urb %p (%08x)", 441 td, 442 ({ char *pid; 443 switch (info & TD_DP) { 444 case TD_DP_SETUP: pid = "setup"; break; 445 case TD_DP_IN: pid = "in"; break; 446 case TD_DP_OUT: pid = "out"; break; 447 default: pid = "(?)"; break; 448 } pid;}), 449 cbp ? (be + 1 - cbp) : 0, 450 TD_CC_GET (info), td->urb, info); 451 size -= temp; 452 buf += temp; 453 } 454 455 temp = scnprintf (buf, size, "\n"); 456 size -= temp; 457 buf += temp; 458 459 ed = ed->ed_next; 460 } 461 return count - size; 462 } 463 464 static ssize_t fill_async_buffer(struct debug_buffer *buf) 465 { 466 struct ohci_hcd *ohci; 467 size_t temp; 468 unsigned long flags; 469 470 ohci = buf->ohci; 471 472 /* display control and bulk lists together, for simplicity */ 473 spin_lock_irqsave (&ohci->lock, flags); 474 temp = show_list(ohci, buf->page, buf->count, ohci->ed_controltail); 475 temp += show_list(ohci, buf->page + temp, buf->count - temp, 476 ohci->ed_bulktail); 477 spin_unlock_irqrestore (&ohci->lock, flags); 478 479 return temp; 480 } 481 482 #define DBG_SCHED_LIMIT 64 483 484 static ssize_t fill_periodic_buffer(struct debug_buffer *buf) 485 { 486 struct ohci_hcd *ohci; 487 struct ed **seen, *ed; 488 unsigned long flags; 489 unsigned temp, size, seen_count; 490 char *next; 491 unsigned i; 492 493 if (!(seen = kmalloc (DBG_SCHED_LIMIT * sizeof *seen, GFP_ATOMIC))) 494 return 0; 495 seen_count = 0; 496 497 ohci = buf->ohci; 498 next = buf->page; 499 size = PAGE_SIZE; 500 501 temp = scnprintf (next, size, "size = %d\n", NUM_INTS); 502 size -= temp; 503 next += temp; 504 505 /* dump a snapshot of the periodic schedule (and load) */ 506 spin_lock_irqsave (&ohci->lock, flags); 507 for (i = 0; i < NUM_INTS; i++) { 508 if (!(ed = ohci->periodic [i])) 509 continue; 510 511 temp = scnprintf (next, size, "%2d [%3d]:", i, ohci->load [i]); 512 size -= temp; 513 next += temp; 514 515 do { 516 temp = scnprintf (next, size, " ed%d/%p", 517 ed->interval, ed); 518 size -= temp; 519 next += temp; 520 for (temp = 0; temp < seen_count; temp++) { 521 if (seen [temp] == ed) 522 break; 523 } 524 525 /* show more info the first time around */ 526 if (temp == seen_count) { 527 u32 info = hc32_to_cpu (ohci, ed->hwINFO); 528 struct list_head *entry; 529 unsigned qlen = 0; 530 531 /* qlen measured here in TDs, not urbs */ 532 list_for_each (entry, &ed->td_list) 533 qlen++; 534 535 temp = scnprintf (next, size, 536 " (%cs dev%d ep%d%s-%s qlen %u" 537 " max %d %08x%s%s)", 538 (info & ED_LOWSPEED) ? 'l' : 'f', 539 info & 0x7f, 540 (info >> 7) & 0xf, 541 (info & ED_IN) ? "in" : "out", 542 (info & ED_ISO) ? "iso" : "int", 543 qlen, 544 0x03ff & (info >> 16), 545 info, 546 (info & ED_SKIP) ? " K" : "", 547 (ed->hwHeadP & 548 cpu_to_hc32(ohci, ED_H)) ? 549 " H" : ""); 550 size -= temp; 551 next += temp; 552 553 if (seen_count < DBG_SCHED_LIMIT) 554 seen [seen_count++] = ed; 555 556 ed = ed->ed_next; 557 558 } else { 559 /* we've seen it and what's after */ 560 temp = 0; 561 ed = NULL; 562 } 563 564 } while (ed); 565 566 temp = scnprintf (next, size, "\n"); 567 size -= temp; 568 next += temp; 569 } 570 spin_unlock_irqrestore (&ohci->lock, flags); 571 kfree (seen); 572 573 return PAGE_SIZE - size; 574 } 575 #undef DBG_SCHED_LIMIT 576 577 static ssize_t fill_registers_buffer(struct debug_buffer *buf) 578 { 579 struct usb_hcd *hcd; 580 struct ohci_hcd *ohci; 581 struct ohci_regs __iomem *regs; 582 unsigned long flags; 583 unsigned temp, size; 584 char *next; 585 u32 rdata; 586 587 ohci = buf->ohci; 588 hcd = ohci_to_hcd(ohci); 589 regs = ohci->regs; 590 next = buf->page; 591 size = PAGE_SIZE; 592 593 spin_lock_irqsave (&ohci->lock, flags); 594 595 /* dump driver info, then registers in spec order */ 596 597 ohci_dbg_nosw(ohci, &next, &size, 598 "bus %s, device %s\n" 599 "%s\n" 600 "%s\n", 601 hcd->self.controller->bus->name, 602 dev_name(hcd->self.controller), 603 hcd->product_desc, 604 hcd_name); 605 606 if (!HCD_HW_ACCESSIBLE(hcd)) { 607 size -= scnprintf (next, size, 608 "SUSPENDED (no register access)\n"); 609 goto done; 610 } 611 612 ohci_dump_status(ohci, &next, &size); 613 614 /* hcca */ 615 if (ohci->hcca) 616 ohci_dbg_nosw(ohci, &next, &size, 617 "hcca frame 0x%04x\n", ohci_frame_no(ohci)); 618 619 /* other registers mostly affect frame timings */ 620 rdata = ohci_readl (ohci, ®s->fminterval); 621 temp = scnprintf (next, size, 622 "fmintvl 0x%08x %sFSMPS=0x%04x FI=0x%04x\n", 623 rdata, (rdata >> 31) ? "FIT " : "", 624 (rdata >> 16) & 0xefff, rdata & 0xffff); 625 size -= temp; 626 next += temp; 627 628 rdata = ohci_readl (ohci, ®s->fmremaining); 629 temp = scnprintf (next, size, "fmremaining 0x%08x %sFR=0x%04x\n", 630 rdata, (rdata >> 31) ? "FRT " : "", 631 rdata & 0x3fff); 632 size -= temp; 633 next += temp; 634 635 rdata = ohci_readl (ohci, ®s->periodicstart); 636 temp = scnprintf (next, size, "periodicstart 0x%04x\n", 637 rdata & 0x3fff); 638 size -= temp; 639 next += temp; 640 641 rdata = ohci_readl (ohci, ®s->lsthresh); 642 temp = scnprintf (next, size, "lsthresh 0x%04x\n", 643 rdata & 0x3fff); 644 size -= temp; 645 next += temp; 646 647 temp = scnprintf (next, size, "hub poll timer %s\n", 648 HCD_POLL_RH(ohci_to_hcd(ohci)) ? "ON" : "off"); 649 size -= temp; 650 next += temp; 651 652 /* roothub */ 653 ohci_dump_roothub (ohci, 1, &next, &size); 654 655 done: 656 spin_unlock_irqrestore (&ohci->lock, flags); 657 658 return PAGE_SIZE - size; 659 } 660 661 static struct debug_buffer *alloc_buffer(struct ohci_hcd *ohci, 662 ssize_t (*fill_func)(struct debug_buffer *)) 663 { 664 struct debug_buffer *buf; 665 666 buf = kzalloc(sizeof(struct debug_buffer), GFP_KERNEL); 667 668 if (buf) { 669 buf->ohci = ohci; 670 buf->fill_func = fill_func; 671 mutex_init(&buf->mutex); 672 } 673 674 return buf; 675 } 676 677 static int fill_buffer(struct debug_buffer *buf) 678 { 679 int ret = 0; 680 681 if (!buf->page) 682 buf->page = (char *)get_zeroed_page(GFP_KERNEL); 683 684 if (!buf->page) { 685 ret = -ENOMEM; 686 goto out; 687 } 688 689 ret = buf->fill_func(buf); 690 691 if (ret >= 0) { 692 buf->count = ret; 693 ret = 0; 694 } 695 696 out: 697 return ret; 698 } 699 700 static ssize_t debug_output(struct file *file, char __user *user_buf, 701 size_t len, loff_t *offset) 702 { 703 struct debug_buffer *buf = file->private_data; 704 int ret = 0; 705 706 mutex_lock(&buf->mutex); 707 if (buf->count == 0) { 708 ret = fill_buffer(buf); 709 if (ret != 0) { 710 mutex_unlock(&buf->mutex); 711 goto out; 712 } 713 } 714 mutex_unlock(&buf->mutex); 715 716 ret = simple_read_from_buffer(user_buf, len, offset, 717 buf->page, buf->count); 718 719 out: 720 return ret; 721 722 } 723 724 static int debug_close(struct inode *inode, struct file *file) 725 { 726 struct debug_buffer *buf = file->private_data; 727 728 if (buf) { 729 if (buf->page) 730 free_page((unsigned long)buf->page); 731 kfree(buf); 732 } 733 734 return 0; 735 } 736 static int debug_async_open(struct inode *inode, struct file *file) 737 { 738 file->private_data = alloc_buffer(inode->i_private, fill_async_buffer); 739 740 return file->private_data ? 0 : -ENOMEM; 741 } 742 743 static int debug_periodic_open(struct inode *inode, struct file *file) 744 { 745 file->private_data = alloc_buffer(inode->i_private, 746 fill_periodic_buffer); 747 748 return file->private_data ? 0 : -ENOMEM; 749 } 750 751 static int debug_registers_open(struct inode *inode, struct file *file) 752 { 753 file->private_data = alloc_buffer(inode->i_private, 754 fill_registers_buffer); 755 756 return file->private_data ? 0 : -ENOMEM; 757 } 758 static inline void create_debug_files (struct ohci_hcd *ohci) 759 { 760 struct usb_bus *bus = &ohci_to_hcd(ohci)->self; 761 762 ohci->debug_dir = debugfs_create_dir(bus->bus_name, ohci_debug_root); 763 if (!ohci->debug_dir) 764 goto dir_error; 765 766 ohci->debug_async = debugfs_create_file("async", S_IRUGO, 767 ohci->debug_dir, ohci, 768 &debug_async_fops); 769 if (!ohci->debug_async) 770 goto async_error; 771 772 ohci->debug_periodic = debugfs_create_file("periodic", S_IRUGO, 773 ohci->debug_dir, ohci, 774 &debug_periodic_fops); 775 if (!ohci->debug_periodic) 776 goto periodic_error; 777 778 ohci->debug_registers = debugfs_create_file("registers", S_IRUGO, 779 ohci->debug_dir, ohci, 780 &debug_registers_fops); 781 if (!ohci->debug_registers) 782 goto registers_error; 783 784 ohci_dbg (ohci, "created debug files\n"); 785 return; 786 787 registers_error: 788 debugfs_remove(ohci->debug_periodic); 789 periodic_error: 790 debugfs_remove(ohci->debug_async); 791 async_error: 792 debugfs_remove(ohci->debug_dir); 793 dir_error: 794 ohci->debug_periodic = NULL; 795 ohci->debug_async = NULL; 796 ohci->debug_dir = NULL; 797 } 798 799 static inline void remove_debug_files (struct ohci_hcd *ohci) 800 { 801 debugfs_remove(ohci->debug_registers); 802 debugfs_remove(ohci->debug_periodic); 803 debugfs_remove(ohci->debug_async); 804 debugfs_remove(ohci->debug_dir); 805 } 806 807 /*-------------------------------------------------------------------------*/ 808 809