V4L/DVB: w9966: coding style cleanup
Clean up the coding style before we convert this driver to V4L2. Signed-off-by: Hans Verkuil <hverkuil@xs4all.nl> Signed-off-by: Mauro Carvalho Chehab <mchehab@redhat.com>
This commit is contained in:
Hans Verkuil
Mauro Carvalho Chehab
Родитель
88f4423454
Коммит
4bfdd58604
|
|
@ -76,12 +76,12 @@
|
|||
*/
|
||||
|
||||
#define W9966_DRIVERNAME "W9966CF Webcam"
|
||||
#define W9966_MAXCAMS 4 // Maximum number of cameras
|
||||
#define W9966_RBUFFER 2048 // Read buffer (must be an even number)
|
||||
#define W9966_SRAMSIZE 131072 // 128kb
|
||||
#define W9966_SRAMID 0x02 // check w9966cf.pdf
|
||||
#define W9966_MAXCAMS 4 /* Maximum number of cameras */
|
||||
#define W9966_RBUFFER 2048 /* Read buffer (must be an even number) */
|
||||
#define W9966_SRAMSIZE 131072 /* 128kb */
|
||||
#define W9966_SRAMID 0x02 /* check w9966cf.pdf */
|
||||
|
||||
// Empirically determined window limits
|
||||
/* Empirically determined window limits */
|
||||
#define W9966_WND_MIN_X 16
|
||||
#define W9966_WND_MIN_Y 14
|
||||
#define W9966_WND_MAX_X 705
|
||||
|
|
@ -89,7 +89,7 @@
|
|||
#define W9966_WND_MAX_W (W9966_WND_MAX_X - W9966_WND_MIN_X)
|
||||
#define W9966_WND_MAX_H (W9966_WND_MAX_Y - W9966_WND_MIN_Y)
|
||||
|
||||
// Keep track of our current state
|
||||
/* Keep track of our current state */
|
||||
#define W9966_STATE_PDEV 0x01
|
||||
#define W9966_STATE_CLAIMED 0x02
|
||||
#define W9966_STATE_VDEV 0x04
|
||||
|
|
@ -132,10 +132,10 @@ static const char* pardev[] = {[0 ... W9966_MAXCAMS] = ""};
|
|||
static const char *pardev[] = {[0 ... W9966_MAXCAMS] = "aggressive"};
|
||||
#endif
|
||||
module_param_array(pardev, charp, NULL, 0);
|
||||
MODULE_PARM_DESC(pardev, "pardev: where to search for\n\
|
||||
\teach camera. 'aggressive' means brute-force search.\n\
|
||||
\tEg: >pardev=parport3,aggressive,parport2,parport1< would assign\n\
|
||||
\tcam 1 to parport3 and search every parport for cam 2 etc...");
|
||||
MODULE_PARM_DESC(pardev, "pardev: where to search for\n"
|
||||
"\teach camera. 'aggressive' means brute-force search.\n"
|
||||
"\tEg: >pardev=parport3,aggressive,parport2,parport1< would assign\n"
|
||||
"\tcam 1 to parport3 and search every parport for cam 2 etc...");
|
||||
|
||||
static int parmode;
|
||||
module_param(parmode, int, 0);
|
||||
|
|
@ -219,19 +219,19 @@ static struct video_device w9966_template = {
|
|||
*/
|
||||
|
||||
|
||||
// Set camera phase flags, so we know what to uninit when terminating
|
||||
/* Set camera phase flags, so we know what to uninit when terminating */
|
||||
static inline void w9966_setState(struct w9966_dev *cam, int mask, int val)
|
||||
{
|
||||
cam->dev_state = (cam->dev_state & ~mask) ^ val;
|
||||
}
|
||||
|
||||
// Get camera phase flags
|
||||
/* Get camera phase flags */
|
||||
static inline int w9966_getState(struct w9966_dev *cam, int mask, int val)
|
||||
{
|
||||
return ((cam->dev_state & mask) == val);
|
||||
}
|
||||
|
||||
// Claim parport for ourself
|
||||
/* Claim parport for ourself */
|
||||
static inline void w9966_pdev_claim(struct w9966_dev *cam)
|
||||
{
|
||||
if (w9966_getState(cam, W9966_STATE_CLAIMED, W9966_STATE_CLAIMED))
|
||||
|
|
@ -240,7 +240,7 @@ static inline void w9966_pdev_claim(struct w9966_dev* cam)
|
|||
w9966_setState(cam, W9966_STATE_CLAIMED, W9966_STATE_CLAIMED);
|
||||
}
|
||||
|
||||
// Release parport for others to use
|
||||
/* Release parport for others to use */
|
||||
static inline void w9966_pdev_release(struct w9966_dev *cam)
|
||||
{
|
||||
if (w9966_getState(cam, W9966_STATE_CLAIMED, 0))
|
||||
|
|
@ -249,12 +249,12 @@ static inline void w9966_pdev_release(struct w9966_dev* cam)
|
|||
w9966_setState(cam, W9966_STATE_CLAIMED, 0);
|
||||
}
|
||||
|
||||
// Read register from W9966 interface-chip
|
||||
// Expects a claimed pdev
|
||||
// -1 on error, else register data (byte)
|
||||
/* Read register from W9966 interface-chip
|
||||
Expects a claimed pdev
|
||||
-1 on error, else register data (byte) */
|
||||
static int w9966_rReg(struct w9966_dev *cam, int reg)
|
||||
{
|
||||
// ECP, read, regtransfer, REG, REG, REG, REG, REG
|
||||
/* ECP, read, regtransfer, REG, REG, REG, REG, REG */
|
||||
const unsigned char addr = 0x80 | (reg & 0x1f);
|
||||
unsigned char val;
|
||||
|
||||
|
|
@ -270,12 +270,12 @@ static int w9966_rReg(struct w9966_dev* cam, int reg)
|
|||
return val;
|
||||
}
|
||||
|
||||
// Write register to W9966 interface-chip
|
||||
// Expects a claimed pdev
|
||||
// -1 on error
|
||||
/* Write register to W9966 interface-chip
|
||||
Expects a claimed pdev
|
||||
-1 on error */
|
||||
static int w9966_wReg(struct w9966_dev *cam, int reg, int data)
|
||||
{
|
||||
// ECP, write, regtransfer, REG, REG, REG, REG, REG
|
||||
/* ECP, write, regtransfer, REG, REG, REG, REG, REG */
|
||||
const unsigned char addr = 0xc0 | (reg & 0x1f);
|
||||
const unsigned char val = data;
|
||||
|
||||
|
|
@ -291,10 +291,10 @@ static int w9966_wReg(struct w9966_dev* cam, int reg, int data)
|
|||
return 0;
|
||||
}
|
||||
|
||||
// Initialize camera device. Setup all internal flags, set a
|
||||
// default video mode, setup ccd-chip, register v4l device etc..
|
||||
// Also used for 'probing' of hardware.
|
||||
// -1 on error
|
||||
/* Initialize camera device. Setup all internal flags, set a
|
||||
default video mode, setup ccd-chip, register v4l device etc..
|
||||
Also used for 'probing' of hardware.
|
||||
-1 on error */
|
||||
static int w9966_init(struct w9966_dev *cam, struct parport* port)
|
||||
{
|
||||
if (cam->dev_state != 0)
|
||||
|
|
@ -306,10 +306,9 @@ static int w9966_init(struct w9966_dev* cam, struct parport* port)
|
|||
cam->color = 64;
|
||||
cam->hue = 0;
|
||||
|
||||
// Select requested transfer mode
|
||||
switch(parmode)
|
||||
{
|
||||
default: // Auto-detect (priority: hw-ecp, hw-epp, sw-ecp)
|
||||
/* Select requested transfer mode */
|
||||
switch (parmode) {
|
||||
default: /* Auto-detect (priority: hw-ecp, hw-epp, sw-ecp) */
|
||||
case 0:
|
||||
if (port->modes & PARPORT_MODE_ECP)
|
||||
cam->ppmode = IEEE1284_MODE_ECP;
|
||||
|
|
@ -318,15 +317,15 @@ static int w9966_init(struct w9966_dev* cam, struct parport* port)
|
|||
else
|
||||
cam->ppmode = IEEE1284_MODE_ECP;
|
||||
break;
|
||||
case 1: // hw- or sw-ecp
|
||||
case 1: /* hw- or sw-ecp */
|
||||
cam->ppmode = IEEE1284_MODE_ECP;
|
||||
break;
|
||||
case 2: // hw- or sw-epp
|
||||
case 2: /* hw- or sw-epp */
|
||||
cam->ppmode = IEEE1284_MODE_EPP;
|
||||
break;
|
||||
}
|
||||
|
||||
// Tell the parport driver that we exists
|
||||
/* Tell the parport driver that we exists */
|
||||
cam->pdev = parport_register_device(port, "w9966", NULL, NULL, NULL, 0, NULL);
|
||||
if (cam->pdev == NULL) {
|
||||
DPRINTF("parport_register_device() failed\n");
|
||||
|
|
@ -336,7 +335,7 @@ static int w9966_init(struct w9966_dev* cam, struct parport* port)
|
|||
|
||||
w9966_pdev_claim(cam);
|
||||
|
||||
// Setup a default capture mode
|
||||
/* Setup a default capture mode */
|
||||
if (w9966_setup(cam, 0, 0, 1023, 1023, 200, 160) != 0) {
|
||||
DPRINTF("w9966_setup() failed.\n");
|
||||
return -1;
|
||||
|
|
@ -344,7 +343,7 @@ static int w9966_init(struct w9966_dev* cam, struct parport* port)
|
|||
|
||||
w9966_pdev_release(cam);
|
||||
|
||||
// Fill in the video_device struct and register us to v4l
|
||||
/* Fill in the video_device struct and register us to v4l */
|
||||
memcpy(&cam->vdev, &w9966_template, sizeof(struct video_device));
|
||||
video_set_drvdata(&cam->vdev, cam);
|
||||
|
||||
|
|
@ -353,32 +352,30 @@ static int w9966_init(struct w9966_dev* cam, struct parport* port)
|
|||
|
||||
w9966_setState(cam, W9966_STATE_VDEV, W9966_STATE_VDEV);
|
||||
|
||||
// All ok
|
||||
printk(
|
||||
"w9966cf: Found and initialized a webcam on %s.\n",
|
||||
cam->pport->name
|
||||
);
|
||||
/* All ok */
|
||||
printk(KERN_INFO "w9966cf: Found and initialized a webcam on %s.\n",
|
||||
cam->pport->name);
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
// Terminate everything gracefully
|
||||
/* Terminate everything gracefully */
|
||||
static void w9966_term(struct w9966_dev *cam)
|
||||
{
|
||||
// Unregister from v4l
|
||||
/* Unregister from v4l */
|
||||
if (w9966_getState(cam, W9966_STATE_VDEV, W9966_STATE_VDEV)) {
|
||||
video_unregister_device(&cam->vdev);
|
||||
w9966_setState(cam, W9966_STATE_VDEV, 0);
|
||||
}
|
||||
|
||||
// Terminate from IEEE1284 mode and release pdev block
|
||||
/* Terminate from IEEE1284 mode and release pdev block */
|
||||
if (w9966_getState(cam, W9966_STATE_PDEV, W9966_STATE_PDEV)) {
|
||||
w9966_pdev_claim(cam);
|
||||
parport_negotiate(cam->pport, IEEE1284_MODE_COMPAT);
|
||||
w9966_pdev_release(cam);
|
||||
}
|
||||
|
||||
// Unregister from parport
|
||||
/* Unregister from parport */
|
||||
if (w9966_getState(cam, W9966_STATE_PDEV, W9966_STATE_PDEV)) {
|
||||
parport_unregister_device(cam->pdev);
|
||||
w9966_setState(cam, W9966_STATE_PDEV, 0);
|
||||
|
|
@ -386,24 +383,23 @@ static void w9966_term(struct w9966_dev* cam)
|
|||
}
|
||||
|
||||
|
||||
// Find a good length for capture window (used both for W and H)
|
||||
// A bit ugly but pretty functional. The capture length
|
||||
// have to match the downscale
|
||||
/* Find a good length for capture window (used both for W and H)
|
||||
A bit ugly but pretty functional. The capture length
|
||||
have to match the downscale */
|
||||
static int w9966_findlen(int near, int size, int maxlen)
|
||||
{
|
||||
int bestlen = size;
|
||||
int besterr = abs(near - bestlen);
|
||||
int len;
|
||||
|
||||
for(len = size+1;len < maxlen;len++)
|
||||
{
|
||||
for (len = size + 1; len < maxlen; len++) {
|
||||
int err;
|
||||
if (((64 * size) % len) != 0)
|
||||
continue;
|
||||
|
||||
err = abs(near - len);
|
||||
|
||||
// Only continue as long as we keep getting better values
|
||||
/* Only continue as long as we keep getting better values */
|
||||
if (err > besterr)
|
||||
break;
|
||||
|
||||
|
|
@ -414,9 +410,9 @@ static int w9966_findlen(int near, int size, int maxlen)
|
|||
return bestlen;
|
||||
}
|
||||
|
||||
// Modify capture window (if necessary)
|
||||
// and calculate downscaling
|
||||
// Return -1 on error
|
||||
/* Modify capture window (if necessary)
|
||||
and calculate downscaling
|
||||
Return -1 on error */
|
||||
static int w9966_calcscale(int size, int min, int max, int *beg, int *end, unsigned char *factor)
|
||||
{
|
||||
int maxlen = max - min;
|
||||
|
|
@ -424,22 +420,22 @@ static int w9966_calcscale(int size, int min, int max, int* beg, int* end, unsig
|
|||
int newlen = w9966_findlen(len, size, maxlen);
|
||||
int err = newlen - len;
|
||||
|
||||
// Check for bad format
|
||||
/* Check for bad format */
|
||||
if (newlen > maxlen || newlen < size)
|
||||
return -1;
|
||||
|
||||
// Set factor (6 bit fixed)
|
||||
/* Set factor (6 bit fixed) */
|
||||
*factor = (64 * size) / newlen;
|
||||
if (*factor == 64)
|
||||
*factor = 0x00; // downscale is disabled
|
||||
*factor = 0x00; /* downscale is disabled */
|
||||
else
|
||||
*factor |= 0x80; // set downscale-enable bit
|
||||
*factor |= 0x80; /* set downscale-enable bit */
|
||||
|
||||
// Modify old beginning and end
|
||||
/* Modify old beginning and end */
|
||||
*beg -= err / 2;
|
||||
*end += err - (err / 2);
|
||||
|
||||
// Move window if outside borders
|
||||
/* Move window if outside borders */
|
||||
if (*beg < min) {
|
||||
*end += min - *beg;
|
||||
*beg += min - *beg;
|
||||
|
|
@ -452,9 +448,9 @@ static int w9966_calcscale(int size, int min, int max, int* beg, int* end, unsig
|
|||
return 0;
|
||||
}
|
||||
|
||||
// Setup the cameras capture window etc.
|
||||
// Expects a claimed pdev
|
||||
// return -1 on error
|
||||
/* Setup the cameras capture window etc.
|
||||
Expects a claimed pdev
|
||||
return -1 on error */
|
||||
static int w9966_setup(struct w9966_dev *cam, int x1, int y1, int x2, int y2, int w, int h)
|
||||
{
|
||||
unsigned int i;
|
||||
|
|
@ -469,17 +465,20 @@ static int w9966_setup(struct w9966_dev* cam, int x1, int y1, int x2, int y2, in
|
|||
};
|
||||
|
||||
|
||||
if (w*h*2 > W9966_SRAMSIZE)
|
||||
{
|
||||
if (w * h * 2 > W9966_SRAMSIZE) {
|
||||
DPRINTF("capture window exceeds SRAM size!.\n");
|
||||
w = 200; h = 160; // Pick default values
|
||||
w = 200; h = 160; /* Pick default values */
|
||||
}
|
||||
|
||||
w &= ~0x1;
|
||||
if (w < 2) w = 2;
|
||||
if (h < 1) h = 1;
|
||||
if (w > W9966_WND_MAX_W) w = W9966_WND_MAX_W;
|
||||
if (h > W9966_WND_MAX_H) h = W9966_WND_MAX_H;
|
||||
if (w < 2)
|
||||
w = 2;
|
||||
if (h < 1)
|
||||
h = 1;
|
||||
if (w > W9966_WND_MAX_W)
|
||||
w = W9966_WND_MAX_W;
|
||||
if (h > W9966_WND_MAX_H)
|
||||
h = W9966_WND_MAX_H;
|
||||
|
||||
cam->width = w;
|
||||
cam->height = h;
|
||||
|
|
@ -487,66 +486,63 @@ static int w9966_setup(struct w9966_dev* cam, int x1, int y1, int x2, int y2, in
|
|||
enh_s = 0;
|
||||
enh_e = w * h * 2;
|
||||
|
||||
// Modify capture window if necessary and calculate downscaling
|
||||
if (
|
||||
w9966_calcscale(w, W9966_WND_MIN_X, W9966_WND_MAX_X, &x1, &x2, &scale_x) != 0 ||
|
||||
w9966_calcscale(h, W9966_WND_MIN_Y, W9966_WND_MAX_Y, &y1, &y2, &scale_y) != 0
|
||||
) return -1;
|
||||
/* Modify capture window if necessary and calculate downscaling */
|
||||
if (w9966_calcscale(w, W9966_WND_MIN_X, W9966_WND_MAX_X, &x1, &x2, &scale_x) != 0 ||
|
||||
w9966_calcscale(h, W9966_WND_MIN_Y, W9966_WND_MAX_Y, &y1, &y2, &scale_y) != 0)
|
||||
return -1;
|
||||
|
||||
DPRINTF(
|
||||
"%dx%d, x: %d<->%d, y: %d<->%d, sx: %d/64, sy: %d/64.\n",
|
||||
w, h, x1, x2, y1, y2, scale_x&~0x80, scale_y&~0x80
|
||||
);
|
||||
DPRINTF("%dx%d, x: %d<->%d, y: %d<->%d, sx: %d/64, sy: %d/64.\n",
|
||||
w, h, x1, x2, y1, y2, scale_x & ~0x80, scale_y & ~0x80);
|
||||
|
||||
// Setup registers
|
||||
regs[0x00] = 0x00; // Set normal operation
|
||||
regs[0x01] = 0x18; // Capture mode
|
||||
regs[0x02] = scale_y; // V-scaling
|
||||
regs[0x03] = scale_x; // H-scaling
|
||||
/* Setup registers */
|
||||
regs[0x00] = 0x00; /* Set normal operation */
|
||||
regs[0x01] = 0x18; /* Capture mode */
|
||||
regs[0x02] = scale_y; /* V-scaling */
|
||||
regs[0x03] = scale_x; /* H-scaling */
|
||||
|
||||
// Capture window
|
||||
regs[0x04] = (x1 & 0x0ff); // X-start (8 low bits)
|
||||
regs[0x05] = (x1 & 0x300)>>8; // X-start (2 high bits)
|
||||
regs[0x06] = (y1 & 0x0ff); // Y-start (8 low bits)
|
||||
regs[0x07] = (y1 & 0x300)>>8; // Y-start (2 high bits)
|
||||
regs[0x08] = (x2 & 0x0ff); // X-end (8 low bits)
|
||||
regs[0x09] = (x2 & 0x300)>>8; // X-end (2 high bits)
|
||||
regs[0x0a] = (y2 & 0x0ff); // Y-end (8 low bits)
|
||||
/* Capture window */
|
||||
regs[0x04] = (x1 & 0x0ff); /* X-start (8 low bits) */
|
||||
regs[0x05] = (x1 & 0x300)>>8; /* X-start (2 high bits) */
|
||||
regs[0x06] = (y1 & 0x0ff); /* Y-start (8 low bits) */
|
||||
regs[0x07] = (y1 & 0x300)>>8; /* Y-start (2 high bits) */
|
||||
regs[0x08] = (x2 & 0x0ff); /* X-end (8 low bits) */
|
||||
regs[0x09] = (x2 & 0x300)>>8; /* X-end (2 high bits) */
|
||||
regs[0x0a] = (y2 & 0x0ff); /* Y-end (8 low bits) */
|
||||
|
||||
regs[0x0c] = W9966_SRAMID; // SRAM-banks (1x 128kb)
|
||||
regs[0x0c] = W9966_SRAMID; /* SRAM-banks (1x 128kb) */
|
||||
|
||||
// Enhancement layer
|
||||
regs[0x0d] = (enh_s& 0x000ff); // Enh. start (0-7)
|
||||
regs[0x0e] = (enh_s& 0x0ff00)>>8; // Enh. start (8-15)
|
||||
regs[0x0f] = (enh_s& 0x70000)>>16; // Enh. start (16-17/18??)
|
||||
regs[0x10] = (enh_e& 0x000ff); // Enh. end (0-7)
|
||||
regs[0x11] = (enh_e& 0x0ff00)>>8; // Enh. end (8-15)
|
||||
regs[0x12] = (enh_e& 0x70000)>>16; // Enh. end (16-17/18??)
|
||||
/* Enhancement layer */
|
||||
regs[0x0d] = (enh_s & 0x000ff); /* Enh. start (0-7) */
|
||||
regs[0x0e] = (enh_s & 0x0ff00) >> 8; /* Enh. start (8-15) */
|
||||
regs[0x0f] = (enh_s & 0x70000) >> 16; /* Enh. start (16-17/18??) */
|
||||
regs[0x10] = (enh_e & 0x000ff); /* Enh. end (0-7) */
|
||||
regs[0x11] = (enh_e & 0x0ff00) >> 8; /* Enh. end (8-15) */
|
||||
regs[0x12] = (enh_e & 0x70000) >> 16; /* Enh. end (16-17/18??) */
|
||||
|
||||
// Misc
|
||||
regs[0x13] = 0x40; // VEE control (raw 4:2:2)
|
||||
regs[0x17] = 0x00; // ???
|
||||
regs[0x18] = cam->i2c_state = 0x00; // Serial bus
|
||||
regs[0x19] = 0xff; // I/O port direction control
|
||||
regs[0x1a] = 0xff; // I/O port data register
|
||||
regs[0x1b] = 0x10; // ???
|
||||
/* Misc */
|
||||
regs[0x13] = 0x40; /* VEE control (raw 4:2:2) */
|
||||
regs[0x17] = 0x00; /* ??? */
|
||||
regs[0x18] = cam->i2c_state = 0x00; /* Serial bus */
|
||||
regs[0x19] = 0xff; /* I/O port direction control */
|
||||
regs[0x1a] = 0xff; /* I/O port data register */
|
||||
regs[0x1b] = 0x10; /* ??? */
|
||||
|
||||
// SAA7111 chip settings
|
||||
/* SAA7111 chip settings */
|
||||
saa7111_regs[0x0a] = cam->brightness;
|
||||
saa7111_regs[0x0b] = cam->contrast;
|
||||
saa7111_regs[0x0c] = cam->color;
|
||||
saa7111_regs[0x0d] = cam->hue;
|
||||
|
||||
// Reset (ECP-fifo & serial-bus)
|
||||
/* Reset (ECP-fifo & serial-bus) */
|
||||
if (w9966_wReg(cam, 0x00, 0x03) == -1)
|
||||
return -1;
|
||||
|
||||
// Write regs to w9966cf chip
|
||||
/* Write regs to w9966cf chip */
|
||||
for (i = 0; i < 0x1c; i++)
|
||||
if (w9966_wReg(cam, i, regs[i]) == -1)
|
||||
return -1;
|
||||
|
||||
// Write regs to saa7111 chip
|
||||
/* Write regs to saa7111 chip */
|
||||
for (i = 0; i < 0x20; i++)
|
||||
if (w9966_wReg_i2c(cam, i, saa7111_regs[i]) == -1)
|
||||
return -1;
|
||||
|
|
@ -558,8 +554,8 @@ static int w9966_setup(struct w9966_dev* cam, int x1, int y1, int x2, int y2, in
|
|||
* Ugly and primitive i2c protocol functions
|
||||
*/
|
||||
|
||||
// Sets the data line on the i2c bus.
|
||||
// Expects a claimed pdev.
|
||||
/* Sets the data line on the i2c bus.
|
||||
Expects a claimed pdev. */
|
||||
static inline void w9966_i2c_setsda(struct w9966_dev *cam, int state)
|
||||
{
|
||||
if (state)
|
||||
|
|
@ -571,16 +567,16 @@ static inline void w9966_i2c_setsda(struct w9966_dev* cam, int state)
|
|||
udelay(5);
|
||||
}
|
||||
|
||||
// Get peripheral clock line
|
||||
// Expects a claimed pdev.
|
||||
/* Get peripheral clock line
|
||||
Expects a claimed pdev. */
|
||||
static inline int w9966_i2c_getscl(struct w9966_dev *cam)
|
||||
{
|
||||
const unsigned char state = w9966_rReg(cam, 0x18);
|
||||
return ((state & W9966_I2C_R_CLOCK) > 0);
|
||||
}
|
||||
|
||||
// Sets the clock line on the i2c bus.
|
||||
// Expects a claimed pdev. -1 on error
|
||||
/* Sets the clock line on the i2c bus.
|
||||
Expects a claimed pdev. -1 on error */
|
||||
static inline int w9966_i2c_setscl(struct w9966_dev *cam, int state)
|
||||
{
|
||||
unsigned long timeout;
|
||||
|
|
@ -593,7 +589,7 @@ static inline int w9966_i2c_setscl(struct w9966_dev* cam, int state)
|
|||
w9966_wReg(cam, 0x18, cam->i2c_state);
|
||||
udelay(5);
|
||||
|
||||
// we go to high, we also expect the peripheral to ack.
|
||||
/* we go to high, we also expect the peripheral to ack. */
|
||||
if (state) {
|
||||
timeout = jiffies + 100;
|
||||
while (!w9966_i2c_getscl(cam)) {
|
||||
|
|
@ -604,21 +600,21 @@ static inline int w9966_i2c_setscl(struct w9966_dev* cam, int state)
|
|||
return 0;
|
||||
}
|
||||
|
||||
// Get peripheral data line
|
||||
// Expects a claimed pdev.
|
||||
/* Get peripheral data line
|
||||
Expects a claimed pdev. */
|
||||
static inline int w9966_i2c_getsda(struct w9966_dev *cam)
|
||||
{
|
||||
const unsigned char state = w9966_rReg(cam, 0x18);
|
||||
return ((state & W9966_I2C_R_DATA) > 0);
|
||||
}
|
||||
|
||||
// Write a byte with ack to the i2c bus.
|
||||
// Expects a claimed pdev. -1 on error
|
||||
/* Write a byte with ack to the i2c bus.
|
||||
Expects a claimed pdev. -1 on error */
|
||||
static int w9966_i2c_wbyte(struct w9966_dev *cam, int data)
|
||||
{
|
||||
int i;
|
||||
for (i = 7; i >= 0; i--)
|
||||
{
|
||||
|
||||
for (i = 7; i >= 0; i--) {
|
||||
w9966_i2c_setsda(cam, (data >> i) & 0x01);
|
||||
|
||||
if (w9966_i2c_setscl(cam, 1) == -1)
|
||||
|
|
@ -635,8 +631,8 @@ static int w9966_i2c_wbyte(struct w9966_dev* cam, int data)
|
|||
return 0;
|
||||
}
|
||||
|
||||
// Read a data byte with ack from the i2c-bus
|
||||
// Expects a claimed pdev. -1 on error
|
||||
/* Read a data byte with ack from the i2c-bus
|
||||
Expects a claimed pdev. -1 on error */
|
||||
#if 0
|
||||
static int w9966_i2c_rbyte(struct w9966_dev *cam)
|
||||
{
|
||||
|
|
@ -645,8 +641,7 @@ static int w9966_i2c_rbyte(struct w9966_dev* cam)
|
|||
|
||||
w9966_i2c_setsda(cam, 1);
|
||||
|
||||
for (i = 0; i < 8; i++)
|
||||
{
|
||||
for (i = 0; i < 8; i++) {
|
||||
if (w9966_i2c_setscl(cam, 1) == -1)
|
||||
return -1;
|
||||
data = data << 1;
|
||||
|
|
@ -659,8 +654,8 @@ static int w9966_i2c_rbyte(struct w9966_dev* cam)
|
|||
}
|
||||
#endif
|
||||
|
||||
// Read a register from the i2c device.
|
||||
// Expects claimed pdev. -1 on error
|
||||
/* Read a register from the i2c device.
|
||||
Expects claimed pdev. -1 on error */
|
||||
#if 0
|
||||
static int w9966_rReg_i2c(struct w9966_dev *cam, int reg)
|
||||
{
|
||||
|
|
@ -669,10 +664,8 @@ static int w9966_rReg_i2c(struct w9966_dev* cam, int reg)
|
|||
w9966_i2c_setsda(cam, 0);
|
||||
w9966_i2c_setscl(cam, 0);
|
||||
|
||||
if (
|
||||
w9966_i2c_wbyte(cam, W9966_I2C_W_ID) == -1 ||
|
||||
w9966_i2c_wbyte(cam, reg) == -1
|
||||
)
|
||||
if (w9966_i2c_wbyte(cam, W9966_I2C_W_ID) == -1 ||
|
||||
w9966_i2c_wbyte(cam, reg) == -1)
|
||||
return -1;
|
||||
|
||||
w9966_i2c_setsda(cam, 1);
|
||||
|
|
@ -681,10 +674,10 @@ static int w9966_rReg_i2c(struct w9966_dev* cam, int reg)
|
|||
w9966_i2c_setsda(cam, 0);
|
||||
w9966_i2c_setscl(cam, 0);
|
||||
|
||||
if (
|
||||
w9966_i2c_wbyte(cam, W9966_I2C_R_ID) == -1 ||
|
||||
(data = w9966_i2c_rbyte(cam)) == -1
|
||||
)
|
||||
if (w9966_i2c_wbyte(cam, W9966_I2C_R_ID) == -1)
|
||||
return -1;
|
||||
data = w9966_i2c_rbyte(cam);
|
||||
if (data == -1)
|
||||
return -1;
|
||||
|
||||
w9966_i2c_setsda(cam, 0);
|
||||
|
|
@ -697,18 +690,16 @@ static int w9966_rReg_i2c(struct w9966_dev* cam, int reg)
|
|||
}
|
||||
#endif
|
||||
|
||||
// Write a register to the i2c device.
|
||||
// Expects claimed pdev. -1 on error
|
||||
/* Write a register to the i2c device.
|
||||
Expects claimed pdev. -1 on error */
|
||||
static int w9966_wReg_i2c(struct w9966_dev *cam, int reg, int data)
|
||||
{
|
||||
w9966_i2c_setsda(cam, 0);
|
||||
w9966_i2c_setscl(cam, 0);
|
||||
|
||||
if (
|
||||
w9966_i2c_wbyte(cam, W9966_I2C_W_ID) == -1 ||
|
||||
if (w9966_i2c_wbyte(cam, W9966_I2C_W_ID) == -1 ||
|
||||
w9966_i2c_wbyte(cam, reg) == -1 ||
|
||||
w9966_i2c_wbyte(cam, data) == -1
|
||||
)
|
||||
w9966_i2c_wbyte(cam, data) == -1)
|
||||
return -1;
|
||||
|
||||
w9966_i2c_setsda(cam, 0);
|
||||
|
|
@ -728,8 +719,7 @@ static long w9966_v4l_do_ioctl(struct file *file, unsigned int cmd, void *arg)
|
|||
{
|
||||
struct w9966_dev *cam = video_drvdata(file);
|
||||
|
||||
switch(cmd)
|
||||
{
|
||||
switch (cmd) {
|
||||
case VIDIOCGCAP:
|
||||
{
|
||||
static struct video_capability vcap = {
|
||||
|
|
@ -748,7 +738,7 @@ static long w9966_v4l_do_ioctl(struct file *file, unsigned int cmd, void *arg)
|
|||
case VIDIOCGCHAN:
|
||||
{
|
||||
struct video_channel *vch = arg;
|
||||
if(vch->channel != 0) // We only support one channel (#0)
|
||||
if (vch->channel != 0) /* We only support one channel (#0) */
|
||||
return -EINVAL;
|
||||
memset(vch, 0, sizeof(*vch));
|
||||
strcpy(vch->name, "CCD-input");
|
||||
|
|
@ -787,12 +777,12 @@ static long w9966_v4l_do_ioctl(struct file *file, unsigned int cmd, void *arg)
|
|||
case VIDIOCGPICT:
|
||||
{
|
||||
struct video_picture vpic = {
|
||||
cam->brightness << 8, // brightness
|
||||
(cam->hue + 128) << 8, // hue
|
||||
cam->color << 9, // color
|
||||
cam->contrast << 9, // contrast
|
||||
0x8000, // whiteness
|
||||
16, VIDEO_PALETTE_YUV422// bpp, palette format
|
||||
cam->brightness << 8, /* brightness */
|
||||
(cam->hue + 128) << 8, /* hue */
|
||||
cam->color << 9, /* color */
|
||||
cam->contrast << 9, /* contrast */
|
||||
0x8000, /* whiteness */
|
||||
16, VIDEO_PALETTE_YUV422/* bpp, palette format */
|
||||
};
|
||||
struct video_picture *pic = arg;
|
||||
*pic = vpic;
|
||||
|
|
@ -838,7 +828,7 @@ static long w9966_v4l_do_ioctl(struct file *file, unsigned int cmd, void *arg)
|
|||
if (vwin->height < 1 || vwin->height > W9966_WND_MAX_H)
|
||||
return -EINVAL;
|
||||
|
||||
// Update camera regs
|
||||
/* Update camera regs */
|
||||
w9966_pdev_claim(cam);
|
||||
ret = w9966_setup(cam, 0, 0, 1023, 1023, vwin->width, vwin->height);
|
||||
w9966_pdev_release(cam);
|
||||
|
|
@ -858,7 +848,7 @@ static long w9966_v4l_do_ioctl(struct file *file, unsigned int cmd, void *arg)
|
|||
vwin->height = cam->height;
|
||||
return 0;
|
||||
}
|
||||
// Unimplemented
|
||||
/* Unimplemented */
|
||||
case VIDIOCCAPTURE:
|
||||
case VIDIOCGFBUF:
|
||||
case VIDIOCSFBUF:
|
||||
|
|
@ -880,31 +870,29 @@ static long w9966_v4l_ioctl(struct file *file,
|
|||
return video_usercopy(file, cmd, arg, w9966_v4l_do_ioctl);
|
||||
}
|
||||
|
||||
// Capture data
|
||||
/* Capture data */
|
||||
static ssize_t w9966_v4l_read(struct file *file, char __user *buf,
|
||||
size_t count, loff_t *ppos)
|
||||
{
|
||||
struct w9966_dev *cam = video_drvdata(file);
|
||||
unsigned char addr = 0xa0; // ECP, read, CCD-transfer, 00000
|
||||
unsigned char addr = 0xa0; /* ECP, read, CCD-transfer, 00000 */
|
||||
unsigned char __user *dest = (unsigned char __user *)buf;
|
||||
unsigned long dleft = count;
|
||||
unsigned char *tbuf;
|
||||
|
||||
// Why would anyone want more than this??
|
||||
/* Why would anyone want more than this?? */
|
||||
if (count > cam->width * cam->height * 2)
|
||||
return -EINVAL;
|
||||
|
||||
w9966_pdev_claim(cam);
|
||||
w9966_wReg(cam, 0x00, 0x02); // Reset ECP-FIFO buffer
|
||||
w9966_wReg(cam, 0x00, 0x00); // Return to normal operation
|
||||
w9966_wReg(cam, 0x01, 0x98); // Enable capture
|
||||
w9966_wReg(cam, 0x00, 0x02); /* Reset ECP-FIFO buffer */
|
||||
w9966_wReg(cam, 0x00, 0x00); /* Return to normal operation */
|
||||
w9966_wReg(cam, 0x01, 0x98); /* Enable capture */
|
||||
|
||||
// write special capture-addr and negotiate into data transfer
|
||||
if (
|
||||
(parport_negotiate(cam->pport, cam->ppmode|IEEE1284_ADDR) != 0 )||
|
||||
/* write special capture-addr and negotiate into data transfer */
|
||||
if ((parport_negotiate(cam->pport, cam->ppmode|IEEE1284_ADDR) != 0) ||
|
||||
(parport_write(cam->pport, &addr, 1) != 1) ||
|
||||
(parport_negotiate(cam->pport, cam->ppmode|IEEE1284_DATA) != 0 )
|
||||
) {
|
||||
(parport_negotiate(cam->pport, cam->ppmode|IEEE1284_DATA) != 0)) {
|
||||
w9966_pdev_release(cam);
|
||||
return -EFAULT;
|
||||
}
|
||||
|
|
@ -915,8 +903,7 @@ static ssize_t w9966_v4l_read(struct file *file, char __user *buf,
|
|||
goto out;
|
||||
}
|
||||
|
||||
while(dleft > 0)
|
||||
{
|
||||
while (dleft > 0) {
|
||||
unsigned long tsize = (dleft > W9966_RBUFFER) ? W9966_RBUFFER : dleft;
|
||||
|
||||
if (parport_read(cam->pport, tbuf, tsize) < tsize) {
|
||||
|
|
@ -931,7 +918,7 @@ static ssize_t w9966_v4l_read(struct file *file, char __user *buf,
|
|||
dleft -= tsize;
|
||||
}
|
||||
|
||||
w9966_wReg(cam, 0x01, 0x18); // Disable capture
|
||||
w9966_wReg(cam, 0x01, 0x18); /* Disable capture */
|
||||
|
||||
out:
|
||||
kfree(tbuf);
|
||||
|
|
@ -941,30 +928,27 @@ out:
|
|||
}
|
||||
|
||||
|
||||
// Called once for every parport on init
|
||||
/* Called once for every parport on init */
|
||||
static void w9966_attach(struct parport *port)
|
||||
{
|
||||
int i;
|
||||
|
||||
for (i = 0; i < W9966_MAXCAMS; i++)
|
||||
{
|
||||
if (w9966_cams[i].dev_state != 0) // Cam is already assigned
|
||||
for (i = 0; i < W9966_MAXCAMS; i++) {
|
||||
if (w9966_cams[i].dev_state != 0) /* Cam is already assigned */
|
||||
continue;
|
||||
if (
|
||||
strcmp(pardev[i], "aggressive") == 0 ||
|
||||
strcmp(pardev[i], port->name) == 0
|
||||
) {
|
||||
if (strcmp(pardev[i], "aggressive") == 0 || strcmp(pardev[i], port->name) == 0) {
|
||||
if (w9966_init(&w9966_cams[i], port) != 0)
|
||||
w9966_term(&w9966_cams[i]);
|
||||
break; // return
|
||||
break; /* return */
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
// Called once for every parport on termination
|
||||
/* Called once for every parport on termination */
|
||||
static void w9966_detach(struct parport *port)
|
||||
{
|
||||
int i;
|
||||
|
||||
for (i = 0; i < W9966_MAXCAMS; i++)
|
||||
if (w9966_cams[i].dev_state != 0 && w9966_cams[i].pport == port)
|
||||
w9966_term(&w9966_cams[i]);
|
||||
|
|
@ -977,17 +961,18 @@ static struct parport_driver w9966_ppd = {
|
|||
.detach = w9966_detach,
|
||||
};
|
||||
|
||||
// Module entry point
|
||||
/* Module entry point */
|
||||
static int __init w9966_mod_init(void)
|
||||
{
|
||||
int i;
|
||||
|
||||
for (i = 0; i < W9966_MAXCAMS; i++)
|
||||
w9966_cams[i].dev_state = 0;
|
||||
|
||||
return parport_register_driver(&w9966_ppd);
|
||||
}
|
||||
|
||||
// Module cleanup
|
||||
/* Module cleanup */
|
||||
static void __exit w9966_mod_term(void)
|
||||
{
|
||||
parport_unregister_driver(&w9966_ppd);
|
||||
|
|
|
|||
Загрузка…
Ссылка в новой задаче