/*
* Store a set of start/stop values into the camera.
*/
static int stk_sensor_set_hw(struct stk_camera *dev,
int hstart, int hstop, int vstart, int vstop)
{
int ret;
unsigned char v;
/*
* Horizontal: 11 bits, top 8 live in hstart and hstop. Bottom 3 of
* hstart are in href[2:0], bottom 3 of hstop in href[5:3]. There is
* a mystery "edge offset" value in the top two bits of href.
*/
ret = stk_sensor_outb(dev, REG_HSTART, (hstart >> 3) & 0xff);
ret += stk_sensor_outb(dev, REG_HSTOP, (hstop >> 3) & 0xff);
ret += stk_sensor_inb(dev, REG_HREF, &v);
v = (v & 0xc0) | ((hstop & 0x7) << 3) | (hstart & 0x7);
msleep(10);
ret += stk_sensor_outb(dev, REG_HREF, v);
/*
* Vertical: similar arrangement (note: this is different from ov7670.c)
*/
ret += stk_sensor_outb(dev, REG_VSTART, (vstart >> 3) & 0xff);
ret += stk_sensor_outb(dev, REG_VSTOP, (vstop >> 3) & 0xff);
ret += stk_sensor_inb(dev, REG_VREF, &v);
v = (v & 0xc0) | ((vstop & 0x7) << 3) | (vstart & 0x7);
msleep(10);
ret += stk_sensor_outb(dev, REG_VREF, v);
return ret;
}
/* Probe the I2C bus and initialise the sensor chip */
int stk_sensor_init(struct stk_camera *dev)
{
u8 idl = 0;
u8 idh = 0;
if (stk_camera_write_reg(dev, STK_IIC_ENABLE, STK_IIC_ENABLE_YES)
|| stk_camera_write_reg(dev, STK_IIC_ADDR, SENSOR_ADDRESS)
|| stk_sensor_outb(dev, REG_COM7, COM7_RESET)) {
STK_ERROR("Sensor resetting failed\n");
return -ENODEV;
}
msleep(10);
/* Read the manufacturer ID: ov = 0x7FA2 */
if (stk_sensor_inb(dev, REG_MIDH, &idh)
|| stk_sensor_inb(dev, REG_MIDL, &idl)) {
STK_ERROR("Strange error reading sensor ID\n");
return -ENODEV;
}
if (idh != 0x7f || idl != 0xa2) {
STK_ERROR("Huh? you don't have a sensor from ovt\n");
return -ENODEV;
}
if (stk_sensor_inb(dev, REG_PID, &idh)
|| stk_sensor_inb(dev, REG_VER, &idl)) {
STK_ERROR("Could not read sensor model\n");
return -ENODEV;
}
stk_sensor_write_regvals(dev, ov_initvals);
msleep(10);
STK_INFO("OmniVision sensor detected, id %02X%02X"
" at address %x\n", idh, idl, SENSOR_ADDRESS);
return 0;
}
static int stk_sensor_set_hw(struct stk_camera *dev,
int hstart, int hstop, int vstart, int vstop)
{
int ret;
unsigned char v;
ret = stk_sensor_outb(dev, REG_HSTART, (hstart >> 3) & 0xff);
ret += stk_sensor_outb(dev, REG_HSTOP, (hstop >> 3) & 0xff);
ret += stk_sensor_inb(dev, REG_HREF, &v);
v = (v & 0xc0) | ((hstop & 0x7) << 3) | (hstart & 0x7);
msleep(10);
ret += stk_sensor_outb(dev, REG_HREF, v);
ret += stk_sensor_outb(dev, REG_VSTART, (vstart >> 3) & 0xff);
ret += stk_sensor_outb(dev, REG_VSTOP, (vstop >> 3) & 0xff);
ret += stk_sensor_inb(dev, REG_VREF, &v);
v = (v & 0xc0) | ((vstop & 0x7) << 3) | (vstart & 0x7);
msleep(10);
ret += stk_sensor_outb(dev, REG_VREF, v);
return ret;
}
int stk_sensor_wakeup(struct stk_camera *dev)
{
u8 tmp;
return stk_sensor_inb(dev, REG_COM2, &tmp)
|| stk_sensor_outb(dev, REG_COM2, tmp&~COM2_SSLEEP);
}