Merge tag 'for-linus-20171120' of git://git.infradead.org/linux-mtd
[platform/kernel/linux-rpi.git] / drivers / usb / host / uhci-debug.c
1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  * UHCI-specific debugging code. Invaluable when something
4  * goes wrong, but don't get in my face.
5  *
6  * Kernel visible pointers are surrounded in []s and bus
7  * visible pointers are surrounded in ()s
8  *
9  * (C) Copyright 1999 Linus Torvalds
10  * (C) Copyright 1999-2001 Johannes Erdfelt
11  */
12
13 #include <linux/slab.h>
14 #include <linux/kernel.h>
15 #include <linux/debugfs.h>
16 #include <asm/io.h>
17
18 #include "uhci-hcd.h"
19
20 #define EXTRA_SPACE     1024
21
22 static struct dentry *uhci_debugfs_root;
23
24 #ifdef CONFIG_DYNAMIC_DEBUG
25
26 /* Handle REALLY large printks so we don't overflow buffers */
27 static void lprintk(char *buf)
28 {
29         char *p;
30
31         /* Just write one line at a time */
32         while (buf) {
33                 p = strchr(buf, '\n');
34                 if (p)
35                         *p = 0;
36                 printk(KERN_DEBUG "%s\n", buf);
37                 buf = p;
38                 if (buf)
39                         buf++;
40         }
41 }
42
43 static int uhci_show_td(struct uhci_hcd *uhci, struct uhci_td *td, char *buf,
44                         int len, int space)
45 {
46         char *out = buf;
47         char *spid;
48         u32 status, token;
49
50         status = td_status(uhci, td);
51         out += sprintf(out, "%*s[%p] link (%08x) ", space, "", td,
52                 hc32_to_cpu(uhci, td->link));
53         out += sprintf(out, "e%d %s%s%s%s%s%s%s%s%s%sLength=%x ",
54                 ((status >> 27) & 3),
55                 (status & TD_CTRL_SPD) ?      "SPD " : "",
56                 (status & TD_CTRL_LS) ?       "LS " : "",
57                 (status & TD_CTRL_IOC) ?      "IOC " : "",
58                 (status & TD_CTRL_ACTIVE) ?   "Active " : "",
59                 (status & TD_CTRL_STALLED) ?  "Stalled " : "",
60                 (status & TD_CTRL_DBUFERR) ?  "DataBufErr " : "",
61                 (status & TD_CTRL_BABBLE) ?   "Babble " : "",
62                 (status & TD_CTRL_NAK) ?      "NAK " : "",
63                 (status & TD_CTRL_CRCTIMEO) ? "CRC/Timeo " : "",
64                 (status & TD_CTRL_BITSTUFF) ? "BitStuff " : "",
65                 status & 0x7ff);
66         if (out - buf > len)
67                 goto done;
68
69         token = td_token(uhci, td);
70         switch (uhci_packetid(token)) {
71                 case USB_PID_SETUP:
72                         spid = "SETUP";
73                         break;
74                 case USB_PID_OUT:
75                         spid = "OUT";
76                         break;
77                 case USB_PID_IN:
78                         spid = "IN";
79                         break;
80                 default:
81                         spid = "?";
82                         break;
83         }
84
85         out += sprintf(out, "MaxLen=%x DT%d EndPt=%x Dev=%x, PID=%x(%s) ",
86                 token >> 21,
87                 ((token >> 19) & 1),
88                 (token >> 15) & 15,
89                 (token >> 8) & 127,
90                 (token & 0xff),
91                 spid);
92         out += sprintf(out, "(buf=%08x)\n", hc32_to_cpu(uhci, td->buffer));
93
94 done:
95         if (out - buf > len)
96                 out += sprintf(out, " ...\n");
97         return out - buf;
98 }
99
100 static int uhci_show_urbp(struct uhci_hcd *uhci, struct urb_priv *urbp,
101                         char *buf, int len, int space)
102 {
103         char *out = buf;
104         struct uhci_td *td;
105         int i, nactive, ninactive;
106         char *ptype;
107
108
109         out += sprintf(out, "urb_priv [%p] ", urbp);
110         out += sprintf(out, "urb [%p] ", urbp->urb);
111         out += sprintf(out, "qh [%p] ", urbp->qh);
112         out += sprintf(out, "Dev=%d ", usb_pipedevice(urbp->urb->pipe));
113         out += sprintf(out, "EP=%x(%s) ", usb_pipeendpoint(urbp->urb->pipe),
114                         (usb_pipein(urbp->urb->pipe) ? "IN" : "OUT"));
115         if (out - buf > len)
116                 goto done;
117
118         switch (usb_pipetype(urbp->urb->pipe)) {
119         case PIPE_ISOCHRONOUS: ptype = "ISO"; break;
120         case PIPE_INTERRUPT: ptype = "INT"; break;
121         case PIPE_BULK: ptype = "BLK"; break;
122         default:
123         case PIPE_CONTROL: ptype = "CTL"; break;
124         }
125
126         out += sprintf(out, "%s%s", ptype, (urbp->fsbr ? " FSBR" : ""));
127         out += sprintf(out, " Actlen=%d%s", urbp->urb->actual_length,
128                         (urbp->qh->type == USB_ENDPOINT_XFER_CONTROL ?
129                                 "-8" : ""));
130
131         if (urbp->urb->unlinked)
132                 out += sprintf(out, " Unlinked=%d", urbp->urb->unlinked);
133         out += sprintf(out, "\n");
134
135         if (out - buf > len)
136                 goto done;
137
138         i = nactive = ninactive = 0;
139         list_for_each_entry(td, &urbp->td_list, list) {
140                 if (urbp->qh->type != USB_ENDPOINT_XFER_ISOC &&
141                                 (++i <= 10 || debug > 2)) {
142                         out += sprintf(out, "%*s%d: ", space + 2, "", i);
143                         out += uhci_show_td(uhci, td, out,
144                                         len - (out - buf), 0);
145                         if (out - buf > len)
146                                 goto tail;
147                 } else {
148                         if (td_status(uhci, td) & TD_CTRL_ACTIVE)
149                                 ++nactive;
150                         else
151                                 ++ninactive;
152                 }
153         }
154         if (nactive + ninactive > 0)
155                 out += sprintf(out,
156                                 "%*s[skipped %d inactive and %d active TDs]\n",
157                                 space, "", ninactive, nactive);
158 done:
159         if (out - buf > len)
160                 out += sprintf(out, " ...\n");
161 tail:
162         return out - buf;
163 }
164
165 static int uhci_show_qh(struct uhci_hcd *uhci,
166                 struct uhci_qh *qh, char *buf, int len, int space)
167 {
168         char *out = buf;
169         int i, nurbs;
170         __hc32 element = qh_element(qh);
171         char *qtype;
172
173         switch (qh->type) {
174         case USB_ENDPOINT_XFER_ISOC: qtype = "ISO"; break;
175         case USB_ENDPOINT_XFER_INT: qtype = "INT"; break;
176         case USB_ENDPOINT_XFER_BULK: qtype = "BLK"; break;
177         case USB_ENDPOINT_XFER_CONTROL: qtype = "CTL"; break;
178         default: qtype = "Skel" ; break;
179         }
180
181         out += sprintf(out, "%*s[%p] %s QH link (%08x) element (%08x)\n",
182                         space, "", qh, qtype,
183                         hc32_to_cpu(uhci, qh->link),
184                         hc32_to_cpu(uhci, element));
185         if (qh->type == USB_ENDPOINT_XFER_ISOC)
186                 out += sprintf(out,
187                                 "%*s    period %d phase %d load %d us, frame %x desc [%p]\n",
188                                 space, "", qh->period, qh->phase, qh->load,
189                                 qh->iso_frame, qh->iso_packet_desc);
190         else if (qh->type == USB_ENDPOINT_XFER_INT)
191                 out += sprintf(out, "%*s    period %d phase %d load %d us\n",
192                                 space, "", qh->period, qh->phase, qh->load);
193         if (out - buf > len)
194                 goto done;
195
196         if (element & UHCI_PTR_QH(uhci))
197                 out += sprintf(out, "%*s  Element points to QH (bug?)\n", space, "");
198
199         if (element & UHCI_PTR_DEPTH(uhci))
200                 out += sprintf(out, "%*s  Depth traverse\n", space, "");
201
202         if (element & cpu_to_hc32(uhci, 8))
203                 out += sprintf(out, "%*s  Bit 3 set (bug?)\n", space, "");
204
205         if (!(element & ~(UHCI_PTR_QH(uhci) | UHCI_PTR_DEPTH(uhci))))
206                 out += sprintf(out, "%*s  Element is NULL (bug?)\n", space, "");
207
208         if (out - buf > len)
209                 goto done;
210
211         if (list_empty(&qh->queue)) {
212                 out += sprintf(out, "%*s  queue is empty\n", space, "");
213                 if (qh == uhci->skel_async_qh) {
214                         out += uhci_show_td(uhci, uhci->term_td, out,
215                                         len - (out - buf), 0);
216                         if (out - buf > len)
217                                 goto tail;
218                 }
219         } else {
220                 struct urb_priv *urbp = list_entry(qh->queue.next,
221                                 struct urb_priv, node);
222                 struct uhci_td *td = list_entry(urbp->td_list.next,
223                                 struct uhci_td, list);
224
225                 if (element != LINK_TO_TD(uhci, td))
226                         out += sprintf(out, "%*s Element != First TD\n",
227                                         space, "");
228                 i = nurbs = 0;
229                 list_for_each_entry(urbp, &qh->queue, node) {
230                         if (++i <= 10) {
231                                 out += uhci_show_urbp(uhci, urbp, out,
232                                                 len - (out - buf), space + 2);
233                                 if (out - buf > len)
234                                         goto tail;
235                         }
236                         else
237                                 ++nurbs;
238                 }
239                 if (nurbs > 0)
240                         out += sprintf(out, "%*s Skipped %d URBs\n",
241                                         space, "", nurbs);
242         }
243
244         if (out - buf > len)
245                 goto done;
246
247         if (qh->dummy_td) {
248                 out += sprintf(out, "%*s  Dummy TD\n", space, "");
249                 out += uhci_show_td(uhci, qh->dummy_td, out,
250                                 len - (out - buf), 0);
251                 if (out - buf > len)
252                         goto tail;
253         }
254
255 done:
256         if (out - buf > len)
257                 out += sprintf(out, " ...\n");
258 tail:
259         return out - buf;
260 }
261
262 static int uhci_show_sc(int port, unsigned short status, char *buf)
263 {
264         return sprintf(buf, "  stat%d     =     %04x  %s%s%s%s%s%s%s%s%s%s\n",
265                 port,
266                 status,
267                 (status & USBPORTSC_SUSP) ?     " Suspend" : "",
268                 (status & USBPORTSC_OCC) ?      " OverCurrentChange" : "",
269                 (status & USBPORTSC_OC) ?       " OverCurrent" : "",
270                 (status & USBPORTSC_PR) ?       " Reset" : "",
271                 (status & USBPORTSC_LSDA) ?     " LowSpeed" : "",
272                 (status & USBPORTSC_RD) ?       " ResumeDetect" : "",
273                 (status & USBPORTSC_PEC) ?      " EnableChange" : "",
274                 (status & USBPORTSC_PE) ?       " Enabled" : "",
275                 (status & USBPORTSC_CSC) ?      " ConnectChange" : "",
276                 (status & USBPORTSC_CCS) ?      " Connected" : "");
277 }
278
279 static int uhci_show_root_hub_state(struct uhci_hcd *uhci, char *buf)
280 {
281         char *rh_state;
282
283         switch (uhci->rh_state) {
284             case UHCI_RH_RESET:
285                 rh_state = "reset";             break;
286             case UHCI_RH_SUSPENDED:
287                 rh_state = "suspended";         break;
288             case UHCI_RH_AUTO_STOPPED:
289                 rh_state = "auto-stopped";      break;
290             case UHCI_RH_RESUMING:
291                 rh_state = "resuming";          break;
292             case UHCI_RH_SUSPENDING:
293                 rh_state = "suspending";        break;
294             case UHCI_RH_RUNNING:
295                 rh_state = "running";           break;
296             case UHCI_RH_RUNNING_NODEVS:
297                 rh_state = "running, no devs";  break;
298             default:
299                 rh_state = "?";                 break;
300         }
301         return sprintf(buf, "Root-hub state: %s   FSBR: %d\n",
302                         rh_state, uhci->fsbr_is_on);
303 }
304
305 static int uhci_show_status(struct uhci_hcd *uhci, char *buf, int len)
306 {
307         char *out = buf;
308         unsigned short usbcmd, usbstat, usbint, usbfrnum;
309         unsigned int flbaseadd;
310         unsigned char sof;
311         unsigned short portsc1, portsc2;
312
313
314         usbcmd    = uhci_readw(uhci, USBCMD);
315         usbstat   = uhci_readw(uhci, USBSTS);
316         usbint    = uhci_readw(uhci, USBINTR);
317         usbfrnum  = uhci_readw(uhci, USBFRNUM);
318         flbaseadd = uhci_readl(uhci, USBFLBASEADD);
319         sof       = uhci_readb(uhci, USBSOF);
320         portsc1   = uhci_readw(uhci, USBPORTSC1);
321         portsc2   = uhci_readw(uhci, USBPORTSC2);
322
323         out += sprintf(out, "  usbcmd    =     %04x   %s%s%s%s%s%s%s%s\n",
324                 usbcmd,
325                 (usbcmd & USBCMD_MAXP) ?    "Maxp64 " : "Maxp32 ",
326                 (usbcmd & USBCMD_CF) ?      "CF " : "",
327                 (usbcmd & USBCMD_SWDBG) ?   "SWDBG " : "",
328                 (usbcmd & USBCMD_FGR) ?     "FGR " : "",
329                 (usbcmd & USBCMD_EGSM) ?    "EGSM " : "",
330                 (usbcmd & USBCMD_GRESET) ?  "GRESET " : "",
331                 (usbcmd & USBCMD_HCRESET) ? "HCRESET " : "",
332                 (usbcmd & USBCMD_RS) ?      "RS " : "");
333         if (out - buf > len)
334                 goto done;
335
336         out += sprintf(out, "  usbstat   =     %04x   %s%s%s%s%s%s\n",
337                 usbstat,
338                 (usbstat & USBSTS_HCH) ?    "HCHalted " : "",
339                 (usbstat & USBSTS_HCPE) ?   "HostControllerProcessError " : "",
340                 (usbstat & USBSTS_HSE) ?    "HostSystemError " : "",
341                 (usbstat & USBSTS_RD) ?     "ResumeDetect " : "",
342                 (usbstat & USBSTS_ERROR) ?  "USBError " : "",
343                 (usbstat & USBSTS_USBINT) ? "USBINT " : "");
344         if (out - buf > len)
345                 goto done;
346
347         out += sprintf(out, "  usbint    =     %04x\n", usbint);
348         out += sprintf(out, "  usbfrnum  =   (%d)%03x\n", (usbfrnum >> 10) & 1,
349                 0xfff & (4*(unsigned int)usbfrnum));
350         out += sprintf(out, "  flbaseadd = %08x\n", flbaseadd);
351         out += sprintf(out, "  sof       =       %02x\n", sof);
352         if (out - buf > len)
353                 goto done;
354
355         out += uhci_show_sc(1, portsc1, out);
356         if (out - buf > len)
357                 goto done;
358
359         out += uhci_show_sc(2, portsc2, out);
360         if (out - buf > len)
361                 goto done;
362
363         out += sprintf(out,
364                         "Most recent frame: %x (%d)   Last ISO frame: %x (%d)\n",
365                         uhci->frame_number, uhci->frame_number & 1023,
366                         uhci->last_iso_frame, uhci->last_iso_frame & 1023);
367
368 done:
369         if (out - buf > len)
370                 out += sprintf(out, " ...\n");
371         return out - buf;
372 }
373
374 static int uhci_sprint_schedule(struct uhci_hcd *uhci, char *buf, int len)
375 {
376         char *out = buf;
377         int i, j;
378         struct uhci_qh *qh;
379         struct uhci_td *td;
380         struct list_head *tmp, *head;
381         int nframes, nerrs;
382         __hc32 link;
383         __hc32 fsbr_link;
384
385         static const char * const qh_names[] = {
386                 "unlink", "iso", "int128", "int64", "int32", "int16",
387                 "int8", "int4", "int2", "async", "term"
388         };
389
390         out += uhci_show_root_hub_state(uhci, out);
391         if (out - buf > len)
392                 goto done;
393         out += sprintf(out, "HC status\n");
394         out += uhci_show_status(uhci, out, len - (out - buf));
395         if (out - buf > len)
396                 goto tail;
397
398         out += sprintf(out, "Periodic load table\n");
399         for (i = 0; i < MAX_PHASE; ++i) {
400                 out += sprintf(out, "\t%d", uhci->load[i]);
401                 if (i % 8 == 7)
402                         *out++ = '\n';
403         }
404         out += sprintf(out, "Total: %d, #INT: %d, #ISO: %d\n",
405                         uhci->total_load,
406                         uhci_to_hcd(uhci)->self.bandwidth_int_reqs,
407                         uhci_to_hcd(uhci)->self.bandwidth_isoc_reqs);
408         if (debug <= 1)
409                 goto tail;
410
411         out += sprintf(out, "Frame List\n");
412         nframes = 10;
413         nerrs = 0;
414         for (i = 0; i < UHCI_NUMFRAMES; ++i) {
415                 __hc32 qh_dma;
416
417                 if (out - buf > len)
418                         goto done;
419                 j = 0;
420                 td = uhci->frame_cpu[i];
421                 link = uhci->frame[i];
422                 if (!td)
423                         goto check_link;
424
425                 if (nframes > 0) {
426                         out += sprintf(out, "- Frame %d -> (%08x)\n",
427                                         i, hc32_to_cpu(uhci, link));
428                         j = 1;
429                 }
430
431                 head = &td->fl_list;
432                 tmp = head;
433                 do {
434                         td = list_entry(tmp, struct uhci_td, fl_list);
435                         tmp = tmp->next;
436                         if (link != LINK_TO_TD(uhci, td)) {
437                                 if (nframes > 0) {
438                                         out += sprintf(out,
439                                                 "    link does not match list entry!\n");
440                                         if (out - buf > len)
441                                                 goto done;
442                                 } else
443                                         ++nerrs;
444                         }
445                         if (nframes > 0) {
446                                 out += uhci_show_td(uhci, td, out,
447                                                 len - (out - buf), 4);
448                                 if (out - buf > len)
449                                         goto tail;
450                         }
451                         link = td->link;
452                 } while (tmp != head);
453
454 check_link:
455                 qh_dma = uhci_frame_skel_link(uhci, i);
456                 if (link != qh_dma) {
457                         if (nframes > 0) {
458                                 if (!j) {
459                                         out += sprintf(out,
460                                                 "- Frame %d -> (%08x)\n",
461                                                 i, hc32_to_cpu(uhci, link));
462                                         j = 1;
463                                 }
464                                 out += sprintf(out,
465                                         "   link does not match QH (%08x)!\n",
466                                         hc32_to_cpu(uhci, qh_dma));
467                                 if (out - buf > len)
468                                         goto done;
469                         } else
470                                 ++nerrs;
471                 }
472                 nframes -= j;
473         }
474         if (nerrs > 0)
475                 out += sprintf(out, "Skipped %d bad links\n", nerrs);
476
477         out += sprintf(out, "Skeleton QHs\n");
478
479         if (out - buf > len)
480                 goto done;
481
482         fsbr_link = 0;
483         for (i = 0; i < UHCI_NUM_SKELQH; ++i) {
484                 int cnt = 0;
485
486                 qh = uhci->skelqh[i];
487                 out += sprintf(out, "- skel_%s_qh\n", qh_names[i]);
488                 out += uhci_show_qh(uhci, qh, out, len - (out - buf), 4);
489                 if (out - buf > len)
490                         goto tail;
491
492                 /* Last QH is the Terminating QH, it's different */
493                 if (i == SKEL_TERM) {
494                         if (qh_element(qh) != LINK_TO_TD(uhci, uhci->term_td)) {
495                                 out += sprintf(out,
496                                         "    skel_term_qh element is not set to term_td!\n");
497                                 if (out - buf > len)
498                                         goto done;
499                         }
500                         link = fsbr_link;
501                         if (!link)
502                                 link = LINK_TO_QH(uhci, uhci->skel_term_qh);
503                         goto check_qh_link;
504                 }
505
506                 head = &qh->node;
507                 tmp = head->next;
508
509                 while (tmp != head) {
510                         qh = list_entry(tmp, struct uhci_qh, node);
511                         tmp = tmp->next;
512                         if (++cnt <= 10) {
513                                 out += uhci_show_qh(uhci, qh, out,
514                                                 len - (out - buf), 4);
515                                 if (out - buf > len)
516                                         goto tail;
517                         }
518                         if (!fsbr_link && qh->skel >= SKEL_FSBR)
519                                 fsbr_link = LINK_TO_QH(uhci, qh);
520                 }
521                 if ((cnt -= 10) > 0)
522                         out += sprintf(out, "    Skipped %d QHs\n", cnt);
523
524                 link = UHCI_PTR_TERM(uhci);
525                 if (i <= SKEL_ISO)
526                         ;
527                 else if (i < SKEL_ASYNC)
528                         link = LINK_TO_QH(uhci, uhci->skel_async_qh);
529                 else if (!uhci->fsbr_is_on)
530                         ;
531                 else
532                         link = LINK_TO_QH(uhci, uhci->skel_term_qh);
533 check_qh_link:
534                 if (qh->link != link)
535                         out += sprintf(out,
536                                 "    last QH not linked to next skeleton!\n");
537
538                 if (out - buf > len)
539                         goto done;
540         }
541
542 done:
543         if (out - buf > len)
544                 out += sprintf(out, " ...\n");
545 tail:
546         return out - buf;
547 }
548
549 #ifdef CONFIG_DEBUG_FS
550
551 #define MAX_OUTPUT      (64 * 1024)
552
553 struct uhci_debug {
554         int size;
555         char *data;
556 };
557
558 static int uhci_debug_open(struct inode *inode, struct file *file)
559 {
560         struct uhci_hcd *uhci = inode->i_private;
561         struct uhci_debug *up;
562         unsigned long flags;
563
564         up = kmalloc(sizeof(*up), GFP_KERNEL);
565         if (!up)
566                 return -ENOMEM;
567
568         up->data = kmalloc(MAX_OUTPUT, GFP_KERNEL);
569         if (!up->data) {
570                 kfree(up);
571                 return -ENOMEM;
572         }
573
574         up->size = 0;
575         spin_lock_irqsave(&uhci->lock, flags);
576         if (uhci->is_initialized)
577                 up->size = uhci_sprint_schedule(uhci, up->data,
578                                         MAX_OUTPUT - EXTRA_SPACE);
579         spin_unlock_irqrestore(&uhci->lock, flags);
580
581         file->private_data = up;
582
583         return 0;
584 }
585
586 static loff_t uhci_debug_lseek(struct file *file, loff_t off, int whence)
587 {
588         struct uhci_debug *up = file->private_data;
589         return no_seek_end_llseek_size(file, off, whence, up->size);
590 }
591
592 static ssize_t uhci_debug_read(struct file *file, char __user *buf,
593                                 size_t nbytes, loff_t *ppos)
594 {
595         struct uhci_debug *up = file->private_data;
596         return simple_read_from_buffer(buf, nbytes, ppos, up->data, up->size);
597 }
598
599 static int uhci_debug_release(struct inode *inode, struct file *file)
600 {
601         struct uhci_debug *up = file->private_data;
602
603         kfree(up->data);
604         kfree(up);
605
606         return 0;
607 }
608
609 static const struct file_operations uhci_debug_operations = {
610         .owner =        THIS_MODULE,
611         .open =         uhci_debug_open,
612         .llseek =       uhci_debug_lseek,
613         .read =         uhci_debug_read,
614         .release =      uhci_debug_release,
615 };
616 #define UHCI_DEBUG_OPS
617
618 #endif  /* CONFIG_DEBUG_FS */
619
620 #else   /* CONFIG_DYNAMIC_DEBUG*/
621
622 static inline void lprintk(char *buf)
623 {}
624
625 static inline int uhci_show_qh(struct uhci_hcd *uhci,
626                 struct uhci_qh *qh, char *buf, int len, int space)
627 {
628         return 0;
629 }
630
631 static inline int uhci_sprint_schedule(struct uhci_hcd *uhci,
632                 char *buf, int len)
633 {
634         return 0;
635 }
636
637 #endif