diff options
author | Jonathan Herman <hermanjl@cs.unc.edu> | 2013-01-22 10:38:37 -0500 |
---|---|---|
committer | Jonathan Herman <hermanjl@cs.unc.edu> | 2013-01-22 10:38:37 -0500 |
commit | fcc9d2e5a6c89d22b8b773a64fb4ad21ac318446 (patch) | |
tree | a57612d1888735a2ec7972891b68c1ac5ec8faea /drivers/media/dvb/ttpci/budget-core.c | |
parent | 8dea78da5cee153b8af9c07a2745f6c55057fe12 (diff) |
Diffstat (limited to 'drivers/media/dvb/ttpci/budget-core.c')
-rw-r--r-- | drivers/media/dvb/ttpci/budget-core.c | 600 |
1 files changed, 600 insertions, 0 deletions
diff --git a/drivers/media/dvb/ttpci/budget-core.c b/drivers/media/dvb/ttpci/budget-core.c new file mode 100644 index 00000000000..37666d4edab --- /dev/null +++ b/drivers/media/dvb/ttpci/budget-core.c | |||
@@ -0,0 +1,600 @@ | |||
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_KNC1CP_MK3: | ||
114 | if (budget->video_port == BUDGET_VIDEO_PORTA) { | ||
115 | saa7146_write(dev, DD1_INIT, 0x06000200); | ||
116 | saa7146_write(dev, MC2, (MASK_09 | MASK_25 | MASK_10 | MASK_26)); | ||
117 | saa7146_write(dev, BRS_CTRL, 0x00000000); | ||
118 | } else { | ||
119 | saa7146_write(dev, DD1_INIT, 0x00000600); | ||
120 | saa7146_write(dev, MC2, (MASK_09 | MASK_25 | MASK_10 | MASK_26)); | ||
121 | saa7146_write(dev, BRS_CTRL, 0x60000000); | ||
122 | } | ||
123 | break; | ||
124 | default: | ||
125 | if (budget->video_port == BUDGET_VIDEO_PORTA) { | ||
126 | saa7146_write(dev, DD1_INIT, 0x06000200); | ||
127 | saa7146_write(dev, MC2, (MASK_09 | MASK_25 | MASK_10 | MASK_26)); | ||
128 | saa7146_write(dev, BRS_CTRL, 0x00000000); | ||
129 | } else { | ||
130 | saa7146_write(dev, DD1_INIT, 0x02000600); | ||
131 | saa7146_write(dev, MC2, (MASK_09 | MASK_25 | MASK_10 | MASK_26)); | ||
132 | saa7146_write(dev, BRS_CTRL, 0x60000000); | ||
133 | } | ||
134 | } | ||
135 | |||
136 | saa7146_write(dev, MC2, (MASK_08 | MASK_24)); | ||
137 | mdelay(10); | ||
138 | |||
139 | saa7146_write(dev, BASE_ODD3, 0); | ||
140 | if (budget->buffer_size > budget->buffer_height * budget->buffer_width) { | ||
141 | // using odd/even buffers | ||
142 | saa7146_write(dev, BASE_EVEN3, budget->buffer_height * budget->buffer_width); | ||
143 | } else { | ||
144 | // using a single buffer | ||
145 | saa7146_write(dev, BASE_EVEN3, 0); | ||
146 | } | ||
147 | saa7146_write(dev, PROT_ADDR3, budget->buffer_size); | ||
148 | saa7146_write(dev, BASE_PAGE3, budget->pt.dma | ME1 | 0x90); | ||
149 | |||
150 | saa7146_write(dev, PITCH3, budget->buffer_width); | ||
151 | saa7146_write(dev, NUM_LINE_BYTE3, | ||
152 | (budget->buffer_height << 16) | budget->buffer_width); | ||
153 | |||
154 | saa7146_write(dev, MC2, (MASK_04 | MASK_20)); | ||
155 | |||
156 | SAA7146_ISR_CLEAR(budget->dev, MASK_10); /* VPE */ | ||
157 | SAA7146_IER_ENABLE(budget->dev, MASK_10); /* VPE */ | ||
158 | saa7146_write(dev, MC1, (MASK_04 | MASK_20)); /* DMA3 on */ | ||
159 | |||
160 | return 0; | ||
161 | } | ||
162 | |||
163 | static int budget_read_fe_status(struct dvb_frontend *fe, fe_status_t *status) | ||
164 | { | ||
165 | struct budget *budget = (struct budget *) fe->dvb->priv; | ||
166 | int synced; | ||
167 | int ret; | ||
168 | |||
169 | if (budget->read_fe_status) | ||
170 | ret = budget->read_fe_status(fe, status); | ||
171 | else | ||
172 | ret = -EINVAL; | ||
173 | |||
174 | if (!ret) { | ||
175 | synced = (*status & FE_HAS_LOCK); | ||
176 | if (synced != budget->fe_synced) { | ||
177 | budget->fe_synced = synced; | ||
178 | spin_lock(&budget->feedlock); | ||
179 | if (synced) | ||
180 | start_ts_capture(budget); | ||
181 | else | ||
182 | stop_ts_capture(budget); | ||
183 | spin_unlock(&budget->feedlock); | ||
184 | } | ||
185 | } | ||
186 | return ret; | ||
187 | } | ||
188 | |||
189 | static void vpeirq(unsigned long data) | ||
190 | { | ||
191 | struct budget *budget = (struct budget *) data; | ||
192 | u8 *mem = (u8 *) (budget->grabbing); | ||
193 | u32 olddma = budget->ttbp; | ||
194 | u32 newdma = saa7146_read(budget->dev, PCI_VDP3); | ||
195 | u32 count; | ||
196 | |||
197 | /* Ensure streamed PCI data is synced to CPU */ | ||
198 | pci_dma_sync_sg_for_cpu(budget->dev->pci, budget->pt.slist, budget->pt.nents, PCI_DMA_FROMDEVICE); | ||
199 | |||
200 | /* nearest lower position divisible by 188 */ | ||
201 | newdma -= newdma % 188; | ||
202 | |||
203 | if (newdma >= budget->buffer_size) | ||
204 | return; | ||
205 | |||
206 | budget->ttbp = newdma; | ||
207 | |||
208 | if (budget->feeding == 0 || newdma == olddma) | ||
209 | return; | ||
210 | |||
211 | if (newdma > olddma) { /* no wraparound, dump olddma..newdma */ | ||
212 | count = newdma - olddma; | ||
213 | dvb_dmx_swfilter_packets(&budget->demux, mem + olddma, count / 188); | ||
214 | } else { /* wraparound, dump olddma..buflen and 0..newdma */ | ||
215 | count = budget->buffer_size - olddma; | ||
216 | dvb_dmx_swfilter_packets(&budget->demux, mem + olddma, count / 188); | ||
217 | count += newdma; | ||
218 | dvb_dmx_swfilter_packets(&budget->demux, mem, newdma / 188); | ||
219 | } | ||
220 | |||
221 | if (count > budget->buffer_warning_threshold) | ||
222 | budget->buffer_warnings++; | ||
223 | |||
224 | if (budget->buffer_warnings && time_after(jiffies, budget->buffer_warning_time)) { | ||
225 | printk("%s %s: used %d times >80%% of buffer (%u bytes now)\n", | ||
226 | budget->dev->name, __func__, budget->buffer_warnings, count); | ||
227 | budget->buffer_warning_time = jiffies + BUFFER_WARNING_WAIT; | ||
228 | budget->buffer_warnings = 0; | ||
229 | } | ||
230 | } | ||
231 | |||
232 | |||
233 | int ttpci_budget_debiread(struct budget *budget, u32 config, int addr, int count, | ||
234 | int uselocks, int nobusyloop) | ||
235 | { | ||
236 | struct saa7146_dev *saa = budget->dev; | ||
237 | int result = 0; | ||
238 | unsigned long flags = 0; | ||
239 | |||
240 | if (count > 4 || count <= 0) | ||
241 | return 0; | ||
242 | |||
243 | if (uselocks) | ||
244 | spin_lock_irqsave(&budget->debilock, flags); | ||
245 | |||
246 | if ((result = saa7146_wait_for_debi_done(saa, nobusyloop)) < 0) { | ||
247 | if (uselocks) | ||
248 | spin_unlock_irqrestore(&budget->debilock, flags); | ||
249 | return result; | ||
250 | } | ||
251 | |||
252 | saa7146_write(saa, DEBI_COMMAND, (count << 17) | 0x10000 | (addr & 0xffff)); | ||
253 | saa7146_write(saa, DEBI_CONFIG, config); | ||
254 | saa7146_write(saa, DEBI_PAGE, 0); | ||
255 | saa7146_write(saa, MC2, (2 << 16) | 2); | ||
256 | |||
257 | if ((result = saa7146_wait_for_debi_done(saa, nobusyloop)) < 0) { | ||
258 | if (uselocks) | ||
259 | spin_unlock_irqrestore(&budget->debilock, flags); | ||
260 | return result; | ||
261 | } | ||
262 | |||
263 | result = saa7146_read(saa, DEBI_AD); | ||
264 | result &= (0xffffffffUL >> ((4 - count) * 8)); | ||
265 | |||
266 | if (uselocks) | ||
267 | spin_unlock_irqrestore(&budget->debilock, flags); | ||
268 | |||
269 | return result; | ||
270 | } | ||
271 | |||
272 | int ttpci_budget_debiwrite(struct budget *budget, u32 config, int addr, | ||
273 | int count, u32 value, int uselocks, int nobusyloop) | ||
274 | { | ||
275 | struct saa7146_dev *saa = budget->dev; | ||
276 | unsigned long flags = 0; | ||
277 | int result; | ||
278 | |||
279 | if (count > 4 || count <= 0) | ||
280 | return 0; | ||
281 | |||
282 | if (uselocks) | ||
283 | spin_lock_irqsave(&budget->debilock, flags); | ||
284 | |||
285 | if ((result = saa7146_wait_for_debi_done(saa, nobusyloop)) < 0) { | ||
286 | if (uselocks) | ||
287 | spin_unlock_irqrestore(&budget->debilock, flags); | ||
288 | return result; | ||
289 | } | ||
290 | |||
291 | saa7146_write(saa, DEBI_COMMAND, (count << 17) | 0x00000 | (addr & 0xffff)); | ||
292 | saa7146_write(saa, DEBI_CONFIG, config); | ||
293 | saa7146_write(saa, DEBI_PAGE, 0); | ||
294 | saa7146_write(saa, DEBI_AD, value); | ||
295 | saa7146_write(saa, MC2, (2 << 16) | 2); | ||
296 | |||
297 | if ((result = saa7146_wait_for_debi_done(saa, nobusyloop)) < 0) { | ||
298 | if (uselocks) | ||
299 | spin_unlock_irqrestore(&budget->debilock, flags); | ||
300 | return result; | ||
301 | } | ||
302 | |||
303 | if (uselocks) | ||
304 | spin_unlock_irqrestore(&budget->debilock, flags); | ||
305 | return 0; | ||
306 | } | ||
307 | |||
308 | |||
309 | /**************************************************************************** | ||
310 | * DVB API SECTION | ||
311 | ****************************************************************************/ | ||
312 | |||
313 | static int budget_start_feed(struct dvb_demux_feed *feed) | ||
314 | { | ||
315 | struct dvb_demux *demux = feed->demux; | ||
316 | struct budget *budget = (struct budget *) demux->priv; | ||
317 | int status = 0; | ||
318 | |||
319 | dprintk(2, "budget: %p\n", budget); | ||
320 | |||
321 | if (!demux->dmx.frontend) | ||
322 | return -EINVAL; | ||
323 | |||
324 | spin_lock(&budget->feedlock); | ||
325 | feed->pusi_seen = 0; /* have a clean section start */ | ||
326 | if (budget->feeding++ == 0) | ||
327 | status = start_ts_capture(budget); | ||
328 | spin_unlock(&budget->feedlock); | ||
329 | return status; | ||
330 | } | ||
331 | |||
332 | static int budget_stop_feed(struct dvb_demux_feed *feed) | ||
333 | { | ||
334 | struct dvb_demux *demux = feed->demux; | ||
335 | struct budget *budget = (struct budget *) demux->priv; | ||
336 | int status = 0; | ||
337 | |||
338 | dprintk(2, "budget: %p\n", budget); | ||
339 | |||
340 | spin_lock(&budget->feedlock); | ||
341 | if (--budget->feeding == 0) | ||
342 | status = stop_ts_capture(budget); | ||
343 | spin_unlock(&budget->feedlock); | ||
344 | return status; | ||
345 | } | ||
346 | |||
347 | static int budget_register(struct budget *budget) | ||
348 | { | ||
349 | struct dvb_demux *dvbdemux = &budget->demux; | ||
350 | int ret; | ||
351 | |||
352 | dprintk(2, "budget: %p\n", budget); | ||
353 | |||
354 | dvbdemux->priv = (void *) budget; | ||
355 | |||
356 | dvbdemux->filternum = 256; | ||
357 | dvbdemux->feednum = 256; | ||
358 | dvbdemux->start_feed = budget_start_feed; | ||
359 | dvbdemux->stop_feed = budget_stop_feed; | ||
360 | dvbdemux->write_to_decoder = NULL; | ||
361 | |||
362 | dvbdemux->dmx.capabilities = (DMX_TS_FILTERING | DMX_SECTION_FILTERING | | ||
363 | DMX_MEMORY_BASED_FILTERING); | ||
364 | |||
365 | dvb_dmx_init(&budget->demux); | ||
366 | |||
367 | budget->dmxdev.filternum = 256; | ||
368 | budget->dmxdev.demux = &dvbdemux->dmx; | ||
369 | budget->dmxdev.capabilities = 0; | ||
370 | |||
371 | dvb_dmxdev_init(&budget->dmxdev, &budget->dvb_adapter); | ||
372 | |||
373 | budget->hw_frontend.source = DMX_FRONTEND_0; | ||
374 | |||
375 | ret = dvbdemux->dmx.add_frontend(&dvbdemux->dmx, &budget->hw_frontend); | ||
376 | |||
377 | if (ret < 0) | ||
378 | return ret; | ||
379 | |||
380 | budget->mem_frontend.source = DMX_MEMORY_FE; | ||
381 | ret = dvbdemux->dmx.add_frontend(&dvbdemux->dmx, &budget->mem_frontend); | ||
382 | if (ret < 0) | ||
383 | return ret; | ||
384 | |||
385 | ret = dvbdemux->dmx.connect_frontend(&dvbdemux->dmx, &budget->hw_frontend); | ||
386 | if (ret < 0) | ||
387 | return ret; | ||
388 | |||
389 | dvb_net_init(&budget->dvb_adapter, &budget->dvb_net, &dvbdemux->dmx); | ||
390 | |||
391 | return 0; | ||
392 | } | ||
393 | |||
394 | static void budget_unregister(struct budget *budget) | ||
395 | { | ||
396 | struct dvb_demux *dvbdemux = &budget->demux; | ||
397 | |||
398 | dprintk(2, "budget: %p\n", budget); | ||
399 | |||
400 | dvb_net_release(&budget->dvb_net); | ||
401 | |||
402 | dvbdemux->dmx.close(&dvbdemux->dmx); | ||
403 | dvbdemux->dmx.remove_frontend(&dvbdemux->dmx, &budget->hw_frontend); | ||
404 | dvbdemux->dmx.remove_frontend(&dvbdemux->dmx, &budget->mem_frontend); | ||
405 | |||
406 | dvb_dmxdev_release(&budget->dmxdev); | ||
407 | dvb_dmx_release(&budget->demux); | ||
408 | } | ||
409 | |||
410 | int ttpci_budget_init(struct budget *budget, struct saa7146_dev *dev, | ||
411 | struct saa7146_pci_extension_data *info, | ||
412 | struct module *owner, short *adapter_nums) | ||
413 | { | ||
414 | int ret = 0; | ||
415 | struct budget_info *bi = info->ext_priv; | ||
416 | int max_bufsize; | ||
417 | int height_mask; | ||
418 | |||
419 | memset(budget, 0, sizeof(struct budget)); | ||
420 | |||
421 | dprintk(2, "dev: %p, budget: %p\n", dev, budget); | ||
422 | |||
423 | budget->card = bi; | ||
424 | budget->dev = (struct saa7146_dev *) dev; | ||
425 | |||
426 | switch(budget->card->type) { | ||
427 | case BUDGET_FS_ACTIVY: | ||
428 | budget->buffer_width = TS_WIDTH_ACTIVY; | ||
429 | max_bufsize = TS_MAX_BUFSIZE_K_ACTIVY; | ||
430 | height_mask = TS_HEIGHT_MASK_ACTIVY; | ||
431 | break; | ||
432 | |||
433 | case BUDGET_KNC1C: | ||
434 | case BUDGET_KNC1CP: | ||
435 | case BUDGET_CIN1200C: | ||
436 | case BUDGET_KNC1C_MK3: | ||
437 | case BUDGET_KNC1CP_MK3: | ||
438 | case BUDGET_CIN1200C_MK3: | ||
439 | budget->buffer_width = TS_WIDTH_DVBC; | ||
440 | max_bufsize = TS_MAX_BUFSIZE_K_DVBC; | ||
441 | height_mask = TS_HEIGHT_MASK_DVBC; | ||
442 | break; | ||
443 | |||
444 | default: | ||
445 | budget->buffer_width = TS_WIDTH; | ||
446 | max_bufsize = TS_MAX_BUFSIZE_K; | ||
447 | height_mask = TS_HEIGHT_MASK; | ||
448 | } | ||
449 | |||
450 | if (dma_buffer_size < TS_MIN_BUFSIZE_K) | ||
451 | dma_buffer_size = TS_MIN_BUFSIZE_K; | ||
452 | else if (dma_buffer_size > max_bufsize) | ||
453 | dma_buffer_size = max_bufsize; | ||
454 | |||
455 | budget->buffer_height = dma_buffer_size * 1024 / budget->buffer_width; | ||
456 | if (budget->buffer_height > 0xfff) { | ||
457 | budget->buffer_height /= 2; | ||
458 | budget->buffer_height &= height_mask; | ||
459 | budget->buffer_size = 2 * budget->buffer_height * budget->buffer_width; | ||
460 | } else { | ||
461 | budget->buffer_height &= height_mask; | ||
462 | budget->buffer_size = budget->buffer_height * budget->buffer_width; | ||
463 | } | ||
464 | budget->buffer_warning_threshold = budget->buffer_size * 80/100; | ||
465 | budget->buffer_warnings = 0; | ||
466 | budget->buffer_warning_time = jiffies; | ||
467 | |||
468 | dprintk(2, "%s: buffer type = %s, width = %d, height = %d\n", | ||
469 | budget->dev->name, | ||
470 | budget->buffer_size > budget->buffer_width * budget->buffer_height ? "odd/even" : "single", | ||
471 | budget->buffer_width, budget->buffer_height); | ||
472 | printk("%s: dma buffer size %u\n", budget->dev->name, budget->buffer_size); | ||
473 | |||
474 | ret = dvb_register_adapter(&budget->dvb_adapter, budget->card->name, | ||
475 | owner, &budget->dev->pci->dev, adapter_nums); | ||
476 | if (ret < 0) | ||
477 | return ret; | ||
478 | |||
479 | /* set dd1 stream a & b */ | ||
480 | saa7146_write(dev, DD1_STREAM_B, 0x00000000); | ||
481 | saa7146_write(dev, MC2, (MASK_09 | MASK_25)); | ||
482 | saa7146_write(dev, MC2, (MASK_10 | MASK_26)); | ||
483 | saa7146_write(dev, DD1_INIT, 0x02000000); | ||
484 | saa7146_write(dev, MC2, (MASK_09 | MASK_25 | MASK_10 | MASK_26)); | ||
485 | |||
486 | if (bi->type != BUDGET_FS_ACTIVY) | ||
487 | budget->video_port = BUDGET_VIDEO_PORTB; | ||
488 | else | ||
489 | budget->video_port = BUDGET_VIDEO_PORTA; | ||
490 | spin_lock_init(&budget->feedlock); | ||
491 | spin_lock_init(&budget->debilock); | ||
492 | |||
493 | /* the Siemens DVB needs this if you want to have the i2c chips | ||
494 | get recognized before the main driver is loaded */ | ||
495 | if (bi->type != BUDGET_FS_ACTIVY) | ||
496 | saa7146_write(dev, GPIO_CTRL, 0x500000); /* GPIO 3 = 1 */ | ||
497 | |||
498 | strlcpy(budget->i2c_adap.name, budget->card->name, sizeof(budget->i2c_adap.name)); | ||
499 | |||
500 | saa7146_i2c_adapter_prepare(dev, &budget->i2c_adap, SAA7146_I2C_BUS_BIT_RATE_120); | ||
501 | strcpy(budget->i2c_adap.name, budget->card->name); | ||
502 | |||
503 | if (i2c_add_adapter(&budget->i2c_adap) < 0) { | ||
504 | ret = -ENOMEM; | ||
505 | goto err_dvb_unregister; | ||
506 | } | ||
507 | |||
508 | ttpci_eeprom_parse_mac(&budget->i2c_adap, budget->dvb_adapter.proposed_mac); | ||
509 | |||
510 | budget->grabbing = saa7146_vmalloc_build_pgtable(dev->pci, budget->buffer_size, &budget->pt); | ||
511 | if (NULL == budget->grabbing) { | ||
512 | ret = -ENOMEM; | ||
513 | goto err_del_i2c; | ||
514 | } | ||
515 | |||
516 | saa7146_write(dev, PCI_BT_V1, 0x001c0000); | ||
517 | /* upload all */ | ||
518 | saa7146_write(dev, GPIO_CTRL, 0x000000); | ||
519 | |||
520 | tasklet_init(&budget->vpe_tasklet, vpeirq, (unsigned long) budget); | ||
521 | |||
522 | /* frontend power on */ | ||
523 | if (bi->type != BUDGET_FS_ACTIVY) | ||
524 | saa7146_setgpio(dev, 2, SAA7146_GPIO_OUTHI); | ||
525 | |||
526 | if ((ret = budget_register(budget)) == 0) | ||
527 | return 0; /* Everything OK */ | ||
528 | |||
529 | /* An error occurred, cleanup resources */ | ||
530 | saa7146_vfree_destroy_pgtable(dev->pci, budget->grabbing, &budget->pt); | ||
531 | |||
532 | err_del_i2c: | ||
533 | i2c_del_adapter(&budget->i2c_adap); | ||
534 | |||
535 | err_dvb_unregister: | ||
536 | dvb_unregister_adapter(&budget->dvb_adapter); | ||
537 | |||
538 | return ret; | ||
539 | } | ||
540 | |||
541 | void ttpci_budget_init_hooks(struct budget *budget) | ||
542 | { | ||
543 | if (budget->dvb_frontend && !budget->read_fe_status) { | ||
544 | budget->read_fe_status = budget->dvb_frontend->ops.read_status; | ||
545 | budget->dvb_frontend->ops.read_status = budget_read_fe_status; | ||
546 | } | ||
547 | } | ||
548 | |||
549 | int ttpci_budget_deinit(struct budget *budget) | ||
550 | { | ||
551 | struct saa7146_dev *dev = budget->dev; | ||
552 | |||
553 | dprintk(2, "budget: %p\n", budget); | ||
554 | |||
555 | budget_unregister(budget); | ||
556 | |||
557 | tasklet_kill(&budget->vpe_tasklet); | ||
558 | |||
559 | saa7146_vfree_destroy_pgtable(dev->pci, budget->grabbing, &budget->pt); | ||
560 | |||
561 | i2c_del_adapter(&budget->i2c_adap); | ||
562 | |||
563 | dvb_unregister_adapter(&budget->dvb_adapter); | ||
564 | |||
565 | return 0; | ||
566 | } | ||
567 | |||
568 | void ttpci_budget_irq10_handler(struct saa7146_dev *dev, u32 * isr) | ||
569 | { | ||
570 | struct budget *budget = (struct budget *) dev->ext_priv; | ||
571 | |||
572 | dprintk(8, "dev: %p, budget: %p\n", dev, budget); | ||
573 | |||
574 | if (*isr & MASK_10) | ||
575 | tasklet_schedule(&budget->vpe_tasklet); | ||
576 | } | ||
577 | |||
578 | void ttpci_budget_set_video_port(struct saa7146_dev *dev, int video_port) | ||
579 | { | ||
580 | struct budget *budget = (struct budget *) dev->ext_priv; | ||
581 | |||
582 | spin_lock(&budget->feedlock); | ||
583 | budget->video_port = video_port; | ||
584 | if (budget->feeding) { | ||
585 | stop_ts_capture(budget); | ||
586 | start_ts_capture(budget); | ||
587 | } | ||
588 | spin_unlock(&budget->feedlock); | ||
589 | } | ||
590 | |||
591 | EXPORT_SYMBOL_GPL(ttpci_budget_debiread); | ||
592 | EXPORT_SYMBOL_GPL(ttpci_budget_debiwrite); | ||
593 | EXPORT_SYMBOL_GPL(ttpci_budget_init); | ||
594 | EXPORT_SYMBOL_GPL(ttpci_budget_init_hooks); | ||
595 | EXPORT_SYMBOL_GPL(ttpci_budget_deinit); | ||
596 | EXPORT_SYMBOL_GPL(ttpci_budget_irq10_handler); | ||
597 | EXPORT_SYMBOL_GPL(ttpci_budget_set_video_port); | ||
598 | EXPORT_SYMBOL_GPL(budget_debug); | ||
599 | |||
600 | MODULE_LICENSE("GPL"); | ||