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) 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, size; 468 unsigned long flags; 469 470 ohci = buf->ohci; 471 size = PAGE_SIZE; 472 473 /* display control and bulk lists together, for simplicity */ 474 spin_lock_irqsave (&ohci->lock, flags); 475 temp = show_list(ohci, buf->page, size, ohci->ed_controltail); 476 temp += show_list(ohci, buf->page + temp, size - temp, 477 ohci->ed_bulktail); 478 spin_unlock_irqrestore (&ohci->lock, flags); 479 480 return temp; 481 } 482 483 #define DBG_SCHED_LIMIT 64 484 485 static ssize_t fill_periodic_buffer(struct debug_buffer *buf) 486 { 487 struct ohci_hcd *ohci; 488 struct ed **seen, *ed; 489 unsigned long flags; 490 unsigned temp, size, seen_count; 491 char *next; 492 unsigned i; 493 494 seen = kmalloc(DBG_SCHED_LIMIT * sizeof *seen, GFP_ATOMIC); 495 if (!seen) 496 return 0; 497 seen_count = 0; 498 499 ohci = buf->ohci; 500 next = buf->page; 501 size = PAGE_SIZE; 502 503 temp = scnprintf (next, size, "size = %d\n", NUM_INTS); 504 size -= temp; 505 next += temp; 506 507 /* dump a snapshot of the periodic schedule (and load) */ 508 spin_lock_irqsave (&ohci->lock, flags); 509 for (i = 0; i < NUM_INTS; i++) { 510 ed = ohci->periodic[i]; 511 if (!ed) 512 continue; 513 514 temp = scnprintf (next, size, "%2d [%3d]:", i, ohci->load [i]); 515 size -= temp; 516 next += temp; 517 518 do { 519 temp = scnprintf (next, size, " ed%d/%p", 520 ed->interval, ed); 521 size -= temp; 522 next += temp; 523 for (temp = 0; temp < seen_count; temp++) { 524 if (seen [temp] == ed) 525 break; 526 } 527 528 /* show more info the first time around */ 529 if (temp == seen_count) { 530 u32 info = hc32_to_cpu (ohci, ed->hwINFO); 531 struct list_head *entry; 532 unsigned qlen = 0; 533 534 /* qlen measured here in TDs, not urbs */ 535 list_for_each (entry, &ed->td_list) 536 qlen++; 537 538 temp = scnprintf (next, size, 539 " (%cs dev%d ep%d%s-%s qlen %u" 540 " max %d %08x%s%s)", 541 (info & ED_LOWSPEED) ? 'l' : 'f', 542 info & 0x7f, 543 (info >> 7) & 0xf, 544 (info & ED_IN) ? "in" : "out", 545 (info & ED_ISO) ? "iso" : "int", 546 qlen, 547 0x03ff & (info >> 16), 548 info, 549 (info & ED_SKIP) ? " K" : "", 550 (ed->hwHeadP & 551 cpu_to_hc32(ohci, ED_H)) ? 552 " H" : ""); 553 size -= temp; 554 next += temp; 555 556 if (seen_count < DBG_SCHED_LIMIT) 557 seen [seen_count++] = ed; 558 559 ed = ed->ed_next; 560 561 } else { 562 /* we've seen it and what's after */ 563 temp = 0; 564 ed = NULL; 565 } 566 567 } while (ed); 568 569 temp = scnprintf (next, size, "\n"); 570 size -= temp; 571 next += temp; 572 } 573 spin_unlock_irqrestore (&ohci->lock, flags); 574 kfree (seen); 575 576 return PAGE_SIZE - size; 577 } 578 #undef DBG_SCHED_LIMIT 579 580 static ssize_t fill_registers_buffer(struct debug_buffer *buf) 581 { 582 struct usb_hcd *hcd; 583 struct ohci_hcd *ohci; 584 struct ohci_regs __iomem *regs; 585 unsigned long flags; 586 unsigned temp, size; 587 char *next; 588 u32 rdata; 589 590 ohci = buf->ohci; 591 hcd = ohci_to_hcd(ohci); 592 regs = ohci->regs; 593 next = buf->page; 594 size = PAGE_SIZE; 595 596 spin_lock_irqsave (&ohci->lock, flags); 597 598 /* dump driver info, then registers in spec order */ 599 600 ohci_dbg_nosw(ohci, &next, &size, 601 "bus %s, device %s\n" 602 "%s\n" 603 "%s\n", 604 hcd->self.controller->bus->name, 605 dev_name(hcd->self.controller), 606 hcd->product_desc, 607 hcd_name); 608 609 if (!HCD_HW_ACCESSIBLE(hcd)) { 610 size -= scnprintf (next, size, 611 "SUSPENDED (no register access)\n"); 612 goto done; 613 } 614 615 ohci_dump_status(ohci, &next, &size); 616 617 /* hcca */ 618 if (ohci->hcca) 619 ohci_dbg_nosw(ohci, &next, &size, 620 "hcca frame 0x%04x\n", ohci_frame_no(ohci)); 621 622 /* other registers mostly affect frame timings */ 623 rdata = ohci_readl (ohci, ®s->fminterval); 624 temp = scnprintf (next, size, 625 "fmintvl 0x%08x %sFSMPS=0x%04x FI=0x%04x\n", 626 rdata, (rdata >> 31) ? "FIT " : "", 627 (rdata >> 16) & 0xefff, rdata & 0xffff); 628 size -= temp; 629 next += temp; 630 631 rdata = ohci_readl (ohci, ®s->fmremaining); 632 temp = scnprintf (next, size, "fmremaining 0x%08x %sFR=0x%04x\n", 633 rdata, (rdata >> 31) ? "FRT " : "", 634 rdata & 0x3fff); 635 size -= temp; 636 next += temp; 637 638 rdata = ohci_readl (ohci, ®s->periodicstart); 639 temp = scnprintf (next, size, "periodicstart 0x%04x\n", 640 rdata & 0x3fff); 641 size -= temp; 642 next += temp; 643 644 rdata = ohci_readl (ohci, ®s->lsthresh); 645 temp = scnprintf (next, size, "lsthresh 0x%04x\n", 646 rdata & 0x3fff); 647 size -= temp; 648 next += temp; 649 650 temp = scnprintf (next, size, "hub poll timer %s\n", 651 HCD_POLL_RH(ohci_to_hcd(ohci)) ? "ON" : "off"); 652 size -= temp; 653 next += temp; 654 655 /* roothub */ 656 ohci_dump_roothub (ohci, 1, &next, &size); 657 658 done: 659 spin_unlock_irqrestore (&ohci->lock, flags); 660 661 return PAGE_SIZE - size; 662 } 663 664 static struct debug_buffer *alloc_buffer(struct ohci_hcd *ohci, 665 ssize_t (*fill_func)(struct debug_buffer *)) 666 { 667 struct debug_buffer *buf; 668 669 buf = kzalloc(sizeof(struct debug_buffer), GFP_KERNEL); 670 671 if (buf) { 672 buf->ohci = ohci; 673 buf->fill_func = fill_func; 674 mutex_init(&buf->mutex); 675 } 676 677 return buf; 678 } 679 680 static int fill_buffer(struct debug_buffer *buf) 681 { 682 int ret = 0; 683 684 if (!buf->page) 685 buf->page = (char *)get_zeroed_page(GFP_KERNEL); 686 687 if (!buf->page) { 688 ret = -ENOMEM; 689 goto out; 690 } 691 692 ret = buf->fill_func(buf); 693 694 if (ret >= 0) { 695 buf->count = ret; 696 ret = 0; 697 } 698 699 out: 700 return ret; 701 } 702 703 static ssize_t debug_output(struct file *file, char __user *user_buf, 704 size_t len, loff_t *offset) 705 { 706 struct debug_buffer *buf = file->private_data; 707 int ret = 0; 708 709 mutex_lock(&buf->mutex); 710 if (buf->count == 0) { 711 ret = fill_buffer(buf); 712 if (ret != 0) { 713 mutex_unlock(&buf->mutex); 714 goto out; 715 } 716 } 717 mutex_unlock(&buf->mutex); 718 719 ret = simple_read_from_buffer(user_buf, len, offset, 720 buf->page, buf->count); 721 722 out: 723 return ret; 724 725 } 726 727 static int debug_close(struct inode *inode, struct file *file) 728 { 729 struct debug_buffer *buf = file->private_data; 730 731 if (buf) { 732 if (buf->page) 733 free_page((unsigned long)buf->page); 734 kfree(buf); 735 } 736 737 return 0; 738 } 739 static int debug_async_open(struct inode *inode, struct file *file) 740 { 741 file->private_data = alloc_buffer(inode->i_private, fill_async_buffer); 742 743 return file->private_data ? 0 : -ENOMEM; 744 } 745 746 static int debug_periodic_open(struct inode *inode, struct file *file) 747 { 748 file->private_data = alloc_buffer(inode->i_private, 749 fill_periodic_buffer); 750 751 return file->private_data ? 0 : -ENOMEM; 752 } 753 754 static int debug_registers_open(struct inode *inode, struct file *file) 755 { 756 file->private_data = alloc_buffer(inode->i_private, 757 fill_registers_buffer); 758 759 return file->private_data ? 0 : -ENOMEM; 760 } 761 static inline void create_debug_files (struct ohci_hcd *ohci) 762 { 763 struct usb_bus *bus = &ohci_to_hcd(ohci)->self; 764 765 ohci->debug_dir = debugfs_create_dir(bus->bus_name, ohci_debug_root); 766 if (!ohci->debug_dir) 767 goto dir_error; 768 769 ohci->debug_async = debugfs_create_file("async", S_IRUGO, 770 ohci->debug_dir, ohci, 771 &debug_async_fops); 772 if (!ohci->debug_async) 773 goto async_error; 774 775 ohci->debug_periodic = debugfs_create_file("periodic", S_IRUGO, 776 ohci->debug_dir, ohci, 777 &debug_periodic_fops); 778 if (!ohci->debug_periodic) 779 goto periodic_error; 780 781 ohci->debug_registers = debugfs_create_file("registers", S_IRUGO, 782 ohci->debug_dir, ohci, 783 &debug_registers_fops); 784 if (!ohci->debug_registers) 785 goto registers_error; 786 787 ohci_dbg (ohci, "created debug files\n"); 788 return; 789 790 registers_error: 791 debugfs_remove(ohci->debug_periodic); 792 periodic_error: 793 debugfs_remove(ohci->debug_async); 794 async_error: 795 debugfs_remove(ohci->debug_dir); 796 dir_error: 797 ohci->debug_periodic = NULL; 798 ohci->debug_async = NULL; 799 ohci->debug_dir = NULL; 800 } 801 802 static inline void remove_debug_files (struct ohci_hcd *ohci) 803 { 804 debugfs_remove(ohci->debug_registers); 805 debugfs_remove(ohci->debug_periodic); 806 debugfs_remove(ohci->debug_async); 807 debugfs_remove(ohci->debug_dir); 808 } 809 810 /*-------------------------------------------------------------------------*/ 811 812