xref: /OK3568_Linux_fs/kernel/drivers/usb/mon/mon_text.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
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