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 enh_s, enh_e;
unsigned char scale_x, scale_y;
unsigned char regs[0x1c];
unsigned char saa7111_regs[] = {
0x21, 0x00, 0xd8, 0x23, 0x00, 0x80, 0x80, 0x00,
0x88, 0x10, 0x80, 0x40, 0x40, 0x00, 0x01, 0x00,
0x48, 0x0c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
0x00, 0x00, 0x00, 0x71, 0xe7, 0x00, 0x00, 0xc0
};
if (w*h*2 > W9966_SRAMSIZE)
{
DPRINTF("capture window exceeds SRAM size!.\n");
w = 200; h = 160;
}
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;
cam->width = w;
cam->height = h;
enh_s = 0;
enh_e = w*h*2;
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
);
regs[0x00] = 0x00;
regs[0x01] = 0x18;
regs[0x02] = scale_y;
regs[0x03] = scale_x;
regs[0x04] = (x1 & 0x0ff);
regs[0x05] = (x1 & 0x300)>>8;
regs[0x06] = (y1 & 0x0ff);
regs[0x07] = (y1 & 0x300)>>8;
regs[0x08] = (x2 & 0x0ff);
regs[0x09] = (x2 & 0x300)>>8;
regs[0x0a] = (y2 & 0x0ff);
regs[0x0c] = W9966_SRAMID;
regs[0x0d] = (enh_s& 0x000ff);
regs[0x0e] = (enh_s& 0x0ff00)>>8;
regs[0x0f] = (enh_s& 0x70000)>>16;
regs[0x10] = (enh_e& 0x000ff);
regs[0x11] = (enh_e& 0x0ff00)>>8;
regs[0x12] = (enh_e& 0x70000)>>16;
regs[0x13] = 0x40;
regs[0x17] = 0x00;
regs[0x18] = cam->i2c_state = 0x00;
regs[0x19] = 0xff;
regs[0x1a] = 0xff;
regs[0x1b] = 0x10;
saa7111_regs[0x0a] = cam->brightness;
saa7111_regs[0x0b] = cam->contrast;
saa7111_regs[0x0c] = cam->color;
saa7111_regs[0x0d] = cam->hue;
if (w9966_wReg(cam, 0x00, 0x03) == -1)
return -1;
for (i = 0; i < 0x1c; i++)
if (w9966_wReg(cam, i, regs[i]) == -1)
return -1;
for (i = 0; i < 0x20; i++)
if (w9966_wReg_i2c(cam, i, saa7111_regs[i]) == -1)
return -1;
return 0;
}
// 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;
unsigned int enh_s, enh_e;
unsigned char scale_x, scale_y;
unsigned char regs[0x1c];
unsigned char saa7111_regs[] = {
0x21, 0x00, 0xd8, 0x23, 0x00, 0x80, 0x80, 0x00,
0x88, 0x10, 0x80, 0x40, 0x40, 0x00, 0x01, 0x00,
0x48, 0x0c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
0x00, 0x00, 0x00, 0x71, 0xe7, 0x00, 0x00, 0xc0
};
if (w*h*2 > W9966_SRAMSIZE)
{
DPRINTF("capture window exceeds SRAM size!.\n");
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;
cam->width = w;
cam->height = h;
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;
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
// 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)
// 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; // ???
// 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)
if (w9966_wReg(cam, 0x00, 0x03) == -1)
return -1;
// 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
for (i = 0; i < 0x20; i++)
if (w9966_wReg_i2c(cam, i, saa7111_regs[i]) == -1)
return -1;
return 0;
}
// Setup the w9966 capture window and also set SRAM settings
// expects a claimed pdev and detected camera model
// 1 on success, else 0
static int w9966_window(struct w9966_dev* cam, int x1, int y1, int x2, int y2, int w, int h)
{
unsigned int enh_s, enh_e;
u8 scale_x, scale_y;
u8 regs[0x13];
int i;
// Modify width and height to match capture window and SRAM
w = MAX(W9966_WND_MIN_W, w);
h = MAX(W9966_WND_MIN_H, h);
w = MIN(cam->max_x - cam->min_x, w);
h = MIN(cam->max_y - cam->min_y, h);
w &= ~0x1;
if (w*h*2 > cam->sramsize)
h = cam->sramsize / (w*2);
cam->width = w;
cam->height = h;
enh_s = 0;
enh_e = w*h*2;
// Calculate downscaling
if (!w9966_calcscale(w, cam->min_x, cam->max_x, &x1, &x2, &scale_x) ||
!w9966_calcscale(h, cam->min_y, cam->max_y, &y1, &y2, &scale_y))
return 0;
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] = cam->cmask; // 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)
regs[0x0c] = cam->sramid; // SRAM layout
// 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??)
// Write regs to w9966cf chip
for (i = 0x01; i < 0x13; i++)
if (!w9966_wreg(cam, i, regs[i]))
return 0;
return 1;
}
