Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * Copyright (c) 2001-2002 by David Brownell | |
53bd6a60 | 3 | * |
1da177e4 LT |
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 | ||
1c20163d | 21 | #ifdef CONFIG_DYNAMIC_DEBUG |
1da177e4 LT |
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 | */ | |
27 | static void dbg_hcs_params (struct ehci_hcd *ehci, char *label) | |
28 | { | |
083522d7 | 29 | u32 params = ehci_readl(ehci, &ehci->caps->hcs_params); |
1da177e4 LT |
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), | |
6dbd682b | 38 | HCS_PORTROUTED (params) ? "" : " ordered", |
1da177e4 LT |
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)]); | |
53bd6a60 | 51 | sprintf(tmp, "%d ", |
1da177e4 LT |
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 | ||
61 | static inline void dbg_hcs_params (struct ehci_hcd *ehci, char *label) {} | |
62 | ||
63 | #endif | |
64 | ||
1c20163d | 65 | #ifdef CONFIG_DYNAMIC_DEBUG |
1da177e4 LT |
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 | * */ | |
71 | static void dbg_hcc_params (struct ehci_hcd *ehci, char *label) | |
72 | { | |
083522d7 | 73 | u32 params = ehci_readl(ehci, &ehci->caps->hcc_params); |
1da177e4 LT |
74 | |
75 | if (HCC_ISOC_CACHE (params)) { | |
76 | ehci_dbg (ehci, | |
6dbd682b SR |
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" : ""); | |
1da177e4 LT |
82 | } else { |
83 | ehci_dbg (ehci, | |
aa4d8342 | 84 | "%s hcc_params %04x thresh %d uframes %s%s%s%s%s%s%s\n", |
6dbd682b SR |
85 | label, |
86 | params, | |
87 | HCC_ISOC_THRES(params), | |
88 | HCC_PGM_FRAMELISTLEN(params) ? "256/512/1024" : "1024", | |
89 | HCC_CANPARK(params) ? " park" : "", | |
aa4d8342 AD |
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) ? | |
855ef452 | 95 | " 32 periodic list" : ""); |
1da177e4 LT |
96 | } |
97 | } | |
98 | #else | |
99 | ||
100 | static inline void dbg_hcc_params (struct ehci_hcd *ehci, char *label) {} | |
101 | ||
102 | #endif | |
103 | ||
1c20163d | 104 | #ifdef CONFIG_DYNAMIC_DEBUG |
1da177e4 | 105 | |
8234509c | 106 | static void __maybe_unused |
1da177e4 LT |
107 | dbg_qtd (const char *label, struct ehci_hcd *ehci, struct ehci_qtd *qtd) |
108 | { | |
6dbd682b SR |
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])); | |
1da177e4 | 114 | if (qtd->hw_buf [1]) |
6dbd682b SR |
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])); | |
1da177e4 LT |
120 | } |
121 | ||
8234509c | 122 | static void __maybe_unused |
1da177e4 LT |
123 | dbg_qh (const char *label, struct ehci_hcd *ehci, struct ehci_qh *qh) |
124 | { | |
3807e26d AD |
125 | struct ehci_qh_hw *hw = qh->hw; |
126 | ||
1da177e4 | 127 | ehci_dbg (ehci, "%s qh %p n%08x info %x %x qtd %x\n", label, |
3807e26d AD |
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); | |
1da177e4 LT |
130 | } |
131 | ||
8234509c | 132 | static void __maybe_unused |
53bd6a60 | 133 | dbg_itd (const char *label, struct ehci_hcd *ehci, struct ehci_itd *itd) |
1da177e4 LT |
134 | { |
135 | ehci_dbg (ehci, "%s [%d] itd %p, next %08x, urb %p\n", | |
6dbd682b SR |
136 | label, itd->frame, itd, hc32_to_cpu(ehci, itd->hw_next), |
137 | itd->urb); | |
1da177e4 | 138 | ehci_dbg (ehci, |
53bd6a60 | 139 | " trans: %08x %08x %08x %08x %08x %08x %08x %08x\n", |
6dbd682b SR |
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])); | |
1da177e4 | 148 | ehci_dbg (ehci, |
53bd6a60 | 149 | " buf: %08x %08x %08x %08x %08x %08x %08x\n", |
6dbd682b SR |
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])); | |
1da177e4 LT |
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 | ||
8234509c | 163 | static void __maybe_unused |
53bd6a60 | 164 | dbg_sitd (const char *label, struct ehci_hcd *ehci, struct ehci_sitd *sitd) |
1da177e4 LT |
165 | { |
166 | ehci_dbg (ehci, "%s [%d] sitd %p, next %08x, urb %p\n", | |
6dbd682b SR |
167 | label, sitd->frame, sitd, hc32_to_cpu(ehci, sitd->hw_next), |
168 | sitd->urb); | |
1da177e4 | 169 | ehci_dbg (ehci, |
53bd6a60 | 170 | " addr %08x sched %04x result %08x buf %08x %08x\n", |
6dbd682b SR |
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])); | |
1da177e4 LT |
176 | } |
177 | ||
8234509c | 178 | static int __maybe_unused |
1da177e4 LT |
179 | dbg_status_buf (char *buf, unsigned len, const char *label, u32 status) |
180 | { | |
181 | return scnprintf (buf, len, | |
aa4d8342 | 182 | "%s%sstatus %04x%s%s%s%s%s%s%s%s%s%s%s", |
1da177e4 | 183 | label, label [0] ? " " : "", status, |
aa4d8342 | 184 | (status & STS_PPCE_MASK) ? " PPCE" : "", |
1da177e4 LT |
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 | ||
8234509c | 198 | static int __maybe_unused |
1da177e4 LT |
199 | dbg_intr_buf (char *buf, unsigned len, const char *label, u32 enable) |
200 | { | |
201 | return scnprintf (buf, len, | |
aa4d8342 | 202 | "%s%sintrenable %02x%s%s%s%s%s%s%s", |
1da177e4 | 203 | label, label [0] ? " " : "", enable, |
aa4d8342 | 204 | (enable & STS_PPCE_MASK) ? " PPCE" : "", |
1da177e4 LT |
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 | ||
214 | static const char *const fls_strings [] = | |
215 | { "1024", "512", "256", "??" }; | |
216 | ||
217 | static int | |
218 | dbg_command_buf (char *buf, unsigned len, const char *label, u32 command) | |
219 | { | |
220 | return scnprintf (buf, len, | |
aa4d8342 AD |
221 | "%s%scommand %07x %s%s%s%s%s%s=%d ithresh=%d%s%s%s%s " |
222 | "period=%s%s %s", | |
1da177e4 | 223 | label, label [0] ? " " : "", command, |
aa4d8342 AD |
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)", | |
1da177e4 LT |
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 | ||
242 | static int | |
243 | dbg_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, | |
aa4d8342 AD |
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", | |
1da177e4 | 258 | label, label [0] ? " " : "", port, status, |
aa4d8342 AD |
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" : "", | |
1da177e4 LT |
268 | (status & PORT_POWER) ? " POWER" : "", |
269 | (status & PORT_OWNER) ? " OWNER" : "", | |
270 | sig, | |
aa4d8342 | 271 | (status & PORT_LPM) ? " LPM" : "", |
1da177e4 LT |
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" : "", | |
6dbd682b | 280 | (status & PORT_CONNECT) ? " CONNECT" : ""); |
1da177e4 LT |
281 | } |
282 | ||
283 | #else | |
8234509c | 284 | static inline void __maybe_unused |
1da177e4 LT |
285 | dbg_qh (char *label, struct ehci_hcd *ehci, struct ehci_qh *qh) |
286 | {} | |
287 | ||
8234509c | 288 | static inline int __maybe_unused |
1da177e4 LT |
289 | dbg_status_buf (char *buf, unsigned len, const char *label, u32 status) |
290 | { return 0; } | |
291 | ||
8234509c | 292 | static inline int __maybe_unused |
1da177e4 LT |
293 | dbg_command_buf (char *buf, unsigned len, const char *label, u32 command) |
294 | { return 0; } | |
295 | ||
8234509c | 296 | static inline int __maybe_unused |
1da177e4 LT |
297 | dbg_intr_buf (char *buf, unsigned len, const char *label, u32 enable) |
298 | { return 0; } | |
299 | ||
8234509c | 300 | static inline int __maybe_unused |
1da177e4 LT |
301 | dbg_port_buf (char *buf, unsigned len, const char *label, int port, u32 status) |
302 | { return 0; } | |
303 | ||
1c20163d | 304 | #endif /* CONFIG_DYNAMIC_DEBUG */ |
1da177e4 LT |
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 | ||
329 | static inline void create_debug_files (struct ehci_hcd *bus) { } | |
330 | static inline void remove_debug_files (struct ehci_hcd *bus) { } | |
331 | ||
332 | #else | |
333 | ||
694cc208 TJ |
334 | /* troubleshooting help: expose state in debugfs */ |
335 | ||
336 | static int debug_async_open(struct inode *, struct file *); | |
d0ce5c6b | 337 | static int debug_bandwidth_open(struct inode *, struct file *); |
694cc208 TJ |
338 | static int debug_periodic_open(struct inode *, struct file *); |
339 | static int debug_registers_open(struct inode *, struct file *); | |
aa4d8342 | 340 | |
694cc208 TJ |
341 | static ssize_t debug_output(struct file*, char __user*, size_t, loff_t*); |
342 | static int debug_close(struct inode *, struct file *); | |
343 | ||
344 | static const struct file_operations debug_async_fops = { | |
345 | .owner = THIS_MODULE, | |
346 | .open = debug_async_open, | |
347 | .read = debug_output, | |
348 | .release = debug_close, | |
6038f373 | 349 | .llseek = default_llseek, |
694cc208 | 350 | }; |
d0ce5c6b AS |
351 | static 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 | }; | |
694cc208 TJ |
358 | static const struct file_operations debug_periodic_fops = { |
359 | .owner = THIS_MODULE, | |
360 | .open = debug_periodic_open, | |
361 | .read = debug_output, | |
362 | .release = debug_close, | |
6038f373 | 363 | .llseek = default_llseek, |
694cc208 TJ |
364 | }; |
365 | static const struct file_operations debug_registers_fops = { | |
366 | .owner = THIS_MODULE, | |
367 | .open = debug_registers_open, | |
368 | .read = debug_output, | |
369 | .release = debug_close, | |
6038f373 | 370 | .llseek = default_llseek, |
694cc208 TJ |
371 | }; |
372 | ||
373 | static struct dentry *ehci_debug_root; | |
374 | ||
375 | struct 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 */ | |
3c04e20e ML |
380 | char *output_buf; |
381 | size_t alloc_size; | |
694cc208 | 382 | }; |
1da177e4 LT |
383 | |
384 | #define speed_char(info1) ({ char tmp; \ | |
385 | switch (info1 & (3 << 12)) { \ | |
4c53de72 AS |
386 | case QH_FULL_SPEED: tmp = 'f'; break; \ |
387 | case QH_LOW_SPEED: tmp = 'l'; break; \ | |
388 | case QH_HIGH_SPEED: tmp = 'h'; break; \ | |
1da177e4 | 389 | default: tmp = '?'; break; \ |
2b84f92b | 390 | } tmp; }) |
1da177e4 | 391 | |
6dbd682b | 392 | static inline char token_mark(struct ehci_hcd *ehci, __hc32 token) |
1da177e4 | 393 | { |
6dbd682b SR |
394 | __u32 v = hc32_to_cpu(ehci, token); |
395 | ||
1da177e4 LT |
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 | ||
406 | static 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; | |
fd05e720 | 421 | __le32 list_end = EHCI_LIST_END(ehci); |
3807e26d | 422 | struct ehci_qh_hw *hw = qh->hw; |
1da177e4 | 423 | |
3807e26d | 424 | if (hw->hw_qtd_next == list_end) /* NEC does this */ |
1da177e4 LT |
425 | mark = '@'; |
426 | else | |
3807e26d | 427 | mark = token_mark(ehci, hw->hw_token); |
1da177e4 | 428 | if (mark == '/') { /* qh_alt_next controls qh advance? */ |
3807e26d AD |
429 | if ((hw->hw_alt_next & QTD_MASK(ehci)) |
430 | == ehci->async->hw->hw_alt_next) | |
1da177e4 | 431 | mark = '#'; /* blocked */ |
3807e26d | 432 | else if (hw->hw_alt_next == list_end) |
1da177e4 LT |
433 | mark = '.'; /* use hw_qtd_next */ |
434 | /* else alt_next points to some other qtd */ | |
435 | } | |
3807e26d AD |
436 | scratch = hc32_to_cpup(ehci, &hw->hw_info1); |
437 | hw_curr = (mark == '*') ? hc32_to_cpup(ehci, &hw->hw_current) : 0; | |
1da177e4 | 438 | temp = scnprintf (next, size, |
8ee10d62 AS |
439 | "qh/%p dev%d %cs ep%d %08x %08x (%08x%c %s nak%d)" |
440 | " [cur %08x next %08x buf[0] %08x]", | |
1da177e4 LT |
441 | qh, scratch & 0x007f, |
442 | speed_char (scratch), | |
443 | (scratch >> 8) & 0x000f, | |
3807e26d AD |
444 | scratch, hc32_to_cpup(ehci, &hw->hw_info2), |
445 | hc32_to_cpup(ehci, &hw->hw_token), mark, | |
446 | (cpu_to_hc32(ehci, QTD_TOGGLE) & hw->hw_token) | |
1da177e4 | 447 | ? "data1" : "data0", |
8ee10d62 AS |
448 | (hc32_to_cpup(ehci, &hw->hw_alt_next) >> 1) & 0x0f, |
449 | hc32_to_cpup(ehci, &hw->hw_current), | |
450 | hc32_to_cpup(ehci, &hw->hw_qtd_next), | |
451 | hc32_to_cpup(ehci, &hw->hw_buf[0])); | |
1da177e4 LT |
452 | size -= temp; |
453 | next += temp; | |
454 | ||
455 | /* hc may be modifying the list as we read it ... */ | |
456 | list_for_each (entry, &qh->qtd_list) { | |
457 | td = list_entry (entry, struct ehci_qtd, qtd_list); | |
6dbd682b | 458 | scratch = hc32_to_cpup(ehci, &td->hw_token); |
1da177e4 LT |
459 | mark = ' '; |
460 | if (hw_curr == td->qtd_dma) | |
461 | mark = '*'; | |
3807e26d | 462 | else if (hw->hw_qtd_next == cpu_to_hc32(ehci, td->qtd_dma)) |
1da177e4 LT |
463 | mark = '+'; |
464 | else if (QTD_LENGTH (scratch)) { | |
3807e26d | 465 | if (td->hw_alt_next == ehci->async->hw->hw_alt_next) |
1da177e4 | 466 | mark = '#'; |
6dbd682b | 467 | else if (td->hw_alt_next != list_end) |
1da177e4 LT |
468 | mark = '/'; |
469 | } | |
470 | temp = snprintf (next, size, | |
8ee10d62 AS |
471 | "\n\t%p%c%s len=%d %08x urb %p" |
472 | " [td %08x buf[0] %08x]", | |
1da177e4 LT |
473 | td, mark, ({ char *tmp; |
474 | switch ((scratch>>8)&0x03) { | |
475 | case 0: tmp = "out"; break; | |
476 | case 1: tmp = "in"; break; | |
477 | case 2: tmp = "setup"; break; | |
478 | default: tmp = "?"; break; | |
479 | } tmp;}), | |
480 | (scratch >> 16) & 0x7fff, | |
481 | scratch, | |
8ee10d62 AS |
482 | td->urb, |
483 | (u32) td->qtd_dma, | |
484 | hc32_to_cpup(ehci, &td->hw_buf[0])); | |
e64a5219 | 485 | if (size < temp) |
1da177e4 LT |
486 | temp = size; |
487 | size -= temp; | |
488 | next += temp; | |
489 | if (temp == size) | |
490 | goto done; | |
491 | } | |
492 | ||
493 | temp = snprintf (next, size, "\n"); | |
e64a5219 | 494 | if (size < temp) |
1da177e4 LT |
495 | temp = size; |
496 | size -= temp; | |
497 | next += temp; | |
498 | ||
499 | done: | |
500 | *sizep = size; | |
501 | *nextp = next; | |
502 | } | |
503 | ||
694cc208 | 504 | static ssize_t fill_async_buffer(struct debug_buffer *buf) |
1da177e4 | 505 | { |
1da177e4 LT |
506 | struct usb_hcd *hcd; |
507 | struct ehci_hcd *ehci; | |
508 | unsigned long flags; | |
509 | unsigned temp, size; | |
510 | char *next; | |
511 | struct ehci_qh *qh; | |
512 | ||
694cc208 | 513 | hcd = bus_to_hcd(buf->bus); |
1da177e4 | 514 | ehci = hcd_to_ehci (hcd); |
3c04e20e ML |
515 | next = buf->output_buf; |
516 | size = buf->alloc_size; | |
1da177e4 | 517 | |
694cc208 TJ |
518 | *next = 0; |
519 | ||
1da177e4 LT |
520 | /* dumps a snapshot of the async schedule. |
521 | * usually empty except for long-term bulk reads, or head. | |
522 | * one QH per line, and TDs we know about | |
523 | */ | |
524 | spin_lock_irqsave (&ehci->lock, flags); | |
525 | for (qh = ehci->async->qh_next.qh; size > 0 && qh; qh = qh->qh_next.qh) | |
526 | qh_lines (ehci, qh, &next, &size); | |
6e018751 | 527 | if (!list_empty(&ehci->async_unlink) && size > 0) { |
99ac5b1e | 528 | temp = scnprintf(next, size, "\nunlink =\n"); |
1da177e4 LT |
529 | size -= temp; |
530 | next += temp; | |
531 | ||
6e018751 AS |
532 | list_for_each_entry(qh, &ehci->async_unlink, unlink_node) { |
533 | if (size <= 0) | |
534 | break; | |
535 | qh_lines(ehci, qh, &next, &size); | |
536 | } | |
1da177e4 LT |
537 | } |
538 | spin_unlock_irqrestore (&ehci->lock, flags); | |
539 | ||
3c04e20e | 540 | return strlen(buf->output_buf); |
1da177e4 | 541 | } |
1da177e4 | 542 | |
d0ce5c6b AS |
543 | static ssize_t fill_bandwidth_buffer(struct debug_buffer *buf) |
544 | { | |
545 | struct ehci_hcd *ehci; | |
b35c5009 AS |
546 | struct ehci_tt *tt; |
547 | struct ehci_per_sched *ps; | |
d0ce5c6b AS |
548 | unsigned temp, size; |
549 | char *next; | |
550 | unsigned i; | |
551 | u8 *bw; | |
b35c5009 AS |
552 | u16 *bf; |
553 | u8 budget[EHCI_BANDWIDTH_SIZE]; | |
d0ce5c6b AS |
554 | |
555 | ehci = hcd_to_ehci(bus_to_hcd(buf->bus)); | |
556 | next = buf->output_buf; | |
557 | size = buf->alloc_size; | |
558 | ||
559 | *next = 0; | |
560 | ||
561 | spin_lock_irq(&ehci->lock); | |
562 | ||
563 | /* Dump the HS bandwidth table */ | |
564 | temp = scnprintf(next, size, | |
565 | "HS bandwidth allocation (us per microframe)\n"); | |
566 | size -= temp; | |
567 | next += temp; | |
568 | for (i = 0; i < EHCI_BANDWIDTH_SIZE; i += 8) { | |
569 | bw = &ehci->bandwidth[i]; | |
570 | temp = scnprintf(next, size, | |
571 | "%2u: %4u%4u%4u%4u%4u%4u%4u%4u\n", | |
572 | i, bw[0], bw[1], bw[2], bw[3], | |
573 | bw[4], bw[5], bw[6], bw[7]); | |
574 | size -= temp; | |
575 | next += temp; | |
576 | } | |
b35c5009 AS |
577 | |
578 | /* Dump all the FS/LS tables */ | |
579 | list_for_each_entry(tt, &ehci->tt_list, tt_list) { | |
580 | temp = scnprintf(next, size, | |
581 | "\nTT %s port %d FS/LS bandwidth allocation (us per frame)\n", | |
582 | dev_name(&tt->usb_tt->hub->dev), | |
583 | tt->tt_port + !!tt->usb_tt->multi); | |
584 | size -= temp; | |
585 | next += temp; | |
586 | ||
587 | bf = tt->bandwidth; | |
588 | temp = scnprintf(next, size, | |
589 | " %5u%5u%5u%5u%5u%5u%5u%5u\n", | |
590 | bf[0], bf[1], bf[2], bf[3], | |
591 | bf[4], bf[5], bf[6], bf[7]); | |
592 | size -= temp; | |
593 | next += temp; | |
594 | ||
595 | temp = scnprintf(next, size, | |
596 | "FS/LS budget (us per microframe)\n"); | |
597 | size -= temp; | |
598 | next += temp; | |
599 | compute_tt_budget(budget, tt); | |
600 | for (i = 0; i < EHCI_BANDWIDTH_SIZE; i += 8) { | |
601 | bw = &budget[i]; | |
602 | temp = scnprintf(next, size, | |
603 | "%2u: %4u%4u%4u%4u%4u%4u%4u%4u\n", | |
604 | i, bw[0], bw[1], bw[2], bw[3], | |
605 | bw[4], bw[5], bw[6], bw[7]); | |
606 | size -= temp; | |
607 | next += temp; | |
608 | } | |
609 | list_for_each_entry(ps, &tt->ps_list, ps_list) { | |
610 | temp = scnprintf(next, size, | |
611 | "%s ep %02x: %4u @ %2u.%u+%u mask %04x\n", | |
612 | dev_name(&ps->udev->dev), | |
613 | ps->ep->desc.bEndpointAddress, | |
614 | ps->tt_usecs, | |
615 | ps->bw_phase, ps->phase_uf, | |
616 | ps->bw_period, ps->cs_mask); | |
617 | size -= temp; | |
618 | next += temp; | |
619 | } | |
620 | } | |
d0ce5c6b AS |
621 | spin_unlock_irq(&ehci->lock); |
622 | ||
623 | return next - buf->output_buf; | |
624 | } | |
625 | ||
1da177e4 | 626 | #define DBG_SCHED_LIMIT 64 |
694cc208 | 627 | static ssize_t fill_periodic_buffer(struct debug_buffer *buf) |
1da177e4 | 628 | { |
1da177e4 LT |
629 | struct usb_hcd *hcd; |
630 | struct ehci_hcd *ehci; | |
631 | unsigned long flags; | |
632 | union ehci_shadow p, *seen; | |
633 | unsigned temp, size, seen_count; | |
634 | char *next; | |
635 | unsigned i; | |
6dbd682b | 636 | __hc32 tag; |
1da177e4 | 637 | |
911fdb6e GKH |
638 | seen = kmalloc(DBG_SCHED_LIMIT * sizeof *seen, GFP_ATOMIC); |
639 | if (!seen) | |
1da177e4 LT |
640 | return 0; |
641 | seen_count = 0; | |
642 | ||
694cc208 | 643 | hcd = bus_to_hcd(buf->bus); |
1da177e4 | 644 | ehci = hcd_to_ehci (hcd); |
3c04e20e ML |
645 | next = buf->output_buf; |
646 | size = buf->alloc_size; | |
1da177e4 LT |
647 | |
648 | temp = scnprintf (next, size, "size = %d\n", ehci->periodic_size); | |
649 | size -= temp; | |
650 | next += temp; | |
651 | ||
652 | /* dump a snapshot of the periodic schedule. | |
653 | * iso changes, interrupt usually doesn't. | |
654 | */ | |
655 | spin_lock_irqsave (&ehci->lock, flags); | |
656 | for (i = 0; i < ehci->periodic_size; i++) { | |
657 | p = ehci->pshadow [i]; | |
658 | if (likely (!p.ptr)) | |
659 | continue; | |
6dbd682b | 660 | tag = Q_NEXT_TYPE(ehci, ehci->periodic [i]); |
1da177e4 LT |
661 | |
662 | temp = scnprintf (next, size, "%4d: ", i); | |
663 | size -= temp; | |
664 | next += temp; | |
665 | ||
666 | do { | |
3807e26d AD |
667 | struct ehci_qh_hw *hw; |
668 | ||
6dbd682b | 669 | switch (hc32_to_cpu(ehci, tag)) { |
1da177e4 | 670 | case Q_TYPE_QH: |
3807e26d | 671 | hw = p.qh->hw; |
1da177e4 | 672 | temp = scnprintf (next, size, " qh%d-%04x/%p", |
ffa0248e | 673 | p.qh->ps.period, |
6dbd682b | 674 | hc32_to_cpup(ehci, |
3807e26d | 675 | &hw->hw_info2) |
1da177e4 | 676 | /* uframe masks */ |
7dedacf4 | 677 | & (QH_CMASK | QH_SMASK), |
1da177e4 LT |
678 | p.qh); |
679 | size -= temp; | |
680 | next += temp; | |
681 | /* don't repeat what follows this qh */ | |
682 | for (temp = 0; temp < seen_count; temp++) { | |
683 | if (seen [temp].ptr != p.ptr) | |
684 | continue; | |
3c4bb71f | 685 | if (p.qh->qh_next.ptr) { |
1da177e4 LT |
686 | temp = scnprintf (next, size, |
687 | " ..."); | |
3c4bb71f ML |
688 | size -= temp; |
689 | next += temp; | |
690 | } | |
1da177e4 LT |
691 | break; |
692 | } | |
693 | /* show more info the first time around */ | |
3c4bb71f | 694 | if (temp == seen_count) { |
6dbd682b | 695 | u32 scratch = hc32_to_cpup(ehci, |
3807e26d | 696 | &hw->hw_info1); |
1da177e4 LT |
697 | struct ehci_qtd *qtd; |
698 | char *type = ""; | |
699 | ||
700 | /* count tds, get ep direction */ | |
701 | temp = 0; | |
702 | list_for_each_entry (qtd, | |
703 | &p.qh->qtd_list, | |
704 | qtd_list) { | |
705 | temp++; | |
6dbd682b SR |
706 | switch (0x03 & (hc32_to_cpu( |
707 | ehci, | |
1da177e4 LT |
708 | qtd->hw_token) >> 8)) { |
709 | case 0: type = "out"; continue; | |
710 | case 1: type = "in"; continue; | |
711 | } | |
712 | } | |
713 | ||
714 | temp = scnprintf (next, size, | |
715 | " (%c%d ep%d%s " | |
716 | "[%d/%d] q%d p%d)", | |
717 | speed_char (scratch), | |
718 | scratch & 0x007f, | |
719 | (scratch >> 8) & 0x000f, type, | |
ffa0248e AS |
720 | p.qh->ps.usecs, |
721 | p.qh->ps.c_usecs, | |
1da177e4 LT |
722 | temp, |
723 | 0x7ff & (scratch >> 16)); | |
724 | ||
725 | if (seen_count < DBG_SCHED_LIMIT) | |
726 | seen [seen_count++].qh = p.qh; | |
727 | } else | |
728 | temp = 0; | |
17dcfc9b AS |
729 | tag = Q_NEXT_TYPE(ehci, hw->hw_next); |
730 | p = p.qh->qh_next; | |
1da177e4 LT |
731 | break; |
732 | case Q_TYPE_FSTN: | |
733 | temp = scnprintf (next, size, | |
734 | " fstn-%8x/%p", p.fstn->hw_prev, | |
735 | p.fstn); | |
6dbd682b | 736 | tag = Q_NEXT_TYPE(ehci, p.fstn->hw_next); |
1da177e4 LT |
737 | p = p.fstn->fstn_next; |
738 | break; | |
739 | case Q_TYPE_ITD: | |
740 | temp = scnprintf (next, size, | |
741 | " itd/%p", p.itd); | |
6dbd682b | 742 | tag = Q_NEXT_TYPE(ehci, p.itd->hw_next); |
1da177e4 LT |
743 | p = p.itd->itd_next; |
744 | break; | |
745 | case Q_TYPE_SITD: | |
746 | temp = scnprintf (next, size, | |
747 | " sitd%d-%04x/%p", | |
ffa0248e | 748 | p.sitd->stream->ps.period, |
6dbd682b | 749 | hc32_to_cpup(ehci, &p.sitd->hw_uframe) |
1da177e4 LT |
750 | & 0x0000ffff, |
751 | p.sitd); | |
6dbd682b | 752 | tag = Q_NEXT_TYPE(ehci, p.sitd->hw_next); |
1da177e4 LT |
753 | p = p.sitd->sitd_next; |
754 | break; | |
755 | } | |
756 | size -= temp; | |
757 | next += temp; | |
758 | } while (p.ptr); | |
759 | ||
760 | temp = scnprintf (next, size, "\n"); | |
761 | size -= temp; | |
762 | next += temp; | |
763 | } | |
764 | spin_unlock_irqrestore (&ehci->lock, flags); | |
765 | kfree (seen); | |
766 | ||
3c04e20e | 767 | return buf->alloc_size - size; |
1da177e4 | 768 | } |
1da177e4 LT |
769 | #undef DBG_SCHED_LIMIT |
770 | ||
e8799906 AS |
771 | static const char *rh_state_string(struct ehci_hcd *ehci) |
772 | { | |
773 | switch (ehci->rh_state) { | |
774 | case EHCI_RH_HALTED: | |
775 | return "halted"; | |
776 | case EHCI_RH_SUSPENDED: | |
777 | return "suspended"; | |
778 | case EHCI_RH_RUNNING: | |
779 | return "running"; | |
c0c53dbc AS |
780 | case EHCI_RH_STOPPING: |
781 | return "stopping"; | |
e8799906 AS |
782 | } |
783 | return "?"; | |
784 | } | |
785 | ||
694cc208 | 786 | static ssize_t fill_registers_buffer(struct debug_buffer *buf) |
1da177e4 | 787 | { |
1da177e4 LT |
788 | struct usb_hcd *hcd; |
789 | struct ehci_hcd *ehci; | |
790 | unsigned long flags; | |
791 | unsigned temp, size, i; | |
792 | char *next, scratch [80]; | |
793 | static char fmt [] = "%*s\n"; | |
794 | static char label [] = ""; | |
795 | ||
694cc208 | 796 | hcd = bus_to_hcd(buf->bus); |
1da177e4 | 797 | ehci = hcd_to_ehci (hcd); |
3c04e20e ML |
798 | next = buf->output_buf; |
799 | size = buf->alloc_size; | |
1da177e4 LT |
800 | |
801 | spin_lock_irqsave (&ehci->lock, flags); | |
802 | ||
541c7d43 | 803 | if (!HCD_HW_ACCESSIBLE(hcd)) { |
1da177e4 | 804 | size = scnprintf (next, size, |
2b70f073 | 805 | "bus %s, device %s\n" |
d49d4317 | 806 | "%s\n" |
1da177e4 LT |
807 | "SUSPENDED (no register access)\n", |
808 | hcd->self.controller->bus->name, | |
7071a3ce | 809 | dev_name(hcd->self.controller), |
d49d4317 | 810 | hcd->product_desc); |
1da177e4 LT |
811 | goto done; |
812 | } | |
813 | ||
814 | /* Capability Registers */ | |
c430131a | 815 | i = HC_VERSION(ehci, ehci_readl(ehci, &ehci->caps->hc_capbase)); |
1da177e4 | 816 | temp = scnprintf (next, size, |
2b70f073 | 817 | "bus %s, device %s\n" |
d49d4317 | 818 | "%s\n" |
e8799906 | 819 | "EHCI %x.%02x, rh state %s\n", |
1da177e4 | 820 | hcd->self.controller->bus->name, |
7071a3ce | 821 | dev_name(hcd->self.controller), |
d49d4317 | 822 | hcd->product_desc, |
e8799906 | 823 | i >> 8, i & 0x0ff, rh_state_string(ehci)); |
1da177e4 LT |
824 | size -= temp; |
825 | next += temp; | |
826 | ||
d49d4317 DB |
827 | #ifdef CONFIG_PCI |
828 | /* EHCI 0.96 and later may have "extended capabilities" */ | |
e10e6f43 | 829 | if (dev_is_pci(hcd->self.controller)) { |
d49d4317 DB |
830 | struct pci_dev *pdev; |
831 | u32 offset, cap, cap2; | |
832 | unsigned count = 256/4; | |
833 | ||
834 | pdev = to_pci_dev(ehci_to_hcd(ehci)->self.controller); | |
6dbd682b SR |
835 | offset = HCC_EXT_CAPS(ehci_readl(ehci, |
836 | &ehci->caps->hcc_params)); | |
d49d4317 DB |
837 | while (offset && count--) { |
838 | pci_read_config_dword (pdev, offset, &cap); | |
839 | switch (cap & 0xff) { | |
840 | case 1: | |
841 | temp = scnprintf (next, size, | |
842 | "ownership %08x%s%s\n", cap, | |
843 | (cap & (1 << 24)) ? " linux" : "", | |
844 | (cap & (1 << 16)) ? " firmware" : ""); | |
845 | size -= temp; | |
846 | next += temp; | |
847 | ||
848 | offset += 4; | |
849 | pci_read_config_dword (pdev, offset, &cap2); | |
850 | temp = scnprintf (next, size, | |
851 | "SMI sts/enable 0x%08x\n", cap2); | |
852 | size -= temp; | |
853 | next += temp; | |
854 | break; | |
855 | case 0: /* illegal reserved capability */ | |
856 | cap = 0; | |
857 | /* FALLTHROUGH */ | |
858 | default: /* unknown */ | |
859 | break; | |
860 | } | |
861 | temp = (cap >> 8) & 0xff; | |
862 | } | |
863 | } | |
864 | #endif | |
865 | ||
1da177e4 | 866 | // FIXME interpret both types of params |
083522d7 | 867 | i = ehci_readl(ehci, &ehci->caps->hcs_params); |
1da177e4 LT |
868 | temp = scnprintf (next, size, "structural params 0x%08x\n", i); |
869 | size -= temp; | |
870 | next += temp; | |
871 | ||
083522d7 | 872 | i = ehci_readl(ehci, &ehci->caps->hcc_params); |
1da177e4 LT |
873 | temp = scnprintf (next, size, "capability params 0x%08x\n", i); |
874 | size -= temp; | |
875 | next += temp; | |
876 | ||
877 | /* Operational Registers */ | |
878 | temp = dbg_status_buf (scratch, sizeof scratch, label, | |
083522d7 | 879 | ehci_readl(ehci, &ehci->regs->status)); |
1da177e4 LT |
880 | temp = scnprintf (next, size, fmt, temp, scratch); |
881 | size -= temp; | |
882 | next += temp; | |
883 | ||
884 | temp = dbg_command_buf (scratch, sizeof scratch, label, | |
083522d7 | 885 | ehci_readl(ehci, &ehci->regs->command)); |
1da177e4 LT |
886 | temp = scnprintf (next, size, fmt, temp, scratch); |
887 | size -= temp; | |
888 | next += temp; | |
889 | ||
890 | temp = dbg_intr_buf (scratch, sizeof scratch, label, | |
083522d7 | 891 | ehci_readl(ehci, &ehci->regs->intr_enable)); |
1da177e4 LT |
892 | temp = scnprintf (next, size, fmt, temp, scratch); |
893 | size -= temp; | |
894 | next += temp; | |
895 | ||
896 | temp = scnprintf (next, size, "uframe %04x\n", | |
68aa95d5 | 897 | ehci_read_frame_index(ehci)); |
1da177e4 LT |
898 | size -= temp; |
899 | next += temp; | |
900 | ||
d49d4317 DB |
901 | for (i = 1; i <= HCS_N_PORTS (ehci->hcs_params); i++) { |
902 | temp = dbg_port_buf (scratch, sizeof scratch, label, i, | |
6dbd682b SR |
903 | ehci_readl(ehci, |
904 | &ehci->regs->port_status[i - 1])); | |
1da177e4 LT |
905 | temp = scnprintf (next, size, fmt, temp, scratch); |
906 | size -= temp; | |
907 | next += temp; | |
d49d4317 DB |
908 | if (i == HCS_DEBUG_PORT(ehci->hcs_params) && ehci->debug) { |
909 | temp = scnprintf (next, size, | |
910 | " debug control %08x\n", | |
6dbd682b SR |
911 | ehci_readl(ehci, |
912 | &ehci->debug->control)); | |
d49d4317 DB |
913 | size -= temp; |
914 | next += temp; | |
915 | } | |
1da177e4 LT |
916 | } |
917 | ||
6e018751 | 918 | if (!list_empty(&ehci->async_unlink)) { |
99ac5b1e | 919 | temp = scnprintf(next, size, "async unlink qh %p\n", |
6e018751 AS |
920 | list_first_entry(&ehci->async_unlink, |
921 | struct ehci_qh, unlink_node)); | |
1da177e4 LT |
922 | size -= temp; |
923 | next += temp; | |
924 | } | |
925 | ||
926 | #ifdef EHCI_STATS | |
927 | temp = scnprintf (next, size, | |
99ac5b1e AS |
928 | "irq normal %ld err %ld iaa %ld (lost %ld)\n", |
929 | ehci->stats.normal, ehci->stats.error, ehci->stats.iaa, | |
1da177e4 LT |
930 | ehci->stats.lost_iaa); |
931 | size -= temp; | |
932 | next += temp; | |
933 | ||
934 | temp = scnprintf (next, size, "complete %ld unlink %ld\n", | |
935 | ehci->stats.complete, ehci->stats.unlink); | |
936 | size -= temp; | |
937 | next += temp; | |
938 | #endif | |
939 | ||
940 | done: | |
941 | spin_unlock_irqrestore (&ehci->lock, flags); | |
942 | ||
3c04e20e | 943 | return buf->alloc_size - size; |
1da177e4 | 944 | } |
1da177e4 | 945 | |
694cc208 TJ |
946 | static struct debug_buffer *alloc_buffer(struct usb_bus *bus, |
947 | ssize_t (*fill_func)(struct debug_buffer *)) | |
1da177e4 | 948 | { |
694cc208 TJ |
949 | struct debug_buffer *buf; |
950 | ||
951 | buf = kzalloc(sizeof(struct debug_buffer), GFP_KERNEL); | |
1da177e4 | 952 | |
694cc208 TJ |
953 | if (buf) { |
954 | buf->bus = bus; | |
955 | buf->fill_func = fill_func; | |
956 | mutex_init(&buf->mutex); | |
3c04e20e | 957 | buf->alloc_size = PAGE_SIZE; |
694cc208 TJ |
958 | } |
959 | ||
960 | return buf; | |
1da177e4 LT |
961 | } |
962 | ||
694cc208 | 963 | static int fill_buffer(struct debug_buffer *buf) |
1da177e4 | 964 | { |
694cc208 TJ |
965 | int ret = 0; |
966 | ||
3c04e20e | 967 | if (!buf->output_buf) |
73f35c60 | 968 | buf->output_buf = vmalloc(buf->alloc_size); |
694cc208 | 969 | |
3c04e20e | 970 | if (!buf->output_buf) { |
694cc208 TJ |
971 | ret = -ENOMEM; |
972 | goto out; | |
973 | } | |
974 | ||
975 | ret = buf->fill_func(buf); | |
1da177e4 | 976 | |
694cc208 TJ |
977 | if (ret >= 0) { |
978 | buf->count = ret; | |
979 | ret = 0; | |
980 | } | |
981 | ||
982 | out: | |
983 | return ret; | |
1da177e4 LT |
984 | } |
985 | ||
694cc208 TJ |
986 | static ssize_t debug_output(struct file *file, char __user *user_buf, |
987 | size_t len, loff_t *offset) | |
988 | { | |
989 | struct debug_buffer *buf = file->private_data; | |
990 | int ret = 0; | |
991 | ||
992 | mutex_lock(&buf->mutex); | |
993 | if (buf->count == 0) { | |
994 | ret = fill_buffer(buf); | |
995 | if (ret != 0) { | |
996 | mutex_unlock(&buf->mutex); | |
997 | goto out; | |
998 | } | |
999 | } | |
1000 | mutex_unlock(&buf->mutex); | |
1001 | ||
1002 | ret = simple_read_from_buffer(user_buf, len, offset, | |
3c04e20e | 1003 | buf->output_buf, buf->count); |
694cc208 TJ |
1004 | |
1005 | out: | |
1006 | return ret; | |
1007 | ||
1008 | } | |
1009 | ||
1010 | static int debug_close(struct inode *inode, struct file *file) | |
1011 | { | |
1012 | struct debug_buffer *buf = file->private_data; | |
1da177e4 | 1013 | |
694cc208 | 1014 | if (buf) { |
f8086a07 | 1015 | vfree(buf->output_buf); |
694cc208 TJ |
1016 | kfree(buf); |
1017 | } | |
1018 | ||
1019 | return 0; | |
1020 | } | |
d0ce5c6b | 1021 | |
694cc208 TJ |
1022 | static int debug_async_open(struct inode *inode, struct file *file) |
1023 | { | |
1024 | file->private_data = alloc_buffer(inode->i_private, fill_async_buffer); | |
1025 | ||
1026 | return file->private_data ? 0 : -ENOMEM; | |
1027 | } | |
1028 | ||
d0ce5c6b AS |
1029 | static int debug_bandwidth_open(struct inode *inode, struct file *file) |
1030 | { | |
1031 | file->private_data = alloc_buffer(inode->i_private, | |
1032 | fill_bandwidth_buffer); | |
1033 | ||
1034 | return file->private_data ? 0 : -ENOMEM; | |
1035 | } | |
1036 | ||
694cc208 TJ |
1037 | static int debug_periodic_open(struct inode *inode, struct file *file) |
1038 | { | |
3c04e20e ML |
1039 | struct debug_buffer *buf; |
1040 | buf = alloc_buffer(inode->i_private, fill_periodic_buffer); | |
1041 | if (!buf) | |
1042 | return -ENOMEM; | |
694cc208 | 1043 | |
3c04e20e ML |
1044 | buf->alloc_size = (sizeof(void *) == 4 ? 6 : 8)*PAGE_SIZE; |
1045 | file->private_data = buf; | |
1046 | return 0; | |
694cc208 TJ |
1047 | } |
1048 | ||
1049 | static int debug_registers_open(struct inode *inode, struct file *file) | |
1050 | { | |
1051 | file->private_data = alloc_buffer(inode->i_private, | |
1052 | fill_registers_buffer); | |
1053 | ||
1054 | return file->private_data ? 0 : -ENOMEM; | |
1055 | } | |
1056 | ||
1057 | static inline void create_debug_files (struct ehci_hcd *ehci) | |
1058 | { | |
1059 | struct usb_bus *bus = &ehci_to_hcd(ehci)->self; | |
1060 | ||
1061 | ehci->debug_dir = debugfs_create_dir(bus->bus_name, ehci_debug_root); | |
1062 | if (!ehci->debug_dir) | |
185c9bcf ML |
1063 | return; |
1064 | ||
1065 | if (!debugfs_create_file("async", S_IRUGO, ehci->debug_dir, bus, | |
1066 | &debug_async_fops)) | |
1067 | goto file_error; | |
1068 | ||
d0ce5c6b AS |
1069 | if (!debugfs_create_file("bandwidth", S_IRUGO, ehci->debug_dir, bus, |
1070 | &debug_bandwidth_fops)) | |
1071 | goto file_error; | |
1072 | ||
185c9bcf ML |
1073 | if (!debugfs_create_file("periodic", S_IRUGO, ehci->debug_dir, bus, |
1074 | &debug_periodic_fops)) | |
1075 | goto file_error; | |
1076 | ||
1077 | if (!debugfs_create_file("registers", S_IRUGO, ehci->debug_dir, bus, | |
1078 | &debug_registers_fops)) | |
1079 | goto file_error; | |
1080 | ||
694cc208 TJ |
1081 | return; |
1082 | ||
185c9bcf ML |
1083 | file_error: |
1084 | debugfs_remove_recursive(ehci->debug_dir); | |
694cc208 TJ |
1085 | } |
1086 | ||
1087 | static inline void remove_debug_files (struct ehci_hcd *ehci) | |
1088 | { | |
185c9bcf | 1089 | debugfs_remove_recursive(ehci->debug_dir); |
694cc208 TJ |
1090 | } |
1091 | ||
1092 | #endif /* STUB_DEBUG_FILES */ |