2 * This program is free software; you can redistribute it and/or modify
3 * it under the terms of the GNU General Public License as published by
4 * the Free Software Foundation; either version 2, or (at your option)
7 * This program is distributed in the hope that it will be useful,
8 * but WITHOUT ANY WARRANTY; without even the implied warranty of
9 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
10 * GNU General Public License for more details.
12 * You should have received a copy of the GNU General Public License
13 * along with this program; if not, write to the Free Software
14 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
19 #include <linux/config.h>
20 #include <linux/videodev.h>
21 #include <linux/usb.h>
23 /* Most helpful debugging aid */
24 #define assert(expr) ((void) ((expr) ? 0 : (err("assert failed at line %d",__LINE__))))
26 #define USBVIDEO_REPORT_STATS 1 /* Set to 0 to block statistics on close */
28 /* Bit flags (options) */
29 #define FLAGS_RETRY_VIDIOCSYNC (1 << 0)
30 #define FLAGS_MONOCHROME (1 << 1)
31 #define FLAGS_DISPLAY_HINTS (1 << 2)
32 #define FLAGS_OVERLAY_STATS (1 << 3)
33 #define FLAGS_FORCE_TESTPATTERN (1 << 4)
34 #define FLAGS_SEPARATE_FRAMES (1 << 5)
35 #define FLAGS_CLEAN_FRAMES (1 << 6)
36 #define FLAGS_NO_DECODING (1 << 7)
38 /* Bit flags for frames (apply to the frame where they are specified) */
39 #define USBVIDEO_FRAME_FLAG_SOFTWARE_CONTRAST (1 << 0)
41 /* Camera capabilities (maximum) */
42 #define CAMERA_URB_FRAMES 32
43 #define CAMERA_MAX_ISO_PACKET 1023 /* 1022 actually sent by camera */
44 #define FRAMES_PER_DESC (CAMERA_URB_FRAMES)
45 #define FRAME_SIZE_PER_DESC (CAMERA_MAX_ISO_PACKET)
47 /* This macro restricts an int variable to an inclusive range */
48 #define RESTRICT_TO_RANGE(v,mi,ma) { if ((v) < (mi)) (v) = (mi); else if ((v) > (ma)) (v) = (ma); }
50 #define V4L_BYTES_PER_PIXEL 3 /* Because we produce RGB24 */
53 * Use this macro to construct constants for different video sizes.
54 * We have to deal with different video sizes that have to be
55 * configured in the device or compared against when we receive
56 * a data. Normally one would define a bunch of VIDEOSIZE_x_by_y
57 * #defines and that's the end of story. However this solution
58 * does not allow to convert between real pixel sizes and the
59 * constant (integer) value that may be used to tag a frame or
60 * whatever. The set of macros below constructs videosize constants
61 * from the pixel size and allows to reconstruct the pixel size
62 * from the combined value later.
64 #define VIDEOSIZE(x,y) (((x) & 0xFFFFL) | (((y) & 0xFFFFL) << 16))
65 #define VIDEOSIZE_X(vs) ((vs) & 0xFFFFL)
66 #define VIDEOSIZE_Y(vs) (((vs) >> 16) & 0xFFFFL)
67 typedef unsigned long videosize_t;
70 * This macro checks if the camera is still operational. The 'uvd'
71 * pointer must be valid, uvd->dev must be valid, we are not
72 * removing the device and the device has not erred on us.
74 #define CAMERA_IS_OPERATIONAL(uvd) (\
76 ((uvd)->dev != NULL) && \
77 ((uvd)->last_error == 0) && \
78 (!(uvd)->remove_pending))
81 * We use macros to do YUV -> RGB conversion because this is
82 * very important for speed and totally unimportant for size.
84 * YUV -> RGB Conversion
85 * ---------------------
87 * B = 1.164*(Y-16) + 2.018*(V-128)
88 * G = 1.164*(Y-16) - 0.813*(U-128) - 0.391*(V-128)
89 * R = 1.164*(Y-16) + 1.596*(U-128)
91 * If you fancy integer arithmetics (as you should), hear this:
93 * 65536*B = 76284*(Y-16) + 132252*(V-128)
94 * 65536*G = 76284*(Y-16) - 53281*(U-128) - 25625*(V-128)
95 * 65536*R = 76284*(Y-16) + 104595*(U-128)
97 * Make sure the output values are within [0..255] range.
99 #define LIMIT_RGB(x) (((x) < 0) ? 0 : (((x) > 255) ? 255 : (x)))
100 #define YUV_TO_RGB_BY_THE_BOOK(my,mu,mv,mr,mg,mb) { \
101 int mm_y, mm_yc, mm_u, mm_v, mm_r, mm_g, mm_b; \
105 mm_yc= mm_y * 76284; \
106 mm_b = (mm_yc + 132252*mm_v ) >> 16; \
107 mm_g = (mm_yc - 53281*mm_u - 25625*mm_v ) >> 16; \
108 mm_r = (mm_yc + 104595*mm_u ) >> 16; \
109 mb = LIMIT_RGB(mm_b); \
110 mg = LIMIT_RGB(mm_g); \
111 mr = LIMIT_RGB(mm_r); \
114 #define RING_QUEUE_SIZE (128*1024) /* Must be a power of 2 */
115 #define RING_QUEUE_ADVANCE_INDEX(rq,ind,n) (rq)->ind = ((rq)->ind + (n)) & ((rq)->length-1)
116 #define RING_QUEUE_DEQUEUE_BYTES(rq,n) RING_QUEUE_ADVANCE_INDEX(rq,ri,n)
117 #define RING_QUEUE_PEEK(rq,ofs) ((rq)->queue[((ofs) + (rq)->ri) & ((rq)->length-1)])
120 unsigned char *queue; /* Data from the Isoc data pump */
121 int length; /* How many bytes allocated for the queue */
122 int wi; /* That's where we write */
123 int ri; /* Read from here until you hit write index */
124 wait_queue_head_t wqh; /* Processes waiting */
128 ScanState_Scanning, /* Scanning for header */
129 ScanState_Lines /* Parsing lines */
132 /* Completion states of the data parser */
134 scan_Continue, /* Just parse next item */
135 scan_NextFrame, /* Frame done, send it to V4L */
136 scan_Out, /* Not enough data for frame */
137 scan_EndParse /* End parsing */
141 FrameState_Unused, /* Unused (no MCAPTURE) */
142 FrameState_Ready, /* Ready to start grabbing */
143 FrameState_Grabbing, /* In the process of being grabbed into */
144 FrameState_Done, /* Finished grabbing, but not been synced yet */
145 FrameState_Done_Hold, /* Are syncing or reading */
146 FrameState_Error, /* Something bad happened while processing */
150 * Some frames may contain only even or odd lines. This type
151 * specifies what type of deinterlacing is required.
155 Deinterlace_FillOddLines,
156 Deinterlace_FillEvenLines
159 #define USBVIDEO_NUMFRAMES 2 /* How many frames we work with */
160 #define USBVIDEO_NUMSBUF 2 /* How many URBs linked in a ring */
162 /* This structure represents one Isoc request - URB and buffer */
163 struct usbvideo_sbuf {
168 struct usbvideo_frame {
169 char *data; /* Frame buffer */
170 unsigned long header; /* Significant bits from the header */
172 videosize_t canvas; /* The canvas (max. image) allocated */
173 videosize_t request; /* That's what the application asked for */
174 unsigned short palette; /* The desired format */
176 enum FrameState frameState;/* State of grabbing */
177 enum ScanState scanstate; /* State of scanning */
178 enum Deinterlace deinterlace;
179 int flags; /* USBVIDEO_FRAME_FLAG_xxx bit flags */
181 int curline; /* Line of frame we're working on */
183 long seqRead_Length; /* Raw data length of frame */
184 long seqRead_Index; /* Amount of data that has been already read */
186 void *user; /* Additional data that user may need */
189 /* Statistics that can be overlaid on screen */
190 struct usbvideo_statistics {
191 unsigned long frame_num; /* Sequential number of the frame */
192 unsigned long urb_count; /* How many URBs we received so far */
193 unsigned long urb_length; /* Length of last URB */
194 unsigned long data_count; /* How many bytes we received */
195 unsigned long header_count; /* How many frame headers we found */
196 unsigned long iso_skip_count; /* How many empty ISO packets received */
197 unsigned long iso_err_count; /* How many bad ISO packets received */
203 struct video_device vdev; /* Must be the first field! */
204 struct usb_device *dev;
205 struct usbvideo *handle; /* Points back to the struct usbvideo */
206 void *user_data; /* Camera-dependent data */
207 int user_size; /* Size of that camera-dependent data */
208 int debug; /* Debug level for usbvideo */
209 unsigned char iface; /* Video interface number */
210 unsigned char video_endp;
211 unsigned char ifaceAltActive;
212 unsigned char ifaceAltInactive; /* Alt settings */
213 unsigned long flags; /* FLAGS_USBVIDEO_xxx */
214 unsigned long paletteBits; /* Which palettes we accept? */
215 unsigned short defaultPalette; /* What palette to use for read() */
216 struct semaphore lock;
217 int user; /* user count for exclusive use */
219 videosize_t videosize; /* Current setting */
220 videosize_t canvas; /* This is the width,height of the V4L canvas */
221 int max_frame_size; /* Bytes in one video frame */
223 int uvd_used; /* Is this structure in use? */
224 int streaming; /* Are we streaming Isochronous? */
225 int grabbing; /* Are we grabbing? */
226 int settingsAdjusted; /* Have we adjusted contrast etc.? */
227 int last_error; /* What calamity struck us? */
229 char *fbuf; /* Videodev buffer area */
230 int fbuf_size; /* Videodev buffer size */
233 int iso_packet_len; /* Videomode-dependent, saves bus bandwidth */
235 struct RingQueue dp; /* Isoc data pump */
236 struct usbvideo_frame frame[USBVIDEO_NUMFRAMES];
237 struct usbvideo_sbuf sbuf[USBVIDEO_NUMSBUF];
239 volatile int remove_pending; /* If set then about to exit */
241 struct video_picture vpic, vpic_old; /* Picture settings */
242 struct video_capability vcap; /* Video capabilities */
243 struct video_channel vchan; /* May be used for tuner support */
244 struct usbvideo_statistics stats;
245 char videoName[32]; /* Holds name like "video7" */
249 * usbvideo callbacks (virtual methods). They are set when usbvideo
250 * services are registered. All of these default to NULL, except those
251 * that default to usbvideo-provided methods.
254 int (*probe)(struct usb_interface *, const struct usb_device_id *);
255 void (*userFree)(struct uvd *);
256 void (*disconnect)(struct usb_interface *);
257 int (*setupOnOpen)(struct uvd *);
258 void (*videoStart)(struct uvd *);
259 void (*videoStop)(struct uvd *);
260 void (*processData)(struct uvd *, struct usbvideo_frame *);
261 void (*postProcess)(struct uvd *, struct usbvideo_frame *);
262 void (*adjustPicture)(struct uvd *);
263 int (*getFPS)(struct uvd *);
264 int (*overlayHook)(struct uvd *, struct usbvideo_frame *);
265 int (*getFrame)(struct uvd *, int);
266 int (*startDataPump)(struct uvd *uvd);
267 void (*stopDataPump)(struct uvd *uvd);
268 int (*setVideoMode)(struct uvd *uvd, struct video_window *vw);
272 int num_cameras; /* As allocated */
273 struct usb_driver usbdrv; /* Interface to the USB stack */
274 char drvName[80]; /* Driver name */
275 struct semaphore lock; /* Mutex protecting camera structures */
276 struct usbvideo_cb cb; /* Table of callbacks (virtual methods) */
277 struct video_device vdt; /* Video device template */
278 struct uvd *cam; /* Array of camera structures */
279 struct module *md_module; /* Minidriver module */
284 * This macro retrieves callback address from the struct uvd object.
285 * No validity checks are done here, so be sure to check the
286 * callback beforehand with VALID_CALLBACK.
288 #define GET_CALLBACK(uvd,cbName) ((uvd)->handle->cb.cbName)
291 * This macro returns either callback pointer or NULL. This is safe
292 * macro, meaning that most of components of data structures involved
293 * may be NULL - this only results in NULL being returned. You may
294 * wish to use this macro to make sure that the callback is callable.
295 * However keep in mind that those checks take time.
297 #define VALID_CALLBACK(uvd,cbName) ((((uvd) != NULL) && \
298 ((uvd)->handle != NULL)) ? GET_CALLBACK(uvd,cbName) : NULL)
300 int RingQueue_Dequeue(struct RingQueue *rq, unsigned char *dst, int len);
301 int RingQueue_Enqueue(struct RingQueue *rq, const unsigned char *cdata, int n);
302 void RingQueue_WakeUpInterruptible(struct RingQueue *rq);
303 void RingQueue_Flush(struct RingQueue *rq);
305 static inline int RingQueue_GetLength(const struct RingQueue *rq)
307 return (rq->wi - rq->ri + rq->length) & (rq->length-1);
310 static inline int RingQueue_GetFreeSpace(const struct RingQueue *rq)
312 return rq->length - RingQueue_GetLength(rq);
315 void usbvideo_DrawLine(
316 struct usbvideo_frame *frame,
319 unsigned char cr, unsigned char cg, unsigned char cb);
320 void usbvideo_HexDump(const unsigned char *data, int len);
321 void usbvideo_SayAndWait(const char *what);
322 void usbvideo_TestPattern(struct uvd *uvd, int fullframe, int pmode);
324 /* Memory allocation routines */
325 unsigned long usbvideo_kvirt_to_pa(unsigned long adr);
327 int usbvideo_register(
328 struct usbvideo **pCams,
331 const char *driverName,
332 const struct usbvideo_cb *cbTable,
334 const struct usb_device_id *id_table);
335 struct uvd *usbvideo_AllocateDevice(struct usbvideo *cams);
336 int usbvideo_RegisterVideoDevice(struct uvd *uvd);
337 void usbvideo_Deregister(struct usbvideo **uvt);
339 int usbvideo_v4l_initialize(struct video_device *dev);
341 void usbvideo_DeinterlaceFrame(struct uvd *uvd, struct usbvideo_frame *frame);
344 * This code performs bounds checking - use it when working with
345 * new formats, or else you may get oopses all over the place.
346 * If pixel falls out of bounds then it gets shoved back (as close
347 * to place of offence as possible) and is painted bright red.
349 * There are two important concepts: frame width, height and
350 * V4L canvas width, height. The former is the area requested by
351 * the application -for this very frame-. The latter is the largest
352 * possible frame that we can serve (we advertise that via V4L ioctl).
353 * The frame data is expected to be formatted as lines of length
354 * VIDEOSIZE_X(fr->request), total VIDEOSIZE_Y(frame->request) lines.
356 static inline void RGB24_PUTPIXEL(
357 struct usbvideo_frame *fr,
363 register unsigned char *pf;
364 int limiter = 0, mx, my;
370 } else if (mx >= VIDEOSIZE_X((fr)->request)) {
371 mx= VIDEOSIZE_X((fr)->request) - 1;
377 } else if (my >= VIDEOSIZE_Y((fr)->request)) {
378 my = VIDEOSIZE_Y((fr)->request) - 1;
381 pf = (fr)->data + V4L_BYTES_PER_PIXEL*((iy)*VIDEOSIZE_X((fr)->request) + (ix));
393 #endif /* usbvideo_h */