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/videodev.h>
20 #include <media/v4l2-common.h>
21 #include <media/v4l2-ioctl.h>
22 #include <linux/usb.h>
23 #include <linux/mutex.h>
25 /* Most helpful debugging aid */
26 #define assert(expr) ((void) ((expr) ? 0 : (err("assert failed at line %d",__LINE__))))
28 #define USBVIDEO_REPORT_STATS 1 /* Set to 0 to block statistics on close */
30 /* Bit flags (options) */
31 #define FLAGS_RETRY_VIDIOCSYNC (1 << 0)
32 #define FLAGS_MONOCHROME (1 << 1)
33 #define FLAGS_DISPLAY_HINTS (1 << 2)
34 #define FLAGS_OVERLAY_STATS (1 << 3)
35 #define FLAGS_FORCE_TESTPATTERN (1 << 4)
36 #define FLAGS_SEPARATE_FRAMES (1 << 5)
37 #define FLAGS_CLEAN_FRAMES (1 << 6)
38 #define FLAGS_NO_DECODING (1 << 7)
40 /* Bit flags for frames (apply to the frame where they are specified) */
41 #define USBVIDEO_FRAME_FLAG_SOFTWARE_CONTRAST (1 << 0)
43 /* Camera capabilities (maximum) */
44 #define CAMERA_URB_FRAMES 32
45 #define CAMERA_MAX_ISO_PACKET 1023 /* 1022 actually sent by camera */
46 #define FRAMES_PER_DESC (CAMERA_URB_FRAMES)
47 #define FRAME_SIZE_PER_DESC (CAMERA_MAX_ISO_PACKET)
49 /* This macro restricts an int variable to an inclusive range */
50 #define RESTRICT_TO_RANGE(v,mi,ma) { if ((v) < (mi)) (v) = (mi); else if ((v) > (ma)) (v) = (ma); }
52 #define V4L_BYTES_PER_PIXEL 3 /* Because we produce RGB24 */
55 * Use this macro to construct constants for different video sizes.
56 * We have to deal with different video sizes that have to be
57 * configured in the device or compared against when we receive
58 * a data. Normally one would define a bunch of VIDEOSIZE_x_by_y
59 * #defines and that's the end of story. However this solution
60 * does not allow to convert between real pixel sizes and the
61 * constant (integer) value that may be used to tag a frame or
62 * whatever. The set of macros below constructs videosize constants
63 * from the pixel size and allows to reconstruct the pixel size
64 * from the combined value later.
66 #define VIDEOSIZE(x,y) (((x) & 0xFFFFL) | (((y) & 0xFFFFL) << 16))
67 #define VIDEOSIZE_X(vs) ((vs) & 0xFFFFL)
68 #define VIDEOSIZE_Y(vs) (((vs) >> 16) & 0xFFFFL)
69 typedef unsigned long videosize_t
;
72 * This macro checks if the camera is still operational. The 'uvd'
73 * pointer must be valid, uvd->dev must be valid, we are not
74 * removing the device and the device has not erred on us.
76 #define CAMERA_IS_OPERATIONAL(uvd) (\
78 ((uvd)->dev != NULL) && \
79 ((uvd)->last_error == 0) && \
80 (!(uvd)->remove_pending))
83 * We use macros to do YUV -> RGB conversion because this is
84 * very important for speed and totally unimportant for size.
86 * YUV -> RGB Conversion
87 * ---------------------
89 * B = 1.164*(Y-16) + 2.018*(V-128)
90 * G = 1.164*(Y-16) - 0.813*(U-128) - 0.391*(V-128)
91 * R = 1.164*(Y-16) + 1.596*(U-128)
93 * If you fancy integer arithmetics (as you should), hear this:
95 * 65536*B = 76284*(Y-16) + 132252*(V-128)
96 * 65536*G = 76284*(Y-16) - 53281*(U-128) - 25625*(V-128)
97 * 65536*R = 76284*(Y-16) + 104595*(U-128)
99 * Make sure the output values are within [0..255] range.
101 #define LIMIT_RGB(x) (((x) < 0) ? 0 : (((x) > 255) ? 255 : (x)))
102 #define YUV_TO_RGB_BY_THE_BOOK(my,mu,mv,mr,mg,mb) { \
103 int mm_y, mm_yc, mm_u, mm_v, mm_r, mm_g, mm_b; \
107 mm_yc= mm_y * 76284; \
108 mm_b = (mm_yc + 132252*mm_v ) >> 16; \
109 mm_g = (mm_yc - 53281*mm_u - 25625*mm_v ) >> 16; \
110 mm_r = (mm_yc + 104595*mm_u ) >> 16; \
111 mb = LIMIT_RGB(mm_b); \
112 mg = LIMIT_RGB(mm_g); \
113 mr = LIMIT_RGB(mm_r); \
116 #define RING_QUEUE_SIZE (128*1024) /* Must be a power of 2 */
117 #define RING_QUEUE_ADVANCE_INDEX(rq,ind,n) (rq)->ind = ((rq)->ind + (n)) & ((rq)->length-1)
118 #define RING_QUEUE_DEQUEUE_BYTES(rq,n) RING_QUEUE_ADVANCE_INDEX(rq,ri,n)
119 #define RING_QUEUE_PEEK(rq,ofs) ((rq)->queue[((ofs) + (rq)->ri) & ((rq)->length-1)])
122 unsigned char *queue
; /* Data from the Isoc data pump */
123 int length
; /* How many bytes allocated for the queue */
124 int wi
; /* That's where we write */
125 int ri
; /* Read from here until you hit write index */
126 wait_queue_head_t wqh
; /* Processes waiting */
130 ScanState_Scanning
, /* Scanning for header */
131 ScanState_Lines
/* Parsing lines */
134 /* Completion states of the data parser */
136 scan_Continue
, /* Just parse next item */
137 scan_NextFrame
, /* Frame done, send it to V4L */
138 scan_Out
, /* Not enough data for frame */
139 scan_EndParse
/* End parsing */
143 FrameState_Unused
, /* Unused (no MCAPTURE) */
144 FrameState_Ready
, /* Ready to start grabbing */
145 FrameState_Grabbing
, /* In the process of being grabbed into */
146 FrameState_Done
, /* Finished grabbing, but not been synced yet */
147 FrameState_Done_Hold
, /* Are syncing or reading */
148 FrameState_Error
, /* Something bad happened while processing */
152 * Some frames may contain only even or odd lines. This type
153 * specifies what type of deinterlacing is required.
157 Deinterlace_FillOddLines
,
158 Deinterlace_FillEvenLines
161 #define USBVIDEO_NUMFRAMES 2 /* How many frames we work with */
162 #define USBVIDEO_NUMSBUF 2 /* How many URBs linked in a ring */
164 /* This structure represents one Isoc request - URB and buffer */
165 struct usbvideo_sbuf
{
170 struct usbvideo_frame
{
171 char *data
; /* Frame buffer */
172 unsigned long header
; /* Significant bits from the header */
174 videosize_t canvas
; /* The canvas (max. image) allocated */
175 videosize_t request
; /* That's what the application asked for */
176 unsigned short palette
; /* The desired format */
178 enum FrameState frameState
;/* State of grabbing */
179 enum ScanState scanstate
; /* State of scanning */
180 enum Deinterlace deinterlace
;
181 int flags
; /* USBVIDEO_FRAME_FLAG_xxx bit flags */
183 int curline
; /* Line of frame we're working on */
185 long seqRead_Length
; /* Raw data length of frame */
186 long seqRead_Index
; /* Amount of data that has been already read */
188 void *user
; /* Additional data that user may need */
191 /* Statistics that can be overlaid on screen */
192 struct usbvideo_statistics
{
193 unsigned long frame_num
; /* Sequential number of the frame */
194 unsigned long urb_count
; /* How many URBs we received so far */
195 unsigned long urb_length
; /* Length of last URB */
196 unsigned long data_count
; /* How many bytes we received */
197 unsigned long header_count
; /* How many frame headers we found */
198 unsigned long iso_skip_count
; /* How many empty ISO packets received */
199 unsigned long iso_err_count
; /* How many bad ISO packets received */
205 struct video_device vdev
; /* Must be the first field! */
206 struct usb_device
*dev
;
207 struct usbvideo
*handle
; /* Points back to the struct usbvideo */
208 void *user_data
; /* Camera-dependent data */
209 int user_size
; /* Size of that camera-dependent data */
210 int debug
; /* Debug level for usbvideo */
211 unsigned char iface
; /* Video interface number */
212 unsigned char video_endp
;
213 unsigned char ifaceAltActive
;
214 unsigned char ifaceAltInactive
; /* Alt settings */
215 unsigned long flags
; /* FLAGS_USBVIDEO_xxx */
216 unsigned long paletteBits
; /* Which palettes we accept? */
217 unsigned short defaultPalette
; /* What palette to use for read() */
219 int user
; /* user count for exclusive use */
221 videosize_t videosize
; /* Current setting */
222 videosize_t canvas
; /* This is the width,height of the V4L canvas */
223 int max_frame_size
; /* Bytes in one video frame */
225 int uvd_used
; /* Is this structure in use? */
226 int streaming
; /* Are we streaming Isochronous? */
227 int grabbing
; /* Are we grabbing? */
228 int settingsAdjusted
; /* Have we adjusted contrast etc.? */
229 int last_error
; /* What calamity struck us? */
231 char *fbuf
; /* Videodev buffer area */
232 int fbuf_size
; /* Videodev buffer size */
235 int iso_packet_len
; /* Videomode-dependent, saves bus bandwidth */
237 struct RingQueue dp
; /* Isoc data pump */
238 struct usbvideo_frame frame
[USBVIDEO_NUMFRAMES
];
239 struct usbvideo_sbuf sbuf
[USBVIDEO_NUMSBUF
];
241 volatile int remove_pending
; /* If set then about to exit */
243 struct video_picture vpic
, vpic_old
; /* Picture settings */
244 struct video_capability vcap
; /* Video capabilities */
245 struct video_channel vchan
; /* May be used for tuner support */
246 struct usbvideo_statistics stats
;
247 char videoName
[32]; /* Holds name like "video7" */
251 * usbvideo callbacks (virtual methods). They are set when usbvideo
252 * services are registered. All of these default to NULL, except those
253 * that default to usbvideo-provided methods.
256 int (*probe
)(struct usb_interface
*, const struct usb_device_id
*);
257 void (*userFree
)(struct uvd
*);
258 void (*disconnect
)(struct usb_interface
*);
259 int (*setupOnOpen
)(struct uvd
*);
260 void (*videoStart
)(struct uvd
*);
261 void (*videoStop
)(struct uvd
*);
262 void (*processData
)(struct uvd
*, struct usbvideo_frame
*);
263 void (*postProcess
)(struct uvd
*, struct usbvideo_frame
*);
264 void (*adjustPicture
)(struct uvd
*);
265 int (*getFPS
)(struct uvd
*);
266 int (*overlayHook
)(struct uvd
*, struct usbvideo_frame
*);
267 int (*getFrame
)(struct uvd
*, int);
268 int (*startDataPump
)(struct uvd
*uvd
);
269 void (*stopDataPump
)(struct uvd
*uvd
);
270 int (*setVideoMode
)(struct uvd
*uvd
, struct video_window
*vw
);
274 int num_cameras
; /* As allocated */
275 struct usb_driver usbdrv
; /* Interface to the USB stack */
276 char drvName
[80]; /* Driver name */
277 struct mutex lock
; /* Mutex protecting camera structures */
278 struct usbvideo_cb cb
; /* Table of callbacks (virtual methods) */
279 struct video_device vdt
; /* Video device template */
280 struct uvd
*cam
; /* Array of camera structures */
281 struct module
*md_module
; /* Minidriver module */
286 * This macro retrieves callback address from the struct uvd object.
287 * No validity checks are done here, so be sure to check the
288 * callback beforehand with VALID_CALLBACK.
290 #define GET_CALLBACK(uvd,cbName) ((uvd)->handle->cb.cbName)
293 * This macro returns either callback pointer or NULL. This is safe
294 * macro, meaning that most of components of data structures involved
295 * may be NULL - this only results in NULL being returned. You may
296 * wish to use this macro to make sure that the callback is callable.
297 * However keep in mind that those checks take time.
299 #define VALID_CALLBACK(uvd,cbName) ((((uvd) != NULL) && \
300 ((uvd)->handle != NULL)) ? GET_CALLBACK(uvd,cbName) : NULL)
302 int RingQueue_Dequeue(struct RingQueue
*rq
, unsigned char *dst
, int len
);
303 int RingQueue_Enqueue(struct RingQueue
*rq
, const unsigned char *cdata
, int n
);
304 void RingQueue_WakeUpInterruptible(struct RingQueue
*rq
);
305 void RingQueue_Flush(struct RingQueue
*rq
);
307 static inline int RingQueue_GetLength(const struct RingQueue
*rq
)
309 return (rq
->wi
- rq
->ri
+ rq
->length
) & (rq
->length
-1);
312 static inline int RingQueue_GetFreeSpace(const struct RingQueue
*rq
)
314 return rq
->length
- RingQueue_GetLength(rq
);
317 void usbvideo_DrawLine(
318 struct usbvideo_frame
*frame
,
321 unsigned char cr
, unsigned char cg
, unsigned char cb
);
322 void usbvideo_HexDump(const unsigned char *data
, int len
);
323 void usbvideo_SayAndWait(const char *what
);
324 void usbvideo_TestPattern(struct uvd
*uvd
, int fullframe
, int pmode
);
326 /* Memory allocation routines */
327 unsigned long usbvideo_kvirt_to_pa(unsigned long adr
);
329 int usbvideo_register(
330 struct usbvideo
**pCams
,
333 const char *driverName
,
334 const struct usbvideo_cb
*cbTable
,
336 const struct usb_device_id
*id_table
);
337 struct uvd
*usbvideo_AllocateDevice(struct usbvideo
*cams
);
338 int usbvideo_RegisterVideoDevice(struct uvd
*uvd
);
339 void usbvideo_Deregister(struct usbvideo
**uvt
);
341 int usbvideo_v4l_initialize(struct video_device
*dev
);
343 void usbvideo_DeinterlaceFrame(struct uvd
*uvd
, struct usbvideo_frame
*frame
);
346 * This code performs bounds checking - use it when working with
347 * new formats, or else you may get oopses all over the place.
348 * If pixel falls out of bounds then it gets shoved back (as close
349 * to place of offence as possible) and is painted bright red.
351 * There are two important concepts: frame width, height and
352 * V4L canvas width, height. The former is the area requested by
353 * the application -for this very frame-. The latter is the largest
354 * possible frame that we can serve (we advertise that via V4L ioctl).
355 * The frame data is expected to be formatted as lines of length
356 * VIDEOSIZE_X(fr->request), total VIDEOSIZE_Y(frame->request) lines.
358 static inline void RGB24_PUTPIXEL(
359 struct usbvideo_frame
*fr
,
365 register unsigned char *pf
;
366 int limiter
= 0, mx
, my
;
372 } else if (mx
>= VIDEOSIZE_X((fr
)->request
)) {
373 mx
= VIDEOSIZE_X((fr
)->request
) - 1;
379 } else if (my
>= VIDEOSIZE_Y((fr
)->request
)) {
380 my
= VIDEOSIZE_Y((fr
)->request
) - 1;
383 pf
= (fr
)->data
+ V4L_BYTES_PER_PIXEL
*((iy
)*VIDEOSIZE_X((fr
)->request
) + (ix
));
395 #endif /* usbvideo_h */