1 /* 2 * saa717x - Philips SAA717xHL video decoder driver 3 * 4 * Based on the saa7115 driver 5 * 6 * Changes by Ohta Kyuma <alpha292@bremen.or.jp> 7 * - Apply to SAA717x,NEC uPD64031,uPD64083. (1/31/2004) 8 * 9 * Changes by T.Adachi (tadachi@tadachi-net.com) 10 * - support audio, video scaler etc, and checked the initialize sequence. 11 * 12 * Cleaned up by Hans Verkuil <hverkuil@xs4all.nl> 13 * 14 * Note: this is a reversed engineered driver based on captures from 15 * the I2C bus under Windows. This chip is very similar to the saa7134, 16 * though. Unfortunately, this driver is currently only working for NTSC. 17 * 18 * This program is free software; you can redistribute it and/or modify 19 * it under the terms of the GNU General Public License as published by 20 * the Free Software Foundation; either version 2 of the License, or 21 * (at your option) any later version. 22 * 23 * This program is distributed in the hope that it will be useful, 24 * but WITHOUT ANY WARRANTY; without even the implied warranty of 25 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 26 * GNU General Public License for more details. 27 */ 28 29 #include <linux/module.h> 30 #include <linux/kernel.h> 31 #include <linux/slab.h> 32 #include <linux/sched.h> 33 34 #include <linux/videodev2.h> 35 #include <linux/i2c.h> 36 #include <media/v4l2-device.h> 37 #include <media/v4l2-ctrls.h> 38 39 MODULE_DESCRIPTION("Philips SAA717x audio/video decoder driver"); 40 MODULE_AUTHOR("K. Ohta, T. Adachi, Hans Verkuil"); 41 MODULE_LICENSE("GPL"); 42 43 static int debug; 44 module_param(debug, int, 0644); 45 MODULE_PARM_DESC(debug, "Debug level (0-1)"); 46 47 /* 48 * Generic i2c probe 49 * concerning the addresses: i2c wants 7 bit (without the r/w bit), so '>>1' 50 */ 51 52 struct saa717x_state { 53 struct v4l2_subdev sd; 54 struct v4l2_ctrl_handler hdl; 55 v4l2_std_id std; 56 int input; 57 int enable; 58 int radio; 59 int playback; 60 int audio; 61 int tuner_audio_mode; 62 int audio_main_mute; 63 int audio_main_vol_r; 64 int audio_main_vol_l; 65 u16 audio_main_bass; 66 u16 audio_main_treble; 67 u16 audio_main_volume; 68 u16 audio_main_balance; 69 int audio_input; 70 }; 71 72 static inline struct saa717x_state *to_state(struct v4l2_subdev *sd) 73 { 74 return container_of(sd, struct saa717x_state, sd); 75 } 76 77 static inline struct v4l2_subdev *to_sd(struct v4l2_ctrl *ctrl) 78 { 79 return &container_of(ctrl->handler, struct saa717x_state, hdl)->sd; 80 } 81 82 /* ----------------------------------------------------------------------- */ 83 84 /* for audio mode */ 85 #define TUNER_AUDIO_MONO 0 /* LL */ 86 #define TUNER_AUDIO_STEREO 1 /* LR */ 87 #define TUNER_AUDIO_LANG1 2 /* LL */ 88 #define TUNER_AUDIO_LANG2 3 /* RR */ 89 90 #define SAA717X_NTSC_WIDTH (704) 91 #define SAA717X_NTSC_HEIGHT (480) 92 93 /* ----------------------------------------------------------------------- */ 94 95 static int saa717x_write(struct v4l2_subdev *sd, u32 reg, u32 value) 96 { 97 struct i2c_client *client = v4l2_get_subdevdata(sd); 98 struct i2c_adapter *adap = client->adapter; 99 int fw_addr = reg == 0x454 || (reg >= 0x464 && reg <= 0x478) || reg == 0x480 || reg == 0x488; 100 unsigned char mm1[6]; 101 struct i2c_msg msg; 102 103 msg.flags = 0; 104 msg.addr = client->addr; 105 mm1[0] = (reg >> 8) & 0xff; 106 mm1[1] = reg & 0xff; 107 108 if (fw_addr) { 109 mm1[4] = (value >> 16) & 0xff; 110 mm1[3] = (value >> 8) & 0xff; 111 mm1[2] = value & 0xff; 112 } else { 113 mm1[2] = value & 0xff; 114 } 115 msg.len = fw_addr ? 5 : 3; /* Long Registers have *only* three bytes! */ 116 msg.buf = mm1; 117 v4l2_dbg(2, debug, sd, "wrote: reg 0x%03x=%08x\n", reg, value); 118 return i2c_transfer(adap, &msg, 1) == 1; 119 } 120 121 static void saa717x_write_regs(struct v4l2_subdev *sd, u32 *data) 122 { 123 while (data[0] || data[1]) { 124 saa717x_write(sd, data[0], data[1]); 125 data += 2; 126 } 127 } 128 129 static u32 saa717x_read(struct v4l2_subdev *sd, u32 reg) 130 { 131 struct i2c_client *client = v4l2_get_subdevdata(sd); 132 struct i2c_adapter *adap = client->adapter; 133 int fw_addr = (reg >= 0x404 && reg <= 0x4b8) || reg == 0x528; 134 unsigned char mm1[2]; 135 unsigned char mm2[4] = { 0, 0, 0, 0 }; 136 struct i2c_msg msgs[2]; 137 u32 value; 138 139 msgs[0].flags = 0; 140 msgs[1].flags = I2C_M_RD; 141 msgs[0].addr = msgs[1].addr = client->addr; 142 mm1[0] = (reg >> 8) & 0xff; 143 mm1[1] = reg & 0xff; 144 msgs[0].len = 2; 145 msgs[0].buf = mm1; 146 msgs[1].len = fw_addr ? 3 : 1; /* Multibyte Registers contains *only* 3 bytes */ 147 msgs[1].buf = mm2; 148 i2c_transfer(adap, msgs, 2); 149 150 if (fw_addr) 151 value = (mm2[2] << 16) | (mm2[1] << 8) | mm2[0]; 152 else 153 value = mm2[0]; 154 155 v4l2_dbg(2, debug, sd, "read: reg 0x%03x=0x%08x\n", reg, value); 156 return value; 157 } 158 159 /* ----------------------------------------------------------------------- */ 160 161 static u32 reg_init_initialize[] = 162 { 163 /* from linux driver */ 164 0x101, 0x008, /* Increment delay */ 165 166 0x103, 0x000, /* Analog input control 2 */ 167 0x104, 0x090, /* Analog input control 3 */ 168 0x105, 0x090, /* Analog input control 4 */ 169 0x106, 0x0eb, /* Horizontal sync start */ 170 0x107, 0x0e0, /* Horizontal sync stop */ 171 0x109, 0x055, /* Luminance control */ 172 173 0x10f, 0x02a, /* Chroma gain control */ 174 0x110, 0x000, /* Chroma control 2 */ 175 176 0x114, 0x045, /* analog/ADC */ 177 178 0x118, 0x040, /* RAW data gain */ 179 0x119, 0x080, /* RAW data offset */ 180 181 0x044, 0x000, /* VBI horizontal input window start (L) TASK A */ 182 0x045, 0x000, /* VBI horizontal input window start (H) TASK A */ 183 0x046, 0x0cf, /* VBI horizontal input window stop (L) TASK A */ 184 0x047, 0x002, /* VBI horizontal input window stop (H) TASK A */ 185 186 0x049, 0x000, /* VBI vertical input window start (H) TASK A */ 187 188 0x04c, 0x0d0, /* VBI horizontal output length (L) TASK A */ 189 0x04d, 0x002, /* VBI horizontal output length (H) TASK A */ 190 191 0x064, 0x080, /* Lumina brightness TASK A */ 192 0x065, 0x040, /* Luminance contrast TASK A */ 193 0x066, 0x040, /* Chroma saturation TASK A */ 194 /* 067H: Reserved */ 195 0x068, 0x000, /* VBI horizontal scaling increment (L) TASK A */ 196 0x069, 0x004, /* VBI horizontal scaling increment (H) TASK A */ 197 0x06a, 0x000, /* VBI phase offset TASK A */ 198 199 0x06e, 0x000, /* Horizontal phase offset Luma TASK A */ 200 0x06f, 0x000, /* Horizontal phase offset Chroma TASK A */ 201 202 0x072, 0x000, /* Vertical filter mode TASK A */ 203 204 0x084, 0x000, /* VBI horizontal input window start (L) TAKS B */ 205 0x085, 0x000, /* VBI horizontal input window start (H) TAKS B */ 206 0x086, 0x0cf, /* VBI horizontal input window stop (L) TAKS B */ 207 0x087, 0x002, /* VBI horizontal input window stop (H) TAKS B */ 208 209 0x089, 0x000, /* VBI vertical input window start (H) TAKS B */ 210 211 0x08c, 0x0d0, /* VBI horizontal output length (L) TASK B */ 212 0x08d, 0x002, /* VBI horizontal output length (H) TASK B */ 213 214 0x0a4, 0x080, /* Lumina brightness TASK B */ 215 0x0a5, 0x040, /* Luminance contrast TASK B */ 216 0x0a6, 0x040, /* Chroma saturation TASK B */ 217 /* 0A7H reserved */ 218 0x0a8, 0x000, /* VBI horizontal scaling increment (L) TASK B */ 219 0x0a9, 0x004, /* VBI horizontal scaling increment (H) TASK B */ 220 0x0aa, 0x000, /* VBI phase offset TASK B */ 221 222 0x0ae, 0x000, /* Horizontal phase offset Luma TASK B */ 223 0x0af, 0x000, /*Horizontal phase offset Chroma TASK B */ 224 225 0x0b2, 0x000, /* Vertical filter mode TASK B */ 226 227 0x00c, 0x000, /* Start point GREEN path */ 228 0x00d, 0x000, /* Start point BLUE path */ 229 0x00e, 0x000, /* Start point RED path */ 230 231 0x010, 0x010, /* GREEN path gamma curve --- */ 232 0x011, 0x020, 233 0x012, 0x030, 234 0x013, 0x040, 235 0x014, 0x050, 236 0x015, 0x060, 237 0x016, 0x070, 238 0x017, 0x080, 239 0x018, 0x090, 240 0x019, 0x0a0, 241 0x01a, 0x0b0, 242 0x01b, 0x0c0, 243 0x01c, 0x0d0, 244 0x01d, 0x0e0, 245 0x01e, 0x0f0, 246 0x01f, 0x0ff, /* --- GREEN path gamma curve */ 247 248 0x020, 0x010, /* BLUE path gamma curve --- */ 249 0x021, 0x020, 250 0x022, 0x030, 251 0x023, 0x040, 252 0x024, 0x050, 253 0x025, 0x060, 254 0x026, 0x070, 255 0x027, 0x080, 256 0x028, 0x090, 257 0x029, 0x0a0, 258 0x02a, 0x0b0, 259 0x02b, 0x0c0, 260 0x02c, 0x0d0, 261 0x02d, 0x0e0, 262 0x02e, 0x0f0, 263 0x02f, 0x0ff, /* --- BLUE path gamma curve */ 264 265 0x030, 0x010, /* RED path gamma curve --- */ 266 0x031, 0x020, 267 0x032, 0x030, 268 0x033, 0x040, 269 0x034, 0x050, 270 0x035, 0x060, 271 0x036, 0x070, 272 0x037, 0x080, 273 0x038, 0x090, 274 0x039, 0x0a0, 275 0x03a, 0x0b0, 276 0x03b, 0x0c0, 277 0x03c, 0x0d0, 278 0x03d, 0x0e0, 279 0x03e, 0x0f0, 280 0x03f, 0x0ff, /* --- RED path gamma curve */ 281 282 0x109, 0x085, /* Luminance control */ 283 284 /**** from app start ****/ 285 0x584, 0x000, /* AGC gain control */ 286 0x585, 0x000, /* Program count */ 287 0x586, 0x003, /* Status reset */ 288 0x588, 0x0ff, /* Number of audio samples (L) */ 289 0x589, 0x00f, /* Number of audio samples (M) */ 290 0x58a, 0x000, /* Number of audio samples (H) */ 291 0x58b, 0x000, /* Audio select */ 292 0x58c, 0x010, /* Audio channel assign1 */ 293 0x58d, 0x032, /* Audio channel assign2 */ 294 0x58e, 0x054, /* Audio channel assign3 */ 295 0x58f, 0x023, /* Audio format */ 296 0x590, 0x000, /* SIF control */ 297 298 0x595, 0x000, /* ?? */ 299 0x596, 0x000, /* ?? */ 300 0x597, 0x000, /* ?? */ 301 302 0x464, 0x00, /* Digital input crossbar1 */ 303 304 0x46c, 0xbbbb10, /* Digital output selection1-3 */ 305 0x470, 0x101010, /* Digital output selection4-6 */ 306 307 0x478, 0x00, /* Sound feature control */ 308 309 0x474, 0x18, /* Softmute control */ 310 311 0x454, 0x0425b9, /* Sound Easy programming(reset) */ 312 0x454, 0x042539, /* Sound Easy programming(reset) */ 313 314 315 /**** common setting( of DVD play, including scaler commands) ****/ 316 0x042, 0x003, /* Data path configuration for VBI (TASK A) */ 317 318 0x082, 0x003, /* Data path configuration for VBI (TASK B) */ 319 320 0x108, 0x0f8, /* Sync control */ 321 0x2a9, 0x0fd, /* ??? */ 322 0x102, 0x089, /* select video input "mode 9" */ 323 0x111, 0x000, /* Mode/delay control */ 324 325 0x10e, 0x00a, /* Chroma control 1 */ 326 327 0x594, 0x002, /* SIF, analog I/O select */ 328 329 0x454, 0x0425b9, /* Sound */ 330 0x454, 0x042539, 331 332 0x111, 0x000, 333 0x10e, 0x00a, 334 0x464, 0x000, 335 0x300, 0x000, 336 0x301, 0x006, 337 0x302, 0x000, 338 0x303, 0x006, 339 0x308, 0x040, 340 0x309, 0x000, 341 0x30a, 0x000, 342 0x30b, 0x000, 343 0x000, 0x002, 344 0x001, 0x000, 345 0x002, 0x000, 346 0x003, 0x000, 347 0x004, 0x033, 348 0x040, 0x01d, 349 0x041, 0x001, 350 0x042, 0x004, 351 0x043, 0x000, 352 0x080, 0x01e, 353 0x081, 0x001, 354 0x082, 0x004, 355 0x083, 0x000, 356 0x190, 0x018, 357 0x115, 0x000, 358 0x116, 0x012, 359 0x117, 0x018, 360 0x04a, 0x011, 361 0x08a, 0x011, 362 0x04b, 0x000, 363 0x08b, 0x000, 364 0x048, 0x000, 365 0x088, 0x000, 366 0x04e, 0x012, 367 0x08e, 0x012, 368 0x058, 0x012, 369 0x098, 0x012, 370 0x059, 0x000, 371 0x099, 0x000, 372 0x05a, 0x003, 373 0x09a, 0x003, 374 0x05b, 0x001, 375 0x09b, 0x001, 376 0x054, 0x008, 377 0x094, 0x008, 378 0x055, 0x000, 379 0x095, 0x000, 380 0x056, 0x0c7, 381 0x096, 0x0c7, 382 0x057, 0x002, 383 0x097, 0x002, 384 0x0ff, 0x0ff, 385 0x060, 0x001, 386 0x0a0, 0x001, 387 0x061, 0x000, 388 0x0a1, 0x000, 389 0x062, 0x000, 390 0x0a2, 0x000, 391 0x063, 0x000, 392 0x0a3, 0x000, 393 0x070, 0x000, 394 0x0b0, 0x000, 395 0x071, 0x004, 396 0x0b1, 0x004, 397 0x06c, 0x0e9, 398 0x0ac, 0x0e9, 399 0x06d, 0x003, 400 0x0ad, 0x003, 401 0x05c, 0x0d0, 402 0x09c, 0x0d0, 403 0x05d, 0x002, 404 0x09d, 0x002, 405 0x05e, 0x0f2, 406 0x09e, 0x0f2, 407 0x05f, 0x000, 408 0x09f, 0x000, 409 0x074, 0x000, 410 0x0b4, 0x000, 411 0x075, 0x000, 412 0x0b5, 0x000, 413 0x076, 0x000, 414 0x0b6, 0x000, 415 0x077, 0x000, 416 0x0b7, 0x000, 417 0x195, 0x008, 418 0x0ff, 0x0ff, 419 0x108, 0x0f8, 420 0x111, 0x000, 421 0x10e, 0x00a, 422 0x2a9, 0x0fd, 423 0x464, 0x001, 424 0x454, 0x042135, 425 0x598, 0x0e7, 426 0x599, 0x07d, 427 0x59a, 0x018, 428 0x59c, 0x066, 429 0x59d, 0x090, 430 0x59e, 0x001, 431 0x584, 0x000, 432 0x585, 0x000, 433 0x586, 0x003, 434 0x588, 0x0ff, 435 0x589, 0x00f, 436 0x58a, 0x000, 437 0x58b, 0x000, 438 0x58c, 0x010, 439 0x58d, 0x032, 440 0x58e, 0x054, 441 0x58f, 0x023, 442 0x590, 0x000, 443 0x595, 0x000, 444 0x596, 0x000, 445 0x597, 0x000, 446 0x464, 0x000, 447 0x46c, 0xbbbb10, 448 0x470, 0x101010, 449 450 451 0x478, 0x000, 452 0x474, 0x018, 453 0x454, 0x042135, 454 0x598, 0x0e7, 455 0x599, 0x07d, 456 0x59a, 0x018, 457 0x59c, 0x066, 458 0x59d, 0x090, 459 0x59e, 0x001, 460 0x584, 0x000, 461 0x585, 0x000, 462 0x586, 0x003, 463 0x588, 0x0ff, 464 0x589, 0x00f, 465 0x58a, 0x000, 466 0x58b, 0x000, 467 0x58c, 0x010, 468 0x58d, 0x032, 469 0x58e, 0x054, 470 0x58f, 0x023, 471 0x590, 0x000, 472 0x595, 0x000, 473 0x596, 0x000, 474 0x597, 0x000, 475 0x464, 0x000, 476 0x46c, 0xbbbb10, 477 0x470, 0x101010, 478 479 0x478, 0x000, 480 0x474, 0x018, 481 0x454, 0x042135, 482 0x598, 0x0e7, 483 0x599, 0x07d, 484 0x59a, 0x018, 485 0x59c, 0x066, 486 0x59d, 0x090, 487 0x59e, 0x001, 488 0x584, 0x000, 489 0x585, 0x000, 490 0x586, 0x003, 491 0x588, 0x0ff, 492 0x589, 0x00f, 493 0x58a, 0x000, 494 0x58b, 0x000, 495 0x58c, 0x010, 496 0x58d, 0x032, 497 0x58e, 0x054, 498 0x58f, 0x023, 499 0x590, 0x000, 500 0x595, 0x000, 501 0x596, 0x000, 502 0x597, 0x000, 503 0x464, 0x000, 504 0x46c, 0xbbbb10, 505 0x470, 0x101010, 506 0x478, 0x000, 507 0x474, 0x018, 508 0x454, 0x042135, 509 0x193, 0x000, 510 0x300, 0x000, 511 0x301, 0x006, 512 0x302, 0x000, 513 0x303, 0x006, 514 0x308, 0x040, 515 0x309, 0x000, 516 0x30a, 0x000, 517 0x30b, 0x000, 518 0x000, 0x002, 519 0x001, 0x000, 520 0x002, 0x000, 521 0x003, 0x000, 522 0x004, 0x033, 523 0x040, 0x01d, 524 0x041, 0x001, 525 0x042, 0x004, 526 0x043, 0x000, 527 0x080, 0x01e, 528 0x081, 0x001, 529 0x082, 0x004, 530 0x083, 0x000, 531 0x190, 0x018, 532 0x115, 0x000, 533 0x116, 0x012, 534 0x117, 0x018, 535 0x04a, 0x011, 536 0x08a, 0x011, 537 0x04b, 0x000, 538 0x08b, 0x000, 539 0x048, 0x000, 540 0x088, 0x000, 541 0x04e, 0x012, 542 0x08e, 0x012, 543 0x058, 0x012, 544 0x098, 0x012, 545 0x059, 0x000, 546 0x099, 0x000, 547 0x05a, 0x003, 548 0x09a, 0x003, 549 0x05b, 0x001, 550 0x09b, 0x001, 551 0x054, 0x008, 552 0x094, 0x008, 553 0x055, 0x000, 554 0x095, 0x000, 555 0x056, 0x0c7, 556 0x096, 0x0c7, 557 0x057, 0x002, 558 0x097, 0x002, 559 0x060, 0x001, 560 0x0a0, 0x001, 561 0x061, 0x000, 562 0x0a1, 0x000, 563 0x062, 0x000, 564 0x0a2, 0x000, 565 0x063, 0x000, 566 0x0a3, 0x000, 567 0x070, 0x000, 568 0x0b0, 0x000, 569 0x071, 0x004, 570 0x0b1, 0x004, 571 0x06c, 0x0e9, 572 0x0ac, 0x0e9, 573 0x06d, 0x003, 574 0x0ad, 0x003, 575 0x05c, 0x0d0, 576 0x09c, 0x0d0, 577 0x05d, 0x002, 578 0x09d, 0x002, 579 0x05e, 0x0f2, 580 0x09e, 0x0f2, 581 0x05f, 0x000, 582 0x09f, 0x000, 583 0x074, 0x000, 584 0x0b4, 0x000, 585 0x075, 0x000, 586 0x0b5, 0x000, 587 0x076, 0x000, 588 0x0b6, 0x000, 589 0x077, 0x000, 590 0x0b7, 0x000, 591 0x195, 0x008, 592 0x598, 0x0e7, 593 0x599, 0x07d, 594 0x59a, 0x018, 595 0x59c, 0x066, 596 0x59d, 0x090, 597 0x59e, 0x001, 598 0x584, 0x000, 599 0x585, 0x000, 600 0x586, 0x003, 601 0x588, 0x0ff, 602 0x589, 0x00f, 603 0x58a, 0x000, 604 0x58b, 0x000, 605 0x58c, 0x010, 606 0x58d, 0x032, 607 0x58e, 0x054, 608 0x58f, 0x023, 609 0x590, 0x000, 610 0x595, 0x000, 611 0x596, 0x000, 612 0x597, 0x000, 613 0x464, 0x000, 614 0x46c, 0xbbbb10, 615 0x470, 0x101010, 616 0x478, 0x000, 617 0x474, 0x018, 618 0x454, 0x042135, 619 0x193, 0x0a6, 620 0x108, 0x0f8, 621 0x042, 0x003, 622 0x082, 0x003, 623 0x454, 0x0425b9, 624 0x454, 0x042539, 625 0x193, 0x000, 626 0x193, 0x0a6, 627 0x464, 0x000, 628 629 0, 0 630 }; 631 632 /* Tuner */ 633 static u32 reg_init_tuner_input[] = { 634 0x108, 0x0f8, /* Sync control */ 635 0x111, 0x000, /* Mode/delay control */ 636 0x10e, 0x00a, /* Chroma control 1 */ 637 0, 0 638 }; 639 640 /* Composite */ 641 static u32 reg_init_composite_input[] = { 642 0x108, 0x0e8, /* Sync control */ 643 0x111, 0x000, /* Mode/delay control */ 644 0x10e, 0x04a, /* Chroma control 1 */ 645 0, 0 646 }; 647 648 /* S-Video */ 649 static u32 reg_init_svideo_input[] = { 650 0x108, 0x0e8, /* Sync control */ 651 0x111, 0x000, /* Mode/delay control */ 652 0x10e, 0x04a, /* Chroma control 1 */ 653 0, 0 654 }; 655 656 static u32 reg_set_audio_template[4][2] = 657 { 658 { /* for MONO 659 tadachi 6/29 DMA audio output select? 660 Register 0x46c 661 7-4: DMA2, 3-0: DMA1 ch. DMA4, DMA3 DMA2, DMA1 662 0: MAIN left, 1: MAIN right 663 2: AUX1 left, 3: AUX1 right 664 4: AUX2 left, 5: AUX2 right 665 6: DPL left, 7: DPL right 666 8: DPL center, 9: DPL surround 667 A: monitor output, B: digital sense */ 668 0xbbbb00, 669 670 /* tadachi 6/29 DAC and I2S output select? 671 Register 0x470 672 7-4:DAC right ch. 3-0:DAC left ch. 673 I2S1 right,left I2S2 right,left */ 674 0x00, 675 }, 676 { /* for STEREO */ 677 0xbbbb10, 0x101010, 678 }, 679 { /* for LANG1 */ 680 0xbbbb00, 0x00, 681 }, 682 { /* for LANG2/SAP */ 683 0xbbbb11, 0x111111, 684 } 685 }; 686 687 688 /* Get detected audio flags (from saa7134 driver) */ 689 static void get_inf_dev_status(struct v4l2_subdev *sd, 690 int *dual_flag, int *stereo_flag) 691 { 692 u32 reg_data3; 693 694 static char *stdres[0x20] = { 695 [0x00] = "no standard detected", 696 [0x01] = "B/G (in progress)", 697 [0x02] = "D/K (in progress)", 698 [0x03] = "M (in progress)", 699 700 [0x04] = "B/G A2", 701 [0x05] = "B/G NICAM", 702 [0x06] = "D/K A2 (1)", 703 [0x07] = "D/K A2 (2)", 704 [0x08] = "D/K A2 (3)", 705 [0x09] = "D/K NICAM", 706 [0x0a] = "L NICAM", 707 [0x0b] = "I NICAM", 708 709 [0x0c] = "M Korea", 710 [0x0d] = "M BTSC ", 711 [0x0e] = "M EIAJ", 712 713 [0x0f] = "FM radio / IF 10.7 / 50 deemp", 714 [0x10] = "FM radio / IF 10.7 / 75 deemp", 715 [0x11] = "FM radio / IF sel / 50 deemp", 716 [0x12] = "FM radio / IF sel / 75 deemp", 717 718 [0x13 ... 0x1e] = "unknown", 719 [0x1f] = "??? [in progress]", 720 }; 721 722 723 *dual_flag = *stereo_flag = 0; 724 725 /* (demdec status: 0x528) */ 726 727 /* read current status */ 728 reg_data3 = saa717x_read(sd, 0x0528); 729 730 v4l2_dbg(1, debug, sd, "tvaudio thread status: 0x%x [%s%s%s]\n", 731 reg_data3, stdres[reg_data3 & 0x1f], 732 (reg_data3 & 0x000020) ? ",stereo" : "", 733 (reg_data3 & 0x000040) ? ",dual" : ""); 734 v4l2_dbg(1, debug, sd, "detailed status: " 735 "%s#%s#%s#%s#%s#%s#%s#%s#%s#%s#%s#%s#%s#%s\n", 736 (reg_data3 & 0x000080) ? " A2/EIAJ pilot tone " : "", 737 (reg_data3 & 0x000100) ? " A2/EIAJ dual " : "", 738 (reg_data3 & 0x000200) ? " A2/EIAJ stereo " : "", 739 (reg_data3 & 0x000400) ? " A2/EIAJ noise mute " : "", 740 741 (reg_data3 & 0x000800) ? " BTSC/FM radio pilot " : "", 742 (reg_data3 & 0x001000) ? " SAP carrier " : "", 743 (reg_data3 & 0x002000) ? " BTSC stereo noise mute " : "", 744 (reg_data3 & 0x004000) ? " SAP noise mute " : "", 745 (reg_data3 & 0x008000) ? " VDSP " : "", 746 747 (reg_data3 & 0x010000) ? " NICST " : "", 748 (reg_data3 & 0x020000) ? " NICDU " : "", 749 (reg_data3 & 0x040000) ? " NICAM muted " : "", 750 (reg_data3 & 0x080000) ? " NICAM reserve sound " : "", 751 752 (reg_data3 & 0x100000) ? " init done " : ""); 753 754 if (reg_data3 & 0x000220) { 755 v4l2_dbg(1, debug, sd, "ST!!!\n"); 756 *stereo_flag = 1; 757 } 758 759 if (reg_data3 & 0x000140) { 760 v4l2_dbg(1, debug, sd, "DUAL!!!\n"); 761 *dual_flag = 1; 762 } 763 } 764 765 /* regs write to set audio mode */ 766 static void set_audio_mode(struct v4l2_subdev *sd, int audio_mode) 767 { 768 v4l2_dbg(1, debug, sd, "writing registers to set audio mode by set %d\n", 769 audio_mode); 770 771 saa717x_write(sd, 0x46c, reg_set_audio_template[audio_mode][0]); 772 saa717x_write(sd, 0x470, reg_set_audio_template[audio_mode][1]); 773 } 774 775 /* write regs to set audio volume, bass and treble */ 776 static int set_audio_regs(struct v4l2_subdev *sd, 777 struct saa717x_state *decoder) 778 { 779 u8 mute = 0xac; /* -84 dB */ 780 u32 val; 781 unsigned int work_l, work_r; 782 783 /* set SIF analog I/O select */ 784 saa717x_write(sd, 0x0594, decoder->audio_input); 785 v4l2_dbg(1, debug, sd, "set audio input %d\n", 786 decoder->audio_input); 787 788 /* normalize ( 65535 to 0 -> 24 to -40 (not -84)) */ 789 work_l = (min(65536 - decoder->audio_main_balance, 32768) * decoder->audio_main_volume) / 32768; 790 work_r = (min(decoder->audio_main_balance, (u16)32768) * decoder->audio_main_volume) / 32768; 791 decoder->audio_main_vol_l = (long)work_l * (24 - (-40)) / 65535 - 40; 792 decoder->audio_main_vol_r = (long)work_r * (24 - (-40)) / 65535 - 40; 793 794 /* set main volume */ 795 /* main volume L[7-0],R[7-0],0x00 24=24dB,-83dB, -84(mute) */ 796 /* def:0dB->6dB(MPG600GR) */ 797 /* if mute is on, set mute */ 798 if (decoder->audio_main_mute) { 799 val = mute | (mute << 8); 800 } else { 801 val = (u8)decoder->audio_main_vol_l | 802 ((u8)decoder->audio_main_vol_r << 8); 803 } 804 805 saa717x_write(sd, 0x480, val); 806 807 /* set bass and treble */ 808 val = decoder->audio_main_bass & 0x1f; 809 val |= (decoder->audio_main_treble & 0x1f) << 5; 810 saa717x_write(sd, 0x488, val); 811 return 0; 812 } 813 814 /********** scaling staff ***********/ 815 static void set_h_prescale(struct v4l2_subdev *sd, 816 int task, int prescale) 817 { 818 static const struct { 819 int xpsc; 820 int xacl; 821 int xc2_1; 822 int xdcg; 823 int vpfy; 824 } vals[] = { 825 /* XPSC XACL XC2_1 XDCG VPFY */ 826 { 1, 0, 0, 0, 0 }, 827 { 2, 2, 1, 2, 2 }, 828 { 3, 4, 1, 3, 2 }, 829 { 4, 8, 1, 4, 2 }, 830 { 5, 8, 1, 4, 2 }, 831 { 6, 8, 1, 4, 3 }, 832 { 7, 8, 1, 4, 3 }, 833 { 8, 15, 0, 4, 3 }, 834 { 9, 15, 0, 4, 3 }, 835 { 10, 16, 1, 5, 3 }, 836 }; 837 static const int count = ARRAY_SIZE(vals); 838 int i, task_shift; 839 840 task_shift = task * 0x40; 841 for (i = 0; i < count; i++) 842 if (vals[i].xpsc == prescale) 843 break; 844 if (i == count) 845 return; 846 847 /* horizonal prescaling */ 848 saa717x_write(sd, 0x60 + task_shift, vals[i].xpsc); 849 /* accumulation length */ 850 saa717x_write(sd, 0x61 + task_shift, vals[i].xacl); 851 /* level control */ 852 saa717x_write(sd, 0x62 + task_shift, 853 (vals[i].xc2_1 << 3) | vals[i].xdcg); 854 /*FIR prefilter control */ 855 saa717x_write(sd, 0x63 + task_shift, 856 (vals[i].vpfy << 2) | vals[i].vpfy); 857 } 858 859 /********** scaling staff ***********/ 860 static void set_v_scale(struct v4l2_subdev *sd, int task, int yscale) 861 { 862 int task_shift; 863 864 task_shift = task * 0x40; 865 /* Vertical scaling ratio (LOW) */ 866 saa717x_write(sd, 0x70 + task_shift, yscale & 0xff); 867 /* Vertical scaling ratio (HI) */ 868 saa717x_write(sd, 0x71 + task_shift, yscale >> 8); 869 } 870 871 static int saa717x_s_ctrl(struct v4l2_ctrl *ctrl) 872 { 873 struct v4l2_subdev *sd = to_sd(ctrl); 874 struct saa717x_state *state = to_state(sd); 875 876 switch (ctrl->id) { 877 case V4L2_CID_BRIGHTNESS: 878 saa717x_write(sd, 0x10a, ctrl->val); 879 return 0; 880 881 case V4L2_CID_CONTRAST: 882 saa717x_write(sd, 0x10b, ctrl->val); 883 return 0; 884 885 case V4L2_CID_SATURATION: 886 saa717x_write(sd, 0x10c, ctrl->val); 887 return 0; 888 889 case V4L2_CID_HUE: 890 saa717x_write(sd, 0x10d, ctrl->val); 891 return 0; 892 893 case V4L2_CID_AUDIO_MUTE: 894 state->audio_main_mute = ctrl->val; 895 break; 896 897 case V4L2_CID_AUDIO_VOLUME: 898 state->audio_main_volume = ctrl->val; 899 break; 900 901 case V4L2_CID_AUDIO_BALANCE: 902 state->audio_main_balance = ctrl->val; 903 break; 904 905 case V4L2_CID_AUDIO_TREBLE: 906 state->audio_main_treble = ctrl->val; 907 break; 908 909 case V4L2_CID_AUDIO_BASS: 910 state->audio_main_bass = ctrl->val; 911 break; 912 913 default: 914 return 0; 915 } 916 set_audio_regs(sd, state); 917 return 0; 918 } 919 920 static int saa717x_s_video_routing(struct v4l2_subdev *sd, 921 u32 input, u32 output, u32 config) 922 { 923 struct saa717x_state *decoder = to_state(sd); 924 int is_tuner = input & 0x80; /* tuner input flag */ 925 926 input &= 0x7f; 927 928 v4l2_dbg(1, debug, sd, "decoder set input (%d)\n", input); 929 /* inputs from 0-9 are available*/ 930 /* saa717x have mode0-mode9 but mode5 is reserved. */ 931 if (input > 9 || input == 5) 932 return -EINVAL; 933 934 if (decoder->input != input) { 935 int input_line = input; 936 937 decoder->input = input_line; 938 v4l2_dbg(1, debug, sd, "now setting %s input %d\n", 939 input_line >= 6 ? "S-Video" : "Composite", 940 input_line); 941 942 /* select mode */ 943 saa717x_write(sd, 0x102, 944 (saa717x_read(sd, 0x102) & 0xf0) | 945 input_line); 946 947 /* bypass chrominance trap for modes 6..9 */ 948 saa717x_write(sd, 0x109, 949 (saa717x_read(sd, 0x109) & 0x7f) | 950 (input_line < 6 ? 0x0 : 0x80)); 951 952 /* change audio_mode */ 953 if (is_tuner) { 954 /* tuner */ 955 set_audio_mode(sd, decoder->tuner_audio_mode); 956 } else { 957 /* Force to STEREO mode if Composite or 958 * S-Video were chosen */ 959 set_audio_mode(sd, TUNER_AUDIO_STEREO); 960 } 961 /* change initialize procedure (Composite/S-Video) */ 962 if (is_tuner) 963 saa717x_write_regs(sd, reg_init_tuner_input); 964 else if (input_line >= 6) 965 saa717x_write_regs(sd, reg_init_svideo_input); 966 else 967 saa717x_write_regs(sd, reg_init_composite_input); 968 } 969 970 return 0; 971 } 972 973 #ifdef CONFIG_VIDEO_ADV_DEBUG 974 static int saa717x_g_register(struct v4l2_subdev *sd, struct v4l2_dbg_register *reg) 975 { 976 reg->val = saa717x_read(sd, reg->reg); 977 reg->size = 1; 978 return 0; 979 } 980 981 static int saa717x_s_register(struct v4l2_subdev *sd, const struct v4l2_dbg_register *reg) 982 { 983 u16 addr = reg->reg & 0xffff; 984 u8 val = reg->val & 0xff; 985 986 saa717x_write(sd, addr, val); 987 return 0; 988 } 989 #endif 990 991 static int saa717x_set_fmt(struct v4l2_subdev *sd, 992 struct v4l2_subdev_pad_config *cfg, 993 struct v4l2_subdev_format *format) 994 { 995 struct v4l2_mbus_framefmt *fmt = &format->format; 996 int prescale, h_scale, v_scale; 997 998 v4l2_dbg(1, debug, sd, "decoder set size\n"); 999 1000 if (format->pad || fmt->code != MEDIA_BUS_FMT_FIXED) 1001 return -EINVAL; 1002 1003 /* FIXME need better bounds checking here */ 1004 if (fmt->width < 1 || fmt->width > 1440) 1005 return -EINVAL; 1006 if (fmt->height < 1 || fmt->height > 960) 1007 return -EINVAL; 1008 1009 fmt->field = V4L2_FIELD_INTERLACED; 1010 fmt->colorspace = V4L2_COLORSPACE_SMPTE170M; 1011 1012 if (format->which == V4L2_SUBDEV_FORMAT_TRY) 1013 return 0; 1014 1015 /* scaling setting */ 1016 /* NTSC and interlace only */ 1017 prescale = SAA717X_NTSC_WIDTH / fmt->width; 1018 if (prescale == 0) 1019 prescale = 1; 1020 h_scale = 1024 * SAA717X_NTSC_WIDTH / prescale / fmt->width; 1021 /* interlace */ 1022 v_scale = 512 * 2 * SAA717X_NTSC_HEIGHT / fmt->height; 1023 1024 /* Horizontal prescaling etc */ 1025 set_h_prescale(sd, 0, prescale); 1026 set_h_prescale(sd, 1, prescale); 1027 1028 /* Horizontal scaling increment */ 1029 /* TASK A */ 1030 saa717x_write(sd, 0x6C, (u8)(h_scale & 0xFF)); 1031 saa717x_write(sd, 0x6D, (u8)((h_scale >> 8) & 0xFF)); 1032 /* TASK B */ 1033 saa717x_write(sd, 0xAC, (u8)(h_scale & 0xFF)); 1034 saa717x_write(sd, 0xAD, (u8)((h_scale >> 8) & 0xFF)); 1035 1036 /* Vertical prescaling etc */ 1037 set_v_scale(sd, 0, v_scale); 1038 set_v_scale(sd, 1, v_scale); 1039 1040 /* set video output size */ 1041 /* video number of pixels at output */ 1042 /* TASK A */ 1043 saa717x_write(sd, 0x5C, (u8)(fmt->width & 0xFF)); 1044 saa717x_write(sd, 0x5D, (u8)((fmt->width >> 8) & 0xFF)); 1045 /* TASK B */ 1046 saa717x_write(sd, 0x9C, (u8)(fmt->width & 0xFF)); 1047 saa717x_write(sd, 0x9D, (u8)((fmt->width >> 8) & 0xFF)); 1048 1049 /* video number of lines at output */ 1050 /* TASK A */ 1051 saa717x_write(sd, 0x5E, (u8)(fmt->height & 0xFF)); 1052 saa717x_write(sd, 0x5F, (u8)((fmt->height >> 8) & 0xFF)); 1053 /* TASK B */ 1054 saa717x_write(sd, 0x9E, (u8)(fmt->height & 0xFF)); 1055 saa717x_write(sd, 0x9F, (u8)((fmt->height >> 8) & 0xFF)); 1056 return 0; 1057 } 1058 1059 static int saa717x_s_radio(struct v4l2_subdev *sd) 1060 { 1061 struct saa717x_state *decoder = to_state(sd); 1062 1063 decoder->radio = 1; 1064 return 0; 1065 } 1066 1067 static int saa717x_s_std(struct v4l2_subdev *sd, v4l2_std_id std) 1068 { 1069 struct saa717x_state *decoder = to_state(sd); 1070 1071 v4l2_dbg(1, debug, sd, "decoder set norm "); 1072 v4l2_dbg(1, debug, sd, "(not yet implemented)\n"); 1073 1074 decoder->radio = 0; 1075 decoder->std = std; 1076 return 0; 1077 } 1078 1079 static int saa717x_s_audio_routing(struct v4l2_subdev *sd, 1080 u32 input, u32 output, u32 config) 1081 { 1082 struct saa717x_state *decoder = to_state(sd); 1083 1084 if (input < 3) { /* FIXME! --tadachi */ 1085 decoder->audio_input = input; 1086 v4l2_dbg(1, debug, sd, 1087 "set decoder audio input to %d\n", 1088 decoder->audio_input); 1089 set_audio_regs(sd, decoder); 1090 return 0; 1091 } 1092 return -ERANGE; 1093 } 1094 1095 static int saa717x_s_stream(struct v4l2_subdev *sd, int enable) 1096 { 1097 struct saa717x_state *decoder = to_state(sd); 1098 1099 v4l2_dbg(1, debug, sd, "decoder %s output\n", 1100 enable ? "enable" : "disable"); 1101 decoder->enable = enable; 1102 saa717x_write(sd, 0x193, enable ? 0xa6 : 0x26); 1103 return 0; 1104 } 1105 1106 /* change audio mode */ 1107 static int saa717x_s_tuner(struct v4l2_subdev *sd, const struct v4l2_tuner *vt) 1108 { 1109 struct saa717x_state *decoder = to_state(sd); 1110 int audio_mode; 1111 char *mes[4] = { 1112 "MONO", "STEREO", "LANG1", "LANG2/SAP" 1113 }; 1114 1115 audio_mode = TUNER_AUDIO_STEREO; 1116 1117 switch (vt->audmode) { 1118 case V4L2_TUNER_MODE_MONO: 1119 audio_mode = TUNER_AUDIO_MONO; 1120 break; 1121 case V4L2_TUNER_MODE_STEREO: 1122 audio_mode = TUNER_AUDIO_STEREO; 1123 break; 1124 case V4L2_TUNER_MODE_LANG2: 1125 audio_mode = TUNER_AUDIO_LANG2; 1126 break; 1127 case V4L2_TUNER_MODE_LANG1: 1128 audio_mode = TUNER_AUDIO_LANG1; 1129 break; 1130 } 1131 1132 v4l2_dbg(1, debug, sd, "change audio mode to %s\n", 1133 mes[audio_mode]); 1134 decoder->tuner_audio_mode = audio_mode; 1135 /* The registers are not changed here. */ 1136 /* See DECODER_ENABLE_OUTPUT section. */ 1137 set_audio_mode(sd, decoder->tuner_audio_mode); 1138 return 0; 1139 } 1140 1141 static int saa717x_g_tuner(struct v4l2_subdev *sd, struct v4l2_tuner *vt) 1142 { 1143 struct saa717x_state *decoder = to_state(sd); 1144 int dual_f, stereo_f; 1145 1146 if (decoder->radio) 1147 return 0; 1148 get_inf_dev_status(sd, &dual_f, &stereo_f); 1149 1150 v4l2_dbg(1, debug, sd, "DETECT==st:%d dual:%d\n", 1151 stereo_f, dual_f); 1152 1153 /* mono */ 1154 if ((dual_f == 0) && (stereo_f == 0)) { 1155 vt->rxsubchans = V4L2_TUNER_SUB_MONO; 1156 v4l2_dbg(1, debug, sd, "DETECT==MONO\n"); 1157 } 1158 1159 /* stereo */ 1160 if (stereo_f == 1) { 1161 if (vt->audmode == V4L2_TUNER_MODE_STEREO || 1162 vt->audmode == V4L2_TUNER_MODE_LANG1) { 1163 vt->rxsubchans = V4L2_TUNER_SUB_STEREO; 1164 v4l2_dbg(1, debug, sd, "DETECT==ST(ST)\n"); 1165 } else { 1166 vt->rxsubchans = V4L2_TUNER_SUB_MONO; 1167 v4l2_dbg(1, debug, sd, "DETECT==ST(MONO)\n"); 1168 } 1169 } 1170 1171 /* dual */ 1172 if (dual_f == 1) { 1173 if (vt->audmode == V4L2_TUNER_MODE_LANG2) { 1174 vt->rxsubchans = V4L2_TUNER_SUB_LANG2 | V4L2_TUNER_SUB_MONO; 1175 v4l2_dbg(1, debug, sd, "DETECT==DUAL1\n"); 1176 } else { 1177 vt->rxsubchans = V4L2_TUNER_SUB_LANG1 | V4L2_TUNER_SUB_MONO; 1178 v4l2_dbg(1, debug, sd, "DETECT==DUAL2\n"); 1179 } 1180 } 1181 return 0; 1182 } 1183 1184 static int saa717x_log_status(struct v4l2_subdev *sd) 1185 { 1186 struct saa717x_state *state = to_state(sd); 1187 1188 v4l2_ctrl_handler_log_status(&state->hdl, sd->name); 1189 return 0; 1190 } 1191 1192 /* ----------------------------------------------------------------------- */ 1193 1194 static const struct v4l2_ctrl_ops saa717x_ctrl_ops = { 1195 .s_ctrl = saa717x_s_ctrl, 1196 }; 1197 1198 static const struct v4l2_subdev_core_ops saa717x_core_ops = { 1199 #ifdef CONFIG_VIDEO_ADV_DEBUG 1200 .g_register = saa717x_g_register, 1201 .s_register = saa717x_s_register, 1202 #endif 1203 .log_status = saa717x_log_status, 1204 }; 1205 1206 static const struct v4l2_subdev_tuner_ops saa717x_tuner_ops = { 1207 .g_tuner = saa717x_g_tuner, 1208 .s_tuner = saa717x_s_tuner, 1209 .s_radio = saa717x_s_radio, 1210 }; 1211 1212 static const struct v4l2_subdev_video_ops saa717x_video_ops = { 1213 .s_std = saa717x_s_std, 1214 .s_routing = saa717x_s_video_routing, 1215 .s_stream = saa717x_s_stream, 1216 }; 1217 1218 static const struct v4l2_subdev_audio_ops saa717x_audio_ops = { 1219 .s_routing = saa717x_s_audio_routing, 1220 }; 1221 1222 static const struct v4l2_subdev_pad_ops saa717x_pad_ops = { 1223 .set_fmt = saa717x_set_fmt, 1224 }; 1225 1226 static const struct v4l2_subdev_ops saa717x_ops = { 1227 .core = &saa717x_core_ops, 1228 .tuner = &saa717x_tuner_ops, 1229 .audio = &saa717x_audio_ops, 1230 .video = &saa717x_video_ops, 1231 .pad = &saa717x_pad_ops, 1232 }; 1233 1234 /* ----------------------------------------------------------------------- */ 1235 1236 1237 /* i2c implementation */ 1238 1239 /* ----------------------------------------------------------------------- */ 1240 static int saa717x_probe(struct i2c_client *client, 1241 const struct i2c_device_id *did) 1242 { 1243 struct saa717x_state *decoder; 1244 struct v4l2_ctrl_handler *hdl; 1245 struct v4l2_subdev *sd; 1246 u8 id = 0; 1247 char *p = ""; 1248 1249 /* Check if the adapter supports the needed features */ 1250 if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA)) 1251 return -EIO; 1252 1253 decoder = devm_kzalloc(&client->dev, sizeof(*decoder), GFP_KERNEL); 1254 if (decoder == NULL) 1255 return -ENOMEM; 1256 1257 sd = &decoder->sd; 1258 v4l2_i2c_subdev_init(sd, client, &saa717x_ops); 1259 1260 if (saa717x_write(sd, 0x5a4, 0xfe) && 1261 saa717x_write(sd, 0x5a5, 0x0f) && 1262 saa717x_write(sd, 0x5a6, 0x00) && 1263 saa717x_write(sd, 0x5a7, 0x01)) 1264 id = saa717x_read(sd, 0x5a0); 1265 if (id != 0xc2 && id != 0x32 && id != 0xf2 && id != 0x6c) { 1266 v4l2_dbg(1, debug, sd, "saa717x not found (id=%02x)\n", id); 1267 return -ENODEV; 1268 } 1269 if (id == 0xc2) 1270 p = "saa7173"; 1271 else if (id == 0x32) 1272 p = "saa7174A"; 1273 else if (id == 0x6c) 1274 p = "saa7174HL"; 1275 else 1276 p = "saa7171"; 1277 v4l2_info(sd, "%s found @ 0x%x (%s)\n", p, 1278 client->addr << 1, client->adapter->name); 1279 1280 hdl = &decoder->hdl; 1281 v4l2_ctrl_handler_init(hdl, 9); 1282 /* add in ascending ID order */ 1283 v4l2_ctrl_new_std(hdl, &saa717x_ctrl_ops, 1284 V4L2_CID_BRIGHTNESS, 0, 255, 1, 128); 1285 v4l2_ctrl_new_std(hdl, &saa717x_ctrl_ops, 1286 V4L2_CID_CONTRAST, 0, 255, 1, 68); 1287 v4l2_ctrl_new_std(hdl, &saa717x_ctrl_ops, 1288 V4L2_CID_SATURATION, 0, 255, 1, 64); 1289 v4l2_ctrl_new_std(hdl, &saa717x_ctrl_ops, 1290 V4L2_CID_HUE, -128, 127, 1, 0); 1291 v4l2_ctrl_new_std(hdl, &saa717x_ctrl_ops, 1292 V4L2_CID_AUDIO_VOLUME, 0, 65535, 65535 / 100, 42000); 1293 v4l2_ctrl_new_std(hdl, &saa717x_ctrl_ops, 1294 V4L2_CID_AUDIO_BALANCE, 0, 65535, 65535 / 100, 32768); 1295 v4l2_ctrl_new_std(hdl, &saa717x_ctrl_ops, 1296 V4L2_CID_AUDIO_BASS, -16, 15, 1, 0); 1297 v4l2_ctrl_new_std(hdl, &saa717x_ctrl_ops, 1298 V4L2_CID_AUDIO_TREBLE, -16, 15, 1, 0); 1299 v4l2_ctrl_new_std(hdl, &saa717x_ctrl_ops, 1300 V4L2_CID_AUDIO_MUTE, 0, 1, 1, 0); 1301 sd->ctrl_handler = hdl; 1302 if (hdl->error) { 1303 int err = hdl->error; 1304 1305 v4l2_ctrl_handler_free(hdl); 1306 return err; 1307 } 1308 1309 decoder->std = V4L2_STD_NTSC; 1310 decoder->input = -1; 1311 decoder->enable = 1; 1312 1313 /* FIXME!! */ 1314 decoder->playback = 0; /* initially capture mode used */ 1315 decoder->audio = 1; /* DECODER_AUDIO_48_KHZ */ 1316 1317 decoder->audio_input = 2; /* FIXME!! */ 1318 1319 decoder->tuner_audio_mode = TUNER_AUDIO_STEREO; 1320 /* set volume, bass and treble */ 1321 decoder->audio_main_vol_l = 6; 1322 decoder->audio_main_vol_r = 6; 1323 1324 v4l2_dbg(1, debug, sd, "writing init values\n"); 1325 1326 /* FIXME!! */ 1327 saa717x_write_regs(sd, reg_init_initialize); 1328 1329 v4l2_ctrl_handler_setup(hdl); 1330 1331 set_current_state(TASK_INTERRUPTIBLE); 1332 schedule_timeout(2*HZ); 1333 return 0; 1334 } 1335 1336 static int saa717x_remove(struct i2c_client *client) 1337 { 1338 struct v4l2_subdev *sd = i2c_get_clientdata(client); 1339 1340 v4l2_device_unregister_subdev(sd); 1341 v4l2_ctrl_handler_free(sd->ctrl_handler); 1342 return 0; 1343 } 1344 1345 /* ----------------------------------------------------------------------- */ 1346 1347 static const struct i2c_device_id saa717x_id[] = { 1348 { "saa717x", 0 }, 1349 { } 1350 }; 1351 MODULE_DEVICE_TABLE(i2c, saa717x_id); 1352 1353 static struct i2c_driver saa717x_driver = { 1354 .driver = { 1355 .name = "saa717x", 1356 }, 1357 .probe = saa717x_probe, 1358 .remove = saa717x_remove, 1359 .id_table = saa717x_id, 1360 }; 1361 1362 module_i2c_driver(saa717x_driver); 1363