Skip to content

L
linux
Commit 4bfdd586 authored by Hans Verkuil's avatar Hans Verkuil Committed by Mauro Carvalho Chehab
Browse files
Options

V4L/DVB: w9966: coding style cleanup 

Clean up the coding style before we convert this driver to V4L2.
Signed-off-by: default avatarHans Verkuil <hverkuil@xs4all.nl>
Signed-off-by: default avatarMauro Carvalho Chehab <mchehab@redhat.com>
parent 88f44234
Hide whitespace changes
Inline Side-by-side
Showing with 223 additions and 238 deletions
drivers/media/video/w9966.c
View file @ 4bfdd586
...@@ -76,12 +76,12 @@ ...@@ -76,12 +76,12 @@
*/ */
#define W9966_DRIVERNAME "W9966CF Webcam" #define W9966_DRIVERNAME "W9966CF Webcam"
#define W9966_MAXCAMS 4 // Maximum number of cameras #define W9966_MAXCAMS 4 /* Maximum number of cameras */
#define W9966_RBUFFER 2048 // Read buffer (must be an even number) #define W9966_RBUFFER 2048 /* Read buffer (must be an even number) */
#define W9966_SRAMSIZE 131072 // 128kb #define W9966_SRAMSIZE 131072 /* 128kb */
#define W9966_SRAMID 0x02 // check w9966cf.pdf #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_X 16
#define W9966_WND_MIN_Y 14 #define W9966_WND_MIN_Y 14
#define W9966_WND_MAX_X 705 #define W9966_WND_MAX_X 705
...@@ -89,7 +89,7 @@ ...@@ -89,7 +89,7 @@
#define W9966_WND_MAX_W (W9966_WND_MAX_X - W9966_WND_MIN_X) #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) #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_PDEV 0x01
#define W9966_STATE_CLAIMED 0x02 #define W9966_STATE_CLAIMED 0x02
#define W9966_STATE_VDEV 0x04 #define W9966_STATE_VDEV 0x04
...@@ -105,8 +105,8 @@ struct w9966_dev { ...@@ -105,8 +105,8 @@ struct w9966_dev {
unsigned char dev_state; unsigned char dev_state;
unsigned char i2c_state; unsigned char i2c_state;
unsigned short ppmode; unsigned short ppmode;
struct parport* pport; struct parport *pport;
struct pardevice* pdev; struct pardevice *pdev;
struct video_device vdev; struct video_device vdev;
unsigned short width; unsigned short width;
unsigned short height; unsigned short height;
...@@ -127,15 +127,15 @@ MODULE_LICENSE("GPL"); ...@@ -127,15 +127,15 @@ MODULE_LICENSE("GPL");
#ifdef MODULE #ifdef MODULE
static const char* pardev[] = {[0 ... W9966_MAXCAMS] = ""}; static const char *pardev[] = {[0 ... W9966_MAXCAMS] = ""};
#else #else
static const char* pardev[] = {[0 ... W9966_MAXCAMS] = "aggressive"}; static const char *pardev[] = {[0 ... W9966_MAXCAMS] = "aggressive"};
#endif #endif
module_param_array(pardev, charp, NULL, 0); module_param_array(pardev, charp, NULL, 0);
MODULE_PARM_DESC(pardev, "pardev: where to search for\n\ MODULE_PARM_DESC(pardev, "pardev: where to search for\n"
\teach camera. 'aggressive' means brute-force search.\n\ "\teach camera. 'aggressive' means brute-force search.\n"
\tEg: >pardev=parport3,aggressive,parport2,parport1< would assign\n\ "\tEg: >pardev=parport3,aggressive,parport2,parport1< would assign\n"
\tcam 1 to parport3 and search every parport for cam 2 etc..."); "\tcam 1 to parport3 and search every parport for cam 2 etc...");
static int parmode; static int parmode;
module_param(parmode, int, 0); module_param(parmode, int, 0);
...@@ -154,31 +154,31 @@ static struct w9966_dev w9966_cams[W9966_MAXCAMS]; ...@@ -154,31 +154,31 @@ static struct w9966_dev w9966_cams[W9966_MAXCAMS];
* Private function declares * Private function declares
*/ */
static inline void w9966_setState(struct w9966_dev* cam, int mask, int val); static inline void w9966_setState(struct w9966_dev *cam, int mask, int val);
static inline int w9966_getState(struct w9966_dev* cam, int mask, int val); static inline int w9966_getState(struct w9966_dev *cam, int mask, int val);
static inline void w9966_pdev_claim(struct w9966_dev *vdev); static inline void w9966_pdev_claim(struct w9966_dev *vdev);
static inline void w9966_pdev_release(struct w9966_dev *vdev); static inline void w9966_pdev_release(struct w9966_dev *vdev);
static int w9966_rReg(struct w9966_dev* cam, int reg); static int w9966_rReg(struct w9966_dev *cam, int reg);
static int w9966_wReg(struct w9966_dev* cam, int reg, int data); static int w9966_wReg(struct w9966_dev *cam, int reg, int data);
#if 0 #if 0
static int w9966_rReg_i2c(struct w9966_dev* cam, int reg); static int w9966_rReg_i2c(struct w9966_dev *cam, int reg);
#endif #endif
static int w9966_wReg_i2c(struct w9966_dev* cam, int reg, int data); static int w9966_wReg_i2c(struct w9966_dev *cam, int reg, int data);
static int w9966_findlen(int near, int size, int maxlen); static int w9966_findlen(int near, int size, int maxlen);
static int w9966_calcscale(int size, int min, int max, int* beg, int* end, unsigned char* factor); static int w9966_calcscale(int size, int min, int max, int *beg, int *end, unsigned char *factor);
static int w9966_setup(struct w9966_dev* cam, int x1, int y1, int x2, int y2, int w, int h); static int w9966_setup(struct w9966_dev *cam, int x1, int y1, int x2, int y2, int w, int h);
static int w9966_init(struct w9966_dev* cam, struct parport* port); static int w9966_init(struct w9966_dev *cam, struct parport* port);
static void w9966_term(struct w9966_dev* cam); static void w9966_term(struct w9966_dev *cam);
static inline void w9966_i2c_setsda(struct w9966_dev* cam, int state); static inline void w9966_i2c_setsda(struct w9966_dev *cam, int state);
static inline int w9966_i2c_setscl(struct w9966_dev* cam, int state); static inline int w9966_i2c_setscl(struct w9966_dev *cam, int state);
static inline int w9966_i2c_getsda(struct w9966_dev* cam); static inline int w9966_i2c_getsda(struct w9966_dev *cam);
static inline int w9966_i2c_getscl(struct w9966_dev* cam); static inline int w9966_i2c_getscl(struct w9966_dev *cam);
static int w9966_i2c_wbyte(struct w9966_dev* cam, int data); static int w9966_i2c_wbyte(struct w9966_dev *cam, int data);
#if 0 #if 0
static int w9966_i2c_rbyte(struct w9966_dev* cam); static int w9966_i2c_rbyte(struct w9966_dev *cam);
#endif #endif
static long w9966_v4l_ioctl(struct file *file, static long w9966_v4l_ioctl(struct file *file,
...@@ -219,20 +219,20 @@ static struct video_device w9966_template = { ...@@ -219,20 +219,20 @@ 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) static inline void w9966_setState(struct w9966_dev *cam, int mask, int val)
{ {
cam->dev_state = (cam->dev_state & ~mask) ^ 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) static inline int w9966_getState(struct w9966_dev *cam, int mask, int val)
{ {
return ((cam->dev_state & mask) == 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) static inline void w9966_pdev_claim(struct w9966_dev *cam)
{ {
if (w9966_getState(cam, W9966_STATE_CLAIMED, W9966_STATE_CLAIMED)) if (w9966_getState(cam, W9966_STATE_CLAIMED, W9966_STATE_CLAIMED))
return; return;
...@@ -240,8 +240,8 @@ static inline void w9966_pdev_claim(struct w9966_dev* cam) ...@@ -240,8 +240,8 @@ static inline void w9966_pdev_claim(struct w9966_dev* cam)
w9966_setState(cam, W9966_STATE_CLAIMED, W9966_STATE_CLAIMED); 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) static inline void w9966_pdev_release(struct w9966_dev *cam)
{ {
if (w9966_getState(cam, W9966_STATE_CLAIMED, 0)) if (w9966_getState(cam, W9966_STATE_CLAIMED, 0))
return; return;
...@@ -249,12 +249,12 @@ static inline void w9966_pdev_release(struct w9966_dev* cam) ...@@ -249,12 +249,12 @@ static inline void w9966_pdev_release(struct w9966_dev* cam)
w9966_setState(cam, W9966_STATE_CLAIMED, 0); w9966_setState(cam, W9966_STATE_CLAIMED, 0);
} }
// Read register from W9966 interface-chip /* Read register from W9966 interface-chip
// Expects a claimed pdev Expects a claimed pdev
// -1 on error, else register data (byte) -1 on error, else register data (byte) */
static int w9966_rReg(struct w9966_dev* cam, int reg) 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); const unsigned char addr = 0x80 | (reg & 0x1f);
unsigned char val; unsigned char val;
...@@ -270,12 +270,12 @@ static int w9966_rReg(struct w9966_dev* cam, int reg) ...@@ -270,12 +270,12 @@ static int w9966_rReg(struct w9966_dev* cam, int reg)
return val; return val;
} }
// Write register to W9966 interface-chip /* Write register to W9966 interface-chip
// Expects a claimed pdev Expects a claimed pdev
// -1 on error -1 on error */
static int w9966_wReg(struct w9966_dev* cam, int reg, int data) 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 addr = 0xc0 | (reg & 0x1f);
const unsigned char val = data; const unsigned char val = data;
...@@ -291,11 +291,11 @@ static int w9966_wReg(struct w9966_dev* cam, int reg, int data) ...@@ -291,11 +291,11 @@ static int w9966_wReg(struct w9966_dev* cam, int reg, int data)
return 0; return 0;
} }
// Initialize camera device. Setup all internal flags, set a /* Initialize camera device. Setup all internal flags, set a
// default video mode, setup ccd-chip, register v4l device etc.. default video mode, setup ccd-chip, register v4l device etc..
// Also used for 'probing' of hardware. Also used for 'probing' of hardware.
// -1 on error -1 on error */
static int w9966_init(struct w9966_dev* cam, struct parport* port) static int w9966_init(struct w9966_dev *cam, struct parport* port)
{ {
if (cam->dev_state != 0) if (cam->dev_state != 0)
return -1; return -1;
...@@ -306,10 +306,9 @@ static int w9966_init(struct w9966_dev* cam, struct parport* port) ...@@ -306,10 +306,9 @@ static int w9966_init(struct w9966_dev* cam, struct parport* port)
cam->color = 64; cam->color = 64;
cam->hue = 0; cam->hue = 0;
// Select requested transfer mode /* Select requested transfer mode */
switch(parmode) switch (parmode) {
{ default: /* Auto-detect (priority: hw-ecp, hw-epp, sw-ecp) */
default: // Auto-detect (priority: hw-ecp, hw-epp, sw-ecp)
case 0: case 0:
if (port->modes & PARPORT_MODE_ECP) if (port->modes & PARPORT_MODE_ECP)
cam->ppmode = IEEE1284_MODE_ECP; cam->ppmode = IEEE1284_MODE_ECP;
...@@ -318,15 +317,15 @@ static int w9966_init(struct w9966_dev* cam, struct parport* port) ...@@ -318,15 +317,15 @@ static int w9966_init(struct w9966_dev* cam, struct parport* port)
else else
cam->ppmode = IEEE1284_MODE_ECP; cam->ppmode = IEEE1284_MODE_ECP;
break; break;
case 1: // hw- or sw-ecp case 1: /* hw- or sw-ecp */
cam->ppmode = IEEE1284_MODE_ECP; cam->ppmode = IEEE1284_MODE_ECP;
break; break;
case 2: // hw- or sw-epp case 2: /* hw- or sw-epp */
cam->ppmode = IEEE1284_MODE_EPP; cam->ppmode = IEEE1284_MODE_EPP;
break; 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); cam->pdev = parport_register_device(port, "w9966", NULL, NULL, NULL, 0, NULL);
if (cam->pdev == NULL) { if (cam->pdev == NULL) {
DPRINTF("parport_register_device() failed\n"); DPRINTF("parport_register_device() failed\n");
...@@ -336,7 +335,7 @@ static int w9966_init(struct w9966_dev* cam, struct parport* port) ...@@ -336,7 +335,7 @@ static int w9966_init(struct w9966_dev* cam, struct parport* port)
w9966_pdev_claim(cam); 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) { if (w9966_setup(cam, 0, 0, 1023, 1023, 200, 160) != 0) {
DPRINTF("w9966_setup() failed.\n"); DPRINTF("w9966_setup() failed.\n");
return -1; return -1;
...@@ -344,7 +343,7 @@ static int w9966_init(struct w9966_dev* cam, struct parport* port) ...@@ -344,7 +343,7 @@ static int w9966_init(struct w9966_dev* cam, struct parport* port)
w9966_pdev_release(cam); 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)); memcpy(&cam->vdev, &w9966_template, sizeof(struct video_device));
video_set_drvdata(&cam->vdev, cam); video_set_drvdata(&cam->vdev, cam);
...@@ -353,32 +352,30 @@ static int w9966_init(struct w9966_dev* cam, struct parport* port) ...@@ -353,32 +352,30 @@ static int w9966_init(struct w9966_dev* cam, struct parport* port)
w9966_setState(cam, W9966_STATE_VDEV, W9966_STATE_VDEV); w9966_setState(cam, W9966_STATE_VDEV, W9966_STATE_VDEV);
// All ok /* All ok */
printk( printk(KERN_INFO "w9966cf: Found and initialized a webcam on %s.\n",
"w9966cf: Found and initialized a webcam on %s.\n", cam->pport->name);
cam->pport->name
);
return 0; return 0;
} }
// Terminate everything gracefully /* Terminate everything gracefully */
static void w9966_term(struct w9966_dev* cam) static void w9966_term(struct w9966_dev *cam)
{ {
// Unregister from v4l /* Unregister from v4l */
if (w9966_getState(cam, W9966_STATE_VDEV, W9966_STATE_VDEV)) { if (w9966_getState(cam, W9966_STATE_VDEV, W9966_STATE_VDEV)) {
video_unregister_device(&cam->vdev); video_unregister_device(&cam->vdev);
w9966_setState(cam, W9966_STATE_VDEV, 0); 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)) { if (w9966_getState(cam, W9966_STATE_PDEV, W9966_STATE_PDEV)) {
w9966_pdev_claim(cam); w9966_pdev_claim(cam);
parport_negotiate(cam->pport, IEEE1284_MODE_COMPAT); parport_negotiate(cam->pport, IEEE1284_MODE_COMPAT);
w9966_pdev_release(cam); w9966_pdev_release(cam);
} }
// Unregister from parport /* Unregister from parport */
if (w9966_getState(cam, W9966_STATE_PDEV, W9966_STATE_PDEV)) { if (w9966_getState(cam, W9966_STATE_PDEV, W9966_STATE_PDEV)) {
parport_unregister_device(cam->pdev); parport_unregister_device(cam->pdev);
w9966_setState(cam, W9966_STATE_PDEV, 0); w9966_setState(cam, W9966_STATE_PDEV, 0);
...@@ -386,24 +383,23 @@ static void w9966_term(struct w9966_dev* cam) ...@@ -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) /* Find a good length for capture window (used both for W and H)
// A bit ugly but pretty functional. The capture length A bit ugly but pretty functional. The capture length
// have to match the downscale have to match the downscale */
static int w9966_findlen(int near, int size, int maxlen) static int w9966_findlen(int near, int size, int maxlen)
{ {
int bestlen = size; int bestlen = size;
int besterr = abs(near - bestlen); int besterr = abs(near - bestlen);
int len; int len;
for(len = size+1;len < maxlen;len++) for (len = size + 1; len < maxlen; len++) {
{
int err; int err;
if ( ((64*size) %len) != 0) if (((64 * size) % len) != 0)
continue; continue;
err = abs(near - len); 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) if (err > besterr)
break; break;
...@@ -414,32 +410,32 @@ static int w9966_findlen(int near, int size, int maxlen) ...@@ -414,32 +410,32 @@ static int w9966_findlen(int near, int size, int maxlen)
return bestlen; return bestlen;
} }
// Modify capture window (if necessary) /* Modify capture window (if necessary)
// and calculate downscaling and calculate downscaling
// Return -1 on error Return -1 on error */
static int w9966_calcscale(int size, int min, int max, int* beg, int* end, unsigned char* factor) static int w9966_calcscale(int size, int min, int max, int *beg, int *end, unsigned char *factor)
{ {
int maxlen = max - min; int maxlen = max - min;
int len = *end - *beg + 1; int len = *end - *beg + 1;
int newlen = w9966_findlen(len, size, maxlen); int newlen = w9966_findlen(len, size, maxlen);
int err = newlen - len; int err = newlen - len;
// Check for bad format /* Check for bad format */
if (newlen > maxlen || newlen < size) if (newlen > maxlen || newlen < size)
return -1; return -1;
// Set factor (6 bit fixed) /* Set factor (6 bit fixed) */
*factor = (64*size) / newlen; *factor = (64 * size) / newlen;
if (*factor == 64) if (*factor == 64)
*factor = 0x00; // downscale is disabled *factor = 0x00; /* downscale is disabled */
else 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; *beg -= err / 2;
*end += err - (err / 2); *end += err - (err / 2);
// Move window if outside borders /* Move window if outside borders */
if (*beg < min) { if (*beg < min) {
*end += min - *beg; *end += min - *beg;
*beg += min - *beg; *beg += min - *beg;
...@@ -452,10 +448,10 @@ static int w9966_calcscale(int size, int min, int max, int* beg, int* end, unsig ...@@ -452,10 +448,10 @@ static int w9966_calcscale(int size, int min, int max, int* beg, int* end, unsig
return 0; return 0;
} }
// Setup the cameras capture window etc. /* Setup the cameras capture window etc.
// Expects a claimed pdev Expects a claimed pdev
// return -1 on error return -1 on error */
static int w9966_setup(struct w9966_dev* cam, int x1, int y1, int x2, int y2, int w, int h) static int w9966_setup(struct w9966_dev *cam, int x1, int y1, int x2, int y2, int w, int h)
{ {
unsigned int i; unsigned int i;
unsigned int enh_s, enh_e; unsigned int enh_s, enh_e;
...@@ -469,84 +465,84 @@ static int w9966_setup(struct w9966_dev* cam, int x1, int y1, int x2, int y2, in ...@@ -469,84 +465,84 @@ 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"); DPRINTF("capture window exceeds SRAM size!.\n");
w = 200; h = 160; // Pick default values w = 200; h = 160; /* Pick default values */
} }
w &= ~0x1; w &= ~0x1;
if (w < 2) w = 2; if (w < 2)
if (h < 1) h = 1; w = 2;
if (w > W9966_WND_MAX_W) w = W9966_WND_MAX_W; if (h < 1)
if (h > W9966_WND_MAX_H) h = W9966_WND_MAX_H; 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->width = w;
cam->height = h; cam->height = h;
enh_s = 0; enh_s = 0;
enh_e = w*h*2; enh_e = w * h * 2;
// Modify capture window if necessary and calculate downscaling /* Modify capture window if necessary and calculate downscaling */
if ( if (w9966_calcscale(w, W9966_WND_MIN_X, W9966_WND_MAX_X, &x1, &x2, &scale_x) != 0 ||
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)
w9966_calcscale(h, W9966_WND_MIN_Y, W9966_WND_MAX_Y, &y1, &y2, &scale_y) != 0 return -1;
) return -1;
DPRINTF("%dx%d, x: %d<->%d, y: %d<->%d, sx: %d/64, sy: %d/64.\n",
DPRINTF( w, h, x1, x2, y1, y2, scale_x & ~0x80, scale_y & ~0x80);
"%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 */
// Setup registers regs[0x02] = scale_y; /* V-scaling */
regs[0x00] = 0x00; // Set normal operation regs[0x03] = scale_x; /* H-scaling */
regs[0x01] = 0x18; // Capture mode
regs[0x02] = scale_y; // V-scaling /* Capture window */
regs[0x03] = scale_x; // H-scaling regs[0x04] = (x1 & 0x0ff); /* X-start (8 low bits) */
regs[0x05] = (x1 & 0x300)>>8; /* X-start (2 high bits) */
// Capture window regs[0x06] = (y1 & 0x0ff); /* Y-start (8 low bits) */
regs[0x04] = (x1 & 0x0ff); // X-start (8 low bits) regs[0x07] = (y1 & 0x300)>>8; /* Y-start (2 high bits) */
regs[0x05] = (x1 & 0x300)>>8; // X-start (2 high bits) regs[0x08] = (x2 & 0x0ff); /* X-end (8 low bits) */
regs[0x06] = (y1 & 0x0ff); // Y-start (8 low bits) regs[0x09] = (x2 & 0x300)>>8; /* X-end (2 high bits) */
regs[0x07] = (y1 & 0x300)>>8; // Y-start (2 high bits) regs[0x0a] = (y2 & 0x0ff); /* Y-end (8 low bits) */
regs[0x08] = (x2 & 0x0ff); // X-end (8 low bits)
regs[0x09] = (x2 & 0x300)>>8; // X-end (2 high bits) regs[0x0c] = W9966_SRAMID; /* SRAM-banks (1x 128kb) */
regs[0x0a] = (y2 & 0x0ff); // Y-end (8 low bits)
/* Enhancement layer */
regs[0x0c] = W9966_SRAMID; // SRAM-banks (1x 128kb) regs[0x0d] = (enh_s & 0x000ff); /* Enh. start (0-7) */
regs[0x0e] = (enh_s & 0x0ff00) >> 8; /* Enh. start (8-15) */
// Enhancement layer regs[0x0f] = (enh_s & 0x70000) >> 16; /* Enh. start (16-17/18??) */
regs[0x0d] = (enh_s& 0x000ff); // Enh. start (0-7) regs[0x10] = (enh_e & 0x000ff); /* Enh. end (0-7) */
regs[0x0e] = (enh_s& 0x0ff00)>>8; // Enh. start (8-15) regs[0x11] = (enh_e & 0x0ff00) >> 8; /* Enh. end (8-15) */
regs[0x0f] = (enh_s& 0x70000)>>16; // Enh. start (16-17/18??) regs[0x12] = (enh_e & 0x70000) >> 16; /* Enh. end (16-17/18??) */
regs[0x10] = (enh_e& 0x000ff); // Enh. end (0-7)
regs[0x11] = (enh_e& 0x0ff00)>>8; // Enh. end (8-15) /* Misc */
regs[0x12] = (enh_e& 0x70000)>>16; // Enh. end (16-17/18??) regs[0x13] = 0x40; /* VEE control (raw 4:2:2) */
regs[0x17] = 0x00; /* ??? */
// Misc regs[0x18] = cam->i2c_state = 0x00; /* Serial bus */
regs[0x13] = 0x40; // VEE control (raw 4:2:2) regs[0x19] = 0xff; /* I/O port direction control */
regs[0x17] = 0x00; // ??? regs[0x1a] = 0xff; /* I/O port data register */
regs[0x18] = cam->i2c_state = 0x00; // Serial bus regs[0x1b] = 0x10; /* ??? */
regs[0x19] = 0xff; // I/O port direction control
regs[0x1a] = 0xff; // I/O port data register /* SAA7111 chip settings */
regs[0x1b] = 0x10; // ???
// SAA7111 chip settings
saa7111_regs[0x0a] = cam->brightness; saa7111_regs[0x0a] = cam->brightness;
saa7111_regs[0x0b] = cam->contrast; saa7111_regs[0x0b] = cam->contrast;
saa7111_regs[0x0c] = cam->color; saa7111_regs[0x0c] = cam->color;
saa7111_regs[0x0d] = cam->hue; saa7111_regs[0x0d] = cam->hue;
// Reset (ECP-fifo & serial-bus) /* Reset (ECP-fifo & serial-bus) */
if (w9966_wReg(cam, 0x00, 0x03) == -1) if (w9966_wReg(cam, 0x00, 0x03) == -1)
return -1; return -1;
// Write regs to w9966cf chip /* Write regs to w9966cf chip */
for (i = 0; i < 0x1c; i++) for (i = 0; i < 0x1c; i++)
if (w9966_wReg(cam, i, regs[i]) == -1) if (w9966_wReg(cam, i, regs[i]) == -1)
return -1; return -1;
// Write regs to saa7111 chip /* Write regs to saa7111 chip */
for (i = 0; i < 0x20; i++) for (i = 0; i < 0x20; i++)
if (w9966_wReg_i2c(cam, i, saa7111_regs[i]) == -1) if (w9966_wReg_i2c(cam, i, saa7111_regs[i]) == -1)
return -1; return -1;
...@@ -558,9 +554,9 @@ static int w9966_setup(struct w9966_dev* cam, int x1, int y1, int x2, int y2, in ...@@ -558,9 +554,9 @@ static int w9966_setup(struct w9966_dev* cam, int x1, int y1, int x2, int y2, in
* Ugly and primitive i2c protocol functions * Ugly and primitive i2c protocol functions
*/ */
// Sets the data line on the i2c bus. /* Sets the data line on the i2c bus.
// Expects a claimed pdev. Expects a claimed pdev. */
static inline void w9966_i2c_setsda(struct w9966_dev* cam, int state) static inline void w9966_i2c_setsda(struct w9966_dev *cam, int state)
{ {
if (state) if (state)
cam->i2c_state |= W9966_I2C_W_DATA; cam->i2c_state |= W9966_I2C_W_DATA;
...@@ -571,17 +567,17 @@ static inline void w9966_i2c_setsda(struct w9966_dev* cam, int state) ...@@ -571,17 +567,17 @@ static inline void w9966_i2c_setsda(struct w9966_dev* cam, int state)
udelay(5); udelay(5);
} }
// Get peripheral clock line /* Get peripheral clock line
// Expects a claimed pdev. Expects a claimed pdev. */
static inline int w9966_i2c_getscl(struct w9966_dev* cam) static inline int w9966_i2c_getscl(struct w9966_dev *cam)
{ {
const unsigned char state = w9966_rReg(cam, 0x18); const unsigned char state = w9966_rReg(cam, 0x18);
return ((state & W9966_I2C_R_CLOCK) > 0); return ((state & W9966_I2C_R_CLOCK) > 0);
} }
// Sets the clock line on the i2c bus. /* Sets the clock line on the i2c bus.
// Expects a claimed pdev. -1 on error Expects a claimed pdev. -1 on error */
static inline int w9966_i2c_setscl(struct w9966_dev* cam, int state) static inline int w9966_i2c_setscl(struct w9966_dev *cam, int state)
{ {
unsigned long timeout; unsigned long timeout;
...@@ -593,7 +589,7 @@ static inline int w9966_i2c_setscl(struct w9966_dev* cam, int state) ...@@ -593,7 +589,7 @@ static inline int w9966_i2c_setscl(struct w9966_dev* cam, int state)
w9966_wReg(cam, 0x18, cam->i2c_state); w9966_wReg(cam, 0x18, cam->i2c_state);
udelay(5); 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) { if (state) {
timeout = jiffies + 100; timeout = jiffies + 100;
while (!w9966_i2c_getscl(cam)) { while (!w9966_i2c_getscl(cam)) {
...@@ -604,21 +600,21 @@ static inline int w9966_i2c_setscl(struct w9966_dev* cam, int state) ...@@ -604,21 +600,21 @@ static inline int w9966_i2c_setscl(struct w9966_dev* cam, int state)
return 0; return 0;
} }
// Get peripheral data line /* Get peripheral data line
// Expects a claimed pdev. Expects a claimed pdev. */
static inline int w9966_i2c_getsda(struct w9966_dev* cam) static inline int w9966_i2c_getsda(struct w9966_dev *cam)
{ {
const unsigned char state = w9966_rReg(cam, 0x18); const unsigned char state = w9966_rReg(cam, 0x18);
return ((state & W9966_I2C_R_DATA) > 0); return ((state & W9966_I2C_R_DATA) > 0);
} }
// Write a byte with ack to the i2c bus. /* Write a byte with ack to the i2c bus.
// Expects a claimed pdev. -1 on error Expects a claimed pdev. -1 on error */
static int w9966_i2c_wbyte(struct w9966_dev* cam, int data) static int w9966_i2c_wbyte(struct w9966_dev *cam, int data)
{ {
int i; int i;
for (i = 7; i >= 0; i--)
{ for (i = 7; i >= 0; i--) {
w9966_i2c_setsda(cam, (data >> i) & 0x01); w9966_i2c_setsda(cam, (data >> i) & 0x01);
if (w9966_i2c_setscl(cam, 1) == -1) if (w9966_i2c_setscl(cam, 1) == -1)
...@@ -635,18 +631,17 @@ static int w9966_i2c_wbyte(struct w9966_dev* cam, int data) ...@@ -635,18 +631,17 @@ static int w9966_i2c_wbyte(struct w9966_dev* cam, int data)
return 0; return 0;
} }
// Read a data byte with ack from the i2c-bus /* Read a data byte with ack from the i2c-bus
// Expects a claimed pdev. -1 on error Expects a claimed pdev. -1 on error */
#if 0 #if 0
static int w9966_i2c_rbyte(struct w9966_dev* cam) static int w9966_i2c_rbyte(struct w9966_dev *cam)
{ {
unsigned char data = 0x00; unsigned char data = 0x00;
int i; int i;
w9966_i2c_setsda(cam, 1); w9966_i2c_setsda(cam, 1);
for (i = 0; i < 8; i++) for (i = 0; i < 8; i++) {
{
if (w9966_i2c_setscl(cam, 1) == -1) if (w9966_i2c_setscl(cam, 1) == -1)
return -1; return -1;
data = data << 1; data = data << 1;
...@@ -659,20 +654,18 @@ static int w9966_i2c_rbyte(struct w9966_dev* cam) ...@@ -659,20 +654,18 @@ static int w9966_i2c_rbyte(struct w9966_dev* cam)
} }
#endif #endif
// Read a register from the i2c device. /* Read a register from the i2c device.
// Expects claimed pdev. -1 on error Expects claimed pdev. -1 on error */
#if 0 #if 0
static int w9966_rReg_i2c(struct w9966_dev* cam, int reg) static int w9966_rReg_i2c(struct w9966_dev *cam, int reg)
{ {
int data; int data;
w9966_i2c_setsda(cam, 0); w9966_i2c_setsda(cam, 0);
w9966_i2c_setscl(cam, 0); w9966_i2c_setscl(cam, 0);
if ( if (w9966_i2c_wbyte(cam, W9966_I2C_W_ID) == -1 ||
w9966_i2c_wbyte(cam, W9966_I2C_W_ID) == -1 || w9966_i2c_wbyte(cam, reg) == -1)
w9966_i2c_wbyte(cam, reg) == -1
)
return -1; return -1;
w9966_i2c_setsda(cam, 1); w9966_i2c_setsda(cam, 1);
...@@ -681,10 +674,10 @@ static int w9966_rReg_i2c(struct w9966_dev* cam, int reg) ...@@ -681,10 +674,10 @@ static int w9966_rReg_i2c(struct w9966_dev* cam, int reg)
w9966_i2c_setsda(cam, 0); w9966_i2c_setsda(cam, 0);
w9966_i2c_setscl(cam, 0); w9966_i2c_setscl(cam, 0);
if ( if (w9966_i2c_wbyte(cam, W9966_I2C_R_ID) == -1)
w9966_i2c_wbyte(cam, W9966_I2C_R_ID) == -1 || return -1;
(data = w9966_i2c_rbyte(cam)) == -1 data = w9966_i2c_rbyte(cam);
) if (data == -1)
return -1; return -1;
w9966_i2c_setsda(cam, 0); w9966_i2c_setsda(cam, 0);
...@@ -697,18 +690,16 @@ static int w9966_rReg_i2c(struct w9966_dev* cam, int reg) ...@@ -697,18 +690,16 @@ static int w9966_rReg_i2c(struct w9966_dev* cam, int reg)
} }
#endif #endif
// Write a register to the i2c device. /* Write a register to the i2c device.
// Expects claimed pdev. -1 on error Expects claimed pdev. -1 on error */
static int w9966_wReg_i2c(struct w9966_dev* cam, int reg, int data) static int w9966_wReg_i2c(struct w9966_dev *cam, int reg, int data)
{ {
w9966_i2c_setsda(cam, 0); w9966_i2c_setsda(cam, 0);
w9966_i2c_setscl(cam, 0); w9966_i2c_setscl(cam, 0);
if ( if (w9966_i2c_wbyte(cam, W9966_I2C_W_ID) == -1 ||
w9966_i2c_wbyte(cam, W9966_I2C_W_ID) == -1 || w9966_i2c_wbyte(cam, reg) == -1 ||
w9966_i2c_wbyte(cam, reg) == -1 || w9966_i2c_wbyte(cam, data) == -1)
w9966_i2c_wbyte(cam, data) == -1
)
return -1; return -1;
w9966_i2c_setsda(cam, 0); w9966_i2c_setsda(cam, 0);
...@@ -728,8 +719,7 @@ static long w9966_v4l_do_ioctl(struct file *file, unsigned int cmd, void *arg) ...@@ -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); struct w9966_dev *cam = video_drvdata(file);
switch(cmd) switch (cmd) {
{
case VIDIOCGCAP: case VIDIOCGCAP:
{ {
static struct video_capability vcap = { static struct video_capability vcap = {
...@@ -748,9 +738,9 @@ static long w9966_v4l_do_ioctl(struct file *file, unsigned int cmd, void *arg) ...@@ -748,9 +738,9 @@ static long w9966_v4l_do_ioctl(struct file *file, unsigned int cmd, void *arg)
case VIDIOCGCHAN: case VIDIOCGCHAN:
{ {
struct video_channel *vch = arg; 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; return -EINVAL;
memset(vch,0,sizeof(*vch)); memset(vch, 0, sizeof(*vch));
strcpy(vch->name, "CCD-input"); strcpy(vch->name, "CCD-input");
vch->type = VIDEO_TYPE_CAMERA; vch->type = VIDEO_TYPE_CAMERA;
return 0; return 0;
...@@ -758,14 +748,14 @@ static long w9966_v4l_do_ioctl(struct file *file, unsigned int cmd, void *arg) ...@@ -758,14 +748,14 @@ static long w9966_v4l_do_ioctl(struct file *file, unsigned int cmd, void *arg)
case VIDIOCSCHAN: case VIDIOCSCHAN:
{ {
struct video_channel *vch = arg; struct video_channel *vch = arg;
if(vch->channel != 0) if (vch->channel != 0)
return -EINVAL; return -EINVAL;
return 0; return 0;
} }
case VIDIOCGTUNER: case VIDIOCGTUNER:
{ {
struct video_tuner *vtune = arg; struct video_tuner *vtune = arg;
if(vtune->tuner != 0) if (vtune->tuner != 0)
return -EINVAL; return -EINVAL;
strcpy(vtune->name, "no tuner"); strcpy(vtune->name, "no tuner");
vtune->rangelow = 0; vtune->rangelow = 0;
...@@ -787,12 +777,12 @@ static long w9966_v4l_do_ioctl(struct file *file, unsigned int cmd, void *arg) ...@@ -787,12 +777,12 @@ static long w9966_v4l_do_ioctl(struct file *file, unsigned int cmd, void *arg)
case VIDIOCGPICT: case VIDIOCGPICT:
{ {
struct video_picture vpic = { struct video_picture vpic = {
cam->brightness << 8, // brightness cam->brightness << 8, /* brightness */
(cam->hue + 128) << 8, // hue (cam->hue + 128) << 8, /* hue */
cam->color << 9, // color cam->color << 9, /* color */
cam->contrast << 9, // contrast cam->contrast << 9, /* contrast */
0x8000, // whiteness 0x8000, /* whiteness */
16, VIDEO_PALETTE_YUV422// bpp, palette format 16, VIDEO_PALETTE_YUV422/* bpp, palette format */
}; };
struct video_picture *pic = arg; struct video_picture *pic = arg;
*pic = vpic; *pic = vpic;
...@@ -838,7 +828,7 @@ static long w9966_v4l_do_ioctl(struct file *file, unsigned int cmd, void *arg) ...@@ -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) if (vwin->height < 1 || vwin->height > W9966_WND_MAX_H)
return -EINVAL; return -EINVAL;
// Update camera regs /* Update camera regs */
w9966_pdev_claim(cam); w9966_pdev_claim(cam);
ret = w9966_setup(cam, 0, 0, 1023, 1023, vwin->width, vwin->height); ret = w9966_setup(cam, 0, 0, 1023, 1023, vwin->width, vwin->height);
w9966_pdev_release(cam); w9966_pdev_release(cam);
...@@ -858,7 +848,7 @@ static long w9966_v4l_do_ioctl(struct file *file, unsigned int cmd, void *arg) ...@@ -858,7 +848,7 @@ static long w9966_v4l_do_ioctl(struct file *file, unsigned int cmd, void *arg)
vwin->height = cam->height; vwin->height = cam->height;
return 0; return 0;
} }
// Unimplemented /* Unimplemented */
case VIDIOCCAPTURE: case VIDIOCCAPTURE:
case VIDIOCGFBUF: case VIDIOCGFBUF:
case VIDIOCSFBUF: case VIDIOCSFBUF:
...@@ -880,31 +870,29 @@ static long w9966_v4l_ioctl(struct file *file, ...@@ -880,31 +870,29 @@ static long w9966_v4l_ioctl(struct file *file,
return video_usercopy(file, cmd, arg, w9966_v4l_do_ioctl); 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, static ssize_t w9966_v4l_read(struct file *file, char __user *buf,
size_t count, loff_t *ppos) size_t count, loff_t *ppos)
{ {
struct w9966_dev *cam = video_drvdata(file); 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 char __user *dest = (unsigned char __user *)buf;
unsigned long dleft = count; unsigned long dleft = count;
unsigned char *tbuf; unsigned char *tbuf;
// Why would anyone want more than this?? /* Why would anyone want more than this?? */
if (count > cam->width * cam->height * 2) if (count > cam->width * cam->height * 2)
return -EINVAL; return -EINVAL;
w9966_pdev_claim(cam); w9966_pdev_claim(cam);
w9966_wReg(cam, 0x00, 0x02); // Reset ECP-FIFO buffer w9966_wReg(cam, 0x00, 0x02); /* Reset ECP-FIFO buffer */
w9966_wReg(cam, 0x00, 0x00); // Return to normal operation w9966_wReg(cam, 0x00, 0x00); /* Return to normal operation */
w9966_wReg(cam, 0x01, 0x98); // Enable capture w9966_wReg(cam, 0x01, 0x98); /* Enable capture */
// write special capture-addr and negotiate into data transfer /* write special capture-addr and negotiate into data transfer */
if ( if ((parport_negotiate(cam->pport, cam->ppmode|IEEE1284_ADDR) != 0) ||
(parport_negotiate(cam->pport, cam->ppmode|IEEE1284_ADDR) != 0 )|| (parport_write(cam->pport, &addr, 1) != 1) ||
(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); w9966_pdev_release(cam);
return -EFAULT; return -EFAULT;
} }
...@@ -915,8 +903,7 @@ static ssize_t w9966_v4l_read(struct file *file, char __user *buf, ...@@ -915,8 +903,7 @@ static ssize_t w9966_v4l_read(struct file *file, char __user *buf,
goto out; goto out;
} }
while(dleft > 0) while (dleft > 0) {
{
unsigned long tsize = (dleft > W9966_RBUFFER) ? W9966_RBUFFER : dleft; unsigned long tsize = (dleft > W9966_RBUFFER) ? W9966_RBUFFER : dleft;
if (parport_read(cam->pport, tbuf, tsize) < tsize) { if (parport_read(cam->pport, tbuf, tsize) < tsize) {
...@@ -931,7 +918,7 @@ static ssize_t w9966_v4l_read(struct file *file, char __user *buf, ...@@ -931,7 +918,7 @@ static ssize_t w9966_v4l_read(struct file *file, char __user *buf,
dleft -= tsize; dleft -= tsize;
} }
w9966_wReg(cam, 0x01, 0x18); // Disable capture w9966_wReg(cam, 0x01, 0x18); /* Disable capture */
out: out:
kfree(tbuf); kfree(tbuf);
...@@ -941,33 +928,30 @@ static ssize_t w9966_v4l_read(struct file *file, char __user *buf, ...@@ -941,33 +928,30 @@ static ssize_t w9966_v4l_read(struct file *file, char __user *buf,
} }
// Called once for every parport on init /* Called once for every parport on init */
static void w9966_attach(struct parport *port) static void w9966_attach(struct parport *port)
{ {
int i; int i;
for (i = 0; i < W9966_MAXCAMS; i++) for (i = 0; i < W9966_MAXCAMS; i++) {
{ if (w9966_cams[i].dev_state != 0) /* Cam is already assigned */
if (w9966_cams[i].dev_state != 0) // Cam is already assigned
continue; continue;
if ( if (strcmp(pardev[i], "aggressive") == 0 || strcmp(pardev[i], port->name) == 0) {
strcmp(pardev[i], "aggressive") == 0 ||
strcmp(pardev[i], port->name) == 0
) {
if (w9966_init(&w9966_cams[i], port) != 0) if (w9966_init(&w9966_cams[i], port) != 0)
w9966_term(&w9966_cams[i]); 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) static void w9966_detach(struct parport *port)
{ {
int i; int i;
for (i = 0; i < W9966_MAXCAMS; i++) for (i = 0; i < W9966_MAXCAMS; i++)
if (w9966_cams[i].dev_state != 0 && w9966_cams[i].pport == port) if (w9966_cams[i].dev_state != 0 && w9966_cams[i].pport == port)
w9966_term(&w9966_cams[i]); w9966_term(&w9966_cams[i]);
} }
...@@ -977,17 +961,18 @@ static struct parport_driver w9966_ppd = { ...@@ -977,17 +961,18 @@ static struct parport_driver w9966_ppd = {
.detach = w9966_detach, .detach = w9966_detach,
}; };
// Module entry point /* Module entry point */
static int __init w9966_mod_init(void) static int __init w9966_mod_init(void)
{ {
int i; int i;
for (i = 0; i < W9966_MAXCAMS; i++) for (i = 0; i < W9966_MAXCAMS; i++)
w9966_cams[i].dev_state = 0; w9966_cams[i].dev_state = 0;
return parport_register_driver(&w9966_ppd); return parport_register_driver(&w9966_ppd);
} }
// Module cleanup /* Module cleanup */
static void __exit w9966_mod_term(void) static void __exit w9966_mod_term(void)
{ {
parport_unregister_driver(&w9966_ppd); parport_unregister_driver(&w9966_ppd);
......
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment
GitLab Nexedi Edition | About GitLab | About Nexedi | 沪ICP备2021021310号-2 | 沪ICP备2021021310号-7