xref: /openbmc/linux/drivers/media/pci/saa7146/mxb.c (revision 22b6e7f3)
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3     mxb - v4l2 driver for the Multimedia eXtension Board
4 
5     Copyright (C) 1998-2006 Michael Hunold <michael@mihu.de>
6 
7     Visit http://www.themm.net/~mihu/linux/saa7146/mxb.html
8     for further details about this card.
9 
10 */
11 
12 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
13 
14 #define DEBUG_VARIABLE debug
15 
16 #include <media/drv-intf/saa7146_vv.h>
17 #include <media/tuner.h>
18 #include <media/v4l2-common.h>
19 #include <media/i2c/saa7115.h>
20 #include <linux/module.h>
21 #include <linux/kernel.h>
22 
23 #include "tea6415c.h"
24 #include "tea6420.h"
25 
26 #define MXB_AUDIOS	6
27 
28 #define I2C_SAA7111A  0x24
29 #define	I2C_TDA9840   0x42
30 #define	I2C_TEA6415C  0x43
31 #define	I2C_TEA6420_1 0x4c
32 #define	I2C_TEA6420_2 0x4d
33 #define	I2C_TUNER     0x60
34 
35 #define MXB_BOARD_CAN_DO_VBI(dev)   (dev->revision != 0)
36 
37 /* global variable */
38 static int mxb_num;
39 
40 /* initial frequence the tuner will be tuned to.
41    in verden (lower saxony, germany) 4148 is a
42    channel called "phoenix" */
43 static int freq = 4148;
44 module_param(freq, int, 0644);
45 MODULE_PARM_DESC(freq, "initial frequency the tuner will be tuned to while setup");
46 
47 static int debug;
48 module_param(debug, int, 0644);
49 MODULE_PARM_DESC(debug, "Turn on/off device debugging (default:off).");
50 
51 #define MXB_STD (V4L2_STD_PAL_BG | V4L2_STD_PAL_I | V4L2_STD_SECAM | V4L2_STD_NTSC)
52 #define MXB_INPUTS 4
53 enum { TUNER, AUX1, AUX3, AUX3_YC };
54 
55 static struct v4l2_input mxb_inputs[MXB_INPUTS] = {
56 	{ TUNER,   "Tuner",          V4L2_INPUT_TYPE_TUNER,  0x3f, 0,
57 		V4L2_STD_PAL_BG | V4L2_STD_PAL_I, 0, V4L2_IN_CAP_STD },
58 	{ AUX1,	   "AUX1",           V4L2_INPUT_TYPE_CAMERA, 0x3f, 0,
59 		MXB_STD, 0, V4L2_IN_CAP_STD },
60 	{ AUX3,	   "AUX3 Composite", V4L2_INPUT_TYPE_CAMERA, 0x3f, 0,
61 		MXB_STD, 0, V4L2_IN_CAP_STD },
62 	{ AUX3_YC, "AUX3 S-Video",   V4L2_INPUT_TYPE_CAMERA, 0x3f, 0,
63 		MXB_STD, 0, V4L2_IN_CAP_STD },
64 };
65 
66 /* this array holds the information, which port of the saa7146 each
67    input actually uses. the mxb uses port 0 for every input */
68 static struct {
69 	int hps_source;
70 	int hps_sync;
71 } input_port_selection[MXB_INPUTS] = {
72 	{ SAA7146_HPS_SOURCE_PORT_A, SAA7146_HPS_SYNC_PORT_A },
73 	{ SAA7146_HPS_SOURCE_PORT_A, SAA7146_HPS_SYNC_PORT_A },
74 	{ SAA7146_HPS_SOURCE_PORT_A, SAA7146_HPS_SYNC_PORT_A },
75 	{ SAA7146_HPS_SOURCE_PORT_A, SAA7146_HPS_SYNC_PORT_A },
76 };
77 
78 /* this array holds the information of the audio source (mxb_audios),
79    which has to be switched corresponding to the video source (mxb_channels) */
80 static int video_audio_connect[MXB_INPUTS] =
81 	{ 0, 1, 3, 3 };
82 
83 struct mxb_routing {
84 	u32 input;
85 	u32 output;
86 };
87 
88 /* these are the available audio sources, which can switched
89    to the line- and cd-output individually */
90 static struct v4l2_audio mxb_audios[MXB_AUDIOS] = {
91 	    {
92 		.index	= 0,
93 		.name	= "Tuner",
94 		.capability = V4L2_AUDCAP_STEREO,
95 	} , {
96 		.index	= 1,
97 		.name	= "AUX1",
98 		.capability = V4L2_AUDCAP_STEREO,
99 	} , {
100 		.index	= 2,
101 		.name	= "AUX2",
102 		.capability = V4L2_AUDCAP_STEREO,
103 	} , {
104 		.index	= 3,
105 		.name	= "AUX3",
106 		.capability = V4L2_AUDCAP_STEREO,
107 	} , {
108 		.index	= 4,
109 		.name	= "Radio (X9)",
110 		.capability = V4L2_AUDCAP_STEREO,
111 	} , {
112 		.index	= 5,
113 		.name	= "CD-ROM (X10)",
114 		.capability = V4L2_AUDCAP_STEREO,
115 	}
116 };
117 
118 /* These are the necessary input-output-pins for bringing one audio source
119    (see above) to the CD-output. Note that gain is set to 0 in this table. */
120 static struct mxb_routing TEA6420_cd[MXB_AUDIOS + 1][2] = {
121 	{ { 1, 1 }, { 1, 1 } },	/* Tuner */
122 	{ { 5, 1 }, { 6, 1 } },	/* AUX 1 */
123 	{ { 4, 1 }, { 6, 1 } },	/* AUX 2 */
124 	{ { 3, 1 }, { 6, 1 } },	/* AUX 3 */
125 	{ { 1, 1 }, { 3, 1 } },	/* Radio */
126 	{ { 1, 1 }, { 2, 1 } },	/* CD-Rom */
127 	{ { 6, 1 }, { 6, 1 } }	/* Mute */
128 };
129 
130 /* These are the necessary input-output-pins for bringing one audio source
131    (see above) to the line-output. Note that gain is set to 0 in this table. */
132 static struct mxb_routing TEA6420_line[MXB_AUDIOS + 1][2] = {
133 	{ { 2, 3 }, { 1, 2 } },
134 	{ { 5, 3 }, { 6, 2 } },
135 	{ { 4, 3 }, { 6, 2 } },
136 	{ { 3, 3 }, { 6, 2 } },
137 	{ { 2, 3 }, { 3, 2 } },
138 	{ { 2, 3 }, { 2, 2 } },
139 	{ { 6, 3 }, { 6, 2 } }	/* Mute */
140 };
141 
142 struct mxb
143 {
144 	struct video_device	video_dev;
145 	struct video_device	vbi_dev;
146 
147 	struct i2c_adapter	i2c_adapter;
148 
149 	struct v4l2_subdev	*saa7111a;
150 	struct v4l2_subdev	*tda9840;
151 	struct v4l2_subdev	*tea6415c;
152 	struct v4l2_subdev	*tuner;
153 	struct v4l2_subdev	*tea6420_1;
154 	struct v4l2_subdev	*tea6420_2;
155 
156 	int	cur_mode;	/* current audio mode (mono, stereo, ...) */
157 	int	cur_input;	/* current input */
158 	int	cur_audinput;	/* current audio input */
159 	int	cur_mute;	/* current mute status */
160 	struct v4l2_frequency	cur_freq;	/* current frequency the tuner is tuned to */
161 };
162 
163 #define saa7111a_call(mxb, o, f, args...) \
164 	v4l2_subdev_call(mxb->saa7111a, o, f, ##args)
165 #define tda9840_call(mxb, o, f, args...) \
166 	v4l2_subdev_call(mxb->tda9840, o, f, ##args)
167 #define tea6415c_call(mxb, o, f, args...) \
168 	v4l2_subdev_call(mxb->tea6415c, o, f, ##args)
169 #define tuner_call(mxb, o, f, args...) \
170 	v4l2_subdev_call(mxb->tuner, o, f, ##args)
171 #define call_all(dev, o, f, args...) \
172 	v4l2_device_call_until_err(&dev->v4l2_dev, 0, o, f, ##args)
173 
174 static void mxb_update_audmode(struct mxb *mxb)
175 {
176 	struct v4l2_tuner t = {
177 		.audmode = mxb->cur_mode,
178 	};
179 
180 	tda9840_call(mxb, tuner, s_tuner, &t);
181 }
182 
183 static inline void tea6420_route(struct mxb *mxb, int idx)
184 {
185 	v4l2_subdev_call(mxb->tea6420_1, audio, s_routing,
186 		TEA6420_cd[idx][0].input, TEA6420_cd[idx][0].output, 0);
187 	v4l2_subdev_call(mxb->tea6420_2, audio, s_routing,
188 		TEA6420_cd[idx][1].input, TEA6420_cd[idx][1].output, 0);
189 	v4l2_subdev_call(mxb->tea6420_1, audio, s_routing,
190 		TEA6420_line[idx][0].input, TEA6420_line[idx][0].output, 0);
191 	v4l2_subdev_call(mxb->tea6420_2, audio, s_routing,
192 		TEA6420_line[idx][1].input, TEA6420_line[idx][1].output, 0);
193 }
194 
195 static struct saa7146_extension extension;
196 
197 static int mxb_s_ctrl(struct v4l2_ctrl *ctrl)
198 {
199 	struct saa7146_dev *dev = container_of(ctrl->handler,
200 				struct saa7146_dev, ctrl_handler);
201 	struct mxb *mxb = dev->ext_priv;
202 
203 	switch (ctrl->id) {
204 	case V4L2_CID_AUDIO_MUTE:
205 		mxb->cur_mute = ctrl->val;
206 		/* switch the audio-source */
207 		tea6420_route(mxb, ctrl->val ? 6 :
208 				video_audio_connect[mxb->cur_input]);
209 		break;
210 	default:
211 		return -EINVAL;
212 	}
213 	return 0;
214 }
215 
216 static const struct v4l2_ctrl_ops mxb_ctrl_ops = {
217 	.s_ctrl = mxb_s_ctrl,
218 };
219 
220 static int mxb_probe(struct saa7146_dev *dev)
221 {
222 	struct v4l2_ctrl_handler *hdl = &dev->ctrl_handler;
223 	struct mxb *mxb = NULL;
224 
225 	v4l2_ctrl_new_std(hdl, &mxb_ctrl_ops,
226 			V4L2_CID_AUDIO_MUTE, 0, 1, 1, 1);
227 	if (hdl->error)
228 		return hdl->error;
229 	mxb = kzalloc(sizeof(struct mxb), GFP_KERNEL);
230 	if (mxb == NULL) {
231 		DEB_D("not enough kernel memory\n");
232 		return -ENOMEM;
233 	}
234 
235 
236 	snprintf(mxb->i2c_adapter.name, sizeof(mxb->i2c_adapter.name), "mxb%d", mxb_num);
237 
238 	saa7146_i2c_adapter_prepare(dev, &mxb->i2c_adapter, SAA7146_I2C_BUS_BIT_RATE_480);
239 	if (i2c_add_adapter(&mxb->i2c_adapter) < 0) {
240 		DEB_S("cannot register i2c-device. skipping.\n");
241 		kfree(mxb);
242 		return -EFAULT;
243 	}
244 
245 	mxb->saa7111a = v4l2_i2c_new_subdev(&dev->v4l2_dev, &mxb->i2c_adapter,
246 			"saa7111", I2C_SAA7111A, NULL);
247 	mxb->tea6420_1 = v4l2_i2c_new_subdev(&dev->v4l2_dev, &mxb->i2c_adapter,
248 			"tea6420", I2C_TEA6420_1, NULL);
249 	mxb->tea6420_2 = v4l2_i2c_new_subdev(&dev->v4l2_dev, &mxb->i2c_adapter,
250 			"tea6420", I2C_TEA6420_2, NULL);
251 	mxb->tea6415c = v4l2_i2c_new_subdev(&dev->v4l2_dev, &mxb->i2c_adapter,
252 			"tea6415c", I2C_TEA6415C, NULL);
253 	mxb->tda9840 = v4l2_i2c_new_subdev(&dev->v4l2_dev, &mxb->i2c_adapter,
254 			"tda9840", I2C_TDA9840, NULL);
255 	mxb->tuner = v4l2_i2c_new_subdev(&dev->v4l2_dev, &mxb->i2c_adapter,
256 			"tuner", I2C_TUNER, NULL);
257 
258 	/* check if all devices are present */
259 	if (!mxb->tea6420_1 || !mxb->tea6420_2 || !mxb->tea6415c ||
260 	    !mxb->tda9840 || !mxb->saa7111a || !mxb->tuner) {
261 		pr_err("did not find all i2c devices. aborting\n");
262 		i2c_del_adapter(&mxb->i2c_adapter);
263 		kfree(mxb);
264 		return -ENODEV;
265 	}
266 
267 	/* all devices are present, probe was successful */
268 
269 	/* we store the pointer in our private data field */
270 	dev->ext_priv = mxb;
271 
272 	v4l2_ctrl_handler_setup(hdl);
273 
274 	return 0;
275 }
276 
277 /* some init data for the saa7740, the so-called 'sound arena module'.
278    there are no specs available, so we simply use some init values */
279 static struct {
280 	int	length;
281 	char	data[9];
282 } mxb_saa7740_init[] = {
283 	{ 3, { 0x80, 0x00, 0x00 } },{ 3, { 0x80, 0x89, 0x00 } },
284 	{ 3, { 0x80, 0xb0, 0x0a } },{ 3, { 0x00, 0x00, 0x00 } },
285 	{ 3, { 0x49, 0x00, 0x00 } },{ 3, { 0x4a, 0x00, 0x00 } },
286 	{ 3, { 0x4b, 0x00, 0x00 } },{ 3, { 0x4c, 0x00, 0x00 } },
287 	{ 3, { 0x4d, 0x00, 0x00 } },{ 3, { 0x4e, 0x00, 0x00 } },
288 	{ 3, { 0x4f, 0x00, 0x00 } },{ 3, { 0x50, 0x00, 0x00 } },
289 	{ 3, { 0x51, 0x00, 0x00 } },{ 3, { 0x52, 0x00, 0x00 } },
290 	{ 3, { 0x53, 0x00, 0x00 } },{ 3, { 0x54, 0x00, 0x00 } },
291 	{ 3, { 0x55, 0x00, 0x00 } },{ 3, { 0x56, 0x00, 0x00 } },
292 	{ 3, { 0x57, 0x00, 0x00 } },{ 3, { 0x58, 0x00, 0x00 } },
293 	{ 3, { 0x59, 0x00, 0x00 } },{ 3, { 0x5a, 0x00, 0x00 } },
294 	{ 3, { 0x5b, 0x00, 0x00 } },{ 3, { 0x5c, 0x00, 0x00 } },
295 	{ 3, { 0x5d, 0x00, 0x00 } },{ 3, { 0x5e, 0x00, 0x00 } },
296 	{ 3, { 0x5f, 0x00, 0x00 } },{ 3, { 0x60, 0x00, 0x00 } },
297 	{ 3, { 0x61, 0x00, 0x00 } },{ 3, { 0x62, 0x00, 0x00 } },
298 	{ 3, { 0x63, 0x00, 0x00 } },{ 3, { 0x64, 0x00, 0x00 } },
299 	{ 3, { 0x65, 0x00, 0x00 } },{ 3, { 0x66, 0x00, 0x00 } },
300 	{ 3, { 0x67, 0x00, 0x00 } },{ 3, { 0x68, 0x00, 0x00 } },
301 	{ 3, { 0x69, 0x00, 0x00 } },{ 3, { 0x6a, 0x00, 0x00 } },
302 	{ 3, { 0x6b, 0x00, 0x00 } },{ 3, { 0x6c, 0x00, 0x00 } },
303 	{ 3, { 0x6d, 0x00, 0x00 } },{ 3, { 0x6e, 0x00, 0x00 } },
304 	{ 3, { 0x6f, 0x00, 0x00 } },{ 3, { 0x70, 0x00, 0x00 } },
305 	{ 3, { 0x71, 0x00, 0x00 } },{ 3, { 0x72, 0x00, 0x00 } },
306 	{ 3, { 0x73, 0x00, 0x00 } },{ 3, { 0x74, 0x00, 0x00 } },
307 	{ 3, { 0x75, 0x00, 0x00 } },{ 3, { 0x76, 0x00, 0x00 } },
308 	{ 3, { 0x77, 0x00, 0x00 } },{ 3, { 0x41, 0x00, 0x42 } },
309 	{ 3, { 0x42, 0x10, 0x42 } },{ 3, { 0x43, 0x20, 0x42 } },
310 	{ 3, { 0x44, 0x30, 0x42 } },{ 3, { 0x45, 0x00, 0x01 } },
311 	{ 3, { 0x46, 0x00, 0x01 } },{ 3, { 0x47, 0x00, 0x01 } },
312 	{ 3, { 0x48, 0x00, 0x01 } },
313 	{ 9, { 0x01, 0x03, 0xc5, 0x5c, 0x7a, 0x85, 0x01, 0x00, 0x54 } },
314 	{ 9, { 0x21, 0x03, 0xc5, 0x5c, 0x7a, 0x85, 0x01, 0x00, 0x54 } },
315 	{ 9, { 0x09, 0x0b, 0xb4, 0x6b, 0x74, 0x85, 0x95, 0x00, 0x34 } },
316 	{ 9, { 0x29, 0x0b, 0xb4, 0x6b, 0x74, 0x85, 0x95, 0x00, 0x34 } },
317 	{ 9, { 0x11, 0x17, 0x43, 0x62, 0x68, 0x89, 0xd1, 0xff, 0xb0 } },
318 	{ 9, { 0x31, 0x17, 0x43, 0x62, 0x68, 0x89, 0xd1, 0xff, 0xb0 } },
319 	{ 9, { 0x19, 0x20, 0x62, 0x51, 0x5a, 0x95, 0x19, 0x01, 0x50 } },
320 	{ 9, { 0x39, 0x20, 0x62, 0x51, 0x5a, 0x95, 0x19, 0x01, 0x50 } },
321 	{ 9, { 0x05, 0x3e, 0xd2, 0x69, 0x4e, 0x9a, 0x51, 0x00, 0xf0 } },
322 	{ 9, { 0x25, 0x3e, 0xd2, 0x69, 0x4e, 0x9a, 0x51, 0x00, 0xf0 } },
323 	{ 9, { 0x0d, 0x3d, 0xa1, 0x40, 0x7d, 0x9f, 0x29, 0xfe, 0x14 } },
324 	{ 9, { 0x2d, 0x3d, 0xa1, 0x40, 0x7d, 0x9f, 0x29, 0xfe, 0x14 } },
325 	{ 9, { 0x15, 0x73, 0xa1, 0x50, 0x5d, 0xa6, 0xf5, 0xfe, 0x38 } },
326 	{ 9, { 0x35, 0x73, 0xa1, 0x50, 0x5d, 0xa6, 0xf5, 0xfe, 0x38 } },
327 	{ 9, { 0x1d, 0xed, 0xd0, 0x68, 0x29, 0xb4, 0xe1, 0x00, 0xb8 } },
328 	{ 9, { 0x3d, 0xed, 0xd0, 0x68, 0x29, 0xb4, 0xe1, 0x00, 0xb8 } },
329 	{ 3, { 0x80, 0xb3, 0x0a } },
330 	{-1, { 0 } }
331 };
332 
333 /* bring hardware to a sane state. this has to be done, just in case someone
334    wants to capture from this device before it has been properly initialized.
335    the capture engine would badly fail, because no valid signal arrives on the
336    saa7146, thus leading to timeouts and stuff. */
337 static int mxb_init_done(struct saa7146_dev* dev)
338 {
339 	struct mxb* mxb = (struct mxb*)dev->ext_priv;
340 	struct i2c_msg msg;
341 	struct tuner_setup tun_setup;
342 	v4l2_std_id std = V4L2_STD_PAL_BG;
343 
344 	int i, err = 0;
345 
346 	/* mute audio on tea6420s */
347 	tea6420_route(mxb, 6);
348 
349 	/* select video mode in saa7111a */
350 	saa7111a_call(mxb, video, s_std, std);
351 
352 	/* select tuner-output on saa7111a */
353 	saa7111a_call(mxb, video, s_routing, SAA7115_COMPOSITE0,
354 		SAA7111_FMT_CCIR, 0);
355 
356 	/* select a tuner type */
357 	tun_setup.mode_mask = T_ANALOG_TV;
358 	tun_setup.addr = ADDR_UNSET;
359 	tun_setup.type = TUNER_PHILIPS_PAL;
360 	tuner_call(mxb, tuner, s_type_addr, &tun_setup);
361 	/* tune in some frequency on tuner */
362 	mxb->cur_freq.tuner = 0;
363 	mxb->cur_freq.type = V4L2_TUNER_ANALOG_TV;
364 	mxb->cur_freq.frequency = freq;
365 	tuner_call(mxb, tuner, s_frequency, &mxb->cur_freq);
366 
367 	/* set a default video standard */
368 	/* These two gpio calls set the GPIO pins that control the tda9820 */
369 	saa7146_write(dev, GPIO_CTRL, 0x00404050);
370 	saa7111a_call(mxb, core, s_gpio, 1);
371 	saa7111a_call(mxb, video, s_std, std);
372 	tuner_call(mxb, video, s_std, std);
373 
374 	/* switch to tuner-channel on tea6415c */
375 	tea6415c_call(mxb, video, s_routing, 3, 17, 0);
376 
377 	/* select tuner-output on multicable on tea6415c */
378 	tea6415c_call(mxb, video, s_routing, 3, 13, 0);
379 
380 	/* the rest for mxb */
381 	mxb->cur_input = 0;
382 	mxb->cur_audinput = video_audio_connect[mxb->cur_input];
383 	mxb->cur_mute = 1;
384 
385 	mxb->cur_mode = V4L2_TUNER_MODE_STEREO;
386 	mxb_update_audmode(mxb);
387 
388 	/* check if the saa7740 (aka 'sound arena module') is present
389 	   on the mxb. if so, we must initialize it. due to lack of
390 	   information about the saa7740, the values were reverse
391 	   engineered. */
392 	msg.addr = 0x1b;
393 	msg.flags = 0;
394 	msg.len = mxb_saa7740_init[0].length;
395 	msg.buf = &mxb_saa7740_init[0].data[0];
396 
397 	err = i2c_transfer(&mxb->i2c_adapter, &msg, 1);
398 	if (err == 1) {
399 		/* the sound arena module is a pos, that's probably the reason
400 		   philips refuses to hand out a datasheet for the saa7740...
401 		   it seems to screw up the i2c bus, so we disable fast irq
402 		   based i2c transactions here and rely on the slow and safe
403 		   polling method ... */
404 		extension.flags &= ~SAA7146_USE_I2C_IRQ;
405 		for (i = 1; ; i++) {
406 			if (-1 == mxb_saa7740_init[i].length)
407 				break;
408 
409 			msg.len = mxb_saa7740_init[i].length;
410 			msg.buf = &mxb_saa7740_init[i].data[0];
411 			err = i2c_transfer(&mxb->i2c_adapter, &msg, 1);
412 			if (err != 1) {
413 				DEB_D("failed to initialize 'sound arena module'\n");
414 				goto err;
415 			}
416 		}
417 		pr_info("'sound arena module' detected\n");
418 	}
419 err:
420 	/* the rest for saa7146: you should definitely set some basic values
421 	   for the input-port handling of the saa7146. */
422 
423 	/* ext->saa has been filled by the core driver */
424 
425 	/* some stuff is done via variables */
426 	saa7146_set_hps_source_and_sync(dev, input_port_selection[mxb->cur_input].hps_source,
427 			input_port_selection[mxb->cur_input].hps_sync);
428 
429 	/* some stuff is done via direct write to the registers */
430 
431 	/* this is ugly, but because of the fact that this is completely
432 	   hardware dependend, it should be done directly... */
433 	saa7146_write(dev, DD1_STREAM_B,	0x00000000);
434 	saa7146_write(dev, DD1_INIT,		0x02000200);
435 	saa7146_write(dev, MC2, (MASK_09 | MASK_25 | MASK_10 | MASK_26));
436 
437 	return 0;
438 }
439 
440 /* interrupt-handler. this gets called when irq_mask is != 0.
441    it must clear the interrupt-bits in irq_mask it has handled */
442 /*
443 void mxb_irq_bh(struct saa7146_dev* dev, u32* irq_mask)
444 {
445 	struct mxb* mxb = (struct mxb*)dev->ext_priv;
446 }
447 */
448 
449 static int vidioc_enum_input(struct file *file, void *fh, struct v4l2_input *i)
450 {
451 	DEB_EE("VIDIOC_ENUMINPUT %d\n", i->index);
452 	if (i->index >= MXB_INPUTS)
453 		return -EINVAL;
454 	memcpy(i, &mxb_inputs[i->index], sizeof(struct v4l2_input));
455 	return 0;
456 }
457 
458 static int vidioc_g_input(struct file *file, void *fh, unsigned int *i)
459 {
460 	struct saa7146_dev *dev = video_drvdata(file);
461 	struct mxb *mxb = (struct mxb *)dev->ext_priv;
462 	*i = mxb->cur_input;
463 
464 	DEB_EE("VIDIOC_G_INPUT %d\n", *i);
465 	return 0;
466 }
467 
468 static int vidioc_s_input(struct file *file, void *fh, unsigned int input)
469 {
470 	struct saa7146_dev *dev = video_drvdata(file);
471 	struct mxb *mxb = (struct mxb *)dev->ext_priv;
472 	int err = 0;
473 	int i = 0;
474 
475 	DEB_EE("VIDIOC_S_INPUT %d\n", input);
476 
477 	if (input >= MXB_INPUTS)
478 		return -EINVAL;
479 
480 	mxb->cur_input = input;
481 
482 	saa7146_set_hps_source_and_sync(dev, input_port_selection[input].hps_source,
483 			input_port_selection[input].hps_sync);
484 
485 	/* prepare switching of tea6415c and saa7111a;
486 	   have a look at the 'background'-file for further information  */
487 	switch (input) {
488 	case TUNER:
489 		i = SAA7115_COMPOSITE0;
490 
491 		err = tea6415c_call(mxb, video, s_routing, 3, 17, 0);
492 
493 		/* connect tuner-output always to multicable */
494 		if (!err)
495 			err = tea6415c_call(mxb, video, s_routing, 3, 13, 0);
496 		break;
497 	case AUX3_YC:
498 		/* nothing to be done here. aux3_yc is
499 		   directly connected to the saa711a */
500 		i = SAA7115_SVIDEO1;
501 		break;
502 	case AUX3:
503 		/* nothing to be done here. aux3 is
504 		   directly connected to the saa711a */
505 		i = SAA7115_COMPOSITE1;
506 		break;
507 	case AUX1:
508 		i = SAA7115_COMPOSITE0;
509 		err = tea6415c_call(mxb, video, s_routing, 1, 17, 0);
510 		break;
511 	}
512 
513 	if (err)
514 		return err;
515 
516 	mxb->video_dev.tvnorms = mxb_inputs[input].std;
517 	mxb->vbi_dev.tvnorms = mxb_inputs[input].std;
518 
519 	/* switch video in saa7111a */
520 	if (saa7111a_call(mxb, video, s_routing, i, SAA7111_FMT_CCIR, 0))
521 		pr_err("VIDIOC_S_INPUT: could not address saa7111a\n");
522 
523 	mxb->cur_audinput = video_audio_connect[input];
524 	/* switch the audio-source only if necessary */
525 	if (0 == mxb->cur_mute)
526 		tea6420_route(mxb, mxb->cur_audinput);
527 	if (mxb->cur_audinput == 0)
528 		mxb_update_audmode(mxb);
529 
530 	return 0;
531 }
532 
533 static int vidioc_g_tuner(struct file *file, void *fh, struct v4l2_tuner *t)
534 {
535 	struct saa7146_dev *dev = video_drvdata(file);
536 	struct mxb *mxb = (struct mxb *)dev->ext_priv;
537 
538 	if (t->index) {
539 		DEB_D("VIDIOC_G_TUNER: channel %d does not have a tuner attached\n",
540 		      t->index);
541 		return -EINVAL;
542 	}
543 
544 	DEB_EE("VIDIOC_G_TUNER: %d\n", t->index);
545 
546 	memset(t, 0, sizeof(*t));
547 	strscpy(t->name, "TV Tuner", sizeof(t->name));
548 	t->type = V4L2_TUNER_ANALOG_TV;
549 	t->capability = V4L2_TUNER_CAP_NORM | V4L2_TUNER_CAP_STEREO |
550 			V4L2_TUNER_CAP_LANG1 | V4L2_TUNER_CAP_LANG2 | V4L2_TUNER_CAP_SAP;
551 	t->audmode = mxb->cur_mode;
552 	return call_all(dev, tuner, g_tuner, t);
553 }
554 
555 static int vidioc_s_tuner(struct file *file, void *fh, const struct v4l2_tuner *t)
556 {
557 	struct saa7146_dev *dev = video_drvdata(file);
558 	struct mxb *mxb = (struct mxb *)dev->ext_priv;
559 
560 	if (t->index) {
561 		DEB_D("VIDIOC_S_TUNER: channel %d does not have a tuner attached\n",
562 		      t->index);
563 		return -EINVAL;
564 	}
565 
566 	mxb->cur_mode = t->audmode;
567 	return call_all(dev, tuner, s_tuner, t);
568 }
569 
570 static int vidioc_querystd(struct file *file, void *fh, v4l2_std_id *norm)
571 {
572 	struct saa7146_dev *dev = video_drvdata(file);
573 
574 	return call_all(dev, video, querystd, norm);
575 }
576 
577 static int vidioc_g_frequency(struct file *file, void *fh, struct v4l2_frequency *f)
578 {
579 	struct saa7146_dev *dev = video_drvdata(file);
580 	struct mxb *mxb = (struct mxb *)dev->ext_priv;
581 
582 	if (f->tuner)
583 		return -EINVAL;
584 	*f = mxb->cur_freq;
585 
586 	DEB_EE("VIDIOC_G_FREQ: freq:0x%08x\n", mxb->cur_freq.frequency);
587 	return 0;
588 }
589 
590 static int vidioc_s_frequency(struct file *file, void *fh, const struct v4l2_frequency *f)
591 {
592 	struct saa7146_dev *dev = video_drvdata(file);
593 	struct mxb *mxb = (struct mxb *)dev->ext_priv;
594 
595 	if (f->tuner)
596 		return -EINVAL;
597 
598 	if (V4L2_TUNER_ANALOG_TV != f->type)
599 		return -EINVAL;
600 
601 	DEB_EE("VIDIOC_S_FREQUENCY: freq:0x%08x\n", mxb->cur_freq.frequency);
602 
603 	/* tune in desired frequency */
604 	tuner_call(mxb, tuner, s_frequency, f);
605 	/* let the tuner subdev clamp the frequency to the tuner range */
606 	mxb->cur_freq = *f;
607 	tuner_call(mxb, tuner, g_frequency, &mxb->cur_freq);
608 	if (mxb->cur_audinput == 0)
609 		mxb_update_audmode(mxb);
610 	return 0;
611 }
612 
613 static int vidioc_enumaudio(struct file *file, void *fh, struct v4l2_audio *a)
614 {
615 	if (a->index >= MXB_AUDIOS)
616 		return -EINVAL;
617 	*a = mxb_audios[a->index];
618 	return 0;
619 }
620 
621 static int vidioc_g_audio(struct file *file, void *fh, struct v4l2_audio *a)
622 {
623 	struct saa7146_dev *dev = video_drvdata(file);
624 	struct mxb *mxb = (struct mxb *)dev->ext_priv;
625 
626 	DEB_EE("VIDIOC_G_AUDIO\n");
627 	*a = mxb_audios[mxb->cur_audinput];
628 	return 0;
629 }
630 
631 static int vidioc_s_audio(struct file *file, void *fh, const struct v4l2_audio *a)
632 {
633 	struct saa7146_dev *dev = video_drvdata(file);
634 	struct mxb *mxb = (struct mxb *)dev->ext_priv;
635 
636 	DEB_D("VIDIOC_S_AUDIO %d\n", a->index);
637 	if (a->index >= 32 ||
638 	    !(mxb_inputs[mxb->cur_input].audioset & (1 << a->index)))
639 		return -EINVAL;
640 
641 	if (mxb->cur_audinput != a->index) {
642 		mxb->cur_audinput = a->index;
643 		tea6420_route(mxb, a->index);
644 		if (mxb->cur_audinput == 0)
645 			mxb_update_audmode(mxb);
646 	}
647 	return 0;
648 }
649 
650 #ifdef CONFIG_VIDEO_ADV_DEBUG
651 static int vidioc_g_register(struct file *file, void *fh, struct v4l2_dbg_register *reg)
652 {
653 	struct saa7146_dev *dev = video_drvdata(file);
654 
655 	if (reg->reg > pci_resource_len(dev->pci, 0) - 4)
656 		return -EINVAL;
657 	reg->val = saa7146_read(dev, reg->reg);
658 	reg->size = 4;
659 	return 0;
660 }
661 
662 static int vidioc_s_register(struct file *file, void *fh, const struct v4l2_dbg_register *reg)
663 {
664 	struct saa7146_dev *dev = video_drvdata(file);
665 
666 	if (reg->reg > pci_resource_len(dev->pci, 0) - 4)
667 		return -EINVAL;
668 	saa7146_write(dev, reg->reg, reg->val);
669 	return 0;
670 }
671 #endif
672 
673 static struct saa7146_ext_vv vv_data;
674 
675 /* this function only gets called when the probing was successful */
676 static int mxb_attach(struct saa7146_dev *dev, struct saa7146_pci_extension_data *info)
677 {
678 	struct mxb *mxb;
679 	int ret;
680 
681 	DEB_EE("dev:%p\n", dev);
682 
683 	ret = saa7146_vv_init(dev, &vv_data);
684 	if (ret) {
685 		ERR("Error in saa7146_vv_init()");
686 		return ret;
687 	}
688 
689 	if (mxb_probe(dev)) {
690 		saa7146_vv_release(dev);
691 		return -1;
692 	}
693 	mxb = (struct mxb *)dev->ext_priv;
694 
695 	vv_data.vid_ops.vidioc_enum_input = vidioc_enum_input;
696 	vv_data.vid_ops.vidioc_g_input = vidioc_g_input;
697 	vv_data.vid_ops.vidioc_s_input = vidioc_s_input;
698 	vv_data.vid_ops.vidioc_querystd = vidioc_querystd;
699 	vv_data.vid_ops.vidioc_g_tuner = vidioc_g_tuner;
700 	vv_data.vid_ops.vidioc_s_tuner = vidioc_s_tuner;
701 	vv_data.vid_ops.vidioc_g_frequency = vidioc_g_frequency;
702 	vv_data.vid_ops.vidioc_s_frequency = vidioc_s_frequency;
703 	vv_data.vid_ops.vidioc_enumaudio = vidioc_enumaudio;
704 	vv_data.vid_ops.vidioc_g_audio = vidioc_g_audio;
705 	vv_data.vid_ops.vidioc_s_audio = vidioc_s_audio;
706 #ifdef CONFIG_VIDEO_ADV_DEBUG
707 	vv_data.vid_ops.vidioc_g_register = vidioc_g_register;
708 	vv_data.vid_ops.vidioc_s_register = vidioc_s_register;
709 #endif
710 	vv_data.vbi_ops.vidioc_enum_input = vidioc_enum_input;
711 	vv_data.vbi_ops.vidioc_g_input = vidioc_g_input;
712 	vv_data.vbi_ops.vidioc_s_input = vidioc_s_input;
713 	vv_data.vbi_ops.vidioc_querystd = vidioc_querystd;
714 	vv_data.vbi_ops.vidioc_g_tuner = vidioc_g_tuner;
715 	vv_data.vbi_ops.vidioc_s_tuner = vidioc_s_tuner;
716 	vv_data.vbi_ops.vidioc_g_frequency = vidioc_g_frequency;
717 	vv_data.vbi_ops.vidioc_s_frequency = vidioc_s_frequency;
718 	vv_data.vbi_ops.vidioc_enumaudio = vidioc_enumaudio;
719 	vv_data.vbi_ops.vidioc_g_audio = vidioc_g_audio;
720 	vv_data.vbi_ops.vidioc_s_audio = vidioc_s_audio;
721 	if (saa7146_register_device(&mxb->video_dev, dev, "mxb", VFL_TYPE_VIDEO)) {
722 		ERR("cannot register capture v4l2 device. skipping.\n");
723 		saa7146_vv_release(dev);
724 		return -1;
725 	}
726 
727 	/* initialization stuff (vbi) (only for revision > 0 and for extensions which want it)*/
728 	if (MXB_BOARD_CAN_DO_VBI(dev)) {
729 		if (saa7146_register_device(&mxb->vbi_dev, dev, "mxb", VFL_TYPE_VBI)) {
730 			ERR("cannot register vbi v4l2 device. skipping.\n");
731 		}
732 	}
733 
734 	pr_info("found Multimedia eXtension Board #%d\n", mxb_num);
735 
736 	mxb_num++;
737 	mxb_init_done(dev);
738 	return 0;
739 }
740 
741 static int mxb_detach(struct saa7146_dev *dev)
742 {
743 	struct mxb *mxb = (struct mxb *)dev->ext_priv;
744 
745 	DEB_EE("dev:%p\n", dev);
746 
747 	/* mute audio on tea6420s */
748 	tea6420_route(mxb, 6);
749 
750 	saa7146_unregister_device(&mxb->video_dev,dev);
751 	if (MXB_BOARD_CAN_DO_VBI(dev))
752 		saa7146_unregister_device(&mxb->vbi_dev, dev);
753 	saa7146_vv_release(dev);
754 
755 	mxb_num--;
756 
757 	i2c_del_adapter(&mxb->i2c_adapter);
758 	kfree(mxb);
759 
760 	return 0;
761 }
762 
763 static int std_callback(struct saa7146_dev *dev, struct saa7146_standard *standard)
764 {
765 	struct mxb *mxb = (struct mxb *)dev->ext_priv;
766 
767 	if (V4L2_STD_PAL_I == standard->id) {
768 		v4l2_std_id std = V4L2_STD_PAL_I;
769 
770 		DEB_D("VIDIOC_S_STD: setting mxb for PAL_I\n");
771 		/* These two gpio calls set the GPIO pins that control the tda9820 */
772 		saa7146_write(dev, GPIO_CTRL, 0x00404050);
773 		saa7111a_call(mxb, core, s_gpio, 0);
774 		saa7111a_call(mxb, video, s_std, std);
775 		if (mxb->cur_input == 0)
776 			tuner_call(mxb, video, s_std, std);
777 	} else {
778 		v4l2_std_id std = V4L2_STD_PAL_BG;
779 
780 		if (mxb->cur_input)
781 			std = standard->id;
782 		DEB_D("VIDIOC_S_STD: setting mxb for PAL/NTSC/SECAM\n");
783 		/* These two gpio calls set the GPIO pins that control the tda9820 */
784 		saa7146_write(dev, GPIO_CTRL, 0x00404050);
785 		saa7111a_call(mxb, core, s_gpio, 1);
786 		saa7111a_call(mxb, video, s_std, std);
787 		if (mxb->cur_input == 0)
788 			tuner_call(mxb, video, s_std, std);
789 	}
790 	return 0;
791 }
792 
793 static struct saa7146_standard standard[] = {
794 	{
795 		.name	= "PAL-BG",	.id	= V4L2_STD_PAL_BG,
796 		.v_offset	= 0x17,	.v_field	= 288,
797 		.h_offset	= 0x14,	.h_pixels	= 680,
798 		.v_max_out	= 576,	.h_max_out	= 768,
799 	}, {
800 		.name	= "PAL-I",	.id	= V4L2_STD_PAL_I,
801 		.v_offset	= 0x17,	.v_field	= 288,
802 		.h_offset	= 0x14,	.h_pixels	= 680,
803 		.v_max_out	= 576,	.h_max_out	= 768,
804 	}, {
805 		.name	= "NTSC",	.id	= V4L2_STD_NTSC,
806 		.v_offset	= 0x16,	.v_field	= 240,
807 		.h_offset	= 0x06,	.h_pixels	= 708,
808 		.v_max_out	= 480,	.h_max_out	= 640,
809 	}, {
810 		.name	= "SECAM",	.id	= V4L2_STD_SECAM,
811 		.v_offset	= 0x14,	.v_field	= 288,
812 		.h_offset	= 0x14,	.h_pixels	= 720,
813 		.v_max_out	= 576,	.h_max_out	= 768,
814 	}
815 };
816 
817 static struct saa7146_pci_extension_data mxb = {
818 	.ext_priv = "Multimedia eXtension Board",
819 	.ext = &extension,
820 };
821 
822 static const struct pci_device_id pci_tbl[] = {
823 	{
824 		.vendor    = PCI_VENDOR_ID_PHILIPS,
825 		.device	   = PCI_DEVICE_ID_PHILIPS_SAA7146,
826 		.subvendor = 0x0000,
827 		.subdevice = 0x0000,
828 		.driver_data = (unsigned long)&mxb,
829 	}, {
830 		.vendor	= 0,
831 	}
832 };
833 
834 MODULE_DEVICE_TABLE(pci, pci_tbl);
835 
836 static struct saa7146_ext_vv vv_data = {
837 	.inputs		= MXB_INPUTS,
838 	.capabilities	= V4L2_CAP_TUNER | V4L2_CAP_VBI_CAPTURE | V4L2_CAP_AUDIO,
839 	.stds		= &standard[0],
840 	.num_stds	= ARRAY_SIZE(standard),
841 	.std_callback	= &std_callback,
842 };
843 
844 static struct saa7146_extension extension = {
845 	.name		= "Multimedia eXtension Board",
846 	.flags		= SAA7146_USE_I2C_IRQ,
847 
848 	.pci_tbl	= &pci_tbl[0],
849 	.module		= THIS_MODULE,
850 
851 	.attach		= mxb_attach,
852 	.detach		= mxb_detach,
853 
854 	.irq_mask	= 0,
855 	.irq_func	= NULL,
856 };
857 
858 static int __init mxb_init_module(void)
859 {
860 	if (saa7146_register_extension(&extension)) {
861 		DEB_S("failed to register extension\n");
862 		return -ENODEV;
863 	}
864 
865 	return 0;
866 }
867 
868 static void __exit mxb_cleanup_module(void)
869 {
870 	saa7146_unregister_extension(&extension);
871 }
872 
873 module_init(mxb_init_module);
874 module_exit(mxb_cleanup_module);
875 
876 MODULE_DESCRIPTION("video4linux-2 driver for the Siemens-Nixdorf 'Multimedia eXtension board'");
877 MODULE_AUTHOR("Michael Hunold <michael@mihu.de>");
878 MODULE_LICENSE("GPL");
879