📄 saa7134-core.c
字号:
printk("\n"); }}static struct video_device *vdev_init(struct saa7134_dev *dev, struct video_device *template, char *type){ struct video_device *vfd; vfd = video_device_alloc(); if (NULL == vfd) return NULL; *vfd = *template; vfd->minor = -1;#if LINUX_VERSION_CODE > KERNEL_VERSION(2,5,0) vfd->dev = &dev->pci->dev; vfd->release = video_device_release;#endif snprintf(vfd->name, sizeof(vfd->name), "%s %s (%s)", dev->name, type, saa7134_boards[dev->board].name); return vfd;}static void saa7134_unregister_video(struct saa7134_dev *dev){ if (dev->video_dev) { if (-1 != dev->video_dev->minor) video_unregister_device(dev->video_dev); else video_device_release(dev->video_dev); dev->video_dev = NULL; } if (dev->ts_dev) { if (-1 != dev->ts_dev->minor) video_unregister_device(dev->ts_dev); else video_device_release(dev->ts_dev); dev->ts_dev = NULL; } if (dev->vbi_dev) { if (-1 != dev->vbi_dev->minor) video_unregister_device(dev->vbi_dev); else video_device_release(dev->vbi_dev); dev->vbi_dev = NULL; } if (dev->radio_dev) { if (-1 != dev->radio_dev->minor) video_unregister_device(dev->radio_dev); else video_device_release(dev->radio_dev); dev->radio_dev = NULL; }}static int __devinit saa7134_initdev(struct pci_dev *pci_dev, const struct pci_device_id *pci_id){ struct saa7134_dev *dev; int err; dev = kmalloc(sizeof(*dev),GFP_KERNEL); if (NULL == dev) return -ENOMEM; memset(dev,0,sizeof(*dev)); /* pci init */ dev->pci = pci_dev; if (pci_enable_device(pci_dev)) { err = -EIO; goto fail1; } sprintf(dev->name,"saa%x[%d]",pci_dev->device,saa7134_devcount); /* pci quirks */ if (pci_pci_problems) { if (pci_pci_problems & PCIPCI_TRITON) printk(KERN_INFO "%s: quirk: PCIPCI_TRITON\n", dev->name); if (pci_pci_problems & PCIPCI_NATOMA) printk(KERN_INFO "%s: quirk: PCIPCI_NATOMA\n", dev->name); if (pci_pci_problems & PCIPCI_VIAETBF) printk(KERN_INFO "%s: quirk: PCIPCI_VIAETBF\n", dev->name); if (pci_pci_problems & PCIPCI_VSFX) printk(KERN_INFO "%s: quirk: PCIPCI_VSFX\n",dev->name);#ifdef PCIPCI_ALIMAGIK if (pci_pci_problems & PCIPCI_ALIMAGIK) { printk(KERN_INFO "%s: quirk: PCIPCI_ALIMAGIK -- latency fixup\n", dev->name); latency = 0x0A; }#endif } if (UNSET != latency) { printk(KERN_INFO "%s: setting pci latency timer to %d\n", dev->name,latency); pci_write_config_byte(pci_dev, PCI_LATENCY_TIMER, latency); } /* print pci info */ pci_read_config_byte(pci_dev, PCI_CLASS_REVISION, &dev->pci_rev); pci_read_config_byte(pci_dev, PCI_LATENCY_TIMER, &dev->pci_lat); printk(KERN_INFO "%s: found at %s, rev: %d, irq: %d, " "latency: %d, mmio: 0x%lx\n", dev->name, pci_name(pci_dev), dev->pci_rev, pci_dev->irq, dev->pci_lat,pci_resource_start(pci_dev,0)); pci_set_master(pci_dev); if (!pci_dma_supported(pci_dev,0xffffffff)) { printk("%s: Oops: no 32bit PCI DMA ???\n",dev->name); err = -EIO; goto fail1; } /* board config */ dev->board = pci_id->driver_data; if (card[saa7134_devcount] >= 0 && card[saa7134_devcount] < saa7134_bcount) dev->board = card[saa7134_devcount]; if (SAA7134_BOARD_NOAUTO == dev->board) { must_configure_manually(); dev->board = SAA7134_BOARD_UNKNOWN; } dev->tuner_type = saa7134_boards[dev->board].tuner_type; if (UNSET != tuner[saa7134_devcount]) dev->tuner_type = tuner[saa7134_devcount]; printk(KERN_INFO "%s: subsystem: %04x:%04x, board: %s [card=%d,%s]\n", dev->name,pci_dev->subsystem_vendor, pci_dev->subsystem_device,saa7134_boards[dev->board].name, dev->board, card[saa7134_devcount] == dev->board ? "insmod option" : "autodetected"); /* get mmio */ if (!request_mem_region(pci_resource_start(pci_dev,0), pci_resource_len(pci_dev,0), dev->name)) { err = -EBUSY; printk(KERN_ERR "%s: can't get MMIO memory @ 0x%lx\n", dev->name,pci_resource_start(pci_dev,0)); goto fail1; } dev->lmmio = ioremap(pci_resource_start(pci_dev,0), 0x1000); dev->bmmio = (__u8*)dev->lmmio; if (NULL == dev->lmmio) { err = -EIO; printk(KERN_ERR "%s: can't ioremap() MMIO memory\n", dev->name); goto fail2; } /* initialize hardware #1 */ saa7134_board_init(dev); saa7134_hwinit1(dev); /* get irq */ err = request_irq(pci_dev->irq, saa7134_irq, SA_SHIRQ | SA_INTERRUPT, dev->name, dev); if (err < 0) { printk(KERN_ERR "%s: can't get IRQ %d\n", dev->name,pci_dev->irq); goto fail3; } /* wait a bit, register i2c bus */ set_current_state(TASK_INTERRUPTIBLE); schedule_timeout(HZ/10); saa7134_i2c_register(dev); /* initialize hardware #2 */ saa7134_hwinit2(dev); /* load i2c helpers */ if (TUNER_ABSENT != dev->tuner_type) request_module("tuner"); if (saa7134_boards[dev->board].need_tda9887) request_module("tda9887"); if (card_has_ts(dev)) request_module("saa6752hs");#ifdef VIDIOC_G_PRIORITY v4l2_prio_init(&dev->prio);#endif /* register v4l devices */ dev->video_dev = vdev_init(dev,&saa7134_video_template,"video"); err = video_register_device(dev->video_dev,VFL_TYPE_GRABBER, video_nr[saa7134_devcount]); if (err < 0) { printk(KERN_INFO "%s: can't register video device\n", dev->name); goto fail4; } printk(KERN_INFO "%s: registered device video%d [v4l2]\n", dev->name,dev->video_dev->minor & 0x1f); if (card_has_ts(dev)) { dev->ts_dev = vdev_init(dev,&saa7134_ts_template,"ts"); err = video_register_device(dev->ts_dev,VFL_TYPE_GRABBER, ts_nr[saa7134_devcount]); if (err < 0) { printk(KERN_INFO "%s: can't register video device\n", dev->name); goto fail4; } printk(KERN_INFO "%s: registered device video%d [ts]\n", dev->name,dev->ts_dev->minor & 0x1f); } dev->vbi_dev = vdev_init(dev,&saa7134_vbi_template,"vbi"); err = video_register_device(dev->vbi_dev,VFL_TYPE_VBI, vbi_nr[saa7134_devcount]); if (err < 0) goto fail4; printk(KERN_INFO "%s: registered device vbi%d\n", dev->name,dev->vbi_dev->minor & 0x1f); if (card_has_radio(dev)) { dev->radio_dev = vdev_init(dev,&saa7134_radio_template,"radio"); err = video_register_device(dev->radio_dev,VFL_TYPE_RADIO, radio_nr[saa7134_devcount]); if (err < 0) goto fail4; printk(KERN_INFO "%s: registered device radio%d\n", dev->name,dev->radio_dev->minor & 0x1f); } /* register oss devices */ switch (dev->pci->device) { case PCI_DEVICE_ID_PHILIPS_SAA7134: case PCI_DEVICE_ID_PHILIPS_SAA7133: case PCI_DEVICE_ID_PHILIPS_SAA7135: if (oss) { err = dev->oss.minor_dsp = register_sound_dsp(&saa7134_dsp_fops, dsp_nr[saa7134_devcount]); if (err < 0) { goto fail4; } printk(KERN_INFO "%s: registered device dsp%d\n", dev->name,dev->oss.minor_dsp >> 4); err = dev->oss.minor_mixer = register_sound_mixer(&saa7134_mixer_fops, mixer_nr[saa7134_devcount]); if (err < 0) goto fail5; printk(KERN_INFO "%s: registered device mixer%d\n", dev->name,dev->oss.minor_mixer >> 4); } break; } /* everything worked */ list_add_tail(&dev->devlist,&saa7134_devlist); pci_set_drvdata(pci_dev,dev); saa7134_devcount++; return 0; fail5: switch (dev->pci->device) { case PCI_DEVICE_ID_PHILIPS_SAA7134: case PCI_DEVICE_ID_PHILIPS_SAA7133: case PCI_DEVICE_ID_PHILIPS_SAA7135: if (oss) unregister_sound_dsp(dev->oss.minor_dsp); break; } fail4: saa7134_unregister_video(dev); saa7134_i2c_unregister(dev); free_irq(pci_dev->irq, dev); fail3: saa7134_hwfini(dev); iounmap(dev->lmmio); fail2: release_mem_region(pci_resource_start(pci_dev,0), pci_resource_len(pci_dev,0)); fail1: kfree(dev); return err;}static void __devexit saa7134_finidev(struct pci_dev *pci_dev){ struct saa7134_dev *dev = pci_get_drvdata(pci_dev); /* debugging ... */ if (irq_debug) { u32 report = saa_readl(SAA7134_IRQ_REPORT); u32 status = saa_readl(SAA7134_IRQ_STATUS); print_irqstatus(dev,42,report,status); } /* disable peripheral devices */ saa_writeb(SAA7134_SPECIAL_MODE,0); /* shutdown hardware */ saa_writel(SAA7134_IRQ1,0); saa_writel(SAA7134_IRQ2,0); saa_writel(SAA7134_MAIN_CTRL,0); /* shutdown subsystems */ saa7134_hwfini(dev); /* unregister */ saa7134_i2c_unregister(dev); switch (dev->pci->device) { case PCI_DEVICE_ID_PHILIPS_SAA7134: case PCI_DEVICE_ID_PHILIPS_SAA7133: case PCI_DEVICE_ID_PHILIPS_SAA7135: if (oss) { unregister_sound_mixer(dev->oss.minor_mixer); unregister_sound_dsp(dev->oss.minor_dsp); } break; } saa7134_unregister_video(dev); /* release ressources */ free_irq(pci_dev->irq, dev); iounmap(dev->lmmio); release_mem_region(pci_resource_start(pci_dev,0), pci_resource_len(pci_dev,0));#if 0 /* causes some trouble when reinserting the driver ... */ pci_disable_device(pci_dev);#endif pci_set_drvdata(pci_dev, NULL); /* free memory */ list_del(&dev->devlist); saa7134_devcount--; kfree(dev);}static struct pci_driver saa7134_pci_driver = { .name = "saa7134", .id_table = saa7134_pci_tbl, .probe = saa7134_initdev, .remove = saa7134_finidev,};static int saa7134_init(void){ INIT_LIST_HEAD(&saa7134_devlist); printk(KERN_INFO "saa7130/34: v4l2 driver version %d.%d.%d loaded\n", (SAA7134_VERSION_CODE >> 16) & 0xff, (SAA7134_VERSION_CODE >> 8) & 0xff, SAA7134_VERSION_CODE & 0xff);#ifdef SNAPSHOT printk(KERN_INFO "saa7130/34: snapshot date %04d-%02d-%02d\n", SNAPSHOT/10000, (SNAPSHOT/100)%100, SNAPSHOT%100);#endif return pci_module_init(&saa7134_pci_driver);}static void saa7134_fini(void){ pci_unregister_driver(&saa7134_pci_driver);}module_init(saa7134_init);module_exit(saa7134_fini);/* ----------------------------------------------------------- *//* * Local variables: * c-basic-offset: 8 * End: */
⌨️ 快捷键说明
复制代码
Ctrl + C
搜索代码
Ctrl + F
全屏模式
F11
切换主题
Ctrl + Shift + D
显示快捷键
?
增大字号
Ctrl + =
减小字号
Ctrl + -