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