[mirror_ubuntu-artful-kernel.git] / drivers / media / usb / gspca / pac207.c

/*
 * Pixart PAC207BCA library
 *
 * Copyright (C) 2008 Hans de Goede <hdegoede@redhat.com>
 * Copyright (C) 2005 Thomas Kaiser thomas@kaiser-linux.li
 * Copyleft (C) 2005 Michel Xhaard mxhaard@magic.fr
 *
 * V4L2 by Jean-Francois Moine <http://moinejf.free.fr>
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
 *
 */

#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

#define MODULE_NAME "pac207"

#include <linux/input.h>
#include "gspca.h"
/* Include pac common sof detection functions */
#include "pac_common.h"

MODULE_AUTHOR("Hans de Goede <hdegoede@redhat.com>");
MODULE_DESCRIPTION("Pixart PAC207");
MODULE_LICENSE("GPL");

#define PAC207_CTRL_TIMEOUT		100  /* ms */

#define PAC207_BRIGHTNESS_MIN		0
#define PAC207_BRIGHTNESS_MAX		255
#define PAC207_BRIGHTNESS_DEFAULT	46
#define PAC207_BRIGHTNESS_REG		0x08

#define PAC207_EXPOSURE_MIN		3
#define PAC207_EXPOSURE_MAX		90 /* 1 sec expo time / 1 fps */
#define PAC207_EXPOSURE_DEFAULT		5 /* power on default: 3 */
#define PAC207_EXPOSURE_REG		0x02

#define PAC207_GAIN_MIN			0
#define PAC207_GAIN_MAX			31
#define PAC207_GAIN_DEFAULT		7 /* power on default: 9 */
#define PAC207_GAIN_REG			0x0e

#define PAC207_AUTOGAIN_DEADZONE	30

/* global parameters */
static int led_invert;
module_param(led_invert, int, 0644);
MODULE_PARM_DESC(led_invert, "Invert led");

/* specific webcam descriptor */
struct sd {
	struct gspca_dev gspca_dev;		/* !! must be the first item */

	struct v4l2_ctrl *brightness;

	u8 mode;
	u8 sof_read;
	u8 header_read;
	u8 autogain_ignore_frames;

	atomic_t avg_lum;
};

static const struct v4l2_pix_format sif_mode[] = {
	{176, 144, V4L2_PIX_FMT_PAC207, V4L2_FIELD_NONE,
		.bytesperline = 176,
		.sizeimage = (176 + 2) * 144,
			/* uncompressed, add 2 bytes / line for line header */
		.colorspace = V4L2_COLORSPACE_SRGB,
		.priv = 1},
	{352, 288, V4L2_PIX_FMT_PAC207, V4L2_FIELD_NONE,
		.bytesperline = 352,
			/* compressed, but only when needed (not compressed
			   when the framerate is low) */
		.sizeimage = (352 + 2) * 288,
		.colorspace = V4L2_COLORSPACE_SRGB,
		.priv = 0},
};

static const __u8 pac207_sensor_init[][8] = {
	{0x10, 0x12, 0x0d, 0x12, 0x0c, 0x01, 0x29, 0x84},
	{0x49, 0x64, 0x64, 0x64, 0x04, 0x10, 0xf0, 0x30},
	{0x00, 0x00, 0x00, 0x70, 0xa0, 0xf8, 0x00, 0x00},
	{0x32, 0x00, 0x96, 0x00, 0xa2, 0x02, 0xaf, 0x00},
};

static void pac207_write_regs(struct gspca_dev *gspca_dev, u16 index,
	const u8 *buffer, u16 length)
{
	struct usb_device *udev = gspca_dev->dev;
	int err;

	if (gspca_dev->usb_err < 0)
		return;

	memcpy(gspca_dev->usb_buf, buffer, length);

	err = usb_control_msg(udev, usb_sndctrlpipe(udev, 0), 0x01,
			USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_INTERFACE,
			0x00, index,
			gspca_dev->usb_buf, length, PAC207_CTRL_TIMEOUT);
	if (err < 0) {
		pr_err("Failed to write registers to index 0x%04X, error %d\n",
		       index, err);
		gspca_dev->usb_err = err;
	}
}

static void pac207_write_reg(struct gspca_dev *gspca_dev, u16 index, u16 value)
{
	struct usb_device *udev = gspca_dev->dev;
	int err;

	if (gspca_dev->usb_err < 0)
		return;

	err = usb_control_msg(udev, usb_sndctrlpipe(udev, 0), 0x00,
			USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_INTERFACE,
			value, index, NULL, 0, PAC207_CTRL_TIMEOUT);
	if (err) {
		pr_err("Failed to write a register (index 0x%04X, value 0x%02X, error %d)\n",
		       index, value, err);
		gspca_dev->usb_err = err;
	}
}

static int pac207_read_reg(struct gspca_dev *gspca_dev, u16 index)
{
	struct usb_device *udev = gspca_dev->dev;
	int res;

	if (gspca_dev->usb_err < 0)
		return 0;

	res = usb_control_msg(udev, usb_rcvctrlpipe(udev, 0), 0x00,
			USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_INTERFACE,
			0x00, index,
			gspca_dev->usb_buf, 1, PAC207_CTRL_TIMEOUT);
	if (res < 0) {
		pr_err("Failed to read a register (index 0x%04X, error %d)\n",
		       index, res);
		gspca_dev->usb_err = res;
		return 0;
	}

	return gspca_dev->usb_buf[0];
}

/* this function is called at probe time */
static int sd_config(struct gspca_dev *gspca_dev,
			const struct usb_device_id *id)
{
	struct cam *cam;
	u8 idreg[2];

	idreg[0] = pac207_read_reg(gspca_dev, 0x0000);
	idreg[1] = pac207_read_reg(gspca_dev, 0x0001);
	idreg[0] = ((idreg[0] & 0x0f) << 4) | ((idreg[1] & 0xf0) >> 4);
	idreg[1] = idreg[1] & 0x0f;
	PDEBUG(D_PROBE, "Pixart Sensor ID 0x%02X Chips ID 0x%02X",
		idreg[0], idreg[1]);

	if (idreg[0] != 0x27) {
		PDEBUG(D_PROBE, "Error invalid sensor ID!");
		return -ENODEV;
	}

	PDEBUG(D_PROBE,
		"Pixart PAC207BCA Image Processor and Control Chip detected (vid/pid 0x%04X:0x%04X)",
		id->idVendor, id->idProduct);

	cam = &gspca_dev->cam;
	cam->cam_mode = sif_mode;
	cam->nmodes = ARRAY_SIZE(sif_mode);

	return 0;
}

/* this function is called at probe and resume time */
static int sd_init(struct gspca_dev *gspca_dev)
{
	u8 mode;

	/* mode: Image Format (Bit 0), LED (1), Compr. test mode (2) */
	if (led_invert)
		mode = 0x02;
	else
		mode = 0x00;
	pac207_write_reg(gspca_dev, 0x41, mode);
	pac207_write_reg(gspca_dev, 0x0f, 0x00); /* Power Control */

	return gspca_dev->usb_err;
}

static void setcontrol(struct gspca_dev *gspca_dev, u16 reg, u16 val)
{
	pac207_write_reg(gspca_dev, reg, val);
	pac207_write_reg(gspca_dev, 0x13, 0x01);	/* Bit 0, auto clear */
	pac207_write_reg(gspca_dev, 0x1c, 0x01);	/* not documented */
}

static int sd_s_ctrl(struct v4l2_ctrl *ctrl)
{
	struct gspca_dev *gspca_dev =
		container_of(ctrl->handler, struct gspca_dev, ctrl_handler);
	struct sd *sd = (struct sd *)gspca_dev;

	gspca_dev->usb_err = 0;

	if (ctrl->id == V4L2_CID_AUTOGAIN && ctrl->is_new && ctrl->val) {
		/* when switching to autogain set defaults to make sure
		   we are on a valid point of the autogain gain /
		   exposure knee graph, and give this change time to
		   take effect before doing autogain. */
		gspca_dev->exposure->val    = PAC207_EXPOSURE_DEFAULT;
		gspca_dev->gain->val        = PAC207_GAIN_DEFAULT;
		sd->autogain_ignore_frames  = PAC_AUTOGAIN_IGNORE_FRAMES;
	}

	if (!gspca_dev->streaming)
		return 0;

	switch (ctrl->id) {
	case V4L2_CID_BRIGHTNESS:
		setcontrol(gspca_dev, PAC207_BRIGHTNESS_REG, ctrl->val);
		break;
	case V4L2_CID_AUTOGAIN:
		if (gspca_dev->exposure->is_new || (ctrl->is_new && ctrl->val))
			setcontrol(gspca_dev, PAC207_EXPOSURE_REG,
				   gspca_dev->exposure->val);
		if (gspca_dev->gain->is_new || (ctrl->is_new && ctrl->val))
			setcontrol(gspca_dev, PAC207_GAIN_REG,
				   gspca_dev->gain->val);
		break;
	default:
		return -EINVAL;
	}
	return gspca_dev->usb_err;
}

static const struct v4l2_ctrl_ops sd_ctrl_ops = {
	.s_ctrl = sd_s_ctrl,
};

/* this function is called at probe time */
static int sd_init_controls(struct gspca_dev *gspca_dev)
{
	struct sd *sd = (struct sd *) gspca_dev;
	struct v4l2_ctrl_handler *hdl = &gspca_dev->ctrl_handler;

	gspca_dev->vdev.ctrl_handler = hdl;
	v4l2_ctrl_handler_init(hdl, 4);

	sd->brightness = v4l2_ctrl_new_std(hdl, &sd_ctrl_ops,
				V4L2_CID_BRIGHTNESS,
				PAC207_BRIGHTNESS_MIN, PAC207_BRIGHTNESS_MAX,
				1, PAC207_BRIGHTNESS_DEFAULT);
	gspca_dev->autogain = v4l2_ctrl_new_std(hdl, &sd_ctrl_ops,
				V4L2_CID_AUTOGAIN, 0, 1, 1, 1);
	gspca_dev->exposure = v4l2_ctrl_new_std(hdl, &sd_ctrl_ops,
				V4L2_CID_EXPOSURE,
				PAC207_EXPOSURE_MIN, PAC207_EXPOSURE_MAX,
				1, PAC207_EXPOSURE_DEFAULT);
	gspca_dev->gain = v4l2_ctrl_new_std(hdl, &sd_ctrl_ops,
				V4L2_CID_GAIN,
				PAC207_GAIN_MIN, PAC207_GAIN_MAX,
				1, PAC207_GAIN_DEFAULT);
	if (hdl->error) {
		pr_err("Could not initialize controls\n");
		return hdl->error;
	}
	v4l2_ctrl_auto_cluster(3, &gspca_dev->autogain, 0, false);
	return 0;
}

/* -- start the camera -- */
static int sd_start(struct gspca_dev *gspca_dev)
{
	struct sd *sd = (struct sd *) gspca_dev;
	__u8 mode;

	pac207_write_reg(gspca_dev, 0x0f, 0x10); /* Power control (Bit 6-0) */
	pac207_write_regs(gspca_dev, 0x0002, pac207_sensor_init[0], 8);
	pac207_write_regs(gspca_dev, 0x000a, pac207_sensor_init[1], 8);
	pac207_write_regs(gspca_dev, 0x0012, pac207_sensor_init[2], 8);
	pac207_write_regs(gspca_dev, 0x0042, pac207_sensor_init[3], 8);

	/* Compression Balance */
	if (gspca_dev->pixfmt.width == 176)
		pac207_write_reg(gspca_dev, 0x4a, 0xff);
	else
		pac207_write_reg(gspca_dev, 0x4a, 0x30);
	pac207_write_reg(gspca_dev, 0x4b, 0x00); /* Sram test value */
	pac207_write_reg(gspca_dev, 0x08, v4l2_ctrl_g_ctrl(sd->brightness));

	/* PGA global gain (Bit 4-0) */
	pac207_write_reg(gspca_dev, 0x0e,
		v4l2_ctrl_g_ctrl(gspca_dev->gain));
	pac207_write_reg(gspca_dev, 0x02,
		v4l2_ctrl_g_ctrl(gspca_dev->exposure)); /* PXCK = 12MHz /n */

	/* mode: Image Format (Bit 0), LED (1), Compr. test mode (2) */
	if (led_invert)
		mode = 0x00;
	else
		mode = 0x02;
	if (gspca_dev->pixfmt.width == 176) {	/* 176x144 */
		mode |= 0x01;
		PDEBUG(D_STREAM, "pac207_start mode 176x144");
	} else {				/* 352x288 */
		PDEBUG(D_STREAM, "pac207_start mode 352x288");
	}
	pac207_write_reg(gspca_dev, 0x41, mode);

	pac207_write_reg(gspca_dev, 0x13, 0x01); /* Bit 0, auto clear */
	pac207_write_reg(gspca_dev, 0x1c, 0x01); /* not documented */
	msleep(10);
	pac207_write_reg(gspca_dev, 0x40, 0x01); /* Start ISO pipe */

	sd->sof_read = 0;
	sd->autogain_ignore_frames = 0;
	atomic_set(&sd->avg_lum, -1);
	return gspca_dev->usb_err;
}

static void sd_stopN(struct gspca_dev *gspca_dev)
{
	u8 mode;

	/* mode: Image Format (Bit 0), LED (1), Compr. test mode (2) */
	if (led_invert)
		mode = 0x02;
	else
		mode = 0x00;
	pac207_write_reg(gspca_dev, 0x40, 0x00); /* Stop ISO pipe */
	pac207_write_reg(gspca_dev, 0x41, mode); /* Turn off LED */
	pac207_write_reg(gspca_dev, 0x0f, 0x00); /* Power Control */
}


static void pac207_do_auto_gain(struct gspca_dev *gspca_dev)
{
	struct sd *sd = (struct sd *) gspca_dev;
	int avg_lum = atomic_read(&sd->avg_lum);

	if (avg_lum == -1)
		return;

	if (sd->autogain_ignore_frames > 0)
		sd->autogain_ignore_frames--;
	else if (gspca_coarse_grained_expo_autogain(gspca_dev, avg_lum,
			90, PAC207_AUTOGAIN_DEADZONE))
		sd->autogain_ignore_frames = PAC_AUTOGAIN_IGNORE_FRAMES;
}

static void sd_pkt_scan(struct gspca_dev *gspca_dev,
			u8 *data,
			int len)
{
	struct sd *sd = (struct sd *) gspca_dev;
	unsigned char *sof;

	sof = pac_find_sof(gspca_dev, &sd->sof_read, data, len);
	if (sof) {
		int n;

		/* finish decoding current frame */
		n = sof - data;
		if (n > sizeof pac_sof_marker)
			n -= sizeof pac_sof_marker;
		else
			n = 0;
		gspca_frame_add(gspca_dev, LAST_PACKET,
				data, n);
		sd->header_read = 0;
		gspca_frame_add(gspca_dev, FIRST_PACKET, NULL, 0);
		len -= sof - data;
		data = sof;
	}
	if (sd->header_read < 11) {
		int needed;

		/* get average lumination from frame header (byte 5) */
		if (sd->header_read < 5) {
			needed = 5 - sd->header_read;
			if (len >= needed)
				atomic_set(&sd->avg_lum, data[needed - 1]);
		}
		/* skip the rest of the header */
		needed = 11 - sd->header_read;
		if (len <= needed) {
			sd->header_read += len;
			return;
		}
		data += needed;
		len -= needed;
		sd->header_read = 11;
	}

	gspca_frame_add(gspca_dev, INTER_PACKET, data, len);
}

#if IS_ENABLED(CONFIG_INPUT)
static int sd_int_pkt_scan(struct gspca_dev *gspca_dev,
			u8 *data,		/* interrupt packet data */
			int len)		/* interrupt packet length */
{
	int ret = -EINVAL;

	if (len == 2 && data[0] == 0x5a && data[1] == 0x5a) {
		input_report_key(gspca_dev->input_dev, KEY_CAMERA, 1);
		input_sync(gspca_dev->input_dev);
		input_report_key(gspca_dev->input_dev, KEY_CAMERA, 0);
		input_sync(gspca_dev->input_dev);
		ret = 0;
	}

	return ret;
}
#endif

/* sub-driver description */
static const struct sd_desc sd_desc = {
	.name = MODULE_NAME,
	.config = sd_config,
	.init = sd_init,
	.init_controls = sd_init_controls,
	.start = sd_start,
	.stopN = sd_stopN,
	.dq_callback = pac207_do_auto_gain,
	.pkt_scan = sd_pkt_scan,
#if IS_ENABLED(CONFIG_INPUT)
	.int_pkt_scan = sd_int_pkt_scan,
#endif
};

/* -- module initialisation -- */
static const struct usb_device_id device_table[] = {
	{USB_DEVICE(0x041e, 0x4028)},
	{USB_DEVICE(0x093a, 0x2460)},
	{USB_DEVICE(0x093a, 0x2461)},
	{USB_DEVICE(0x093a, 0x2463)},
	{USB_DEVICE(0x093a, 0x2464)},
	{USB_DEVICE(0x093a, 0x2468)},
	{USB_DEVICE(0x093a, 0x2470)},
	{USB_DEVICE(0x093a, 0x2471)},
	{USB_DEVICE(0x093a, 0x2472)},
	{USB_DEVICE(0x093a, 0x2474)},
	{USB_DEVICE(0x093a, 0x2476)},
	{USB_DEVICE(0x145f, 0x013a)},
	{USB_DEVICE(0x2001, 0xf115)},
	{}
};
MODULE_DEVICE_TABLE(usb, device_table);

/* -- device connect -- */
static int sd_probe(struct usb_interface *intf,
			const struct usb_device_id *id)
{
	return gspca_dev_probe(intf, id, &sd_desc, sizeof(struct sd),
				THIS_MODULE);
}

static struct usb_driver sd_driver = {
	.name = MODULE_NAME,
	.id_table = device_table,
	.probe = sd_probe,
	.disconnect = gspca_disconnect,
#ifdef CONFIG_PM
	.suspend = gspca_suspend,
	.resume = gspca_resume,
	.reset_resume = gspca_resume,
#endif
};

module_usb_driver(sd_driver);
Commit	Line	Data
e2997a72 HG	1	/*
	2	* Pixart PAC207BCA library
	3	*
1fddcf0e	4	* Copyright (C) 2008 Hans de Goede <hdegoede@redhat.com>
e2997a72 HG	5	* Copyright (C) 2005 Thomas Kaiser thomas@kaiser-linux.li
	6	* Copyleft (C) 2005 Michel Xhaard mxhaard@magic.fr
	7	*
	8	* V4L2 by Jean-Francois Moine <http://moinejf.free.fr>
	9	*
	10	* This program is free software; you can redistribute it and/or modify
	11	* it under the terms of the GNU General Public License as published by
	12	* the Free Software Foundation; either version 2 of the License, or
	13	* (at your option) any later version.
	14	*
	15	* This program is distributed in the hope that it will be useful,
	16	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	17	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	18	* GNU General Public License for more details.
	19	*
	20	* You should have received a copy of the GNU General Public License
	21	* along with this program; if not, write to the Free Software
	22	* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
	23	*
	24	*/
	25
be612514 JP	26	#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
be612514 JP	27
e2997a72 HG	28	#define MODULE_NAME "pac207"
e2997a72 HG	29
937a6f54	30	#include <linux/input.h>
e2997a72	31	#include "gspca.h"
cd92c1a6 HG	32	/* Include pac common sof detection functions */
cd92c1a6 HG	33	#include "pac_common.h"
e2997a72	34
1fddcf0e	35	MODULE_AUTHOR("Hans de Goede <hdegoede@redhat.com>");
e2997a72 HG	36	MODULE_DESCRIPTION("Pixart PAC207");
	37	MODULE_LICENSE("GPL");
	38
	39	#define PAC207_CTRL_TIMEOUT 100 /* ms */
	40
	41	#define PAC207_BRIGHTNESS_MIN 0
	42	#define PAC207_BRIGHTNESS_MAX 255
0e4a9099	43	#define PAC207_BRIGHTNESS_DEFAULT 46
cd92c1a6	44	#define PAC207_BRIGHTNESS_REG 0x08
0e4a9099 HG	45
0e4a9099 HG	46	#define PAC207_EXPOSURE_MIN 3
69c00399	47	#define PAC207_EXPOSURE_MAX 90 /* 1 sec expo time / 1 fps */
0e4a9099	48	#define PAC207_EXPOSURE_DEFAULT 5 /* power on default: 3 */
cd92c1a6	49	#define PAC207_EXPOSURE_REG 0x02
e2997a72 HG	50
	51	#define PAC207_GAIN_MIN 0
	52	#define PAC207_GAIN_MAX 31
69c00399	53	#define PAC207_GAIN_DEFAULT 7 /* power on default: 9 */
cd92c1a6	54	#define PAC207_GAIN_REG 0x0e
e2997a72 HG	55
e2997a72 HG	56	#define PAC207_AUTOGAIN_DEADZONE 30
e2997a72	57
143dd345 HG	58	/* global parameters */
	59	static int led_invert;
	60	module_param(led_invert, int, 0644);
	61	MODULE_PARM_DESC(led_invert, "Invert led");
	62
e2997a72 HG	63	/* specific webcam descriptor */
	64	struct sd {
	65	struct gspca_dev gspca_dev; /* !! must be the first item */
	66
cd92c1a6	67	struct v4l2_ctrl *brightness;
e2997a72	68
cd92c1a6	69	u8 mode;
e2997a72	70	u8 sof_read;
ab8f12cf	71	u8 header_read;
e2997a72 HG	72	u8 autogain_ignore_frames;
	73
	74	atomic_t avg_lum;
	75	};
	76
cc611b8a	77	static const struct v4l2_pix_format sif_mode[] = {
c2446b3e JFM	78	{176, 144, V4L2_PIX_FMT_PAC207, V4L2_FIELD_NONE,
	79	.bytesperline = 176,
	80	.sizeimage = (176 + 2) * 144,
	81	/* uncompressed, add 2 bytes / line for line header */
	82	.colorspace = V4L2_COLORSPACE_SRGB,
	83	.priv = 1},
	84	{352, 288, V4L2_PIX_FMT_PAC207, V4L2_FIELD_NONE,
	85	.bytesperline = 352,
80544d3c HG	86	/* compressed, but only when needed (not compressed
	87	when the framerate is low) */
	88	.sizeimage = (352 + 2) * 288,
c2446b3e JFM	89	.colorspace = V4L2_COLORSPACE_SRGB,
c2446b3e JFM	90	.priv = 0},
e2997a72 HG	91	};
	92
	93	static const __u8 pac207_sensor_init[][8] = {
0e4a9099 HG	94	{0x10, 0x12, 0x0d, 0x12, 0x0c, 0x01, 0x29, 0x84},
0e4a9099 HG	95	{0x49, 0x64, 0x64, 0x64, 0x04, 0x10, 0xf0, 0x30},
e2997a72	96	{0x00, 0x00, 0x00, 0x70, 0xa0, 0xf8, 0x00, 0x00},
1d00d6c1	97	{0x32, 0x00, 0x96, 0x00, 0xa2, 0x02, 0xaf, 0x00},
e2997a72 HG	98	};
e2997a72 HG	99
cb0988cb	100	static void pac207_write_regs(struct gspca_dev *gspca_dev, u16 index,
e2997a72 HG	101	const u8 *buffer, u16 length)
	102	{
	103	struct usb_device *udev = gspca_dev->dev;
	104	int err;
e2997a72	105
cb0988cb HG	106	if (gspca_dev->usb_err < 0)
	107	return;
	108
739570bb	109	memcpy(gspca_dev->usb_buf, buffer, length);
e2997a72 HG	110
	111	err = usb_control_msg(udev, usb_sndctrlpipe(udev, 0), 0x01,
	112	USB_DIR_OUT \| USB_TYPE_VENDOR \| USB_RECIP_INTERFACE,
739570bb JFM	113	0x00, index,
739570bb JFM	114	gspca_dev->usb_buf, length, PAC207_CTRL_TIMEOUT);
cb0988cb	115	if (err < 0) {
be612514 JP	116	pr_err("Failed to write registers to index 0x%04X, error %d\n",
be612514 JP	117	index, err);
cb0988cb HG	118	gspca_dev->usb_err = err;
cb0988cb HG	119	}
e2997a72 HG	120	}
e2997a72 HG	121
cb0988cb	122	static void pac207_write_reg(struct gspca_dev *gspca_dev, u16 index, u16 value)
e2997a72 HG	123	{
	124	struct usb_device *udev = gspca_dev->dev;
	125	int err;
	126
cb0988cb HG	127	if (gspca_dev->usb_err < 0)
	128	return;
	129
e2997a72 HG	130	err = usb_control_msg(udev, usb_sndctrlpipe(udev, 0), 0x00,
	131	USB_DIR_OUT \| USB_TYPE_VENDOR \| USB_RECIP_INTERFACE,
	132	value, index, NULL, 0, PAC207_CTRL_TIMEOUT);
cb0988cb	133	if (err) {
be612514 JP	134	pr_err("Failed to write a register (index 0x%04X, value 0x%02X, error %d)\n",
be612514 JP	135	index, value, err);
cb0988cb HG	136	gspca_dev->usb_err = err;
cb0988cb HG	137	}
e2997a72 HG	138	}
e2997a72 HG	139
903e10aa	140	static int pac207_read_reg(struct gspca_dev *gspca_dev, u16 index)
e2997a72 HG	141	{
e2997a72 HG	142	struct usb_device *udev = gspca_dev->dev;
e2997a72 HG	143	int res;
e2997a72 HG	144
cb0988cb HG	145	if (gspca_dev->usb_err < 0)
	146	return 0;
	147
e2997a72 HG	148	res = usb_control_msg(udev, usb_rcvctrlpipe(udev, 0), 0x00,
e2997a72 HG	149	USB_DIR_IN \| USB_TYPE_VENDOR \| USB_RECIP_INTERFACE,
739570bb JFM	150	0x00, index,
739570bb JFM	151	gspca_dev->usb_buf, 1, PAC207_CTRL_TIMEOUT);
e2997a72	152	if (res < 0) {
be612514 JP	153	pr_err("Failed to read a register (index 0x%04X, error %d)\n",
be612514 JP	154	index, res);
cb0988cb HG	155	gspca_dev->usb_err = res;
cb0988cb HG	156	return 0;
e2997a72 HG	157	}
e2997a72 HG	158
739570bb	159	return gspca_dev->usb_buf[0];
e2997a72 HG	160	}
e2997a72 HG	161
e2997a72 HG	162	/* this function is called at probe time */
	163	static int sd_config(struct gspca_dev *gspca_dev,
	164	const struct usb_device_id *id)
	165	{
	166	struct cam *cam;
	167	u8 idreg[2];
	168
	169	idreg[0] = pac207_read_reg(gspca_dev, 0x0000);
	170	idreg[1] = pac207_read_reg(gspca_dev, 0x0001);
1d00d6c1	171	idreg[0] = ((idreg[0] & 0x0f) << 4) \| ((idreg[1] & 0xf0) >> 4);
e2997a72 HG	172	idreg[1] = idreg[1] & 0x0f;
	173	PDEBUG(D_PROBE, "Pixart Sensor ID 0x%02X Chips ID 0x%02X",
	174	idreg[0], idreg[1]);
	175
	176	if (idreg[0] != 0x27) {
	177	PDEBUG(D_PROBE, "Error invalid sensor ID!");
	178	return -ENODEV;
	179	}
	180
e2997a72	181	PDEBUG(D_PROBE,
1ddc9f75 MCC	182	"Pixart PAC207BCA Image Processor and Control Chip detected (vid/pid 0x%04X:0x%04X)",
1ddc9f75 MCC	183	id->idVendor, id->idProduct);
e2997a72 HG	184
e2997a72 HG	185	cam = &gspca_dev->cam;
e2997a72 HG	186	cam->cam_mode = sif_mode;
	187	cam->nmodes = ARRAY_SIZE(sif_mode);
	188
	189	return 0;
	190	}
	191
012d6b02 JFM	192	/* this function is called at probe and resume time */
012d6b02 JFM	193	static int sd_init(struct gspca_dev *gspca_dev)
e2997a72	194	{
143dd345 HG	195	u8 mode;
	196
	197	/* mode: Image Format (Bit 0), LED (1), Compr. test mode (2) */
	198	if (led_invert)
	199	mode = 0x02;
	200	else
	201	mode = 0x00;
	202	pac207_write_reg(gspca_dev, 0x41, mode);
66e4124f	203	pac207_write_reg(gspca_dev, 0x0f, 0x00); /* Power Control */
e2997a72	204
cb0988cb	205	return gspca_dev->usb_err;
e2997a72 HG	206	}
e2997a72 HG	207
cd92c1a6 HG	208	static void setcontrol(struct gspca_dev *gspca_dev, u16 reg, u16 val)
	209	{
	210	pac207_write_reg(gspca_dev, reg, val);
	211	pac207_write_reg(gspca_dev, 0x13, 0x01); /* Bit 0, auto clear */
	212	pac207_write_reg(gspca_dev, 0x1c, 0x01); /* not documented */
	213	}
	214
	215	static int sd_s_ctrl(struct v4l2_ctrl *ctrl)
	216	{
	217	struct gspca_dev *gspca_dev =
	218	container_of(ctrl->handler, struct gspca_dev, ctrl_handler);
	219	struct sd sd = (struct sd )gspca_dev;
	220
	221	gspca_dev->usb_err = 0;
	222
	223	if (ctrl->id == V4L2_CID_AUTOGAIN && ctrl->is_new && ctrl->val) {
	224	/* when switching to autogain set defaults to make sure
	225	we are on a valid point of the autogain gain /
	226	exposure knee graph, and give this change time to
	227	take effect before doing autogain. */
	228	gspca_dev->exposure->val = PAC207_EXPOSURE_DEFAULT;
	229	gspca_dev->gain->val = PAC207_GAIN_DEFAULT;
	230	sd->autogain_ignore_frames = PAC_AUTOGAIN_IGNORE_FRAMES;
	231	}
	232
	233	if (!gspca_dev->streaming)
	234	return 0;
	235
	236	switch (ctrl->id) {
	237	case V4L2_CID_BRIGHTNESS:
	238	setcontrol(gspca_dev, PAC207_BRIGHTNESS_REG, ctrl->val);
	239	break;
	240	case V4L2_CID_AUTOGAIN:
	241	if (gspca_dev->exposure->is_new \|\| (ctrl->is_new && ctrl->val))
	242	setcontrol(gspca_dev, PAC207_EXPOSURE_REG,
	243	gspca_dev->exposure->val);
	244	if (gspca_dev->gain->is_new \|\| (ctrl->is_new && ctrl->val))
	245	setcontrol(gspca_dev, PAC207_GAIN_REG,
	246	gspca_dev->gain->val);
	247	break;
	248	default:
	249	return -EINVAL;
	250	}
	251	return gspca_dev->usb_err;
	252	}
	253
	254	static const struct v4l2_ctrl_ops sd_ctrl_ops = {
	255	.s_ctrl = sd_s_ctrl,
	256	};
	257
	258	/* this function is called at probe time */
	259	static int sd_init_controls(struct gspca_dev *gspca_dev)
	260	{
	261	struct sd sd = (struct sd ) gspca_dev;
	262	struct v4l2_ctrl_handler *hdl = &gspca_dev->ctrl_handler;
	263
	264	gspca_dev->vdev.ctrl_handler = hdl;
	265	v4l2_ctrl_handler_init(hdl, 4);
	266
	267	sd->brightness = v4l2_ctrl_new_std(hdl, &sd_ctrl_ops,
	268	V4L2_CID_BRIGHTNESS,
	269	PAC207_BRIGHTNESS_MIN, PAC207_BRIGHTNESS_MAX,
	270	1, PAC207_BRIGHTNESS_DEFAULT);
	271	gspca_dev->autogain = v4l2_ctrl_new_std(hdl, &sd_ctrl_ops,
272	V4L2_CID_AUTOGAIN, 0, 1, 1, 1);
273	gspca_dev->exposure = v4l2_ctrl_new_std(hdl, &sd_ctrl_ops,
274	V4L2_CID_EXPOSURE,
275	PAC207_EXPOSURE_MIN, PAC207_EXPOSURE_MAX,
276	1, PAC207_EXPOSURE_DEFAULT);
277	gspca_dev->gain = v4l2_ctrl_new_std(hdl, &sd_ctrl_ops,
278	V4L2_CID_GAIN,
279	PAC207_GAIN_MIN, PAC207_GAIN_MAX,
280	1, PAC207_GAIN_DEFAULT);
281	if (hdl->error) {
282	pr_err("Could not initialize controls\n");
283	return hdl->error;
284	}
285	v4l2_ctrl_auto_cluster(3, &gspca_dev->autogain, 0, false);
286	return 0;
287	}
288
e2997a72	289	/* -- start the camera -- */
72ab97ce	290	static int sd_start(struct gspca_dev *gspca_dev)
e2997a72 HG	291	{
	292	struct sd sd = (struct sd ) gspca_dev;
	293	__u8 mode;
	294
	295	pac207_write_reg(gspca_dev, 0x0f, 0x10); /* Power control (Bit 6-0) */
	296	pac207_write_regs(gspca_dev, 0x0002, pac207_sensor_init[0], 8);
	297	pac207_write_regs(gspca_dev, 0x000a, pac207_sensor_init[1], 8);
	298	pac207_write_regs(gspca_dev, 0x0012, pac207_sensor_init[2], 8);
c529e556	299	pac207_write_regs(gspca_dev, 0x0042, pac207_sensor_init[3], 8);
e2997a72 HG	300
e2997a72 HG	301	/* Compression Balance */
1966bc2a	302	if (gspca_dev->pixfmt.width == 176)
e2997a72 HG	303	pac207_write_reg(gspca_dev, 0x4a, 0xff);
e2997a72 HG	304	else
0e4a9099	305	pac207_write_reg(gspca_dev, 0x4a, 0x30);
e2997a72	306	pac207_write_reg(gspca_dev, 0x4b, 0x00); /* Sram test value */
cd92c1a6	307	pac207_write_reg(gspca_dev, 0x08, v4l2_ctrl_g_ctrl(sd->brightness));
e2997a72 HG	308
e2997a72 HG	309	/* PGA global gain (Bit 4-0) */
cd92c1a6 HG	310	pac207_write_reg(gspca_dev, 0x0e,
	311	v4l2_ctrl_g_ctrl(gspca_dev->gain));
	312	pac207_write_reg(gspca_dev, 0x02,
	313	v4l2_ctrl_g_ctrl(gspca_dev->exposure)); /* PXCK = 12MHz /n */
e2997a72	314
143dd345 HG	315	/* mode: Image Format (Bit 0), LED (1), Compr. test mode (2) */
	316	if (led_invert)
	317	mode = 0x00;
	318	else
	319	mode = 0x02;
1966bc2a	320	if (gspca_dev->pixfmt.width == 176) { /* 176x144 */
e2997a72 HG	321	mode \|= 0x01;
e2997a72 HG	322	PDEBUG(D_STREAM, "pac207_start mode 176x144");
d43fa32f	323	} else { /* 352x288 */
e2997a72	324	PDEBUG(D_STREAM, "pac207_start mode 352x288");
d43fa32f	325	}
e2997a72 HG	326	pac207_write_reg(gspca_dev, 0x41, mode);
	327
	328	pac207_write_reg(gspca_dev, 0x13, 0x01); /* Bit 0, auto clear */
	329	pac207_write_reg(gspca_dev, 0x1c, 0x01); /* not documented */
6a7eba24	330	msleep(10);
e2997a72 HG	331	pac207_write_reg(gspca_dev, 0x40, 0x01); /* Start ISO pipe */
	332
	333	sd->sof_read = 0;
	334	sd->autogain_ignore_frames = 0;
	335	atomic_set(&sd->avg_lum, -1);
cb0988cb	336	return gspca_dev->usb_err;
e2997a72 HG	337	}
	338
	339	static void sd_stopN(struct gspca_dev *gspca_dev)
	340	{
143dd345 HG	341	u8 mode;
	342
	343	/* mode: Image Format (Bit 0), LED (1), Compr. test mode (2) */
	344	if (led_invert)
	345	mode = 0x02;
	346	else
	347	mode = 0x00;
e2997a72	348	pac207_write_reg(gspca_dev, 0x40, 0x00); /* Stop ISO pipe */
143dd345	349	pac207_write_reg(gspca_dev, 0x41, mode); /* Turn off LED */
e2997a72 HG	350	pac207_write_reg(gspca_dev, 0x0f, 0x00); /* Power Control */
	351	}
	352
8a5b2e90	353
e2997a72 HG	354	static void pac207_do_auto_gain(struct gspca_dev *gspca_dev)
	355	{
	356	struct sd sd = (struct sd ) gspca_dev;
e2997a72 HG	357	int avg_lum = atomic_read(&sd->avg_lum);
e2997a72 HG	358
dcef3237	359	if (avg_lum == -1)
e2997a72 HG	360	return;
e2997a72 HG	361
dcef3237	362	if (sd->autogain_ignore_frames > 0)
e2997a72	363	sd->autogain_ignore_frames--;
0413d3b2 HG	364	else if (gspca_coarse_grained_expo_autogain(gspca_dev, avg_lum,
0413d3b2 HG	365	90, PAC207_AUTOGAIN_DEADZONE))
8a5b2e90	366	sd->autogain_ignore_frames = PAC_AUTOGAIN_IGNORE_FRAMES;
e2997a72 HG	367	}
e2997a72 HG	368
e2997a72	369	static void sd_pkt_scan(struct gspca_dev *gspca_dev,
76dd272b	370	u8 *data,
e2997a72 HG	371	int len)
e2997a72 HG	372	{
ab8f12cf	373	struct sd sd = (struct sd ) gspca_dev;
e2997a72	374	unsigned char *sof;
e2997a72	375
c93396e1	376	sof = pac_find_sof(gspca_dev, &sd->sof_read, data, len);
e2997a72	377	if (sof) {
ab8f12cf HG	378	int n;
ab8f12cf HG	379
e2997a72	380	/* finish decoding current frame */
ab8f12cf	381	n = sof - data;
327c4abf HG	382	if (n > sizeof pac_sof_marker)
327c4abf HG	383	n -= sizeof pac_sof_marker;
ab8f12cf HG	384	else
ab8f12cf HG	385	n = 0;
76dd272b JFM	386	gspca_frame_add(gspca_dev, LAST_PACKET,
76dd272b JFM	387	data, n);
ab8f12cf	388	sd->header_read = 0;
76dd272b	389	gspca_frame_add(gspca_dev, FIRST_PACKET, NULL, 0);
e2997a72 HG	390	len -= sof - data;
	391	data = sof;
	392	}
ab8f12cf HG	393	if (sd->header_read < 11) {
ab8f12cf HG	394	int needed;
e2997a72	395
ab8f12cf HG	396	/* get average lumination from frame header (byte 5) */
	397	if (sd->header_read < 5) {
	398	needed = 5 - sd->header_read;
	399	if (len >= needed)
	400	atomic_set(&sd->avg_lum, data[needed - 1]);
	401	}
	402	/* skip the rest of the header */
	403	needed = 11 - sd->header_read;
	404	if (len <= needed) {
	405	sd->header_read += len;
	406	return;
	407	}
	408	data += needed;
	409	len -= needed;
	410	sd->header_read = 11;
	411	}
e2997a72	412
76dd272b	413	gspca_frame_add(gspca_dev, INTER_PACKET, data, len);
e2997a72 HG	414	}
e2997a72 HG	415
4f4d1785	416	#if IS_ENABLED(CONFIG_INPUT)
937a6f54 HG	417	static int sd_int_pkt_scan(struct gspca_dev *gspca_dev,
937a6f54 HG	418	u8 data, / interrupt packet data */
f58c91ce	419	int len) /* interrupt packet length */
937a6f54 HG	420	{
	421	int ret = -EINVAL;
	422
	423	if (len == 2 && data[0] == 0x5a && data[1] == 0x5a) {
	424	input_report_key(gspca_dev->input_dev, KEY_CAMERA, 1);
	425	input_sync(gspca_dev->input_dev);
	426	input_report_key(gspca_dev->input_dev, KEY_CAMERA, 0);
	427	input_sync(gspca_dev->input_dev);
	428	ret = 0;
	429	}
	430
	431	return ret;
	432	}
	433	#endif
	434
e2997a72	435	/* sub-driver description */
a5ae2062	436	static const struct sd_desc sd_desc = {
e2997a72	437	.name = MODULE_NAME,
e2997a72	438	.config = sd_config,
012d6b02	439	.init = sd_init,
cd92c1a6	440	.init_controls = sd_init_controls,
e2997a72 HG	441	.start = sd_start,
e2997a72 HG	442	.stopN = sd_stopN,
e2997a72 HG	443	.dq_callback = pac207_do_auto_gain,
e2997a72 HG	444	.pkt_scan = sd_pkt_scan,
4f4d1785	445	#if IS_ENABLED(CONFIG_INPUT)
937a6f54 HG	446	.int_pkt_scan = sd_int_pkt_scan,
937a6f54 HG	447	#endif
e2997a72 HG	448	};
	449
	450	/* -- module initialisation -- */
95c967c1	451	static const struct usb_device_id device_table[] = {
9d64fdb1 JFM	452	{USB_DEVICE(0x041e, 0x4028)},
9d64fdb1 JFM	453	{USB_DEVICE(0x093a, 0x2460)},
87945895	454	{USB_DEVICE(0x093a, 0x2461)},
9d64fdb1 JFM	455	{USB_DEVICE(0x093a, 0x2463)},
	456	{USB_DEVICE(0x093a, 0x2464)},
	457	{USB_DEVICE(0x093a, 0x2468)},
	458	{USB_DEVICE(0x093a, 0x2470)},
	459	{USB_DEVICE(0x093a, 0x2471)},
	460	{USB_DEVICE(0x093a, 0x2472)},
db91235e	461	{USB_DEVICE(0x093a, 0x2474)},
d654dca7	462	{USB_DEVICE(0x093a, 0x2476)},
91711874	463	{USB_DEVICE(0x145f, 0x013a)},
9d64fdb1	464	{USB_DEVICE(0x2001, 0xf115)},
e2997a72 HG	465	{}
	466	};
	467	MODULE_DEVICE_TABLE(usb, device_table);
	468
	469	/* -- device connect -- */
	470	static int sd_probe(struct usb_interface *intf,
	471	const struct usb_device_id *id)
	472	{
d43fa32f JFM	473	return gspca_dev_probe(intf, id, &sd_desc, sizeof(struct sd),
d43fa32f JFM	474	THIS_MODULE);
e2997a72 HG	475	}
	476
	477	static struct usb_driver sd_driver = {
	478	.name = MODULE_NAME,
	479	.id_table = device_table,
	480	.probe = sd_probe,
	481	.disconnect = gspca_disconnect,
6a709749 JFM	482	#ifdef CONFIG_PM
	483	.suspend = gspca_suspend,
	484	.resume = gspca_resume,
8bb58964	485	.reset_resume = gspca_resume,
6a709749	486	#endif
e2997a72 HG	487	};
e2997a72 HG	488
ecb3b2b3	489	module_usb_driver(sd_driver);