b482f4fc7b3146781df8e74df5e35ce09d80b8c9
[linux-2.6.git] / drivers / media / video / uvc / uvc_status.c
1 /*
2  *      uvc_status.c  --  USB Video Class driver - Status endpoint
3  *
4  *      Copyright (C) 2007-2008
5  *          Laurent Pinchart (laurent.pinchart@skynet.be)
6  *
7  *      This program is free software; you can redistribute it and/or modify
8  *      it under the terms of the GNU General Public License as published by
9  *      the Free Software Foundation; either version 2 of the License, or
10  *      (at your option) any later version.
11  *
12  */
13
14 #include <linux/kernel.h>
15 #include <linux/input.h>
16 #include <linux/usb.h>
17 #include <linux/usb/input.h>
18
19 #include "uvcvideo.h"
20
21 /* --------------------------------------------------------------------------
22  * Input device
23  */
24 #ifdef CONFIG_USB_VIDEO_CLASS_INPUT_EVDEV
25 static int uvc_input_init(struct uvc_device *dev)
26 {
27         struct usb_device *udev = dev->udev;
28         struct input_dev *input;
29         char *phys = NULL;
30         int ret;
31
32         input = input_allocate_device();
33         if (input == NULL)
34                 return -ENOMEM;
35
36         phys = kmalloc(6 + strlen(udev->bus->bus_name) + strlen(udev->devpath),
37                         GFP_KERNEL);
38         if (phys == NULL) {
39                 ret = -ENOMEM;
40                 goto error;
41         }
42         sprintf(phys, "usb-%s-%s", udev->bus->bus_name, udev->devpath);
43
44         input->name = dev->name;
45         input->phys = phys;
46         usb_to_input_id(udev, &input->id);
47         input->dev.parent = &dev->intf->dev;
48
49         set_bit(EV_KEY, input->evbit);
50         set_bit(BTN_0, input->keybit);
51
52         if ((ret = input_register_device(input)) < 0)
53                 goto error;
54
55         dev->input = input;
56         return 0;
57
58 error:
59         input_free_device(input);
60         kfree(phys);
61         return ret;
62 }
63
64 static void uvc_input_cleanup(struct uvc_device *dev)
65 {
66         if (dev->input)
67                 input_unregister_device(dev->input);
68 }
69
70 static void uvc_input_report_key(struct uvc_device *dev, unsigned int code,
71         int value)
72 {
73         if (dev->input)
74                 input_report_key(dev->input, code, value);
75 }
76
77 #else
78 #define uvc_input_init(dev)
79 #define uvc_input_cleanup(dev)
80 #define uvc_input_report_key(dev, code, value)
81 #endif /* CONFIG_USB_VIDEO_CLASS_INPUT_EVDEV */
82
83 /* --------------------------------------------------------------------------
84  * Status interrupt endpoint
85  */
86 static void uvc_event_streaming(struct uvc_device *dev, __u8 *data, int len)
87 {
88         if (len < 3) {
89                 uvc_trace(UVC_TRACE_STATUS, "Invalid streaming status event "
90                                 "received.\n");
91                 return;
92         }
93
94         if (data[2] == 0) {
95                 if (len < 4)
96                         return;
97                 uvc_trace(UVC_TRACE_STATUS, "Button (intf %u) %s len %d\n",
98                         data[1], data[3] ? "pressed" : "released", len);
99                 uvc_input_report_key(dev, BTN_0, data[3]);
100         } else {
101                 uvc_trace(UVC_TRACE_STATUS, "Stream %u error event %02x %02x "
102                         "len %d.\n", data[1], data[2], data[3], len);
103         }
104 }
105
106 static void uvc_event_control(struct uvc_device *dev, __u8 *data, int len)
107 {
108         char *attrs[3] = { "value", "info", "failure" };
109
110         if (len < 6 || data[2] != 0 || data[4] > 2) {
111                 uvc_trace(UVC_TRACE_STATUS, "Invalid control status event "
112                                 "received.\n");
113                 return;
114         }
115
116         uvc_trace(UVC_TRACE_STATUS, "Control %u/%u %s change len %d.\n",
117                 data[1], data[3], attrs[data[4]], len);
118 }
119
120 static void uvc_status_complete(struct urb *urb)
121 {
122         struct uvc_device *dev = urb->context;
123         int len, ret;
124
125         switch (urb->status) {
126         case 0:
127                 break;
128
129         case -ENOENT:           /* usb_kill_urb() called. */
130         case -ECONNRESET:       /* usb_unlink_urb() called. */
131         case -ESHUTDOWN:        /* The endpoint is being disabled. */
132         case -EPROTO:           /* Device is disconnected (reported by some
133                                  * host controller). */
134                 return;
135
136         default:
137                 uvc_printk(KERN_WARNING, "Non-zero status (%d) in status "
138                         "completion handler.\n", urb->status);
139                 return;
140         }
141
142         len = urb->actual_length;
143         if (len > 0) {
144                 switch (dev->status[0] & 0x0f) {
145                 case UVC_STATUS_TYPE_CONTROL:
146                         uvc_event_control(dev, dev->status, len);
147                         break;
148
149                 case UVC_STATUS_TYPE_STREAMING:
150                         uvc_event_streaming(dev, dev->status, len);
151                         break;
152
153                 default:
154                         uvc_printk(KERN_INFO, "unknown event type %u.\n",
155                                 dev->status[0]);
156                         break;
157                 }
158         }
159
160         /* Resubmit the URB. */
161         urb->interval = dev->int_ep->desc.bInterval;
162         if ((ret = usb_submit_urb(urb, GFP_ATOMIC)) < 0) {
163                 uvc_printk(KERN_ERR, "Failed to resubmit status URB (%d).\n",
164                         ret);
165         }
166 }
167
168 int uvc_status_init(struct uvc_device *dev)
169 {
170         struct usb_host_endpoint *ep = dev->int_ep;
171         unsigned int pipe;
172         int interval;
173
174         if (ep == NULL)
175                 return 0;
176
177         uvc_input_init(dev);
178
179         dev->status = kzalloc(UVC_MAX_STATUS_SIZE, GFP_KERNEL);
180         if (dev->status == NULL)
181                 return -ENOMEM;
182
183         dev->int_urb = usb_alloc_urb(0, GFP_KERNEL);
184         if (dev->int_urb == NULL) {
185                 kfree(dev->status);
186                 return -ENOMEM;
187         }
188
189         pipe = usb_rcvintpipe(dev->udev, ep->desc.bEndpointAddress);
190
191         /* For high-speed interrupt endpoints, the bInterval value is used as
192          * an exponent of two. Some developers forgot about it.
193          */
194         interval = ep->desc.bInterval;
195         if (interval > 16 && dev->udev->speed == USB_SPEED_HIGH &&
196             (dev->quirks & UVC_QUIRK_STATUS_INTERVAL))
197                 interval = fls(interval) - 1;
198
199         usb_fill_int_urb(dev->int_urb, dev->udev, pipe,
200                 dev->status, UVC_MAX_STATUS_SIZE, uvc_status_complete,
201                 dev, interval);
202
203         return usb_submit_urb(dev->int_urb, GFP_KERNEL);
204 }
205
206 void uvc_status_cleanup(struct uvc_device *dev)
207 {
208         usb_kill_urb(dev->int_urb);
209         usb_free_urb(dev->int_urb);
210         kfree(dev->status);
211         uvc_input_cleanup(dev);
212 }
213
214 int uvc_status_suspend(struct uvc_device *dev)
215 {
216         usb_kill_urb(dev->int_urb);
217         return 0;
218 }
219
220 int uvc_status_resume(struct uvc_device *dev)
221 {
222         if (dev->int_urb == NULL)
223                 return 0;
224
225         return usb_submit_urb(dev->int_urb, GFP_NOIO);
226 }
227