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 mxb_update_audmode(struct mxb * mxb)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 tea6420_route(struct mxb * mxb,int idx)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 mxb_s_ctrl(struct v4l2_ctrl * ctrl)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 mxb_probe(struct saa7146_dev * dev)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. */ mxb_init_done(struct saa7146_dev * dev)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 vidioc_enum_input(struct file * file,void * fh,struct v4l2_input * i)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 vidioc_g_input(struct file * file,void * fh,unsigned int * i)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 vidioc_s_input(struct file * file,void * fh,unsigned int input)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 vidioc_g_tuner(struct file * file,void * fh,struct v4l2_tuner * t)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 vidioc_s_tuner(struct file * file,void * fh,const struct v4l2_tuner * t)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 vidioc_querystd(struct file * file,void * fh,v4l2_std_id * norm)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 vidioc_g_frequency(struct file * file,void * fh,struct v4l2_frequency * f)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 vidioc_s_frequency(struct file * file,void * fh,const struct v4l2_frequency * f)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 vidioc_enumaudio(struct file * file,void * fh,struct v4l2_audio * a)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 vidioc_g_audio(struct file * file,void * fh,struct v4l2_audio * a)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 vidioc_s_audio(struct file * file,void * fh,const struct v4l2_audio * a)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 vidioc_g_register(struct file * file,void * fh,struct v4l2_dbg_register * reg)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 vidioc_s_register(struct file * file,void * fh,const struct v4l2_dbg_register * reg)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 */ mxb_attach(struct saa7146_dev * dev,struct saa7146_pci_extension_data * info)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 mxb_detach(struct saa7146_dev * dev)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 std_callback(struct saa7146_dev * dev,struct saa7146_standard * standard)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 mxb_init_module(void)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 mxb_cleanup_module(void)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