[mirror_ubuntu-jammy-kernel.git] / drivers / media / i2c / bt856.c

// SPDX-License-Identifier: GPL-2.0-or-later
/*
 * 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)
 */

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