projects / deliverable / linux.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
V4L/DVB (10138): v4l2-ioctl: change to long return type to match unlocked_ioctl.
[deliverable/linux.git] / drivers / media / dvb / ttpci / av7110_v4l.c
CommitLineData
1da177e4
LT		 1/*
2 * av7110_v4l.c: av7110 video4linux interface for DVB and Siemens DVB-C analog module
3 *
4 * Copyright (C) 1999-2002 Ralph Metzler
5 * & Marcus Metzler for convergence integrated media GmbH
6 *
7 * originally based on code by:
8 * Copyright (C) 1998,1999 Christian Theiss <mistert@rz.fh-augsburg.de>
9 *
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.
14 *
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.
19 *
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
24 *
25 * the project's page is at http://www.linuxtv.org/dvb/
26 */
27
28#include <linux/kernel.h>
1da177e4
LT		 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>
1da177e4
LT		 34
35#include "av7110.h"
36#include "av7110_hw.h"
37#include "av7110_av.h"
38
39int msp_writereg(struct av7110 *av7110, u8 dev, u16 reg, u16 val)
40{
41 u8 msg[5] = { dev, reg >> 8, reg & 0xff, val >> 8 , val & 0xff };
61391e04
TK		 42 struct i2c_msg msgs = { .flags = 0, .len = 5, .buf = msg };
43
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;
53 }
1da177e4
LT		 54
55 if (i2c_transfer(&av7110->i2c_adap, &msgs, 1) != 1) {
56 dprintk(1, "dvb-ttpci: failed @ card %d, %u = %u\n",
fdc53a6d 57 av7110->dvb_adapter.num, reg, val);
1da177e4
LT		 58 return -EIO;
59 }
60 return 0;
61}
62
d91b730d 63static int msp_readreg(struct av7110 *av7110, u8 dev, u16 reg, u16 *val)
1da177e4
LT		 64{
65 u8 msg1[3] = { dev, reg >> 8, reg & 0xff };
66 u8 msg2[2];
67 struct i2c_msg msgs[2] = {
61391e04
TK		 68 { .flags = 0 , .len = 3, .buf = msg1 },
69 { .flags = I2C_M_RD, .len = 2, .buf = msg2 }
1da177e4
LT		 70 };
71
61391e04
TK		 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;
83 }
84
1da177e4
LT		 85 if (i2c_transfer(&av7110->i2c_adap, &msgs[0], 2) != 2) {
86 dprintk(1, "dvb-ttpci: failed @ card %d, %u\n",
fdc53a6d 87 av7110->dvb_adapter.num, reg);
1da177e4
LT		 88 return -EIO;
89 }
90 *val = (msg2[0] << 8) | msg2[1];
91 return 0;
92}
93
f63f5346 94static struct v4l2_input inputs[4] = {
1da177e4
LT		 95 {
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,
f63f5346 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,
1da177e4
LT		 127 }
128};
129
130static int ves1820_writereg(struct saa7146_dev *dev, u8 addr, u8 reg, u8 data)
131{
36c15f8e 132 struct av7110 *av7110 = dev->ext_priv;
1da177e4
LT		 133 u8 buf[] = { 0x00, reg, data };
134 struct i2c_msg msg = { .addr = addr, .flags = 0, .buf = buf, .len = 3 };
135
136 dprintk(4, "dev: %p\n", dev);
137
36c15f8e 138 if (1 != i2c_transfer(&av7110->i2c_adap, &msg, 1))
1da177e4
LT		 139 return -1;
140 return 0;
141}
142
1da177e4
LT		 143static int tuner_write(struct saa7146_dev *dev, u8 addr, u8 data [4])
144{
36c15f8e 145 struct av7110 *av7110 = dev->ext_priv;
1da177e4
LT		 146 struct i2c_msg msg = { .addr = addr, .flags = 0, .buf = data, .len = 4 };
147
148 dprintk(4, "dev: %p\n", dev);
149
36c15f8e 150 if (1 != i2c_transfer(&av7110->i2c_adap, &msg, 1))
1da177e4
LT		 151 return -1;
152 return 0;
153}
154
155static int ves1820_set_tv_freq(struct saa7146_dev *dev, u32 freq)
156{
157 u32 div;
158 u8 config;
159 u8 buf[4];
160
161 dprintk(4, "freq: 0x%08x\n", freq);
162
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;
166
167 buf[0] = (div >> 8) & 0x7f;
168 buf[1] = div & 0xff;
169 buf[2] = 0x8e;
170
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;
178
179 buf[3] = config;
180
181 return tuner_write(dev, 0x61, buf);
182}
183
184static int stv0297_set_tv_freq(struct saa7146_dev *dev, u32 freq)
185{
89e4d59f 186 struct av7110 *av7110 = (struct av7110*)dev->ext_priv;
1da177e4
LT		 187 u32 div;
188 u8 data[4];
189
190 div = (freq + 38900000 + 31250) / 62500;
191
192 data[0] = (div >> 8) & 0x7f;
193 data[1] = div & 0xff;
194 data[2] = 0xce;
195
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;
206
89e4d59f
MS		 207 if (av7110->fe->ops.i2c_gate_ctrl)
208 av7110->fe->ops.i2c_gate_ctrl(av7110->fe, 1);
1da177e4
LT		 209 return tuner_write(dev, 0x63, data);
210}
211
212
213
214static struct saa7146_standard analog_standard[];
215static struct saa7146_standard dvb_standard[];
216static struct saa7146_standard standard[];
217
218static struct v4l2_audio msp3400_v4l2_audio = {
219 .index = 0,
220 .name = "Television",
221 .capability = V4L2_AUDCAP_STEREO
222};
223
224static int av7110_dvb_c_switch(struct saa7146_fh *fh)
225{
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;
231
232 dprintk(4, "%p\n", av7110);
233
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;
240 }
241 }
242
243 if (0 != av7110->current_input) {
f63f5346 244 dprintk(1, "switching to analog TV:\n");
1da177e4
LT		 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);
1da177e4 249
f63f5346 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
259
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) {
6a857747
MS		 264 saa7146_setgpio(dev, 1, SAA7146_GPIO_OUTHI); // TDA9819 pin9(STD)
265 saa7146_setgpio(dev, 3, SAA7146_GPIO_OUTHI); // TDA9819 pin30(VIF)
f63f5346 266 }
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");
1da177e4
LT		 282 }
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
295
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) {
6a857747
MS		 300 saa7146_setgpio(dev, 1, SAA7146_GPIO_OUTLO); // TDA9819 pin9(STD)
301 saa7146_setgpio(dev, 3, SAA7146_GPIO_OUTLO); // TDA9819 pin30(VIF)
1da177e4
LT		 302 }
303 }
304
305 /* hmm, this does not do anything!? */
306 if (av7110_fw_cmd(av7110, COMTYPE_AUDIODAC, ADSwitch, 1, adswitch))
307 dprintk(1, "ADSwitch error\n");
308
309 saa7146_set_hps_source_and_sync(dev, source, sync);
310
311 if (vv->ov_suspend != NULL) {
312 saa7146_start_preview(vv->ov_suspend);
313 vv->ov_suspend = NULL;
314 }
315
316 return 0;
317}
318
069b7479 319static long av7110_ioctl(struct saa7146_fh *fh, unsigned int cmd, void *arg)
1da177e4
LT		 320{
321 struct saa7146_dev *dev = fh->dev;
322 struct av7110 *av7110 = (struct av7110*) dev->ext_priv;
323 dprintk(4, "saa7146_dev: %p\n", dev);
324
325 switch (cmd) {
326 case VIDIOC_G_TUNER:
327 {
328 struct v4l2_tuner *t = arg;
329 u16 stereo_det;
330 s8 stereo;
331
332 dprintk(2, "VIDIOC_G_TUNER: %d\n", t->index);
333
334 if (!av7110->analog_tuner_flags || t->index != 0)
335 return -EINVAL;
336
337 memset(t, 0, sizeof(*t));
804b4458 338 strcpy((char *)t->name, "Television");
1da177e4
LT		 339
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;
348
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);
1da177e4
LT		 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;
359 }
360 else if (stereo < -0x10) {
f63f5346 361 /* bilingual */
1da177e4
LT		 362 t->rxsubchans = V4L2_TUNER_SUB_LANG1 | V4L2_TUNER_SUB_LANG2;
363 t->audmode = V4L2_TUNER_MODE_LANG1;
364 }
365 else /* mono */
366 t->rxsubchans = V4L2_TUNER_SUB_MONO;
367
368 return 0;
369 }
370 case VIDIOC_S_TUNER:
371 {
372 struct v4l2_tuner *t = arg;
373 u16 fm_matrix, src;
374 dprintk(2, "VIDIOC_S_TUNER: %d\n", t->index);
375
376 if (!av7110->analog_tuner_flags || av7110->current_input != 1)
377 return -EINVAL;
378
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;
301e22d6
HV		 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;
1da177e4
LT		 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;
f63f5346 400 default: /* case V4L2_TUNER_MODE_MONO: */
1da177e4
LT		 401 dprintk(2, "VIDIOC_S_TUNER: TDA9840_SET_MONO\n");
402 fm_matrix = 0x3000; // mono
403 src = 0x0030;
404 break;
405 }
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;
411 }
412 case VIDIOC_G_FREQUENCY:
413 {
414 struct v4l2_frequency *f = arg;
415
416 dprintk(2, "VIDIOC_G_FREQ: freq:0x%08x.\n", f->frequency);
417
418 if (!av7110->analog_tuner_flags || av7110->current_input != 1)
419 return -EINVAL;
420
421 memset(f, 0, sizeof(*f));
422 f->type = V4L2_TUNER_ANALOG_TV;
423 f->frequency = av7110->current_freq;
424 return 0;
425 }
426 case VIDIOC_S_FREQUENCY:
427 {
428 struct v4l2_frequency *f = arg;
429
430 dprintk(2, "VIDIOC_S_FREQUENCY: freq:0x%08x.\n", f->frequency);
431
432 if (!av7110->analog_tuner_flags || av7110->current_input != 1)
433 return -EINVAL;
434
435 if (V4L2_TUNER_ANALOG_TV != f->type)
436 return -EINVAL;
437
438 msp_writereg(av7110, MSP_WR_DSP, 0x0000, 0xffe0); // fast mute
439 msp_writereg(av7110, MSP_WR_DSP, 0x0007, 0xffe0);
440
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);
446 }
447 av7110->current_freq = f->frequency;
448
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;
454 }
455 case VIDIOC_ENUMINPUT:
456 {
457 struct v4l2_input *i = arg;
458
459 dprintk(2, "VIDIOC_ENUMINPUT: %d\n", i->index);
460
461 if (av7110->analog_tuner_flags) {
f63f5346 462 if (i->index < 0 || i->index >= 4)
1da177e4
LT		 463 return -EINVAL;
464 } else {
465 if (i->index != 0)
466 return -EINVAL;
467 }
468
469 memcpy(i, &inputs[i->index], sizeof(struct v4l2_input));
470
471 return 0;
472 }
473 case VIDIOC_G_INPUT:
474 {
475 int *input = (int *)arg;
476 *input = av7110->current_input;
477 dprintk(2, "VIDIOC_G_INPUT: %d\n", *input);
478 return 0;
479 }
480 case VIDIOC_S_INPUT:
481 {
482 int input = *(int *)arg;
483
484 dprintk(2, "VIDIOC_S_INPUT: %d\n", input);
485
486 if (!av7110->analog_tuner_flags)
487 return 0;
488
f63f5346 489 if (input < 0 || input >= 4)
1da177e4
LT		 490 return -EINVAL;
491
1da177e4
LT		 492 av7110->current_input = input;
493 return av7110_dvb_c_switch(fh);
494 }
495 case VIDIOC_G_AUDIO:
496 {
497 struct v4l2_audio *a = arg;
498
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;
504 }
505 case VIDIOC_S_AUDIO:
506 {
507 struct v4l2_audio *a = arg;
508 dprintk(2, "VIDIOC_S_AUDIO: %d\n", a->index);
509 break;
510 }
5b0fa4ff
OE		 511 case VIDIOC_G_SLICED_VBI_CAP:
512 {
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;
519 }
520 break;
521 }
522 case VIDIOC_G_FMT:
523 {
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);
534 }
535 break;
536 }
537 case VIDIOC_S_FMT:
538 {
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;
560 }
561 break;
562 }
1da177e4
LT		 563 default:
564 printk("no such ioctl\n");
565 return -ENOIOCTLCMD;
566 }
567 return 0;
568}
569
bec43661 570static int av7110_vbi_reset(struct file *file)
5b0fa4ff
OE		 571{
572 struct saa7146_fh *fh = file->private_data;
573 struct saa7146_dev *dev = fh->dev;
574 struct av7110 *av7110 = (struct av7110*) dev->ext_priv;
575
3ca7fc84 576 dprintk(2, "%s\n", __func__);
5b0fa4ff
OE		 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);
583}
584
585static ssize_t av7110_vbi_write(struct file *file, const char __user *data, size_t count, loff_t *ppos)
586{
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;
592
3ca7fc84 593 dprintk(2, "%s\n", __func__);
5b0fa4ff
OE		 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;
4caba426 600 if (d.id)
5b0fa4ff 601 av7110->wssData = ((d.data[1] << 8) & 0x3f00) | d.data[0];
4caba426
OE		 602 else
603 av7110->wssData = 0x8000;
604 rc = av7110_fw_cmd(av7110, COMTYPE_ENCODER, SetWSSConfig, 2, 1, av7110->wssData);
5b0fa4ff
OE		 605 return (rc < 0) ? rc : count;
606}
1da177e4
LT		 607
608/****************************************************************************
609 * INITIALIZATION
610 ****************************************************************************/
611
612static 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 },
5b0fa4ff
OE		 622 { VIDIOC_G_SLICED_VBI_CAP, SAA7146_EXCLUSIVE },
623 { VIDIOC_G_FMT, SAA7146_BEFORE },
624 { VIDIOC_S_FMT, SAA7146_BEFORE },
1da177e4
LT		 625 { 0, 0 }
626};
627
628static 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,
658
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,
682
683 0xff
684};
685
686
687static struct saa7146_ext_vv av7110_vv_data_st;
688static struct saa7146_ext_vv av7110_vv_data_c;
689
690int av7110_init_analog_module(struct av7110 *av7110)
691{
692 u16 version1, version2;
693
61391e04
TK		 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
1da177e4
LT		 705 return -ENODEV;
706
1da177e4
LT		 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);
61391e04 710 dprintk(1, "dvb-ttpci: @ card %d MSP34xx version 0x%04x 0x%04x\n",
fdc53a6d 711 av7110->dvb_adapter.num, version1, version2);
1da177e4
LT		 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
61391e04 719 msp_writereg(av7110, MSP_WR_DSP, 0x000d, 0x1900); // prescale SCART
1da177e4
LT		 720
721 if (i2c_writereg(av7110, 0x48, 0x01, 0x00)!=1) {
722 INFO(("saa7113 not accessible.\n"));
723 } else {
724 u8 *i = saa7113_init_regs;
725
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;
735 }
736
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) {
6a857747
MS		 742 saa7146_setgpio(av7110->dev, 1, SAA7146_GPIO_OUTLO); // TDA9819 pin9(STD)
743 saa7146_setgpio(av7110->dev, 3, SAA7146_GPIO_OUTLO); // TDA9819 pin30(VIF)
1da177e4
LT		 744 }
745
746 /* init the saa7113 */
747 while (*i != 0xff) {
748 if (i2c_writereg(av7110, 0x48, i[0], i[1]) != 1) {
fdc53a6d 749 dprintk(1, "saa7113 initialization failed @ card %d", av7110->dvb_adapter.num);
1da177e4
LT		 750 break;
751 }
752 i += 2;
753 }
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
777 }
778
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));
784
785 return 0;
786}
787
788int av7110_init_v4l(struct av7110 *av7110)
789{
790 struct saa7146_dev* dev = av7110->dev;
791 int ret;
792
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);
800
801 if (ret) {
802 ERR(("cannot init capture device. skipping.\n"));
803 return -ENODEV;
804 }
805
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;
810 }
7857735b 811 if (saa7146_register_device(&av7110->vbi_dev, dev, "av7110", VFL_TYPE_VBI))
5b0fa4ff 812 ERR(("cannot register vbi v4l2 device. skipping.\n"));
1da177e4
LT		 813 return 0;
814}
815
816int av7110_exit_v4l(struct av7110 *av7110)
817{
e19c55ff
MS		 818 struct saa7146_dev* dev = av7110->dev;
819
1da177e4 820 saa7146_unregister_device(&av7110->v4l_dev, av7110->dev);
7857735b 821 saa7146_unregister_device(&av7110->vbi_dev, av7110->dev);
e19c55ff
MS		 822
823 saa7146_vv_release(dev);
824
1da177e4
LT		 825 return 0;
826}
827
828
829
830/* FIXME: these values are experimental values that look better than the
831 values from the latest "official" driver -- at least for me... (MiHu) */
832static struct saa7146_standard standard[] = {
833 {
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,
843 }
844};
845
846static struct saa7146_standard analog_standard[] = {
847 {
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,
857 }
858};
859
860static struct saa7146_standard dvb_standard[] = {
861 {
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,
871 }
872};
873
874static int std_callback(struct saa7146_dev* dev, struct saa7146_standard *std)
875{
876 struct av7110 *av7110 = (struct av7110*) dev->ext_priv;
877
4ab3f08b 878 if (std->id & V4L2_STD_PAL) {
58a44040 879 av7110->vidmode = AV7110_VIDEO_MODE_PAL;
1da177e4
LT		 880 av7110_set_vidmode(av7110, av7110->vidmode);
881 }
4ab3f08b 882 else if (std->id & V4L2_STD_NTSC) {
58a44040 883 av7110->vidmode = AV7110_VIDEO_MODE_NTSC;
1da177e4
LT		 884 av7110_set_vidmode(av7110, av7110->vidmode);
885 }
886 else
887 return -1;
888
889 return 0;
890}
891
892
893static struct saa7146_ext_vv av7110_vv_data_st = {
894 .inputs = 1,
895 .audios = 1,
5b0fa4ff 896 .capabilities = V4L2_CAP_SLICED_VBI_OUTPUT,
1da177e4
LT		 897 .flags = 0,
898
899 .stds = &standard[0],
900 .num_stds = ARRAY_SIZE(standard),
901 .std_callback = &std_callback,
902
903 .ioctls = &ioctls[0],
904 .ioctl = av7110_ioctl,
5b0fa4ff
OE		 905
906 .vbi_fops.open = av7110_vbi_reset,
907 .vbi_fops.release = av7110_vbi_reset,
908 .vbi_fops.write = av7110_vbi_write,
1da177e4
LT		 909};
910
911static struct saa7146_ext_vv av7110_vv_data_c = {
912 .inputs = 1,
913 .audios = 1,
d7e7a156 914 .capabilities = V4L2_CAP_TUNER | V4L2_CAP_SLICED_VBI_OUTPUT,
1da177e4
LT		 915 .flags = SAA7146_USE_PORT_B_FOR_VBI,
916
917 .stds = &standard[0],
918 .num_stds = ARRAY_SIZE(standard),
919 .std_callback = &std_callback,
920
921 .ioctls = &ioctls[0],
922 .ioctl = av7110_ioctl,
5b0fa4ff
OE		 923
924 .vbi_fops.open = av7110_vbi_reset,
925 .vbi_fops.release = av7110_vbi_reset,
926 .vbi_fops.write = av7110_vbi_write,
1da177e4
LT		 927};
928
Linux kernel - Deliverables
This page took 0.700595 seconds and 5 git commands to generate.