blob: 7e5bd365c2391dcf94359b78d25c9b85a672ccf7 [file] [log] [blame]
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -03001/*
Linus Torvalds1da177e2005-04-16 15:20:36 -07002 * 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>
Mauro Carvalho Chehab18f3fa12007-07-02 15:39:57 -030032#include <linux/types.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090033#include <linux/slab.h>
Hans Verkuila8c26df2008-09-07 07:59:35 -030034#include <linux/ioctl.h>
Mauro Carvalho Chehab18f3fa12007-07-02 15:39:57 -030035#include <asm/uaccess.h>
Hans Verkuila8c26df2008-09-07 07:59:35 -030036#include <linux/i2c.h>
Hans Verkuila91f56e2009-02-19 08:54:36 -030037#include <linux/videodev2.h>
38#include <media/v4l2-device.h>
39#include <media/v4l2-chip-ident.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070040
41MODULE_DESCRIPTION("Brooktree-856A video encoder driver");
42MODULE_AUTHOR("Mike Bernson & Dave Perks");
43MODULE_LICENSE("GPL");
44
Douglas Schilling Landgrafff699e62008-04-22 14:41:48 -030045static int debug;
Linus Torvalds1da177e2005-04-16 15:20:36 -070046module_param(debug, int, 0);
47MODULE_PARM_DESC(debug, "Debug level (0-1)");
48
Hans Verkuila91f56e2009-02-19 08:54:36 -030049
Linus Torvalds1da177e2005-04-16 15:20:36 -070050/* ----------------------------------------------------------------------- */
51
Hans Verkuil187565c2008-08-30 06:03:09 -030052#define BT856_REG_OFFSET 0xDA
53#define BT856_NR_REG 6
Linus Torvalds1da177e2005-04-16 15:20:36 -070054
55struct bt856 {
Hans Verkuila91f56e2009-02-19 08:54:36 -030056 struct v4l2_subdev sd;
Jean Delvaref49a5ea2006-03-22 03:48:36 -030057 unsigned char reg[BT856_NR_REG];
Linus Torvalds1da177e2005-04-16 15:20:36 -070058
Hans Verkuil107063c2009-02-18 17:26:06 -030059 v4l2_std_id norm;
Linus Torvalds1da177e2005-04-16 15:20:36 -070060};
61
Hans Verkuila91f56e2009-02-19 08:54:36 -030062static inline struct bt856 *to_bt856(struct v4l2_subdev *sd)
63{
64 return container_of(sd, struct bt856, sd);
65}
66
Linus Torvalds1da177e2005-04-16 15:20:36 -070067/* ----------------------------------------------------------------------- */
68
Hans Verkuila91f56e2009-02-19 08:54:36 -030069static inline int bt856_write(struct bt856 *encoder, u8 reg, u8 value)
Linus Torvalds1da177e2005-04-16 15:20:36 -070070{
Hans Verkuila91f56e2009-02-19 08:54:36 -030071 struct i2c_client *client = v4l2_get_subdevdata(&encoder->sd);
Linus Torvalds1da177e2005-04-16 15:20:36 -070072
Hans Verkuil187565c2008-08-30 06:03:09 -030073 encoder->reg[reg - BT856_REG_OFFSET] = value;
Linus Torvalds1da177e2005-04-16 15:20:36 -070074 return i2c_smbus_write_byte_data(client, reg, value);
75}
76
Hans Verkuila91f56e2009-02-19 08:54:36 -030077static inline int bt856_setbit(struct bt856 *encoder, u8 reg, u8 bit, u8 value)
Linus Torvalds1da177e2005-04-16 15:20:36 -070078{
Hans Verkuila91f56e2009-02-19 08:54:36 -030079 return bt856_write(encoder, reg,
Hans Verkuila8c26df2008-09-07 07:59:35 -030080 (encoder->reg[reg - BT856_REG_OFFSET] & ~(1 << bit)) |
81 (value ? (1 << bit) : 0));
Linus Torvalds1da177e2005-04-16 15:20:36 -070082}
83
Hans Verkuila91f56e2009-02-19 08:54:36 -030084static void bt856_dump(struct bt856 *encoder)
Linus Torvalds1da177e2005-04-16 15:20:36 -070085{
86 int i;
Linus Torvalds1da177e2005-04-16 15:20:36 -070087
Hans Verkuila91f56e2009-02-19 08:54:36 -030088 v4l2_info(&encoder->sd, "register dump:\n");
Jean Delvaref49a5ea2006-03-22 03:48:36 -030089 for (i = 0; i < BT856_NR_REG; i += 2)
Hans Verkuila8c26df2008-09-07 07:59:35 -030090 printk(KERN_CONT " %02x", encoder->reg[i]);
91 printk(KERN_CONT "\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -070092}
93
94/* ----------------------------------------------------------------------- */
95
Hans Verkuila91f56e2009-02-19 08:54:36 -030096static int bt856_init(struct v4l2_subdev *sd, u32 arg)
Linus Torvalds1da177e2005-04-16 15:20:36 -070097{
Hans Verkuila91f56e2009-02-19 08:54:36 -030098 struct bt856 *encoder = to_bt856(sd);
Linus Torvalds1da177e2005-04-16 15:20:36 -070099
Hans Verkuila91f56e2009-02-19 08:54:36 -0300100 /* This is just for testing!!! */
101 v4l2_dbg(1, debug, sd, "init\n");
102 bt856_write(encoder, 0xdc, 0x18);
103 bt856_write(encoder, 0xda, 0);
104 bt856_write(encoder, 0xde, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700105
Hans Verkuila91f56e2009-02-19 08:54:36 -0300106 bt856_setbit(encoder, 0xdc, 3, 1);
107 /*bt856_setbit(encoder, 0xdc, 6, 0);*/
108 bt856_setbit(encoder, 0xdc, 4, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700109
Hans Verkuila91f56e2009-02-19 08:54:36 -0300110 if (encoder->norm & V4L2_STD_NTSC)
111 bt856_setbit(encoder, 0xdc, 2, 0);
112 else
113 bt856_setbit(encoder, 0xdc, 2, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700114
Hans Verkuila91f56e2009-02-19 08:54:36 -0300115 bt856_setbit(encoder, 0xdc, 1, 1);
116 bt856_setbit(encoder, 0xde, 4, 0);
117 bt856_setbit(encoder, 0xde, 3, 1);
118 if (debug != 0)
119 bt856_dump(encoder);
120 return 0;
121}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700122
Hans Verkuila91f56e2009-02-19 08:54:36 -0300123static int bt856_s_std_output(struct v4l2_subdev *sd, v4l2_std_id std)
124{
125 struct bt856 *encoder = to_bt856(sd);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700126
Hans Verkuilcc5cef82009-03-06 10:15:01 -0300127 v4l2_dbg(1, debug, sd, "set norm %llx\n", (unsigned long long)std);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700128
Hans Verkuila91f56e2009-02-19 08:54:36 -0300129 if (std & V4L2_STD_NTSC) {
130 bt856_setbit(encoder, 0xdc, 2, 0);
131 } else if (std & V4L2_STD_PAL) {
132 bt856_setbit(encoder, 0xdc, 2, 1);
133 bt856_setbit(encoder, 0xda, 0, 0);
134 /*bt856_setbit(encoder, 0xda, 0, 1);*/
135 } else {
136 return -EINVAL;
Hans Verkuila8c26df2008-09-07 07:59:35 -0300137 }
Hans Verkuila91f56e2009-02-19 08:54:36 -0300138 encoder->norm = std;
139 if (debug != 0)
140 bt856_dump(encoder);
141 return 0;
142}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700143
Hans Verkuil5325b422009-04-02 11:26:22 -0300144static int bt856_s_routing(struct v4l2_subdev *sd,
145 u32 input, u32 output, u32 config)
Hans Verkuila91f56e2009-02-19 08:54:36 -0300146{
147 struct bt856 *encoder = to_bt856(sd);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700148
Hans Verkuil5325b422009-04-02 11:26:22 -0300149 v4l2_dbg(1, debug, sd, "set input %d\n", input);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700150
Hans Verkuila91f56e2009-02-19 08:54:36 -0300151 /* We only have video bus.
Hans Verkuil5325b422009-04-02 11:26:22 -0300152 * input= 0: input is from bt819
153 * input= 1: input is from ZR36060 */
154 switch (input) {
Hans Verkuila91f56e2009-02-19 08:54:36 -0300155 case 0:
156 bt856_setbit(encoder, 0xde, 4, 0);
157 bt856_setbit(encoder, 0xde, 3, 1);
158 bt856_setbit(encoder, 0xdc, 3, 1);
159 bt856_setbit(encoder, 0xdc, 6, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700160 break;
Hans Verkuila91f56e2009-02-19 08:54:36 -0300161 case 1:
162 bt856_setbit(encoder, 0xde, 4, 0);
163 bt856_setbit(encoder, 0xde, 3, 1);
164 bt856_setbit(encoder, 0xdc, 3, 1);
165 bt856_setbit(encoder, 0xdc, 6, 1);
166 break;
167 case 2: /* Color bar */
168 bt856_setbit(encoder, 0xdc, 3, 0);
169 bt856_setbit(encoder, 0xde, 4, 1);
170 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700171 default:
172 return -EINVAL;
173 }
174
Hans Verkuila91f56e2009-02-19 08:54:36 -0300175 if (debug != 0)
176 bt856_dump(encoder);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700177 return 0;
178}
179
Hans Verkuila91f56e2009-02-19 08:54:36 -0300180static int bt856_g_chip_ident(struct v4l2_subdev *sd, struct v4l2_dbg_chip_ident *chip)
181{
182 struct i2c_client *client = v4l2_get_subdevdata(sd);
183
184 return v4l2_chip_ident_i2c_client(client, chip, V4L2_IDENT_BT856, 0);
185}
186
Linus Torvalds1da177e2005-04-16 15:20:36 -0700187/* ----------------------------------------------------------------------- */
188
Hans Verkuila91f56e2009-02-19 08:54:36 -0300189static const struct v4l2_subdev_core_ops bt856_core_ops = {
190 .g_chip_ident = bt856_g_chip_ident,
191 .init = bt856_init,
192};
Linus Torvalds1da177e2005-04-16 15:20:36 -0700193
Hans Verkuila91f56e2009-02-19 08:54:36 -0300194static const struct v4l2_subdev_video_ops bt856_video_ops = {
195 .s_std_output = bt856_s_std_output,
196 .s_routing = bt856_s_routing,
197};
198
199static const struct v4l2_subdev_ops bt856_ops = {
200 .core = &bt856_core_ops,
201 .video = &bt856_video_ops,
202};
203
204/* ----------------------------------------------------------------------- */
Mauro Carvalho Chehabd56410e2006-03-25 09:19:53 -0300205
Hans Verkuila8c26df2008-09-07 07:59:35 -0300206static int bt856_probe(struct i2c_client *client,
207 const struct i2c_device_id *id)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700208{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700209 struct bt856 *encoder;
Hans Verkuila91f56e2009-02-19 08:54:36 -0300210 struct v4l2_subdev *sd;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700211
Linus Torvalds1da177e2005-04-16 15:20:36 -0700212 /* Check if the adapter supports the needed features */
Hans Verkuila8c26df2008-09-07 07:59:35 -0300213 if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA))
214 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700215
Hans Verkuila8c26df2008-09-07 07:59:35 -0300216 v4l_info(client, "chip found @ 0x%x (%s)\n",
217 client->addr << 1, client->adapter->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700218
Panagiotis Issaris74081872006-01-11 19:40:56 -0200219 encoder = kzalloc(sizeof(struct bt856), GFP_KERNEL);
Hans Verkuila8c26df2008-09-07 07:59:35 -0300220 if (encoder == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700221 return -ENOMEM;
Hans Verkuila91f56e2009-02-19 08:54:36 -0300222 sd = &encoder->sd;
223 v4l2_i2c_subdev_init(sd, client, &bt856_ops);
Hans Verkuil107063c2009-02-18 17:26:06 -0300224 encoder->norm = V4L2_STD_NTSC;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700225
Hans Verkuila91f56e2009-02-19 08:54:36 -0300226 bt856_write(encoder, 0xdc, 0x18);
227 bt856_write(encoder, 0xda, 0);
228 bt856_write(encoder, 0xde, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700229
Hans Verkuila91f56e2009-02-19 08:54:36 -0300230 bt856_setbit(encoder, 0xdc, 3, 1);
231 /*bt856_setbit(encoder, 0xdc, 6, 0);*/
232 bt856_setbit(encoder, 0xdc, 4, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700233
Hans Verkuil107063c2009-02-18 17:26:06 -0300234 if (encoder->norm & V4L2_STD_NTSC)
Hans Verkuila91f56e2009-02-19 08:54:36 -0300235 bt856_setbit(encoder, 0xdc, 2, 0);
Hans Verkuil107063c2009-02-18 17:26:06 -0300236 else
Hans Verkuila91f56e2009-02-19 08:54:36 -0300237 bt856_setbit(encoder, 0xdc, 2, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700238
Hans Verkuila91f56e2009-02-19 08:54:36 -0300239 bt856_setbit(encoder, 0xdc, 1, 1);
240 bt856_setbit(encoder, 0xde, 4, 0);
241 bt856_setbit(encoder, 0xde, 3, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700242
243 if (debug != 0)
Hans Verkuila91f56e2009-02-19 08:54:36 -0300244 bt856_dump(encoder);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700245 return 0;
246}
247
Hans Verkuila8c26df2008-09-07 07:59:35 -0300248static int bt856_remove(struct i2c_client *client)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700249{
Hans Verkuila91f56e2009-02-19 08:54:36 -0300250 struct v4l2_subdev *sd = i2c_get_clientdata(client);
251
252 v4l2_device_unregister_subdev(sd);
253 kfree(to_bt856(sd));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700254 return 0;
255}
256
Hans Verkuila8c26df2008-09-07 07:59:35 -0300257static const struct i2c_device_id bt856_id[] = {
258 { "bt856", 0 },
259 { }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700260};
Hans Verkuila8c26df2008-09-07 07:59:35 -0300261MODULE_DEVICE_TABLE(i2c, bt856_id);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700262
Hans Verkuil3f417202010-09-15 15:32:24 -0300263static struct i2c_driver bt856_driver = {
264 .driver = {
265 .owner = THIS_MODULE,
266 .name = "bt856",
267 },
268 .probe = bt856_probe,
269 .remove = bt856_remove,
270 .id_table = bt856_id,
Hans Verkuila8c26df2008-09-07 07:59:35 -0300271};
Hans Verkuil3f417202010-09-15 15:32:24 -0300272
Axel Linc6e8d862012-02-12 06:56:32 -0300273module_i2c_driver(bt856_driver);