]>
Commit | Line | Data |
---|---|---|
c942fddf | 1 | // SPDX-License-Identifier: GPL-2.0-or-later |
1da177e4 | 2 | /* |
1da177e4 LT |
3 | * |
4 | * Support for the mpeg transport stream transfers | |
5 | * PCI function #2 of the cx2388x. | |
6 | * | |
f8de18d4 | 7 | * (c) 2004 Jelle Foks <jelle@foks.us> |
1da177e4 LT |
8 | * (c) 2004 Chris Pascoe <c.pascoe@itee.uq.edu.au> |
9 | * (c) 2004 Gerd Knorr <kraxel@bytesex.org> | |
1da177e4 LT |
10 | */ |
11 | ||
65bc2fe8 MCC |
12 | #include "cx88.h" |
13 | ||
1da177e4 | 14 | #include <linux/module.h> |
5a0e3ad6 | 15 | #include <linux/slab.h> |
1da177e4 LT |
16 | #include <linux/init.h> |
17 | #include <linux/device.h> | |
c24228da | 18 | #include <linux/dma-mapping.h> |
1da177e4 | 19 | #include <linux/interrupt.h> |
399426ca | 20 | #include <linux/delay.h> |
1da177e4 | 21 | |
1da177e4 LT |
22 | /* ------------------------------------------------------------------ */ |
23 | ||
24 | MODULE_DESCRIPTION("mpeg driver for cx2388x based TV cards"); | |
f8de18d4 | 25 | MODULE_AUTHOR("Jelle Foks <jelle@foks.us>"); |
1da177e4 LT |
26 | MODULE_AUTHOR("Chris Pascoe <c.pascoe@itee.uq.edu.au>"); |
27 | MODULE_AUTHOR("Gerd Knorr <kraxel@bytesex.org> [SuSE Labs]"); | |
28 | MODULE_LICENSE("GPL"); | |
1990d50b | 29 | MODULE_VERSION(CX88_VERSION); |
1da177e4 | 30 | |
ff699e6b | 31 | static unsigned int debug; |
7b61ba8f MCC |
32 | module_param(debug, int, 0644); |
33 | MODULE_PARM_DESC(debug, "enable debug messages [mpeg]"); | |
1da177e4 | 34 | |
65bc2fe8 MCC |
35 | #define dprintk(level, fmt, arg...) do { \ |
36 | if (debug + 1 > level) \ | |
37 | printk(KERN_DEBUG pr_fmt("%s: mpeg:" fmt), \ | |
38 | __func__, ##arg); \ | |
39 | } while (0) | |
6c5be74c | 40 | |
77b74774 MR |
41 | #if defined(CONFIG_MODULES) && defined(MODULE) |
42 | static void request_module_async(struct work_struct *work) | |
43 | { | |
399426ca MCC |
44 | struct cx8802_dev *dev = container_of(work, struct cx8802_dev, |
45 | request_module_wk); | |
ced80c67 | 46 | |
6a59d64c | 47 | if (dev->core->board.mpeg & CX88_MPEG_DVB) |
77b74774 | 48 | request_module("cx88-dvb"); |
6a59d64c | 49 | if (dev->core->board.mpeg & CX88_MPEG_BLACKBIRD) |
ced80c67 | 50 | request_module("cx88-blackbird"); |
77b74774 MR |
51 | } |
52 | ||
53 | static void request_modules(struct cx8802_dev *dev) | |
54 | { | |
55 | INIT_WORK(&dev->request_module_wk, request_module_async); | |
56 | schedule_work(&dev->request_module_wk); | |
57 | } | |
707bcf32 TH |
58 | |
59 | static void flush_request_modules(struct cx8802_dev *dev) | |
60 | { | |
43829731 | 61 | flush_work(&dev->request_module_wk); |
707bcf32 | 62 | } |
77b74774 MR |
63 | #else |
64 | #define request_modules(dev) | |
707bcf32 | 65 | #define flush_request_modules(dev) |
77b74774 MR |
66 | #endif /* CONFIG_MODULES */ |
67 | ||
6c5be74c | 68 | static LIST_HEAD(cx8802_devlist); |
344d6c6b | 69 | static DEFINE_MUTEX(cx8802_mutex); |
1da177e4 LT |
70 | /* ------------------------------------------------------------------ */ |
71 | ||
0b6b6302 | 72 | int cx8802_start_dma(struct cx8802_dev *dev, |
399426ca MCC |
73 | struct cx88_dmaqueue *q, |
74 | struct cx88_buffer *buf) | |
1da177e4 LT |
75 | { |
76 | struct cx88_core *core = dev->core; | |
77 | ||
65bc2fe8 | 78 | dprintk(1, "w: %d, h: %d, f: %d\n", |
ccd6f1d4 | 79 | core->width, core->height, core->field); |
1da177e4 LT |
80 | |
81 | /* setup fifo + format */ | |
82 | cx88_sram_channel_setup(core, &cx88_sram_channels[SRAM_CH28], | |
83 | dev->ts_packet_size, buf->risc.dma); | |
84 | ||
85 | /* write TS length to chip */ | |
0b6b6302 | 86 | cx_write(MO_TS_LNGTH, dev->ts_packet_size); |
1da177e4 | 87 | |
399426ca MCC |
88 | /* |
89 | * FIXME: this needs a review. | |
90 | * also: move to cx88-blackbird + cx88-dvb source files? | |
91 | */ | |
1da177e4 | 92 | |
65bc2fe8 | 93 | dprintk(1, "core->active_type_id = 0x%08x\n", core->active_type_id); |
6c5be74c | 94 | |
7b61ba8f | 95 | if ((core->active_type_id == CX88_MPEG_DVB) && |
399426ca | 96 | (core->board.mpeg & CX88_MPEG_DVB)) { |
65bc2fe8 | 97 | dprintk(1, "cx8802_start_dma doing .dvb\n"); |
1da177e4 | 98 | /* negedge driven & software reset */ |
f1798495 | 99 | cx_write(TS_GEN_CNTRL, 0x0040 | dev->ts_gen_cntrl); |
1da177e4 LT |
100 | udelay(100); |
101 | cx_write(MO_PINMUX_IO, 0x00); | |
399426ca | 102 | cx_write(TS_HW_SOP_CNTRL, 0x47 << 16 | 188 << 4 | 0x01); |
6a59d64c | 103 | switch (core->boardnr) { |
e52e98a7 MCC |
104 | case CX88_BOARD_DVICO_FUSIONHDTV_3_GOLD_Q: |
105 | case CX88_BOARD_DVICO_FUSIONHDTV_3_GOLD_T: | |
106 | case CX88_BOARD_DVICO_FUSIONHDTV_5_GOLD: | |
da215d22 | 107 | case CX88_BOARD_PCHDTV_HD5500: |
399426ca | 108 | cx_write(TS_SOP_STAT, 1 << 13); |
e52e98a7 | 109 | break; |
4f3ca2f1 DH |
110 | case CX88_BOARD_SAMSUNG_SMT_7020: |
111 | cx_write(TS_SOP_STAT, 0x00); | |
112 | break; | |
0fa14aa6 ST |
113 | case CX88_BOARD_HAUPPAUGE_NOVASPLUS_S1: |
114 | case CX88_BOARD_HAUPPAUGE_NOVASE2_S1: | |
399426ca MCC |
115 | /* Enable MPEG parallel IO and video signal pins */ |
116 | cx_write(MO_PINMUX_IO, 0x88); | |
0fa14aa6 ST |
117 | udelay(100); |
118 | break; | |
6c5be74c | 119 | case CX88_BOARD_HAUPPAUGE_HVR1300: |
337ab6d3 SS |
120 | /* Enable MPEG parallel IO and video signal pins */ |
121 | cx_write(MO_PINMUX_IO, 0x88); | |
122 | cx_write(TS_SOP_STAT, 0); | |
123 | cx_write(TS_VALERR_CNTRL, 0); | |
6c5be74c | 124 | break; |
60464da8 | 125 | case CX88_BOARD_PINNACLE_PCTV_HD_800i: |
4917019d ST |
126 | /* Enable MPEG parallel IO and video signal pins */ |
127 | cx_write(MO_PINMUX_IO, 0x88); | |
128 | cx_write(TS_HW_SOP_CNTRL, (0x47 << 16) | (188 << 4)); | |
129 | dev->ts_gen_cntrl = 5; | |
130 | cx_write(TS_SOP_STAT, 0); | |
131 | cx_write(TS_VALERR_CNTRL, 0); | |
60464da8 ST |
132 | udelay(100); |
133 | break; | |
e52e98a7 | 134 | default: |
41ef7c1e | 135 | cx_write(TS_SOP_STAT, 0x00); |
e52e98a7 | 136 | break; |
f1798495 | 137 | } |
1da177e4 LT |
138 | cx_write(TS_GEN_CNTRL, dev->ts_gen_cntrl); |
139 | udelay(100); | |
7b61ba8f MCC |
140 | } else if ((core->active_type_id == CX88_MPEG_BLACKBIRD) && |
141 | (core->board.mpeg & CX88_MPEG_BLACKBIRD)) { | |
65bc2fe8 | 142 | dprintk(1, "cx8802_start_dma doing .blackbird\n"); |
1da177e4 LT |
143 | cx_write(MO_PINMUX_IO, 0x88); /* enable MPEG parallel IO */ |
144 | ||
399426ca MCC |
145 | /* punctured clock TS & posedge driven & software reset */ |
146 | cx_write(TS_GEN_CNTRL, 0x46); | |
1da177e4 LT |
147 | udelay(100); |
148 | ||
149 | cx_write(TS_HW_SOP_CNTRL, 0x408); /* mpeg start byte */ | |
1da177e4 LT |
150 | cx_write(TS_VALERR_CNTRL, 0x2000); |
151 | ||
399426ca MCC |
152 | /* punctured clock TS & posedge driven */ |
153 | cx_write(TS_GEN_CNTRL, 0x06); | |
1da177e4 | 154 | udelay(100); |
6c5be74c | 155 | } else { |
65bc2fe8 MCC |
156 | pr_err("%s() Failed. Unsupported value in .mpeg (0x%08x)\n", |
157 | __func__, core->board.mpeg); | |
6c5be74c | 158 | return -EINVAL; |
1da177e4 | 159 | } |
1da177e4 LT |
160 | |
161 | /* reset counter */ | |
162 | cx_write(MO_TS_GPCNTRL, GP_COUNT_CONTROL_RESET); | |
9450684b | 163 | q->count = 0; |
1da177e4 LT |
164 | |
165 | /* enable irqs */ | |
65bc2fe8 | 166 | dprintk(1, "setting the interrupt mask\n"); |
8ddac9ee | 167 | cx_set(MO_PCI_INTMSK, core->pci_irqmask | PCI_INT_TSINT); |
b45009b0 | 168 | cx_set(MO_TS_INTMSK, 0x1f0011); |
1da177e4 LT |
169 | |
170 | /* start dma */ | |
399426ca | 171 | cx_set(MO_DEV_CNTRL2, (1 << 5)); |
b45009b0 | 172 | cx_set(MO_TS_DMACNTRL, 0x11); |
1da177e4 LT |
173 | return 0; |
174 | } | |
399426ca | 175 | EXPORT_SYMBOL(cx8802_start_dma); |
1da177e4 LT |
176 | |
177 | static int cx8802_stop_dma(struct cx8802_dev *dev) | |
178 | { | |
179 | struct cx88_core *core = dev->core; | |
7b61ba8f | 180 | |
65bc2fe8 | 181 | dprintk(1, "\n"); |
1da177e4 LT |
182 | |
183 | /* stop dma */ | |
184 | cx_clear(MO_TS_DMACNTRL, 0x11); | |
185 | ||
186 | /* disable irqs */ | |
8ddac9ee | 187 | cx_clear(MO_PCI_INTMSK, PCI_INT_TSINT); |
1da177e4 LT |
188 | cx_clear(MO_TS_INTMSK, 0x1f0011); |
189 | ||
190 | /* Reset the controller */ | |
191 | cx_write(TS_GEN_CNTRL, 0xcd); | |
192 | return 0; | |
193 | } | |
194 | ||
195 | static int cx8802_restart_queue(struct cx8802_dev *dev, | |
196 | struct cx88_dmaqueue *q) | |
197 | { | |
198 | struct cx88_buffer *buf; | |
1da177e4 | 199 | |
65bc2fe8 | 200 | dprintk(1, "\n"); |
1da177e4 LT |
201 | if (list_empty(&q->active)) |
202 | return 0; | |
203 | ||
0b6b6302 | 204 | buf = list_entry(q->active.next, struct cx88_buffer, list); |
7b61ba8f | 205 | dprintk(2, "restart_queue [%p/%d]: restart dma\n", |
2d700715 | 206 | buf, buf->vb.vb2_buf.index); |
1da177e4 | 207 | cx8802_start_dma(dev, q, buf); |
1da177e4 LT |
208 | return 0; |
209 | } | |
210 | ||
211 | /* ------------------------------------------------------------------ */ | |
212 | ||
0b6b6302 | 213 | int cx8802_buf_prepare(struct vb2_queue *q, struct cx8802_dev *dev, |
399426ca | 214 | struct cx88_buffer *buf) |
1da177e4 LT |
215 | { |
216 | int size = dev->ts_packet_size * dev->ts_packet_count; | |
2d700715 | 217 | struct sg_table *sgt = vb2_dma_sg_plane_desc(&buf->vb.vb2_buf, 0); |
5e7045e3 | 218 | struct cx88_riscmem *risc = &buf->risc; |
1da177e4 LT |
219 | int rc; |
220 | ||
2d700715 | 221 | if (vb2_plane_size(&buf->vb.vb2_buf, 0) < size) |
1da177e4 | 222 | return -EINVAL; |
2d700715 | 223 | vb2_set_plane_payload(&buf->vb.vb2_buf, 0, size); |
1da177e4 | 224 | |
5e7045e3 | 225 | rc = cx88_risc_databuffer(dev->pci, risc, sgt->sgl, |
399426ca | 226 | dev->ts_packet_size, dev->ts_packet_count, 0); |
999b3ceb | 227 | if (rc) { |
5e7045e3 | 228 | if (risc->cpu) |
399426ca MCC |
229 | pci_free_consistent(dev->pci, risc->size, |
230 | risc->cpu, risc->dma); | |
5e7045e3 | 231 | memset(risc, 0, sizeof(*risc)); |
999b3ceb HV |
232 | return rc; |
233 | } | |
0b6b6302 | 234 | return 0; |
1da177e4 | 235 | } |
399426ca | 236 | EXPORT_SYMBOL(cx8802_buf_prepare); |
1da177e4 LT |
237 | |
238 | void cx8802_buf_queue(struct cx8802_dev *dev, struct cx88_buffer *buf) | |
239 | { | |
240 | struct cx88_buffer *prev; | |
c7b0ac05 | 241 | struct cx88_dmaqueue *cx88q = &dev->mpegq; |
1da177e4 | 242 | |
65bc2fe8 | 243 | dprintk(1, "\n"); |
0b6b6302 HV |
244 | /* add jump to start */ |
245 | buf->risc.cpu[1] = cpu_to_le32(buf->risc.dma + 8); | |
246 | buf->risc.jmp[0] = cpu_to_le32(RISC_JUMP | RISC_CNT_INC); | |
247 | buf->risc.jmp[1] = cpu_to_le32(buf->risc.dma + 8); | |
1da177e4 | 248 | |
c7b0ac05 | 249 | if (list_empty(&cx88q->active)) { |
65bc2fe8 | 250 | dprintk(1, "queue is empty - first active\n"); |
0b6b6302 | 251 | list_add_tail(&buf->list, &cx88q->active); |
7b61ba8f | 252 | dprintk(1, "[%p/%d] %s - first active\n", |
2d700715 | 253 | buf, buf->vb.vb2_buf.index, __func__); |
1da177e4 LT |
254 | |
255 | } else { | |
0b6b6302 | 256 | buf->risc.cpu[0] |= cpu_to_le32(RISC_IRQ1); |
65bc2fe8 | 257 | dprintk(1, "queue is not empty - append to active\n"); |
0b6b6302 HV |
258 | prev = list_entry(cx88q->active.prev, struct cx88_buffer, list); |
259 | list_add_tail(&buf->list, &cx88q->active); | |
1da177e4 | 260 | prev->risc.jmp[1] = cpu_to_le32(buf->risc.dma); |
65bc2fe8 | 261 | dprintk(1, "[%p/%d] %s - append to active\n", |
2d700715 | 262 | buf, buf->vb.vb2_buf.index, __func__); |
1da177e4 LT |
263 | } |
264 | } | |
399426ca | 265 | EXPORT_SYMBOL(cx8802_buf_queue); |
1da177e4 LT |
266 | |
267 | /* ----------------------------------------------------------- */ | |
268 | ||
0b6b6302 | 269 | static void do_cancel_buffers(struct cx8802_dev *dev) |
1da177e4 LT |
270 | { |
271 | struct cx88_dmaqueue *q = &dev->mpegq; | |
272 | struct cx88_buffer *buf; | |
273 | unsigned long flags; | |
274 | ||
7b61ba8f | 275 | spin_lock_irqsave(&dev->slock, flags); |
1da177e4 | 276 | while (!list_empty(&q->active)) { |
0b6b6302 HV |
277 | buf = list_entry(q->active.next, struct cx88_buffer, list); |
278 | list_del(&buf->list); | |
2d700715 | 279 | vb2_buffer_done(&buf->vb.vb2_buf, VB2_BUF_STATE_ERROR); |
b45009b0 | 280 | } |
7b61ba8f | 281 | spin_unlock_irqrestore(&dev->slock, flags); |
1da177e4 LT |
282 | } |
283 | ||
284 | void cx8802_cancel_buffers(struct cx8802_dev *dev) | |
285 | { | |
65bc2fe8 | 286 | dprintk(1, "\n"); |
1da177e4 | 287 | cx8802_stop_dma(dev); |
0b6b6302 | 288 | do_cancel_buffers(dev); |
1da177e4 | 289 | } |
399426ca | 290 | EXPORT_SYMBOL(cx8802_cancel_buffers); |
1da177e4 | 291 | |
7b61ba8f | 292 | static const char *cx88_mpeg_irqs[32] = { |
41ef7c1e MCC |
293 | "ts_risci1", NULL, NULL, NULL, |
294 | "ts_risci2", NULL, NULL, NULL, | |
295 | "ts_oflow", NULL, NULL, NULL, | |
296 | "ts_sync", NULL, NULL, NULL, | |
297 | "opc_err", "par_err", "rip_err", "pci_abort", | |
298 | "ts_err?", | |
299 | }; | |
300 | ||
1da177e4 LT |
301 | static void cx8802_mpeg_irq(struct cx8802_dev *dev) |
302 | { | |
303 | struct cx88_core *core = dev->core; | |
304 | u32 status, mask, count; | |
305 | ||
65bc2fe8 | 306 | dprintk(1, "\n"); |
1da177e4 LT |
307 | status = cx_read(MO_TS_INTSTAT); |
308 | mask = cx_read(MO_TS_INTMSK); | |
309 | if (0 == (status & mask)) | |
310 | return; | |
311 | ||
312 | cx_write(MO_TS_INTSTAT, status); | |
41ef7c1e | 313 | |
1da177e4 | 314 | if (debug || (status & mask & ~0xff)) |
65bc2fe8 | 315 | cx88_print_irqbits("irq mpeg ", |
66623a04 MCC |
316 | cx88_mpeg_irqs, ARRAY_SIZE(cx88_mpeg_irqs), |
317 | status, mask); | |
1da177e4 LT |
318 | |
319 | /* risc op code error */ | |
320 | if (status & (1 << 16)) { | |
65bc2fe8 | 321 | pr_warn("mpeg risc op code error\n"); |
1da177e4 | 322 | cx_clear(MO_TS_DMACNTRL, 0x11); |
399426ca MCC |
323 | cx88_sram_channel_dump(dev->core, |
324 | &cx88_sram_channels[SRAM_CH28]); | |
1da177e4 LT |
325 | } |
326 | ||
327 | /* risc1 y */ | |
328 | if (status & 0x01) { | |
65bc2fe8 | 329 | dprintk(1, "wake up\n"); |
1da177e4 LT |
330 | spin_lock(&dev->slock); |
331 | count = cx_read(MO_TS_GPCNT); | |
332 | cx88_wakeup(dev->core, &dev->mpegq, count); | |
333 | spin_unlock(&dev->slock); | |
334 | } | |
335 | ||
4ac97914 MCC |
336 | /* other general errors */ |
337 | if (status & 0x1f0100) { | |
65bc2fe8 | 338 | dprintk(0, "general errors: 0x%08x\n", status & 0x1f0100); |
4ac97914 | 339 | spin_lock(&dev->slock); |
1da177e4 | 340 | cx8802_stop_dma(dev); |
4ac97914 MCC |
341 | spin_unlock(&dev->slock); |
342 | } | |
1da177e4 LT |
343 | } |
344 | ||
b45009b0 MCC |
345 | #define MAX_IRQ_LOOP 10 |
346 | ||
7d12e780 | 347 | static irqreturn_t cx8802_irq(int irq, void *dev_id) |
1da177e4 LT |
348 | { |
349 | struct cx8802_dev *dev = dev_id; | |
350 | struct cx88_core *core = dev->core; | |
351 | u32 status; | |
352 | int loop, handled = 0; | |
353 | ||
b45009b0 | 354 | for (loop = 0; loop < MAX_IRQ_LOOP; loop++) { |
8ddac9ee TP |
355 | status = cx_read(MO_PCI_INTSTAT) & |
356 | (core->pci_irqmask | PCI_INT_TSINT); | |
7b61ba8f | 357 | if (status == 0) |
1da177e4 | 358 | goto out; |
65bc2fe8 MCC |
359 | dprintk(1, "cx8802_irq\n"); |
360 | dprintk(1, " loop: %d/%d\n", loop, MAX_IRQ_LOOP); | |
361 | dprintk(1, " status: %d\n", status); | |
1da177e4 LT |
362 | handled = 1; |
363 | cx_write(MO_PCI_INTSTAT, status); | |
364 | ||
365 | if (status & core->pci_irqmask) | |
7b61ba8f | 366 | cx88_core_irq(core, status); |
8ddac9ee | 367 | if (status & PCI_INT_TSINT) |
1da177e4 | 368 | cx8802_mpeg_irq(dev); |
c2c1b415 | 369 | } |
7b61ba8f | 370 | if (loop == MAX_IRQ_LOOP) { |
65bc2fe8 MCC |
371 | dprintk(0, "clearing mask\n"); |
372 | pr_warn("irq loop -- clearing mask\n"); | |
7b61ba8f | 373 | cx_write(MO_PCI_INTMSK, 0); |
1da177e4 LT |
374 | } |
375 | ||
376 | out: | |
377 | return IRQ_RETVAL(handled); | |
378 | } | |
379 | ||
a2fbaa51 | 380 | static int cx8802_init_common(struct cx8802_dev *dev) |
1da177e4 LT |
381 | { |
382 | struct cx88_core *core = dev->core; | |
383 | int err; | |
384 | ||
385 | /* pci init */ | |
386 | if (pci_enable_device(dev->pci)) | |
387 | return -EIO; | |
388 | pci_set_master(dev->pci); | |
7b61ba8f | 389 | err = pci_set_dma_mask(dev->pci, DMA_BIT_MASK(32)); |
1a47de6e | 390 | if (err) { |
65bc2fe8 | 391 | pr_err("Oops: no 32bit PCI DMA ???\n"); |
1da177e4 LT |
392 | return -EIO; |
393 | } | |
394 | ||
abd34d8d | 395 | dev->pci_rev = dev->pci->revision; |
4ac97914 | 396 | pci_read_config_byte(dev->pci, PCI_LATENCY_TIMER, &dev->pci_lat); |
65bc2fe8 MCC |
397 | pr_info("found at %s, rev: %d, irq: %d, latency: %d, mmio: 0x%llx\n", |
398 | pci_name(dev->pci), dev->pci_rev, dev->pci->irq, | |
399 | dev->pci_lat, | |
400 | (unsigned long long)pci_resource_start(dev->pci, 0)); | |
1da177e4 LT |
401 | |
402 | /* initialize driver struct */ | |
1da177e4 LT |
403 | spin_lock_init(&dev->slock); |
404 | ||
405 | /* init dma queue */ | |
406 | INIT_LIST_HEAD(&dev->mpegq.active); | |
1da177e4 LT |
407 | |
408 | /* get irq */ | |
409 | err = request_irq(dev->pci->irq, cx8802_irq, | |
3e018fe4 | 410 | IRQF_SHARED, dev->core->name, dev); |
1da177e4 | 411 | if (err < 0) { |
65bc2fe8 | 412 | pr_err("can't get IRQ %d\n", dev->pci->irq); |
1da177e4 LT |
413 | return err; |
414 | } | |
415 | cx_set(MO_PCI_INTMSK, core->pci_irqmask); | |
416 | ||
417 | /* everything worked */ | |
7b61ba8f | 418 | pci_set_drvdata(dev->pci, dev); |
1da177e4 LT |
419 | return 0; |
420 | } | |
421 | ||
a2fbaa51 | 422 | static void cx8802_fini_common(struct cx8802_dev *dev) |
1da177e4 | 423 | { |
65bc2fe8 | 424 | dprintk(2, "\n"); |
1da177e4 LT |
425 | cx8802_stop_dma(dev); |
426 | pci_disable_device(dev->pci); | |
427 | ||
428 | /* unregister stuff */ | |
429 | free_irq(dev->pci->irq, dev); | |
1da177e4 LT |
430 | } |
431 | ||
432 | /* ----------------------------------------------------------- */ | |
433 | ||
a2fbaa51 | 434 | static int cx8802_suspend_common(struct pci_dev *pci_dev, pm_message_t state) |
1da177e4 | 435 | { |
4ac97914 | 436 | struct cx8802_dev *dev = pci_get_drvdata(pci_dev); |
5ddfbbb9 | 437 | unsigned long flags; |
1da177e4 LT |
438 | |
439 | /* stop mpeg dma */ | |
5ddfbbb9 | 440 | spin_lock_irqsave(&dev->slock, flags); |
1da177e4 | 441 | if (!list_empty(&dev->mpegq.active)) { |
65bc2fe8 MCC |
442 | dprintk(2, "suspend\n"); |
443 | pr_info("suspend mpeg\n"); | |
1da177e4 | 444 | cx8802_stop_dma(dev); |
1da177e4 | 445 | } |
5ddfbbb9 | 446 | spin_unlock_irqrestore(&dev->slock, flags); |
1da177e4 | 447 | |
1da177e4 LT |
448 | /* FIXME -- shutdown device */ |
449 | cx88_shutdown(dev->core); | |
1da177e4 LT |
450 | |
451 | pci_save_state(pci_dev); | |
399426ca MCC |
452 | if (pci_set_power_state(pci_dev, |
453 | pci_choose_state(pci_dev, state)) != 0) { | |
1da177e4 LT |
454 | pci_disable_device(pci_dev); |
455 | dev->state.disabled = 1; | |
456 | } | |
457 | return 0; | |
458 | } | |
459 | ||
a2fbaa51 | 460 | static int cx8802_resume_common(struct pci_dev *pci_dev) |
1da177e4 | 461 | { |
08adb9e2 | 462 | struct cx8802_dev *dev = pci_get_drvdata(pci_dev); |
5ddfbbb9 | 463 | unsigned long flags; |
08adb9e2 | 464 | int err; |
1da177e4 LT |
465 | |
466 | if (dev->state.disabled) { | |
7b61ba8f | 467 | err = pci_enable_device(pci_dev); |
08adb9e2 | 468 | if (err) { |
65bc2fe8 | 469 | pr_err("can't enable device\n"); |
08adb9e2 MCC |
470 | return err; |
471 | } | |
1da177e4 LT |
472 | dev->state.disabled = 0; |
473 | } | |
7b61ba8f | 474 | err = pci_set_power_state(pci_dev, PCI_D0); |
08adb9e2 | 475 | if (err) { |
65bc2fe8 | 476 | pr_err("can't enable device\n"); |
08adb9e2 MCC |
477 | pci_disable_device(pci_dev); |
478 | dev->state.disabled = 1; | |
479 | ||
480 | return err; | |
481 | } | |
1da177e4 LT |
482 | pci_restore_state(pci_dev); |
483 | ||
1da177e4 LT |
484 | /* FIXME: re-initialize hardware */ |
485 | cx88_reset(dev->core); | |
1da177e4 LT |
486 | |
487 | /* restart video+vbi capture */ | |
5ddfbbb9 | 488 | spin_lock_irqsave(&dev->slock, flags); |
1da177e4 | 489 | if (!list_empty(&dev->mpegq.active)) { |
65bc2fe8 | 490 | pr_info("resume mpeg\n"); |
7b61ba8f | 491 | cx8802_restart_queue(dev, &dev->mpegq); |
1da177e4 | 492 | } |
5ddfbbb9 | 493 | spin_unlock_irqrestore(&dev->slock, flags); |
1da177e4 LT |
494 | |
495 | return 0; | |
496 | } | |
497 | ||
399426ca MCC |
498 | struct cx8802_driver *cx8802_get_driver(struct cx8802_dev *dev, |
499 | enum cx88_board_type btype) | |
6c5be74c | 500 | { |
081c2fc8 | 501 | struct cx8802_driver *d; |
6c5be74c | 502 | |
89a47942 | 503 | list_for_each_entry(d, &dev->drvlist, drvlist) |
081c2fc8 TP |
504 | if (d->type_id == btype) |
505 | return d; | |
6c5be74c ST |
506 | |
507 | return NULL; | |
508 | } | |
399426ca | 509 | EXPORT_SYMBOL(cx8802_get_driver); |
6c5be74c ST |
510 | |
511 | /* Driver asked for hardware access. */ | |
9df2ead5 | 512 | static int cx8802_request_acquire(struct cx8802_driver *drv) |
6c5be74c ST |
513 | { |
514 | struct cx88_core *core = drv->core; | |
d922b8ea | 515 | unsigned int i; |
6c5be74c ST |
516 | |
517 | /* Fail a request for hardware if the device is busy. */ | |
27d0fe18 RS |
518 | if (core->active_type_id != CX88_BOARD_NONE && |
519 | core->active_type_id != drv->type_id) | |
6c5be74c ST |
520 | return -EBUSY; |
521 | ||
243bf1a2 DH |
522 | if (drv->type_id == CX88_MPEG_DVB) { |
523 | /* When switching to DVB, always set the input to the tuner */ | |
524 | core->last_analog_input = core->input; | |
525 | core->input = 0; | |
526 | for (i = 0; | |
399426ca MCC |
527 | i < (sizeof(core->board.input) / |
528 | sizeof(struct cx88_input)); | |
243bf1a2 DH |
529 | i++) { |
530 | if (core->board.input[i].type == CX88_VMUX_DVB) { | |
531 | core->input = i; | |
532 | break; | |
533 | } | |
d922b8ea IV |
534 | } |
535 | } | |
c2cb8fcc | 536 | |
399426ca | 537 | if (drv->advise_acquire) { |
baff6cdd | 538 | core->active_ref++; |
27d0fe18 RS |
539 | if (core->active_type_id == CX88_BOARD_NONE) { |
540 | core->active_type_id = drv->type_id; | |
541 | drv->advise_acquire(drv); | |
542 | } | |
6c5be74c | 543 | |
65bc2fe8 | 544 | dprintk(1, "Post acquire GPIO=%x\n", cx_read(MO_GP0_IO)); |
6c5be74c ST |
545 | } |
546 | ||
547 | return 0; | |
548 | } | |
549 | ||
550 | /* Driver asked to release hardware. */ | |
9df2ead5 | 551 | static int cx8802_request_release(struct cx8802_driver *drv) |
6c5be74c ST |
552 | { |
553 | struct cx88_core *core = drv->core; | |
554 | ||
399426ca | 555 | if (drv->advise_release && --core->active_ref == 0) { |
243bf1a2 | 556 | if (drv->type_id == CX88_MPEG_DVB) { |
399426ca MCC |
557 | /* |
558 | * If the DVB driver is releasing, reset the input | |
559 | * state to the last configured analog input | |
560 | */ | |
243bf1a2 DH |
561 | core->input = core->last_analog_input; |
562 | } | |
563 | ||
6c5be74c ST |
564 | drv->advise_release(drv); |
565 | core->active_type_id = CX88_BOARD_NONE; | |
65bc2fe8 | 566 | dprintk(1, "Post release GPIO=%x\n", cx_read(MO_GP0_IO)); |
6c5be74c ST |
567 | } |
568 | ||
569 | return 0; | |
570 | } | |
571 | ||
572 | static int cx8802_check_driver(struct cx8802_driver *drv) | |
573 | { | |
399426ca | 574 | if (!drv) |
6c5be74c ST |
575 | return -ENODEV; |
576 | ||
577 | if ((drv->type_id != CX88_MPEG_DVB) && | |
399426ca | 578 | (drv->type_id != CX88_MPEG_BLACKBIRD)) |
6c5be74c ST |
579 | return -EINVAL; |
580 | ||
581 | if ((drv->hw_access != CX8802_DRVCTL_SHARED) && | |
399426ca | 582 | (drv->hw_access != CX8802_DRVCTL_EXCLUSIVE)) |
6c5be74c ST |
583 | return -EINVAL; |
584 | ||
399426ca MCC |
585 | if ((!drv->probe) || |
586 | (!drv->remove) || | |
587 | (!drv->advise_acquire) || | |
588 | (!drv->advise_release)) | |
6c5be74c ST |
589 | return -EINVAL; |
590 | ||
591 | return 0; | |
592 | } | |
593 | ||
594 | int cx8802_register_driver(struct cx8802_driver *drv) | |
595 | { | |
89a47942 | 596 | struct cx8802_dev *dev; |
6c5be74c | 597 | struct cx8802_driver *driver; |
89a47942 | 598 | int err, i = 0; |
6c5be74c | 599 | |
65bc2fe8 MCC |
600 | pr_info("registering cx8802 driver, type: %s access: %s\n", |
601 | drv->type_id == CX88_MPEG_DVB ? "dvb" : "blackbird", | |
399426ca MCC |
602 | drv->hw_access == CX8802_DRVCTL_SHARED ? |
603 | "shared" : "exclusive"); | |
6c5be74c | 604 | |
399426ca MCC |
605 | err = cx8802_check_driver(drv); |
606 | if (err) { | |
65bc2fe8 | 607 | pr_err("cx8802_driver is invalid\n"); |
6c5be74c ST |
608 | return err; |
609 | } | |
610 | ||
344d6c6b JN |
611 | mutex_lock(&cx8802_mutex); |
612 | ||
89a47942 | 613 | list_for_each_entry(dev, &cx8802_devlist, devlist) { |
65bc2fe8 MCC |
614 | pr_info("subsystem: %04x:%04x, board: %s [card=%d]\n", |
615 | dev->pci->subsystem_vendor, | |
616 | dev->pci->subsystem_device, dev->core->board.name, | |
617 | dev->core->boardnr); | |
6c5be74c ST |
618 | |
619 | /* Bring up a new struct for each driver instance */ | |
7b61ba8f | 620 | driver = kzalloc(sizeof(*drv), GFP_KERNEL); |
399426ca | 621 | if (!driver) { |
344d6c6b JN |
622 | err = -ENOMEM; |
623 | goto out; | |
624 | } | |
6c5be74c ST |
625 | |
626 | /* Snapshot of the driver registration data */ | |
89a47942 | 627 | drv->core = dev->core; |
6c5be74c ST |
628 | drv->suspend = cx8802_suspend_common; |
629 | drv->resume = cx8802_resume_common; | |
630 | drv->request_acquire = cx8802_request_acquire; | |
631 | drv->request_release = cx8802_request_release; | |
632 | memcpy(driver, drv, sizeof(*driver)); | |
633 | ||
1d6213ab | 634 | mutex_lock(&drv->core->lock); |
6c5be74c ST |
635 | err = drv->probe(driver); |
636 | if (err == 0) { | |
019391e4 | 637 | i++; |
89a47942 | 638 | list_add_tail(&driver->drvlist, &dev->drvlist); |
6c5be74c | 639 | } else { |
65bc2fe8 | 640 | pr_err("cx8802 probe failed, err = %d\n", err); |
6c5be74c | 641 | } |
1d6213ab | 642 | mutex_unlock(&drv->core->lock); |
6c5be74c | 643 | } |
6c5be74c | 644 | |
344d6c6b JN |
645 | err = i ? 0 : -ENODEV; |
646 | out: | |
647 | mutex_unlock(&cx8802_mutex); | |
648 | return err; | |
6c5be74c | 649 | } |
399426ca | 650 | EXPORT_SYMBOL(cx8802_register_driver); |
6c5be74c ST |
651 | |
652 | int cx8802_unregister_driver(struct cx8802_driver *drv) | |
653 | { | |
89a47942 TP |
654 | struct cx8802_dev *dev; |
655 | struct cx8802_driver *d, *dtmp; | |
656 | int err = 0; | |
6c5be74c | 657 | |
65bc2fe8 MCC |
658 | pr_info("unregistering cx8802 driver, type: %s access: %s\n", |
659 | drv->type_id == CX88_MPEG_DVB ? "dvb" : "blackbird", | |
399426ca MCC |
660 | drv->hw_access == CX8802_DRVCTL_SHARED ? |
661 | "shared" : "exclusive"); | |
6c5be74c | 662 | |
344d6c6b JN |
663 | mutex_lock(&cx8802_mutex); |
664 | ||
89a47942 | 665 | list_for_each_entry(dev, &cx8802_devlist, devlist) { |
65bc2fe8 MCC |
666 | pr_info("subsystem: %04x:%04x, board: %s [card=%d]\n", |
667 | dev->pci->subsystem_vendor, | |
668 | dev->pci->subsystem_device, dev->core->board.name, | |
669 | dev->core->boardnr); | |
6c5be74c | 670 | |
8a317a87 JN |
671 | mutex_lock(&dev->core->lock); |
672 | ||
89a47942 | 673 | list_for_each_entry_safe(d, dtmp, &dev->drvlist, drvlist) { |
6c5be74c ST |
674 | /* only unregister the correct driver type */ |
675 | if (d->type_id != drv->type_id) | |
676 | continue; | |
677 | ||
678 | err = d->remove(d); | |
679 | if (err == 0) { | |
89a47942 | 680 | list_del(&d->drvlist); |
a04036a3 | 681 | kfree(d); |
6c5be74c | 682 | } else |
65bc2fe8 MCC |
683 | pr_err("cx8802 driver remove failed (%d)\n", |
684 | err); | |
6c5be74c ST |
685 | } |
686 | ||
8a317a87 | 687 | mutex_unlock(&dev->core->lock); |
6c5be74c ST |
688 | } |
689 | ||
344d6c6b JN |
690 | mutex_unlock(&cx8802_mutex); |
691 | ||
6c5be74c ST |
692 | return err; |
693 | } | |
399426ca | 694 | EXPORT_SYMBOL(cx8802_unregister_driver); |
6c5be74c | 695 | |
1da177e4 | 696 | /* ----------------------------------------------------------- */ |
4c62e976 GKH |
697 | static int cx8802_probe(struct pci_dev *pci_dev, |
698 | const struct pci_device_id *pci_id) | |
6c5be74c ST |
699 | { |
700 | struct cx8802_dev *dev; | |
701 | struct cx88_core *core; | |
9212a572 | 702 | int err; |
6c5be74c ST |
703 | |
704 | /* general setup */ | |
705 | core = cx88_core_get(pci_dev); | |
399426ca | 706 | if (!core) |
6c5be74c ST |
707 | return -EINVAL; |
708 | ||
65bc2fe8 | 709 | pr_info("cx2388x 8802 Driver Manager\n"); |
6c5be74c ST |
710 | |
711 | err = -ENODEV; | |
6a59d64c | 712 | if (!core->board.mpeg) |
6c5be74c ST |
713 | goto fail_core; |
714 | ||
715 | err = -ENOMEM; | |
7b61ba8f | 716 | dev = kzalloc(sizeof(*dev), GFP_KERNEL); |
399426ca | 717 | if (!dev) |
6c5be74c ST |
718 | goto fail_core; |
719 | dev->pci = pci_dev; | |
720 | dev->core = core; | |
721 | ||
e32fadc4 MCC |
722 | /* Maintain a reference so cx88-video can query the 8802 device. */ |
723 | core->dvbdev = dev; | |
724 | ||
6c5be74c ST |
725 | err = cx8802_init_common(dev); |
726 | if (err != 0) | |
2bc46b3a | 727 | goto fail_dev; |
6c5be74c | 728 | |
081c2fc8 | 729 | INIT_LIST_HEAD(&dev->drvlist); |
344d6c6b | 730 | mutex_lock(&cx8802_mutex); |
7b61ba8f | 731 | list_add_tail(&dev->devlist, &cx8802_devlist); |
344d6c6b | 732 | mutex_unlock(&cx8802_mutex); |
1da177e4 | 733 | |
77b74774 MR |
734 | /* now autoload cx88-dvb or cx88-blackbird */ |
735 | request_modules(dev); | |
6c5be74c ST |
736 | return 0; |
737 | ||
96df988b | 738 | fail_dev: |
6c5be74c ST |
739 | kfree(dev); |
740 | fail_core: | |
e32fadc4 | 741 | core->dvbdev = NULL; |
7b61ba8f | 742 | cx88_core_put(core, pci_dev); |
6c5be74c ST |
743 | return err; |
744 | } | |
745 | ||
4c62e976 | 746 | static void cx8802_remove(struct pci_dev *pci_dev) |
6c5be74c ST |
747 | { |
748 | struct cx8802_dev *dev; | |
6c5be74c ST |
749 | |
750 | dev = pci_get_drvdata(pci_dev); | |
751 | ||
65bc2fe8 | 752 | dprintk(1, "%s\n", __func__); |
6c5be74c | 753 | |
707bcf32 TH |
754 | flush_request_modules(dev); |
755 | ||
8a317a87 JN |
756 | mutex_lock(&dev->core->lock); |
757 | ||
081c2fc8 | 758 | if (!list_empty(&dev->drvlist)) { |
89a47942 | 759 | struct cx8802_driver *drv, *tmp; |
081c2fc8 TP |
760 | int err; |
761 | ||
65bc2fe8 | 762 | pr_warn("Trying to remove cx8802 driver while cx8802 sub-drivers still loaded?!\n"); |
081c2fc8 | 763 | |
89a47942 | 764 | list_for_each_entry_safe(drv, tmp, &dev->drvlist, drvlist) { |
081c2fc8 TP |
765 | err = drv->remove(drv); |
766 | if (err == 0) { | |
89a47942 | 767 | list_del(&drv->drvlist); |
081c2fc8 | 768 | } else |
65bc2fe8 MCC |
769 | pr_err("cx8802 driver remove failed (%d)\n", |
770 | err); | |
a04036a3 | 771 | kfree(drv); |
6c5be74c | 772 | } |
6c5be74c ST |
773 | } |
774 | ||
8a317a87 JN |
775 | mutex_unlock(&dev->core->lock); |
776 | ||
6c5be74c ST |
777 | /* Destroy any 8802 reference. */ |
778 | dev->core->dvbdev = NULL; | |
779 | ||
780 | /* common */ | |
781 | cx8802_fini_common(dev); | |
7b61ba8f | 782 | cx88_core_put(dev->core, dev->pci); |
6c5be74c ST |
783 | kfree(dev); |
784 | } | |
785 | ||
2e4e98e7 | 786 | static const struct pci_device_id cx8802_pci_tbl[] = { |
6c5be74c ST |
787 | { |
788 | .vendor = 0x14f1, | |
789 | .device = 0x8802, | |
790 | .subvendor = PCI_ANY_ID, | |
791 | .subdevice = PCI_ANY_ID, | |
7b61ba8f | 792 | }, { |
6c5be74c ST |
793 | /* --- end of list --- */ |
794 | } | |
795 | }; | |
796 | MODULE_DEVICE_TABLE(pci, cx8802_pci_tbl); | |
797 | ||
798 | static struct pci_driver cx8802_pci_driver = { | |
799 | .name = "cx88-mpeg driver manager", | |
800 | .id_table = cx8802_pci_tbl, | |
801 | .probe = cx8802_probe, | |
4c62e976 | 802 | .remove = cx8802_remove, |
6c5be74c ST |
803 | }; |
804 | ||
38b25adc | 805 | module_pci_driver(cx8802_pci_driver); |