projects / deliverable / linux.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
Merge drm-fixes into drm-next.
[deliverable/linux.git] / drivers / media / pci / ttpci / av7110.c
CommitLineData
1da177e4
LT		 1/*
2 * driver for the SAA7146 based AV110 cards (like the Fujitsu-Siemens DVB)
3 * av7110.c: initialization and demux stuff
4 *
5 * Copyright (C) 1999-2002 Ralph Metzler
6 * & Marcus Metzler for convergence integrated media GmbH
7 *
8 * originally based on code by:
9 * Copyright (C) 1998,1999 Christian Theiss <mistert@rz.fh-augsburg.de>
10 *
11 * This program is free software; you can redistribute it and/or
12 * modify it under the terms of the GNU General Public License
13 * as published by the Free Software Foundation; either version 2
14 * of the License, or (at your option) any later version.
15 *
16 *
17 * This program is distributed in the hope that it will be useful,
18 * but WITHOUT ANY WARRANTY; without even the implied warranty of
19 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
20 * GNU General Public License for more details.
21 *
22 *
23 * You should have received a copy of the GNU General Public License
24 * along with this program; if not, write to the Free Software
25 * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
26 * Or, point your browser to http://www.gnu.org/copyleft/gpl.html
27 *
28 *
991ce92f 29 * the project's page is at https://linuxtv.org
1da177e4
LT		 30 */
31
32
1da177e4
LT		 33#include <linux/module.h>
34#include <linux/kmod.h>
35#include <linux/delay.h>
36#include <linux/fs.h>
37#include <linux/timer.h>
38#include <linux/poll.h>
1da177e4
LT		 39
40#include <linux/kernel.h>
1da177e4
LT		 41#include <linux/sched.h>
42#include <linux/types.h>
43#include <linux/fcntl.h>
44#include <linux/interrupt.h>
45#include <linux/string.h>
46#include <linux/pci.h>
47#include <linux/vmalloc.h>
48#include <linux/firmware.h>
49#include <linux/crc32.h>
50#include <linux/i2c.h>
8eec1429 51#include <linux/kthread.h>
5a0e3ad6 52#include <linux/slab.h>
3e085629 53#include <asm/unaligned.h>
1a651a00 54#include <asm/byteorder.h>
1da177e4 55
1da177e4
LT		 56
57#include <linux/dvb/frontend.h>
58
59#include "dvb_frontend.h"
60
61#include "ttpci-eeprom.h"
62#include "av7110.h"
63#include "av7110_hw.h"
64#include "av7110_av.h"
65#include "av7110_ca.h"
66#include "av7110_ipack.h"
67
db5d91eb
OE		 68#include "bsbe1.h"
69#include "lnbp21.h"
265366e8 70#include "bsru6.h"
db5d91eb 71
1da177e4
LT		 72#define TS_WIDTH 376
73#define TS_HEIGHT 512
74#define TS_BUFLEN (TS_WIDTH*TS_HEIGHT)
75#define TS_MAX_PACKETS (TS_BUFLEN/TS_SIZE)
76
77
78int av7110_debug;
79
80static int vidmode = CVBS_RGB_OUT;
81static int pids_off;
82static int adac = DVB_ADAC_TI;
83static int hw_sections;
84static int rgb_on;
85static int volume = 255;
a5ed425c 86static int budgetpatch;
4caba426
OE		 87static int wss_cfg_4_3 = 0x4008;
88static int wss_cfg_16_9 = 0x0007;
2f03ee8e 89static int tv_standard;
9e615eac 90static int full_ts;
1da177e4
LT		 91
92module_param_named(debug, av7110_debug, int, 0644);
93MODULE_PARM_DESC(debug, "debug level (bitmask, default 0)");
94module_param(vidmode, int, 0444);
95MODULE_PARM_DESC(vidmode,"analog video out: 0 off, 1 CVBS+RGB (default), 2 CVBS+YC, 3 YC");
96module_param(pids_off, int, 0444);
97MODULE_PARM_DESC(pids_off,"clear video/audio/PCR PID filters when demux is closed");
98module_param(adac, int, 0444);
99MODULE_PARM_DESC(adac,"audio DAC type: 0 TI, 1 CRYSTAL, 2 MSP (use if autodetection fails)");
100module_param(hw_sections, int, 0444);
101MODULE_PARM_DESC(hw_sections, "0 use software section filter, 1 use hardware");
102module_param(rgb_on, int, 0444);
103MODULE_PARM_DESC(rgb_on, "For Siemens DVB-C cards only: Enable RGB control"
104 " signal on SCART pin 16 to switch SCART video mode from CVBS to RGB");
105module_param(volume, int, 0444);
106MODULE_PARM_DESC(volume, "initial volume: default 255 (range 0-255)");
107module_param(budgetpatch, int, 0444);
108MODULE_PARM_DESC(budgetpatch, "use budget-patch hardware modification: default 0 (0 no, 1 autodetect, 2 always)");
9e615eac
OE		 109module_param(full_ts, int, 0444);
110MODULE_PARM_DESC(full_ts, "enable code for full-ts hardware modification: 0 disable (default), 1 enable");
4caba426
OE		 111module_param(wss_cfg_4_3, int, 0444);
112MODULE_PARM_DESC(wss_cfg_4_3, "WSS 4:3 - default 0x4008 - bit 15: disable, 14: burst mode, 13..0: wss data");
113module_param(wss_cfg_16_9, int, 0444);
114MODULE_PARM_DESC(wss_cfg_16_9, "WSS 16:9 - default 0x0007 - bit 15: disable, 14: burst mode, 13..0: wss data");
2f03ee8e 115module_param(tv_standard, int, 0444);
116MODULE_PARM_DESC(tv_standard, "TV standard: 0 PAL (default), 1 NTSC");
1da177e4 117
78e92006
JG		 118DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr);
119
1da177e4 120static void restart_feeds(struct av7110 *av7110);
9e615eac
OE		 121static int budget_start_feed(struct dvb_demux_feed *feed);
122static int budget_stop_feed(struct dvb_demux_feed *feed);
1da177e4 123
a5ed425c 124static int av7110_num;
1da177e4
LT		 125
126#define FE_FUNC_OVERRIDE(fe_func, av7110_copy, av7110_func) \
127{\
128 if (fe_func != NULL) { \
129 av7110_copy = fe_func; \
130 fe_func = av7110_func; \
131 } \
132}
133
134
135static void init_av7110_av(struct av7110 *av7110)
136{
ce18a223 137 int ret;
1da177e4
LT		 138 struct saa7146_dev *dev = av7110->dev;
139
140 /* set internal volume control to maximum */
141 av7110->adac_type = DVB_ADAC_TI;
ce18a223 142 ret = av7110_set_volume(av7110, av7110->mixer.volume_left, av7110->mixer.volume_right);
7a2fa90f 143 if (ret < 0)
ce18a223 144 printk("dvb-ttpci:cannot set internal volume to maximum:%d\n",ret);
1da177e4 145
defd574e
OE		 146 ret = av7110_fw_cmd(av7110, COMTYPE_ENCODER, SetMonitorType,
147 1, (u16) av7110->display_ar);
148 if (ret < 0)
149 printk("dvb-ttpci: unable to set aspect ratio\n");
150 ret = av7110_fw_cmd(av7110, COMTYPE_ENCODER, SetPanScanType,
151 1, av7110->display_panscan);
152 if (ret < 0)
153 printk("dvb-ttpci: unable to set pan scan\n");
154
4caba426
OE		 155 ret = av7110_fw_cmd(av7110, COMTYPE_ENCODER, SetWSSConfig, 2, 2, wss_cfg_4_3);
156 if (ret < 0)
157 printk("dvb-ttpci: unable to configure 4:3 wss\n");
158 ret = av7110_fw_cmd(av7110, COMTYPE_ENCODER, SetWSSConfig, 2, 3, wss_cfg_16_9);
159 if (ret < 0)
160 printk("dvb-ttpci: unable to configure 16:9 wss\n");
161
ce18a223 162 ret = av7710_set_video_mode(av7110, vidmode);
7a2fa90f 163 if (ret < 0)
ce18a223 164 printk("dvb-ttpci:cannot set video mode:%d\n",ret);
1da177e4
LT		 165
166 /* handle different card types */
167 /* remaining inits according to card and frontend type */
168 av7110->analog_tuner_flags = 0;
169 av7110->current_input = 0;
61391e04 170 if (dev->pci->subsystem_vendor == 0x13c2 && dev->pci->subsystem_device == 0x000a)
1c13b95c 171 av7110_fw_cmd(av7110, COMTYPE_AUDIODAC, ADSwitch, 1, 0); // SPDIF on
61391e04 172 if (i2c_writereg(av7110, 0x20, 0x00, 0x00) == 1) {
1da177e4 173 printk ("dvb-ttpci: Crystal audio DAC @ card %d detected\n",
fdc53a6d 174 av7110->dvb_adapter.num);
1da177e4
LT		 175 av7110->adac_type = DVB_ADAC_CRYSTAL;
176 i2c_writereg(av7110, 0x20, 0x01, 0xd2);
177 i2c_writereg(av7110, 0x20, 0x02, 0x49);
178 i2c_writereg(av7110, 0x20, 0x03, 0x00);
179 i2c_writereg(av7110, 0x20, 0x04, 0x00);
180
181 /**
182 * some special handling for the Siemens DVB-C cards...
183 */
184 } else if (0 == av7110_init_analog_module(av7110)) {
185 /* done. */
186 }
187 else if (dev->pci->subsystem_vendor == 0x110a) {
188 printk("dvb-ttpci: DVB-C w/o analog module @ card %d detected\n",
fdc53a6d 189 av7110->dvb_adapter.num);
1da177e4
LT		 190 av7110->adac_type = DVB_ADAC_NONE;
191 }
192 else {
193 av7110->adac_type = adac;
194 printk("dvb-ttpci: adac type set to %d @ card %d\n",
1c13b95c 195 av7110->adac_type, av7110->dvb_adapter.num);
1da177e4
LT		 196 }
197
1c13b95c 198 if (av7110->adac_type == DVB_ADAC_NONE || av7110->adac_type == DVB_ADAC_MSP34x0) {
1da177e4 199 // switch DVB SCART on
ce18a223 200 ret = av7110_fw_cmd(av7110, COMTYPE_AUDIODAC, MainSwitch, 1, 0);
7a2fa90f 201 if (ret < 0)
ce18a223
WR		 202 printk("dvb-ttpci:cannot switch on SCART(Main):%d\n",ret);
203 ret = av7110_fw_cmd(av7110, COMTYPE_AUDIODAC, ADSwitch, 1, 1);
7a2fa90f 204 if (ret < 0)
ce18a223 205 printk("dvb-ttpci:cannot switch on SCART(AD):%d\n",ret);
1da177e4 206 if (rgb_on &&
6af4ee10
KH		 207 ((av7110->dev->pci->subsystem_vendor == 0x110a) ||
208 (av7110->dev->pci->subsystem_vendor == 0x13c2)) &&
209 (av7110->dev->pci->subsystem_device == 0x0000)) {
1da177e4
LT		 210 saa7146_setgpio(dev, 1, SAA7146_GPIO_OUTHI); // RGB on, SCART pin 16
211 //saa7146_setgpio(dev, 3, SAA7146_GPIO_OUTLO); // SCARTpin 8
212 }
213 }
214
60edb137
OE		 215 if (dev->pci->subsystem_vendor == 0x13c2 && dev->pci->subsystem_device == 0x000e)
216 av7110_fw_cmd(av7110, COMTYPE_AUDIODAC, SpdifSwitch, 1, 0); // SPDIF on
217
ce18a223 218 ret = av7110_set_volume(av7110, av7110->mixer.volume_left, av7110->mixer.volume_right);
7a2fa90f 219 if (ret < 0)
ce18a223 220 printk("dvb-ttpci:cannot set volume :%d\n",ret);
1da177e4
LT		 221}
222
223static void recover_arm(struct av7110 *av7110)
224{
225 dprintk(4, "%p\n",av7110);
226
227 av7110_bootarm(av7110);
228 msleep(100);
1da177e4 229
66190a27 230 init_av7110_av(av7110);
1da177e4 231
66190a27
OE		 232 /* card-specific recovery */
233 if (av7110->recover)
234 av7110->recover(av7110);
235
236 restart_feeds(av7110);
ee820a64 237
b250392f 238#if IS_ENABLED(CONFIG_DVB_AV7110_IR)
ee820a64
OE		 239 av7110_check_ir_config(av7110, true);
240#endif
1da177e4
LT		 241}
242
243static void av7110_arm_sync(struct av7110 *av7110)
244{
8eec1429
HP		 245 if (av7110->arm_thread)
246 kthread_stop(av7110->arm_thread);
1da177e4 247
8eec1429 248 av7110->arm_thread = NULL;
1da177e4
LT		 249}
250
251static int arm_thread(void *data)
252{
253 struct av7110 *av7110 = data;
254 u16 newloops = 0;
255 int timeout;
256
257 dprintk(4, "%p\n",av7110);
258
1da177e4
LT		 259 for (;;) {
260 timeout = wait_event_interruptible_timeout(av7110->arm_wait,
8eec1429
HP		 261 kthread_should_stop(), 5 * HZ);
262
263 if (-ERESTARTSYS == timeout || kthread_should_stop()) {
1da177e4
LT		 264 /* got signal or told to quit*/
265 break;
266 }
267
268 if (!av7110->arm_ready)
269 continue;
270
b250392f 271#if IS_ENABLED(CONFIG_DVB_AV7110_IR)
ee820a64
OE		 272 av7110_check_ir_config(av7110, false);
273#endif
274
3593cab5 275 if (mutex_lock_interruptible(&av7110->dcomlock))
1da177e4 276 break;
1da177e4 277 newloops = rdebi(av7110, DEBINOSWAP, STATUS_LOOPS, 0, 2);
3593cab5 278 mutex_unlock(&av7110->dcomlock);
1da177e4 279
66190a27 280 if (newloops == av7110->arm_loops || av7110->arm_errors > 3) {
1da177e4 281 printk(KERN_ERR "dvb-ttpci: ARM crashed @ card %d\n",
fdc53a6d 282 av7110->dvb_adapter.num);
1da177e4 283
66190a27 284 recover_arm(av7110);
1da177e4 285
3593cab5 286 if (mutex_lock_interruptible(&av7110->dcomlock))
1da177e4 287 break;
1da177e4 288 newloops = rdebi(av7110, DEBINOSWAP, STATUS_LOOPS, 0, 2) - 1;
3593cab5 289 mutex_unlock(&av7110->dcomlock);
1da177e4
LT		 290 }
291 av7110->arm_loops = newloops;
66190a27 292 av7110->arm_errors = 0;
1da177e4
LT		 293 }
294
1da177e4
LT		 295 return 0;
296}
297
298
1da177e4
LT		 299/****************************************************************************
300 * IRQ handling
301 ****************************************************************************/
302
303static int DvbDmxFilterCallback(u8 *buffer1, size_t buffer1_len,
304 u8 *buffer2, size_t buffer2_len,
305 struct dvb_demux_filter *dvbdmxfilter,
1da177e4
LT		 306 struct av7110 *av7110)
307{
308 if (!dvbdmxfilter->feed->demux->dmx.frontend)
309 return 0;
310 if (dvbdmxfilter->feed->demux->dmx.frontend->source == DMX_MEMORY_FE)
311 return 0;
312
313 switch (dvbdmxfilter->type) {
314 case DMX_TYPE_SEC:
315 if ((((buffer1[1] << 8) | buffer1[2]) & 0xfff) + 3 != buffer1_len)
316 return 0;
317 if (dvbdmxfilter->doneq) {
318 struct dmx_section_filter *filter = &dvbdmxfilter->filter;
319 int i;
320 u8 xor, neq = 0;
321
322 for (i = 0; i < DVB_DEMUX_MASK_MAX; i++) {
323 xor = filter->filter_value[i] ^ buffer1[i];
324 neq |= dvbdmxfilter->maskandnotmode[i] & xor;
325 }
326 if (!neq)
327 return 0;
328 }
329 return dvbdmxfilter->feed->cb.sec(buffer1, buffer1_len,
330 buffer2, buffer2_len,
2f684b23 331 &dvbdmxfilter->filter);
1da177e4
LT		 332 case DMX_TYPE_TS:
333 if (!(dvbdmxfilter->feed->ts_type & TS_PACKET))
334 return 0;
335 if (dvbdmxfilter->feed->ts_type & TS_PAYLOAD_ONLY)
336 return dvbdmxfilter->feed->cb.ts(buffer1, buffer1_len,
337 buffer2, buffer2_len,
2f684b23 338 &dvbdmxfilter->feed->feed.ts);
1da177e4
LT		 339 else
340 av7110_p2t_write(buffer1, buffer1_len,
341 dvbdmxfilter->feed->pid,
342 &av7110->p2t_filter[dvbdmxfilter->index]);
343 default:
344 return 0;
345 }
346}
347
348
349//#define DEBUG_TIMING
350static inline void print_time(char *s)
351{
352#ifdef DEBUG_TIMING
353 struct timeval tv;
354 do_gettimeofday(&tv);
355 printk("%s: %d.%d\n", s, (int)tv.tv_sec, (int)tv.tv_usec);
356#endif
357}
358
359#define DEBI_READ 0
360#define DEBI_WRITE 1
361static inline void start_debi_dma(struct av7110 *av7110, int dir,
362 unsigned long addr, unsigned int len)
363{
364 dprintk(8, "%c %08lx %u\n", dir == DEBI_READ ? 'R' : 'W', addr, len);
365 if (saa7146_wait_for_debi_done(av7110->dev, 0)) {
3ca7fc84 366 printk(KERN_ERR "%s: saa7146_wait_for_debi_done timed out\n", __func__);
1da177e4
LT		 367 return;
368 }
369
370 SAA7146_ISR_CLEAR(av7110->dev, MASK_19); /* for good measure */
371 SAA7146_IER_ENABLE(av7110->dev, MASK_19);
372 if (len < 5)
373 len = 5; /* we want a real DEBI DMA */
374 if (dir == DEBI_WRITE)
375 iwdebi(av7110, DEBISWAB, addr, 0, (len + 3) & ~3);
376 else
377 irdebi(av7110, DEBISWAB, addr, 0, len);
378}
379
d45b9b8a 380static void debiirq(unsigned long cookie)
1da177e4 381{
d45b9b8a 382 struct av7110 *av7110 = (struct av7110 *)cookie;
1da177e4
LT		 383 int type = av7110->debitype;
384 int handle = (type >> 8) & 0x1f;
385 unsigned int xfer = 0;
386
387 print_time("debi");
388 dprintk(4, "type 0x%04x\n", type);
389
390 if (type == -1) {
391 printk("DEBI irq oops @ %ld, psr:0x%08x, ssr:0x%08x\n",
392 jiffies, saa7146_read(av7110->dev, PSR),
393 saa7146_read(av7110->dev, SSR));
394 goto debi_done;
395 }
396 av7110->debitype = -1;
397
398 switch (type & 0xff) {
399
400 case DATA_TS_RECORD:
401 dvb_dmx_swfilter_packets(&av7110->demux,
402 (const u8 *) av7110->debi_virt,
403 av7110->debilen / 188);
404 xfer = RX_BUFF;
405 break;
406
407 case DATA_PES_RECORD:
408 if (av7110->demux.recording)
409 av7110_record_cb(&av7110->p2t[handle],
410 (u8 *) av7110->debi_virt,
411 av7110->debilen);
412 xfer = RX_BUFF;
413 break;
414
415 case DATA_IPMPE:
416 case DATA_FSECTION:
417 case DATA_PIPING:
418 if (av7110->handle2filter[handle])
419 DvbDmxFilterCallback((u8 *)av7110->debi_virt,
420 av7110->debilen, NULL, 0,
421 av7110->handle2filter[handle],
2f684b23 422 av7110);
1da177e4
LT		 423 xfer = RX_BUFF;
424 break;
425
426 case DATA_CI_GET:
427 {
428 u8 *data = av7110->debi_virt;
429
430 if ((data[0] < 2) && data[2] == 0xff) {
431 int flags = 0;
432 if (data[5] > 0)
433 flags |= CA_CI_MODULE_PRESENT;
434 if (data[5] > 5)
435 flags |= CA_CI_MODULE_READY;
436 av7110->ci_slot[data[0]].flags = flags;
437 } else
438 ci_get_data(&av7110->ci_rbuffer,
439 av7110->debi_virt,
440 av7110->debilen);
441 xfer = RX_BUFF;
442 break;
443 }
444
445 case DATA_COMMON_INTERFACE:
446 CI_handle(av7110, (u8 *)av7110->debi_virt, av7110->debilen);
447#if 0
448 {
449 int i;
450
451 printk("av7110%d: ", av7110->num);
452 printk("%02x ", *(u8 *)av7110->debi_virt);
453 printk("%02x ", *(1+(u8 *)av7110->debi_virt));
454 for (i = 2; i < av7110->debilen; i++)
455 printk("%02x ", (*(i+(unsigned char *)av7110->debi_virt)));
456 for (i = 2; i < av7110->debilen; i++)
457 printk("%c", chtrans(*(i+(unsigned char *)av7110->debi_virt)));
458
459 printk("\n");
460 }
461#endif
462 xfer = RX_BUFF;
463 break;
464
465 case DATA_DEBUG_MESSAGE:
466 ((s8*)av7110->debi_virt)[Reserved_SIZE - 1] = 0;
467 printk("%s\n", (s8 *) av7110->debi_virt);
468 xfer = RX_BUFF;
469 break;
470
471 case DATA_CI_PUT:
472 dprintk(4, "debi DATA_CI_PUT\n");
473 case DATA_MPEG_PLAY:
474 dprintk(4, "debi DATA_MPEG_PLAY\n");
475 case DATA_BMP_LOAD:
476 dprintk(4, "debi DATA_BMP_LOAD\n");
477 xfer = TX_BUFF;
478 break;
479 default:
480 break;
481 }
482debi_done:
483 spin_lock(&av7110->debilock);
484 if (xfer)
485 iwdebi(av7110, DEBINOSWAP, xfer, 0, 2);
486 ARM_ClearMailBox(av7110);
487 spin_unlock(&av7110->debilock);
488}
489
490/* irq from av7110 firmware writing the mailbox register in the DPRAM */
d45b9b8a 491static void gpioirq(unsigned long cookie)
1da177e4 492{
d45b9b8a 493 struct av7110 *av7110 = (struct av7110 *)cookie;
1da177e4
LT		 494 u32 rxbuf, txbuf;
495 int len;
496
497 if (av7110->debitype != -1)
498 /* we shouldn't get any irq while a debi xfer is running */
499 printk("dvb-ttpci: GPIO0 irq oops @ %ld, psr:0x%08x, ssr:0x%08x\n",
500 jiffies, saa7146_read(av7110->dev, PSR),
501 saa7146_read(av7110->dev, SSR));
502
503 if (saa7146_wait_for_debi_done(av7110->dev, 0)) {
3ca7fc84 504 printk(KERN_ERR "%s: saa7146_wait_for_debi_done timed out\n", __func__);
1da177e4
LT		 505 BUG(); /* maybe we should try resetting the debi? */
506 }
507
508 spin_lock(&av7110->debilock);
509 ARM_ClearIrq(av7110);
510
511 /* see what the av7110 wants */
512 av7110->debitype = irdebi(av7110, DEBINOSWAP, IRQ_STATE, 0, 2);
513 av7110->debilen = irdebi(av7110, DEBINOSWAP, IRQ_STATE_EXT, 0, 2);
514 rxbuf = irdebi(av7110, DEBINOSWAP, RX_BUFF, 0, 2);
515 txbuf = irdebi(av7110, DEBINOSWAP, TX_BUFF, 0, 2);
516 len = (av7110->debilen + 3) & ~3;
517
518 print_time("gpio");
519 dprintk(8, "GPIO0 irq 0x%04x %d\n", av7110->debitype, av7110->debilen);
520
521 switch (av7110->debitype & 0xff) {
522
523 case DATA_TS_PLAY:
524 case DATA_PES_PLAY:
525 break;
526
527 case DATA_MPEG_VIDEO_EVENT:
528 {
529 u32 h_ar;
530 struct video_event event;
531
532 av7110->video_size.w = irdebi(av7110, DEBINOSWAP, STATUS_MPEG_WIDTH, 0, 2);
533 h_ar = irdebi(av7110, DEBINOSWAP, STATUS_MPEG_HEIGHT_AR, 0, 2);
534
535 iwdebi(av7110, DEBINOSWAP, IRQ_STATE_EXT, 0, 2);
536 iwdebi(av7110, DEBINOSWAP, RX_BUFF, 0, 2);
537
538 av7110->video_size.h = h_ar & 0xfff;
1da177e4
LT		 539
540 event.type = VIDEO_EVENT_SIZE_CHANGED;
541 event.u.size.w = av7110->video_size.w;
542 event.u.size.h = av7110->video_size.h;
543 switch ((h_ar >> 12) & 0xf)
544 {
545 case 3:
546 av7110->video_size.aspect_ratio = VIDEO_FORMAT_16_9;
547 event.u.size.aspect_ratio = VIDEO_FORMAT_16_9;
548 av7110->videostate.video_format = VIDEO_FORMAT_16_9;
549 break;
550 case 4:
551 av7110->video_size.aspect_ratio = VIDEO_FORMAT_221_1;
552 event.u.size.aspect_ratio = VIDEO_FORMAT_221_1;
553 av7110->videostate.video_format = VIDEO_FORMAT_221_1;
554 break;
555 default:
556 av7110->video_size.aspect_ratio = VIDEO_FORMAT_4_3;
557 event.u.size.aspect_ratio = VIDEO_FORMAT_4_3;
558 av7110->videostate.video_format = VIDEO_FORMAT_4_3;
559 }
66190a27
OE		 560
561 dprintk(8, "GPIO0 irq: DATA_MPEG_VIDEO_EVENT: w/h/ar = %u/%u/%u\n",
562 av7110->video_size.w, av7110->video_size.h,
563 av7110->video_size.aspect_ratio);
564
1da177e4
LT		 565 dvb_video_add_event(av7110, &event);
566 break;
567 }
568
569 case DATA_CI_PUT:
570 {
571 int avail;
572 struct dvb_ringbuffer *cibuf = &av7110->ci_wbuffer;
573
574 avail = dvb_ringbuffer_avail(cibuf);
575 if (avail <= 2) {
576 iwdebi(av7110, DEBINOSWAP, IRQ_STATE_EXT, 0, 2);
577 iwdebi(av7110, DEBINOSWAP, TX_LEN, 0, 2);
578 iwdebi(av7110, DEBINOSWAP, TX_BUFF, 0, 2);
579 break;
580 }
581 len = DVB_RINGBUFFER_PEEK(cibuf, 0) << 8;
582 len |= DVB_RINGBUFFER_PEEK(cibuf, 1);
583 if (avail < len + 2) {
584 iwdebi(av7110, DEBINOSWAP, IRQ_STATE_EXT, 0, 2);
585 iwdebi(av7110, DEBINOSWAP, TX_LEN, 0, 2);
586 iwdebi(av7110, DEBINOSWAP, TX_BUFF, 0, 2);
587 break;
588 }
589 DVB_RINGBUFFER_SKIP(cibuf, 2);
590
b0ba0e3a 591 dvb_ringbuffer_read(cibuf, av7110->debi_virt, len);
1da177e4
LT		 592
593 iwdebi(av7110, DEBINOSWAP, TX_LEN, len, 2);
594 iwdebi(av7110, DEBINOSWAP, IRQ_STATE_EXT, len, 2);
595 dprintk(8, "DMA: CI\n");
596 start_debi_dma(av7110, DEBI_WRITE, DPRAM_BASE + txbuf, len);
597 spin_unlock(&av7110->debilock);
598 wake_up(&cibuf->queue);
599 return;
600 }
601
602 case DATA_MPEG_PLAY:
603 if (!av7110->playing) {
604 iwdebi(av7110, DEBINOSWAP, IRQ_STATE_EXT, 0, 2);
605 iwdebi(av7110, DEBINOSWAP, TX_LEN, 0, 2);
606 iwdebi(av7110, DEBINOSWAP, TX_BUFF, 0, 2);
607 break;
608 }
609 len = 0;
610 if (av7110->debitype & 0x100) {
611 spin_lock(&av7110->aout.lock);
612 len = av7110_pes_play(av7110->debi_virt, &av7110->aout, 2048);
613 spin_unlock(&av7110->aout.lock);
614 }
615 if (len <= 0 && (av7110->debitype & 0x200)
616 &&av7110->videostate.play_state != VIDEO_FREEZED) {
617 spin_lock(&av7110->avout.lock);
618 len = av7110_pes_play(av7110->debi_virt, &av7110->avout, 2048);
619 spin_unlock(&av7110->avout.lock);
620 }
621 if (len <= 0) {
622 iwdebi(av7110, DEBINOSWAP, IRQ_STATE_EXT, 0, 2);
623 iwdebi(av7110, DEBINOSWAP, TX_LEN, 0, 2);
624 iwdebi(av7110, DEBINOSWAP, TX_BUFF, 0, 2);
625 break;
626 }
627 dprintk(8, "GPIO0 PES_PLAY len=%04x\n", len);
628 iwdebi(av7110, DEBINOSWAP, TX_LEN, len, 2);
629 iwdebi(av7110, DEBINOSWAP, IRQ_STATE_EXT, len, 2);
630 dprintk(8, "DMA: MPEG_PLAY\n");
631 start_debi_dma(av7110, DEBI_WRITE, DPRAM_BASE + txbuf, len);
632 spin_unlock(&av7110->debilock);
633 return;
634
635 case DATA_BMP_LOAD:
636 len = av7110->debilen;
637 dprintk(8, "gpio DATA_BMP_LOAD len %d\n", len);
638 if (!len) {
639 av7110->bmp_state = BMP_LOADED;
640 iwdebi(av7110, DEBINOSWAP, IRQ_STATE_EXT, 0, 2);
641 iwdebi(av7110, DEBINOSWAP, TX_LEN, 0, 2);
642 iwdebi(av7110, DEBINOSWAP, TX_BUFF, 0, 2);
643 wake_up(&av7110->bmpq);
644 dprintk(8, "gpio DATA_BMP_LOAD done\n");
645 break;
646 }
647 if (len > av7110->bmplen)
648 len = av7110->bmplen;
649 if (len > 2 * 1024)
650 len = 2 * 1024;
651 iwdebi(av7110, DEBINOSWAP, TX_LEN, len, 2);
652 iwdebi(av7110, DEBINOSWAP, IRQ_STATE_EXT, len, 2);
653 memcpy(av7110->debi_virt, av7110->bmpbuf+av7110->bmpp, len);
654 av7110->bmpp += len;
655 av7110->bmplen -= len;
656 dprintk(8, "gpio DATA_BMP_LOAD DMA len %d\n", len);
657 start_debi_dma(av7110, DEBI_WRITE, DPRAM_BASE+txbuf, len);
658 spin_unlock(&av7110->debilock);
659 return;
660
661 case DATA_CI_GET:
662 case DATA_COMMON_INTERFACE:
663 case DATA_FSECTION:
664 case DATA_IPMPE:
665 case DATA_PIPING:
666 if (!len || len > 4 * 1024) {
667 iwdebi(av7110, DEBINOSWAP, RX_BUFF, 0, 2);
668 break;
669 }
670 /* fall through */
671
672 case DATA_TS_RECORD:
673 case DATA_PES_RECORD:
674 dprintk(8, "DMA: TS_REC etc.\n");
675 start_debi_dma(av7110, DEBI_READ, DPRAM_BASE+rxbuf, len);
676 spin_unlock(&av7110->debilock);
677 return;
678
679 case DATA_DEBUG_MESSAGE:
680 if (!len || len > 0xff) {
681 iwdebi(av7110, DEBINOSWAP, RX_BUFF, 0, 2);
682 break;
683 }
684 start_debi_dma(av7110, DEBI_READ, Reserved, len);
685 spin_unlock(&av7110->debilock);
686 return;
687
688 case DATA_IRCOMMAND:
ee820a64
OE		 689 if (av7110->ir.ir_handler)
690 av7110->ir.ir_handler(av7110,
03388ae3 691 swahw32(irdebi(av7110, DEBINOSWAP, Reserved, 0, 4)));
1da177e4
LT		 692 iwdebi(av7110, DEBINOSWAP, RX_BUFF, 0, 2);
693 break;
694
695 default:
696 printk("dvb-ttpci: gpioirq unknown type=%d len=%d\n",
697 av7110->debitype, av7110->debilen);
698 break;
699 }
700 av7110->debitype = -1;
701 ARM_ClearMailBox(av7110);
702 spin_unlock(&av7110->debilock);
703}
704
705
706#ifdef CONFIG_DVB_AV7110_OSD
16ef8def 707static int dvb_osd_ioctl(struct file *file,
1da177e4
LT		 708 unsigned int cmd, void *parg)
709{
d9bdf772
TK		 710 struct dvb_device *dvbdev = file->private_data;
711 struct av7110 *av7110 = dvbdev->priv;
1da177e4
LT		 712
713 dprintk(4, "%p\n", av7110);
714
715 if (cmd == OSD_SEND_CMD)
716 return av7110_osd_cmd(av7110, (osd_cmd_t *) parg);
717 if (cmd == OSD_GET_CAPABILITY)
718 return av7110_osd_capability(av7110, (osd_cap_t *) parg);
719
720 return -EINVAL;
721}
722
723
784e29d2 724static const struct file_operations dvb_osd_fops = {
1da177e4 725 .owner = THIS_MODULE,
16ef8def 726 .unlocked_ioctl = dvb_generic_ioctl,
1da177e4
LT		 727 .open = dvb_generic_open,
728 .release = dvb_generic_release,
6038f373 729 .llseek = noop_llseek,
1da177e4
LT		 730};
731
732static struct dvb_device dvbdev_osd = {
733 .priv = NULL,
734 .users = 1,
735 .writers = 1,
736 .fops = &dvb_osd_fops,
737 .kernel_ioctl = dvb_osd_ioctl,
738};
739#endif /* CONFIG_DVB_AV7110_OSD */
740
741
742static inline int SetPIDs(struct av7110 *av7110, u16 vpid, u16 apid, u16 ttpid,
743 u16 subpid, u16 pcrpid)
744{
47f36920
DWF		 745 u16 aflags = 0;
746
1da177e4
LT		 747 dprintk(4, "%p\n", av7110);
748
749 if (vpid == 0x1fff || apid == 0x1fff ||
750 ttpid == 0x1fff || subpid == 0x1fff || pcrpid == 0x1fff) {
751 vpid = apid = ttpid = subpid = pcrpid = 0;
752 av7110->pids[DMX_PES_VIDEO] = 0;
753 av7110->pids[DMX_PES_AUDIO] = 0;
754 av7110->pids[DMX_PES_TELETEXT] = 0;
755 av7110->pids[DMX_PES_PCR] = 0;
756 }
757
47f36920
DWF		 758 if (av7110->audiostate.bypass_mode)
759 aflags |= 0x8000;
760
761 return av7110_fw_cmd(av7110, COMTYPE_PIDFILTER, MultiPID, 6,
762 pcrpid, vpid, apid, ttpid, subpid, aflags);
1da177e4
LT		 763}
764
ce18a223 765int ChangePIDs(struct av7110 *av7110, u16 vpid, u16 apid, u16 ttpid,
1da177e4
LT		 766 u16 subpid, u16 pcrpid)
767{
ce18a223 768 int ret = 0;
1da177e4
LT		 769 dprintk(4, "%p\n", av7110);
770
3593cab5 771 if (mutex_lock_interruptible(&av7110->pid_mutex))
ce18a223 772 return -ERESTARTSYS;
1da177e4
LT		 773
774 if (!(vpid & 0x8000))
775 av7110->pids[DMX_PES_VIDEO] = vpid;
776 if (!(apid & 0x8000))
777 av7110->pids[DMX_PES_AUDIO] = apid;
778 if (!(ttpid & 0x8000))
779 av7110->pids[DMX_PES_TELETEXT] = ttpid;
780 if (!(pcrpid & 0x8000))
781 av7110->pids[DMX_PES_PCR] = pcrpid;
782
783 av7110->pids[DMX_PES_SUBTITLE] = 0;
784
785 if (av7110->fe_synced) {
786 pcrpid = av7110->pids[DMX_PES_PCR];
ce18a223 787 ret = SetPIDs(av7110, vpid, apid, ttpid, subpid, pcrpid);
1da177e4
LT		 788 }
789
3593cab5 790 mutex_unlock(&av7110->pid_mutex);
ce18a223 791 return ret;
1da177e4
LT		 792}
793
794
795/******************************************************************************
796 * hardware filter functions
797 ******************************************************************************/
798
799static int StartHWFilter(struct dvb_demux_filter *dvbdmxfilter)
800{
801 struct dvb_demux_feed *dvbdmxfeed = dvbdmxfilter->feed;
d9bdf772 802 struct av7110 *av7110 = dvbdmxfeed->demux->priv;
1da177e4
LT		 803 u16 buf[20];
804 int ret, i;
805 u16 handle;
806// u16 mode = 0x0320;
807 u16 mode = 0xb96a;
808
809 dprintk(4, "%p\n", av7110);
810
9e615eac
OE		 811 if (av7110->full_ts)
812 return 0;
813
1da177e4
LT		 814 if (dvbdmxfilter->type == DMX_TYPE_SEC) {
815 if (hw_sections) {
816 buf[4] = (dvbdmxfilter->filter.filter_value[0] << 8) |
817 dvbdmxfilter->maskandmode[0];
818 for (i = 3; i < 18; i++)
819 buf[i + 4 - 2] =
820 (dvbdmxfilter->filter.filter_value[i] << 8) |
821 dvbdmxfilter->maskandmode[i];
822 mode = 4;
823 }
824 } else if ((dvbdmxfeed->ts_type & TS_PACKET) &&
825 !(dvbdmxfeed->ts_type & TS_PAYLOAD_ONLY)) {
826 av7110_p2t_init(&av7110->p2t_filter[dvbdmxfilter->index], dvbdmxfeed);
827 }
828
829 buf[0] = (COMTYPE_PID_FILTER << 8) + AddPIDFilter;
830 buf[1] = 16;
831 buf[2] = dvbdmxfeed->pid;
832 buf[3] = mode;
833
834 ret = av7110_fw_request(av7110, buf, 20, &handle, 1);
835 if (ret != 0 || handle >= 32) {
836 printk("dvb-ttpci: %s error buf %04x %04x %04x %04x "
ce18a223 837 "ret %d handle %04x\n",
3ca7fc84 838 __func__, buf[0], buf[1], buf[2], buf[3],
1da177e4
LT		 839 ret, handle);
840 dvbdmxfilter->hw_handle = 0xffff;
ce18a223
WR		 841 if (!ret)
842 ret = -1;
843 return ret;
1da177e4
LT		 844 }
845
846 av7110->handle2filter[handle] = dvbdmxfilter;
847 dvbdmxfilter->hw_handle = handle;
848
849 return ret;
850}
851
852static int StopHWFilter(struct dvb_demux_filter *dvbdmxfilter)
853{
d9bdf772 854 struct av7110 *av7110 = dvbdmxfilter->feed->demux->priv;
1da177e4
LT		 855 u16 buf[3];
856 u16 answ[2];
857 int ret;
858 u16 handle;
859
860 dprintk(4, "%p\n", av7110);
861
9e615eac
OE		 862 if (av7110->full_ts)
863 return 0;
864
1da177e4
LT		 865 handle = dvbdmxfilter->hw_handle;
866 if (handle >= 32) {
867 printk("%s tried to stop invalid filter %04x, filter type = %x\n",
3ca7fc84 868 __func__, handle, dvbdmxfilter->type);
ce18a223 869 return -EINVAL;
1da177e4
LT		 870 }
871
872 av7110->handle2filter[handle] = NULL;
873
874 buf[0] = (COMTYPE_PID_FILTER << 8) + DelPIDFilter;
875 buf[1] = 1;
876 buf[2] = handle;
877 ret = av7110_fw_request(av7110, buf, 3, answ, 2);
878 if (ret != 0 || answ[1] != handle) {
879 printk("dvb-ttpci: %s error cmd %04x %04x %04x ret %x "
880 "resp %04x %04x pid %d\n",
3ca7fc84 881 __func__, buf[0], buf[1], buf[2], ret,
1da177e4 882 answ[0], answ[1], dvbdmxfilter->feed->pid);
ce18a223
WR		 883 if (!ret)
884 ret = -1;
1da177e4
LT		 885 }
886 return ret;
887}
888
889
ce18a223 890static int dvb_feed_start_pid(struct dvb_demux_feed *dvbdmxfeed)
1da177e4
LT		 891{
892 struct dvb_demux *dvbdmx = dvbdmxfeed->demux;
d9bdf772 893 struct av7110 *av7110 = dvbdmx->priv;
1da177e4
LT		 894 u16 *pid = dvbdmx->pids, npids[5];
895 int i;
ce18a223 896 int ret = 0;
1da177e4
LT		 897
898 dprintk(4, "%p\n", av7110);
899
900 npids[0] = npids[1] = npids[2] = npids[3] = npids[4] = 0xffff;
901 i = dvbdmxfeed->pes_type;
902 npids[i] = (pid[i]&0x8000) ? 0 : pid[i];
903 if ((i == 2) && npids[i] && (dvbdmxfeed->ts_type & TS_PACKET)) {
904 npids[i] = 0;
ce18a223
WR		 905 ret = ChangePIDs(av7110, npids[1], npids[0], npids[2], npids[3], npids[4]);
906 if (!ret)
907 ret = StartHWFilter(dvbdmxfeed->filter);
908 return ret;
909 }
910 if (dvbdmxfeed->pes_type <= 2 || dvbdmxfeed->pes_type == 4) {
911 ret = ChangePIDs(av7110, npids[1], npids[0], npids[2], npids[3], npids[4]);
912 if (ret)
913 return ret;
1da177e4 914 }
1da177e4
LT		 915
916 if (dvbdmxfeed->pes_type < 2 && npids[0])
917 if (av7110->fe_synced)
ce18a223
WR		 918 {
919 ret = av7110_fw_cmd(av7110, COMTYPE_PIDFILTER, Scan, 0);
920 if (ret)
921 return ret;
922 }
1da177e4 923
9e615eac 924 if ((dvbdmxfeed->ts_type & TS_PACKET) && !av7110->full_ts) {
1da177e4 925 if (dvbdmxfeed->pes_type == 0 && !(dvbdmx->pids[0] & 0x8000))
ce18a223 926 ret = av7110_av_start_record(av7110, RP_AUDIO, dvbdmxfeed);
1da177e4 927 if (dvbdmxfeed->pes_type == 1 && !(dvbdmx->pids[1] & 0x8000))
ce18a223 928 ret = av7110_av_start_record(av7110, RP_VIDEO, dvbdmxfeed);
1da177e4 929 }
ce18a223 930 return ret;
1da177e4
LT		 931}
932
ce18a223 933static int dvb_feed_stop_pid(struct dvb_demux_feed *dvbdmxfeed)
1da177e4
LT		 934{
935 struct dvb_demux *dvbdmx = dvbdmxfeed->demux;
d9bdf772 936 struct av7110 *av7110 = dvbdmx->priv;
1da177e4
LT		 937 u16 *pid = dvbdmx->pids, npids[5];
938 int i;
939
ce18a223
WR		 940 int ret = 0;
941
1da177e4
LT		 942 dprintk(4, "%p\n", av7110);
943
944 if (dvbdmxfeed->pes_type <= 1) {
ce18a223
WR		 945 ret = av7110_av_stop(av7110, dvbdmxfeed->pes_type ? RP_VIDEO : RP_AUDIO);
946 if (ret)
947 return ret;
1da177e4
LT		 948 if (!av7110->rec_mode)
949 dvbdmx->recording = 0;
950 if (!av7110->playing)
951 dvbdmx->playing = 0;
952 }
953 npids[0] = npids[1] = npids[2] = npids[3] = npids[4] = 0xffff;
954 i = dvbdmxfeed->pes_type;
955 switch (i) {
956 case 2: //teletext
957 if (dvbdmxfeed->ts_type & TS_PACKET)
ce18a223 958 ret = StopHWFilter(dvbdmxfeed->filter);
1da177e4
LT		 959 npids[2] = 0;
960 break;
961 case 0:
962 case 1:
963 case 4:
964 if (!pids_off)
ce18a223 965 return 0;
1da177e4
LT		 966 npids[i] = (pid[i]&0x8000) ? 0 : pid[i];
967 break;
968 }
ce18a223
WR		 969 if (!ret)
970 ret = ChangePIDs(av7110, npids[1], npids[0], npids[2], npids[3], npids[4]);
971 return ret;
1da177e4
LT		 972}
973
974static int av7110_start_feed(struct dvb_demux_feed *feed)
975{
976 struct dvb_demux *demux = feed->demux;
977 struct av7110 *av7110 = demux->priv;
ce18a223 978 int ret = 0;
1da177e4
LT		 979
980 dprintk(4, "%p\n", av7110);
981
982 if (!demux->dmx.frontend)
983 return -EINVAL;
984
9e615eac 985 if (!av7110->full_ts && feed->pid > 0x1fff)
1da177e4
LT		 986 return -EINVAL;
987
988 if (feed->type == DMX_TYPE_TS) {
989 if ((feed->ts_type & TS_DECODER) &&
fde04ab9 990 (feed->pes_type <= DMX_PES_PCR)) {
1da177e4
LT		 991 switch (demux->dmx.frontend->source) {
992 case DMX_MEMORY_FE:
993 if (feed->ts_type & TS_DECODER)
994 if (feed->pes_type < 2 &&
995 !(demux->pids[0] & 0x8000) &&
996 !(demux->pids[1] & 0x8000)) {
997 dvb_ringbuffer_flush_spinlock_wakeup(&av7110->avout);
998 dvb_ringbuffer_flush_spinlock_wakeup(&av7110->aout);
ce18a223
WR		 999 ret = av7110_av_start_play(av7110,RP_AV);
1000 if (!ret)
1001 demux->playing = 1;
1da177e4
LT		 1002 }
1003 break;
1004 default:
ce18a223 1005 ret = dvb_feed_start_pid(feed);
1da177e4
LT		 1006 break;
1007 }
1008 } else if ((feed->ts_type & TS_PACKET) &&
1009 (demux->dmx.frontend->source != DMX_MEMORY_FE)) {
ce18a223 1010 ret = StartHWFilter(feed->filter);
1da177e4
LT		 1011 }
1012 }
1013
9e615eac
OE		 1014 if (av7110->full_ts) {
1015 budget_start_feed(feed);
1016 return ret;
1017 }
1018
1019 if (feed->type == DMX_TYPE_SEC) {
1da177e4
LT		 1020 int i;
1021
1022 for (i = 0; i < demux->filternum; i++) {
1023 if (demux->filter[i].state != DMX_STATE_READY)
1024 continue;
1025 if (demux->filter[i].type != DMX_TYPE_SEC)
1026 continue;
1027 if (demux->filter[i].filter.parent != &feed->feed.sec)
1028 continue;
1029 demux->filter[i].state = DMX_STATE_GO;
ce18a223
WR		 1030 if (demux->dmx.frontend->source != DMX_MEMORY_FE) {
1031 ret = StartHWFilter(&demux->filter[i]);
1032 if (ret)
1033 break;
1034 }
1da177e4
LT		 1035 }
1036 }
1037
ce18a223 1038 return ret;
1da177e4
LT		 1039}
1040
1041
1042static int av7110_stop_feed(struct dvb_demux_feed *feed)
1043{
1044 struct dvb_demux *demux = feed->demux;
1045 struct av7110 *av7110 = demux->priv;
12ba0504 1046 int i, rc, ret = 0;
1da177e4
LT		 1047 dprintk(4, "%p\n", av7110);
1048
1049 if (feed->type == DMX_TYPE_TS) {
1050 if (feed->ts_type & TS_DECODER) {
fde04ab9 1051 if (feed->pes_type >= DMX_PES_OTHER ||
1da177e4
LT		 1052 !demux->pesfilter[feed->pes_type])
1053 return -EINVAL;
1054 demux->pids[feed->pes_type] |= 0x8000;
1055 demux->pesfilter[feed->pes_type] = NULL;
1056 }
1057 if (feed->ts_type & TS_DECODER &&
fde04ab9 1058 feed->pes_type < DMX_PES_OTHER) {
ce18a223 1059 ret = dvb_feed_stop_pid(feed);
1da177e4
LT		 1060 } else
1061 if ((feed->ts_type & TS_PACKET) &&
1062 (demux->dmx.frontend->source != DMX_MEMORY_FE))
ce18a223 1063 ret = StopHWFilter(feed->filter);
1da177e4
LT		 1064 }
1065
9e615eac
OE		 1066 if (av7110->full_ts) {
1067 budget_stop_feed(feed);
1068 return ret;
1069 }
1070
1071 if (feed->type == DMX_TYPE_SEC) {
12ba0504 1072 for (i = 0; i<demux->filternum; i++) {
1da177e4
LT		 1073 if (demux->filter[i].state == DMX_STATE_GO &&
1074 demux->filter[i].filter.parent == &feed->feed.sec) {
1075 demux->filter[i].state = DMX_STATE_READY;
ce18a223 1076 if (demux->dmx.frontend->source != DMX_MEMORY_FE) {
12ba0504
JS		 1077 rc = StopHWFilter(&demux->filter[i]);
1078 if (!ret)
1079 ret = rc;
1080 /* keep going, stop as many filters as possible */
ce18a223 1081 }
12ba0504 1082 }
1da177e4
LT		 1083 }
1084 }
1085
ce18a223 1086 return ret;
1da177e4
LT		 1087}
1088
1089
1090static void restart_feeds(struct av7110 *av7110)
1091{
1092 struct dvb_demux *dvbdmx = &av7110->demux;
1093 struct dvb_demux_feed *feed;
1094 int mode;
9e615eac 1095 int feeding;
66190a27 1096 int i, j;
1da177e4
LT		 1097
1098 dprintk(4, "%p\n", av7110);
1099
1100 mode = av7110->playing;
1101 av7110->playing = 0;
1102 av7110->rec_mode = 0;
1103
9e615eac
OE		 1104 feeding = av7110->feeding1; /* full_ts mod */
1105
66190a27 1106 for (i = 0; i < dvbdmx->feednum; i++) {
1da177e4 1107 feed = &dvbdmx->feed[i];
66190a27
OE		 1108 if (feed->state == DMX_STATE_GO) {
1109 if (feed->type == DMX_TYPE_SEC) {
1110 for (j = 0; j < dvbdmx->filternum; j++) {
1111 if (dvbdmx->filter[j].type != DMX_TYPE_SEC)
1112 continue;
1113 if (dvbdmx->filter[j].filter.parent != &feed->feed.sec)
1114 continue;
1115 if (dvbdmx->filter[j].state == DMX_STATE_GO)
1116 dvbdmx->filter[j].state = DMX_STATE_READY;
1117 }
1118 }
1da177e4 1119 av7110_start_feed(feed);
66190a27 1120 }
1da177e4
LT		 1121 }
1122
9e615eac
OE		 1123 av7110->feeding1 = feeding; /* full_ts mod */
1124
1da177e4
LT		 1125 if (mode)
1126 av7110_av_start_play(av7110, mode);
1127}
1128
1129static int dvb_get_stc(struct dmx_demux *demux, unsigned int num,
1130 uint64_t *stc, unsigned int *base)
1131{
1132 int ret;
1133 u16 fwstc[4];
1134 u16 tag = ((COMTYPE_REQUEST << 8) + ReqSTC);
1135 struct dvb_demux *dvbdemux;
1136 struct av7110 *av7110;
1137
1138 /* pointer casting paranoia... */
ae24601b 1139 BUG_ON(!demux);
d9bdf772 1140 dvbdemux = demux->priv;
ae24601b 1141 BUG_ON(!dvbdemux);
d9bdf772 1142 av7110 = dvbdemux->priv;
1da177e4
LT		 1143
1144 dprintk(4, "%p\n", av7110);
1145
1146 if (num != 0)
1147 return -EINVAL;
1148
1149 ret = av7110_fw_request(av7110, &tag, 0, fwstc, 4);
1150 if (ret) {
3ca7fc84 1151 printk(KERN_ERR "%s: av7110_fw_request error\n", __func__);
ce18a223 1152 return ret;
1da177e4
LT		 1153 }
1154 dprintk(2, "fwstc = %04hx %04hx %04hx %04hx\n",
1155 fwstc[0], fwstc[1], fwstc[2], fwstc[3]);
1156
1157 *stc = (((uint64_t) ((fwstc[3] & 0x8000) >> 15)) << 32) |
1158 (((uint64_t) fwstc[1]) << 16) | ((uint64_t) fwstc[0]);
1159 *base = 1;
1160
1161 dprintk(4, "stc = %lu\n", (unsigned long)*stc);
1162
1163 return 0;
1164}
1165
1166
1167/******************************************************************************
1168 * SEC device file operations
1169 ******************************************************************************/
1170
1171
0df289a2 1172static int av7110_set_tone(struct dvb_frontend *fe, enum fe_sec_tone_mode tone)
1da177e4 1173{
d9bdf772 1174 struct av7110* av7110 = fe->dvb->priv;
1da177e4
LT		 1175
1176 switch (tone) {
1177 case SEC_TONE_ON:
ce18a223 1178 return Set22K(av7110, 1);
1da177e4
LT		 1179
1180 case SEC_TONE_OFF:
ce18a223 1181 return Set22K(av7110, 0);
1da177e4
LT		 1182
1183 default:
1184 return -EINVAL;
1185 }
1da177e4
LT		 1186}
1187
1188static int av7110_diseqc_send_master_cmd(struct dvb_frontend* fe,
1189 struct dvb_diseqc_master_cmd* cmd)
1190{
1191 struct av7110* av7110 = fe->dvb->priv;
1192
ce18a223 1193 return av7110_diseqc_send(av7110, cmd->msg_len, cmd->msg, -1);
1da177e4
LT		 1194}
1195
1196static int av7110_diseqc_send_burst(struct dvb_frontend* fe,
0df289a2 1197 enum fe_sec_mini_cmd minicmd)
1da177e4
LT		 1198{
1199 struct av7110* av7110 = fe->dvb->priv;
1200
ce18a223 1201 return av7110_diseqc_send(av7110, 0, NULL, minicmd);
1da177e4
LT		 1202}
1203
1204/* simplified code from budget-core.c */
1205static int stop_ts_capture(struct av7110 *budget)
1206{
1207 dprintk(2, "budget: %p\n", budget);
1208
1209 if (--budget->feeding1)
1210 return budget->feeding1;
1211 saa7146_write(budget->dev, MC1, MASK_20); /* DMA3 off */
1212 SAA7146_IER_DISABLE(budget->dev, MASK_10);
1213 SAA7146_ISR_CLEAR(budget->dev, MASK_10);
1214 return 0;
1215}
1216
1217static int start_ts_capture(struct av7110 *budget)
1218{
e5b30145
HV		 1219 unsigned y;
1220
1da177e4
LT		 1221 dprintk(2, "budget: %p\n", budget);
1222
1223 if (budget->feeding1)
1224 return ++budget->feeding1;
e5b30145
HV		 1225 for (y = 0; y < TS_HEIGHT; y++)
1226 memset(budget->grabbing + y * TS_WIDTH, 0x00, TS_WIDTH);
1da177e4 1227 budget->ttbp = 0;
9e615eac 1228 SAA7146_ISR_CLEAR(budget->dev, MASK_10); /* VPE */
1da177e4
LT		 1229 SAA7146_IER_ENABLE(budget->dev, MASK_10); /* VPE */
1230 saa7146_write(budget->dev, MC1, (MASK_04 | MASK_20)); /* DMA3 on */
1231 return ++budget->feeding1;
1232}
1233
1234static int budget_start_feed(struct dvb_demux_feed *feed)
1235{
1236 struct dvb_demux *demux = feed->demux;
d9bdf772 1237 struct av7110 *budget = demux->priv;
1da177e4
LT		 1238 int status;
1239
1240 dprintk(2, "av7110: %p\n", budget);
1241
1242 spin_lock(&budget->feedlock1);
1243 feed->pusi_seen = 0; /* have a clean section start */
1244 status = start_ts_capture(budget);
1245 spin_unlock(&budget->feedlock1);
1246 return status;
1247}
1248
1249static int budget_stop_feed(struct dvb_demux_feed *feed)
1250{
1251 struct dvb_demux *demux = feed->demux;
d9bdf772 1252 struct av7110 *budget = demux->priv;
1da177e4
LT		 1253 int status;
1254
1255 dprintk(2, "budget: %p\n", budget);
1256
1257 spin_lock(&budget->feedlock1);
1258 status = stop_ts_capture(budget);
1259 spin_unlock(&budget->feedlock1);
1260 return status;
1261}
1262
d45b9b8a 1263static void vpeirq(unsigned long cookie)
1da177e4 1264{
d45b9b8a 1265 struct av7110 *budget = (struct av7110 *)cookie;
1da177e4
LT		 1266 u8 *mem = (u8 *) (budget->grabbing);
1267 u32 olddma = budget->ttbp;
1268 u32 newdma = saa7146_read(budget->dev, PCI_VDP3);
9e615eac 1269 struct dvb_demux *demux = budget->full_ts ? &budget->demux : &budget->demux1;
1da177e4 1270
1da177e4
LT		 1271 /* nearest lower position divisible by 188 */
1272 newdma -= newdma % 188;
1273
1274 if (newdma >= TS_BUFLEN)
1275 return;
1276
1277 budget->ttbp = newdma;
1278
1279 if (!budget->feeding1 || (newdma == olddma))
1280 return;
1281
87c3019d
JB		 1282 /* Ensure streamed PCI data is synced to CPU */
1283 pci_dma_sync_sg_for_cpu(budget->dev->pci, budget->pt.slist, budget->pt.nents, PCI_DMA_FROMDEVICE);
1284
1da177e4
LT		 1285#if 0
1286 /* track rps1 activity */
1287 printk("vpeirq: %02x Event Counter 1 0x%04x\n",
1288 mem[olddma],
1289 saa7146_read(budget->dev, EC1R) & 0x3fff);
1290#endif
1291
1292 if (newdma > olddma)
1293 /* no wraparound, dump olddma..newdma */
9e615eac 1294 dvb_dmx_swfilter_packets(demux, mem + olddma, (newdma - olddma) / 188);
1da177e4
LT		 1295 else {
1296 /* wraparound, dump olddma..buflen and 0..newdma */
9e615eac
OE		 1297 dvb_dmx_swfilter_packets(demux, mem + olddma, (TS_BUFLEN - olddma) / 188);
1298 dvb_dmx_swfilter_packets(demux, mem, newdma / 188);
1da177e4
LT		 1299 }
1300}
1301
1302static int av7110_register(struct av7110 *av7110)
1303{
1304 int ret, i;
1305 struct dvb_demux *dvbdemux = &av7110->demux;
1306 struct dvb_demux *dvbdemux1 = &av7110->demux1;
1307
1308 dprintk(4, "%p\n", av7110);
1309
1310 if (av7110->registered)
1311 return -1;
1312
1313 av7110->registered = 1;
1314
1315 dvbdemux->priv = (void *) av7110;
1316
1317 for (i = 0; i < 32; i++)
1318 av7110->handle2filter[i] = NULL;
1319
9e615eac
OE		 1320 dvbdemux->filternum = (av7110->full_ts) ? 256 : 32;
1321 dvbdemux->feednum = (av7110->full_ts) ? 256 : 32;
1da177e4
LT		 1322 dvbdemux->start_feed = av7110_start_feed;
1323 dvbdemux->stop_feed = av7110_stop_feed;
1324 dvbdemux->write_to_decoder = av7110_write_to_decoder;
1325 dvbdemux->dmx.capabilities = (DMX_TS_FILTERING | DMX_SECTION_FILTERING |
1326 DMX_MEMORY_BASED_FILTERING);
1327
1328 dvb_dmx_init(&av7110->demux);
1329 av7110->demux.dmx.get_stc = dvb_get_stc;
1330
9e615eac 1331 av7110->dmxdev.filternum = (av7110->full_ts) ? 256 : 32;
1da177e4
LT		 1332 av7110->dmxdev.demux = &dvbdemux->dmx;
1333 av7110->dmxdev.capabilities = 0;
1334
fdc53a6d 1335 dvb_dmxdev_init(&av7110->dmxdev, &av7110->dvb_adapter);
1da177e4
LT		 1336
1337 av7110->hw_frontend.source = DMX_FRONTEND_0;
1338
1339 ret = dvbdemux->dmx.add_frontend(&dvbdemux->dmx, &av7110->hw_frontend);
1340
1341 if (ret < 0)
1342 return ret;
1343
1344 av7110->mem_frontend.source = DMX_MEMORY_FE;
1345
1346 ret = dvbdemux->dmx.add_frontend(&dvbdemux->dmx, &av7110->mem_frontend);
1347
1348 if (ret < 0)
1349 return ret;
1350
1351 ret = dvbdemux->dmx.connect_frontend(&dvbdemux->dmx,
1352 &av7110->hw_frontend);
1353 if (ret < 0)
1354 return ret;
1355
1356 av7110_av_register(av7110);
1357 av7110_ca_register(av7110);
1358
1359#ifdef CONFIG_DVB_AV7110_OSD
fdc53a6d 1360 dvb_register_device(&av7110->dvb_adapter, &av7110->osd_dev,
df2f94e5 1361 &dvbdev_osd, av7110, DVB_DEVICE_OSD, 0);
1da177e4
LT		 1362#endif
1363
fdc53a6d 1364 dvb_net_init(&av7110->dvb_adapter, &av7110->dvb_net, &dvbdemux->dmx);
1da177e4
LT		 1365
1366 if (budgetpatch) {
1367 /* initialize software demux1 without its own frontend
1368 * demux1 hardware is connected to frontend0 of demux0
1369 */
1370 dvbdemux1->priv = (void *) av7110;
1371
1372 dvbdemux1->filternum = 256;
1373 dvbdemux1->feednum = 256;
1374 dvbdemux1->start_feed = budget_start_feed;
1375 dvbdemux1->stop_feed = budget_stop_feed;
1376 dvbdemux1->write_to_decoder = NULL;
1377
1378 dvbdemux1->dmx.capabilities = (DMX_TS_FILTERING | DMX_SECTION_FILTERING |
1379 DMX_MEMORY_BASED_FILTERING);
1380
1381 dvb_dmx_init(&av7110->demux1);
1382
1383 av7110->dmxdev1.filternum = 256;
1384 av7110->dmxdev1.demux = &dvbdemux1->dmx;
1385 av7110->dmxdev1.capabilities = 0;
1386
fdc53a6d 1387 dvb_dmxdev_init(&av7110->dmxdev1, &av7110->dvb_adapter);
1da177e4 1388
fdc53a6d 1389 dvb_net_init(&av7110->dvb_adapter, &av7110->dvb_net1, &dvbdemux1->dmx);
1da177e4
LT		 1390 printk("dvb-ttpci: additional demux1 for budget-patch registered\n");
1391 }
1392 return 0;
1393}
1394
1395
1396static void dvb_unregister(struct av7110 *av7110)
1397{
1398 struct dvb_demux *dvbdemux = &av7110->demux;
1399 struct dvb_demux *dvbdemux1 = &av7110->demux1;
1400
1401 dprintk(4, "%p\n", av7110);
1402
1403 if (!av7110->registered)
1404 return;
1405
1406 if (budgetpatch) {
1407 dvb_net_release(&av7110->dvb_net1);
1408 dvbdemux->dmx.close(&dvbdemux1->dmx);
1409 dvb_dmxdev_release(&av7110->dmxdev1);
1410 dvb_dmx_release(&av7110->demux1);
1411 }
1412
1413 dvb_net_release(&av7110->dvb_net);
1414
1415 dvbdemux->dmx.close(&dvbdemux->dmx);
1416 dvbdemux->dmx.remove_frontend(&dvbdemux->dmx, &av7110->hw_frontend);
1417 dvbdemux->dmx.remove_frontend(&dvbdemux->dmx, &av7110->mem_frontend);
1418
1419 dvb_dmxdev_release(&av7110->dmxdev);
1420 dvb_dmx_release(&av7110->demux);
1421
2bfe031d 1422 if (av7110->fe != NULL) {
1da177e4 1423 dvb_unregister_frontend(av7110->fe);
f52a838b 1424 dvb_frontend_detach(av7110->fe);
2bfe031d 1425 }
1da177e4
LT		 1426 dvb_unregister_device(av7110->osd_dev);
1427 av7110_av_unregister(av7110);
1428 av7110_ca_unregister(av7110);
1429}
1430
1431
1432/****************************************************************************
1433 * I2C client commands
1434 ****************************************************************************/
1435
1436int i2c_writereg(struct av7110 *av7110, u8 id, u8 reg, u8 val)
1437{
1438 u8 msg[2] = { reg, val };
1439 struct i2c_msg msgs;
1440
1441 msgs.flags = 0;
1442 msgs.addr = id / 2;
1443 msgs.len = 2;
1444 msgs.buf = msg;
1445 return i2c_transfer(&av7110->i2c_adap, &msgs, 1);
1446}
1447
1da177e4
LT		 1448u8 i2c_readreg(struct av7110 *av7110, u8 id, u8 reg)
1449{
1450 u8 mm1[] = {0x00};
1451 u8 mm2[] = {0x00};
1452 struct i2c_msg msgs[2];
1453
1454 msgs[0].flags = 0;
1455 msgs[1].flags = I2C_M_RD;
1456 msgs[0].addr = msgs[1].addr = id / 2;
1457 mm1[0] = reg;
1458 msgs[0].len = 1; msgs[1].len = 1;
1459 msgs[0].buf = mm1; msgs[1].buf = mm2;
1460 i2c_transfer(&av7110->i2c_adap, msgs, 2);
1461
1462 return mm2[0];
1463}
1da177e4
LT		 1464
1465/****************************************************************************
1466 * INITIALIZATION
1467 ****************************************************************************/
1468
1469
1470static int check_firmware(struct av7110* av7110)
1471{
1472 u32 crc = 0, len = 0;
1473 unsigned char *ptr;
1474
1475 /* check for firmware magic */
1476 ptr = av7110->bin_fw;
1477 if (ptr[0] != 'A' || ptr[1] != 'V' ||
1478 ptr[2] != 'F' || ptr[3] != 'W') {
1479 printk("dvb-ttpci: this is not an av7110 firmware\n");
1480 return -EINVAL;
1481 }
1482 ptr += 4;
1483
1484 /* check dpram file */
3e085629 1485 crc = get_unaligned_be32(ptr);
1da177e4 1486 ptr += 4;
3e085629 1487 len = get_unaligned_be32(ptr);
1da177e4
LT		 1488 ptr += 4;
1489 if (len >= 512) {
be787ace 1490 printk("dvb-ttpci: dpram file is way too big.\n");
1da177e4
LT		 1491 return -EINVAL;
1492 }
1493 if (crc != crc32_le(0, ptr, len)) {
1494 printk("dvb-ttpci: crc32 of dpram file does not match.\n");
1495 return -EINVAL;
1496 }
1497 av7110->bin_dpram = ptr;
1498 av7110->size_dpram = len;
1499 ptr += len;
1500
1501 /* check root file */
3e085629 1502 crc = get_unaligned_be32(ptr);
1da177e4 1503 ptr += 4;
3e085629 1504 len = get_unaligned_be32(ptr);
1da177e4
LT		 1505 ptr += 4;
1506
1507 if (len <= 200000 || len >= 300000 ||
1508 len > ((av7110->bin_fw + av7110->size_fw) - ptr)) {
1509 printk("dvb-ttpci: root file has strange size (%d). aborting.\n", len);
1510 return -EINVAL;
1511 }
1512 if( crc != crc32_le(0, ptr, len)) {
1513 printk("dvb-ttpci: crc32 of root file does not match.\n");
1514 return -EINVAL;
1515 }
1516 av7110->bin_root = ptr;
1517 av7110->size_root = len;
1518 return 0;
1519}
1520
1da177e4
LT		 1521static void put_firmware(struct av7110* av7110)
1522{
1523 vfree(av7110->bin_fw);
1524}
1525
1526static int get_firmware(struct av7110* av7110)
1527{
1528 int ret;
1529 const struct firmware *fw;
1530
1531 /* request the av7110 firmware, this will block until someone uploads it */
1532 ret = request_firmware(&fw, "dvb-ttpci-01.fw", &av7110->dev->pci->dev);
1533 if (ret) {
1534 if (ret == -ENOENT) {
1535 printk(KERN_ERR "dvb-ttpci: could not load firmware,"
1536 " file not found: dvb-ttpci-01.fw\n");