1 // SPDX-License-Identifier: GPL-2.0-or-later 2 /* 3 * Copyright (c) 2001 Jean-Fredric Clere, Nikolas Zimmermann, Georg Acher 4 * Mark Cave-Ayland, Carlo E Prelz, Dick Streefland 5 * Copyright (c) 2002, 2003 Tuukka Toivonen 6 * Copyright (c) 2008 Erik Andrén 7 * 8 * P/N 861037: Sensor HDCS1000 ASIC STV0600 9 * P/N 861050-0010: Sensor HDCS1000 ASIC STV0600 10 * P/N 861050-0020: Sensor Photobit PB100 ASIC STV0600-1 - QuickCam Express 11 * P/N 861055: Sensor ST VV6410 ASIC STV0610 - LEGO cam 12 * P/N 861075-0040: Sensor HDCS1000 ASIC 13 * P/N 961179-0700: Sensor ST VV6410 ASIC STV0602 - Dexxa WebCam USB 14 * P/N 861040-0000: Sensor ST VV6410 ASIC STV0610 - QuickCam Web 15 */ 16 17 /* 18 * The spec file for the PB-0100 suggests the following for best quality 19 * images after the sensor has been reset : 20 * 21 * PB_ADCGAINL = R60 = 0x03 (3 dec) : sets low reference of ADC 22 to produce good black level 23 * PB_PREADCTRL = R32 = 0x1400 (5120 dec) : Enables global gain changes 24 through R53 25 * PB_ADCMINGAIN = R52 = 0x10 (16 dec) : Sets the minimum gain for 26 auto-exposure 27 * PB_ADCGLOBALGAIN = R53 = 0x10 (16 dec) : Sets the global gain 28 * PB_EXPGAIN = R14 = 0x11 (17 dec) : Sets the auto-exposure value 29 * PB_UPDATEINT = R23 = 0x02 (2 dec) : Sets the speed on 30 auto-exposure routine 31 * PB_CFILLIN = R5 = 0x0E (14 dec) : Sets the frame rate 32 */ 33 34 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt 35 36 #include "stv06xx_pb0100.h" 37 38 struct 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 50 static 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_VGA 62 }, 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 = 0 72 } 73 }; 74 75 static 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 102 static const struct v4l2_ctrl_ops pb0100_ctrl_ops = { 103 .s_ctrl = pb0100_s_ctrl, 104 }; 105 106 static 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 155 static 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 175 static 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 else 199 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 232 static 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"); 246 out: 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 */ 254 static 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 transition 272 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 316 static int pb0100_dump(struct sd *sd) 317 { 318 return 0; 319 } 320 321 static 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 341 static 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 360 static 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 379 static 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 391 static 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 else 401 val = BIT(4)|BIT(0); 402 } else 403 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 412 static 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