[deliverable/linux.git] / drivers / media / video / bt856.c

/*
 * bt856 - BT856A Digital Video Encoder (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>
 *
 * This code was modify/ported from the saa7111 driver written
 * by Dave Perks.
 *
 * Changes by Ronald Bultje <rbultje@ronald.bitfreak.net>
 *   - moved over to linux>=2.4.x i2c protocol (9/9/2002)
 *
 * 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 <asm/uaccess.h>
#include <linux/i2c.h>
#include <linux/i2c-id.h>
#include <linux/videodev.h>
#include <linux/video_encoder.h>
#include <media/v4l2-common.h>
#include <media/v4l2-i2c-drv-legacy.h>

MODULE_DESCRIPTION("Brooktree-856A video encoder 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)");

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

#define BT856_REG_OFFSET	0xDA
#define BT856_NR_REG		6

struct bt856 {
	unsigned char reg[BT856_NR_REG];

	int norm;
	int enable;
};

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

static inline int bt856_write(struct i2c_client *client, u8 reg, u8 value)
{
	struct bt856 *encoder = i2c_get_clientdata(client);

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

static inline int bt856_setbit(struct i2c_client *client, u8 reg, u8 bit, u8 value)
{
	struct bt856 *encoder = i2c_get_clientdata(client);

	return bt856_write(client, reg,
		(encoder->reg[reg - BT856_REG_OFFSET] & ~(1 << bit)) |
				(value ? (1 << bit) : 0));
}

static void bt856_dump(struct i2c_client *client)
{
	int i;
	struct bt856 *encoder = i2c_get_clientdata(client);

	v4l_info(client, "register dump:\n");
	for (i = 0; i < BT856_NR_REG; i += 2)
		printk(KERN_CONT " %02x", encoder->reg[i]);
	printk(KERN_CONT "\n");
}

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

static int bt856_command(struct i2c_client *client, unsigned cmd, void *arg)
{
	struct bt856 *encoder = i2c_get_clientdata(client);

	switch (cmd) {
	case 0:
		/* This is just for testing!!! */
		v4l_dbg(1, debug, client, "init\n");
		bt856_write(client, 0xdc, 0x18);
		bt856_write(client, 0xda, 0);
		bt856_write(client, 0xde, 0);

		bt856_setbit(client, 0xdc, 3, 1);
		//bt856_setbit(client, 0xdc, 6, 0);
		bt856_setbit(client, 0xdc, 4, 1);

		switch (encoder->norm) {
		case VIDEO_MODE_NTSC:
			bt856_setbit(client, 0xdc, 2, 0);
			break;

		case VIDEO_MODE_PAL:
			bt856_setbit(client, 0xdc, 2, 1);
			break;
		}

		bt856_setbit(client, 0xdc, 1, 1);
		bt856_setbit(client, 0xde, 4, 0);
		bt856_setbit(client, 0xde, 3, 1);
		if (debug != 0)
			bt856_dump(client);
		break;

	case ENCODER_GET_CAPABILITIES:
	{
		struct video_encoder_capability *cap = arg;

		v4l_dbg(1, debug, client, "get capabilities\n");

		cap->flags = VIDEO_ENCODER_PAL |
			     VIDEO_ENCODER_NTSC |
			     VIDEO_ENCODER_CCIR;
		cap->inputs = 2;
		cap->outputs = 1;
		break;
	}

	case ENCODER_SET_NORM:
	{
		int *iarg = arg;

		v4l_dbg(1, debug, client, "set norm %d\n", *iarg);

		switch (*iarg) {
		case VIDEO_MODE_NTSC:
			bt856_setbit(client, 0xdc, 2, 0);
			break;

		case VIDEO_MODE_PAL:
			bt856_setbit(client, 0xdc, 2, 1);
			bt856_setbit(client, 0xda, 0, 0);
			//bt856_setbit(client, 0xda, 0, 1);
			break;

		default:
			return -EINVAL;
		}
		encoder->norm = *iarg;
		if (debug != 0)
			bt856_dump(client);
		break;
	}

	case ENCODER_SET_INPUT:
	{
		int *iarg = arg;

		v4l_dbg(1, debug, client, "set input %d\n", *iarg);

		/* We only have video bus.
		 * iarg = 0: input is from bt819
		 * iarg = 1: input is from ZR36060 */
		switch (*iarg) {
		case 0:
			bt856_setbit(client, 0xde, 4, 0);
			bt856_setbit(client, 0xde, 3, 1);
			bt856_setbit(client, 0xdc, 3, 1);
			bt856_setbit(client, 0xdc, 6, 0);
			break;
		case 1:
			bt856_setbit(client, 0xde, 4, 0);
			bt856_setbit(client, 0xde, 3, 1);
			bt856_setbit(client, 0xdc, 3, 1);
			bt856_setbit(client, 0xdc, 6, 1);
			break;
		case 2:	// Color bar
			bt856_setbit(client, 0xdc, 3, 0);
			bt856_setbit(client, 0xde, 4, 1);
			break;
		default:
			return -EINVAL;
		}

		if (debug != 0)
			bt856_dump(client);
		break;
	}

	case ENCODER_SET_OUTPUT:
	{
		int *iarg = arg;

		v4l_dbg(1, debug, client, "set output %d\n", *iarg);

		/* not much choice of outputs */
		if (*iarg != 0)
			return -EINVAL;
		break;
	}

	case ENCODER_ENABLE_OUTPUT:
	{
		int *iarg = arg;

		encoder->enable = !!*iarg;

		v4l_dbg(1, debug, client, "enable output %d\n", encoder->enable);
		break;
	}

	default:
		return -EINVAL;
	}

	return 0;
}

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

static unsigned short normal_i2c[] = { 0x88 >> 1, I2C_CLIENT_END };

I2C_CLIENT_INSMOD;

static int bt856_probe(struct i2c_client *client,
			const struct i2c_device_id *id)
{
	struct bt856 *encoder;

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

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

	encoder = kzalloc(sizeof(struct bt856), GFP_KERNEL);
	if (encoder == NULL)
		return -ENOMEM;
	encoder->norm = VIDEO_MODE_NTSC;
	encoder->enable = 1;
	i2c_set_clientdata(client, encoder);

	bt856_write(client, 0xdc, 0x18);
	bt856_write(client, 0xda, 0);
	bt856_write(client, 0xde, 0);

	bt856_setbit(client, 0xdc, 3, 1);
	//bt856_setbit(client, 0xdc, 6, 0);
	bt856_setbit(client, 0xdc, 4, 1);

	switch (encoder->norm) {

	case VIDEO_MODE_NTSC:
		bt856_setbit(client, 0xdc, 2, 0);
		break;

	case VIDEO_MODE_PAL:
		bt856_setbit(client, 0xdc, 2, 1);
		break;
	}

	bt856_setbit(client, 0xdc, 1, 1);
	bt856_setbit(client, 0xde, 4, 0);
	bt856_setbit(client, 0xde, 3, 1);

	if (debug != 0)
		bt856_dump(client);
	return 0;
}

static int bt856_remove(struct i2c_client *client)
{
	kfree(i2c_get_clientdata(client));
	return 0;
}

static const struct i2c_device_id bt856_id[] = {
	{ "bt856", 0 },
	{ }
};
MODULE_DEVICE_TABLE(i2c, bt856_id);

static struct v4l2_i2c_driver_data v4l2_i2c_data = {
	.name = "bt856",
	.driverid = I2C_DRIVERID_BT856,
	.command = bt856_command,
	.probe = bt856_probe,
	.remove = bt856_remove,
	.id_table = bt856_id,
};
Commit	Line	Data
d56410e0	1	/*
1da177e4 LT	2	* bt856 - BT856A Digital Video Encoder (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>
	9	*
	10	* This code was modify/ported from the saa7111 driver written
	11	* by Dave Perks.
	12	*
	13	* Changes by Ronald Bultje <rbultje@ronald.bitfreak.net>
	14	* - moved over to linux>=2.4.x i2c protocol (9/9/2002)
	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>
a8c26dfe	33	#include <linux/ioctl.h>
18f3fa1e	34	#include <asm/uaccess.h>
a8c26dfe HV	35	#include <linux/i2c.h>
a8c26dfe HV	36	#include <linux/i2c-id.h>
1da177e4	37	#include <linux/videodev.h>
a8c26dfe HV	38	#include <linux/video_encoder.h>
	39	#include <media/v4l2-common.h>
	40	#include <media/v4l2-i2c-drv-legacy.h>
1da177e4 LT	41
	42	MODULE_DESCRIPTION("Brooktree-856A video encoder 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
1da177e4 LT	50	/* ----------------------------------------------------------------------- */
1da177e4 LT	51
187565c4 HV	52	#define BT856_REG_OFFSET 0xDA
187565c4 HV	53	#define BT856_NR_REG 6
1da177e4 LT	54
1da177e4 LT	55	struct bt856 {
f49a5eae	56	unsigned char reg[BT856_NR_REG];
1da177e4 LT	57
	58	int norm;
	59	int enable;
1da177e4 LT	60	};
1da177e4 LT	61
1da177e4 LT	62	/* ----------------------------------------------------------------------- */
1da177e4 LT	63
a8c26dfe	64	static inline int bt856_write(struct i2c_client *client, u8 reg, u8 value)
1da177e4 LT	65	{
	66	struct bt856 *encoder = i2c_get_clientdata(client);
	67
187565c4	68	encoder->reg[reg - BT856_REG_OFFSET] = value;
1da177e4 LT	69	return i2c_smbus_write_byte_data(client, reg, value);
	70	}
	71
a8c26dfe	72	static inline int bt856_setbit(struct i2c_client *client, u8 reg, u8 bit, u8 value)
1da177e4 LT	73	{
	74	struct bt856 *encoder = i2c_get_clientdata(client);
	75
	76	return bt856_write(client, reg,
a8c26dfe HV	77	(encoder->reg[reg - BT856_REG_OFFSET] & ~(1 << bit)) \|
a8c26dfe HV	78	(value ? (1 << bit) : 0));
1da177e4 LT	79	}
1da177e4 LT	80
a8c26dfe	81	static void bt856_dump(struct i2c_client *client)
1da177e4 LT	82	{
	83	int i;
	84	struct bt856 *encoder = i2c_get_clientdata(client);
	85
a8c26dfe	86	v4l_info(client, "register dump:\n");
f49a5eae	87	for (i = 0; i < BT856_NR_REG; i += 2)
a8c26dfe HV	88	printk(KERN_CONT " %02x", encoder->reg[i]);
a8c26dfe HV	89	printk(KERN_CONT "\n");
1da177e4 LT	90	}
	91
	92	/* ----------------------------------------------------------------------- */
	93
a8c26dfe	94	static int bt856_command(struct i2c_client client, unsigned cmd, void arg)
1da177e4 LT	95	{
	96	struct bt856 *encoder = i2c_get_clientdata(client);
	97
	98	switch (cmd) {
1da177e4 LT	99	case 0:
1da177e4 LT	100	/* This is just for testing!!! */
a8c26dfe	101	v4l_dbg(1, debug, client, "init\n");
1da177e4 LT	102	bt856_write(client, 0xdc, 0x18);
	103	bt856_write(client, 0xda, 0);
	104	bt856_write(client, 0xde, 0);
	105
	106	bt856_setbit(client, 0xdc, 3, 1);
	107	//bt856_setbit(client, 0xdc, 6, 0);
	108	bt856_setbit(client, 0xdc, 4, 1);
	109
	110	switch (encoder->norm) {
1da177e4 LT	111	case VIDEO_MODE_NTSC:
	112	bt856_setbit(client, 0xdc, 2, 0);
	113	break;
	114
	115	case VIDEO_MODE_PAL:
	116	bt856_setbit(client, 0xdc, 2, 1);
	117	break;
	118	}
	119
	120	bt856_setbit(client, 0xdc, 1, 1);
	121	bt856_setbit(client, 0xde, 4, 0);
	122	bt856_setbit(client, 0xde, 3, 1);
	123	if (debug != 0)
	124	bt856_dump(client);
	125	break;
	126
	127	case ENCODER_GET_CAPABILITIES:
	128	{
	129	struct video_encoder_capability *cap = arg;
	130
a8c26dfe	131	v4l_dbg(1, debug, client, "get capabilities\n");
1da177e4 LT	132
	133	cap->flags = VIDEO_ENCODER_PAL \|
	134	VIDEO_ENCODER_NTSC \|
	135	VIDEO_ENCODER_CCIR;
	136	cap->inputs = 2;
	137	cap->outputs = 1;
1da177e4	138	break;
a8c26dfe	139	}
1da177e4 LT	140
	141	case ENCODER_SET_NORM:
	142	{
	143	int *iarg = arg;
	144
a8c26dfe	145	v4l_dbg(1, debug, client, "set norm %d\n", *iarg);
1da177e4 LT	146
1da177e4 LT	147	switch (*iarg) {
1da177e4 LT	148	case VIDEO_MODE_NTSC:
	149	bt856_setbit(client, 0xdc, 2, 0);
	150	break;
	151
	152	case VIDEO_MODE_PAL:
	153	bt856_setbit(client, 0xdc, 2, 1);
	154	bt856_setbit(client, 0xda, 0, 0);
	155	//bt856_setbit(client, 0xda, 0, 1);
	156	break;
	157
	158	default:
	159	return -EINVAL;
1da177e4 LT	160	}
	161	encoder->norm = *iarg;
	162	if (debug != 0)
	163	bt856_dump(client);
1da177e4	164	break;
a8c26dfe	165	}
1da177e4 LT	166
	167	case ENCODER_SET_INPUT:
	168	{
	169	int *iarg = arg;
	170
a8c26dfe	171	v4l_dbg(1, debug, client, "set input %d\n", *iarg);
1da177e4 LT	172
	173	/* We only have video bus.
	174	* iarg = 0: input is from bt819
	175	* iarg = 1: input is from ZR36060 */
1da177e4	176	switch (*iarg) {
1da177e4 LT	177	case 0:
	178	bt856_setbit(client, 0xde, 4, 0);
	179	bt856_setbit(client, 0xde, 3, 1);
	180	bt856_setbit(client, 0xdc, 3, 1);
	181	bt856_setbit(client, 0xdc, 6, 0);
	182	break;
	183	case 1:
	184	bt856_setbit(client, 0xde, 4, 0);
	185	bt856_setbit(client, 0xde, 3, 1);
	186	bt856_setbit(client, 0xdc, 3, 1);
	187	bt856_setbit(client, 0xdc, 6, 1);
	188	break;
	189	case 2: // Color bar
	190	bt856_setbit(client, 0xdc, 3, 0);
	191	bt856_setbit(client, 0xde, 4, 1);
	192	break;
	193	default:
	194	return -EINVAL;
1da177e4 LT	195	}
	196
	197	if (debug != 0)
	198	bt856_dump(client);
1da177e4	199	break;
a8c26dfe	200	}
1da177e4 LT	201
	202	case ENCODER_SET_OUTPUT:
	203	{
	204	int *iarg = arg;
	205
a8c26dfe	206	v4l_dbg(1, debug, client, "set output %d\n", *iarg);
1da177e4 LT	207
1da177e4 LT	208	/* not much choice of outputs */
a8c26dfe	209	if (*iarg != 0)
1da177e4	210	return -EINVAL;
1da177e4	211	break;
a8c26dfe	212	}
1da177e4 LT	213
	214	case ENCODER_ENABLE_OUTPUT:
	215	{
	216	int *iarg = arg;
	217
	218	encoder->enable = !!*iarg;
	219
a8c26dfe	220	v4l_dbg(1, debug, client, "enable output %d\n", encoder->enable);
1da177e4	221	break;
a8c26dfe	222	}
1da177e4 LT	223
	224	default:
	225	return -EINVAL;
	226	}
	227
	228	return 0;
	229	}
	230
	231	/* ----------------------------------------------------------------------- */
	232
a8c26dfe	233	static unsigned short normal_i2c[] = { 0x88 >> 1, I2C_CLIENT_END };
1da177e4	234
a8c26dfe	235	I2C_CLIENT_INSMOD;
1da177e4	236
a8c26dfe HV	237	static int bt856_probe(struct i2c_client *client,
a8c26dfe HV	238	const struct i2c_device_id *id)
1da177e4	239	{
1da177e4 LT	240	struct bt856 *encoder;
1da177e4 LT	241
1da177e4	242	/* Check if the adapter supports the needed features */
a8c26dfe HV	243	if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA))
a8c26dfe HV	244	return -ENODEV;
1da177e4	245
a8c26dfe HV	246	v4l_info(client, "chip found @ 0x%x (%s)\n",
a8c26dfe HV	247	client->addr << 1, client->adapter->name);
1da177e4	248
7408187d	249	encoder = kzalloc(sizeof(struct bt856), GFP_KERNEL);
a8c26dfe	250	if (encoder == NULL)
1da177e4	251	return -ENOMEM;
1da177e4 LT	252	encoder->norm = VIDEO_MODE_NTSC;
	253	encoder->enable = 1;
	254	i2c_set_clientdata(client, encoder);
	255
1da177e4 LT	256	bt856_write(client, 0xdc, 0x18);
	257	bt856_write(client, 0xda, 0);
	258	bt856_write(client, 0xde, 0);
	259
	260	bt856_setbit(client, 0xdc, 3, 1);
	261	//bt856_setbit(client, 0xdc, 6, 0);
	262	bt856_setbit(client, 0xdc, 4, 1);
	263
	264	switch (encoder->norm) {
	265
	266	case VIDEO_MODE_NTSC:
	267	bt856_setbit(client, 0xdc, 2, 0);
	268	break;
	269
	270	case VIDEO_MODE_PAL:
	271	bt856_setbit(client, 0xdc, 2, 1);
	272	break;
	273	}
	274
	275	bt856_setbit(client, 0xdc, 1, 1);
	276	bt856_setbit(client, 0xde, 4, 0);
	277	bt856_setbit(client, 0xde, 3, 1);
	278
	279	if (debug != 0)
	280	bt856_dump(client);
1da177e4 LT	281	return 0;
	282	}
	283
a8c26dfe	284	static int bt856_remove(struct i2c_client *client)
1da177e4	285	{
a8c26dfe	286	kfree(i2c_get_clientdata(client));
1da177e4 LT	287	return 0;
	288	}
	289
a8c26dfe HV	290	static const struct i2c_device_id bt856_id[] = {
	291	{ "bt856", 0 },
	292	{ }
	293	};
	294	MODULE_DEVICE_TABLE(i2c, bt856_id);
1da177e4	295
a8c26dfe HV	296	static struct v4l2_i2c_driver_data v4l2_i2c_data = {
	297	.name = "bt856",
	298	.driverid = I2C_DRIVERID_BT856,
1da177e4	299	.command = bt856_command,
a8c26dfe HV	300	.probe = bt856_probe,
	301	.remove = bt856_remove,
	302	.id_table = bt856_id,
1da177e4	303	};