2 * Benq DC E300 subdriver
4 * Copyright (C) 2009 Jean-Francois Moine (http://moinejf.free.fr)
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
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.
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
21 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
23 #define MODULE_NAME "benq"
27 MODULE_AUTHOR("Jean-Francois Moine <http://moinejf.free.fr>");
28 MODULE_DESCRIPTION("Benq DC E300 USB Camera Driver");
29 MODULE_LICENSE("GPL");
31 /* specific webcam descriptor */
33 struct gspca_dev gspca_dev
; /* !! must be the first item */
36 /* V4L2 controls supported by the driver */
37 static const struct ctrl sd_ctrls
[] = {
40 static const struct v4l2_pix_format vga_mode
[] = {
41 {320, 240, V4L2_PIX_FMT_JPEG
, V4L2_FIELD_NONE
,
43 .sizeimage
= 320 * 240 * 3 / 8 + 590,
44 .colorspace
= V4L2_COLORSPACE_JPEG
},
47 static void sd_isoc_irq(struct urb
*urb
);
49 /* -- write a register -- */
50 static void reg_w(struct gspca_dev
*gspca_dev
,
53 struct usb_device
*dev
= gspca_dev
->dev
;
56 if (gspca_dev
->usb_err
< 0)
58 ret
= usb_control_msg(dev
, usb_sndctrlpipe(dev
, 0),
60 USB_DIR_OUT
| USB_TYPE_VENDOR
| USB_RECIP_DEVICE
,
67 pr_err("reg_w err %d\n", ret
);
68 gspca_dev
->usb_err
= ret
;
72 /* this function is called at probe time */
73 static int sd_config(struct gspca_dev
*gspca_dev
,
74 const struct usb_device_id
*id
)
76 gspca_dev
->cam
.cam_mode
= vga_mode
;
77 gspca_dev
->cam
.nmodes
= ARRAY_SIZE(vga_mode
);
78 gspca_dev
->cam
.no_urb_create
= 1;
79 gspca_dev
->cam
.reverse_alts
= 1;
83 /* this function is called at probe and resume time */
84 static int sd_init(struct gspca_dev
*gspca_dev
)
89 static int sd_isoc_init(struct gspca_dev
*gspca_dev
)
93 ret
= usb_set_interface(gspca_dev
->dev
, gspca_dev
->iface
,
94 gspca_dev
->nbalt
- 1);
96 pr_err("usb_set_interface failed\n");
99 /* reg_w(gspca_dev, 0x0003, 0x0002); */
103 /* -- start the camera -- */
104 static int sd_start(struct gspca_dev
*gspca_dev
)
109 /* create 4 URBs - 2 on endpoint 0x83 and 2 on 0x082 */
111 #error "Not enough URBs in the gspca table"
115 for (n
= 0; n
< 4; n
++) {
116 urb
= usb_alloc_urb(SD_NPKT
, GFP_KERNEL
);
118 pr_err("usb_alloc_urb failed\n");
121 gspca_dev
->urb
[n
] = urb
;
122 urb
->transfer_buffer
= usb_alloc_coherent(gspca_dev
->dev
,
127 if (urb
->transfer_buffer
== NULL
) {
128 pr_err("usb_alloc_coherent failed\n");
131 urb
->dev
= gspca_dev
->dev
;
132 urb
->context
= gspca_dev
;
133 urb
->transfer_buffer_length
= SD_PKT_SZ
* SD_NPKT
;
134 urb
->pipe
= usb_rcvisocpipe(gspca_dev
->dev
,
135 n
& 1 ? 0x82 : 0x83);
136 urb
->transfer_flags
= URB_ISO_ASAP
137 | URB_NO_TRANSFER_DMA_MAP
;
139 urb
->complete
= sd_isoc_irq
;
140 urb
->number_of_packets
= SD_NPKT
;
141 for (i
= 0; i
< SD_NPKT
; i
++) {
142 urb
->iso_frame_desc
[i
].length
= SD_PKT_SZ
;
143 urb
->iso_frame_desc
[i
].offset
= SD_PKT_SZ
* i
;
147 return gspca_dev
->usb_err
;
150 static void sd_stopN(struct gspca_dev
*gspca_dev
)
152 reg_w(gspca_dev
, 0x003c, 0x0003);
153 reg_w(gspca_dev
, 0x003c, 0x0004);
154 reg_w(gspca_dev
, 0x003c, 0x0005);
155 reg_w(gspca_dev
, 0x003c, 0x0006);
156 reg_w(gspca_dev
, 0x003c, 0x0007);
157 usb_set_interface(gspca_dev
->dev
, gspca_dev
->iface
,
158 gspca_dev
->nbalt
- 1);
161 static void sd_pkt_scan(struct gspca_dev
*gspca_dev
,
162 u8
*data
, /* isoc packet */
163 int len
) /* iso packet length */
168 /* reception of an URB */
169 static void sd_isoc_irq(struct urb
*urb
)
171 struct gspca_dev
*gspca_dev
= (struct gspca_dev
*) urb
->context
;
176 PDEBUG(D_PACK
, "sd isoc irq");
177 if (!gspca_dev
->streaming
)
179 if (urb
->status
!= 0) {
180 if (urb
->status
== -ESHUTDOWN
)
181 return; /* disconnection */
183 if (gspca_dev
->frozen
)
186 pr_err("urb status: %d\n", urb
->status
);
190 /* if this is a control URN (ep 0x83), wait */
191 if (urb
== gspca_dev
->urb
[0] || urb
== gspca_dev
->urb
[2])
194 /* scan both received URBs */
195 if (urb
== gspca_dev
->urb
[1])
196 urb0
= gspca_dev
->urb
[0];
198 urb0
= gspca_dev
->urb
[2];
199 for (i
= 0; i
< urb
->number_of_packets
; i
++) {
201 /* check the packet status and length */
202 if (urb0
->iso_frame_desc
[i
].actual_length
!= SD_PKT_SZ
203 || urb
->iso_frame_desc
[i
].actual_length
!= SD_PKT_SZ
) {
204 PDEBUG(D_ERR
, "ISOC bad lengths %d / %d",
205 urb0
->iso_frame_desc
[i
].actual_length
,
206 urb
->iso_frame_desc
[i
].actual_length
);
207 gspca_dev
->last_packet_type
= DISCARD_PACKET
;
210 st
= urb0
->iso_frame_desc
[i
].status
;
212 st
= urb
->iso_frame_desc
[i
].status
;
214 pr_err("ISOC data error: [%d] status=%d\n",
216 gspca_dev
->last_packet_type
= DISCARD_PACKET
;
221 * The images are received in URBs of different endpoints
223 * Image pieces in URBs of ep 0x83 are continuated in URBs of
224 * ep 0x82 of the same index.
225 * The packets in the URBs of endpoint 0x83 start with:
226 * - 80 ba/bb 00 00 = start of image followed by 'ff d8'
227 * - 04 ba/bb oo oo = image piece
228 * where 'oo oo' is the image offset
230 * - (other -> bad frame)
231 * The images are JPEG encoded with full header and
233 * The end of image ('ff d9') may occur in any URB.
236 data
= (u8
*) urb0
->transfer_buffer
237 + urb0
->iso_frame_desc
[i
].offset
;
238 if (data
[0] == 0x80 && (data
[1] & 0xfe) == 0xba) {
241 gspca_frame_add(gspca_dev
, LAST_PACKET
,
243 gspca_frame_add(gspca_dev
, FIRST_PACKET
,
244 data
+ 4, SD_PKT_SZ
- 4);
245 } else if (data
[0] == 0x04 && (data
[1] & 0xfe) == 0xba) {
246 gspca_frame_add(gspca_dev
, INTER_PACKET
,
247 data
+ 4, SD_PKT_SZ
- 4);
249 gspca_dev
->last_packet_type
= DISCARD_PACKET
;
252 data
= (u8
*) urb
->transfer_buffer
253 + urb
->iso_frame_desc
[i
].offset
;
254 gspca_frame_add(gspca_dev
, INTER_PACKET
,
258 /* resubmit the URBs */
259 st
= usb_submit_urb(urb0
, GFP_ATOMIC
);
261 pr_err("usb_submit_urb(0) ret %d\n", st
);
262 st
= usb_submit_urb(urb
, GFP_ATOMIC
);
264 pr_err("usb_submit_urb() ret %d\n", st
);
267 /* sub-driver description */
268 static const struct sd_desc sd_desc
= {
271 .nctrls
= ARRAY_SIZE(sd_ctrls
),
274 .isoc_init
= sd_isoc_init
,
277 .pkt_scan
= sd_pkt_scan
,
280 /* -- module initialisation -- */
281 static const struct usb_device_id device_table
[] = {
282 {USB_DEVICE(0x04a5, 0x3035)},
285 MODULE_DEVICE_TABLE(usb
, device_table
);
287 /* -- device connect -- */
288 static int sd_probe(struct usb_interface
*intf
,
289 const struct usb_device_id
*id
)
291 return gspca_dev_probe(intf
, id
, &sd_desc
, sizeof(struct sd
),
295 static struct usb_driver sd_driver
= {
297 .id_table
= device_table
,
299 .disconnect
= gspca_disconnect
,
301 .suspend
= gspca_suspend
,
302 .resume
= gspca_resume
,
306 /* -- module insert / remove -- */
307 static int __init
sd_mod_init(void)
309 return usb_register(&sd_driver
);
311 static void __exit
sd_mod_exit(void)
313 usb_deregister(&sd_driver
);
316 module_init(sd_mod_init
);
317 module_exit(sd_mod_exit
);