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