?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
PRCM: 34XX: Fix wrong shift value used in dpll4_m4x2_ck enable bit
[linux-ginger.git] / drivers / media / video / w9966.c
blob33f702698a56f06d629bceb96bef454661282855
1 /*
2 Winbond w9966cf Webcam parport driver.
3
4 Version 0.32
5
6 Copyright (C) 2001 Jakob Kemi <jakob.kemi@post.utfors.se>
7
8 This program is free software; you can redistribute it and/or modify
9 it under the terms of the GNU General Public License as published by
10 the Free Software Foundation; either version 2 of the License, or
11 (at your option) any later version.
12
13 This program is distributed in the hope that it will be useful,
14 but WITHOUT ANY WARRANTY; without even the implied warranty of
15 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 GNU General Public License for more details.
17
18 You should have received a copy of the GNU General Public License
19 along with this program; if not, write to the Free Software
20 Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
21 */
22 /*
23 Supported devices:
24 *Lifeview FlyCam Supra (using the Philips saa7111a chip)
25
26 Does any other model using the w9966 interface chip exist ?
27
28 Todo:
29
30 *Add a working EPP mode, since DMA ECP read isn't implemented
31 in the parport drivers. (That's why it's so sloow)
32
33 *Add support for other ccd-control chips than the saa7111
34 please send me feedback on what kind of chips you have.
35
36 *Add proper probing. I don't know what's wrong with the IEEE1284
37 parport drivers but (IEEE1284_MODE_NIBBLE|IEEE1284_DEVICE_ID)
38 and nibble read seems to be broken for some peripherals.
39
40 *Add probing for onboard SRAM, port directions etc. (if possible)
41
42 *Add support for the hardware compressed modes (maybe using v4l2)
43
44 *Fix better support for the capture window (no skewed images, v4l
45 interface to capt. window)
46
47 *Probably some bugs that I don't know of
48
49 Please support me by sending feedback!
50
51 Changes:
52
53 Alan Cox: Removed RGB mode for kernel merge, added THIS_MODULE
54 and owner support for newer module locks
55 */
56
57 #include <linux/module.h>
58 #include <linux/init.h>
59 #include <linux/delay.h>
60 #include <linux/videodev.h>
61 #include <media/v4l2-common.h>
62 #include <linux/parport.h>
63
64 /*#define DEBUG*/ /* Undef me for production */
65
66 #ifdef DEBUG
67 #define DPRINTF(x, a...) printk(KERN_DEBUG "W9966: %s(): "x, __func__ , ##a)
68 #else
69 #define DPRINTF(x...)
70 #endif
71
72 /*
73 * Defines, simple typedefs etc.
74 */
75
76 #define W9966_DRIVERNAME "W9966CF Webcam"
77 #define W9966_MAXCAMS 4 // Maximum number of cameras
78 #define W9966_RBUFFER 2048 // Read buffer (must be an even number)
79 #define W9966_SRAMSIZE 131072 // 128kb
80 #define W9966_SRAMID 0x02 // check w9966cf.pdf
81
82 // Empirically determined window limits
83 #define W9966_WND_MIN_X 16
84 #define W9966_WND_MIN_Y 14
85 #define W9966_WND_MAX_X 705
86 #define W9966_WND_MAX_Y 253
87 #define W9966_WND_MAX_W (W9966_WND_MAX_X - W9966_WND_MIN_X)
88 #define W9966_WND_MAX_H (W9966_WND_MAX_Y - W9966_WND_MIN_Y)
89
90 // Keep track of our current state
91 #define W9966_STATE_PDEV 0x01
92 #define W9966_STATE_CLAIMED 0x02
93 #define W9966_STATE_VDEV 0x04
94
95 #define W9966_I2C_W_ID 0x48
96 #define W9966_I2C_R_ID 0x49
97 #define W9966_I2C_R_DATA 0x08
98 #define W9966_I2C_R_CLOCK 0x04
99 #define W9966_I2C_W_DATA 0x02
100 #define W9966_I2C_W_CLOCK 0x01
101
102 struct w9966_dev {
103 unsigned char dev_state;
104 unsigned char i2c_state;
105 unsigned short ppmode;
106 struct parport* pport;
107 struct pardevice* pdev;
108 struct video_device vdev;
109 unsigned short width;
110 unsigned short height;
111 unsigned char brightness;
112 signed char contrast;
113 signed char color;
114 signed char hue;
115 };
116
117 /*
118 * Module specific properties
119 */
120
121 MODULE_AUTHOR("Jakob Kemi <jakob.kemi@post.utfors.se>");
122 MODULE_DESCRIPTION("Winbond w9966cf WebCam driver (0.32)");
123 MODULE_LICENSE("GPL");
124
125
126 #ifdef MODULE
127 static const char* pardev[] = {[0 ... W9966_MAXCAMS] = ""};
128 #else
129 static const char* pardev[] = {[0 ... W9966_MAXCAMS] = "aggressive"};
130 #endif
131 module_param_array(pardev, charp, NULL, 0);
132 MODULE_PARM_DESC(pardev, "pardev: where to search for\n\
133 \teach camera. 'aggressive' means brute-force search.\n\
134 \tEg: >pardev=parport3,aggressive,parport2,parport1< would assign\n\
135 \tcam 1 to parport3 and search every parport for cam 2 etc...");
136
137 static int parmode;
138 module_param(parmode, int, 0);
139 MODULE_PARM_DESC(parmode, "parmode: transfer mode (0=auto, 1=ecp, 2=epp");
140
141 static int video_nr = -1;
142 module_param(video_nr, int, 0);
143
144 /*
145 * Private data
146 */
147
148 static struct w9966_dev w9966_cams[W9966_MAXCAMS];
149
150 /*
151 * Private function declares
152 */
153
154 static inline void w9966_setState(struct w9966_dev* cam, int mask, int val);
155 static inline int w9966_getState(struct w9966_dev* cam, int mask, int val);
156 static inline void w9966_pdev_claim(struct w9966_dev *vdev);
157 static inline void w9966_pdev_release(struct w9966_dev *vdev);
158
159 static int w9966_rReg(struct w9966_dev* cam, int reg);
160 static int w9966_wReg(struct w9966_dev* cam, int reg, int data);
161 #if 0
162 static int w9966_rReg_i2c(struct w9966_dev* cam, int reg);
163 #endif
164 static int w9966_wReg_i2c(struct w9966_dev* cam, int reg, int data);
165 static int w9966_findlen(int near, int size, int maxlen);
166 static int w9966_calcscale(int size, int min, int max, int* beg, int* end, unsigned char* factor);
167 static int w9966_setup(struct w9966_dev* cam, int x1, int y1, int x2, int y2, int w, int h);
168
169 static int w9966_init(struct w9966_dev* cam, struct parport* port);
170 static void w9966_term(struct w9966_dev* cam);
171
172 static inline void w9966_i2c_setsda(struct w9966_dev* cam, int state);
173 static inline int w9966_i2c_setscl(struct w9966_dev* cam, int state);
174 static inline int w9966_i2c_getsda(struct w9966_dev* cam);
175 static inline int w9966_i2c_getscl(struct w9966_dev* cam);
176 static int w9966_i2c_wbyte(struct w9966_dev* cam, int data);
177 #if 0
178 static int w9966_i2c_rbyte(struct w9966_dev* cam);
179 #endif
180
181 static int w9966_v4l_ioctl(struct inode *inode, struct file *file,
182 unsigned int cmd, unsigned long arg);
183 static ssize_t w9966_v4l_read(struct file *file, char __user *buf,
184 size_t count, loff_t *ppos);
185
186 static const struct file_operations w9966_fops = {
187 .owner = THIS_MODULE,
188 .open = video_exclusive_open,
189 .release = video_exclusive_release,
190 .ioctl = w9966_v4l_ioctl,
191 #ifdef CONFIG_COMPAT
192 .compat_ioctl = v4l_compat_ioctl32,
193 #endif
194 .read = w9966_v4l_read,
195 .llseek = no_llseek,
196 };
197 static struct video_device w9966_template = {
198 .owner = THIS_MODULE,
199 .name = W9966_DRIVERNAME,
200 .type = VID_TYPE_CAPTURE | VID_TYPE_SCALES,
201 .fops = &w9966_fops,
202 };
203
204 /*
205 * Private function defines
206 */
207
208
209 // Set camera phase flags, so we know what to uninit when terminating
210 static inline void w9966_setState(struct w9966_dev* cam, int mask, int val)
211 {
212 cam->dev_state = (cam->dev_state & ~mask) ^ val;
213 }
214
215 // Get camera phase flags
216 static inline int w9966_getState(struct w9966_dev* cam, int mask, int val)
217 {
218 return ((cam->dev_state & mask) == val);
219 }
220
221 // Claim parport for ourself
222 static inline void w9966_pdev_claim(struct w9966_dev* cam)
223 {
224 if (w9966_getState(cam, W9966_STATE_CLAIMED, W9966_STATE_CLAIMED))
225 return;
226 parport_claim_or_block(cam->pdev);
227 w9966_setState(cam, W9966_STATE_CLAIMED, W9966_STATE_CLAIMED);
228 }
229
230 // Release parport for others to use
231 static inline void w9966_pdev_release(struct w9966_dev* cam)
232 {
233 if (w9966_getState(cam, W9966_STATE_CLAIMED, 0))
234 return;
235 parport_release(cam->pdev);
236 w9966_setState(cam, W9966_STATE_CLAIMED, 0);
237 }
238
239 // Read register from W9966 interface-chip
240 // Expects a claimed pdev
241 // -1 on error, else register data (byte)
242 static int w9966_rReg(struct w9966_dev* cam, int reg)
243 {
244 // ECP, read, regtransfer, REG, REG, REG, REG, REG
245 const unsigned char addr = 0x80 | (reg & 0x1f);
246 unsigned char val;
247
248 if (parport_negotiate(cam->pport, cam->ppmode | IEEE1284_ADDR) != 0)
249 return -1;
250 if (parport_write(cam->pport, &addr, 1) != 1)
251 return -1;
252 if (parport_negotiate(cam->pport, cam->ppmode | IEEE1284_DATA) != 0)
253 return -1;
254 if (parport_read(cam->pport, &val, 1) != 1)
255 return -1;
256
257 return val;
258 }
259
260 // Write register to W9966 interface-chip
261 // Expects a claimed pdev
262 // -1 on error
263 static int w9966_wReg(struct w9966_dev* cam, int reg, int data)
264 {
265 // ECP, write, regtransfer, REG, REG, REG, REG, REG
266 const unsigned char addr = 0xc0 | (reg & 0x1f);
267 const unsigned char val = data;
268
269 if (parport_negotiate(cam->pport, cam->ppmode | IEEE1284_ADDR) != 0)
270 return -1;
271 if (parport_write(cam->pport, &addr, 1) != 1)
272 return -1;
273 if (parport_negotiate(cam->pport, cam->ppmode | IEEE1284_DATA) != 0)
274 return -1;
275 if (parport_write(cam->pport, &val, 1) != 1)
276 return -1;
277
278 return 0;
279 }
280
281 // Initialize camera device. Setup all internal flags, set a
282 // default video mode, setup ccd-chip, register v4l device etc..
283 // Also used for 'probing' of hardware.
284 // -1 on error
285 static int w9966_init(struct w9966_dev* cam, struct parport* port)
286 {
287 if (cam->dev_state != 0)
288 return -1;
289
290 cam->pport = port;
291 cam->brightness = 128;
292 cam->contrast = 64;
293 cam->color = 64;
294 cam->hue = 0;
295
296 // Select requested transfer mode
297 switch(parmode)
298 {
299 default: // Auto-detect (priority: hw-ecp, hw-epp, sw-ecp)
300 case 0:
301 if (port->modes & PARPORT_MODE_ECP)
302 cam->ppmode = IEEE1284_MODE_ECP;
303 else if (port->modes & PARPORT_MODE_EPP)
304 cam->ppmode = IEEE1284_MODE_EPP;
305 else
306 cam->ppmode = IEEE1284_MODE_ECP;
307 break;
308 case 1: // hw- or sw-ecp
309 cam->ppmode = IEEE1284_MODE_ECP;
310 break;
311 case 2: // hw- or sw-epp
312 cam->ppmode = IEEE1284_MODE_EPP;
313 break;
314 }
315
316 // Tell the parport driver that we exists
317 cam->pdev = parport_register_device(port, "w9966", NULL, NULL, NULL, 0, NULL);
318 if (cam->pdev == NULL) {
319 DPRINTF("parport_register_device() failed\n");
320 return -1;
321 }
322 w9966_setState(cam, W9966_STATE_PDEV, W9966_STATE_PDEV);
323
324 w9966_pdev_claim(cam);
325
326 // Setup a default capture mode
327 if (w9966_setup(cam, 0, 0, 1023, 1023, 200, 160) != 0) {
328 DPRINTF("w9966_setup() failed.\n");
329 return -1;
330 }
331
332 w9966_pdev_release(cam);
333
334 // Fill in the video_device struct and register us to v4l
335 memcpy(&cam->vdev, &w9966_template, sizeof(struct video_device));
336 cam->vdev.priv = cam;
337
338 if (video_register_device(&cam->vdev, VFL_TYPE_GRABBER, video_nr) == -1)
339 return -1;
340
341 w9966_setState(cam, W9966_STATE_VDEV, W9966_STATE_VDEV);
342
343 // All ok
344 printk(
345 "w9966cf: Found and initialized a webcam on %s.\n",
346 cam->pport->name
347 );
348 return 0;
349 }
350
351
352 // Terminate everything gracefully
353 static void w9966_term(struct w9966_dev* cam)
354 {
355 // Unregister from v4l
356 if (w9966_getState(cam, W9966_STATE_VDEV, W9966_STATE_VDEV)) {
357 video_unregister_device(&cam->vdev);
358 w9966_setState(cam, W9966_STATE_VDEV, 0);
359 }
360
361 // Terminate from IEEE1284 mode and release pdev block
362 if (w9966_getState(cam, W9966_STATE_PDEV, W9966_STATE_PDEV)) {
363 w9966_pdev_claim(cam);
364 parport_negotiate(cam->pport, IEEE1284_MODE_COMPAT);
365 w9966_pdev_release(cam);
366 }
367
368 // Unregister from parport
369 if (w9966_getState(cam, W9966_STATE_PDEV, W9966_STATE_PDEV)) {
370 parport_unregister_device(cam->pdev);
371 w9966_setState(cam, W9966_STATE_PDEV, 0);
372 }
373 }
374
375
376 // Find a good length for capture window (used both for W and H)
377 // A bit ugly but pretty functional. The capture length
378 // have to match the downscale
379 static int w9966_findlen(int near, int size, int maxlen)
380 {
381 int bestlen = size;
382 int besterr = abs(near - bestlen);
383 int len;
384
385 for(len = size+1;len < maxlen;len++)
386 {
387 int err;
388 if ( ((64*size) %len) != 0)
389 continue;
390
391 err = abs(near - len);
392
393 // Only continue as long as we keep getting better values
394 if (err > besterr)
395 break;
396
397 besterr = err;
398 bestlen = len;
399 }
400
401 return bestlen;
402 }
403
404 // Modify capture window (if necessary)
405 // and calculate downscaling
406 // Return -1 on error
407 static int w9966_calcscale(int size, int min, int max, int* beg, int* end, unsigned char* factor)
408 {
409 int maxlen = max - min;
410 int len = *end - *beg + 1;
411 int newlen = w9966_findlen(len, size, maxlen);
412 int err = newlen - len;
413
414 // Check for bad format
415 if (newlen > maxlen || newlen < size)
416 return -1;
417
418 // Set factor (6 bit fixed)
419 *factor = (64*size) / newlen;
420 if (*factor == 64)
421 *factor = 0x00; // downscale is disabled
422 else
423 *factor |= 0x80; // set downscale-enable bit
424
425 // Modify old beginning and end
426 *beg -= err / 2;
427 *end += err - (err / 2);
428
429 // Move window if outside borders
430 if (*beg < min) {
431 *end += min - *beg;
432 *beg += min - *beg;
433 }
434 if (*end > max) {
435 *beg -= *end - max;
436 *end -= *end - max;
437 }
438
439 return 0;
440 }
441
442 // Setup the cameras capture window etc.
443 // Expects a claimed pdev
444 // return -1 on error
445 static int w9966_setup(struct w9966_dev* cam, int x1, int y1, int x2, int y2, int w, int h)
446 {
447 unsigned int i;
448 unsigned int enh_s, enh_e;
449 unsigned char scale_x, scale_y;
450 unsigned char regs[0x1c];
451 unsigned char saa7111_regs[] = {
452 0x21, 0x00, 0xd8, 0x23, 0x00, 0x80, 0x80, 0x00,
453 0x88, 0x10, 0x80, 0x40, 0x40, 0x00, 0x01, 0x00,
454 0x48, 0x0c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
455 0x00, 0x00, 0x00, 0x71, 0xe7, 0x00, 0x00, 0xc0
456 };
457
458
459 if (w*h*2 > W9966_SRAMSIZE)
460 {
461 DPRINTF("capture window exceeds SRAM size!.\n");
462 w = 200; h = 160; // Pick default values
463 }
464
465 w &= ~0x1;
466 if (w < 2) w = 2;
467 if (h < 1) h = 1;
468 if (w > W9966_WND_MAX_W) w = W9966_WND_MAX_W;
469 if (h > W9966_WND_MAX_H) h = W9966_WND_MAX_H;
470
471 cam->width = w;
472 cam->height = h;
473
474 enh_s = 0;
475 enh_e = w*h*2;
476
477 // Modify capture window if necessary and calculate downscaling
478 if (
479 w9966_calcscale(w, W9966_WND_MIN_X, W9966_WND_MAX_X, &x1, &x2, &scale_x) != 0 ||
480 w9966_calcscale(h, W9966_WND_MIN_Y, W9966_WND_MAX_Y, &y1, &y2, &scale_y) != 0
481 ) return -1;
482
483 DPRINTF(
484 "%dx%d, x: %d<->%d, y: %d<->%d, sx: %d/64, sy: %d/64.\n",
485 w, h, x1, x2, y1, y2, scale_x&~0x80, scale_y&~0x80
486 );
487
488 // Setup registers
489 regs[0x00] = 0x00; // Set normal operation
490 regs[0x01] = 0x18; // Capture mode
491 regs[0x02] = scale_y; // V-scaling
492 regs[0x03] = scale_x; // H-scaling
493
494 // Capture window
495 regs[0x04] = (x1 & 0x0ff); // X-start (8 low bits)
496 regs[0x05] = (x1 & 0x300)>>8; // X-start (2 high bits)
497 regs[0x06] = (y1 & 0x0ff); // Y-start (8 low bits)
498 regs[0x07] = (y1 & 0x300)>>8; // Y-start (2 high bits)
499 regs[0x08] = (x2 & 0x0ff); // X-end (8 low bits)
500 regs[0x09] = (x2 & 0x300)>>8; // X-end (2 high bits)
501 regs[0x0a] = (y2 & 0x0ff); // Y-end (8 low bits)
502
503 regs[0x0c] = W9966_SRAMID; // SRAM-banks (1x 128kb)
504
505 // Enhancement layer
506 regs[0x0d] = (enh_s& 0x000ff); // Enh. start (0-7)
507 regs[0x0e] = (enh_s& 0x0ff00)>>8; // Enh. start (8-15)
508 regs[0x0f] = (enh_s& 0x70000)>>16; // Enh. start (16-17/18??)
509 regs[0x10] = (enh_e& 0x000ff); // Enh. end (0-7)
510 regs[0x11] = (enh_e& 0x0ff00)>>8; // Enh. end (8-15)
511 regs[0x12] = (enh_e& 0x70000)>>16; // Enh. end (16-17/18??)
512
513 // Misc
514 regs[0x13] = 0x40; // VEE control (raw 4:2:2)
515 regs[0x17] = 0x00; // ???
516 regs[0x18] = cam->i2c_state = 0x00; // Serial bus
517 regs[0x19] = 0xff; // I/O port direction control
518 regs[0x1a] = 0xff; // I/O port data register
519 regs[0x1b] = 0x10; // ???
520
521 // SAA7111 chip settings
522 saa7111_regs[0x0a] = cam->brightness;
523 saa7111_regs[0x0b] = cam->contrast;
524 saa7111_regs[0x0c] = cam->color;
525 saa7111_regs[0x0d] = cam->hue;
526
527 // Reset (ECP-fifo & serial-bus)
528 if (w9966_wReg(cam, 0x00, 0x03) == -1)
529 return -1;
530
531 // Write regs to w9966cf chip
532 for (i = 0; i < 0x1c; i++)
533 if (w9966_wReg(cam, i, regs[i]) == -1)
534 return -1;
535
536 // Write regs to saa7111 chip
537 for (i = 0; i < 0x20; i++)
538 if (w9966_wReg_i2c(cam, i, saa7111_regs[i]) == -1)
539 return -1;
540
541 return 0;
542 }
543
544 /*
545 * Ugly and primitive i2c protocol functions
546 */
547
548 // Sets the data line on the i2c bus.
549 // Expects a claimed pdev.
550 static inline void w9966_i2c_setsda(struct w9966_dev* cam, int state)
551 {
552 if (state)
553 cam->i2c_state |= W9966_I2C_W_DATA;
554 else
555 cam->i2c_state &= ~W9966_I2C_W_DATA;
556
557 w9966_wReg(cam, 0x18, cam->i2c_state);
558 udelay(5);
559 }
560
561 // Get peripheral clock line
562 // Expects a claimed pdev.
563 static inline int w9966_i2c_getscl(struct w9966_dev* cam)
564 {
565 const unsigned char state = w9966_rReg(cam, 0x18);
566 return ((state & W9966_I2C_R_CLOCK) > 0);
567 }
568
569 // Sets the clock line on the i2c bus.
570 // Expects a claimed pdev. -1 on error
571 static inline int w9966_i2c_setscl(struct w9966_dev* cam, int state)
572 {
573 unsigned long timeout;
574
575 if (state)
576 cam->i2c_state |= W9966_I2C_W_CLOCK;
577 else
578 cam->i2c_state &= ~W9966_I2C_W_CLOCK;
579
580 w9966_wReg(cam, 0x18, cam->i2c_state);
581 udelay(5);
582
583 // we go to high, we also expect the peripheral to ack.
584 if (state) {
585 timeout = jiffies + 100;
586 while (!w9966_i2c_getscl(cam)) {
587 if (time_after(jiffies, timeout))
588 return -1;
589 }
590 }
591 return 0;
592 }
593
594 // Get peripheral data line
595 // Expects a claimed pdev.
596 static inline int w9966_i2c_getsda(struct w9966_dev* cam)
597 {
598 const unsigned char state = w9966_rReg(cam, 0x18);
599 return ((state & W9966_I2C_R_DATA) > 0);
600 }
601
602 // Write a byte with ack to the i2c bus.
603 // Expects a claimed pdev. -1 on error
604 static int w9966_i2c_wbyte(struct w9966_dev* cam, int data)
605 {
606 int i;
607 for (i = 7; i >= 0; i--)
608 {
609 w9966_i2c_setsda(cam, (data >> i) & 0x01);
610
611 if (w9966_i2c_setscl(cam, 1) == -1)
612 return -1;
613 w9966_i2c_setscl(cam, 0);
614 }
615
616 w9966_i2c_setsda(cam, 1);
617
618 if (w9966_i2c_setscl(cam, 1) == -1)
619 return -1;
620 w9966_i2c_setscl(cam, 0);
621
622 return 0;
623 }
624
625 // Read a data byte with ack from the i2c-bus
626 // Expects a claimed pdev. -1 on error
627 #if 0
628 static int w9966_i2c_rbyte(struct w9966_dev* cam)
629 {
630 unsigned char data = 0x00;
631 int i;
632
633 w9966_i2c_setsda(cam, 1);
634
635 for (i = 0; i < 8; i++)
636 {
637 if (w9966_i2c_setscl(cam, 1) == -1)
638 return -1;
639 data = data << 1;
640 if (w9966_i2c_getsda(cam))
641 data |= 0x01;
642
643 w9966_i2c_setscl(cam, 0);
644 }
645 return data;
646 }
647 #endif
648
649 // Read a register from the i2c device.
650 // Expects claimed pdev. -1 on error
651 #if 0
652 static int w9966_rReg_i2c(struct w9966_dev* cam, int reg)
653 {
654 int data;
655
656 w9966_i2c_setsda(cam, 0);
657 w9966_i2c_setscl(cam, 0);
658
659 if (
660 w9966_i2c_wbyte(cam, W9966_I2C_W_ID) == -1 ||
661 w9966_i2c_wbyte(cam, reg) == -1
662 )
663 return -1;
664
665 w9966_i2c_setsda(cam, 1);
666 if (w9966_i2c_setscl(cam, 1) == -1)
667 return -1;
668 w9966_i2c_setsda(cam, 0);
669 w9966_i2c_setscl(cam, 0);
670
671 if (
672 w9966_i2c_wbyte(cam, W9966_I2C_R_ID) == -1 ||
673 (data = w9966_i2c_rbyte(cam)) == -1
674 )
675 return -1;
676
677 w9966_i2c_setsda(cam, 0);
678
679 if (w9966_i2c_setscl(cam, 1) == -1)
680 return -1;
681 w9966_i2c_setsda(cam, 1);
682
683 return data;
684 }
685 #endif
686
687 // Write a register to the i2c device.
688 // Expects claimed pdev. -1 on error
689 static int w9966_wReg_i2c(struct w9966_dev* cam, int reg, int data)
690 {
691 w9966_i2c_setsda(cam, 0);
692 w9966_i2c_setscl(cam, 0);
693
694 if (
695 w9966_i2c_wbyte(cam, W9966_I2C_W_ID) == -1 ||
696 w9966_i2c_wbyte(cam, reg) == -1 ||
697 w9966_i2c_wbyte(cam, data) == -1
698 )
699 return -1;
700
701 w9966_i2c_setsda(cam, 0);
702 if (w9966_i2c_setscl(cam, 1) == -1)
703 return -1;
704
705 w9966_i2c_setsda(cam, 1);
706
707 return 0;
708 }
709
710 /*
711 * Video4linux interfacing
712 */
713
714 static int w9966_v4l_do_ioctl(struct inode *inode, struct file *file,
715 unsigned int cmd, void *arg)
716 {
717 struct video_device *vdev = video_devdata(file);
718 struct w9966_dev *cam = vdev->priv;
719
720 switch(cmd)
721 {
722 case VIDIOCGCAP:
723 {
724 static struct video_capability vcap = {
725 .name = W9966_DRIVERNAME,
726 .type = VID_TYPE_CAPTURE | VID_TYPE_SCALES,
727 .channels = 1,
728 .maxwidth = W9966_WND_MAX_W,
729 .maxheight = W9966_WND_MAX_H,
730 .minwidth = 2,
731 .minheight = 1,
732 };
733 struct video_capability *cap = arg;
734 *cap = vcap;
735 return 0;
736 }
737 case VIDIOCGCHAN:
738 {
739 struct video_channel *vch = arg;
740 if(vch->channel != 0) // We only support one channel (#0)
741 return -EINVAL;
742 memset(vch,0,sizeof(*vch));
743 strcpy(vch->name, "CCD-input");
744 vch->type = VIDEO_TYPE_CAMERA;
745 return 0;
746 }
747 case VIDIOCSCHAN:
748 {
749 struct video_channel *vch = arg;
750 if(vch->channel != 0)
751 return -EINVAL;
752 return 0;
753 }
754 case VIDIOCGTUNER:
755 {
756 struct video_tuner *vtune = arg;
757 if(vtune->tuner != 0)
758 return -EINVAL;
759 strcpy(vtune->name, "no tuner");
760 vtune->rangelow = 0;
761 vtune->rangehigh = 0;
762 vtune->flags = VIDEO_TUNER_NORM;
763 vtune->mode = VIDEO_MODE_AUTO;
764 vtune->signal = 0xffff;
765 return 0;
766 }
767 case VIDIOCSTUNER:
768 {
769 struct video_tuner *vtune = arg;
770 if (vtune->tuner != 0)
771 return -EINVAL;
772 if (vtune->mode != VIDEO_MODE_AUTO)
773 return -EINVAL;
774 return 0;
775 }
776 case VIDIOCGPICT:
777 {
778 struct video_picture vpic = {
779 cam->brightness << 8, // brightness
780 (cam->hue + 128) << 8, // hue
781 cam->color << 9, // color
782 cam->contrast << 9, // contrast
783 0x8000, // whiteness
784 16, VIDEO_PALETTE_YUV422// bpp, palette format
785 };
786 struct video_picture *pic = arg;
787 *pic = vpic;
788 return 0;
789 }
790 case VIDIOCSPICT:
791 {
792 struct video_picture *vpic = arg;
793 if (vpic->depth != 16 || (vpic->palette != VIDEO_PALETTE_YUV422 && vpic->palette != VIDEO_PALETTE_YUYV))
794 return -EINVAL;
795
796 cam->brightness = vpic->brightness >> 8;
797 cam->hue = (vpic->hue >> 8) - 128;
798 cam->color = vpic->colour >> 9;
799 cam->contrast = vpic->contrast >> 9;
800
801 w9966_pdev_claim(cam);
802
803 if (
804 w9966_wReg_i2c(cam, 0x0a, cam->brightness) == -1 ||
805 w9966_wReg_i2c(cam, 0x0b, cam->contrast) == -1 ||
806 w9966_wReg_i2c(cam, 0x0c, cam->color) == -1 ||
807 w9966_wReg_i2c(cam, 0x0d, cam->hue) == -1
808 ) {
809 w9966_pdev_release(cam);
810 return -EIO;
811 }
812
813 w9966_pdev_release(cam);
814 return 0;
815 }
816 case VIDIOCSWIN:
817 {
818 int ret;
819 struct video_window *vwin = arg;
820
821 if (vwin->flags != 0)
822 return -EINVAL;
823 if (vwin->clipcount != 0)
824 return -EINVAL;
825 if (vwin->width < 2 || vwin->width > W9966_WND_MAX_W)
826 return -EINVAL;
827 if (vwin->height < 1 || vwin->height > W9966_WND_MAX_H)
828 return -EINVAL;
829
830 // Update camera regs
831 w9966_pdev_claim(cam);
832 ret = w9966_setup(cam, 0, 0, 1023, 1023, vwin->width, vwin->height);
833 w9966_pdev_release(cam);
834
835 if (ret != 0) {
836 DPRINTF("VIDIOCSWIN: w9966_setup() failed.\n");
837 return -EIO;
838 }
839
840 return 0;
841 }
842 case VIDIOCGWIN:
843 {
844 struct video_window *vwin = arg;
845 memset(vwin, 0, sizeof(*vwin));
846 vwin->width = cam->width;
847 vwin->height = cam->height;
848 return 0;
849 }
850 // Unimplemented
851 case VIDIOCCAPTURE:
852 case VIDIOCGFBUF:
853 case VIDIOCSFBUF:
854 case VIDIOCKEY:
855 case VIDIOCGFREQ:
856 case VIDIOCSFREQ:
857 case VIDIOCGAUDIO:
858 case VIDIOCSAUDIO:
859 return -EINVAL;
860 default:
861 return -ENOIOCTLCMD;
862 }
863 return 0;
864 }
865
866 static int w9966_v4l_ioctl(struct inode *inode, struct file *file,
867 unsigned int cmd, unsigned long arg)
868 {
869 return video_usercopy(inode, file, cmd, arg, w9966_v4l_do_ioctl);
870 }
871
872 // Capture data
873 static ssize_t w9966_v4l_read(struct file *file, char __user *buf,
874 size_t count, loff_t *ppos)
875 {
876 struct video_device *vdev = video_devdata(file);
877 struct w9966_dev *cam = vdev->priv;
878 unsigned char addr = 0xa0; // ECP, read, CCD-transfer, 00000
879 unsigned char __user *dest = (unsigned char __user *)buf;
880 unsigned long dleft = count;
881 unsigned char *tbuf;
882
883 // Why would anyone want more than this??
884 if (count > cam->width * cam->height * 2)
885 return -EINVAL;
886
887 w9966_pdev_claim(cam);
888 w9966_wReg(cam, 0x00, 0x02); // Reset ECP-FIFO buffer
889 w9966_wReg(cam, 0x00, 0x00); // Return to normal operation
890 w9966_wReg(cam, 0x01, 0x98); // Enable capture
891
892 // write special capture-addr and negotiate into data transfer
893 if (
894 (parport_negotiate(cam->pport, cam->ppmode|IEEE1284_ADDR) != 0 )||
895 (parport_write(cam->pport, &addr, 1) != 1 )||
896 (parport_negotiate(cam->pport, cam->ppmode|IEEE1284_DATA) != 0 )
897 ) {
898 w9966_pdev_release(cam);
899 return -EFAULT;
900 }
901
902 tbuf = kmalloc(W9966_RBUFFER, GFP_KERNEL);
903 if (tbuf == NULL) {
904 count = -ENOMEM;
905 goto out;
906 }
907
908 while(dleft > 0)
909 {
910 unsigned long tsize = (dleft > W9966_RBUFFER) ? W9966_RBUFFER : dleft;
911
912 if (parport_read(cam->pport, tbuf, tsize) < tsize) {
913 count = -EFAULT;
914 goto out;
915 }
916 if (copy_to_user(dest, tbuf, tsize) != 0) {
917 count = -EFAULT;
918 goto out;
919 }
920 dest += tsize;
921 dleft -= tsize;
922 }
923
924 w9966_wReg(cam, 0x01, 0x18); // Disable capture
925
926 out:
927 kfree(tbuf);
928 w9966_pdev_release(cam);
929
930 return count;
931 }
932
933
934 // Called once for every parport on init
935 static void w9966_attach(struct parport *port)
936 {
937 int i;
938
939 for (i = 0; i < W9966_MAXCAMS; i++)
940 {
941 if (w9966_cams[i].dev_state != 0) // Cam is already assigned
942 continue;
943 if (
944 strcmp(pardev[i], "aggressive") == 0 ||
945 strcmp(pardev[i], port->name) == 0
946 ) {
947 if (w9966_init(&w9966_cams[i], port) != 0)
948 w9966_term(&w9966_cams[i]);
949 break; // return
950 }
951 }
952 }
953
954 // Called once for every parport on termination
955 static void w9966_detach(struct parport *port)
956 {
957 int i;
958 for (i = 0; i < W9966_MAXCAMS; i++)
959 if (w9966_cams[i].dev_state != 0 && w9966_cams[i].pport == port)
960 w9966_term(&w9966_cams[i]);
961 }
962
963
964 static struct parport_driver w9966_ppd = {
965 .name = W9966_DRIVERNAME,
966 .attach = w9966_attach,
967 .detach = w9966_detach,
968 };
969
970 // Module entry point
971 static int __init w9966_mod_init(void)
972 {
973 int i;
974 for (i = 0; i < W9966_MAXCAMS; i++)
975 w9966_cams[i].dev_state = 0;
976
977 return parport_register_driver(&w9966_ppd);
978 }
979
980 // Module cleanup
981 static void __exit w9966_mod_term(void)
982 {
983 parport_unregister_driver(&w9966_ppd);
984 }
985
986 module_init(w9966_mod_init);
987 module_exit(w9966_mod_term);
Linux for Ginger Game Console