2 * Support for the sensor part which is integrated (I think) into the
3 * st6422 stv06xx alike bridge, as its integrated there are no i2c writes
4 * but instead direct bridge writes.
6 * Copyright (c) 2009 Hans de Goede <hdegoede@redhat.com>
8 * Strongly based on qc-usb-messenger, which is:
9 * Copyright (c) 2001 Jean-Fredric Clere, Nikolas Zimmermann, Georg Acher
10 * Mark Cave-Ayland, Carlo E Prelz, Dick Streefland
11 * Copyright (c) 2002, 2003 Tuukka Toivonen
13 * This program is free software; you can redistribute it and/or modify
14 * it under the terms of the GNU General Public License as published by
15 * the Free Software Foundation; either version 2 of the License, or
16 * (at your option) any later version.
18 * This program is distributed in the hope that it will be useful,
19 * but WITHOUT ANY WARRANTY; without even the implied warranty of
20 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
21 * GNU General Public License for more details.
25 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
27 #include "stv06xx_st6422.h"
29 static struct v4l2_pix_format st6422_mode[] = {
30 /* Note we actually get 124 lines of data, of which we skip the 4st
31 4 as they are garbage */
37 .sizeimage = 162 * 120,
39 .colorspace = V4L2_COLORSPACE_SRGB,
42 /* Note we actually get 248 lines of data, of which we skip the 4st
43 4 as they are garbage, and we tell the app it only gets the
44 first 240 of the 244 lines it actually gets, so that it ignores
51 .sizeimage = 324 * 244,
53 .colorspace = V4L2_COLORSPACE_SRGB,
58 /* V4L2 controls supported by the driver */
59 static int setbrightness(struct sd *sd, s32 val);
60 static int setcontrast(struct sd *sd, s32 val);
61 static int setgain(struct sd *sd, u8 gain);
62 static int setexposure(struct sd *sd, s16 expo);
64 static int st6422_s_ctrl(struct v4l2_ctrl *ctrl)
66 struct gspca_dev *gspca_dev =
67 container_of(ctrl->handler, struct gspca_dev, ctrl_handler);
68 struct sd *sd = (struct sd *)gspca_dev;
72 case V4L2_CID_BRIGHTNESS:
73 err = setbrightness(sd, ctrl->val);
75 case V4L2_CID_CONTRAST:
76 err = setcontrast(sd, ctrl->val);
79 err = setgain(sd, ctrl->val);
81 case V4L2_CID_EXPOSURE:
82 err = setexposure(sd, ctrl->val);
88 err = stv06xx_write_bridge(sd, 0x143f, 0x01);
89 sd->gspca_dev.usb_err = err;
93 static const struct v4l2_ctrl_ops st6422_ctrl_ops = {
94 .s_ctrl = st6422_s_ctrl,
97 static int st6422_init_controls(struct sd *sd)
99 struct v4l2_ctrl_handler *hdl = &sd->gspca_dev.ctrl_handler;
101 v4l2_ctrl_handler_init(hdl, 4);
102 v4l2_ctrl_new_std(hdl, &st6422_ctrl_ops,
103 V4L2_CID_BRIGHTNESS, 0, 31, 1, 3);
104 v4l2_ctrl_new_std(hdl, &st6422_ctrl_ops,
105 V4L2_CID_CONTRAST, 0, 15, 1, 11);
106 v4l2_ctrl_new_std(hdl, &st6422_ctrl_ops,
107 V4L2_CID_EXPOSURE, 0, 1023, 1, 256);
108 v4l2_ctrl_new_std(hdl, &st6422_ctrl_ops,
109 V4L2_CID_GAIN, 0, 255, 1, 64);
114 static int st6422_probe(struct sd *sd)
116 if (sd->bridge != BRIDGE_ST6422)
119 pr_info("st6422 sensor detected\n");
121 sd->gspca_dev.cam.cam_mode = st6422_mode;
122 sd->gspca_dev.cam.nmodes = ARRAY_SIZE(st6422_mode);
126 static int st6422_init(struct sd *sd)
130 const u16 st6422_bridge_init[][2] = {
131 { STV_ISO_ENABLE, 0x00 }, /* disable capture */
133 { 0x1432, 0x03 }, /* 0x00-0x1F brightness */
134 { 0x143a, 0xf9 }, /* 0x00-0x0F contrast */
135 { 0x0509, 0x38 }, /* R */
136 { 0x050a, 0x38 }, /* G */
137 { 0x050b, 0x38 }, /* B */
142 { 0x1431, 0x00 }, /* 0x00-0x07 ??? */
143 { 0x1433, 0x34 }, /* 160x120, 0x00-0x01 night filter */
144 { 0x1438, 0x18 }, /* 640x480 */
149 /* anti-noise? 0xa2 gives a perfect image */
152 { 0x143c, 0x00 }, /* 0x00-0x01 - ??? */
155 /* shutter time 0x0000-0x03FF */
156 /* low value give good picures on moving objects (but requires much light) */
157 /* high value gives good picures in darkness (but tends to be overexposed) */
162 /* write: 1x1x xxxx */
163 /* read: 1x1x xxxx */
164 /* bit 5 == button pressed and hold if 0 */
165 /* write 0xe2,0xea */
169 /* bit 7 == button has been pressed, but not handled */
172 /* if(urb->iso_frame_desc[i].status == 0x80) { */
173 /* if(urb->iso_frame_desc[i].status == 0x88) { */
177 { 0x1500, 0x50 }, /* 0x00 - 0xFF 0x80 == compr ? */
180 /* high val-> light area gets darker */
181 /* low val -> light area gets lighter */
183 /* high val-> light area gets darker */
184 /* low val -> light area gets lighter */
186 /* high val-> light area gets darker */
187 /* low val -> light area gets lighter */
189 /* 2 : 324x248 80352 bytes */
190 /* 7 : 248x162 40176 bytes */
191 /* c+f: 162*124 20088 bytes */
196 { 0x15c3, 0x08 }, /* 0x04/0x14 ... test pictures ??? */
199 { 0x143f, 0x01 }, /* commit settings */
203 for (i = 0; i < ARRAY_SIZE(st6422_bridge_init) && !err; i++) {
204 err = stv06xx_write_bridge(sd, st6422_bridge_init[i][0],
205 st6422_bridge_init[i][1]);
211 static int setbrightness(struct sd *sd, s32 val)
213 /* val goes from 0 -> 31 */
214 return stv06xx_write_bridge(sd, 0x1432, val);
217 static int setcontrast(struct sd *sd, s32 val)
219 /* Val goes from 0 -> 15 */
220 return stv06xx_write_bridge(sd, 0x143a, val | 0xf0);
223 static int setgain(struct sd *sd, u8 gain)
227 /* Set red, green, blue, gain */
228 err = stv06xx_write_bridge(sd, 0x0509, gain);
232 err = stv06xx_write_bridge(sd, 0x050a, gain);
236 err = stv06xx_write_bridge(sd, 0x050b, gain);
240 /* 2 mystery writes */
241 err = stv06xx_write_bridge(sd, 0x050c, 0x2a);
245 return stv06xx_write_bridge(sd, 0x050d, 0x01);
248 static int setexposure(struct sd *sd, s16 expo)
252 err = stv06xx_write_bridge(sd, 0x143d, expo & 0xff);
256 return stv06xx_write_bridge(sd, 0x143e, expo >> 8);
259 static int st6422_start(struct sd *sd)
262 struct cam *cam = &sd->gspca_dev.cam;
264 if (cam->cam_mode[sd->gspca_dev.curr_mode].priv)
265 err = stv06xx_write_bridge(sd, 0x1505, 0x0f);
267 err = stv06xx_write_bridge(sd, 0x1505, 0x02);
271 /* commit settings */
272 err = stv06xx_write_bridge(sd, 0x143f, 0x01);
273 return (err < 0) ? err : 0;
276 static int st6422_stop(struct sd *sd)
278 struct gspca_dev *gspca_dev = (struct gspca_dev *)sd;
280 PDEBUG(D_STREAM, "Halting stream");