2 * Zoran zr36057/zr36067 PCI controller driver, for the
3 * Pinnacle/Miro DC10/DC10+/DC30/DC30+, Iomega Buz, Linux
4 * Media Labs LML33/LML33R10.
6 * Copyright (C) 2000 Serguei Miridonov <mirsev@cicese.mx>
8 * Changes for BUZ by Wolfgang Scherr <scherr@net4you.net>
10 * Changes for DC10/DC30 by Laurent Pinchart <laurent.pinchart@skynet.be>
12 * Changes for LML33R10 by Maxim Yevtyushkin <max@linuxmedialabs.com>
14 * Changes for videodev2/v4l2 by Ronald Bultje <rbultje@ronald.bitfreak.net>
19 * Copyright (C) 1999 Wolfgang Scherr <scherr@net4you.net>
21 * Iomega Buz driver version 1.0
22 * Copyright (C) 1999 Rainer Johanni <Rainer@Johanni.de>
25 * Copyright (C) 1998 Dave Perks <dperks@ibm.net>
27 * bttv - Bt848 frame grabber driver
28 * Copyright (C) 1996,97,98 Ralph Metzler (rjkm@thp.uni-koeln.de)
29 * & Marcus Metzler (mocm@thp.uni-koeln.de)
32 * This program is free software; you can redistribute it and/or modify
33 * it under the terms of the GNU General Public License as published by
34 * the Free Software Foundation; either version 2 of the License, or
35 * (at your option) any later version.
37 * This program is distributed in the hope that it will be useful,
38 * but WITHOUT ANY WARRANTY; without even the implied warranty of
39 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
40 * GNU General Public License for more details.
42 * You should have received a copy of the GNU General Public License
43 * along with this program; if not, write to the Free Software
44 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
47 #include <linux/version.h>
48 #include <linux/init.h>
49 #include <linux/module.h>
50 #include <linux/delay.h>
51 #include <linux/slab.h>
52 #include <linux/pci.h>
53 #include <linux/vmalloc.h>
54 #include <linux/wait.h>
56 #include <linux/interrupt.h>
57 #include <linux/i2c.h>
58 #include <linux/i2c-algo-bit.h>
60 #include <linux/spinlock.h>
62 #include <linux/videodev2.h>
63 #include <media/v4l2-common.h>
64 #include <media/v4l2-ioctl.h>
65 #include "videocodec.h"
67 #include <asm/byteorder.h>
69 #include <asm/uaccess.h>
70 #include <linux/proc_fs.h>
72 #include <linux/mutex.h>
74 #include "zoran_device.h"
75 #include "zoran_card.h"
78 const struct zoran_format zoran_formats
[] = {
80 .name
= "15-bit RGB LE",
81 .fourcc
= V4L2_PIX_FMT_RGB555
,
82 .colorspace
= V4L2_COLORSPACE_SRGB
,
84 .flags
= ZORAN_FORMAT_CAPTURE
|
86 .vfespfr
= ZR36057_VFESPFR_RGB555
|ZR36057_VFESPFR_ErrDif
|
87 ZR36057_VFESPFR_LittleEndian
,
89 .name
= "15-bit RGB BE",
90 .fourcc
= V4L2_PIX_FMT_RGB555X
,
91 .colorspace
= V4L2_COLORSPACE_SRGB
,
93 .flags
= ZORAN_FORMAT_CAPTURE
|
95 .vfespfr
= ZR36057_VFESPFR_RGB555
|ZR36057_VFESPFR_ErrDif
,
97 .name
= "16-bit RGB LE",
98 .fourcc
= V4L2_PIX_FMT_RGB565
,
99 .colorspace
= V4L2_COLORSPACE_SRGB
,
101 .flags
= ZORAN_FORMAT_CAPTURE
|
102 ZORAN_FORMAT_OVERLAY
,
103 .vfespfr
= ZR36057_VFESPFR_RGB565
|ZR36057_VFESPFR_ErrDif
|
104 ZR36057_VFESPFR_LittleEndian
,
106 .name
= "16-bit RGB BE",
107 .fourcc
= V4L2_PIX_FMT_RGB565X
,
108 .colorspace
= V4L2_COLORSPACE_SRGB
,
110 .flags
= ZORAN_FORMAT_CAPTURE
|
111 ZORAN_FORMAT_OVERLAY
,
112 .vfespfr
= ZR36057_VFESPFR_RGB565
|ZR36057_VFESPFR_ErrDif
,
114 .name
= "24-bit RGB",
115 .fourcc
= V4L2_PIX_FMT_BGR24
,
116 .colorspace
= V4L2_COLORSPACE_SRGB
,
118 .flags
= ZORAN_FORMAT_CAPTURE
|
119 ZORAN_FORMAT_OVERLAY
,
120 .vfespfr
= ZR36057_VFESPFR_RGB888
|ZR36057_VFESPFR_Pack24
,
122 .name
= "32-bit RGB LE",
123 .fourcc
= V4L2_PIX_FMT_BGR32
,
124 .colorspace
= V4L2_COLORSPACE_SRGB
,
126 .flags
= ZORAN_FORMAT_CAPTURE
|
127 ZORAN_FORMAT_OVERLAY
,
128 .vfespfr
= ZR36057_VFESPFR_RGB888
|ZR36057_VFESPFR_LittleEndian
,
130 .name
= "32-bit RGB BE",
131 .fourcc
= V4L2_PIX_FMT_RGB32
,
132 .colorspace
= V4L2_COLORSPACE_SRGB
,
134 .flags
= ZORAN_FORMAT_CAPTURE
|
135 ZORAN_FORMAT_OVERLAY
,
136 .vfespfr
= ZR36057_VFESPFR_RGB888
,
138 .name
= "4:2:2, packed, YUYV",
139 .fourcc
= V4L2_PIX_FMT_YUYV
,
140 .colorspace
= V4L2_COLORSPACE_SMPTE170M
,
142 .flags
= ZORAN_FORMAT_CAPTURE
|
143 ZORAN_FORMAT_OVERLAY
,
144 .vfespfr
= ZR36057_VFESPFR_YUV422
,
146 .name
= "4:2:2, packed, UYVY",
147 .fourcc
= V4L2_PIX_FMT_UYVY
,
148 .colorspace
= V4L2_COLORSPACE_SMPTE170M
,
150 .flags
= ZORAN_FORMAT_CAPTURE
|
151 ZORAN_FORMAT_OVERLAY
,
152 .vfespfr
= ZR36057_VFESPFR_YUV422
|ZR36057_VFESPFR_LittleEndian
,
154 .name
= "Hardware-encoded Motion-JPEG",
155 .fourcc
= V4L2_PIX_FMT_MJPEG
,
156 .colorspace
= V4L2_COLORSPACE_SMPTE170M
,
158 .flags
= ZORAN_FORMAT_CAPTURE
|
159 ZORAN_FORMAT_PLAYBACK
|
160 ZORAN_FORMAT_COMPRESSED
,
163 #define NUM_FORMATS ARRAY_SIZE(zoran_formats)
165 /* small helper function for calculating buffersizes for v4l2
166 * we calculate the nearest higher power-of-two, which
167 * will be the recommended buffersize */
169 zoran_v4l2_calc_bufsize (struct zoran_jpg_settings
*settings
)
171 __u8 div
= settings
->VerDcm
* settings
->HorDcm
* settings
->TmpDcm
;
172 __u32 num
= (1024 * 512) / (div
);
181 if (result
> jpg_bufsize
)
188 /* forward references */
189 static void v4l_fbuffer_free(struct zoran_fh
*fh
);
190 static void jpg_fbuffer_free(struct zoran_fh
*fh
);
192 /* Set mapping mode */
193 static void map_mode_raw(struct zoran_fh
*fh
)
195 fh
->map_mode
= ZORAN_MAP_MODE_RAW
;
196 fh
->buffers
.buffer_size
= v4l_bufsize
;
197 fh
->buffers
.num_buffers
= v4l_nbufs
;
199 static void map_mode_jpg(struct zoran_fh
*fh
, int play
)
201 fh
->map_mode
= play
? ZORAN_MAP_MODE_JPG_PLAY
: ZORAN_MAP_MODE_JPG_REC
;
202 fh
->buffers
.buffer_size
= jpg_bufsize
;
203 fh
->buffers
.num_buffers
= jpg_nbufs
;
205 static inline const char *mode_name(enum zoran_map_mode mode
)
207 return mode
== ZORAN_MAP_MODE_RAW
? "V4L" : "JPG";
211 * Allocate the V4L grab buffers
213 * These have to be pysically contiguous.
216 static int v4l_fbuffer_alloc(struct zoran_fh
*fh
)
218 struct zoran
*zr
= fh
->zr
;
222 for (i
= 0; i
< fh
->buffers
.num_buffers
; i
++) {
223 if (fh
->buffers
.buffer
[i
].v4l
.fbuffer
)
226 "%s: %s - buffer %d already allocated!?\n",
227 ZR_DEVNAME(zr
), __func__
, i
);
230 mem
= kmalloc(fh
->buffers
.buffer_size
,
231 GFP_KERNEL
| __GFP_NOWARN
);
235 "%s: %s - kmalloc for V4L buf %d failed\n",
236 ZR_DEVNAME(zr
), __func__
, i
);
237 v4l_fbuffer_free(fh
);
240 fh
->buffers
.buffer
[i
].v4l
.fbuffer
= mem
;
241 fh
->buffers
.buffer
[i
].v4l
.fbuffer_phys
= virt_to_phys(mem
);
242 fh
->buffers
.buffer
[i
].v4l
.fbuffer_bus
= virt_to_bus(mem
);
243 for (off
= 0; off
< fh
->buffers
.buffer_size
;
245 SetPageReserved(virt_to_page(mem
+ off
));
248 "%s: %s - V4L frame %d mem 0x%lx (bus: 0x%llx)\n",
249 ZR_DEVNAME(zr
), __func__
, i
, (unsigned long) mem
,
250 (unsigned long long)virt_to_bus(mem
));
253 fh
->buffers
.allocated
= 1;
258 /* free the V4L grab buffers */
259 static void v4l_fbuffer_free(struct zoran_fh
*fh
)
261 struct zoran
*zr
= fh
->zr
;
265 dprintk(4, KERN_INFO
"%s: %s\n", ZR_DEVNAME(zr
), __func__
);
267 for (i
= 0; i
< fh
->buffers
.num_buffers
; i
++) {
268 if (!fh
->buffers
.buffer
[i
].v4l
.fbuffer
)
271 mem
= fh
->buffers
.buffer
[i
].v4l
.fbuffer
;
272 for (off
= 0; off
< fh
->buffers
.buffer_size
;
274 ClearPageReserved(virt_to_page(mem
+ off
));
275 kfree(fh
->buffers
.buffer
[i
].v4l
.fbuffer
);
276 fh
->buffers
.buffer
[i
].v4l
.fbuffer
= NULL
;
279 fh
->buffers
.allocated
= 0;
283 * Allocate the MJPEG grab buffers.
285 * If a Natoma chipset is present and this is a revision 1 zr36057,
286 * each MJPEG buffer needs to be physically contiguous.
287 * (RJ: This statement is from Dave Perks' original driver,
288 * I could never check it because I have a zr36067)
290 * RJ: The contents grab buffers needs never be accessed in the driver.
291 * Therefore there is no need to allocate them with vmalloc in order
292 * to get a contiguous virtual memory space.
293 * I don't understand why many other drivers first allocate them with
294 * vmalloc (which uses internally also get_zeroed_page, but delivers you
295 * virtual addresses) and then again have to make a lot of efforts
296 * to get the physical address.
299 * On big-endian architectures (such as ppc) some extra steps
300 * are needed. When reading and writing to the stat_com array
301 * and fragment buffers, the device expects to see little-
302 * endian values. The use of cpu_to_le32() and le32_to_cpu()
303 * in this function (and one or two others in zoran_device.c)
304 * ensure that these values are always stored in little-endian
305 * form, regardless of architecture. The zr36057 does Very Bad
306 * Things on big endian architectures if the stat_com array
307 * and fragment buffers are not little-endian.
310 static int jpg_fbuffer_alloc(struct zoran_fh
*fh
)
312 struct zoran
*zr
= fh
->zr
;
316 for (i
= 0; i
< fh
->buffers
.num_buffers
; i
++) {
317 if (fh
->buffers
.buffer
[i
].jpg
.frag_tab
)
320 "%s: %s - buffer %d already allocated!?\n",
321 ZR_DEVNAME(zr
), __func__
, i
);
323 /* Allocate fragment table for this buffer */
325 mem
= (void *)get_zeroed_page(GFP_KERNEL
);
329 "%s: %s - get_zeroed_page (frag_tab) failed for buffer %d\n",
330 ZR_DEVNAME(zr
), __func__
, i
);
331 jpg_fbuffer_free(fh
);
334 fh
->buffers
.buffer
[i
].jpg
.frag_tab
= (__le32
*)mem
;
335 fh
->buffers
.buffer
[i
].jpg
.frag_tab_bus
= virt_to_bus(mem
);
337 if (fh
->buffers
.need_contiguous
) {
338 mem
= kmalloc(fh
->buffers
.buffer_size
, GFP_KERNEL
);
342 "%s: %s - kmalloc failed for buffer %d\n",
343 ZR_DEVNAME(zr
), __func__
, i
);
344 jpg_fbuffer_free(fh
);
347 fh
->buffers
.buffer
[i
].jpg
.frag_tab
[0] =
348 cpu_to_le32(virt_to_bus(mem
));
349 fh
->buffers
.buffer
[i
].jpg
.frag_tab
[1] =
350 cpu_to_le32((fh
->buffers
.buffer_size
>> 1) | 1);
351 for (off
= 0; off
< fh
->buffers
.buffer_size
; off
+= PAGE_SIZE
)
352 SetPageReserved(virt_to_page(mem
+ off
));
354 /* jpg_bufsize is already page aligned */
355 for (j
= 0; j
< fh
->buffers
.buffer_size
/ PAGE_SIZE
; j
++) {
356 mem
= (void *)get_zeroed_page(GFP_KERNEL
);
360 "%s: %s - get_zeroed_page failed for buffer %d\n",
361 ZR_DEVNAME(zr
), __func__
, i
);
362 jpg_fbuffer_free(fh
);
366 fh
->buffers
.buffer
[i
].jpg
.frag_tab
[2 * j
] =
367 cpu_to_le32(virt_to_bus(mem
));
368 fh
->buffers
.buffer
[i
].jpg
.frag_tab
[2 * j
+ 1] =
369 cpu_to_le32((PAGE_SIZE
>> 2) << 1);
370 SetPageReserved(virt_to_page(mem
));
373 fh
->buffers
.buffer
[i
].jpg
.frag_tab
[2 * j
- 1] |= cpu_to_le32(1);
378 KERN_DEBUG
"%s: %s - %d KB allocated\n",
379 ZR_DEVNAME(zr
), __func__
,
380 (fh
->buffers
.num_buffers
* fh
->buffers
.buffer_size
) >> 10);
382 fh
->buffers
.allocated
= 1;
387 /* free the MJPEG grab buffers */
388 static void jpg_fbuffer_free(struct zoran_fh
*fh
)
390 struct zoran
*zr
= fh
->zr
;
394 struct zoran_buffer
*buffer
;
396 dprintk(4, KERN_DEBUG
"%s: %s\n", ZR_DEVNAME(zr
), __func__
);
398 for (i
= 0, buffer
= &fh
->buffers
.buffer
[0];
399 i
< fh
->buffers
.num_buffers
; i
++, buffer
++) {
400 if (!buffer
->jpg
.frag_tab
)
403 if (fh
->buffers
.need_contiguous
) {
404 frag_tab
= buffer
->jpg
.frag_tab
[0];
407 mem
= bus_to_virt(le32_to_cpu(frag_tab
));
408 for (off
= 0; off
< fh
->buffers
.buffer_size
; off
+= PAGE_SIZE
)
409 ClearPageReserved(virt_to_page(mem
+ off
));
411 buffer
->jpg
.frag_tab
[0] = 0;
412 buffer
->jpg
.frag_tab
[1] = 0;
415 for (j
= 0; j
< fh
->buffers
.buffer_size
/ PAGE_SIZE
; j
++) {
416 frag_tab
= buffer
->jpg
.frag_tab
[2 * j
];
420 ClearPageReserved(virt_to_page(bus_to_virt(le32_to_cpu(frag_tab
))));
421 free_page((unsigned long)bus_to_virt(le32_to_cpu(frag_tab
)));
422 buffer
->jpg
.frag_tab
[2 * j
] = 0;
423 buffer
->jpg
.frag_tab
[2 * j
+ 1] = 0;
427 free_page((unsigned long)buffer
->jpg
.frag_tab
);
428 buffer
->jpg
.frag_tab
= NULL
;
431 fh
->buffers
.allocated
= 0;
435 * V4L Buffer grabbing
439 zoran_v4l_set_format (struct zoran_fh
*fh
,
442 const struct zoran_format
*format
)
444 struct zoran
*zr
= fh
->zr
;
447 /* Check size and format of the grab wanted */
449 if (height
< BUZ_MIN_HEIGHT
|| width
< BUZ_MIN_WIDTH
||
450 height
> BUZ_MAX_HEIGHT
|| width
> BUZ_MAX_WIDTH
) {
453 "%s: %s - wrong frame size (%dx%d)\n",
454 ZR_DEVNAME(zr
), __func__
, width
, height
);
458 bpp
= (format
->depth
+ 7) / 8;
460 /* Check against available buffer size */
461 if (height
* width
* bpp
> fh
->buffers
.buffer_size
) {
464 "%s: %s - video buffer size (%d kB) is too small\n",
465 ZR_DEVNAME(zr
), __func__
, fh
->buffers
.buffer_size
>> 10);
469 /* The video front end needs 4-byte alinged line sizes */
471 if ((bpp
== 2 && (width
& 1)) || (bpp
== 3 && (width
& 3))) {
474 "%s: %s - wrong frame alignment\n",
475 ZR_DEVNAME(zr
), __func__
);
479 fh
->v4l_settings
.width
= width
;
480 fh
->v4l_settings
.height
= height
;
481 fh
->v4l_settings
.format
= format
;
482 fh
->v4l_settings
.bytesperline
= bpp
* fh
->v4l_settings
.width
;
487 static int zoran_v4l_queue_frame(struct zoran_fh
*fh
, int num
)
489 struct zoran
*zr
= fh
->zr
;
493 if (!fh
->buffers
.allocated
) {
496 "%s: %s - buffers not yet allocated\n",
497 ZR_DEVNAME(zr
), __func__
);
501 /* No grabbing outside the buffer range! */
502 if (num
>= fh
->buffers
.num_buffers
|| num
< 0) {
505 "%s: %s - buffer %d is out of range\n",
506 ZR_DEVNAME(zr
), __func__
, num
);
510 spin_lock_irqsave(&zr
->spinlock
, flags
);
512 if (fh
->buffers
.active
== ZORAN_FREE
) {
513 if (zr
->v4l_buffers
.active
== ZORAN_FREE
) {
514 zr
->v4l_buffers
= fh
->buffers
;
515 fh
->buffers
.active
= ZORAN_ACTIVE
;
519 "%s: %s - another session is already capturing\n",
520 ZR_DEVNAME(zr
), __func__
);
525 /* make sure a grab isn't going on currently with this buffer */
527 switch (zr
->v4l_buffers
.buffer
[num
].state
) {
530 if (zr
->v4l_buffers
.active
== ZORAN_FREE
) {
531 fh
->buffers
.active
= ZORAN_FREE
;
532 zr
->v4l_buffers
.allocated
= 0;
534 res
= -EBUSY
; /* what are you doing? */
539 "%s: %s - queueing buffer %d in state DONE!?\n",
540 ZR_DEVNAME(zr
), __func__
, num
);
542 /* since there is at least one unused buffer there's room for at least
543 * one more pend[] entry */
544 zr
->v4l_pend
[zr
->v4l_pend_head
++ & V4L_MASK_FRAME
] = num
;
545 zr
->v4l_buffers
.buffer
[num
].state
= BUZ_STATE_PEND
;
546 zr
->v4l_buffers
.buffer
[num
].bs
.length
=
547 fh
->v4l_settings
.bytesperline
*
548 zr
->v4l_settings
.height
;
549 fh
->buffers
.buffer
[num
] = zr
->v4l_buffers
.buffer
[num
];
554 spin_unlock_irqrestore(&zr
->spinlock
, flags
);
556 if (!res
&& zr
->v4l_buffers
.active
== ZORAN_FREE
)
557 zr
->v4l_buffers
.active
= fh
->buffers
.active
;
563 * Sync on a V4L buffer
566 static int v4l_sync(struct zoran_fh
*fh
, int frame
)
568 struct zoran
*zr
= fh
->zr
;
571 if (fh
->buffers
.active
== ZORAN_FREE
) {
574 "%s: %s - no grab active for this session\n",
575 ZR_DEVNAME(zr
), __func__
);
579 /* check passed-in frame number */
580 if (frame
>= fh
->buffers
.num_buffers
|| frame
< 0) {
582 KERN_ERR
"%s: %s - frame %d is invalid\n",
583 ZR_DEVNAME(zr
), __func__
, frame
);
587 /* Check if is buffer was queued at all */
588 if (zr
->v4l_buffers
.buffer
[frame
].state
== BUZ_STATE_USER
) {
591 "%s: %s - attempt to sync on a buffer which was not queued?\n",
592 ZR_DEVNAME(zr
), __func__
);
596 /* wait on this buffer to get ready */
597 if (!wait_event_interruptible_timeout(zr
->v4l_capq
,
598 (zr
->v4l_buffers
.buffer
[frame
].state
!= BUZ_STATE_PEND
), 10*HZ
))
600 if (signal_pending(current
))
603 /* buffer should now be in BUZ_STATE_DONE */
604 if (zr
->v4l_buffers
.buffer
[frame
].state
!= BUZ_STATE_DONE
)
606 KERN_ERR
"%s: %s - internal state error\n",
607 ZR_DEVNAME(zr
), __func__
);
609 zr
->v4l_buffers
.buffer
[frame
].state
= BUZ_STATE_USER
;
610 fh
->buffers
.buffer
[frame
] = zr
->v4l_buffers
.buffer
[frame
];
612 spin_lock_irqsave(&zr
->spinlock
, flags
);
614 /* Check if streaming capture has finished */
615 if (zr
->v4l_pend_tail
== zr
->v4l_pend_head
) {
616 zr36057_set_memgrab(zr
, 0);
617 if (zr
->v4l_buffers
.active
== ZORAN_ACTIVE
) {
618 fh
->buffers
.active
= zr
->v4l_buffers
.active
= ZORAN_FREE
;
619 zr
->v4l_buffers
.allocated
= 0;
623 spin_unlock_irqrestore(&zr
->spinlock
, flags
);
629 * Queue a MJPEG buffer for capture/playback
632 static int zoran_jpg_queue_frame(struct zoran_fh
*fh
, int num
,
633 enum zoran_codec_mode mode
)
635 struct zoran
*zr
= fh
->zr
;
639 /* Check if buffers are allocated */
640 if (!fh
->buffers
.allocated
) {
643 "%s: %s - buffers not yet allocated\n",
644 ZR_DEVNAME(zr
), __func__
);
648 /* No grabbing outside the buffer range! */
649 if (num
>= fh
->buffers
.num_buffers
|| num
< 0) {
652 "%s: %s - buffer %d out of range\n",
653 ZR_DEVNAME(zr
), __func__
, num
);
657 /* what is the codec mode right now? */
658 if (zr
->codec_mode
== BUZ_MODE_IDLE
) {
659 zr
->jpg_settings
= fh
->jpg_settings
;
660 } else if (zr
->codec_mode
!= mode
) {
661 /* wrong codec mode active - invalid */
664 "%s: %s - codec in wrong mode\n",
665 ZR_DEVNAME(zr
), __func__
);
669 if (fh
->buffers
.active
== ZORAN_FREE
) {
670 if (zr
->jpg_buffers
.active
== ZORAN_FREE
) {
671 zr
->jpg_buffers
= fh
->buffers
;
672 fh
->buffers
.active
= ZORAN_ACTIVE
;
676 "%s: %s - another session is already capturing\n",
677 ZR_DEVNAME(zr
), __func__
);
682 if (!res
&& zr
->codec_mode
== BUZ_MODE_IDLE
) {
683 /* Ok load up the jpeg codec */
684 zr36057_enable_jpg(zr
, mode
);
687 spin_lock_irqsave(&zr
->spinlock
, flags
);
690 switch (zr
->jpg_buffers
.buffer
[num
].state
) {
694 "%s: %s - queing frame in BUZ_STATE_DONE state!?\n",
695 ZR_DEVNAME(zr
), __func__
);
697 /* since there is at least one unused buffer there's room for at
698 *least one more pend[] entry */
699 zr
->jpg_pend
[zr
->jpg_que_head
++ & BUZ_MASK_FRAME
] = num
;
700 zr
->jpg_buffers
.buffer
[num
].state
= BUZ_STATE_PEND
;
701 fh
->buffers
.buffer
[num
] = zr
->jpg_buffers
.buffer
[num
];
702 zoran_feed_stat_com(zr
);
707 if (zr
->jpg_buffers
.active
== ZORAN_FREE
) {
708 fh
->buffers
.active
= ZORAN_FREE
;
709 zr
->jpg_buffers
.allocated
= 0;
711 res
= -EBUSY
; /* what are you doing? */
716 spin_unlock_irqrestore(&zr
->spinlock
, flags
);
718 if (!res
&& zr
->jpg_buffers
.active
== ZORAN_FREE
)
719 zr
->jpg_buffers
.active
= fh
->buffers
.active
;
724 static int jpg_qbuf(struct zoran_fh
*fh
, int frame
, enum zoran_codec_mode mode
)
726 struct zoran
*zr
= fh
->zr
;
729 /* Does the user want to stop streaming? */
731 if (zr
->codec_mode
== mode
) {
732 if (fh
->buffers
.active
== ZORAN_FREE
) {
735 "%s: %s(-1) - session not active\n",
736 ZR_DEVNAME(zr
), __func__
);
739 fh
->buffers
.active
= zr
->jpg_buffers
.active
= ZORAN_FREE
;
740 zr
->jpg_buffers
.allocated
= 0;
741 zr36057_enable_jpg(zr
, BUZ_MODE_IDLE
);
746 "%s: %s - stop streaming but not in streaming mode\n",
747 ZR_DEVNAME(zr
), __func__
);
752 if ((res
= zoran_jpg_queue_frame(fh
, frame
, mode
)))
755 /* Start the jpeg codec when the first frame is queued */
756 if (!res
&& zr
->jpg_que_head
== 1)
763 * Sync on a MJPEG buffer
766 static int jpg_sync(struct zoran_fh
*fh
, struct zoran_sync
*bs
)
768 struct zoran
*zr
= fh
->zr
;
772 if (fh
->buffers
.active
== ZORAN_FREE
) {
775 "%s: %s - capture is not currently active\n",
776 ZR_DEVNAME(zr
), __func__
);
779 if (zr
->codec_mode
!= BUZ_MODE_MOTION_DECOMPRESS
&&
780 zr
->codec_mode
!= BUZ_MODE_MOTION_COMPRESS
) {
783 "%s: %s - codec not in streaming mode\n",
784 ZR_DEVNAME(zr
), __func__
);
787 if (!wait_event_interruptible_timeout(zr
->jpg_capq
,
788 (zr
->jpg_que_tail
!= zr
->jpg_dma_tail
||
789 zr
->jpg_dma_tail
== zr
->jpg_dma_head
),
793 btand(~ZR36057_JMC_Go_en
, ZR36057_JMC
);
795 zr
->codec
->control(zr
->codec
, CODEC_G_STATUS
,
799 "%s: %s - timeout: codec isr=0x%02x\n",
800 ZR_DEVNAME(zr
), __func__
, isr
);
805 if (signal_pending(current
))
808 spin_lock_irqsave(&zr
->spinlock
, flags
);
810 if (zr
->jpg_dma_tail
!= zr
->jpg_dma_head
)
811 frame
= zr
->jpg_pend
[zr
->jpg_que_tail
++ & BUZ_MASK_FRAME
];
813 frame
= zr
->jpg_pend
[zr
->jpg_que_tail
& BUZ_MASK_FRAME
];
815 /* buffer should now be in BUZ_STATE_DONE */
816 if (zr
->jpg_buffers
.buffer
[frame
].state
!= BUZ_STATE_DONE
)
818 KERN_ERR
"%s: %s - internal state error\n",
819 ZR_DEVNAME(zr
), __func__
);
821 *bs
= zr
->jpg_buffers
.buffer
[frame
].bs
;
823 zr
->jpg_buffers
.buffer
[frame
].state
= BUZ_STATE_USER
;
824 fh
->buffers
.buffer
[frame
] = zr
->jpg_buffers
.buffer
[frame
];
826 spin_unlock_irqrestore(&zr
->spinlock
, flags
);
831 static void zoran_open_init_session(struct zoran_fh
*fh
)
834 struct zoran
*zr
= fh
->zr
;
836 /* Per default, map the V4L Buffers */
839 /* take over the card's current settings */
840 fh
->overlay_settings
= zr
->overlay_settings
;
841 fh
->overlay_settings
.is_set
= 0;
842 fh
->overlay_settings
.format
= zr
->overlay_settings
.format
;
843 fh
->overlay_active
= ZORAN_FREE
;
846 fh
->v4l_settings
= zr
->v4l_settings
;
848 fh
->jpg_settings
= zr
->jpg_settings
;
851 memset(&fh
->buffers
, 0, sizeof(fh
->buffers
));
852 for (i
= 0; i
< MAX_FRAME
; i
++) {
853 fh
->buffers
.buffer
[i
].state
= BUZ_STATE_USER
; /* nothing going on */
854 fh
->buffers
.buffer
[i
].bs
.frame
= i
;
856 fh
->buffers
.allocated
= 0;
857 fh
->buffers
.active
= ZORAN_FREE
;
860 static void zoran_close_end_session(struct zoran_fh
*fh
)
862 struct zoran
*zr
= fh
->zr
;
865 if (fh
->overlay_active
!= ZORAN_FREE
) {
866 fh
->overlay_active
= zr
->overlay_active
= ZORAN_FREE
;
867 zr
->v4l_overlay_active
= 0;
868 if (!zr
->v4l_memgrab_active
)
869 zr36057_overlay(zr
, 0);
870 zr
->overlay_mask
= NULL
;
873 if (fh
->map_mode
== ZORAN_MAP_MODE_RAW
) {
875 if (fh
->buffers
.active
!= ZORAN_FREE
) {
878 spin_lock_irqsave(&zr
->spinlock
, flags
);
879 zr36057_set_memgrab(zr
, 0);
880 zr
->v4l_buffers
.allocated
= 0;
881 zr
->v4l_buffers
.active
= fh
->buffers
.active
= ZORAN_FREE
;
882 spin_unlock_irqrestore(&zr
->spinlock
, flags
);
886 if (fh
->buffers
.allocated
)
887 v4l_fbuffer_free(fh
);
890 if (fh
->buffers
.active
!= ZORAN_FREE
) {
891 zr36057_enable_jpg(zr
, BUZ_MODE_IDLE
);
892 zr
->jpg_buffers
.allocated
= 0;
893 zr
->jpg_buffers
.active
= fh
->buffers
.active
= ZORAN_FREE
;
897 if (fh
->buffers
.allocated
)
898 jpg_fbuffer_free(fh
);
903 * Open a zoran card. Right now the flags stuff is just playing
906 static int zoran_open(struct file
*file
)
908 struct zoran
*zr
= video_drvdata(file
);
910 int res
, first_open
= 0;
912 dprintk(2, KERN_INFO
"%s: %s(%s, pid=[%d]), users(-)=%d\n",
913 ZR_DEVNAME(zr
), __func__
, current
->comm
, task_pid_nr(current
), zr
->user
+ 1);
915 mutex_lock(&zr
->other_lock
);
917 if (zr
->user
>= 2048) {
918 dprintk(1, KERN_ERR
"%s: too many users (%d) on device\n",
919 ZR_DEVNAME(zr
), zr
->user
);
924 /* now, create the open()-specific file_ops struct */
925 fh
= kzalloc(sizeof(struct zoran_fh
), GFP_KERNEL
);
929 "%s: %s - allocation of zoran_fh failed\n",
930 ZR_DEVNAME(zr
), __func__
);
934 /* used to be BUZ_MAX_WIDTH/HEIGHT, but that gives overflows
937 kmalloc(((768 + 31) / 32) * 576 * 4, GFP_KERNEL
);
938 if (!fh
->overlay_mask
) {
941 "%s: %s - allocation of overlay_mask failed\n",
942 ZR_DEVNAME(zr
), __func__
);
950 /*mutex_unlock(&zr->resource_lock);*/
952 /* default setup - TODO: look at flags */
953 if (first_open
) { /* First device open */
955 zoran_open_init_params(zr
);
956 zoran_init_hardware(zr
);
958 btor(ZR36057_ICR_IntPinEn
, ZR36057_ICR
);
961 /* set file_ops stuff */
962 file
->private_data
= fh
;
964 zoran_open_init_session(fh
);
965 mutex_unlock(&zr
->other_lock
);
972 mutex_unlock(&zr
->other_lock
);
974 dprintk(2, KERN_INFO
"%s: open failed (%d), users(-)=%d\n",
975 ZR_DEVNAME(zr
), res
, zr
->user
);
981 zoran_close(struct file
*file
)
983 struct zoran_fh
*fh
= file
->private_data
;
984 struct zoran
*zr
= fh
->zr
;
986 dprintk(2, KERN_INFO
"%s: %s(%s, pid=[%d]), users(+)=%d\n",
987 ZR_DEVNAME(zr
), __func__
, current
->comm
, task_pid_nr(current
), zr
->user
- 1);
989 /* kernel locks (fs/device.c), so don't do that ourselves
990 * (prevents deadlocks) */
991 mutex_lock(&zr
->other_lock
);
993 zoran_close_end_session(fh
);
995 if (zr
->user
-- == 1) { /* Last process */
996 /* Clean up JPEG process */
997 wake_up_interruptible(&zr
->jpg_capq
);
998 zr36057_enable_jpg(zr
, BUZ_MODE_IDLE
);
999 zr
->jpg_buffers
.allocated
= 0;
1000 zr
->jpg_buffers
.active
= ZORAN_FREE
;
1002 /* disable interrupts */
1003 btand(~ZR36057_ICR_IntPinEn
, ZR36057_ICR
);
1005 if (zr36067_debug
> 1)
1006 print_interrupts(zr
);
1009 zr
->v4l_overlay_active
= 0;
1010 zr36057_overlay(zr
, 0);
1011 zr
->overlay_mask
= NULL
;
1014 wake_up_interruptible(&zr
->v4l_capq
);
1015 zr36057_set_memgrab(zr
, 0);
1016 zr
->v4l_buffers
.allocated
= 0;
1017 zr
->v4l_buffers
.active
= ZORAN_FREE
;
1018 zoran_set_pci_master(zr
, 0);
1020 if (!pass_through
) { /* Switch to color bar */
1021 decoder_call(zr
, video
, s_stream
, 0);
1022 encoder_call(zr
, video
, s_routing
, 2, 0, 0);
1025 mutex_unlock(&zr
->other_lock
);
1027 file
->private_data
= NULL
;
1028 kfree(fh
->overlay_mask
);
1031 dprintk(4, KERN_INFO
"%s: %s done\n", ZR_DEVNAME(zr
), __func__
);
1038 zoran_read (struct file
*file
,
1043 /* we simply don't support read() (yet)... */
1049 zoran_write (struct file
*file
,
1050 const char __user
*data
,
1054 /* ...and the same goes for write() */
1059 static int setup_fbuffer(struct zoran_fh
*fh
,
1061 const struct zoran_format
*fmt
,
1066 struct zoran
*zr
= fh
->zr
;
1068 /* (Ronald) v4l/v4l2 guidelines */
1069 if (!capable(CAP_SYS_ADMIN
) && !capable(CAP_SYS_RAWIO
))
1072 /* Don't allow frame buffer overlay if PCI or AGP is buggy, or on
1073 ALi Magik (that needs very low latency while the card needs a
1074 higher value always) */
1076 if (pci_pci_problems
& (PCIPCI_FAIL
| PCIAGP_FAIL
| PCIPCI_ALIMAGIK
))
1079 /* we need a bytesperline value, even if not given */
1081 bytesperline
= width
* ((fmt
->depth
+ 7) & ~7) / 8;
1084 if (zr
->overlay_active
) {
1085 /* dzjee... stupid users... don't even bother to turn off
1086 * overlay before changing the memory location...
1087 * normally, we would return errors here. However, one of
1088 * the tools that does this is... xawtv! and since xawtv
1089 * is used by +/- 99% of the users, we'd rather be user-
1090 * friendly and silently do as if nothing went wrong */
1093 "%s: %s - forced overlay turnoff because framebuffer changed\n",
1094 ZR_DEVNAME(zr
), __func__
);
1095 zr36057_overlay(zr
, 0);
1099 if (!(fmt
->flags
& ZORAN_FORMAT_OVERLAY
)) {
1102 "%s: %s - no valid overlay format given\n",
1103 ZR_DEVNAME(zr
), __func__
);
1106 if (height
<= 0 || width
<= 0 || bytesperline
<= 0) {
1109 "%s: %s - invalid height/width/bpl value (%d|%d|%d)\n",
1110 ZR_DEVNAME(zr
), __func__
, width
, height
, bytesperline
);
1113 if (bytesperline
& 3) {
1116 "%s: %s - bytesperline (%d) must be 4-byte aligned\n",
1117 ZR_DEVNAME(zr
), __func__
, bytesperline
);
1121 zr
->vbuf_base
= (void *) ((unsigned long) base
& ~3);
1122 zr
->vbuf_height
= height
;
1123 zr
->vbuf_width
= width
;
1124 zr
->vbuf_depth
= fmt
->depth
;
1125 zr
->overlay_settings
.format
= fmt
;
1126 zr
->vbuf_bytesperline
= bytesperline
;
1128 /* The user should set new window parameters */
1129 zr
->overlay_settings
.is_set
= 0;
1135 static int setup_window(struct zoran_fh
*fh
, int x
, int y
, int width
, int height
,
1136 struct v4l2_clip __user
*clips
, int clipcount
, void __user
*bitmap
)
1138 struct zoran
*zr
= fh
->zr
;
1139 struct v4l2_clip
*vcp
= NULL
;
1143 if (!zr
->vbuf_base
) {
1146 "%s: %s - frame buffer has to be set first\n",
1147 ZR_DEVNAME(zr
), __func__
);
1151 if (!fh
->overlay_settings
.format
) {
1154 "%s: %s - no overlay format set\n",
1155 ZR_DEVNAME(zr
), __func__
);
1160 * The video front end needs 4-byte alinged line sizes, we correct that
1161 * silently here if necessary
1163 if (zr
->vbuf_depth
== 15 || zr
->vbuf_depth
== 16) {
1164 end
= (x
+ width
) & ~1; /* round down */
1165 x
= (x
+ 1) & ~1; /* round up */
1169 if (zr
->vbuf_depth
== 24) {
1170 end
= (x
+ width
) & ~3; /* round down */
1171 x
= (x
+ 3) & ~3; /* round up */
1175 if (width
> BUZ_MAX_WIDTH
)
1176 width
= BUZ_MAX_WIDTH
;
1177 if (height
> BUZ_MAX_HEIGHT
)
1178 height
= BUZ_MAX_HEIGHT
;
1180 /* Check for invalid parameters */
1181 if (width
< BUZ_MIN_WIDTH
|| height
< BUZ_MIN_HEIGHT
||
1182 width
> BUZ_MAX_WIDTH
|| height
> BUZ_MAX_HEIGHT
) {
1185 "%s: %s - width = %d or height = %d invalid\n",
1186 ZR_DEVNAME(zr
), __func__
, width
, height
);
1190 fh
->overlay_settings
.x
= x
;
1191 fh
->overlay_settings
.y
= y
;
1192 fh
->overlay_settings
.width
= width
;
1193 fh
->overlay_settings
.height
= height
;
1194 fh
->overlay_settings
.clipcount
= clipcount
;
1197 * If an overlay is running, we have to switch it off
1198 * and switch it on again in order to get the new settings in effect.
1200 * We also want to avoid that the overlay mask is written
1201 * when an overlay is running.
1204 on
= zr
->v4l_overlay_active
&& !zr
->v4l_memgrab_active
&&
1205 zr
->overlay_active
!= ZORAN_FREE
&&
1206 fh
->overlay_active
!= ZORAN_FREE
;
1208 zr36057_overlay(zr
, 0);
1211 * Write the overlay mask if clips are wanted.
1212 * We prefer a bitmap.
1215 /* fake value - it just means we want clips */
1216 fh
->overlay_settings
.clipcount
= 1;
1218 if (copy_from_user(fh
->overlay_mask
, bitmap
,
1219 (width
* height
+ 7) / 8)) {
1222 } else if (clipcount
> 0) {
1223 /* write our own bitmap from the clips */
1224 vcp
= vmalloc(sizeof(struct v4l2_clip
) * (clipcount
+ 4));
1228 "%s: %s - Alloc of clip mask failed\n",
1229 ZR_DEVNAME(zr
), __func__
);
1233 (vcp
, clips
, sizeof(struct v4l2_clip
) * clipcount
)) {
1237 write_overlay_mask(fh
, vcp
, clipcount
);
1241 fh
->overlay_settings
.is_set
= 1;
1242 if (fh
->overlay_active
!= ZORAN_FREE
&&
1243 zr
->overlay_active
!= ZORAN_FREE
)
1244 zr
->overlay_settings
= fh
->overlay_settings
;
1247 zr36057_overlay(zr
, 1);
1249 /* Make sure the changes come into effect */
1250 return wait_grab_pending(zr
);
1253 static int setup_overlay(struct zoran_fh
*fh
, int on
)
1255 struct zoran
*zr
= fh
->zr
;
1257 /* If there is nothing to do, return immediatly */
1258 if ((on
&& fh
->overlay_active
!= ZORAN_FREE
) ||
1259 (!on
&& fh
->overlay_active
== ZORAN_FREE
))
1262 /* check whether we're touching someone else's overlay */
1263 if (on
&& zr
->overlay_active
!= ZORAN_FREE
&&
1264 fh
->overlay_active
== ZORAN_FREE
) {
1267 "%s: %s - overlay is already active for another session\n",
1268 ZR_DEVNAME(zr
), __func__
);
1271 if (!on
&& zr
->overlay_active
!= ZORAN_FREE
&&
1272 fh
->overlay_active
== ZORAN_FREE
) {
1275 "%s: %s - you cannot cancel someone else's session\n",
1276 ZR_DEVNAME(zr
), __func__
);
1281 zr
->overlay_active
= fh
->overlay_active
= ZORAN_FREE
;
1282 zr
->v4l_overlay_active
= 0;
1283 /* When a grab is running, the video simply
1284 * won't be switched on any more */
1285 if (!zr
->v4l_memgrab_active
)
1286 zr36057_overlay(zr
, 0);
1287 zr
->overlay_mask
= NULL
;
1289 if (!zr
->vbuf_base
|| !fh
->overlay_settings
.is_set
) {
1292 "%s: %s - buffer or window not set\n",
1293 ZR_DEVNAME(zr
), __func__
);
1296 if (!fh
->overlay_settings
.format
) {
1299 "%s: %s - no overlay format set\n",
1300 ZR_DEVNAME(zr
), __func__
);
1303 zr
->overlay_active
= fh
->overlay_active
= ZORAN_LOCKED
;
1304 zr
->v4l_overlay_active
= 1;
1305 zr
->overlay_mask
= fh
->overlay_mask
;
1306 zr
->overlay_settings
= fh
->overlay_settings
;
1307 if (!zr
->v4l_memgrab_active
)
1308 zr36057_overlay(zr
, 1);
1309 /* When a grab is running, the video will be
1310 * switched on when grab is finished */
1313 /* Make sure the changes come into effect */
1314 return wait_grab_pending(zr
);
1317 /* get the status of a buffer in the clients buffer queue */
1318 static int zoran_v4l2_buffer_status(struct zoran_fh
*fh
,
1319 struct v4l2_buffer
*buf
, int num
)
1321 struct zoran
*zr
= fh
->zr
;
1322 unsigned long flags
;
1324 buf
->flags
= V4L2_BUF_FLAG_MAPPED
;
1326 switch (fh
->map_mode
) {
1327 case ZORAN_MAP_MODE_RAW
:
1329 if (num
< 0 || num
>= fh
->buffers
.num_buffers
||
1330 !fh
->buffers
.allocated
) {
1333 "%s: %s - wrong number or buffers not allocated\n",
1334 ZR_DEVNAME(zr
), __func__
);
1338 spin_lock_irqsave(&zr
->spinlock
, flags
);
1341 "%s: %s() - raw active=%c, buffer %d: state=%c, map=%c\n",
1342 ZR_DEVNAME(zr
), __func__
,
1343 "FAL"[fh
->buffers
.active
], num
,
1344 "UPMD"[zr
->v4l_buffers
.buffer
[num
].state
],
1345 fh
->buffers
.buffer
[num
].map
? 'Y' : 'N');
1346 spin_unlock_irqrestore(&zr
->spinlock
, flags
);
1348 buf
->type
= V4L2_BUF_TYPE_VIDEO_CAPTURE
;
1349 buf
->length
= fh
->buffers
.buffer_size
;
1352 buf
->bytesused
= fh
->buffers
.buffer
[num
].bs
.length
;
1353 if (fh
->buffers
.buffer
[num
].state
== BUZ_STATE_DONE
||
1354 fh
->buffers
.buffer
[num
].state
== BUZ_STATE_USER
) {
1355 buf
->sequence
= fh
->buffers
.buffer
[num
].bs
.seq
;
1356 buf
->flags
|= V4L2_BUF_FLAG_DONE
;
1357 buf
->timestamp
= fh
->buffers
.buffer
[num
].bs
.timestamp
;
1359 buf
->flags
|= V4L2_BUF_FLAG_QUEUED
;
1362 if (fh
->v4l_settings
.height
<= BUZ_MAX_HEIGHT
/ 2)
1363 buf
->field
= V4L2_FIELD_TOP
;
1365 buf
->field
= V4L2_FIELD_INTERLACED
;
1369 case ZORAN_MAP_MODE_JPG_REC
:
1370 case ZORAN_MAP_MODE_JPG_PLAY
:
1373 if (num
< 0 || num
>= fh
->buffers
.num_buffers
||
1374 !fh
->buffers
.allocated
) {
1377 "%s: %s - wrong number or buffers not allocated\n",
1378 ZR_DEVNAME(zr
), __func__
);
1382 buf
->type
= (fh
->map_mode
== ZORAN_MAP_MODE_JPG_REC
) ?
1383 V4L2_BUF_TYPE_VIDEO_CAPTURE
:
1384 V4L2_BUF_TYPE_VIDEO_OUTPUT
;
1385 buf
->length
= fh
->buffers
.buffer_size
;
1387 /* these variables are only written after frame has been captured */
1388 if (fh
->buffers
.buffer
[num
].state
== BUZ_STATE_DONE
||
1389 fh
->buffers
.buffer
[num
].state
== BUZ_STATE_USER
) {
1390 buf
->sequence
= fh
->buffers
.buffer
[num
].bs
.seq
;
1391 buf
->timestamp
= fh
->buffers
.buffer
[num
].bs
.timestamp
;
1392 buf
->bytesused
= fh
->buffers
.buffer
[num
].bs
.length
;
1393 buf
->flags
|= V4L2_BUF_FLAG_DONE
;
1395 buf
->flags
|= V4L2_BUF_FLAG_QUEUED
;
1398 /* which fields are these? */
1399 if (fh
->jpg_settings
.TmpDcm
!= 1)
1400 buf
->field
= fh
->jpg_settings
.odd_even
?
1401 V4L2_FIELD_TOP
: V4L2_FIELD_BOTTOM
;
1403 buf
->field
= fh
->jpg_settings
.odd_even
?
1404 V4L2_FIELD_SEQ_TB
: V4L2_FIELD_SEQ_BT
;
1412 "%s: %s - invalid buffer type|map_mode (%d|%d)\n",
1413 ZR_DEVNAME(zr
), __func__
, buf
->type
, fh
->map_mode
);
1417 buf
->memory
= V4L2_MEMORY_MMAP
;
1419 buf
->m
.offset
= buf
->length
* num
;
1425 zoran_set_norm (struct zoran
*zr
,
1430 if (zr
->v4l_buffers
.active
!= ZORAN_FREE
||
1431 zr
->jpg_buffers
.active
!= ZORAN_FREE
) {
1434 "%s: %s called while in playback/capture mode\n",
1435 ZR_DEVNAME(zr
), __func__
);
1439 if (!(norm
& zr
->card
.norms
)) {
1441 KERN_ERR
"%s: %s - unsupported norm %llx\n",
1442 ZR_DEVNAME(zr
), __func__
, norm
);
1446 if (norm
== V4L2_STD_ALL
) {
1447 unsigned int status
= 0;
1448 v4l2_std_id std
= 0;
1450 decoder_call(zr
, video
, querystd
, &std
);
1451 decoder_call(zr
, core
, s_std
, std
);
1453 /* let changes come into effect */
1456 decoder_call(zr
, video
, g_input_status
, &status
);
1457 if (status
& V4L2_IN_ST_NO_SIGNAL
) {
1460 "%s: %s - no norm detected\n",
1461 ZR_DEVNAME(zr
), __func__
);
1463 decoder_call(zr
, core
, s_std
, zr
->norm
);
1469 if (norm
& V4L2_STD_SECAM
)
1470 zr
->timing
= zr
->card
.tvn
[2];
1471 else if (norm
& V4L2_STD_NTSC
)
1472 zr
->timing
= zr
->card
.tvn
[1];
1474 zr
->timing
= zr
->card
.tvn
[0];
1476 /* We switch overlay off and on since a change in the
1477 * norm needs different VFE settings */
1478 on
= zr
->overlay_active
&& !zr
->v4l_memgrab_active
;
1480 zr36057_overlay(zr
, 0);
1482 decoder_call(zr
, core
, s_std
, norm
);
1483 encoder_call(zr
, video
, s_std_output
, norm
);
1486 zr36057_overlay(zr
, 1);
1488 /* Make sure the changes come into effect */
1495 zoran_set_input (struct zoran
*zr
,
1498 if (input
== zr
->input
) {
1502 if (zr
->v4l_buffers
.active
!= ZORAN_FREE
||
1503 zr
->jpg_buffers
.active
!= ZORAN_FREE
) {
1506 "%s: %s called while in playback/capture mode\n",
1507 ZR_DEVNAME(zr
), __func__
);
1511 if (input
< 0 || input
>= zr
->card
.inputs
) {
1514 "%s: %s - unnsupported input %d\n",
1515 ZR_DEVNAME(zr
), __func__
, input
);
1521 decoder_call(zr
, video
, s_routing
,
1522 zr
->card
.input
[input
].muxsel
, 0, 0);
1531 static int zoran_querycap(struct file
*file
, void *__fh
, struct v4l2_capability
*cap
)
1533 struct zoran_fh
*fh
= __fh
;
1534 struct zoran
*zr
= fh
->zr
;
1536 memset(cap
, 0, sizeof(*cap
));
1537 strncpy(cap
->card
, ZR_DEVNAME(zr
), sizeof(cap
->card
)-1);
1538 strncpy(cap
->driver
, "zoran", sizeof(cap
->driver
)-1);
1539 snprintf(cap
->bus_info
, sizeof(cap
->bus_info
), "PCI:%s",
1540 pci_name(zr
->pci_dev
));
1541 cap
->version
= KERNEL_VERSION(MAJOR_VERSION
, MINOR_VERSION
,
1543 cap
->capabilities
= V4L2_CAP_STREAMING
| V4L2_CAP_VIDEO_CAPTURE
|
1544 V4L2_CAP_VIDEO_OUTPUT
| V4L2_CAP_VIDEO_OVERLAY
;
1548 static int zoran_enum_fmt(struct zoran
*zr
, struct v4l2_fmtdesc
*fmt
, int flag
)
1550 unsigned int num
, i
;
1552 for (num
= i
= 0; i
< NUM_FORMATS
; i
++) {
1553 if (zoran_formats
[i
].flags
& flag
&& num
++ == fmt
->index
) {
1554 strncpy(fmt
->description
, zoran_formats
[i
].name
,
1555 sizeof(fmt
->description
) - 1);
1556 /* fmt struct pre-zeroed, so adding '\0' not neeed */
1557 fmt
->pixelformat
= zoran_formats
[i
].fourcc
;
1558 if (zoran_formats
[i
].flags
& ZORAN_FORMAT_COMPRESSED
)
1559 fmt
->flags
|= V4L2_FMT_FLAG_COMPRESSED
;
1566 static int zoran_enum_fmt_vid_cap(struct file
*file
, void *__fh
,
1567 struct v4l2_fmtdesc
*f
)
1569 struct zoran_fh
*fh
= __fh
;
1570 struct zoran
*zr
= fh
->zr
;
1572 return zoran_enum_fmt(zr
, f
, ZORAN_FORMAT_CAPTURE
);
1575 static int zoran_enum_fmt_vid_out(struct file
*file
, void *__fh
,
1576 struct v4l2_fmtdesc
*f
)
1578 struct zoran_fh
*fh
= __fh
;
1579 struct zoran
*zr
= fh
->zr
;
1581 return zoran_enum_fmt(zr
, f
, ZORAN_FORMAT_PLAYBACK
);
1584 static int zoran_enum_fmt_vid_overlay(struct file
*file
, void *__fh
,
1585 struct v4l2_fmtdesc
*f
)
1587 struct zoran_fh
*fh
= __fh
;
1588 struct zoran
*zr
= fh
->zr
;
1590 return zoran_enum_fmt(zr
, f
, ZORAN_FORMAT_OVERLAY
);
1593 static int zoran_g_fmt_vid_out(struct file
*file
, void *__fh
,
1594 struct v4l2_format
*fmt
)
1596 struct zoran_fh
*fh
= __fh
;
1597 struct zoran
*zr
= fh
->zr
;
1599 mutex_lock(&zr
->resource_lock
);
1601 fmt
->fmt
.pix
.width
= fh
->jpg_settings
.img_width
/ fh
->jpg_settings
.HorDcm
;
1602 fmt
->fmt
.pix
.height
= fh
->jpg_settings
.img_height
* 2 /
1603 (fh
->jpg_settings
.VerDcm
* fh
->jpg_settings
.TmpDcm
);
1604 fmt
->fmt
.pix
.sizeimage
= zoran_v4l2_calc_bufsize(&fh
->jpg_settings
);
1605 fmt
->fmt
.pix
.pixelformat
= V4L2_PIX_FMT_MJPEG
;
1606 if (fh
->jpg_settings
.TmpDcm
== 1)
1607 fmt
->fmt
.pix
.field
= (fh
->jpg_settings
.odd_even
?
1608 V4L2_FIELD_SEQ_TB
: V4L2_FIELD_SEQ_BT
);
1610 fmt
->fmt
.pix
.field
= (fh
->jpg_settings
.odd_even
?
1611 V4L2_FIELD_TOP
: V4L2_FIELD_BOTTOM
);
1612 fmt
->fmt
.pix
.bytesperline
= 0;
1613 fmt
->fmt
.pix
.colorspace
= V4L2_COLORSPACE_SMPTE170M
;
1615 mutex_unlock(&zr
->resource_lock
);
1619 static int zoran_g_fmt_vid_cap(struct file
*file
, void *__fh
,
1620 struct v4l2_format
*fmt
)
1622 struct zoran_fh
*fh
= __fh
;
1623 struct zoran
*zr
= fh
->zr
;
1625 if (fh
->map_mode
!= ZORAN_MAP_MODE_RAW
)
1626 return zoran_g_fmt_vid_out(file
, fh
, fmt
);
1628 mutex_lock(&zr
->resource_lock
);
1629 fmt
->fmt
.pix
.width
= fh
->v4l_settings
.width
;
1630 fmt
->fmt
.pix
.height
= fh
->v4l_settings
.height
;
1631 fmt
->fmt
.pix
.sizeimage
= fh
->v4l_settings
.bytesperline
*
1632 fh
->v4l_settings
.height
;
1633 fmt
->fmt
.pix
.pixelformat
= fh
->v4l_settings
.format
->fourcc
;
1634 fmt
->fmt
.pix
.colorspace
= fh
->v4l_settings
.format
->colorspace
;
1635 fmt
->fmt
.pix
.bytesperline
= fh
->v4l_settings
.bytesperline
;
1636 if (BUZ_MAX_HEIGHT
< (fh
->v4l_settings
.height
* 2))
1637 fmt
->fmt
.pix
.field
= V4L2_FIELD_INTERLACED
;
1639 fmt
->fmt
.pix
.field
= V4L2_FIELD_TOP
;
1640 mutex_unlock(&zr
->resource_lock
);
1644 static int zoran_g_fmt_vid_overlay(struct file
*file
, void *__fh
,
1645 struct v4l2_format
*fmt
)
1647 struct zoran_fh
*fh
= __fh
;
1648 struct zoran
*zr
= fh
->zr
;
1650 mutex_lock(&zr
->resource_lock
);
1652 fmt
->fmt
.win
.w
.left
= fh
->overlay_settings
.x
;
1653 fmt
->fmt
.win
.w
.top
= fh
->overlay_settings
.y
;
1654 fmt
->fmt
.win
.w
.width
= fh
->overlay_settings
.width
;
1655 fmt
->fmt
.win
.w
.height
= fh
->overlay_settings
.height
;
1656 if (fh
->overlay_settings
.width
* 2 > BUZ_MAX_HEIGHT
)
1657 fmt
->fmt
.win
.field
= V4L2_FIELD_INTERLACED
;
1659 fmt
->fmt
.win
.field
= V4L2_FIELD_TOP
;
1661 mutex_unlock(&zr
->resource_lock
);
1665 static int zoran_try_fmt_vid_overlay(struct file
*file
, void *__fh
,
1666 struct v4l2_format
*fmt
)
1668 struct zoran_fh
*fh
= __fh
;
1669 struct zoran
*zr
= fh
->zr
;
1671 mutex_lock(&zr
->resource_lock
);
1673 if (fmt
->fmt
.win
.w
.width
> BUZ_MAX_WIDTH
)
1674 fmt
->fmt
.win
.w
.width
= BUZ_MAX_WIDTH
;
1675 if (fmt
->fmt
.win
.w
.width
< BUZ_MIN_WIDTH
)
1676 fmt
->fmt
.win
.w
.width
= BUZ_MIN_WIDTH
;
1677 if (fmt
->fmt
.win
.w
.height
> BUZ_MAX_HEIGHT
)
1678 fmt
->fmt
.win
.w
.height
= BUZ_MAX_HEIGHT
;
1679 if (fmt
->fmt
.win
.w
.height
< BUZ_MIN_HEIGHT
)
1680 fmt
->fmt
.win
.w
.height
= BUZ_MIN_HEIGHT
;
1682 mutex_unlock(&zr
->resource_lock
);
1686 static int zoran_try_fmt_vid_out(struct file
*file
, void *__fh
,
1687 struct v4l2_format
*fmt
)
1689 struct zoran_fh
*fh
= __fh
;
1690 struct zoran
*zr
= fh
->zr
;
1691 struct zoran_jpg_settings settings
;
1694 if (fmt
->fmt
.pix
.pixelformat
!= V4L2_PIX_FMT_MJPEG
)
1697 mutex_lock(&zr
->resource_lock
);
1698 settings
= fh
->jpg_settings
;
1700 /* we actually need to set 'real' parameters now */
1701 if ((fmt
->fmt
.pix
.height
* 2) > BUZ_MAX_HEIGHT
)
1702 settings
.TmpDcm
= 1;
1704 settings
.TmpDcm
= 2;
1705 settings
.decimation
= 0;
1706 if (fmt
->fmt
.pix
.height
<= fh
->jpg_settings
.img_height
/ 2)
1707 settings
.VerDcm
= 2;
1709 settings
.VerDcm
= 1;
1710 if (fmt
->fmt
.pix
.width
<= fh
->jpg_settings
.img_width
/ 4)
1711 settings
.HorDcm
= 4;
1712 else if (fmt
->fmt
.pix
.width
<= fh
->jpg_settings
.img_width
/ 2)
1713 settings
.HorDcm
= 2;
1715 settings
.HorDcm
= 1;
1716 if (settings
.TmpDcm
== 1)
1717 settings
.field_per_buff
= 2;
1719 settings
.field_per_buff
= 1;
1721 if (settings
.HorDcm
> 1) {
1722 settings
.img_x
= (BUZ_MAX_WIDTH
== 720) ? 8 : 0;
1723 settings
.img_width
= (BUZ_MAX_WIDTH
== 720) ? 704 : BUZ_MAX_WIDTH
;
1726 settings
.img_width
= BUZ_MAX_WIDTH
;
1730 res
= zoran_check_jpg_settings(zr
, &settings
, 1);
1732 goto tryfmt_unlock_and_return
;
1734 /* tell the user what we actually did */
1735 fmt
->fmt
.pix
.width
= settings
.img_width
/ settings
.HorDcm
;
1736 fmt
->fmt
.pix
.height
= settings
.img_height
* 2 /
1737 (settings
.TmpDcm
* settings
.VerDcm
);
1738 if (settings
.TmpDcm
== 1)
1739 fmt
->fmt
.pix
.field
= (fh
->jpg_settings
.odd_even
?
1740 V4L2_FIELD_SEQ_TB
: V4L2_FIELD_SEQ_BT
);
1742 fmt
->fmt
.pix
.field
= (fh
->jpg_settings
.odd_even
?
1743 V4L2_FIELD_TOP
: V4L2_FIELD_BOTTOM
);
1745 fmt
->fmt
.pix
.sizeimage
= zoran_v4l2_calc_bufsize(&settings
);
1746 fmt
->fmt
.pix
.bytesperline
= 0;
1747 fmt
->fmt
.pix
.colorspace
= V4L2_COLORSPACE_SMPTE170M
;
1748 tryfmt_unlock_and_return
:
1749 mutex_unlock(&zr
->resource_lock
);
1753 static int zoran_try_fmt_vid_cap(struct file
*file
, void *__fh
,
1754 struct v4l2_format
*fmt
)
1756 struct zoran_fh
*fh
= __fh
;
1757 struct zoran
*zr
= fh
->zr
;
1761 if (fmt
->fmt
.pix
.pixelformat
== V4L2_PIX_FMT_MJPEG
)
1762 return zoran_try_fmt_vid_out(file
, fh
, fmt
);
1764 mutex_lock(&zr
->resource_lock
);
1766 for (i
= 0; i
< NUM_FORMATS
; i
++)
1767 if (zoran_formats
[i
].fourcc
== fmt
->fmt
.pix
.pixelformat
)
1770 if (i
== NUM_FORMATS
) {
1771 mutex_unlock(&zr
->resource_lock
);
1775 bpp
= DIV_ROUND_UP(zoran_formats
[i
].depth
, 8);
1776 v4l_bound_align_image(
1777 &fmt
->fmt
.pix
.width
, BUZ_MIN_WIDTH
, BUZ_MAX_WIDTH
, bpp
== 2 ? 1 : 2,
1778 &fmt
->fmt
.pix
.height
, BUZ_MIN_HEIGHT
, BUZ_MAX_HEIGHT
, 0, 0);
1779 mutex_unlock(&zr
->resource_lock
);
1784 static int zoran_s_fmt_vid_overlay(struct file
*file
, void *__fh
,
1785 struct v4l2_format
*fmt
)
1787 struct zoran_fh
*fh
= __fh
;
1788 struct zoran
*zr
= fh
->zr
;
1791 dprintk(3, "x=%d, y=%d, w=%d, h=%d, cnt=%d, map=0x%p\n",
1792 fmt
->fmt
.win
.w
.left
, fmt
->fmt
.win
.w
.top
,
1793 fmt
->fmt
.win
.w
.width
,
1794 fmt
->fmt
.win
.w
.height
,
1795 fmt
->fmt
.win
.clipcount
,
1796 fmt
->fmt
.win
.bitmap
);
1797 mutex_lock(&zr
->resource_lock
);
1798 res
= setup_window(fh
, fmt
->fmt
.win
.w
.left
, fmt
->fmt
.win
.w
.top
,
1799 fmt
->fmt
.win
.w
.width
, fmt
->fmt
.win
.w
.height
,
1800 (struct v4l2_clip __user
*)fmt
->fmt
.win
.clips
,
1801 fmt
->fmt
.win
.clipcount
, fmt
->fmt
.win
.bitmap
);
1802 mutex_unlock(&zr
->resource_lock
);
1806 static int zoran_s_fmt_vid_out(struct file
*file
, void *__fh
,
1807 struct v4l2_format
*fmt
)
1809 struct zoran_fh
*fh
= __fh
;
1810 struct zoran
*zr
= fh
->zr
;
1811 __le32 printformat
= __cpu_to_le32(fmt
->fmt
.pix
.pixelformat
);
1812 struct zoran_jpg_settings settings
;
1815 dprintk(3, "size=%dx%d, fmt=0x%x (%4.4s)\n",
1816 fmt
->fmt
.pix
.width
, fmt
->fmt
.pix
.height
,
1817 fmt
->fmt
.pix
.pixelformat
,
1818 (char *) &printformat
);
1819 if (fmt
->fmt
.pix
.pixelformat
!= V4L2_PIX_FMT_MJPEG
)
1822 mutex_lock(&zr
->resource_lock
);
1824 if (fh
->buffers
.allocated
) {
1825 dprintk(1, KERN_ERR
"%s: VIDIOC_S_FMT - cannot change capture mode\n",
1828 goto sfmtjpg_unlock_and_return
;
1831 settings
= fh
->jpg_settings
;
1833 /* we actually need to set 'real' parameters now */
1834 if (fmt
->fmt
.pix
.height
* 2 > BUZ_MAX_HEIGHT
)
1835 settings
.TmpDcm
= 1;
1837 settings
.TmpDcm
= 2;
1838 settings
.decimation
= 0;
1839 if (fmt
->fmt
.pix
.height
<= fh
->jpg_settings
.img_height
/ 2)
1840 settings
.VerDcm
= 2;
1842 settings
.VerDcm
= 1;
1843 if (fmt
->fmt
.pix
.width
<= fh
->jpg_settings
.img_width
/ 4)
1844 settings
.HorDcm
= 4;
1845 else if (fmt
->fmt
.pix
.width
<= fh
->jpg_settings
.img_width
/ 2)
1846 settings
.HorDcm
= 2;
1848 settings
.HorDcm
= 1;
1849 if (settings
.TmpDcm
== 1)
1850 settings
.field_per_buff
= 2;
1852 settings
.field_per_buff
= 1;
1854 if (settings
.HorDcm
> 1) {
1855 settings
.img_x
= (BUZ_MAX_WIDTH
== 720) ? 8 : 0;
1856 settings
.img_width
= (BUZ_MAX_WIDTH
== 720) ? 704 : BUZ_MAX_WIDTH
;
1859 settings
.img_width
= BUZ_MAX_WIDTH
;
1863 res
= zoran_check_jpg_settings(zr
, &settings
, 0);
1865 goto sfmtjpg_unlock_and_return
;
1867 /* it's ok, so set them */
1868 fh
->jpg_settings
= settings
;
1870 map_mode_jpg(fh
, fmt
->type
== V4L2_BUF_TYPE_VIDEO_OUTPUT
);
1871 fh
->buffers
.buffer_size
= zoran_v4l2_calc_bufsize(&fh
->jpg_settings
);
1873 /* tell the user what we actually did */
1874 fmt
->fmt
.pix
.width
= settings
.img_width
/ settings
.HorDcm
;
1875 fmt
->fmt
.pix
.height
= settings
.img_height
* 2 /
1876 (settings
.TmpDcm
* settings
.VerDcm
);
1877 if (settings
.TmpDcm
== 1)
1878 fmt
->fmt
.pix
.field
= (fh
->jpg_settings
.odd_even
?
1879 V4L2_FIELD_SEQ_TB
: V4L2_FIELD_SEQ_BT
);
1881 fmt
->fmt
.pix
.field
= (fh
->jpg_settings
.odd_even
?
1882 V4L2_FIELD_TOP
: V4L2_FIELD_BOTTOM
);
1883 fmt
->fmt
.pix
.bytesperline
= 0;
1884 fmt
->fmt
.pix
.sizeimage
= fh
->buffers
.buffer_size
;
1885 fmt
->fmt
.pix
.colorspace
= V4L2_COLORSPACE_SMPTE170M
;
1887 sfmtjpg_unlock_and_return
:
1888 mutex_unlock(&zr
->resource_lock
);
1892 static int zoran_s_fmt_vid_cap(struct file
*file
, void *__fh
,
1893 struct v4l2_format
*fmt
)
1895 struct zoran_fh
*fh
= __fh
;
1896 struct zoran
*zr
= fh
->zr
;
1900 if (fmt
->fmt
.pix
.pixelformat
== V4L2_PIX_FMT_MJPEG
)
1901 return zoran_s_fmt_vid_out(file
, fh
, fmt
);
1903 for (i
= 0; i
< NUM_FORMATS
; i
++)
1904 if (fmt
->fmt
.pix
.pixelformat
== zoran_formats
[i
].fourcc
)
1906 if (i
== NUM_FORMATS
) {
1907 dprintk(1, KERN_ERR
"%s: VIDIOC_S_FMT - unknown/unsupported format 0x%x\n",
1908 ZR_DEVNAME(zr
), fmt
->fmt
.pix
.pixelformat
);
1912 mutex_lock(&zr
->resource_lock
);
1914 if ((fh
->map_mode
!= ZORAN_MAP_MODE_RAW
&& fh
->buffers
.allocated
) ||
1915 fh
->buffers
.active
!= ZORAN_FREE
) {
1916 dprintk(1, KERN_ERR
"%s: VIDIOC_S_FMT - cannot change capture mode\n",
1919 goto sfmtv4l_unlock_and_return
;
1921 if (fmt
->fmt
.pix
.height
> BUZ_MAX_HEIGHT
)
1922 fmt
->fmt
.pix
.height
= BUZ_MAX_HEIGHT
;
1923 if (fmt
->fmt
.pix
.width
> BUZ_MAX_WIDTH
)
1924 fmt
->fmt
.pix
.width
= BUZ_MAX_WIDTH
;
1928 res
= zoran_v4l_set_format(fh
, fmt
->fmt
.pix
.width
, fmt
->fmt
.pix
.height
,
1931 goto sfmtv4l_unlock_and_return
;
1933 /* tell the user the results/missing stuff */
1934 fmt
->fmt
.pix
.bytesperline
= fh
->v4l_settings
.bytesperline
;
1935 fmt
->fmt
.pix
.sizeimage
= fh
->v4l_settings
.height
* fh
->v4l_settings
.bytesperline
;
1936 fmt
->fmt
.pix
.colorspace
= fh
->v4l_settings
.format
->colorspace
;
1937 if (BUZ_MAX_HEIGHT
< (fh
->v4l_settings
.height
* 2))
1938 fmt
->fmt
.pix
.field
= V4L2_FIELD_INTERLACED
;
1940 fmt
->fmt
.pix
.field
= V4L2_FIELD_TOP
;
1942 sfmtv4l_unlock_and_return
:
1943 mutex_unlock(&zr
->resource_lock
);
1947 static int zoran_g_fbuf(struct file
*file
, void *__fh
,
1948 struct v4l2_framebuffer
*fb
)
1950 struct zoran_fh
*fh
= __fh
;
1951 struct zoran
*zr
= fh
->zr
;
1953 memset(fb
, 0, sizeof(*fb
));
1954 mutex_lock(&zr
->resource_lock
);
1955 fb
->base
= zr
->vbuf_base
;
1956 fb
->fmt
.width
= zr
->vbuf_width
;
1957 fb
->fmt
.height
= zr
->vbuf_height
;
1958 if (zr
->overlay_settings
.format
)
1959 fb
->fmt
.pixelformat
= fh
->overlay_settings
.format
->fourcc
;
1960 fb
->fmt
.bytesperline
= zr
->vbuf_bytesperline
;
1961 mutex_unlock(&zr
->resource_lock
);
1962 fb
->fmt
.colorspace
= V4L2_COLORSPACE_SRGB
;
1963 fb
->fmt
.field
= V4L2_FIELD_INTERLACED
;
1964 fb
->flags
= V4L2_FBUF_FLAG_OVERLAY
;
1965 fb
->capability
= V4L2_FBUF_CAP_LIST_CLIPPING
;
1970 static int zoran_s_fbuf(struct file
*file
, void *__fh
,
1971 struct v4l2_framebuffer
*fb
)
1973 struct zoran_fh
*fh
= __fh
;
1974 struct zoran
*zr
= fh
->zr
;
1976 __le32 printformat
= __cpu_to_le32(fb
->fmt
.pixelformat
);
1978 for (i
= 0; i
< NUM_FORMATS
; i
++)
1979 if (zoran_formats
[i
].fourcc
== fb
->fmt
.pixelformat
)
1981 if (i
== NUM_FORMATS
) {
1982 dprintk(1, KERN_ERR
"%s: VIDIOC_S_FBUF - format=0x%x (%4.4s) not allowed\n",
1983 ZR_DEVNAME(zr
), fb
->fmt
.pixelformat
,
1984 (char *)&printformat
);
1988 mutex_lock(&zr
->resource_lock
);
1989 res
= setup_fbuffer(fh
, fb
->base
, &zoran_formats
[i
], fb
->fmt
.width
,
1990 fb
->fmt
.height
, fb
->fmt
.bytesperline
);
1991 mutex_unlock(&zr
->resource_lock
);
1996 static int zoran_overlay(struct file
*file
, void *__fh
, unsigned int on
)
1998 struct zoran_fh
*fh
= __fh
;
1999 struct zoran
*zr
= fh
->zr
;
2002 mutex_lock(&zr
->resource_lock
);
2003 res
= setup_overlay(fh
, on
);
2004 mutex_unlock(&zr
->resource_lock
);
2009 static int zoran_streamoff(struct file
*file
, void *__fh
, enum v4l2_buf_type type
);
2011 static int zoran_reqbufs(struct file
*file
, void *__fh
, struct v4l2_requestbuffers
*req
)
2013 struct zoran_fh
*fh
= __fh
;
2014 struct zoran
*zr
= fh
->zr
;
2017 if (req
->memory
!= V4L2_MEMORY_MMAP
) {
2020 "%s: only MEMORY_MMAP capture is supported, not %d\n",
2021 ZR_DEVNAME(zr
), req
->memory
);
2025 if (req
->count
== 0)
2026 return zoran_streamoff(file
, fh
, req
->type
);
2028 mutex_lock(&zr
->resource_lock
);
2029 if (fh
->buffers
.allocated
) {
2032 "%s: VIDIOC_REQBUFS - buffers already allocated\n",
2035 goto v4l2reqbuf_unlock_and_return
;
2038 if (fh
->map_mode
== ZORAN_MAP_MODE_RAW
&&
2039 req
->type
== V4L2_BUF_TYPE_VIDEO_CAPTURE
) {
2040 /* control user input */
2043 if (req
->count
> v4l_nbufs
)
2044 req
->count
= v4l_nbufs
;
2046 /* The next mmap will map the V4L buffers */
2048 fh
->buffers
.num_buffers
= req
->count
;
2050 if (v4l_fbuffer_alloc(fh
)) {
2052 goto v4l2reqbuf_unlock_and_return
;
2054 } else if (fh
->map_mode
== ZORAN_MAP_MODE_JPG_REC
||
2055 fh
->map_mode
== ZORAN_MAP_MODE_JPG_PLAY
) {
2056 /* we need to calculate size ourselves now */
2059 if (req
->count
> jpg_nbufs
)
2060 req
->count
= jpg_nbufs
;
2062 /* The next mmap will map the MJPEG buffers */
2063 map_mode_jpg(fh
, req
->type
== V4L2_BUF_TYPE_VIDEO_OUTPUT
);
2064 fh
->buffers
.num_buffers
= req
->count
;
2065 fh
->buffers
.buffer_size
= zoran_v4l2_calc_bufsize(&fh
->jpg_settings
);
2067 if (jpg_fbuffer_alloc(fh
)) {
2069 goto v4l2reqbuf_unlock_and_return
;
2074 "%s: VIDIOC_REQBUFS - unknown type %d\n",
2075 ZR_DEVNAME(zr
), req
->type
);
2077 goto v4l2reqbuf_unlock_and_return
;
2079 v4l2reqbuf_unlock_and_return
:
2080 mutex_unlock(&zr
->resource_lock
);
2085 static int zoran_querybuf(struct file
*file
, void *__fh
, struct v4l2_buffer
*buf
)
2087 struct zoran_fh
*fh
= __fh
;
2088 struct zoran
*zr
= fh
->zr
;
2091 mutex_lock(&zr
->resource_lock
);
2092 res
= zoran_v4l2_buffer_status(fh
, buf
, buf
->index
);
2093 mutex_unlock(&zr
->resource_lock
);
2098 static int zoran_qbuf(struct file
*file
, void *__fh
, struct v4l2_buffer
*buf
)
2100 struct zoran_fh
*fh
= __fh
;
2101 struct zoran
*zr
= fh
->zr
;
2102 int res
= 0, codec_mode
, buf_type
;
2104 mutex_lock(&zr
->resource_lock
);
2106 switch (fh
->map_mode
) {
2107 case ZORAN_MAP_MODE_RAW
:
2108 if (buf
->type
!= V4L2_BUF_TYPE_VIDEO_CAPTURE
) {
2110 "%s: VIDIOC_QBUF - invalid buf->type=%d for map_mode=%d\n",
2111 ZR_DEVNAME(zr
), buf
->type
, fh
->map_mode
);
2113 goto qbuf_unlock_and_return
;
2116 res
= zoran_v4l_queue_frame(fh
, buf
->index
);
2118 goto qbuf_unlock_and_return
;
2119 if (!zr
->v4l_memgrab_active
&& fh
->buffers
.active
== ZORAN_LOCKED
)
2120 zr36057_set_memgrab(zr
, 1);
2123 case ZORAN_MAP_MODE_JPG_REC
:
2124 case ZORAN_MAP_MODE_JPG_PLAY
:
2125 if (fh
->map_mode
== ZORAN_MAP_MODE_JPG_PLAY
) {
2126 buf_type
= V4L2_BUF_TYPE_VIDEO_OUTPUT
;
2127 codec_mode
= BUZ_MODE_MOTION_DECOMPRESS
;
2129 buf_type
= V4L2_BUF_TYPE_VIDEO_CAPTURE
;
2130 codec_mode
= BUZ_MODE_MOTION_COMPRESS
;
2133 if (buf
->type
!= buf_type
) {
2135 "%s: VIDIOC_QBUF - invalid buf->type=%d for map_mode=%d\n",
2136 ZR_DEVNAME(zr
), buf
->type
, fh
->map_mode
);
2138 goto qbuf_unlock_and_return
;
2141 res
= zoran_jpg_queue_frame(fh
, buf
->index
, codec_mode
);
2143 goto qbuf_unlock_and_return
;
2144 if (zr
->codec_mode
== BUZ_MODE_IDLE
&&
2145 fh
->buffers
.active
== ZORAN_LOCKED
)
2146 zr36057_enable_jpg(zr
, codec_mode
);
2152 "%s: VIDIOC_QBUF - unsupported type %d\n",
2153 ZR_DEVNAME(zr
), buf
->type
);
2157 qbuf_unlock_and_return
:
2158 mutex_unlock(&zr
->resource_lock
);
2163 static int zoran_dqbuf(struct file
*file
, void *__fh
, struct v4l2_buffer
*buf
)
2165 struct zoran_fh
*fh
= __fh
;
2166 struct zoran
*zr
= fh
->zr
;
2167 int res
= 0, buf_type
, num
= -1; /* compiler borks here (?) */
2169 mutex_lock(&zr
->resource_lock
);
2171 switch (fh
->map_mode
) {
2172 case ZORAN_MAP_MODE_RAW
:
2173 if (buf
->type
!= V4L2_BUF_TYPE_VIDEO_CAPTURE
) {
2175 "%s: VIDIOC_QBUF - invalid buf->type=%d for map_mode=%d\n",
2176 ZR_DEVNAME(zr
), buf
->type
, fh
->map_mode
);
2178 goto dqbuf_unlock_and_return
;
2181 num
= zr
->v4l_pend
[zr
->v4l_sync_tail
& V4L_MASK_FRAME
];
2182 if (file
->f_flags
& O_NONBLOCK
&&
2183 zr
->v4l_buffers
.buffer
[num
].state
!= BUZ_STATE_DONE
) {
2185 goto dqbuf_unlock_and_return
;
2187 res
= v4l_sync(fh
, num
);
2189 goto dqbuf_unlock_and_return
;
2190 zr
->v4l_sync_tail
++;
2191 res
= zoran_v4l2_buffer_status(fh
, buf
, num
);
2194 case ZORAN_MAP_MODE_JPG_REC
:
2195 case ZORAN_MAP_MODE_JPG_PLAY
:
2197 struct zoran_sync bs
;
2199 if (fh
->map_mode
== ZORAN_MAP_MODE_JPG_PLAY
)
2200 buf_type
= V4L2_BUF_TYPE_VIDEO_OUTPUT
;
2202 buf_type
= V4L2_BUF_TYPE_VIDEO_CAPTURE
;
2204 if (buf
->type
!= buf_type
) {
2206 "%s: VIDIOC_QBUF - invalid buf->type=%d for map_mode=%d\n",
2207 ZR_DEVNAME(zr
), buf
->type
, fh
->map_mode
);
2209 goto dqbuf_unlock_and_return
;
2212 num
= zr
->jpg_pend
[zr
->jpg_que_tail
& BUZ_MASK_FRAME
];
2214 if (file
->f_flags
& O_NONBLOCK
&&
2215 zr
->jpg_buffers
.buffer
[num
].state
!= BUZ_STATE_DONE
) {
2217 goto dqbuf_unlock_and_return
;
2219 bs
.frame
= 0; /* suppress compiler warning */
2220 res
= jpg_sync(fh
, &bs
);
2222 goto dqbuf_unlock_and_return
;
2223 res
= zoran_v4l2_buffer_status(fh
, buf
, bs
.frame
);
2229 "%s: VIDIOC_DQBUF - unsupported type %d\n",
2230 ZR_DEVNAME(zr
), buf
->type
);
2234 dqbuf_unlock_and_return
:
2235 mutex_unlock(&zr
->resource_lock
);
2240 static int zoran_streamon(struct file
*file
, void *__fh
, enum v4l2_buf_type type
)
2242 struct zoran_fh
*fh
= __fh
;
2243 struct zoran
*zr
= fh
->zr
;
2246 mutex_lock(&zr
->resource_lock
);
2248 switch (fh
->map_mode
) {
2249 case ZORAN_MAP_MODE_RAW
: /* raw capture */
2250 if (zr
->v4l_buffers
.active
!= ZORAN_ACTIVE
||
2251 fh
->buffers
.active
!= ZORAN_ACTIVE
) {
2253 goto strmon_unlock_and_return
;
2256 zr
->v4l_buffers
.active
= fh
->buffers
.active
= ZORAN_LOCKED
;
2257 zr
->v4l_settings
= fh
->v4l_settings
;
2259 zr
->v4l_sync_tail
= zr
->v4l_pend_tail
;
2260 if (!zr
->v4l_memgrab_active
&&
2261 zr
->v4l_pend_head
!= zr
->v4l_pend_tail
) {
2262 zr36057_set_memgrab(zr
, 1);
2266 case ZORAN_MAP_MODE_JPG_REC
:
2267 case ZORAN_MAP_MODE_JPG_PLAY
:
2268 /* what is the codec mode right now? */
2269 if (zr
->jpg_buffers
.active
!= ZORAN_ACTIVE
||
2270 fh
->buffers
.active
!= ZORAN_ACTIVE
) {
2272 goto strmon_unlock_and_return
;
2275 zr
->jpg_buffers
.active
= fh
->buffers
.active
= ZORAN_LOCKED
;
2277 if (zr
->jpg_que_head
!= zr
->jpg_que_tail
) {
2278 /* Start the jpeg codec when the first frame is queued */
2286 "%s: VIDIOC_STREAMON - invalid map mode %d\n",
2287 ZR_DEVNAME(zr
), fh
->map_mode
);
2291 strmon_unlock_and_return
:
2292 mutex_unlock(&zr
->resource_lock
);
2297 static int zoran_streamoff(struct file
*file
, void *__fh
, enum v4l2_buf_type type
)
2299 struct zoran_fh
*fh
= __fh
;
2300 struct zoran
*zr
= fh
->zr
;
2302 unsigned long flags
;
2304 mutex_lock(&zr
->resource_lock
);
2306 switch (fh
->map_mode
) {
2307 case ZORAN_MAP_MODE_RAW
: /* raw capture */
2308 if (fh
->buffers
.active
== ZORAN_FREE
&&
2309 zr
->v4l_buffers
.active
!= ZORAN_FREE
) {
2310 res
= -EPERM
; /* stay off other's settings! */
2311 goto strmoff_unlock_and_return
;
2313 if (zr
->v4l_buffers
.active
== ZORAN_FREE
)
2314 goto strmoff_unlock_and_return
;
2316 spin_lock_irqsave(&zr
->spinlock
, flags
);
2317 /* unload capture */
2318 if (zr
->v4l_memgrab_active
) {
2320 zr36057_set_memgrab(zr
, 0);
2323 for (i
= 0; i
< fh
->buffers
.num_buffers
; i
++)
2324 zr
->v4l_buffers
.buffer
[i
].state
= BUZ_STATE_USER
;
2325 fh
->buffers
= zr
->v4l_buffers
;
2327 zr
->v4l_buffers
.active
= fh
->buffers
.active
= ZORAN_FREE
;
2329 zr
->v4l_grab_seq
= 0;
2330 zr
->v4l_pend_head
= zr
->v4l_pend_tail
= 0;
2331 zr
->v4l_sync_tail
= 0;
2333 spin_unlock_irqrestore(&zr
->spinlock
, flags
);
2337 case ZORAN_MAP_MODE_JPG_REC
:
2338 case ZORAN_MAP_MODE_JPG_PLAY
:
2339 if (fh
->buffers
.active
== ZORAN_FREE
&&
2340 zr
->jpg_buffers
.active
!= ZORAN_FREE
) {
2341 res
= -EPERM
; /* stay off other's settings! */
2342 goto strmoff_unlock_and_return
;
2344 if (zr
->jpg_buffers
.active
== ZORAN_FREE
)
2345 goto strmoff_unlock_and_return
;
2347 res
= jpg_qbuf(fh
, -1,
2348 (fh
->map_mode
== ZORAN_MAP_MODE_JPG_REC
) ?
2349 BUZ_MODE_MOTION_COMPRESS
:
2350 BUZ_MODE_MOTION_DECOMPRESS
);
2352 goto strmoff_unlock_and_return
;
2356 "%s: VIDIOC_STREAMOFF - invalid map mode %d\n",
2357 ZR_DEVNAME(zr
), fh
->map_mode
);
2361 strmoff_unlock_and_return
:
2362 mutex_unlock(&zr
->resource_lock
);
2367 static int zoran_queryctrl(struct file
*file
, void *__fh
,
2368 struct v4l2_queryctrl
*ctrl
)
2370 struct zoran_fh
*fh
= __fh
;
2371 struct zoran
*zr
= fh
->zr
;
2373 /* we only support hue/saturation/contrast/brightness */
2374 if (ctrl
->id
< V4L2_CID_BRIGHTNESS
||
2375 ctrl
->id
> V4L2_CID_HUE
)
2378 decoder_call(zr
, core
, queryctrl
, ctrl
);
2383 static int zoran_g_ctrl(struct file
*file
, void *__fh
, struct v4l2_control
*ctrl
)
2385 struct zoran_fh
*fh
= __fh
;
2386 struct zoran
*zr
= fh
->zr
;
2388 /* we only support hue/saturation/contrast/brightness */
2389 if (ctrl
->id
< V4L2_CID_BRIGHTNESS
||
2390 ctrl
->id
> V4L2_CID_HUE
)
2393 mutex_lock(&zr
->resource_lock
);
2394 decoder_call(zr
, core
, g_ctrl
, ctrl
);
2395 mutex_unlock(&zr
->resource_lock
);
2400 static int zoran_s_ctrl(struct file
*file
, void *__fh
, struct v4l2_control
*ctrl
)
2402 struct zoran_fh
*fh
= __fh
;
2403 struct zoran
*zr
= fh
->zr
;
2405 /* we only support hue/saturation/contrast/brightness */
2406 if (ctrl
->id
< V4L2_CID_BRIGHTNESS
||
2407 ctrl
->id
> V4L2_CID_HUE
)
2410 mutex_lock(&zr
->resource_lock
);
2411 decoder_call(zr
, core
, s_ctrl
, ctrl
);
2412 mutex_unlock(&zr
->resource_lock
);
2417 static int zoran_g_std(struct file
*file
, void *__fh
, v4l2_std_id
*std
)
2419 struct zoran_fh
*fh
= __fh
;
2420 struct zoran
*zr
= fh
->zr
;
2422 mutex_lock(&zr
->resource_lock
);
2424 mutex_unlock(&zr
->resource_lock
);
2428 static int zoran_s_std(struct file
*file
, void *__fh
, v4l2_std_id
*std
)
2430 struct zoran_fh
*fh
= __fh
;
2431 struct zoran
*zr
= fh
->zr
;
2434 mutex_lock(&zr
->resource_lock
);
2435 res
= zoran_set_norm(zr
, *std
);
2437 goto sstd_unlock_and_return
;
2439 res
= wait_grab_pending(zr
);
2440 sstd_unlock_and_return
:
2441 mutex_unlock(&zr
->resource_lock
);
2445 static int zoran_enum_input(struct file
*file
, void *__fh
,
2446 struct v4l2_input
*inp
)
2448 struct zoran_fh
*fh
= __fh
;
2449 struct zoran
*zr
= fh
->zr
;
2451 if (inp
->index
>= zr
->card
.inputs
)
2454 strncpy(inp
->name
, zr
->card
.input
[inp
->index
].name
,
2455 sizeof(inp
->name
) - 1);
2456 inp
->type
= V4L2_INPUT_TYPE_CAMERA
;
2457 inp
->std
= V4L2_STD_ALL
;
2459 /* Get status of video decoder */
2460 mutex_lock(&zr
->resource_lock
);
2461 decoder_call(zr
, video
, g_input_status
, &inp
->status
);
2462 mutex_unlock(&zr
->resource_lock
);
2466 static int zoran_g_input(struct file
*file
, void *__fh
, unsigned int *input
)
2468 struct zoran_fh
*fh
= __fh
;
2469 struct zoran
*zr
= fh
->zr
;
2471 mutex_lock(&zr
->resource_lock
);
2473 mutex_unlock(&zr
->resource_lock
);
2478 static int zoran_s_input(struct file
*file
, void *__fh
, unsigned int input
)
2480 struct zoran_fh
*fh
= __fh
;
2481 struct zoran
*zr
= fh
->zr
;
2484 mutex_lock(&zr
->resource_lock
);
2485 res
= zoran_set_input(zr
, input
);
2487 goto sinput_unlock_and_return
;
2489 /* Make sure the changes come into effect */
2490 res
= wait_grab_pending(zr
);
2491 sinput_unlock_and_return
:
2492 mutex_unlock(&zr
->resource_lock
);
2496 static int zoran_enum_output(struct file
*file
, void *__fh
,
2497 struct v4l2_output
*outp
)
2499 if (outp
->index
!= 0)
2503 outp
->type
= V4L2_OUTPUT_TYPE_ANALOGVGAOVERLAY
;
2504 strncpy(outp
->name
, "Autodetect", sizeof(outp
->name
)-1);
2509 static int zoran_g_output(struct file
*file
, void *__fh
, unsigned int *output
)
2516 static int zoran_s_output(struct file
*file
, void *__fh
, unsigned int output
)
2524 /* cropping (sub-frame capture) */
2525 static int zoran_cropcap(struct file
*file
, void *__fh
,
2526 struct v4l2_cropcap
*cropcap
)
2528 struct zoran_fh
*fh
= __fh
;
2529 struct zoran
*zr
= fh
->zr
;
2530 int type
= cropcap
->type
, res
= 0;
2532 memset(cropcap
, 0, sizeof(*cropcap
));
2533 cropcap
->type
= type
;
2535 mutex_lock(&zr
->resource_lock
);
2537 if (cropcap
->type
!= V4L2_BUF_TYPE_VIDEO_OUTPUT
&&
2538 (cropcap
->type
!= V4L2_BUF_TYPE_VIDEO_CAPTURE
||
2539 fh
->map_mode
== ZORAN_MAP_MODE_RAW
)) {
2541 "%s: VIDIOC_CROPCAP - subcapture only supported for compressed capture\n",
2544 goto cropcap_unlock_and_return
;
2547 cropcap
->bounds
.top
= cropcap
->bounds
.left
= 0;
2548 cropcap
->bounds
.width
= BUZ_MAX_WIDTH
;
2549 cropcap
->bounds
.height
= BUZ_MAX_HEIGHT
;
2550 cropcap
->defrect
.top
= cropcap
->defrect
.left
= 0;
2551 cropcap
->defrect
.width
= BUZ_MIN_WIDTH
;
2552 cropcap
->defrect
.height
= BUZ_MIN_HEIGHT
;
2553 cropcap_unlock_and_return
:
2554 mutex_unlock(&zr
->resource_lock
);
2558 static int zoran_g_crop(struct file
*file
, void *__fh
, struct v4l2_crop
*crop
)
2560 struct zoran_fh
*fh
= __fh
;
2561 struct zoran
*zr
= fh
->zr
;
2562 int type
= crop
->type
, res
= 0;
2564 memset(crop
, 0, sizeof(*crop
));
2567 mutex_lock(&zr
->resource_lock
);
2569 if (crop
->type
!= V4L2_BUF_TYPE_VIDEO_OUTPUT
&&
2570 (crop
->type
!= V4L2_BUF_TYPE_VIDEO_CAPTURE
||
2571 fh
->map_mode
== ZORAN_MAP_MODE_RAW
)) {
2574 "%s: VIDIOC_G_CROP - subcapture only supported for compressed capture\n",
2577 goto gcrop_unlock_and_return
;
2580 crop
->c
.top
= fh
->jpg_settings
.img_y
;
2581 crop
->c
.left
= fh
->jpg_settings
.img_x
;
2582 crop
->c
.width
= fh
->jpg_settings
.img_width
;
2583 crop
->c
.height
= fh
->jpg_settings
.img_height
;
2585 gcrop_unlock_and_return
:
2586 mutex_unlock(&zr
->resource_lock
);
2591 static int zoran_s_crop(struct file
*file
, void *__fh
, struct v4l2_crop
*crop
)
2593 struct zoran_fh
*fh
= __fh
;
2594 struct zoran
*zr
= fh
->zr
;
2596 struct zoran_jpg_settings settings
;
2598 settings
= fh
->jpg_settings
;
2600 mutex_lock(&zr
->resource_lock
);
2602 if (fh
->buffers
.allocated
) {
2604 "%s: VIDIOC_S_CROP - cannot change settings while active\n",
2607 goto scrop_unlock_and_return
;
2610 if (crop
->type
!= V4L2_BUF_TYPE_VIDEO_OUTPUT
&&
2611 (crop
->type
!= V4L2_BUF_TYPE_VIDEO_CAPTURE
||
2612 fh
->map_mode
== ZORAN_MAP_MODE_RAW
)) {
2614 "%s: VIDIOC_G_CROP - subcapture only supported for compressed capture\n",
2617 goto scrop_unlock_and_return
;
2620 /* move into a form that we understand */
2621 settings
.img_x
= crop
->c
.left
;
2622 settings
.img_y
= crop
->c
.top
;
2623 settings
.img_width
= crop
->c
.width
;
2624 settings
.img_height
= crop
->c
.height
;
2626 /* check validity */
2627 res
= zoran_check_jpg_settings(zr
, &settings
, 0);
2629 goto scrop_unlock_and_return
;
2632 fh
->jpg_settings
= settings
;
2634 scrop_unlock_and_return
:
2635 mutex_unlock(&zr
->resource_lock
);
2639 static int zoran_g_jpegcomp(struct file
*file
, void *__fh
,
2640 struct v4l2_jpegcompression
*params
)
2642 struct zoran_fh
*fh
= __fh
;
2643 struct zoran
*zr
= fh
->zr
;
2644 memset(params
, 0, sizeof(*params
));
2646 mutex_lock(&zr
->resource_lock
);
2648 params
->quality
= fh
->jpg_settings
.jpg_comp
.quality
;
2649 params
->APPn
= fh
->jpg_settings
.jpg_comp
.APPn
;
2650 memcpy(params
->APP_data
,
2651 fh
->jpg_settings
.jpg_comp
.APP_data
,
2652 fh
->jpg_settings
.jpg_comp
.APP_len
);
2653 params
->APP_len
= fh
->jpg_settings
.jpg_comp
.APP_len
;
2654 memcpy(params
->COM_data
,
2655 fh
->jpg_settings
.jpg_comp
.COM_data
,
2656 fh
->jpg_settings
.jpg_comp
.COM_len
);
2657 params
->COM_len
= fh
->jpg_settings
.jpg_comp
.COM_len
;
2658 params
->jpeg_markers
=
2659 fh
->jpg_settings
.jpg_comp
.jpeg_markers
;
2661 mutex_unlock(&zr
->resource_lock
);
2666 static int zoran_s_jpegcomp(struct file
*file
, void *__fh
,
2667 struct v4l2_jpegcompression
*params
)
2669 struct zoran_fh
*fh
= __fh
;
2670 struct zoran
*zr
= fh
->zr
;
2672 struct zoran_jpg_settings settings
;
2674 settings
= fh
->jpg_settings
;
2676 settings
.jpg_comp
= *params
;
2678 mutex_lock(&zr
->resource_lock
);
2680 if (fh
->buffers
.active
!= ZORAN_FREE
) {
2681 dprintk(1, KERN_WARNING
2682 "%s: VIDIOC_S_JPEGCOMP called while in playback/capture mode\n",
2685 goto sjpegc_unlock_and_return
;
2688 res
= zoran_check_jpg_settings(zr
, &settings
, 0);
2690 goto sjpegc_unlock_and_return
;
2691 if (!fh
->buffers
.allocated
)
2692 fh
->buffers
.buffer_size
=
2693 zoran_v4l2_calc_bufsize(&fh
->jpg_settings
);
2694 fh
->jpg_settings
.jpg_comp
= *params
= settings
.jpg_comp
;
2695 sjpegc_unlock_and_return
:
2696 mutex_unlock(&zr
->resource_lock
);
2702 zoran_poll (struct file
*file
,
2705 struct zoran_fh
*fh
= file
->private_data
;
2706 struct zoran
*zr
= fh
->zr
;
2708 unsigned long flags
;
2710 /* we should check whether buffers are ready to be synced on
2711 * (w/o waits - O_NONBLOCK) here
2712 * if ready for read (sync), return POLLIN|POLLRDNORM,
2713 * if ready for write (sync), return POLLOUT|POLLWRNORM,
2714 * if error, return POLLERR,
2715 * if no buffers queued or so, return POLLNVAL
2718 mutex_lock(&zr
->resource_lock
);
2720 switch (fh
->map_mode
) {
2721 case ZORAN_MAP_MODE_RAW
:
2722 poll_wait(file
, &zr
->v4l_capq
, wait
);
2723 frame
= zr
->v4l_pend
[zr
->v4l_sync_tail
& V4L_MASK_FRAME
];
2725 spin_lock_irqsave(&zr
->spinlock
, flags
);
2728 "%s: %s() raw - active=%c, sync_tail=%lu/%c, pend_tail=%lu, pend_head=%lu\n",
2729 ZR_DEVNAME(zr
), __func__
,
2730 "FAL"[fh
->buffers
.active
], zr
->v4l_sync_tail
,
2731 "UPMD"[zr
->v4l_buffers
.buffer
[frame
].state
],
2732 zr
->v4l_pend_tail
, zr
->v4l_pend_head
);
2733 /* Process is the one capturing? */
2734 if (fh
->buffers
.active
!= ZORAN_FREE
&&
2735 /* Buffer ready to DQBUF? */
2736 zr
->v4l_buffers
.buffer
[frame
].state
== BUZ_STATE_DONE
)
2737 res
= POLLIN
| POLLRDNORM
;
2738 spin_unlock_irqrestore(&zr
->spinlock
, flags
);
2742 case ZORAN_MAP_MODE_JPG_REC
:
2743 case ZORAN_MAP_MODE_JPG_PLAY
:
2744 poll_wait(file
, &zr
->jpg_capq
, wait
);
2745 frame
= zr
->jpg_pend
[zr
->jpg_que_tail
& BUZ_MASK_FRAME
];
2747 spin_lock_irqsave(&zr
->spinlock
, flags
);
2750 "%s: %s() jpg - active=%c, que_tail=%lu/%c, que_head=%lu, dma=%lu/%lu\n",
2751 ZR_DEVNAME(zr
), __func__
,
2752 "FAL"[fh
->buffers
.active
], zr
->jpg_que_tail
,
2753 "UPMD"[zr
->jpg_buffers
.buffer
[frame
].state
],
2754 zr
->jpg_que_head
, zr
->jpg_dma_tail
, zr
->jpg_dma_head
);
2755 if (fh
->buffers
.active
!= ZORAN_FREE
&&
2756 zr
->jpg_buffers
.buffer
[frame
].state
== BUZ_STATE_DONE
) {
2757 if (fh
->map_mode
== ZORAN_MAP_MODE_JPG_REC
)
2758 res
= POLLIN
| POLLRDNORM
;
2760 res
= POLLOUT
| POLLWRNORM
;
2762 spin_unlock_irqrestore(&zr
->spinlock
, flags
);
2769 "%s: %s - internal error, unknown map_mode=%d\n",
2770 ZR_DEVNAME(zr
), __func__
, fh
->map_mode
);
2774 mutex_unlock(&zr
->resource_lock
);
2781 * This maps the buffers to user space.
2783 * Depending on the state of fh->map_mode
2784 * the V4L or the MJPEG buffers are mapped
2785 * per buffer or all together
2787 * Note that we need to connect to some
2788 * unmap signal event to unmap the de-allocate
2789 * the buffer accordingly (zoran_vm_close())
2793 zoran_vm_open (struct vm_area_struct
*vma
)
2795 struct zoran_mapping
*map
= vma
->vm_private_data
;
2801 zoran_vm_close (struct vm_area_struct
*vma
)
2803 struct zoran_mapping
*map
= vma
->vm_private_data
;
2804 struct zoran_fh
*fh
= map
->file
->private_data
;
2805 struct zoran
*zr
= fh
->zr
;
2808 if (--map
->count
> 0)
2811 dprintk(3, KERN_INFO
"%s: %s - munmap(%s)\n", ZR_DEVNAME(zr
),
2812 __func__
, mode_name(fh
->map_mode
));
2814 for (i
= 0; i
< fh
->buffers
.num_buffers
; i
++) {
2815 if (fh
->buffers
.buffer
[i
].map
== map
)
2816 fh
->buffers
.buffer
[i
].map
= NULL
;
2820 /* Any buffers still mapped? */
2821 for (i
= 0; i
< fh
->buffers
.num_buffers
; i
++)
2822 if (fh
->buffers
.buffer
[i
].map
)
2825 dprintk(3, KERN_INFO
"%s: %s - free %s buffers\n", ZR_DEVNAME(zr
),
2826 __func__
, mode_name(fh
->map_mode
));
2828 mutex_lock(&zr
->resource_lock
);
2830 if (fh
->map_mode
== ZORAN_MAP_MODE_RAW
) {
2831 if (fh
->buffers
.active
!= ZORAN_FREE
) {
2832 unsigned long flags
;
2834 spin_lock_irqsave(&zr
->spinlock
, flags
);
2835 zr36057_set_memgrab(zr
, 0);
2836 zr
->v4l_buffers
.allocated
= 0;
2837 zr
->v4l_buffers
.active
= fh
->buffers
.active
= ZORAN_FREE
;
2838 spin_unlock_irqrestore(&zr
->spinlock
, flags
);
2840 v4l_fbuffer_free(fh
);
2842 if (fh
->buffers
.active
!= ZORAN_FREE
) {
2843 jpg_qbuf(fh
, -1, zr
->codec_mode
);
2844 zr
->jpg_buffers
.allocated
= 0;
2845 zr
->jpg_buffers
.active
= fh
->buffers
.active
= ZORAN_FREE
;
2847 jpg_fbuffer_free(fh
);
2850 mutex_unlock(&zr
->resource_lock
);
2853 static const struct vm_operations_struct zoran_vm_ops
= {
2854 .open
= zoran_vm_open
,
2855 .close
= zoran_vm_close
,
2859 zoran_mmap (struct file
*file
,
2860 struct vm_area_struct
*vma
)
2862 struct zoran_fh
*fh
= file
->private_data
;
2863 struct zoran
*zr
= fh
->zr
;
2864 unsigned long size
= (vma
->vm_end
- vma
->vm_start
);
2865 unsigned long offset
= vma
->vm_pgoff
<< PAGE_SHIFT
;
2867 unsigned long page
, start
= vma
->vm_start
, todo
, pos
, fraglen
;
2869 struct zoran_mapping
*map
;
2873 KERN_INFO
"%s: %s(%s) of 0x%08lx-0x%08lx (size=%lu)\n",
2874 ZR_DEVNAME(zr
), __func__
,
2875 mode_name(fh
->map_mode
), vma
->vm_start
, vma
->vm_end
, size
);
2877 if (!(vma
->vm_flags
& VM_SHARED
) || !(vma
->vm_flags
& VM_READ
) ||
2878 !(vma
->vm_flags
& VM_WRITE
)) {
2881 "%s: %s - no MAP_SHARED/PROT_{READ,WRITE} given\n",
2882 ZR_DEVNAME(zr
), __func__
);
2886 mutex_lock(&zr
->resource_lock
);
2888 if (!fh
->buffers
.allocated
) {
2891 "%s: %s(%s) - buffers not yet allocated\n",
2892 ZR_DEVNAME(zr
), __func__
, mode_name(fh
->map_mode
));
2894 goto mmap_unlock_and_return
;
2897 first
= offset
/ fh
->buffers
.buffer_size
;
2898 last
= first
- 1 + size
/ fh
->buffers
.buffer_size
;
2899 if (offset
% fh
->buffers
.buffer_size
!= 0 ||
2900 size
% fh
->buffers
.buffer_size
!= 0 || first
< 0 ||
2901 last
< 0 || first
>= fh
->buffers
.num_buffers
||
2902 last
>= fh
->buffers
.buffer_size
) {
2905 "%s: %s(%s) - offset=%lu or size=%lu invalid for bufsize=%d and numbufs=%d\n",
2906 ZR_DEVNAME(zr
), __func__
, mode_name(fh
->map_mode
), offset
, size
,
2907 fh
->buffers
.buffer_size
,
2908 fh
->buffers
.num_buffers
);
2910 goto mmap_unlock_and_return
;
2913 /* Check if any buffers are already mapped */
2914 for (i
= first
; i
<= last
; i
++) {
2915 if (fh
->buffers
.buffer
[i
].map
) {
2918 "%s: %s(%s) - buffer %d already mapped\n",
2919 ZR_DEVNAME(zr
), __func__
, mode_name(fh
->map_mode
), i
);
2921 goto mmap_unlock_and_return
;
2925 /* map these buffers */
2926 map
= kmalloc(sizeof(struct zoran_mapping
), GFP_KERNEL
);
2929 goto mmap_unlock_and_return
;
2934 vma
->vm_ops
= &zoran_vm_ops
;
2935 vma
->vm_flags
|= VM_DONTEXPAND
;
2936 vma
->vm_private_data
= map
;
2938 if (fh
->map_mode
== ZORAN_MAP_MODE_RAW
) {
2939 for (i
= first
; i
<= last
; i
++) {
2941 if (todo
> fh
->buffers
.buffer_size
)
2942 todo
= fh
->buffers
.buffer_size
;
2943 page
= fh
->buffers
.buffer
[i
].v4l
.fbuffer_phys
;
2944 if (remap_pfn_range(vma
, start
, page
>> PAGE_SHIFT
,
2945 todo
, PAGE_SHARED
)) {
2948 "%s: %s(V4L) - remap_pfn_range failed\n",
2949 ZR_DEVNAME(zr
), __func__
);
2951 goto mmap_unlock_and_return
;
2955 fh
->buffers
.buffer
[i
].map
= map
;
2960 for (i
= first
; i
<= last
; i
++) {
2962 j
< fh
->buffers
.buffer_size
/ PAGE_SIZE
;
2965 (le32_to_cpu(fh
->buffers
.buffer
[i
].jpg
.
2966 frag_tab
[2 * j
+ 1]) & ~1) << 1;
2971 le32_to_cpu(fh
->buffers
.
2972 buffer
[i
].jpg
.frag_tab
[2 * j
]);
2973 /* should just be pos on i386 */
2974 page
= virt_to_phys(bus_to_virt(pos
))
2976 if (remap_pfn_range(vma
, start
, page
,
2977 todo
, PAGE_SHARED
)) {
2980 "%s: %s(V4L) - remap_pfn_range failed\n",
2981 ZR_DEVNAME(zr
), __func__
);
2983 goto mmap_unlock_and_return
;
2989 if (le32_to_cpu(fh
->buffers
.buffer
[i
].jpg
.
2990 frag_tab
[2 * j
+ 1]) & 1)
2991 break; /* was last fragment */
2993 fh
->buffers
.buffer
[i
].map
= map
;
3000 mmap_unlock_and_return
:
3001 mutex_unlock(&zr
->resource_lock
);
3006 static const struct v4l2_ioctl_ops zoran_ioctl_ops
= {
3007 .vidioc_querycap
= zoran_querycap
,
3008 .vidioc_cropcap
= zoran_cropcap
,
3009 .vidioc_s_crop
= zoran_s_crop
,
3010 .vidioc_g_crop
= zoran_g_crop
,
3011 .vidioc_enum_input
= zoran_enum_input
,
3012 .vidioc_g_input
= zoran_g_input
,
3013 .vidioc_s_input
= zoran_s_input
,
3014 .vidioc_enum_output
= zoran_enum_output
,
3015 .vidioc_g_output
= zoran_g_output
,
3016 .vidioc_s_output
= zoran_s_output
,
3017 .vidioc_g_fbuf
= zoran_g_fbuf
,
3018 .vidioc_s_fbuf
= zoran_s_fbuf
,
3019 .vidioc_g_std
= zoran_g_std
,
3020 .vidioc_s_std
= zoran_s_std
,
3021 .vidioc_g_jpegcomp
= zoran_g_jpegcomp
,
3022 .vidioc_s_jpegcomp
= zoran_s_jpegcomp
,
3023 .vidioc_overlay
= zoran_overlay
,
3024 .vidioc_reqbufs
= zoran_reqbufs
,
3025 .vidioc_querybuf
= zoran_querybuf
,
3026 .vidioc_qbuf
= zoran_qbuf
,
3027 .vidioc_dqbuf
= zoran_dqbuf
,
3028 .vidioc_streamon
= zoran_streamon
,
3029 .vidioc_streamoff
= zoran_streamoff
,
3030 .vidioc_enum_fmt_vid_cap
= zoran_enum_fmt_vid_cap
,
3031 .vidioc_enum_fmt_vid_out
= zoran_enum_fmt_vid_out
,
3032 .vidioc_enum_fmt_vid_overlay
= zoran_enum_fmt_vid_overlay
,
3033 .vidioc_g_fmt_vid_cap
= zoran_g_fmt_vid_cap
,
3034 .vidioc_g_fmt_vid_out
= zoran_g_fmt_vid_out
,
3035 .vidioc_g_fmt_vid_overlay
= zoran_g_fmt_vid_overlay
,
3036 .vidioc_s_fmt_vid_cap
= zoran_s_fmt_vid_cap
,
3037 .vidioc_s_fmt_vid_out
= zoran_s_fmt_vid_out
,
3038 .vidioc_s_fmt_vid_overlay
= zoran_s_fmt_vid_overlay
,
3039 .vidioc_try_fmt_vid_cap
= zoran_try_fmt_vid_cap
,
3040 .vidioc_try_fmt_vid_out
= zoran_try_fmt_vid_out
,
3041 .vidioc_try_fmt_vid_overlay
= zoran_try_fmt_vid_overlay
,
3042 .vidioc_queryctrl
= zoran_queryctrl
,
3043 .vidioc_s_ctrl
= zoran_s_ctrl
,
3044 .vidioc_g_ctrl
= zoran_g_ctrl
,
3047 /* please use zr->resource_lock consistently and kill this wrapper */
3048 static long zoran_ioctl(struct file
*file
, unsigned int cmd
,
3051 struct zoran_fh
*fh
= file
->private_data
;
3052 struct zoran
*zr
= fh
->zr
;
3055 mutex_lock(&zr
->other_lock
);
3056 ret
= video_ioctl2(file
, cmd
, arg
);
3057 mutex_unlock(&zr
->other_lock
);
3062 static const struct v4l2_file_operations zoran_fops
= {
3063 .owner
= THIS_MODULE
,
3065 .release
= zoran_close
,
3066 .unlocked_ioctl
= zoran_ioctl
,
3068 .write
= zoran_write
,
3073 struct video_device zoran_template __devinitdata
= {
3075 .fops
= &zoran_fops
,
3076 .ioctl_ops
= &zoran_ioctl_ops
,
3077 .release
= &zoran_vdev_release
,
3078 .tvnorms
= V4L2_STD_NTSC
| V4L2_STD_PAL
| V4L2_STD_SECAM
,