1 /* 2 * 3 * device driver for philips saa7134 based TV cards 4 * driver core 5 * 6 * (c) 2001-03 Gerd Knorr <kraxel@bytesex.org> [SuSE Labs] 7 * 8 * This program is free software; you can redistribute it and/or modify 9 * it under the terms of the GNU General Public License as published by 10 * the Free Software Foundation; either version 2 of the License, or 11 * (at your option) any later version. 12 * 13 * This program is distributed in the hope that it will be useful, 14 * but WITHOUT ANY WARRANTY; without even the implied warranty of 15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 16 * GNU General Public License for more details. 17 * 18 * You should have received a copy of the GNU General Public License 19 * along with this program; if not, write to the Free Software 20 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. 21 */ 22 23 #include "saa7134.h" 24 #include "saa7134-reg.h" 25 26 #include <linux/init.h> 27 #include <linux/list.h> 28 #include <linux/module.h> 29 #include <linux/kernel.h> 30 #include <linux/slab.h> 31 #include <linux/kmod.h> 32 #include <linux/sound.h> 33 #include <linux/interrupt.h> 34 #include <linux/delay.h> 35 #include <linux/mutex.h> 36 #include <linux/dma-mapping.h> 37 #include <linux/pm.h> 38 39 MODULE_DESCRIPTION("v4l2 driver module for saa7130/34 based TV cards"); 40 MODULE_AUTHOR("Gerd Knorr <kraxel@bytesex.org> [SuSE Labs]"); 41 MODULE_LICENSE("GPL"); 42 MODULE_VERSION(SAA7134_VERSION); 43 44 45 /* ------------------------------------------------------------------ */ 46 47 static unsigned int irq_debug; 48 module_param(irq_debug, int, 0644); 49 MODULE_PARM_DESC(irq_debug,"enable debug messages [IRQ handler]"); 50 51 static unsigned int core_debug; 52 module_param(core_debug, int, 0644); 53 MODULE_PARM_DESC(core_debug,"enable debug messages [core]"); 54 55 static unsigned int gpio_tracking; 56 module_param(gpio_tracking, int, 0644); 57 MODULE_PARM_DESC(gpio_tracking,"enable debug messages [gpio]"); 58 59 static unsigned int alsa = 1; 60 module_param(alsa, int, 0644); 61 MODULE_PARM_DESC(alsa,"enable/disable ALSA DMA sound [dmasound]"); 62 63 static unsigned int latency = UNSET; 64 module_param(latency, int, 0444); 65 MODULE_PARM_DESC(latency,"pci latency timer"); 66 67 int saa7134_no_overlay=-1; 68 module_param_named(no_overlay, saa7134_no_overlay, int, 0444); 69 MODULE_PARM_DESC(no_overlay, "allow override overlay default (0 disables, 1 enables) [some VIA/SIS chipsets are known to have problem with overlay]"); 70 71 bool saa7134_userptr; 72 module_param(saa7134_userptr, bool, 0644); 73 MODULE_PARM_DESC(saa7134_userptr, "enable page-aligned userptr support"); 74 75 static unsigned int video_nr[] = {[0 ... (SAA7134_MAXBOARDS - 1)] = UNSET }; 76 static unsigned int vbi_nr[] = {[0 ... (SAA7134_MAXBOARDS - 1)] = UNSET }; 77 static unsigned int radio_nr[] = {[0 ... (SAA7134_MAXBOARDS - 1)] = UNSET }; 78 static unsigned int tuner[] = {[0 ... (SAA7134_MAXBOARDS - 1)] = UNSET }; 79 static unsigned int card[] = {[0 ... (SAA7134_MAXBOARDS - 1)] = UNSET }; 80 81 82 module_param_array(video_nr, int, NULL, 0444); 83 module_param_array(vbi_nr, int, NULL, 0444); 84 module_param_array(radio_nr, int, NULL, 0444); 85 module_param_array(tuner, int, NULL, 0444); 86 module_param_array(card, int, NULL, 0444); 87 88 MODULE_PARM_DESC(video_nr, "video device number"); 89 MODULE_PARM_DESC(vbi_nr, "vbi device number"); 90 MODULE_PARM_DESC(radio_nr, "radio device number"); 91 MODULE_PARM_DESC(tuner, "tuner type"); 92 MODULE_PARM_DESC(card, "card type"); 93 94 DEFINE_MUTEX(saa7134_devlist_lock); 95 EXPORT_SYMBOL(saa7134_devlist_lock); 96 LIST_HEAD(saa7134_devlist); 97 EXPORT_SYMBOL(saa7134_devlist); 98 static LIST_HEAD(mops_list); 99 static unsigned int saa7134_devcount; 100 101 int (*saa7134_dmasound_init)(struct saa7134_dev *dev); 102 int (*saa7134_dmasound_exit)(struct saa7134_dev *dev); 103 104 #define core_dbg(fmt, arg...) do { \ 105 if (core_debug) \ 106 printk(KERN_DEBUG pr_fmt("core: " fmt), ## arg); \ 107 } while (0) 108 109 #define irq_dbg(level, fmt, arg...) do {\ 110 if (irq_debug > level) \ 111 printk(KERN_DEBUG pr_fmt("irq: " fmt), ## arg); \ 112 } while (0) 113 114 void saa7134_track_gpio(struct saa7134_dev *dev, const char *msg) 115 { 116 unsigned long mode,status; 117 118 if (!gpio_tracking) 119 return; 120 /* rising SAA7134_GPIO_GPRESCAN reads the status */ 121 saa_andorb(SAA7134_GPIO_GPMODE3,SAA7134_GPIO_GPRESCAN,0); 122 saa_andorb(SAA7134_GPIO_GPMODE3,SAA7134_GPIO_GPRESCAN,SAA7134_GPIO_GPRESCAN); 123 mode = saa_readl(SAA7134_GPIO_GPMODE0 >> 2) & 0xfffffff; 124 status = saa_readl(SAA7134_GPIO_GPSTATUS0 >> 2) & 0xfffffff; 125 core_dbg("%s: gpio: mode=0x%07lx in=0x%07lx out=0x%07lx [%s]\n", 126 dev->name, mode, (~mode) & status, mode & status, msg); 127 } 128 129 void saa7134_set_gpio(struct saa7134_dev *dev, int bit_no, int value) 130 { 131 u32 index, bitval; 132 133 index = 1 << bit_no; 134 switch (value) { 135 case 0: /* static value */ 136 case 1: 137 core_dbg("setting GPIO%d to static %d\n", bit_no, value); 138 /* turn sync mode off if necessary */ 139 if (index & 0x00c00000) 140 saa_andorb(SAA7134_VIDEO_PORT_CTRL6, 0x0f, 0x00); 141 if (value) 142 bitval = index; 143 else 144 bitval = 0; 145 saa_andorl(SAA7134_GPIO_GPMODE0 >> 2, index, index); 146 saa_andorl(SAA7134_GPIO_GPSTATUS0 >> 2, index, bitval); 147 break; 148 case 3: /* tristate */ 149 core_dbg("setting GPIO%d to tristate\n", bit_no); 150 saa_andorl(SAA7134_GPIO_GPMODE0 >> 2, index, 0); 151 break; 152 } 153 } 154 155 /* ------------------------------------------------------------------ */ 156 157 158 /* ----------------------------------------------------------- */ 159 /* delayed request_module */ 160 161 #if defined(CONFIG_MODULES) && defined(MODULE) 162 163 static void request_module_async(struct work_struct *work){ 164 struct saa7134_dev* dev = container_of(work, struct saa7134_dev, request_module_wk); 165 if (card_is_empress(dev)) 166 request_module("saa7134-empress"); 167 if (card_is_dvb(dev)) 168 request_module("saa7134-dvb"); 169 if (card_is_go7007(dev)) 170 request_module("saa7134-go7007"); 171 if (alsa) { 172 if (dev->pci->device != PCI_DEVICE_ID_PHILIPS_SAA7130) 173 request_module("saa7134-alsa"); 174 } 175 } 176 177 static void request_submodules(struct saa7134_dev *dev) 178 { 179 INIT_WORK(&dev->request_module_wk, request_module_async); 180 schedule_work(&dev->request_module_wk); 181 } 182 183 static void flush_request_submodules(struct saa7134_dev *dev) 184 { 185 flush_work(&dev->request_module_wk); 186 } 187 188 #else 189 #define request_submodules(dev) 190 #define flush_request_submodules(dev) 191 #endif /* CONFIG_MODULES */ 192 193 /* ------------------------------------------------------------------ */ 194 195 /* nr of (saa7134-)pages for the given buffer size */ 196 static int saa7134_buffer_pages(int size) 197 { 198 size = PAGE_ALIGN(size); 199 size += PAGE_SIZE; /* for non-page-aligned buffers */ 200 size /= 4096; 201 return size; 202 } 203 204 /* calc max # of buffers from size (must not exceed the 4MB virtual 205 * address space per DMA channel) */ 206 int saa7134_buffer_count(unsigned int size, unsigned int count) 207 { 208 unsigned int maxcount; 209 210 maxcount = 1024 / saa7134_buffer_pages(size); 211 if (count > maxcount) 212 count = maxcount; 213 return count; 214 } 215 216 int saa7134_buffer_startpage(struct saa7134_buf *buf) 217 { 218 return saa7134_buffer_pages(vb2_plane_size(&buf->vb2.vb2_buf, 0)) 219 * buf->vb2.vb2_buf.index; 220 } 221 222 unsigned long saa7134_buffer_base(struct saa7134_buf *buf) 223 { 224 unsigned long base; 225 struct sg_table *dma = vb2_dma_sg_plane_desc(&buf->vb2.vb2_buf, 0); 226 227 base = saa7134_buffer_startpage(buf) * 4096; 228 base += dma->sgl[0].offset; 229 return base; 230 } 231 232 /* ------------------------------------------------------------------ */ 233 234 int saa7134_pgtable_alloc(struct pci_dev *pci, struct saa7134_pgtable *pt) 235 { 236 __le32 *cpu; 237 dma_addr_t dma_addr = 0; 238 239 cpu = pci_alloc_consistent(pci, SAA7134_PGTABLE_SIZE, &dma_addr); 240 if (NULL == cpu) 241 return -ENOMEM; 242 pt->size = SAA7134_PGTABLE_SIZE; 243 pt->cpu = cpu; 244 pt->dma = dma_addr; 245 return 0; 246 } 247 248 int saa7134_pgtable_build(struct pci_dev *pci, struct saa7134_pgtable *pt, 249 struct scatterlist *list, unsigned int length, 250 unsigned int startpage) 251 { 252 __le32 *ptr; 253 unsigned int i, p; 254 255 BUG_ON(NULL == pt || NULL == pt->cpu); 256 257 ptr = pt->cpu + startpage; 258 for (i = 0; i < length; i++, list = sg_next(list)) { 259 for (p = 0; p * 4096 < list->length; p++, ptr++) 260 *ptr = cpu_to_le32(sg_dma_address(list) + 261 list->offset + p * 4096); 262 } 263 return 0; 264 } 265 266 void saa7134_pgtable_free(struct pci_dev *pci, struct saa7134_pgtable *pt) 267 { 268 if (NULL == pt->cpu) 269 return; 270 pci_free_consistent(pci, pt->size, pt->cpu, pt->dma); 271 pt->cpu = NULL; 272 } 273 274 /* ------------------------------------------------------------------ */ 275 276 int saa7134_buffer_queue(struct saa7134_dev *dev, 277 struct saa7134_dmaqueue *q, 278 struct saa7134_buf *buf) 279 { 280 struct saa7134_buf *next = NULL; 281 unsigned long flags; 282 283 spin_lock_irqsave(&dev->slock, flags); 284 core_dbg("buffer_queue %p\n", buf); 285 if (NULL == q->curr) { 286 if (!q->need_two) { 287 q->curr = buf; 288 buf->activate(dev, buf, NULL); 289 } else if (list_empty(&q->queue)) { 290 list_add_tail(&buf->entry, &q->queue); 291 } else { 292 next = list_entry(q->queue.next, struct saa7134_buf, 293 entry); 294 q->curr = buf; 295 buf->activate(dev, buf, next); 296 } 297 } else { 298 list_add_tail(&buf->entry, &q->queue); 299 } 300 spin_unlock_irqrestore(&dev->slock, flags); 301 return 0; 302 } 303 304 void saa7134_buffer_finish(struct saa7134_dev *dev, 305 struct saa7134_dmaqueue *q, 306 unsigned int state) 307 { 308 core_dbg("buffer_finish %p\n", q->curr); 309 310 /* finish current buffer */ 311 q->curr->vb2.vb2_buf.timestamp = ktime_get_ns(); 312 q->curr->vb2.sequence = q->seq_nr++; 313 vb2_buffer_done(&q->curr->vb2.vb2_buf, state); 314 q->curr = NULL; 315 } 316 317 void saa7134_buffer_next(struct saa7134_dev *dev, 318 struct saa7134_dmaqueue *q) 319 { 320 struct saa7134_buf *buf,*next = NULL; 321 322 assert_spin_locked(&dev->slock); 323 BUG_ON(NULL != q->curr); 324 325 if (!list_empty(&q->queue)) { 326 /* activate next one from queue */ 327 buf = list_entry(q->queue.next, struct saa7134_buf, entry); 328 core_dbg("buffer_next %p [prev=%p/next=%p]\n", 329 buf, q->queue.prev, q->queue.next); 330 list_del(&buf->entry); 331 if (!list_empty(&q->queue)) 332 next = list_entry(q->queue.next, struct saa7134_buf, entry); 333 q->curr = buf; 334 buf->activate(dev, buf, next); 335 core_dbg("buffer_next #2 prev=%p/next=%p\n", 336 q->queue.prev, q->queue.next); 337 } else { 338 /* nothing to do -- just stop DMA */ 339 core_dbg("buffer_next %p\n", NULL); 340 saa7134_set_dmabits(dev); 341 del_timer(&q->timeout); 342 } 343 } 344 345 void saa7134_buffer_timeout(unsigned long data) 346 { 347 struct saa7134_dmaqueue *q = (struct saa7134_dmaqueue *)data; 348 struct saa7134_dev *dev = q->dev; 349 unsigned long flags; 350 351 spin_lock_irqsave(&dev->slock, flags); 352 353 /* try to reset the hardware (SWRST) */ 354 saa_writeb(SAA7134_REGION_ENABLE, 0x00); 355 saa_writeb(SAA7134_REGION_ENABLE, 0x80); 356 saa_writeb(SAA7134_REGION_ENABLE, 0x00); 357 358 /* flag current buffer as failed, 359 try to start over with the next one. */ 360 if (q->curr) { 361 core_dbg("timeout on %p\n", q->curr); 362 saa7134_buffer_finish(dev, q, VB2_BUF_STATE_ERROR); 363 } 364 saa7134_buffer_next(dev, q); 365 spin_unlock_irqrestore(&dev->slock, flags); 366 } 367 368 void saa7134_stop_streaming(struct saa7134_dev *dev, struct saa7134_dmaqueue *q) 369 { 370 unsigned long flags; 371 struct list_head *pos, *n; 372 struct saa7134_buf *tmp; 373 374 spin_lock_irqsave(&dev->slock, flags); 375 if (!list_empty(&q->queue)) { 376 list_for_each_safe(pos, n, &q->queue) { 377 tmp = list_entry(pos, struct saa7134_buf, entry); 378 vb2_buffer_done(&tmp->vb2.vb2_buf, 379 VB2_BUF_STATE_ERROR); 380 list_del(pos); 381 tmp = NULL; 382 } 383 } 384 spin_unlock_irqrestore(&dev->slock, flags); 385 saa7134_buffer_timeout((unsigned long)q); /* also calls del_timer(&q->timeout) */ 386 } 387 EXPORT_SYMBOL_GPL(saa7134_stop_streaming); 388 389 /* ------------------------------------------------------------------ */ 390 391 int saa7134_set_dmabits(struct saa7134_dev *dev) 392 { 393 u32 split, task=0, ctrl=0, irq=0; 394 enum v4l2_field cap = V4L2_FIELD_ANY; 395 enum v4l2_field ov = V4L2_FIELD_ANY; 396 397 assert_spin_locked(&dev->slock); 398 399 if (dev->insuspend) 400 return 0; 401 402 /* video capture -- dma 0 + video task A */ 403 if (dev->video_q.curr) { 404 task |= 0x01; 405 ctrl |= SAA7134_MAIN_CTRL_TE0; 406 irq |= SAA7134_IRQ1_INTE_RA0_1 | 407 SAA7134_IRQ1_INTE_RA0_0; 408 cap = dev->field; 409 } 410 411 /* video capture -- dma 1+2 (planar modes) */ 412 if (dev->video_q.curr && dev->fmt->planar) { 413 ctrl |= SAA7134_MAIN_CTRL_TE4 | 414 SAA7134_MAIN_CTRL_TE5; 415 } 416 417 /* screen overlay -- dma 0 + video task B */ 418 if (dev->ovenable) { 419 task |= 0x10; 420 ctrl |= SAA7134_MAIN_CTRL_TE1; 421 ov = dev->ovfield; 422 } 423 424 /* vbi capture -- dma 0 + vbi task A+B */ 425 if (dev->vbi_q.curr) { 426 task |= 0x22; 427 ctrl |= SAA7134_MAIN_CTRL_TE2 | 428 SAA7134_MAIN_CTRL_TE3; 429 irq |= SAA7134_IRQ1_INTE_RA0_7 | 430 SAA7134_IRQ1_INTE_RA0_6 | 431 SAA7134_IRQ1_INTE_RA0_5 | 432 SAA7134_IRQ1_INTE_RA0_4; 433 } 434 435 /* audio capture -- dma 3 */ 436 if (dev->dmasound.dma_running) { 437 ctrl |= SAA7134_MAIN_CTRL_TE6; 438 irq |= SAA7134_IRQ1_INTE_RA3_1 | 439 SAA7134_IRQ1_INTE_RA3_0; 440 } 441 442 /* TS capture -- dma 5 */ 443 if (dev->ts_q.curr) { 444 ctrl |= SAA7134_MAIN_CTRL_TE5; 445 irq |= SAA7134_IRQ1_INTE_RA2_1 | 446 SAA7134_IRQ1_INTE_RA2_0; 447 } 448 449 /* set task conditions + field handling */ 450 if (V4L2_FIELD_HAS_BOTH(cap) || V4L2_FIELD_HAS_BOTH(ov) || cap == ov) { 451 /* default config -- use full frames */ 452 saa_writeb(SAA7134_TASK_CONDITIONS(TASK_A), 0x0d); 453 saa_writeb(SAA7134_TASK_CONDITIONS(TASK_B), 0x0d); 454 saa_writeb(SAA7134_FIELD_HANDLING(TASK_A), 0x02); 455 saa_writeb(SAA7134_FIELD_HANDLING(TASK_B), 0x02); 456 split = 0; 457 } else { 458 /* split fields between tasks */ 459 if (V4L2_FIELD_TOP == cap) { 460 /* odd A, even B, repeat */ 461 saa_writeb(SAA7134_TASK_CONDITIONS(TASK_A), 0x0d); 462 saa_writeb(SAA7134_TASK_CONDITIONS(TASK_B), 0x0e); 463 } else { 464 /* odd B, even A, repeat */ 465 saa_writeb(SAA7134_TASK_CONDITIONS(TASK_A), 0x0e); 466 saa_writeb(SAA7134_TASK_CONDITIONS(TASK_B), 0x0d); 467 } 468 saa_writeb(SAA7134_FIELD_HANDLING(TASK_A), 0x01); 469 saa_writeb(SAA7134_FIELD_HANDLING(TASK_B), 0x01); 470 split = 1; 471 } 472 473 /* irqs */ 474 saa_writeb(SAA7134_REGION_ENABLE, task); 475 saa_writel(SAA7134_IRQ1, irq); 476 saa_andorl(SAA7134_MAIN_CTRL, 477 SAA7134_MAIN_CTRL_TE0 | 478 SAA7134_MAIN_CTRL_TE1 | 479 SAA7134_MAIN_CTRL_TE2 | 480 SAA7134_MAIN_CTRL_TE3 | 481 SAA7134_MAIN_CTRL_TE4 | 482 SAA7134_MAIN_CTRL_TE5 | 483 SAA7134_MAIN_CTRL_TE6, 484 ctrl); 485 core_dbg("dmabits: task=0x%02x ctrl=0x%02x irq=0x%x split=%s\n", 486 task, ctrl, irq, split ? "no" : "yes"); 487 488 return 0; 489 } 490 491 /* ------------------------------------------------------------------ */ 492 /* IRQ handler + helpers */ 493 494 static char *irqbits[] = { 495 "DONE_RA0", "DONE_RA1", "DONE_RA2", "DONE_RA3", 496 "AR", "PE", "PWR_ON", "RDCAP", "INTL", "FIDT", "MMC", 497 "TRIG_ERR", "CONF_ERR", "LOAD_ERR", 498 "GPIO16", "GPIO18", "GPIO22", "GPIO23" 499 }; 500 #define IRQBITS ARRAY_SIZE(irqbits) 501 502 static void print_irqstatus(struct saa7134_dev *dev, int loop, 503 unsigned long report, unsigned long status) 504 { 505 unsigned int i; 506 507 irq_dbg(1, "[%d,%ld]: r=0x%lx s=0x%02lx", 508 loop, jiffies, report, status); 509 for (i = 0; i < IRQBITS; i++) { 510 if (!(report & (1 << i))) 511 continue; 512 pr_cont(" %s", irqbits[i]); 513 } 514 if (report & SAA7134_IRQ_REPORT_DONE_RA0) { 515 pr_cont(" | RA0=%s,%s,%s,%ld", 516 (status & 0x40) ? "vbi" : "video", 517 (status & 0x20) ? "b" : "a", 518 (status & 0x10) ? "odd" : "even", 519 (status & 0x0f)); 520 } 521 pr_cont("\n"); 522 } 523 524 static irqreturn_t saa7134_irq(int irq, void *dev_id) 525 { 526 struct saa7134_dev *dev = (struct saa7134_dev*) dev_id; 527 unsigned long report,status; 528 int loop, handled = 0; 529 530 if (dev->insuspend) 531 goto out; 532 533 for (loop = 0; loop < 10; loop++) { 534 report = saa_readl(SAA7134_IRQ_REPORT); 535 status = saa_readl(SAA7134_IRQ_STATUS); 536 537 /* If dmasound support is active and we get a sound report, 538 * mask out the report and let the saa7134-alsa module deal 539 * with it */ 540 if ((report & SAA7134_IRQ_REPORT_DONE_RA3) && 541 (dev->dmasound.priv_data != NULL) ) 542 { 543 irq_dbg(2, "preserving DMA sound interrupt\n"); 544 report &= ~SAA7134_IRQ_REPORT_DONE_RA3; 545 } 546 547 if (0 == report) { 548 irq_dbg(2, "no (more) work\n"); 549 goto out; 550 } 551 552 handled = 1; 553 saa_writel(SAA7134_IRQ_REPORT,report); 554 if (irq_debug) 555 print_irqstatus(dev,loop,report,status); 556 557 558 if ((report & SAA7134_IRQ_REPORT_RDCAP) || 559 (report & SAA7134_IRQ_REPORT_INTL)) 560 saa7134_irq_video_signalchange(dev); 561 562 563 if ((report & SAA7134_IRQ_REPORT_DONE_RA0) && 564 (status & 0x60) == 0) 565 saa7134_irq_video_done(dev,status); 566 567 if ((report & SAA7134_IRQ_REPORT_DONE_RA0) && 568 (status & 0x40) == 0x40) 569 saa7134_irq_vbi_done(dev,status); 570 571 if ((report & SAA7134_IRQ_REPORT_DONE_RA2) && 572 card_has_mpeg(dev)) { 573 if (dev->mops->irq_ts_done != NULL) 574 dev->mops->irq_ts_done(dev, status); 575 else 576 saa7134_irq_ts_done(dev, status); 577 } 578 579 if (report & SAA7134_IRQ_REPORT_GPIO16) { 580 switch (dev->has_remote) { 581 case SAA7134_REMOTE_GPIO: 582 if (!dev->remote) 583 break; 584 if (dev->remote->mask_keydown & 0x10000) { 585 saa7134_input_irq(dev); 586 } 587 break; 588 589 case SAA7134_REMOTE_I2C: 590 break; /* FIXME: invoke I2C get_key() */ 591 592 default: /* GPIO16 not used by IR remote */ 593 break; 594 } 595 } 596 597 if (report & SAA7134_IRQ_REPORT_GPIO18) { 598 switch (dev->has_remote) { 599 case SAA7134_REMOTE_GPIO: 600 if (!dev->remote) 601 break; 602 if ((dev->remote->mask_keydown & 0x40000) || 603 (dev->remote->mask_keyup & 0x40000)) { 604 saa7134_input_irq(dev); 605 } 606 break; 607 608 case SAA7134_REMOTE_I2C: 609 break; /* FIXME: invoke I2C get_key() */ 610 611 default: /* GPIO18 not used by IR remote */ 612 break; 613 } 614 } 615 } 616 617 if (10 == loop) { 618 print_irqstatus(dev,loop,report,status); 619 if (report & SAA7134_IRQ_REPORT_PE) { 620 /* disable all parity error */ 621 pr_warn("%s/irq: looping -- clearing PE (parity error!) enable bit\n", 622 dev->name); 623 saa_clearl(SAA7134_IRQ2,SAA7134_IRQ2_INTE_PE); 624 } else if (report & SAA7134_IRQ_REPORT_GPIO16) { 625 /* disable gpio16 IRQ */ 626 pr_warn("%s/irq: looping -- clearing GPIO16 enable bit\n", 627 dev->name); 628 saa_clearl(SAA7134_IRQ2, SAA7134_IRQ2_INTE_GPIO16_P); 629 saa_clearl(SAA7134_IRQ2, SAA7134_IRQ2_INTE_GPIO16_N); 630 } else if (report & SAA7134_IRQ_REPORT_GPIO18) { 631 /* disable gpio18 IRQs */ 632 pr_warn("%s/irq: looping -- clearing GPIO18 enable bit\n", 633 dev->name); 634 saa_clearl(SAA7134_IRQ2, SAA7134_IRQ2_INTE_GPIO18_P); 635 saa_clearl(SAA7134_IRQ2, SAA7134_IRQ2_INTE_GPIO18_N); 636 } else { 637 /* disable all irqs */ 638 pr_warn("%s/irq: looping -- clearing all enable bits\n", 639 dev->name); 640 saa_writel(SAA7134_IRQ1,0); 641 saa_writel(SAA7134_IRQ2,0); 642 } 643 } 644 645 out: 646 return IRQ_RETVAL(handled); 647 } 648 649 /* ------------------------------------------------------------------ */ 650 651 /* early init (no i2c, no irq) */ 652 653 static int saa7134_hw_enable1(struct saa7134_dev *dev) 654 { 655 /* RAM FIFO config */ 656 saa_writel(SAA7134_FIFO_SIZE, 0x08070503); 657 saa_writel(SAA7134_THRESHOULD, 0x02020202); 658 659 /* enable audio + video processing */ 660 saa_writel(SAA7134_MAIN_CTRL, 661 SAA7134_MAIN_CTRL_VPLLE | 662 SAA7134_MAIN_CTRL_APLLE | 663 SAA7134_MAIN_CTRL_EXOSC | 664 SAA7134_MAIN_CTRL_EVFE1 | 665 SAA7134_MAIN_CTRL_EVFE2 | 666 SAA7134_MAIN_CTRL_ESFE | 667 SAA7134_MAIN_CTRL_EBDAC); 668 669 /* 670 * Initialize OSS _after_ enabling audio clock PLL and audio processing. 671 * OSS initialization writes to registers via the audio DSP; these 672 * writes will fail unless the audio clock has been started. At worst, 673 * audio will not work. 674 */ 675 676 /* enable peripheral devices */ 677 saa_writeb(SAA7134_SPECIAL_MODE, 0x01); 678 679 /* set vertical line numbering start (vbi needs this) */ 680 saa_writeb(SAA7134_SOURCE_TIMING2, 0x20); 681 682 return 0; 683 } 684 685 static int saa7134_hwinit1(struct saa7134_dev *dev) 686 { 687 core_dbg("hwinit1\n"); 688 689 saa_writel(SAA7134_IRQ1, 0); 690 saa_writel(SAA7134_IRQ2, 0); 691 692 /* Clear any stale IRQ reports */ 693 saa_writel(SAA7134_IRQ_REPORT, saa_readl(SAA7134_IRQ_REPORT)); 694 695 mutex_init(&dev->lock); 696 spin_lock_init(&dev->slock); 697 698 saa7134_track_gpio(dev,"pre-init"); 699 saa7134_video_init1(dev); 700 saa7134_vbi_init1(dev); 701 if (card_has_mpeg(dev)) 702 saa7134_ts_init1(dev); 703 saa7134_input_init1(dev); 704 705 saa7134_hw_enable1(dev); 706 707 return 0; 708 } 709 710 /* late init (with i2c + irq) */ 711 static int saa7134_hw_enable2(struct saa7134_dev *dev) 712 { 713 714 unsigned int irq2_mask; 715 716 /* enable IRQ's */ 717 irq2_mask = 718 SAA7134_IRQ2_INTE_DEC3 | 719 SAA7134_IRQ2_INTE_DEC2 | 720 SAA7134_IRQ2_INTE_DEC1 | 721 SAA7134_IRQ2_INTE_DEC0 | 722 SAA7134_IRQ2_INTE_PE | 723 SAA7134_IRQ2_INTE_AR; 724 725 if (dev->has_remote == SAA7134_REMOTE_GPIO && dev->remote) { 726 if (dev->remote->mask_keydown & 0x10000) 727 irq2_mask |= SAA7134_IRQ2_INTE_GPIO16_N; 728 else { /* Allow enabling both IRQ edge triggers */ 729 if (dev->remote->mask_keydown & 0x40000) 730 irq2_mask |= SAA7134_IRQ2_INTE_GPIO18_P; 731 if (dev->remote->mask_keyup & 0x40000) 732 irq2_mask |= SAA7134_IRQ2_INTE_GPIO18_N; 733 } 734 } 735 736 if (dev->has_remote == SAA7134_REMOTE_I2C) { 737 request_module("ir-kbd-i2c"); 738 } 739 740 saa_writel(SAA7134_IRQ1, 0); 741 saa_writel(SAA7134_IRQ2, irq2_mask); 742 743 return 0; 744 } 745 746 static int saa7134_hwinit2(struct saa7134_dev *dev) 747 { 748 749 core_dbg("hwinit2\n"); 750 751 saa7134_video_init2(dev); 752 saa7134_tvaudio_init2(dev); 753 754 saa7134_hw_enable2(dev); 755 756 return 0; 757 } 758 759 760 /* shutdown */ 761 static int saa7134_hwfini(struct saa7134_dev *dev) 762 { 763 core_dbg("hwfini\n"); 764 765 if (card_has_mpeg(dev)) 766 saa7134_ts_fini(dev); 767 saa7134_input_fini(dev); 768 saa7134_vbi_fini(dev); 769 saa7134_tvaudio_fini(dev); 770 saa7134_video_fini(dev); 771 return 0; 772 } 773 774 static void must_configure_manually(int has_eeprom) 775 { 776 unsigned int i,p; 777 778 if (!has_eeprom) 779 pr_warn("saa7134: <rant>\n" 780 "saa7134: Congratulations! Your TV card vendor saved a few\n" 781 "saa7134: cents for a eeprom, thus your pci board has no\n" 782 "saa7134: subsystem ID and I can't identify it automatically\n" 783 "saa7134: </rant>\n" 784 "saa7134: I feel better now. Ok, here are the good news:\n" 785 "saa7134: You can use the card=<nr> insmod option to specify\n" 786 "saa7134: which board do you have. The list:\n"); 787 else 788 pr_warn("saa7134: Board is currently unknown. You might try to use the card=<nr>\n" 789 "saa7134: insmod option to specify which board do you have, but this is\n" 790 "saa7134: somewhat risky, as might damage your card. It is better to ask\n" 791 "saa7134: for support at linux-media@vger.kernel.org.\n" 792 "saa7134: The supported cards are:\n"); 793 794 for (i = 0; i < saa7134_bcount; i++) { 795 pr_warn("saa7134: card=%d -> %-40.40s", 796 i,saa7134_boards[i].name); 797 for (p = 0; saa7134_pci_tbl[p].driver_data; p++) { 798 if (saa7134_pci_tbl[p].driver_data != i) 799 continue; 800 pr_cont(" %04x:%04x", 801 saa7134_pci_tbl[p].subvendor, 802 saa7134_pci_tbl[p].subdevice); 803 } 804 pr_cont("\n"); 805 } 806 } 807 808 static void saa7134_unregister_media_device(struct saa7134_dev *dev) 809 { 810 811 #ifdef CONFIG_MEDIA_CONTROLLER 812 if (!dev->media_dev) 813 return; 814 media_device_unregister(dev->media_dev); 815 media_device_cleanup(dev->media_dev); 816 kfree(dev->media_dev); 817 dev->media_dev = NULL; 818 #endif 819 } 820 821 static void saa7134_media_release(struct saa7134_dev *dev) 822 { 823 #ifdef CONFIG_MEDIA_CONTROLLER 824 int i; 825 826 for (i = 0; i < SAA7134_INPUT_MAX + 1; i++) 827 media_device_unregister_entity(&dev->input_ent[i]); 828 #endif 829 } 830 831 #if defined(CONFIG_MEDIA_CONTROLLER) 832 static void saa7134_create_entities(struct saa7134_dev *dev) 833 { 834 int ret, i; 835 struct media_entity *entity; 836 struct media_entity *decoder = NULL; 837 838 /* Check if it is using an external analog TV demod */ 839 media_device_for_each_entity(entity, dev->media_dev) { 840 if (entity->function == MEDIA_ENT_F_ATV_DECODER) { 841 decoder = entity; 842 break; 843 } 844 } 845 846 /* 847 * saa713x is not using an external ATV demod. 848 * Register the internal one 849 */ 850 if (!decoder) { 851 dev->demod.name = "saa713x"; 852 dev->demod_pad[DEMOD_PAD_IF_INPUT].flags = MEDIA_PAD_FL_SINK; 853 dev->demod_pad[DEMOD_PAD_VID_OUT].flags = MEDIA_PAD_FL_SOURCE; 854 dev->demod_pad[DEMOD_PAD_VBI_OUT].flags = MEDIA_PAD_FL_SOURCE; 855 dev->demod.function = MEDIA_ENT_F_ATV_DECODER; 856 857 ret = media_entity_pads_init(&dev->demod, DEMOD_NUM_PADS, 858 dev->demod_pad); 859 if (ret < 0) 860 pr_err("failed to initialize demod pad!\n"); 861 862 ret = media_device_register_entity(dev->media_dev, &dev->demod); 863 if (ret < 0) 864 pr_err("failed to register demod entity!\n"); 865 866 dev->decoder = &dev->demod; 867 } else { 868 dev->decoder = decoder; 869 } 870 871 /* Initialize Video, VBI and Radio pads */ 872 dev->video_pad.flags = MEDIA_PAD_FL_SINK; 873 ret = media_entity_pads_init(&dev->video_dev->entity, 1, 874 &dev->video_pad); 875 if (ret < 0) 876 pr_err("failed to initialize video media entity!\n"); 877 878 dev->vbi_pad.flags = MEDIA_PAD_FL_SINK; 879 ret = media_entity_pads_init(&dev->vbi_dev->entity, 1, 880 &dev->vbi_pad); 881 if (ret < 0) 882 pr_err("failed to initialize vbi media entity!\n"); 883 884 /* Create entities for each input connector */ 885 for (i = 0; i < SAA7134_INPUT_MAX; i++) { 886 struct media_entity *ent = &dev->input_ent[i]; 887 struct saa7134_input *in = &card_in(dev, i); 888 889 if (in->type == SAA7134_NO_INPUT) 890 break; 891 892 /* This input uses the S-Video connector */ 893 if (in->type == SAA7134_INPUT_COMPOSITE_OVER_SVIDEO) 894 continue; 895 896 ent->name = saa7134_input_name[in->type]; 897 ent->flags = MEDIA_ENT_FL_CONNECTOR; 898 dev->input_pad[i].flags = MEDIA_PAD_FL_SOURCE; 899 900 switch (in->type) { 901 case SAA7134_INPUT_COMPOSITE: 902 case SAA7134_INPUT_COMPOSITE0: 903 case SAA7134_INPUT_COMPOSITE1: 904 case SAA7134_INPUT_COMPOSITE2: 905 case SAA7134_INPUT_COMPOSITE3: 906 case SAA7134_INPUT_COMPOSITE4: 907 ent->function = MEDIA_ENT_F_CONN_COMPOSITE; 908 break; 909 case SAA7134_INPUT_SVIDEO: 910 case SAA7134_INPUT_SVIDEO0: 911 case SAA7134_INPUT_SVIDEO1: 912 ent->function = MEDIA_ENT_F_CONN_SVIDEO; 913 break; 914 default: 915 /* 916 * SAA7134_INPUT_TV and SAA7134_INPUT_TV_MONO. 917 * 918 * Please notice that neither SAA7134_INPUT_MUTE or 919 * SAA7134_INPUT_RADIO are defined at 920 * saa7134_board.input. 921 */ 922 ent->function = MEDIA_ENT_F_CONN_RF; 923 break; 924 } 925 926 ret = media_entity_pads_init(ent, 1, &dev->input_pad[i]); 927 if (ret < 0) 928 pr_err("failed to initialize input pad[%d]!\n", i); 929 930 ret = media_device_register_entity(dev->media_dev, ent); 931 if (ret < 0) 932 pr_err("failed to register input entity %d!\n", i); 933 } 934 935 /* Create input for Radio RF connector */ 936 if (card_has_radio(dev)) { 937 struct saa7134_input *in = &saa7134_boards[dev->board].radio; 938 struct media_entity *ent = &dev->input_ent[i]; 939 940 ent->name = saa7134_input_name[in->type]; 941 ent->flags = MEDIA_ENT_FL_CONNECTOR; 942 dev->input_pad[i].flags = MEDIA_PAD_FL_SOURCE; 943 ent->function = MEDIA_ENT_F_CONN_RF; 944 945 ret = media_entity_pads_init(ent, 1, &dev->input_pad[i]); 946 if (ret < 0) 947 pr_err("failed to initialize input pad[%d]!\n", i); 948 949 ret = media_device_register_entity(dev->media_dev, ent); 950 if (ret < 0) 951 pr_err("failed to register input entity %d!\n", i); 952 } 953 } 954 #endif 955 956 static struct video_device *vdev_init(struct saa7134_dev *dev, 957 struct video_device *template, 958 char *type) 959 { 960 struct video_device *vfd; 961 962 vfd = video_device_alloc(); 963 if (NULL == vfd) 964 return NULL; 965 *vfd = *template; 966 vfd->v4l2_dev = &dev->v4l2_dev; 967 vfd->release = video_device_release; 968 snprintf(vfd->name, sizeof(vfd->name), "%s %s (%s)", 969 dev->name, type, saa7134_boards[dev->board].name); 970 video_set_drvdata(vfd, dev); 971 return vfd; 972 } 973 974 static void saa7134_unregister_video(struct saa7134_dev *dev) 975 { 976 saa7134_media_release(dev); 977 978 if (dev->video_dev) { 979 if (video_is_registered(dev->video_dev)) 980 video_unregister_device(dev->video_dev); 981 else 982 video_device_release(dev->video_dev); 983 dev->video_dev = NULL; 984 } 985 if (dev->vbi_dev) { 986 if (video_is_registered(dev->vbi_dev)) 987 video_unregister_device(dev->vbi_dev); 988 else 989 video_device_release(dev->vbi_dev); 990 dev->vbi_dev = NULL; 991 } 992 if (dev->radio_dev) { 993 if (video_is_registered(dev->radio_dev)) 994 video_unregister_device(dev->radio_dev); 995 else 996 video_device_release(dev->radio_dev); 997 dev->radio_dev = NULL; 998 } 999 } 1000 1001 static void mpeg_ops_attach(struct saa7134_mpeg_ops *ops, 1002 struct saa7134_dev *dev) 1003 { 1004 int err; 1005 1006 if (NULL != dev->mops) 1007 return; 1008 if (saa7134_boards[dev->board].mpeg != ops->type) 1009 return; 1010 err = ops->init(dev); 1011 if (0 != err) 1012 return; 1013 dev->mops = ops; 1014 } 1015 1016 static void mpeg_ops_detach(struct saa7134_mpeg_ops *ops, 1017 struct saa7134_dev *dev) 1018 { 1019 if (NULL == dev->mops) 1020 return; 1021 if (dev->mops != ops) 1022 return; 1023 dev->mops->fini(dev); 1024 dev->mops = NULL; 1025 } 1026 1027 static int saa7134_initdev(struct pci_dev *pci_dev, 1028 const struct pci_device_id *pci_id) 1029 { 1030 struct saa7134_dev *dev; 1031 struct saa7134_mpeg_ops *mops; 1032 int err; 1033 1034 if (saa7134_devcount == SAA7134_MAXBOARDS) 1035 return -ENOMEM; 1036 1037 dev = kzalloc(sizeof(*dev),GFP_KERNEL); 1038 if (NULL == dev) 1039 return -ENOMEM; 1040 1041 dev->nr = saa7134_devcount; 1042 sprintf(dev->name, "saa%x[%d]", pci_dev->device, dev->nr); 1043 1044 #ifdef CONFIG_MEDIA_CONTROLLER 1045 dev->media_dev = kzalloc(sizeof(*dev->media_dev), GFP_KERNEL); 1046 if (!dev->media_dev) { 1047 err = -ENOMEM; 1048 goto fail0; 1049 } 1050 media_device_pci_init(dev->media_dev, pci_dev, dev->name); 1051 dev->v4l2_dev.mdev = dev->media_dev; 1052 #endif 1053 1054 err = v4l2_device_register(&pci_dev->dev, &dev->v4l2_dev); 1055 if (err) 1056 goto fail0; 1057 1058 /* pci init */ 1059 dev->pci = pci_dev; 1060 if (pci_enable_device(pci_dev)) { 1061 err = -EIO; 1062 goto fail1; 1063 } 1064 1065 /* pci quirks */ 1066 if (pci_pci_problems) { 1067 if (pci_pci_problems & PCIPCI_TRITON) 1068 pr_info("%s: quirk: PCIPCI_TRITON\n", dev->name); 1069 if (pci_pci_problems & PCIPCI_NATOMA) 1070 pr_info("%s: quirk: PCIPCI_NATOMA\n", dev->name); 1071 if (pci_pci_problems & PCIPCI_VIAETBF) 1072 pr_info("%s: quirk: PCIPCI_VIAETBF\n", dev->name); 1073 if (pci_pci_problems & PCIPCI_VSFX) 1074 pr_info("%s: quirk: PCIPCI_VSFX\n", dev->name); 1075 #ifdef PCIPCI_ALIMAGIK 1076 if (pci_pci_problems & PCIPCI_ALIMAGIK) { 1077 pr_info("%s: quirk: PCIPCI_ALIMAGIK -- latency fixup\n", 1078 dev->name); 1079 latency = 0x0A; 1080 } 1081 #endif 1082 if (pci_pci_problems & (PCIPCI_FAIL|PCIAGP_FAIL)) { 1083 pr_info("%s: quirk: this driver and your chipset may not work together in overlay mode.\n", 1084 dev->name); 1085 if (!saa7134_no_overlay) { 1086 pr_info("%s: quirk: overlay mode will be disabled.\n", 1087 dev->name); 1088 saa7134_no_overlay = 1; 1089 } else { 1090 pr_info("%s: quirk: overlay mode will be forced. Use this option at your own risk.\n", 1091 dev->name); 1092 } 1093 } 1094 } 1095 if (UNSET != latency) { 1096 pr_info("%s: setting pci latency timer to %d\n", 1097 dev->name,latency); 1098 pci_write_config_byte(pci_dev, PCI_LATENCY_TIMER, latency); 1099 } 1100 1101 /* print pci info */ 1102 dev->pci_rev = pci_dev->revision; 1103 pci_read_config_byte(pci_dev, PCI_LATENCY_TIMER, &dev->pci_lat); 1104 pr_info("%s: found at %s, rev: %d, irq: %d, latency: %d, mmio: 0x%llx\n", 1105 dev->name, pci_name(pci_dev), dev->pci_rev, pci_dev->irq, 1106 dev->pci_lat, 1107 (unsigned long long)pci_resource_start(pci_dev, 0)); 1108 pci_set_master(pci_dev); 1109 err = pci_set_dma_mask(pci_dev, DMA_BIT_MASK(32)); 1110 if (err) { 1111 pr_warn("%s: Oops: no 32bit PCI DMA ???\n", dev->name); 1112 goto fail1; 1113 } 1114 1115 /* board config */ 1116 dev->board = pci_id->driver_data; 1117 if ((unsigned)card[dev->nr] < saa7134_bcount) 1118 dev->board = card[dev->nr]; 1119 if (SAA7134_BOARD_UNKNOWN == dev->board) 1120 must_configure_manually(0); 1121 else if (SAA7134_BOARD_NOAUTO == dev->board) { 1122 must_configure_manually(1); 1123 dev->board = SAA7134_BOARD_UNKNOWN; 1124 } 1125 dev->autodetected = card[dev->nr] != dev->board; 1126 dev->tuner_type = saa7134_boards[dev->board].tuner_type; 1127 dev->tuner_addr = saa7134_boards[dev->board].tuner_addr; 1128 dev->radio_type = saa7134_boards[dev->board].radio_type; 1129 dev->radio_addr = saa7134_boards[dev->board].radio_addr; 1130 dev->tda9887_conf = saa7134_boards[dev->board].tda9887_conf; 1131 if (UNSET != tuner[dev->nr]) 1132 dev->tuner_type = tuner[dev->nr]; 1133 pr_info("%s: subsystem: %04x:%04x, board: %s [card=%d,%s]\n", 1134 dev->name,pci_dev->subsystem_vendor, 1135 pci_dev->subsystem_device,saa7134_boards[dev->board].name, 1136 dev->board, dev->autodetected ? 1137 "autodetected" : "insmod option"); 1138 1139 /* get mmio */ 1140 if (!request_mem_region(pci_resource_start(pci_dev,0), 1141 pci_resource_len(pci_dev,0), 1142 dev->name)) { 1143 err = -EBUSY; 1144 pr_err("%s: can't get MMIO memory @ 0x%llx\n", 1145 dev->name,(unsigned long long)pci_resource_start(pci_dev,0)); 1146 goto fail1; 1147 } 1148 dev->lmmio = ioremap(pci_resource_start(pci_dev, 0), 1149 pci_resource_len(pci_dev, 0)); 1150 dev->bmmio = (__u8 __iomem *)dev->lmmio; 1151 if (NULL == dev->lmmio) { 1152 err = -EIO; 1153 pr_err("%s: can't ioremap() MMIO memory\n", 1154 dev->name); 1155 goto fail2; 1156 } 1157 1158 /* initialize hardware #1 */ 1159 saa7134_board_init1(dev); 1160 saa7134_hwinit1(dev); 1161 1162 /* get irq */ 1163 err = request_irq(pci_dev->irq, saa7134_irq, 1164 IRQF_SHARED, dev->name, dev); 1165 if (err < 0) { 1166 pr_err("%s: can't get IRQ %d\n", 1167 dev->name,pci_dev->irq); 1168 goto fail3; 1169 } 1170 1171 /* wait a bit, register i2c bus */ 1172 msleep(100); 1173 saa7134_i2c_register(dev); 1174 saa7134_board_init2(dev); 1175 1176 saa7134_hwinit2(dev); 1177 1178 /* load i2c helpers */ 1179 if (card_is_empress(dev)) { 1180 dev->empress_sd = 1181 v4l2_i2c_new_subdev(&dev->v4l2_dev, &dev->i2c_adap, 1182 "saa6752hs", 1183 saa7134_boards[dev->board].empress_addr, NULL); 1184 1185 if (dev->empress_sd) 1186 dev->empress_sd->grp_id = GRP_EMPRESS; 1187 } 1188 1189 if (saa7134_boards[dev->board].rds_addr) { 1190 struct v4l2_subdev *sd; 1191 1192 sd = v4l2_i2c_new_subdev(&dev->v4l2_dev, 1193 &dev->i2c_adap, "saa6588", 1194 0, I2C_ADDRS(saa7134_boards[dev->board].rds_addr)); 1195 if (sd) { 1196 pr_info("%s: found RDS decoder\n", dev->name); 1197 dev->has_rds = 1; 1198 } 1199 } 1200 1201 mutex_lock(&saa7134_devlist_lock); 1202 list_for_each_entry(mops, &mops_list, next) 1203 mpeg_ops_attach(mops, dev); 1204 list_add_tail(&dev->devlist, &saa7134_devlist); 1205 mutex_unlock(&saa7134_devlist_lock); 1206 1207 /* check for signal */ 1208 saa7134_irq_video_signalchange(dev); 1209 1210 if (TUNER_ABSENT != dev->tuner_type) 1211 saa_call_all(dev, core, s_power, 0); 1212 1213 /* register v4l devices */ 1214 if (saa7134_no_overlay > 0) 1215 pr_info("%s: Overlay support disabled.\n", dev->name); 1216 1217 dev->video_dev = vdev_init(dev,&saa7134_video_template,"video"); 1218 dev->video_dev->ctrl_handler = &dev->ctrl_handler; 1219 dev->video_dev->lock = &dev->lock; 1220 dev->video_dev->queue = &dev->video_vbq; 1221 err = video_register_device(dev->video_dev,VFL_TYPE_GRABBER, 1222 video_nr[dev->nr]); 1223 if (err < 0) { 1224 pr_info("%s: can't register video device\n", 1225 dev->name); 1226 goto fail4; 1227 } 1228 pr_info("%s: registered device %s [v4l2]\n", 1229 dev->name, video_device_node_name(dev->video_dev)); 1230 1231 dev->vbi_dev = vdev_init(dev, &saa7134_video_template, "vbi"); 1232 dev->vbi_dev->ctrl_handler = &dev->ctrl_handler; 1233 dev->vbi_dev->lock = &dev->lock; 1234 dev->vbi_dev->queue = &dev->vbi_vbq; 1235 1236 err = video_register_device(dev->vbi_dev,VFL_TYPE_VBI, 1237 vbi_nr[dev->nr]); 1238 if (err < 0) 1239 goto fail4; 1240 pr_info("%s: registered device %s\n", 1241 dev->name, video_device_node_name(dev->vbi_dev)); 1242 1243 if (card_has_radio(dev)) { 1244 dev->radio_dev = vdev_init(dev,&saa7134_radio_template,"radio"); 1245 dev->radio_dev->ctrl_handler = &dev->radio_ctrl_handler; 1246 dev->radio_dev->lock = &dev->lock; 1247 err = video_register_device(dev->radio_dev,VFL_TYPE_RADIO, 1248 radio_nr[dev->nr]); 1249 if (err < 0) 1250 goto fail4; 1251 pr_info("%s: registered device %s\n", 1252 dev->name, video_device_node_name(dev->radio_dev)); 1253 } 1254 1255 #ifdef CONFIG_MEDIA_CONTROLLER 1256 saa7134_create_entities(dev); 1257 1258 err = v4l2_mc_create_media_graph(dev->media_dev); 1259 if (err) { 1260 pr_err("failed to create media graph\n"); 1261 goto fail4; 1262 } 1263 #endif 1264 /* everything worked */ 1265 saa7134_devcount++; 1266 1267 if (saa7134_dmasound_init && !dev->dmasound.priv_data) 1268 saa7134_dmasound_init(dev); 1269 1270 request_submodules(dev); 1271 1272 /* 1273 * Do it at the end, to reduce dynamic configuration changes during 1274 * the device init. Yet, as request_modules() can be async, the 1275 * topology will likely change after load the saa7134 subdrivers. 1276 */ 1277 #ifdef CONFIG_MEDIA_CONTROLLER 1278 err = media_device_register(dev->media_dev); 1279 if (err) 1280 goto fail4; 1281 #endif 1282 1283 return 0; 1284 1285 fail4: 1286 saa7134_unregister_video(dev); 1287 saa7134_i2c_unregister(dev); 1288 free_irq(pci_dev->irq, dev); 1289 fail3: 1290 saa7134_hwfini(dev); 1291 iounmap(dev->lmmio); 1292 fail2: 1293 release_mem_region(pci_resource_start(pci_dev,0), 1294 pci_resource_len(pci_dev,0)); 1295 fail1: 1296 v4l2_device_unregister(&dev->v4l2_dev); 1297 fail0: 1298 #ifdef CONFIG_MEDIA_CONTROLLER 1299 kfree(dev->media_dev); 1300 #endif 1301 kfree(dev); 1302 return err; 1303 } 1304 1305 static void saa7134_finidev(struct pci_dev *pci_dev) 1306 { 1307 struct v4l2_device *v4l2_dev = pci_get_drvdata(pci_dev); 1308 struct saa7134_dev *dev = container_of(v4l2_dev, struct saa7134_dev, v4l2_dev); 1309 struct saa7134_mpeg_ops *mops; 1310 1311 flush_request_submodules(dev); 1312 1313 /* Release DMA sound modules if present */ 1314 if (saa7134_dmasound_exit && dev->dmasound.priv_data) { 1315 saa7134_dmasound_exit(dev); 1316 } 1317 1318 /* debugging ... */ 1319 if (irq_debug) { 1320 u32 report = saa_readl(SAA7134_IRQ_REPORT); 1321 u32 status = saa_readl(SAA7134_IRQ_STATUS); 1322 print_irqstatus(dev,42,report,status); 1323 } 1324 1325 /* disable peripheral devices */ 1326 saa_writeb(SAA7134_SPECIAL_MODE,0); 1327 1328 /* shutdown hardware */ 1329 saa_writel(SAA7134_IRQ1,0); 1330 saa_writel(SAA7134_IRQ2,0); 1331 saa_writel(SAA7134_MAIN_CTRL,0); 1332 1333 /* shutdown subsystems */ 1334 saa7134_hwfini(dev); 1335 1336 /* unregister */ 1337 mutex_lock(&saa7134_devlist_lock); 1338 list_del(&dev->devlist); 1339 list_for_each_entry(mops, &mops_list, next) 1340 mpeg_ops_detach(mops, dev); 1341 mutex_unlock(&saa7134_devlist_lock); 1342 saa7134_devcount--; 1343 1344 saa7134_i2c_unregister(dev); 1345 saa7134_unregister_video(dev); 1346 1347 1348 /* the DMA sound modules should be unloaded before reaching 1349 this, but just in case they are still present... */ 1350 if (dev->dmasound.priv_data != NULL) { 1351 free_irq(pci_dev->irq, &dev->dmasound); 1352 dev->dmasound.priv_data = NULL; 1353 } 1354 1355 1356 /* release resources */ 1357 free_irq(pci_dev->irq, dev); 1358 iounmap(dev->lmmio); 1359 release_mem_region(pci_resource_start(pci_dev,0), 1360 pci_resource_len(pci_dev,0)); 1361 1362 v4l2_device_unregister(&dev->v4l2_dev); 1363 1364 saa7134_unregister_media_device(dev); 1365 1366 /* free memory */ 1367 kfree(dev); 1368 } 1369 1370 #ifdef CONFIG_PM 1371 1372 /* resends a current buffer in queue after resume */ 1373 static int saa7134_buffer_requeue(struct saa7134_dev *dev, 1374 struct saa7134_dmaqueue *q) 1375 { 1376 struct saa7134_buf *buf, *next; 1377 1378 assert_spin_locked(&dev->slock); 1379 1380 buf = q->curr; 1381 next = buf; 1382 core_dbg("buffer_requeue\n"); 1383 1384 if (!buf) 1385 return 0; 1386 1387 core_dbg("buffer_requeue : resending active buffer\n"); 1388 1389 if (!list_empty(&q->queue)) 1390 next = list_entry(q->queue.next, struct saa7134_buf, 1391 entry); 1392 buf->activate(dev, buf, next); 1393 1394 return 0; 1395 } 1396 1397 static int saa7134_suspend(struct pci_dev *pci_dev , pm_message_t state) 1398 { 1399 struct v4l2_device *v4l2_dev = pci_get_drvdata(pci_dev); 1400 struct saa7134_dev *dev = container_of(v4l2_dev, struct saa7134_dev, v4l2_dev); 1401 1402 /* disable overlay - apps should enable it explicitly on resume*/ 1403 dev->ovenable = 0; 1404 1405 /* Disable interrupts, DMA, and rest of the chip*/ 1406 saa_writel(SAA7134_IRQ1, 0); 1407 saa_writel(SAA7134_IRQ2, 0); 1408 saa_writel(SAA7134_MAIN_CTRL, 0); 1409 1410 dev->insuspend = 1; 1411 synchronize_irq(pci_dev->irq); 1412 1413 /* ACK interrupts once more, just in case, 1414 since the IRQ handler won't ack them anymore*/ 1415 1416 saa_writel(SAA7134_IRQ_REPORT, saa_readl(SAA7134_IRQ_REPORT)); 1417 1418 /* Disable timeout timers - if we have active buffers, we will 1419 fill them on resume*/ 1420 1421 del_timer(&dev->video_q.timeout); 1422 del_timer(&dev->vbi_q.timeout); 1423 del_timer(&dev->ts_q.timeout); 1424 1425 if (dev->remote) 1426 saa7134_ir_stop(dev); 1427 1428 pci_save_state(pci_dev); 1429 pci_set_power_state(pci_dev, pci_choose_state(pci_dev, state)); 1430 1431 return 0; 1432 } 1433 1434 static int saa7134_resume(struct pci_dev *pci_dev) 1435 { 1436 struct v4l2_device *v4l2_dev = pci_get_drvdata(pci_dev); 1437 struct saa7134_dev *dev = container_of(v4l2_dev, struct saa7134_dev, v4l2_dev); 1438 unsigned long flags; 1439 1440 pci_set_power_state(pci_dev, PCI_D0); 1441 pci_restore_state(pci_dev); 1442 1443 /* Do things that are done in saa7134_initdev , 1444 except of initializing memory structures.*/ 1445 1446 saa7134_board_init1(dev); 1447 1448 /* saa7134_hwinit1 */ 1449 if (saa7134_boards[dev->board].video_out) 1450 saa7134_videoport_init(dev); 1451 if (card_has_mpeg(dev)) 1452 saa7134_ts_init_hw(dev); 1453 if (dev->remote) 1454 saa7134_ir_start(dev); 1455 saa7134_hw_enable1(dev); 1456 1457 msleep(100); 1458 1459 saa7134_board_init2(dev); 1460 1461 /*saa7134_hwinit2*/ 1462 saa7134_set_tvnorm_hw(dev); 1463 saa7134_tvaudio_setmute(dev); 1464 saa7134_tvaudio_setvolume(dev, dev->ctl_volume); 1465 saa7134_tvaudio_init(dev); 1466 saa7134_enable_i2s(dev); 1467 saa7134_hw_enable2(dev); 1468 1469 saa7134_irq_video_signalchange(dev); 1470 1471 /*resume unfinished buffer(s)*/ 1472 spin_lock_irqsave(&dev->slock, flags); 1473 saa7134_buffer_requeue(dev, &dev->video_q); 1474 saa7134_buffer_requeue(dev, &dev->vbi_q); 1475 saa7134_buffer_requeue(dev, &dev->ts_q); 1476 1477 /* FIXME: Disable DMA audio sound - temporary till proper support 1478 is implemented*/ 1479 1480 dev->dmasound.dma_running = 0; 1481 1482 /* start DMA now*/ 1483 dev->insuspend = 0; 1484 smp_wmb(); 1485 saa7134_set_dmabits(dev); 1486 spin_unlock_irqrestore(&dev->slock, flags); 1487 1488 return 0; 1489 } 1490 #endif 1491 1492 /* ----------------------------------------------------------- */ 1493 1494 int saa7134_ts_register(struct saa7134_mpeg_ops *ops) 1495 { 1496 struct saa7134_dev *dev; 1497 1498 mutex_lock(&saa7134_devlist_lock); 1499 list_for_each_entry(dev, &saa7134_devlist, devlist) 1500 mpeg_ops_attach(ops, dev); 1501 list_add_tail(&ops->next,&mops_list); 1502 mutex_unlock(&saa7134_devlist_lock); 1503 return 0; 1504 } 1505 1506 void saa7134_ts_unregister(struct saa7134_mpeg_ops *ops) 1507 { 1508 struct saa7134_dev *dev; 1509 1510 mutex_lock(&saa7134_devlist_lock); 1511 list_del(&ops->next); 1512 list_for_each_entry(dev, &saa7134_devlist, devlist) 1513 mpeg_ops_detach(ops, dev); 1514 mutex_unlock(&saa7134_devlist_lock); 1515 } 1516 1517 EXPORT_SYMBOL(saa7134_ts_register); 1518 EXPORT_SYMBOL(saa7134_ts_unregister); 1519 1520 /* ----------------------------------------------------------- */ 1521 1522 static struct pci_driver saa7134_pci_driver = { 1523 .name = "saa7134", 1524 .id_table = saa7134_pci_tbl, 1525 .probe = saa7134_initdev, 1526 .remove = saa7134_finidev, 1527 #ifdef CONFIG_PM 1528 .suspend = saa7134_suspend, 1529 .resume = saa7134_resume 1530 #endif 1531 }; 1532 1533 static int __init saa7134_init(void) 1534 { 1535 INIT_LIST_HEAD(&saa7134_devlist); 1536 pr_info("saa7130/34: v4l2 driver version %s loaded\n", 1537 SAA7134_VERSION); 1538 return pci_register_driver(&saa7134_pci_driver); 1539 } 1540 1541 static void __exit saa7134_fini(void) 1542 { 1543 pci_unregister_driver(&saa7134_pci_driver); 1544 } 1545 1546 module_init(saa7134_init); 1547 module_exit(saa7134_fini); 1548 1549 /* ----------------------------------------------------------- */ 1550 1551 EXPORT_SYMBOL(saa7134_set_gpio); 1552 EXPORT_SYMBOL(saa7134_boards); 1553 1554 /* ----------------- for the DMA sound modules --------------- */ 1555 1556 EXPORT_SYMBOL(saa7134_dmasound_init); 1557 EXPORT_SYMBOL(saa7134_dmasound_exit); 1558 EXPORT_SYMBOL(saa7134_pgtable_free); 1559 EXPORT_SYMBOL(saa7134_pgtable_build); 1560 EXPORT_SYMBOL(saa7134_pgtable_alloc); 1561 EXPORT_SYMBOL(saa7134_set_dmabits); 1562