Merge branch 'linus' into timers/nohz
[linux-2.6] / drivers / media / video / cx88 / cx88-core.c
1 /*
2  *
3  * device driver for Conexant 2388x based TV cards
4  * driver core
5  *
6  * (c) 2003 Gerd Knorr <kraxel@bytesex.org> [SuSE Labs]
7  *
8  * (c) 2005-2006 Mauro Carvalho Chehab <mchehab@infradead.org>
9  *     - Multituner support
10  *     - video_ioctl2 conversion
11  *     - PAL/M fixes
12  *
13  *  This program is free software; you can redistribute it and/or modify
14  *  it under the terms of the GNU General Public License as published by
15  *  the Free Software Foundation; either version 2 of the License, or
16  *  (at your option) any later version.
17  *
18  *  This program is distributed in the hope that it will be useful,
19  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
20  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
21  *  GNU General Public License for more details.
22  *
23  *  You should have received a copy of the GNU General Public License
24  *  along with this program; if not, write to the Free Software
25  *  Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
26  */
27
28 #include <linux/init.h>
29 #include <linux/list.h>
30 #include <linux/module.h>
31 #include <linux/kernel.h>
32 #include <linux/slab.h>
33 #include <linux/kmod.h>
34 #include <linux/sound.h>
35 #include <linux/interrupt.h>
36 #include <linux/pci.h>
37 #include <linux/delay.h>
38 #include <linux/videodev2.h>
39 #include <linux/mutex.h>
40
41 #include "cx88.h"
42 #include <media/v4l2-common.h>
43
44 MODULE_DESCRIPTION("v4l2 driver module for cx2388x based TV cards");
45 MODULE_AUTHOR("Gerd Knorr <kraxel@bytesex.org> [SuSE Labs]");
46 MODULE_LICENSE("GPL");
47
48 /* ------------------------------------------------------------------ */
49
50 static unsigned int core_debug;
51 module_param(core_debug,int,0644);
52 MODULE_PARM_DESC(core_debug,"enable debug messages [core]");
53
54 static unsigned int nicam;
55 module_param(nicam,int,0644);
56 MODULE_PARM_DESC(nicam,"tv audio is nicam");
57
58 static unsigned int nocomb;
59 module_param(nocomb,int,0644);
60 MODULE_PARM_DESC(nocomb,"disable comb filter");
61
62 #define dprintk(level,fmt, arg...)      if (core_debug >= level)        \
63         printk(KERN_DEBUG "%s: " fmt, core->name , ## arg)
64
65 static unsigned int cx88_devcount;
66 static LIST_HEAD(cx88_devlist);
67 static DEFINE_MUTEX(devlist);
68
69 #define NO_SYNC_LINE (-1U)
70
71 /* @lpi: lines per IRQ, or 0 to not generate irqs. Note: IRQ to be
72          generated _after_ lpi lines are transferred. */
73 static __le32* cx88_risc_field(__le32 *rp, struct scatterlist *sglist,
74                             unsigned int offset, u32 sync_line,
75                             unsigned int bpl, unsigned int padding,
76                             unsigned int lines, unsigned int lpi)
77 {
78         struct scatterlist *sg;
79         unsigned int line,todo,sol;
80
81         /* sync instruction */
82         if (sync_line != NO_SYNC_LINE)
83                 *(rp++) = cpu_to_le32(RISC_RESYNC | sync_line);
84
85         /* scan lines */
86         sg = sglist;
87         for (line = 0; line < lines; line++) {
88                 while (offset && offset >= sg_dma_len(sg)) {
89                         offset -= sg_dma_len(sg);
90                         sg++;
91                 }
92                 if (lpi && line>0 && !(line % lpi))
93                         sol = RISC_SOL | RISC_IRQ1 | RISC_CNT_INC;
94                 else
95                         sol = RISC_SOL;
96                 if (bpl <= sg_dma_len(sg)-offset) {
97                         /* fits into current chunk */
98                         *(rp++)=cpu_to_le32(RISC_WRITE|sol|RISC_EOL|bpl);
99                         *(rp++)=cpu_to_le32(sg_dma_address(sg)+offset);
100                         offset+=bpl;
101                 } else {
102                         /* scanline needs to be split */
103                         todo = bpl;
104                         *(rp++)=cpu_to_le32(RISC_WRITE|sol|
105                                             (sg_dma_len(sg)-offset));
106                         *(rp++)=cpu_to_le32(sg_dma_address(sg)+offset);
107                         todo -= (sg_dma_len(sg)-offset);
108                         offset = 0;
109                         sg++;
110                         while (todo > sg_dma_len(sg)) {
111                                 *(rp++)=cpu_to_le32(RISC_WRITE|
112                                                     sg_dma_len(sg));
113                                 *(rp++)=cpu_to_le32(sg_dma_address(sg));
114                                 todo -= sg_dma_len(sg);
115                                 sg++;
116                         }
117                         *(rp++)=cpu_to_le32(RISC_WRITE|RISC_EOL|todo);
118                         *(rp++)=cpu_to_le32(sg_dma_address(sg));
119                         offset += todo;
120                 }
121                 offset += padding;
122         }
123
124         return rp;
125 }
126
127 int cx88_risc_buffer(struct pci_dev *pci, struct btcx_riscmem *risc,
128                      struct scatterlist *sglist,
129                      unsigned int top_offset, unsigned int bottom_offset,
130                      unsigned int bpl, unsigned int padding, unsigned int lines)
131 {
132         u32 instructions,fields;
133         __le32 *rp;
134         int rc;
135
136         fields = 0;
137         if (UNSET != top_offset)
138                 fields++;
139         if (UNSET != bottom_offset)
140                 fields++;
141
142         /* estimate risc mem: worst case is one write per page border +
143            one write per scan line + syncs + jump (all 2 dwords).  Padding
144            can cause next bpl to start close to a page border.  First DMA
145            region may be smaller than PAGE_SIZE */
146         instructions  = fields * (1 + ((bpl + padding) * lines) / PAGE_SIZE + lines);
147         instructions += 2;
148         if ((rc = btcx_riscmem_alloc(pci,risc,instructions*8)) < 0)
149                 return rc;
150
151         /* write risc instructions */
152         rp = risc->cpu;
153         if (UNSET != top_offset)
154                 rp = cx88_risc_field(rp, sglist, top_offset, 0,
155                                      bpl, padding, lines, 0);
156         if (UNSET != bottom_offset)
157                 rp = cx88_risc_field(rp, sglist, bottom_offset, 0x200,
158                                      bpl, padding, lines, 0);
159
160         /* save pointer to jmp instruction address */
161         risc->jmp = rp;
162         BUG_ON((risc->jmp - risc->cpu + 2) * sizeof (*risc->cpu) > risc->size);
163         return 0;
164 }
165
166 int cx88_risc_databuffer(struct pci_dev *pci, struct btcx_riscmem *risc,
167                          struct scatterlist *sglist, unsigned int bpl,
168                          unsigned int lines, unsigned int lpi)
169 {
170         u32 instructions;
171         __le32 *rp;
172         int rc;
173
174         /* estimate risc mem: worst case is one write per page border +
175            one write per scan line + syncs + jump (all 2 dwords).  Here
176            there is no padding and no sync.  First DMA region may be smaller
177            than PAGE_SIZE */
178         instructions  = 1 + (bpl * lines) / PAGE_SIZE + lines;
179         instructions += 1;
180         if ((rc = btcx_riscmem_alloc(pci,risc,instructions*8)) < 0)
181                 return rc;
182
183         /* write risc instructions */
184         rp = risc->cpu;
185         rp = cx88_risc_field(rp, sglist, 0, NO_SYNC_LINE, bpl, 0, lines, lpi);
186
187         /* save pointer to jmp instruction address */
188         risc->jmp = rp;
189         BUG_ON((risc->jmp - risc->cpu + 2) * sizeof (*risc->cpu) > risc->size);
190         return 0;
191 }
192
193 int cx88_risc_stopper(struct pci_dev *pci, struct btcx_riscmem *risc,
194                       u32 reg, u32 mask, u32 value)
195 {
196         __le32 *rp;
197         int rc;
198
199         if ((rc = btcx_riscmem_alloc(pci, risc, 4*16)) < 0)
200                 return rc;
201
202         /* write risc instructions */
203         rp = risc->cpu;
204         *(rp++) = cpu_to_le32(RISC_WRITECR  | RISC_IRQ2 | RISC_IMM);
205         *(rp++) = cpu_to_le32(reg);
206         *(rp++) = cpu_to_le32(value);
207         *(rp++) = cpu_to_le32(mask);
208         *(rp++) = cpu_to_le32(RISC_JUMP);
209         *(rp++) = cpu_to_le32(risc->dma);
210         return 0;
211 }
212
213 void
214 cx88_free_buffer(struct videobuf_queue *q, struct cx88_buffer *buf)
215 {
216         struct videobuf_dmabuf *dma=videobuf_to_dma(&buf->vb);
217
218         BUG_ON(in_interrupt());
219         videobuf_waiton(&buf->vb,0,0);
220         videobuf_dma_unmap(q, dma);
221         videobuf_dma_free(dma);
222         btcx_riscmem_free(to_pci_dev(q->dev), &buf->risc);
223         buf->vb.state = VIDEOBUF_NEEDS_INIT;
224 }
225
226 /* ------------------------------------------------------------------ */
227 /* our SRAM memory layout                                             */
228
229 /* we are going to put all thr risc programs into host memory, so we
230  * can use the whole SDRAM for the DMA fifos.  To simplify things, we
231  * use a static memory layout.  That surely will waste memory in case
232  * we don't use all DMA channels at the same time (which will be the
233  * case most of the time).  But that still gives us enougth FIFO space
234  * to be able to deal with insane long pci latencies ...
235  *
236  * FIFO space allocations:
237  *    channel  21    (y video)  - 10.0k
238  *    channel  22    (u video)  -  2.0k
239  *    channel  23    (v video)  -  2.0k
240  *    channel  24    (vbi)      -  4.0k
241  *    channels 25+26 (audio)    -  4.0k
242  *    channel  28    (mpeg)     -  4.0k
243  *    TOTAL                     = 29.0k
244  *
245  * Every channel has 160 bytes control data (64 bytes instruction
246  * queue and 6 CDT entries), which is close to 2k total.
247  *
248  * Address layout:
249  *    0x0000 - 0x03ff    CMDs / reserved
250  *    0x0400 - 0x0bff    instruction queues + CDs
251  *    0x0c00 -           FIFOs
252  */
253
254 struct sram_channel cx88_sram_channels[] = {
255         [SRAM_CH21] = {
256                 .name       = "video y / packed",
257                 .cmds_start = 0x180040,
258                 .ctrl_start = 0x180400,
259                 .cdt        = 0x180400 + 64,
260                 .fifo_start = 0x180c00,
261                 .fifo_size  = 0x002800,
262                 .ptr1_reg   = MO_DMA21_PTR1,
263                 .ptr2_reg   = MO_DMA21_PTR2,
264                 .cnt1_reg   = MO_DMA21_CNT1,
265                 .cnt2_reg   = MO_DMA21_CNT2,
266         },
267         [SRAM_CH22] = {
268                 .name       = "video u",
269                 .cmds_start = 0x180080,
270                 .ctrl_start = 0x1804a0,
271                 .cdt        = 0x1804a0 + 64,
272                 .fifo_start = 0x183400,
273                 .fifo_size  = 0x000800,
274                 .ptr1_reg   = MO_DMA22_PTR1,
275                 .ptr2_reg   = MO_DMA22_PTR2,
276                 .cnt1_reg   = MO_DMA22_CNT1,
277                 .cnt2_reg   = MO_DMA22_CNT2,
278         },
279         [SRAM_CH23] = {
280                 .name       = "video v",
281                 .cmds_start = 0x1800c0,
282                 .ctrl_start = 0x180540,
283                 .cdt        = 0x180540 + 64,
284                 .fifo_start = 0x183c00,
285                 .fifo_size  = 0x000800,
286                 .ptr1_reg   = MO_DMA23_PTR1,
287                 .ptr2_reg   = MO_DMA23_PTR2,
288                 .cnt1_reg   = MO_DMA23_CNT1,
289                 .cnt2_reg   = MO_DMA23_CNT2,
290         },
291         [SRAM_CH24] = {
292                 .name       = "vbi",
293                 .cmds_start = 0x180100,
294                 .ctrl_start = 0x1805e0,
295                 .cdt        = 0x1805e0 + 64,
296                 .fifo_start = 0x184400,
297                 .fifo_size  = 0x001000,
298                 .ptr1_reg   = MO_DMA24_PTR1,
299                 .ptr2_reg   = MO_DMA24_PTR2,
300                 .cnt1_reg   = MO_DMA24_CNT1,
301                 .cnt2_reg   = MO_DMA24_CNT2,
302         },
303         [SRAM_CH25] = {
304                 .name       = "audio from",
305                 .cmds_start = 0x180140,
306                 .ctrl_start = 0x180680,
307                 .cdt        = 0x180680 + 64,
308                 .fifo_start = 0x185400,
309                 .fifo_size  = 0x001000,
310                 .ptr1_reg   = MO_DMA25_PTR1,
311                 .ptr2_reg   = MO_DMA25_PTR2,
312                 .cnt1_reg   = MO_DMA25_CNT1,
313                 .cnt2_reg   = MO_DMA25_CNT2,
314         },
315         [SRAM_CH26] = {
316                 .name       = "audio to",
317                 .cmds_start = 0x180180,
318                 .ctrl_start = 0x180720,
319                 .cdt        = 0x180680 + 64,  /* same as audio IN */
320                 .fifo_start = 0x185400,       /* same as audio IN */
321                 .fifo_size  = 0x001000,       /* same as audio IN */
322                 .ptr1_reg   = MO_DMA26_PTR1,
323                 .ptr2_reg   = MO_DMA26_PTR2,
324                 .cnt1_reg   = MO_DMA26_CNT1,
325                 .cnt2_reg   = MO_DMA26_CNT2,
326         },
327         [SRAM_CH28] = {
328                 .name       = "mpeg",
329                 .cmds_start = 0x180200,
330                 .ctrl_start = 0x1807C0,
331                 .cdt        = 0x1807C0 + 64,
332                 .fifo_start = 0x186400,
333                 .fifo_size  = 0x001000,
334                 .ptr1_reg   = MO_DMA28_PTR1,
335                 .ptr2_reg   = MO_DMA28_PTR2,
336                 .cnt1_reg   = MO_DMA28_CNT1,
337                 .cnt2_reg   = MO_DMA28_CNT2,
338         },
339 };
340
341 int cx88_sram_channel_setup(struct cx88_core *core,
342                             struct sram_channel *ch,
343                             unsigned int bpl, u32 risc)
344 {
345         unsigned int i,lines;
346         u32 cdt;
347
348         bpl   = (bpl + 7) & ~7; /* alignment */
349         cdt   = ch->cdt;
350         lines = ch->fifo_size / bpl;
351         if (lines > 6)
352                 lines = 6;
353         BUG_ON(lines < 2);
354
355         /* write CDT */
356         for (i = 0; i < lines; i++)
357                 cx_write(cdt + 16*i, ch->fifo_start + bpl*i);
358
359         /* write CMDS */
360         cx_write(ch->cmds_start +  0, risc);
361         cx_write(ch->cmds_start +  4, cdt);
362         cx_write(ch->cmds_start +  8, (lines*16) >> 3);
363         cx_write(ch->cmds_start + 12, ch->ctrl_start);
364         cx_write(ch->cmds_start + 16, 64 >> 2);
365         for (i = 20; i < 64; i += 4)
366                 cx_write(ch->cmds_start + i, 0);
367
368         /* fill registers */
369         cx_write(ch->ptr1_reg, ch->fifo_start);
370         cx_write(ch->ptr2_reg, cdt);
371         cx_write(ch->cnt1_reg, (bpl >> 3) -1);
372         cx_write(ch->cnt2_reg, (lines*16) >> 3);
373
374         dprintk(2,"sram setup %s: bpl=%d lines=%d\n", ch->name, bpl, lines);
375         return 0;
376 }
377
378 /* ------------------------------------------------------------------ */
379 /* debug helper code                                                  */
380
381 static int cx88_risc_decode(u32 risc)
382 {
383         static char *instr[16] = {
384                 [ RISC_SYNC    >> 28 ] = "sync",
385                 [ RISC_WRITE   >> 28 ] = "write",
386                 [ RISC_WRITEC  >> 28 ] = "writec",
387                 [ RISC_READ    >> 28 ] = "read",
388                 [ RISC_READC   >> 28 ] = "readc",
389                 [ RISC_JUMP    >> 28 ] = "jump",
390                 [ RISC_SKIP    >> 28 ] = "skip",
391                 [ RISC_WRITERM >> 28 ] = "writerm",
392                 [ RISC_WRITECM >> 28 ] = "writecm",
393                 [ RISC_WRITECR >> 28 ] = "writecr",
394         };
395         static int incr[16] = {
396                 [ RISC_WRITE   >> 28 ] = 2,
397                 [ RISC_JUMP    >> 28 ] = 2,
398                 [ RISC_WRITERM >> 28 ] = 3,
399                 [ RISC_WRITECM >> 28 ] = 3,
400                 [ RISC_WRITECR >> 28 ] = 4,
401         };
402         static char *bits[] = {
403                 "12",   "13",   "14",   "resync",
404                 "cnt0", "cnt1", "18",   "19",
405                 "20",   "21",   "22",   "23",
406                 "irq1", "irq2", "eol",  "sol",
407         };
408         int i;
409
410         printk("0x%08x [ %s", risc,
411                instr[risc >> 28] ? instr[risc >> 28] : "INVALID");
412         for (i = ARRAY_SIZE(bits)-1; i >= 0; i--)
413                 if (risc & (1 << (i + 12)))
414                         printk(" %s",bits[i]);
415         printk(" count=%d ]\n", risc & 0xfff);
416         return incr[risc >> 28] ? incr[risc >> 28] : 1;
417 }
418
419
420 void cx88_sram_channel_dump(struct cx88_core *core,
421                             struct sram_channel *ch)
422 {
423         static char *name[] = {
424                 "initial risc",
425                 "cdt base",
426                 "cdt size",
427                 "iq base",
428                 "iq size",
429                 "risc pc",
430                 "iq wr ptr",
431                 "iq rd ptr",
432                 "cdt current",
433                 "pci target",
434                 "line / byte",
435         };
436         u32 risc;
437         unsigned int i,j,n;
438
439         printk("%s: %s - dma channel status dump\n",
440                core->name,ch->name);
441         for (i = 0; i < ARRAY_SIZE(name); i++)
442                 printk("%s:   cmds: %-12s: 0x%08x\n",
443                        core->name,name[i],
444                        cx_read(ch->cmds_start + 4*i));
445         for (n = 1, i = 0; i < 4; i++) {
446                 risc = cx_read(ch->cmds_start + 4 * (i+11));
447                 printk("%s:   risc%d: ", core->name, i);
448                 if (--n)
449                         printk("0x%08x [ arg #%d ]\n", risc, n);
450                 else
451                         n = cx88_risc_decode(risc);
452         }
453         for (i = 0; i < 16; i += n) {
454                 risc = cx_read(ch->ctrl_start + 4 * i);
455                 printk("%s:   iq %x: ", core->name, i);
456                 n = cx88_risc_decode(risc);
457                 for (j = 1; j < n; j++) {
458                         risc = cx_read(ch->ctrl_start + 4 * (i+j));
459                         printk("%s:   iq %x: 0x%08x [ arg #%d ]\n",
460                                core->name, i+j, risc, j);
461                 }
462         }
463
464         printk("%s: fifo: 0x%08x -> 0x%x\n",
465                core->name, ch->fifo_start, ch->fifo_start+ch->fifo_size);
466         printk("%s: ctrl: 0x%08x -> 0x%x\n",
467                core->name, ch->ctrl_start, ch->ctrl_start+6*16);
468         printk("%s:   ptr1_reg: 0x%08x\n",
469                core->name,cx_read(ch->ptr1_reg));
470         printk("%s:   ptr2_reg: 0x%08x\n",
471                core->name,cx_read(ch->ptr2_reg));
472         printk("%s:   cnt1_reg: 0x%08x\n",
473                core->name,cx_read(ch->cnt1_reg));
474         printk("%s:   cnt2_reg: 0x%08x\n",
475                core->name,cx_read(ch->cnt2_reg));
476 }
477
478 static char *cx88_pci_irqs[32] = {
479         "vid", "aud", "ts", "vip", "hst", "5", "6", "tm1",
480         "src_dma", "dst_dma", "risc_rd_err", "risc_wr_err",
481         "brdg_err", "src_dma_err", "dst_dma_err", "ipb_dma_err",
482         "i2c", "i2c_rack", "ir_smp", "gpio0", "gpio1"
483 };
484
485 void cx88_print_irqbits(char *name, char *tag, char **strings,
486                         int len, u32 bits, u32 mask)
487 {
488         unsigned int i;
489
490         printk(KERN_DEBUG "%s: %s [0x%x]", name, tag, bits);
491         for (i = 0; i < len; i++) {
492                 if (!(bits & (1 << i)))
493                         continue;
494                 if (strings[i])
495                         printk(" %s", strings[i]);
496                 else
497                         printk(" %d", i);
498                 if (!(mask & (1 << i)))
499                         continue;
500                 printk("*");
501         }
502         printk("\n");
503 }
504
505 /* ------------------------------------------------------------------ */
506
507 int cx88_core_irq(struct cx88_core *core, u32 status)
508 {
509         int handled = 0;
510
511         if (status & PCI_INT_IR_SMPINT) {
512                 cx88_ir_irq(core);
513                 handled++;
514         }
515         if (!handled)
516                 cx88_print_irqbits(core->name, "irq pci",
517                                    cx88_pci_irqs, ARRAY_SIZE(cx88_pci_irqs),
518                                    status, core->pci_irqmask);
519         return handled;
520 }
521
522 void cx88_wakeup(struct cx88_core *core,
523                  struct cx88_dmaqueue *q, u32 count)
524 {
525         struct cx88_buffer *buf;
526         int bc;
527
528         for (bc = 0;; bc++) {
529                 if (list_empty(&q->active))
530                         break;
531                 buf = list_entry(q->active.next,
532                                  struct cx88_buffer, vb.queue);
533                 /* count comes from the hw and is is 16bit wide --
534                  * this trick handles wrap-arounds correctly for
535                  * up to 32767 buffers in flight... */
536                 if ((s16) (count - buf->count) < 0)
537                         break;
538                 do_gettimeofday(&buf->vb.ts);
539                 dprintk(2,"[%p/%d] wakeup reg=%d buf=%d\n",buf,buf->vb.i,
540                         count, buf->count);
541                 buf->vb.state = VIDEOBUF_DONE;
542                 list_del(&buf->vb.queue);
543                 wake_up(&buf->vb.done);
544         }
545         if (list_empty(&q->active)) {
546                 del_timer(&q->timeout);
547         } else {
548                 mod_timer(&q->timeout, jiffies+BUFFER_TIMEOUT);
549         }
550         if (bc != 1)
551                 printk("%s: %d buffers handled (should be 1)\n",__func__,bc);
552 }
553
554 void cx88_shutdown(struct cx88_core *core)
555 {
556         /* disable RISC controller + IRQs */
557         cx_write(MO_DEV_CNTRL2, 0);
558
559         /* stop dma transfers */
560         cx_write(MO_VID_DMACNTRL, 0x0);
561         cx_write(MO_AUD_DMACNTRL, 0x0);
562         cx_write(MO_TS_DMACNTRL, 0x0);
563         cx_write(MO_VIP_DMACNTRL, 0x0);
564         cx_write(MO_GPHST_DMACNTRL, 0x0);
565
566         /* stop interrupts */
567         cx_write(MO_PCI_INTMSK, 0x0);
568         cx_write(MO_VID_INTMSK, 0x0);
569         cx_write(MO_AUD_INTMSK, 0x0);
570         cx_write(MO_TS_INTMSK, 0x0);
571         cx_write(MO_VIP_INTMSK, 0x0);
572         cx_write(MO_GPHST_INTMSK, 0x0);
573
574         /* stop capturing */
575         cx_write(VID_CAPTURE_CONTROL, 0);
576 }
577
578 int cx88_reset(struct cx88_core *core)
579 {
580         dprintk(1,"%s\n",__func__);
581         cx88_shutdown(core);
582
583         /* clear irq status */
584         cx_write(MO_VID_INTSTAT, 0xFFFFFFFF); // Clear PIV int
585         cx_write(MO_PCI_INTSTAT, 0xFFFFFFFF); // Clear PCI int
586         cx_write(MO_INT1_STAT,   0xFFFFFFFF); // Clear RISC int
587
588         /* wait a bit */
589         msleep(100);
590
591         /* init sram */
592         cx88_sram_channel_setup(core, &cx88_sram_channels[SRAM_CH21], 720*4, 0);
593         cx88_sram_channel_setup(core, &cx88_sram_channels[SRAM_CH22], 128, 0);
594         cx88_sram_channel_setup(core, &cx88_sram_channels[SRAM_CH23], 128, 0);
595         cx88_sram_channel_setup(core, &cx88_sram_channels[SRAM_CH24], 128, 0);
596         cx88_sram_channel_setup(core, &cx88_sram_channels[SRAM_CH25], 128, 0);
597         cx88_sram_channel_setup(core, &cx88_sram_channels[SRAM_CH26], 128, 0);
598         cx88_sram_channel_setup(core, &cx88_sram_channels[SRAM_CH28], 188*4, 0);
599
600         /* misc init ... */
601         cx_write(MO_INPUT_FORMAT, ((1 << 13) |   // agc enable
602                                    (1 << 12) |   // agc gain
603                                    (1 << 11) |   // adaptibe agc
604                                    (0 << 10) |   // chroma agc
605                                    (0 <<  9) |   // ckillen
606                                    (7)));
607
608         /* setup image format */
609         cx_andor(MO_COLOR_CTRL, 0x4000, 0x4000);
610
611         /* setup FIFO Threshholds */
612         cx_write(MO_PDMA_STHRSH,   0x0807);
613         cx_write(MO_PDMA_DTHRSH,   0x0807);
614
615         /* fixes flashing of image */
616         cx_write(MO_AGC_SYNC_TIP1, 0x0380000F);
617         cx_write(MO_AGC_BACK_VBI,  0x00E00555);
618
619         cx_write(MO_VID_INTSTAT,   0xFFFFFFFF); // Clear PIV int
620         cx_write(MO_PCI_INTSTAT,   0xFFFFFFFF); // Clear PCI int
621         cx_write(MO_INT1_STAT,     0xFFFFFFFF); // Clear RISC int
622
623         /* Reset on-board parts */
624         cx_write(MO_SRST_IO, 0);
625         msleep(10);
626         cx_write(MO_SRST_IO, 1);
627
628         return 0;
629 }
630
631 /* ------------------------------------------------------------------ */
632
633 static unsigned int inline norm_swidth(v4l2_std_id norm)
634 {
635         return (norm & (V4L2_STD_MN & ~V4L2_STD_PAL_Nc)) ? 754 : 922;
636 }
637
638 static unsigned int inline norm_hdelay(v4l2_std_id norm)
639 {
640         return (norm & (V4L2_STD_MN & ~V4L2_STD_PAL_Nc)) ? 135 : 186;
641 }
642
643 static unsigned int inline norm_vdelay(v4l2_std_id norm)
644 {
645         return (norm & V4L2_STD_625_50) ? 0x24 : 0x18;
646 }
647
648 static unsigned int inline norm_fsc8(v4l2_std_id norm)
649 {
650         if (norm & V4L2_STD_PAL_M)
651                 return 28604892;      // 3.575611 MHz
652
653         if (norm & (V4L2_STD_PAL_Nc))
654                 return 28656448;      // 3.582056 MHz
655
656         if (norm & V4L2_STD_NTSC) // All NTSC/M and variants
657                 return 28636360;      // 3.57954545 MHz +/- 10 Hz
658
659         /* SECAM have also different sub carrier for chroma,
660            but step_db and step_dr, at cx88_set_tvnorm already handles that.
661
662            The same FSC applies to PAL/BGDKIH, PAL/60, NTSC/4.43 and PAL/N
663          */
664
665         return 35468950;      // 4.43361875 MHz +/- 5 Hz
666 }
667
668 static unsigned int inline norm_htotal(v4l2_std_id norm)
669 {
670
671         unsigned int fsc4=norm_fsc8(norm)/2;
672
673         /* returns 4*FSC / vtotal / frames per seconds */
674         return (norm & V4L2_STD_625_50) ?
675                                 ((fsc4+312)/625+12)/25 :
676                                 ((fsc4+262)/525*1001+15000)/30000;
677 }
678
679 static unsigned int inline norm_vbipack(v4l2_std_id norm)
680 {
681         return (norm & V4L2_STD_625_50) ? 511 : 400;
682 }
683
684 int cx88_set_scale(struct cx88_core *core, unsigned int width, unsigned int height,
685                    enum v4l2_field field)
686 {
687         unsigned int swidth  = norm_swidth(core->tvnorm);
688         unsigned int sheight = norm_maxh(core->tvnorm);
689         u32 value;
690
691         dprintk(1,"set_scale: %dx%d [%s%s,%s]\n", width, height,
692                 V4L2_FIELD_HAS_TOP(field)    ? "T" : "",
693                 V4L2_FIELD_HAS_BOTTOM(field) ? "B" : "",
694                 v4l2_norm_to_name(core->tvnorm));
695         if (!V4L2_FIELD_HAS_BOTH(field))
696                 height *= 2;
697
698         // recalc H delay and scale registers
699         value = (width * norm_hdelay(core->tvnorm)) / swidth;
700         value &= 0x3fe;
701         cx_write(MO_HDELAY_EVEN,  value);
702         cx_write(MO_HDELAY_ODD,   value);
703         dprintk(1,"set_scale: hdelay  0x%04x (width %d)\n", value,swidth);
704
705         value = (swidth * 4096 / width) - 4096;
706         cx_write(MO_HSCALE_EVEN,  value);
707         cx_write(MO_HSCALE_ODD,   value);
708         dprintk(1,"set_scale: hscale  0x%04x\n", value);
709
710         cx_write(MO_HACTIVE_EVEN, width);
711         cx_write(MO_HACTIVE_ODD,  width);
712         dprintk(1,"set_scale: hactive 0x%04x\n", width);
713
714         // recalc V scale Register (delay is constant)
715         cx_write(MO_VDELAY_EVEN, norm_vdelay(core->tvnorm));
716         cx_write(MO_VDELAY_ODD,  norm_vdelay(core->tvnorm));
717         dprintk(1,"set_scale: vdelay  0x%04x\n", norm_vdelay(core->tvnorm));
718
719         value = (0x10000 - (sheight * 512 / height - 512)) & 0x1fff;
720         cx_write(MO_VSCALE_EVEN,  value);
721         cx_write(MO_VSCALE_ODD,   value);
722         dprintk(1,"set_scale: vscale  0x%04x\n", value);
723
724         cx_write(MO_VACTIVE_EVEN, sheight);
725         cx_write(MO_VACTIVE_ODD,  sheight);
726         dprintk(1,"set_scale: vactive 0x%04x\n", sheight);
727
728         // setup filters
729         value = 0;
730         value |= (1 << 19);        // CFILT (default)
731         if (core->tvnorm & V4L2_STD_SECAM) {
732                 value |= (1 << 15);
733                 value |= (1 << 16);
734         }
735         if (INPUT(core->input).type == CX88_VMUX_SVIDEO)
736                 value |= (1 << 13) | (1 << 5);
737         if (V4L2_FIELD_INTERLACED == field)
738                 value |= (1 << 3); // VINT (interlaced vertical scaling)
739         if (width < 385)
740                 value |= (1 << 0); // 3-tap interpolation
741         if (width < 193)
742                 value |= (1 << 1); // 5-tap interpolation
743         if (nocomb)
744                 value |= (3 << 5); // disable comb filter
745
746         cx_write(MO_FILTER_EVEN,  value);
747         cx_write(MO_FILTER_ODD,   value);
748         dprintk(1,"set_scale: filter  0x%04x\n", value);
749
750         return 0;
751 }
752
753 static const u32 xtal = 28636363;
754
755 static int set_pll(struct cx88_core *core, int prescale, u32 ofreq)
756 {
757         static u32 pre[] = { 0, 0, 0, 3, 2, 1 };
758         u64 pll;
759         u32 reg;
760         int i;
761
762         if (prescale < 2)
763                 prescale = 2;
764         if (prescale > 5)
765                 prescale = 5;
766
767         pll = ofreq * 8 * prescale * (u64)(1 << 20);
768         do_div(pll,xtal);
769         reg = (pll & 0x3ffffff) | (pre[prescale] << 26);
770         if (((reg >> 20) & 0x3f) < 14) {
771                 printk("%s/0: pll out of range\n",core->name);
772                 return -1;
773         }
774
775         dprintk(1,"set_pll:    MO_PLL_REG       0x%08x [old=0x%08x,freq=%d]\n",
776                 reg, cx_read(MO_PLL_REG), ofreq);
777         cx_write(MO_PLL_REG, reg);
778         for (i = 0; i < 100; i++) {
779                 reg = cx_read(MO_DEVICE_STATUS);
780                 if (reg & (1<<2)) {
781                         dprintk(1,"pll locked [pre=%d,ofreq=%d]\n",
782                                 prescale,ofreq);
783                         return 0;
784                 }
785                 dprintk(1,"pll not locked yet, waiting ...\n");
786                 msleep(10);
787         }
788         dprintk(1,"pll NOT locked [pre=%d,ofreq=%d]\n",prescale,ofreq);
789         return -1;
790 }
791
792 int cx88_start_audio_dma(struct cx88_core *core)
793 {
794         /* constant 128 made buzz in analog Nicam-stereo for bigger fifo_size */
795         int bpl = cx88_sram_channels[SRAM_CH25].fifo_size/4;
796
797         /* If downstream RISC is enabled, bail out; ALSA is managing DMA */
798         if (cx_read(MO_AUD_DMACNTRL) & 0x10)
799                 return 0;
800
801         /* setup fifo + format */
802         cx88_sram_channel_setup(core, &cx88_sram_channels[SRAM_CH25], bpl, 0);
803         cx88_sram_channel_setup(core, &cx88_sram_channels[SRAM_CH26], bpl, 0);
804
805         cx_write(MO_AUDD_LNGTH, bpl); /* fifo bpl size */
806         cx_write(MO_AUDR_LNGTH, bpl); /* fifo bpl size */
807
808         /* start dma */
809         cx_write(MO_AUD_DMACNTRL, 0x0003); /* Up and Down fifo enable */
810
811         return 0;
812 }
813
814 int cx88_stop_audio_dma(struct cx88_core *core)
815 {
816         /* If downstream RISC is enabled, bail out; ALSA is managing DMA */
817         if (cx_read(MO_AUD_DMACNTRL) & 0x10)
818                 return 0;
819
820         /* stop dma */
821         cx_write(MO_AUD_DMACNTRL, 0x0000);
822
823         return 0;
824 }
825
826 static int set_tvaudio(struct cx88_core *core)
827 {
828         v4l2_std_id norm = core->tvnorm;
829
830         if (CX88_VMUX_TELEVISION != INPUT(core->input).type)
831                 return 0;
832
833         if (V4L2_STD_PAL_BG & norm) {
834                 core->tvaudio = WW_BG;
835
836         } else if (V4L2_STD_PAL_DK & norm) {
837                 core->tvaudio = WW_DK;
838
839         } else if (V4L2_STD_PAL_I & norm) {
840                 core->tvaudio = WW_I;
841
842         } else if (V4L2_STD_SECAM_L & norm) {
843                 core->tvaudio = WW_L;
844
845         } else if (V4L2_STD_SECAM_DK & norm) {
846                 core->tvaudio = WW_DK;
847
848         } else if ((V4L2_STD_NTSC_M & norm) ||
849                    (V4L2_STD_PAL_M  & norm)) {
850                 core->tvaudio = WW_BTSC;
851
852         } else if (V4L2_STD_NTSC_M_JP & norm) {
853                 core->tvaudio = WW_EIAJ;
854
855         } else {
856                 printk("%s/0: tvaudio support needs work for this tv norm [%s], sorry\n",
857                        core->name, v4l2_norm_to_name(core->tvnorm));
858                 core->tvaudio = 0;
859                 return 0;
860         }
861
862         cx_andor(MO_AFECFG_IO, 0x1f, 0x0);
863         cx88_set_tvaudio(core);
864         /* cx88_set_stereo(dev,V4L2_TUNER_MODE_STEREO); */
865
866 /*
867    This should be needed only on cx88-alsa. It seems that some cx88 chips have
868    bugs and does require DMA enabled for it to work.
869  */
870         cx88_start_audio_dma(core);
871         return 0;
872 }
873
874
875
876 int cx88_set_tvnorm(struct cx88_core *core, v4l2_std_id norm)
877 {
878         u32 fsc8;
879         u32 adc_clock;
880         u32 vdec_clock;
881         u32 step_db,step_dr;
882         u64 tmp64;
883         u32 bdelay,agcdelay,htotal;
884         u32 cxiformat, cxoformat;
885
886         core->tvnorm = norm;
887         fsc8       = norm_fsc8(norm);
888         adc_clock  = xtal;
889         vdec_clock = fsc8;
890         step_db    = fsc8;
891         step_dr    = fsc8;
892
893         if (norm & V4L2_STD_NTSC_M_JP) {
894                 cxiformat = VideoFormatNTSCJapan;
895                 cxoformat = 0x181f0008;
896         } else if (norm & V4L2_STD_NTSC_443) {
897                 cxiformat = VideoFormatNTSC443;
898                 cxoformat = 0x181f0008;
899         } else if (norm & V4L2_STD_PAL_M) {
900                 cxiformat = VideoFormatPALM;
901                 cxoformat = 0x1c1f0008;
902         } else if (norm & V4L2_STD_PAL_N) {
903                 cxiformat = VideoFormatPALN;
904                 cxoformat = 0x1c1f0008;
905         } else if (norm & V4L2_STD_PAL_Nc) {
906                 cxiformat = VideoFormatPALNC;
907                 cxoformat = 0x1c1f0008;
908         } else if (norm & V4L2_STD_PAL_60) {
909                 cxiformat = VideoFormatPAL60;
910                 cxoformat = 0x181f0008;
911         } else if (norm & V4L2_STD_NTSC) {
912                 cxiformat = VideoFormatNTSC;
913                 cxoformat = 0x181f0008;
914         } else if (norm & V4L2_STD_SECAM) {
915                 step_db = 4250000 * 8;
916                 step_dr = 4406250 * 8;
917
918                 cxiformat = VideoFormatSECAM;
919                 cxoformat = 0x181f0008;
920         } else { /* PAL */
921                 cxiformat = VideoFormatPAL;
922                 cxoformat = 0x181f0008;
923         }
924
925         dprintk(1,"set_tvnorm: \"%s\" fsc8=%d adc=%d vdec=%d db/dr=%d/%d\n",
926                 v4l2_norm_to_name(core->tvnorm), fsc8, adc_clock, vdec_clock,
927                 step_db, step_dr);
928         set_pll(core,2,vdec_clock);
929
930         dprintk(1,"set_tvnorm: MO_INPUT_FORMAT  0x%08x [old=0x%08x]\n",
931                 cxiformat, cx_read(MO_INPUT_FORMAT) & 0x0f);
932         /* Chroma AGC must be disabled if SECAM is used, we enable it
933            by default on PAL and NTSC */
934         cx_andor(MO_INPUT_FORMAT, 0x40f,
935                  norm & V4L2_STD_SECAM ? cxiformat : cxiformat | 0x400);
936
937         // FIXME: as-is from DScaler
938         dprintk(1,"set_tvnorm: MO_OUTPUT_FORMAT 0x%08x [old=0x%08x]\n",
939                 cxoformat, cx_read(MO_OUTPUT_FORMAT));
940         cx_write(MO_OUTPUT_FORMAT, cxoformat);
941
942         // MO_SCONV_REG = adc clock / video dec clock * 2^17
943         tmp64  = adc_clock * (u64)(1 << 17);
944         do_div(tmp64, vdec_clock);
945         dprintk(1,"set_tvnorm: MO_SCONV_REG     0x%08x [old=0x%08x]\n",
946                 (u32)tmp64, cx_read(MO_SCONV_REG));
947         cx_write(MO_SCONV_REG, (u32)tmp64);
948
949         // MO_SUB_STEP = 8 * fsc / video dec clock * 2^22
950         tmp64  = step_db * (u64)(1 << 22);
951         do_div(tmp64, vdec_clock);
952         dprintk(1,"set_tvnorm: MO_SUB_STEP      0x%08x [old=0x%08x]\n",
953                 (u32)tmp64, cx_read(MO_SUB_STEP));
954         cx_write(MO_SUB_STEP, (u32)tmp64);
955
956         // MO_SUB_STEP_DR = 8 * 4406250 / video dec clock * 2^22
957         tmp64  = step_dr * (u64)(1 << 22);
958         do_div(tmp64, vdec_clock);
959         dprintk(1,"set_tvnorm: MO_SUB_STEP_DR   0x%08x [old=0x%08x]\n",
960                 (u32)tmp64, cx_read(MO_SUB_STEP_DR));
961         cx_write(MO_SUB_STEP_DR, (u32)tmp64);
962
963         // bdelay + agcdelay
964         bdelay   = vdec_clock * 65 / 20000000 + 21;
965         agcdelay = vdec_clock * 68 / 20000000 + 15;
966         dprintk(1,"set_tvnorm: MO_AGC_BURST     0x%08x [old=0x%08x,bdelay=%d,agcdelay=%d]\n",
967                 (bdelay << 8) | agcdelay, cx_read(MO_AGC_BURST), bdelay, agcdelay);
968         cx_write(MO_AGC_BURST, (bdelay << 8) | agcdelay);
969
970         // htotal
971         tmp64 = norm_htotal(norm) * (u64)vdec_clock;
972         do_div(tmp64, fsc8);
973         htotal = (u32)tmp64 | (HLNotchFilter4xFsc << 11);
974         dprintk(1,"set_tvnorm: MO_HTOTAL        0x%08x [old=0x%08x,htotal=%d]\n",
975                 htotal, cx_read(MO_HTOTAL), (u32)tmp64);
976         cx_write(MO_HTOTAL, htotal);
977
978         // vbi stuff, set vbi offset to 10 (for 20 Clk*2 pixels), this makes
979         // the effective vbi offset ~244 samples, the same as the Bt8x8
980         cx_write(MO_VBI_PACKET, (10<<11) | norm_vbipack(norm));
981
982         // this is needed as well to set all tvnorm parameter
983         cx88_set_scale(core, 320, 240, V4L2_FIELD_INTERLACED);
984
985         // audio
986         set_tvaudio(core);
987
988         // tell i2c chips
989         cx88_call_i2c_clients(core,VIDIOC_S_STD,&norm);
990
991         // done
992         return 0;
993 }
994
995 /* ------------------------------------------------------------------ */
996
997 struct video_device *cx88_vdev_init(struct cx88_core *core,
998                                     struct pci_dev *pci,
999                                     struct video_device *template,
1000                                     char *type)
1001 {
1002         struct video_device *vfd;
1003
1004         vfd = video_device_alloc();
1005         if (NULL == vfd)
1006                 return NULL;
1007         *vfd = *template;
1008         vfd->minor   = -1;
1009         vfd->dev     = &pci->dev;
1010         vfd->release = video_device_release;
1011         snprintf(vfd->name, sizeof(vfd->name), "%s %s (%s)",
1012                  core->name, type, core->board.name);
1013         return vfd;
1014 }
1015
1016 struct cx88_core* cx88_core_get(struct pci_dev *pci)
1017 {
1018         struct cx88_core *core;
1019
1020         mutex_lock(&devlist);
1021         list_for_each_entry(core, &cx88_devlist, devlist) {
1022                 if (pci->bus->number != core->pci_bus)
1023                         continue;
1024                 if (PCI_SLOT(pci->devfn) != core->pci_slot)
1025                         continue;
1026
1027                 if (0 != cx88_get_resources(core, pci)) {
1028                         mutex_unlock(&devlist);
1029                         return NULL;
1030                 }
1031                 atomic_inc(&core->refcount);
1032                 mutex_unlock(&devlist);
1033                 return core;
1034         }
1035
1036         core = cx88_core_create(pci, cx88_devcount);
1037         if (NULL != core) {
1038                 cx88_devcount++;
1039                 list_add_tail(&core->devlist, &cx88_devlist);
1040         }
1041
1042         mutex_unlock(&devlist);
1043         return core;
1044 }
1045
1046 void cx88_core_put(struct cx88_core *core, struct pci_dev *pci)
1047 {
1048         release_mem_region(pci_resource_start(pci,0),
1049                            pci_resource_len(pci,0));
1050
1051         if (!atomic_dec_and_test(&core->refcount))
1052                 return;
1053
1054         mutex_lock(&devlist);
1055         cx88_ir_fini(core);
1056         if (0 == core->i2c_rc)
1057                 i2c_del_adapter(&core->i2c_adap);
1058         list_del(&core->devlist);
1059         iounmap(core->lmmio);
1060         cx88_devcount--;
1061         mutex_unlock(&devlist);
1062         kfree(core);
1063 }
1064
1065 /* ------------------------------------------------------------------ */
1066
1067 EXPORT_SYMBOL(cx88_print_irqbits);
1068
1069 EXPORT_SYMBOL(cx88_core_irq);
1070 EXPORT_SYMBOL(cx88_wakeup);
1071 EXPORT_SYMBOL(cx88_reset);
1072 EXPORT_SYMBOL(cx88_shutdown);
1073
1074 EXPORT_SYMBOL(cx88_risc_buffer);
1075 EXPORT_SYMBOL(cx88_risc_databuffer);
1076 EXPORT_SYMBOL(cx88_risc_stopper);
1077 EXPORT_SYMBOL(cx88_free_buffer);
1078
1079 EXPORT_SYMBOL(cx88_sram_channels);
1080 EXPORT_SYMBOL(cx88_sram_channel_setup);
1081 EXPORT_SYMBOL(cx88_sram_channel_dump);
1082
1083 EXPORT_SYMBOL(cx88_set_tvnorm);
1084 EXPORT_SYMBOL(cx88_set_scale);
1085
1086 EXPORT_SYMBOL(cx88_vdev_init);
1087 EXPORT_SYMBOL(cx88_core_get);
1088 EXPORT_SYMBOL(cx88_core_put);
1089
1090 EXPORT_SYMBOL(cx88_ir_start);
1091 EXPORT_SYMBOL(cx88_ir_stop);
1092
1093 /*
1094  * Local variables:
1095  * c-basic-offset: 8
1096  * End:
1097  * 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
1098  */