^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0-or-later
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * Mars-Semi MR97311A library
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) * Copyright (C) 2005 <bradlch@hotmail.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) * V4L2 by Jean-Francois Moine <http://moinejf.free.fr>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #define MODULE_NAME "mars"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include "gspca.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include "jpeg.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) MODULE_AUTHOR("Michel Xhaard <mxhaard@users.sourceforge.net>");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) MODULE_DESCRIPTION("GSPCA/Mars USB Camera Driver");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) MODULE_LICENSE("GPL");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) #define QUALITY 50
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) /* specific webcam descriptor */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) struct sd {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) struct gspca_dev gspca_dev; /* !! must be the first item */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) struct v4l2_ctrl *brightness;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) struct v4l2_ctrl *saturation;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) struct v4l2_ctrl *sharpness;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) struct v4l2_ctrl *gamma;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) struct { /* illuminator control cluster */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) struct v4l2_ctrl *illum_top;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) struct v4l2_ctrl *illum_bottom;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) u8 jpeg_hdr[JPEG_HDR_SZ];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) /* V4L2 controls supported by the driver */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) static void setbrightness(struct gspca_dev *gspca_dev, s32 val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) static void setcolors(struct gspca_dev *gspca_dev, s32 val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) static void setgamma(struct gspca_dev *gspca_dev, s32 val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) static void setsharpness(struct gspca_dev *gspca_dev, s32 val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) static const struct v4l2_pix_format vga_mode[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) {320, 240, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) .bytesperline = 320,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) .sizeimage = 320 * 240 * 3 / 8 + 590,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) .colorspace = V4L2_COLORSPACE_JPEG,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) .priv = 2},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) {640, 480, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) .bytesperline = 640,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) .sizeimage = 640 * 480 * 3 / 8 + 590,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) .colorspace = V4L2_COLORSPACE_JPEG,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) .priv = 1},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) static const __u8 mi_data[0x20] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) /* 01 02 03 04 05 06 07 08 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) 0x48, 0x22, 0x01, 0x47, 0x10, 0x00, 0x00, 0x00,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) /* 09 0a 0b 0c 0d 0e 0f 10 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) 0x00, 0x01, 0x30, 0x01, 0x30, 0x01, 0x30, 0x01,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) /* 11 12 13 14 15 16 17 18 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) 0x30, 0x00, 0x04, 0x00, 0x06, 0x01, 0xe2, 0x02,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) /* 19 1a 1b 1c 1d 1e 1f 20 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) 0x82, 0x00, 0x20, 0x17, 0x80, 0x08, 0x0c, 0x00
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) /* write <len> bytes from gspca_dev->usb_buf */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) static void reg_w(struct gspca_dev *gspca_dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) int len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) int alen, ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) if (gspca_dev->usb_err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) ret = usb_bulk_msg(gspca_dev->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) usb_sndbulkpipe(gspca_dev->dev, 4),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) gspca_dev->usb_buf,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) len,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) &alen,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) 500); /* timeout in milliseconds */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) if (ret < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) pr_err("reg write [%02x] error %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) gspca_dev->usb_buf[0], ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) gspca_dev->usb_err = ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) static void mi_w(struct gspca_dev *gspca_dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) u8 addr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) u8 value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) gspca_dev->usb_buf[0] = 0x1f;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) gspca_dev->usb_buf[1] = 0; /* control byte */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) gspca_dev->usb_buf[2] = addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) gspca_dev->usb_buf[3] = value;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) reg_w(gspca_dev, 4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) static void setbrightness(struct gspca_dev *gspca_dev, s32 val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) gspca_dev->usb_buf[0] = 0x61;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) gspca_dev->usb_buf[1] = val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) reg_w(gspca_dev, 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) static void setcolors(struct gspca_dev *gspca_dev, s32 val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) gspca_dev->usb_buf[0] = 0x5f;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) gspca_dev->usb_buf[1] = val << 3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) gspca_dev->usb_buf[2] = ((val >> 2) & 0xf8) | 0x04;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) reg_w(gspca_dev, 3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) static void setgamma(struct gspca_dev *gspca_dev, s32 val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) gspca_dev->usb_buf[0] = 0x06;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) gspca_dev->usb_buf[1] = val * 0x40;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) reg_w(gspca_dev, 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) static void setsharpness(struct gspca_dev *gspca_dev, s32 val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) gspca_dev->usb_buf[0] = 0x67;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) gspca_dev->usb_buf[1] = val * 4 + 3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) reg_w(gspca_dev, 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) static void setilluminators(struct gspca_dev *gspca_dev, bool top, bool bottom)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) /* both are off if not streaming */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) gspca_dev->usb_buf[0] = 0x22;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) if (top)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) gspca_dev->usb_buf[1] = 0x76;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) else if (bottom)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) gspca_dev->usb_buf[1] = 0x7a;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) gspca_dev->usb_buf[1] = 0x7e;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) reg_w(gspca_dev, 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) static int mars_s_ctrl(struct v4l2_ctrl *ctrl)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) struct gspca_dev *gspca_dev =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) container_of(ctrl->handler, struct gspca_dev, ctrl_handler);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) struct sd *sd = (struct sd *)gspca_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) gspca_dev->usb_err = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) if (ctrl->id == V4L2_CID_ILLUMINATORS_1) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) /* only one can be on at a time */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) if (ctrl->is_new && ctrl->val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) sd->illum_bottom->val = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) if (sd->illum_bottom->is_new && sd->illum_bottom->val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) sd->illum_top->val = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) if (!gspca_dev->streaming)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) switch (ctrl->id) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) case V4L2_CID_BRIGHTNESS:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) setbrightness(gspca_dev, ctrl->val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) case V4L2_CID_SATURATION:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) setcolors(gspca_dev, ctrl->val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) case V4L2_CID_GAMMA:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) setgamma(gspca_dev, ctrl->val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) case V4L2_CID_ILLUMINATORS_1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) setilluminators(gspca_dev, sd->illum_top->val,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) sd->illum_bottom->val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) case V4L2_CID_SHARPNESS:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) setsharpness(gspca_dev, ctrl->val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) return gspca_dev->usb_err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) static const struct v4l2_ctrl_ops mars_ctrl_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) .s_ctrl = mars_s_ctrl,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) /* this function is called at probe time */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) static int sd_init_controls(struct gspca_dev *gspca_dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) struct sd *sd = (struct sd *) gspca_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) struct v4l2_ctrl_handler *hdl = &gspca_dev->ctrl_handler;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) gspca_dev->vdev.ctrl_handler = hdl;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) v4l2_ctrl_handler_init(hdl, 6);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) sd->brightness = v4l2_ctrl_new_std(hdl, &mars_ctrl_ops,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) V4L2_CID_BRIGHTNESS, 0, 30, 1, 15);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) sd->saturation = v4l2_ctrl_new_std(hdl, &mars_ctrl_ops,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) V4L2_CID_SATURATION, 0, 255, 1, 200);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) sd->gamma = v4l2_ctrl_new_std(hdl, &mars_ctrl_ops,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) V4L2_CID_GAMMA, 0, 3, 1, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) sd->sharpness = v4l2_ctrl_new_std(hdl, &mars_ctrl_ops,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) V4L2_CID_SHARPNESS, 0, 2, 1, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) sd->illum_top = v4l2_ctrl_new_std(hdl, &mars_ctrl_ops,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) V4L2_CID_ILLUMINATORS_1, 0, 1, 1, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) sd->illum_top->flags |= V4L2_CTRL_FLAG_UPDATE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) sd->illum_bottom = v4l2_ctrl_new_std(hdl, &mars_ctrl_ops,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) V4L2_CID_ILLUMINATORS_2, 0, 1, 1, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) sd->illum_bottom->flags |= V4L2_CTRL_FLAG_UPDATE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) if (hdl->error) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) pr_err("Could not initialize controls\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) return hdl->error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) v4l2_ctrl_cluster(2, &sd->illum_top);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) /* this function is called at probe time */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) static int sd_config(struct gspca_dev *gspca_dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) const struct usb_device_id *id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) struct cam *cam;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) cam = &gspca_dev->cam;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) cam->cam_mode = vga_mode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) cam->nmodes = ARRAY_SIZE(vga_mode);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) /* this function is called at probe and resume time */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) static int sd_init(struct gspca_dev *gspca_dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) static int sd_start(struct gspca_dev *gspca_dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) struct sd *sd = (struct sd *) gspca_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) u8 *data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) /* create the JPEG header */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) jpeg_define(sd->jpeg_hdr, gspca_dev->pixfmt.height,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) gspca_dev->pixfmt.width,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) 0x21); /* JPEG 422 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) jpeg_set_qual(sd->jpeg_hdr, QUALITY);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) data = gspca_dev->usb_buf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) data[0] = 0x01; /* address */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) data[1] = 0x01;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) reg_w(gspca_dev, 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) Initialize the MR97113 chip register
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) data[0] = 0x00; /* address */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) data[1] = 0x0c | 0x01; /* reg 0 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) data[2] = 0x01; /* reg 1 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) data[3] = gspca_dev->pixfmt.width / 8; /* h_size , reg 2 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) data[4] = gspca_dev->pixfmt.height / 8; /* v_size , reg 3 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) data[5] = 0x30; /* reg 4, MI, PAS5101 :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) * 0x30 for 24mhz , 0x28 for 12mhz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) data[6] = 0x02; /* reg 5, H start - was 0x04 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) data[7] = v4l2_ctrl_g_ctrl(sd->gamma) * 0x40; /* reg 0x06: gamma */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) data[8] = 0x01; /* reg 7, V start - was 0x03 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) /* if (h_size == 320 ) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) /* data[9]= 0x56; * reg 8, 24MHz, 2:1 scale down */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) /* else */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) data[9] = 0x52; /* reg 8, 24MHz, no scale down */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) /*jfm: from win trace*/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) data[10] = 0x18;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) reg_w(gspca_dev, 11);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) data[0] = 0x23; /* address */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) data[1] = 0x09; /* reg 35, append frame header */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) reg_w(gspca_dev, 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) data[0] = 0x3c; /* address */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) /* if (gspca_dev->width == 1280) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) /* data[1] = 200; * reg 60, pc-cam frame size
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) * (unit: 4KB) 800KB */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) /* else */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) data[1] = 50; /* 50 reg 60, pc-cam frame size
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) * (unit: 4KB) 200KB */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) reg_w(gspca_dev, 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) /* auto dark-gain */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) data[0] = 0x5e; /* address */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) data[1] = 0; /* reg 94, Y Gain (auto) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) /*jfm: from win trace*/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) /* reg 0x5f/0x60 (LE) = saturation */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) /* h (60): xxxx x100
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) * l (5f): xxxx x000 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) data[2] = v4l2_ctrl_g_ctrl(sd->saturation) << 3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) data[3] = ((v4l2_ctrl_g_ctrl(sd->saturation) >> 2) & 0xf8) | 0x04;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) data[4] = v4l2_ctrl_g_ctrl(sd->brightness); /* reg 0x61 = brightness */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) data[5] = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) reg_w(gspca_dev, 6);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) data[0] = 0x67;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) /*jfm: from win trace*/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) data[1] = v4l2_ctrl_g_ctrl(sd->sharpness) * 4 + 3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) data[2] = 0x14;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) reg_w(gspca_dev, 3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) data[0] = 0x69;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) data[1] = 0x2f;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) data[2] = 0x28;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) data[3] = 0x42;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) reg_w(gspca_dev, 4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) data[0] = 0x63;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) data[1] = 0x07;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) reg_w(gspca_dev, 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) /*jfm: win trace - many writes here to reg 0x64*/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) /* initialize the MI sensor */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) for (i = 0; i < sizeof mi_data; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) mi_w(gspca_dev, i + 1, mi_data[i]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) data[0] = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) data[1] = 0x4d; /* ISOC transferring enable... */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) reg_w(gspca_dev, 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) setilluminators(gspca_dev, v4l2_ctrl_g_ctrl(sd->illum_top),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) v4l2_ctrl_g_ctrl(sd->illum_bottom));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) return gspca_dev->usb_err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) static void sd_stopN(struct gspca_dev *gspca_dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) struct sd *sd = (struct sd *) gspca_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) if (v4l2_ctrl_g_ctrl(sd->illum_top) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) v4l2_ctrl_g_ctrl(sd->illum_bottom)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) setilluminators(gspca_dev, false, false);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) msleep(20);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) gspca_dev->usb_buf[0] = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) gspca_dev->usb_buf[1] = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) reg_w(gspca_dev, 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) static void sd_pkt_scan(struct gspca_dev *gspca_dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) u8 *data, /* isoc packet */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) int len) /* iso packet length */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) struct sd *sd = (struct sd *) gspca_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) int p;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) if (len < 6) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) /* gspca_dev->last_packet_type = DISCARD_PACKET; */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) for (p = 0; p < len - 6; p++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) if (data[0 + p] == 0xff
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) && data[1 + p] == 0xff
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) && data[2 + p] == 0x00
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) && data[3 + p] == 0xff
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) && data[4 + p] == 0x96) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) if (data[5 + p] == 0x64
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) || data[5 + p] == 0x65
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) || data[5 + p] == 0x66
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) || data[5 + p] == 0x67) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) gspca_dbg(gspca_dev, D_PACK, "sof offset: %d len: %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) p, len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) gspca_frame_add(gspca_dev, LAST_PACKET,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) data, p);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) /* put the JPEG header */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) gspca_frame_add(gspca_dev, FIRST_PACKET,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) sd->jpeg_hdr, JPEG_HDR_SZ);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) data += p + 16;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) len -= p + 16;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) gspca_frame_add(gspca_dev, INTER_PACKET, data, len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) /* sub-driver description */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) static const struct sd_desc sd_desc = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) .name = MODULE_NAME,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) .config = sd_config,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) .init = sd_init,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) .init_controls = sd_init_controls,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) .start = sd_start,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) .stopN = sd_stopN,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) .pkt_scan = sd_pkt_scan,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) /* -- module initialisation -- */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) static const struct usb_device_id device_table[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) {USB_DEVICE(0x093a, 0x050f)},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) {}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) MODULE_DEVICE_TABLE(usb, device_table);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) /* -- device connect -- */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) static int sd_probe(struct usb_interface *intf,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) const struct usb_device_id *id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) return gspca_dev_probe(intf, id, &sd_desc, sizeof(struct sd),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) THIS_MODULE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) static struct usb_driver sd_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) .name = MODULE_NAME,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) .id_table = device_table,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) .probe = sd_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) .disconnect = gspca_disconnect,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) #ifdef CONFIG_PM
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) .suspend = gspca_suspend,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) .resume = gspca_resume,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) .reset_resume = gspca_resume,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) module_usb_driver(sd_driver);