diff options
author | Mauro Carvalho Chehab <mchehab@redhat.com> | 2012-08-13 23:13:22 -0400 |
---|---|---|
committer | Mauro Carvalho Chehab <mchehab@redhat.com> | 2012-08-15 15:25:07 -0400 |
commit | 0c0d06cac63ee327ceaab4b5ffe2206574ab86bd (patch) | |
tree | e759f0dc3185d97f2a0c6b5cd5e32ea6faa74d40 /drivers/media/usb/gspca/benq.c | |
parent | 84cfe9e79bd5ac11c963f4841158454fefa872f6 (diff) |
[media] rename most media/video usb drivers to media/usb
Rename all USB drivers with their own directory under
drivers/media/video into drivers/media/usb and update the
building system.
Signed-off-by: Mauro Carvalho Chehab <mchehab@redhat.com>
Diffstat (limited to 'drivers/media/usb/gspca/benq.c')
-rw-r--r-- | drivers/media/usb/gspca/benq.c | 289 |
1 files changed, 289 insertions, 0 deletions
diff --git a/drivers/media/usb/gspca/benq.c b/drivers/media/usb/gspca/benq.c new file mode 100644 index 000000000000..352f32190e68 --- /dev/null +++ b/drivers/media/usb/gspca/benq.c | |||
@@ -0,0 +1,289 @@ | |||
1 | /* | ||
2 | * Benq DC E300 subdriver | ||
3 | * | ||
4 | * Copyright (C) 2009 Jean-Francois Moine (http://moinejf.free.fr) | ||
5 | * | ||
6 | * This program is free software; you can redistribute it and/or modify | ||
7 | * it under the terms of the GNU General Public License as published by | ||
8 | * the Free Software Foundation; either version 2 of the License, or | ||
9 | * any later version. | ||
10 | * | ||
11 | * This program is distributed in the hope that it will be useful, | ||
12 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
13 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
14 | * GNU General Public License for more details. | ||
15 | * | ||
16 | * You should have received a copy of the GNU General Public License | ||
17 | * along with this program; if not, write to the Free Software | ||
18 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | ||
19 | */ | ||
20 | |||
21 | #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt | ||
22 | |||
23 | #define MODULE_NAME "benq" | ||
24 | |||
25 | #include "gspca.h" | ||
26 | |||
27 | MODULE_AUTHOR("Jean-Francois Moine <http://moinejf.free.fr>"); | ||
28 | MODULE_DESCRIPTION("Benq DC E300 USB Camera Driver"); | ||
29 | MODULE_LICENSE("GPL"); | ||
30 | |||
31 | /* specific webcam descriptor */ | ||
32 | struct sd { | ||
33 | struct gspca_dev gspca_dev; /* !! must be the first item */ | ||
34 | }; | ||
35 | |||
36 | static const struct v4l2_pix_format vga_mode[] = { | ||
37 | {320, 240, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE, | ||
38 | .bytesperline = 320, | ||
39 | .sizeimage = 320 * 240 * 3 / 8 + 590, | ||
40 | .colorspace = V4L2_COLORSPACE_JPEG}, | ||
41 | }; | ||
42 | |||
43 | static void sd_isoc_irq(struct urb *urb); | ||
44 | |||
45 | /* -- write a register -- */ | ||
46 | static void reg_w(struct gspca_dev *gspca_dev, | ||
47 | u16 value, u16 index) | ||
48 | { | ||
49 | struct usb_device *dev = gspca_dev->dev; | ||
50 | int ret; | ||
51 | |||
52 | if (gspca_dev->usb_err < 0) | ||
53 | return; | ||
54 | ret = usb_control_msg(dev, usb_sndctrlpipe(dev, 0), | ||
55 | 0x02, | ||
56 | USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE, | ||
57 | value, | ||
58 | index, | ||
59 | NULL, | ||
60 | 0, | ||
61 | 500); | ||
62 | if (ret < 0) { | ||
63 | pr_err("reg_w err %d\n", ret); | ||
64 | gspca_dev->usb_err = ret; | ||
65 | } | ||
66 | } | ||
67 | |||
68 | /* this function is called at probe time */ | ||
69 | static int sd_config(struct gspca_dev *gspca_dev, | ||
70 | const struct usb_device_id *id) | ||
71 | { | ||
72 | gspca_dev->cam.cam_mode = vga_mode; | ||
73 | gspca_dev->cam.nmodes = ARRAY_SIZE(vga_mode); | ||
74 | gspca_dev->cam.no_urb_create = 1; | ||
75 | return 0; | ||
76 | } | ||
77 | |||
78 | /* this function is called at probe and resume time */ | ||
79 | static int sd_init(struct gspca_dev *gspca_dev) | ||
80 | { | ||
81 | return 0; | ||
82 | } | ||
83 | |||
84 | /* -- start the camera -- */ | ||
85 | static int sd_start(struct gspca_dev *gspca_dev) | ||
86 | { | ||
87 | struct urb *urb; | ||
88 | int i, n; | ||
89 | |||
90 | /* create 4 URBs - 2 on endpoint 0x83 and 2 on 0x082 */ | ||
91 | #if MAX_NURBS < 4 | ||
92 | #error "Not enough URBs in the gspca table" | ||
93 | #endif | ||
94 | #define SD_PKT_SZ 64 | ||
95 | #define SD_NPKT 32 | ||
96 | for (n = 0; n < 4; n++) { | ||
97 | urb = usb_alloc_urb(SD_NPKT, GFP_KERNEL); | ||
98 | if (!urb) { | ||
99 | pr_err("usb_alloc_urb failed\n"); | ||
100 | return -ENOMEM; | ||
101 | } | ||
102 | gspca_dev->urb[n] = urb; | ||
103 | urb->transfer_buffer = usb_alloc_coherent(gspca_dev->dev, | ||
104 | SD_PKT_SZ * SD_NPKT, | ||
105 | GFP_KERNEL, | ||
106 | &urb->transfer_dma); | ||
107 | |||
108 | if (urb->transfer_buffer == NULL) { | ||
109 | pr_err("usb_alloc_coherent failed\n"); | ||
110 | return -ENOMEM; | ||
111 | } | ||
112 | urb->dev = gspca_dev->dev; | ||
113 | urb->context = gspca_dev; | ||
114 | urb->transfer_buffer_length = SD_PKT_SZ * SD_NPKT; | ||
115 | urb->pipe = usb_rcvisocpipe(gspca_dev->dev, | ||
116 | n & 1 ? 0x82 : 0x83); | ||
117 | urb->transfer_flags = URB_ISO_ASAP | ||
118 | | URB_NO_TRANSFER_DMA_MAP; | ||
119 | urb->interval = 1; | ||
120 | urb->complete = sd_isoc_irq; | ||
121 | urb->number_of_packets = SD_NPKT; | ||
122 | for (i = 0; i < SD_NPKT; i++) { | ||
123 | urb->iso_frame_desc[i].length = SD_PKT_SZ; | ||
124 | urb->iso_frame_desc[i].offset = SD_PKT_SZ * i; | ||
125 | } | ||
126 | } | ||
127 | |||
128 | return gspca_dev->usb_err; | ||
129 | } | ||
130 | |||
131 | static void sd_stopN(struct gspca_dev *gspca_dev) | ||
132 | { | ||
133 | struct usb_interface *intf; | ||
134 | |||
135 | reg_w(gspca_dev, 0x003c, 0x0003); | ||
136 | reg_w(gspca_dev, 0x003c, 0x0004); | ||
137 | reg_w(gspca_dev, 0x003c, 0x0005); | ||
138 | reg_w(gspca_dev, 0x003c, 0x0006); | ||
139 | reg_w(gspca_dev, 0x003c, 0x0007); | ||
140 | |||
141 | intf = usb_ifnum_to_if(gspca_dev->dev, gspca_dev->iface); | ||
142 | usb_set_interface(gspca_dev->dev, gspca_dev->iface, | ||
143 | intf->num_altsetting - 1); | ||
144 | } | ||
145 | |||
146 | static void sd_pkt_scan(struct gspca_dev *gspca_dev, | ||
147 | u8 *data, /* isoc packet */ | ||
148 | int len) /* iso packet length */ | ||
149 | { | ||
150 | /* unused */ | ||
151 | } | ||
152 | |||
153 | /* reception of an URB */ | ||
154 | static void sd_isoc_irq(struct urb *urb) | ||
155 | { | ||
156 | struct gspca_dev *gspca_dev = (struct gspca_dev *) urb->context; | ||
157 | struct urb *urb0; | ||
158 | u8 *data; | ||
159 | int i, st; | ||
160 | |||
161 | PDEBUG(D_PACK, "sd isoc irq"); | ||
162 | if (!gspca_dev->streaming) | ||
163 | return; | ||
164 | if (urb->status != 0) { | ||
165 | if (urb->status == -ESHUTDOWN) | ||
166 | return; /* disconnection */ | ||
167 | #ifdef CONFIG_PM | ||
168 | if (gspca_dev->frozen) | ||
169 | return; | ||
170 | #endif | ||
171 | pr_err("urb status: %d\n", urb->status); | ||
172 | return; | ||
173 | } | ||
174 | |||
175 | /* if this is a control URN (ep 0x83), wait */ | ||
176 | if (urb == gspca_dev->urb[0] || urb == gspca_dev->urb[2]) | ||
177 | return; | ||
178 | |||
179 | /* scan both received URBs */ | ||
180 | if (urb == gspca_dev->urb[1]) | ||
181 | urb0 = gspca_dev->urb[0]; | ||
182 | else | ||
183 | urb0 = gspca_dev->urb[2]; | ||
184 | for (i = 0; i < urb->number_of_packets; i++) { | ||
185 | |||
186 | /* check the packet status and length */ | ||
187 | if (urb0->iso_frame_desc[i].actual_length != SD_PKT_SZ | ||
188 | || urb->iso_frame_desc[i].actual_length != SD_PKT_SZ) { | ||
189 | PDEBUG(D_ERR, "ISOC bad lengths %d / %d", | ||
190 | urb0->iso_frame_desc[i].actual_length, | ||
191 | urb->iso_frame_desc[i].actual_length); | ||
192 | gspca_dev->last_packet_type = DISCARD_PACKET; | ||
193 | continue; | ||
194 | } | ||
195 | st = urb0->iso_frame_desc[i].status; | ||
196 | if (st == 0) | ||
197 | st = urb->iso_frame_desc[i].status; | ||
198 | if (st) { | ||
199 | pr_err("ISOC data error: [%d] status=%d\n", | ||
200 | i, st); | ||
201 | gspca_dev->last_packet_type = DISCARD_PACKET; | ||
202 | continue; | ||
203 | } | ||
204 | |||
205 | /* | ||
206 | * The images are received in URBs of different endpoints | ||
207 | * (0x83 and 0x82). | ||
208 | * Image pieces in URBs of ep 0x83 are continuated in URBs of | ||
209 | * ep 0x82 of the same index. | ||
210 | * The packets in the URBs of endpoint 0x83 start with: | ||
211 | * - 80 ba/bb 00 00 = start of image followed by 'ff d8' | ||
212 | * - 04 ba/bb oo oo = image piece | ||
213 | * where 'oo oo' is the image offset | ||
214 | (not cheked) | ||
215 | * - (other -> bad frame) | ||
216 | * The images are JPEG encoded with full header and | ||
217 | * normal ff escape. | ||
218 | * The end of image ('ff d9') may occur in any URB. | ||
219 | * (not cheked) | ||
220 | */ | ||
221 | data = (u8 *) urb0->transfer_buffer | ||
222 | + urb0->iso_frame_desc[i].offset; | ||
223 | if (data[0] == 0x80 && (data[1] & 0xfe) == 0xba) { | ||
224 | |||
225 | /* new image */ | ||
226 | gspca_frame_add(gspca_dev, LAST_PACKET, | ||
227 | NULL, 0); | ||
228 | gspca_frame_add(gspca_dev, FIRST_PACKET, | ||
229 | data + 4, SD_PKT_SZ - 4); | ||
230 | } else if (data[0] == 0x04 && (data[1] & 0xfe) == 0xba) { | ||
231 | gspca_frame_add(gspca_dev, INTER_PACKET, | ||
232 | data + 4, SD_PKT_SZ - 4); | ||
233 | } else { | ||
234 | gspca_dev->last_packet_type = DISCARD_PACKET; | ||
235 | continue; | ||
236 | } | ||
237 | data = (u8 *) urb->transfer_buffer | ||
238 | + urb->iso_frame_desc[i].offset; | ||
239 | gspca_frame_add(gspca_dev, INTER_PACKET, | ||
240 | data, SD_PKT_SZ); | ||
241 | } | ||
242 | |||
243 | /* resubmit the URBs */ | ||
244 | st = usb_submit_urb(urb0, GFP_ATOMIC); | ||
245 | if (st < 0) | ||
246 | pr_err("usb_submit_urb(0) ret %d\n", st); | ||
247 | st = usb_submit_urb(urb, GFP_ATOMIC); | ||
248 | if (st < 0) | ||
249 | pr_err("usb_submit_urb() ret %d\n", st); | ||
250 | } | ||
251 | |||
252 | /* sub-driver description */ | ||
253 | static const struct sd_desc sd_desc = { | ||
254 | .name = MODULE_NAME, | ||
255 | .config = sd_config, | ||
256 | .init = sd_init, | ||
257 | .start = sd_start, | ||
258 | .stopN = sd_stopN, | ||
259 | .pkt_scan = sd_pkt_scan, | ||
260 | }; | ||
261 | |||
262 | /* -- module initialisation -- */ | ||
263 | static const struct usb_device_id device_table[] = { | ||
264 | {USB_DEVICE(0x04a5, 0x3035)}, | ||
265 | {} | ||
266 | }; | ||
267 | MODULE_DEVICE_TABLE(usb, device_table); | ||
268 | |||
269 | /* -- device connect -- */ | ||
270 | static int sd_probe(struct usb_interface *intf, | ||
271 | const struct usb_device_id *id) | ||
272 | { | ||
273 | return gspca_dev_probe(intf, id, &sd_desc, sizeof(struct sd), | ||
274 | THIS_MODULE); | ||
275 | } | ||
276 | |||
277 | static struct usb_driver sd_driver = { | ||
278 | .name = MODULE_NAME, | ||
279 | .id_table = device_table, | ||
280 | .probe = sd_probe, | ||
281 | .disconnect = gspca_disconnect, | ||
282 | #ifdef CONFIG_PM | ||
283 | .suspend = gspca_suspend, | ||
284 | .resume = gspca_resume, | ||
285 | .reset_resume = gspca_resume, | ||
286 | #endif | ||
287 | }; | ||
288 | |||
289 | module_usb_driver(sd_driver); | ||