[deliverable/linux.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 <asm/uaccess.h>
#include <linux/i2c.h>
#include <linux/i2c-id.h>
#include <linux/videodev2.h>
#include <media/v4l2-device.h>
#include <media/v4l2-chip-ident.h>
#include <media/v4l2-i2c-drv.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", std);

	if (std & V4L2_STD_NTSC) {
		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) {
		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", 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;
	return 0;
}

static int bt819_s_routing(struct v4l2_subdev *sd, const struct v4l2_routing *route)
{
	struct bt819 *decoder = to_bt819(sd);

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

	if (route->input < 0 || route->input > 7)
		return -EINVAL;

	if (decoder->input != route->input) {
		decoder->input = route->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);
		}
	}
	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,
};

static const struct v4l2_subdev_tuner_ops bt819_tuner_ops = {
	.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,
	.tuner = &bt819_tuner_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 v4l2_i2c_driver_data v4l2_i2c_data = {
	.name = "bt819",
	.probe = bt819_probe,
	.remove = bt819_remove,
	.id_table = bt819_id,
};
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>
18f3fa1e	35	#include <asm/uaccess.h>
7fd011fb HV	36	#include <linux/i2c.h>
7fd011fb HV	37	#include <linux/i2c-id.h>
c2179ad8 HV	38	#include <linux/videodev2.h>
	39	#include <media/v4l2-device.h>
	40	#include <media/v4l2-chip-ident.h>
2d26698e	41	#include <media/v4l2-i2c-drv.h>
1da177e4 LT	42
	43	MODULE_DESCRIPTION("Brooktree-819 video decoder driver");
	44	MODULE_AUTHOR("Mike Bernson & Dave Perks");
	45	MODULE_LICENSE("GPL");
	46
ff699e6b	47	static int debug;
1da177e4 LT	48	module_param(debug, int, 0);
	49	MODULE_PARM_DESC(debug, "Debug level (0-1)");
	50
c2179ad8	51
1da177e4 LT	52	/* ----------------------------------------------------------------------- */
	53
	54	struct bt819 {
c2179ad8	55	struct v4l2_subdev sd;
1da177e4 LT	56	unsigned char reg[32];
1da177e4 LT	57
107063c6	58	v4l2_std_id norm;
c2179ad8	59	int ident;
1da177e4 LT	60	int input;
	61	int enable;
	62	int bright;
	63	int contrast;
	64	int hue;
	65	int sat;
	66	};
	67
c2179ad8 HV	68	static inline struct bt819 to_bt819(struct v4l2_subdev sd)
	69	{
	70	return container_of(sd, struct bt819, 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;
	218	v4l2_std_id std;
	219
	220	if ((status & 0x80))
	221	res = 0;
	222
	223	if ((status & 0x10))
	224	std = V4L2_STD_PAL;
	225	else
	226	std = V4L2_STD_NTSC;
	227	if (pstd)
	228	*pstd = std;
	229	if (pstatus)
	230	*pstatus = status;
	231
	232	v4l2_dbg(1, debug, sd, "get status %x\n", status);
	233	return 0;
	234	}
1da177e4	235
c2179ad8 HV	236	static int bt819_querystd(struct v4l2_subdev sd, v4l2_std_id std)
	237	{
	238	return bt819_status(sd, NULL, std);
	239	}
1da177e4	240
c2179ad8 HV	241	static int bt819_g_input_status(struct v4l2_subdev sd, u32 status)
	242	{
	243	return bt819_status(sd, status, NULL);
	244	}
	245
	246	static int bt819_s_std(struct v4l2_subdev *sd, v4l2_std_id std)
	247	{
	248	struct bt819 *decoder = to_bt819(sd);
	249	struct timing *timing = NULL;
	250
	251	v4l2_dbg(1, debug, sd, "set norm %llx\n", std);
	252
	253	if (std & V4L2_STD_NTSC) {
	254	bt819_setbit(decoder, 0x01, 0, 1);
	255	bt819_setbit(decoder, 0x01, 1, 0);
	256	bt819_setbit(decoder, 0x01, 5, 0);
	257	bt819_write(decoder, 0x18, 0x68);
	258	bt819_write(decoder, 0x19, 0x5d);
	259	/* bt819_setbit(decoder, 0x1a, 5, 1); */
	260	timing = &timing_data[1];
	261	} else if (std & V4L2_STD_PAL) {
	262	bt819_setbit(decoder, 0x01, 0, 1);
	263	bt819_setbit(decoder, 0x01, 1, 1);
	264	bt819_setbit(decoder, 0x01, 5, 1);
	265	bt819_write(decoder, 0x18, 0x7f);
	266	bt819_write(decoder, 0x19, 0x72);
	267	/* bt819_setbit(decoder, 0x1a, 5, 0); */
	268	timing = &timing_data[0];
	269	} else {
	270	v4l2_dbg(1, debug, sd, "unsupported norm %llx\n", std);
	271	return -EINVAL;
1da177e4	272	}
c2179ad8 HV	273	bt819_write(decoder, 0x03,
	274	(((timing->vdelay >> 8) & 0x03) << 6) \|
	275	(((timing->vactive >> 8) & 0x03) << 4) \|
	276	(((timing->hdelay >> 8) & 0x03) << 2) \|
	277	((timing->hactive >> 8) & 0x03));
	278	bt819_write(decoder, 0x04, timing->vdelay & 0xff);
	279	bt819_write(decoder, 0x05, timing->vactive & 0xff);
	280	bt819_write(decoder, 0x06, timing->hdelay & 0xff);
	281	bt819_write(decoder, 0x07, timing->hactive & 0xff);
	282	bt819_write(decoder, 0x08, (timing->hscale >> 8) & 0xff);
	283	bt819_write(decoder, 0x09, timing->hscale & 0xff);
	284	decoder->norm = std;
	285	return 0;
	286	}
1da177e4	287
c2179ad8 HV	288	static int bt819_s_routing(struct v4l2_subdev sd, const struct v4l2_routing route)
	289	{
	290	struct bt819 *decoder = to_bt819(sd);
1da177e4	291
c2179ad8	292	v4l2_dbg(1, debug, sd, "set input %x\n", route->input);
1da177e4	293
c2179ad8 HV	294	if (route->input < 0 \|\| route->input > 7)
c2179ad8 HV	295	return -EINVAL;
1da177e4	296
c2179ad8 HV	297	if (decoder->input != route->input) {
	298	decoder->input = route->input;
	299	/* select mode */
	300	if (decoder->input == 0) {
	301	bt819_setbit(decoder, 0x0b, 6, 0);
	302	bt819_setbit(decoder, 0x1a, 1, 1);
	303	} else {
	304	bt819_setbit(decoder, 0x0b, 6, 1);
	305	bt819_setbit(decoder, 0x1a, 1, 0);
1da177e4	306	}
7fd011fb	307	}
c2179ad8 HV	308	return 0;
c2179ad8 HV	309	}
1da177e4	310
c2179ad8 HV	311	static int bt819_s_stream(struct v4l2_subdev *sd, int enable)
	312	{
	313	struct bt819 *decoder = to_bt819(sd);
1da177e4	314
c2179ad8	315	v4l2_dbg(1, debug, sd, "enable output %x\n", enable);
1da177e4	316
c2179ad8 HV	317	if (decoder->enable != enable) {
	318	decoder->enable = enable;
	319	bt819_setbit(decoder, 0x16, 7, !enable);
7fd011fb	320	}
c2179ad8 HV	321	return 0;
c2179ad8 HV	322	}
1da177e4	323
c2179ad8 HV	324	static int bt819_queryctrl(struct v4l2_subdev sd, struct v4l2_queryctrl qc)
	325	{
	326	switch (qc->id) {
	327	case V4L2_CID_BRIGHTNESS:
	328	v4l2_ctrl_query_fill(qc, -128, 127, 1, 0);
	329	break;
107063c6	330
c2179ad8 HV	331	case V4L2_CID_CONTRAST:
	332	v4l2_ctrl_query_fill(qc, 0, 511, 1, 256);
	333	break;
107063c6	334
c2179ad8 HV	335	case V4L2_CID_SATURATION:
	336	v4l2_ctrl_query_fill(qc, 0, 511, 1, 256);
	337	break;
107063c6	338
c2179ad8 HV	339	case V4L2_CID_HUE:
c2179ad8 HV	340	v4l2_ctrl_query_fill(qc, -128, 127, 1, 0);
1da177e4	341	break;
c2179ad8 HV	342
	343	default:
	344	return -EINVAL;
7fd011fb	345	}
c2179ad8 HV	346	return 0;
c2179ad8 HV	347	}
1da177e4	348
c2179ad8 HV	349	static int bt819_s_ctrl(struct v4l2_subdev sd, struct v4l2_control ctrl)
	350	{
	351	struct bt819 *decoder = to_bt819(sd);
	352	int temp;
1da177e4	353
c2179ad8 HV	354	switch (ctrl->id) {
	355	case V4L2_CID_BRIGHTNESS:
	356	if (decoder->bright == ctrl->value)
107063c6	357	break;
c2179ad8 HV	358	decoder->bright = ctrl->value;
	359	bt819_write(decoder, 0x0a, decoder->bright);
	360	break;
1da177e4	361
c2179ad8 HV	362	case V4L2_CID_CONTRAST:
c2179ad8 HV	363	if (decoder->contrast == ctrl->value)
107063c6	364	break;
c2179ad8 HV	365	decoder->contrast = ctrl->value;
	366	bt819_write(decoder, 0x0c, decoder->contrast & 0xff);
	367	bt819_setbit(decoder, 0x0b, 2, ((decoder->contrast >> 8) & 0x01));
	368	break;
1da177e4	369
c2179ad8 HV	370	case V4L2_CID_SATURATION:
c2179ad8 HV	371	if (decoder->sat == ctrl->value)
107063c6	372	break;
c2179ad8 HV	373	decoder->sat = ctrl->value;
	374	bt819_write(decoder, 0x0d, (decoder->sat >> 7) & 0xff);
	375	bt819_setbit(decoder, 0x0b, 1, ((decoder->sat >> 15) & 0x01));
	376
	377	/* Ratio between U gain and V gain must stay the same as
	378	the ratio between the default U and V gain values. */
	379	temp = (decoder->sat * 180) / 254;
	380	bt819_write(decoder, 0x0e, (temp >> 7) & 0xff);
	381	bt819_setbit(decoder, 0x0b, 0, (temp >> 15) & 0x01);
	382	break;
1da177e4	383
c2179ad8 HV	384	case V4L2_CID_HUE:
c2179ad8 HV	385	if (decoder->hue == ctrl->value)
107063c6	386	break;
c2179ad8 HV	387	decoder->hue = ctrl->value;
c2179ad8 HV	388	bt819_write(decoder, 0x0f, decoder->hue);
107063c6	389	break;
c2179ad8 HV	390
	391	default:
	392	return -EINVAL;
107063c6	393	}
c2179ad8 HV	394	return 0;
c2179ad8 HV	395	}
1da177e4	396
c2179ad8 HV	397	static int bt819_g_ctrl(struct v4l2_subdev sd, struct v4l2_control ctrl)
	398	{
	399	struct bt819 *decoder = to_bt819(sd);
1da177e4	400
c2179ad8 HV	401	switch (ctrl->id) {
	402	case V4L2_CID_BRIGHTNESS:
	403	ctrl->value = decoder->bright;
	404	break;
	405	case V4L2_CID_CONTRAST:
	406	ctrl->value = decoder->contrast;
	407	break;
	408	case V4L2_CID_SATURATION:
	409	ctrl->value = decoder->sat;
	410	break;
	411	case V4L2_CID_HUE:
	412	ctrl->value = decoder->hue;
1da177e4	413	break;
1da177e4 LT	414	default:
	415	return -EINVAL;
	416	}
1da177e4 LT	417	return 0;
	418	}
	419
c2179ad8 HV	420	static int bt819_g_chip_ident(struct v4l2_subdev sd, struct v4l2_dbg_chip_ident chip)
	421	{
	422	struct bt819 *decoder = to_bt819(sd);
	423	struct i2c_client *client = v4l2_get_subdevdata(sd);
	424
	425	return v4l2_chip_ident_i2c_client(client, chip, decoder->ident, 0);
	426	}
	427
1da177e4 LT	428	/* ----------------------------------------------------------------------- */
1da177e4 LT	429
c2179ad8 HV	430	static const struct v4l2_subdev_core_ops bt819_core_ops = {
	431	.g_chip_ident = bt819_g_chip_ident,
	432	.g_ctrl = bt819_g_ctrl,
	433	.s_ctrl = bt819_s_ctrl,
	434	.queryctrl = bt819_queryctrl,
	435	};
1da177e4	436
c2179ad8 HV	437	static const struct v4l2_subdev_tuner_ops bt819_tuner_ops = {
	438	.s_std = bt819_s_std,
	439	};
	440
	441	static const struct v4l2_subdev_video_ops bt819_video_ops = {
	442	.s_routing = bt819_s_routing,
	443	.s_stream = bt819_s_stream,
	444	.querystd = bt819_querystd,
	445	.g_input_status = bt819_g_input_status,
	446	};
	447
	448	static const struct v4l2_subdev_ops bt819_ops = {
	449	.core = &bt819_core_ops,
	450	.tuner = &bt819_tuner_ops,
	451	.video = &bt819_video_ops,
	452	};
	453
	454	/* ----------------------------------------------------------------------- */
1da177e4	455
7fd011fb HV	456	static int bt819_probe(struct i2c_client *client,
7fd011fb HV	457	const struct i2c_device_id *id)
1da177e4	458	{
7fd011fb	459	int i, ver;
1da177e4	460	struct bt819 *decoder;
c2179ad8	461	struct v4l2_subdev *sd;
7fd011fb	462	const char *name;
1da177e4 LT	463
1da177e4 LT	464	/* Check if the adapter supports the needed features */
7fd011fb HV	465	if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA))
7fd011fb HV	466	return -ENODEV;
1da177e4	467
c2179ad8 HV	468	decoder = kzalloc(sizeof(struct bt819), GFP_KERNEL);
	469	if (decoder == NULL)
	470	return -ENOMEM;
	471	sd = &decoder->sd;
	472	v4l2_i2c_subdev_init(sd, client, &bt819_ops);
	473
	474	ver = bt819_read(decoder, 0x17);
7fd011fb HV	475	switch (ver & 0xf0) {
	476	case 0x70:
	477	name = "bt819a";
c2179ad8	478	decoder->ident = V4L2_IDENT_BT819A;
7fd011fb HV	479	break;
	480	case 0x60:
	481	name = "bt817a";
c2179ad8	482	decoder->ident = V4L2_IDENT_BT817A;
7fd011fb HV	483	break;
	484	case 0x20:
	485	name = "bt815a";
c2179ad8	486	decoder->ident = V4L2_IDENT_BT815A;
7fd011fb HV	487	break;
7fd011fb HV	488	default:
c2179ad8	489	v4l2_dbg(1, debug, sd,
7fd011fb HV	490	"unknown chip version 0x%02x\n", ver);
	491	return -ENODEV;
	492	}
	493
	494	v4l_info(client, "%s found @ 0x%x (%s)\n", name,
	495	client->addr << 1, client->adapter->name);
1da177e4	496
107063c6	497	decoder->norm = V4L2_STD_NTSC;
1da177e4 LT	498	decoder->input = 0;
1da177e4 LT	499	decoder->enable = 1;
107063c6 HV	500	decoder->bright = 0;
	501	decoder->contrast = 0xd8; /* 100% of original signal */
	502	decoder->hue = 0;
c2179ad8	503	decoder->sat = 0xfe; /* 100% of original signal */
1da177e4	504
c2179ad8	505	i = bt819_init(sd);
7fd011fb	506	if (i < 0)
c2179ad8	507	v4l2_dbg(1, debug, sd, "init status %d\n", i);
1da177e4 LT	508	return 0;
	509	}
	510
7fd011fb	511	static int bt819_remove(struct i2c_client *client)
1da177e4	512	{
c2179ad8 HV	513	struct v4l2_subdev *sd = i2c_get_clientdata(client);
	514
	515	v4l2_device_unregister_subdev(sd);
	516	kfree(to_bt819(sd));
1da177e4 LT	517	return 0;
	518	}
	519
	520	/* ----------------------------------------------------------------------- */
	521
7fd011fb HV	522	static const struct i2c_device_id bt819_id[] = {
	523	{ "bt819a", 0 },
	524	{ "bt817a", 0 },
	525	{ "bt815a", 0 },
	526	{ }
	527	};
	528	MODULE_DEVICE_TABLE(i2c, bt819_id);
1da177e4	529
7fd011fb HV	530	static struct v4l2_i2c_driver_data v4l2_i2c_data = {
7fd011fb HV	531	.name = "bt819",
7fd011fb HV	532	.probe = bt819_probe,
	533	.remove = bt819_remove,
	534	.id_table = bt819_id,
1da177e4	535	};