diff options
Diffstat (limited to 'drivers/media/pci/ttpci/budget-core.c')
-rw-r--r-- | drivers/media/pci/ttpci/budget-core.c | 602 |
1 files changed, 602 insertions, 0 deletions
diff --git a/drivers/media/pci/ttpci/budget-core.c b/drivers/media/pci/ttpci/budget-core.c new file mode 100644 index 00000000000..37d02fe0913 --- /dev/null +++ b/drivers/media/pci/ttpci/budget-core.c | |||
@@ -0,0 +1,602 @@ | |||
1 | /* | ||
2 | * budget-core.c: driver for the SAA7146 based Budget DVB cards | ||
3 | * | ||
4 | * Compiled from various sources by Michael Hunold <michael@mihu.de> | ||
5 | * | ||
6 | * Copyright (C) 2002 Ralph Metzler <rjkm@metzlerbros.de> | ||
7 | * | ||
8 | * Copyright (C) 1999-2002 Ralph Metzler | ||
9 | * & Marcus Metzler for convergence integrated media GmbH | ||
10 | * | ||
11 | * 26feb2004 Support for FS Activy Card (Grundig tuner) by | ||
12 | * Michael Dreher <michael@5dot1.de>, | ||
13 | * Oliver Endriss <o.endriss@gmx.de>, | ||
14 | * Andreas 'randy' Weinberger | ||
15 | * | ||
16 | * This program is free software; you can redistribute it and/or | ||
17 | * modify it under the terms of the GNU General Public License | ||
18 | * as published by the Free Software Foundation; either version 2 | ||
19 | * of the License, or (at your option) any later version. | ||
20 | * | ||
21 | * | ||
22 | * This program is distributed in the hope that it will be useful, | ||
23 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
24 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
25 | * GNU General Public License for more details. | ||
26 | * | ||
27 | * | ||
28 | * You should have received a copy of the GNU General Public License | ||
29 | * along with this program; if not, write to the Free Software | ||
30 | * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. | ||
31 | * Or, point your browser to http://www.gnu.org/copyleft/gpl.html | ||
32 | * | ||
33 | * | ||
34 | * the project's page is at http://www.linuxtv.org/ | ||
35 | */ | ||
36 | |||
37 | |||
38 | #include "budget.h" | ||
39 | #include "ttpci-eeprom.h" | ||
40 | |||
41 | #define TS_WIDTH (2 * TS_SIZE) | ||
42 | #define TS_WIDTH_ACTIVY TS_SIZE | ||
43 | #define TS_WIDTH_DVBC TS_SIZE | ||
44 | #define TS_HEIGHT_MASK 0xf00 | ||
45 | #define TS_HEIGHT_MASK_ACTIVY 0xc00 | ||
46 | #define TS_HEIGHT_MASK_DVBC 0xe00 | ||
47 | #define TS_MIN_BUFSIZE_K 188 | ||
48 | #define TS_MAX_BUFSIZE_K 1410 | ||
49 | #define TS_MAX_BUFSIZE_K_ACTIVY 564 | ||
50 | #define TS_MAX_BUFSIZE_K_DVBC 1316 | ||
51 | #define BUFFER_WARNING_WAIT (30*HZ) | ||
52 | |||
53 | int budget_debug; | ||
54 | static int dma_buffer_size = TS_MIN_BUFSIZE_K; | ||
55 | module_param_named(debug, budget_debug, int, 0644); | ||
56 | module_param_named(bufsize, dma_buffer_size, int, 0444); | ||
57 | MODULE_PARM_DESC(debug, "Turn on/off budget debugging (default:off)."); | ||
58 | MODULE_PARM_DESC(bufsize, "DMA buffer size in KB, default: 188, min: 188, max: 1410 (Activy: 564)"); | ||
59 | |||
60 | /**************************************************************************** | ||
61 | * TT budget / WinTV Nova | ||
62 | ****************************************************************************/ | ||
63 | |||
64 | static int stop_ts_capture(struct budget *budget) | ||
65 | { | ||
66 | dprintk(2, "budget: %p\n", budget); | ||
67 | |||
68 | saa7146_write(budget->dev, MC1, MASK_20); // DMA3 off | ||
69 | SAA7146_IER_DISABLE(budget->dev, MASK_10); | ||
70 | return 0; | ||
71 | } | ||
72 | |||
73 | static int start_ts_capture(struct budget *budget) | ||
74 | { | ||
75 | struct saa7146_dev *dev = budget->dev; | ||
76 | |||
77 | dprintk(2, "budget: %p\n", budget); | ||
78 | |||
79 | if (!budget->feeding || !budget->fe_synced) | ||
80 | return 0; | ||
81 | |||
82 | saa7146_write(dev, MC1, MASK_20); // DMA3 off | ||
83 | |||
84 | memset(budget->grabbing, 0x00, budget->buffer_size); | ||
85 | |||
86 | saa7146_write(dev, PCI_BT_V1, 0x001c0000 | (saa7146_read(dev, PCI_BT_V1) & ~0x001f0000)); | ||
87 | |||
88 | budget->ttbp = 0; | ||
89 | |||
90 | /* | ||
91 | * Signal path on the Activy: | ||
92 | * | ||
93 | * tuner -> SAA7146 port A -> SAA7146 BRS -> SAA7146 DMA3 -> memory | ||
94 | * | ||
95 | * Since the tuner feeds 204 bytes packets into the SAA7146, | ||
96 | * DMA3 is configured to strip the trailing 16 FEC bytes: | ||
97 | * Pitch: 188, NumBytes3: 188, NumLines3: 1024 | ||
98 | */ | ||
99 | |||
100 | switch(budget->card->type) { | ||
101 | case BUDGET_FS_ACTIVY: | ||
102 | saa7146_write(dev, DD1_INIT, 0x04000000); | ||
103 | saa7146_write(dev, MC2, (MASK_09 | MASK_25)); | ||
104 | saa7146_write(dev, BRS_CTRL, 0x00000000); | ||
105 | break; | ||
106 | case BUDGET_PATCH: | ||
107 | saa7146_write(dev, DD1_INIT, 0x00000200); | ||
108 | saa7146_write(dev, MC2, (MASK_10 | MASK_26)); | ||
109 | saa7146_write(dev, BRS_CTRL, 0x60000000); | ||
110 | break; | ||
111 | case BUDGET_CIN1200C_MK3: | ||
112 | case BUDGET_KNC1C_MK3: | ||
113 | case BUDGET_KNC1C_TDA10024: | ||
114 | case BUDGET_KNC1CP_MK3: | ||
115 | if (budget->video_port == BUDGET_VIDEO_PORTA) { | ||
116 | saa7146_write(dev, DD1_INIT, 0x06000200); | ||
117 | saa7146_write(dev, MC2, (MASK_09 | MASK_25 | MASK_10 | MASK_26)); | ||
118 | saa7146_write(dev, BRS_CTRL, 0x00000000); | ||
119 | } else { | ||
120 | saa7146_write(dev, DD1_INIT, 0x00000600); | ||
121 | saa7146_write(dev, MC2, (MASK_09 | MASK_25 | MASK_10 | MASK_26)); | ||
122 | saa7146_write(dev, BRS_CTRL, 0x60000000); | ||
123 | } | ||
124 | break; | ||
125 | default: | ||
126 | if (budget->video_port == BUDGET_VIDEO_PORTA) { | ||
127 | saa7146_write(dev, DD1_INIT, 0x06000200); | ||
128 | saa7146_write(dev, MC2, (MASK_09 | MASK_25 | MASK_10 | MASK_26)); | ||
129 | saa7146_write(dev, BRS_CTRL, 0x00000000); | ||
130 | } else { | ||
131 | saa7146_write(dev, DD1_INIT, 0x02000600); | ||
132 | saa7146_write(dev, MC2, (MASK_09 | MASK_25 | MASK_10 | MASK_26)); | ||
133 | saa7146_write(dev, BRS_CTRL, 0x60000000); | ||
134 | } | ||
135 | } | ||
136 | |||
137 | saa7146_write(dev, MC2, (MASK_08 | MASK_24)); | ||
138 | mdelay(10); | ||
139 | |||
140 | saa7146_write(dev, BASE_ODD3, 0); | ||
141 | if (budget->buffer_size > budget->buffer_height * budget->buffer_width) { | ||
142 | // using odd/even buffers | ||
143 | saa7146_write(dev, BASE_EVEN3, budget->buffer_height * budget->buffer_width); | ||
144 | } else { | ||
145 | // using a single buffer | ||
146 | saa7146_write(dev, BASE_EVEN3, 0); | ||
147 | } | ||
148 | saa7146_write(dev, PROT_ADDR3, budget->buffer_size); | ||
149 | saa7146_write(dev, BASE_PAGE3, budget->pt.dma | ME1 | 0x90); | ||
150 | |||
151 | saa7146_write(dev, PITCH3, budget->buffer_width); | ||
152 | saa7146_write(dev, NUM_LINE_BYTE3, | ||
153 | (budget->buffer_height << 16) | budget->buffer_width); | ||
154 | |||
155 | saa7146_write(dev, MC2, (MASK_04 | MASK_20)); | ||
156 | |||
157 | SAA7146_ISR_CLEAR(budget->dev, MASK_10); /* VPE */ | ||
158 | SAA7146_IER_ENABLE(budget->dev, MASK_10); /* VPE */ | ||
159 | saa7146_write(dev, MC1, (MASK_04 | MASK_20)); /* DMA3 on */ | ||
160 | |||
161 | return 0; | ||
162 | } | ||
163 | |||
164 | static int budget_read_fe_status(struct dvb_frontend *fe, fe_status_t *status) | ||
165 | { | ||
166 | struct budget *budget = (struct budget *) fe->dvb->priv; | ||
167 | int synced; | ||
168 | int ret; | ||
169 | |||
170 | if (budget->read_fe_status) | ||
171 | ret = budget->read_fe_status(fe, status); | ||
172 | else | ||
173 | ret = -EINVAL; | ||
174 | |||
175 | if (!ret) { | ||
176 | synced = (*status & FE_HAS_LOCK); | ||
177 | if (synced != budget->fe_synced) { | ||
178 | budget->fe_synced = synced; | ||
179 | spin_lock(&budget->feedlock); | ||
180 | if (synced) | ||
181 | start_ts_capture(budget); | ||
182 | else | ||
183 | stop_ts_capture(budget); | ||
184 | spin_unlock(&budget->feedlock); | ||
185 | } | ||
186 | } | ||
187 | return ret; | ||
188 | } | ||
189 | |||
190 | static void vpeirq(unsigned long data) | ||
191 | { | ||
192 | struct budget *budget = (struct budget *) data; | ||
193 | u8 *mem = (u8 *) (budget->grabbing); | ||
194 | u32 olddma = budget->ttbp; | ||
195 | u32 newdma = saa7146_read(budget->dev, PCI_VDP3); | ||
196 | u32 count; | ||
197 | |||
198 | /* Ensure streamed PCI data is synced to CPU */ | ||
199 | pci_dma_sync_sg_for_cpu(budget->dev->pci, budget->pt.slist, budget->pt.nents, PCI_DMA_FROMDEVICE); | ||
200 | |||
201 | /* nearest lower position divisible by 188 */ | ||
202 | newdma -= newdma % 188; | ||
203 | |||
204 | if (newdma >= budget->buffer_size) | ||
205 | return; | ||
206 | |||
207 | budget->ttbp = newdma; | ||
208 | |||
209 | if (budget->feeding == 0 || newdma == olddma) | ||
210 | return; | ||
211 | |||
212 | if (newdma > olddma) { /* no wraparound, dump olddma..newdma */ | ||
213 | count = newdma - olddma; | ||
214 | dvb_dmx_swfilter_packets(&budget->demux, mem + olddma, count / 188); | ||
215 | } else { /* wraparound, dump olddma..buflen and 0..newdma */ | ||
216 | count = budget->buffer_size - olddma; | ||
217 | dvb_dmx_swfilter_packets(&budget->demux, mem + olddma, count / 188); | ||
218 | count += newdma; | ||
219 | dvb_dmx_swfilter_packets(&budget->demux, mem, newdma / 188); | ||
220 | } | ||
221 | |||
222 | if (count > budget->buffer_warning_threshold) | ||
223 | budget->buffer_warnings++; | ||
224 | |||
225 | if (budget->buffer_warnings && time_after(jiffies, budget->buffer_warning_time)) { | ||
226 | printk("%s %s: used %d times >80%% of buffer (%u bytes now)\n", | ||
227 | budget->dev->name, __func__, budget->buffer_warnings, count); | ||
228 | budget->buffer_warning_time = jiffies + BUFFER_WARNING_WAIT; | ||
229 | budget->buffer_warnings = 0; | ||
230 | } | ||
231 | } | ||
232 | |||
233 | |||
234 | int ttpci_budget_debiread(struct budget *budget, u32 config, int addr, int count, | ||
235 | int uselocks, int nobusyloop) | ||
236 | { | ||
237 | struct saa7146_dev *saa = budget->dev; | ||
238 | int result = 0; | ||
239 | unsigned long flags = 0; | ||
240 | |||
241 | if (count > 4 || count <= 0) | ||
242 | return 0; | ||
243 | |||
244 | if (uselocks) | ||
245 | spin_lock_irqsave(&budget->debilock, flags); | ||
246 | |||
247 | if ((result = saa7146_wait_for_debi_done(saa, nobusyloop)) < 0) { | ||
248 | if (uselocks) | ||
249 | spin_unlock_irqrestore(&budget->debilock, flags); | ||
250 | return result; | ||
251 | } | ||
252 | |||
253 | saa7146_write(saa, DEBI_COMMAND, (count << 17) | 0x10000 | (addr & 0xffff)); | ||
254 | saa7146_write(saa, DEBI_CONFIG, config); | ||
255 | saa7146_write(saa, DEBI_PAGE, 0); | ||
256 | saa7146_write(saa, MC2, (2 << 16) | 2); | ||
257 | |||
258 | if ((result = saa7146_wait_for_debi_done(saa, nobusyloop)) < 0) { | ||
259 | if (uselocks) | ||
260 | spin_unlock_irqrestore(&budget->debilock, flags); | ||
261 | return result; | ||
262 | } | ||
263 | |||
264 | result = saa7146_read(saa, DEBI_AD); | ||
265 | result &= (0xffffffffUL >> ((4 - count) * 8)); | ||
266 | |||
267 | if (uselocks) | ||
268 | spin_unlock_irqrestore(&budget->debilock, flags); | ||
269 | |||
270 | return result; | ||
271 | } | ||
272 | |||
273 | int ttpci_budget_debiwrite(struct budget *budget, u32 config, int addr, | ||
274 | int count, u32 value, int uselocks, int nobusyloop) | ||
275 | { | ||
276 | struct saa7146_dev *saa = budget->dev; | ||
277 | unsigned long flags = 0; | ||
278 | int result; | ||
279 | |||
280 | if (count > 4 || count <= 0) | ||
281 | return 0; | ||
282 | |||
283 | if (uselocks) | ||
284 | spin_lock_irqsave(&budget->debilock, flags); | ||
285 | |||
286 | if ((result = saa7146_wait_for_debi_done(saa, nobusyloop)) < 0) { | ||
287 | if (uselocks) | ||
288 | spin_unlock_irqrestore(&budget->debilock, flags); | ||
289 | return result; | ||
290 | } | ||
291 | |||
292 | saa7146_write(saa, DEBI_COMMAND, (count << 17) | 0x00000 | (addr & 0xffff)); | ||
293 | saa7146_write(saa, DEBI_CONFIG, config); | ||
294 | saa7146_write(saa, DEBI_PAGE, 0); | ||
295 | saa7146_write(saa, DEBI_AD, value); | ||
296 | saa7146_write(saa, MC2, (2 << 16) | 2); | ||
297 | |||
298 | if ((result = saa7146_wait_for_debi_done(saa, nobusyloop)) < 0) { | ||
299 | if (uselocks) | ||
300 | spin_unlock_irqrestore(&budget->debilock, flags); | ||
301 | return result; | ||
302 | } | ||
303 | |||
304 | if (uselocks) | ||
305 | spin_unlock_irqrestore(&budget->debilock, flags); | ||
306 | return 0; | ||
307 | } | ||
308 | |||
309 | |||
310 | /**************************************************************************** | ||
311 | * DVB API SECTION | ||
312 | ****************************************************************************/ | ||
313 | |||
314 | static int budget_start_feed(struct dvb_demux_feed *feed) | ||
315 | { | ||
316 | struct dvb_demux *demux = feed->demux; | ||
317 | struct budget *budget = (struct budget *) demux->priv; | ||
318 | int status = 0; | ||
319 | |||
320 | dprintk(2, "budget: %p\n", budget); | ||
321 | |||
322 | if (!demux->dmx.frontend) | ||
323 | return -EINVAL; | ||
324 | |||
325 | spin_lock(&budget->feedlock); | ||
326 | feed->pusi_seen = 0; /* have a clean section start */ | ||
327 | if (budget->feeding++ == 0) | ||
328 | status = start_ts_capture(budget); | ||
329 | spin_unlock(&budget->feedlock); | ||
330 | return status; | ||
331 | } | ||
332 | |||
333 | static int budget_stop_feed(struct dvb_demux_feed *feed) | ||
334 | { | ||
335 | struct dvb_demux *demux = feed->demux; | ||
336 | struct budget *budget = (struct budget *) demux->priv; | ||
337 | int status = 0; | ||
338 | |||
339 | dprintk(2, "budget: %p\n", budget); | ||
340 | |||
341 | spin_lock(&budget->feedlock); | ||
342 | if (--budget->feeding == 0) | ||
343 | status = stop_ts_capture(budget); | ||
344 | spin_unlock(&budget->feedlock); | ||
345 | return status; | ||
346 | } | ||
347 | |||
348 | static int budget_register(struct budget *budget) | ||
349 | { | ||
350 | struct dvb_demux *dvbdemux = &budget->demux; | ||
351 | int ret; | ||
352 | |||
353 | dprintk(2, "budget: %p\n", budget); | ||
354 | |||
355 | dvbdemux->priv = (void *) budget; | ||
356 | |||
357 | dvbdemux->filternum = 256; | ||
358 | dvbdemux->feednum = 256; | ||
359 | dvbdemux->start_feed = budget_start_feed; | ||
360 | dvbdemux->stop_feed = budget_stop_feed; | ||
361 | dvbdemux->write_to_decoder = NULL; | ||
362 | |||
363 | dvbdemux->dmx.capabilities = (DMX_TS_FILTERING | DMX_SECTION_FILTERING | | ||
364 | DMX_MEMORY_BASED_FILTERING); | ||
365 | |||
366 | dvb_dmx_init(&budget->demux); | ||
367 | |||
368 | budget->dmxdev.filternum = 256; | ||
369 | budget->dmxdev.demux = &dvbdemux->dmx; | ||
370 | budget->dmxdev.capabilities = 0; | ||
371 | |||
372 | dvb_dmxdev_init(&budget->dmxdev, &budget->dvb_adapter); | ||
373 | |||
374 | budget->hw_frontend.source = DMX_FRONTEND_0; | ||
375 | |||
376 | ret = dvbdemux->dmx.add_frontend(&dvbdemux->dmx, &budget->hw_frontend); | ||
377 | |||
378 | if (ret < 0) | ||
379 | return ret; | ||
380 | |||
381 | budget->mem_frontend.source = DMX_MEMORY_FE; | ||
382 | ret = dvbdemux->dmx.add_frontend(&dvbdemux->dmx, &budget->mem_frontend); | ||
383 | if (ret < 0) | ||
384 | return ret; | ||
385 | |||
386 | ret = dvbdemux->dmx.connect_frontend(&dvbdemux->dmx, &budget->hw_frontend); | ||
387 | if (ret < 0) | ||
388 | return ret; | ||
389 | |||
390 | dvb_net_init(&budget->dvb_adapter, &budget->dvb_net, &dvbdemux->dmx); | ||
391 | |||
392 | return 0; | ||
393 | } | ||
394 | |||
395 | static void budget_unregister(struct budget *budget) | ||
396 | { | ||
397 | struct dvb_demux *dvbdemux = &budget->demux; | ||
398 | |||
399 | dprintk(2, "budget: %p\n", budget); | ||
400 | |||
401 | dvb_net_release(&budget->dvb_net); | ||
402 | |||
403 | dvbdemux->dmx.close(&dvbdemux->dmx); | ||
404 | dvbdemux->dmx.remove_frontend(&dvbdemux->dmx, &budget->hw_frontend); | ||
405 | dvbdemux->dmx.remove_frontend(&dvbdemux->dmx, &budget->mem_frontend); | ||
406 | |||
407 | dvb_dmxdev_release(&budget->dmxdev); | ||
408 | dvb_dmx_release(&budget->demux); | ||
409 | } | ||
410 | |||
411 | int ttpci_budget_init(struct budget *budget, struct saa7146_dev *dev, | ||
412 | struct saa7146_pci_extension_data *info, | ||
413 | struct module *owner, short *adapter_nums) | ||
414 | { | ||
415 | int ret = 0; | ||
416 | struct budget_info *bi = info->ext_priv; | ||
417 | int max_bufsize; | ||
418 | int height_mask; | ||
419 | |||
420 | memset(budget, 0, sizeof(struct budget)); | ||
421 | |||
422 | dprintk(2, "dev: %p, budget: %p\n", dev, budget); | ||
423 | |||
424 | budget->card = bi; | ||
425 | budget->dev = (struct saa7146_dev *) dev; | ||
426 | |||
427 | switch(budget->card->type) { | ||
428 | case BUDGET_FS_ACTIVY: | ||
429 | budget->buffer_width = TS_WIDTH_ACTIVY; | ||
430 | max_bufsize = TS_MAX_BUFSIZE_K_ACTIVY; | ||
431 | height_mask = TS_HEIGHT_MASK_ACTIVY; | ||
432 | break; | ||
433 | |||
434 | case BUDGET_KNC1C: | ||
435 | case BUDGET_KNC1CP: | ||
436 | case BUDGET_CIN1200C: | ||
437 | case BUDGET_KNC1C_MK3: | ||
438 | case BUDGET_KNC1C_TDA10024: | ||
439 | case BUDGET_KNC1CP_MK3: | ||
440 | case BUDGET_CIN1200C_MK3: | ||
441 | budget->buffer_width = TS_WIDTH_DVBC; | ||
442 | max_bufsize = TS_MAX_BUFSIZE_K_DVBC; | ||
443 | height_mask = TS_HEIGHT_MASK_DVBC; | ||
444 | break; | ||
445 | |||
446 | default: | ||
447 | budget->buffer_width = TS_WIDTH; | ||
448 | max_bufsize = TS_MAX_BUFSIZE_K; | ||
449 | height_mask = TS_HEIGHT_MASK; | ||
450 | } | ||
451 | |||
452 | if (dma_buffer_size < TS_MIN_BUFSIZE_K) | ||
453 | dma_buffer_size = TS_MIN_BUFSIZE_K; | ||
454 | else if (dma_buffer_size > max_bufsize) | ||
455 | dma_buffer_size = max_bufsize; | ||
456 | |||
457 | budget->buffer_height = dma_buffer_size * 1024 / budget->buffer_width; | ||
458 | if (budget->buffer_height > 0xfff) { | ||
459 | budget->buffer_height /= 2; | ||
460 | budget->buffer_height &= height_mask; | ||
461 | budget->buffer_size = 2 * budget->buffer_height * budget->buffer_width; | ||
462 | } else { | ||
463 | budget->buffer_height &= height_mask; | ||
464 | budget->buffer_size = budget->buffer_height * budget->buffer_width; | ||
465 | } | ||
466 | budget->buffer_warning_threshold = budget->buffer_size * 80/100; | ||
467 | budget->buffer_warnings = 0; | ||
468 | budget->buffer_warning_time = jiffies; | ||
469 | |||
470 | dprintk(2, "%s: buffer type = %s, width = %d, height = %d\n", | ||
471 | budget->dev->name, | ||
472 | budget->buffer_size > budget->buffer_width * budget->buffer_height ? "odd/even" : "single", | ||
473 | budget->buffer_width, budget->buffer_height); | ||
474 | printk("%s: dma buffer size %u\n", budget->dev->name, budget->buffer_size); | ||
475 | |||
476 | ret = dvb_register_adapter(&budget->dvb_adapter, budget->card->name, | ||
477 | owner, &budget->dev->pci->dev, adapter_nums); | ||
478 | if (ret < 0) | ||
479 | return ret; | ||
480 | |||
481 | /* set dd1 stream a & b */ | ||
482 | saa7146_write(dev, DD1_STREAM_B, 0x00000000); | ||
483 | saa7146_write(dev, MC2, (MASK_09 | MASK_25)); | ||
484 | saa7146_write(dev, MC2, (MASK_10 | MASK_26)); | ||
485 | saa7146_write(dev, DD1_INIT, 0x02000000); | ||
486 | saa7146_write(dev, MC2, (MASK_09 | MASK_25 | MASK_10 | MASK_26)); | ||
487 | |||
488 | if (bi->type != BUDGET_FS_ACTIVY) | ||
489 | budget->video_port = BUDGET_VIDEO_PORTB; | ||
490 | else | ||
491 | budget->video_port = BUDGET_VIDEO_PORTA; | ||
492 | spin_lock_init(&budget->feedlock); | ||
493 | spin_lock_init(&budget->debilock); | ||
494 | |||
495 | /* the Siemens DVB needs this if you want to have the i2c chips | ||
496 | get recognized before the main driver is loaded */ | ||
497 | if (bi->type != BUDGET_FS_ACTIVY) | ||
498 | saa7146_write(dev, GPIO_CTRL, 0x500000); /* GPIO 3 = 1 */ | ||
499 | |||
500 | strlcpy(budget->i2c_adap.name, budget->card->name, sizeof(budget->i2c_adap.name)); | ||
501 | |||
502 | saa7146_i2c_adapter_prepare(dev, &budget->i2c_adap, SAA7146_I2C_BUS_BIT_RATE_120); | ||
503 | strcpy(budget->i2c_adap.name, budget->card->name); | ||
504 | |||
505 | if (i2c_add_adapter(&budget->i2c_adap) < 0) { | ||
506 | ret = -ENOMEM; | ||
507 | goto err_dvb_unregister; | ||
508 | } | ||
509 | |||
510 | ttpci_eeprom_parse_mac(&budget->i2c_adap, budget->dvb_adapter.proposed_mac); | ||
511 | |||
512 | budget->grabbing = saa7146_vmalloc_build_pgtable(dev->pci, budget->buffer_size, &budget->pt); | ||
513 | if (NULL == budget->grabbing) { | ||
514 | ret = -ENOMEM; | ||
515 | goto err_del_i2c; | ||
516 | } | ||
517 | |||
518 | saa7146_write(dev, PCI_BT_V1, 0x001c0000); | ||
519 | /* upload all */ | ||
520 | saa7146_write(dev, GPIO_CTRL, 0x000000); | ||
521 | |||
522 | tasklet_init(&budget->vpe_tasklet, vpeirq, (unsigned long) budget); | ||
523 | |||
524 | /* frontend power on */ | ||
525 | if (bi->type != BUDGET_FS_ACTIVY) | ||
526 | saa7146_setgpio(dev, 2, SAA7146_GPIO_OUTHI); | ||
527 | |||
528 | if ((ret = budget_register(budget)) == 0) | ||
529 | return 0; /* Everything OK */ | ||
530 | |||
531 | /* An error occurred, cleanup resources */ | ||
532 | saa7146_vfree_destroy_pgtable(dev->pci, budget->grabbing, &budget->pt); | ||
533 | |||
534 | err_del_i2c: | ||
535 | i2c_del_adapter(&budget->i2c_adap); | ||
536 | |||
537 | err_dvb_unregister: | ||
538 | dvb_unregister_adapter(&budget->dvb_adapter); | ||
539 | |||
540 | return ret; | ||
541 | } | ||
542 | |||
543 | void ttpci_budget_init_hooks(struct budget *budget) | ||
544 | { | ||
545 | if (budget->dvb_frontend && !budget->read_fe_status) { | ||
546 | budget->read_fe_status = budget->dvb_frontend->ops.read_status; | ||
547 | budget->dvb_frontend->ops.read_status = budget_read_fe_status; | ||
548 | } | ||
549 | } | ||
550 | |||
551 | int ttpci_budget_deinit(struct budget *budget) | ||
552 | { | ||
553 | struct saa7146_dev *dev = budget->dev; | ||
554 | |||
555 | dprintk(2, "budget: %p\n", budget); | ||
556 | |||
557 | budget_unregister(budget); | ||
558 | |||
559 | tasklet_kill(&budget->vpe_tasklet); | ||
560 | |||
561 | saa7146_vfree_destroy_pgtable(dev->pci, budget->grabbing, &budget->pt); | ||
562 | |||
563 | i2c_del_adapter(&budget->i2c_adap); | ||
564 | |||
565 | dvb_unregister_adapter(&budget->dvb_adapter); | ||
566 | |||
567 | return 0; | ||
568 | } | ||
569 | |||
570 | void ttpci_budget_irq10_handler(struct saa7146_dev *dev, u32 * isr) | ||
571 | { | ||
572 | struct budget *budget = (struct budget *) dev->ext_priv; | ||
573 | |||
574 | dprintk(8, "dev: %p, budget: %p\n", dev, budget); | ||
575 | |||
576 | if (*isr & MASK_10) | ||
577 | tasklet_schedule(&budget->vpe_tasklet); | ||
578 | } | ||
579 | |||
580 | void ttpci_budget_set_video_port(struct saa7146_dev *dev, int video_port) | ||
581 | { | ||
582 | struct budget *budget = (struct budget *) dev->ext_priv; | ||
583 | |||
584 | spin_lock(&budget->feedlock); | ||
585 | budget->video_port = video_port; | ||
586 | if (budget->feeding) { | ||
587 | stop_ts_capture(budget); | ||
588 | start_ts_capture(budget); | ||
589 | } | ||
590 | spin_unlock(&budget->feedlock); | ||
591 | } | ||
592 | |||
593 | EXPORT_SYMBOL_GPL(ttpci_budget_debiread); | ||
594 | EXPORT_SYMBOL_GPL(ttpci_budget_debiwrite); | ||
595 | EXPORT_SYMBOL_GPL(ttpci_budget_init); | ||
596 | EXPORT_SYMBOL_GPL(ttpci_budget_init_hooks); | ||
597 | EXPORT_SYMBOL_GPL(ttpci_budget_deinit); | ||
598 | EXPORT_SYMBOL_GPL(ttpci_budget_irq10_handler); | ||
599 | EXPORT_SYMBOL_GPL(ttpci_budget_set_video_port); | ||
600 | EXPORT_SYMBOL_GPL(budget_debug); | ||
601 | |||
602 | MODULE_LICENSE("GPL"); | ||