Linux Audio

Check our new training course

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