]> git.proxmox.com Git - mirror_ubuntu-bionic-kernel.git/blame - drivers/media/video/adv7170.c
V4L/DVB (10726): vpx3220: convert to v4l2_subdev.
[mirror_ubuntu-bionic-kernel.git] / drivers / media / video / adv7170.c
CommitLineData
d56410e0 1/*
1da177e4
LT
2 * adv7170 - adv7170, adv7171 video encoder driver version 0.0.1
3 *
4 * Copyright (C) 2002 Maxim Yevtyushkin <max@linuxmedialabs.com>
5 *
d56410e0 6 * Based on adv7176 driver by:
1da177e4
LT
7 *
8 * Copyright (C) 1998 Dave Perks <dperks@ibm.net>
9 * Copyright (C) 1999 Wolfgang Scherr <scherr@net4you.net>
10 * Copyright (C) 2000 Serguei Miridonov <mirsev@cicese.mx>
11 * - some corrections for Pinnacle Systems Inc. DC10plus card.
12 *
13 * Changes by Ronald Bultje <rbultje@ronald.bitfreak.net>
14 * - moved over to linux>=2.4.x i2c protocol (1/1/2003)
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>
b9a21f84 33#include <linux/ioctl.h>
18f3fa1e 34#include <asm/uaccess.h>
b9a21f84
HV
35#include <linux/i2c.h>
36#include <linux/i2c-id.h>
1da177e4 37#include <linux/videodev.h>
18f3fa1e 38#include <linux/video_encoder.h>
b9a21f84
HV
39#include <media/v4l2-common.h>
40#include <media/v4l2-i2c-drv-legacy.h>
1da177e4
LT
41
42MODULE_DESCRIPTION("Analog Devices ADV7170 video encoder driver");
43MODULE_AUTHOR("Maxim Yevtyushkin");
44MODULE_LICENSE("GPL");
45
ff699e6b 46static int debug;
1da177e4
LT
47module_param(debug, int, 0);
48MODULE_PARM_DESC(debug, "Debug level (0-1)");
49
1da177e4
LT
50/* ----------------------------------------------------------------------- */
51
52struct adv7170 {
53 unsigned char reg[128];
54
107063c6 55 v4l2_std_id norm;
1da177e4 56 int input;
1da177e4
LT
57 int bright;
58 int contrast;
59 int hue;
60 int sat;
61};
62
1da177e4 63static char *inputs[] = { "pass_through", "play_back" };
1da177e4
LT
64
65/* ----------------------------------------------------------------------- */
66
b9a21f84 67static inline int adv7170_write(struct i2c_client *client, u8 reg, u8 value)
1da177e4
LT
68{
69 struct adv7170 *encoder = i2c_get_clientdata(client);
70
71 encoder->reg[reg] = value;
72 return i2c_smbus_write_byte_data(client, reg, value);
73}
74
b9a21f84 75static inline int adv7170_read(struct i2c_client *client, u8 reg)
1da177e4
LT
76{
77 return i2c_smbus_read_byte_data(client, reg);
78}
79
b9a21f84
HV
80static int adv7170_write_block(struct i2c_client *client,
81 const u8 *data, unsigned int len)
1da177e4
LT
82{
83 int ret = -1;
84 u8 reg;
85
86 /* the adv7170 has an autoincrement function, use it if
87 * the adapter understands raw I2C */
88 if (i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) {
89 /* do raw I2C, not smbus compatible */
90 struct adv7170 *encoder = i2c_get_clientdata(client);
1da177e4 91 u8 block_data[32];
9aa45e34 92 int block_len;
1da177e4 93
1da177e4 94 while (len >= 2) {
9aa45e34
JD
95 block_len = 0;
96 block_data[block_len++] = reg = data[0];
1da177e4 97 do {
9aa45e34 98 block_data[block_len++] =
1da177e4
LT
99 encoder->reg[reg++] = data[1];
100 len -= 2;
101 data += 2;
b9a21f84
HV
102 } while (len >= 2 && data[0] == reg && block_len < 32);
103 ret = i2c_master_send(client, block_data, block_len);
104 if (ret < 0)
1da177e4
LT
105 break;
106 }
107 } else {
108 /* do some slow I2C emulation kind of thing */
109 while (len >= 2) {
110 reg = *data++;
b9a21f84
HV
111 ret = adv7170_write(client, reg, *data++);
112 if (ret < 0)
1da177e4
LT
113 break;
114 len -= 2;
115 }
116 }
1da177e4
LT
117 return ret;
118}
119
120/* ----------------------------------------------------------------------- */
1da177e4
LT
121
122#define TR0MODE 0x4c
123#define TR0RST 0x80
124
125#define TR1CAPT 0x00
126#define TR1PLAY 0x00
127
1da177e4
LT
128static const unsigned char init_NTSC[] = {
129 0x00, 0x10, // MR0
130 0x01, 0x20, // MR1
d56410e0 131 0x02, 0x0e, // MR2 RTC control: bits 2 and 1
1da177e4
LT
132 0x03, 0x80, // MR3
133 0x04, 0x30, // MR4
134 0x05, 0x00, // Reserved
135 0x06, 0x00, // Reserved
136 0x07, TR0MODE, // TM0
137 0x08, TR1CAPT, // TM1
138 0x09, 0x16, // Fsc0
139 0x0a, 0x7c, // Fsc1
140 0x0b, 0xf0, // Fsc2
141 0x0c, 0x21, // Fsc3
142 0x0d, 0x00, // Subcarrier Phase
143 0x0e, 0x00, // Closed Capt. Ext 0
144 0x0f, 0x00, // Closed Capt. Ext 1
145 0x10, 0x00, // Closed Capt. 0
146 0x11, 0x00, // Closed Capt. 1
147 0x12, 0x00, // Pedestal Ctl 0
148 0x13, 0x00, // Pedestal Ctl 1
149 0x14, 0x00, // Pedestal Ctl 2
150 0x15, 0x00, // Pedestal Ctl 3
151 0x16, 0x00, // CGMS_WSS_0
152 0x17, 0x00, // CGMS_WSS_1
153 0x18, 0x00, // CGMS_WSS_2
d56410e0 154 0x19, 0x00, // Teletext Ctl
1da177e4
LT
155};
156
157static const unsigned char init_PAL[] = {
158 0x00, 0x71, // MR0
159 0x01, 0x20, // MR1
160 0x02, 0x0e, // MR2 RTC control: bits 2 and 1
161 0x03, 0x80, // MR3
162 0x04, 0x30, // MR4
163 0x05, 0x00, // Reserved
164 0x06, 0x00, // Reserved
165 0x07, TR0MODE, // TM0
166 0x08, TR1CAPT, // TM1
167 0x09, 0xcb, // Fsc0
168 0x0a, 0x8a, // Fsc1
169 0x0b, 0x09, // Fsc2
170 0x0c, 0x2a, // Fsc3
171 0x0d, 0x00, // Subcarrier Phase
172 0x0e, 0x00, // Closed Capt. Ext 0
173 0x0f, 0x00, // Closed Capt. Ext 1
174 0x10, 0x00, // Closed Capt. 0
175 0x11, 0x00, // Closed Capt. 1
176 0x12, 0x00, // Pedestal Ctl 0
177 0x13, 0x00, // Pedestal Ctl 1
178 0x14, 0x00, // Pedestal Ctl 2
179 0x15, 0x00, // Pedestal Ctl 3
180 0x16, 0x00, // CGMS_WSS_0
181 0x17, 0x00, // CGMS_WSS_1
182 0x18, 0x00, // CGMS_WSS_2
183 0x19, 0x00, // Teletext Ctl
184};
185
186
b9a21f84 187static int adv7170_command(struct i2c_client *client, unsigned cmd, void *arg)
1da177e4
LT
188{
189 struct adv7170 *encoder = i2c_get_clientdata(client);
190
191 switch (cmd) {
107063c6 192 case VIDIOC_INT_INIT:
1da177e4
LT
193#if 0
194 /* This is just for testing!!! */
195 adv7170_write_block(client, init_common,
196 sizeof(init_common));
197 adv7170_write(client, 0x07, TR0MODE | TR0RST);
198 adv7170_write(client, 0x07, TR0MODE);
199#endif
200 break;
201
107063c6 202 case VIDIOC_INT_S_STD_OUTPUT:
1da177e4 203 {
107063c6 204 v4l2_std_id iarg = *(v4l2_std_id *) arg;
1da177e4 205
107063c6 206 v4l_dbg(1, debug, client, "set norm %llx\n", iarg);
1da177e4 207
107063c6 208 if (iarg & V4L2_STD_NTSC) {
1da177e4
LT
209 adv7170_write_block(client, init_NTSC,
210 sizeof(init_NTSC));
211 if (encoder->input == 0)
212 adv7170_write(client, 0x02, 0x0e); // Enable genlock
213 adv7170_write(client, 0x07, TR0MODE | TR0RST);
214 adv7170_write(client, 0x07, TR0MODE);
107063c6 215 } else if (iarg & V4L2_STD_PAL) {
1da177e4
LT
216 adv7170_write_block(client, init_PAL,
217 sizeof(init_PAL));
218 if (encoder->input == 0)
219 adv7170_write(client, 0x02, 0x0e); // Enable genlock
220 adv7170_write(client, 0x07, TR0MODE | TR0RST);
221 adv7170_write(client, 0x07, TR0MODE);
107063c6
HV
222 } else {
223 v4l_dbg(1, debug, client, "illegal norm: %llx\n", iarg);
1da177e4 224 return -EINVAL;
1da177e4 225 }
107063c6 226 v4l_dbg(1, debug, client, "switched to %llx\n", iarg);
1da177e4 227 encoder->norm = iarg;
1da177e4 228 break;
b9a21f84 229 }
1da177e4 230
107063c6 231 case VIDIOC_INT_S_VIDEO_ROUTING:
1da177e4 232 {
107063c6 233 struct v4l2_routing *route = arg;
1da177e4
LT
234
235 /* RJ: *iarg = 0: input is from decoder
236 *iarg = 1: input is from ZR36060
237 *iarg = 2: color bar */
238
b9a21f84 239 v4l_dbg(1, debug, client, "set input from %s\n",
107063c6 240 route->input == 0 ? "decoder" : "ZR36060");
1da177e4 241
107063c6 242 switch (route->input) {
1da177e4
LT
243 case 0:
244 adv7170_write(client, 0x01, 0x20);
245 adv7170_write(client, 0x08, TR1CAPT); /* TR1 */
246 adv7170_write(client, 0x02, 0x0e); // Enable genlock
247 adv7170_write(client, 0x07, TR0MODE | TR0RST);
248 adv7170_write(client, 0x07, TR0MODE);
b9a21f84 249 /* udelay(10); */
1da177e4
LT
250 break;
251
252 case 1:
253 adv7170_write(client, 0x01, 0x00);
254 adv7170_write(client, 0x08, TR1PLAY); /* TR1 */
255 adv7170_write(client, 0x02, 0x08);
256 adv7170_write(client, 0x07, TR0MODE | TR0RST);
257 adv7170_write(client, 0x07, TR0MODE);
b9a21f84 258 /* udelay(10); */
1da177e4
LT
259 break;
260
261 default:
107063c6 262 v4l_dbg(1, debug, client, "illegal input: %d\n", route->input);
1da177e4
LT
263 return -EINVAL;
264 }
107063c6
HV
265 v4l_dbg(1, debug, client, "switched to %s\n", inputs[route->input]);
266 encoder->input = route->input;
1da177e4 267 break;
b9a21f84 268 }
1da177e4
LT
269
270 default:
271 return -EINVAL;
272 }
273
274 return 0;
275}
276
277/* ----------------------------------------------------------------------- */
278
b9a21f84
HV
279static unsigned short normal_i2c[] = {
280 0xd4 >> 1, 0xd6 >> 1, /* adv7170 IDs */
281 0x54 >> 1, 0x56 >> 1, /* adv7171 IDs */
1da177e4
LT
282 I2C_CLIENT_END
283};
1da177e4 284
b9a21f84 285I2C_CLIENT_INSMOD;
d56410e0 286
b9a21f84
HV
287static int adv7170_probe(struct i2c_client *client,
288 const struct i2c_device_id *id)
1da177e4 289{
1da177e4 290 struct adv7170 *encoder;
b9a21f84 291 int i;
1da177e4
LT
292
293 /* Check if the adapter supports the needed features */
b9a21f84
HV
294 if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA))
295 return -ENODEV;
1da177e4 296
b9a21f84
HV
297 v4l_info(client, "chip found @ 0x%x (%s)\n",
298 client->addr << 1, client->adapter->name);
1da177e4 299
7408187d 300 encoder = kzalloc(sizeof(struct adv7170), GFP_KERNEL);
b9a21f84 301 if (encoder == NULL)
1da177e4 302 return -ENOMEM;
107063c6 303 encoder->norm = V4L2_STD_NTSC;
1da177e4 304 encoder->input = 0;
1da177e4
LT
305 i2c_set_clientdata(client, encoder);
306
1da177e4
LT
307 i = adv7170_write_block(client, init_NTSC, sizeof(init_NTSC));
308 if (i >= 0) {
309 i = adv7170_write(client, 0x07, TR0MODE | TR0RST);
310 i = adv7170_write(client, 0x07, TR0MODE);
311 i = adv7170_read(client, 0x12);
b9a21f84 312 v4l_dbg(1, debug, client, "revision %d\n", i & 1);
1da177e4 313 }
b9a21f84
HV
314 if (i < 0)
315 v4l_dbg(1, debug, client, "init error 0x%x\n", i);
1da177e4
LT
316 return 0;
317}
318
b9a21f84 319static int adv7170_remove(struct i2c_client *client)
1da177e4 320{
b9a21f84 321 kfree(i2c_get_clientdata(client));
1da177e4
LT
322 return 0;
323}
324
325/* ----------------------------------------------------------------------- */
326
b9a21f84
HV
327static const struct i2c_device_id adv7170_id[] = {
328 { "adv7170", 0 },
329 { "adv7171", 0 },
330 { }
331};
332MODULE_DEVICE_TABLE(i2c, adv7170_id);
1da177e4 333
b9a21f84
HV
334static struct v4l2_i2c_driver_data v4l2_i2c_data = {
335 .name = "adv7170",
336 .driverid = I2C_DRIVERID_ADV7170,
1da177e4 337 .command = adv7170_command,
b9a21f84
HV
338 .probe = adv7170_probe,
339 .remove = adv7170_remove,
340 .id_table = adv7170_id,
1da177e4 341};