1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun * The USB Monitor, inspired by Dave Harding's USBMon.
4*4882a593Smuzhiyun *
5*4882a593Smuzhiyun * This is a text format reader.
6*4882a593Smuzhiyun */
7*4882a593Smuzhiyun
8*4882a593Smuzhiyun #include <linux/kernel.h>
9*4882a593Smuzhiyun #include <linux/list.h>
10*4882a593Smuzhiyun #include <linux/usb.h>
11*4882a593Smuzhiyun #include <linux/slab.h>
12*4882a593Smuzhiyun #include <linux/sched/signal.h>
13*4882a593Smuzhiyun #include <linux/time.h>
14*4882a593Smuzhiyun #include <linux/ktime.h>
15*4882a593Smuzhiyun #include <linux/export.h>
16*4882a593Smuzhiyun #include <linux/mutex.h>
17*4882a593Smuzhiyun #include <linux/debugfs.h>
18*4882a593Smuzhiyun #include <linux/scatterlist.h>
19*4882a593Smuzhiyun #include <linux/uaccess.h>
20*4882a593Smuzhiyun
21*4882a593Smuzhiyun #include "usb_mon.h"
22*4882a593Smuzhiyun
23*4882a593Smuzhiyun /*
24*4882a593Smuzhiyun * No, we do not want arbitrarily long data strings.
25*4882a593Smuzhiyun * Use the binary interface if you want to capture bulk data!
26*4882a593Smuzhiyun */
27*4882a593Smuzhiyun #define DATA_MAX 32
28*4882a593Smuzhiyun
29*4882a593Smuzhiyun /*
30*4882a593Smuzhiyun * Defined by USB 2.0 clause 9.3, table 9.2.
31*4882a593Smuzhiyun */
32*4882a593Smuzhiyun #define SETUP_MAX 8
33*4882a593Smuzhiyun
34*4882a593Smuzhiyun /*
35*4882a593Smuzhiyun * This limit exists to prevent OOMs when the user process stops reading.
36*4882a593Smuzhiyun * If usbmon were available to unprivileged processes, it might be open
37*4882a593Smuzhiyun * to a local DoS. But we have to keep to root in order to prevent
38*4882a593Smuzhiyun * password sniffing from HID devices.
39*4882a593Smuzhiyun */
40*4882a593Smuzhiyun #define EVENT_MAX (4*PAGE_SIZE / sizeof(struct mon_event_text))
41*4882a593Smuzhiyun
42*4882a593Smuzhiyun /*
43*4882a593Smuzhiyun * Potentially unlimited number; we limit it for similar allocations.
44*4882a593Smuzhiyun * The usbfs limits this to 128, but we're not quite as generous.
45*4882a593Smuzhiyun */
46*4882a593Smuzhiyun #define ISODESC_MAX 5
47*4882a593Smuzhiyun
48*4882a593Smuzhiyun #define PRINTF_DFL 250 /* with 5 ISOs segs */
49*4882a593Smuzhiyun
50*4882a593Smuzhiyun struct mon_iso_desc {
51*4882a593Smuzhiyun int status;
52*4882a593Smuzhiyun unsigned int offset;
53*4882a593Smuzhiyun unsigned int length; /* Unsigned here, signed in URB. Historic. */
54*4882a593Smuzhiyun };
55*4882a593Smuzhiyun
56*4882a593Smuzhiyun struct mon_event_text {
57*4882a593Smuzhiyun struct list_head e_link;
58*4882a593Smuzhiyun int type; /* submit, complete, etc. */
59*4882a593Smuzhiyun unsigned long id; /* From pointer, most of the time */
60*4882a593Smuzhiyun unsigned int tstamp;
61*4882a593Smuzhiyun int busnum;
62*4882a593Smuzhiyun char devnum;
63*4882a593Smuzhiyun char epnum;
64*4882a593Smuzhiyun char is_in;
65*4882a593Smuzhiyun char xfertype;
66*4882a593Smuzhiyun int length; /* Depends on type: xfer length or act length */
67*4882a593Smuzhiyun int status;
68*4882a593Smuzhiyun int interval;
69*4882a593Smuzhiyun int start_frame;
70*4882a593Smuzhiyun int error_count;
71*4882a593Smuzhiyun char setup_flag;
72*4882a593Smuzhiyun char data_flag;
73*4882a593Smuzhiyun int numdesc; /* Full number */
74*4882a593Smuzhiyun struct mon_iso_desc isodesc[ISODESC_MAX];
75*4882a593Smuzhiyun unsigned char setup[SETUP_MAX];
76*4882a593Smuzhiyun unsigned char data[DATA_MAX];
77*4882a593Smuzhiyun };
78*4882a593Smuzhiyun
79*4882a593Smuzhiyun #define SLAB_NAME_SZ 30
80*4882a593Smuzhiyun struct mon_reader_text {
81*4882a593Smuzhiyun struct kmem_cache *e_slab;
82*4882a593Smuzhiyun int nevents;
83*4882a593Smuzhiyun struct list_head e_list;
84*4882a593Smuzhiyun struct mon_reader r; /* In C, parent class can be placed anywhere */
85*4882a593Smuzhiyun
86*4882a593Smuzhiyun wait_queue_head_t wait;
87*4882a593Smuzhiyun int printf_size;
88*4882a593Smuzhiyun size_t printf_offset;
89*4882a593Smuzhiyun size_t printf_togo;
90*4882a593Smuzhiyun char *printf_buf;
91*4882a593Smuzhiyun struct mutex printf_lock;
92*4882a593Smuzhiyun
93*4882a593Smuzhiyun char slab_name[SLAB_NAME_SZ];
94*4882a593Smuzhiyun };
95*4882a593Smuzhiyun
96*4882a593Smuzhiyun static struct dentry *mon_dir; /* Usually /sys/kernel/debug/usbmon */
97*4882a593Smuzhiyun
98*4882a593Smuzhiyun static void mon_text_ctor(void *);
99*4882a593Smuzhiyun
100*4882a593Smuzhiyun struct mon_text_ptr {
101*4882a593Smuzhiyun int cnt, limit;
102*4882a593Smuzhiyun char *pbuf;
103*4882a593Smuzhiyun };
104*4882a593Smuzhiyun
105*4882a593Smuzhiyun static struct mon_event_text *
106*4882a593Smuzhiyun mon_text_read_wait(struct mon_reader_text *rp, struct file *file);
107*4882a593Smuzhiyun static void mon_text_read_head_t(struct mon_reader_text *rp,
108*4882a593Smuzhiyun struct mon_text_ptr *p, const struct mon_event_text *ep);
109*4882a593Smuzhiyun static void mon_text_read_head_u(struct mon_reader_text *rp,
110*4882a593Smuzhiyun struct mon_text_ptr *p, const struct mon_event_text *ep);
111*4882a593Smuzhiyun static void mon_text_read_statset(struct mon_reader_text *rp,
112*4882a593Smuzhiyun struct mon_text_ptr *p, const struct mon_event_text *ep);
113*4882a593Smuzhiyun static void mon_text_read_intstat(struct mon_reader_text *rp,
114*4882a593Smuzhiyun struct mon_text_ptr *p, const struct mon_event_text *ep);
115*4882a593Smuzhiyun static void mon_text_read_isostat(struct mon_reader_text *rp,
116*4882a593Smuzhiyun struct mon_text_ptr *p, const struct mon_event_text *ep);
117*4882a593Smuzhiyun static void mon_text_read_isodesc(struct mon_reader_text *rp,
118*4882a593Smuzhiyun struct mon_text_ptr *p, const struct mon_event_text *ep);
119*4882a593Smuzhiyun static void mon_text_read_data(struct mon_reader_text *rp,
120*4882a593Smuzhiyun struct mon_text_ptr *p, const struct mon_event_text *ep);
121*4882a593Smuzhiyun
122*4882a593Smuzhiyun /*
123*4882a593Smuzhiyun * mon_text_submit
124*4882a593Smuzhiyun * mon_text_complete
125*4882a593Smuzhiyun *
126*4882a593Smuzhiyun * May be called from an interrupt.
127*4882a593Smuzhiyun *
128*4882a593Smuzhiyun * This is called with the whole mon_bus locked, so no additional lock.
129*4882a593Smuzhiyun */
130*4882a593Smuzhiyun
mon_text_get_setup(struct mon_event_text * ep,struct urb * urb,char ev_type,struct mon_bus * mbus)131*4882a593Smuzhiyun static inline char mon_text_get_setup(struct mon_event_text *ep,
132*4882a593Smuzhiyun struct urb *urb, char ev_type, struct mon_bus *mbus)
133*4882a593Smuzhiyun {
134*4882a593Smuzhiyun
135*4882a593Smuzhiyun if (ep->xfertype != USB_ENDPOINT_XFER_CONTROL || ev_type != 'S')
136*4882a593Smuzhiyun return '-';
137*4882a593Smuzhiyun
138*4882a593Smuzhiyun if (urb->setup_packet == NULL)
139*4882a593Smuzhiyun return 'Z'; /* '0' would be not as pretty. */
140*4882a593Smuzhiyun
141*4882a593Smuzhiyun memcpy(ep->setup, urb->setup_packet, SETUP_MAX);
142*4882a593Smuzhiyun return 0;
143*4882a593Smuzhiyun }
144*4882a593Smuzhiyun
mon_text_get_data(struct mon_event_text * ep,struct urb * urb,int len,char ev_type,struct mon_bus * mbus)145*4882a593Smuzhiyun static inline char mon_text_get_data(struct mon_event_text *ep, struct urb *urb,
146*4882a593Smuzhiyun int len, char ev_type, struct mon_bus *mbus)
147*4882a593Smuzhiyun {
148*4882a593Smuzhiyun void *src;
149*4882a593Smuzhiyun
150*4882a593Smuzhiyun if (len <= 0)
151*4882a593Smuzhiyun return 'L';
152*4882a593Smuzhiyun if (len >= DATA_MAX)
153*4882a593Smuzhiyun len = DATA_MAX;
154*4882a593Smuzhiyun
155*4882a593Smuzhiyun if (ep->is_in) {
156*4882a593Smuzhiyun if (ev_type != 'C')
157*4882a593Smuzhiyun return '<';
158*4882a593Smuzhiyun } else {
159*4882a593Smuzhiyun if (ev_type != 'S')
160*4882a593Smuzhiyun return '>';
161*4882a593Smuzhiyun }
162*4882a593Smuzhiyun
163*4882a593Smuzhiyun if (urb->num_sgs == 0) {
164*4882a593Smuzhiyun src = urb->transfer_buffer;
165*4882a593Smuzhiyun if (src == NULL)
166*4882a593Smuzhiyun return 'Z'; /* '0' would be not as pretty. */
167*4882a593Smuzhiyun } else {
168*4882a593Smuzhiyun struct scatterlist *sg = urb->sg;
169*4882a593Smuzhiyun
170*4882a593Smuzhiyun if (PageHighMem(sg_page(sg)))
171*4882a593Smuzhiyun return 'D';
172*4882a593Smuzhiyun
173*4882a593Smuzhiyun /* For the text interface we copy only the first sg buffer */
174*4882a593Smuzhiyun len = min_t(int, sg->length, len);
175*4882a593Smuzhiyun src = sg_virt(sg);
176*4882a593Smuzhiyun }
177*4882a593Smuzhiyun
178*4882a593Smuzhiyun memcpy(ep->data, src, len);
179*4882a593Smuzhiyun return 0;
180*4882a593Smuzhiyun }
181*4882a593Smuzhiyun
mon_get_timestamp(void)182*4882a593Smuzhiyun static inline unsigned int mon_get_timestamp(void)
183*4882a593Smuzhiyun {
184*4882a593Smuzhiyun struct timespec64 now;
185*4882a593Smuzhiyun unsigned int stamp;
186*4882a593Smuzhiyun
187*4882a593Smuzhiyun ktime_get_ts64(&now);
188*4882a593Smuzhiyun stamp = now.tv_sec & 0xFFF; /* 2^32 = 4294967296. Limit to 4096s. */
189*4882a593Smuzhiyun stamp = stamp * USEC_PER_SEC + now.tv_nsec / NSEC_PER_USEC;
190*4882a593Smuzhiyun return stamp;
191*4882a593Smuzhiyun }
192*4882a593Smuzhiyun
mon_text_event(struct mon_reader_text * rp,struct urb * urb,char ev_type,int status)193*4882a593Smuzhiyun static void mon_text_event(struct mon_reader_text *rp, struct urb *urb,
194*4882a593Smuzhiyun char ev_type, int status)
195*4882a593Smuzhiyun {
196*4882a593Smuzhiyun struct mon_event_text *ep;
197*4882a593Smuzhiyun unsigned int stamp;
198*4882a593Smuzhiyun struct usb_iso_packet_descriptor *fp;
199*4882a593Smuzhiyun struct mon_iso_desc *dp;
200*4882a593Smuzhiyun int i, ndesc;
201*4882a593Smuzhiyun
202*4882a593Smuzhiyun stamp = mon_get_timestamp();
203*4882a593Smuzhiyun
204*4882a593Smuzhiyun if (rp->nevents >= EVENT_MAX ||
205*4882a593Smuzhiyun (ep = kmem_cache_alloc(rp->e_slab, GFP_ATOMIC)) == NULL) {
206*4882a593Smuzhiyun rp->r.m_bus->cnt_text_lost++;
207*4882a593Smuzhiyun return;
208*4882a593Smuzhiyun }
209*4882a593Smuzhiyun
210*4882a593Smuzhiyun ep->type = ev_type;
211*4882a593Smuzhiyun ep->id = (unsigned long) urb;
212*4882a593Smuzhiyun ep->busnum = urb->dev->bus->busnum;
213*4882a593Smuzhiyun ep->devnum = urb->dev->devnum;
214*4882a593Smuzhiyun ep->epnum = usb_endpoint_num(&urb->ep->desc);
215*4882a593Smuzhiyun ep->xfertype = usb_endpoint_type(&urb->ep->desc);
216*4882a593Smuzhiyun ep->is_in = usb_urb_dir_in(urb);
217*4882a593Smuzhiyun ep->tstamp = stamp;
218*4882a593Smuzhiyun ep->length = (ev_type == 'S') ?
219*4882a593Smuzhiyun urb->transfer_buffer_length : urb->actual_length;
220*4882a593Smuzhiyun /* Collecting status makes debugging sense for submits, too */
221*4882a593Smuzhiyun ep->status = status;
222*4882a593Smuzhiyun
223*4882a593Smuzhiyun if (ep->xfertype == USB_ENDPOINT_XFER_INT) {
224*4882a593Smuzhiyun ep->interval = urb->interval;
225*4882a593Smuzhiyun } else if (ep->xfertype == USB_ENDPOINT_XFER_ISOC) {
226*4882a593Smuzhiyun ep->interval = urb->interval;
227*4882a593Smuzhiyun ep->start_frame = urb->start_frame;
228*4882a593Smuzhiyun ep->error_count = urb->error_count;
229*4882a593Smuzhiyun }
230*4882a593Smuzhiyun ep->numdesc = urb->number_of_packets;
231*4882a593Smuzhiyun if (ep->xfertype == USB_ENDPOINT_XFER_ISOC &&
232*4882a593Smuzhiyun urb->number_of_packets > 0) {
233*4882a593Smuzhiyun if ((ndesc = urb->number_of_packets) > ISODESC_MAX)
234*4882a593Smuzhiyun ndesc = ISODESC_MAX;
235*4882a593Smuzhiyun fp = urb->iso_frame_desc;
236*4882a593Smuzhiyun dp = ep->isodesc;
237*4882a593Smuzhiyun for (i = 0; i < ndesc; i++) {
238*4882a593Smuzhiyun dp->status = fp->status;
239*4882a593Smuzhiyun dp->offset = fp->offset;
240*4882a593Smuzhiyun dp->length = (ev_type == 'S') ?
241*4882a593Smuzhiyun fp->length : fp->actual_length;
242*4882a593Smuzhiyun fp++;
243*4882a593Smuzhiyun dp++;
244*4882a593Smuzhiyun }
245*4882a593Smuzhiyun /* Wasteful, but simple to understand: ISO 'C' is sparse. */
246*4882a593Smuzhiyun if (ev_type == 'C')
247*4882a593Smuzhiyun ep->length = urb->transfer_buffer_length;
248*4882a593Smuzhiyun }
249*4882a593Smuzhiyun
250*4882a593Smuzhiyun ep->setup_flag = mon_text_get_setup(ep, urb, ev_type, rp->r.m_bus);
251*4882a593Smuzhiyun ep->data_flag = mon_text_get_data(ep, urb, ep->length, ev_type,
252*4882a593Smuzhiyun rp->r.m_bus);
253*4882a593Smuzhiyun
254*4882a593Smuzhiyun rp->nevents++;
255*4882a593Smuzhiyun list_add_tail(&ep->e_link, &rp->e_list);
256*4882a593Smuzhiyun wake_up(&rp->wait);
257*4882a593Smuzhiyun }
258*4882a593Smuzhiyun
mon_text_submit(void * data,struct urb * urb)259*4882a593Smuzhiyun static void mon_text_submit(void *data, struct urb *urb)
260*4882a593Smuzhiyun {
261*4882a593Smuzhiyun struct mon_reader_text *rp = data;
262*4882a593Smuzhiyun mon_text_event(rp, urb, 'S', -EINPROGRESS);
263*4882a593Smuzhiyun }
264*4882a593Smuzhiyun
mon_text_complete(void * data,struct urb * urb,int status)265*4882a593Smuzhiyun static void mon_text_complete(void *data, struct urb *urb, int status)
266*4882a593Smuzhiyun {
267*4882a593Smuzhiyun struct mon_reader_text *rp = data;
268*4882a593Smuzhiyun mon_text_event(rp, urb, 'C', status);
269*4882a593Smuzhiyun }
270*4882a593Smuzhiyun
mon_text_error(void * data,struct urb * urb,int error)271*4882a593Smuzhiyun static void mon_text_error(void *data, struct urb *urb, int error)
272*4882a593Smuzhiyun {
273*4882a593Smuzhiyun struct mon_reader_text *rp = data;
274*4882a593Smuzhiyun struct mon_event_text *ep;
275*4882a593Smuzhiyun
276*4882a593Smuzhiyun if (rp->nevents >= EVENT_MAX ||
277*4882a593Smuzhiyun (ep = kmem_cache_alloc(rp->e_slab, GFP_ATOMIC)) == NULL) {
278*4882a593Smuzhiyun rp->r.m_bus->cnt_text_lost++;
279*4882a593Smuzhiyun return;
280*4882a593Smuzhiyun }
281*4882a593Smuzhiyun
282*4882a593Smuzhiyun ep->type = 'E';
283*4882a593Smuzhiyun ep->id = (unsigned long) urb;
284*4882a593Smuzhiyun ep->busnum = urb->dev->bus->busnum;
285*4882a593Smuzhiyun ep->devnum = urb->dev->devnum;
286*4882a593Smuzhiyun ep->epnum = usb_endpoint_num(&urb->ep->desc);
287*4882a593Smuzhiyun ep->xfertype = usb_endpoint_type(&urb->ep->desc);
288*4882a593Smuzhiyun ep->is_in = usb_urb_dir_in(urb);
289*4882a593Smuzhiyun ep->tstamp = mon_get_timestamp();
290*4882a593Smuzhiyun ep->length = 0;
291*4882a593Smuzhiyun ep->status = error;
292*4882a593Smuzhiyun
293*4882a593Smuzhiyun ep->setup_flag = '-';
294*4882a593Smuzhiyun ep->data_flag = 'E';
295*4882a593Smuzhiyun
296*4882a593Smuzhiyun rp->nevents++;
297*4882a593Smuzhiyun list_add_tail(&ep->e_link, &rp->e_list);
298*4882a593Smuzhiyun wake_up(&rp->wait);
299*4882a593Smuzhiyun }
300*4882a593Smuzhiyun
301*4882a593Smuzhiyun /*
302*4882a593Smuzhiyun * Fetch next event from the circular buffer.
303*4882a593Smuzhiyun */
mon_text_fetch(struct mon_reader_text * rp,struct mon_bus * mbus)304*4882a593Smuzhiyun static struct mon_event_text *mon_text_fetch(struct mon_reader_text *rp,
305*4882a593Smuzhiyun struct mon_bus *mbus)
306*4882a593Smuzhiyun {
307*4882a593Smuzhiyun struct list_head *p;
308*4882a593Smuzhiyun unsigned long flags;
309*4882a593Smuzhiyun
310*4882a593Smuzhiyun spin_lock_irqsave(&mbus->lock, flags);
311*4882a593Smuzhiyun if (list_empty(&rp->e_list)) {
312*4882a593Smuzhiyun spin_unlock_irqrestore(&mbus->lock, flags);
313*4882a593Smuzhiyun return NULL;
314*4882a593Smuzhiyun }
315*4882a593Smuzhiyun p = rp->e_list.next;
316*4882a593Smuzhiyun list_del(p);
317*4882a593Smuzhiyun --rp->nevents;
318*4882a593Smuzhiyun spin_unlock_irqrestore(&mbus->lock, flags);
319*4882a593Smuzhiyun return list_entry(p, struct mon_event_text, e_link);
320*4882a593Smuzhiyun }
321*4882a593Smuzhiyun
322*4882a593Smuzhiyun /*
323*4882a593Smuzhiyun */
mon_text_open(struct inode * inode,struct file * file)324*4882a593Smuzhiyun static int mon_text_open(struct inode *inode, struct file *file)
325*4882a593Smuzhiyun {
326*4882a593Smuzhiyun struct mon_bus *mbus;
327*4882a593Smuzhiyun struct mon_reader_text *rp;
328*4882a593Smuzhiyun int rc;
329*4882a593Smuzhiyun
330*4882a593Smuzhiyun mutex_lock(&mon_lock);
331*4882a593Smuzhiyun mbus = inode->i_private;
332*4882a593Smuzhiyun
333*4882a593Smuzhiyun rp = kzalloc(sizeof(struct mon_reader_text), GFP_KERNEL);
334*4882a593Smuzhiyun if (rp == NULL) {
335*4882a593Smuzhiyun rc = -ENOMEM;
336*4882a593Smuzhiyun goto err_alloc;
337*4882a593Smuzhiyun }
338*4882a593Smuzhiyun INIT_LIST_HEAD(&rp->e_list);
339*4882a593Smuzhiyun init_waitqueue_head(&rp->wait);
340*4882a593Smuzhiyun mutex_init(&rp->printf_lock);
341*4882a593Smuzhiyun
342*4882a593Smuzhiyun rp->printf_size = PRINTF_DFL;
343*4882a593Smuzhiyun rp->printf_buf = kmalloc(rp->printf_size, GFP_KERNEL);
344*4882a593Smuzhiyun if (rp->printf_buf == NULL) {
345*4882a593Smuzhiyun rc = -ENOMEM;
346*4882a593Smuzhiyun goto err_alloc_pr;
347*4882a593Smuzhiyun }
348*4882a593Smuzhiyun
349*4882a593Smuzhiyun rp->r.m_bus = mbus;
350*4882a593Smuzhiyun rp->r.r_data = rp;
351*4882a593Smuzhiyun rp->r.rnf_submit = mon_text_submit;
352*4882a593Smuzhiyun rp->r.rnf_error = mon_text_error;
353*4882a593Smuzhiyun rp->r.rnf_complete = mon_text_complete;
354*4882a593Smuzhiyun
355*4882a593Smuzhiyun snprintf(rp->slab_name, SLAB_NAME_SZ, "mon_text_%p", rp);
356*4882a593Smuzhiyun rp->e_slab = kmem_cache_create(rp->slab_name,
357*4882a593Smuzhiyun sizeof(struct mon_event_text), sizeof(long), 0,
358*4882a593Smuzhiyun mon_text_ctor);
359*4882a593Smuzhiyun if (rp->e_slab == NULL) {
360*4882a593Smuzhiyun rc = -ENOMEM;
361*4882a593Smuzhiyun goto err_slab;
362*4882a593Smuzhiyun }
363*4882a593Smuzhiyun
364*4882a593Smuzhiyun mon_reader_add(mbus, &rp->r);
365*4882a593Smuzhiyun
366*4882a593Smuzhiyun file->private_data = rp;
367*4882a593Smuzhiyun mutex_unlock(&mon_lock);
368*4882a593Smuzhiyun return 0;
369*4882a593Smuzhiyun
370*4882a593Smuzhiyun // err_busy:
371*4882a593Smuzhiyun // kmem_cache_destroy(rp->e_slab);
372*4882a593Smuzhiyun err_slab:
373*4882a593Smuzhiyun kfree(rp->printf_buf);
374*4882a593Smuzhiyun err_alloc_pr:
375*4882a593Smuzhiyun kfree(rp);
376*4882a593Smuzhiyun err_alloc:
377*4882a593Smuzhiyun mutex_unlock(&mon_lock);
378*4882a593Smuzhiyun return rc;
379*4882a593Smuzhiyun }
380*4882a593Smuzhiyun
mon_text_copy_to_user(struct mon_reader_text * rp,char __user * const buf,const size_t nbytes)381*4882a593Smuzhiyun static ssize_t mon_text_copy_to_user(struct mon_reader_text *rp,
382*4882a593Smuzhiyun char __user * const buf, const size_t nbytes)
383*4882a593Smuzhiyun {
384*4882a593Smuzhiyun const size_t togo = min(nbytes, rp->printf_togo);
385*4882a593Smuzhiyun
386*4882a593Smuzhiyun if (copy_to_user(buf, &rp->printf_buf[rp->printf_offset], togo))
387*4882a593Smuzhiyun return -EFAULT;
388*4882a593Smuzhiyun rp->printf_togo -= togo;
389*4882a593Smuzhiyun rp->printf_offset += togo;
390*4882a593Smuzhiyun return togo;
391*4882a593Smuzhiyun }
392*4882a593Smuzhiyun
393*4882a593Smuzhiyun /* ppos is not advanced since the llseek operation is not permitted. */
mon_text_read_t(struct file * file,char __user * buf,size_t nbytes,loff_t * ppos)394*4882a593Smuzhiyun static ssize_t mon_text_read_t(struct file *file, char __user *buf,
395*4882a593Smuzhiyun size_t nbytes, loff_t *ppos)
396*4882a593Smuzhiyun {
397*4882a593Smuzhiyun struct mon_reader_text *rp = file->private_data;
398*4882a593Smuzhiyun struct mon_event_text *ep;
399*4882a593Smuzhiyun struct mon_text_ptr ptr;
400*4882a593Smuzhiyun ssize_t ret;
401*4882a593Smuzhiyun
402*4882a593Smuzhiyun mutex_lock(&rp->printf_lock);
403*4882a593Smuzhiyun
404*4882a593Smuzhiyun if (rp->printf_togo == 0) {
405*4882a593Smuzhiyun
406*4882a593Smuzhiyun ep = mon_text_read_wait(rp, file);
407*4882a593Smuzhiyun if (IS_ERR(ep)) {
408*4882a593Smuzhiyun mutex_unlock(&rp->printf_lock);
409*4882a593Smuzhiyun return PTR_ERR(ep);
410*4882a593Smuzhiyun }
411*4882a593Smuzhiyun ptr.cnt = 0;
412*4882a593Smuzhiyun ptr.pbuf = rp->printf_buf;
413*4882a593Smuzhiyun ptr.limit = rp->printf_size;
414*4882a593Smuzhiyun
415*4882a593Smuzhiyun mon_text_read_head_t(rp, &ptr, ep);
416*4882a593Smuzhiyun mon_text_read_statset(rp, &ptr, ep);
417*4882a593Smuzhiyun ptr.cnt += scnprintf(ptr.pbuf + ptr.cnt, ptr.limit - ptr.cnt,
418*4882a593Smuzhiyun " %d", ep->length);
419*4882a593Smuzhiyun mon_text_read_data(rp, &ptr, ep);
420*4882a593Smuzhiyun
421*4882a593Smuzhiyun rp->printf_togo = ptr.cnt;
422*4882a593Smuzhiyun rp->printf_offset = 0;
423*4882a593Smuzhiyun
424*4882a593Smuzhiyun kmem_cache_free(rp->e_slab, ep);
425*4882a593Smuzhiyun }
426*4882a593Smuzhiyun
427*4882a593Smuzhiyun ret = mon_text_copy_to_user(rp, buf, nbytes);
428*4882a593Smuzhiyun mutex_unlock(&rp->printf_lock);
429*4882a593Smuzhiyun return ret;
430*4882a593Smuzhiyun }
431*4882a593Smuzhiyun
432*4882a593Smuzhiyun /* ppos is not advanced since the llseek operation is not permitted. */
mon_text_read_u(struct file * file,char __user * buf,size_t nbytes,loff_t * ppos)433*4882a593Smuzhiyun static ssize_t mon_text_read_u(struct file *file, char __user *buf,
434*4882a593Smuzhiyun size_t nbytes, loff_t *ppos)
435*4882a593Smuzhiyun {
436*4882a593Smuzhiyun struct mon_reader_text *rp = file->private_data;
437*4882a593Smuzhiyun struct mon_event_text *ep;
438*4882a593Smuzhiyun struct mon_text_ptr ptr;
439*4882a593Smuzhiyun ssize_t ret;
440*4882a593Smuzhiyun
441*4882a593Smuzhiyun mutex_lock(&rp->printf_lock);
442*4882a593Smuzhiyun
443*4882a593Smuzhiyun if (rp->printf_togo == 0) {
444*4882a593Smuzhiyun
445*4882a593Smuzhiyun ep = mon_text_read_wait(rp, file);
446*4882a593Smuzhiyun if (IS_ERR(ep)) {
447*4882a593Smuzhiyun mutex_unlock(&rp->printf_lock);
448*4882a593Smuzhiyun return PTR_ERR(ep);
449*4882a593Smuzhiyun }
450*4882a593Smuzhiyun ptr.cnt = 0;
451*4882a593Smuzhiyun ptr.pbuf = rp->printf_buf;
452*4882a593Smuzhiyun ptr.limit = rp->printf_size;
453*4882a593Smuzhiyun
454*4882a593Smuzhiyun mon_text_read_head_u(rp, &ptr, ep);
455*4882a593Smuzhiyun if (ep->type == 'E') {
456*4882a593Smuzhiyun mon_text_read_statset(rp, &ptr, ep);
457*4882a593Smuzhiyun } else if (ep->xfertype == USB_ENDPOINT_XFER_ISOC) {
458*4882a593Smuzhiyun mon_text_read_isostat(rp, &ptr, ep);
459*4882a593Smuzhiyun mon_text_read_isodesc(rp, &ptr, ep);
460*4882a593Smuzhiyun } else if (ep->xfertype == USB_ENDPOINT_XFER_INT) {
461*4882a593Smuzhiyun mon_text_read_intstat(rp, &ptr, ep);
462*4882a593Smuzhiyun } else {
463*4882a593Smuzhiyun mon_text_read_statset(rp, &ptr, ep);
464*4882a593Smuzhiyun }
465*4882a593Smuzhiyun ptr.cnt += scnprintf(ptr.pbuf + ptr.cnt, ptr.limit - ptr.cnt,
466*4882a593Smuzhiyun " %d", ep->length);
467*4882a593Smuzhiyun mon_text_read_data(rp, &ptr, ep);
468*4882a593Smuzhiyun
469*4882a593Smuzhiyun rp->printf_togo = ptr.cnt;
470*4882a593Smuzhiyun rp->printf_offset = 0;
471*4882a593Smuzhiyun
472*4882a593Smuzhiyun kmem_cache_free(rp->e_slab, ep);
473*4882a593Smuzhiyun }
474*4882a593Smuzhiyun
475*4882a593Smuzhiyun ret = mon_text_copy_to_user(rp, buf, nbytes);
476*4882a593Smuzhiyun mutex_unlock(&rp->printf_lock);
477*4882a593Smuzhiyun return ret;
478*4882a593Smuzhiyun }
479*4882a593Smuzhiyun
mon_text_read_wait(struct mon_reader_text * rp,struct file * file)480*4882a593Smuzhiyun static struct mon_event_text *mon_text_read_wait(struct mon_reader_text *rp,
481*4882a593Smuzhiyun struct file *file)
482*4882a593Smuzhiyun {
483*4882a593Smuzhiyun struct mon_bus *mbus = rp->r.m_bus;
484*4882a593Smuzhiyun DECLARE_WAITQUEUE(waita, current);
485*4882a593Smuzhiyun struct mon_event_text *ep;
486*4882a593Smuzhiyun
487*4882a593Smuzhiyun add_wait_queue(&rp->wait, &waita);
488*4882a593Smuzhiyun set_current_state(TASK_INTERRUPTIBLE);
489*4882a593Smuzhiyun while ((ep = mon_text_fetch(rp, mbus)) == NULL) {
490*4882a593Smuzhiyun if (file->f_flags & O_NONBLOCK) {
491*4882a593Smuzhiyun set_current_state(TASK_RUNNING);
492*4882a593Smuzhiyun remove_wait_queue(&rp->wait, &waita);
493*4882a593Smuzhiyun return ERR_PTR(-EWOULDBLOCK);
494*4882a593Smuzhiyun }
495*4882a593Smuzhiyun /*
496*4882a593Smuzhiyun * We do not count nwaiters, because ->release is supposed
497*4882a593Smuzhiyun * to be called when all openers are gone only.
498*4882a593Smuzhiyun */
499*4882a593Smuzhiyun schedule();
500*4882a593Smuzhiyun if (signal_pending(current)) {
501*4882a593Smuzhiyun remove_wait_queue(&rp->wait, &waita);
502*4882a593Smuzhiyun return ERR_PTR(-EINTR);
503*4882a593Smuzhiyun }
504*4882a593Smuzhiyun set_current_state(TASK_INTERRUPTIBLE);
505*4882a593Smuzhiyun }
506*4882a593Smuzhiyun set_current_state(TASK_RUNNING);
507*4882a593Smuzhiyun remove_wait_queue(&rp->wait, &waita);
508*4882a593Smuzhiyun return ep;
509*4882a593Smuzhiyun }
510*4882a593Smuzhiyun
mon_text_read_head_t(struct mon_reader_text * rp,struct mon_text_ptr * p,const struct mon_event_text * ep)511*4882a593Smuzhiyun static void mon_text_read_head_t(struct mon_reader_text *rp,
512*4882a593Smuzhiyun struct mon_text_ptr *p, const struct mon_event_text *ep)
513*4882a593Smuzhiyun {
514*4882a593Smuzhiyun char udir, utype;
515*4882a593Smuzhiyun
516*4882a593Smuzhiyun udir = (ep->is_in ? 'i' : 'o');
517*4882a593Smuzhiyun switch (ep->xfertype) {
518*4882a593Smuzhiyun case USB_ENDPOINT_XFER_ISOC: utype = 'Z'; break;
519*4882a593Smuzhiyun case USB_ENDPOINT_XFER_INT: utype = 'I'; break;
520*4882a593Smuzhiyun case USB_ENDPOINT_XFER_CONTROL: utype = 'C'; break;
521*4882a593Smuzhiyun default: /* PIPE_BULK */ utype = 'B';
522*4882a593Smuzhiyun }
523*4882a593Smuzhiyun p->cnt += scnprintf(p->pbuf + p->cnt, p->limit - p->cnt,
524*4882a593Smuzhiyun "%lx %u %c %c%c:%03u:%02u",
525*4882a593Smuzhiyun ep->id, ep->tstamp, ep->type,
526*4882a593Smuzhiyun utype, udir, ep->devnum, ep->epnum);
527*4882a593Smuzhiyun }
528*4882a593Smuzhiyun
mon_text_read_head_u(struct mon_reader_text * rp,struct mon_text_ptr * p,const struct mon_event_text * ep)529*4882a593Smuzhiyun static void mon_text_read_head_u(struct mon_reader_text *rp,
530*4882a593Smuzhiyun struct mon_text_ptr *p, const struct mon_event_text *ep)
531*4882a593Smuzhiyun {
532*4882a593Smuzhiyun char udir, utype;
533*4882a593Smuzhiyun
534*4882a593Smuzhiyun udir = (ep->is_in ? 'i' : 'o');
535*4882a593Smuzhiyun switch (ep->xfertype) {
536*4882a593Smuzhiyun case USB_ENDPOINT_XFER_ISOC: utype = 'Z'; break;
537*4882a593Smuzhiyun case USB_ENDPOINT_XFER_INT: utype = 'I'; break;
538*4882a593Smuzhiyun case USB_ENDPOINT_XFER_CONTROL: utype = 'C'; break;
539*4882a593Smuzhiyun default: /* PIPE_BULK */ utype = 'B';
540*4882a593Smuzhiyun }
541*4882a593Smuzhiyun p->cnt += scnprintf(p->pbuf + p->cnt, p->limit - p->cnt,
542*4882a593Smuzhiyun "%lx %u %c %c%c:%d:%03u:%u",
543*4882a593Smuzhiyun ep->id, ep->tstamp, ep->type,
544*4882a593Smuzhiyun utype, udir, ep->busnum, ep->devnum, ep->epnum);
545*4882a593Smuzhiyun }
546*4882a593Smuzhiyun
mon_text_read_statset(struct mon_reader_text * rp,struct mon_text_ptr * p,const struct mon_event_text * ep)547*4882a593Smuzhiyun static void mon_text_read_statset(struct mon_reader_text *rp,
548*4882a593Smuzhiyun struct mon_text_ptr *p, const struct mon_event_text *ep)
549*4882a593Smuzhiyun {
550*4882a593Smuzhiyun
551*4882a593Smuzhiyun if (ep->setup_flag == 0) { /* Setup packet is present and captured */
552*4882a593Smuzhiyun p->cnt += scnprintf(p->pbuf + p->cnt, p->limit - p->cnt,
553*4882a593Smuzhiyun " s %02x %02x %04x %04x %04x",
554*4882a593Smuzhiyun ep->setup[0],
555*4882a593Smuzhiyun ep->setup[1],
556*4882a593Smuzhiyun (ep->setup[3] << 8) | ep->setup[2],
557*4882a593Smuzhiyun (ep->setup[5] << 8) | ep->setup[4],
558*4882a593Smuzhiyun (ep->setup[7] << 8) | ep->setup[6]);
559*4882a593Smuzhiyun } else if (ep->setup_flag != '-') { /* Unable to capture setup packet */
560*4882a593Smuzhiyun p->cnt += scnprintf(p->pbuf + p->cnt, p->limit - p->cnt,
561*4882a593Smuzhiyun " %c __ __ ____ ____ ____", ep->setup_flag);
562*4882a593Smuzhiyun } else { /* No setup for this kind of URB */
563*4882a593Smuzhiyun p->cnt += scnprintf(p->pbuf + p->cnt, p->limit - p->cnt,
564*4882a593Smuzhiyun " %d", ep->status);
565*4882a593Smuzhiyun }
566*4882a593Smuzhiyun }
567*4882a593Smuzhiyun
mon_text_read_intstat(struct mon_reader_text * rp,struct mon_text_ptr * p,const struct mon_event_text * ep)568*4882a593Smuzhiyun static void mon_text_read_intstat(struct mon_reader_text *rp,
569*4882a593Smuzhiyun struct mon_text_ptr *p, const struct mon_event_text *ep)
570*4882a593Smuzhiyun {
571*4882a593Smuzhiyun p->cnt += scnprintf(p->pbuf + p->cnt, p->limit - p->cnt,
572*4882a593Smuzhiyun " %d:%d", ep->status, ep->interval);
573*4882a593Smuzhiyun }
574*4882a593Smuzhiyun
mon_text_read_isostat(struct mon_reader_text * rp,struct mon_text_ptr * p,const struct mon_event_text * ep)575*4882a593Smuzhiyun static void mon_text_read_isostat(struct mon_reader_text *rp,
576*4882a593Smuzhiyun struct mon_text_ptr *p, const struct mon_event_text *ep)
577*4882a593Smuzhiyun {
578*4882a593Smuzhiyun if (ep->type == 'S') {
579*4882a593Smuzhiyun p->cnt += scnprintf(p->pbuf + p->cnt, p->limit - p->cnt,
580*4882a593Smuzhiyun " %d:%d:%d", ep->status, ep->interval, ep->start_frame);
581*4882a593Smuzhiyun } else {
582*4882a593Smuzhiyun p->cnt += scnprintf(p->pbuf + p->cnt, p->limit - p->cnt,
583*4882a593Smuzhiyun " %d:%d:%d:%d",
584*4882a593Smuzhiyun ep->status, ep->interval, ep->start_frame, ep->error_count);
585*4882a593Smuzhiyun }
586*4882a593Smuzhiyun }
587*4882a593Smuzhiyun
mon_text_read_isodesc(struct mon_reader_text * rp,struct mon_text_ptr * p,const struct mon_event_text * ep)588*4882a593Smuzhiyun static void mon_text_read_isodesc(struct mon_reader_text *rp,
589*4882a593Smuzhiyun struct mon_text_ptr *p, const struct mon_event_text *ep)
590*4882a593Smuzhiyun {
591*4882a593Smuzhiyun int ndesc; /* Display this many */
592*4882a593Smuzhiyun int i;
593*4882a593Smuzhiyun const struct mon_iso_desc *dp;
594*4882a593Smuzhiyun
595*4882a593Smuzhiyun p->cnt += scnprintf(p->pbuf + p->cnt, p->limit - p->cnt,
596*4882a593Smuzhiyun " %d", ep->numdesc);
597*4882a593Smuzhiyun ndesc = ep->numdesc;
598*4882a593Smuzhiyun if (ndesc > ISODESC_MAX)
599*4882a593Smuzhiyun ndesc = ISODESC_MAX;
600*4882a593Smuzhiyun if (ndesc < 0)
601*4882a593Smuzhiyun ndesc = 0;
602*4882a593Smuzhiyun dp = ep->isodesc;
603*4882a593Smuzhiyun for (i = 0; i < ndesc; i++) {
604*4882a593Smuzhiyun p->cnt += scnprintf(p->pbuf + p->cnt, p->limit - p->cnt,
605*4882a593Smuzhiyun " %d:%u:%u", dp->status, dp->offset, dp->length);
606*4882a593Smuzhiyun dp++;
607*4882a593Smuzhiyun }
608*4882a593Smuzhiyun }
609*4882a593Smuzhiyun
mon_text_read_data(struct mon_reader_text * rp,struct mon_text_ptr * p,const struct mon_event_text * ep)610*4882a593Smuzhiyun static void mon_text_read_data(struct mon_reader_text *rp,
611*4882a593Smuzhiyun struct mon_text_ptr *p, const struct mon_event_text *ep)
612*4882a593Smuzhiyun {
613*4882a593Smuzhiyun int data_len, i;
614*4882a593Smuzhiyun
615*4882a593Smuzhiyun if ((data_len = ep->length) > 0) {
616*4882a593Smuzhiyun if (ep->data_flag == 0) {
617*4882a593Smuzhiyun p->cnt += scnprintf(p->pbuf + p->cnt, p->limit - p->cnt,
618*4882a593Smuzhiyun " =");
619*4882a593Smuzhiyun if (data_len >= DATA_MAX)
620*4882a593Smuzhiyun data_len = DATA_MAX;
621*4882a593Smuzhiyun for (i = 0; i < data_len; i++) {
622*4882a593Smuzhiyun if (i % 4 == 0) {
623*4882a593Smuzhiyun p->cnt += scnprintf(p->pbuf + p->cnt,
624*4882a593Smuzhiyun p->limit - p->cnt,
625*4882a593Smuzhiyun " ");
626*4882a593Smuzhiyun }
627*4882a593Smuzhiyun p->cnt += scnprintf(p->pbuf + p->cnt,
628*4882a593Smuzhiyun p->limit - p->cnt,
629*4882a593Smuzhiyun "%02x", ep->data[i]);
630*4882a593Smuzhiyun }
631*4882a593Smuzhiyun p->cnt += scnprintf(p->pbuf + p->cnt, p->limit - p->cnt,
632*4882a593Smuzhiyun "\n");
633*4882a593Smuzhiyun } else {
634*4882a593Smuzhiyun p->cnt += scnprintf(p->pbuf + p->cnt, p->limit - p->cnt,
635*4882a593Smuzhiyun " %c\n", ep->data_flag);
636*4882a593Smuzhiyun }
637*4882a593Smuzhiyun } else {
638*4882a593Smuzhiyun p->cnt += scnprintf(p->pbuf + p->cnt, p->limit - p->cnt, "\n");
639*4882a593Smuzhiyun }
640*4882a593Smuzhiyun }
641*4882a593Smuzhiyun
mon_text_release(struct inode * inode,struct file * file)642*4882a593Smuzhiyun static int mon_text_release(struct inode *inode, struct file *file)
643*4882a593Smuzhiyun {
644*4882a593Smuzhiyun struct mon_reader_text *rp = file->private_data;
645*4882a593Smuzhiyun struct mon_bus *mbus;
646*4882a593Smuzhiyun /* unsigned long flags; */
647*4882a593Smuzhiyun struct list_head *p;
648*4882a593Smuzhiyun struct mon_event_text *ep;
649*4882a593Smuzhiyun
650*4882a593Smuzhiyun mutex_lock(&mon_lock);
651*4882a593Smuzhiyun mbus = inode->i_private;
652*4882a593Smuzhiyun
653*4882a593Smuzhiyun if (mbus->nreaders <= 0) {
654*4882a593Smuzhiyun printk(KERN_ERR TAG ": consistency error on close\n");
655*4882a593Smuzhiyun mutex_unlock(&mon_lock);
656*4882a593Smuzhiyun return 0;
657*4882a593Smuzhiyun }
658*4882a593Smuzhiyun mon_reader_del(mbus, &rp->r);
659*4882a593Smuzhiyun
660*4882a593Smuzhiyun /*
661*4882a593Smuzhiyun * In theory, e_list is protected by mbus->lock. However,
662*4882a593Smuzhiyun * after mon_reader_del has finished, the following is the case:
663*4882a593Smuzhiyun * - we are not on reader list anymore, so new events won't be added;
664*4882a593Smuzhiyun * - whole mbus may be dropped if it was orphaned.
665*4882a593Smuzhiyun * So, we better not touch mbus.
666*4882a593Smuzhiyun */
667*4882a593Smuzhiyun /* spin_lock_irqsave(&mbus->lock, flags); */
668*4882a593Smuzhiyun while (!list_empty(&rp->e_list)) {
669*4882a593Smuzhiyun p = rp->e_list.next;
670*4882a593Smuzhiyun ep = list_entry(p, struct mon_event_text, e_link);
671*4882a593Smuzhiyun list_del(p);
672*4882a593Smuzhiyun --rp->nevents;
673*4882a593Smuzhiyun kmem_cache_free(rp->e_slab, ep);
674*4882a593Smuzhiyun }
675*4882a593Smuzhiyun /* spin_unlock_irqrestore(&mbus->lock, flags); */
676*4882a593Smuzhiyun
677*4882a593Smuzhiyun kmem_cache_destroy(rp->e_slab);
678*4882a593Smuzhiyun kfree(rp->printf_buf);
679*4882a593Smuzhiyun kfree(rp);
680*4882a593Smuzhiyun
681*4882a593Smuzhiyun mutex_unlock(&mon_lock);
682*4882a593Smuzhiyun return 0;
683*4882a593Smuzhiyun }
684*4882a593Smuzhiyun
685*4882a593Smuzhiyun static const struct file_operations mon_fops_text_t = {
686*4882a593Smuzhiyun .owner = THIS_MODULE,
687*4882a593Smuzhiyun .open = mon_text_open,
688*4882a593Smuzhiyun .llseek = no_llseek,
689*4882a593Smuzhiyun .read = mon_text_read_t,
690*4882a593Smuzhiyun .release = mon_text_release,
691*4882a593Smuzhiyun };
692*4882a593Smuzhiyun
693*4882a593Smuzhiyun static const struct file_operations mon_fops_text_u = {
694*4882a593Smuzhiyun .owner = THIS_MODULE,
695*4882a593Smuzhiyun .open = mon_text_open,
696*4882a593Smuzhiyun .llseek = no_llseek,
697*4882a593Smuzhiyun .read = mon_text_read_u,
698*4882a593Smuzhiyun .release = mon_text_release,
699*4882a593Smuzhiyun };
700*4882a593Smuzhiyun
mon_text_add(struct mon_bus * mbus,const struct usb_bus * ubus)701*4882a593Smuzhiyun int mon_text_add(struct mon_bus *mbus, const struct usb_bus *ubus)
702*4882a593Smuzhiyun {
703*4882a593Smuzhiyun enum { NAMESZ = 10 };
704*4882a593Smuzhiyun char name[NAMESZ];
705*4882a593Smuzhiyun int busnum = ubus? ubus->busnum: 0;
706*4882a593Smuzhiyun int rc;
707*4882a593Smuzhiyun
708*4882a593Smuzhiyun if (mon_dir == NULL)
709*4882a593Smuzhiyun return 0;
710*4882a593Smuzhiyun
711*4882a593Smuzhiyun if (ubus != NULL) {
712*4882a593Smuzhiyun rc = snprintf(name, NAMESZ, "%dt", busnum);
713*4882a593Smuzhiyun if (rc <= 0 || rc >= NAMESZ)
714*4882a593Smuzhiyun goto err_print_t;
715*4882a593Smuzhiyun mbus->dent_t = debugfs_create_file(name, 0600, mon_dir, mbus,
716*4882a593Smuzhiyun &mon_fops_text_t);
717*4882a593Smuzhiyun }
718*4882a593Smuzhiyun
719*4882a593Smuzhiyun rc = snprintf(name, NAMESZ, "%du", busnum);
720*4882a593Smuzhiyun if (rc <= 0 || rc >= NAMESZ)
721*4882a593Smuzhiyun goto err_print_u;
722*4882a593Smuzhiyun mbus->dent_u = debugfs_create_file(name, 0600, mon_dir, mbus,
723*4882a593Smuzhiyun &mon_fops_text_u);
724*4882a593Smuzhiyun
725*4882a593Smuzhiyun rc = snprintf(name, NAMESZ, "%ds", busnum);
726*4882a593Smuzhiyun if (rc <= 0 || rc >= NAMESZ)
727*4882a593Smuzhiyun goto err_print_s;
728*4882a593Smuzhiyun mbus->dent_s = debugfs_create_file(name, 0600, mon_dir, mbus,
729*4882a593Smuzhiyun &mon_fops_stat);
730*4882a593Smuzhiyun
731*4882a593Smuzhiyun return 1;
732*4882a593Smuzhiyun
733*4882a593Smuzhiyun err_print_s:
734*4882a593Smuzhiyun debugfs_remove(mbus->dent_u);
735*4882a593Smuzhiyun mbus->dent_u = NULL;
736*4882a593Smuzhiyun err_print_u:
737*4882a593Smuzhiyun if (ubus != NULL) {
738*4882a593Smuzhiyun debugfs_remove(mbus->dent_t);
739*4882a593Smuzhiyun mbus->dent_t = NULL;
740*4882a593Smuzhiyun }
741*4882a593Smuzhiyun err_print_t:
742*4882a593Smuzhiyun return 0;
743*4882a593Smuzhiyun }
744*4882a593Smuzhiyun
mon_text_del(struct mon_bus * mbus)745*4882a593Smuzhiyun void mon_text_del(struct mon_bus *mbus)
746*4882a593Smuzhiyun {
747*4882a593Smuzhiyun debugfs_remove(mbus->dent_u);
748*4882a593Smuzhiyun debugfs_remove(mbus->dent_t);
749*4882a593Smuzhiyun debugfs_remove(mbus->dent_s);
750*4882a593Smuzhiyun }
751*4882a593Smuzhiyun
752*4882a593Smuzhiyun /*
753*4882a593Smuzhiyun * Slab interface: constructor.
754*4882a593Smuzhiyun */
mon_text_ctor(void * mem)755*4882a593Smuzhiyun static void mon_text_ctor(void *mem)
756*4882a593Smuzhiyun {
757*4882a593Smuzhiyun /*
758*4882a593Smuzhiyun * Nothing to initialize. No, really!
759*4882a593Smuzhiyun * So, we fill it with garbage to emulate a reused object.
760*4882a593Smuzhiyun */
761*4882a593Smuzhiyun memset(mem, 0xe5, sizeof(struct mon_event_text));
762*4882a593Smuzhiyun }
763*4882a593Smuzhiyun
mon_text_init(void)764*4882a593Smuzhiyun int __init mon_text_init(void)
765*4882a593Smuzhiyun {
766*4882a593Smuzhiyun mon_dir = debugfs_create_dir("usbmon", usb_debug_root);
767*4882a593Smuzhiyun return 0;
768*4882a593Smuzhiyun }
769*4882a593Smuzhiyun
mon_text_exit(void)770*4882a593Smuzhiyun void mon_text_exit(void)
771*4882a593Smuzhiyun {
772*4882a593Smuzhiyun debugfs_remove(mon_dir);
773*4882a593Smuzhiyun }
774