leandrof/linux
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

V4L/DVB (13490): gspca - ov534: Add controls for sensor ov965x.

Browse Source 
Signed-off-by: Jean-Francois Moine <moinejf@free.fr>
Signed-off-by: Mauro Carvalho Chehab <mchehab@redhat.com>
This commit is contained in:
Jean-Francois Moine 2009-11-24 05:22:05 -03:00 committed by Mauro Carvalho Chehab
parent b8c8a5bf83
commit c22c4a20a6
1 changed files with 407 additions and 72 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

479
drivers/media/video/gspca/ov534.c
View File

@ -65,9 +65,11 @@ struct sd {
u8 hue; u8 hue;
u8 autogain; u8 autogain;
u8 awb; u8 awb;
u8 sharpness; s8 sharpness;
u8 hflip; u8 hflip;
u8 vflip; u8 vflip;
u8 satur;
u8 lightfreq;
u8 sensor; u8 sensor;
#define SENSOR_OV772X 0 #define SENSOR_OV772X 0
@ -99,6 +101,10 @@ static int sd_setbrightness(struct gspca_dev *gspca_dev, __s32 val);
static int sd_getbrightness(struct gspca_dev *gspca_dev, __s32 *val); static int sd_getbrightness(struct gspca_dev *gspca_dev, __s32 *val);
static int sd_setcontrast(struct gspca_dev *gspca_dev, __s32 val); static int sd_setcontrast(struct gspca_dev *gspca_dev, __s32 val);
static int sd_getcontrast(struct gspca_dev *gspca_dev, __s32 *val); static int sd_getcontrast(struct gspca_dev *gspca_dev, __s32 *val);
static int sd_setsatur(struct gspca_dev *gspca_dev, __s32 val);
static int sd_getsatur(struct gspca_dev *gspca_dev, __s32 *val);
static int sd_setfreq(struct gspca_dev *gspca_dev, __s32 val);
static int sd_getfreq(struct gspca_dev *gspca_dev, __s32 *val);
static struct ctrl sd_ctrls_ov772x[] = { static struct ctrl sd_ctrls_ov772x[] = {
{ /* 0 */ { /* 0 */
@ -109,8 +115,8 @@ static struct ctrl sd_ctrls_ov772x[] = {
.minimum = 0, .minimum = 0,
.maximum = 255, .maximum = 255,
.step = 1, .step = 1,
#define BRIGHTNESS_DEF 20 #define BRIGHTNESS_77_DEF 20
.default_value = BRIGHTNESS_DEF, .default_value = BRIGHTNESS_77_DEF,
}, },
.set = sd_setbrightness, .set = sd_setbrightness,
.get = sd_getbrightness, .get = sd_getbrightness,
@ -123,8 +129,8 @@ static struct ctrl sd_ctrls_ov772x[] = {
.minimum = 0, .minimum = 0,
.maximum = 255, .maximum = 255,
.step = 1, .step = 1,
#define CONTRAST_DEF 37 #define CONTRAST_77_DEF 37
.default_value = CONTRAST_DEF, .default_value = CONTRAST_77_DEF,
}, },
.set = sd_setcontrast, .set = sd_setcontrast,
.get = sd_getcontrast, .get = sd_getcontrast,
@ -151,8 +157,8 @@ static struct ctrl sd_ctrls_ov772x[] = {
.minimum = 0, .minimum = 0,
.maximum = 255, .maximum = 255,
.step = 1, .step = 1,
#define EXPO_DEF 120 #define EXPO_77_DEF 120
.default_value = EXPO_DEF, .default_value = EXPO_77_DEF,
}, },
.set = sd_setexposure, .set = sd_setexposure,
.get = sd_getexposure, .get = sd_getexposure,
@ -207,13 +213,13 @@ static struct ctrl sd_ctrls_ov772x[] = {
.minimum = 0, .minimum = 0,
.maximum = 1, .maximum = 1,
.step = 1, .step = 1,
#define AUTOGAIN_DEF 0 #define AUTOGAIN_77_DEF 0
.default_value = AUTOGAIN_DEF, .default_value = AUTOGAIN_77_DEF,
}, },
.set = sd_setautogain, .set = sd_setautogain,
.get = sd_getautogain, .get = sd_getautogain,
}, },
#define AWB_IDX 8 #define AWB_77_IDX 8
{ /* 8 */ { /* 8 */
{ {
.id = V4L2_CID_AUTO_WHITE_BALANCE, .id = V4L2_CID_AUTO_WHITE_BALANCE,
@ -236,8 +242,8 @@ static struct ctrl sd_ctrls_ov772x[] = {
.minimum = 0, .minimum = 0,
.maximum = 63, .maximum = 63,
.step = 1, .step = 1,
#define SHARPNESS_DEF 0 #define SHARPNESS_77_DEF 0
.default_value = SHARPNESS_DEF, .default_value = SHARPNESS_77_DEF,
}, },
.set = sd_setsharpness, .set = sd_setsharpness,
.get = sd_getsharpness, .get = sd_getsharpness,
@ -272,6 +278,105 @@ static struct ctrl sd_ctrls_ov772x[] = {
}, },
}; };
static struct ctrl sd_ctrls_ov965x[] = { static struct ctrl sd_ctrls_ov965x[] = {
{ /* 0 */
{
.id = V4L2_CID_BRIGHTNESS,
.type = V4L2_CTRL_TYPE_INTEGER,
.name = "Brightness",
.minimum = 0,
.maximum = 15,
.step = 1,
#define BRIGHTNESS_96_DEF 7
.default_value = BRIGHTNESS_96_DEF,
},
.set = sd_setbrightness,
.get = sd_getbrightness,
},
{ /* 1 */
{
.id = V4L2_CID_CONTRAST,
.type = V4L2_CTRL_TYPE_INTEGER,
.name = "Contrast",
.minimum = 0,
.maximum = 15,
.step = 1,
#define CONTRAST_96_DEF 3
.default_value = CONTRAST_96_DEF,
},
.set = sd_setcontrast,
.get = sd_getcontrast,
},
{ /* 2 */
{
.id = V4L2_CID_AUTOGAIN,
.type = V4L2_CTRL_TYPE_BOOLEAN,
.name = "Autogain",
.minimum = 0,
.maximum = 1,
.step = 1,
#define AUTOGAIN_96_DEF 1
.default_value = AUTOGAIN_96_DEF,
},
.set = sd_setautogain,
.get = sd_getautogain,
},
#define EXPO_96_IDX 3
{ /* 3 */
{
.id = V4L2_CID_EXPOSURE,
.type = V4L2_CTRL_TYPE_INTEGER,
.name = "Exposure",
.minimum = 0,
.maximum = 3,
.step = 1,
#define EXPO_96_DEF 0
.default_value = EXPO_96_DEF,
},
.set = sd_setexposure,
.get = sd_getexposure,
},
{ /* 4 */
{
.id = V4L2_CID_SHARPNESS,
.type = V4L2_CTRL_TYPE_INTEGER,
.name = "Sharpness",
.minimum = -1, /* -1 = auto */
.maximum = 4,
.step = 1,
#define SHARPNESS_96_DEF -1
.default_value = SHARPNESS_96_DEF,
},
.set = sd_setsharpness,
.get = sd_getsharpness,
},
{ /* 5 */
{
.id = V4L2_CID_SATURATION,
.type = V4L2_CTRL_TYPE_INTEGER,
.name = "Saturation",
.minimum = 0,
.maximum = 4,
.step = 1,
#define SATUR_DEF 2
.default_value = SATUR_DEF,
},
.set = sd_setsatur,
.get = sd_getsatur,
},
{
{
.id = V4L2_CID_POWER_LINE_FREQUENCY,
.type = V4L2_CTRL_TYPE_MENU,
.name = "Light frequency filter",
.minimum = 0,
.maximum = 2, /* 0: 0, 1: 50Hz, 2:60Hz */
.step = 1,
#define FREQ_DEF 0
.default_value = FREQ_DEF,
},
.set = sd_setfreq,
.get = sd_getfreq,
},
}; };
static const struct v4l2_pix_format ov772x_mode[] = { static const struct v4l2_pix_format ov772x_mode[] = {
@ -314,6 +419,7 @@ static const struct v4l2_pix_format ov965x_mode[] = {
.colorspace = V4L2_COLORSPACE_JPEG, .colorspace = V4L2_COLORSPACE_JPEG,
.priv = 0}, .priv = 0},
}; };
static const u8 bridge_init_ov772x[][2] = { static const u8 bridge_init_ov772x[][2] = {
{ 0xc2, 0x0c }, { 0xc2, 0x0c },
{ 0x88, 0xf8 }, { 0x88, 0xf8 },
@ -689,7 +795,7 @@ static const u8 sensor_init_ov965x[][2] = {
{0xcb, 0xf0}, {0xcb, 0xf0},
{0xcc, 0xd8}, {0xcc, 0xd8},
{0xcd, 0xf1}, {0xcd, 0xf1},
{0x4f, 0x98}, {0x4f, 0x98}, /* matrix */
{0x50, 0x98}, {0x50, 0x98},
{0x51, 0x00}, {0x51, 0x00},
{0x52, 0x28}, {0x52, 0x28},
@ -698,6 +804,7 @@ static const u8 sensor_init_ov965x[][2] = {
{0x58, 0x1a}, {0x58, 0x1a},
{0xff, 0x41}, /* read 41, write ff 00 */ {0xff, 0x41}, /* read 41, write ff 00 */
{0x41, 0x40}, /* com16 */ {0x41, 0x40}, /* com16 */
{0xc5, 0x03}, /* 60 Hz banding filter */ {0xc5, 0x03}, /* 60 Hz banding filter */
{0x6a, 0x02}, /* 50 Hz banding filter */ {0x6a, 0x02}, /* 50 Hz banding filter */
@ -741,8 +848,8 @@ static const u8 bridge_init_ov965x_2[][2] = {
{0x52, 0x3c}, {0x52, 0x3c},
{0x53, 0x00}, {0x53, 0x00},
{0x54, 0x00}, {0x54, 0x00},
{0x55, 0x00}, /* brightness */ {0x55, 0x00},
{0x57, 0x00}, /* contrast 2 */ {0x57, 0x00},
{0x5c, 0x00}, {0x5c, 0x00},
{0x5a, 0xa0}, {0x5a, 0xa0},
{0x5b, 0x78}, {0x5b, 0x78},
@ -765,14 +872,16 @@ static const u8 sensor_init_ov965x_2[][2] = {
{0xa3, 0x3e}, {0xa3, 0x3e},
{0x2d, 0x00}, {0x2d, 0x00},
{0xff, 0x42}, /* read 42, write ff 00 */ {0xff, 0x42}, /* read 42, write ff 00 */
{0x42, 0xc0}, {0x42, 0xc0}, /* com17 */
{0x2d, 0x00}, {0x2d, 0x00},
{0xff, 0x42}, /* read 42, write ff 00 */ {0xff, 0x42}, /* read 42, write ff 00 */
{0x42, 0xc1}, {0x42, 0xc1}, /* com17 */
/* sharpness */
{0x3f, 0x01}, {0x3f, 0x01},
{0xff, 0x42}, /* read 42, write ff 00 */ {0xff, 0x42}, /* read 42, write ff 00 */
{0x42, 0xc1}, {0x42, 0xc1}, /* com17 */
{0x4f, 0x98}, /* saturation */
{0x4f, 0x98}, /* matrix */
{0x50, 0x98}, {0x50, 0x98},
{0x51, 0x00}, {0x51, 0x00},
{0x52, 0x28}, {0x52, 0x28},
@ -781,8 +890,11 @@ static const u8 sensor_init_ov965x_2[][2] = {
{0x58, 0x1a}, {0x58, 0x1a},
{0xff, 0x41}, /* read 41, write ff 00 */ {0xff, 0x41}, /* read 41, write ff 00 */
{0x41, 0x40}, /* com16 */ {0x41, 0x40}, /* com16 */
/* contrast */
{0x56, 0x40}, {0x56, 0x40},
/* brightness */
{0x55, 0x8f}, {0x55, 0x8f},
/* expo */
{0x10, 0x25}, /* aech - exposure high bits */ {0x10, 0x25}, /* aech - exposure high bits */
{0xff, 0x13}, /* read 13, write ff 00 */ {0xff, 0x13}, /* read 13, write ff 00 */
{0x13, 0xe7}, /* com8 - everything (AGC, AWB and AEC) */ {0x13, 0xe7}, /* com8 - everything (AGC, AWB and AEC) */
@ -943,7 +1055,6 @@ static const u8 bridge_start_ov965x_svga[][2] = {
{0x8c, 0x00}, {0x8c, 0x00},
{0x8d, 0x1c}, {0x8d, 0x1c},
{0x34, 0x05}, {0x34, 0x05},
{0xc2, 0x4c}, {0xc2, 0x4c},
{0xc3, 0xf9}, {0xc3, 0xf9},
{0x50, 0x00}, {0x50, 0x00},
@ -1052,7 +1163,6 @@ static const u8 sensor_start_ov965x_2_svga[][2] = { /* same for xga */
{0xc5, 0x0f}, /* 60 Hz banding filter */ {0xc5, 0x0f}, /* 60 Hz banding filter */
{0xa2, 0x4e}, /* bd50 */ {0xa2, 0x4e}, /* bd50 */
{0xa3, 0x41}, /* bd60 */ {0xa3, 0x41}, /* bd60 */
{0x2d, 0x00}, /* advfl */
}; };
static const u8 sensor_start_ov965x_2_sxga[][2] = { static const u8 sensor_start_ov965x_2_sxga[][2] = {
@ -1067,15 +1177,8 @@ static const u8 sensor_start_ov965x_2_sxga[][2] = {
{0xc5, 0x0f}, /* 60 Hz banding filter */ {0xc5, 0x0f}, /* 60 Hz banding filter */
{0xa2, 0x4e}, /* bd50 */ {0xa2, 0x4e}, /* bd50 */
{0xa3, 0x41}, /* bd60 */ {0xa3, 0x41}, /* bd60 */
{0x2d, 0x00}, /* advfl */
}; };
static const u8 sensor_start_ov965x_2[][2] = {
{0xff, 0x42}, /* read 42, write ff 00 */
{0x42, 0xc1}, /* com17 - 50 Hz filter */
};
static void ov534_reg_write(struct gspca_dev *gspca_dev, u16 reg, u8 val) static void ov534_reg_write(struct gspca_dev *gspca_dev, u16 reg, u8 val)
{ {
struct usb_device *udev = gspca_dev->dev; struct usb_device *udev = gspca_dev->dev;
@ -1257,14 +1360,14 @@ static void set_frame_rate(struct gspca_dev *gspca_dev)
PDEBUG(D_PROBE, "frame_rate: %d", r->fps); PDEBUG(D_PROBE, "frame_rate: %d", r->fps);
} }
static void setbrightness(struct gspca_dev *gspca_dev) static void setbrightness_77(struct gspca_dev *gspca_dev)
{ {
struct sd *sd = (struct sd *) gspca_dev; struct sd *sd = (struct sd *) gspca_dev;
sccb_reg_write(gspca_dev, 0x9B, sd->brightness); sccb_reg_write(gspca_dev, 0x9B, sd->brightness);
} }
static void setcontrast(struct gspca_dev *gspca_dev) static void setcontrast_77(struct gspca_dev *gspca_dev)
{ {
struct sd *sd = (struct sd *) gspca_dev; struct sd *sd = (struct sd *) gspca_dev;
@ -1298,7 +1401,7 @@ static void setgain(struct gspca_dev *gspca_dev)
sccb_reg_write(gspca_dev, 0x00, val); sccb_reg_write(gspca_dev, 0x00, val);
} }
static void setexposure(struct gspca_dev *gspca_dev) static void setexposure_77(struct gspca_dev *gspca_dev)
{ {
struct sd *sd = (struct sd *) gspca_dev; struct sd *sd = (struct sd *) gspca_dev;
u8 val; u8 val;
@ -1329,7 +1432,7 @@ static void sethue(struct gspca_dev *gspca_dev)
sccb_reg_write(gspca_dev, 0x01, sd->hue); sccb_reg_write(gspca_dev, 0x01, sd->hue);
} }
static void setautogain(struct gspca_dev *gspca_dev) static void setautogain_77(struct gspca_dev *gspca_dev)
{ {
struct sd *sd = (struct sd *) gspca_dev; struct sd *sd = (struct sd *) gspca_dev;
@ -1354,7 +1457,7 @@ static void setawb(struct gspca_dev *gspca_dev)
sccb_reg_write(gspca_dev, 0x63, 0xaa); /* AWB off */ sccb_reg_write(gspca_dev, 0x63, 0xaa); /* AWB off */
} }
static void setsharpness(struct gspca_dev *gspca_dev) static void setsharpness_77(struct gspca_dev *gspca_dev)
{ {
struct sd *sd = (struct sd *) gspca_dev; struct sd *sd = (struct sd *) gspca_dev;
u8 val; u8 val;
@ -1388,6 +1491,132 @@ static void setvflip(struct gspca_dev *gspca_dev)
sccb_reg_read(gspca_dev, 0x0c) & 0x7f); sccb_reg_read(gspca_dev, 0x0c) & 0x7f);
} }
/* ov965x specific controls */
static void setbrightness_96(struct gspca_dev *gspca_dev)
{
struct sd *sd = (struct sd *) gspca_dev;
u8 val;
val = sd->brightness;
if (val < 8)
val = 15 - val; /* f .. 8 */
else
val = val - 8; /* 0 .. 7 */
sccb_reg_write(gspca_dev, 0x55, /* brtn - brightness adjustment */
0x0f | (val << 4));
}
static void setcontrast_96(struct gspca_dev *gspca_dev)
{
struct sd *sd = (struct sd *) gspca_dev;
sccb_reg_write(gspca_dev, 0x56, /* cnst1 - contrast 1 ctrl coeff */
sd->contrast << 4);
}
static void setexposure_96(struct gspca_dev *gspca_dev)
{
struct sd *sd = (struct sd *) gspca_dev;
u8 val;
static const u8 expo[4] = {0x00, 0x25, 0x38, 0x5e};
sccb_reg_write(gspca_dev, 0x10, /* aec[9:2] */
expo[sd->exposure]);
val = sccb_reg_read(gspca_dev, 0x13); /* com8 */
sccb_reg_write(gspca_dev, 0xff, 0x00);
sccb_reg_write(gspca_dev, 0x13, val);
val = sccb_reg_read(gspca_dev, 0xa1); /* aech */
sccb_reg_write(gspca_dev, 0xff, 0x00);
sccb_reg_write(gspca_dev, 0xa1, val & 0xe0); /* aec[15:10] = 0 */
}
static void setsharpness_96(struct gspca_dev *gspca_dev)
{
struct sd *sd = (struct sd *) gspca_dev;
u8 val;
val = sd->sharpness;
if (val < 0) { /* auto */
val = sccb_reg_read(gspca_dev, 0x42); /* com17 */
sccb_reg_write(gspca_dev, 0xff, 0x00);
sccb_reg_write(gspca_dev, 0x42, val | 0x40);
/* Edge enhancement strength auto adjust */
return;
}
if (val != 0)
val = 1 << (val - 1);
sccb_reg_write(gspca_dev, 0x3f, /* edge - edge enhance. factor */
val);
val = sccb_reg_read(gspca_dev, 0x42); /* com17 */
sccb_reg_write(gspca_dev, 0xff, 0x00);
sccb_reg_write(gspca_dev, 0x42, val & 0xbf);
}
static void setautogain_96(struct gspca_dev *gspca_dev)
{
struct sd *sd = (struct sd *) gspca_dev;
u8 val;
/*fixme: should adjust agc/awb/aec by different controls */
val = sd->autogain;
val = sccb_reg_read(gspca_dev, 0x13); /* com8 */
sccb_reg_write(gspca_dev, 0xff, 0x00);
if (sd->autogain)
val |= 0x05; /* agc & aec */
else
val &= 0xfa;
sccb_reg_write(gspca_dev, 0x13, val);
}
static void setsatur(struct gspca_dev *gspca_dev)
{
struct sd *sd = (struct sd *) gspca_dev;
u8 val1, val2, val3;
static const u8 matrix[5][2] = {
{0x14, 0x38},
{0x1e, 0x54},
{0x28, 0x70},
{0x32, 0x8c},
{0x48, 0x90}
};
val1 = matrix[sd->satur][0];
val2 = matrix[sd->satur][1];
val3 = val1 + val2;
sccb_reg_write(gspca_dev, 0x4f, val3); /* matrix coeff */
sccb_reg_write(gspca_dev, 0x50, val3);
sccb_reg_write(gspca_dev, 0x51, 0x00);
sccb_reg_write(gspca_dev, 0x52, val1);
sccb_reg_write(gspca_dev, 0x53, val2);
sccb_reg_write(gspca_dev, 0x54, val3);
sccb_reg_write(gspca_dev, 0x58, 0x1a); /* mtxs - coeff signs */
val1 = sccb_reg_read(gspca_dev, 0x41); /* com16 */
sccb_reg_write(gspca_dev, 0xff, 0x00);
sccb_reg_write(gspca_dev, 0x41, val1);
}
static void setfreq(struct gspca_dev *gspca_dev)
{
struct sd *sd = (struct sd *) gspca_dev;
u8 val;
val = sccb_reg_read(gspca_dev, 0x13); /* com8 */
sccb_reg_write(gspca_dev, 0xff, 0x00);
if (sd->lightfreq == 0) {
sccb_reg_write(gspca_dev, 0x13, val & 0xdf);
return;
}
sccb_reg_write(gspca_dev, 0x13, val | 0x20);
val = sccb_reg_read(gspca_dev, 0x42); /* com17 */
sccb_reg_write(gspca_dev, 0xff, 0x00);
if (sd->lightfreq == 1)
val |= 0x01;
else
val &= 0xfe;
sccb_reg_write(gspca_dev, 0x42, val);
}
/* this function is called at probe time */ /* this function is called at probe time */
static int sd_config(struct gspca_dev *gspca_dev, static int sd_config(struct gspca_dev *gspca_dev,
const struct usb_device_id *id) const struct usb_device_id *id)
@ -1413,28 +1642,47 @@ static int sd_config(struct gspca_dev *gspca_dev,
sd->frame_rate = 30; sd->frame_rate = 30;
sd->brightness = BRIGHTNESS_DEF; if (sd->sensor == SENSOR_OV772X) {
sd->contrast = CONTRAST_DEF; sd->brightness = BRIGHTNESS_77_DEF;
sd->gain = GAIN_DEF; sd->contrast = CONTRAST_77_DEF;
sd->exposure = EXPO_DEF; sd->gain = GAIN_DEF;
sd->redblc = RED_BALANCE_DEF; sd->exposure = EXPO_77_DEF;
sd->blueblc = BLUE_BALANCE_DEF; sd->redblc = RED_BALANCE_DEF;
sd->hue = HUE_DEF; sd->blueblc = BLUE_BALANCE_DEF;
#if AUTOGAIN_DEF != 0 sd->hue = HUE_DEF;
sd->autogain = AUTOGAIN_DEF; #if AUTOGAIN_77_DEF != 0
sd->autogain = AUTOGAIN_77_DEF;
#else #else
gspca_dev->ctrl_inac |= (1 << AWB_IDX); gspca_dev->ctrl_inac |= (1 << AWB_77_IDX);
#endif #endif
#if AWB_DEF != 0 #if AWB_DEF != 0
sd->awb = AWB_DEF sd->awb = AWB_DEF
#endif
#if SHARPNESS_77_DEF != 0
sd->sharpness = SHARPNESS_77_DEF;
#endif #endif
sd->sharpness = SHARPNESS_DEF;
#if HFLIP_DEF != 0 #if HFLIP_DEF != 0
sd->hflip = HFLIP_DEF; sd->hflip = HFLIP_DEF;
#endif #endif
#if VFLIP_DEF != 0 #if VFLIP_DEF != 0
sd->vflip = VFLIP_DEF; sd->vflip = VFLIP_DEF;
#endif #endif
} else {
sd->brightness = BRIGHTNESS_96_DEF;
sd->contrast = CONTRAST_96_DEF;
#if AUTOGAIN_96_DEF != 0
sd->autogain = AUTOGAIN_96_DEF;
gspca_dev->ctrl_inac |= (1 << EXPO_96_IDX);
#endif
#if EXPO_96_DEF != 0
sd->exposure = EXPO_96_DEF;
#endif
#if SHARPNESS_96_DEF != 0
sd->sharpness = SHARPNESS_96_DEF;
#endif
sd->satur = SATUR_DEF;
sd->lightfreq = FREQ_DEF;
}
return 0; return 0;
} }
@ -1517,16 +1765,16 @@ static int sd_start_ov772x(struct gspca_dev *gspca_dev)
} }
set_frame_rate(gspca_dev); set_frame_rate(gspca_dev);
setautogain(gspca_dev); setautogain_77(gspca_dev);
setawb(gspca_dev); setawb(gspca_dev);
setgain(gspca_dev); setgain(gspca_dev);
setredblc(gspca_dev); setredblc(gspca_dev);
setblueblc(gspca_dev); setblueblc(gspca_dev);
sethue(gspca_dev); sethue(gspca_dev);
setexposure(gspca_dev); setexposure_77(gspca_dev);
setbrightness(gspca_dev); setbrightness_77(gspca_dev);
setcontrast(gspca_dev); setcontrast_77(gspca_dev);
setsharpness(gspca_dev); setsharpness_77(gspca_dev);
setvflip(gspca_dev); setvflip(gspca_dev);
sethflip(gspca_dev); sethflip(gspca_dev);
@ -1583,8 +1831,14 @@ static int sd_start_ov965x(struct gspca_dev *gspca_dev)
ARRAY_SIZE(sensor_start_ov965x_2_sxga)); ARRAY_SIZE(sensor_start_ov965x_2_sxga));
break; break;
} }
sccb_w_array(gspca_dev, sensor_start_ov965x_2, setfreq(gspca_dev);
ARRAY_SIZE(sensor_start_ov965x_2)); setautogain_96(gspca_dev);
setbrightness_96(gspca_dev);
setcontrast_96(gspca_dev);
setexposure_96(gspca_dev);
setsharpness_96(gspca_dev);
setsatur(gspca_dev);
ov534_reg_write(gspca_dev, 0xe0, 0x00); ov534_reg_write(gspca_dev, 0xe0, 0x00);
ov534_reg_write(gspca_dev, 0xe0, 0x00); ov534_reg_write(gspca_dev, 0xe0, 0x00);
ov534_set_led(gspca_dev, 1); ov534_set_led(gspca_dev, 1);
@ -1687,7 +1941,7 @@ scan_next:
} while (remaining_len > 0); } while (remaining_len > 0);
} }
/* ov772x controls */ /* controls */
static int sd_setgain(struct gspca_dev *gspca_dev, __s32 val) static int sd_setgain(struct gspca_dev *gspca_dev, __s32 val)
{ {
struct sd *sd = (struct sd *) gspca_dev; struct sd *sd = (struct sd *) gspca_dev;
@ -1711,8 +1965,12 @@ static int sd_setexposure(struct gspca_dev *gspca_dev, __s32 val)
struct sd *sd = (struct sd *) gspca_dev; struct sd *sd = (struct sd *) gspca_dev;
sd->exposure = val; sd->exposure = val;
if (gspca_dev->streaming) if (gspca_dev->streaming) {
setexposure(gspca_dev); if (sd->sensor == SENSOR_OV772X)
setexposure_77(gspca_dev);
else
setexposure_96(gspca_dev);
}
return 0; return 0;
} }
@ -1729,8 +1987,12 @@ static int sd_setbrightness(struct gspca_dev *gspca_dev, __s32 val)
struct sd *sd = (struct sd *) gspca_dev; struct sd *sd = (struct sd *) gspca_dev;
sd->brightness = val; sd->brightness = val;
if (gspca_dev->streaming) if (gspca_dev->streaming) {
setbrightness(gspca_dev); if (sd->sensor == SENSOR_OV772X)
setbrightness_77(gspca_dev);
else
setbrightness_96(gspca_dev);
}
return 0; return 0;
} }
@ -1747,8 +2009,12 @@ static int sd_setcontrast(struct gspca_dev *gspca_dev, __s32 val)
struct sd *sd = (struct sd *) gspca_dev; struct sd *sd = (struct sd *) gspca_dev;
sd->contrast = val; sd->contrast = val;
if (gspca_dev->streaming) if (gspca_dev->streaming) {
setcontrast(gspca_dev); if (sd->sensor == SENSOR_OV772X)
setcontrast_77(gspca_dev);
else
setcontrast_96(gspca_dev);
}
return 0; return 0;
} }
@ -1760,6 +2026,41 @@ static int sd_getcontrast(struct gspca_dev *gspca_dev, __s32 *val)
return 0; return 0;
} }
static int sd_setsatur(struct gspca_dev *gspca_dev, __s32 val)
{
struct sd *sd = (struct sd *) gspca_dev;
sd->satur = val;
if (gspca_dev->streaming)
setsatur(gspca_dev);
return 0;
}
static int sd_getsatur(struct gspca_dev *gspca_dev, __s32 *val)
{
struct sd *sd = (struct sd *) gspca_dev;
*val = sd->satur;
return 0;
}
static int sd_setfreq(struct gspca_dev *gspca_dev, __s32 val)
{
struct sd *sd = (struct sd *) gspca_dev;
sd->lightfreq = val;
if (gspca_dev->streaming)
setfreq(gspca_dev);
return 0;
}
static int sd_getfreq(struct gspca_dev *gspca_dev, __s32 *val)
{
struct sd *sd = (struct sd *) gspca_dev;
*val = sd->lightfreq;
return 0;
}
static int sd_setredblc(struct gspca_dev *gspca_dev, __s32 val) static int sd_setredblc(struct gspca_dev *gspca_dev, __s32 val)
{ {
struct sd *sd = (struct sd *) gspca_dev; struct sd *sd = (struct sd *) gspca_dev;
@ -1820,14 +2121,24 @@ static int sd_setautogain(struct gspca_dev *gspca_dev, __s32 val)
sd->autogain = val; sd->autogain = val;
/* the auto white balance control works only when auto gain is set */ if (gspca_dev->streaming) {
if (val) if (sd->sensor == SENSOR_OV772X) {
gspca_dev->ctrl_inac &= ~(1 << AWB_IDX);
else
gspca_dev->ctrl_inac |= (1 << AWB_IDX);
if (gspca_dev->streaming) /* the auto white balance control works only
setautogain(gspca_dev); * when auto gain is set */
if (val)
gspca_dev->ctrl_inac &= ~(1 << AWB_77_IDX);
else
gspca_dev->ctrl_inac |= (1 << AWB_77_IDX);
setautogain_77(gspca_dev);
} else {
if (val)
gspca_dev->ctrl_inac |= (1 << EXPO_96_IDX);
else
gspca_dev->ctrl_inac &= ~(1 << EXPO_96_IDX);
setautogain_96(gspca_dev);
}
}
return 0; return 0;
} }
@ -1862,8 +2173,12 @@ static int sd_setsharpness(struct gspca_dev *gspca_dev, __s32 val)
struct sd *sd = (struct sd *) gspca_dev; struct sd *sd = (struct sd *) gspca_dev;
sd->sharpness = val; sd->sharpness = val;
if (gspca_dev->streaming) if (gspca_dev->streaming) {
setsharpness(gspca_dev); if (sd->sensor == SENSOR_OV772X)
setsharpness_77(gspca_dev);
else
setsharpness_96(gspca_dev);
}
return 0; return 0;
} }
@ -1952,6 +2267,27 @@ static int sd_set_streamparm(struct gspca_dev *gspca_dev,
return 0; return 0;
} }
static int sd_querymenu(struct gspca_dev *gspca_dev,
struct v4l2_querymenu *menu)
{
switch (menu->id) {
case V4L2_CID_POWER_LINE_FREQUENCY:
switch (menu->index) {
case 0: /* V4L2_CID_POWER_LINE_FREQUENCY_DISABLED */
strcpy((char *) menu->name, "NoFliker");
return 0;
case 1: /* V4L2_CID_POWER_LINE_FREQUENCY_50HZ */
strcpy((char *) menu->name, "50 Hz");
return 0;
case 2: /* V4L2_CID_POWER_LINE_FREQUENCY_60HZ */
strcpy((char *) menu->name, "60 Hz");
return 0;
}
break;
}
return -EINVAL;
}
/* sub-driver description */ /* sub-driver description */
static const struct sd_desc sd_desc_ov772x = { static const struct sd_desc sd_desc_ov772x = {
.name = MODULE_NAME, .name = MODULE_NAME,
@ -1975,8 +2311,7 @@ static const struct sd_desc sd_desc_ov965x = {
.start = sd_start_ov965x, .start = sd_start_ov965x,
.stopN = sd_stopN_ov965x, .stopN = sd_stopN_ov965x,
.pkt_scan = sd_pkt_scan, .pkt_scan = sd_pkt_scan,
.get_streamparm = sd_get_streamparm, .querymenu = sd_querymenu,
.set_streamparm = sd_set_streamparm,
}; };
/* -- module initialisation -- */ /* -- module initialisation -- */