433 lines · c
1// SPDX-License-Identifier: GPL-2.0-or-later2/*3 * Copyright (c) 2001 Jean-Fredric Clere, Nikolas Zimmermann, Georg Acher4 * Mark Cave-Ayland, Carlo E Prelz, Dick Streefland5 * Copyright (c) 2002, 2003 Tuukka Toivonen6 * Copyright (c) 2008 Erik Andrén7 *8 * P/N 861037: Sensor HDCS1000 ASIC STV06009 * P/N 861050-0010: Sensor HDCS1000 ASIC STV060010 * P/N 861050-0020: Sensor Photobit PB100 ASIC STV0600-1 - QuickCam Express11 * P/N 861055: Sensor ST VV6410 ASIC STV0610 - LEGO cam12 * P/N 861075-0040: Sensor HDCS1000 ASIC13 * P/N 961179-0700: Sensor ST VV6410 ASIC STV0602 - Dexxa WebCam USB14 * P/N 861040-0000: Sensor ST VV6410 ASIC STV0610 - QuickCam Web15 */16 17/*18 * The spec file for the PB-0100 suggests the following for best quality19 * images after the sensor has been reset :20 *21 * PB_ADCGAINL = R60 = 0x03 (3 dec) : sets low reference of ADC22 to produce good black level23 * PB_PREADCTRL = R32 = 0x1400 (5120 dec) : Enables global gain changes24 through R5325 * PB_ADCMINGAIN = R52 = 0x10 (16 dec) : Sets the minimum gain for26 auto-exposure27 * PB_ADCGLOBALGAIN = R53 = 0x10 (16 dec) : Sets the global gain28 * PB_EXPGAIN = R14 = 0x11 (17 dec) : Sets the auto-exposure value29 * PB_UPDATEINT = R23 = 0x02 (2 dec) : Sets the speed on30 auto-exposure routine31 * PB_CFILLIN = R5 = 0x0E (14 dec) : Sets the frame rate32 */33 34#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt35 36#include "stv06xx_pb0100.h"37 38struct pb0100_ctrls {39 struct { /* one big happy control cluster... */40 struct v4l2_ctrl *autogain;41 struct v4l2_ctrl *gain;42 struct v4l2_ctrl *exposure;43 struct v4l2_ctrl *red;44 struct v4l2_ctrl *blue;45 struct v4l2_ctrl *natural;46 };47 struct v4l2_ctrl *target;48};49 50static struct v4l2_pix_format pb0100_mode[] = {51/* low res / subsample modes disabled as they are only half res horizontal,52 halving the vertical resolution does not seem to work */53 {54 320,55 240,56 V4L2_PIX_FMT_SGRBG8,57 V4L2_FIELD_NONE,58 .sizeimage = 320 * 240,59 .bytesperline = 320,60 .colorspace = V4L2_COLORSPACE_SRGB,61 .priv = PB0100_CROP_TO_VGA62 },63 {64 352,65 288,66 V4L2_PIX_FMT_SGRBG8,67 V4L2_FIELD_NONE,68 .sizeimage = 352 * 288,69 .bytesperline = 352,70 .colorspace = V4L2_COLORSPACE_SRGB,71 .priv = 072 }73};74 75static int pb0100_s_ctrl(struct v4l2_ctrl *ctrl)76{77 struct gspca_dev *gspca_dev =78 container_of(ctrl->handler, struct gspca_dev, ctrl_handler);79 struct sd *sd = (struct sd *)gspca_dev;80 struct pb0100_ctrls *ctrls = sd->sensor_priv;81 int err = -EINVAL;82 83 switch (ctrl->id) {84 case V4L2_CID_AUTOGAIN:85 err = pb0100_set_autogain(gspca_dev, ctrl->val);86 if (err)87 break;88 if (ctrl->val)89 break;90 err = pb0100_set_gain(gspca_dev, ctrls->gain->val);91 if (err)92 break;93 err = pb0100_set_exposure(gspca_dev, ctrls->exposure->val);94 break;95 case V4L2_CTRL_CLASS_USER + 0x1001:96 err = pb0100_set_autogain_target(gspca_dev, ctrl->val);97 break;98 }99 return err;100}101 102static const struct v4l2_ctrl_ops pb0100_ctrl_ops = {103 .s_ctrl = pb0100_s_ctrl,104};105 106static int pb0100_init_controls(struct sd *sd)107{108 struct v4l2_ctrl_handler *hdl = &sd->gspca_dev.ctrl_handler;109 struct pb0100_ctrls *ctrls;110 static const struct v4l2_ctrl_config autogain_target = {111 .ops = &pb0100_ctrl_ops,112 .id = V4L2_CTRL_CLASS_USER + 0x1000,113 .type = V4L2_CTRL_TYPE_INTEGER,114 .name = "Automatic Gain Target",115 .max = 255,116 .step = 1,117 .def = 128,118 };119 static const struct v4l2_ctrl_config natural_light = {120 .ops = &pb0100_ctrl_ops,121 .id = V4L2_CTRL_CLASS_USER + 0x1001,122 .type = V4L2_CTRL_TYPE_BOOLEAN,123 .name = "Natural Light Source",124 .max = 1,125 .step = 1,126 .def = 1,127 };128 129 ctrls = kzalloc(sizeof(*ctrls), GFP_KERNEL);130 if (!ctrls)131 return -ENOMEM;132 133 v4l2_ctrl_handler_init(hdl, 6);134 ctrls->autogain = v4l2_ctrl_new_std(hdl, &pb0100_ctrl_ops,135 V4L2_CID_AUTOGAIN, 0, 1, 1, 1);136 ctrls->exposure = v4l2_ctrl_new_std(hdl, &pb0100_ctrl_ops,137 V4L2_CID_EXPOSURE, 0, 511, 1, 12);138 ctrls->gain = v4l2_ctrl_new_std(hdl, &pb0100_ctrl_ops,139 V4L2_CID_GAIN, 0, 255, 1, 128);140 ctrls->red = v4l2_ctrl_new_std(hdl, &pb0100_ctrl_ops,141 V4L2_CID_RED_BALANCE, -255, 255, 1, 0);142 ctrls->blue = v4l2_ctrl_new_std(hdl, &pb0100_ctrl_ops,143 V4L2_CID_BLUE_BALANCE, -255, 255, 1, 0);144 ctrls->natural = v4l2_ctrl_new_custom(hdl, &natural_light, NULL);145 ctrls->target = v4l2_ctrl_new_custom(hdl, &autogain_target, NULL);146 if (hdl->error) {147 kfree(ctrls);148 return hdl->error;149 }150 sd->sensor_priv = ctrls;151 v4l2_ctrl_auto_cluster(5, &ctrls->autogain, 0, false);152 return 0;153}154 155static int pb0100_probe(struct sd *sd)156{157 u16 sensor;158 int err;159 160 err = stv06xx_read_sensor(sd, PB_IDENT, &sensor);161 162 if (err < 0)163 return -ENODEV;164 if ((sensor >> 8) != 0x64)165 return -ENODEV;166 167 pr_info("Photobit pb0100 sensor detected\n");168 169 sd->gspca_dev.cam.cam_mode = pb0100_mode;170 sd->gspca_dev.cam.nmodes = ARRAY_SIZE(pb0100_mode);171 172 return 0;173}174 175static int pb0100_start(struct sd *sd)176{177 int err, packet_size, max_packet_size;178 struct usb_host_interface *alt;179 struct usb_interface *intf;180 struct gspca_dev *gspca_dev = (struct gspca_dev *)sd;181 struct cam *cam = &sd->gspca_dev.cam;182 u32 mode = cam->cam_mode[sd->gspca_dev.curr_mode].priv;183 184 intf = usb_ifnum_to_if(sd->gspca_dev.dev, sd->gspca_dev.iface);185 alt = usb_altnum_to_altsetting(intf, sd->gspca_dev.alt);186 if (!alt)187 return -ENODEV;188 189 if (alt->desc.bNumEndpoints < 1)190 return -ENODEV;191 192 packet_size = le16_to_cpu(alt->endpoint[0].desc.wMaxPacketSize);193 194 /* If we don't have enough bandwidth use a lower framerate */195 max_packet_size = sd->sensor->max_packet_size[sd->gspca_dev.curr_mode];196 if (packet_size < max_packet_size)197 stv06xx_write_sensor(sd, PB_ROWSPEED, BIT(4)|BIT(3)|BIT(1));198 else199 stv06xx_write_sensor(sd, PB_ROWSPEED, BIT(5)|BIT(3)|BIT(1));200 201 /* Setup sensor window */202 if (mode & PB0100_CROP_TO_VGA) {203 stv06xx_write_sensor(sd, PB_RSTART, 30);204 stv06xx_write_sensor(sd, PB_CSTART, 20);205 stv06xx_write_sensor(sd, PB_RWSIZE, 240 - 1);206 stv06xx_write_sensor(sd, PB_CWSIZE, 320 - 1);207 } else {208 stv06xx_write_sensor(sd, PB_RSTART, 8);209 stv06xx_write_sensor(sd, PB_CSTART, 4);210 stv06xx_write_sensor(sd, PB_RWSIZE, 288 - 1);211 stv06xx_write_sensor(sd, PB_CWSIZE, 352 - 1);212 }213 214 if (mode & PB0100_SUBSAMPLE) {215 stv06xx_write_bridge(sd, STV_Y_CTRL, 0x02); /* Wrong, FIXME */216 stv06xx_write_bridge(sd, STV_X_CTRL, 0x06);217 218 stv06xx_write_bridge(sd, STV_SCAN_RATE, 0x10);219 } else {220 stv06xx_write_bridge(sd, STV_Y_CTRL, 0x01);221 stv06xx_write_bridge(sd, STV_X_CTRL, 0x0a);222 /* larger -> slower */223 stv06xx_write_bridge(sd, STV_SCAN_RATE, 0x20);224 }225 226 err = stv06xx_write_sensor(sd, PB_CONTROL, BIT(5)|BIT(3)|BIT(1));227 gspca_dbg(gspca_dev, D_STREAM, "Started stream, status: %d\n", err);228 229 return (err < 0) ? err : 0;230}231 232static int pb0100_stop(struct sd *sd)233{234 struct gspca_dev *gspca_dev = (struct gspca_dev *)sd;235 int err;236 237 err = stv06xx_write_sensor(sd, PB_ABORTFRAME, 1);238 239 if (err < 0)240 goto out;241 242 /* Set bit 1 to zero */243 err = stv06xx_write_sensor(sd, PB_CONTROL, BIT(5)|BIT(3));244 245 gspca_dbg(gspca_dev, D_STREAM, "Halting stream\n");246out:247 return (err < 0) ? err : 0;248}249 250/* FIXME: Sort the init commands out and put them into tables,251 this is only for getting the camera to work */252/* FIXME: No error handling for now,253 add this once the init has been converted to proper tables */254static int pb0100_init(struct sd *sd)255{256 stv06xx_write_bridge(sd, STV_REG00, 1);257 stv06xx_write_bridge(sd, STV_SCAN_RATE, 0);258 259 /* Reset sensor */260 stv06xx_write_sensor(sd, PB_RESET, 1);261 stv06xx_write_sensor(sd, PB_RESET, 0);262 263 /* Disable chip */264 stv06xx_write_sensor(sd, PB_CONTROL, BIT(5)|BIT(3));265 266 /* Gain stuff...*/267 stv06xx_write_sensor(sd, PB_PREADCTRL, BIT(12)|BIT(10)|BIT(6));268 stv06xx_write_sensor(sd, PB_ADCGLOBALGAIN, 12);269 270 /* Set up auto-exposure */271 /* ADC VREF_HI new setting for a transition272 from the Expose1 to the Expose2 setting */273 stv06xx_write_sensor(sd, PB_R28, 12);274 /* gain max for autoexposure */275 stv06xx_write_sensor(sd, PB_ADCMAXGAIN, 180);276 /* gain min for autoexposure */277 stv06xx_write_sensor(sd, PB_ADCMINGAIN, 12);278 /* Maximum frame integration time (programmed into R8)279 allowed for auto-exposure routine */280 stv06xx_write_sensor(sd, PB_R54, 3);281 /* Minimum frame integration time (programmed into R8)282 allowed for auto-exposure routine */283 stv06xx_write_sensor(sd, PB_R55, 0);284 stv06xx_write_sensor(sd, PB_UPDATEINT, 1);285 /* R15 Expose0 (maximum that auto-exposure may use) */286 stv06xx_write_sensor(sd, PB_R15, 800);287 /* R17 Expose2 (minimum that auto-exposure may use) */288 stv06xx_write_sensor(sd, PB_R17, 10);289 290 stv06xx_write_sensor(sd, PB_EXPGAIN, 0);291 292 /* 0x14 */293 stv06xx_write_sensor(sd, PB_VOFFSET, 0);294 /* 0x0D */295 stv06xx_write_sensor(sd, PB_ADCGAINH, 11);296 /* Set black level (important!) */297 stv06xx_write_sensor(sd, PB_ADCGAINL, 0);298 299 /* ??? */300 stv06xx_write_bridge(sd, STV_REG00, 0x11);301 stv06xx_write_bridge(sd, STV_REG03, 0x45);302 stv06xx_write_bridge(sd, STV_REG04, 0x07);303 304 /* Scan/timing for the sensor */305 stv06xx_write_sensor(sd, PB_ROWSPEED, BIT(4)|BIT(3)|BIT(1));306 stv06xx_write_sensor(sd, PB_CFILLIN, 14);307 stv06xx_write_sensor(sd, PB_VBL, 0);308 stv06xx_write_sensor(sd, PB_FINTTIME, 0);309 stv06xx_write_sensor(sd, PB_RINTTIME, 123);310 311 stv06xx_write_bridge(sd, STV_REG01, 0xc2);312 stv06xx_write_bridge(sd, STV_REG02, 0xb0);313 return 0;314}315 316static int pb0100_dump(struct sd *sd)317{318 return 0;319}320 321static int pb0100_set_gain(struct gspca_dev *gspca_dev, __s32 val)322{323 int err;324 struct sd *sd = (struct sd *) gspca_dev;325 struct pb0100_ctrls *ctrls = sd->sensor_priv;326 327 err = stv06xx_write_sensor(sd, PB_G1GAIN, val);328 if (!err)329 err = stv06xx_write_sensor(sd, PB_G2GAIN, val);330 gspca_dbg(gspca_dev, D_CONF, "Set green gain to %d, status: %d\n",331 val, err);332 333 if (!err)334 err = pb0100_set_red_balance(gspca_dev, ctrls->red->val);335 if (!err)336 err = pb0100_set_blue_balance(gspca_dev, ctrls->blue->val);337 338 return err;339}340 341static int pb0100_set_red_balance(struct gspca_dev *gspca_dev, __s32 val)342{343 int err;344 struct sd *sd = (struct sd *) gspca_dev;345 struct pb0100_ctrls *ctrls = sd->sensor_priv;346 347 val += ctrls->gain->val;348 if (val < 0)349 val = 0;350 else if (val > 255)351 val = 255;352 353 err = stv06xx_write_sensor(sd, PB_RGAIN, val);354 gspca_dbg(gspca_dev, D_CONF, "Set red gain to %d, status: %d\n",355 val, err);356 357 return err;358}359 360static int pb0100_set_blue_balance(struct gspca_dev *gspca_dev, __s32 val)361{362 int err;363 struct sd *sd = (struct sd *) gspca_dev;364 struct pb0100_ctrls *ctrls = sd->sensor_priv;365 366 val += ctrls->gain->val;367 if (val < 0)368 val = 0;369 else if (val > 255)370 val = 255;371 372 err = stv06xx_write_sensor(sd, PB_BGAIN, val);373 gspca_dbg(gspca_dev, D_CONF, "Set blue gain to %d, status: %d\n",374 val, err);375 376 return err;377}378 379static int pb0100_set_exposure(struct gspca_dev *gspca_dev, __s32 val)380{381 struct sd *sd = (struct sd *) gspca_dev;382 int err;383 384 err = stv06xx_write_sensor(sd, PB_RINTTIME, val);385 gspca_dbg(gspca_dev, D_CONF, "Set exposure to %d, status: %d\n",386 val, err);387 388 return err;389}390 391static int pb0100_set_autogain(struct gspca_dev *gspca_dev, __s32 val)392{393 int err;394 struct sd *sd = (struct sd *) gspca_dev;395 struct pb0100_ctrls *ctrls = sd->sensor_priv;396 397 if (val) {398 if (ctrls->natural->val)399 val = BIT(6)|BIT(4)|BIT(0);400 else401 val = BIT(4)|BIT(0);402 } else403 val = 0;404 405 err = stv06xx_write_sensor(sd, PB_EXPGAIN, val);406 gspca_dbg(gspca_dev, D_CONF, "Set autogain to %d (natural: %d), status: %d\n",407 val, ctrls->natural->val, err);408 409 return err;410}411 412static int pb0100_set_autogain_target(struct gspca_dev *gspca_dev, __s32 val)413{414 int err, totalpixels, brightpixels, darkpixels;415 struct sd *sd = (struct sd *) gspca_dev;416 417 /* Number of pixels counted by the sensor when subsampling the pixels.418 * Slightly larger than the real value to avoid oscillation */419 totalpixels = gspca_dev->pixfmt.width * gspca_dev->pixfmt.height;420 totalpixels = totalpixels/(8*8) + totalpixels/(64*64);421 422 brightpixels = (totalpixels * val) >> 8;423 darkpixels = totalpixels - brightpixels;424 err = stv06xx_write_sensor(sd, PB_R21, brightpixels);425 if (!err)426 err = stv06xx_write_sensor(sd, PB_R22, darkpixels);427 428 gspca_dbg(gspca_dev, D_CONF, "Set autogain target to %d, status: %d\n",429 val, err);430 431 return err;432}433