| /* |
| * saa717x - Philips SAA717xHL video decoder driver |
| * |
| * Based on the saa7115 driver |
| * |
| * Changes by Ohta Kyuma <alpha292@bremen.or.jp> |
| * - Apply to SAA717x,NEC uPD64031,uPD64083. (1/31/2004) |
| * |
| * Changes by T.Adachi (tadachi@tadachi-net.com) |
| * - support audio, video scaler etc, and checked the initialize sequence. |
| * |
| * Cleaned up by Hans Verkuil <hverkuil@xs4all.nl> |
| * |
| * Note: this is a reversed engineered driver based on captures from |
| * the I2C bus under Windows. This chip is very similar to the saa7134, |
| * though. Unfortunately, this driver is currently only working for NTSC. |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License as published by |
| * the Free Software Foundation; either version 2 of the License, or |
| * (at your option) any later version. |
| * |
| * This program is distributed in the hope that it will be useful, |
| * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| * GNU General Public License for more details. |
| * |
| * You should have received a copy of the GNU General Public License |
| * along with this program; if not, write to the Free Software |
| * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. |
| */ |
| |
| #include <linux/module.h> |
| #include <linux/kernel.h> |
| #include <linux/slab.h> |
| #include <linux/sched.h> |
| |
| #include <linux/videodev2.h> |
| #include <linux/i2c.h> |
| #include <media/v4l2-device.h> |
| #include <media/v4l2-i2c-drv.h> |
| |
| MODULE_DESCRIPTION("Philips SAA717x audio/video decoder driver"); |
| MODULE_AUTHOR("K. Ohta, T. Adachi, Hans Verkuil"); |
| MODULE_LICENSE("GPL"); |
| |
| static int debug; |
| module_param(debug, int, 0644); |
| MODULE_PARM_DESC(debug, "Debug level (0-1)"); |
| |
| /* |
| * Generic i2c probe |
| * concerning the addresses: i2c wants 7 bit (without the r/w bit), so '>>1' |
| */ |
| |
| struct saa717x_state { |
| struct v4l2_subdev sd; |
| v4l2_std_id std; |
| int input; |
| int enable; |
| int radio; |
| int bright; |
| int contrast; |
| int hue; |
| int sat; |
| int playback; |
| int audio; |
| int tuner_audio_mode; |
| int audio_main_mute; |
| int audio_main_vol_r; |
| int audio_main_vol_l; |
| u16 audio_main_bass; |
| u16 audio_main_treble; |
| u16 audio_main_volume; |
| u16 audio_main_balance; |
| int audio_input; |
| }; |
| |
| static inline struct saa717x_state *to_state(struct v4l2_subdev *sd) |
| { |
| return container_of(sd, struct saa717x_state, sd); |
| } |
| |
| /* ----------------------------------------------------------------------- */ |
| |
| /* for audio mode */ |
| #define TUNER_AUDIO_MONO 0 /* LL */ |
| #define TUNER_AUDIO_STEREO 1 /* LR */ |
| #define TUNER_AUDIO_LANG1 2 /* LL */ |
| #define TUNER_AUDIO_LANG2 3 /* RR */ |
| |
| #define SAA717X_NTSC_WIDTH (704) |
| #define SAA717X_NTSC_HEIGHT (480) |
| |
| /* ----------------------------------------------------------------------- */ |
| |
| static int saa717x_write(struct v4l2_subdev *sd, u32 reg, u32 value) |
| { |
| struct i2c_client *client = v4l2_get_subdevdata(sd); |
| struct i2c_adapter *adap = client->adapter; |
| int fw_addr = reg == 0x454 || (reg >= 0x464 && reg <= 0x478) || reg == 0x480 || reg == 0x488; |
| unsigned char mm1[6]; |
| struct i2c_msg msg; |
| |
| msg.flags = 0; |
| msg.addr = client->addr; |
| mm1[0] = (reg >> 8) & 0xff; |
| mm1[1] = reg & 0xff; |
| |
| if (fw_addr) { |
| mm1[4] = (value >> 16) & 0xff; |
| mm1[3] = (value >> 8) & 0xff; |
| mm1[2] = value & 0xff; |
| } else { |
| mm1[2] = value & 0xff; |
| } |
| msg.len = fw_addr ? 5 : 3; /* Long Registers have *only* three bytes! */ |
| msg.buf = mm1; |
| v4l2_dbg(2, debug, sd, "wrote: reg 0x%03x=%08x\n", reg, value); |
| return i2c_transfer(adap, &msg, 1) == 1; |
| } |
| |
| static void saa717x_write_regs(struct v4l2_subdev *sd, u32 *data) |
| { |
| while (data[0] || data[1]) { |
| saa717x_write(sd, data[0], data[1]); |
| data += 2; |
| } |
| } |
| |
| static u32 saa717x_read(struct v4l2_subdev *sd, u32 reg) |
| { |
| struct i2c_client *client = v4l2_get_subdevdata(sd); |
| struct i2c_adapter *adap = client->adapter; |
| int fw_addr = (reg >= 0x404 && reg <= 0x4b8) || reg == 0x528; |
| unsigned char mm1[2]; |
| unsigned char mm2[4] = { 0, 0, 0, 0 }; |
| struct i2c_msg msgs[2]; |
| u32 value; |
| |
| msgs[0].flags = 0; |
| msgs[1].flags = I2C_M_RD; |
| msgs[0].addr = msgs[1].addr = client->addr; |
| mm1[0] = (reg >> 8) & 0xff; |
| mm1[1] = reg & 0xff; |
| msgs[0].len = 2; |
| msgs[0].buf = mm1; |
| msgs[1].len = fw_addr ? 3 : 1; /* Multibyte Registers contains *only* 3 bytes */ |
| msgs[1].buf = mm2; |
| i2c_transfer(adap, msgs, 2); |
| |
| if (fw_addr) |
| value = (mm2[2] & 0xff) | ((mm2[1] & 0xff) >> 8) | ((mm2[0] & 0xff) >> 16); |
| else |
| value = mm2[0] & 0xff; |
| |
| v4l2_dbg(2, debug, sd, "read: reg 0x%03x=0x%08x\n", reg, value); |
| return value; |
| } |
| |
| /* ----------------------------------------------------------------------- */ |
| |
| static u32 reg_init_initialize[] = |
| { |
| /* from linux driver */ |
| 0x101, 0x008, /* Increment delay */ |
| |
| 0x103, 0x000, /* Analog input control 2 */ |
| 0x104, 0x090, /* Analog input control 3 */ |
| 0x105, 0x090, /* Analog input control 4 */ |
| 0x106, 0x0eb, /* Horizontal sync start */ |
| 0x107, 0x0e0, /* Horizontal sync stop */ |
| 0x109, 0x055, /* Luminance control */ |
| |
| 0x10f, 0x02a, /* Chroma gain control */ |
| 0x110, 0x000, /* Chroma control 2 */ |
| |
| 0x114, 0x045, /* analog/ADC */ |
| |
| 0x118, 0x040, /* RAW data gain */ |
| 0x119, 0x080, /* RAW data offset */ |
| |
| 0x044, 0x000, /* VBI horizontal input window start (L) TASK A */ |
| 0x045, 0x000, /* VBI horizontal input window start (H) TASK A */ |
| 0x046, 0x0cf, /* VBI horizontal input window stop (L) TASK A */ |
| 0x047, 0x002, /* VBI horizontal input window stop (H) TASK A */ |
| |
| 0x049, 0x000, /* VBI vertical input window start (H) TASK A */ |
| |
| 0x04c, 0x0d0, /* VBI horizontal output length (L) TASK A */ |
| 0x04d, 0x002, /* VBI horizontal output length (H) TASK A */ |
| |
| 0x064, 0x080, /* Lumina brightness TASK A */ |
| 0x065, 0x040, /* Luminance contrast TASK A */ |
| 0x066, 0x040, /* Chroma saturation TASK A */ |
| /* 067H: Reserved */ |
| 0x068, 0x000, /* VBI horizontal scaling increment (L) TASK A */ |
| 0x069, 0x004, /* VBI horizontal scaling increment (H) TASK A */ |
| 0x06a, 0x000, /* VBI phase offset TASK A */ |
| |
| 0x06e, 0x000, /* Horizontal phase offset Luma TASK A */ |
| 0x06f, 0x000, /* Horizontal phase offset Chroma TASK A */ |
| |
| 0x072, 0x000, /* Vertical filter mode TASK A */ |
| |
| 0x084, 0x000, /* VBI horizontal input window start (L) TAKS B */ |
| 0x085, 0x000, /* VBI horizontal input window start (H) TAKS B */ |
| 0x086, 0x0cf, /* VBI horizontal input window stop (L) TAKS B */ |
| 0x087, 0x002, /* VBI horizontal input window stop (H) TAKS B */ |
| |
| 0x089, 0x000, /* VBI vertical input window start (H) TAKS B */ |
| |
| 0x08c, 0x0d0, /* VBI horizontal output length (L) TASK B */ |
| 0x08d, 0x002, /* VBI horizontal output length (H) TASK B */ |
| |
| 0x0a4, 0x080, /* Lumina brightness TASK B */ |
| 0x0a5, 0x040, /* Luminance contrast TASK B */ |
| 0x0a6, 0x040, /* Chroma saturation TASK B */ |
| /* 0A7H reserved */ |
| 0x0a8, 0x000, /* VBI horizontal scaling increment (L) TASK B */ |
| 0x0a9, 0x004, /* VBI horizontal scaling increment (H) TASK B */ |
| 0x0aa, 0x000, /* VBI phase offset TASK B */ |
| |
| 0x0ae, 0x000, /* Horizontal phase offset Luma TASK B */ |
| 0x0af, 0x000, /*Horizontal phase offset Chroma TASK B */ |
| |
| 0x0b2, 0x000, /* Vertical filter mode TASK B */ |
| |
| 0x00c, 0x000, /* Start point GREEN path */ |
| 0x00d, 0x000, /* Start point BLUE path */ |
| 0x00e, 0x000, /* Start point RED path */ |
| |
| 0x010, 0x010, /* GREEN path gamma curve --- */ |
| 0x011, 0x020, |
| 0x012, 0x030, |
| 0x013, 0x040, |
| 0x014, 0x050, |
| 0x015, 0x060, |
| 0x016, 0x070, |
| 0x017, 0x080, |
| 0x018, 0x090, |
| 0x019, 0x0a0, |
| 0x01a, 0x0b0, |
| 0x01b, 0x0c0, |
| 0x01c, 0x0d0, |
| 0x01d, 0x0e0, |
| 0x01e, 0x0f0, |
| 0x01f, 0x0ff, /* --- GREEN path gamma curve */ |
| |
| 0x020, 0x010, /* BLUE path gamma curve --- */ |
| 0x021, 0x020, |
| 0x022, 0x030, |
| 0x023, 0x040, |
| 0x024, 0x050, |
| 0x025, 0x060, |
| 0x026, 0x070, |
| 0x027, 0x080, |
| 0x028, 0x090, |
| 0x029, 0x0a0, |
| 0x02a, 0x0b0, |
| 0x02b, 0x0c0, |
| 0x02c, 0x0d0, |
| 0x02d, 0x0e0, |
| 0x02e, 0x0f0, |
| 0x02f, 0x0ff, /* --- BLUE path gamma curve */ |
| |
| 0x030, 0x010, /* RED path gamma curve --- */ |
| 0x031, 0x020, |
| 0x032, 0x030, |
| 0x033, 0x040, |
| 0x034, 0x050, |
| 0x035, 0x060, |
| 0x036, 0x070, |
| 0x037, 0x080, |
| 0x038, 0x090, |
| 0x039, 0x0a0, |
| 0x03a, 0x0b0, |
| 0x03b, 0x0c0, |
| 0x03c, 0x0d0, |
| 0x03d, 0x0e0, |
| 0x03e, 0x0f0, |
| 0x03f, 0x0ff, /* --- RED path gamma curve */ |
| |
| 0x109, 0x085, /* Luminance control */ |
| |
| /**** from app start ****/ |
| 0x584, 0x000, /* AGC gain control */ |
| 0x585, 0x000, /* Program count */ |
| 0x586, 0x003, /* Status reset */ |
| 0x588, 0x0ff, /* Number of audio samples (L) */ |
| 0x589, 0x00f, /* Number of audio samples (M) */ |
| 0x58a, 0x000, /* Number of audio samples (H) */ |
| 0x58b, 0x000, /* Audio select */ |
| 0x58c, 0x010, /* Audio channel assign1 */ |
| 0x58d, 0x032, /* Audio channel assign2 */ |
| 0x58e, 0x054, /* Audio channel assign3 */ |
| 0x58f, 0x023, /* Audio format */ |
| 0x590, 0x000, /* SIF control */ |
| |
| 0x595, 0x000, /* ?? */ |
| 0x596, 0x000, /* ?? */ |
| 0x597, 0x000, /* ?? */ |
| |
| 0x464, 0x00, /* Digital input crossbar1 */ |
| |
| 0x46c, 0xbbbb10, /* Digital output selection1-3 */ |
| 0x470, 0x101010, /* Digital output selection4-6 */ |
| |
| 0x478, 0x00, /* Sound feature control */ |
| |
| 0x474, 0x18, /* Softmute control */ |
| |
| 0x454, 0x0425b9, /* Sound Easy programming(reset) */ |
| 0x454, 0x042539, /* Sound Easy programming(reset) */ |
| |
| |
| /**** common setting( of DVD play, including scaler commands) ****/ |
| 0x042, 0x003, /* Data path configuration for VBI (TASK A) */ |
| |
| 0x082, 0x003, /* Data path configuration for VBI (TASK B) */ |
| |
| 0x108, 0x0f8, /* Sync control */ |
| 0x2a9, 0x0fd, /* ??? */ |
| 0x102, 0x089, /* select video input "mode 9" */ |
| 0x111, 0x000, /* Mode/delay control */ |
| |
| 0x10e, 0x00a, /* Chroma control 1 */ |
| |
| 0x594, 0x002, /* SIF, analog I/O select */ |
| |
| 0x454, 0x0425b9, /* Sound */ |
| 0x454, 0x042539, |
| |
| 0x111, 0x000, |
| 0x10e, 0x00a, |
| 0x464, 0x000, |
| 0x300, 0x000, |
| 0x301, 0x006, |
| 0x302, 0x000, |
| 0x303, 0x006, |
| 0x308, 0x040, |
| 0x309, 0x000, |
| 0x30a, 0x000, |
| 0x30b, 0x000, |
| 0x000, 0x002, |
| 0x001, 0x000, |
| 0x002, 0x000, |
| 0x003, 0x000, |
| 0x004, 0x033, |
| 0x040, 0x01d, |
| 0x041, 0x001, |
| 0x042, 0x004, |
| 0x043, 0x000, |
| 0x080, 0x01e, |
| 0x081, 0x001, |
| 0x082, 0x004, |
| 0x083, 0x000, |
| 0x190, 0x018, |
| 0x115, 0x000, |
| 0x116, 0x012, |
| 0x117, 0x018, |
| 0x04a, 0x011, |
| 0x08a, 0x011, |
| 0x04b, 0x000, |
| 0x08b, 0x000, |
| 0x048, 0x000, |
| 0x088, 0x000, |
| 0x04e, 0x012, |
| 0x08e, 0x012, |
| 0x058, 0x012, |
| 0x098, 0x012, |
| 0x059, 0x000, |
| 0x099, 0x000, |
| 0x05a, 0x003, |
| 0x09a, 0x003, |
| 0x05b, 0x001, |
| 0x09b, 0x001, |
| 0x054, 0x008, |
| 0x094, 0x008, |
| 0x055, 0x000, |
| 0x095, 0x000, |
| 0x056, 0x0c7, |
| 0x096, 0x0c7, |
| 0x057, 0x002, |
| 0x097, 0x002, |
| 0x0ff, 0x0ff, |
| 0x060, 0x001, |
| 0x0a0, 0x001, |
| 0x061, 0x000, |
| 0x0a1, 0x000, |
| 0x062, 0x000, |
| 0x0a2, 0x000, |
| 0x063, 0x000, |
| 0x0a3, 0x000, |
| 0x070, 0x000, |
| 0x0b0, 0x000, |
| 0x071, 0x004, |
| 0x0b1, 0x004, |
| 0x06c, 0x0e9, |
| 0x0ac, 0x0e9, |
| 0x06d, 0x003, |
| 0x0ad, 0x003, |
| 0x05c, 0x0d0, |
| 0x09c, 0x0d0, |
| 0x05d, 0x002, |
| 0x09d, 0x002, |
| 0x05e, 0x0f2, |
| 0x09e, 0x0f2, |
| 0x05f, 0x000, |
| 0x09f, 0x000, |
| 0x074, 0x000, |
| 0x0b4, 0x000, |
| 0x075, 0x000, |
| 0x0b5, 0x000, |
| 0x076, 0x000, |
| 0x0b6, 0x000, |
| 0x077, 0x000, |
| 0x0b7, 0x000, |
| 0x195, 0x008, |
| 0x0ff, 0x0ff, |
| 0x108, 0x0f8, |
| 0x111, 0x000, |
| 0x10e, 0x00a, |
| 0x2a9, 0x0fd, |
| 0x464, 0x001, |
| 0x454, 0x042135, |
| 0x598, 0x0e7, |
| 0x599, 0x07d, |
| 0x59a, 0x018, |
| 0x59c, 0x066, |
| 0x59d, 0x090, |
| 0x59e, 0x001, |
| 0x584, 0x000, |
| 0x585, 0x000, |
| 0x586, 0x003, |
| 0x588, 0x0ff, |
| 0x589, 0x00f, |
| 0x58a, 0x000, |
| 0x58b, 0x000, |
| 0x58c, 0x010, |
| 0x58d, 0x032, |
| 0x58e, 0x054, |
| 0x58f, 0x023, |
| 0x590, 0x000, |
| 0x595, 0x000, |
| 0x596, 0x000, |
| 0x597, 0x000, |
| 0x464, 0x000, |
| 0x46c, 0xbbbb10, |
| 0x470, 0x101010, |
| |
| |
| 0x478, 0x000, |
| 0x474, 0x018, |
| 0x454, 0x042135, |
| 0x598, 0x0e7, |
| 0x599, 0x07d, |
| 0x59a, 0x018, |
| 0x59c, 0x066, |
| 0x59d, 0x090, |
| 0x59e, 0x001, |
| 0x584, 0x000, |
| 0x585, 0x000, |
| 0x586, 0x003, |
| 0x588, 0x0ff, |
| 0x589, 0x00f, |
| 0x58a, 0x000, |
| 0x58b, 0x000, |
| 0x58c, 0x010, |
| 0x58d, 0x032, |
| 0x58e, 0x054, |
| 0x58f, 0x023, |
| 0x590, 0x000, |
| 0x595, 0x000, |
| 0x596, 0x000, |
| 0x597, 0x000, |
| 0x464, 0x000, |
| 0x46c, 0xbbbb10, |
| 0x470, 0x101010, |
| |
| 0x478, 0x000, |
| 0x474, 0x018, |
| 0x454, 0x042135, |
| 0x598, 0x0e7, |
| 0x599, 0x07d, |
| 0x59a, 0x018, |
| 0x59c, 0x066, |
| 0x59d, 0x090, |
| 0x59e, 0x001, |
| 0x584, 0x000, |
| 0x585, 0x000, |
| 0x586, 0x003, |
| 0x588, 0x0ff, |
| 0x589, 0x00f, |
| 0x58a, 0x000, |
| 0x58b, 0x000, |
| 0x58c, 0x010, |
| 0x58d, 0x032, |
| 0x58e, 0x054, |
| 0x58f, 0x023, |
| 0x590, 0x000, |
| 0x595, 0x000, |
| 0x596, 0x000, |
| 0x597, 0x000, |
| 0x464, 0x000, |
| 0x46c, 0xbbbb10, |
| 0x470, 0x101010, |
| 0x478, 0x000, |
| 0x474, 0x018, |
| 0x454, 0x042135, |
| 0x193, 0x000, |
| 0x300, 0x000, |
| 0x301, 0x006, |
| 0x302, 0x000, |
| 0x303, 0x006, |
| 0x308, 0x040, |
| 0x309, 0x000, |
| 0x30a, 0x000, |
| 0x30b, 0x000, |
| 0x000, 0x002, |
| 0x001, 0x000, |
| 0x002, 0x000, |
| 0x003, 0x000, |
| 0x004, 0x033, |
| 0x040, 0x01d, |
| 0x041, 0x001, |
| 0x042, 0x004, |
| 0x043, 0x000, |
| 0x080, 0x01e, |
| 0x081, 0x001, |
| 0x082, 0x004, |
| 0x083, 0x000, |
| 0x190, 0x018, |
| 0x115, 0x000, |
| 0x116, 0x012, |
| 0x117, 0x018, |
| 0x04a, 0x011, |
| 0x08a, 0x011, |
| 0x04b, 0x000, |
| 0x08b, 0x000, |
| 0x048, 0x000, |
| 0x088, 0x000, |
| 0x04e, 0x012, |
| 0x08e, 0x012, |
| 0x058, 0x012, |
| 0x098, 0x012, |
| 0x059, 0x000, |
| 0x099, 0x000, |
| 0x05a, 0x003, |
| 0x09a, 0x003, |
| 0x05b, 0x001, |
| 0x09b, 0x001, |
| 0x054, 0x008, |
| 0x094, 0x008, |
| 0x055, 0x000, |
| 0x095, 0x000, |
| 0x056, 0x0c7, |
| 0x096, 0x0c7, |
| 0x057, 0x002, |
| 0x097, 0x002, |
| 0x060, 0x001, |
| 0x0a0, 0x001, |
| 0x061, 0x000, |
| 0x0a1, 0x000, |
| 0x062, 0x000, |
| 0x0a2, 0x000, |
| 0x063, 0x000, |
| 0x0a3, 0x000, |
| 0x070, 0x000, |
| 0x0b0, 0x000, |
| 0x071, 0x004, |
| 0x0b1, 0x004, |
| 0x06c, 0x0e9, |
| 0x0ac, 0x0e9, |
| 0x06d, 0x003, |
| 0x0ad, 0x003, |
| 0x05c, 0x0d0, |
| 0x09c, 0x0d0, |
| 0x05d, 0x002, |
| 0x09d, 0x002, |
| 0x05e, 0x0f2, |
| 0x09e, 0x0f2, |
| 0x05f, 0x000, |
| 0x09f, 0x000, |
| 0x074, 0x000, |
| 0x0b4, 0x000, |
| 0x075, 0x000, |
| 0x0b5, 0x000, |
| 0x076, 0x000, |
| 0x0b6, 0x000, |
| 0x077, 0x000, |
| 0x0b7, 0x000, |
| 0x195, 0x008, |
| 0x598, 0x0e7, |
| 0x599, 0x07d, |
| 0x59a, 0x018, |
| 0x59c, 0x066, |
| 0x59d, 0x090, |
| 0x59e, 0x001, |
| 0x584, 0x000, |
| 0x585, 0x000, |
| 0x586, 0x003, |
| 0x588, 0x0ff, |
| 0x589, 0x00f, |
| 0x58a, 0x000, |
| 0x58b, 0x000, |
| 0x58c, 0x010, |
| 0x58d, 0x032, |
| 0x58e, 0x054, |
| 0x58f, 0x023, |
| 0x590, 0x000, |
| 0x595, 0x000, |
| 0x596, 0x000, |
| 0x597, 0x000, |
| 0x464, 0x000, |
| 0x46c, 0xbbbb10, |
| 0x470, 0x101010, |
| 0x478, 0x000, |
| 0x474, 0x018, |
| 0x454, 0x042135, |
| 0x193, 0x0a6, |
| 0x108, 0x0f8, |
| 0x042, 0x003, |
| 0x082, 0x003, |
| 0x454, 0x0425b9, |
| 0x454, 0x042539, |
| 0x193, 0x000, |
| 0x193, 0x0a6, |
| 0x464, 0x000, |
| |
| 0, 0 |
| }; |
| |
| /* Tuner */ |
| static u32 reg_init_tuner_input[] = { |
| 0x108, 0x0f8, /* Sync control */ |
| 0x111, 0x000, /* Mode/delay control */ |
| 0x10e, 0x00a, /* Chroma control 1 */ |
| 0, 0 |
| }; |
| |
| /* Composite */ |
| static u32 reg_init_composite_input[] = { |
| 0x108, 0x0e8, /* Sync control */ |
| 0x111, 0x000, /* Mode/delay control */ |
| 0x10e, 0x04a, /* Chroma control 1 */ |
| 0, 0 |
| }; |
| |
| /* S-Video */ |
| static u32 reg_init_svideo_input[] = { |
| 0x108, 0x0e8, /* Sync control */ |
| 0x111, 0x000, /* Mode/delay control */ |
| 0x10e, 0x04a, /* Chroma control 1 */ |
| 0, 0 |
| }; |
| |
| static u32 reg_set_audio_template[4][2] = |
| { |
| { /* for MONO |
| tadachi 6/29 DMA audio output select? |
| Register 0x46c |
| 7-4: DMA2, 3-0: DMA1 ch. DMA4, DMA3 DMA2, DMA1 |
| 0: MAIN left, 1: MAIN right |
| 2: AUX1 left, 3: AUX1 right |
| 4: AUX2 left, 5: AUX2 right |
| 6: DPL left, 7: DPL right |
| 8: DPL center, 9: DPL surround |
| A: monitor output, B: digital sense */ |
| 0xbbbb00, |
| |
| /* tadachi 6/29 DAC and I2S output select? |
| Register 0x470 |
| 7-4:DAC right ch. 3-0:DAC left ch. |
| I2S1 right,left I2S2 right,left */ |
| 0x00, |
| }, |
| { /* for STEREO */ |
| 0xbbbb10, 0x101010, |
| }, |
| { /* for LANG1 */ |
| 0xbbbb00, 0x00, |
| }, |
| { /* for LANG2/SAP */ |
| 0xbbbb11, 0x111111, |
| } |
| }; |
| |
| |
| /* Get detected audio flags (from saa7134 driver) */ |
| static void get_inf_dev_status(struct v4l2_subdev *sd, |
| int *dual_flag, int *stereo_flag) |
| { |
| u32 reg_data3; |
| |
| static char *stdres[0x20] = { |
| [0x00] = "no standard detected", |
| [0x01] = "B/G (in progress)", |
| [0x02] = "D/K (in progress)", |
| [0x03] = "M (in progress)", |
| |
| [0x04] = "B/G A2", |
| [0x05] = "B/G NICAM", |
| [0x06] = "D/K A2 (1)", |
| [0x07] = "D/K A2 (2)", |
| [0x08] = "D/K A2 (3)", |
| [0x09] = "D/K NICAM", |
| [0x0a] = "L NICAM", |
| [0x0b] = "I NICAM", |
| |
| [0x0c] = "M Korea", |
| [0x0d] = "M BTSC ", |
| [0x0e] = "M EIAJ", |
| |
| [0x0f] = "FM radio / IF 10.7 / 50 deemp", |
| [0x10] = "FM radio / IF 10.7 / 75 deemp", |
| [0x11] = "FM radio / IF sel / 50 deemp", |
| [0x12] = "FM radio / IF sel / 75 deemp", |
| |
| [0x13 ... 0x1e] = "unknown", |
| [0x1f] = "??? [in progress]", |
| }; |
| |
| |
| *dual_flag = *stereo_flag = 0; |
| |
| /* (demdec status: 0x528) */ |
| |
| /* read current status */ |
| reg_data3 = saa717x_read(sd, 0x0528); |
| |
| v4l2_dbg(1, debug, sd, "tvaudio thread status: 0x%x [%s%s%s]\n", |
| reg_data3, stdres[reg_data3 & 0x1f], |
| (reg_data3 & 0x000020) ? ",stereo" : "", |
| (reg_data3 & 0x000040) ? ",dual" : ""); |
| v4l2_dbg(1, debug, sd, "detailed status: " |
| "%s#%s#%s#%s#%s#%s#%s#%s#%s#%s#%s#%s#%s#%s\n", |
| (reg_data3 & 0x000080) ? " A2/EIAJ pilot tone " : "", |
| (reg_data3 & 0x000100) ? " A2/EIAJ dual " : "", |
| (reg_data3 & 0x000200) ? " A2/EIAJ stereo " : "", |
| (reg_data3 & 0x000400) ? " A2/EIAJ noise mute " : "", |
| |
| (reg_data3 & 0x000800) ? " BTSC/FM radio pilot " : "", |
| (reg_data3 & 0x001000) ? " SAP carrier " : "", |
| (reg_data3 & 0x002000) ? " BTSC stereo noise mute " : "", |
| (reg_data3 & 0x004000) ? " SAP noise mute " : "", |
| (reg_data3 & 0x008000) ? " VDSP " : "", |
| |
| (reg_data3 & 0x010000) ? " NICST " : "", |
| (reg_data3 & 0x020000) ? " NICDU " : "", |
| (reg_data3 & 0x040000) ? " NICAM muted " : "", |
| (reg_data3 & 0x080000) ? " NICAM reserve sound " : "", |
| |
| (reg_data3 & 0x100000) ? " init done " : ""); |
| |
| if (reg_data3 & 0x000220) { |
| v4l2_dbg(1, debug, sd, "ST!!!\n"); |
| *stereo_flag = 1; |
| } |
| |
| if (reg_data3 & 0x000140) { |
| v4l2_dbg(1, debug, sd, "DUAL!!!\n"); |
| *dual_flag = 1; |
| } |
| } |
| |
| /* regs write to set audio mode */ |
| static void set_audio_mode(struct v4l2_subdev *sd, int audio_mode) |
| { |
| v4l2_dbg(1, debug, sd, "writing registers to set audio mode by set %d\n", |
| audio_mode); |
| |
| saa717x_write(sd, 0x46c, reg_set_audio_template[audio_mode][0]); |
| saa717x_write(sd, 0x470, reg_set_audio_template[audio_mode][1]); |
| } |
| |
| /* write regs to video output level (bright,contrast,hue,sat) */ |
| static void set_video_output_level_regs(struct v4l2_subdev *sd, |
| struct saa717x_state *decoder) |
| { |
| /* brightness ffh (bright) - 80h (ITU level) - 00h (dark) */ |
| saa717x_write(sd, 0x10a, decoder->bright); |
| |
| /* contrast 7fh (max: 1.984) - 44h (ITU) - 40h (1.0) - |
| 0h (luminance off) 40: i2c dump |
| c0h (-1.0 inverse chrominance) |
| 80h (-2.0 inverse chrominance) */ |
| saa717x_write(sd, 0x10b, decoder->contrast); |
| |
| /* saturation? 7fh(max)-40h(ITU)-0h(color off) |
| c0h (-1.0 inverse chrominance) |
| 80h (-2.0 inverse chrominance) */ |
| saa717x_write(sd, 0x10c, decoder->sat); |
| |
| /* color hue (phase) control |
| 7fh (+178.6) - 0h (0 normal) - 80h (-180.0) */ |
| saa717x_write(sd, 0x10d, decoder->hue); |
| } |
| |
| /* write regs to set audio volume, bass and treble */ |
| static int set_audio_regs(struct v4l2_subdev *sd, |
| struct saa717x_state *decoder) |
| { |
| u8 mute = 0xac; /* -84 dB */ |
| u32 val; |
| unsigned int work_l, work_r; |
| |
| /* set SIF analog I/O select */ |
| saa717x_write(sd, 0x0594, decoder->audio_input); |
| v4l2_dbg(1, debug, sd, "set audio input %d\n", |
| decoder->audio_input); |
| |
| /* normalize ( 65535 to 0 -> 24 to -40 (not -84)) */ |
| work_l = (min(65536 - decoder->audio_main_balance, 32768) * decoder->audio_main_volume) / 32768; |
| work_r = (min(decoder->audio_main_balance, (u16)32768) * decoder->audio_main_volume) / 32768; |
| decoder->audio_main_vol_l = (long)work_l * (24 - (-40)) / 65535 - 40; |
| decoder->audio_main_vol_r = (long)work_r * (24 - (-40)) / 65535 - 40; |
| |
| /* set main volume */ |
| /* main volume L[7-0],R[7-0],0x00 24=24dB,-83dB, -84(mute) */ |
| /* def:0dB->6dB(MPG600GR) */ |
| /* if mute is on, set mute */ |
| if (decoder->audio_main_mute) { |
| val = mute | (mute << 8); |
| } else { |
| val = (u8)decoder->audio_main_vol_l | |
| ((u8)decoder->audio_main_vol_r << 8); |
| } |
| |
| saa717x_write(sd, 0x480, val); |
| |
| /* bass and treble; go to another function */ |
| /* set bass and treble */ |
| val = decoder->audio_main_bass | (decoder->audio_main_treble << 8); |
| saa717x_write(sd, 0x488, val); |
| return 0; |
| } |
| |
| /********** scaling staff ***********/ |
| static void set_h_prescale(struct v4l2_subdev *sd, |
| int task, int prescale) |
| { |
| static const struct { |
| int xpsc; |
| int xacl; |
| int xc2_1; |
| int xdcg; |
| int vpfy; |
| } vals[] = { |
| /* XPSC XACL XC2_1 XDCG VPFY */ |
| { 1, 0, 0, 0, 0 }, |
| { 2, 2, 1, 2, 2 }, |
| { 3, 4, 1, 3, 2 }, |
| { 4, 8, 1, 4, 2 }, |
| { 5, 8, 1, 4, 2 }, |
| { 6, 8, 1, 4, 3 }, |
| { 7, 8, 1, 4, 3 }, |
| { 8, 15, 0, 4, 3 }, |
| { 9, 15, 0, 4, 3 }, |
| { 10, 16, 1, 5, 3 }, |
| }; |
| static const int count = ARRAY_SIZE(vals); |
| int i, task_shift; |
| |
| task_shift = task * 0x40; |
| for (i = 0; i < count; i++) |
| if (vals[i].xpsc == prescale) |
| break; |
| if (i == count) |
| return; |
| |
| /* horizonal prescaling */ |
| saa717x_write(sd, 0x60 + task_shift, vals[i].xpsc); |
| /* accumulation length */ |
| saa717x_write(sd, 0x61 + task_shift, vals[i].xacl); |
| /* level control */ |
| saa717x_write(sd, 0x62 + task_shift, |
| (vals[i].xc2_1 << 3) | vals[i].xdcg); |
| /*FIR prefilter control */ |
| saa717x_write(sd, 0x63 + task_shift, |
| (vals[i].vpfy << 2) | vals[i].vpfy); |
| } |
| |
| /********** scaling staff ***********/ |
| static void set_v_scale(struct v4l2_subdev *sd, int task, int yscale) |
| { |
| int task_shift; |
| |
| task_shift = task * 0x40; |
| /* Vertical scaling ratio (LOW) */ |
| saa717x_write(sd, 0x70 + task_shift, yscale & 0xff); |
| /* Vertical scaling ratio (HI) */ |
| saa717x_write(sd, 0x71 + task_shift, yscale >> 8); |
| } |
| |
| static int saa717x_s_ctrl(struct v4l2_subdev *sd, struct v4l2_control *ctrl) |
| { |
| struct saa717x_state *state = to_state(sd); |
| |
| switch (ctrl->id) { |
| case V4L2_CID_BRIGHTNESS: |
| if (ctrl->value < 0 || ctrl->value > 255) { |
| v4l2_err(sd, "invalid brightness setting %d\n", ctrl->value); |
| return -ERANGE; |
| } |
| |
| state->bright = ctrl->value; |
| v4l2_dbg(1, debug, sd, "bright:%d\n", state->bright); |
| saa717x_write(sd, 0x10a, state->bright); |
| break; |
| |
| case V4L2_CID_CONTRAST: |
| if (ctrl->value < 0 || ctrl->value > 127) { |
| v4l2_err(sd, "invalid contrast setting %d\n", ctrl->value); |
| return -ERANGE; |
| } |
| |
| state->contrast = ctrl->value; |
| v4l2_dbg(1, debug, sd, "contrast:%d\n", state->contrast); |
| saa717x_write(sd, 0x10b, state->contrast); |
| break; |
| |
| case V4L2_CID_SATURATION: |
| if (ctrl->value < 0 || ctrl->value > 127) { |
| v4l2_err(sd, "invalid saturation setting %d\n", ctrl->value); |
| return -ERANGE; |
| } |
| |
| state->sat = ctrl->value; |
| v4l2_dbg(1, debug, sd, "sat:%d\n", state->sat); |
| saa717x_write(sd, 0x10c, state->sat); |
| break; |
| |
| case V4L2_CID_HUE: |
| if (ctrl->value < -128 || ctrl->value > 127) { |
| v4l2_err(sd, "invalid hue setting %d\n", ctrl->value); |
| return -ERANGE; |
| } |
| |
| state->hue = ctrl->value; |
| v4l2_dbg(1, debug, sd, "hue:%d\n", state->hue); |
| saa717x_write(sd, 0x10d, state->hue); |
| break; |
| |
| case V4L2_CID_AUDIO_MUTE: |
| state->audio_main_mute = ctrl->value; |
| set_audio_regs(sd, state); |
| break; |
| |
| case V4L2_CID_AUDIO_VOLUME: |
| state->audio_main_volume = ctrl->value; |
| set_audio_regs(sd, state); |
| break; |
| |
| case V4L2_CID_AUDIO_BALANCE: |
| state->audio_main_balance = ctrl->value; |
| set_audio_regs(sd, state); |
| break; |
| |
| case V4L2_CID_AUDIO_TREBLE: |
| state->audio_main_treble = ctrl->value; |
| set_audio_regs(sd, state); |
| break; |
| |
| case V4L2_CID_AUDIO_BASS: |
| state->audio_main_bass = ctrl->value; |
| set_audio_regs(sd, state); |
| break; |
| |
| default: |
| return -EINVAL; |
| } |
| |
| return 0; |
| } |
| |
| static int saa717x_g_ctrl(struct v4l2_subdev *sd, struct v4l2_control *ctrl) |
| { |
| struct saa717x_state *state = to_state(sd); |
| |
| switch (ctrl->id) { |
| case V4L2_CID_BRIGHTNESS: |
| ctrl->value = state->bright; |
| break; |
| |
| case V4L2_CID_CONTRAST: |
| ctrl->value = state->contrast; |
| break; |
| |
| case V4L2_CID_SATURATION: |
| ctrl->value = state->sat; |
| break; |
| |
| case V4L2_CID_HUE: |
| ctrl->value = state->hue; |
| break; |
| |
| case V4L2_CID_AUDIO_MUTE: |
| ctrl->value = state->audio_main_mute; |
| break; |
| |
| case V4L2_CID_AUDIO_VOLUME: |
| ctrl->value = state->audio_main_volume; |
| break; |
| |
| case V4L2_CID_AUDIO_BALANCE: |
| ctrl->value = state->audio_main_balance; |
| break; |
| |
| case V4L2_CID_AUDIO_TREBLE: |
| ctrl->value = state->audio_main_treble; |
| break; |
| |
| case V4L2_CID_AUDIO_BASS: |
| ctrl->value = state->audio_main_bass; |
| break; |
| |
| default: |
| return -EINVAL; |
| } |
| |
| return 0; |
| } |
| |
| static struct v4l2_queryctrl saa717x_qctrl[] = { |
| { |
| .id = V4L2_CID_BRIGHTNESS, |
| .type = V4L2_CTRL_TYPE_INTEGER, |
| .name = "Brightness", |
| .minimum = 0, |
| .maximum = 255, |
| .step = 1, |
| .default_value = 128, |
| .flags = 0, |
| }, { |
| .id = V4L2_CID_CONTRAST, |
| .type = V4L2_CTRL_TYPE_INTEGER, |
| .name = "Contrast", |
| .minimum = 0, |
| .maximum = 255, |
| .step = 1, |
| .default_value = 64, |
| .flags = 0, |
| }, { |
| .id = V4L2_CID_SATURATION, |
| .type = V4L2_CTRL_TYPE_INTEGER, |
| .name = "Saturation", |
| .minimum = 0, |
| .maximum = 255, |
| .step = 1, |
| .default_value = 64, |
| .flags = 0, |
| }, { |
| .id = V4L2_CID_HUE, |
| .type = V4L2_CTRL_TYPE_INTEGER, |
| .name = "Hue", |
| .minimum = -128, |
| .maximum = 127, |
| .step = 1, |
| .default_value = 0, |
| .flags = 0, |
| }, { |
| .id = V4L2_CID_AUDIO_VOLUME, |
| .type = V4L2_CTRL_TYPE_INTEGER, |
| .name = "Volume", |
| .minimum = 0, |
| .maximum = 65535, |
| .step = 65535 / 100, |
| .default_value = 58880, |
| .flags = 0, |
| }, { |
| .id = V4L2_CID_AUDIO_BALANCE, |
| .type = V4L2_CTRL_TYPE_INTEGER, |
| .name = "Balance", |
| .minimum = 0, |
| .maximum = 65535, |
| .step = 65535 / 100, |
| .default_value = 32768, |
| .flags = 0, |
| }, { |
| .id = V4L2_CID_AUDIO_MUTE, |
| .type = V4L2_CTRL_TYPE_BOOLEAN, |
| .name = "Mute", |
| .minimum = 0, |
| .maximum = 1, |
| .step = 1, |
| .default_value = 1, |
| .flags = 0, |
| }, { |
| .id = V4L2_CID_AUDIO_BASS, |
| .type = V4L2_CTRL_TYPE_INTEGER, |
| .name = "Bass", |
| .minimum = 0, |
| .maximum = 65535, |
| .step = 65535 / 100, |
| .default_value = 32768, |
| }, { |
| .id = V4L2_CID_AUDIO_TREBLE, |
| .type = V4L2_CTRL_TYPE_INTEGER, |
| .name = "Treble", |
| .minimum = 0, |
| .maximum = 65535, |
| .step = 65535 / 100, |
| .default_value = 32768, |
| }, |
| }; |
| |
| static int saa717x_s_video_routing(struct v4l2_subdev *sd, |
| u32 input, u32 output, u32 config) |
| { |
| struct saa717x_state *decoder = to_state(sd); |
| int is_tuner = input & 0x80; /* tuner input flag */ |
| |
| input &= 0x7f; |
| |
| v4l2_dbg(1, debug, sd, "decoder set input (%d)\n", input); |
| /* inputs from 0-9 are available*/ |
| /* saa717x have mode0-mode9 but mode5 is reserved. */ |
| if (input > 9 || input == 5) |
| return -EINVAL; |
| |
| if (decoder->input != input) { |
| int input_line = input; |
| |
| decoder->input = input_line; |
| v4l2_dbg(1, debug, sd, "now setting %s input %d\n", |
| input_line >= 6 ? "S-Video" : "Composite", |
| input_line); |
| |
| /* select mode */ |
| saa717x_write(sd, 0x102, |
| (saa717x_read(sd, 0x102) & 0xf0) | |
| input_line); |
| |
| /* bypass chrominance trap for modes 6..9 */ |
| saa717x_write(sd, 0x109, |
| (saa717x_read(sd, 0x109) & 0x7f) | |
| (input_line < 6 ? 0x0 : 0x80)); |
| |
| /* change audio_mode */ |
| if (is_tuner) { |
| /* tuner */ |
| set_audio_mode(sd, decoder->tuner_audio_mode); |
| } else { |
| /* Force to STEREO mode if Composite or |
| * S-Video were chosen */ |
| set_audio_mode(sd, TUNER_AUDIO_STEREO); |
| } |
| /* change initialize procedure (Composite/S-Video) */ |
| if (is_tuner) |
| saa717x_write_regs(sd, reg_init_tuner_input); |
| else if (input_line >= 6) |
| saa717x_write_regs(sd, reg_init_svideo_input); |
| else |
| saa717x_write_regs(sd, reg_init_composite_input); |
| } |
| |
| return 0; |
| } |
| |
| static int saa717x_queryctrl(struct v4l2_subdev *sd, struct v4l2_queryctrl *qc) |
| { |
| int i; |
| |
| for (i = 0; i < ARRAY_SIZE(saa717x_qctrl); i++) |
| if (qc->id && qc->id == saa717x_qctrl[i].id) { |
| memcpy(qc, &saa717x_qctrl[i], sizeof(*qc)); |
| return 0; |
| } |
| return -EINVAL; |
| } |
| |
| #ifdef CONFIG_VIDEO_ADV_DEBUG |
| static int saa717x_g_register(struct v4l2_subdev *sd, struct v4l2_dbg_register *reg) |
| { |
| struct i2c_client *client = v4l2_get_subdevdata(sd); |
| |
| if (!v4l2_chip_match_i2c_client(client, ®->match)) |
| return -EINVAL; |
| if (!capable(CAP_SYS_ADMIN)) |
| return -EPERM; |
| reg->val = saa717x_read(sd, reg->reg); |
| reg->size = 1; |
| return 0; |
| } |
| |
| static int saa717x_s_register(struct v4l2_subdev *sd, struct v4l2_dbg_register *reg) |
| { |
| struct i2c_client *client = v4l2_get_subdevdata(sd); |
| u16 addr = reg->reg & 0xffff; |
| u8 val = reg->val & 0xff; |
| |
| if (!v4l2_chip_match_i2c_client(client, ®->match)) |
| return -EINVAL; |
| if (!capable(CAP_SYS_ADMIN)) |
| return -EPERM; |
| saa717x_write(sd, addr, val); |
| return 0; |
| } |
| #endif |
| |
| static int saa717x_s_mbus_fmt(struct v4l2_subdev *sd, struct v4l2_mbus_framefmt *fmt) |
| { |
| int prescale, h_scale, v_scale; |
| |
| v4l2_dbg(1, debug, sd, "decoder set size\n"); |
| |
| if (fmt->code != V4L2_MBUS_FMT_FIXED) |
| return -EINVAL; |
| |
| /* FIXME need better bounds checking here */ |
| if (fmt->width < 1 || fmt->width > 1440) |
| return -EINVAL; |
| if (fmt->height < 1 || fmt->height > 960) |
| return -EINVAL; |
| |
| fmt->field = V4L2_FIELD_INTERLACED; |
| fmt->colorspace = V4L2_COLORSPACE_SMPTE170M; |
| |
| /* scaling setting */ |
| /* NTSC and interlace only */ |
| prescale = SAA717X_NTSC_WIDTH / fmt->width; |
| if (prescale == 0) |
| prescale = 1; |
| h_scale = 1024 * SAA717X_NTSC_WIDTH / prescale / fmt->width; |
| /* interlace */ |
| v_scale = 512 * 2 * SAA717X_NTSC_HEIGHT / fmt->height; |
| |
| /* Horizontal prescaling etc */ |
| set_h_prescale(sd, 0, prescale); |
| set_h_prescale(sd, 1, prescale); |
| |
| /* Horizontal scaling increment */ |
| /* TASK A */ |
| saa717x_write(sd, 0x6C, (u8)(h_scale & 0xFF)); |
| saa717x_write(sd, 0x6D, (u8)((h_scale >> 8) & 0xFF)); |
| /* TASK B */ |
| saa717x_write(sd, 0xAC, (u8)(h_scale & 0xFF)); |
| saa717x_write(sd, 0xAD, (u8)((h_scale >> 8) & 0xFF)); |
| |
| /* Vertical prescaling etc */ |
| set_v_scale(sd, 0, v_scale); |
| set_v_scale(sd, 1, v_scale); |
| |
| /* set video output size */ |
| /* video number of pixels at output */ |
| /* TASK A */ |
| saa717x_write(sd, 0x5C, (u8)(fmt->width & 0xFF)); |
| saa717x_write(sd, 0x5D, (u8)((fmt->width >> 8) & 0xFF)); |
| /* TASK B */ |
| saa717x_write(sd, 0x9C, (u8)(fmt->width & 0xFF)); |
| saa717x_write(sd, 0x9D, (u8)((fmt->width >> 8) & 0xFF)); |
| |
| /* video number of lines at output */ |
| /* TASK A */ |
| saa717x_write(sd, 0x5E, (u8)(fmt->height & 0xFF)); |
| saa717x_write(sd, 0x5F, (u8)((fmt->height >> 8) & 0xFF)); |
| /* TASK B */ |
| saa717x_write(sd, 0x9E, (u8)(fmt->height & 0xFF)); |
| saa717x_write(sd, 0x9F, (u8)((fmt->height >> 8) & 0xFF)); |
| return 0; |
| } |
| |
| static int saa717x_s_radio(struct v4l2_subdev *sd) |
| { |
| struct saa717x_state *decoder = to_state(sd); |
| |
| decoder->radio = 1; |
| return 0; |
| } |
| |
| static int saa717x_s_std(struct v4l2_subdev *sd, v4l2_std_id std) |
| { |
| struct saa717x_state *decoder = to_state(sd); |
| |
| v4l2_dbg(1, debug, sd, "decoder set norm "); |
| v4l2_dbg(1, debug, sd, "(not yet implementd)\n"); |
| |
| decoder->radio = 0; |
| decoder->std = std; |
| return 0; |
| } |
| |
| static int saa717x_s_audio_routing(struct v4l2_subdev *sd, |
| u32 input, u32 output, u32 config) |
| { |
| struct saa717x_state *decoder = to_state(sd); |
| |
| if (input < 3) { /* FIXME! --tadachi */ |
| decoder->audio_input = input; |
| v4l2_dbg(1, debug, sd, |
| "set decoder audio input to %d\n", |
| decoder->audio_input); |
| set_audio_regs(sd, decoder); |
| return 0; |
| } |
| return -ERANGE; |
| } |
| |
| static int saa717x_s_stream(struct v4l2_subdev *sd, int enable) |
| { |
| struct saa717x_state *decoder = to_state(sd); |
| |
| v4l2_dbg(1, debug, sd, "decoder %s output\n", |
| enable ? "enable" : "disable"); |
| decoder->enable = enable; |
| saa717x_write(sd, 0x193, enable ? 0xa6 : 0x26); |
| return 0; |
| } |
| |
| /* change audio mode */ |
| static int saa717x_s_tuner(struct v4l2_subdev *sd, struct v4l2_tuner *vt) |
| { |
| struct saa717x_state *decoder = to_state(sd); |
| int audio_mode; |
| char *mes[4] = { |
| "MONO", "STEREO", "LANG1", "LANG2/SAP" |
| }; |
| |
| audio_mode = TUNER_AUDIO_STEREO; |
| |
| switch (vt->audmode) { |
| case V4L2_TUNER_MODE_MONO: |
| audio_mode = TUNER_AUDIO_MONO; |
| break; |
| case V4L2_TUNER_MODE_STEREO: |
| audio_mode = TUNER_AUDIO_STEREO; |
| break; |
| case V4L2_TUNER_MODE_LANG2: |
| audio_mode = TUNER_AUDIO_LANG2; |
| break; |
| case V4L2_TUNER_MODE_LANG1: |
| audio_mode = TUNER_AUDIO_LANG1; |
| break; |
| } |
| |
| v4l2_dbg(1, debug, sd, "change audio mode to %s\n", |
| mes[audio_mode]); |
| decoder->tuner_audio_mode = audio_mode; |
| /* The registers are not changed here. */ |
| /* See DECODER_ENABLE_OUTPUT section. */ |
| set_audio_mode(sd, decoder->tuner_audio_mode); |
| return 0; |
| } |
| |
| static int saa717x_g_tuner(struct v4l2_subdev *sd, struct v4l2_tuner *vt) |
| { |
| struct saa717x_state *decoder = to_state(sd); |
| int dual_f, stereo_f; |
| |
| if (decoder->radio) |
| return 0; |
| get_inf_dev_status(sd, &dual_f, &stereo_f); |
| |
| v4l2_dbg(1, debug, sd, "DETECT==st:%d dual:%d\n", |
| stereo_f, dual_f); |
| |
| /* mono */ |
| if ((dual_f == 0) && (stereo_f == 0)) { |
| vt->rxsubchans = V4L2_TUNER_SUB_MONO; |
| v4l2_dbg(1, debug, sd, "DETECT==MONO\n"); |
| } |
| |
| /* stereo */ |
| if (stereo_f == 1) { |
| if (vt->audmode == V4L2_TUNER_MODE_STEREO || |
| vt->audmode == V4L2_TUNER_MODE_LANG1) { |
| vt->rxsubchans = V4L2_TUNER_SUB_STEREO; |
| v4l2_dbg(1, debug, sd, "DETECT==ST(ST)\n"); |
| } else { |
| vt->rxsubchans = V4L2_TUNER_SUB_MONO; |
| v4l2_dbg(1, debug, sd, "DETECT==ST(MONO)\n"); |
| } |
| } |
| |
| /* dual */ |
| if (dual_f == 1) { |
| if (vt->audmode == V4L2_TUNER_MODE_LANG2) { |
| vt->rxsubchans = V4L2_TUNER_SUB_LANG2 | V4L2_TUNER_SUB_MONO; |
| v4l2_dbg(1, debug, sd, "DETECT==DUAL1\n"); |
| } else { |
| vt->rxsubchans = V4L2_TUNER_SUB_LANG1 | V4L2_TUNER_SUB_MONO; |
| v4l2_dbg(1, debug, sd, "DETECT==DUAL2\n"); |
| } |
| } |
| return 0; |
| } |
| |
| /* ----------------------------------------------------------------------- */ |
| |
| static const struct v4l2_subdev_core_ops saa717x_core_ops = { |
| #ifdef CONFIG_VIDEO_ADV_DEBUG |
| .g_register = saa717x_g_register, |
| .s_register = saa717x_s_register, |
| #endif |
| .queryctrl = saa717x_queryctrl, |
| .g_ctrl = saa717x_g_ctrl, |
| .s_ctrl = saa717x_s_ctrl, |
| .s_std = saa717x_s_std, |
| }; |
| |
| static const struct v4l2_subdev_tuner_ops saa717x_tuner_ops = { |
| .g_tuner = saa717x_g_tuner, |
| .s_tuner = saa717x_s_tuner, |
| .s_radio = saa717x_s_radio, |
| }; |
| |
| static const struct v4l2_subdev_video_ops saa717x_video_ops = { |
| .s_routing = saa717x_s_video_routing, |
| .s_mbus_fmt = saa717x_s_mbus_fmt, |
| .s_stream = saa717x_s_stream, |
| }; |
| |
| static const struct v4l2_subdev_audio_ops saa717x_audio_ops = { |
| .s_routing = saa717x_s_audio_routing, |
| }; |
| |
| static const struct v4l2_subdev_ops saa717x_ops = { |
| .core = &saa717x_core_ops, |
| .tuner = &saa717x_tuner_ops, |
| .audio = &saa717x_audio_ops, |
| .video = &saa717x_video_ops, |
| }; |
| |
| /* ----------------------------------------------------------------------- */ |
| |
| |
| /* i2c implementation */ |
| |
| /* ----------------------------------------------------------------------- */ |
| static int saa717x_probe(struct i2c_client *client, |
| const struct i2c_device_id *did) |
| { |
| struct saa717x_state *decoder; |
| struct v4l2_subdev *sd; |
| u8 id = 0; |
| char *p = ""; |
| |
| /* Check if the adapter supports the needed features */ |
| if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA)) |
| return -EIO; |
| |
| decoder = kzalloc(sizeof(struct saa717x_state), GFP_KERNEL); |
| if (decoder == NULL) |
| return -ENOMEM; |
| |
| sd = &decoder->sd; |
| v4l2_i2c_subdev_init(sd, client, &saa717x_ops); |
| |
| if (saa717x_write(sd, 0x5a4, 0xfe) && |
| saa717x_write(sd, 0x5a5, 0x0f) && |
| saa717x_write(sd, 0x5a6, 0x00) && |
| saa717x_write(sd, 0x5a7, 0x01)) |
| id = saa717x_read(sd, 0x5a0); |
| if (id != 0xc2 && id != 0x32 && id != 0xf2 && id != 0x6c) { |
| v4l2_dbg(1, debug, sd, "saa717x not found (id=%02x)\n", id); |
| kfree(decoder); |
| return -ENODEV; |
| } |
| if (id == 0xc2) |
| p = "saa7173"; |
| else if (id == 0x32) |
| p = "saa7174A"; |
| else if (id == 0x6c) |
| p = "saa7174HL"; |
| else |
| p = "saa7171"; |
| v4l2_info(sd, "%s found @ 0x%x (%s)\n", p, |
| client->addr << 1, client->adapter->name); |
| decoder->std = V4L2_STD_NTSC; |
| decoder->input = -1; |
| decoder->enable = 1; |
| |
| /* tune these parameters */ |
| decoder->bright = 0x80; |
| decoder->contrast = 0x44; |
| decoder->sat = 0x40; |
| decoder->hue = 0x00; |
| |
| /* FIXME!! */ |
| decoder->playback = 0; /* initially capture mode used */ |
| decoder->audio = 1; /* DECODER_AUDIO_48_KHZ */ |
| |
| decoder->audio_input = 2; /* FIXME!! */ |
| |
| decoder->tuner_audio_mode = TUNER_AUDIO_STEREO; |
| /* set volume, bass and treble */ |
| decoder->audio_main_vol_l = 6; |
| decoder->audio_main_vol_r = 6; |
| decoder->audio_main_bass = 0; |
| decoder->audio_main_treble = 0; |
| decoder->audio_main_mute = 0; |
| decoder->audio_main_balance = 32768; |
| /* normalize (24 to -40 (not -84) -> 65535 to 0) */ |
| decoder->audio_main_volume = |
| (decoder->audio_main_vol_r + 41) * 65535 / (24 - (-40)); |
| |
| v4l2_dbg(1, debug, sd, "writing init values\n"); |
| |
| /* FIXME!! */ |
| saa717x_write_regs(sd, reg_init_initialize); |
| set_video_output_level_regs(sd, decoder); |
| /* set bass,treble to 0db 20041101 K.Ohta */ |
| decoder->audio_main_bass = 0; |
| decoder->audio_main_treble = 0; |
| set_audio_regs(sd, decoder); |
| |
| set_current_state(TASK_INTERRUPTIBLE); |
| schedule_timeout(2*HZ); |
| return 0; |
| } |
| |
| static int saa717x_remove(struct i2c_client *client) |
| { |
| struct v4l2_subdev *sd = i2c_get_clientdata(client); |
| |
| v4l2_device_unregister_subdev(sd); |
| kfree(to_state(sd)); |
| return 0; |
| } |
| |
| /* ----------------------------------------------------------------------- */ |
| |
| static const struct i2c_device_id saa717x_id[] = { |
| { "saa717x", 0 }, |
| { } |
| }; |
| MODULE_DEVICE_TABLE(i2c, saa717x_id); |
| |
| static struct v4l2_i2c_driver_data v4l2_i2c_data = { |
| .name = "saa717x", |
| .probe = saa717x_probe, |
| .remove = saa717x_remove, |
| .id_table = saa717x_id, |
| }; |