Commit | Line | Data |
---|---|---|
1da177e4 | 1 | /* |
1da177e4 LT |
2 | * |
3 | * Support for the mpeg transport stream transfers | |
4 | * PCI function #2 of the cx2388x. | |
5 | * | |
6 | * (c) 2004 Jelle Foks <jelle@foks.8m.com> | |
7 | * (c) 2004 Chris Pascoe <c.pascoe@itee.uq.edu.au> | |
8 | * (c) 2004 Gerd Knorr <kraxel@bytesex.org> | |
9 | * | |
10 | * This program is free software; you can redistribute it and/or modify | |
11 | * it under the terms of the GNU General Public License as published by | |
12 | * the Free Software Foundation; either version 2 of the License, or | |
13 | * (at your option) any later version. | |
14 | * | |
15 | * This program is distributed in the hope that it will be useful, | |
16 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
17 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
18 | * GNU General Public License for more details. | |
19 | * | |
20 | * You should have received a copy of the GNU General Public License | |
21 | * along with this program; if not, write to the Free Software | |
22 | * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | |
23 | */ | |
24 | ||
25 | #include <linux/module.h> | |
1da177e4 LT |
26 | #include <linux/init.h> |
27 | #include <linux/device.h> | |
c24228da | 28 | #include <linux/dma-mapping.h> |
1da177e4 LT |
29 | #include <linux/interrupt.h> |
30 | #include <asm/delay.h> | |
31 | ||
32 | #include "cx88.h" | |
33 | ||
34 | /* ------------------------------------------------------------------ */ | |
35 | ||
36 | MODULE_DESCRIPTION("mpeg driver for cx2388x based TV cards"); | |
37 | MODULE_AUTHOR("Jelle Foks <jelle@foks.8m.com>"); | |
38 | MODULE_AUTHOR("Chris Pascoe <c.pascoe@itee.uq.edu.au>"); | |
39 | MODULE_AUTHOR("Gerd Knorr <kraxel@bytesex.org> [SuSE Labs]"); | |
40 | MODULE_LICENSE("GPL"); | |
41 | ||
42 | static unsigned int debug = 0; | |
43 | module_param(debug,int,0644); | |
44 | MODULE_PARM_DESC(debug,"enable debug messages [mpeg]"); | |
45 | ||
46 | #define dprintk(level,fmt, arg...) if (debug >= level) \ | |
6c5be74c | 47 | printk(KERN_DEBUG "%s/2-mpeg: " fmt, dev->core->name, ## arg) |
1da177e4 | 48 | |
6c5be74c ST |
49 | #define mpeg_dbg(level,fmt, arg...) if (debug >= level) \ |
50 | printk(KERN_DEBUG "%s/2-mpeg: " fmt, core->name, ## arg) | |
51 | ||
77b74774 MR |
52 | #if defined(CONFIG_MODULES) && defined(MODULE) |
53 | static void request_module_async(struct work_struct *work) | |
54 | { | |
55 | struct cx8802_dev *dev=container_of(work, struct cx8802_dev, request_module_wk); | |
ced80c67 | 56 | |
6a59d64c | 57 | if (dev->core->board.mpeg & CX88_MPEG_DVB) |
77b74774 | 58 | request_module("cx88-dvb"); |
6a59d64c | 59 | if (dev->core->board.mpeg & CX88_MPEG_BLACKBIRD) |
ced80c67 | 60 | request_module("cx88-blackbird"); |
77b74774 MR |
61 | } |
62 | ||
63 | static void request_modules(struct cx8802_dev *dev) | |
64 | { | |
65 | INIT_WORK(&dev->request_module_wk, request_module_async); | |
66 | schedule_work(&dev->request_module_wk); | |
67 | } | |
68 | #else | |
69 | #define request_modules(dev) | |
70 | #endif /* CONFIG_MODULES */ | |
71 | ||
72 | ||
6c5be74c | 73 | static LIST_HEAD(cx8802_devlist); |
1da177e4 LT |
74 | /* ------------------------------------------------------------------ */ |
75 | ||
76 | static int cx8802_start_dma(struct cx8802_dev *dev, | |
77 | struct cx88_dmaqueue *q, | |
78 | struct cx88_buffer *buf) | |
79 | { | |
80 | struct cx88_core *core = dev->core; | |
81 | ||
7717cbed TP |
82 | dprintk(1, "cx8802_start_dma w: %d, h: %d, f: %d\n", |
83 | buf->vb.width, buf->vb.height, buf->vb.field); | |
1da177e4 LT |
84 | |
85 | /* setup fifo + format */ | |
86 | cx88_sram_channel_setup(core, &cx88_sram_channels[SRAM_CH28], | |
87 | dev->ts_packet_size, buf->risc.dma); | |
88 | ||
89 | /* write TS length to chip */ | |
90 | cx_write(MO_TS_LNGTH, buf->vb.width); | |
91 | ||
1da177e4 LT |
92 | /* FIXME: this needs a review. |
93 | * also: move to cx88-blackbird + cx88-dvb source files? */ | |
94 | ||
6c5be74c ST |
95 | dprintk( 1, "core->active_type_id = 0x%08x\n", core->active_type_id); |
96 | ||
97 | if ( (core->active_type_id == CX88_MPEG_DVB) && | |
6a59d64c | 98 | (core->board.mpeg & CX88_MPEG_DVB) ) { |
6c5be74c ST |
99 | |
100 | dprintk( 1, "cx8802_start_dma doing .dvb\n"); | |
1da177e4 | 101 | /* negedge driven & software reset */ |
f1798495 | 102 | cx_write(TS_GEN_CNTRL, 0x0040 | dev->ts_gen_cntrl); |
1da177e4 LT |
103 | udelay(100); |
104 | cx_write(MO_PINMUX_IO, 0x00); | |
0d723c09 | 105 | cx_write(TS_HW_SOP_CNTRL,0x47<<16|188<<4|0x01); |
6a59d64c | 106 | switch (core->boardnr) { |
e52e98a7 MCC |
107 | case CX88_BOARD_DVICO_FUSIONHDTV_3_GOLD_Q: |
108 | case CX88_BOARD_DVICO_FUSIONHDTV_3_GOLD_T: | |
109 | case CX88_BOARD_DVICO_FUSIONHDTV_5_GOLD: | |
da215d22 | 110 | case CX88_BOARD_PCHDTV_HD5500: |
41ef7c1e | 111 | cx_write(TS_SOP_STAT, 1<<13); |
e52e98a7 | 112 | break; |
0fa14aa6 ST |
113 | case CX88_BOARD_HAUPPAUGE_NOVASPLUS_S1: |
114 | case CX88_BOARD_HAUPPAUGE_NOVASE2_S1: | |
115 | cx_write(MO_PINMUX_IO, 0x88); /* Enable MPEG parallel IO and video signal pins */ | |
116 | udelay(100); | |
117 | break; | |
6c5be74c ST |
118 | case CX88_BOARD_HAUPPAUGE_HVR1300: |
119 | break; | |
e52e98a7 | 120 | default: |
41ef7c1e | 121 | cx_write(TS_SOP_STAT, 0x00); |
e52e98a7 | 122 | break; |
f1798495 | 123 | } |
1da177e4 LT |
124 | cx_write(TS_GEN_CNTRL, dev->ts_gen_cntrl); |
125 | udelay(100); | |
6c5be74c | 126 | } else if ( (core->active_type_id == CX88_MPEG_BLACKBIRD) && |
6a59d64c | 127 | (core->board.mpeg & CX88_MPEG_BLACKBIRD) ) { |
6c5be74c | 128 | dprintk( 1, "cx8802_start_dma doing .blackbird\n"); |
1da177e4 LT |
129 | cx_write(MO_PINMUX_IO, 0x88); /* enable MPEG parallel IO */ |
130 | ||
1da177e4 LT |
131 | cx_write(TS_GEN_CNTRL, 0x46); /* punctured clock TS & posedge driven & software reset */ |
132 | udelay(100); | |
133 | ||
134 | cx_write(TS_HW_SOP_CNTRL, 0x408); /* mpeg start byte */ | |
1da177e4 LT |
135 | cx_write(TS_VALERR_CNTRL, 0x2000); |
136 | ||
137 | cx_write(TS_GEN_CNTRL, 0x06); /* punctured clock TS & posedge driven */ | |
138 | udelay(100); | |
6c5be74c ST |
139 | } else { |
140 | printk( "%s() Failed. Unsupported value in .mpeg (0x%08x)\n", __FUNCTION__, | |
6a59d64c | 141 | core->board.mpeg ); |
6c5be74c | 142 | return -EINVAL; |
1da177e4 | 143 | } |
1da177e4 LT |
144 | |
145 | /* reset counter */ | |
146 | cx_write(MO_TS_GPCNTRL, GP_COUNT_CONTROL_RESET); | |
147 | q->count = 1; | |
148 | ||
149 | /* enable irqs */ | |
76d313bf | 150 | dprintk( 1, "setting the interrupt mask\n" ); |
8ddac9ee | 151 | cx_set(MO_PCI_INTMSK, core->pci_irqmask | PCI_INT_TSINT); |
b45009b0 | 152 | cx_set(MO_TS_INTMSK, 0x1f0011); |
1da177e4 LT |
153 | |
154 | /* start dma */ | |
b45009b0 MCC |
155 | cx_set(MO_DEV_CNTRL2, (1<<5)); |
156 | cx_set(MO_TS_DMACNTRL, 0x11); | |
1da177e4 LT |
157 | return 0; |
158 | } | |
159 | ||
160 | static int cx8802_stop_dma(struct cx8802_dev *dev) | |
161 | { | |
162 | struct cx88_core *core = dev->core; | |
76d313bf | 163 | dprintk( 1, "cx8802_stop_dma\n" ); |
1da177e4 LT |
164 | |
165 | /* stop dma */ | |
166 | cx_clear(MO_TS_DMACNTRL, 0x11); | |
167 | ||
168 | /* disable irqs */ | |
8ddac9ee | 169 | cx_clear(MO_PCI_INTMSK, PCI_INT_TSINT); |
1da177e4 LT |
170 | cx_clear(MO_TS_INTMSK, 0x1f0011); |
171 | ||
172 | /* Reset the controller */ | |
173 | cx_write(TS_GEN_CNTRL, 0xcd); | |
174 | return 0; | |
175 | } | |
176 | ||
177 | static int cx8802_restart_queue(struct cx8802_dev *dev, | |
178 | struct cx88_dmaqueue *q) | |
179 | { | |
180 | struct cx88_buffer *buf; | |
181 | struct list_head *item; | |
182 | ||
b930e1d8 | 183 | dprintk( 1, "cx8802_restart_queue\n" ); |
1da177e4 | 184 | if (list_empty(&q->active)) |
b45009b0 | 185 | { |
b930e1d8 MK |
186 | struct cx88_buffer *prev; |
187 | prev = NULL; | |
188 | ||
189 | dprintk(1, "cx8802_restart_queue: queue is empty\n" ); | |
190 | ||
191 | for (;;) { | |
192 | if (list_empty(&q->queued)) | |
193 | return 0; | |
194 | buf = list_entry(q->queued.next, struct cx88_buffer, vb.queue); | |
195 | if (NULL == prev) { | |
196 | list_del(&buf->vb.queue); | |
197 | list_add_tail(&buf->vb.queue,&q->active); | |
198 | cx8802_start_dma(dev, q, buf); | |
199 | buf->vb.state = STATE_ACTIVE; | |
200 | buf->count = q->count++; | |
201 | mod_timer(&q->timeout, jiffies+BUFFER_TIMEOUT); | |
202 | dprintk(1,"[%p/%d] restart_queue - first active\n", | |
203 | buf,buf->vb.i); | |
204 | ||
205 | } else if (prev->vb.width == buf->vb.width && | |
206 | prev->vb.height == buf->vb.height && | |
207 | prev->fmt == buf->fmt) { | |
208 | list_del(&buf->vb.queue); | |
209 | list_add_tail(&buf->vb.queue,&q->active); | |
210 | buf->vb.state = STATE_ACTIVE; | |
211 | buf->count = q->count++; | |
212 | prev->risc.jmp[1] = cpu_to_le32(buf->risc.dma); | |
213 | dprintk(1,"[%p/%d] restart_queue - move to active\n", | |
214 | buf,buf->vb.i); | |
215 | } else { | |
216 | return 0; | |
217 | } | |
218 | prev = buf; | |
219 | } | |
1da177e4 | 220 | return 0; |
b45009b0 | 221 | } |
1da177e4 LT |
222 | |
223 | buf = list_entry(q->active.next, struct cx88_buffer, vb.queue); | |
224 | dprintk(2,"restart_queue [%p/%d]: restart dma\n", | |
225 | buf, buf->vb.i); | |
226 | cx8802_start_dma(dev, q, buf); | |
227 | list_for_each(item,&q->active) { | |
228 | buf = list_entry(item, struct cx88_buffer, vb.queue); | |
229 | buf->count = q->count++; | |
230 | } | |
231 | mod_timer(&q->timeout, jiffies+BUFFER_TIMEOUT); | |
232 | return 0; | |
233 | } | |
234 | ||
235 | /* ------------------------------------------------------------------ */ | |
236 | ||
c7b0ac05 MCC |
237 | int cx8802_buf_prepare(struct videobuf_queue *q, struct cx8802_dev *dev, |
238 | struct cx88_buffer *buf, enum v4l2_field field) | |
1da177e4 LT |
239 | { |
240 | int size = dev->ts_packet_size * dev->ts_packet_count; | |
c1accaa2 | 241 | struct videobuf_dmabuf *dma=videobuf_to_dma(&buf->vb); |
1da177e4 LT |
242 | int rc; |
243 | ||
244 | dprintk(1, "%s: %p\n", __FUNCTION__, buf); | |
245 | if (0 != buf->vb.baddr && buf->vb.bsize < size) | |
246 | return -EINVAL; | |
247 | ||
248 | if (STATE_NEEDS_INIT == buf->vb.state) { | |
249 | buf->vb.width = dev->ts_packet_size; | |
250 | buf->vb.height = dev->ts_packet_count; | |
251 | buf->vb.size = size; | |
31629424 | 252 | buf->vb.field = field /*V4L2_FIELD_TOP*/; |
1da177e4 | 253 | |
c7b0ac05 | 254 | if (0 != (rc = videobuf_iolock(q,&buf->vb,NULL))) |
1da177e4 LT |
255 | goto fail; |
256 | cx88_risc_databuffer(dev->pci, &buf->risc, | |
c1accaa2 | 257 | dma->sglist, |
05b27233 | 258 | buf->vb.width, buf->vb.height, 0); |
1da177e4 LT |
259 | } |
260 | buf->vb.state = STATE_PREPARED; | |
261 | return 0; | |
262 | ||
263 | fail: | |
c7b0ac05 | 264 | cx88_free_buffer(q,buf); |
1da177e4 LT |
265 | return rc; |
266 | } | |
267 | ||
268 | void cx8802_buf_queue(struct cx8802_dev *dev, struct cx88_buffer *buf) | |
269 | { | |
270 | struct cx88_buffer *prev; | |
c7b0ac05 | 271 | struct cx88_dmaqueue *cx88q = &dev->mpegq; |
1da177e4 | 272 | |
b45009b0 | 273 | dprintk( 1, "cx8802_buf_queue\n" ); |
1da177e4 LT |
274 | /* add jump to stopper */ |
275 | buf->risc.jmp[0] = cpu_to_le32(RISC_JUMP | RISC_IRQ1 | RISC_CNT_INC); | |
c7b0ac05 | 276 | buf->risc.jmp[1] = cpu_to_le32(cx88q->stopper.dma); |
1da177e4 | 277 | |
c7b0ac05 | 278 | if (list_empty(&cx88q->active)) { |
76d313bf | 279 | dprintk( 1, "queue is empty - first active\n" ); |
c7b0ac05 MCC |
280 | list_add_tail(&buf->vb.queue,&cx88q->active); |
281 | cx8802_start_dma(dev, cx88q, buf); | |
1da177e4 | 282 | buf->vb.state = STATE_ACTIVE; |
c7b0ac05 MCC |
283 | buf->count = cx88q->count++; |
284 | mod_timer(&cx88q->timeout, jiffies+BUFFER_TIMEOUT); | |
76d313bf | 285 | dprintk(1,"[%p/%d] %s - first active\n", |
1da177e4 LT |
286 | buf, buf->vb.i, __FUNCTION__); |
287 | ||
288 | } else { | |
b45009b0 | 289 | dprintk( 1, "queue is not empty - append to active\n" ); |
c7b0ac05 MCC |
290 | prev = list_entry(cx88q->active.prev, struct cx88_buffer, vb.queue); |
291 | list_add_tail(&buf->vb.queue,&cx88q->active); | |
1da177e4 | 292 | buf->vb.state = STATE_ACTIVE; |
c7b0ac05 | 293 | buf->count = cx88q->count++; |
1da177e4 | 294 | prev->risc.jmp[1] = cpu_to_le32(buf->risc.dma); |
b45009b0 | 295 | dprintk( 1, "[%p/%d] %s - append to active\n", |
1da177e4 LT |
296 | buf, buf->vb.i, __FUNCTION__); |
297 | } | |
298 | } | |
299 | ||
300 | /* ----------------------------------------------------------- */ | |
301 | ||
302 | static void do_cancel_buffers(struct cx8802_dev *dev, char *reason, int restart) | |
303 | { | |
304 | struct cx88_dmaqueue *q = &dev->mpegq; | |
305 | struct cx88_buffer *buf; | |
306 | unsigned long flags; | |
307 | ||
308 | spin_lock_irqsave(&dev->slock,flags); | |
309 | while (!list_empty(&q->active)) { | |
310 | buf = list_entry(q->active.next, struct cx88_buffer, vb.queue); | |
311 | list_del(&buf->vb.queue); | |
312 | buf->vb.state = STATE_ERROR; | |
313 | wake_up(&buf->vb.done); | |
314 | dprintk(1,"[%p/%d] %s - dma=0x%08lx\n", | |
315 | buf, buf->vb.i, reason, (unsigned long)buf->risc.dma); | |
316 | } | |
317 | if (restart) | |
b45009b0 | 318 | { |
76d313bf | 319 | dprintk(1, "restarting queue\n" ); |
1da177e4 | 320 | cx8802_restart_queue(dev,q); |
b45009b0 | 321 | } |
1da177e4 LT |
322 | spin_unlock_irqrestore(&dev->slock,flags); |
323 | } | |
324 | ||
325 | void cx8802_cancel_buffers(struct cx8802_dev *dev) | |
326 | { | |
327 | struct cx88_dmaqueue *q = &dev->mpegq; | |
328 | ||
b45009b0 | 329 | dprintk( 1, "cx8802_cancel_buffers" ); |
1da177e4 LT |
330 | del_timer_sync(&q->timeout); |
331 | cx8802_stop_dma(dev); | |
332 | do_cancel_buffers(dev,"cancel",0); | |
333 | } | |
334 | ||
335 | static void cx8802_timeout(unsigned long data) | |
336 | { | |
337 | struct cx8802_dev *dev = (struct cx8802_dev*)data; | |
338 | ||
7d816b25 | 339 | dprintk(1, "%s\n",__FUNCTION__); |
1da177e4 LT |
340 | |
341 | if (debug) | |
342 | cx88_sram_channel_dump(dev->core, &cx88_sram_channels[SRAM_CH28]); | |
343 | cx8802_stop_dma(dev); | |
344 | do_cancel_buffers(dev,"timeout",1); | |
345 | } | |
346 | ||
41ef7c1e MCC |
347 | static char *cx88_mpeg_irqs[32] = { |
348 | "ts_risci1", NULL, NULL, NULL, | |
349 | "ts_risci2", NULL, NULL, NULL, | |
350 | "ts_oflow", NULL, NULL, NULL, | |
351 | "ts_sync", NULL, NULL, NULL, | |
352 | "opc_err", "par_err", "rip_err", "pci_abort", | |
353 | "ts_err?", | |
354 | }; | |
355 | ||
1da177e4 LT |
356 | static void cx8802_mpeg_irq(struct cx8802_dev *dev) |
357 | { | |
358 | struct cx88_core *core = dev->core; | |
359 | u32 status, mask, count; | |
360 | ||
b45009b0 | 361 | dprintk( 1, "cx8802_mpeg_irq\n" ); |
1da177e4 LT |
362 | status = cx_read(MO_TS_INTSTAT); |
363 | mask = cx_read(MO_TS_INTMSK); | |
364 | if (0 == (status & mask)) | |
365 | return; | |
366 | ||
367 | cx_write(MO_TS_INTSTAT, status); | |
41ef7c1e | 368 | |
1da177e4 LT |
369 | if (debug || (status & mask & ~0xff)) |
370 | cx88_print_irqbits(core->name, "irq mpeg ", | |
66623a04 MCC |
371 | cx88_mpeg_irqs, ARRAY_SIZE(cx88_mpeg_irqs), |
372 | status, mask); | |
1da177e4 LT |
373 | |
374 | /* risc op code error */ | |
375 | if (status & (1 << 16)) { | |
376 | printk(KERN_WARNING "%s: mpeg risc op code error\n",core->name); | |
377 | cx_clear(MO_TS_DMACNTRL, 0x11); | |
378 | cx88_sram_channel_dump(dev->core, &cx88_sram_channels[SRAM_CH28]); | |
379 | } | |
380 | ||
381 | /* risc1 y */ | |
382 | if (status & 0x01) { | |
b45009b0 | 383 | dprintk( 1, "wake up\n" ); |
1da177e4 LT |
384 | spin_lock(&dev->slock); |
385 | count = cx_read(MO_TS_GPCNT); | |
386 | cx88_wakeup(dev->core, &dev->mpegq, count); | |
387 | spin_unlock(&dev->slock); | |
388 | } | |
389 | ||
390 | /* risc2 y */ | |
391 | if (status & 0x10) { | |
392 | spin_lock(&dev->slock); | |
393 | cx8802_restart_queue(dev,&dev->mpegq); | |
394 | spin_unlock(&dev->slock); | |
395 | } | |
396 | ||
4ac97914 MCC |
397 | /* other general errors */ |
398 | if (status & 0x1f0100) { | |
b45009b0 | 399 | dprintk( 0, "general errors: 0x%08x\n", status & 0x1f0100 ); |
4ac97914 | 400 | spin_lock(&dev->slock); |
1da177e4 | 401 | cx8802_stop_dma(dev); |
4ac97914 MCC |
402 | cx8802_restart_queue(dev,&dev->mpegq); |
403 | spin_unlock(&dev->slock); | |
404 | } | |
1da177e4 LT |
405 | } |
406 | ||
b45009b0 MCC |
407 | #define MAX_IRQ_LOOP 10 |
408 | ||
7d12e780 | 409 | static irqreturn_t cx8802_irq(int irq, void *dev_id) |
1da177e4 LT |
410 | { |
411 | struct cx8802_dev *dev = dev_id; | |
412 | struct cx88_core *core = dev->core; | |
413 | u32 status; | |
414 | int loop, handled = 0; | |
415 | ||
b45009b0 | 416 | for (loop = 0; loop < MAX_IRQ_LOOP; loop++) { |
8ddac9ee TP |
417 | status = cx_read(MO_PCI_INTSTAT) & |
418 | (core->pci_irqmask | PCI_INT_TSINT); | |
1da177e4 LT |
419 | if (0 == status) |
420 | goto out; | |
b45009b0 MCC |
421 | dprintk( 1, "cx8802_irq\n" ); |
422 | dprintk( 1, " loop: %d/%d\n", loop, MAX_IRQ_LOOP ); | |
423 | dprintk( 1, " status: %d\n", status ); | |
1da177e4 LT |
424 | handled = 1; |
425 | cx_write(MO_PCI_INTSTAT, status); | |
426 | ||
427 | if (status & core->pci_irqmask) | |
428 | cx88_core_irq(core,status); | |
8ddac9ee | 429 | if (status & PCI_INT_TSINT) |
1da177e4 LT |
430 | cx8802_mpeg_irq(dev); |
431 | }; | |
b45009b0 MCC |
432 | if (MAX_IRQ_LOOP == loop) { |
433 | dprintk( 0, "clearing mask\n" ); | |
1da177e4 LT |
434 | printk(KERN_WARNING "%s/0: irq loop -- clearing mask\n", |
435 | core->name); | |
436 | cx_write(MO_PCI_INTMSK,0); | |
437 | } | |
438 | ||
439 | out: | |
440 | return IRQ_RETVAL(handled); | |
441 | } | |
442 | ||
443 | /* ----------------------------------------------------------- */ | |
444 | /* exported stuff */ | |
445 | ||
446 | int cx8802_init_common(struct cx8802_dev *dev) | |
447 | { | |
448 | struct cx88_core *core = dev->core; | |
449 | int err; | |
450 | ||
451 | /* pci init */ | |
452 | if (pci_enable_device(dev->pci)) | |
453 | return -EIO; | |
454 | pci_set_master(dev->pci); | |
aaa40cb8 | 455 | if (!pci_dma_supported(dev->pci,DMA_32BIT_MASK)) { |
1da177e4 LT |
456 | printk("%s/2: Oops: no 32bit PCI DMA ???\n",dev->core->name); |
457 | return -EIO; | |
458 | } | |
459 | ||
460 | pci_read_config_byte(dev->pci, PCI_CLASS_REVISION, &dev->pci_rev); | |
4ac97914 MCC |
461 | pci_read_config_byte(dev->pci, PCI_LATENCY_TIMER, &dev->pci_lat); |
462 | printk(KERN_INFO "%s/2: found at %s, rev: %d, irq: %d, " | |
228aef63 | 463 | "latency: %d, mmio: 0x%llx\n", dev->core->name, |
1da177e4 | 464 | pci_name(dev->pci), dev->pci_rev, dev->pci->irq, |
228aef63 | 465 | dev->pci_lat,(unsigned long long)pci_resource_start(dev->pci,0)); |
1da177e4 LT |
466 | |
467 | /* initialize driver struct */ | |
1da177e4 LT |
468 | spin_lock_init(&dev->slock); |
469 | ||
470 | /* init dma queue */ | |
471 | INIT_LIST_HEAD(&dev->mpegq.active); | |
472 | INIT_LIST_HEAD(&dev->mpegq.queued); | |
473 | dev->mpegq.timeout.function = cx8802_timeout; | |
474 | dev->mpegq.timeout.data = (unsigned long)dev; | |
475 | init_timer(&dev->mpegq.timeout); | |
476 | cx88_risc_stopper(dev->pci,&dev->mpegq.stopper, | |
477 | MO_TS_DMACNTRL,0x11,0x00); | |
478 | ||
479 | /* get irq */ | |
480 | err = request_irq(dev->pci->irq, cx8802_irq, | |
8076fe32 | 481 | IRQF_SHARED | IRQF_DISABLED, dev->core->name, dev); |
1da177e4 LT |
482 | if (err < 0) { |
483 | printk(KERN_ERR "%s: can't get IRQ %d\n", | |
484 | dev->core->name, dev->pci->irq); | |
485 | return err; | |
486 | } | |
487 | cx_set(MO_PCI_INTMSK, core->pci_irqmask); | |
488 | ||
489 | /* everything worked */ | |
490 | pci_set_drvdata(dev->pci,dev); | |
491 | return 0; | |
492 | } | |
493 | ||
494 | void cx8802_fini_common(struct cx8802_dev *dev) | |
495 | { | |
b45009b0 | 496 | dprintk( 2, "cx8802_fini_common\n" ); |
1da177e4 LT |
497 | cx8802_stop_dma(dev); |
498 | pci_disable_device(dev->pci); | |
499 | ||
500 | /* unregister stuff */ | |
501 | free_irq(dev->pci->irq, dev); | |
502 | pci_set_drvdata(dev->pci, NULL); | |
503 | ||
504 | /* free memory */ | |
505 | btcx_riscmem_free(dev->pci,&dev->mpegq.stopper); | |
506 | } | |
507 | ||
508 | /* ----------------------------------------------------------- */ | |
509 | ||
510 | int cx8802_suspend_common(struct pci_dev *pci_dev, pm_message_t state) | |
511 | { | |
4ac97914 | 512 | struct cx8802_dev *dev = pci_get_drvdata(pci_dev); |
1da177e4 LT |
513 | struct cx88_core *core = dev->core; |
514 | ||
515 | /* stop mpeg dma */ | |
516 | spin_lock(&dev->slock); | |
517 | if (!list_empty(&dev->mpegq.active)) { | |
b45009b0 | 518 | dprintk( 2, "suspend\n" ); |
1da177e4 LT |
519 | printk("%s: suspend mpeg\n", core->name); |
520 | cx8802_stop_dma(dev); | |
521 | del_timer(&dev->mpegq.timeout); | |
522 | } | |
523 | spin_unlock(&dev->slock); | |
524 | ||
1da177e4 LT |
525 | /* FIXME -- shutdown device */ |
526 | cx88_shutdown(dev->core); | |
1da177e4 LT |
527 | |
528 | pci_save_state(pci_dev); | |
529 | if (0 != pci_set_power_state(pci_dev, pci_choose_state(pci_dev, state))) { | |
530 | pci_disable_device(pci_dev); | |
531 | dev->state.disabled = 1; | |
532 | } | |
533 | return 0; | |
534 | } | |
535 | ||
536 | int cx8802_resume_common(struct pci_dev *pci_dev) | |
537 | { | |
08adb9e2 | 538 | struct cx8802_dev *dev = pci_get_drvdata(pci_dev); |
1da177e4 | 539 | struct cx88_core *core = dev->core; |
08adb9e2 | 540 | int err; |
1da177e4 LT |
541 | |
542 | if (dev->state.disabled) { | |
08adb9e2 MCC |
543 | err=pci_enable_device(pci_dev); |
544 | if (err) { | |
545 | printk(KERN_ERR "%s: can't enable device\n", | |
546 | dev->core->name); | |
547 | return err; | |
548 | } | |
1da177e4 LT |
549 | dev->state.disabled = 0; |
550 | } | |
08adb9e2 MCC |
551 | err=pci_set_power_state(pci_dev, PCI_D0); |
552 | if (err) { | |
553 | printk(KERN_ERR "%s: can't enable device\n", | |
554 | dev->core->name); | |
555 | pci_disable_device(pci_dev); | |
556 | dev->state.disabled = 1; | |
557 | ||
558 | return err; | |
559 | } | |
1da177e4 LT |
560 | pci_restore_state(pci_dev); |
561 | ||
1da177e4 LT |
562 | /* FIXME: re-initialize hardware */ |
563 | cx88_reset(dev->core); | |
1da177e4 LT |
564 | |
565 | /* restart video+vbi capture */ | |
566 | spin_lock(&dev->slock); | |
567 | if (!list_empty(&dev->mpegq.active)) { | |
568 | printk("%s: resume mpeg\n", core->name); | |
569 | cx8802_restart_queue(dev,&dev->mpegq); | |
570 | } | |
571 | spin_unlock(&dev->slock); | |
572 | ||
573 | return 0; | |
574 | } | |
575 | ||
7717cbed TP |
576 | #if defined(CONFIG_VIDEO_CX88_BLACKBIRD) || \ |
577 | defined(CONFIG_VIDEO_CX88_BLACKBIRD_MODULE) | |
6c5be74c ST |
578 | struct cx8802_dev * cx8802_get_device(struct inode *inode) |
579 | { | |
580 | int minor = iminor(inode); | |
581 | struct cx8802_dev *h = NULL; | |
582 | struct list_head *list; | |
583 | ||
584 | list_for_each(list,&cx8802_devlist) { | |
585 | h = list_entry(list, struct cx8802_dev, devlist); | |
48200bae | 586 | if (h->mpeg_dev && h->mpeg_dev->minor == minor) |
6c5be74c ST |
587 | return h; |
588 | } | |
589 | ||
590 | return NULL; | |
591 | } | |
7717cbed TP |
592 | EXPORT_SYMBOL(cx8802_get_device); |
593 | #endif | |
6c5be74c ST |
594 | |
595 | struct cx8802_driver * cx8802_get_driver(struct cx8802_dev *dev, enum cx88_board_type btype) | |
596 | { | |
081c2fc8 | 597 | struct cx8802_driver *d; |
6c5be74c | 598 | struct list_head *list; |
6c5be74c | 599 | |
081c2fc8 TP |
600 | list_for_each(list, &dev->drvlist) { |
601 | d = list_entry(list, struct cx8802_driver, drvlist); | |
6c5be74c | 602 | |
081c2fc8 TP |
603 | if (d->type_id == btype) |
604 | return d; | |
6c5be74c ST |
605 | } |
606 | ||
607 | return NULL; | |
608 | } | |
609 | ||
610 | /* Driver asked for hardware access. */ | |
9df2ead5 | 611 | static int cx8802_request_acquire(struct cx8802_driver *drv) |
6c5be74c ST |
612 | { |
613 | struct cx88_core *core = drv->core; | |
614 | ||
615 | /* Fail a request for hardware if the device is busy. */ | |
616 | if (core->active_type_id != CX88_BOARD_NONE) | |
617 | return -EBUSY; | |
618 | ||
619 | if (drv->advise_acquire) | |
620 | { | |
621 | core->active_type_id = drv->type_id; | |
622 | drv->advise_acquire(drv); | |
623 | ||
624 | mpeg_dbg(1,"%s() Post acquire GPIO=%x\n", __FUNCTION__, cx_read(MO_GP0_IO)); | |
625 | } | |
626 | ||
627 | return 0; | |
628 | } | |
629 | ||
630 | /* Driver asked to release hardware. */ | |
9df2ead5 | 631 | static int cx8802_request_release(struct cx8802_driver *drv) |
6c5be74c ST |
632 | { |
633 | struct cx88_core *core = drv->core; | |
634 | ||
635 | if (drv->advise_release) | |
636 | { | |
637 | drv->advise_release(drv); | |
638 | core->active_type_id = CX88_BOARD_NONE; | |
639 | mpeg_dbg(1,"%s() Post release GPIO=%x\n", __FUNCTION__, cx_read(MO_GP0_IO)); | |
640 | } | |
641 | ||
642 | return 0; | |
643 | } | |
644 | ||
645 | static int cx8802_check_driver(struct cx8802_driver *drv) | |
646 | { | |
647 | if (drv == NULL) | |
648 | return -ENODEV; | |
649 | ||
650 | if ((drv->type_id != CX88_MPEG_DVB) && | |
651 | (drv->type_id != CX88_MPEG_BLACKBIRD)) | |
652 | return -EINVAL; | |
653 | ||
654 | if ((drv->hw_access != CX8802_DRVCTL_SHARED) && | |
655 | (drv->hw_access != CX8802_DRVCTL_EXCLUSIVE)) | |
656 | return -EINVAL; | |
657 | ||
658 | if ((drv->probe == NULL) || | |
659 | (drv->remove == NULL) || | |
660 | (drv->advise_acquire == NULL) || | |
661 | (drv->advise_release == NULL)) | |
662 | return -EINVAL; | |
663 | ||
664 | return 0; | |
665 | } | |
666 | ||
667 | int cx8802_register_driver(struct cx8802_driver *drv) | |
668 | { | |
669 | struct cx8802_dev *h; | |
670 | struct cx8802_driver *driver; | |
671 | struct list_head *list; | |
672 | int err = 0, i = 0; | |
673 | ||
5772f813 TP |
674 | printk(KERN_INFO |
675 | "cx88/2: registering cx8802 driver, type: %s access: %s\n", | |
676 | drv->type_id == CX88_MPEG_DVB ? "dvb" : "blackbird", | |
677 | drv->hw_access == CX8802_DRVCTL_SHARED ? "shared" : "exclusive"); | |
6c5be74c ST |
678 | |
679 | if ((err = cx8802_check_driver(drv)) != 0) { | |
5772f813 | 680 | printk(KERN_ERR "cx88/2: cx8802_driver is invalid\n"); |
6c5be74c ST |
681 | return err; |
682 | } | |
683 | ||
684 | list_for_each(list,&cx8802_devlist) { | |
6c5be74c ST |
685 | h = list_entry(list, struct cx8802_dev, devlist); |
686 | ||
5772f813 TP |
687 | printk(KERN_INFO |
688 | "%s/2: subsystem: %04x:%04x, board: %s [card=%d]\n", | |
689 | h->core->name, h->pci->subsystem_vendor, | |
690 | h->pci->subsystem_device, h->core->board.name, | |
691 | h->core->boardnr); | |
6c5be74c ST |
692 | |
693 | /* Bring up a new struct for each driver instance */ | |
694 | driver = kzalloc(sizeof(*drv),GFP_KERNEL); | |
695 | if (driver == NULL) | |
696 | return -ENOMEM; | |
697 | ||
698 | /* Snapshot of the driver registration data */ | |
699 | drv->core = h->core; | |
700 | drv->suspend = cx8802_suspend_common; | |
701 | drv->resume = cx8802_resume_common; | |
702 | drv->request_acquire = cx8802_request_acquire; | |
703 | drv->request_release = cx8802_request_release; | |
704 | memcpy(driver, drv, sizeof(*driver)); | |
705 | ||
706 | err = drv->probe(driver); | |
707 | if (err == 0) { | |
019391e4 | 708 | i++; |
6c5be74c | 709 | mutex_lock(&drv->core->lock); |
081c2fc8 | 710 | list_add_tail(&driver->drvlist, &h->drvlist); |
6c5be74c ST |
711 | mutex_unlock(&drv->core->lock); |
712 | } else { | |
5772f813 TP |
713 | printk(KERN_ERR |
714 | "%s/2: cx8802 probe failed, err = %d\n", | |
715 | h->core->name, err); | |
6c5be74c ST |
716 | } |
717 | ||
718 | } | |
719 | if (i == 0) | |
720 | err = -ENODEV; | |
019391e4 ST |
721 | else |
722 | err = 0; | |
6c5be74c ST |
723 | |
724 | return err; | |
725 | } | |
726 | ||
727 | int cx8802_unregister_driver(struct cx8802_driver *drv) | |
728 | { | |
729 | struct cx8802_dev *h; | |
730 | struct cx8802_driver *d; | |
731 | struct list_head *list; | |
732 | struct list_head *list2, *q; | |
733 | int err = 0, i = 0; | |
734 | ||
5772f813 TP |
735 | printk(KERN_INFO |
736 | "cx88/2: unregistering cx8802 driver, type: %s access: %s\n", | |
737 | drv->type_id == CX88_MPEG_DVB ? "dvb" : "blackbird", | |
738 | drv->hw_access == CX8802_DRVCTL_SHARED ? "shared" : "exclusive"); | |
6c5be74c ST |
739 | |
740 | list_for_each(list,&cx8802_devlist) { | |
741 | i++; | |
742 | h = list_entry(list, struct cx8802_dev, devlist); | |
743 | ||
5772f813 TP |
744 | printk(KERN_INFO |
745 | "%s/2: subsystem: %04x:%04x, board: %s [card=%d]\n", | |
746 | h->core->name, h->pci->subsystem_vendor, | |
747 | h->pci->subsystem_device, h->core->board.name, | |
748 | h->core->boardnr); | |
6c5be74c | 749 | |
081c2fc8 TP |
750 | list_for_each_safe(list2, q, &h->drvlist) { |
751 | d = list_entry(list2, struct cx8802_driver, drvlist); | |
6c5be74c ST |
752 | |
753 | /* only unregister the correct driver type */ | |
754 | if (d->type_id != drv->type_id) | |
755 | continue; | |
756 | ||
757 | err = d->remove(d); | |
758 | if (err == 0) { | |
759 | mutex_lock(&drv->core->lock); | |
760 | list_del(list2); | |
761 | mutex_unlock(&drv->core->lock); | |
762 | } else | |
5772f813 TP |
763 | printk(KERN_ERR "%s/2: cx8802 driver remove " |
764 | "failed (%d)\n", h->core->name, err); | |
6c5be74c ST |
765 | } |
766 | ||
767 | } | |
768 | ||
769 | return err; | |
770 | } | |
771 | ||
1da177e4 | 772 | /* ----------------------------------------------------------- */ |
6c5be74c ST |
773 | static int __devinit cx8802_probe(struct pci_dev *pci_dev, |
774 | const struct pci_device_id *pci_id) | |
775 | { | |
776 | struct cx8802_dev *dev; | |
777 | struct cx88_core *core; | |
778 | int err; | |
779 | ||
780 | /* general setup */ | |
781 | core = cx88_core_get(pci_dev); | |
782 | if (NULL == core) | |
783 | return -EINVAL; | |
784 | ||
785 | printk("%s/2: cx2388x 8802 Driver Manager\n", core->name); | |
786 | ||
787 | err = -ENODEV; | |
6a59d64c | 788 | if (!core->board.mpeg) |
6c5be74c ST |
789 | goto fail_core; |
790 | ||
791 | err = -ENOMEM; | |
792 | dev = kzalloc(sizeof(*dev),GFP_KERNEL); | |
793 | if (NULL == dev) | |
794 | goto fail_core; | |
795 | dev->pci = pci_dev; | |
796 | dev->core = core; | |
797 | ||
798 | err = cx8802_init_common(dev); | |
799 | if (err != 0) | |
800 | goto fail_free; | |
801 | ||
081c2fc8 | 802 | INIT_LIST_HEAD(&dev->drvlist); |
6c5be74c | 803 | list_add_tail(&dev->devlist,&cx8802_devlist); |
1da177e4 | 804 | |
6c5be74c ST |
805 | /* Maintain a reference so cx88-video can query the 8802 device. */ |
806 | core->dvbdev = dev; | |
77b74774 MR |
807 | |
808 | /* now autoload cx88-dvb or cx88-blackbird */ | |
809 | request_modules(dev); | |
6c5be74c ST |
810 | return 0; |
811 | ||
812 | fail_free: | |
813 | kfree(dev); | |
814 | fail_core: | |
815 | cx88_core_put(core,pci_dev); | |
816 | return err; | |
817 | } | |
818 | ||
819 | static void __devexit cx8802_remove(struct pci_dev *pci_dev) | |
820 | { | |
821 | struct cx8802_dev *dev; | |
6c5be74c ST |
822 | |
823 | dev = pci_get_drvdata(pci_dev); | |
824 | ||
825 | dprintk( 1, "%s\n", __FUNCTION__); | |
826 | ||
081c2fc8 TP |
827 | if (!list_empty(&dev->drvlist)) { |
828 | struct list_head *list, *tmp; | |
829 | struct cx8802_driver *drv; | |
830 | int err; | |
831 | ||
832 | printk(KERN_WARNING "%s/2: Trying to remove cx8802 driver " | |
833 | "while cx8802 sub-drivers still loaded?!\n", | |
834 | dev->core->name); | |
835 | ||
836 | list_for_each_safe(list, tmp, &dev->drvlist) { | |
837 | drv = list_entry(list, struct cx8802_driver, drvlist); | |
838 | ||
839 | err = drv->remove(drv); | |
840 | if (err == 0) { | |
841 | mutex_lock(&drv->core->lock); | |
842 | list_del(list); | |
843 | mutex_unlock(&drv->core->lock); | |
844 | } else | |
845 | printk(KERN_ERR "%s/2: cx8802 driver remove " | |
846 | "failed (%d)\n", dev->core->name, err); | |
6c5be74c | 847 | } |
6c5be74c ST |
848 | } |
849 | ||
850 | /* Destroy any 8802 reference. */ | |
851 | dev->core->dvbdev = NULL; | |
852 | ||
853 | /* common */ | |
854 | cx8802_fini_common(dev); | |
855 | cx88_core_put(dev->core,dev->pci); | |
856 | kfree(dev); | |
857 | } | |
858 | ||
859 | static struct pci_device_id cx8802_pci_tbl[] = { | |
860 | { | |
861 | .vendor = 0x14f1, | |
862 | .device = 0x8802, | |
863 | .subvendor = PCI_ANY_ID, | |
864 | .subdevice = PCI_ANY_ID, | |
865 | },{ | |
866 | /* --- end of list --- */ | |
867 | } | |
868 | }; | |
869 | MODULE_DEVICE_TABLE(pci, cx8802_pci_tbl); | |
870 | ||
871 | static struct pci_driver cx8802_pci_driver = { | |
872 | .name = "cx88-mpeg driver manager", | |
873 | .id_table = cx8802_pci_tbl, | |
874 | .probe = cx8802_probe, | |
875 | .remove = __devexit_p(cx8802_remove), | |
876 | }; | |
877 | ||
878 | static int cx8802_init(void) | |
879 | { | |
5772f813 | 880 | printk(KERN_INFO "cx88/2: cx2388x MPEG-TS Driver Manager version %d.%d.%d loaded\n", |
6c5be74c ST |
881 | (CX88_VERSION_CODE >> 16) & 0xff, |
882 | (CX88_VERSION_CODE >> 8) & 0xff, | |
883 | CX88_VERSION_CODE & 0xff); | |
884 | #ifdef SNAPSHOT | |
885 | printk(KERN_INFO "cx2388x: snapshot date %04d-%02d-%02d\n", | |
886 | SNAPSHOT/10000, (SNAPSHOT/100)%100, SNAPSHOT%100); | |
887 | #endif | |
888 | return pci_register_driver(&cx8802_pci_driver); | |
889 | } | |
890 | ||
891 | static void cx8802_fini(void) | |
892 | { | |
893 | pci_unregister_driver(&cx8802_pci_driver); | |
894 | } | |
895 | ||
896 | module_init(cx8802_init); | |
897 | module_exit(cx8802_fini); | |
1da177e4 LT |
898 | EXPORT_SYMBOL(cx8802_buf_prepare); |
899 | EXPORT_SYMBOL(cx8802_buf_queue); | |
900 | EXPORT_SYMBOL(cx8802_cancel_buffers); | |
901 | ||
902 | EXPORT_SYMBOL(cx8802_init_common); | |
903 | EXPORT_SYMBOL(cx8802_fini_common); | |
904 | ||
6c5be74c ST |
905 | EXPORT_SYMBOL(cx8802_register_driver); |
906 | EXPORT_SYMBOL(cx8802_unregister_driver); | |
6c5be74c | 907 | EXPORT_SYMBOL(cx8802_get_driver); |
1da177e4 LT |
908 | /* ----------------------------------------------------------- */ |
909 | /* | |
910 | * Local variables: | |
911 | * c-basic-offset: 8 | |
912 | * End: | |
b45009b0 | 913 | * kate: eol "unix"; indent-width 3; remove-trailing-space on; replace-trailing-space-save on; tab-width 8; replace-tabs off; space-indent off; mixed-indent off |
1da177e4 | 914 | */ |