Commit | Line | Data |
---|---|---|
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 | ||
78 | int av7110_debug; | |
79 | ||
80 | static int vidmode = CVBS_RGB_OUT; | |
81 | static int pids_off; | |
82 | static int adac = DVB_ADAC_TI; | |
83 | static int hw_sections; | |
84 | static int rgb_on; | |
85 | static int volume = 255; | |
a5ed425c | 86 | static int budgetpatch; |
4caba426 OE |
87 | static int wss_cfg_4_3 = 0x4008; |
88 | static int wss_cfg_16_9 = 0x0007; | |
2f03ee8e | 89 | static int tv_standard; |
9e615eac | 90 | static int full_ts; |
1da177e4 LT |
91 | |
92 | module_param_named(debug, av7110_debug, int, 0644); | |
93 | MODULE_PARM_DESC(debug, "debug level (bitmask, default 0)"); | |
94 | module_param(vidmode, int, 0444); | |
95 | MODULE_PARM_DESC(vidmode,"analog video out: 0 off, 1 CVBS+RGB (default), 2 CVBS+YC, 3 YC"); | |
96 | module_param(pids_off, int, 0444); | |
97 | MODULE_PARM_DESC(pids_off,"clear video/audio/PCR PID filters when demux is closed"); | |
98 | module_param(adac, int, 0444); | |
99 | MODULE_PARM_DESC(adac,"audio DAC type: 0 TI, 1 CRYSTAL, 2 MSP (use if autodetection fails)"); | |
100 | module_param(hw_sections, int, 0444); | |
101 | MODULE_PARM_DESC(hw_sections, "0 use software section filter, 1 use hardware"); | |
102 | module_param(rgb_on, int, 0444); | |
103 | MODULE_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"); | |
105 | module_param(volume, int, 0444); | |
106 | MODULE_PARM_DESC(volume, "initial volume: default 255 (range 0-255)"); | |
107 | module_param(budgetpatch, int, 0444); | |
108 | MODULE_PARM_DESC(budgetpatch, "use budget-patch hardware modification: default 0 (0 no, 1 autodetect, 2 always)"); | |
9e615eac OE |
109 | module_param(full_ts, int, 0444); |
110 | MODULE_PARM_DESC(full_ts, "enable code for full-ts hardware modification: 0 disable (default), 1 enable"); | |
4caba426 OE |
111 | module_param(wss_cfg_4_3, int, 0444); |
112 | MODULE_PARM_DESC(wss_cfg_4_3, "WSS 4:3 - default 0x4008 - bit 15: disable, 14: burst mode, 13..0: wss data"); | |
113 | module_param(wss_cfg_16_9, int, 0444); | |
114 | MODULE_PARM_DESC(wss_cfg_16_9, "WSS 16:9 - default 0x0007 - bit 15: disable, 14: burst mode, 13..0: wss data"); | |
2f03ee8e | 115 | module_param(tv_standard, int, 0444); |
116 | MODULE_PARM_DESC(tv_standard, "TV standard: 0 PAL (default), 1 NTSC"); | |
1da177e4 | 117 | |
78e92006 JG |
118 | DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr); |
119 | ||
1da177e4 | 120 | static void restart_feeds(struct av7110 *av7110); |
9e615eac OE |
121 | static int budget_start_feed(struct dvb_demux_feed *feed); |
122 | static int budget_stop_feed(struct dvb_demux_feed *feed); | |
1da177e4 | 123 | |
a5ed425c | 124 | static 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 | ||
135 | static 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 | ||
223 | static 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 | ||
243 | static 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 | ||
251 | static 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 | ||
303 | static 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 | |
350 | static 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 | |
361 | static 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 | 380 | static 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 | } | |
482 | debi_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 | 491 | static 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 | 707 | static 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 | 724 | static 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 | ||
732 | static 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 | ||
742 | static 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 | 765 | int 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 | ||
799 | static 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 | ||
852 | static 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 | 890 | static 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 | 933 | static 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 | ||
974 | static 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 | ||
1042 | static 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 | ||
1090 | static 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 | ||
1129 | static 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 | 1172 | static 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 | ||
1188 | static 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 | ||
1196 | static 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 */ | |
1205 | static 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 | ||
1217 | static 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 | ||
1234 | static 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 | ||
1249 | static 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 | 1263 | static 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 | ||
1302 | static 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 | ||
1396 | static 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 | ||
1436 | int 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 |
1448 | u8 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 | ||
1470 | static 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 |
1521 | static void put_firmware(struct av7110* av7110) |
1522 | { | |
1523 | vfree(av7110->bin_fw); | |
1524 | } | |
1525 | ||
1526 | static 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"); |