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