diff options
Diffstat (limited to 'drivers/media/pci/zoran/zoran_driver.c')
-rw-r--r-- | drivers/media/pci/zoran/zoran_driver.c | 3090 |
1 files changed, 3090 insertions, 0 deletions
diff --git a/drivers/media/pci/zoran/zoran_driver.c b/drivers/media/pci/zoran/zoran_driver.c new file mode 100644 index 000000000000..c6ccdeb6d8d6 --- /dev/null +++ b/drivers/media/pci/zoran/zoran_driver.c | |||
@@ -0,0 +1,3090 @@ | |||
1 | /* | ||
2 | * Zoran zr36057/zr36067 PCI controller driver, for the | ||
3 | * Pinnacle/Miro DC10/DC10+/DC30/DC30+, Iomega Buz, Linux | ||
4 | * Media Labs LML33/LML33R10. | ||
5 | * | ||
6 | * Copyright (C) 2000 Serguei Miridonov <mirsev@cicese.mx> | ||
7 | * | ||
8 | * Changes for BUZ by Wolfgang Scherr <scherr@net4you.net> | ||
9 | * | ||
10 | * Changes for DC10/DC30 by Laurent Pinchart <laurent.pinchart@skynet.be> | ||
11 | * | ||
12 | * Changes for LML33R10 by Maxim Yevtyushkin <max@linuxmedialabs.com> | ||
13 | * | ||
14 | * Changes for videodev2/v4l2 by Ronald Bultje <rbultje@ronald.bitfreak.net> | ||
15 | * | ||
16 | * Based on | ||
17 | * | ||
18 | * Miro DC10 driver | ||
19 | * Copyright (C) 1999 Wolfgang Scherr <scherr@net4you.net> | ||
20 | * | ||
21 | * Iomega Buz driver version 1.0 | ||
22 | * Copyright (C) 1999 Rainer Johanni <Rainer@Johanni.de> | ||
23 | * | ||
24 | * buz.0.0.3 | ||
25 | * Copyright (C) 1998 Dave Perks <dperks@ibm.net> | ||
26 | * | ||
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) | ||
30 | * | ||
31 | * | ||
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. | ||
36 | * | ||
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. | ||
41 | * | ||
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. | ||
45 | */ | ||
46 | |||
47 | #include <linux/init.h> | ||
48 | #include <linux/module.h> | ||
49 | #include <linux/delay.h> | ||
50 | #include <linux/slab.h> | ||
51 | #include <linux/pci.h> | ||
52 | #include <linux/vmalloc.h> | ||
53 | #include <linux/wait.h> | ||
54 | |||
55 | #include <linux/interrupt.h> | ||
56 | #include <linux/i2c.h> | ||
57 | #include <linux/i2c-algo-bit.h> | ||
58 | |||
59 | #include <linux/spinlock.h> | ||
60 | |||
61 | #include <linux/videodev2.h> | ||
62 | #include <media/v4l2-common.h> | ||
63 | #include <media/v4l2-ioctl.h> | ||
64 | #include "videocodec.h" | ||
65 | |||
66 | #include <asm/byteorder.h> | ||
67 | #include <asm/io.h> | ||
68 | #include <asm/uaccess.h> | ||
69 | #include <linux/proc_fs.h> | ||
70 | |||
71 | #include <linux/mutex.h> | ||
72 | #include "zoran.h" | ||
73 | #include "zoran_device.h" | ||
74 | #include "zoran_card.h" | ||
75 | |||
76 | |||
77 | const struct zoran_format zoran_formats[] = { | ||
78 | { | ||
79 | .name = "15-bit RGB LE", | ||
80 | .fourcc = V4L2_PIX_FMT_RGB555, | ||
81 | .colorspace = V4L2_COLORSPACE_SRGB, | ||
82 | .depth = 15, | ||
83 | .flags = ZORAN_FORMAT_CAPTURE | | ||
84 | ZORAN_FORMAT_OVERLAY, | ||
85 | .vfespfr = ZR36057_VFESPFR_RGB555|ZR36057_VFESPFR_ErrDif| | ||
86 | ZR36057_VFESPFR_LittleEndian, | ||
87 | }, { | ||
88 | .name = "15-bit RGB BE", | ||
89 | .fourcc = V4L2_PIX_FMT_RGB555X, | ||
90 | .colorspace = V4L2_COLORSPACE_SRGB, | ||
91 | .depth = 15, | ||
92 | .flags = ZORAN_FORMAT_CAPTURE | | ||
93 | ZORAN_FORMAT_OVERLAY, | ||
94 | .vfespfr = ZR36057_VFESPFR_RGB555|ZR36057_VFESPFR_ErrDif, | ||
95 | }, { | ||
96 | .name = "16-bit RGB LE", | ||
97 | .fourcc = V4L2_PIX_FMT_RGB565, | ||
98 | .colorspace = V4L2_COLORSPACE_SRGB, | ||
99 | .depth = 16, | ||
100 | .flags = ZORAN_FORMAT_CAPTURE | | ||
101 | ZORAN_FORMAT_OVERLAY, | ||
102 | .vfespfr = ZR36057_VFESPFR_RGB565|ZR36057_VFESPFR_ErrDif| | ||
103 | ZR36057_VFESPFR_LittleEndian, | ||
104 | }, { | ||
105 | .name = "16-bit RGB BE", | ||
106 | .fourcc = V4L2_PIX_FMT_RGB565X, | ||
107 | .colorspace = V4L2_COLORSPACE_SRGB, | ||
108 | .depth = 16, | ||
109 | .flags = ZORAN_FORMAT_CAPTURE | | ||
110 | ZORAN_FORMAT_OVERLAY, | ||
111 | .vfespfr = ZR36057_VFESPFR_RGB565|ZR36057_VFESPFR_ErrDif, | ||
112 | }, { | ||
113 | .name = "24-bit RGB", | ||
114 | .fourcc = V4L2_PIX_FMT_BGR24, | ||
115 | .colorspace = V4L2_COLORSPACE_SRGB, | ||
116 | .depth = 24, | ||
117 | .flags = ZORAN_FORMAT_CAPTURE | | ||
118 | ZORAN_FORMAT_OVERLAY, | ||
119 | .vfespfr = ZR36057_VFESPFR_RGB888|ZR36057_VFESPFR_Pack24, | ||
120 | }, { | ||
121 | .name = "32-bit RGB LE", | ||
122 | .fourcc = V4L2_PIX_FMT_BGR32, | ||
123 | .colorspace = V4L2_COLORSPACE_SRGB, | ||
124 | .depth = 32, | ||
125 | .flags = ZORAN_FORMAT_CAPTURE | | ||
126 | ZORAN_FORMAT_OVERLAY, | ||
127 | .vfespfr = ZR36057_VFESPFR_RGB888|ZR36057_VFESPFR_LittleEndian, | ||
128 | }, { | ||
129 | .name = "32-bit RGB BE", | ||
130 | .fourcc = V4L2_PIX_FMT_RGB32, | ||
131 | .colorspace = V4L2_COLORSPACE_SRGB, | ||
132 | .depth = 32, | ||
133 | .flags = ZORAN_FORMAT_CAPTURE | | ||
134 | ZORAN_FORMAT_OVERLAY, | ||
135 | .vfespfr = ZR36057_VFESPFR_RGB888, | ||
136 | }, { | ||
137 | .name = "4:2:2, packed, YUYV", | ||
138 | .fourcc = V4L2_PIX_FMT_YUYV, | ||
139 | .colorspace = V4L2_COLORSPACE_SMPTE170M, | ||
140 | .depth = 16, | ||
141 | .flags = ZORAN_FORMAT_CAPTURE | | ||
142 | ZORAN_FORMAT_OVERLAY, | ||
143 | .vfespfr = ZR36057_VFESPFR_YUV422, | ||
144 | }, { | ||
145 | .name = "4:2:2, packed, UYVY", | ||
146 | .fourcc = V4L2_PIX_FMT_UYVY, | ||
147 | .colorspace = V4L2_COLORSPACE_SMPTE170M, | ||
148 | .depth = 16, | ||
149 | .flags = ZORAN_FORMAT_CAPTURE | | ||
150 | ZORAN_FORMAT_OVERLAY, | ||
151 | .vfespfr = ZR36057_VFESPFR_YUV422|ZR36057_VFESPFR_LittleEndian, | ||
152 | }, { | ||
153 | .name = "Hardware-encoded Motion-JPEG", | ||
154 | .fourcc = V4L2_PIX_FMT_MJPEG, | ||
155 | .colorspace = V4L2_COLORSPACE_SMPTE170M, | ||
156 | .depth = 0, | ||
157 | .flags = ZORAN_FORMAT_CAPTURE | | ||
158 | ZORAN_FORMAT_PLAYBACK | | ||
159 | ZORAN_FORMAT_COMPRESSED, | ||
160 | } | ||
161 | }; | ||
162 | #define NUM_FORMATS ARRAY_SIZE(zoran_formats) | ||
163 | |||
164 | /* small helper function for calculating buffersizes for v4l2 | ||
165 | * we calculate the nearest higher power-of-two, which | ||
166 | * will be the recommended buffersize */ | ||
167 | static __u32 | ||
168 | zoran_v4l2_calc_bufsize (struct zoran_jpg_settings *settings) | ||
169 | { | ||
170 | __u8 div = settings->VerDcm * settings->HorDcm * settings->TmpDcm; | ||
171 | __u32 num = (1024 * 512) / (div); | ||
172 | __u32 result = 2; | ||
173 | |||
174 | num--; | ||
175 | while (num) { | ||
176 | num >>= 1; | ||
177 | result <<= 1; | ||
178 | } | ||
179 | |||
180 | if (result > jpg_bufsize) | ||
181 | return jpg_bufsize; | ||
182 | if (result < 8192) | ||
183 | return 8192; | ||
184 | return result; | ||
185 | } | ||
186 | |||
187 | /* forward references */ | ||
188 | static void v4l_fbuffer_free(struct zoran_fh *fh); | ||
189 | static void jpg_fbuffer_free(struct zoran_fh *fh); | ||
190 | |||
191 | /* Set mapping mode */ | ||
192 | static void map_mode_raw(struct zoran_fh *fh) | ||
193 | { | ||
194 | fh->map_mode = ZORAN_MAP_MODE_RAW; | ||
195 | fh->buffers.buffer_size = v4l_bufsize; | ||
196 | fh->buffers.num_buffers = v4l_nbufs; | ||
197 | } | ||
198 | static void map_mode_jpg(struct zoran_fh *fh, int play) | ||
199 | { | ||
200 | fh->map_mode = play ? ZORAN_MAP_MODE_JPG_PLAY : ZORAN_MAP_MODE_JPG_REC; | ||
201 | fh->buffers.buffer_size = jpg_bufsize; | ||
202 | fh->buffers.num_buffers = jpg_nbufs; | ||
203 | } | ||
204 | static inline const char *mode_name(enum zoran_map_mode mode) | ||
205 | { | ||
206 | return mode == ZORAN_MAP_MODE_RAW ? "V4L" : "JPG"; | ||
207 | } | ||
208 | |||
209 | /* | ||
210 | * Allocate the V4L grab buffers | ||
211 | * | ||
212 | * These have to be pysically contiguous. | ||
213 | */ | ||
214 | |||
215 | static int v4l_fbuffer_alloc(struct zoran_fh *fh) | ||
216 | { | ||
217 | struct zoran *zr = fh->zr; | ||
218 | int i, off; | ||
219 | unsigned char *mem; | ||
220 | |||
221 | for (i = 0; i < fh->buffers.num_buffers; i++) { | ||
222 | if (fh->buffers.buffer[i].v4l.fbuffer) | ||
223 | dprintk(2, | ||
224 | KERN_WARNING | ||
225 | "%s: %s - buffer %d already allocated!?\n", | ||
226 | ZR_DEVNAME(zr), __func__, i); | ||
227 | |||
228 | //udelay(20); | ||
229 | mem = kmalloc(fh->buffers.buffer_size, | ||
230 | GFP_KERNEL | __GFP_NOWARN); | ||
231 | if (!mem) { | ||
232 | dprintk(1, | ||
233 | KERN_ERR | ||
234 | "%s: %s - kmalloc for V4L buf %d failed\n", | ||
235 | ZR_DEVNAME(zr), __func__, i); | ||
236 | v4l_fbuffer_free(fh); | ||
237 | return -ENOBUFS; | ||
238 | } | ||
239 | fh->buffers.buffer[i].v4l.fbuffer = mem; | ||
240 | fh->buffers.buffer[i].v4l.fbuffer_phys = virt_to_phys(mem); | ||
241 | fh->buffers.buffer[i].v4l.fbuffer_bus = virt_to_bus(mem); | ||
242 | for (off = 0; off < fh->buffers.buffer_size; | ||
243 | off += PAGE_SIZE) | ||
244 | SetPageReserved(virt_to_page(mem + off)); | ||
245 | dprintk(4, | ||
246 | KERN_INFO | ||
247 | "%s: %s - V4L frame %d mem 0x%lx (bus: 0x%llx)\n", | ||
248 | ZR_DEVNAME(zr), __func__, i, (unsigned long) mem, | ||
249 | (unsigned long long)virt_to_bus(mem)); | ||
250 | } | ||
251 | |||
252 | fh->buffers.allocated = 1; | ||
253 | |||
254 | return 0; | ||
255 | } | ||
256 | |||
257 | /* free the V4L grab buffers */ | ||
258 | static void v4l_fbuffer_free(struct zoran_fh *fh) | ||
259 | { | ||
260 | struct zoran *zr = fh->zr; | ||
261 | int i, off; | ||
262 | unsigned char *mem; | ||
263 | |||
264 | dprintk(4, KERN_INFO "%s: %s\n", ZR_DEVNAME(zr), __func__); | ||
265 | |||
266 | for (i = 0; i < fh->buffers.num_buffers; i++) { | ||
267 | if (!fh->buffers.buffer[i].v4l.fbuffer) | ||
268 | continue; | ||
269 | |||
270 | mem = fh->buffers.buffer[i].v4l.fbuffer; | ||
271 | for (off = 0; off < fh->buffers.buffer_size; | ||
272 | off += PAGE_SIZE) | ||
273 | ClearPageReserved(virt_to_page(mem + off)); | ||
274 | kfree(fh->buffers.buffer[i].v4l.fbuffer); | ||
275 | fh->buffers.buffer[i].v4l.fbuffer = NULL; | ||
276 | } | ||
277 | |||
278 | fh->buffers.allocated = 0; | ||
279 | } | ||
280 | |||
281 | /* | ||
282 | * Allocate the MJPEG grab buffers. | ||
283 | * | ||
284 | * If a Natoma chipset is present and this is a revision 1 zr36057, | ||
285 | * each MJPEG buffer needs to be physically contiguous. | ||
286 | * (RJ: This statement is from Dave Perks' original driver, | ||
287 | * I could never check it because I have a zr36067) | ||
288 | * | ||
289 | * RJ: The contents grab buffers needs never be accessed in the driver. | ||
290 | * Therefore there is no need to allocate them with vmalloc in order | ||
291 | * to get a contiguous virtual memory space. | ||
292 | * I don't understand why many other drivers first allocate them with | ||
293 | * vmalloc (which uses internally also get_zeroed_page, but delivers you | ||
294 | * virtual addresses) and then again have to make a lot of efforts | ||
295 | * to get the physical address. | ||
296 | * | ||
297 | * Ben Capper: | ||
298 | * On big-endian architectures (such as ppc) some extra steps | ||
299 | * are needed. When reading and writing to the stat_com array | ||
300 | * and fragment buffers, the device expects to see little- | ||
301 | * endian values. The use of cpu_to_le32() and le32_to_cpu() | ||
302 | * in this function (and one or two others in zoran_device.c) | ||
303 | * ensure that these values are always stored in little-endian | ||
304 | * form, regardless of architecture. The zr36057 does Very Bad | ||
305 | * Things on big endian architectures if the stat_com array | ||
306 | * and fragment buffers are not little-endian. | ||
307 | */ | ||
308 | |||
309 | static int jpg_fbuffer_alloc(struct zoran_fh *fh) | ||
310 | { | ||
311 | struct zoran *zr = fh->zr; | ||
312 | int i, j, off; | ||
313 | u8 *mem; | ||
314 | |||
315 | for (i = 0; i < fh->buffers.num_buffers; i++) { | ||
316 | if (fh->buffers.buffer[i].jpg.frag_tab) | ||
317 | dprintk(2, | ||
318 | KERN_WARNING | ||
319 | "%s: %s - buffer %d already allocated!?\n", | ||
320 | ZR_DEVNAME(zr), __func__, i); | ||
321 | |||
322 | /* Allocate fragment table for this buffer */ | ||
323 | |||
324 | mem = (void *)get_zeroed_page(GFP_KERNEL); | ||
325 | if (!mem) { | ||
326 | dprintk(1, | ||
327 | KERN_ERR | ||
328 | "%s: %s - get_zeroed_page (frag_tab) failed for buffer %d\n", | ||
329 | ZR_DEVNAME(zr), __func__, i); | ||
330 | jpg_fbuffer_free(fh); | ||
331 | return -ENOBUFS; | ||
332 | } | ||
333 | fh->buffers.buffer[i].jpg.frag_tab = (__le32 *)mem; | ||
334 | fh->buffers.buffer[i].jpg.frag_tab_bus = virt_to_bus(mem); | ||
335 | |||
336 | if (fh->buffers.need_contiguous) { | ||
337 | mem = kmalloc(fh->buffers.buffer_size, GFP_KERNEL); | ||
338 | if (mem == NULL) { | ||
339 | dprintk(1, | ||
340 | KERN_ERR | ||
341 | "%s: %s - kmalloc failed for buffer %d\n", | ||
342 | ZR_DEVNAME(zr), __func__, i); | ||
343 | jpg_fbuffer_free(fh); | ||
344 | return -ENOBUFS; | ||
345 | } | ||
346 | fh->buffers.buffer[i].jpg.frag_tab[0] = | ||
347 | cpu_to_le32(virt_to_bus(mem)); | ||
348 | fh->buffers.buffer[i].jpg.frag_tab[1] = | ||
349 | cpu_to_le32((fh->buffers.buffer_size >> 1) | 1); | ||
350 | for (off = 0; off < fh->buffers.buffer_size; off += PAGE_SIZE) | ||
351 | SetPageReserved(virt_to_page(mem + off)); | ||
352 | } else { | ||
353 | /* jpg_bufsize is already page aligned */ | ||
354 | for (j = 0; j < fh->buffers.buffer_size / PAGE_SIZE; j++) { | ||
355 | mem = (void *)get_zeroed_page(GFP_KERNEL); | ||
356 | if (mem == NULL) { | ||
357 | dprintk(1, | ||
358 | KERN_ERR | ||
359 | "%s: %s - get_zeroed_page failed for buffer %d\n", | ||
360 | ZR_DEVNAME(zr), __func__, i); | ||
361 | jpg_fbuffer_free(fh); | ||
362 | return -ENOBUFS; | ||
363 | } | ||
364 | |||
365 | fh->buffers.buffer[i].jpg.frag_tab[2 * j] = | ||
366 | cpu_to_le32(virt_to_bus(mem)); | ||
367 | fh->buffers.buffer[i].jpg.frag_tab[2 * j + 1] = | ||
368 | cpu_to_le32((PAGE_SIZE >> 2) << 1); | ||
369 | SetPageReserved(virt_to_page(mem)); | ||
370 | } | ||
371 | |||
372 | fh->buffers.buffer[i].jpg.frag_tab[2 * j - 1] |= cpu_to_le32(1); | ||
373 | } | ||
374 | } | ||
375 | |||
376 | dprintk(4, | ||
377 | KERN_DEBUG "%s: %s - %d KB allocated\n", | ||
378 | ZR_DEVNAME(zr), __func__, | ||
379 | (fh->buffers.num_buffers * fh->buffers.buffer_size) >> 10); | ||
380 | |||
381 | fh->buffers.allocated = 1; | ||
382 | |||
383 | return 0; | ||
384 | } | ||
385 | |||
386 | /* free the MJPEG grab buffers */ | ||
387 | static void jpg_fbuffer_free(struct zoran_fh *fh) | ||
388 | { | ||
389 | struct zoran *zr = fh->zr; | ||
390 | int i, j, off; | ||
391 | unsigned char *mem; | ||
392 | __le32 frag_tab; | ||
393 | struct zoran_buffer *buffer; | ||
394 | |||
395 | dprintk(4, KERN_DEBUG "%s: %s\n", ZR_DEVNAME(zr), __func__); | ||
396 | |||
397 | for (i = 0, buffer = &fh->buffers.buffer[0]; | ||
398 | i < fh->buffers.num_buffers; i++, buffer++) { | ||
399 | if (!buffer->jpg.frag_tab) | ||
400 | continue; | ||
401 | |||
402 | if (fh->buffers.need_contiguous) { | ||
403 | frag_tab = buffer->jpg.frag_tab[0]; | ||
404 | |||
405 | if (frag_tab) { | ||
406 | mem = bus_to_virt(le32_to_cpu(frag_tab)); | ||
407 | for (off = 0; off < fh->buffers.buffer_size; off += PAGE_SIZE) | ||
408 | ClearPageReserved(virt_to_page(mem + off)); | ||
409 | kfree(mem); | ||
410 | buffer->jpg.frag_tab[0] = 0; | ||
411 | buffer->jpg.frag_tab[1] = 0; | ||
412 | } | ||
413 | } else { | ||
414 | for (j = 0; j < fh->buffers.buffer_size / PAGE_SIZE; j++) { | ||
415 | frag_tab = buffer->jpg.frag_tab[2 * j]; | ||
416 | |||
417 | if (!frag_tab) | ||
418 | break; | ||
419 | ClearPageReserved(virt_to_page(bus_to_virt(le32_to_cpu(frag_tab)))); | ||
420 | free_page((unsigned long)bus_to_virt(le32_to_cpu(frag_tab))); | ||
421 | buffer->jpg.frag_tab[2 * j] = 0; | ||
422 | buffer->jpg.frag_tab[2 * j + 1] = 0; | ||
423 | } | ||
424 | } | ||
425 | |||
426 | free_page((unsigned long)buffer->jpg.frag_tab); | ||
427 | buffer->jpg.frag_tab = NULL; | ||
428 | } | ||
429 | |||
430 | fh->buffers.allocated = 0; | ||
431 | } | ||
432 | |||
433 | /* | ||
434 | * V4L Buffer grabbing | ||
435 | */ | ||
436 | |||
437 | static int | ||
438 | zoran_v4l_set_format (struct zoran_fh *fh, | ||
439 | int width, | ||
440 | int height, | ||
441 | const struct zoran_format *format) | ||
442 | { | ||
443 | struct zoran *zr = fh->zr; | ||
444 | int bpp; | ||
445 | |||
446 | /* Check size and format of the grab wanted */ | ||
447 | |||
448 | if (height < BUZ_MIN_HEIGHT || width < BUZ_MIN_WIDTH || | ||
449 | height > BUZ_MAX_HEIGHT || width > BUZ_MAX_WIDTH) { | ||
450 | dprintk(1, | ||
451 | KERN_ERR | ||
452 | "%s: %s - wrong frame size (%dx%d)\n", | ||
453 | ZR_DEVNAME(zr), __func__, width, height); | ||
454 | return -EINVAL; | ||
455 | } | ||
456 | |||
457 | bpp = (format->depth + 7) / 8; | ||
458 | |||
459 | /* Check against available buffer size */ | ||
460 | if (height * width * bpp > fh->buffers.buffer_size) { | ||
461 | dprintk(1, | ||
462 | KERN_ERR | ||
463 | "%s: %s - video buffer size (%d kB) is too small\n", | ||
464 | ZR_DEVNAME(zr), __func__, fh->buffers.buffer_size >> 10); | ||
465 | return -EINVAL; | ||
466 | } | ||
467 | |||
468 | /* The video front end needs 4-byte alinged line sizes */ | ||
469 | |||
470 | if ((bpp == 2 && (width & 1)) || (bpp == 3 && (width & 3))) { | ||
471 | dprintk(1, | ||
472 | KERN_ERR | ||
473 | "%s: %s - wrong frame alignment\n", | ||
474 | ZR_DEVNAME(zr), __func__); | ||
475 | return -EINVAL; | ||
476 | } | ||
477 | |||
478 | fh->v4l_settings.width = width; | ||
479 | fh->v4l_settings.height = height; | ||
480 | fh->v4l_settings.format = format; | ||
481 | fh->v4l_settings.bytesperline = bpp * fh->v4l_settings.width; | ||
482 | |||
483 | return 0; | ||
484 | } | ||
485 | |||
486 | static int zoran_v4l_queue_frame(struct zoran_fh *fh, int num) | ||
487 | { | ||
488 | struct zoran *zr = fh->zr; | ||
489 | unsigned long flags; | ||
490 | int res = 0; | ||
491 | |||
492 | if (!fh->buffers.allocated) { | ||
493 | dprintk(1, | ||
494 | KERN_ERR | ||
495 | "%s: %s - buffers not yet allocated\n", | ||
496 | ZR_DEVNAME(zr), __func__); | ||
497 | res = -ENOMEM; | ||
498 | } | ||
499 | |||
500 | /* No grabbing outside the buffer range! */ | ||
501 | if (num >= fh->buffers.num_buffers || num < 0) { | ||
502 | dprintk(1, | ||
503 | KERN_ERR | ||
504 | "%s: %s - buffer %d is out of range\n", | ||
505 | ZR_DEVNAME(zr), __func__, num); | ||
506 | res = -EINVAL; | ||
507 | } | ||
508 | |||
509 | spin_lock_irqsave(&zr->spinlock, flags); | ||
510 | |||
511 | if (fh->buffers.active == ZORAN_FREE) { | ||
512 | if (zr->v4l_buffers.active == ZORAN_FREE) { | ||
513 | zr->v4l_buffers = fh->buffers; | ||
514 | fh->buffers.active = ZORAN_ACTIVE; | ||
515 | } else { | ||
516 | dprintk(1, | ||
517 | KERN_ERR | ||
518 | "%s: %s - another session is already capturing\n", | ||
519 | ZR_DEVNAME(zr), __func__); | ||
520 | res = -EBUSY; | ||
521 | } | ||
522 | } | ||
523 | |||
524 | /* make sure a grab isn't going on currently with this buffer */ | ||
525 | if (!res) { | ||
526 | switch (zr->v4l_buffers.buffer[num].state) { | ||
527 | default: | ||
528 | case BUZ_STATE_PEND: | ||
529 | if (zr->v4l_buffers.active == ZORAN_FREE) { | ||
530 | fh->buffers.active = ZORAN_FREE; | ||
531 | zr->v4l_buffers.allocated = 0; | ||
532 | } | ||
533 | res = -EBUSY; /* what are you doing? */ | ||
534 | break; | ||
535 | case BUZ_STATE_DONE: | ||
536 | dprintk(2, | ||
537 | KERN_WARNING | ||
538 | "%s: %s - queueing buffer %d in state DONE!?\n", | ||
539 | ZR_DEVNAME(zr), __func__, num); | ||
540 | case BUZ_STATE_USER: | ||
541 | /* since there is at least one unused buffer there's room for at least | ||
542 | * one more pend[] entry */ | ||
543 | zr->v4l_pend[zr->v4l_pend_head++ & V4L_MASK_FRAME] = num; | ||
544 | zr->v4l_buffers.buffer[num].state = BUZ_STATE_PEND; | ||
545 | zr->v4l_buffers.buffer[num].bs.length = | ||
546 | fh->v4l_settings.bytesperline * | ||
547 | zr->v4l_settings.height; | ||
548 | fh->buffers.buffer[num] = zr->v4l_buffers.buffer[num]; | ||
549 | break; | ||
550 | } | ||
551 | } | ||
552 | |||
553 | spin_unlock_irqrestore(&zr->spinlock, flags); | ||
554 | |||
555 | if (!res && zr->v4l_buffers.active == ZORAN_FREE) | ||
556 | zr->v4l_buffers.active = fh->buffers.active; | ||
557 | |||
558 | return res; | ||
559 | } | ||
560 | |||
561 | /* | ||
562 | * Sync on a V4L buffer | ||
563 | */ | ||
564 | |||
565 | static int v4l_sync(struct zoran_fh *fh, int frame) | ||
566 | { | ||
567 | struct zoran *zr = fh->zr; | ||
568 | unsigned long flags; | ||
569 | |||
570 | if (fh->buffers.active == ZORAN_FREE) { | ||
571 | dprintk(1, | ||
572 | KERN_ERR | ||
573 | "%s: %s - no grab active for this session\n", | ||
574 | ZR_DEVNAME(zr), __func__); | ||
575 | return -EINVAL; | ||
576 | } | ||
577 | |||
578 | /* check passed-in frame number */ | ||
579 | if (frame >= fh->buffers.num_buffers || frame < 0) { | ||
580 | dprintk(1, | ||
581 | KERN_ERR "%s: %s - frame %d is invalid\n", | ||
582 | ZR_DEVNAME(zr), __func__, frame); | ||
583 | return -EINVAL; | ||
584 | } | ||
585 | |||
586 | /* Check if is buffer was queued at all */ | ||
587 | if (zr->v4l_buffers.buffer[frame].state == BUZ_STATE_USER) { | ||
588 | dprintk(1, | ||
589 | KERN_ERR | ||
590 | "%s: %s - attempt to sync on a buffer which was not queued?\n", | ||
591 | ZR_DEVNAME(zr), __func__); | ||
592 | return -EPROTO; | ||
593 | } | ||
594 | |||
595 | /* wait on this buffer to get ready */ | ||
596 | if (!wait_event_interruptible_timeout(zr->v4l_capq, | ||
597 | (zr->v4l_buffers.buffer[frame].state != BUZ_STATE_PEND), 10*HZ)) | ||
598 | return -ETIME; | ||
599 | if (signal_pending(current)) | ||
600 | return -ERESTARTSYS; | ||
601 | |||
602 | /* buffer should now be in BUZ_STATE_DONE */ | ||
603 | if (zr->v4l_buffers.buffer[frame].state != BUZ_STATE_DONE) | ||
604 | dprintk(2, | ||
605 | KERN_ERR "%s: %s - internal state error\n", | ||
606 | ZR_DEVNAME(zr), __func__); | ||
607 | |||
608 | zr->v4l_buffers.buffer[frame].state = BUZ_STATE_USER; | ||
609 | fh->buffers.buffer[frame] = zr->v4l_buffers.buffer[frame]; | ||
610 | |||
611 | spin_lock_irqsave(&zr->spinlock, flags); | ||
612 | |||
613 | /* Check if streaming capture has finished */ | ||
614 | if (zr->v4l_pend_tail == zr->v4l_pend_head) { | ||
615 | zr36057_set_memgrab(zr, 0); | ||
616 | if (zr->v4l_buffers.active == ZORAN_ACTIVE) { | ||
617 | fh->buffers.active = zr->v4l_buffers.active = ZORAN_FREE; | ||
618 | zr->v4l_buffers.allocated = 0; | ||
619 | } | ||
620 | } | ||
621 | |||
622 | spin_unlock_irqrestore(&zr->spinlock, flags); | ||
623 | |||
624 | return 0; | ||
625 | } | ||
626 | |||
627 | /* | ||
628 | * Queue a MJPEG buffer for capture/playback | ||
629 | */ | ||
630 | |||
631 | static int zoran_jpg_queue_frame(struct zoran_fh *fh, int num, | ||
632 | enum zoran_codec_mode mode) | ||
633 | { | ||
634 | struct zoran *zr = fh->zr; | ||
635 | unsigned long flags; | ||
636 | int res = 0; | ||
637 | |||
638 | /* Check if buffers are allocated */ | ||
639 | if (!fh->buffers.allocated) { | ||
640 | dprintk(1, | ||
641 | KERN_ERR | ||
642 | "%s: %s - buffers not yet allocated\n", | ||
643 | ZR_DEVNAME(zr), __func__); | ||
644 | return -ENOMEM; | ||
645 | } | ||
646 | |||
647 | /* No grabbing outside the buffer range! */ | ||
648 | if (num >= fh->buffers.num_buffers || num < 0) { | ||
649 | dprintk(1, | ||
650 | KERN_ERR | ||
651 | "%s: %s - buffer %d out of range\n", | ||
652 | ZR_DEVNAME(zr), __func__, num); | ||
653 | return -EINVAL; | ||
654 | } | ||
655 | |||
656 | /* what is the codec mode right now? */ | ||
657 | if (zr->codec_mode == BUZ_MODE_IDLE) { | ||
658 | zr->jpg_settings = fh->jpg_settings; | ||
659 | } else if (zr->codec_mode != mode) { | ||
660 | /* wrong codec mode active - invalid */ | ||
661 | dprintk(1, | ||
662 | KERN_ERR | ||
663 | "%s: %s - codec in wrong mode\n", | ||
664 | ZR_DEVNAME(zr), __func__); | ||
665 | return -EINVAL; | ||
666 | } | ||
667 | |||
668 | if (fh->buffers.active == ZORAN_FREE) { | ||
669 | if (zr->jpg_buffers.active == ZORAN_FREE) { | ||
670 | zr->jpg_buffers = fh->buffers; | ||
671 | fh->buffers.active = ZORAN_ACTIVE; | ||
672 | } else { | ||
673 | dprintk(1, | ||
674 | KERN_ERR | ||
675 | "%s: %s - another session is already capturing\n", | ||
676 | ZR_DEVNAME(zr), __func__); | ||
677 | res = -EBUSY; | ||
678 | } | ||
679 | } | ||
680 | |||
681 | if (!res && zr->codec_mode == BUZ_MODE_IDLE) { | ||
682 | /* Ok load up the jpeg codec */ | ||
683 | zr36057_enable_jpg(zr, mode); | ||
684 | } | ||
685 | |||
686 | spin_lock_irqsave(&zr->spinlock, flags); | ||
687 | |||
688 | if (!res) { | ||
689 | switch (zr->jpg_buffers.buffer[num].state) { | ||
690 | case BUZ_STATE_DONE: | ||
691 | dprintk(2, | ||
692 | KERN_WARNING | ||
693 | "%s: %s - queing frame in BUZ_STATE_DONE state!?\n", | ||
694 | ZR_DEVNAME(zr), __func__); | ||
695 | case BUZ_STATE_USER: | ||
696 | /* since there is at least one unused buffer there's room for at | ||
697 | *least one more pend[] entry */ | ||
698 | zr->jpg_pend[zr->jpg_que_head++ & BUZ_MASK_FRAME] = num; | ||
699 | zr->jpg_buffers.buffer[num].state = BUZ_STATE_PEND; | ||
700 | fh->buffers.buffer[num] = zr->jpg_buffers.buffer[num]; | ||
701 | zoran_feed_stat_com(zr); | ||
702 | break; | ||
703 | default: | ||
704 | case BUZ_STATE_DMA: | ||
705 | case BUZ_STATE_PEND: | ||
706 | if (zr->jpg_buffers.active == ZORAN_FREE) { | ||
707 | fh->buffers.active = ZORAN_FREE; | ||
708 | zr->jpg_buffers.allocated = 0; | ||
709 | } | ||
710 | res = -EBUSY; /* what are you doing? */ | ||
711 | break; | ||
712 | } | ||
713 | } | ||
714 | |||
715 | spin_unlock_irqrestore(&zr->spinlock, flags); | ||
716 | |||
717 | if (!res && zr->jpg_buffers.active == ZORAN_FREE) | ||
718 | zr->jpg_buffers.active = fh->buffers.active; | ||
719 | |||
720 | return res; | ||
721 | } | ||
722 | |||
723 | static int jpg_qbuf(struct zoran_fh *fh, int frame, enum zoran_codec_mode mode) | ||
724 | { | ||
725 | struct zoran *zr = fh->zr; | ||
726 | int res = 0; | ||
727 | |||
728 | /* Does the user want to stop streaming? */ | ||
729 | if (frame < 0) { | ||
730 | if (zr->codec_mode == mode) { | ||
731 | if (fh->buffers.active == ZORAN_FREE) { | ||
732 | dprintk(1, | ||
733 | KERN_ERR | ||
734 | "%s: %s(-1) - session not active\n", | ||
735 | ZR_DEVNAME(zr), __func__); | ||
736 | return -EINVAL; | ||
737 | } | ||
738 | fh->buffers.active = zr->jpg_buffers.active = ZORAN_FREE; | ||
739 | zr->jpg_buffers.allocated = 0; | ||
740 | zr36057_enable_jpg(zr, BUZ_MODE_IDLE); | ||
741 | return 0; | ||
742 | } else { | ||
743 | dprintk(1, | ||
744 | KERN_ERR | ||
745 | "%s: %s - stop streaming but not in streaming mode\n", | ||
746 | ZR_DEVNAME(zr), __func__); | ||
747 | return -EINVAL; | ||
748 | } | ||
749 | } | ||
750 | |||
751 | if ((res = zoran_jpg_queue_frame(fh, frame, mode))) | ||
752 | return res; | ||
753 | |||
754 | /* Start the jpeg codec when the first frame is queued */ | ||
755 | if (!res && zr->jpg_que_head == 1) | ||
756 | jpeg_start(zr); | ||
757 | |||
758 | return res; | ||
759 | } | ||
760 | |||
761 | /* | ||
762 | * Sync on a MJPEG buffer | ||
763 | */ | ||
764 | |||
765 | static int jpg_sync(struct zoran_fh *fh, struct zoran_sync *bs) | ||
766 | { | ||
767 | struct zoran *zr = fh->zr; | ||
768 | unsigned long flags; | ||
769 | int frame; | ||
770 | |||
771 | if (fh->buffers.active == ZORAN_FREE) { | ||
772 | dprintk(1, | ||
773 | KERN_ERR | ||
774 | "%s: %s - capture is not currently active\n", | ||
775 | ZR_DEVNAME(zr), __func__); | ||
776 | return -EINVAL; | ||
777 | } | ||
778 | if (zr->codec_mode != BUZ_MODE_MOTION_DECOMPRESS && | ||
779 | zr->codec_mode != BUZ_MODE_MOTION_COMPRESS) { | ||
780 | dprintk(1, | ||
781 | KERN_ERR | ||
782 | "%s: %s - codec not in streaming mode\n", | ||
783 | ZR_DEVNAME(zr), __func__); | ||
784 | return -EINVAL; | ||
785 | } | ||
786 | if (!wait_event_interruptible_timeout(zr->jpg_capq, | ||
787 | (zr->jpg_que_tail != zr->jpg_dma_tail || | ||
788 | zr->jpg_dma_tail == zr->jpg_dma_head), | ||
789 | 10*HZ)) { | ||
790 | int isr; | ||
791 | |||
792 | btand(~ZR36057_JMC_Go_en, ZR36057_JMC); | ||
793 | udelay(1); | ||
794 | zr->codec->control(zr->codec, CODEC_G_STATUS, | ||
795 | sizeof(isr), &isr); | ||
796 | dprintk(1, | ||
797 | KERN_ERR | ||
798 | "%s: %s - timeout: codec isr=0x%02x\n", | ||
799 | ZR_DEVNAME(zr), __func__, isr); | ||
800 | |||
801 | return -ETIME; | ||
802 | |||
803 | } | ||
804 | if (signal_pending(current)) | ||
805 | return -ERESTARTSYS; | ||
806 | |||
807 | spin_lock_irqsave(&zr->spinlock, flags); | ||
808 | |||
809 | if (zr->jpg_dma_tail != zr->jpg_dma_head) | ||
810 | frame = zr->jpg_pend[zr->jpg_que_tail++ & BUZ_MASK_FRAME]; | ||
811 | else | ||
812 | frame = zr->jpg_pend[zr->jpg_que_tail & BUZ_MASK_FRAME]; | ||
813 | |||
814 | /* buffer should now be in BUZ_STATE_DONE */ | ||
815 | if (zr->jpg_buffers.buffer[frame].state != BUZ_STATE_DONE) | ||
816 | dprintk(2, | ||
817 | KERN_ERR "%s: %s - internal state error\n", | ||
818 | ZR_DEVNAME(zr), __func__); | ||
819 | |||
820 | *bs = zr->jpg_buffers.buffer[frame].bs; | ||
821 | bs->frame = frame; | ||
822 | zr->jpg_buffers.buffer[frame].state = BUZ_STATE_USER; | ||
823 | fh->buffers.buffer[frame] = zr->jpg_buffers.buffer[frame]; | ||
824 | |||
825 | spin_unlock_irqrestore(&zr->spinlock, flags); | ||
826 | |||
827 | return 0; | ||
828 | } | ||
829 | |||
830 | static void zoran_open_init_session(struct zoran_fh *fh) | ||
831 | { | ||
832 | int i; | ||
833 | struct zoran *zr = fh->zr; | ||
834 | |||
835 | /* Per default, map the V4L Buffers */ | ||
836 | map_mode_raw(fh); | ||
837 | |||
838 | /* take over the card's current settings */ | ||
839 | fh->overlay_settings = zr->overlay_settings; | ||
840 | fh->overlay_settings.is_set = 0; | ||
841 | fh->overlay_settings.format = zr->overlay_settings.format; | ||
842 | fh->overlay_active = ZORAN_FREE; | ||
843 | |||
844 | /* v4l settings */ | ||
845 | fh->v4l_settings = zr->v4l_settings; | ||
846 | /* jpg settings */ | ||
847 | fh->jpg_settings = zr->jpg_settings; | ||
848 | |||
849 | /* buffers */ | ||
850 | memset(&fh->buffers, 0, sizeof(fh->buffers)); | ||
851 | for (i = 0; i < MAX_FRAME; i++) { | ||
852 | fh->buffers.buffer[i].state = BUZ_STATE_USER; /* nothing going on */ | ||
853 | fh->buffers.buffer[i].bs.frame = i; | ||
854 | } | ||
855 | fh->buffers.allocated = 0; | ||
856 | fh->buffers.active = ZORAN_FREE; | ||
857 | } | ||
858 | |||
859 | static void zoran_close_end_session(struct zoran_fh *fh) | ||
860 | { | ||
861 | struct zoran *zr = fh->zr; | ||
862 | |||
863 | /* overlay */ | ||
864 | if (fh->overlay_active != ZORAN_FREE) { | ||
865 | fh->overlay_active = zr->overlay_active = ZORAN_FREE; | ||
866 | zr->v4l_overlay_active = 0; | ||
867 | if (!zr->v4l_memgrab_active) | ||
868 | zr36057_overlay(zr, 0); | ||
869 | zr->overlay_mask = NULL; | ||
870 | } | ||
871 | |||
872 | if (fh->map_mode == ZORAN_MAP_MODE_RAW) { | ||
873 | /* v4l capture */ | ||
874 | if (fh->buffers.active != ZORAN_FREE) { | ||
875 | unsigned long flags; | ||
876 | |||
877 | spin_lock_irqsave(&zr->spinlock, flags); | ||
878 | zr36057_set_memgrab(zr, 0); | ||
879 | zr->v4l_buffers.allocated = 0; | ||
880 | zr->v4l_buffers.active = fh->buffers.active = ZORAN_FREE; | ||
881 | spin_unlock_irqrestore(&zr->spinlock, flags); | ||
882 | } | ||
883 | |||
884 | /* v4l buffers */ | ||
885 | if (fh->buffers.allocated) | ||
886 | v4l_fbuffer_free(fh); | ||
887 | } else { | ||
888 | /* jpg capture */ | ||
889 | if (fh->buffers.active != ZORAN_FREE) { | ||
890 | zr36057_enable_jpg(zr, BUZ_MODE_IDLE); | ||
891 | zr->jpg_buffers.allocated = 0; | ||
892 | zr->jpg_buffers.active = fh->buffers.active = ZORAN_FREE; | ||
893 | } | ||
894 | |||
895 | /* jpg buffers */ | ||
896 | if (fh->buffers.allocated) | ||
897 | jpg_fbuffer_free(fh); | ||
898 | } | ||
899 | } | ||
900 | |||
901 | /* | ||
902 | * Open a zoran card. Right now the flags stuff is just playing | ||
903 | */ | ||
904 | |||
905 | static int zoran_open(struct file *file) | ||
906 | { | ||
907 | struct zoran *zr = video_drvdata(file); | ||
908 | struct zoran_fh *fh; | ||
909 | int res, first_open = 0; | ||
910 | |||
911 | dprintk(2, KERN_INFO "%s: %s(%s, pid=[%d]), users(-)=%d\n", | ||
912 | ZR_DEVNAME(zr), __func__, current->comm, task_pid_nr(current), zr->user + 1); | ||
913 | |||
914 | mutex_lock(&zr->other_lock); | ||
915 | |||
916 | if (zr->user >= 2048) { | ||
917 | dprintk(1, KERN_ERR "%s: too many users (%d) on device\n", | ||
918 | ZR_DEVNAME(zr), zr->user); | ||
919 | res = -EBUSY; | ||
920 | goto fail_unlock; | ||
921 | } | ||
922 | |||
923 | /* now, create the open()-specific file_ops struct */ | ||
924 | fh = kzalloc(sizeof(struct zoran_fh), GFP_KERNEL); | ||
925 | if (!fh) { | ||
926 | dprintk(1, | ||
927 | KERN_ERR | ||
928 | "%s: %s - allocation of zoran_fh failed\n", | ||
929 | ZR_DEVNAME(zr), __func__); | ||
930 | res = -ENOMEM; | ||
931 | goto fail_unlock; | ||
932 | } | ||
933 | /* used to be BUZ_MAX_WIDTH/HEIGHT, but that gives overflows | ||
934 | * on norm-change! */ | ||
935 | fh->overlay_mask = | ||
936 | kmalloc(((768 + 31) / 32) * 576 * 4, GFP_KERNEL); | ||
937 | if (!fh->overlay_mask) { | ||
938 | dprintk(1, | ||
939 | KERN_ERR | ||
940 | "%s: %s - allocation of overlay_mask failed\n", | ||
941 | ZR_DEVNAME(zr), __func__); | ||
942 | res = -ENOMEM; | ||
943 | goto fail_fh; | ||
944 | } | ||
945 | |||
946 | if (zr->user++ == 0) | ||
947 | first_open = 1; | ||
948 | |||
949 | /*mutex_unlock(&zr->resource_lock);*/ | ||
950 | |||
951 | /* default setup - TODO: look at flags */ | ||
952 | if (first_open) { /* First device open */ | ||
953 | zr36057_restart(zr); | ||
954 | zoran_open_init_params(zr); | ||
955 | zoran_init_hardware(zr); | ||
956 | |||
957 | btor(ZR36057_ICR_IntPinEn, ZR36057_ICR); | ||
958 | } | ||
959 | |||
960 | /* set file_ops stuff */ | ||
961 | file->private_data = fh; | ||
962 | fh->zr = zr; | ||
963 | zoran_open_init_session(fh); | ||
964 | mutex_unlock(&zr->other_lock); | ||
965 | |||
966 | return 0; | ||
967 | |||
968 | fail_fh: | ||
969 | kfree(fh); | ||
970 | fail_unlock: | ||
971 | mutex_unlock(&zr->other_lock); | ||
972 | |||
973 | dprintk(2, KERN_INFO "%s: open failed (%d), users(-)=%d\n", | ||
974 | ZR_DEVNAME(zr), res, zr->user); | ||
975 | |||
976 | return res; | ||
977 | } | ||
978 | |||
979 | static int | ||
980 | zoran_close(struct file *file) | ||
981 | { | ||
982 | struct zoran_fh *fh = file->private_data; | ||
983 | struct zoran *zr = fh->zr; | ||
984 | |||
985 | dprintk(2, KERN_INFO "%s: %s(%s, pid=[%d]), users(+)=%d\n", | ||
986 | ZR_DEVNAME(zr), __func__, current->comm, task_pid_nr(current), zr->user - 1); | ||
987 | |||
988 | /* kernel locks (fs/device.c), so don't do that ourselves | ||
989 | * (prevents deadlocks) */ | ||
990 | mutex_lock(&zr->other_lock); | ||
991 | |||
992 | zoran_close_end_session(fh); | ||
993 | |||
994 | if (zr->user-- == 1) { /* Last process */ | ||
995 | /* Clean up JPEG process */ | ||
996 | wake_up_interruptible(&zr->jpg_capq); | ||
997 | zr36057_enable_jpg(zr, BUZ_MODE_IDLE); | ||
998 | zr->jpg_buffers.allocated = 0; | ||
999 | zr->jpg_buffers.active = ZORAN_FREE; | ||
1000 | |||
1001 | /* disable interrupts */ | ||
1002 | btand(~ZR36057_ICR_IntPinEn, ZR36057_ICR); | ||
1003 | |||
1004 | if (zr36067_debug > 1) | ||
1005 | print_interrupts(zr); | ||
1006 | |||
1007 | /* Overlay off */ | ||
1008 | zr->v4l_overlay_active = 0; | ||
1009 | zr36057_overlay(zr, 0); | ||
1010 | zr->overlay_mask = NULL; | ||
1011 | |||
1012 | /* capture off */ | ||
1013 | wake_up_interruptible(&zr->v4l_capq); | ||
1014 | zr36057_set_memgrab(zr, 0); | ||
1015 | zr->v4l_buffers.allocated = 0; | ||
1016 | zr->v4l_buffers.active = ZORAN_FREE; | ||
1017 | zoran_set_pci_master(zr, 0); | ||
1018 | |||
1019 | if (!pass_through) { /* Switch to color bar */ | ||
1020 | decoder_call(zr, video, s_stream, 0); | ||
1021 | encoder_call(zr, video, s_routing, 2, 0, 0); | ||
1022 | } | ||
1023 | } | ||
1024 | mutex_unlock(&zr->other_lock); | ||
1025 | |||
1026 | file->private_data = NULL; | ||
1027 | kfree(fh->overlay_mask); | ||
1028 | kfree(fh); | ||
1029 | |||
1030 | dprintk(4, KERN_INFO "%s: %s done\n", ZR_DEVNAME(zr), __func__); | ||
1031 | |||
1032 | return 0; | ||
1033 | } | ||
1034 | |||
1035 | |||
1036 | static ssize_t | ||
1037 | zoran_read (struct file *file, | ||
1038 | char __user *data, | ||
1039 | size_t count, | ||
1040 | loff_t *ppos) | ||
1041 | { | ||
1042 | /* we simply don't support read() (yet)... */ | ||
1043 | |||
1044 | return -EINVAL; | ||
1045 | } | ||
1046 | |||
1047 | static ssize_t | ||
1048 | zoran_write (struct file *file, | ||
1049 | const char __user *data, | ||
1050 | size_t count, | ||
1051 | loff_t *ppos) | ||
1052 | { | ||
1053 | /* ...and the same goes for write() */ | ||
1054 | |||
1055 | return -EINVAL; | ||
1056 | } | ||
1057 | |||
1058 | static int setup_fbuffer(struct zoran_fh *fh, | ||
1059 | void *base, | ||
1060 | const struct zoran_format *fmt, | ||
1061 | int width, | ||
1062 | int height, | ||
1063 | int bytesperline) | ||
1064 | { | ||
1065 | struct zoran *zr = fh->zr; | ||
1066 | |||
1067 | /* (Ronald) v4l/v4l2 guidelines */ | ||
1068 | if (!capable(CAP_SYS_ADMIN) && !capable(CAP_SYS_RAWIO)) | ||
1069 | return -EPERM; | ||
1070 | |||
1071 | /* Don't allow frame buffer overlay if PCI or AGP is buggy, or on | ||
1072 | ALi Magik (that needs very low latency while the card needs a | ||
1073 | higher value always) */ | ||
1074 | |||
1075 | if (pci_pci_problems & (PCIPCI_FAIL | PCIAGP_FAIL | PCIPCI_ALIMAGIK)) | ||
1076 | return -ENXIO; | ||
1077 | |||
1078 | /* we need a bytesperline value, even if not given */ | ||
1079 | if (!bytesperline) | ||
1080 | bytesperline = width * ((fmt->depth + 7) & ~7) / 8; | ||
1081 | |||
1082 | #if 0 | ||
1083 | if (zr->overlay_active) { | ||
1084 | /* dzjee... stupid users... don't even bother to turn off | ||
1085 | * overlay before changing the memory location... | ||
1086 | * normally, we would return errors here. However, one of | ||
1087 | * the tools that does this is... xawtv! and since xawtv | ||
1088 | * is used by +/- 99% of the users, we'd rather be user- | ||
1089 | * friendly and silently do as if nothing went wrong */ | ||
1090 | dprintk(3, | ||
1091 | KERN_ERR | ||
1092 | "%s: %s - forced overlay turnoff because framebuffer changed\n", | ||
1093 | ZR_DEVNAME(zr), __func__); | ||
1094 | zr36057_overlay(zr, 0); | ||
1095 | } | ||
1096 | #endif | ||
1097 | |||
1098 | if (!(fmt->flags & ZORAN_FORMAT_OVERLAY)) { | ||
1099 | dprintk(1, | ||
1100 | KERN_ERR | ||
1101 | "%s: %s - no valid overlay format given\n", | ||
1102 | ZR_DEVNAME(zr), __func__); | ||
1103 | return -EINVAL; | ||
1104 | } | ||
1105 | if (height <= 0 || width <= 0 || bytesperline <= 0) { | ||
1106 | dprintk(1, | ||
1107 | KERN_ERR | ||
1108 | "%s: %s - invalid height/width/bpl value (%d|%d|%d)\n", | ||
1109 | ZR_DEVNAME(zr), __func__, width, height, bytesperline); | ||
1110 | return -EINVAL; | ||
1111 | } | ||
1112 | if (bytesperline & 3) { | ||
1113 | dprintk(1, | ||
1114 | KERN_ERR | ||
1115 | "%s: %s - bytesperline (%d) must be 4-byte aligned\n", | ||
1116 | ZR_DEVNAME(zr), __func__, bytesperline); | ||
1117 | return -EINVAL; | ||
1118 | } | ||
1119 | |||
1120 | zr->vbuf_base = (void *) ((unsigned long) base & ~3); | ||
1121 | zr->vbuf_height = height; | ||
1122 | zr->vbuf_width = width; | ||
1123 | zr->vbuf_depth = fmt->depth; | ||
1124 | zr->overlay_settings.format = fmt; | ||
1125 | zr->vbuf_bytesperline = bytesperline; | ||
1126 | |||
1127 | /* The user should set new window parameters */ | ||
1128 | zr->overlay_settings.is_set = 0; | ||
1129 | |||
1130 | return 0; | ||
1131 | } | ||
1132 | |||
1133 | |||
1134 | static int setup_window(struct zoran_fh *fh, | ||
1135 | int x, | ||
1136 | int y, | ||
1137 | int width, | ||
1138 | int height, | ||
1139 | struct v4l2_clip __user *clips, | ||
1140 | unsigned int clipcount, | ||
1141 | void __user *bitmap) | ||
1142 | { | ||
1143 | struct zoran *zr = fh->zr; | ||
1144 | struct v4l2_clip *vcp = NULL; | ||
1145 | int on, end; | ||
1146 | |||
1147 | |||
1148 | if (!zr->vbuf_base) { | ||
1149 | dprintk(1, | ||
1150 | KERN_ERR | ||
1151 | "%s: %s - frame buffer has to be set first\n", | ||
1152 | ZR_DEVNAME(zr), __func__); | ||
1153 | return -EINVAL; | ||
1154 | } | ||
1155 | |||
1156 | if (!fh->overlay_settings.format) { | ||
1157 | dprintk(1, | ||
1158 | KERN_ERR | ||
1159 | "%s: %s - no overlay format set\n", | ||
1160 | ZR_DEVNAME(zr), __func__); | ||
1161 | return -EINVAL; | ||
1162 | } | ||
1163 | |||
1164 | if (clipcount > 2048) { | ||
1165 | dprintk(1, | ||
1166 | KERN_ERR | ||
1167 | "%s: %s - invalid clipcount\n", | ||
1168 | ZR_DEVNAME(zr), __func__); | ||
1169 | return -EINVAL; | ||
1170 | } | ||
1171 | |||
1172 | /* | ||
1173 | * The video front end needs 4-byte alinged line sizes, we correct that | ||
1174 | * silently here if necessary | ||
1175 | */ | ||
1176 | if (zr->vbuf_depth == 15 || zr->vbuf_depth == 16) { | ||
1177 | end = (x + width) & ~1; /* round down */ | ||
1178 | x = (x + 1) & ~1; /* round up */ | ||
1179 | width = end - x; | ||
1180 | } | ||
1181 | |||
1182 | if (zr->vbuf_depth == 24) { | ||
1183 | end = (x + width) & ~3; /* round down */ | ||
1184 | x = (x + 3) & ~3; /* round up */ | ||
1185 | width = end - x; | ||
1186 | } | ||
1187 | |||
1188 | if (width > BUZ_MAX_WIDTH) | ||
1189 | width = BUZ_MAX_WIDTH; | ||
1190 | if (height > BUZ_MAX_HEIGHT) | ||
1191 | height = BUZ_MAX_HEIGHT; | ||
1192 | |||
1193 | /* Check for invalid parameters */ | ||
1194 | if (width < BUZ_MIN_WIDTH || height < BUZ_MIN_HEIGHT || | ||
1195 | width > BUZ_MAX_WIDTH || height > BUZ_MAX_HEIGHT) { | ||
1196 | dprintk(1, | ||
1197 | KERN_ERR | ||
1198 | "%s: %s - width = %d or height = %d invalid\n", | ||
1199 | ZR_DEVNAME(zr), __func__, width, height); | ||
1200 | return -EINVAL; | ||
1201 | } | ||
1202 | |||
1203 | fh->overlay_settings.x = x; | ||
1204 | fh->overlay_settings.y = y; | ||
1205 | fh->overlay_settings.width = width; | ||
1206 | fh->overlay_settings.height = height; | ||
1207 | fh->overlay_settings.clipcount = clipcount; | ||
1208 | |||
1209 | /* | ||
1210 | * If an overlay is running, we have to switch it off | ||
1211 | * and switch it on again in order to get the new settings in effect. | ||
1212 | * | ||
1213 | * We also want to avoid that the overlay mask is written | ||
1214 | * when an overlay is running. | ||
1215 | */ | ||
1216 | |||
1217 | on = zr->v4l_overlay_active && !zr->v4l_memgrab_active && | ||
1218 | zr->overlay_active != ZORAN_FREE && | ||
1219 | fh->overlay_active != ZORAN_FREE; | ||
1220 | if (on) | ||
1221 | zr36057_overlay(zr, 0); | ||
1222 | |||
1223 | /* | ||
1224 | * Write the overlay mask if clips are wanted. | ||
1225 | * We prefer a bitmap. | ||
1226 | */ | ||
1227 | if (bitmap) { | ||
1228 | /* fake value - it just means we want clips */ | ||
1229 | fh->overlay_settings.clipcount = 1; | ||
1230 | |||
1231 | if (copy_from_user(fh->overlay_mask, bitmap, | ||
1232 | (width * height + 7) / 8)) { | ||
1233 | return -EFAULT; | ||
1234 | } | ||
1235 | } else if (clipcount) { | ||
1236 | /* write our own bitmap from the clips */ | ||
1237 | vcp = vmalloc(sizeof(struct v4l2_clip) * (clipcount + 4)); | ||
1238 | if (vcp == NULL) { | ||
1239 | dprintk(1, | ||
1240 | KERN_ERR | ||
1241 | "%s: %s - Alloc of clip mask failed\n", | ||
1242 | ZR_DEVNAME(zr), __func__); | ||
1243 | return -ENOMEM; | ||
1244 | } | ||
1245 | if (copy_from_user | ||
1246 | (vcp, clips, sizeof(struct v4l2_clip) * clipcount)) { | ||
1247 | vfree(vcp); | ||
1248 | return -EFAULT; | ||
1249 | } | ||
1250 | write_overlay_mask(fh, vcp, clipcount); | ||
1251 | vfree(vcp); | ||
1252 | } | ||
1253 | |||
1254 | fh->overlay_settings.is_set = 1; | ||
1255 | if (fh->overlay_active != ZORAN_FREE && | ||
1256 | zr->overlay_active != ZORAN_FREE) | ||
1257 | zr->overlay_settings = fh->overlay_settings; | ||
1258 | |||
1259 | if (on) | ||
1260 | zr36057_overlay(zr, 1); | ||
1261 | |||
1262 | /* Make sure the changes come into effect */ | ||
1263 | return wait_grab_pending(zr); | ||
1264 | } | ||
1265 | |||
1266 | static int setup_overlay(struct zoran_fh *fh, int on) | ||
1267 | { | ||
1268 | struct zoran *zr = fh->zr; | ||
1269 | |||
1270 | /* If there is nothing to do, return immediately */ | ||
1271 | if ((on && fh->overlay_active != ZORAN_FREE) || | ||
1272 | (!on && fh->overlay_active == ZORAN_FREE)) | ||
1273 | return 0; | ||
1274 | |||
1275 | /* check whether we're touching someone else's overlay */ | ||
1276 | if (on && zr->overlay_active != ZORAN_FREE && | ||
1277 | fh->overlay_active == ZORAN_FREE) { | ||
1278 | dprintk(1, | ||
1279 | KERN_ERR | ||
1280 | "%s: %s - overlay is already active for another session\n", | ||
1281 | ZR_DEVNAME(zr), __func__); | ||
1282 | return -EBUSY; | ||
1283 | } | ||
1284 | if (!on && zr->overlay_active != ZORAN_FREE && | ||
1285 | fh->overlay_active == ZORAN_FREE) { | ||
1286 | dprintk(1, | ||
1287 | KERN_ERR | ||
1288 | "%s: %s - you cannot cancel someone else's session\n", | ||
1289 | ZR_DEVNAME(zr), __func__); | ||
1290 | return -EPERM; | ||
1291 | } | ||
1292 | |||
1293 | if (on == 0) { | ||
1294 | zr->overlay_active = fh->overlay_active = ZORAN_FREE; | ||
1295 | zr->v4l_overlay_active = 0; | ||
1296 | /* When a grab is running, the video simply | ||
1297 | * won't be switched on any more */ | ||
1298 | if (!zr->v4l_memgrab_active) | ||
1299 | zr36057_overlay(zr, 0); | ||
1300 | zr->overlay_mask = NULL; | ||
1301 | } else { | ||
1302 | if (!zr->vbuf_base || !fh->overlay_settings.is_set) { | ||
1303 | dprintk(1, | ||
1304 | KERN_ERR | ||
1305 | "%s: %s - buffer or window not set\n", | ||
1306 | ZR_DEVNAME(zr), __func__); | ||
1307 | return -EINVAL; | ||
1308 | } | ||
1309 | if (!fh->overlay_settings.format) { | ||
1310 | dprintk(1, | ||
1311 | KERN_ERR | ||
1312 | "%s: %s - no overlay format set\n", | ||
1313 | ZR_DEVNAME(zr), __func__); | ||
1314 | return -EINVAL; | ||
1315 | } | ||
1316 | zr->overlay_active = fh->overlay_active = ZORAN_LOCKED; | ||
1317 | zr->v4l_overlay_active = 1; | ||
1318 | zr->overlay_mask = fh->overlay_mask; | ||
1319 | zr->overlay_settings = fh->overlay_settings; | ||
1320 | if (!zr->v4l_memgrab_active) | ||
1321 | zr36057_overlay(zr, 1); | ||
1322 | /* When a grab is running, the video will be | ||
1323 | * switched on when grab is finished */ | ||
1324 | } | ||
1325 | |||
1326 | /* Make sure the changes come into effect */ | ||
1327 | return wait_grab_pending(zr); | ||
1328 | } | ||
1329 | |||
1330 | /* get the status of a buffer in the clients buffer queue */ | ||
1331 | static int zoran_v4l2_buffer_status(struct zoran_fh *fh, | ||
1332 | struct v4l2_buffer *buf, int num) | ||
1333 | { | ||
1334 | struct zoran *zr = fh->zr; | ||
1335 | unsigned long flags; | ||
1336 | |||
1337 | buf->flags = V4L2_BUF_FLAG_MAPPED; | ||
1338 | |||
1339 | switch (fh->map_mode) { | ||
1340 | case ZORAN_MAP_MODE_RAW: | ||
1341 | /* check range */ | ||
1342 | if (num < 0 || num >= fh->buffers.num_buffers || | ||
1343 | !fh->buffers.allocated) { | ||
1344 | dprintk(1, | ||
1345 | KERN_ERR | ||
1346 | "%s: %s - wrong number or buffers not allocated\n", | ||
1347 | ZR_DEVNAME(zr), __func__); | ||
1348 | return -EINVAL; | ||
1349 | } | ||
1350 | |||
1351 | spin_lock_irqsave(&zr->spinlock, flags); | ||
1352 | dprintk(3, | ||
1353 | KERN_DEBUG | ||
1354 | "%s: %s() - raw active=%c, buffer %d: state=%c, map=%c\n", | ||
1355 | ZR_DEVNAME(zr), __func__, | ||
1356 | "FAL"[fh->buffers.active], num, | ||
1357 | "UPMD"[zr->v4l_buffers.buffer[num].state], | ||
1358 | fh->buffers.buffer[num].map ? 'Y' : 'N'); | ||
1359 | spin_unlock_irqrestore(&zr->spinlock, flags); | ||
1360 | |||
1361 | buf->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; | ||
1362 | buf->length = fh->buffers.buffer_size; | ||
1363 | |||
1364 | /* get buffer */ | ||
1365 | buf->bytesused = fh->buffers.buffer[num].bs.length; | ||
1366 | if (fh->buffers.buffer[num].state == BUZ_STATE_DONE || | ||
1367 | fh->buffers.buffer[num].state == BUZ_STATE_USER) { | ||
1368 | buf->sequence = fh->buffers.buffer[num].bs.seq; | ||
1369 | buf->flags |= V4L2_BUF_FLAG_DONE; | ||
1370 | buf->timestamp = fh->buffers.buffer[num].bs.timestamp; | ||
1371 | } else { | ||
1372 | buf->flags |= V4L2_BUF_FLAG_QUEUED; | ||
1373 | } | ||
1374 | |||
1375 | if (fh->v4l_settings.height <= BUZ_MAX_HEIGHT / 2) | ||
1376 | buf->field = V4L2_FIELD_TOP; | ||
1377 | else | ||
1378 | buf->field = V4L2_FIELD_INTERLACED; | ||
1379 | |||
1380 | break; | ||
1381 | |||
1382 | case ZORAN_MAP_MODE_JPG_REC: | ||
1383 | case ZORAN_MAP_MODE_JPG_PLAY: | ||
1384 | |||
1385 | /* check range */ | ||
1386 | if (num < 0 || num >= fh->buffers.num_buffers || | ||
1387 | !fh->buffers.allocated) { | ||
1388 | dprintk(1, | ||
1389 | KERN_ERR | ||
1390 | "%s: %s - wrong number or buffers not allocated\n", | ||
1391 | ZR_DEVNAME(zr), __func__); | ||
1392 | return -EINVAL; | ||
1393 | } | ||
1394 | |||
1395 | buf->type = (fh->map_mode == ZORAN_MAP_MODE_JPG_REC) ? | ||
1396 | V4L2_BUF_TYPE_VIDEO_CAPTURE : | ||
1397 | V4L2_BUF_TYPE_VIDEO_OUTPUT; | ||
1398 | buf->length = fh->buffers.buffer_size; | ||
1399 | |||
1400 | /* these variables are only written after frame has been captured */ | ||
1401 | if (fh->buffers.buffer[num].state == BUZ_STATE_DONE || | ||
1402 | fh->buffers.buffer[num].state == BUZ_STATE_USER) { | ||
1403 | buf->sequence = fh->buffers.buffer[num].bs.seq; | ||
1404 | buf->timestamp = fh->buffers.buffer[num].bs.timestamp; | ||
1405 | buf->bytesused = fh->buffers.buffer[num].bs.length; | ||
1406 | buf->flags |= V4L2_BUF_FLAG_DONE; | ||
1407 | } else { | ||
1408 | buf->flags |= V4L2_BUF_FLAG_QUEUED; | ||
1409 | } | ||
1410 | |||
1411 | /* which fields are these? */ | ||
1412 | if (fh->jpg_settings.TmpDcm != 1) | ||
1413 | buf->field = fh->jpg_settings.odd_even ? | ||
1414 | V4L2_FIELD_TOP : V4L2_FIELD_BOTTOM; | ||
1415 | else | ||
1416 | buf->field = fh->jpg_settings.odd_even ? | ||
1417 | V4L2_FIELD_SEQ_TB : V4L2_FIELD_SEQ_BT; | ||
1418 | |||
1419 | break; | ||
1420 | |||
1421 | default: | ||
1422 | |||
1423 | dprintk(5, | ||
1424 | KERN_ERR | ||
1425 | "%s: %s - invalid buffer type|map_mode (%d|%d)\n", | ||
1426 | ZR_DEVNAME(zr), __func__, buf->type, fh->map_mode); | ||
1427 | return -EINVAL; | ||
1428 | } | ||
1429 | |||
1430 | buf->memory = V4L2_MEMORY_MMAP; | ||
1431 | buf->index = num; | ||
1432 | buf->m.offset = buf->length * num; | ||
1433 | |||
1434 | return 0; | ||
1435 | } | ||
1436 | |||
1437 | static int | ||
1438 | zoran_set_norm (struct zoran *zr, | ||
1439 | v4l2_std_id norm) | ||
1440 | { | ||
1441 | int on; | ||
1442 | |||
1443 | if (zr->v4l_buffers.active != ZORAN_FREE || | ||
1444 | zr->jpg_buffers.active != ZORAN_FREE) { | ||
1445 | dprintk(1, | ||
1446 | KERN_WARNING | ||
1447 | "%s: %s called while in playback/capture mode\n", | ||
1448 | ZR_DEVNAME(zr), __func__); | ||
1449 | return -EBUSY; | ||
1450 | } | ||
1451 | |||
1452 | if (!(norm & zr->card.norms)) { | ||
1453 | dprintk(1, | ||
1454 | KERN_ERR "%s: %s - unsupported norm %llx\n", | ||
1455 | ZR_DEVNAME(zr), __func__, norm); | ||
1456 | return -EINVAL; | ||
1457 | } | ||
1458 | |||
1459 | if (norm == V4L2_STD_ALL) { | ||
1460 | unsigned int status = 0; | ||
1461 | v4l2_std_id std = 0; | ||
1462 | |||
1463 | decoder_call(zr, video, querystd, &std); | ||
1464 | decoder_call(zr, core, s_std, std); | ||
1465 | |||
1466 | /* let changes come into effect */ | ||
1467 | ssleep(2); | ||
1468 | |||
1469 | decoder_call(zr, video, g_input_status, &status); | ||
1470 | if (status & V4L2_IN_ST_NO_SIGNAL) { | ||
1471 | dprintk(1, | ||
1472 | KERN_ERR | ||
1473 | "%s: %s - no norm detected\n", | ||
1474 | ZR_DEVNAME(zr), __func__); | ||
1475 | /* reset norm */ | ||
1476 | decoder_call(zr, core, s_std, zr->norm); | ||
1477 | return -EIO; | ||
1478 | } | ||
1479 | |||
1480 | norm = std; | ||
1481 | } | ||
1482 | if (norm & V4L2_STD_SECAM) | ||
1483 | zr->timing = zr->card.tvn[2]; | ||
1484 | else if (norm & V4L2_STD_NTSC) | ||
1485 | zr->timing = zr->card.tvn[1]; | ||
1486 | else | ||
1487 | zr->timing = zr->card.tvn[0]; | ||
1488 | |||
1489 | /* We switch overlay off and on since a change in the | ||
1490 | * norm needs different VFE settings */ | ||
1491 | on = zr->overlay_active && !zr->v4l_memgrab_active; | ||
1492 | if (on) | ||
1493 | zr36057_overlay(zr, 0); | ||
1494 | |||
1495 | decoder_call(zr, core, s_std, norm); | ||
1496 | encoder_call(zr, video, s_std_output, norm); | ||
1497 | |||
1498 | if (on) | ||
1499 | zr36057_overlay(zr, 1); | ||
1500 | |||
1501 | /* Make sure the changes come into effect */ | ||
1502 | zr->norm = norm; | ||
1503 | |||
1504 | return 0; | ||
1505 | } | ||
1506 | |||
1507 | static int | ||
1508 | zoran_set_input (struct zoran *zr, | ||
1509 | int input) | ||
1510 | { | ||
1511 | if (input == zr->input) { | ||
1512 | return 0; | ||
1513 | } | ||
1514 | |||
1515 | if (zr->v4l_buffers.active != ZORAN_FREE || | ||
1516 | zr->jpg_buffers.active != ZORAN_FREE) { | ||
1517 | dprintk(1, | ||
1518 | KERN_WARNING | ||
1519 | "%s: %s called while in playback/capture mode\n", | ||
1520 | ZR_DEVNAME(zr), __func__); | ||
1521 | return -EBUSY; | ||
1522 | } | ||
1523 | |||
1524 | if (input < 0 || input >= zr->card.inputs) { | ||
1525 | dprintk(1, | ||
1526 | KERN_ERR | ||
1527 | "%s: %s - unnsupported input %d\n", | ||
1528 | ZR_DEVNAME(zr), __func__, input); | ||
1529 | return -EINVAL; | ||
1530 | } | ||
1531 | |||
1532 | zr->input = input; | ||
1533 | |||
1534 | decoder_call(zr, video, s_routing, | ||
1535 | zr->card.input[input].muxsel, 0, 0); | ||
1536 | |||
1537 | return 0; | ||
1538 | } | ||
1539 | |||
1540 | /* | ||
1541 | * ioctl routine | ||
1542 | */ | ||
1543 | |||
1544 | static int zoran_querycap(struct file *file, void *__fh, struct v4l2_capability *cap) | ||
1545 | { | ||
1546 | struct zoran_fh *fh = __fh; | ||
1547 | struct zoran *zr = fh->zr; | ||
1548 | |||
1549 | memset(cap, 0, sizeof(*cap)); | ||
1550 | strncpy(cap->card, ZR_DEVNAME(zr), sizeof(cap->card)-1); | ||
1551 | strncpy(cap->driver, "zoran", sizeof(cap->driver)-1); | ||
1552 | snprintf(cap->bus_info, sizeof(cap->bus_info), "PCI:%s", | ||
1553 | pci_name(zr->pci_dev)); | ||
1554 | cap->capabilities = V4L2_CAP_STREAMING | V4L2_CAP_VIDEO_CAPTURE | | ||
1555 | V4L2_CAP_VIDEO_OUTPUT | V4L2_CAP_VIDEO_OVERLAY; | ||
1556 | return 0; | ||
1557 | } | ||
1558 | |||
1559 | static int zoran_enum_fmt(struct zoran *zr, struct v4l2_fmtdesc *fmt, int flag) | ||
1560 | { | ||
1561 | unsigned int num, i; | ||
1562 | |||
1563 | for (num = i = 0; i < NUM_FORMATS; i++) { | ||
1564 | if (zoran_formats[i].flags & flag && num++ == fmt->index) { | ||
1565 | strncpy(fmt->description, zoran_formats[i].name, | ||
1566 | sizeof(fmt->description) - 1); | ||
1567 | /* fmt struct pre-zeroed, so adding '\0' not needed */ | ||
1568 | fmt->pixelformat = zoran_formats[i].fourcc; | ||
1569 | if (zoran_formats[i].flags & ZORAN_FORMAT_COMPRESSED) | ||
1570 | fmt->flags |= V4L2_FMT_FLAG_COMPRESSED; | ||
1571 | return 0; | ||
1572 | } | ||
1573 | } | ||
1574 | return -EINVAL; | ||
1575 | } | ||
1576 | |||
1577 | static int zoran_enum_fmt_vid_cap(struct file *file, void *__fh, | ||
1578 | struct v4l2_fmtdesc *f) | ||
1579 | { | ||
1580 | struct zoran_fh *fh = __fh; | ||
1581 | struct zoran *zr = fh->zr; | ||
1582 | |||
1583 | return zoran_enum_fmt(zr, f, ZORAN_FORMAT_CAPTURE); | ||
1584 | } | ||
1585 | |||
1586 | static int zoran_enum_fmt_vid_out(struct file *file, void *__fh, | ||
1587 | struct v4l2_fmtdesc *f) | ||
1588 | { | ||
1589 | struct zoran_fh *fh = __fh; | ||
1590 | struct zoran *zr = fh->zr; | ||
1591 | |||
1592 | return zoran_enum_fmt(zr, f, ZORAN_FORMAT_PLAYBACK); | ||
1593 | } | ||
1594 | |||
1595 | static int zoran_enum_fmt_vid_overlay(struct file *file, void *__fh, | ||
1596 | struct v4l2_fmtdesc *f) | ||
1597 | { | ||
1598 | struct zoran_fh *fh = __fh; | ||
1599 | struct zoran *zr = fh->zr; | ||
1600 | |||
1601 | return zoran_enum_fmt(zr, f, ZORAN_FORMAT_OVERLAY); | ||
1602 | } | ||
1603 | |||
1604 | static int zoran_g_fmt_vid_out(struct file *file, void *__fh, | ||
1605 | struct v4l2_format *fmt) | ||
1606 | { | ||
1607 | struct zoran_fh *fh = __fh; | ||
1608 | struct zoran *zr = fh->zr; | ||
1609 | |||
1610 | mutex_lock(&zr->resource_lock); | ||
1611 | |||
1612 | fmt->fmt.pix.width = fh->jpg_settings.img_width / fh->jpg_settings.HorDcm; | ||
1613 | fmt->fmt.pix.height = fh->jpg_settings.img_height * 2 / | ||
1614 | (fh->jpg_settings.VerDcm * fh->jpg_settings.TmpDcm); | ||
1615 | fmt->fmt.pix.sizeimage = zoran_v4l2_calc_bufsize(&fh->jpg_settings); | ||
1616 | fmt->fmt.pix.pixelformat = V4L2_PIX_FMT_MJPEG; | ||
1617 | if (fh->jpg_settings.TmpDcm == 1) | ||
1618 | fmt->fmt.pix.field = (fh->jpg_settings.odd_even ? | ||
1619 | V4L2_FIELD_SEQ_TB : V4L2_FIELD_SEQ_BT); | ||
1620 | else | ||
1621 | fmt->fmt.pix.field = (fh->jpg_settings.odd_even ? | ||
1622 | V4L2_FIELD_TOP : V4L2_FIELD_BOTTOM); | ||
1623 | fmt->fmt.pix.bytesperline = 0; | ||
1624 | fmt->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M; | ||
1625 | |||
1626 | mutex_unlock(&zr->resource_lock); | ||
1627 | return 0; | ||
1628 | } | ||
1629 | |||
1630 | static int zoran_g_fmt_vid_cap(struct file *file, void *__fh, | ||
1631 | struct v4l2_format *fmt) | ||
1632 | { | ||
1633 | struct zoran_fh *fh = __fh; | ||
1634 | struct zoran *zr = fh->zr; | ||
1635 | |||
1636 | if (fh->map_mode != ZORAN_MAP_MODE_RAW) | ||
1637 | return zoran_g_fmt_vid_out(file, fh, fmt); | ||
1638 | |||
1639 | mutex_lock(&zr->resource_lock); | ||
1640 | fmt->fmt.pix.width = fh->v4l_settings.width; | ||
1641 | fmt->fmt.pix.height = fh->v4l_settings.height; | ||
1642 | fmt->fmt.pix.sizeimage = fh->v4l_settings.bytesperline * | ||
1643 | fh->v4l_settings.height; | ||
1644 | fmt->fmt.pix.pixelformat = fh->v4l_settings.format->fourcc; | ||
1645 | fmt->fmt.pix.colorspace = fh->v4l_settings.format->colorspace; | ||
1646 | fmt->fmt.pix.bytesperline = fh->v4l_settings.bytesperline; | ||
1647 | if (BUZ_MAX_HEIGHT < (fh->v4l_settings.height * 2)) | ||
1648 | fmt->fmt.pix.field = V4L2_FIELD_INTERLACED; | ||
1649 | else | ||
1650 | fmt->fmt.pix.field = V4L2_FIELD_TOP; | ||
1651 | mutex_unlock(&zr->resource_lock); | ||
1652 | return 0; | ||
1653 | } | ||
1654 | |||
1655 | static int zoran_g_fmt_vid_overlay(struct file *file, void *__fh, | ||
1656 | struct v4l2_format *fmt) | ||
1657 | { | ||
1658 | struct zoran_fh *fh = __fh; | ||
1659 | struct zoran *zr = fh->zr; | ||
1660 | |||
1661 | mutex_lock(&zr->resource_lock); | ||
1662 | |||
1663 | fmt->fmt.win.w.left = fh->overlay_settings.x; | ||
1664 | fmt->fmt.win.w.top = fh->overlay_settings.y; | ||
1665 | fmt->fmt.win.w.width = fh->overlay_settings.width; | ||
1666 | fmt->fmt.win.w.height = fh->overlay_settings.height; | ||
1667 | if (fh->overlay_settings.width * 2 > BUZ_MAX_HEIGHT) | ||
1668 | fmt->fmt.win.field = V4L2_FIELD_INTERLACED; | ||
1669 | else | ||
1670 | fmt->fmt.win.field = V4L2_FIELD_TOP; | ||
1671 | |||
1672 | mutex_unlock(&zr->resource_lock); | ||
1673 | return 0; | ||
1674 | } | ||
1675 | |||
1676 | static int zoran_try_fmt_vid_overlay(struct file *file, void *__fh, | ||
1677 | struct v4l2_format *fmt) | ||
1678 | { | ||
1679 | struct zoran_fh *fh = __fh; | ||
1680 | struct zoran *zr = fh->zr; | ||
1681 | |||
1682 | mutex_lock(&zr->resource_lock); | ||
1683 | |||
1684 | if (fmt->fmt.win.w.width > BUZ_MAX_WIDTH) | ||
1685 | fmt->fmt.win.w.width = BUZ_MAX_WIDTH; | ||
1686 | if (fmt->fmt.win.w.width < BUZ_MIN_WIDTH) | ||
1687 | fmt->fmt.win.w.width = BUZ_MIN_WIDTH; | ||
1688 | if (fmt->fmt.win.w.height > BUZ_MAX_HEIGHT) | ||
1689 | fmt->fmt.win.w.height = BUZ_MAX_HEIGHT; | ||
1690 | if (fmt->fmt.win.w.height < BUZ_MIN_HEIGHT) | ||
1691 | fmt->fmt.win.w.height = BUZ_MIN_HEIGHT; | ||
1692 | |||
1693 | mutex_unlock(&zr->resource_lock); | ||
1694 | return 0; | ||
1695 | } | ||
1696 | |||
1697 | static int zoran_try_fmt_vid_out(struct file *file, void *__fh, | ||
1698 | struct v4l2_format *fmt) | ||
1699 | { | ||
1700 | struct zoran_fh *fh = __fh; | ||
1701 | struct zoran *zr = fh->zr; | ||
1702 | struct zoran_jpg_settings settings; | ||
1703 | int res = 0; | ||
1704 | |||
1705 | if (fmt->fmt.pix.pixelformat != V4L2_PIX_FMT_MJPEG) | ||
1706 | return -EINVAL; | ||
1707 | |||
1708 | mutex_lock(&zr->resource_lock); | ||
1709 | settings = fh->jpg_settings; | ||
1710 | |||
1711 | /* we actually need to set 'real' parameters now */ | ||
1712 | if ((fmt->fmt.pix.height * 2) > BUZ_MAX_HEIGHT) | ||
1713 | settings.TmpDcm = 1; | ||
1714 | else | ||
1715 | settings.TmpDcm = 2; | ||
1716 | settings.decimation = 0; | ||
1717 | if (fmt->fmt.pix.height <= fh->jpg_settings.img_height / 2) | ||
1718 | settings.VerDcm = 2; | ||
1719 | else | ||
1720 | settings.VerDcm = 1; | ||
1721 | if (fmt->fmt.pix.width <= fh->jpg_settings.img_width / 4) | ||
1722 | settings.HorDcm = 4; | ||
1723 | else if (fmt->fmt.pix.width <= fh->jpg_settings.img_width / 2) | ||
1724 | settings.HorDcm = 2; | ||
1725 | else | ||
1726 | settings.HorDcm = 1; | ||
1727 | if (settings.TmpDcm == 1) | ||
1728 | settings.field_per_buff = 2; | ||
1729 | else | ||
1730 | settings.field_per_buff = 1; | ||
1731 | |||
1732 | if (settings.HorDcm > 1) { | ||
1733 | settings.img_x = (BUZ_MAX_WIDTH == 720) ? 8 : 0; | ||
1734 | settings.img_width = (BUZ_MAX_WIDTH == 720) ? 704 : BUZ_MAX_WIDTH; | ||
1735 | } else { | ||
1736 | settings.img_x = 0; | ||
1737 | settings.img_width = BUZ_MAX_WIDTH; | ||
1738 | } | ||
1739 | |||
1740 | /* check */ | ||
1741 | res = zoran_check_jpg_settings(zr, &settings, 1); | ||
1742 | if (res) | ||
1743 | goto tryfmt_unlock_and_return; | ||
1744 | |||
1745 | /* tell the user what we actually did */ | ||
1746 | fmt->fmt.pix.width = settings.img_width / settings.HorDcm; | ||
1747 | fmt->fmt.pix.height = settings.img_height * 2 / | ||
1748 | (settings.TmpDcm * settings.VerDcm); | ||
1749 | if (settings.TmpDcm == 1) | ||
1750 | fmt->fmt.pix.field = (fh->jpg_settings.odd_even ? | ||
1751 | V4L2_FIELD_SEQ_TB : V4L2_FIELD_SEQ_BT); | ||
1752 | else | ||
1753 | fmt->fmt.pix.field = (fh->jpg_settings.odd_even ? | ||
1754 | V4L2_FIELD_TOP : V4L2_FIELD_BOTTOM); | ||
1755 | |||
1756 | fmt->fmt.pix.sizeimage = zoran_v4l2_calc_bufsize(&settings); | ||
1757 | fmt->fmt.pix.bytesperline = 0; | ||
1758 | fmt->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M; | ||
1759 | tryfmt_unlock_and_return: | ||
1760 | mutex_unlock(&zr->resource_lock); | ||
1761 | return res; | ||
1762 | } | ||
1763 | |||
1764 | static int zoran_try_fmt_vid_cap(struct file *file, void *__fh, | ||
1765 | struct v4l2_format *fmt) | ||
1766 | { | ||
1767 | struct zoran_fh *fh = __fh; | ||
1768 | struct zoran *zr = fh->zr; | ||
1769 | int bpp; | ||
1770 | int i; | ||
1771 | |||
1772 | if (fmt->fmt.pix.pixelformat == V4L2_PIX_FMT_MJPEG) | ||
1773 | return zoran_try_fmt_vid_out(file, fh, fmt); | ||
1774 | |||
1775 | mutex_lock(&zr->resource_lock); | ||
1776 | |||
1777 | for (i = 0; i < NUM_FORMATS; i++) | ||
1778 | if (zoran_formats[i].fourcc == fmt->fmt.pix.pixelformat) | ||
1779 | break; | ||
1780 | |||
1781 | if (i == NUM_FORMATS) { | ||
1782 | mutex_unlock(&zr->resource_lock); | ||
1783 | return -EINVAL; | ||
1784 | } | ||
1785 | |||
1786 | bpp = DIV_ROUND_UP(zoran_formats[i].depth, 8); | ||
1787 | v4l_bound_align_image( | ||
1788 | &fmt->fmt.pix.width, BUZ_MIN_WIDTH, BUZ_MAX_WIDTH, bpp == 2 ? 1 : 2, | ||
1789 | &fmt->fmt.pix.height, BUZ_MIN_HEIGHT, BUZ_MAX_HEIGHT, 0, 0); | ||
1790 | mutex_unlock(&zr->resource_lock); | ||
1791 | |||
1792 | return 0; | ||
1793 | } | ||
1794 | |||
1795 | static int zoran_s_fmt_vid_overlay(struct file *file, void *__fh, | ||
1796 | struct v4l2_format *fmt) | ||
1797 | { | ||
1798 | struct zoran_fh *fh = __fh; | ||
1799 | struct zoran *zr = fh->zr; | ||
1800 | int res; | ||
1801 | |||
1802 | dprintk(3, "x=%d, y=%d, w=%d, h=%d, cnt=%d, map=0x%p\n", | ||
1803 | fmt->fmt.win.w.left, fmt->fmt.win.w.top, | ||
1804 | fmt->fmt.win.w.width, | ||
1805 | fmt->fmt.win.w.height, | ||
1806 | fmt->fmt.win.clipcount, | ||
1807 | fmt->fmt.win.bitmap); | ||
1808 | mutex_lock(&zr->resource_lock); | ||
1809 | res = setup_window(fh, fmt->fmt.win.w.left, fmt->fmt.win.w.top, | ||
1810 | fmt->fmt.win.w.width, fmt->fmt.win.w.height, | ||
1811 | (struct v4l2_clip __user *)fmt->fmt.win.clips, | ||
1812 | fmt->fmt.win.clipcount, fmt->fmt.win.bitmap); | ||
1813 | mutex_unlock(&zr->resource_lock); | ||
1814 | return res; | ||
1815 | } | ||
1816 | |||
1817 | static int zoran_s_fmt_vid_out(struct file *file, void *__fh, | ||
1818 | struct v4l2_format *fmt) | ||
1819 | { | ||
1820 | struct zoran_fh *fh = __fh; | ||
1821 | struct zoran *zr = fh->zr; | ||
1822 | __le32 printformat = __cpu_to_le32(fmt->fmt.pix.pixelformat); | ||
1823 | struct zoran_jpg_settings settings; | ||
1824 | int res = 0; | ||
1825 | |||
1826 | dprintk(3, "size=%dx%d, fmt=0x%x (%4.4s)\n", | ||
1827 | fmt->fmt.pix.width, fmt->fmt.pix.height, | ||
1828 | fmt->fmt.pix.pixelformat, | ||
1829 | (char *) &printformat); | ||
1830 | if (fmt->fmt.pix.pixelformat != V4L2_PIX_FMT_MJPEG) | ||
1831 | return -EINVAL; | ||
1832 | |||
1833 | mutex_lock(&zr->resource_lock); | ||
1834 | |||
1835 | if (fh->buffers.allocated) { | ||
1836 | dprintk(1, KERN_ERR "%s: VIDIOC_S_FMT - cannot change capture mode\n", | ||
1837 | ZR_DEVNAME(zr)); | ||
1838 | res = -EBUSY; | ||
1839 | goto sfmtjpg_unlock_and_return; | ||
1840 | } | ||
1841 | |||
1842 | settings = fh->jpg_settings; | ||
1843 | |||
1844 | /* we actually need to set 'real' parameters now */ | ||
1845 | if (fmt->fmt.pix.height * 2 > BUZ_MAX_HEIGHT) | ||
1846 | settings.TmpDcm = 1; | ||
1847 | else | ||
1848 | settings.TmpDcm = 2; | ||
1849 | settings.decimation = 0; | ||
1850 | if (fmt->fmt.pix.height <= fh->jpg_settings.img_height / 2) | ||
1851 | settings.VerDcm = 2; | ||
1852 | else | ||
1853 | settings.VerDcm = 1; | ||
1854 | if (fmt->fmt.pix.width <= fh->jpg_settings.img_width / 4) | ||
1855 | settings.HorDcm = 4; | ||
1856 | else if (fmt->fmt.pix.width <= fh->jpg_settings.img_width / 2) | ||
1857 | settings.HorDcm = 2; | ||
1858 | else | ||
1859 | settings.HorDcm = 1; | ||
1860 | if (settings.TmpDcm == 1) | ||
1861 | settings.field_per_buff = 2; | ||
1862 | else | ||
1863 | settings.field_per_buff = 1; | ||
1864 | |||
1865 | if (settings.HorDcm > 1) { | ||
1866 | settings.img_x = (BUZ_MAX_WIDTH == 720) ? 8 : 0; | ||
1867 | settings.img_width = (BUZ_MAX_WIDTH == 720) ? 704 : BUZ_MAX_WIDTH; | ||
1868 | } else { | ||
1869 | settings.img_x = 0; | ||
1870 | settings.img_width = BUZ_MAX_WIDTH; | ||
1871 | } | ||
1872 | |||
1873 | /* check */ | ||
1874 | res = zoran_check_jpg_settings(zr, &settings, 0); | ||
1875 | if (res) | ||
1876 | goto sfmtjpg_unlock_and_return; | ||
1877 | |||
1878 | /* it's ok, so set them */ | ||
1879 | fh->jpg_settings = settings; | ||
1880 | |||
1881 | map_mode_jpg(fh, fmt->type == V4L2_BUF_TYPE_VIDEO_OUTPUT); | ||
1882 | fh->buffers.buffer_size = zoran_v4l2_calc_bufsize(&fh->jpg_settings); | ||
1883 | |||
1884 | /* tell the user what we actually did */ | ||
1885 | fmt->fmt.pix.width = settings.img_width / settings.HorDcm; | ||
1886 | fmt->fmt.pix.height = settings.img_height * 2 / | ||
1887 | (settings.TmpDcm * settings.VerDcm); | ||
1888 | if (settings.TmpDcm == 1) | ||
1889 | fmt->fmt.pix.field = (fh->jpg_settings.odd_even ? | ||
1890 | V4L2_FIELD_SEQ_TB : V4L2_FIELD_SEQ_BT); | ||
1891 | else | ||
1892 | fmt->fmt.pix.field = (fh->jpg_settings.odd_even ? | ||
1893 | V4L2_FIELD_TOP : V4L2_FIELD_BOTTOM); | ||
1894 | fmt->fmt.pix.bytesperline = 0; | ||
1895 | fmt->fmt.pix.sizeimage = fh->buffers.buffer_size; | ||
1896 | fmt->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M; | ||
1897 | |||
1898 | sfmtjpg_unlock_and_return: | ||
1899 | mutex_unlock(&zr->resource_lock); | ||
1900 | return res; | ||
1901 | } | ||
1902 | |||
1903 | static int zoran_s_fmt_vid_cap(struct file *file, void *__fh, | ||
1904 | struct v4l2_format *fmt) | ||
1905 | { | ||
1906 | struct zoran_fh *fh = __fh; | ||
1907 | struct zoran *zr = fh->zr; | ||
1908 | int i; | ||
1909 | int res = 0; | ||
1910 | |||
1911 | if (fmt->fmt.pix.pixelformat == V4L2_PIX_FMT_MJPEG) | ||
1912 | return zoran_s_fmt_vid_out(file, fh, fmt); | ||
1913 | |||
1914 | for (i = 0; i < NUM_FORMATS; i++) | ||
1915 | if (fmt->fmt.pix.pixelformat == zoran_formats[i].fourcc) | ||
1916 | break; | ||
1917 | if (i == NUM_FORMATS) { | ||
1918 | dprintk(1, KERN_ERR "%s: VIDIOC_S_FMT - unknown/unsupported format 0x%x\n", | ||
1919 | ZR_DEVNAME(zr), fmt->fmt.pix.pixelformat); | ||
1920 | return -EINVAL; | ||
1921 | } | ||
1922 | |||
1923 | mutex_lock(&zr->resource_lock); | ||
1924 | |||
1925 | if ((fh->map_mode != ZORAN_MAP_MODE_RAW && fh->buffers.allocated) || | ||
1926 | fh->buffers.active != ZORAN_FREE) { | ||
1927 | dprintk(1, KERN_ERR "%s: VIDIOC_S_FMT - cannot change capture mode\n", | ||
1928 | ZR_DEVNAME(zr)); | ||
1929 | res = -EBUSY; | ||
1930 | goto sfmtv4l_unlock_and_return; | ||
1931 | } | ||
1932 | if (fmt->fmt.pix.height > BUZ_MAX_HEIGHT) | ||
1933 | fmt->fmt.pix.height = BUZ_MAX_HEIGHT; | ||
1934 | if (fmt->fmt.pix.width > BUZ_MAX_WIDTH) | ||
1935 | fmt->fmt.pix.width = BUZ_MAX_WIDTH; | ||
1936 | |||
1937 | map_mode_raw(fh); | ||
1938 | |||
1939 | res = zoran_v4l_set_format(fh, fmt->fmt.pix.width, fmt->fmt.pix.height, | ||
1940 | &zoran_formats[i]); | ||
1941 | if (res) | ||
1942 | goto sfmtv4l_unlock_and_return; | ||
1943 | |||
1944 | /* tell the user the results/missing stuff */ | ||
1945 | fmt->fmt.pix.bytesperline = fh->v4l_settings.bytesperline; | ||
1946 | fmt->fmt.pix.sizeimage = fh->v4l_settings.height * fh->v4l_settings.bytesperline; | ||
1947 | fmt->fmt.pix.colorspace = fh->v4l_settings.format->colorspace; | ||
1948 | if (BUZ_MAX_HEIGHT < (fh->v4l_settings.height * 2)) | ||
1949 | fmt->fmt.pix.field = V4L2_FIELD_INTERLACED; | ||
1950 | else | ||
1951 | fmt->fmt.pix.field = V4L2_FIELD_TOP; | ||
1952 | |||
1953 | sfmtv4l_unlock_and_return: | ||
1954 | mutex_unlock(&zr->resource_lock); | ||
1955 | return res; | ||
1956 | } | ||
1957 | |||
1958 | static int zoran_g_fbuf(struct file *file, void *__fh, | ||
1959 | struct v4l2_framebuffer *fb) | ||
1960 | { | ||
1961 | struct zoran_fh *fh = __fh; | ||
1962 | struct zoran *zr = fh->zr; | ||
1963 | |||
1964 | memset(fb, 0, sizeof(*fb)); | ||
1965 | mutex_lock(&zr->resource_lock); | ||
1966 | fb->base = zr->vbuf_base; | ||
1967 | fb->fmt.width = zr->vbuf_width; | ||
1968 | fb->fmt.height = zr->vbuf_height; | ||
1969 | if (zr->overlay_settings.format) | ||
1970 | fb->fmt.pixelformat = fh->overlay_settings.format->fourcc; | ||
1971 | fb->fmt.bytesperline = zr->vbuf_bytesperline; | ||
1972 | mutex_unlock(&zr->resource_lock); | ||
1973 | fb->fmt.colorspace = V4L2_COLORSPACE_SRGB; | ||
1974 | fb->fmt.field = V4L2_FIELD_INTERLACED; | ||
1975 | fb->capability = V4L2_FBUF_CAP_LIST_CLIPPING; | ||
1976 | |||
1977 | return 0; | ||
1978 | } | ||
1979 | |||
1980 | static int zoran_s_fbuf(struct file *file, void *__fh, | ||
1981 | struct v4l2_framebuffer *fb) | ||
1982 | { | ||
1983 | struct zoran_fh *fh = __fh; | ||
1984 | struct zoran *zr = fh->zr; | ||
1985 | int i, res = 0; | ||
1986 | __le32 printformat = __cpu_to_le32(fb->fmt.pixelformat); | ||
1987 | |||
1988 | for (i = 0; i < NUM_FORMATS; i++) | ||
1989 | if (zoran_formats[i].fourcc == fb->fmt.pixelformat) | ||
1990 | break; | ||
1991 | if (i == NUM_FORMATS) { | ||
1992 | dprintk(1, KERN_ERR "%s: VIDIOC_S_FBUF - format=0x%x (%4.4s) not allowed\n", | ||
1993 | ZR_DEVNAME(zr), fb->fmt.pixelformat, | ||
1994 | (char *)&printformat); | ||
1995 | return -EINVAL; | ||
1996 | } | ||
1997 | |||
1998 | mutex_lock(&zr->resource_lock); | ||
1999 | res = setup_fbuffer(fh, fb->base, &zoran_formats[i], fb->fmt.width, | ||
2000 | fb->fmt.height, fb->fmt.bytesperline); | ||
2001 | mutex_unlock(&zr->resource_lock); | ||
2002 | |||
2003 | return res; | ||
2004 | } | ||
2005 | |||
2006 | static int zoran_overlay(struct file *file, void *__fh, unsigned int on) | ||
2007 | { | ||
2008 | struct zoran_fh *fh = __fh; | ||
2009 | struct zoran *zr = fh->zr; | ||
2010 | int res; | ||
2011 | |||
2012 | mutex_lock(&zr->resource_lock); | ||
2013 | res = setup_overlay(fh, on); | ||
2014 | mutex_unlock(&zr->resource_lock); | ||
2015 | |||
2016 | return res; | ||
2017 | } | ||
2018 | |||
2019 | static int zoran_streamoff(struct file *file, void *__fh, enum v4l2_buf_type type); | ||
2020 | |||
2021 | static int zoran_reqbufs(struct file *file, void *__fh, struct v4l2_requestbuffers *req) | ||
2022 | { | ||
2023 | struct zoran_fh *fh = __fh; | ||
2024 | struct zoran *zr = fh->zr; | ||
2025 | int res = 0; | ||
2026 | |||
2027 | if (req->memory != V4L2_MEMORY_MMAP) { | ||
2028 | dprintk(2, | ||
2029 | KERN_ERR | ||
2030 | "%s: only MEMORY_MMAP capture is supported, not %d\n", | ||
2031 | ZR_DEVNAME(zr), req->memory); | ||
2032 | return -EINVAL; | ||
2033 | } | ||
2034 | |||
2035 | if (req->count == 0) | ||
2036 | return zoran_streamoff(file, fh, req->type); | ||
2037 | |||
2038 | mutex_lock(&zr->resource_lock); | ||
2039 | if (fh->buffers.allocated) { | ||
2040 | dprintk(2, | ||
2041 | KERN_ERR | ||
2042 | "%s: VIDIOC_REQBUFS - buffers already allocated\n", | ||
2043 | ZR_DEVNAME(zr)); | ||
2044 | res = -EBUSY; | ||
2045 | goto v4l2reqbuf_unlock_and_return; | ||
2046 | } | ||
2047 | |||
2048 | if (fh->map_mode == ZORAN_MAP_MODE_RAW && | ||
2049 | req->type == V4L2_BUF_TYPE_VIDEO_CAPTURE) { | ||
2050 | /* control user input */ | ||
2051 | if (req->count < 2) | ||
2052 | req->count = 2; | ||
2053 | if (req->count > v4l_nbufs) | ||
2054 | req->count = v4l_nbufs; | ||
2055 | |||
2056 | /* The next mmap will map the V4L buffers */ | ||
2057 | map_mode_raw(fh); | ||
2058 | fh->buffers.num_buffers = req->count; | ||
2059 | |||
2060 | if (v4l_fbuffer_alloc(fh)) { | ||
2061 | res = -ENOMEM; | ||
2062 | goto v4l2reqbuf_unlock_and_return; | ||
2063 | } | ||
2064 | } else if (fh->map_mode == ZORAN_MAP_MODE_JPG_REC || | ||
2065 | fh->map_mode == ZORAN_MAP_MODE_JPG_PLAY) { | ||
2066 | /* we need to calculate size ourselves now */ | ||
2067 | if (req->count < 4) | ||
2068 | req->count = 4; | ||
2069 | if (req->count > jpg_nbufs) | ||
2070 | req->count = jpg_nbufs; | ||
2071 | |||
2072 | /* The next mmap will map the MJPEG buffers */ | ||
2073 | map_mode_jpg(fh, req->type == V4L2_BUF_TYPE_VIDEO_OUTPUT); | ||
2074 | fh->buffers.num_buffers = req->count; | ||
2075 | fh->buffers.buffer_size = zoran_v4l2_calc_bufsize(&fh->jpg_settings); | ||
2076 | |||
2077 | if (jpg_fbuffer_alloc(fh)) { | ||
2078 | res = -ENOMEM; | ||
2079 | goto v4l2reqbuf_unlock_and_return; | ||
2080 | } | ||
2081 | } else { | ||
2082 | dprintk(1, | ||
2083 | KERN_ERR | ||
2084 | "%s: VIDIOC_REQBUFS - unknown type %d\n", | ||
2085 | ZR_DEVNAME(zr), req->type); | ||
2086 | res = -EINVAL; | ||
2087 | goto v4l2reqbuf_unlock_and_return; | ||
2088 | } | ||
2089 | v4l2reqbuf_unlock_and_return: | ||
2090 | mutex_unlock(&zr->resource_lock); | ||
2091 | |||
2092 | return res; | ||
2093 | } | ||
2094 | |||
2095 | static int zoran_querybuf(struct file *file, void *__fh, struct v4l2_buffer *buf) | ||
2096 | { | ||
2097 | struct zoran_fh *fh = __fh; | ||
2098 | struct zoran *zr = fh->zr; | ||
2099 | int res; | ||
2100 | |||
2101 | mutex_lock(&zr->resource_lock); | ||
2102 | res = zoran_v4l2_buffer_status(fh, buf, buf->index); | ||
2103 | mutex_unlock(&zr->resource_lock); | ||
2104 | |||
2105 | return res; | ||
2106 | } | ||
2107 | |||
2108 | static int zoran_qbuf(struct file *file, void *__fh, struct v4l2_buffer *buf) | ||
2109 | { | ||
2110 | struct zoran_fh *fh = __fh; | ||
2111 | struct zoran *zr = fh->zr; | ||
2112 | int res = 0, codec_mode, buf_type; | ||
2113 | |||
2114 | mutex_lock(&zr->resource_lock); | ||
2115 | |||
2116 | switch (fh->map_mode) { | ||
2117 | case ZORAN_MAP_MODE_RAW: | ||
2118 | if (buf->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) { | ||
2119 | dprintk(1, KERN_ERR | ||
2120 | "%s: VIDIOC_QBUF - invalid buf->type=%d for map_mode=%d\n", | ||
2121 | ZR_DEVNAME(zr), buf->type, fh->map_mode); | ||
2122 | res = -EINVAL; | ||
2123 | goto qbuf_unlock_and_return; | ||
2124 | } | ||
2125 | |||
2126 | res = zoran_v4l_queue_frame(fh, buf->index); | ||
2127 | if (res) | ||
2128 | goto qbuf_unlock_and_return; | ||
2129 | if (!zr->v4l_memgrab_active && fh->buffers.active == ZORAN_LOCKED) | ||
2130 | zr36057_set_memgrab(zr, 1); | ||
2131 | break; | ||
2132 | |||
2133 | case ZORAN_MAP_MODE_JPG_REC: | ||
2134 | case ZORAN_MAP_MODE_JPG_PLAY: | ||
2135 | if (fh->map_mode == ZORAN_MAP_MODE_JPG_PLAY) { | ||
2136 | buf_type = V4L2_BUF_TYPE_VIDEO_OUTPUT; | ||
2137 | codec_mode = BUZ_MODE_MOTION_DECOMPRESS; | ||
2138 | } else { | ||
2139 | buf_type = V4L2_BUF_TYPE_VIDEO_CAPTURE; | ||
2140 | codec_mode = BUZ_MODE_MOTION_COMPRESS; | ||
2141 | } | ||
2142 | |||
2143 | if (buf->type != buf_type) { | ||
2144 | dprintk(1, KERN_ERR | ||
2145 | "%s: VIDIOC_QBUF - invalid buf->type=%d for map_mode=%d\n", | ||
2146 | ZR_DEVNAME(zr), buf->type, fh->map_mode); | ||
2147 | res = -EINVAL; | ||
2148 | goto qbuf_unlock_and_return; | ||
2149 | } | ||
2150 | |||
2151 | res = zoran_jpg_queue_frame(fh, buf->index, codec_mode); | ||
2152 | if (res != 0) | ||
2153 | goto qbuf_unlock_and_return; | ||
2154 | if (zr->codec_mode == BUZ_MODE_IDLE && | ||
2155 | fh->buffers.active == ZORAN_LOCKED) | ||
2156 | zr36057_enable_jpg(zr, codec_mode); | ||
2157 | |||
2158 | break; | ||
2159 | |||
2160 | default: | ||
2161 | dprintk(1, KERN_ERR | ||
2162 | "%s: VIDIOC_QBUF - unsupported type %d\n", | ||
2163 | ZR_DEVNAME(zr), buf->type); | ||
2164 | res = -EINVAL; | ||
2165 | break; | ||
2166 | } | ||
2167 | qbuf_unlock_and_return: | ||
2168 | mutex_unlock(&zr->resource_lock); | ||
2169 | |||
2170 | return res; | ||
2171 | } | ||
2172 | |||
2173 | static int zoran_dqbuf(struct file *file, void *__fh, struct v4l2_buffer *buf) | ||
2174 | { | ||
2175 | struct zoran_fh *fh = __fh; | ||
2176 | struct zoran *zr = fh->zr; | ||
2177 | int res = 0, buf_type, num = -1; /* compiler borks here (?) */ | ||
2178 | |||
2179 | mutex_lock(&zr->resource_lock); | ||
2180 | |||
2181 | switch (fh->map_mode) { | ||
2182 | case ZORAN_MAP_MODE_RAW: | ||
2183 | if (buf->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) { | ||
2184 | dprintk(1, KERN_ERR | ||
2185 | "%s: VIDIOC_QBUF - invalid buf->type=%d for map_mode=%d\n", | ||
2186 | ZR_DEVNAME(zr), buf->type, fh->map_mode); | ||
2187 | res = -EINVAL; | ||
2188 | goto dqbuf_unlock_and_return; | ||
2189 | } | ||
2190 | |||
2191 | num = zr->v4l_pend[zr->v4l_sync_tail & V4L_MASK_FRAME]; | ||
2192 | if (file->f_flags & O_NONBLOCK && | ||
2193 | zr->v4l_buffers.buffer[num].state != BUZ_STATE_DONE) { | ||
2194 | res = -EAGAIN; | ||
2195 | goto dqbuf_unlock_and_return; | ||
2196 | } | ||
2197 | res = v4l_sync(fh, num); | ||
2198 | if (res) | ||
2199 | goto dqbuf_unlock_and_return; | ||
2200 | zr->v4l_sync_tail++; | ||
2201 | res = zoran_v4l2_buffer_status(fh, buf, num); | ||
2202 | break; | ||
2203 | |||
2204 | case ZORAN_MAP_MODE_JPG_REC: | ||
2205 | case ZORAN_MAP_MODE_JPG_PLAY: | ||
2206 | { | ||
2207 | struct zoran_sync bs; | ||
2208 | |||
2209 | if (fh->map_mode == ZORAN_MAP_MODE_JPG_PLAY) | ||
2210 | buf_type = V4L2_BUF_TYPE_VIDEO_OUTPUT; | ||
2211 | else | ||
2212 | buf_type = V4L2_BUF_TYPE_VIDEO_CAPTURE; | ||
2213 | |||
2214 | if (buf->type != buf_type) { | ||
2215 | dprintk(1, KERN_ERR | ||
2216 | "%s: VIDIOC_QBUF - invalid buf->type=%d for map_mode=%d\n", | ||
2217 | ZR_DEVNAME(zr), buf->type, fh->map_mode); | ||
2218 | res = -EINVAL; | ||
2219 | goto dqbuf_unlock_and_return; | ||
2220 | } | ||
2221 | |||
2222 | num = zr->jpg_pend[zr->jpg_que_tail & BUZ_MASK_FRAME]; | ||
2223 | |||
2224 | if (file->f_flags & O_NONBLOCK && | ||
2225 | zr->jpg_buffers.buffer[num].state != BUZ_STATE_DONE) { | ||
2226 | res = -EAGAIN; | ||
2227 | goto dqbuf_unlock_and_return; | ||
2228 | } | ||
2229 | bs.frame = 0; /* suppress compiler warning */ | ||
2230 | res = jpg_sync(fh, &bs); | ||
2231 | if (res) | ||
2232 | goto dqbuf_unlock_and_return; | ||
2233 | res = zoran_v4l2_buffer_status(fh, buf, bs.frame); | ||
2234 | break; | ||
2235 | } | ||
2236 | |||
2237 | default: | ||
2238 | dprintk(1, KERN_ERR | ||
2239 | "%s: VIDIOC_DQBUF - unsupported type %d\n", | ||
2240 | ZR_DEVNAME(zr), buf->type); | ||
2241 | res = -EINVAL; | ||
2242 | break; | ||
2243 | } | ||
2244 | dqbuf_unlock_and_return: | ||
2245 | mutex_unlock(&zr->resource_lock); | ||
2246 | |||
2247 | return res; | ||
2248 | } | ||
2249 | |||
2250 | static int zoran_streamon(struct file *file, void *__fh, enum v4l2_buf_type type) | ||
2251 | { | ||
2252 | struct zoran_fh *fh = __fh; | ||
2253 | struct zoran *zr = fh->zr; | ||
2254 | int res = 0; | ||
2255 | |||
2256 | mutex_lock(&zr->resource_lock); | ||
2257 | |||
2258 | switch (fh->map_mode) { | ||
2259 | case ZORAN_MAP_MODE_RAW: /* raw capture */ | ||
2260 | if (zr->v4l_buffers.active != ZORAN_ACTIVE || | ||
2261 | fh->buffers.active != ZORAN_ACTIVE) { | ||
2262 | res = -EBUSY; | ||
2263 | goto strmon_unlock_and_return; | ||
2264 | } | ||
2265 | |||
2266 | zr->v4l_buffers.active = fh->buffers.active = ZORAN_LOCKED; | ||
2267 | zr->v4l_settings = fh->v4l_settings; | ||
2268 | |||
2269 | zr->v4l_sync_tail = zr->v4l_pend_tail; | ||
2270 | if (!zr->v4l_memgrab_active && | ||
2271 | zr->v4l_pend_head != zr->v4l_pend_tail) { | ||
2272 | zr36057_set_memgrab(zr, 1); | ||
2273 | } | ||
2274 | break; | ||
2275 | |||
2276 | case ZORAN_MAP_MODE_JPG_REC: | ||
2277 | case ZORAN_MAP_MODE_JPG_PLAY: | ||
2278 | /* what is the codec mode right now? */ | ||
2279 | if (zr->jpg_buffers.active != ZORAN_ACTIVE || | ||
2280 | fh->buffers.active != ZORAN_ACTIVE) { | ||
2281 | res = -EBUSY; | ||
2282 | goto strmon_unlock_and_return; | ||
2283 | } | ||
2284 | |||
2285 | zr->jpg_buffers.active = fh->buffers.active = ZORAN_LOCKED; | ||
2286 | |||
2287 | if (zr->jpg_que_head != zr->jpg_que_tail) { | ||
2288 | /* Start the jpeg codec when the first frame is queued */ | ||
2289 | jpeg_start(zr); | ||
2290 | } | ||
2291 | break; | ||
2292 | |||
2293 | default: | ||
2294 | dprintk(1, | ||
2295 | KERN_ERR | ||
2296 | "%s: VIDIOC_STREAMON - invalid map mode %d\n", | ||
2297 | ZR_DEVNAME(zr), fh->map_mode); | ||
2298 | res = -EINVAL; | ||
2299 | break; | ||
2300 | } | ||
2301 | strmon_unlock_and_return: | ||
2302 | mutex_unlock(&zr->resource_lock); | ||
2303 | |||
2304 | return res; | ||
2305 | } | ||
2306 | |||
2307 | static int zoran_streamoff(struct file *file, void *__fh, enum v4l2_buf_type type) | ||
2308 | { | ||
2309 | struct zoran_fh *fh = __fh; | ||
2310 | struct zoran *zr = fh->zr; | ||
2311 | int i, res = 0; | ||
2312 | unsigned long flags; | ||
2313 | |||
2314 | mutex_lock(&zr->resource_lock); | ||
2315 | |||
2316 | switch (fh->map_mode) { | ||
2317 | case ZORAN_MAP_MODE_RAW: /* raw capture */ | ||
2318 | if (fh->buffers.active == ZORAN_FREE && | ||
2319 | zr->v4l_buffers.active != ZORAN_FREE) { | ||
2320 | res = -EPERM; /* stay off other's settings! */ | ||
2321 | goto strmoff_unlock_and_return; | ||
2322 | } | ||
2323 | if (zr->v4l_buffers.active == ZORAN_FREE) | ||
2324 | goto strmoff_unlock_and_return; | ||
2325 | |||
2326 | spin_lock_irqsave(&zr->spinlock, flags); | ||
2327 | /* unload capture */ | ||
2328 | if (zr->v4l_memgrab_active) { | ||
2329 | |||
2330 | zr36057_set_memgrab(zr, 0); | ||
2331 | } | ||
2332 | |||
2333 | for (i = 0; i < fh->buffers.num_buffers; i++) | ||
2334 | zr->v4l_buffers.buffer[i].state = BUZ_STATE_USER; | ||
2335 | fh->buffers = zr->v4l_buffers; | ||
2336 | |||
2337 | zr->v4l_buffers.active = fh->buffers.active = ZORAN_FREE; | ||
2338 | |||
2339 | zr->v4l_grab_seq = 0; | ||
2340 | zr->v4l_pend_head = zr->v4l_pend_tail = 0; | ||
2341 | zr->v4l_sync_tail = 0; | ||
2342 | |||
2343 | spin_unlock_irqrestore(&zr->spinlock, flags); | ||
2344 | |||
2345 | break; | ||
2346 | |||
2347 | case ZORAN_MAP_MODE_JPG_REC: | ||
2348 | case ZORAN_MAP_MODE_JPG_PLAY: | ||
2349 | if (fh->buffers.active == ZORAN_FREE && | ||
2350 | zr->jpg_buffers.active != ZORAN_FREE) { | ||
2351 | res = -EPERM; /* stay off other's settings! */ | ||
2352 | goto strmoff_unlock_and_return; | ||
2353 | } | ||
2354 | if (zr->jpg_buffers.active == ZORAN_FREE) | ||
2355 | goto strmoff_unlock_and_return; | ||
2356 | |||
2357 | res = jpg_qbuf(fh, -1, | ||
2358 | (fh->map_mode == ZORAN_MAP_MODE_JPG_REC) ? | ||
2359 | BUZ_MODE_MOTION_COMPRESS : | ||
2360 | BUZ_MODE_MOTION_DECOMPRESS); | ||
2361 | if (res) | ||
2362 | goto strmoff_unlock_and_return; | ||
2363 | break; | ||
2364 | default: | ||
2365 | dprintk(1, KERN_ERR | ||
2366 | "%s: VIDIOC_STREAMOFF - invalid map mode %d\n", | ||
2367 | ZR_DEVNAME(zr), fh->map_mode); | ||
2368 | res = -EINVAL; | ||
2369 | break; | ||
2370 | } | ||
2371 | strmoff_unlock_and_return: | ||
2372 | mutex_unlock(&zr->resource_lock); | ||
2373 | |||
2374 | return res; | ||
2375 | } | ||
2376 | |||
2377 | static int zoran_queryctrl(struct file *file, void *__fh, | ||
2378 | struct v4l2_queryctrl *ctrl) | ||
2379 | { | ||
2380 | struct zoran_fh *fh = __fh; | ||
2381 | struct zoran *zr = fh->zr; | ||
2382 | |||
2383 | /* we only support hue/saturation/contrast/brightness */ | ||
2384 | if (ctrl->id < V4L2_CID_BRIGHTNESS || | ||
2385 | ctrl->id > V4L2_CID_HUE) | ||
2386 | return -EINVAL; | ||
2387 | |||
2388 | decoder_call(zr, core, queryctrl, ctrl); | ||
2389 | |||
2390 | return 0; | ||
2391 | } | ||
2392 | |||
2393 | static int zoran_g_ctrl(struct file *file, void *__fh, struct v4l2_control *ctrl) | ||
2394 | { | ||
2395 | struct zoran_fh *fh = __fh; | ||
2396 | struct zoran *zr = fh->zr; | ||
2397 | |||
2398 | /* we only support hue/saturation/contrast/brightness */ | ||
2399 | if (ctrl->id < V4L2_CID_BRIGHTNESS || | ||
2400 | ctrl->id > V4L2_CID_HUE) | ||
2401 | return -EINVAL; | ||
2402 | |||
2403 | mutex_lock(&zr->resource_lock); | ||
2404 | decoder_call(zr, core, g_ctrl, ctrl); | ||
2405 | mutex_unlock(&zr->resource_lock); | ||
2406 | |||
2407 | return 0; | ||
2408 | } | ||
2409 | |||
2410 | static int zoran_s_ctrl(struct file *file, void *__fh, struct v4l2_control *ctrl) | ||
2411 | { | ||
2412 | struct zoran_fh *fh = __fh; | ||
2413 | struct zoran *zr = fh->zr; | ||
2414 | |||
2415 | /* we only support hue/saturation/contrast/brightness */ | ||
2416 | if (ctrl->id < V4L2_CID_BRIGHTNESS || | ||
2417 | ctrl->id > V4L2_CID_HUE) | ||
2418 | return -EINVAL; | ||
2419 | |||
2420 | mutex_lock(&zr->resource_lock); | ||
2421 | decoder_call(zr, core, s_ctrl, ctrl); | ||
2422 | mutex_unlock(&zr->resource_lock); | ||
2423 | |||
2424 | return 0; | ||
2425 | } | ||
2426 | |||
2427 | static int zoran_g_std(struct file *file, void *__fh, v4l2_std_id *std) | ||
2428 | { | ||
2429 | struct zoran_fh *fh = __fh; | ||
2430 | struct zoran *zr = fh->zr; | ||
2431 | |||
2432 | mutex_lock(&zr->resource_lock); | ||
2433 | *std = zr->norm; | ||
2434 | mutex_unlock(&zr->resource_lock); | ||
2435 | return 0; | ||
2436 | } | ||
2437 | |||
2438 | static int zoran_s_std(struct file *file, void *__fh, v4l2_std_id *std) | ||
2439 | { | ||
2440 | struct zoran_fh *fh = __fh; | ||
2441 | struct zoran *zr = fh->zr; | ||
2442 | int res = 0; | ||
2443 | |||
2444 | mutex_lock(&zr->resource_lock); | ||
2445 | res = zoran_set_norm(zr, *std); | ||
2446 | if (res) | ||
2447 | goto sstd_unlock_and_return; | ||
2448 | |||
2449 | res = wait_grab_pending(zr); | ||
2450 | sstd_unlock_and_return: | ||
2451 | mutex_unlock(&zr->resource_lock); | ||
2452 | return res; | ||
2453 | } | ||
2454 | |||
2455 | static int zoran_enum_input(struct file *file, void *__fh, | ||
2456 | struct v4l2_input *inp) | ||
2457 | { | ||
2458 | struct zoran_fh *fh = __fh; | ||
2459 | struct zoran *zr = fh->zr; | ||
2460 | |||
2461 | if (inp->index >= zr->card.inputs) | ||
2462 | return -EINVAL; | ||
2463 | |||
2464 | strncpy(inp->name, zr->card.input[inp->index].name, | ||
2465 | sizeof(inp->name) - 1); | ||
2466 | inp->type = V4L2_INPUT_TYPE_CAMERA; | ||
2467 | inp->std = V4L2_STD_ALL; | ||
2468 | |||
2469 | /* Get status of video decoder */ | ||
2470 | mutex_lock(&zr->resource_lock); | ||
2471 | decoder_call(zr, video, g_input_status, &inp->status); | ||
2472 | mutex_unlock(&zr->resource_lock); | ||
2473 | return 0; | ||
2474 | } | ||
2475 | |||
2476 | static int zoran_g_input(struct file *file, void *__fh, unsigned int *input) | ||
2477 | { | ||
2478 | struct zoran_fh *fh = __fh; | ||
2479 | struct zoran *zr = fh->zr; | ||
2480 | |||
2481 | mutex_lock(&zr->resource_lock); | ||
2482 | *input = zr->input; | ||
2483 | mutex_unlock(&zr->resource_lock); | ||
2484 | |||
2485 | return 0; | ||
2486 | } | ||
2487 | |||
2488 | static int zoran_s_input(struct file *file, void *__fh, unsigned int input) | ||
2489 | { | ||
2490 | struct zoran_fh *fh = __fh; | ||
2491 | struct zoran *zr = fh->zr; | ||
2492 | int res; | ||
2493 | |||
2494 | mutex_lock(&zr->resource_lock); | ||
2495 | res = zoran_set_input(zr, input); | ||
2496 | if (res) | ||
2497 | goto sinput_unlock_and_return; | ||
2498 | |||
2499 | /* Make sure the changes come into effect */ | ||
2500 | res = wait_grab_pending(zr); | ||
2501 | sinput_unlock_and_return: | ||
2502 | mutex_unlock(&zr->resource_lock); | ||
2503 | return res; | ||
2504 | } | ||
2505 | |||
2506 | static int zoran_enum_output(struct file *file, void *__fh, | ||
2507 | struct v4l2_output *outp) | ||
2508 | { | ||
2509 | if (outp->index != 0) | ||
2510 | return -EINVAL; | ||
2511 | |||
2512 | outp->index = 0; | ||
2513 | outp->type = V4L2_OUTPUT_TYPE_ANALOGVGAOVERLAY; | ||
2514 | strncpy(outp->name, "Autodetect", sizeof(outp->name)-1); | ||
2515 | |||
2516 | return 0; | ||
2517 | } | ||
2518 | |||
2519 | static int zoran_g_output(struct file *file, void *__fh, unsigned int *output) | ||
2520 | { | ||
2521 | *output = 0; | ||
2522 | |||
2523 | return 0; | ||
2524 | } | ||
2525 | |||
2526 | static int zoran_s_output(struct file *file, void *__fh, unsigned int output) | ||
2527 | { | ||
2528 | if (output != 0) | ||
2529 | return -EINVAL; | ||
2530 | |||
2531 | return 0; | ||
2532 | } | ||
2533 | |||
2534 | /* cropping (sub-frame capture) */ | ||
2535 | static int zoran_cropcap(struct file *file, void *__fh, | ||
2536 | struct v4l2_cropcap *cropcap) | ||
2537 | { | ||
2538 | struct zoran_fh *fh = __fh; | ||
2539 | struct zoran *zr = fh->zr; | ||
2540 | int type = cropcap->type, res = 0; | ||
2541 | |||
2542 | memset(cropcap, 0, sizeof(*cropcap)); | ||
2543 | cropcap->type = type; | ||
2544 | |||
2545 | mutex_lock(&zr->resource_lock); | ||
2546 | |||
2547 | if (cropcap->type != V4L2_BUF_TYPE_VIDEO_OUTPUT && | ||
2548 | (cropcap->type != V4L2_BUF_TYPE_VIDEO_CAPTURE || | ||
2549 | fh->map_mode == ZORAN_MAP_MODE_RAW)) { | ||
2550 | dprintk(1, KERN_ERR | ||
2551 | "%s: VIDIOC_CROPCAP - subcapture only supported for compressed capture\n", | ||
2552 | ZR_DEVNAME(zr)); | ||
2553 | res = -EINVAL; | ||
2554 | goto cropcap_unlock_and_return; | ||
2555 | } | ||
2556 | |||
2557 | cropcap->bounds.top = cropcap->bounds.left = 0; | ||
2558 | cropcap->bounds.width = BUZ_MAX_WIDTH; | ||
2559 | cropcap->bounds.height = BUZ_MAX_HEIGHT; | ||
2560 | cropcap->defrect.top = cropcap->defrect.left = 0; | ||
2561 | cropcap->defrect.width = BUZ_MIN_WIDTH; | ||
2562 | cropcap->defrect.height = BUZ_MIN_HEIGHT; | ||
2563 | cropcap_unlock_and_return: | ||
2564 | mutex_unlock(&zr->resource_lock); | ||
2565 | return res; | ||
2566 | } | ||
2567 | |||
2568 | static int zoran_g_crop(struct file *file, void *__fh, struct v4l2_crop *crop) | ||
2569 | { | ||
2570 | struct zoran_fh *fh = __fh; | ||
2571 | struct zoran *zr = fh->zr; | ||
2572 | int type = crop->type, res = 0; | ||
2573 | |||
2574 | memset(crop, 0, sizeof(*crop)); | ||
2575 | crop->type = type; | ||
2576 | |||
2577 | mutex_lock(&zr->resource_lock); | ||
2578 | |||
2579 | if (crop->type != V4L2_BUF_TYPE_VIDEO_OUTPUT && | ||
2580 | (crop->type != V4L2_BUF_TYPE_VIDEO_CAPTURE || | ||
2581 | fh->map_mode == ZORAN_MAP_MODE_RAW)) { | ||
2582 | dprintk(1, | ||
2583 | KERN_ERR | ||
2584 | "%s: VIDIOC_G_CROP - subcapture only supported for compressed capture\n", | ||
2585 | ZR_DEVNAME(zr)); | ||
2586 | res = -EINVAL; | ||
2587 | goto gcrop_unlock_and_return; | ||
2588 | } | ||
2589 | |||
2590 | crop->c.top = fh->jpg_settings.img_y; | ||
2591 | crop->c.left = fh->jpg_settings.img_x; | ||
2592 | crop->c.width = fh->jpg_settings.img_width; | ||
2593 | crop->c.height = fh->jpg_settings.img_height; | ||
2594 | |||
2595 | gcrop_unlock_and_return: | ||
2596 | mutex_unlock(&zr->resource_lock); | ||
2597 | |||
2598 | return res; | ||
2599 | } | ||
2600 | |||
2601 | static int zoran_s_crop(struct file *file, void *__fh, struct v4l2_crop *crop) | ||
2602 | { | ||
2603 | struct zoran_fh *fh = __fh; | ||
2604 | struct zoran *zr = fh->zr; | ||
2605 | int res = 0; | ||
2606 | struct zoran_jpg_settings settings; | ||
2607 | |||
2608 | settings = fh->jpg_settings; | ||
2609 | |||
2610 | mutex_lock(&zr->resource_lock); | ||
2611 | |||
2612 | if (fh->buffers.allocated) { | ||
2613 | dprintk(1, KERN_ERR | ||
2614 | "%s: VIDIOC_S_CROP - cannot change settings while active\n", | ||
2615 | ZR_DEVNAME(zr)); | ||
2616 | res = -EBUSY; | ||
2617 | goto scrop_unlock_and_return; | ||
2618 | } | ||
2619 | |||
2620 | if (crop->type != V4L2_BUF_TYPE_VIDEO_OUTPUT && | ||
2621 | (crop->type != V4L2_BUF_TYPE_VIDEO_CAPTURE || | ||
2622 | fh->map_mode == ZORAN_MAP_MODE_RAW)) { | ||
2623 | dprintk(1, KERN_ERR | ||
2624 | "%s: VIDIOC_G_CROP - subcapture only supported for compressed capture\n", | ||
2625 | ZR_DEVNAME(zr)); | ||
2626 | res = -EINVAL; | ||
2627 | goto scrop_unlock_and_return; | ||
2628 | } | ||
2629 | |||
2630 | /* move into a form that we understand */ | ||
2631 | settings.img_x = crop->c.left; | ||
2632 | settings.img_y = crop->c.top; | ||
2633 | settings.img_width = crop->c.width; | ||
2634 | settings.img_height = crop->c.height; | ||
2635 | |||
2636 | /* check validity */ | ||
2637 | res = zoran_check_jpg_settings(zr, &settings, 0); | ||
2638 | if (res) | ||
2639 | goto scrop_unlock_and_return; | ||
2640 | |||
2641 | /* accept */ | ||
2642 | fh->jpg_settings = settings; | ||
2643 | |||
2644 | scrop_unlock_and_return: | ||
2645 | mutex_unlock(&zr->resource_lock); | ||
2646 | return res; | ||
2647 | } | ||
2648 | |||
2649 | static int zoran_g_jpegcomp(struct file *file, void *__fh, | ||
2650 | struct v4l2_jpegcompression *params) | ||
2651 | { | ||
2652 | struct zoran_fh *fh = __fh; | ||
2653 | struct zoran *zr = fh->zr; | ||
2654 | memset(params, 0, sizeof(*params)); | ||
2655 | |||
2656 | mutex_lock(&zr->resource_lock); | ||
2657 | |||
2658 | params->quality = fh->jpg_settings.jpg_comp.quality; | ||
2659 | params->APPn = fh->jpg_settings.jpg_comp.APPn; | ||
2660 | memcpy(params->APP_data, | ||
2661 | fh->jpg_settings.jpg_comp.APP_data, | ||
2662 | fh->jpg_settings.jpg_comp.APP_len); | ||
2663 | params->APP_len = fh->jpg_settings.jpg_comp.APP_len; | ||
2664 | memcpy(params->COM_data, | ||
2665 | fh->jpg_settings.jpg_comp.COM_data, | ||
2666 | fh->jpg_settings.jpg_comp.COM_len); | ||
2667 | params->COM_len = fh->jpg_settings.jpg_comp.COM_len; | ||
2668 | params->jpeg_markers = | ||
2669 | fh->jpg_settings.jpg_comp.jpeg_markers; | ||
2670 | |||
2671 | mutex_unlock(&zr->resource_lock); | ||
2672 | |||
2673 | return 0; | ||
2674 | } | ||
2675 | |||
2676 | static int zoran_s_jpegcomp(struct file *file, void *__fh, | ||
2677 | struct v4l2_jpegcompression *params) | ||
2678 | { | ||
2679 | struct zoran_fh *fh = __fh; | ||
2680 | struct zoran *zr = fh->zr; | ||
2681 | int res = 0; | ||
2682 | struct zoran_jpg_settings settings; | ||
2683 | |||
2684 | settings = fh->jpg_settings; | ||
2685 | |||
2686 | settings.jpg_comp = *params; | ||
2687 | |||
2688 | mutex_lock(&zr->resource_lock); | ||
2689 | |||
2690 | if (fh->buffers.active != ZORAN_FREE) { | ||
2691 | dprintk(1, KERN_WARNING | ||
2692 | "%s: VIDIOC_S_JPEGCOMP called while in playback/capture mode\n", | ||
2693 | ZR_DEVNAME(zr)); | ||
2694 | res = -EBUSY; | ||
2695 | goto sjpegc_unlock_and_return; | ||
2696 | } | ||
2697 | |||
2698 | res = zoran_check_jpg_settings(zr, &settings, 0); | ||
2699 | if (res) | ||
2700 | goto sjpegc_unlock_and_return; | ||
2701 | if (!fh->buffers.allocated) | ||
2702 | fh->buffers.buffer_size = | ||
2703 | zoran_v4l2_calc_bufsize(&fh->jpg_settings); | ||
2704 | fh->jpg_settings.jpg_comp = *params = settings.jpg_comp; | ||
2705 | sjpegc_unlock_and_return: | ||
2706 | mutex_unlock(&zr->resource_lock); | ||
2707 | |||
2708 | return res; | ||
2709 | } | ||
2710 | |||
2711 | static unsigned int | ||
2712 | zoran_poll (struct file *file, | ||
2713 | poll_table *wait) | ||
2714 | { | ||
2715 | struct zoran_fh *fh = file->private_data; | ||
2716 | struct zoran *zr = fh->zr; | ||
2717 | int res = 0, frame; | ||
2718 | unsigned long flags; | ||
2719 | |||
2720 | /* we should check whether buffers are ready to be synced on | ||
2721 | * (w/o waits - O_NONBLOCK) here | ||
2722 | * if ready for read (sync), return POLLIN|POLLRDNORM, | ||
2723 | * if ready for write (sync), return POLLOUT|POLLWRNORM, | ||
2724 | * if error, return POLLERR, | ||
2725 | * if no buffers queued or so, return POLLNVAL | ||
2726 | */ | ||
2727 | |||
2728 | mutex_lock(&zr->resource_lock); | ||
2729 | |||
2730 | switch (fh->map_mode) { | ||
2731 | case ZORAN_MAP_MODE_RAW: | ||
2732 | poll_wait(file, &zr->v4l_capq, wait); | ||
2733 | frame = zr->v4l_pend[zr->v4l_sync_tail & V4L_MASK_FRAME]; | ||
2734 | |||
2735 | spin_lock_irqsave(&zr->spinlock, flags); | ||
2736 | dprintk(3, | ||
2737 | KERN_DEBUG | ||
2738 | "%s: %s() raw - active=%c, sync_tail=%lu/%c, pend_tail=%lu, pend_head=%lu\n", | ||
2739 | ZR_DEVNAME(zr), __func__, | ||
2740 | "FAL"[fh->buffers.active], zr->v4l_sync_tail, | ||
2741 | "UPMD"[zr->v4l_buffers.buffer[frame].state], | ||
2742 | zr->v4l_pend_tail, zr->v4l_pend_head); | ||
2743 | /* Process is the one capturing? */ | ||
2744 | if (fh->buffers.active != ZORAN_FREE && | ||
2745 | /* Buffer ready to DQBUF? */ | ||
2746 | zr->v4l_buffers.buffer[frame].state == BUZ_STATE_DONE) | ||
2747 | res = POLLIN | POLLRDNORM; | ||
2748 | spin_unlock_irqrestore(&zr->spinlock, flags); | ||
2749 | |||
2750 | break; | ||
2751 | |||
2752 | case ZORAN_MAP_MODE_JPG_REC: | ||
2753 | case ZORAN_MAP_MODE_JPG_PLAY: | ||
2754 | poll_wait(file, &zr->jpg_capq, wait); | ||
2755 | frame = zr->jpg_pend[zr->jpg_que_tail & BUZ_MASK_FRAME]; | ||
2756 | |||
2757 | spin_lock_irqsave(&zr->spinlock, flags); | ||
2758 | dprintk(3, | ||
2759 | KERN_DEBUG | ||
2760 | "%s: %s() jpg - active=%c, que_tail=%lu/%c, que_head=%lu, dma=%lu/%lu\n", | ||
2761 | ZR_DEVNAME(zr), __func__, | ||
2762 | "FAL"[fh->buffers.active], zr->jpg_que_tail, | ||
2763 | "UPMD"[zr->jpg_buffers.buffer[frame].state], | ||
2764 | zr->jpg_que_head, zr->jpg_dma_tail, zr->jpg_dma_head); | ||
2765 | if (fh->buffers.active != ZORAN_FREE && | ||
2766 | zr->jpg_buffers.buffer[frame].state == BUZ_STATE_DONE) { | ||
2767 | if (fh->map_mode == ZORAN_MAP_MODE_JPG_REC) | ||
2768 | res = POLLIN | POLLRDNORM; | ||
2769 | else | ||
2770 | res = POLLOUT | POLLWRNORM; | ||
2771 | } | ||
2772 | spin_unlock_irqrestore(&zr->spinlock, flags); | ||
2773 | |||
2774 | break; | ||
2775 | |||
2776 | default: | ||
2777 | dprintk(1, | ||
2778 | KERN_ERR | ||
2779 | "%s: %s - internal error, unknown map_mode=%d\n", | ||
2780 | ZR_DEVNAME(zr), __func__, fh->map_mode); | ||
2781 | res = POLLNVAL; | ||
2782 | } | ||
2783 | |||
2784 | mutex_unlock(&zr->resource_lock); | ||
2785 | |||
2786 | return res; | ||
2787 | } | ||
2788 | |||
2789 | |||
2790 | /* | ||
2791 | * This maps the buffers to user space. | ||
2792 | * | ||
2793 | * Depending on the state of fh->map_mode | ||
2794 | * the V4L or the MJPEG buffers are mapped | ||
2795 | * per buffer or all together | ||
2796 | * | ||
2797 | * Note that we need to connect to some | ||
2798 | * unmap signal event to unmap the de-allocate | ||
2799 | * the buffer accordingly (zoran_vm_close()) | ||
2800 | */ | ||
2801 | |||
2802 | static void | ||
2803 | zoran_vm_open (struct vm_area_struct *vma) | ||
2804 | { | ||
2805 | struct zoran_mapping *map = vma->vm_private_data; | ||
2806 | |||
2807 | map->count++; | ||
2808 | } | ||
2809 | |||
2810 | static void | ||
2811 | zoran_vm_close (struct vm_area_struct *vma) | ||
2812 | { | ||
2813 | struct zoran_mapping *map = vma->vm_private_data; | ||
2814 | struct zoran_fh *fh = map->fh; | ||
2815 | struct zoran *zr = fh->zr; | ||
2816 | int i; | ||
2817 | |||
2818 | if (--map->count > 0) | ||
2819 | return; | ||
2820 | |||
2821 | dprintk(3, KERN_INFO "%s: %s - munmap(%s)\n", ZR_DEVNAME(zr), | ||
2822 | __func__, mode_name(fh->map_mode)); | ||
2823 | |||
2824 | for (i = 0; i < fh->buffers.num_buffers; i++) { | ||
2825 | if (fh->buffers.buffer[i].map == map) | ||
2826 | fh->buffers.buffer[i].map = NULL; | ||
2827 | } | ||
2828 | kfree(map); | ||
2829 | |||
2830 | /* Any buffers still mapped? */ | ||
2831 | for (i = 0; i < fh->buffers.num_buffers; i++) | ||
2832 | if (fh->buffers.buffer[i].map) | ||
2833 | return; | ||
2834 | |||
2835 | dprintk(3, KERN_INFO "%s: %s - free %s buffers\n", ZR_DEVNAME(zr), | ||
2836 | __func__, mode_name(fh->map_mode)); | ||
2837 | |||
2838 | mutex_lock(&zr->resource_lock); | ||
2839 | |||
2840 | if (fh->map_mode == ZORAN_MAP_MODE_RAW) { | ||
2841 | if (fh->buffers.active != ZORAN_FREE) { | ||
2842 | unsigned long flags; | ||
2843 | |||
2844 | spin_lock_irqsave(&zr->spinlock, flags); | ||
2845 | zr36057_set_memgrab(zr, 0); | ||
2846 | zr->v4l_buffers.allocated = 0; | ||
2847 | zr->v4l_buffers.active = fh->buffers.active = ZORAN_FREE; | ||
2848 | spin_unlock_irqrestore(&zr->spinlock, flags); | ||
2849 | } | ||
2850 | v4l_fbuffer_free(fh); | ||
2851 | } else { | ||
2852 | if (fh->buffers.active != ZORAN_FREE) { | ||
2853 | jpg_qbuf(fh, -1, zr->codec_mode); | ||
2854 | zr->jpg_buffers.allocated = 0; | ||
2855 | zr->jpg_buffers.active = fh->buffers.active = ZORAN_FREE; | ||
2856 | } | ||
2857 | jpg_fbuffer_free(fh); | ||
2858 | } | ||
2859 | |||
2860 | mutex_unlock(&zr->resource_lock); | ||
2861 | } | ||
2862 | |||
2863 | static const struct vm_operations_struct zoran_vm_ops = { | ||
2864 | .open = zoran_vm_open, | ||
2865 | .close = zoran_vm_close, | ||
2866 | }; | ||
2867 | |||
2868 | static int | ||
2869 | zoran_mmap (struct file *file, | ||
2870 | struct vm_area_struct *vma) | ||
2871 | { | ||
2872 | struct zoran_fh *fh = file->private_data; | ||
2873 | struct zoran *zr = fh->zr; | ||
2874 | unsigned long size = (vma->vm_end - vma->vm_start); | ||
2875 | unsigned long offset = vma->vm_pgoff << PAGE_SHIFT; | ||
2876 | int i, j; | ||
2877 | unsigned long page, start = vma->vm_start, todo, pos, fraglen; | ||
2878 | int first, last; | ||
2879 | struct zoran_mapping *map; | ||
2880 | int res = 0; | ||
2881 | |||
2882 | dprintk(3, | ||
2883 | KERN_INFO "%s: %s(%s) of 0x%08lx-0x%08lx (size=%lu)\n", | ||
2884 | ZR_DEVNAME(zr), __func__, | ||
2885 | mode_name(fh->map_mode), vma->vm_start, vma->vm_end, size); | ||
2886 | |||
2887 | if (!(vma->vm_flags & VM_SHARED) || !(vma->vm_flags & VM_READ) || | ||
2888 | !(vma->vm_flags & VM_WRITE)) { | ||
2889 | dprintk(1, | ||
2890 | KERN_ERR | ||
2891 | "%s: %s - no MAP_SHARED/PROT_{READ,WRITE} given\n", | ||
2892 | ZR_DEVNAME(zr), __func__); | ||
2893 | return -EINVAL; | ||
2894 | } | ||
2895 | |||
2896 | mutex_lock(&zr->resource_lock); | ||
2897 | |||
2898 | if (!fh->buffers.allocated) { | ||
2899 | dprintk(1, | ||
2900 | KERN_ERR | ||
2901 | "%s: %s(%s) - buffers not yet allocated\n", | ||
2902 | ZR_DEVNAME(zr), __func__, mode_name(fh->map_mode)); | ||
2903 | res = -ENOMEM; | ||
2904 | goto mmap_unlock_and_return; | ||
2905 | } | ||
2906 | |||
2907 | first = offset / fh->buffers.buffer_size; | ||
2908 | last = first - 1 + size / fh->buffers.buffer_size; | ||
2909 | if (offset % fh->buffers.buffer_size != 0 || | ||
2910 | size % fh->buffers.buffer_size != 0 || first < 0 || | ||
2911 | last < 0 || first >= fh->buffers.num_buffers || | ||
2912 | last >= fh->buffers.buffer_size) { | ||
2913 | dprintk(1, | ||
2914 | KERN_ERR | ||
2915 | "%s: %s(%s) - offset=%lu or size=%lu invalid for bufsize=%d and numbufs=%d\n", | ||
2916 | ZR_DEVNAME(zr), __func__, mode_name(fh->map_mode), offset, size, | ||
2917 | fh->buffers.buffer_size, | ||
2918 | fh->buffers.num_buffers); | ||
2919 | res = -EINVAL; | ||
2920 | goto mmap_unlock_and_return; | ||
2921 | } | ||
2922 | |||
2923 | /* Check if any buffers are already mapped */ | ||
2924 | for (i = first; i <= last; i++) { | ||
2925 | if (fh->buffers.buffer[i].map) { | ||
2926 | dprintk(1, | ||
2927 | KERN_ERR | ||
2928 | "%s: %s(%s) - buffer %d already mapped\n", | ||
2929 | ZR_DEVNAME(zr), __func__, mode_name(fh->map_mode), i); | ||
2930 | res = -EBUSY; | ||
2931 | goto mmap_unlock_and_return; | ||
2932 | } | ||
2933 | } | ||
2934 | |||
2935 | /* map these buffers */ | ||
2936 | map = kmalloc(sizeof(struct zoran_mapping), GFP_KERNEL); | ||
2937 | if (!map) { | ||
2938 | res = -ENOMEM; | ||
2939 | goto mmap_unlock_and_return; | ||
2940 | } | ||
2941 | map->fh = fh; | ||
2942 | map->count = 1; | ||
2943 | |||
2944 | vma->vm_ops = &zoran_vm_ops; | ||
2945 | vma->vm_flags |= VM_DONTEXPAND; | ||
2946 | vma->vm_private_data = map; | ||
2947 | |||
2948 | if (fh->map_mode == ZORAN_MAP_MODE_RAW) { | ||
2949 | for (i = first; i <= last; i++) { | ||
2950 | todo = size; | ||
2951 | if (todo > fh->buffers.buffer_size) | ||
2952 | todo = fh->buffers.buffer_size; | ||
2953 | page = fh->buffers.buffer[i].v4l.fbuffer_phys; | ||
2954 | if (remap_pfn_range(vma, start, page >> PAGE_SHIFT, | ||
2955 | todo, PAGE_SHARED)) { | ||
2956 | dprintk(1, | ||
2957 | KERN_ERR | ||
2958 | "%s: %s(V4L) - remap_pfn_range failed\n", | ||
2959 | ZR_DEVNAME(zr), __func__); | ||
2960 | res = -EAGAIN; | ||
2961 | goto mmap_unlock_and_return; | ||
2962 | } | ||
2963 | size -= todo; | ||
2964 | start += todo; | ||
2965 | fh->buffers.buffer[i].map = map; | ||
2966 | if (size == 0) | ||
2967 | break; | ||
2968 | } | ||
2969 | } else { | ||
2970 | for (i = first; i <= last; i++) { | ||
2971 | for (j = 0; | ||
2972 | j < fh->buffers.buffer_size / PAGE_SIZE; | ||
2973 | j++) { | ||
2974 | fraglen = | ||
2975 | (le32_to_cpu(fh->buffers.buffer[i].jpg. | ||
2976 | frag_tab[2 * j + 1]) & ~1) << 1; | ||
2977 | todo = size; | ||
2978 | if (todo > fraglen) | ||
2979 | todo = fraglen; | ||
2980 | pos = | ||
2981 | le32_to_cpu(fh->buffers. | ||
2982 | buffer[i].jpg.frag_tab[2 * j]); | ||
2983 | /* should just be pos on i386 */ | ||
2984 | page = virt_to_phys(bus_to_virt(pos)) | ||
2985 | >> PAGE_SHIFT; | ||
2986 | if (remap_pfn_range(vma, start, page, | ||
2987 | todo, PAGE_SHARED)) { | ||
2988 | dprintk(1, | ||
2989 | KERN_ERR | ||
2990 | "%s: %s(V4L) - remap_pfn_range failed\n", | ||
2991 | ZR_DEVNAME(zr), __func__); | ||
2992 | res = -EAGAIN; | ||
2993 | goto mmap_unlock_and_return; | ||
2994 | } | ||
2995 | size -= todo; | ||
2996 | start += todo; | ||
2997 | if (size == 0) | ||
2998 | break; | ||
2999 | if (le32_to_cpu(fh->buffers.buffer[i].jpg. | ||
3000 | frag_tab[2 * j + 1]) & 1) | ||
3001 | break; /* was last fragment */ | ||
3002 | } | ||
3003 | fh->buffers.buffer[i].map = map; | ||
3004 | if (size == 0) | ||
3005 | break; | ||
3006 | |||
3007 | } | ||
3008 | } | ||
3009 | |||
3010 | mmap_unlock_and_return: | ||
3011 | mutex_unlock(&zr->resource_lock); | ||
3012 | |||
3013 | return res; | ||
3014 | } | ||
3015 | |||
3016 | static const struct v4l2_ioctl_ops zoran_ioctl_ops = { | ||
3017 | .vidioc_querycap = zoran_querycap, | ||
3018 | .vidioc_cropcap = zoran_cropcap, | ||
3019 | .vidioc_s_crop = zoran_s_crop, | ||
3020 | .vidioc_g_crop = zoran_g_crop, | ||
3021 | .vidioc_enum_input = zoran_enum_input, | ||
3022 | .vidioc_g_input = zoran_g_input, | ||
3023 | .vidioc_s_input = zoran_s_input, | ||
3024 | .vidioc_enum_output = zoran_enum_output, | ||
3025 | .vidioc_g_output = zoran_g_output, | ||
3026 | .vidioc_s_output = zoran_s_output, | ||
3027 | .vidioc_g_fbuf = zoran_g_fbuf, | ||
3028 | .vidioc_s_fbuf = zoran_s_fbuf, | ||
3029 | .vidioc_g_std = zoran_g_std, | ||
3030 | .vidioc_s_std = zoran_s_std, | ||
3031 | .vidioc_g_jpegcomp = zoran_g_jpegcomp, | ||
3032 | .vidioc_s_jpegcomp = zoran_s_jpegcomp, | ||
3033 | .vidioc_overlay = zoran_overlay, | ||
3034 | .vidioc_reqbufs = zoran_reqbufs, | ||
3035 | .vidioc_querybuf = zoran_querybuf, | ||
3036 | .vidioc_qbuf = zoran_qbuf, | ||
3037 | .vidioc_dqbuf = zoran_dqbuf, | ||
3038 | .vidioc_streamon = zoran_streamon, | ||
3039 | .vidioc_streamoff = zoran_streamoff, | ||
3040 | .vidioc_enum_fmt_vid_cap = zoran_enum_fmt_vid_cap, | ||
3041 | .vidioc_enum_fmt_vid_out = zoran_enum_fmt_vid_out, | ||
3042 | .vidioc_enum_fmt_vid_overlay = zoran_enum_fmt_vid_overlay, | ||
3043 | .vidioc_g_fmt_vid_cap = zoran_g_fmt_vid_cap, | ||
3044 | .vidioc_g_fmt_vid_out = zoran_g_fmt_vid_out, | ||
3045 | .vidioc_g_fmt_vid_overlay = zoran_g_fmt_vid_overlay, | ||
3046 | .vidioc_s_fmt_vid_cap = zoran_s_fmt_vid_cap, | ||
3047 | .vidioc_s_fmt_vid_out = zoran_s_fmt_vid_out, | ||
3048 | .vidioc_s_fmt_vid_overlay = zoran_s_fmt_vid_overlay, | ||
3049 | .vidioc_try_fmt_vid_cap = zoran_try_fmt_vid_cap, | ||
3050 | .vidioc_try_fmt_vid_out = zoran_try_fmt_vid_out, | ||
3051 | .vidioc_try_fmt_vid_overlay = zoran_try_fmt_vid_overlay, | ||
3052 | .vidioc_queryctrl = zoran_queryctrl, | ||
3053 | .vidioc_s_ctrl = zoran_s_ctrl, | ||
3054 | .vidioc_g_ctrl = zoran_g_ctrl, | ||
3055 | }; | ||
3056 | |||
3057 | /* please use zr->resource_lock consistently and kill this wrapper */ | ||
3058 | static long zoran_ioctl(struct file *file, unsigned int cmd, | ||
3059 | unsigned long arg) | ||
3060 | { | ||
3061 | struct zoran_fh *fh = file->private_data; | ||
3062 | struct zoran *zr = fh->zr; | ||
3063 | int ret; | ||
3064 | |||
3065 | mutex_lock(&zr->other_lock); | ||
3066 | ret = video_ioctl2(file, cmd, arg); | ||
3067 | mutex_unlock(&zr->other_lock); | ||
3068 | |||
3069 | return ret; | ||
3070 | } | ||
3071 | |||
3072 | static const struct v4l2_file_operations zoran_fops = { | ||
3073 | .owner = THIS_MODULE, | ||
3074 | .open = zoran_open, | ||
3075 | .release = zoran_close, | ||
3076 | .unlocked_ioctl = zoran_ioctl, | ||
3077 | .read = zoran_read, | ||
3078 | .write = zoran_write, | ||
3079 | .mmap = zoran_mmap, | ||
3080 | .poll = zoran_poll, | ||
3081 | }; | ||
3082 | |||
3083 | struct video_device zoran_template __devinitdata = { | ||
3084 | .name = ZORAN_NAME, | ||
3085 | .fops = &zoran_fops, | ||
3086 | .ioctl_ops = &zoran_ioctl_ops, | ||
3087 | .release = &zoran_vdev_release, | ||
3088 | .tvnorms = V4L2_STD_NTSC | V4L2_STD_PAL | V4L2_STD_SECAM, | ||
3089 | }; | ||
3090 | |||