iwlwifi: introduce host commands callbacks
[linux/fpc-iii.git] / drivers / media / dvb / ttpci / av7110_v4l.c
blobe2f066fb796727c1f0f7bf1c8196a562d25c1839
1 /*
2 * av7110_v4l.c: av7110 video4linux interface for DVB and Siemens DVB-C analog module
4 * Copyright (C) 1999-2002 Ralph Metzler
5 * & Marcus Metzler for convergence integrated media GmbH
7 * originally based on code by:
8 * Copyright (C) 1998,1999 Christian Theiss <mistert@rz.fh-augsburg.de>
10 * This program is free software; you can redistribute it and/or
11 * modify it under the terms of the GNU General Public License
12 * as published by the Free Software Foundation; either version 2
13 * of the License, or (at your option) any later version.
15 * This program is distributed in the hope that it will be useful,
16 * but WITHOUT ANY WARRANTY; without even the implied warranty of
17 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
18 * GNU General Public License for more details.
20 * You should have received a copy of the GNU General Public License
21 * along with this program; if not, write to the Free Software
22 * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
23 * Or, point your browser to http://www.gnu.org/copyleft/gpl.html
25 * the project's page is at http://www.linuxtv.org/dvb/
28 #include <linux/kernel.h>
29 #include <linux/types.h>
30 #include <linux/delay.h>
31 #include <linux/fs.h>
32 #include <linux/timer.h>
33 #include <linux/poll.h>
35 #include "av7110.h"
36 #include "av7110_hw.h"
37 #include "av7110_av.h"
39 int msp_writereg(struct av7110 *av7110, u8 dev, u16 reg, u16 val)
41 u8 msg[5] = { dev, reg >> 8, reg & 0xff, val >> 8 , val & 0xff };
42 struct i2c_msg msgs = { .flags = 0, .len = 5, .buf = msg };
44 switch (av7110->adac_type) {
45 case DVB_ADAC_MSP34x0:
46 msgs.addr = 0x40;
47 break;
48 case DVB_ADAC_MSP34x5:
49 msgs.addr = 0x42;
50 break;
51 default:
52 return 0;
55 if (i2c_transfer(&av7110->i2c_adap, &msgs, 1) != 1) {
56 dprintk(1, "dvb-ttpci: failed @ card %d, %u = %u\n",
57 av7110->dvb_adapter.num, reg, val);
58 return -EIO;
60 return 0;
63 static int msp_readreg(struct av7110 *av7110, u8 dev, u16 reg, u16 *val)
65 u8 msg1[3] = { dev, reg >> 8, reg & 0xff };
66 u8 msg2[2];
67 struct i2c_msg msgs[2] = {
68 { .flags = 0 , .len = 3, .buf = msg1 },
69 { .flags = I2C_M_RD, .len = 2, .buf = msg2 }
72 switch (av7110->adac_type) {
73 case DVB_ADAC_MSP34x0:
74 msgs[0].addr = 0x40;
75 msgs[1].addr = 0x40;
76 break;
77 case DVB_ADAC_MSP34x5:
78 msgs[0].addr = 0x42;
79 msgs[1].addr = 0x42;
80 break;
81 default:
82 return 0;
85 if (i2c_transfer(&av7110->i2c_adap, &msgs[0], 2) != 2) {
86 dprintk(1, "dvb-ttpci: failed @ card %d, %u\n",
87 av7110->dvb_adapter.num, reg);
88 return -EIO;
90 *val = (msg2[0] << 8) | msg2[1];
91 return 0;
94 static struct v4l2_input inputs[4] = {
96 .index = 0,
97 .name = "DVB",
98 .type = V4L2_INPUT_TYPE_CAMERA,
99 .audioset = 1,
100 .tuner = 0, /* ignored */
101 .std = V4L2_STD_PAL_BG|V4L2_STD_NTSC_M,
102 .status = 0,
103 }, {
104 .index = 1,
105 .name = "Television",
106 .type = V4L2_INPUT_TYPE_TUNER,
107 .audioset = 2,
108 .tuner = 0,
109 .std = V4L2_STD_PAL_BG|V4L2_STD_NTSC_M,
110 .status = 0,
111 }, {
112 .index = 2,
113 .name = "Video",
114 .type = V4L2_INPUT_TYPE_CAMERA,
115 .audioset = 0,
116 .tuner = 0,
117 .std = V4L2_STD_PAL_BG|V4L2_STD_NTSC_M,
118 .status = 0,
119 }, {
120 .index = 3,
121 .name = "Y/C",
122 .type = V4L2_INPUT_TYPE_CAMERA,
123 .audioset = 0,
124 .tuner = 0,
125 .std = V4L2_STD_PAL_BG|V4L2_STD_NTSC_M,
126 .status = 0,
130 static int ves1820_writereg(struct saa7146_dev *dev, u8 addr, u8 reg, u8 data)
132 struct av7110 *av7110 = dev->ext_priv;
133 u8 buf[] = { 0x00, reg, data };
134 struct i2c_msg msg = { .addr = addr, .flags = 0, .buf = buf, .len = 3 };
136 dprintk(4, "dev: %p\n", dev);
138 if (1 != i2c_transfer(&av7110->i2c_adap, &msg, 1))
139 return -1;
140 return 0;
143 static int tuner_write(struct saa7146_dev *dev, u8 addr, u8 data [4])
145 struct av7110 *av7110 = dev->ext_priv;
146 struct i2c_msg msg = { .addr = addr, .flags = 0, .buf = data, .len = 4 };
148 dprintk(4, "dev: %p\n", dev);
150 if (1 != i2c_transfer(&av7110->i2c_adap, &msg, 1))
151 return -1;
152 return 0;
155 static int ves1820_set_tv_freq(struct saa7146_dev *dev, u32 freq)
157 u32 div;
158 u8 config;
159 u8 buf[4];
161 dprintk(4, "freq: 0x%08x\n", freq);
163 /* magic number: 614. tuning with the frequency given by v4l2
164 is always off by 614*62.5 = 38375 kHz...*/
165 div = freq + 614;
167 buf[0] = (div >> 8) & 0x7f;
168 buf[1] = div & 0xff;
169 buf[2] = 0x8e;
171 if (freq < (u32) (16 * 168.25))
172 config = 0xa0;
173 else if (freq < (u32) (16 * 447.25))
174 config = 0x90;
175 else
176 config = 0x30;
177 config &= ~0x02;
179 buf[3] = config;
181 return tuner_write(dev, 0x61, buf);
184 static int stv0297_set_tv_freq(struct saa7146_dev *dev, u32 freq)
186 struct av7110 *av7110 = (struct av7110*)dev->ext_priv;
187 u32 div;
188 u8 data[4];
190 div = (freq + 38900000 + 31250) / 62500;
192 data[0] = (div >> 8) & 0x7f;
193 data[1] = div & 0xff;
194 data[2] = 0xce;
196 if (freq < 45000000)
197 return -EINVAL;
198 else if (freq < 137000000)
199 data[3] = 0x01;
200 else if (freq < 403000000)
201 data[3] = 0x02;
202 else if (freq < 860000000)
203 data[3] = 0x04;
204 else
205 return -EINVAL;
207 if (av7110->fe->ops.i2c_gate_ctrl)
208 av7110->fe->ops.i2c_gate_ctrl(av7110->fe, 1);
209 return tuner_write(dev, 0x63, data);
214 static struct saa7146_standard analog_standard[];
215 static struct saa7146_standard dvb_standard[];
216 static struct saa7146_standard standard[];
218 static struct v4l2_audio msp3400_v4l2_audio = {
219 .index = 0,
220 .name = "Television",
221 .capability = V4L2_AUDCAP_STEREO
224 static int av7110_dvb_c_switch(struct saa7146_fh *fh)
226 struct saa7146_dev *dev = fh->dev;
227 struct saa7146_vv *vv = dev->vv_data;
228 struct av7110 *av7110 = (struct av7110*)dev->ext_priv;
229 u16 adswitch;
230 int source, sync, err;
232 dprintk(4, "%p\n", av7110);
234 if ((vv->video_status & STATUS_OVERLAY) != 0) {
235 vv->ov_suspend = vv->video_fh;
236 err = saa7146_stop_preview(vv->video_fh); /* side effect: video_status is now 0, video_fh is NULL */
237 if (err != 0) {
238 dprintk(2, "suspending video failed\n");
239 vv->ov_suspend = NULL;
243 if (0 != av7110->current_input) {
244 dprintk(1, "switching to analog TV:\n");
245 adswitch = 1;
246 source = SAA7146_HPS_SOURCE_PORT_B;
247 sync = SAA7146_HPS_SYNC_PORT_B;
248 memcpy(standard, analog_standard, sizeof(struct saa7146_standard) * 2);
250 switch (av7110->current_input) {
251 case 1:
252 dprintk(1, "switching SAA7113 to Analog Tuner Input.\n");
253 msp_writereg(av7110, MSP_WR_DSP, 0x0008, 0x0000); // loudspeaker source
254 msp_writereg(av7110, MSP_WR_DSP, 0x0009, 0x0000); // headphone source
255 msp_writereg(av7110, MSP_WR_DSP, 0x000a, 0x0000); // SCART 1 source
256 msp_writereg(av7110, MSP_WR_DSP, 0x000e, 0x3000); // FM matrix, mono
257 msp_writereg(av7110, MSP_WR_DSP, 0x0000, 0x4f00); // loudspeaker + headphone
258 msp_writereg(av7110, MSP_WR_DSP, 0x0007, 0x4f00); // SCART 1 volume
260 if (av7110->analog_tuner_flags & ANALOG_TUNER_VES1820) {
261 if (ves1820_writereg(dev, 0x09, 0x0f, 0x60))
262 dprintk(1, "setting band in demodulator failed.\n");
263 } else if (av7110->analog_tuner_flags & ANALOG_TUNER_STV0297) {
264 saa7146_setgpio(dev, 1, SAA7146_GPIO_OUTHI); // TDA9819 pin9(STD)
265 saa7146_setgpio(dev, 3, SAA7146_GPIO_OUTHI); // TDA9819 pin30(VIF)
267 if (i2c_writereg(av7110, 0x48, 0x02, 0xd0) != 1)
268 dprintk(1, "saa7113 write failed @ card %d", av7110->dvb_adapter.num);
269 break;
270 case 2:
271 dprintk(1, "switching SAA7113 to Video AV CVBS Input.\n");
272 if (i2c_writereg(av7110, 0x48, 0x02, 0xd2) != 1)
273 dprintk(1, "saa7113 write failed @ card %d", av7110->dvb_adapter.num);
274 break;
275 case 3:
276 dprintk(1, "switching SAA7113 to Video AV Y/C Input.\n");
277 if (i2c_writereg(av7110, 0x48, 0x02, 0xd9) != 1)
278 dprintk(1, "saa7113 write failed @ card %d", av7110->dvb_adapter.num);
279 break;
280 default:
281 dprintk(1, "switching SAA7113 to Input: AV7110: SAA7113: invalid input.\n");
283 } else {
284 adswitch = 0;
285 source = SAA7146_HPS_SOURCE_PORT_A;
286 sync = SAA7146_HPS_SYNC_PORT_A;
287 memcpy(standard, dvb_standard, sizeof(struct saa7146_standard) * 2);
288 dprintk(1, "switching DVB mode\n");
289 msp_writereg(av7110, MSP_WR_DSP, 0x0008, 0x0220); // loudspeaker source
290 msp_writereg(av7110, MSP_WR_DSP, 0x0009, 0x0220); // headphone source
291 msp_writereg(av7110, MSP_WR_DSP, 0x000a, 0x0220); // SCART 1 source
292 msp_writereg(av7110, MSP_WR_DSP, 0x000e, 0x3000); // FM matrix, mono
293 msp_writereg(av7110, MSP_WR_DSP, 0x0000, 0x7f00); // loudspeaker + headphone
294 msp_writereg(av7110, MSP_WR_DSP, 0x0007, 0x7f00); // SCART 1 volume
296 if (av7110->analog_tuner_flags & ANALOG_TUNER_VES1820) {
297 if (ves1820_writereg(dev, 0x09, 0x0f, 0x20))
298 dprintk(1, "setting band in demodulator failed.\n");
299 } else if (av7110->analog_tuner_flags & ANALOG_TUNER_STV0297) {
300 saa7146_setgpio(dev, 1, SAA7146_GPIO_OUTLO); // TDA9819 pin9(STD)
301 saa7146_setgpio(dev, 3, SAA7146_GPIO_OUTLO); // TDA9819 pin30(VIF)
305 /* hmm, this does not do anything!? */
306 if (av7110_fw_cmd(av7110, COMTYPE_AUDIODAC, ADSwitch, 1, adswitch))
307 dprintk(1, "ADSwitch error\n");
309 saa7146_set_hps_source_and_sync(dev, source, sync);
311 if (vv->ov_suspend != NULL) {
312 saa7146_start_preview(vv->ov_suspend);
313 vv->ov_suspend = NULL;
316 return 0;
319 static int av7110_ioctl(struct saa7146_fh *fh, unsigned int cmd, void *arg)
321 struct saa7146_dev *dev = fh->dev;
322 struct av7110 *av7110 = (struct av7110*) dev->ext_priv;
323 dprintk(4, "saa7146_dev: %p\n", dev);
325 switch (cmd) {
326 case VIDIOC_G_TUNER:
328 struct v4l2_tuner *t = arg;
329 u16 stereo_det;
330 s8 stereo;
332 dprintk(2, "VIDIOC_G_TUNER: %d\n", t->index);
334 if (!av7110->analog_tuner_flags || t->index != 0)
335 return -EINVAL;
337 memset(t, 0, sizeof(*t));
338 strcpy((char *)t->name, "Television");
340 t->type = V4L2_TUNER_ANALOG_TV;
341 t->capability = V4L2_TUNER_CAP_NORM | V4L2_TUNER_CAP_STEREO |
342 V4L2_TUNER_CAP_LANG1 | V4L2_TUNER_CAP_LANG2 | V4L2_TUNER_CAP_SAP;
343 t->rangelow = 772; /* 48.25 MHZ / 62.5 kHz = 772, see fi1216mk2-specs, page 2 */
344 t->rangehigh = 13684; /* 855.25 MHz / 62.5 kHz = 13684 */
345 /* FIXME: add the real signal strength here */
346 t->signal = 0xffff;
347 t->afc = 0;
349 // FIXME: standard / stereo detection is still broken
350 msp_readreg(av7110, MSP_RD_DEM, 0x007e, &stereo_det);
351 dprintk(1, "VIDIOC_G_TUNER: msp3400 TV standard detection: 0x%04x\n", stereo_det);
352 msp_readreg(av7110, MSP_RD_DSP, 0x0018, &stereo_det);
353 dprintk(1, "VIDIOC_G_TUNER: msp3400 stereo detection: 0x%04x\n", stereo_det);
354 stereo = (s8)(stereo_det >> 8);
355 if (stereo > 0x10) {
356 /* stereo */
357 t->rxsubchans = V4L2_TUNER_SUB_STEREO | V4L2_TUNER_SUB_MONO;
358 t->audmode = V4L2_TUNER_MODE_STEREO;
360 else if (stereo < -0x10) {
361 /* bilingual */
362 t->rxsubchans = V4L2_TUNER_SUB_LANG1 | V4L2_TUNER_SUB_LANG2;
363 t->audmode = V4L2_TUNER_MODE_LANG1;
365 else /* mono */
366 t->rxsubchans = V4L2_TUNER_SUB_MONO;
368 return 0;
370 case VIDIOC_S_TUNER:
372 struct v4l2_tuner *t = arg;
373 u16 fm_matrix, src;
374 dprintk(2, "VIDIOC_S_TUNER: %d\n", t->index);
376 if (!av7110->analog_tuner_flags || av7110->current_input != 1)
377 return -EINVAL;
379 switch (t->audmode) {
380 case V4L2_TUNER_MODE_STEREO:
381 dprintk(2, "VIDIOC_S_TUNER: V4L2_TUNER_MODE_STEREO\n");
382 fm_matrix = 0x3001; // stereo
383 src = 0x0020;
384 break;
385 case V4L2_TUNER_MODE_LANG1_LANG2:
386 dprintk(2, "VIDIOC_S_TUNER: V4L2_TUNER_MODE_LANG1_LANG2\n");
387 fm_matrix = 0x3000; // bilingual
388 src = 0x0020;
389 break;
390 case V4L2_TUNER_MODE_LANG1:
391 dprintk(2, "VIDIOC_S_TUNER: V4L2_TUNER_MODE_LANG1\n");
392 fm_matrix = 0x3000; // mono
393 src = 0x0000;
394 break;
395 case V4L2_TUNER_MODE_LANG2:
396 dprintk(2, "VIDIOC_S_TUNER: V4L2_TUNER_MODE_LANG2\n");
397 fm_matrix = 0x3000; // mono
398 src = 0x0010;
399 break;
400 default: /* case V4L2_TUNER_MODE_MONO: */
401 dprintk(2, "VIDIOC_S_TUNER: TDA9840_SET_MONO\n");
402 fm_matrix = 0x3000; // mono
403 src = 0x0030;
404 break;
406 msp_writereg(av7110, MSP_WR_DSP, 0x000e, fm_matrix);
407 msp_writereg(av7110, MSP_WR_DSP, 0x0008, src);
408 msp_writereg(av7110, MSP_WR_DSP, 0x0009, src);
409 msp_writereg(av7110, MSP_WR_DSP, 0x000a, src);
410 return 0;
412 case VIDIOC_G_FREQUENCY:
414 struct v4l2_frequency *f = arg;
416 dprintk(2, "VIDIOC_G_FREQ: freq:0x%08x.\n", f->frequency);
418 if (!av7110->analog_tuner_flags || av7110->current_input != 1)
419 return -EINVAL;
421 memset(f, 0, sizeof(*f));
422 f->type = V4L2_TUNER_ANALOG_TV;
423 f->frequency = av7110->current_freq;
424 return 0;
426 case VIDIOC_S_FREQUENCY:
428 struct v4l2_frequency *f = arg;
430 dprintk(2, "VIDIOC_S_FREQUENCY: freq:0x%08x.\n", f->frequency);
432 if (!av7110->analog_tuner_flags || av7110->current_input != 1)
433 return -EINVAL;
435 if (V4L2_TUNER_ANALOG_TV != f->type)
436 return -EINVAL;
438 msp_writereg(av7110, MSP_WR_DSP, 0x0000, 0xffe0); // fast mute
439 msp_writereg(av7110, MSP_WR_DSP, 0x0007, 0xffe0);
441 /* tune in desired frequency */
442 if (av7110->analog_tuner_flags & ANALOG_TUNER_VES1820) {
443 ves1820_set_tv_freq(dev, f->frequency);
444 } else if (av7110->analog_tuner_flags & ANALOG_TUNER_STV0297) {
445 stv0297_set_tv_freq(dev, f->frequency);
447 av7110->current_freq = f->frequency;
449 msp_writereg(av7110, MSP_WR_DSP, 0x0015, 0x003f); // start stereo detection
450 msp_writereg(av7110, MSP_WR_DSP, 0x0015, 0x0000);
451 msp_writereg(av7110, MSP_WR_DSP, 0x0000, 0x4f00); // loudspeaker + headphone
452 msp_writereg(av7110, MSP_WR_DSP, 0x0007, 0x4f00); // SCART 1 volume
453 return 0;
455 case VIDIOC_ENUMINPUT:
457 struct v4l2_input *i = arg;
459 dprintk(2, "VIDIOC_ENUMINPUT: %d\n", i->index);
461 if (av7110->analog_tuner_flags) {
462 if (i->index < 0 || i->index >= 4)
463 return -EINVAL;
464 } else {
465 if (i->index != 0)
466 return -EINVAL;
469 memcpy(i, &inputs[i->index], sizeof(struct v4l2_input));
471 return 0;
473 case VIDIOC_G_INPUT:
475 int *input = (int *)arg;
476 *input = av7110->current_input;
477 dprintk(2, "VIDIOC_G_INPUT: %d\n", *input);
478 return 0;
480 case VIDIOC_S_INPUT:
482 int input = *(int *)arg;
484 dprintk(2, "VIDIOC_S_INPUT: %d\n", input);
486 if (!av7110->analog_tuner_flags)
487 return 0;
489 if (input < 0 || input >= 4)
490 return -EINVAL;
492 av7110->current_input = input;
493 return av7110_dvb_c_switch(fh);
495 case VIDIOC_G_AUDIO:
497 struct v4l2_audio *a = arg;
499 dprintk(2, "VIDIOC_G_AUDIO: %d\n", a->index);
500 if (a->index != 0)
501 return -EINVAL;
502 memcpy(a, &msp3400_v4l2_audio, sizeof(struct v4l2_audio));
503 break;
505 case VIDIOC_S_AUDIO:
507 struct v4l2_audio *a = arg;
508 dprintk(2, "VIDIOC_S_AUDIO: %d\n", a->index);
509 break;
511 case VIDIOC_G_SLICED_VBI_CAP:
513 struct v4l2_sliced_vbi_cap *cap = arg;
514 dprintk(2, "VIDIOC_G_SLICED_VBI_CAP\n");
515 memset(cap, 0, sizeof *cap);
516 if (FW_VERSION(av7110->arm_app) >= 0x2623) {
517 cap->service_set = V4L2_SLICED_WSS_625;
518 cap->service_lines[0][23] = V4L2_SLICED_WSS_625;
520 break;
522 case VIDIOC_G_FMT:
524 struct v4l2_format *f = arg;
525 dprintk(2, "VIDIOC_G_FMT:\n");
526 if (f->type != V4L2_BUF_TYPE_SLICED_VBI_OUTPUT ||
527 FW_VERSION(av7110->arm_app) < 0x2623)
528 return -EAGAIN; /* handled by core driver */
529 memset(&f->fmt.sliced, 0, sizeof f->fmt.sliced);
530 if (av7110->wssMode) {
531 f->fmt.sliced.service_set = V4L2_SLICED_WSS_625;
532 f->fmt.sliced.service_lines[0][23] = V4L2_SLICED_WSS_625;
533 f->fmt.sliced.io_size = sizeof (struct v4l2_sliced_vbi_data);
535 break;
537 case VIDIOC_S_FMT:
539 struct v4l2_format *f = arg;
540 dprintk(2, "VIDIOC_S_FMT\n");
541 if (f->type != V4L2_BUF_TYPE_SLICED_VBI_OUTPUT ||
542 FW_VERSION(av7110->arm_app) < 0x2623)
543 return -EAGAIN; /* handled by core driver */
544 if (f->fmt.sliced.service_set != V4L2_SLICED_WSS_625 &&
545 f->fmt.sliced.service_lines[0][23] != V4L2_SLICED_WSS_625) {
546 memset(&f->fmt.sliced, 0, sizeof f->fmt.sliced);
547 /* WSS controlled by firmware */
548 av7110->wssMode = 0;
549 av7110->wssData = 0;
550 return av7110_fw_cmd(av7110, COMTYPE_ENCODER,
551 SetWSSConfig, 1, 0);
552 } else {
553 memset(&f->fmt.sliced, 0, sizeof f->fmt.sliced);
554 f->fmt.sliced.service_set = V4L2_SLICED_WSS_625;
555 f->fmt.sliced.service_lines[0][23] = V4L2_SLICED_WSS_625;
556 f->fmt.sliced.io_size = sizeof (struct v4l2_sliced_vbi_data);
557 /* WSS controlled by userspace */
558 av7110->wssMode = 1;
559 av7110->wssData = 0;
561 break;
563 default:
564 printk("no such ioctl\n");
565 return -ENOIOCTLCMD;
567 return 0;
570 static int av7110_vbi_reset(struct inode *inode, struct file *file)
572 struct saa7146_fh *fh = file->private_data;
573 struct saa7146_dev *dev = fh->dev;
574 struct av7110 *av7110 = (struct av7110*) dev->ext_priv;
576 dprintk(2, "%s\n", __FUNCTION__);
577 av7110->wssMode = 0;
578 av7110->wssData = 0;
579 if (FW_VERSION(av7110->arm_app) < 0x2623)
580 return 0;
581 else
582 return av7110_fw_cmd(av7110, COMTYPE_ENCODER, SetWSSConfig, 1, 0);
585 static ssize_t av7110_vbi_write(struct file *file, const char __user *data, size_t count, loff_t *ppos)
587 struct saa7146_fh *fh = file->private_data;
588 struct saa7146_dev *dev = fh->dev;
589 struct av7110 *av7110 = (struct av7110*) dev->ext_priv;
590 struct v4l2_sliced_vbi_data d;
591 int rc;
593 dprintk(2, "%s\n", __FUNCTION__);
594 if (FW_VERSION(av7110->arm_app) < 0x2623 || !av7110->wssMode || count != sizeof d)
595 return -EINVAL;
596 if (copy_from_user(&d, data, count))
597 return -EFAULT;
598 if ((d.id != 0 && d.id != V4L2_SLICED_WSS_625) || d.field != 0 || d.line != 23)
599 return -EINVAL;
600 if (d.id)
601 av7110->wssData = ((d.data[1] << 8) & 0x3f00) | d.data[0];
602 else
603 av7110->wssData = 0x8000;
604 rc = av7110_fw_cmd(av7110, COMTYPE_ENCODER, SetWSSConfig, 2, 1, av7110->wssData);
605 return (rc < 0) ? rc : count;
608 /****************************************************************************
609 * INITIALIZATION
610 ****************************************************************************/
612 static struct saa7146_extension_ioctls ioctls[] = {
613 { VIDIOC_ENUMINPUT, SAA7146_EXCLUSIVE },
614 { VIDIOC_G_INPUT, SAA7146_EXCLUSIVE },
615 { VIDIOC_S_INPUT, SAA7146_EXCLUSIVE },
616 { VIDIOC_G_FREQUENCY, SAA7146_EXCLUSIVE },
617 { VIDIOC_S_FREQUENCY, SAA7146_EXCLUSIVE },
618 { VIDIOC_G_TUNER, SAA7146_EXCLUSIVE },
619 { VIDIOC_S_TUNER, SAA7146_EXCLUSIVE },
620 { VIDIOC_G_AUDIO, SAA7146_EXCLUSIVE },
621 { VIDIOC_S_AUDIO, SAA7146_EXCLUSIVE },
622 { VIDIOC_G_SLICED_VBI_CAP, SAA7146_EXCLUSIVE },
623 { VIDIOC_G_FMT, SAA7146_BEFORE },
624 { VIDIOC_S_FMT, SAA7146_BEFORE },
625 { 0, 0 }
628 static u8 saa7113_init_regs[] = {
629 0x02, 0xd0,
630 0x03, 0x23,
631 0x04, 0x00,
632 0x05, 0x00,
633 0x06, 0xe9,
634 0x07, 0x0d,
635 0x08, 0x98,
636 0x09, 0x02,
637 0x0a, 0x80,
638 0x0b, 0x40,
639 0x0c, 0x40,
640 0x0d, 0x00,
641 0x0e, 0x01,
642 0x0f, 0x7c,
643 0x10, 0x48,
644 0x11, 0x0c,
645 0x12, 0x8b,
646 0x13, 0x1a,
647 0x14, 0x00,
648 0x15, 0x00,
649 0x16, 0x00,
650 0x17, 0x00,
651 0x18, 0x00,
652 0x19, 0x00,
653 0x1a, 0x00,
654 0x1b, 0x00,
655 0x1c, 0x00,
656 0x1d, 0x00,
657 0x1e, 0x00,
659 0x41, 0x77,
660 0x42, 0x77,
661 0x43, 0x77,
662 0x44, 0x77,
663 0x45, 0x77,
664 0x46, 0x77,
665 0x47, 0x77,
666 0x48, 0x77,
667 0x49, 0x77,
668 0x4a, 0x77,
669 0x4b, 0x77,
670 0x4c, 0x77,
671 0x4d, 0x77,
672 0x4e, 0x77,
673 0x4f, 0x77,
674 0x50, 0x77,
675 0x51, 0x77,
676 0x52, 0x77,
677 0x53, 0x77,
678 0x54, 0x77,
679 0x55, 0x77,
680 0x56, 0x77,
681 0x57, 0xff,
683 0xff
687 static struct saa7146_ext_vv av7110_vv_data_st;
688 static struct saa7146_ext_vv av7110_vv_data_c;
690 int av7110_init_analog_module(struct av7110 *av7110)
692 u16 version1, version2;
694 if (i2c_writereg(av7110, 0x80, 0x0, 0x80) == 1 &&
695 i2c_writereg(av7110, 0x80, 0x0, 0) == 1) {
696 printk("dvb-ttpci: DVB-C analog module @ card %d detected, initializing MSP3400\n",
697 av7110->dvb_adapter.num);
698 av7110->adac_type = DVB_ADAC_MSP34x0;
699 } else if (i2c_writereg(av7110, 0x84, 0x0, 0x80) == 1 &&
700 i2c_writereg(av7110, 0x84, 0x0, 0) == 1) {
701 printk("dvb-ttpci: DVB-C analog module @ card %d detected, initializing MSP3415\n",
702 av7110->dvb_adapter.num);
703 av7110->adac_type = DVB_ADAC_MSP34x5;
704 } else
705 return -ENODEV;
707 msleep(100); // the probing above resets the msp...
708 msp_readreg(av7110, MSP_RD_DSP, 0x001e, &version1);
709 msp_readreg(av7110, MSP_RD_DSP, 0x001f, &version2);
710 dprintk(1, "dvb-ttpci: @ card %d MSP34xx version 0x%04x 0x%04x\n",
711 av7110->dvb_adapter.num, version1, version2);
712 msp_writereg(av7110, MSP_WR_DSP, 0x0013, 0x0c00);
713 msp_writereg(av7110, MSP_WR_DSP, 0x0000, 0x7f00); // loudspeaker + headphone
714 msp_writereg(av7110, MSP_WR_DSP, 0x0008, 0x0220); // loudspeaker source
715 msp_writereg(av7110, MSP_WR_DSP, 0x0009, 0x0220); // headphone source
716 msp_writereg(av7110, MSP_WR_DSP, 0x0004, 0x7f00); // loudspeaker volume
717 msp_writereg(av7110, MSP_WR_DSP, 0x000a, 0x0220); // SCART 1 source
718 msp_writereg(av7110, MSP_WR_DSP, 0x0007, 0x7f00); // SCART 1 volume
719 msp_writereg(av7110, MSP_WR_DSP, 0x000d, 0x1900); // prescale SCART
721 if (i2c_writereg(av7110, 0x48, 0x01, 0x00)!=1) {
722 INFO(("saa7113 not accessible.\n"));
723 } else {
724 u8 *i = saa7113_init_regs;
726 if ((av7110->dev->pci->subsystem_vendor == 0x110a) && (av7110->dev->pci->subsystem_device == 0x0000)) {
727 /* Fujitsu/Siemens DVB-Cable */
728 av7110->analog_tuner_flags |= ANALOG_TUNER_VES1820;
729 } else if ((av7110->dev->pci->subsystem_vendor == 0x13c2) && (av7110->dev->pci->subsystem_device == 0x0002)) {
730 /* Hauppauge/TT DVB-C premium */
731 av7110->analog_tuner_flags |= ANALOG_TUNER_VES1820;
732 } else if ((av7110->dev->pci->subsystem_vendor == 0x13c2) && (av7110->dev->pci->subsystem_device == 0x000A)) {
733 /* Hauppauge/TT DVB-C premium */
734 av7110->analog_tuner_flags |= ANALOG_TUNER_STV0297;
737 /* setup for DVB by default */
738 if (av7110->analog_tuner_flags & ANALOG_TUNER_VES1820) {
739 if (ves1820_writereg(av7110->dev, 0x09, 0x0f, 0x20))
740 dprintk(1, "setting band in demodulator failed.\n");
741 } else if (av7110->analog_tuner_flags & ANALOG_TUNER_STV0297) {
742 saa7146_setgpio(av7110->dev, 1, SAA7146_GPIO_OUTLO); // TDA9819 pin9(STD)
743 saa7146_setgpio(av7110->dev, 3, SAA7146_GPIO_OUTLO); // TDA9819 pin30(VIF)
746 /* init the saa7113 */
747 while (*i != 0xff) {
748 if (i2c_writereg(av7110, 0x48, i[0], i[1]) != 1) {
749 dprintk(1, "saa7113 initialization failed @ card %d", av7110->dvb_adapter.num);
750 break;
752 i += 2;
754 /* setup msp for analog sound: B/G Dual-FM */
755 msp_writereg(av7110, MSP_WR_DEM, 0x00bb, 0x02d0); // AD_CV
756 msp_writereg(av7110, MSP_WR_DEM, 0x0001, 3); // FIR1
757 msp_writereg(av7110, MSP_WR_DEM, 0x0001, 18); // FIR1
758 msp_writereg(av7110, MSP_WR_DEM, 0x0001, 27); // FIR1
759 msp_writereg(av7110, MSP_WR_DEM, 0x0001, 48); // FIR1
760 msp_writereg(av7110, MSP_WR_DEM, 0x0001, 66); // FIR1
761 msp_writereg(av7110, MSP_WR_DEM, 0x0001, 72); // FIR1
762 msp_writereg(av7110, MSP_WR_DEM, 0x0005, 4); // FIR2
763 msp_writereg(av7110, MSP_WR_DEM, 0x0005, 64); // FIR2
764 msp_writereg(av7110, MSP_WR_DEM, 0x0005, 0); // FIR2
765 msp_writereg(av7110, MSP_WR_DEM, 0x0005, 3); // FIR2
766 msp_writereg(av7110, MSP_WR_DEM, 0x0005, 18); // FIR2
767 msp_writereg(av7110, MSP_WR_DEM, 0x0005, 27); // FIR2
768 msp_writereg(av7110, MSP_WR_DEM, 0x0005, 48); // FIR2
769 msp_writereg(av7110, MSP_WR_DEM, 0x0005, 66); // FIR2
770 msp_writereg(av7110, MSP_WR_DEM, 0x0005, 72); // FIR2
771 msp_writereg(av7110, MSP_WR_DEM, 0x0083, 0xa000); // MODE_REG
772 msp_writereg(av7110, MSP_WR_DEM, 0x0093, 0x00aa); // DCO1_LO 5.74MHz
773 msp_writereg(av7110, MSP_WR_DEM, 0x009b, 0x04fc); // DCO1_HI
774 msp_writereg(av7110, MSP_WR_DEM, 0x00a3, 0x038e); // DCO2_LO 5.5MHz
775 msp_writereg(av7110, MSP_WR_DEM, 0x00ab, 0x04c6); // DCO2_HI
776 msp_writereg(av7110, MSP_WR_DEM, 0x0056, 0); // LOAD_REG 1/2
779 memcpy(standard, dvb_standard, sizeof(struct saa7146_standard) * 2);
780 /* set dd1 stream a & b */
781 saa7146_write(av7110->dev, DD1_STREAM_B, 0x00000000);
782 saa7146_write(av7110->dev, DD1_INIT, 0x03000700);
783 saa7146_write(av7110->dev, MC2, (MASK_09 | MASK_25 | MASK_10 | MASK_26));
785 return 0;
788 int av7110_init_v4l(struct av7110 *av7110)
790 struct saa7146_dev* dev = av7110->dev;
791 int ret;
793 /* special case DVB-C: these cards have an analog tuner
794 plus need some special handling, so we have separate
795 saa7146_ext_vv data for these... */
796 if (av7110->analog_tuner_flags)
797 ret = saa7146_vv_init(dev, &av7110_vv_data_c);
798 else
799 ret = saa7146_vv_init(dev, &av7110_vv_data_st);
801 if (ret) {
802 ERR(("cannot init capture device. skipping.\n"));
803 return -ENODEV;
806 if (saa7146_register_device(&av7110->v4l_dev, dev, "av7110", VFL_TYPE_GRABBER)) {
807 ERR(("cannot register capture device. skipping.\n"));
808 saa7146_vv_release(dev);
809 return -ENODEV;
811 if (saa7146_register_device(&av7110->vbi_dev, dev, "av7110", VFL_TYPE_VBI))
812 ERR(("cannot register vbi v4l2 device. skipping.\n"));
813 return 0;
816 int av7110_exit_v4l(struct av7110 *av7110)
818 struct saa7146_dev* dev = av7110->dev;
820 saa7146_unregister_device(&av7110->v4l_dev, av7110->dev);
821 saa7146_unregister_device(&av7110->vbi_dev, av7110->dev);
823 saa7146_vv_release(dev);
825 return 0;
830 /* FIXME: these values are experimental values that look better than the
831 values from the latest "official" driver -- at least for me... (MiHu) */
832 static struct saa7146_standard standard[] = {
834 .name = "PAL", .id = V4L2_STD_PAL_BG,
835 .v_offset = 0x15, .v_field = 288,
836 .h_offset = 0x48, .h_pixels = 708,
837 .v_max_out = 576, .h_max_out = 768,
838 }, {
839 .name = "NTSC", .id = V4L2_STD_NTSC,
840 .v_offset = 0x10, .v_field = 244,
841 .h_offset = 0x40, .h_pixels = 708,
842 .v_max_out = 480, .h_max_out = 640,
846 static struct saa7146_standard analog_standard[] = {
848 .name = "PAL", .id = V4L2_STD_PAL_BG,
849 .v_offset = 0x1b, .v_field = 288,
850 .h_offset = 0x08, .h_pixels = 708,
851 .v_max_out = 576, .h_max_out = 768,
852 }, {
853 .name = "NTSC", .id = V4L2_STD_NTSC,
854 .v_offset = 0x10, .v_field = 244,
855 .h_offset = 0x40, .h_pixels = 708,
856 .v_max_out = 480, .h_max_out = 640,
860 static struct saa7146_standard dvb_standard[] = {
862 .name = "PAL", .id = V4L2_STD_PAL_BG,
863 .v_offset = 0x14, .v_field = 288,
864 .h_offset = 0x48, .h_pixels = 708,
865 .v_max_out = 576, .h_max_out = 768,
866 }, {
867 .name = "NTSC", .id = V4L2_STD_NTSC,
868 .v_offset = 0x10, .v_field = 244,
869 .h_offset = 0x40, .h_pixels = 708,
870 .v_max_out = 480, .h_max_out = 640,
874 static int std_callback(struct saa7146_dev* dev, struct saa7146_standard *std)
876 struct av7110 *av7110 = (struct av7110*) dev->ext_priv;
878 if (std->id & V4L2_STD_PAL) {
879 av7110->vidmode = AV7110_VIDEO_MODE_PAL;
880 av7110_set_vidmode(av7110, av7110->vidmode);
882 else if (std->id & V4L2_STD_NTSC) {
883 av7110->vidmode = AV7110_VIDEO_MODE_NTSC;
884 av7110_set_vidmode(av7110, av7110->vidmode);
886 else
887 return -1;
889 return 0;
893 static struct saa7146_ext_vv av7110_vv_data_st = {
894 .inputs = 1,
895 .audios = 1,
896 .capabilities = V4L2_CAP_SLICED_VBI_OUTPUT,
897 .flags = 0,
899 .stds = &standard[0],
900 .num_stds = ARRAY_SIZE(standard),
901 .std_callback = &std_callback,
903 .ioctls = &ioctls[0],
904 .ioctl = av7110_ioctl,
906 .vbi_fops.open = av7110_vbi_reset,
907 .vbi_fops.release = av7110_vbi_reset,
908 .vbi_fops.write = av7110_vbi_write,
911 static struct saa7146_ext_vv av7110_vv_data_c = {
912 .inputs = 1,
913 .audios = 1,
914 .capabilities = V4L2_CAP_TUNER | V4L2_CAP_SLICED_VBI_OUTPUT,
915 .flags = SAA7146_USE_PORT_B_FOR_VBI,
917 .stds = &standard[0],
918 .num_stds = ARRAY_SIZE(standard),
919 .std_callback = &std_callback,
921 .ioctls = &ioctls[0],
922 .ioctl = av7110_ioctl,
924 .vbi_fops.open = av7110_vbi_reset,
925 .vbi_fops.release = av7110_vbi_reset,
926 .vbi_fops.write = av7110_vbi_write,