[mirror_ubuntu-artful-kernel.git] / drivers / media / i2c / 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.
 */

#include <linux/module.h>
#include <linux/types.h>
#include <linux/slab.h>
#include <linux/ioctl.h>
#include <linux/uaccess.h>
#include <linux/i2c.h>
#include <linux/videodev2.h>
#include <media/v4l2-device.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 {
	struct v4l2_subdev sd;
	unsigned char reg[BT856_NR_REG];

	v4l2_std_id norm;
};

static inline struct bt856 *to_bt856(struct v4l2_subdev *sd)
{
	return container_of(sd, struct bt856, sd);
}

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

static inline int bt856_write(struct bt856 *encoder, u8 reg, u8 value)
{
	struct i2c_client *client = v4l2_get_subdevdata(&encoder->sd);

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

static inline int bt856_setbit(struct bt856 *encoder, u8 reg, u8 bit, u8 value)
{
	return bt856_write(encoder, reg,
		(encoder->reg[reg - BT856_REG_OFFSET] & ~(1 << bit)) |
				(value ? (1 << bit) : 0));
}

static void bt856_dump(struct bt856 *encoder)
{
	int i;

	v4l2_info(&encoder->sd, "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_init(struct v4l2_subdev *sd, u32 arg)
{
	struct bt856 *encoder = to_bt856(sd);

	/* This is just for testing!!! */
	v4l2_dbg(1, debug, sd, "init\n");
	bt856_write(encoder, 0xdc, 0x18);
	bt856_write(encoder, 0xda, 0);
	bt856_write(encoder, 0xde, 0);

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

	if (encoder->norm & V4L2_STD_NTSC)
		bt856_setbit(encoder, 0xdc, 2, 0);
	else
		bt856_setbit(encoder, 0xdc, 2, 1);

	bt856_setbit(encoder, 0xdc, 1, 1);
	bt856_setbit(encoder, 0xde, 4, 0);
	bt856_setbit(encoder, 0xde, 3, 1);
	if (debug != 0)
		bt856_dump(encoder);
	return 0;
}

static int bt856_s_std_output(struct v4l2_subdev *sd, v4l2_std_id std)
{
	struct bt856 *encoder = to_bt856(sd);

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

	if (std & V4L2_STD_NTSC) {
		bt856_setbit(encoder, 0xdc, 2, 0);
	} else if (std & V4L2_STD_PAL) {
		bt856_setbit(encoder, 0xdc, 2, 1);
		bt856_setbit(encoder, 0xda, 0, 0);
		/*bt856_setbit(encoder, 0xda, 0, 1);*/
	} else {
		return -EINVAL;
	}
	encoder->norm = std;
	if (debug != 0)
		bt856_dump(encoder);
	return 0;
}

static int bt856_s_routing(struct v4l2_subdev *sd,
			   u32 input, u32 output, u32 config)
{
	struct bt856 *encoder = to_bt856(sd);

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

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

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

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

static const struct v4l2_subdev_core_ops bt856_core_ops = {
	.init = bt856_init,
};

static const struct v4l2_subdev_video_ops bt856_video_ops = {
	.s_std_output = bt856_s_std_output,
	.s_routing = bt856_s_routing,
};

static const struct v4l2_subdev_ops bt856_ops = {
	.core = &bt856_core_ops,
	.video = &bt856_video_ops,
};

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

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

	/* 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 = devm_kzalloc(&client->dev, sizeof(*encoder), GFP_KERNEL);
	if (encoder == NULL)
		return -ENOMEM;
	sd = &encoder->sd;
	v4l2_i2c_subdev_init(sd, client, &bt856_ops);
	encoder->norm = V4L2_STD_NTSC;

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

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

	if (encoder->norm & V4L2_STD_NTSC)
		bt856_setbit(encoder, 0xdc, 2, 0);
	else
		bt856_setbit(encoder, 0xdc, 2, 1);

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

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

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

	v4l2_device_unregister_subdev(sd);
	return 0;
}

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

static struct i2c_driver bt856_driver = {
	.driver = {
		.name	= "bt856",
	},
	.probe		= bt856_probe,
	.remove		= bt856_remove,
	.id_table	= bt856_id,
};

module_i2c_driver(bt856_driver);
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.
1da177e4 LT	25	*/
	26
	27	#include <linux/module.h>
18f3fa1e	28	#include <linux/types.h>
5a0e3ad6	29	#include <linux/slab.h>
a8c26dfe	30	#include <linux/ioctl.h>
7c0f6ba6	31	#include <linux/uaccess.h>
a8c26dfe	32	#include <linux/i2c.h>
a91f56e7 HV	33	#include <linux/videodev2.h>
a91f56e7 HV	34	#include <media/v4l2-device.h>
1da177e4 LT	35
	36	MODULE_DESCRIPTION("Brooktree-856A video encoder driver");
	37	MODULE_AUTHOR("Mike Bernson & Dave Perks");
	38	MODULE_LICENSE("GPL");
	39
ff699e6b	40	static int debug;
1da177e4 LT	41	module_param(debug, int, 0);
	42	MODULE_PARM_DESC(debug, "Debug level (0-1)");
	43
a91f56e7	44
1da177e4 LT	45	/* ----------------------------------------------------------------------- */
1da177e4 LT	46
187565c4 HV	47	#define BT856_REG_OFFSET 0xDA
187565c4 HV	48	#define BT856_NR_REG 6
1da177e4 LT	49
1da177e4 LT	50	struct bt856 {
a91f56e7	51	struct v4l2_subdev sd;
f49a5eae	52	unsigned char reg[BT856_NR_REG];
1da177e4	53
107063c6	54	v4l2_std_id norm;
1da177e4 LT	55	};
1da177e4 LT	56
a91f56e7 HV	57	static inline struct bt856 to_bt856(struct v4l2_subdev sd)
	58	{
	59	return container_of(sd, struct bt856, sd);
	60	}
	61
1da177e4 LT	62	/* ----------------------------------------------------------------------- */
1da177e4 LT	63
a91f56e7	64	static inline int bt856_write(struct bt856 *encoder, u8 reg, u8 value)
1da177e4	65	{
a91f56e7	66	struct i2c_client *client = v4l2_get_subdevdata(&encoder->sd);
1da177e4	67
187565c4	68	encoder->reg[reg - BT856_REG_OFFSET] = value;
1da177e4 LT	69	return i2c_smbus_write_byte_data(client, reg, value);
	70	}
	71
a91f56e7	72	static inline int bt856_setbit(struct bt856 *encoder, u8 reg, u8 bit, u8 value)
1da177e4	73	{
a91f56e7	74	return bt856_write(encoder, reg,
a8c26dfe HV	75	(encoder->reg[reg - BT856_REG_OFFSET] & ~(1 << bit)) \|
a8c26dfe HV	76	(value ? (1 << bit) : 0));
1da177e4 LT	77	}
1da177e4 LT	78
a91f56e7	79	static void bt856_dump(struct bt856 *encoder)
1da177e4 LT	80	{
1da177e4 LT	81	int i;
1da177e4	82
a91f56e7	83	v4l2_info(&encoder->sd, "register dump:\n");
f49a5eae	84	for (i = 0; i < BT856_NR_REG; i += 2)
a8c26dfe HV	85	printk(KERN_CONT " %02x", encoder->reg[i]);
a8c26dfe HV	86	printk(KERN_CONT "\n");
1da177e4 LT	87	}
	88
	89	/* ----------------------------------------------------------------------- */
	90
a91f56e7	91	static int bt856_init(struct v4l2_subdev *sd, u32 arg)
1da177e4	92	{
a91f56e7	93	struct bt856 *encoder = to_bt856(sd);
1da177e4	94
a91f56e7 HV	95	/* This is just for testing!!! */
	96	v4l2_dbg(1, debug, sd, "init\n");
	97	bt856_write(encoder, 0xdc, 0x18);
	98	bt856_write(encoder, 0xda, 0);
	99	bt856_write(encoder, 0xde, 0);
1da177e4	100
a91f56e7 HV	101	bt856_setbit(encoder, 0xdc, 3, 1);
	102	/bt856_setbit(encoder, 0xdc, 6, 0);/
	103	bt856_setbit(encoder, 0xdc, 4, 1);
	104
	105	if (encoder->norm & V4L2_STD_NTSC)
	106	bt856_setbit(encoder, 0xdc, 2, 0);
	107	else
	108	bt856_setbit(encoder, 0xdc, 2, 1);
	109
	110	bt856_setbit(encoder, 0xdc, 1, 1);
	111	bt856_setbit(encoder, 0xde, 4, 0);
	112	bt856_setbit(encoder, 0xde, 3, 1);
	113	if (debug != 0)
	114	bt856_dump(encoder);
	115	return 0;
	116	}
	117
	118	static int bt856_s_std_output(struct v4l2_subdev *sd, v4l2_std_id std)
	119	{
	120	struct bt856 *encoder = to_bt856(sd);
	121
cc5cef8e	122	v4l2_dbg(1, debug, sd, "set norm %llx\n", (unsigned long long)std);
a91f56e7 HV	123
	124	if (std & V4L2_STD_NTSC) {
	125	bt856_setbit(encoder, 0xdc, 2, 0);
	126	} else if (std & V4L2_STD_PAL) {
	127	bt856_setbit(encoder, 0xdc, 2, 1);
	128	bt856_setbit(encoder, 0xda, 0, 0);
	129	/bt856_setbit(encoder, 0xda, 0, 1);/
	130	} else {
	131	return -EINVAL;
a8c26dfe	132	}
a91f56e7 HV	133	encoder->norm = std;
	134	if (debug != 0)
	135	bt856_dump(encoder);
	136	return 0;
	137	}
1da177e4	138
5325b427 HV	139	static int bt856_s_routing(struct v4l2_subdev *sd,
5325b427 HV	140	u32 input, u32 output, u32 config)
a91f56e7 HV	141	{
	142	struct bt856 *encoder = to_bt856(sd);
	143
5325b427	144	v4l2_dbg(1, debug, sd, "set input %d\n", input);
a91f56e7 HV	145
a91f56e7 HV	146	/* We only have video bus.
5325b427 HV	147	* input= 0: input is from bt819
	148	* input= 1: input is from ZR36060 */
	149	switch (input) {
a91f56e7 HV	150	case 0:
	151	bt856_setbit(encoder, 0xde, 4, 0);
	152	bt856_setbit(encoder, 0xde, 3, 1);
	153	bt856_setbit(encoder, 0xdc, 3, 1);
	154	bt856_setbit(encoder, 0xdc, 6, 0);
	155	break;
	156	case 1:
	157	bt856_setbit(encoder, 0xde, 4, 0);
	158	bt856_setbit(encoder, 0xde, 3, 1);
	159	bt856_setbit(encoder, 0xdc, 3, 1);
	160	bt856_setbit(encoder, 0xdc, 6, 1);
	161	break;
	162	case 2: /* Color bar */
	163	bt856_setbit(encoder, 0xdc, 3, 0);
	164	bt856_setbit(encoder, 0xde, 4, 1);
	165	break;
1da177e4 LT	166	default:
	167	return -EINVAL;
	168	}
	169
a91f56e7 HV	170	if (debug != 0)
a91f56e7 HV	171	bt856_dump(encoder);
1da177e4 LT	172	return 0;
	173	}
	174
	175	/* ----------------------------------------------------------------------- */
	176
a91f56e7	177	static const struct v4l2_subdev_core_ops bt856_core_ops = {
a91f56e7 HV	178	.init = bt856_init,
a91f56e7 HV	179	};
1da177e4	180
a91f56e7 HV	181	static const struct v4l2_subdev_video_ops bt856_video_ops = {
	182	.s_std_output = bt856_s_std_output,
	183	.s_routing = bt856_s_routing,
	184	};
	185
	186	static const struct v4l2_subdev_ops bt856_ops = {
	187	.core = &bt856_core_ops,
	188	.video = &bt856_video_ops,
	189	};
	190
	191	/* ----------------------------------------------------------------------- */
1da177e4	192
a8c26dfe HV	193	static int bt856_probe(struct i2c_client *client,
a8c26dfe HV	194	const struct i2c_device_id *id)
1da177e4	195	{
1da177e4	196	struct bt856 *encoder;
a91f56e7	197	struct v4l2_subdev *sd;
1da177e4	198
1da177e4	199	/* Check if the adapter supports the needed features */
a8c26dfe HV	200	if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA))
a8c26dfe HV	201	return -ENODEV;
1da177e4	202
a8c26dfe HV	203	v4l_info(client, "chip found @ 0x%x (%s)\n",
a8c26dfe HV	204	client->addr << 1, client->adapter->name);
1da177e4	205
c02b211d	206	encoder = devm_kzalloc(&client->dev, sizeof(*encoder), GFP_KERNEL);
a8c26dfe	207	if (encoder == NULL)
1da177e4	208	return -ENOMEM;
a91f56e7 HV	209	sd = &encoder->sd;
a91f56e7 HV	210	v4l2_i2c_subdev_init(sd, client, &bt856_ops);
107063c6	211	encoder->norm = V4L2_STD_NTSC;
1da177e4	212
a91f56e7 HV	213	bt856_write(encoder, 0xdc, 0x18);
	214	bt856_write(encoder, 0xda, 0);
	215	bt856_write(encoder, 0xde, 0);
1da177e4	216
a91f56e7 HV	217	bt856_setbit(encoder, 0xdc, 3, 1);
	218	/bt856_setbit(encoder, 0xdc, 6, 0);/
	219	bt856_setbit(encoder, 0xdc, 4, 1);
1da177e4	220
107063c6	221	if (encoder->norm & V4L2_STD_NTSC)
a91f56e7	222	bt856_setbit(encoder, 0xdc, 2, 0);
107063c6	223	else
a91f56e7	224	bt856_setbit(encoder, 0xdc, 2, 1);
1da177e4	225
a91f56e7 HV	226	bt856_setbit(encoder, 0xdc, 1, 1);
	227	bt856_setbit(encoder, 0xde, 4, 0);
	228	bt856_setbit(encoder, 0xde, 3, 1);
1da177e4 LT	229
1da177e4 LT	230	if (debug != 0)
a91f56e7	231	bt856_dump(encoder);
1da177e4 LT	232	return 0;
	233	}
	234
a8c26dfe	235	static int bt856_remove(struct i2c_client *client)
1da177e4	236	{
a91f56e7 HV	237	struct v4l2_subdev *sd = i2c_get_clientdata(client);
	238
	239	v4l2_device_unregister_subdev(sd);
1da177e4 LT	240	return 0;
	241	}
	242
a8c26dfe HV	243	static const struct i2c_device_id bt856_id[] = {
	244	{ "bt856", 0 },
	245	{ }
	246	};
	247	MODULE_DEVICE_TABLE(i2c, bt856_id);
1da177e4	248
3f417200 HV	249	static struct i2c_driver bt856_driver = {
3f417200 HV	250	.driver = {
3f417200 HV	251	.name = "bt856",
	252	},
	253	.probe = bt856_probe,
	254	.remove = bt856_remove,
	255	.id_table = bt856_id,
1da177e4	256	};
3f417200	257
c6e8d86f	258	module_i2c_driver(bt856_driver);