[mirror_ubuntu-artful-kernel.git] / drivers / media / video / 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-chip-ident.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;
	unsigned char reg[32];

	v4l2_std_id norm;
	int ident;
	int input;
	int enable;
	int bright;
	int contrast;
	int hue;
	int sat;
};

static inline struct bt819 *to_bt819(struct v4l2_subdev *sd)
{
	return container_of(sd, struct bt819, 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;

	if ((status & 0x80))
		res = 0;

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

	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_queryctrl(struct v4l2_subdev *sd, struct v4l2_queryctrl *qc)
{
	switch (qc->id) {
	case V4L2_CID_BRIGHTNESS:
		v4l2_ctrl_query_fill(qc, -128, 127, 1, 0);
		break;

	case V4L2_CID_CONTRAST:
		v4l2_ctrl_query_fill(qc, 0, 511, 1, 256);
		break;

	case V4L2_CID_SATURATION:
		v4l2_ctrl_query_fill(qc, 0, 511, 1, 256);
		break;

	case V4L2_CID_HUE:
		v4l2_ctrl_query_fill(qc, -128, 127, 1, 0);
		break;

	default:
		return -EINVAL;
	}
	return 0;
}

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

	switch (ctrl->id) {
	case V4L2_CID_BRIGHTNESS:
		if (decoder->bright == ctrl->value)
			break;
		decoder->bright = ctrl->value;
		bt819_write(decoder, 0x0a, decoder->bright);
		break;

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

	case V4L2_CID_SATURATION:
		if (decoder->sat == ctrl->value)
			break;
		decoder->sat = ctrl->value;
		bt819_write(decoder, 0x0d, (decoder->sat >> 7) & 0xff);
		bt819_setbit(decoder, 0x0b, 1, ((decoder->sat >> 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 = (decoder->sat * 180) / 254;
		bt819_write(decoder, 0x0e, (temp >> 7) & 0xff);
		bt819_setbit(decoder, 0x0b, 0, (temp >> 15) & 0x01);
		break;

	case V4L2_CID_HUE:
		if (decoder->hue == ctrl->value)
			break;
		decoder->hue = ctrl->value;
		bt819_write(decoder, 0x0f, decoder->hue);
		break;

	default:
		return -EINVAL;
	}
	return 0;
}

static int bt819_g_ctrl(struct v4l2_subdev *sd, struct v4l2_control *ctrl)
{
	struct bt819 *decoder = to_bt819(sd);

	switch (ctrl->id) {
	case V4L2_CID_BRIGHTNESS:
		ctrl->value = decoder->bright;
		break;
	case V4L2_CID_CONTRAST:
		ctrl->value = decoder->contrast;
		break;
	case V4L2_CID_SATURATION:
		ctrl->value = decoder->sat;
		break;
	case V4L2_CID_HUE:
		ctrl->value = decoder->hue;
		break;
	default:
		return -EINVAL;
	}
	return 0;
}

static int bt819_g_chip_ident(struct v4l2_subdev *sd, struct v4l2_dbg_chip_ident *chip)
{
	struct bt819 *decoder = to_bt819(sd);
	struct i2c_client *client = v4l2_get_subdevdata(sd);

	return v4l2_chip_ident_i2c_client(client, chip, decoder->ident, 0);
}

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

static const struct v4l2_subdev_core_ops bt819_core_ops = {
	.g_chip_ident = bt819_g_chip_ident,
	.g_ctrl = bt819_g_ctrl,
	.s_ctrl = bt819_s_ctrl,
	.queryctrl = bt819_queryctrl,
	.s_std = bt819_s_std,
};

static const struct v4l2_subdev_video_ops bt819_video_ops = {
	.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 = kzalloc(sizeof(struct bt819), 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";
		decoder->ident = V4L2_IDENT_BT819A;
		break;
	case 0x60:
		name = "bt817a";
		decoder->ident = V4L2_IDENT_BT817A;
		break;
	case 0x20:
		name = "bt815a";
		decoder->ident = V4L2_IDENT_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;
	decoder->bright = 0;
	decoder->contrast = 0xd8;	/* 100% of original signal */
	decoder->hue = 0;
	decoder->sat = 0xfe;		/* 100% of original signal */

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

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

	v4l2_device_unregister_subdev(sd);
	kfree(to_bt819(sd));
	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,
};

static __init int init_bt819(void)
{
	return i2c_add_driver(&bt819_driver);
}

static __exit void exit_bt819(void)
{
	i2c_del_driver(&bt819_driver);
}

module_init(init_bt819);
module_exit(exit_bt819);
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 HV	38	#include <media/v4l2-device.h>
c2179ad8 HV	39	#include <media/v4l2-chip-ident.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;
1da177e4 LT	55	unsigned char reg[32];
1da177e4 LT	56
107063c6	57	v4l2_std_id norm;
c2179ad8	58	int ident;
1da177e4 LT	59	int input;
	60	int enable;
	61	int bright;
	62	int contrast;
	63	int hue;
	64	int sat;
	65	};
	66
c2179ad8 HV	67	static inline struct bt819 to_bt819(struct v4l2_subdev sd)
	68	{
	69	return container_of(sd, struct bt819, sd);
	70	}
	71
1da177e4 LT	72	struct timing {
	73	int hactive;
	74	int hdelay;
	75	int vactive;
	76	int vdelay;
	77	int hscale;
	78	int vscale;
	79	};
	80
	81	/* for values, see the bt819 datasheet */
	82	static struct timing timing_data[] = {
	83	{864 - 24, 20, 625 - 2, 1, 0x0504, 0x0000},
	84	{858 - 24, 20, 525 - 2, 1, 0x00f8, 0x0000},
	85	};
	86
1da177e4 LT	87	/* ----------------------------------------------------------------------- */
1da177e4 LT	88
c2179ad8	89	static inline int bt819_write(struct bt819 *decoder, u8 reg, u8 value)
1da177e4	90	{
c2179ad8	91	struct i2c_client *client = v4l2_get_subdevdata(&decoder->sd);
1da177e4 LT	92
	93	decoder->reg[reg] = value;
	94	return i2c_smbus_write_byte_data(client, reg, value);
	95	}
	96
c2179ad8	97	static inline int bt819_setbit(struct bt819 *decoder, u8 reg, u8 bit, u8 value)
1da177e4	98	{
c2179ad8	99	return bt819_write(decoder, reg,
7fd011fb	100	(decoder->reg[reg] & ~(1 << bit)) \| (value ? (1 << bit) : 0));
1da177e4 LT	101	}
1da177e4 LT	102
c2179ad8	103	static int bt819_write_block(struct bt819 decoder, const u8 data, unsigned int len)
1da177e4	104	{
c2179ad8	105	struct i2c_client *client = v4l2_get_subdevdata(&decoder->sd);
1da177e4 LT	106	int ret = -1;
	107	u8 reg;
	108
	109	/* the bt819 has an autoincrement function, use it if
	110	* the adapter understands raw I2C */
	111	if (i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) {
	112	/* do raw I2C, not smbus compatible */
1da177e4	113	u8 block_data[32];
9aa45e34	114	int block_len;
1da177e4	115
1da177e4	116	while (len >= 2) {
9aa45e34 JD	117	block_len = 0;
9aa45e34 JD	118	block_data[block_len++] = reg = data[0];
1da177e4	119	do {
9aa45e34	120	block_data[block_len++] =
1da177e4 LT	121	decoder->reg[reg++] = data[1];
	122	len -= 2;
	123	data += 2;
7fd011fb HV	124	} while (len >= 2 && data[0] == reg && block_len < 32);
	125	ret = i2c_master_send(client, block_data, block_len);
	126	if (ret < 0)
1da177e4 LT	127	break;
	128	}
	129	} else {
	130	/* do some slow I2C emulation kind of thing */
	131	while (len >= 2) {
	132	reg = *data++;
c2179ad8 HV	133	ret = bt819_write(decoder, reg, *data++);
c2179ad8 HV	134	if (ret < 0)
1da177e4 LT	135	break;
	136	len -= 2;
	137	}
	138	}
	139
	140	return ret;
	141	}
	142
c2179ad8	143	static inline int bt819_read(struct bt819 *decoder, u8 reg)
1da177e4	144	{
c2179ad8 HV	145	struct i2c_client *client = v4l2_get_subdevdata(&decoder->sd);
c2179ad8 HV	146
1da177e4 LT	147	return i2c_smbus_read_byte_data(client, reg);
	148	}
	149
c2179ad8	150	static int bt819_init(struct v4l2_subdev *sd)
1da177e4	151	{
1da177e4	152	static unsigned char init[] = {
7fd011fb	153	/0x1f, 0x00,/ /* Reset */
1da177e4 LT	154	0x01, 0x59, /* 0x01 input format */
	155	0x02, 0x00, /* 0x02 temporal decimation */
	156	0x03, 0x12, /* 0x03 Cropping msb */
	157	0x04, 0x16, /* 0x04 Vertical Delay, lsb */
	158	0x05, 0xe0, /* 0x05 Vertical Active lsb */
	159	0x06, 0x80, /* 0x06 Horizontal Delay lsb */
	160	0x07, 0xd0, /* 0x07 Horizontal Active lsb */
	161	0x08, 0x00, /* 0x08 Horizontal Scaling msb */
	162	0x09, 0xf8, /* 0x09 Horizontal Scaling lsb */
	163	0x0a, 0x00, /* 0x0a Brightness control */
	164	0x0b, 0x30, /* 0x0b Miscellaneous control */
	165	0x0c, 0xd8, /* 0x0c Luma Gain lsb */
	166	0x0d, 0xfe, /* 0x0d Chroma Gain (U) lsb */
	167	0x0e, 0xb4, /* 0x0e Chroma Gain (V) msb */
	168	0x0f, 0x00, /* 0x0f Hue control */
	169	0x12, 0x04, /* 0x12 Output Format */
	170	0x13, 0x20, /* 0x13 Vertial Scaling msb 0x00
	171	chroma comb OFF, line drop scaling, interlace scaling
	172	BUG? Why does turning the chroma comb on fuck up color?
	173	Bug in the bt819 stepping on my board?
	174	*/
	175	0x14, 0x00, /* 0x14 Vertial Scaling lsb */
d56410e0	176	0x16, 0x07, /* 0x16 Video Timing Polarity
1da177e4	177	ACTIVE=active low
d56410e0	178	FIELD: high=odd,
1da177e4 LT	179	vreset=active high,
	180	hreset=active high */
	181	0x18, 0x68, /* 0x18 AGC Delay */
	182	0x19, 0x5d, /* 0x19 Burst Gate Delay */
	183	0x1a, 0x80, /* 0x1a ADC Interface */
	184	};
	185
c2179ad8	186	struct bt819 *decoder = to_bt819(sd);
107063c6	187	struct timing *timing = &timing_data[(decoder->norm & V4L2_STD_525_60) ? 1 : 0];
1da177e4 LT	188
1da177e4 LT	189	init[0x03 * 2 - 1] =
7fd011fb HV	190	(((timing->vdelay >> 8) & 0x03) << 6) \|
	191	(((timing->vactive >> 8) & 0x03) << 4) \|
	192	(((timing->hdelay >> 8) & 0x03) << 2) \|
	193	((timing->hactive >> 8) & 0x03);
1da177e4 LT	194	init[0x04 * 2 - 1] = timing->vdelay & 0xff;
	195	init[0x05 * 2 - 1] = timing->vactive & 0xff;
	196	init[0x06 * 2 - 1] = timing->hdelay & 0xff;
	197	init[0x07 * 2 - 1] = timing->hactive & 0xff;
	198	init[0x08 * 2 - 1] = timing->hscale >> 8;
	199	init[0x09 * 2 - 1] = timing->hscale & 0xff;
	200	/* 0x15 in array is address 0x19 */
107063c6	201	init[0x15 * 2 - 1] = (decoder->norm & V4L2_STD_625_50) ? 115 : 93; /* Chroma burst delay */
1da177e4	202	/* reset */
c2179ad8	203	bt819_write(decoder, 0x1f, 0x00);
1da177e4 LT	204	mdelay(1);
	205
	206	/* init */
c2179ad8	207	return bt819_write_block(decoder, init, sizeof(init));
1da177e4 LT	208	}
	209
	210	/* ----------------------------------------------------------------------- */
	211
c2179ad8	212	static int bt819_status(struct v4l2_subdev sd, u32 pstatus, v4l2_std_id *pstd)
1da177e4	213	{
c2179ad8 HV	214	struct bt819 *decoder = to_bt819(sd);
	215	int status = bt819_read(decoder, 0x00);
	216	int res = V4L2_IN_ST_NO_SIGNAL;
	217	v4l2_std_id std;
	218
	219	if ((status & 0x80))
	220	res = 0;
	221
	222	if ((status & 0x10))
	223	std = V4L2_STD_PAL;
	224	else
	225	std = V4L2_STD_NTSC;
	226	if (pstd)
	227	*pstd = std;
	228	if (pstatus)
	229	*pstatus = status;
	230
	231	v4l2_dbg(1, debug, sd, "get status %x\n", status);
	232	return 0;
	233	}
1da177e4	234
c2179ad8 HV	235	static int bt819_querystd(struct v4l2_subdev sd, v4l2_std_id std)
	236	{
	237	return bt819_status(sd, NULL, std);
	238	}
1da177e4	239
c2179ad8 HV	240	static int bt819_g_input_status(struct v4l2_subdev sd, u32 status)
	241	{
	242	return bt819_status(sd, status, NULL);
	243	}
	244
	245	static int bt819_s_std(struct v4l2_subdev *sd, v4l2_std_id std)
	246	{
	247	struct bt819 *decoder = to_bt819(sd);
	248	struct timing *timing = NULL;
	249
cc5cef8e	250	v4l2_dbg(1, debug, sd, "set norm %llx\n", (unsigned long long)std);
c2179ad8	251
1cd3c0fa HV	252	if (sd->v4l2_dev == NULL \|\| sd->v4l2_dev->notify == NULL)
	253	v4l2_err(sd, "no notify found!\n");
	254
c2179ad8	255	if (std & V4L2_STD_NTSC) {
b9fb9b79	256	v4l2_subdev_notify(sd, BT819_FIFO_RESET_LOW, NULL);
c2179ad8 HV	257	bt819_setbit(decoder, 0x01, 0, 1);
	258	bt819_setbit(decoder, 0x01, 1, 0);
	259	bt819_setbit(decoder, 0x01, 5, 0);
	260	bt819_write(decoder, 0x18, 0x68);
	261	bt819_write(decoder, 0x19, 0x5d);
	262	/* bt819_setbit(decoder, 0x1a, 5, 1); */
	263	timing = &timing_data[1];
	264	} else if (std & V4L2_STD_PAL) {
b9fb9b79	265	v4l2_subdev_notify(sd, BT819_FIFO_RESET_LOW, NULL);
c2179ad8 HV	266	bt819_setbit(decoder, 0x01, 0, 1);
	267	bt819_setbit(decoder, 0x01, 1, 1);
	268	bt819_setbit(decoder, 0x01, 5, 1);
	269	bt819_write(decoder, 0x18, 0x7f);
	270	bt819_write(decoder, 0x19, 0x72);
	271	/* bt819_setbit(decoder, 0x1a, 5, 0); */
	272	timing = &timing_data[0];
	273	} else {
cc5cef8e HV	274	v4l2_dbg(1, debug, sd, "unsupported norm %llx\n",
cc5cef8e HV	275	(unsigned long long)std);
c2179ad8	276	return -EINVAL;
1da177e4	277	}
c2179ad8 HV	278	bt819_write(decoder, 0x03,
	279	(((timing->vdelay >> 8) & 0x03) << 6) \|
	280	(((timing->vactive >> 8) & 0x03) << 4) \|
	281	(((timing->hdelay >> 8) & 0x03) << 2) \|
	282	((timing->hactive >> 8) & 0x03));
	283	bt819_write(decoder, 0x04, timing->vdelay & 0xff);
	284	bt819_write(decoder, 0x05, timing->vactive & 0xff);
	285	bt819_write(decoder, 0x06, timing->hdelay & 0xff);
	286	bt819_write(decoder, 0x07, timing->hactive & 0xff);
	287	bt819_write(decoder, 0x08, (timing->hscale >> 8) & 0xff);
	288	bt819_write(decoder, 0x09, timing->hscale & 0xff);
	289	decoder->norm = std;
b9fb9b79	290	v4l2_subdev_notify(sd, BT819_FIFO_RESET_HIGH, NULL);
c2179ad8 HV	291	return 0;
c2179ad8 HV	292	}
1da177e4	293
5325b427 HV	294	static int bt819_s_routing(struct v4l2_subdev *sd,
5325b427 HV	295	u32 input, u32 output, u32 config)
c2179ad8 HV	296	{
c2179ad8 HV	297	struct bt819 *decoder = to_bt819(sd);
1da177e4	298
5325b427	299	v4l2_dbg(1, debug, sd, "set input %x\n", input);
1da177e4	300
f14a2972	301	if (input > 7)
c2179ad8	302	return -EINVAL;
1da177e4	303
1cd3c0fa HV	304	if (sd->v4l2_dev == NULL \|\| sd->v4l2_dev->notify == NULL)
	305	v4l2_err(sd, "no notify found!\n");
	306
5325b427	307	if (decoder->input != input) {
b9fb9b79	308	v4l2_subdev_notify(sd, BT819_FIFO_RESET_LOW, NULL);
5325b427	309	decoder->input = input;
c2179ad8 HV	310	/* select mode */
	311	if (decoder->input == 0) {
	312	bt819_setbit(decoder, 0x0b, 6, 0);
	313	bt819_setbit(decoder, 0x1a, 1, 1);
	314	} else {
	315	bt819_setbit(decoder, 0x0b, 6, 1);
	316	bt819_setbit(decoder, 0x1a, 1, 0);
1da177e4	317	}
b9fb9b79	318	v4l2_subdev_notify(sd, BT819_FIFO_RESET_HIGH, NULL);
7fd011fb	319	}
c2179ad8 HV	320	return 0;
c2179ad8 HV	321	}
1da177e4	322
c2179ad8 HV	323	static int bt819_s_stream(struct v4l2_subdev *sd, int enable)
	324	{
	325	struct bt819 *decoder = to_bt819(sd);
1da177e4	326
c2179ad8	327	v4l2_dbg(1, debug, sd, "enable output %x\n", enable);
1da177e4	328
c2179ad8 HV	329	if (decoder->enable != enable) {
	330	decoder->enable = enable;
	331	bt819_setbit(decoder, 0x16, 7, !enable);
7fd011fb	332	}
c2179ad8 HV	333	return 0;
c2179ad8 HV	334	}
1da177e4	335
c2179ad8 HV	336	static int bt819_queryctrl(struct v4l2_subdev sd, struct v4l2_queryctrl qc)
	337	{
	338	switch (qc->id) {
	339	case V4L2_CID_BRIGHTNESS:
	340	v4l2_ctrl_query_fill(qc, -128, 127, 1, 0);
	341	break;
107063c6	342
c2179ad8 HV	343	case V4L2_CID_CONTRAST:
	344	v4l2_ctrl_query_fill(qc, 0, 511, 1, 256);
	345	break;
107063c6	346
c2179ad8 HV	347	case V4L2_CID_SATURATION:
	348	v4l2_ctrl_query_fill(qc, 0, 511, 1, 256);
	349	break;
107063c6	350
c2179ad8 HV	351	case V4L2_CID_HUE:
c2179ad8 HV	352	v4l2_ctrl_query_fill(qc, -128, 127, 1, 0);
1da177e4	353	break;
c2179ad8 HV	354
	355	default:
	356	return -EINVAL;
7fd011fb	357	}
c2179ad8 HV	358	return 0;
c2179ad8 HV	359	}
1da177e4	360
c2179ad8 HV	361	static int bt819_s_ctrl(struct v4l2_subdev sd, struct v4l2_control ctrl)
	362	{
	363	struct bt819 *decoder = to_bt819(sd);
	364	int temp;
1da177e4	365
c2179ad8 HV	366	switch (ctrl->id) {
	367	case V4L2_CID_BRIGHTNESS:
	368	if (decoder->bright == ctrl->value)
107063c6	369	break;
c2179ad8 HV	370	decoder->bright = ctrl->value;
	371	bt819_write(decoder, 0x0a, decoder->bright);
	372	break;
1da177e4	373
c2179ad8 HV	374	case V4L2_CID_CONTRAST:
c2179ad8 HV	375	if (decoder->contrast == ctrl->value)
107063c6	376	break;
c2179ad8 HV	377	decoder->contrast = ctrl->value;
	378	bt819_write(decoder, 0x0c, decoder->contrast & 0xff);
	379	bt819_setbit(decoder, 0x0b, 2, ((decoder->contrast >> 8) & 0x01));
	380	break;
1da177e4	381
c2179ad8 HV	382	case V4L2_CID_SATURATION:
c2179ad8 HV	383	if (decoder->sat == ctrl->value)
107063c6	384	break;
c2179ad8 HV	385	decoder->sat = ctrl->value;
	386	bt819_write(decoder, 0x0d, (decoder->sat >> 7) & 0xff);
	387	bt819_setbit(decoder, 0x0b, 1, ((decoder->sat >> 15) & 0x01));
	388
	389	/* Ratio between U gain and V gain must stay the same as
	390	the ratio between the default U and V gain values. */
	391	temp = (decoder->sat * 180) / 254;
	392	bt819_write(decoder, 0x0e, (temp >> 7) & 0xff);
	393	bt819_setbit(decoder, 0x0b, 0, (temp >> 15) & 0x01);
	394	break;
1da177e4	395
c2179ad8 HV	396	case V4L2_CID_HUE:
c2179ad8 HV	397	if (decoder->hue == ctrl->value)
107063c6	398	break;
c2179ad8 HV	399	decoder->hue = ctrl->value;
c2179ad8 HV	400	bt819_write(decoder, 0x0f, decoder->hue);
107063c6	401	break;
c2179ad8 HV	402
	403	default:
	404	return -EINVAL;
107063c6	405	}
c2179ad8 HV	406	return 0;
c2179ad8 HV	407	}
1da177e4	408
c2179ad8 HV	409	static int bt819_g_ctrl(struct v4l2_subdev sd, struct v4l2_control ctrl)
	410	{
	411	struct bt819 *decoder = to_bt819(sd);
1da177e4	412
c2179ad8 HV	413	switch (ctrl->id) {
	414	case V4L2_CID_BRIGHTNESS:
	415	ctrl->value = decoder->bright;
	416	break;
	417	case V4L2_CID_CONTRAST:
	418	ctrl->value = decoder->contrast;
	419	break;
	420	case V4L2_CID_SATURATION:
	421	ctrl->value = decoder->sat;
	422	break;
	423	case V4L2_CID_HUE:
	424	ctrl->value = decoder->hue;
1da177e4	425	break;
1da177e4 LT	426	default:
	427	return -EINVAL;
	428	}
1da177e4 LT	429	return 0;
	430	}
	431
c2179ad8 HV	432	static int bt819_g_chip_ident(struct v4l2_subdev sd, struct v4l2_dbg_chip_ident chip)
	433	{
	434	struct bt819 *decoder = to_bt819(sd);
	435	struct i2c_client *client = v4l2_get_subdevdata(sd);
	436
	437	return v4l2_chip_ident_i2c_client(client, chip, decoder->ident, 0);
	438	}
	439
1da177e4 LT	440	/* ----------------------------------------------------------------------- */
1da177e4 LT	441
c2179ad8 HV	442	static const struct v4l2_subdev_core_ops bt819_core_ops = {
	443	.g_chip_ident = bt819_g_chip_ident,
	444	.g_ctrl = bt819_g_ctrl,
	445	.s_ctrl = bt819_s_ctrl,
	446	.queryctrl = bt819_queryctrl,
c2179ad8 HV	447	.s_std = bt819_s_std,
	448	};
	449
	450	static const struct v4l2_subdev_video_ops bt819_video_ops = {
	451	.s_routing = bt819_s_routing,
	452	.s_stream = bt819_s_stream,
	453	.querystd = bt819_querystd,
	454	.g_input_status = bt819_g_input_status,
	455	};
	456
	457	static const struct v4l2_subdev_ops bt819_ops = {
	458	.core = &bt819_core_ops,
c2179ad8 HV	459	.video = &bt819_video_ops,
	460	};
	461
	462	/* ----------------------------------------------------------------------- */
1da177e4	463
7fd011fb HV	464	static int bt819_probe(struct i2c_client *client,
7fd011fb HV	465	const struct i2c_device_id *id)
1da177e4	466	{
7fd011fb	467	int i, ver;
1da177e4	468	struct bt819 *decoder;
c2179ad8	469	struct v4l2_subdev *sd;
7fd011fb	470	const char *name;
1da177e4 LT	471
1da177e4 LT	472	/* Check if the adapter supports the needed features */
7fd011fb HV	473	if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA))
7fd011fb HV	474	return -ENODEV;
1da177e4	475
c2179ad8 HV	476	decoder = kzalloc(sizeof(struct bt819), GFP_KERNEL);
	477	if (decoder == NULL)
	478	return -ENOMEM;
	479	sd = &decoder->sd;
	480	v4l2_i2c_subdev_init(sd, client, &bt819_ops);
	481
	482	ver = bt819_read(decoder, 0x17);
7fd011fb HV	483	switch (ver & 0xf0) {
	484	case 0x70:
	485	name = "bt819a";
c2179ad8	486	decoder->ident = V4L2_IDENT_BT819A;
7fd011fb HV	487	break;
	488	case 0x60:
	489	name = "bt817a";
c2179ad8	490	decoder->ident = V4L2_IDENT_BT817A;
7fd011fb HV	491	break;
	492	case 0x20:
	493	name = "bt815a";
c2179ad8	494	decoder->ident = V4L2_IDENT_BT815A;
7fd011fb HV	495	break;
7fd011fb HV	496	default:
c2179ad8	497	v4l2_dbg(1, debug, sd,
7fd011fb HV	498	"unknown chip version 0x%02x\n", ver);
	499	return -ENODEV;
	500	}
	501
	502	v4l_info(client, "%s found @ 0x%x (%s)\n", name,
	503	client->addr << 1, client->adapter->name);
1da177e4	504
107063c6	505	decoder->norm = V4L2_STD_NTSC;
1da177e4 LT	506	decoder->input = 0;
1da177e4 LT	507	decoder->enable = 1;
107063c6 HV	508	decoder->bright = 0;
	509	decoder->contrast = 0xd8; /* 100% of original signal */
	510	decoder->hue = 0;
c2179ad8	511	decoder->sat = 0xfe; /* 100% of original signal */
1da177e4	512
c2179ad8	513	i = bt819_init(sd);
7fd011fb	514	if (i < 0)
c2179ad8	515	v4l2_dbg(1, debug, sd, "init status %d\n", i);
1da177e4 LT	516	return 0;
	517	}
	518
7fd011fb	519	static int bt819_remove(struct i2c_client *client)
1da177e4	520	{
c2179ad8 HV	521	struct v4l2_subdev *sd = i2c_get_clientdata(client);
	522
	523	v4l2_device_unregister_subdev(sd);
	524	kfree(to_bt819(sd));
1da177e4 LT	525	return 0;
	526	}
	527
	528	/* ----------------------------------------------------------------------- */
	529
7fd011fb HV	530	static const struct i2c_device_id bt819_id[] = {
	531	{ "bt819a", 0 },
	532	{ "bt817a", 0 },
	533	{ "bt815a", 0 },
	534	{ }
	535	};
	536	MODULE_DEVICE_TABLE(i2c, bt819_id);
1da177e4	537
00cc8db8 HV	538	static struct i2c_driver bt819_driver = {
	539	.driver = {
	540	.owner = THIS_MODULE,
	541	.name = "bt819",
	542	},
	543	.probe = bt819_probe,
	544	.remove = bt819_remove,
	545	.id_table = bt819_id,
1da177e4	546	};
00cc8db8 HV	547
	548	static __init int init_bt819(void)
	549	{
	550	return i2c_add_driver(&bt819_driver);
	551	}
	552
	553	static __exit void exit_bt819(void)
	554	{
	555	i2c_del_driver(&bt819_driver);
	556	}
	557
	558	module_init(init_bt819);
	559	module_exit(exit_bt819);