projects / GitHub / mt8127 / android_kernel_alcatel_ttab.git / blob
? search:


d0765bed79c9512c727e561ddf4bf8cb59a7c525
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / media / video / meye.c
1 /*
2 * Motion Eye video4linux driver for Sony Vaio PictureBook
3 *
4 * Copyright (C) 2001-2004 Stelian Pop <stelian@popies.net>
5 *
6 * Copyright (C) 2001-2002 Alcôve <www.alcove.com>
7 *
8 * Copyright (C) 2000 Andrew Tridgell <tridge@valinux.com>
9 *
10 * Earlier work by Werner Almesberger, Paul `Rusty' Russell and Paul Mackerras.
11 *
12 * Some parts borrowed from various video4linux drivers, especially
13 * bttv-driver.c and zoran.c, see original files for credits.
14 *
15 * This program is free software; you can redistribute it and/or modify
16 * it under the terms of the GNU General Public License as published by
17 * the Free Software Foundation; either version 2 of the License, or
18 * (at your option) any later version.
19 *
20 * This program is distributed in the hope that it will be useful,
21 * but WITHOUT ANY WARRANTY; without even the implied warranty of
22 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
23 * GNU General Public License for more details.
24 *
25 * You should have received a copy of the GNU General Public License
26 * along with this program; if not, write to the Free Software
27 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
28 */
29 #include <linux/module.h>
30 #include <linux/pci.h>
31 #include <linux/init.h>
32 #include <linux/videodev.h>
33 #include <media/v4l2-common.h>
34 #include <media/v4l2-ioctl.h>
35 #include <asm/uaccess.h>
36 #include <asm/io.h>
37 #include <linux/delay.h>
38 #include <linux/interrupt.h>
39 #include <linux/vmalloc.h>
40 #include <linux/dma-mapping.h>
41
42 #include "meye.h"
43 #include <linux/meye.h>
44
45 MODULE_AUTHOR("Stelian Pop <stelian@popies.net>");
46 MODULE_DESCRIPTION("v4l2 driver for the MotionEye camera");
47 MODULE_LICENSE("GPL");
48 MODULE_VERSION(MEYE_DRIVER_VERSION);
49
50 /* number of grab buffers */
51 static unsigned int gbuffers = 2;
52 module_param(gbuffers, int, 0444);
53 MODULE_PARM_DESC(gbuffers, "number of capture buffers, default is 2 (32 max)");
54
55 /* size of a grab buffer */
56 static unsigned int gbufsize = MEYE_MAX_BUFSIZE;
57 module_param(gbufsize, int, 0444);
58 MODULE_PARM_DESC(gbufsize, "size of the capture buffers, default is 614400"
59 " (will be rounded up to a page multiple)");
60
61 /* /dev/videoX registration number */
62 static int video_nr = -1;
63 module_param(video_nr, int, 0444);
64 MODULE_PARM_DESC(video_nr, "video device to register (0=/dev/video0, etc)");
65
66 /* driver structure - only one possible */
67 static struct meye meye;
68
69 /****************************************************************************/
70 /* Memory allocation routines (stolen from bttv-driver.c) */
71 /****************************************************************************/
72 static void *rvmalloc(unsigned long size)
73 {
74 void *mem;
75 unsigned long adr;
76
77 size = PAGE_ALIGN(size);
78 mem = vmalloc_32(size);
79 if (mem) {
80 memset(mem, 0, size);
81 adr = (unsigned long) mem;
82 while (size > 0) {
83 SetPageReserved(vmalloc_to_page((void *)adr));
84 adr += PAGE_SIZE;
85 size -= PAGE_SIZE;
86 }
87 }
88 return mem;
89 }
90
91 static void rvfree(void * mem, unsigned long size)
92 {
93 unsigned long adr;
94
95 if (mem) {
96 adr = (unsigned long) mem;
97 while ((long) size > 0) {
98 ClearPageReserved(vmalloc_to_page((void *)adr));
99 adr += PAGE_SIZE;
100 size -= PAGE_SIZE;
101 }
102 vfree(mem);
103 }
104 }
105
106 /*
107 * return a page table pointing to N pages of locked memory
108 *
109 * NOTE: The meye device expects DMA addresses on 32 bits, we build
110 * a table of 1024 entries = 4 bytes * 1024 = 4096 bytes.
111 */
112 static int ptable_alloc(void)
113 {
114 u32 *pt;
115 int i;
116
117 memset(meye.mchip_ptable, 0, sizeof(meye.mchip_ptable));
118
119 /* give only 32 bit DMA addresses */
120 if (dma_set_mask(&meye.mchip_dev->dev, DMA_BIT_MASK(32)))
121 return -1;
122
123 meye.mchip_ptable_toc = dma_alloc_coherent(&meye.mchip_dev->dev,
124 PAGE_SIZE,
125 &meye.mchip_dmahandle,
126 GFP_KERNEL);
127 if (!meye.mchip_ptable_toc) {
128 meye.mchip_dmahandle = 0;
129 return -1;
130 }
131
132 pt = meye.mchip_ptable_toc;
133 for (i = 0; i < MCHIP_NB_PAGES; i++) {
134 dma_addr_t dma;
135 meye.mchip_ptable[i] = dma_alloc_coherent(&meye.mchip_dev->dev,
136 PAGE_SIZE,
137 &dma,
138 GFP_KERNEL);
139 if (!meye.mchip_ptable[i]) {
140 int j;
141 pt = meye.mchip_ptable_toc;
142 for (j = 0; j < i; ++j) {
143 dma = (dma_addr_t) *pt;
144 dma_free_coherent(&meye.mchip_dev->dev,
145 PAGE_SIZE,
146 meye.mchip_ptable[j], dma);
147 pt++;
148 }
149 dma_free_coherent(&meye.mchip_dev->dev,
150 PAGE_SIZE,
151 meye.mchip_ptable_toc,
152 meye.mchip_dmahandle);
153 meye.mchip_ptable_toc = NULL;
154 meye.mchip_dmahandle = 0;
155 return -1;
156 }
157 *pt = (u32) dma;
158 pt++;
159 }
160 return 0;
161 }
162
163 static void ptable_free(void)
164 {
165 u32 *pt;
166 int i;
167
168 pt = meye.mchip_ptable_toc;
169 for (i = 0; i < MCHIP_NB_PAGES; i++) {
170 dma_addr_t dma = (dma_addr_t) *pt;
171 if (meye.mchip_ptable[i])
172 dma_free_coherent(&meye.mchip_dev->dev,
173 PAGE_SIZE,
174 meye.mchip_ptable[i], dma);
175 pt++;
176 }
177
178 if (meye.mchip_ptable_toc)
179 dma_free_coherent(&meye.mchip_dev->dev,
180 PAGE_SIZE,
181 meye.mchip_ptable_toc,
182 meye.mchip_dmahandle);
183
184 memset(meye.mchip_ptable, 0, sizeof(meye.mchip_ptable));
185 meye.mchip_ptable_toc = NULL;
186 meye.mchip_dmahandle = 0;
187 }
188
189 /* copy data from ptable into buf */
190 static void ptable_copy(u8 *buf, int start, int size, int pt_pages)
191 {
192 int i;
193
194 for (i = 0; i < (size / PAGE_SIZE) * PAGE_SIZE; i += PAGE_SIZE) {
195 memcpy(buf + i, meye.mchip_ptable[start++], PAGE_SIZE);
196 if (start >= pt_pages)
197 start = 0;
198 }
199 memcpy(buf + i, meye.mchip_ptable[start], size % PAGE_SIZE);
200 }
201
202 /****************************************************************************/
203 /* JPEG tables at different qualities to load into the VRJ chip */
204 /****************************************************************************/
205
206 /* return a set of quantisation tables based on a quality from 1 to 10 */
207 static u16 *jpeg_quantisation_tables(int *length, int quality)
208 {
209 static u16 jpeg_tables[][70] = { {
210 0xdbff, 0x4300, 0xff00, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff,
211 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff,
212 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff,
213 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff,
214 0xffff, 0xffff, 0xffff,
215 0xdbff, 0x4300, 0xff01, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff,
216 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff,
217 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff,
218 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff,
219 0xffff, 0xffff, 0xffff,
220 },
221 {
222 0xdbff, 0x4300, 0x5000, 0x3c37, 0x3c46, 0x5032, 0x4146, 0x5a46,
223 0x5055, 0x785f, 0x82c8, 0x6e78, 0x786e, 0xaff5, 0x91b9, 0xffc8,
224 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff,
225 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff,
226 0xffff, 0xffff, 0xffff,
227 0xdbff, 0x4300, 0x5501, 0x5a5a, 0x6978, 0xeb78, 0x8282, 0xffeb,
228 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff,
229 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff,
230 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff,
231 0xffff, 0xffff, 0xffff,
232 },
233 {
234 0xdbff, 0x4300, 0x2800, 0x1e1c, 0x1e23, 0x2819, 0x2123, 0x2d23,
235 0x282b, 0x3c30, 0x4164, 0x373c, 0x3c37, 0x587b, 0x495d, 0x9164,
236 0x9980, 0x8f96, 0x8c80, 0xa08a, 0xe6b4, 0xa0c3, 0xdaaa, 0x8aad,
237 0xc88c, 0xcbff, 0xeeda, 0xfff5, 0xffff, 0xc19b, 0xffff, 0xfaff,
238 0xe6ff, 0xfffd, 0xfff8,
239 0xdbff, 0x4300, 0x2b01, 0x2d2d, 0x353c, 0x763c, 0x4141, 0xf876,
240 0x8ca5, 0xf8a5, 0xf8f8, 0xf8f8, 0xf8f8, 0xf8f8, 0xf8f8, 0xf8f8,
241 0xf8f8, 0xf8f8, 0xf8f8, 0xf8f8, 0xf8f8, 0xf8f8, 0xf8f8, 0xf8f8,
242 0xf8f8, 0xf8f8, 0xf8f8, 0xf8f8, 0xf8f8, 0xf8f8, 0xf8f8, 0xf8f8,
243 0xf8f8, 0xf8f8, 0xfff8,
244 },
245 {
246 0xdbff, 0x4300, 0x1b00, 0x1412, 0x1417, 0x1b11, 0x1617, 0x1e17,
247 0x1b1c, 0x2820, 0x2b42, 0x2528, 0x2825, 0x3a51, 0x303d, 0x6042,
248 0x6555, 0x5f64, 0x5d55, 0x6a5b, 0x9978, 0x6a81, 0x9071, 0x5b73,
249 0x855d, 0x86b5, 0x9e90, 0xaba3, 0xabad, 0x8067, 0xc9bc, 0xa6ba,
250 0x99c7, 0xaba8, 0xffa4,
251 0xdbff, 0x4300, 0x1c01, 0x1e1e, 0x2328, 0x4e28, 0x2b2b, 0xa44e,
252 0x5d6e, 0xa46e, 0xa4a4, 0xa4a4, 0xa4a4, 0xa4a4, 0xa4a4, 0xa4a4,
253 0xa4a4, 0xa4a4, 0xa4a4, 0xa4a4, 0xa4a4, 0xa4a4, 0xa4a4, 0xa4a4,
254 0xa4a4, 0xa4a4, 0xa4a4, 0xa4a4, 0xa4a4, 0xa4a4, 0xa4a4, 0xa4a4,
255 0xa4a4, 0xa4a4, 0xffa4,
256 },
257 {
258 0xdbff, 0x4300, 0x1400, 0x0f0e, 0x0f12, 0x140d, 0x1012, 0x1712,
259 0x1415, 0x1e18, 0x2132, 0x1c1e, 0x1e1c, 0x2c3d, 0x242e, 0x4932,
260 0x4c40, 0x474b, 0x4640, 0x5045, 0x735a, 0x5062, 0x6d55, 0x4556,
261 0x6446, 0x6588, 0x776d, 0x817b, 0x8182, 0x604e, 0x978d, 0x7d8c,
262 0x7396, 0x817e, 0xff7c,
263 0xdbff, 0x4300, 0x1501, 0x1717, 0x1a1e, 0x3b1e, 0x2121, 0x7c3b,
264 0x4653, 0x7c53, 0x7c7c, 0x7c7c, 0x7c7c, 0x7c7c, 0x7c7c, 0x7c7c,
265 0x7c7c, 0x7c7c, 0x7c7c, 0x7c7c, 0x7c7c, 0x7c7c, 0x7c7c, 0x7c7c,
266 0x7c7c, 0x7c7c, 0x7c7c, 0x7c7c, 0x7c7c, 0x7c7c, 0x7c7c, 0x7c7c,
267 0x7c7c, 0x7c7c, 0xff7c,
268 },
269 {
270 0xdbff, 0x4300, 0x1000, 0x0c0b, 0x0c0e, 0x100a, 0x0d0e, 0x120e,
271 0x1011, 0x1813, 0x1a28, 0x1618, 0x1816, 0x2331, 0x1d25, 0x3a28,
272 0x3d33, 0x393c, 0x3833, 0x4037, 0x5c48, 0x404e, 0x5744, 0x3745,
273 0x5038, 0x516d, 0x5f57, 0x6762, 0x6768, 0x4d3e, 0x7971, 0x6470,
274 0x5c78, 0x6765, 0xff63,
275 0xdbff, 0x4300, 0x1101, 0x1212, 0x1518, 0x2f18, 0x1a1a, 0x632f,
276 0x3842, 0x6342, 0x6363, 0x6363, 0x6363, 0x6363, 0x6363, 0x6363,
277 0x6363, 0x6363, 0x6363, 0x6363, 0x6363, 0x6363, 0x6363, 0x6363,
278 0x6363, 0x6363, 0x6363, 0x6363, 0x6363, 0x6363, 0x6363, 0x6363,
279 0x6363, 0x6363, 0xff63,
280 },
281 {
282 0xdbff, 0x4300, 0x0d00, 0x0a09, 0x0a0b, 0x0d08, 0x0a0b, 0x0e0b,
283 0x0d0e, 0x130f, 0x1520, 0x1213, 0x1312, 0x1c27, 0x171e, 0x2e20,
284 0x3129, 0x2e30, 0x2d29, 0x332c, 0x4a3a, 0x333e, 0x4636, 0x2c37,
285 0x402d, 0x4157, 0x4c46, 0x524e, 0x5253, 0x3e32, 0x615a, 0x505a,
286 0x4a60, 0x5251, 0xff4f,
287 0xdbff, 0x4300, 0x0e01, 0x0e0e, 0x1113, 0x2613, 0x1515, 0x4f26,
288 0x2d35, 0x4f35, 0x4f4f, 0x4f4f, 0x4f4f, 0x4f4f, 0x4f4f, 0x4f4f,
289 0x4f4f, 0x4f4f, 0x4f4f, 0x4f4f, 0x4f4f, 0x4f4f, 0x4f4f, 0x4f4f,
290 0x4f4f, 0x4f4f, 0x4f4f, 0x4f4f, 0x4f4f, 0x4f4f, 0x4f4f, 0x4f4f,
291 0x4f4f, 0x4f4f, 0xff4f,
292 },
293 {
294 0xdbff, 0x4300, 0x0a00, 0x0707, 0x0708, 0x0a06, 0x0808, 0x0b08,
295 0x0a0a, 0x0e0b, 0x1018, 0x0d0e, 0x0e0d, 0x151d, 0x1116, 0x2318,
296 0x251f, 0x2224, 0x221f, 0x2621, 0x372b, 0x262f, 0x3429, 0x2129,
297 0x3022, 0x3141, 0x3934, 0x3e3b, 0x3e3e, 0x2e25, 0x4944, 0x3c43,
298 0x3748, 0x3e3d, 0xff3b,
299 0xdbff, 0x4300, 0x0a01, 0x0b0b, 0x0d0e, 0x1c0e, 0x1010, 0x3b1c,
300 0x2228, 0x3b28, 0x3b3b, 0x3b3b, 0x3b3b, 0x3b3b, 0x3b3b, 0x3b3b,
301 0x3b3b, 0x3b3b, 0x3b3b, 0x3b3b, 0x3b3b, 0x3b3b, 0x3b3b, 0x3b3b,
302 0x3b3b, 0x3b3b, 0x3b3b, 0x3b3b, 0x3b3b, 0x3b3b, 0x3b3b, 0x3b3b,
303 0x3b3b, 0x3b3b, 0xff3b,
304 },
305 {
306 0xdbff, 0x4300, 0x0600, 0x0504, 0x0506, 0x0604, 0x0506, 0x0706,
307 0x0607, 0x0a08, 0x0a10, 0x090a, 0x0a09, 0x0e14, 0x0c0f, 0x1710,
308 0x1814, 0x1718, 0x1614, 0x1a16, 0x251d, 0x1a1f, 0x231b, 0x161c,
309 0x2016, 0x202c, 0x2623, 0x2927, 0x292a, 0x1f19, 0x302d, 0x282d,
310 0x2530, 0x2928, 0xff28,
311 0xdbff, 0x4300, 0x0701, 0x0707, 0x080a, 0x130a, 0x0a0a, 0x2813,
312 0x161a, 0x281a, 0x2828, 0x2828, 0x2828, 0x2828, 0x2828, 0x2828,
313 0x2828, 0x2828, 0x2828, 0x2828, 0x2828, 0x2828, 0x2828, 0x2828,
314 0x2828, 0x2828, 0x2828, 0x2828, 0x2828, 0x2828, 0x2828, 0x2828,
315 0x2828, 0x2828, 0xff28,
316 },
317 {
318 0xdbff, 0x4300, 0x0300, 0x0202, 0x0203, 0x0302, 0x0303, 0x0403,
319 0x0303, 0x0504, 0x0508, 0x0405, 0x0504, 0x070a, 0x0607, 0x0c08,
320 0x0c0a, 0x0b0c, 0x0b0a, 0x0d0b, 0x120e, 0x0d10, 0x110e, 0x0b0e,
321 0x100b, 0x1016, 0x1311, 0x1514, 0x1515, 0x0f0c, 0x1817, 0x1416,
322 0x1218, 0x1514, 0xff14,
323 0xdbff, 0x4300, 0x0301, 0x0404, 0x0405, 0x0905, 0x0505, 0x1409,
324 0x0b0d, 0x140d, 0x1414, 0x1414, 0x1414, 0x1414, 0x1414, 0x1414,
325 0x1414, 0x1414, 0x1414, 0x1414, 0x1414, 0x1414, 0x1414, 0x1414,
326 0x1414, 0x1414, 0x1414, 0x1414, 0x1414, 0x1414, 0x1414, 0x1414,
327 0x1414, 0x1414, 0xff14,
328 },
329 {
330 0xdbff, 0x4300, 0x0100, 0x0101, 0x0101, 0x0101, 0x0101, 0x0101,
331 0x0101, 0x0101, 0x0101, 0x0101, 0x0101, 0x0101, 0x0101, 0x0101,
332 0x0101, 0x0101, 0x0101, 0x0101, 0x0101, 0x0101, 0x0101, 0x0101,
333 0x0101, 0x0101, 0x0101, 0x0101, 0x0101, 0x0101, 0x0101, 0x0101,
334 0x0101, 0x0101, 0xff01,
335 0xdbff, 0x4300, 0x0101, 0x0101, 0x0101, 0x0101, 0x0101, 0x0101,
336 0x0101, 0x0101, 0x0101, 0x0101, 0x0101, 0x0101, 0x0101, 0x0101,
337 0x0101, 0x0101, 0x0101, 0x0101, 0x0101, 0x0101, 0x0101, 0x0101,
338 0x0101, 0x0101, 0x0101, 0x0101, 0x0101, 0x0101, 0x0101, 0x0101,
339 0x0101, 0x0101, 0xff01,
340 } };
341
342 if (quality < 0 || quality > 10) {
343 printk(KERN_WARNING
344 "meye: invalid quality level %d - using 8\n", quality);
345 quality = 8;
346 }
347
348 *length = ARRAY_SIZE(jpeg_tables[quality]);
349 return jpeg_tables[quality];
350 }
351
352 /* return a generic set of huffman tables */
353 static u16 *jpeg_huffman_tables(int *length)
354 {
355 static u16 tables[] = {
356 0xC4FF, 0xB500, 0x0010, 0x0102, 0x0303, 0x0402, 0x0503, 0x0405,
357 0x0004, 0x0100, 0x017D, 0x0302, 0x0400, 0x0511, 0x2112, 0x4131,
358 0x1306, 0x6151, 0x2207, 0x1471, 0x8132, 0xA191, 0x2308, 0xB142,
359 0x15C1, 0xD152, 0x24F0, 0x6233, 0x8272, 0x0A09, 0x1716, 0x1918,
360 0x251A, 0x2726, 0x2928, 0x342A, 0x3635, 0x3837, 0x3A39, 0x4443,
361 0x4645, 0x4847, 0x4A49, 0x5453, 0x5655, 0x5857, 0x5A59, 0x6463,
362 0x6665, 0x6867, 0x6A69, 0x7473, 0x7675, 0x7877, 0x7A79, 0x8483,
363 0x8685, 0x8887, 0x8A89, 0x9392, 0x9594, 0x9796, 0x9998, 0xA29A,
364 0xA4A3, 0xA6A5, 0xA8A7, 0xAAA9, 0xB3B2, 0xB5B4, 0xB7B6, 0xB9B8,
365 0xC2BA, 0xC4C3, 0xC6C5, 0xC8C7, 0xCAC9, 0xD3D2, 0xD5D4, 0xD7D6,
366 0xD9D8, 0xE1DA, 0xE3E2, 0xE5E4, 0xE7E6, 0xE9E8, 0xF1EA, 0xF3F2,
367 0xF5F4, 0xF7F6, 0xF9F8, 0xFFFA,
368 0xC4FF, 0xB500, 0x0011, 0x0102, 0x0402, 0x0304, 0x0704, 0x0405,
369 0x0004, 0x0201, 0x0077, 0x0201, 0x1103, 0x0504, 0x3121, 0x1206,
370 0x5141, 0x6107, 0x1371, 0x3222, 0x0881, 0x4214, 0xA191, 0xC1B1,
371 0x2309, 0x5233, 0x15F0, 0x7262, 0x0AD1, 0x2416, 0xE134, 0xF125,
372 0x1817, 0x1A19, 0x2726, 0x2928, 0x352A, 0x3736, 0x3938, 0x433A,
373 0x4544, 0x4746, 0x4948, 0x534A, 0x5554, 0x5756, 0x5958, 0x635A,
374 0x6564, 0x6766, 0x6968, 0x736A, 0x7574, 0x7776, 0x7978, 0x827A,
375 0x8483, 0x8685, 0x8887, 0x8A89, 0x9392, 0x9594, 0x9796, 0x9998,
376 0xA29A, 0xA4A3, 0xA6A5, 0xA8A7, 0xAAA9, 0xB3B2, 0xB5B4, 0xB7B6,
377 0xB9B8, 0xC2BA, 0xC4C3, 0xC6C5, 0xC8C7, 0xCAC9, 0xD3D2, 0xD5D4,
378 0xD7D6, 0xD9D8, 0xE2DA, 0xE4E3, 0xE6E5, 0xE8E7, 0xEAE9, 0xF3F2,
379 0xF5F4, 0xF7F6, 0xF9F8, 0xFFFA,
380 0xC4FF, 0x1F00, 0x0000, 0x0501, 0x0101, 0x0101, 0x0101, 0x0000,
381 0x0000, 0x0000, 0x0000, 0x0201, 0x0403, 0x0605, 0x0807, 0x0A09,
382 0xFF0B,
383 0xC4FF, 0x1F00, 0x0001, 0x0103, 0x0101, 0x0101, 0x0101, 0x0101,
384 0x0000, 0x0000, 0x0000, 0x0201, 0x0403, 0x0605, 0x0807, 0x0A09,
385 0xFF0B
386 };
387
388 *length = ARRAY_SIZE(tables);
389 return tables;
390 }
391
392 /****************************************************************************/
393 /* MCHIP low-level functions */
394 /****************************************************************************/
395
396 /* returns the horizontal capture size */
397 static inline int mchip_hsize(void)
398 {
399 return meye.params.subsample ? 320 : 640;
400 }
401
402 /* returns the vertical capture size */
403 static inline int mchip_vsize(void)
404 {
405 return meye.params.subsample ? 240 : 480;
406 }
407
408 /* waits for a register to be available */
409 static void mchip_sync(int reg)
410 {
411 u32 status;
412 int i;
413
414 if (reg == MCHIP_MM_FIFO_DATA) {
415 for (i = 0; i < MCHIP_REG_TIMEOUT; i++) {
416 status = readl(meye.mchip_mmregs +
417 MCHIP_MM_FIFO_STATUS);
418 if (!(status & MCHIP_MM_FIFO_WAIT)) {
419 printk(KERN_WARNING "meye: fifo not ready\n");
420 return;
421 }
422 if (status & MCHIP_MM_FIFO_READY)
423 return;
424 udelay(1);
425 }
426 } else if (reg > 0x80) {
427 u32 mask = (reg < 0x100) ? MCHIP_HIC_STATUS_MCC_RDY
428 : MCHIP_HIC_STATUS_VRJ_RDY;
429 for (i = 0; i < MCHIP_REG_TIMEOUT; i++) {
430 status = readl(meye.mchip_mmregs + MCHIP_HIC_STATUS);
431 if (status & mask)
432 return;
433 udelay(1);
434 }
435 } else
436 return;
437 printk(KERN_WARNING
438 "meye: mchip_sync() timeout on reg 0x%x status=0x%x\n",
439 reg, status);
440 }
441
442 /* sets a value into the register */
443 static inline void mchip_set(int reg, u32 v)
444 {
445 mchip_sync(reg);
446 writel(v, meye.mchip_mmregs + reg);
447 }
448
449 /* get the register value */
450 static inline u32 mchip_read(int reg)
451 {
452 mchip_sync(reg);
453 return readl(meye.mchip_mmregs + reg);
454 }
455
456 /* wait for a register to become a particular value */
457 static inline int mchip_delay(u32 reg, u32 v)
458 {
459 int n = 10;
460 while (--n && mchip_read(reg) != v)
461 udelay(1);
462 return n;
463 }
464
465 /* setup subsampling */
466 static void mchip_subsample(void)
467 {
468 mchip_set(MCHIP_MCC_R_SAMPLING, meye.params.subsample);
469 mchip_set(MCHIP_MCC_R_XRANGE, mchip_hsize());
470 mchip_set(MCHIP_MCC_R_YRANGE, mchip_vsize());
471 mchip_set(MCHIP_MCC_B_XRANGE, mchip_hsize());
472 mchip_set(MCHIP_MCC_B_YRANGE, mchip_vsize());
473 mchip_delay(MCHIP_HIC_STATUS, MCHIP_HIC_STATUS_IDLE);
474 }
475
476 /* set the framerate into the mchip */
477 static void mchip_set_framerate(void)
478 {
479 mchip_set(MCHIP_HIC_S_RATE, meye.params.framerate);
480 }
481
482 /* load some huffman and quantisation tables into the VRJ chip ready
483 for JPEG compression */
484 static void mchip_load_tables(void)
485 {
486 int i;
487 int length;
488 u16 *tables;
489
490 tables = jpeg_huffman_tables(&length);
491 for (i = 0; i < length; i++)
492 writel(tables[i], meye.mchip_mmregs + MCHIP_VRJ_TABLE_DATA);
493
494 tables = jpeg_quantisation_tables(&length, meye.params.quality);
495 for (i = 0; i < length; i++)
496 writel(tables[i], meye.mchip_mmregs + MCHIP_VRJ_TABLE_DATA);
497 }
498
499 /* setup the VRJ parameters in the chip */
500 static void mchip_vrj_setup(u8 mode)
501 {
502 mchip_set(MCHIP_VRJ_BUS_MODE, 5);
503 mchip_set(MCHIP_VRJ_SIGNAL_ACTIVE_LEVEL, 0x1f);
504 mchip_set(MCHIP_VRJ_PDAT_USE, 1);
505 mchip_set(MCHIP_VRJ_IRQ_FLAG, 0xa0);
506 mchip_set(MCHIP_VRJ_MODE_SPECIFY, mode);
507 mchip_set(MCHIP_VRJ_NUM_LINES, mchip_vsize());
508 mchip_set(MCHIP_VRJ_NUM_PIXELS, mchip_hsize());
509 mchip_set(MCHIP_VRJ_NUM_COMPONENTS, 0x1b);
510 mchip_set(MCHIP_VRJ_LIMIT_COMPRESSED_LO, 0xFFFF);
511 mchip_set(MCHIP_VRJ_LIMIT_COMPRESSED_HI, 0xFFFF);
512 mchip_set(MCHIP_VRJ_COMP_DATA_FORMAT, 0xC);
513 mchip_set(MCHIP_VRJ_RESTART_INTERVAL, 0);
514 mchip_set(MCHIP_VRJ_SOF1, 0x601);
515 mchip_set(MCHIP_VRJ_SOF2, 0x1502);
516 mchip_set(MCHIP_VRJ_SOF3, 0x1503);
517 mchip_set(MCHIP_VRJ_SOF4, 0x1596);
518 mchip_set(MCHIP_VRJ_SOS, 0x0ed0);
519
520 mchip_load_tables();
521 }
522
523 /* sets the DMA parameters into the chip */
524 static void mchip_dma_setup(dma_addr_t dma_addr)
525 {
526 int i;
527
528 mchip_set(MCHIP_MM_PT_ADDR, (u32)dma_addr);
529 for (i = 0; i < 4; i++)
530 mchip_set(MCHIP_MM_FIR(i), 0);
531 meye.mchip_fnum = 0;
532 }
533
534 /* setup for DMA transfers - also zeros the framebuffer */
535 static int mchip_dma_alloc(void)
536 {
537 if (!meye.mchip_dmahandle)
538 if (ptable_alloc())
539 return -1;
540 return 0;
541 }
542
543 /* frees the DMA buffer */
544 static void mchip_dma_free(void)
545 {
546 if (meye.mchip_dmahandle) {
547 mchip_dma_setup(0);
548 ptable_free();
549 }
550 }
551
552 /* stop any existing HIC action and wait for any dma to complete then
553 reset the dma engine */
554 static void mchip_hic_stop(void)
555 {
556 int i, j;
557
558 meye.mchip_mode = MCHIP_HIC_MODE_NOOP;
559 if (!(mchip_read(MCHIP_HIC_STATUS) & MCHIP_HIC_STATUS_BUSY))
560 return;
561 for (i = 0; i < 20; ++i) {
562 mchip_set(MCHIP_HIC_CMD, MCHIP_HIC_CMD_STOP);
563 mchip_delay(MCHIP_HIC_CMD, 0);
564 for (j = 0; j < 100; ++j) {
565 if (mchip_delay(MCHIP_HIC_STATUS,
566 MCHIP_HIC_STATUS_IDLE))
567 return;
568 msleep(1);
569 }
570 printk(KERN_ERR "meye: need to reset HIC!\n");
571
572 mchip_set(MCHIP_HIC_CTL, MCHIP_HIC_CTL_SOFT_RESET);
573 msleep(250);
574 }
575 printk(KERN_ERR "meye: resetting HIC hanged!\n");
576 }
577
578 /****************************************************************************/
579 /* MCHIP frame processing functions */
580 /****************************************************************************/
581
582 /* get the next ready frame from the dma engine */
583 static u32 mchip_get_frame(void)
584 {
585 u32 v;
586
587 v = mchip_read(MCHIP_MM_FIR(meye.mchip_fnum));
588 return v;
589 }
590
591 /* frees the current frame from the dma engine */
592 static void mchip_free_frame(void)
593 {
594 mchip_set(MCHIP_MM_FIR(meye.mchip_fnum), 0);
595 meye.mchip_fnum++;
596 meye.mchip_fnum %= 4;
597 }
598
599 /* read one frame from the framebuffer assuming it was captured using
600 a uncompressed transfer */
601 static void mchip_cont_read_frame(u32 v, u8 *buf, int size)
602 {
603 int pt_id;
604
605 pt_id = (v >> 17) & 0x3FF;
606
607 ptable_copy(buf, pt_id, size, MCHIP_NB_PAGES);
608 }
609
610 /* read a compressed frame from the framebuffer */
611 static int mchip_comp_read_frame(u32 v, u8 *buf, int size)
612 {
613 int pt_start, pt_end, trailer;
614 int fsize;
615 int i;
616
617 pt_start = (v >> 19) & 0xFF;
618 pt_end = (v >> 11) & 0xFF;
619 trailer = (v >> 1) & 0x3FF;
620
621 if (pt_end < pt_start)
622 fsize = (MCHIP_NB_PAGES_MJPEG - pt_start) * PAGE_SIZE +
623 pt_end * PAGE_SIZE + trailer * 4;
624 else
625 fsize = (pt_end - pt_start) * PAGE_SIZE + trailer * 4;
626
627 if (fsize > size) {
628 printk(KERN_WARNING "meye: oversized compressed frame %d\n",
629 fsize);
630 return -1;
631 }
632
633 ptable_copy(buf, pt_start, fsize, MCHIP_NB_PAGES_MJPEG);
634
635 #ifdef MEYE_JPEG_CORRECTION
636
637 /* Some mchip generated jpeg frames are incorrect. In most
638 * (all ?) of those cases, the final EOI (0xff 0xd9) marker
639 * is not present at the end of the frame.
640 *
641 * Since adding the final marker is not enough to restore
642 * the jpeg integrity, we drop the frame.
643 */
644
645 for (i = fsize - 1; i > 0 && buf[i] == 0xff; i--) ;
646
647 if (i < 2 || buf[i - 1] != 0xff || buf[i] != 0xd9)
648 return -1;
649
650 #endif
651
652 return fsize;
653 }
654
655 /* take a picture into SDRAM */
656 static void mchip_take_picture(void)
657 {
658 int i;
659
660 mchip_hic_stop();
661 mchip_subsample();
662 mchip_dma_setup(meye.mchip_dmahandle);
663
664 mchip_set(MCHIP_HIC_MODE, MCHIP_HIC_MODE_STILL_CAP);
665 mchip_set(MCHIP_HIC_CMD, MCHIP_HIC_CMD_START);
666
667 mchip_delay(MCHIP_HIC_CMD, 0);
668
669 for (i = 0; i < 100; ++i) {
670 if (mchip_delay(MCHIP_HIC_STATUS, MCHIP_HIC_STATUS_IDLE))
671 break;
672 msleep(1);
673 }
674 }
675
676 /* dma a previously taken picture into a buffer */
677 static void mchip_get_picture(u8 *buf, int bufsize)
678 {
679 u32 v;
680 int i;
681
682 mchip_set(MCHIP_HIC_MODE, MCHIP_HIC_MODE_STILL_OUT);
683 mchip_set(MCHIP_HIC_CMD, MCHIP_HIC_CMD_START);
684
685 mchip_delay(MCHIP_HIC_CMD, 0);
686 for (i = 0; i < 100; ++i) {
687 if (mchip_delay(MCHIP_HIC_STATUS, MCHIP_HIC_STATUS_IDLE))
688 break;
689 msleep(1);
690 }
691 for (i = 0; i < 4; ++i) {
692 v = mchip_get_frame();
693 if (v & MCHIP_MM_FIR_RDY) {
694 mchip_cont_read_frame(v, buf, bufsize);
695 break;
696 }
697 mchip_free_frame();
698 }
699 }
700
701 /* start continuous dma capture */
702 static void mchip_continuous_start(void)
703 {
704 mchip_hic_stop();
705 mchip_subsample();
706 mchip_set_framerate();
707 mchip_dma_setup(meye.mchip_dmahandle);
708
709 meye.mchip_mode = MCHIP_HIC_MODE_CONT_OUT;
710
711 mchip_set(MCHIP_HIC_MODE, MCHIP_HIC_MODE_CONT_OUT);
712 mchip_set(MCHIP_HIC_CMD, MCHIP_HIC_CMD_START);
713
714 mchip_delay(MCHIP_HIC_CMD, 0);
715 }
716
717 /* compress one frame into a buffer */
718 static int mchip_compress_frame(u8 *buf, int bufsize)
719 {
720 u32 v;
721 int len = -1, i;
722
723 mchip_vrj_setup(0x3f);
724 udelay(50);
725
726 mchip_set(MCHIP_HIC_MODE, MCHIP_HIC_MODE_STILL_COMP);
727 mchip_set(MCHIP_HIC_CMD, MCHIP_HIC_CMD_START);
728
729 mchip_delay(MCHIP_HIC_CMD, 0);
730 for (i = 0; i < 100; ++i) {
731 if (mchip_delay(MCHIP_HIC_STATUS, MCHIP_HIC_STATUS_IDLE))
732 break;
733 msleep(1);
734 }
735
736 for (i = 0; i < 4; ++i) {
737 v = mchip_get_frame();
738 if (v & MCHIP_MM_FIR_RDY) {
739 len = mchip_comp_read_frame(v, buf, bufsize);
740 break;
741 }
742 mchip_free_frame();
743 }
744 return len;
745 }
746
747 #if 0
748 /* uncompress one image into a buffer */
749 static int mchip_uncompress_frame(u8 *img, int imgsize, u8 *buf, int bufsize)
750 {
751 mchip_vrj_setup(0x3f);
752 udelay(50);
753
754 mchip_set(MCHIP_HIC_MODE, MCHIP_HIC_MODE_STILL_DECOMP);
755 mchip_set(MCHIP_HIC_CMD, MCHIP_HIC_CMD_START);
756
757 mchip_delay(MCHIP_HIC_CMD, 0);
758
759 return mchip_comp_read_frame(buf, bufsize);
760 }
761 #endif
762
763 /* start continuous compressed capture */
764 static void mchip_cont_compression_start(void)
765 {
766 mchip_hic_stop();
767 mchip_vrj_setup(0x3f);
768 mchip_subsample();
769 mchip_set_framerate();
770 mchip_dma_setup(meye.mchip_dmahandle);
771
772 meye.mchip_mode = MCHIP_HIC_MODE_CONT_COMP;
773
774 mchip_set(MCHIP_HIC_MODE, MCHIP_HIC_MODE_CONT_COMP);
775 mchip_set(MCHIP_HIC_CMD, MCHIP_HIC_CMD_START);
776
777 mchip_delay(MCHIP_HIC_CMD, 0);
778 }
779
780 /****************************************************************************/
781 /* Interrupt handling */
782 /****************************************************************************/
783
784 static irqreturn_t meye_irq(int irq, void *dev_id)
785 {
786 u32 v;
787 int reqnr;
788 static int sequence;
789
790 v = mchip_read(MCHIP_MM_INTA);
791
792 if (meye.mchip_mode != MCHIP_HIC_MODE_CONT_OUT &&
793 meye.mchip_mode != MCHIP_HIC_MODE_CONT_COMP)
794 return IRQ_NONE;
795
796 again:
797 v = mchip_get_frame();
798 if (!(v & MCHIP_MM_FIR_RDY))
799 return IRQ_HANDLED;
800
801 if (meye.mchip_mode == MCHIP_HIC_MODE_CONT_OUT) {
802 if (kfifo_get(meye.grabq, (unsigned char *)&reqnr,
803 sizeof(int)) != sizeof(int)) {
804 mchip_free_frame();
805 return IRQ_HANDLED;
806 }
807 mchip_cont_read_frame(v, meye.grab_fbuffer + gbufsize * reqnr,
808 mchip_hsize() * mchip_vsize() * 2);
809 meye.grab_buffer[reqnr].size = mchip_hsize() * mchip_vsize() * 2;
810 meye.grab_buffer[reqnr].state = MEYE_BUF_DONE;
811 do_gettimeofday(&meye.grab_buffer[reqnr].timestamp);
812 meye.grab_buffer[reqnr].sequence = sequence++;
813 kfifo_put(meye.doneq, (unsigned char *)&reqnr, sizeof(int));
814 wake_up_interruptible(&meye.proc_list);
815 } else {
816 int size;
817 size = mchip_comp_read_frame(v, meye.grab_temp, gbufsize);
818 if (size == -1) {
819 mchip_free_frame();
820 goto again;
821 }
822 if (kfifo_get(meye.grabq, (unsigned char *)&reqnr,
823 sizeof(int)) != sizeof(int)) {
824 mchip_free_frame();
825 goto again;
826 }
827 memcpy(meye.grab_fbuffer + gbufsize * reqnr, meye.grab_temp,
828 size);
829 meye.grab_buffer[reqnr].size = size;
830 meye.grab_buffer[reqnr].state = MEYE_BUF_DONE;
831 do_gettimeofday(&meye.grab_buffer[reqnr].timestamp);
832 meye.grab_buffer[reqnr].sequence = sequence++;
833 kfifo_put(meye.doneq, (unsigned char *)&reqnr, sizeof(int));
834 wake_up_interruptible(&meye.proc_list);
835 }
836 mchip_free_frame();
837 goto again;
838 }
839
840 /****************************************************************************/
841 /* video4linux integration */
842 /****************************************************************************/
843
844 static int meye_open(struct file *file)
845 {
846 int i;
847
848 if (test_and_set_bit(0, &meye.in_use))
849 return -EBUSY;
850
851 mchip_hic_stop();
852
853 if (mchip_dma_alloc()) {
854 printk(KERN_ERR "meye: mchip framebuffer allocation failed\n");
855 clear_bit(0, &meye.in_use);
856 return -ENOBUFS;
857 }
858
859 for (i = 0; i < MEYE_MAX_BUFNBRS; i++)
860 meye.grab_buffer[i].state = MEYE_BUF_UNUSED;
861 kfifo_reset(meye.grabq);
862 kfifo_reset(meye.doneq);
863 return 0;
864 }
865
866 static int meye_release(struct file *file)
867 {
868 mchip_hic_stop();
869 mchip_dma_free();
870 clear_bit(0, &meye.in_use);
871 return 0;
872 }
873
874 static int meyeioc_g_params(struct meye_params *p)
875 {
876 *p = meye.params;
877 return 0;
878 }
879
880 static int meyeioc_s_params(struct meye_params *jp)
881 {
882 if (jp->subsample > 1)
883 return -EINVAL;
884
885 if (jp->quality > 10)
886 return -EINVAL;
887
888 if (jp->sharpness > 63 || jp->agc > 63 || jp->picture > 63)
889 return -EINVAL;
890
891 if (jp->framerate > 31)
892 return -EINVAL;
893
894 mutex_lock(&meye.lock);
895
896 if (meye.params.subsample != jp->subsample ||
897 meye.params.quality != jp->quality)
898 mchip_hic_stop(); /* need restart */
899
900 meye.params = *jp;
901 sony_pic_camera_command(SONY_PIC_COMMAND_SETCAMERASHARPNESS,
902 meye.params.sharpness);
903 sony_pic_camera_command(SONY_PIC_COMMAND_SETCAMERAAGC,
904 meye.params.agc);
905 sony_pic_camera_command(SONY_PIC_COMMAND_SETCAMERAPICTURE,
906 meye.params.picture);
907 mutex_unlock(&meye.lock);
908
909 return 0;
910 }
911
912 static int meyeioc_qbuf_capt(int *nb)
913 {
914 if (!meye.grab_fbuffer)
915 return -EINVAL;
916
917 if (*nb >= gbuffers)
918 return -EINVAL;
919
920 if (*nb < 0) {
921 /* stop capture */
922 mchip_hic_stop();
923 return 0;
924 }
925
926 if (meye.grab_buffer[*nb].state != MEYE_BUF_UNUSED)
927 return -EBUSY;
928
929 mutex_lock(&meye.lock);
930
931 if (meye.mchip_mode != MCHIP_HIC_MODE_CONT_COMP)
932 mchip_cont_compression_start();
933
934 meye.grab_buffer[*nb].state = MEYE_BUF_USING;
935 kfifo_put(meye.grabq, (unsigned char *)nb, sizeof(int));
936 mutex_unlock(&meye.lock);
937
938 return 0;
939 }
940
941 static int meyeioc_sync(struct file *file, void *fh, int *i)
942 {
943 int unused;
944
945 if (*i < 0 || *i >= gbuffers)
946 return -EINVAL;
947
948 mutex_lock(&meye.lock);
949 switch (meye.grab_buffer[*i].state) {
950
951 case MEYE_BUF_UNUSED:
952 mutex_unlock(&meye.lock);
953 return -EINVAL;
954 case MEYE_BUF_USING:
955 if (file->f_flags & O_NONBLOCK) {
956 mutex_unlock(&meye.lock);
957 return -EAGAIN;
958 }
959 if (wait_event_interruptible(meye.proc_list,
960 (meye.grab_buffer[*i].state != MEYE_BUF_USING))) {
961 mutex_unlock(&meye.lock);
962 return -EINTR;
963 }
964 /* fall through */
965 case MEYE_BUF_DONE:
966 meye.grab_buffer[*i].state = MEYE_BUF_UNUSED;
967 kfifo_get(meye.doneq, (unsigned char *)&unused, sizeof(int));
968 }
969 *i = meye.grab_buffer[*i].size;
970 mutex_unlock(&meye.lock);
971 return 0;
972 }
973
974 static int meyeioc_stillcapt(void)
975 {
976 if (!meye.grab_fbuffer)
977 return -EINVAL;
978
979 if (meye.grab_buffer[0].state != MEYE_BUF_UNUSED)
980 return -EBUSY;
981
982 mutex_lock(&meye.lock);
983 meye.grab_buffer[0].state = MEYE_BUF_USING;
984 mchip_take_picture();
985
986 mchip_get_picture(meye.grab_fbuffer,
987 mchip_hsize() * mchip_vsize() * 2);
988
989 meye.grab_buffer[0].state = MEYE_BUF_DONE;
990 mutex_unlock(&meye.lock);
991
992 return 0;
993 }
994
995 static int meyeioc_stilljcapt(int *len)
996 {
997 if (!meye.grab_fbuffer)
998 return -EINVAL;
999
1000 if (meye.grab_buffer[0].state != MEYE_BUF_UNUSED)
1001 return -EBUSY;
1002
1003 mutex_lock(&meye.lock);
1004 meye.grab_buffer[0].state = MEYE_BUF_USING;
1005 *len = -1;
1006
1007 while (*len == -1) {
1008 mchip_take_picture();
1009 *len = mchip_compress_frame(meye.grab_fbuffer, gbufsize);
1010 }
1011
1012 meye.grab_buffer[0].state = MEYE_BUF_DONE;
1013 mutex_unlock(&meye.lock);
1014 return 0;
1015 }
1016
1017 static int vidioc_querycap(struct file *file, void *fh,
1018 struct v4l2_capability *cap)
1019 {
1020 strcpy(cap->driver, "meye");
1021 strcpy(cap->card, "meye");
1022 sprintf(cap->bus_info, "PCI:%s", pci_name(meye.mchip_dev));
1023
1024 cap->version = (MEYE_DRIVER_MAJORVERSION << 8) +
1025 MEYE_DRIVER_MINORVERSION;
1026
1027 cap->capabilities = V4L2_CAP_VIDEO_CAPTURE |
1028 V4L2_CAP_STREAMING;
1029
1030 return 0;
1031 }
1032
1033 static int vidioc_enum_input(struct file *file, void *fh, struct v4l2_input *i)
1034 {
1035 if (i->index != 0)
1036 return -EINVAL;
1037
1038 strcpy(i->name, "Camera");
1039 i->type = V4L2_INPUT_TYPE_CAMERA;
1040
1041 return 0;
1042 }
1043
1044 static int vidioc_g_input(struct file *file, void *fh, unsigned int *i)
1045 {
1046 *i = 0;
1047 return 0;
1048 }
1049
1050 static int vidioc_s_input(struct file *file, void *fh, unsigned int i)
1051 {
1052 if (i != 0)
1053 return -EINVAL;
1054
1055 return 0;
1056 }
1057
1058 static int vidioc_queryctrl(struct file *file, void *fh,
1059 struct v4l2_queryctrl *c)
1060 {
1061 switch (c->id) {
1062
1063 case V4L2_CID_BRIGHTNESS:
1064 c->type = V4L2_CTRL_TYPE_INTEGER;
1065 strcpy(c->name, "Brightness");
1066 c->minimum = 0;
1067 c->maximum = 63;
1068 c->step = 1;
1069 c->default_value = 32;
1070 c->flags = 0;
1071 break;
1072 case V4L2_CID_HUE:
1073 c->type = V4L2_CTRL_TYPE_INTEGER;
1074 strcpy(c->name, "Hue");
1075 c->minimum = 0;
1076 c->maximum = 63;
1077 c->step = 1;
1078 c->default_value = 32;
1079 c->flags = 0;
1080 break;
1081 case V4L2_CID_CONTRAST:
1082 c->type = V4L2_CTRL_TYPE_INTEGER;
1083 strcpy(c->name, "Contrast");
1084 c->minimum = 0;
1085 c->maximum = 63;
1086 c->step = 1;
1087 c->default_value = 32;
1088 c->flags = 0;
1089 break;
1090 case V4L2_CID_SATURATION:
1091 c->type = V4L2_CTRL_TYPE_INTEGER;
1092 strcpy(c->name, "Saturation");
1093 c->minimum = 0;
1094 c->maximum = 63;
1095 c->step = 1;
1096 c->default_value = 32;
1097 c->flags = 0;
1098 break;
1099 case V4L2_CID_AGC:
1100 c->type = V4L2_CTRL_TYPE_INTEGER;
1101 strcpy(c->name, "Agc");
1102 c->minimum = 0;
1103 c->maximum = 63;
1104 c->step = 1;
1105 c->default_value = 48;
1106 c->flags = 0;
1107 break;
1108 case V4L2_CID_MEYE_SHARPNESS:
1109 case V4L2_CID_SHARPNESS:
1110 c->type = V4L2_CTRL_TYPE_INTEGER;
1111 strcpy(c->name, "Sharpness");
1112 c->minimum = 0;
1113 c->maximum = 63;
1114 c->step = 1;
1115 c->default_value = 32;
1116
1117 /* Continue to report legacy private SHARPNESS ctrl but
1118 * say it is disabled in preference to ctrl in the spec
1119 */
1120 c->flags = (c->id == V4L2_CID_SHARPNESS) ? 0 :
1121 V4L2_CTRL_FLAG_DISABLED;
1122 break;
1123 case V4L2_CID_PICTURE:
1124 c->type = V4L2_CTRL_TYPE_INTEGER;
1125 strcpy(c->name, "Picture");
1126 c->minimum = 0;
1127 c->maximum = 63;
1128 c->step = 1;
1129 c->default_value = 0;
1130 c->flags = 0;
1131 break;
1132 case V4L2_CID_JPEGQUAL:
1133 c->type = V4L2_CTRL_TYPE_INTEGER;
1134 strcpy(c->name, "JPEG quality");
1135 c->minimum = 0;
1136 c->maximum = 10;
1137 c->step = 1;
1138 c->default_value = 8;
1139 c->flags = 0;
1140 break;
1141 case V4L2_CID_FRAMERATE:
1142 c->type = V4L2_CTRL_TYPE_INTEGER;
1143 strcpy(c->name, "Framerate");
1144 c->minimum = 0;
1145 c->maximum = 31;
1146 c->step = 1;
1147 c->default_value = 0;
1148 c->flags = 0;
1149 break;
1150 default:
1151 return -EINVAL;
1152 }
1153
1154 return 0;
1155 }
1156
1157 static int vidioc_s_ctrl(struct file *file, void *fh, struct v4l2_control *c)
1158 {
1159 mutex_lock(&meye.lock);
1160 switch (c->id) {
1161 case V4L2_CID_BRIGHTNESS:
1162 sony_pic_camera_command(
1163 SONY_PIC_COMMAND_SETCAMERABRIGHTNESS, c->value);
1164 meye.picture.brightness = c->value << 10;
1165 break;
1166 case V4L2_CID_HUE:
1167 sony_pic_camera_command(
1168 SONY_PIC_COMMAND_SETCAMERAHUE, c->value);
1169 meye.picture.hue = c->value << 10;
1170 break;
1171 case V4L2_CID_CONTRAST:
1172 sony_pic_camera_command(
1173 SONY_PIC_COMMAND_SETCAMERACONTRAST, c->value);
1174 meye.picture.contrast = c->value << 10;
1175 break;
1176 case V4L2_CID_SATURATION:
1177 sony_pic_camera_command(
1178 SONY_PIC_COMMAND_SETCAMERACOLOR, c->value);
1179 meye.picture.colour = c->value << 10;
1180 break;
1181 case V4L2_CID_AGC:
1182 sony_pic_camera_command(
1183 SONY_PIC_COMMAND_SETCAMERAAGC, c->value);
1184 meye.params.agc = c->value;
1185 break;
1186 case V4L2_CID_SHARPNESS:
1187 case V4L2_CID_MEYE_SHARPNESS:
1188 sony_pic_camera_command(
1189 SONY_PIC_COMMAND_SETCAMERASHARPNESS, c->value);
1190 meye.params.sharpness = c->value;
1191 break;
1192 case V4L2_CID_PICTURE:
1193 sony_pic_camera_command(
1194 SONY_PIC_COMMAND_SETCAMERAPICTURE, c->value);
1195 meye.params.picture = c->value;
1196 break;
1197 case V4L2_CID_JPEGQUAL:
1198 meye.params.quality = c->value;
1199 break;
1200 case V4L2_CID_FRAMERATE:
1201 meye.params.framerate = c->value;
1202 break;
1203 default:
1204 mutex_unlock(&meye.lock);
1205 return -EINVAL;
1206 }
1207 mutex_unlock(&meye.lock);
1208
1209 return 0;
1210 }
1211
1212 static int vidioc_g_ctrl(struct file *file, void *fh, struct v4l2_control *c)
1213 {
1214 mutex_lock(&meye.lock);
1215 switch (c->id) {
1216 case V4L2_CID_BRIGHTNESS:
1217 c->value = meye.picture.brightness >> 10;
1218 break;
1219 case V4L2_CID_HUE:
1220 c->value = meye.picture.hue >> 10;
1221 break;
1222 case V4L2_CID_CONTRAST:
1223 c->value = meye.picture.contrast >> 10;
1224 break;
1225 case V4L2_CID_SATURATION:
1226 c->value = meye.picture.colour >> 10;
1227 break;
1228 case V4L2_CID_AGC:
1229 c->value = meye.params.agc;
1230 break;
1231 case V4L2_CID_SHARPNESS:
1232 case V4L2_CID_MEYE_SHARPNESS:
1233 c->value = meye.params.sharpness;
1234 break;
1235 case V4L2_CID_PICTURE:
1236 c->value = meye.params.picture;
1237 break;
1238 case V4L2_CID_JPEGQUAL:
1239 c->value = meye.params.quality;
1240 break;
1241 case V4L2_CID_FRAMERATE:
1242 c->value = meye.params.framerate;
1243 break;
1244 default:
1245 mutex_unlock(&meye.lock);
1246 return -EINVAL;
1247 }
1248 mutex_unlock(&meye.lock);
1249
1250 return 0;
1251 }
1252
1253 static int vidioc_enum_fmt_vid_cap(struct file *file, void *fh,
1254 struct v4l2_fmtdesc *f)
1255 {
1256 if (f->index > 1)
1257 return -EINVAL;
1258
1259 if (f->index == 0) {
1260 /* standard YUV 422 capture */
1261 f->flags = 0;
1262 strcpy(f->description, "YUV422");
1263 f->pixelformat = V4L2_PIX_FMT_YUYV;
1264 } else {
1265 /* compressed MJPEG capture */
1266 f->flags = V4L2_FMT_FLAG_COMPRESSED;
1267 strcpy(f->description, "MJPEG");
1268 f->pixelformat = V4L2_PIX_FMT_MJPEG;
1269 }
1270
1271 return 0;
1272 }
1273
1274 static int vidioc_try_fmt_vid_cap(struct file *file, void *fh,
1275 struct v4l2_format *f)
1276 {
1277 if (f->fmt.pix.pixelformat != V4L2_PIX_FMT_YUYV &&
1278 f->fmt.pix.pixelformat != V4L2_PIX_FMT_MJPEG)
1279 return -EINVAL;
1280
1281 if (f->fmt.pix.field != V4L2_FIELD_ANY &&
1282 f->fmt.pix.field != V4L2_FIELD_NONE)
1283 return -EINVAL;
1284
1285 f->fmt.pix.field = V4L2_FIELD_NONE;
1286
1287 if (f->fmt.pix.width <= 320) {
1288 f->fmt.pix.width = 320;
1289 f->fmt.pix.height = 240;
1290 } else {
1291 f->fmt.pix.width = 640;
1292 f->fmt.pix.height = 480;
1293 }
1294
1295 f->fmt.pix.bytesperline = f->fmt.pix.width * 2;
1296 f->fmt.pix.sizeimage = f->fmt.pix.height *
1297 f->fmt.pix.bytesperline;
1298 f->fmt.pix.colorspace = 0;
1299 f->fmt.pix.priv = 0;
1300
1301 return 0;
1302 }
1303
1304 static int vidioc_g_fmt_vid_cap(struct file *file, void *fh,
1305 struct v4l2_format *f)
1306 {
1307 switch (meye.mchip_mode) {
1308 case MCHIP_HIC_MODE_CONT_OUT:
1309 default:
1310 f->fmt.pix.pixelformat = V4L2_PIX_FMT_YUYV;
1311 break;
1312 case MCHIP_HIC_MODE_CONT_COMP:
1313 f->fmt.pix.pixelformat = V4L2_PIX_FMT_MJPEG;
1314 break;
1315 }
1316
1317 f->fmt.pix.field = V4L2_FIELD_NONE;
1318 f->fmt.pix.width = mchip_hsize();
1319 f->fmt.pix.height = mchip_vsize();
1320 f->fmt.pix.bytesperline = f->fmt.pix.width * 2;
1321 f->fmt.pix.sizeimage = f->fmt.pix.height *
1322 f->fmt.pix.bytesperline;
1323
1324 return 0;
1325 }
1326
1327 static int vidioc_s_fmt_vid_cap(struct file *file, void *fh,
1328 struct v4l2_format *f)
1329 {
1330 if (f->fmt.pix.pixelformat != V4L2_PIX_FMT_YUYV &&
1331 f->fmt.pix.pixelformat != V4L2_PIX_FMT_MJPEG)
1332 return -EINVAL;
1333
1334 if (f->fmt.pix.field != V4L2_FIELD_ANY &&
1335 f->fmt.pix.field != V4L2_FIELD_NONE)
1336 return -EINVAL;
1337
1338 f->fmt.pix.field = V4L2_FIELD_NONE;
1339 mutex_lock(&meye.lock);
1340
1341 if (f->fmt.pix.width <= 320) {
1342 f->fmt.pix.width = 320;
1343 f->fmt.pix.height = 240;
1344 meye.params.subsample = 1;
1345 } else {
1346 f->fmt.pix.width = 640;
1347 f->fmt.pix.height = 480;
1348 meye.params.subsample = 0;
1349 }
1350
1351 switch (f->fmt.pix.pixelformat) {
1352 case V4L2_PIX_FMT_YUYV:
1353 meye.mchip_mode = MCHIP_HIC_MODE_CONT_OUT;
1354 break;
1355 case V4L2_PIX_FMT_MJPEG:
1356 meye.mchip_mode = MCHIP_HIC_MODE_CONT_COMP;
1357 break;
1358 }
1359
1360 mutex_unlock(&meye.lock);
1361 f->fmt.pix.bytesperline = f->fmt.pix.width * 2;
1362 f->fmt.pix.sizeimage = f->fmt.pix.height *
1363 f->fmt.pix.bytesperline;
1364 f->fmt.pix.colorspace = 0;
1365 f->fmt.pix.priv = 0;
1366
1367 return 0;
1368 }
1369
1370 static int vidioc_reqbufs(struct file *file, void *fh,
1371 struct v4l2_requestbuffers *req)
1372 {
1373 int i;
1374
1375 if (req->memory != V4L2_MEMORY_MMAP)
1376 return -EINVAL;
1377
1378 if (meye.grab_fbuffer && req->count == gbuffers) {
1379 /* already allocated, no modifications */
1380 return 0;
1381 }
1382
1383 mutex_lock(&meye.lock);
1384 if (meye.grab_fbuffer) {
1385 for (i = 0; i < gbuffers; i++)
1386 if (meye.vma_use_count[i]) {
1387 mutex_unlock(&meye.lock);
1388 return -EINVAL;
1389 }
1390 rvfree(meye.grab_fbuffer, gbuffers * gbufsize);
1391 meye.grab_fbuffer = NULL;
1392 }
1393
1394 gbuffers = max(2, min((int)req->count, MEYE_MAX_BUFNBRS));
1395 req->count = gbuffers;
1396 meye.grab_fbuffer = rvmalloc(gbuffers * gbufsize);
1397
1398 if (!meye.grab_fbuffer) {
1399 printk(KERN_ERR "meye: v4l framebuffer allocation"
1400 " failed\n");
1401 mutex_unlock(&meye.lock);
1402 return -ENOMEM;
1403 }
1404
1405 for (i = 0; i < gbuffers; i++)
1406 meye.vma_use_count[i] = 0;
1407
1408 mutex_unlock(&meye.lock);
1409
1410 return 0;
1411 }
1412
1413 static int vidioc_querybuf(struct file *file, void *fh, struct v4l2_buffer *buf)
1414 {
1415 unsigned int index = buf->index;
1416
1417 if (index >= gbuffers)
1418 return -EINVAL;
1419
1420 buf->bytesused = meye.grab_buffer[index].size;
1421 buf->flags = V4L2_BUF_FLAG_MAPPED;
1422
1423 if (meye.grab_buffer[index].state == MEYE_BUF_USING)
1424 buf->flags |= V4L2_BUF_FLAG_QUEUED;
1425
1426 if (meye.grab_buffer[index].state == MEYE_BUF_DONE)
1427 buf->flags |= V4L2_BUF_FLAG_DONE;
1428
1429 buf->field = V4L2_FIELD_NONE;
1430 buf->timestamp = meye.grab_buffer[index].timestamp;
1431 buf->sequence = meye.grab_buffer[index].sequence;
1432 buf->memory = V4L2_MEMORY_MMAP;
1433 buf->m.offset = index * gbufsize;
1434 buf->length = gbufsize;
1435
1436 return 0;
1437 }
1438
1439 static int vidioc_qbuf(struct file *file, void *fh, struct v4l2_buffer *buf)
1440 {
1441 if (buf->memory != V4L2_MEMORY_MMAP)
1442 return -EINVAL;
1443
1444 if (buf->index >= gbuffers)
1445 return -EINVAL;
1446
1447 if (meye.grab_buffer[buf->index].state != MEYE_BUF_UNUSED)
1448 return -EINVAL;
1449
1450 mutex_lock(&meye.lock);
1451 buf->flags |= V4L2_BUF_FLAG_QUEUED;
1452 buf->flags &= ~V4L2_BUF_FLAG_DONE;
1453 meye.grab_buffer[buf->index].state = MEYE_BUF_USING;
1454 kfifo_put(meye.grabq, (unsigned char *)&buf->index, sizeof(int));
1455 mutex_unlock(&meye.lock);
1456
1457 return 0;
1458 }
1459
1460 static int vidioc_dqbuf(struct file *file, void *fh, struct v4l2_buffer *buf)
1461 {
1462 int reqnr;
1463
1464 if (buf->memory != V4L2_MEMORY_MMAP)
1465 return -EINVAL;
1466
1467 mutex_lock(&meye.lock);
1468
1469 if (kfifo_len(meye.doneq) == 0 && file->f_flags & O_NONBLOCK) {
1470 mutex_unlock(&meye.lock);
1471 return -EAGAIN;
1472 }
1473
1474 if (wait_event_interruptible(meye.proc_list,
1475 kfifo_len(meye.doneq) != 0) < 0) {
1476 mutex_unlock(&meye.lock);
1477 return -EINTR;
1478 }
1479
1480 if (!kfifo_get(meye.doneq, (unsigned char *)&reqnr,
1481 sizeof(int))) {
1482 mutex_unlock(&meye.lock);
1483 return -EBUSY;
1484 }
1485
1486 if (meye.grab_buffer[reqnr].state != MEYE_BUF_DONE) {
1487 mutex_unlock(&meye.lock);
1488 return -EINVAL;
1489 }
1490
1491 buf->index = reqnr;
1492 buf->bytesused = meye.grab_buffer[reqnr].size;
1493 buf->flags = V4L2_BUF_FLAG_MAPPED;
1494 buf->field = V4L2_FIELD_NONE;
1495 buf->timestamp = meye.grab_buffer[reqnr].timestamp;
1496 buf->sequence = meye.grab_buffer[reqnr].sequence;
1497 buf->memory = V4L2_MEMORY_MMAP;
1498 buf->m.offset = reqnr * gbufsize;
1499 buf->length = gbufsize;
1500 meye.grab_buffer[reqnr].state = MEYE_BUF_UNUSED;
1501 mutex_unlock(&meye.lock);
1502
1503 return 0;
1504 }
1505
1506 static int vidioc_streamon(struct file *file, void *fh, enum v4l2_buf_type i)
1507 {
1508 mutex_lock(&meye.lock);
1509
1510 switch (meye.mchip_mode) {
1511 case MCHIP_HIC_MODE_CONT_OUT:
1512 mchip_continuous_start();
1513 break;
1514 case MCHIP_HIC_MODE_CONT_COMP:
1515 mchip_cont_compression_start();
1516 break;
1517 default:
1518 mutex_unlock(&meye.lock);
1519 return -EINVAL;
1520 }
1521
1522 mutex_unlock(&meye.lock);
1523
1524 return 0;
1525 }
1526
1527 static int vidioc_streamoff(struct file *file, void *fh, enum v4l2_buf_type i)
1528 {
1529 mutex_lock(&meye.lock);
1530 mchip_hic_stop();
1531 kfifo_reset(meye.grabq);
1532 kfifo_reset(meye.doneq);
1533
1534 for (i = 0; i < MEYE_MAX_BUFNBRS; i++)
1535 meye.grab_buffer[i].state = MEYE_BUF_UNUSED;
1536
1537 mutex_unlock(&meye.lock);
1538 return 0;
1539 }
1540
1541 static long vidioc_default(struct file *file, void *fh, int cmd, void *arg)
1542 {
1543 switch (cmd) {
1544 case MEYEIOC_G_PARAMS:
1545 return meyeioc_g_params((struct meye_params *) arg);
1546
1547 case MEYEIOC_S_PARAMS:
1548 return meyeioc_s_params((struct meye_params *) arg);
1549
1550 case MEYEIOC_QBUF_CAPT:
1551 return meyeioc_qbuf_capt((int *) arg);
1552
1553 case MEYEIOC_SYNC:
1554 return meyeioc_sync(file, fh, (int *) arg);
1555
1556 case MEYEIOC_STILLCAPT:
1557 return meyeioc_stillcapt();
1558
1559 case MEYEIOC_STILLJCAPT:
1560 return meyeioc_stilljcapt((int *) arg);
1561
1562 default:
1563 return -EINVAL;
1564 }
1565
1566 }
1567
1568 static unsigned int meye_poll(struct file *file, poll_table *wait)
1569 {
1570 unsigned int res = 0;
1571
1572 mutex_lock(&meye.lock);
1573 poll_wait(file, &meye.proc_list, wait);
1574 if (kfifo_len(meye.doneq))
1575 res = POLLIN | POLLRDNORM;
1576 mutex_unlock(&meye.lock);
1577 return res;
1578 }
1579
1580 static void meye_vm_open(struct vm_area_struct *vma)
1581 {
1582 long idx = (long)vma->vm_private_data;
1583 meye.vma_use_count[idx]++;
1584 }
1585
1586 static void meye_vm_close(struct vm_area_struct *vma)
1587 {
1588 long idx = (long)vma->vm_private_data;
1589 meye.vma_use_count[idx]--;
1590 }
1591
1592 static struct vm_operations_struct meye_vm_ops = {
1593 .open = meye_vm_open,
1594 .close = meye_vm_close,
1595 };
1596
1597 static int meye_mmap(struct file *file, struct vm_area_struct *vma)
1598 {
1599 unsigned long start = vma->vm_start;
1600 unsigned long size = vma->vm_end - vma->vm_start;
1601 unsigned long offset = vma->vm_pgoff << PAGE_SHIFT;
1602 unsigned long page, pos;
1603
1604 mutex_lock(&meye.lock);
1605 if (size > gbuffers * gbufsize) {
1606 mutex_unlock(&meye.lock);
1607 return -EINVAL;
1608 }
1609 if (!meye.grab_fbuffer) {
1610 int i;
1611
1612 /* lazy allocation */
1613 meye.grab_fbuffer = rvmalloc(gbuffers*gbufsize);
1614 if (!meye.grab_fbuffer) {
1615 printk(KERN_ERR "meye: v4l framebuffer allocation failed\n");
1616 mutex_unlock(&meye.lock);
1617 return -ENOMEM;
1618 }
1619 for (i = 0; i < gbuffers; i++)
1620 meye.vma_use_count[i] = 0;
1621 }
1622 pos = (unsigned long)meye.grab_fbuffer + offset;
1623
1624 while (size > 0) {
1625 page = vmalloc_to_pfn((void *)pos);
1626 if (remap_pfn_range(vma, start, page, PAGE_SIZE, PAGE_SHARED)) {
1627 mutex_unlock(&meye.lock);
1628 return -EAGAIN;
1629 }
1630 start += PAGE_SIZE;
1631 pos += PAGE_SIZE;
1632 if (size > PAGE_SIZE)
1633 size -= PAGE_SIZE;
1634 else
1635 size = 0;
1636 }
1637
1638 vma->vm_ops = &meye_vm_ops;
1639 vma->vm_flags &= ~VM_IO; /* not I/O memory */
1640 vma->vm_flags |= VM_RESERVED; /* avoid to swap out this VMA */
1641 vma->vm_private_data = (void *) (offset / gbufsize);
1642 meye_vm_open(vma);
1643
1644 mutex_unlock(&meye.lock);
1645 return 0;
1646 }
1647
1648 static const struct v4l2_file_operations meye_fops = {
1649 .owner = THIS_MODULE,
1650 .open = meye_open,
1651 .release = meye_release,
1652 .mmap = meye_mmap,
1653 .ioctl = video_ioctl2,
1654 .poll = meye_poll,
1655 };
1656
1657 static const struct v4l2_ioctl_ops meye_ioctl_ops = {
1658 .vidioc_querycap = vidioc_querycap,
1659 .vidioc_enum_input = vidioc_enum_input,
1660 .vidioc_g_input = vidioc_g_input,
1661 .vidioc_s_input = vidioc_s_input,
1662 .vidioc_queryctrl = vidioc_queryctrl,
1663 .vidioc_s_ctrl = vidioc_s_ctrl,
1664 .vidioc_g_ctrl = vidioc_g_ctrl,
1665 .vidioc_enum_fmt_vid_cap = vidioc_enum_fmt_vid_cap,
1666 .vidioc_try_fmt_vid_cap = vidioc_try_fmt_vid_cap,
1667 .vidioc_g_fmt_vid_cap = vidioc_g_fmt_vid_cap,
1668 .vidioc_s_fmt_vid_cap = vidioc_s_fmt_vid_cap,
1669 .vidioc_reqbufs = vidioc_reqbufs,
1670 .vidioc_querybuf = vidioc_querybuf,
1671 .vidioc_qbuf = vidioc_qbuf,
1672 .vidioc_dqbuf = vidioc_dqbuf,
1673 .vidioc_streamon = vidioc_streamon,
1674 .vidioc_streamoff = vidioc_streamoff,
1675 .vidioc_default = vidioc_default,
1676 };
1677
1678 static struct video_device meye_template = {
1679 .name = "meye",
1680 .fops = &meye_fops,
1681 .ioctl_ops = &meye_ioctl_ops,
1682 .release = video_device_release,
1683 .minor = -1,
1684 };
1685
1686 #ifdef CONFIG_PM
1687 static int meye_suspend(struct pci_dev *pdev, pm_message_t state)
1688 {
1689 pci_save_state(pdev);
1690 meye.pm_mchip_mode = meye.mchip_mode;
1691 mchip_hic_stop();
1692 mchip_set(MCHIP_MM_INTA, 0x0);
1693 return 0;
1694 }
1695
1696 static int meye_resume(struct pci_dev *pdev)
1697 {
1698 pci_restore_state(pdev);
1699 pci_write_config_word(meye.mchip_dev, MCHIP_PCI_SOFTRESET_SET, 1);
1700
1701 mchip_delay(MCHIP_HIC_CMD, 0);
1702 mchip_delay(MCHIP_HIC_STATUS, MCHIP_HIC_STATUS_IDLE);
1703 msleep(1);
1704 mchip_set(MCHIP_VRJ_SOFT_RESET, 1);
1705 msleep(1);
1706 mchip_set(MCHIP_MM_PCI_MODE, 5);
1707 msleep(1);
1708 mchip_set(MCHIP_MM_INTA, MCHIP_MM_INTA_HIC_1_MASK);
1709
1710 switch (meye.pm_mchip_mode) {
1711 case MCHIP_HIC_MODE_CONT_OUT:
1712 mchip_continuous_start();
1713 break;
1714 case MCHIP_HIC_MODE_CONT_COMP:
1715 mchip_cont_compression_start();
1716 break;
1717 }
1718 return 0;
1719 }
1720 #endif
1721
1722 static int __devinit meye_probe(struct pci_dev *pcidev,
1723 const struct pci_device_id *ent)
1724 {
1725 int ret = -EBUSY;
1726 unsigned long mchip_adr;
1727
1728 if (meye.mchip_dev != NULL) {
1729 printk(KERN_ERR "meye: only one device allowed!\n");
1730 goto outnotdev;
1731 }
1732
1733 ret = -ENOMEM;
1734 meye.mchip_dev = pcidev;
1735 meye.video_dev = video_device_alloc();
1736 if (!meye.video_dev) {
1737 printk(KERN_ERR "meye: video_device_alloc() failed!\n");
1738 goto outnotdev;
1739 }
1740
1741 meye.grab_temp = vmalloc(MCHIP_NB_PAGES_MJPEG * PAGE_SIZE);
1742 if (!meye.grab_temp) {
1743 printk(KERN_ERR "meye: grab buffer allocation failed\n");
1744 goto outvmalloc;
1745 }
1746
1747 spin_lock_init(&meye.grabq_lock);
1748 meye.grabq = kfifo_alloc(sizeof(int) * MEYE_MAX_BUFNBRS, GFP_KERNEL,
1749 &meye.grabq_lock);
1750 if (IS_ERR(meye.grabq)) {
1751 printk(KERN_ERR "meye: fifo allocation failed\n");
1752 goto outkfifoalloc1;
1753 }
1754 spin_lock_init(&meye.doneq_lock);
1755 meye.doneq = kfifo_alloc(sizeof(int) * MEYE_MAX_BUFNBRS, GFP_KERNEL,
1756 &meye.doneq_lock);
1757 if (IS_ERR(meye.doneq)) {
1758 printk(KERN_ERR "meye: fifo allocation failed\n");
1759 goto outkfifoalloc2;
1760 }
1761
1762 memcpy(meye.video_dev, &meye_template, sizeof(meye_template));
1763 meye.video_dev->parent = &meye.mchip_dev->dev;
1764
1765 ret = -EIO;
1766 if ((ret = sony_pic_camera_command(SONY_PIC_COMMAND_SETCAMERA, 1))) {
1767 printk(KERN_ERR "meye: unable to power on the camera\n");
1768 printk(KERN_ERR "meye: did you enable the camera in "
1769 "sonypi using the module options ?\n");
1770 goto outsonypienable;
1771 }
1772
1773 if ((ret = pci_enable_device(meye.mchip_dev))) {
1774 printk(KERN_ERR "meye: pci_enable_device failed\n");
1775 goto outenabledev;
1776 }
1777
1778 mchip_adr = pci_resource_start(meye.mchip_dev,0);
1779 if (!mchip_adr) {
1780 printk(KERN_ERR "meye: mchip has no device base address\n");
1781 goto outregions;
1782 }
1783 if (!request_mem_region(pci_resource_start(meye.mchip_dev, 0),
1784 pci_resource_len(meye.mchip_dev, 0),
1785 "meye")) {
1786 printk(KERN_ERR "meye: request_mem_region failed\n");
1787 goto outregions;
1788 }
1789 meye.mchip_mmregs = ioremap(mchip_adr, MCHIP_MM_REGS);
1790 if (!meye.mchip_mmregs) {
1791 printk(KERN_ERR "meye: ioremap failed\n");
1792 goto outremap;
1793 }
1794
1795 meye.mchip_irq = pcidev->irq;
1796 if (request_irq(meye.mchip_irq, meye_irq,
1797 IRQF_DISABLED | IRQF_SHARED, "meye", meye_irq)) {
1798 printk(KERN_ERR "meye: request_irq failed\n");
1799 goto outreqirq;
1800 }
1801
1802 pci_write_config_byte(meye.mchip_dev, PCI_CACHE_LINE_SIZE, 8);
1803 pci_write_config_byte(meye.mchip_dev, PCI_LATENCY_TIMER, 64);
1804
1805 pci_set_master(meye.mchip_dev);
1806
1807 /* Ask the camera to perform a soft reset. */
1808 pci_write_config_word(meye.mchip_dev, MCHIP_PCI_SOFTRESET_SET, 1);
1809
1810 mchip_delay(MCHIP_HIC_CMD, 0);
1811 mchip_delay(MCHIP_HIC_STATUS, MCHIP_HIC_STATUS_IDLE);
1812
1813 msleep(1);
1814 mchip_set(MCHIP_VRJ_SOFT_RESET, 1);
1815
1816 msleep(1);
1817 mchip_set(MCHIP_MM_PCI_MODE, 5);
1818
1819 msleep(1);
1820 mchip_set(MCHIP_MM_INTA, MCHIP_MM_INTA_HIC_1_MASK);
1821
1822 if (video_register_device(meye.video_dev, VFL_TYPE_GRABBER,
1823 video_nr) < 0) {
1824 printk(KERN_ERR "meye: video_register_device failed\n");
1825 goto outvideoreg;
1826 }
1827
1828 mutex_init(&meye.lock);
1829 init_waitqueue_head(&meye.proc_list);
1830 meye.picture.depth = 16;
1831 meye.picture.palette = VIDEO_PALETTE_YUV422;
1832 meye.picture.brightness = 32 << 10;
1833 meye.picture.hue = 32 << 10;
1834 meye.picture.colour = 32 << 10;
1835 meye.picture.contrast = 32 << 10;
1836 meye.picture.whiteness = 0;
1837 meye.params.subsample = 0;
1838 meye.params.quality = 8;
1839 meye.params.sharpness = 32;
1840 meye.params.agc = 48;
1841 meye.params.picture = 0;
1842 meye.params.framerate = 0;
1843
1844 sony_pic_camera_command(SONY_PIC_COMMAND_SETCAMERABRIGHTNESS, 32);
1845 sony_pic_camera_command(SONY_PIC_COMMAND_SETCAMERAHUE, 32);
1846 sony_pic_camera_command(SONY_PIC_COMMAND_SETCAMERACOLOR, 32);
1847 sony_pic_camera_command(SONY_PIC_COMMAND_SETCAMERACONTRAST, 32);
1848 sony_pic_camera_command(SONY_PIC_COMMAND_SETCAMERASHARPNESS, 32);
1849 sony_pic_camera_command(SONY_PIC_COMMAND_SETCAMERAPICTURE, 0);
1850 sony_pic_camera_command(SONY_PIC_COMMAND_SETCAMERAAGC, 48);
1851
1852 printk(KERN_INFO "meye: Motion Eye Camera Driver v%s.\n",
1853 MEYE_DRIVER_VERSION);
1854 printk(KERN_INFO "meye: mchip KL5A72002 rev. %d, base %lx, irq %d\n",
1855 meye.mchip_dev->revision, mchip_adr, meye.mchip_irq);
1856
1857 return 0;
1858
1859 outvideoreg:
1860 free_irq(meye.mchip_irq, meye_irq);
1861 outreqirq:
1862 iounmap(meye.mchip_mmregs);
1863 outremap:
1864 release_mem_region(pci_resource_start(meye.mchip_dev, 0),
1865 pci_resource_len(meye.mchip_dev, 0));
1866 outregions:
1867 pci_disable_device(meye.mchip_dev);
1868 outenabledev:
1869 sony_pic_camera_command(SONY_PIC_COMMAND_SETCAMERA, 0);
1870 outsonypienable:
1871 kfifo_free(meye.doneq);
1872 outkfifoalloc2:
1873 kfifo_free(meye.grabq);
1874 outkfifoalloc1:
1875 vfree(meye.grab_temp);
1876 outvmalloc:
1877 video_device_release(meye.video_dev);
1878 outnotdev:
1879 return ret;
1880 }
1881
1882 static void __devexit meye_remove(struct pci_dev *pcidev)
1883 {
1884 video_unregister_device(meye.video_dev);
1885
1886 mchip_hic_stop();
1887
1888 mchip_dma_free();
1889
1890 /* disable interrupts */
1891 mchip_set(MCHIP_MM_INTA, 0x0);
1892
1893 free_irq(meye.mchip_irq, meye_irq);
1894
1895 iounmap(meye.mchip_mmregs);
1896
1897 release_mem_region(pci_resource_start(meye.mchip_dev, 0),
1898 pci_resource_len(meye.mchip_dev, 0));
1899
1900 pci_disable_device(meye.mchip_dev);
1901
1902 sony_pic_camera_command(SONY_PIC_COMMAND_SETCAMERA, 0);
1903
1904 kfifo_free(meye.doneq);
1905 kfifo_free(meye.grabq);
1906
1907 vfree(meye.grab_temp);
1908
1909 if (meye.grab_fbuffer) {
1910 rvfree(meye.grab_fbuffer, gbuffers*gbufsize);
1911 meye.grab_fbuffer = NULL;
1912 }
1913
1914 printk(KERN_INFO "meye: removed\n");
1915 }
1916
1917 static struct pci_device_id meye_pci_tbl[] = {
1918 { PCI_VDEVICE(KAWASAKI, PCI_DEVICE_ID_MCHIP_KL5A72002), 0 },
1919 { }
1920 };
1921
1922 MODULE_DEVICE_TABLE(pci, meye_pci_tbl);
1923
1924 static struct pci_driver meye_driver = {
1925 .name = "meye",
1926 .id_table = meye_pci_tbl,
1927 .probe = meye_probe,
1928 .remove = __devexit_p(meye_remove),
1929 #ifdef CONFIG_PM
1930 .suspend = meye_suspend,
1931 .resume = meye_resume,
1932 #endif
1933 };
1934
1935 static int __init meye_init(void)
1936 {
1937 gbuffers = max(2, min((int)gbuffers, MEYE_MAX_BUFNBRS));
1938 if (gbufsize < 0 || gbufsize > MEYE_MAX_BUFSIZE)
1939 gbufsize = MEYE_MAX_BUFSIZE;
1940 gbufsize = PAGE_ALIGN(gbufsize);
1941 printk(KERN_INFO "meye: using %d buffers with %dk (%dk total) "
1942 "for capture\n",
1943 gbuffers,
1944 gbufsize / 1024, gbuffers * gbufsize / 1024);
1945 return pci_register_driver(&meye_driver);
1946 }
1947
1948 static void __exit meye_exit(void)
1949 {
1950 pci_unregister_driver(&meye_driver);
1951 }
1952
1953 module_init(meye_init);
1954 module_exit(meye_exit);
kernel source for telekom puls (alcatel/mediatek)