[deliverable/linux.git] / drivers / media / i2c / bt819.c

/*
 *  bt819 - BT819A VideoStream Decoder (Rockwell Part)
 *
 * Copyright (C) 1999 Mike Bernson <mike@mlb.org>
 * Copyright (C) 1998 Dave Perks <dperks@ibm.net>
 *
 * Modifications for LML33/DC10plus unified driver
 * Copyright (C) 2000 Serguei Miridonov <mirsev@cicese.mx>
 *
 * Changes by Ronald Bultje <rbultje@ronald.bitfreak.net>
 *    - moved over to linux>=2.4.x i2c protocol (9/9/2002)
 *
 * This code was modify/ported from the saa7111 driver written
 * by Dave Perks.
 *
 * 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., 675 Mass Ave, Cambridge, MA 02139, USA.
 */

#include <linux/module.h>
#include <linux/types.h>
#include <linux/ioctl.h>
#include <linux/delay.h>
#include <linux/i2c.h>
#include <linux/videodev2.h>
#include <linux/slab.h>
#include <media/v4l2-device.h>
#include <media/v4l2-ctrls.h>
#include <media/bt819.h>

MODULE_DESCRIPTION("Brooktree-819 video decoder driver");
MODULE_AUTHOR("Mike Bernson & Dave Perks");
MODULE_LICENSE("GPL");

static int debug;
module_param(debug, int, 0);
MODULE_PARM_DESC(debug, "Debug level (0-1)");


/* ----------------------------------------------------------------------- */

struct bt819 {
	struct v4l2_subdev sd;
	struct v4l2_ctrl_handler hdl;
	unsigned char reg[32];

	v4l2_std_id norm;
	int input;
	int enable;
};

static inline struct bt819 *to_bt819(struct v4l2_subdev *sd)
{
	return container_of(sd, struct bt819, sd);
}

static inline struct v4l2_subdev *to_sd(struct v4l2_ctrl *ctrl)
{
	return &container_of(ctrl->handler, struct bt819, hdl)->sd;
}

struct timing {
	int hactive;
	int hdelay;
	int vactive;
	int vdelay;
	int hscale;
	int vscale;
};

/* for values, see the bt819 datasheet */
static struct timing timing_data[] = {
	{864 - 24, 20, 625 - 2, 1, 0x0504, 0x0000},
	{858 - 24, 20, 525 - 2, 1, 0x00f8, 0x0000},
};

/* ----------------------------------------------------------------------- */

static inline int bt819_write(struct bt819 *decoder, u8 reg, u8 value)
{
	struct i2c_client *client = v4l2_get_subdevdata(&decoder->sd);

	decoder->reg[reg] = value;
	return i2c_smbus_write_byte_data(client, reg, value);
}

static inline int bt819_setbit(struct bt819 *decoder, u8 reg, u8 bit, u8 value)
{
	return bt819_write(decoder, reg,
		(decoder->reg[reg] & ~(1 << bit)) | (value ? (1 << bit) : 0));
}

static int bt819_write_block(struct bt819 *decoder, const u8 *data, unsigned int len)
{
	struct i2c_client *client = v4l2_get_subdevdata(&decoder->sd);
	int ret = -1;
	u8 reg;

	/* the bt819 has an autoincrement function, use it if
	 * the adapter understands raw I2C */
	if (i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) {
		/* do raw I2C, not smbus compatible */
		u8 block_data[32];
		int block_len;

		while (len >= 2) {
			block_len = 0;
			block_data[block_len++] = reg = data[0];
			do {
				block_data[block_len++] =
				    decoder->reg[reg++] = data[1];
				len -= 2;
				data += 2;
			} while (len >= 2 && data[0] == reg && block_len < 32);
			ret = i2c_master_send(client, block_data, block_len);
			if (ret < 0)
				break;
		}
	} else {
		/* do some slow I2C emulation kind of thing */
		while (len >= 2) {
			reg = *data++;
			ret = bt819_write(decoder, reg, *data++);
			if (ret < 0)
				break;
			len -= 2;
		}
	}

	return ret;
}

static inline int bt819_read(struct bt819 *decoder, u8 reg)
{
	struct i2c_client *client = v4l2_get_subdevdata(&decoder->sd);

	return i2c_smbus_read_byte_data(client, reg);
}

static int bt819_init(struct v4l2_subdev *sd)
{
	static unsigned char init[] = {
		/*0x1f, 0x00,*/     /* Reset */
		0x01, 0x59,	/* 0x01 input format */
		0x02, 0x00,	/* 0x02 temporal decimation */
		0x03, 0x12,	/* 0x03 Cropping msb */
		0x04, 0x16,	/* 0x04 Vertical Delay, lsb */
		0x05, 0xe0,	/* 0x05 Vertical Active lsb */
		0x06, 0x80,	/* 0x06 Horizontal Delay lsb */
		0x07, 0xd0,	/* 0x07 Horizontal Active lsb */
		0x08, 0x00,	/* 0x08 Horizontal Scaling msb */
		0x09, 0xf8,	/* 0x09 Horizontal Scaling lsb */
		0x0a, 0x00,	/* 0x0a Brightness control */
		0x0b, 0x30,	/* 0x0b Miscellaneous control */
		0x0c, 0xd8,	/* 0x0c Luma Gain lsb */
		0x0d, 0xfe,	/* 0x0d Chroma Gain (U) lsb */
		0x0e, 0xb4,	/* 0x0e Chroma Gain (V) msb */
		0x0f, 0x00,	/* 0x0f Hue control */
		0x12, 0x04,	/* 0x12 Output Format */
		0x13, 0x20,	/* 0x13 Vertial Scaling msb 0x00
					   chroma comb OFF, line drop scaling, interlace scaling
					   BUG? Why does turning the chroma comb on fuck up color?
					   Bug in the bt819 stepping on my board?
					*/
		0x14, 0x00,	/* 0x14 Vertial Scaling lsb */
		0x16, 0x07,	/* 0x16 Video Timing Polarity
					   ACTIVE=active low
					   FIELD: high=odd,
					   vreset=active high,
					   hreset=active high */
		0x18, 0x68,	/* 0x18 AGC Delay */
		0x19, 0x5d,	/* 0x19 Burst Gate Delay */
		0x1a, 0x80,	/* 0x1a ADC Interface */
	};

	struct bt819 *decoder = to_bt819(sd);
	struct timing *timing = &timing_data[(decoder->norm & V4L2_STD_525_60) ? 1 : 0];

	init[0x03 * 2 - 1] =
	    (((timing->vdelay >> 8) & 0x03) << 6) |
	    (((timing->vactive >> 8) & 0x03) << 4) |
	    (((timing->hdelay >> 8) & 0x03) << 2) |
	    ((timing->hactive >> 8) & 0x03);
	init[0x04 * 2 - 1] = timing->vdelay & 0xff;
	init[0x05 * 2 - 1] = timing->vactive & 0xff;
	init[0x06 * 2 - 1] = timing->hdelay & 0xff;
	init[0x07 * 2 - 1] = timing->hactive & 0xff;
	init[0x08 * 2 - 1] = timing->hscale >> 8;
	init[0x09 * 2 - 1] = timing->hscale & 0xff;
	/* 0x15 in array is address 0x19 */
	init[0x15 * 2 - 1] = (decoder->norm & V4L2_STD_625_50) ? 115 : 93;	/* Chroma burst delay */
	/* reset */
	bt819_write(decoder, 0x1f, 0x00);
	mdelay(1);

	/* init */
	return bt819_write_block(decoder, init, sizeof(init));
}

/* ----------------------------------------------------------------------- */

static int bt819_status(struct v4l2_subdev *sd, u32 *pstatus, v4l2_std_id *pstd)
{
	struct bt819 *decoder = to_bt819(sd);
	int status = bt819_read(decoder, 0x00);
	int res = V4L2_IN_ST_NO_SIGNAL;
	v4l2_std_id std = pstd ? *pstd : V4L2_STD_ALL;

	if ((status & 0x80))
		res = 0;
	else
		std = V4L2_STD_UNKNOWN;

	if ((status & 0x10))
		std &= V4L2_STD_PAL;
	else
		std &= V4L2_STD_NTSC;
	if (pstd)
		*pstd = std;
	if (pstatus)
		*pstatus = res;

	v4l2_dbg(1, debug, sd, "get status %x\n", status);
	return 0;
}

static int bt819_querystd(struct v4l2_subdev *sd, v4l2_std_id *std)
{
	return bt819_status(sd, NULL, std);
}

static int bt819_g_input_status(struct v4l2_subdev *sd, u32 *status)
{
	return bt819_status(sd, status, NULL);
}

static int bt819_s_std(struct v4l2_subdev *sd, v4l2_std_id std)
{
	struct bt819 *decoder = to_bt819(sd);
	struct timing *timing = NULL;

	v4l2_dbg(1, debug, sd, "set norm %llx\n", (unsigned long long)std);

	if (sd->v4l2_dev == NULL || sd->v4l2_dev->notify == NULL)
		v4l2_err(sd, "no notify found!\n");

	if (std & V4L2_STD_NTSC) {
		v4l2_subdev_notify(sd, BT819_FIFO_RESET_LOW, NULL);
		bt819_setbit(decoder, 0x01, 0, 1);
		bt819_setbit(decoder, 0x01, 1, 0);
		bt819_setbit(decoder, 0x01, 5, 0);
		bt819_write(decoder, 0x18, 0x68);
		bt819_write(decoder, 0x19, 0x5d);
		/* bt819_setbit(decoder, 0x1a,  5, 1); */
		timing = &timing_data[1];
	} else if (std & V4L2_STD_PAL) {
		v4l2_subdev_notify(sd, BT819_FIFO_RESET_LOW, NULL);
		bt819_setbit(decoder, 0x01, 0, 1);
		bt819_setbit(decoder, 0x01, 1, 1);
		bt819_setbit(decoder, 0x01, 5, 1);
		bt819_write(decoder, 0x18, 0x7f);
		bt819_write(decoder, 0x19, 0x72);
		/* bt819_setbit(decoder, 0x1a,  5, 0); */
		timing = &timing_data[0];
	} else {
		v4l2_dbg(1, debug, sd, "unsupported norm %llx\n",
				(unsigned long long)std);
		return -EINVAL;
	}
	bt819_write(decoder, 0x03,
			(((timing->vdelay >> 8) & 0x03) << 6) |
			(((timing->vactive >> 8) & 0x03) << 4) |
			(((timing->hdelay >> 8) & 0x03) << 2) |
			((timing->hactive >> 8) & 0x03));
	bt819_write(decoder, 0x04, timing->vdelay & 0xff);
	bt819_write(decoder, 0x05, timing->vactive & 0xff);
	bt819_write(decoder, 0x06, timing->hdelay & 0xff);
	bt819_write(decoder, 0x07, timing->hactive & 0xff);
	bt819_write(decoder, 0x08, (timing->hscale >> 8) & 0xff);
	bt819_write(decoder, 0x09, timing->hscale & 0xff);
	decoder->norm = std;
	v4l2_subdev_notify(sd, BT819_FIFO_RESET_HIGH, NULL);
	return 0;
}

static int bt819_s_routing(struct v4l2_subdev *sd,
			   u32 input, u32 output, u32 config)
{
	struct bt819 *decoder = to_bt819(sd);

	v4l2_dbg(1, debug, sd, "set input %x\n", input);

	if (input > 7)
		return -EINVAL;

	if (sd->v4l2_dev == NULL || sd->v4l2_dev->notify == NULL)
		v4l2_err(sd, "no notify found!\n");

	if (decoder->input != input) {
		v4l2_subdev_notify(sd, BT819_FIFO_RESET_LOW, NULL);
		decoder->input = input;
		/* select mode */
		if (decoder->input == 0) {
			bt819_setbit(decoder, 0x0b, 6, 0);
			bt819_setbit(decoder, 0x1a, 1, 1);
		} else {
			bt819_setbit(decoder, 0x0b, 6, 1);
			bt819_setbit(decoder, 0x1a, 1, 0);
		}
		v4l2_subdev_notify(sd, BT819_FIFO_RESET_HIGH, NULL);
	}
	return 0;
}

static int bt819_s_stream(struct v4l2_subdev *sd, int enable)
{
	struct bt819 *decoder = to_bt819(sd);

	v4l2_dbg(1, debug, sd, "enable output %x\n", enable);

	if (decoder->enable != enable) {
		decoder->enable = enable;
		bt819_setbit(decoder, 0x16, 7, !enable);
	}
	return 0;
}

static int bt819_s_ctrl(struct v4l2_ctrl *ctrl)
{
	struct v4l2_subdev *sd = to_sd(ctrl);
	struct bt819 *decoder = to_bt819(sd);
	int temp;

	switch (ctrl->id) {
	case V4L2_CID_BRIGHTNESS:
		bt819_write(decoder, 0x0a, ctrl->val);
		break;

	case V4L2_CID_CONTRAST:
		bt819_write(decoder, 0x0c, ctrl->val & 0xff);
		bt819_setbit(decoder, 0x0b, 2, ((ctrl->val >> 8) & 0x01));
		break;

	case V4L2_CID_SATURATION:
		bt819_write(decoder, 0x0d, (ctrl->val >> 7) & 0xff);
		bt819_setbit(decoder, 0x0b, 1, ((ctrl->val >> 15) & 0x01));

		/* Ratio between U gain and V gain must stay the same as
		   the ratio between the default U and V gain values. */
		temp = (ctrl->val * 180) / 254;
		bt819_write(decoder, 0x0e, (temp >> 7) & 0xff);
		bt819_setbit(decoder, 0x0b, 0, (temp >> 15) & 0x01);
		break;

	case V4L2_CID_HUE:
		bt819_write(decoder, 0x0f, ctrl->val);
		break;

	default:
		return -EINVAL;
	}
	return 0;
}

/* ----------------------------------------------------------------------- */

static const struct v4l2_ctrl_ops bt819_ctrl_ops = {
	.s_ctrl = bt819_s_ctrl,
};

static const struct v4l2_subdev_core_ops bt819_core_ops = {
	.g_ext_ctrls = v4l2_subdev_g_ext_ctrls,
	.try_ext_ctrls = v4l2_subdev_try_ext_ctrls,
	.s_ext_ctrls = v4l2_subdev_s_ext_ctrls,
	.g_ctrl = v4l2_subdev_g_ctrl,
	.s_ctrl = v4l2_subdev_s_ctrl,
	.queryctrl = v4l2_subdev_queryctrl,
	.querymenu = v4l2_subdev_querymenu,
};

static const struct v4l2_subdev_video_ops bt819_video_ops = {
	.s_std = bt819_s_std,
	.s_routing = bt819_s_routing,
	.s_stream = bt819_s_stream,
	.querystd = bt819_querystd,
	.g_input_status = bt819_g_input_status,
};

static const struct v4l2_subdev_ops bt819_ops = {
	.core = &bt819_core_ops,
	.video = &bt819_video_ops,
};

/* ----------------------------------------------------------------------- */

static int bt819_probe(struct i2c_client *client,
			const struct i2c_device_id *id)
{
	int i, ver;
	struct bt819 *decoder;
	struct v4l2_subdev *sd;
	const char *name;

	/* Check if the adapter supports the needed features */
	if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA))
		return -ENODEV;

	decoder = devm_kzalloc(&client->dev, sizeof(*decoder), GFP_KERNEL);
	if (decoder == NULL)
		return -ENOMEM;
	sd = &decoder->sd;
	v4l2_i2c_subdev_init(sd, client, &bt819_ops);

	ver = bt819_read(decoder, 0x17);
	switch (ver & 0xf0) {
	case 0x70:
		name = "bt819a";
		break;
	case 0x60:
		name = "bt817a";
		break;
	case 0x20:
		name = "bt815a";
		break;
	default:
		v4l2_dbg(1, debug, sd,
			"unknown chip version 0x%02x\n", ver);
		return -ENODEV;
	}

	v4l_info(client, "%s found @ 0x%x (%s)\n", name,
			client->addr << 1, client->adapter->name);

	decoder->norm = V4L2_STD_NTSC;
	decoder->input = 0;
	decoder->enable = 1;

	i = bt819_init(sd);
	if (i < 0)
		v4l2_dbg(1, debug, sd, "init status %d\n", i);

	v4l2_ctrl_handler_init(&decoder->hdl, 4);
	v4l2_ctrl_new_std(&decoder->hdl, &bt819_ctrl_ops,
			V4L2_CID_BRIGHTNESS, -128, 127, 1, 0);
	v4l2_ctrl_new_std(&decoder->hdl, &bt819_ctrl_ops,
			V4L2_CID_CONTRAST, 0, 511, 1, 0xd8);
	v4l2_ctrl_new_std(&decoder->hdl, &bt819_ctrl_ops,
			V4L2_CID_SATURATION, 0, 511, 1, 0xfe);
	v4l2_ctrl_new_std(&decoder->hdl, &bt819_ctrl_ops,
			V4L2_CID_HUE, -128, 127, 1, 0);
	sd->ctrl_handler = &decoder->hdl;
	if (decoder->hdl.error) {
		int err = decoder->hdl.error;

		v4l2_ctrl_handler_free(&decoder->hdl);
		return err;
	}
	v4l2_ctrl_handler_setup(&decoder->hdl);
	return 0;
}

static int bt819_remove(struct i2c_client *client)
{
	struct v4l2_subdev *sd = i2c_get_clientdata(client);
	struct bt819 *decoder = to_bt819(sd);

	v4l2_device_unregister_subdev(sd);
	v4l2_ctrl_handler_free(&decoder->hdl);
	return 0;
}

/* ----------------------------------------------------------------------- */

static const struct i2c_device_id bt819_id[] = {
	{ "bt819a", 0 },
	{ "bt817a", 0 },
	{ "bt815a", 0 },
	{ }
};
MODULE_DEVICE_TABLE(i2c, bt819_id);

static struct i2c_driver bt819_driver = {
	.driver = {
		.owner	= THIS_MODULE,
		.name	= "bt819",
	},
	.probe		= bt819_probe,
	.remove		= bt819_remove,
	.id_table	= bt819_id,
};

module_i2c_driver(bt819_driver);
Commit	Line	Data
d56410e0	1	/*
1da177e4 LT	2	* bt819 - BT819A VideoStream Decoder (Rockwell Part)
	3	*
	4	* Copyright (C) 1999 Mike Bernson <mike@mlb.org>
	5	* Copyright (C) 1998 Dave Perks <dperks@ibm.net>
	6	*
	7	* Modifications for LML33/DC10plus unified driver
	8	* Copyright (C) 2000 Serguei Miridonov <mirsev@cicese.mx>
d56410e0	9	*
1da177e4 LT	10	* Changes by Ronald Bultje <rbultje@ronald.bitfreak.net>
	11	* - moved over to linux>=2.4.x i2c protocol (9/9/2002)
	12	*
	13	* This code was modify/ported from the saa7111 driver written
	14	* by Dave Perks.
	15	*
	16	* This program is free software; you can redistribute it and/or modify
	17	* it under the terms of the GNU General Public License as published by
	18	* the Free Software Foundation; either version 2 of the License, or
	19	* (at your option) any later version.
	20	*
	21	* This program is distributed in the hope that it will be useful,
	22	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	23	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	24	* GNU General Public License for more details.
	25	*
	26	* You should have received a copy of the GNU General Public License
	27	* along with this program; if not, write to the Free Software
	28	* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
	29	*/
	30
	31	#include <linux/module.h>
18f3fa1e	32	#include <linux/types.h>
7fd011fb	33	#include <linux/ioctl.h>
2883913c	34	#include <linux/delay.h>
7fd011fb	35	#include <linux/i2c.h>
c2179ad8	36	#include <linux/videodev2.h>
5a0e3ad6	37	#include <linux/slab.h>
c2179ad8	38	#include <media/v4l2-device.h>
bd84a65a	39	#include <media/v4l2-ctrls.h>
1cd3c0fa	40	#include <media/bt819.h>
1da177e4 LT	41
	42	MODULE_DESCRIPTION("Brooktree-819 video decoder driver");
	43	MODULE_AUTHOR("Mike Bernson & Dave Perks");
	44	MODULE_LICENSE("GPL");
	45
ff699e6b	46	static int debug;
1da177e4 LT	47	module_param(debug, int, 0);
	48	MODULE_PARM_DESC(debug, "Debug level (0-1)");
	49
c2179ad8	50
1da177e4 LT	51	/* ----------------------------------------------------------------------- */
	52
	53	struct bt819 {
c2179ad8	54	struct v4l2_subdev sd;
bd84a65a	55	struct v4l2_ctrl_handler hdl;
1da177e4 LT	56	unsigned char reg[32];
1da177e4 LT	57
107063c6	58	v4l2_std_id norm;
1da177e4 LT	59	int input;
1da177e4 LT	60	int enable;
1da177e4 LT	61	};
1da177e4 LT	62
c2179ad8 HV	63	static inline struct bt819 to_bt819(struct v4l2_subdev sd)
	64	{
	65	return container_of(sd, struct bt819, sd);
	66	}
	67
bd84a65a HV	68	static inline struct v4l2_subdev to_sd(struct v4l2_ctrl ctrl)
	69	{
	70	return &container_of(ctrl->handler, struct bt819, hdl)->sd;
	71	}
	72
1da177e4 LT	73	struct timing {
	74	int hactive;
	75	int hdelay;
	76	int vactive;
	77	int vdelay;
	78	int hscale;
	79	int vscale;
	80	};
	81
	82	/* for values, see the bt819 datasheet */
	83	static struct timing timing_data[] = {
	84	{864 - 24, 20, 625 - 2, 1, 0x0504, 0x0000},
	85	{858 - 24, 20, 525 - 2, 1, 0x00f8, 0x0000},
	86	};
	87
1da177e4 LT	88	/* ----------------------------------------------------------------------- */
1da177e4 LT	89
c2179ad8	90	static inline int bt819_write(struct bt819 *decoder, u8 reg, u8 value)
1da177e4	91	{
c2179ad8	92	struct i2c_client *client = v4l2_get_subdevdata(&decoder->sd);
1da177e4 LT	93
	94	decoder->reg[reg] = value;
	95	return i2c_smbus_write_byte_data(client, reg, value);
	96	}
	97
c2179ad8	98	static inline int bt819_setbit(struct bt819 *decoder, u8 reg, u8 bit, u8 value)
1da177e4	99	{
c2179ad8	100	return bt819_write(decoder, reg,
7fd011fb	101	(decoder->reg[reg] & ~(1 << bit)) \| (value ? (1 << bit) : 0));
1da177e4 LT	102	}
1da177e4 LT	103
c2179ad8	104	static int bt819_write_block(struct bt819 decoder, const u8 data, unsigned int len)
1da177e4	105	{
c2179ad8	106	struct i2c_client *client = v4l2_get_subdevdata(&decoder->sd);
1da177e4 LT	107	int ret = -1;
	108	u8 reg;
	109
	110	/* the bt819 has an autoincrement function, use it if
	111	* the adapter understands raw I2C */
	112	if (i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) {
	113	/* do raw I2C, not smbus compatible */
1da177e4	114	u8 block_data[32];
9aa45e34	115	int block_len;
1da177e4	116
1da177e4	117	while (len >= 2) {
9aa45e34 JD	118	block_len = 0;
9aa45e34 JD	119	block_data[block_len++] = reg = data[0];
1da177e4	120	do {
9aa45e34	121	block_data[block_len++] =
1da177e4 LT	122	decoder->reg[reg++] = data[1];
	123	len -= 2;
	124	data += 2;
7fd011fb HV	125	} while (len >= 2 && data[0] == reg && block_len < 32);
	126	ret = i2c_master_send(client, block_data, block_len);
	127	if (ret < 0)
1da177e4 LT	128	break;
	129	}
	130	} else {
	131	/* do some slow I2C emulation kind of thing */
	132	while (len >= 2) {
	133	reg = *data++;
c2179ad8 HV	134	ret = bt819_write(decoder, reg, *data++);
c2179ad8 HV	135	if (ret < 0)
1da177e4 LT	136	break;
	137	len -= 2;
	138	}
	139	}
	140
	141	return ret;
	142	}
	143
c2179ad8	144	static inline int bt819_read(struct bt819 *decoder, u8 reg)
1da177e4	145	{
c2179ad8 HV	146	struct i2c_client *client = v4l2_get_subdevdata(&decoder->sd);
c2179ad8 HV	147
1da177e4 LT	148	return i2c_smbus_read_byte_data(client, reg);
	149	}
	150
c2179ad8	151	static int bt819_init(struct v4l2_subdev *sd)
1da177e4	152	{
1da177e4	153	static unsigned char init[] = {
7fd011fb	154	/0x1f, 0x00,/ /* Reset */
1da177e4 LT	155	0x01, 0x59, /* 0x01 input format */
	156	0x02, 0x00, /* 0x02 temporal decimation */
	157	0x03, 0x12, /* 0x03 Cropping msb */
	158	0x04, 0x16, /* 0x04 Vertical Delay, lsb */
	159	0x05, 0xe0, /* 0x05 Vertical Active lsb */
	160	0x06, 0x80, /* 0x06 Horizontal Delay lsb */
	161	0x07, 0xd0, /* 0x07 Horizontal Active lsb */
	162	0x08, 0x00, /* 0x08 Horizontal Scaling msb */
	163	0x09, 0xf8, /* 0x09 Horizontal Scaling lsb */
	164	0x0a, 0x00, /* 0x0a Brightness control */
	165	0x0b, 0x30, /* 0x0b Miscellaneous control */
	166	0x0c, 0xd8, /* 0x0c Luma Gain lsb */
	167	0x0d, 0xfe, /* 0x0d Chroma Gain (U) lsb */
	168	0x0e, 0xb4, /* 0x0e Chroma Gain (V) msb */
	169	0x0f, 0x00, /* 0x0f Hue control */
	170	0x12, 0x04, /* 0x12 Output Format */
	171	0x13, 0x20, /* 0x13 Vertial Scaling msb 0x00
	172	chroma comb OFF, line drop scaling, interlace scaling
	173	BUG? Why does turning the chroma comb on fuck up color?
	174	Bug in the bt819 stepping on my board?
	175	*/
	176	0x14, 0x00, /* 0x14 Vertial Scaling lsb */
d56410e0	177	0x16, 0x07, /* 0x16 Video Timing Polarity
1da177e4	178	ACTIVE=active low
d56410e0	179	FIELD: high=odd,
1da177e4 LT	180	vreset=active high,
	181	hreset=active high */
	182	0x18, 0x68, /* 0x18 AGC Delay */
	183	0x19, 0x5d, /* 0x19 Burst Gate Delay */
	184	0x1a, 0x80, /* 0x1a ADC Interface */
	185	};
	186
c2179ad8	187	struct bt819 *decoder = to_bt819(sd);
107063c6	188	struct timing *timing = &timing_data[(decoder->norm & V4L2_STD_525_60) ? 1 : 0];
1da177e4 LT	189
1da177e4 LT	190	init[0x03 * 2 - 1] =
7fd011fb HV	191	(((timing->vdelay >> 8) & 0x03) << 6) \|
	192	(((timing->vactive >> 8) & 0x03) << 4) \|
	193	(((timing->hdelay >> 8) & 0x03) << 2) \|
	194	((timing->hactive >> 8) & 0x03);
1da177e4 LT	195	init[0x04 * 2 - 1] = timing->vdelay & 0xff;
	196	init[0x05 * 2 - 1] = timing->vactive & 0xff;
	197	init[0x06 * 2 - 1] = timing->hdelay & 0xff;
	198	init[0x07 * 2 - 1] = timing->hactive & 0xff;
	199	init[0x08 * 2 - 1] = timing->hscale >> 8;
	200	init[0x09 * 2 - 1] = timing->hscale & 0xff;
	201	/* 0x15 in array is address 0x19 */
107063c6	202	init[0x15 * 2 - 1] = (decoder->norm & V4L2_STD_625_50) ? 115 : 93; /* Chroma burst delay */
1da177e4	203	/* reset */
c2179ad8	204	bt819_write(decoder, 0x1f, 0x00);
1da177e4 LT	205	mdelay(1);
	206
	207	/* init */
c2179ad8	208	return bt819_write_block(decoder, init, sizeof(init));
1da177e4 LT	209	}
	210
	211	/* ----------------------------------------------------------------------- */
	212
c2179ad8	213	static int bt819_status(struct v4l2_subdev sd, u32 pstatus, v4l2_std_id *pstd)
1da177e4	214	{
c2179ad8 HV	215	struct bt819 *decoder = to_bt819(sd);
	216	int status = bt819_read(decoder, 0x00);
	217	int res = V4L2_IN_ST_NO_SIGNAL;
ddc7f72a	218	v4l2_std_id std = pstd ? *pstd : V4L2_STD_ALL;
c2179ad8 HV	219
	220	if ((status & 0x80))
	221	res = 0;
ddc7f72a HV	222	else
ddc7f72a HV	223	std = V4L2_STD_UNKNOWN;
c2179ad8 HV	224
c2179ad8 HV	225	if ((status & 0x10))
ddc7f72a	226	std &= V4L2_STD_PAL;
c2179ad8	227	else
ddc7f72a	228	std &= V4L2_STD_NTSC;
c2179ad8 HV	229	if (pstd)
	230	*pstd = std;
	231	if (pstatus)
ba08831b	232	*pstatus = res;
c2179ad8 HV	233
	234	v4l2_dbg(1, debug, sd, "get status %x\n", status);
	235	return 0;
	236	}
1da177e4	237
c2179ad8 HV	238	static int bt819_querystd(struct v4l2_subdev sd, v4l2_std_id std)
	239	{
	240	return bt819_status(sd, NULL, std);
	241	}
1da177e4	242
c2179ad8 HV	243	static int bt819_g_input_status(struct v4l2_subdev sd, u32 status)
	244	{
	245	return bt819_status(sd, status, NULL);
	246	}
	247
	248	static int bt819_s_std(struct v4l2_subdev *sd, v4l2_std_id std)
	249	{
	250	struct bt819 *decoder = to_bt819(sd);
	251	struct timing *timing = NULL;
	252
cc5cef8e	253	v4l2_dbg(1, debug, sd, "set norm %llx\n", (unsigned long long)std);
c2179ad8	254
1cd3c0fa HV	255	if (sd->v4l2_dev == NULL \|\| sd->v4l2_dev->notify == NULL)
	256	v4l2_err(sd, "no notify found!\n");
	257
c2179ad8	258	if (std & V4L2_STD_NTSC) {
b9fb9b79	259	v4l2_subdev_notify(sd, BT819_FIFO_RESET_LOW, NULL);
c2179ad8 HV	260	bt819_setbit(decoder, 0x01, 0, 1);
	261	bt819_setbit(decoder, 0x01, 1, 0);
	262	bt819_setbit(decoder, 0x01, 5, 0);
	263	bt819_write(decoder, 0x18, 0x68);
	264	bt819_write(decoder, 0x19, 0x5d);
	265	/* bt819_setbit(decoder, 0x1a, 5, 1); */
	266	timing = &timing_data[1];
	267	} else if (std & V4L2_STD_PAL) {
b9fb9b79	268	v4l2_subdev_notify(sd, BT819_FIFO_RESET_LOW, NULL);
c2179ad8 HV	269	bt819_setbit(decoder, 0x01, 0, 1);
	270	bt819_setbit(decoder, 0x01, 1, 1);
	271	bt819_setbit(decoder, 0x01, 5, 1);
	272	bt819_write(decoder, 0x18, 0x7f);
	273	bt819_write(decoder, 0x19, 0x72);
	274	/* bt819_setbit(decoder, 0x1a, 5, 0); */
	275	timing = &timing_data[0];
	276	} else {
cc5cef8e HV	277	v4l2_dbg(1, debug, sd, "unsupported norm %llx\n",
cc5cef8e HV	278	(unsigned long long)std);
c2179ad8	279	return -EINVAL;
1da177e4	280	}
c2179ad8 HV	281	bt819_write(decoder, 0x03,
	282	(((timing->vdelay >> 8) & 0x03) << 6) \|
	283	(((timing->vactive >> 8) & 0x03) << 4) \|
	284	(((timing->hdelay >> 8) & 0x03) << 2) \|
	285	((timing->hactive >> 8) & 0x03));
	286	bt819_write(decoder, 0x04, timing->vdelay & 0xff);
	287	bt819_write(decoder, 0x05, timing->vactive & 0xff);
	288	bt819_write(decoder, 0x06, timing->hdelay & 0xff);
	289	bt819_write(decoder, 0x07, timing->hactive & 0xff);
	290	bt819_write(decoder, 0x08, (timing->hscale >> 8) & 0xff);
	291	bt819_write(decoder, 0x09, timing->hscale & 0xff);
	292	decoder->norm = std;
b9fb9b79	293	v4l2_subdev_notify(sd, BT819_FIFO_RESET_HIGH, NULL);
c2179ad8 HV	294	return 0;
c2179ad8 HV	295	}
1da177e4	296
5325b427 HV	297	static int bt819_s_routing(struct v4l2_subdev *sd,
5325b427 HV	298	u32 input, u32 output, u32 config)
c2179ad8 HV	299	{
c2179ad8 HV	300	struct bt819 *decoder = to_bt819(sd);
1da177e4	301
5325b427	302	v4l2_dbg(1, debug, sd, "set input %x\n", input);
1da177e4	303
f14a2972	304	if (input > 7)
c2179ad8	305	return -EINVAL;
1da177e4	306
1cd3c0fa HV	307	if (sd->v4l2_dev == NULL \|\| sd->v4l2_dev->notify == NULL)
	308	v4l2_err(sd, "no notify found!\n");
	309
5325b427	310	if (decoder->input != input) {
b9fb9b79	311	v4l2_subdev_notify(sd, BT819_FIFO_RESET_LOW, NULL);
5325b427	312	decoder->input = input;
c2179ad8 HV	313	/* select mode */
	314	if (decoder->input == 0) {
	315	bt819_setbit(decoder, 0x0b, 6, 0);
	316	bt819_setbit(decoder, 0x1a, 1, 1);
	317	} else {
	318	bt819_setbit(decoder, 0x0b, 6, 1);
	319	bt819_setbit(decoder, 0x1a, 1, 0);
1da177e4	320	}
b9fb9b79	321	v4l2_subdev_notify(sd, BT819_FIFO_RESET_HIGH, NULL);
7fd011fb	322	}
c2179ad8 HV	323	return 0;
c2179ad8 HV	324	}
1da177e4	325
c2179ad8 HV	326	static int bt819_s_stream(struct v4l2_subdev *sd, int enable)
	327	{
	328	struct bt819 *decoder = to_bt819(sd);
1da177e4	329
c2179ad8	330	v4l2_dbg(1, debug, sd, "enable output %x\n", enable);
1da177e4	331
c2179ad8 HV	332	if (decoder->enable != enable) {
	333	decoder->enable = enable;
	334	bt819_setbit(decoder, 0x16, 7, !enable);
7fd011fb	335	}
c2179ad8 HV	336	return 0;
c2179ad8 HV	337	}
1da177e4	338
bd84a65a	339	static int bt819_s_ctrl(struct v4l2_ctrl *ctrl)
c2179ad8	340	{
bd84a65a	341	struct v4l2_subdev *sd = to_sd(ctrl);
c2179ad8 HV	342	struct bt819 *decoder = to_bt819(sd);
c2179ad8 HV	343	int temp;
1da177e4	344
c2179ad8 HV	345	switch (ctrl->id) {
c2179ad8 HV	346	case V4L2_CID_BRIGHTNESS:
bd84a65a	347	bt819_write(decoder, 0x0a, ctrl->val);
c2179ad8	348	break;
1da177e4	349
c2179ad8	350	case V4L2_CID_CONTRAST:
bd84a65a HV	351	bt819_write(decoder, 0x0c, ctrl->val & 0xff);
bd84a65a HV	352	bt819_setbit(decoder, 0x0b, 2, ((ctrl->val >> 8) & 0x01));
c2179ad8	353	break;
1da177e4	354
c2179ad8	355	case V4L2_CID_SATURATION:
bd84a65a HV	356	bt819_write(decoder, 0x0d, (ctrl->val >> 7) & 0xff);
bd84a65a HV	357	bt819_setbit(decoder, 0x0b, 1, ((ctrl->val >> 15) & 0x01));
c2179ad8 HV	358
	359	/* Ratio between U gain and V gain must stay the same as
	360	the ratio between the default U and V gain values. */
bd84a65a	361	temp = (ctrl->val * 180) / 254;
c2179ad8 HV	362	bt819_write(decoder, 0x0e, (temp >> 7) & 0xff);
	363	bt819_setbit(decoder, 0x0b, 0, (temp >> 15) & 0x01);
	364	break;
1da177e4	365
c2179ad8	366	case V4L2_CID_HUE:
bd84a65a	367	bt819_write(decoder, 0x0f, ctrl->val);
107063c6	368	break;
c2179ad8 HV	369
	370	default:
	371	return -EINVAL;
107063c6	372	}
c2179ad8 HV	373	return 0;
c2179ad8 HV	374	}
1da177e4	375
1da177e4 LT	376	/* ----------------------------------------------------------------------- */
1da177e4 LT	377
bd84a65a HV	378	static const struct v4l2_ctrl_ops bt819_ctrl_ops = {
	379	.s_ctrl = bt819_s_ctrl,
	380	};
	381
c2179ad8	382	static const struct v4l2_subdev_core_ops bt819_core_ops = {
bd84a65a HV	383	.g_ext_ctrls = v4l2_subdev_g_ext_ctrls,
	384	.try_ext_ctrls = v4l2_subdev_try_ext_ctrls,
	385	.s_ext_ctrls = v4l2_subdev_s_ext_ctrls,
	386	.g_ctrl = v4l2_subdev_g_ctrl,
	387	.s_ctrl = v4l2_subdev_s_ctrl,
	388	.queryctrl = v4l2_subdev_queryctrl,
	389	.querymenu = v4l2_subdev_querymenu,
c2179ad8 HV	390	};
	391
	392	static const struct v4l2_subdev_video_ops bt819_video_ops = {
8774bed9	393	.s_std = bt819_s_std,
c2179ad8 HV	394	.s_routing = bt819_s_routing,
	395	.s_stream = bt819_s_stream,
	396	.querystd = bt819_querystd,
	397	.g_input_status = bt819_g_input_status,
	398	};
	399
	400	static const struct v4l2_subdev_ops bt819_ops = {
	401	.core = &bt819_core_ops,
c2179ad8 HV	402	.video = &bt819_video_ops,
	403	};
	404
	405	/* ----------------------------------------------------------------------- */
1da177e4	406
7fd011fb HV	407	static int bt819_probe(struct i2c_client *client,
7fd011fb HV	408	const struct i2c_device_id *id)
1da177e4	409	{
7fd011fb	410	int i, ver;
1da177e4	411	struct bt819 *decoder;
c2179ad8	412	struct v4l2_subdev *sd;
7fd011fb	413	const char *name;
1da177e4 LT	414
1da177e4 LT	415	/* Check if the adapter supports the needed features */
7fd011fb HV	416	if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA))
7fd011fb HV	417	return -ENODEV;
1da177e4	418
c02b211d	419	decoder = devm_kzalloc(&client->dev, sizeof(*decoder), GFP_KERNEL);
c2179ad8 HV	420	if (decoder == NULL)
	421	return -ENOMEM;
	422	sd = &decoder->sd;
	423	v4l2_i2c_subdev_init(sd, client, &bt819_ops);
	424
	425	ver = bt819_read(decoder, 0x17);
7fd011fb HV	426	switch (ver & 0xf0) {
	427	case 0x70:
	428	name = "bt819a";
	429	break;
	430	case 0x60:
	431	name = "bt817a";
	432	break;
	433	case 0x20:
	434	name = "bt815a";
	435	break;
	436	default:
c2179ad8	437	v4l2_dbg(1, debug, sd,
7fd011fb HV	438	"unknown chip version 0x%02x\n", ver);
	439	return -ENODEV;
	440	}
	441
	442	v4l_info(client, "%s found @ 0x%x (%s)\n", name,
	443	client->addr << 1, client->adapter->name);
1da177e4	444
107063c6	445	decoder->norm = V4L2_STD_NTSC;
1da177e4 LT	446	decoder->input = 0;
1da177e4 LT	447	decoder->enable = 1;
1da177e4	448
c2179ad8	449	i = bt819_init(sd);
7fd011fb	450	if (i < 0)
c2179ad8	451	v4l2_dbg(1, debug, sd, "init status %d\n", i);
bd84a65a HV	452
	453	v4l2_ctrl_handler_init(&decoder->hdl, 4);
	454	v4l2_ctrl_new_std(&decoder->hdl, &bt819_ctrl_ops,
	455	V4L2_CID_BRIGHTNESS, -128, 127, 1, 0);
	456	v4l2_ctrl_new_std(&decoder->hdl, &bt819_ctrl_ops,
	457	V4L2_CID_CONTRAST, 0, 511, 1, 0xd8);
	458	v4l2_ctrl_new_std(&decoder->hdl, &bt819_ctrl_ops,
	459	V4L2_CID_SATURATION, 0, 511, 1, 0xfe);
	460	v4l2_ctrl_new_std(&decoder->hdl, &bt819_ctrl_ops,
	461	V4L2_CID_HUE, -128, 127, 1, 0);
	462	sd->ctrl_handler = &decoder->hdl;
	463	if (decoder->hdl.error) {
	464	int err = decoder->hdl.error;
	465
	466	v4l2_ctrl_handler_free(&decoder->hdl);
bd84a65a HV	467	return err;
	468	}
	469	v4l2_ctrl_handler_setup(&decoder->hdl);
1da177e4 LT	470	return 0;
	471	}
	472
7fd011fb	473	static int bt819_remove(struct i2c_client *client)
1da177e4	474	{
c2179ad8	475	struct v4l2_subdev *sd = i2c_get_clientdata(client);
bd84a65a	476	struct bt819 *decoder = to_bt819(sd);
c2179ad8 HV	477
c2179ad8 HV	478	v4l2_device_unregister_subdev(sd);
bd84a65a	479	v4l2_ctrl_handler_free(&decoder->hdl);
1da177e4 LT	480	return 0;
	481	}
	482
	483	/* ----------------------------------------------------------------------- */
	484
7fd011fb HV	485	static const struct i2c_device_id bt819_id[] = {
	486	{ "bt819a", 0 },
	487	{ "bt817a", 0 },
	488	{ "bt815a", 0 },
	489	{ }
	490	};
	491	MODULE_DEVICE_TABLE(i2c, bt819_id);
1da177e4	492
00cc8db8 HV	493	static struct i2c_driver bt819_driver = {
	494	.driver = {
	495	.owner = THIS_MODULE,
	496	.name = "bt819",
	497	},
	498	.probe = bt819_probe,
	499	.remove = bt819_remove,
	500	.id_table = bt819_id,
1da177e4	501	};
00cc8db8	502
c6e8d86f	503	module_i2c_driver(bt819_driver);