📄 bt878.c
字号:
/* * bt878.c: part of the driver for the Pinnacle PCTV Sat DVB PCI card * * Copyright (C) 2002 Peter Hettkamp <peter.hettkamp@htp-tel.de> * * large parts based on the bttv driver * Copyright (C) 1996,97,98 Ralph Metzler (rjkm@metzlerbros.de) * & Marcus Metzler (mocm@metzlerbros.de) * (c) 1999,2000 Gerd Knorr <kraxel@goldbach.in-berlin.de> * * This program is free software; you can redistribute it and/or * modify it under the terms of the GNU General Public License * as published by the Free Software Foundation; either version 2 * of the License, or (at your option) any later version. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. * Or, point your browser to http://www.gnu.org/copyleft/gpl.html * */#include <linux/module.h>#include <linux/moduleparam.h>#include <linux/kernel.h>#include <linux/pci.h>#include <asm/io.h>#include <linux/ioport.h>#include <asm/pgtable.h>#include <asm/page.h>#include <linux/types.h>#include <linux/interrupt.h>#include <linux/kmod.h>#include <linux/vmalloc.h>#include <linux/init.h>#include "dmxdev.h"#include "dvbdev.h"#include "bt878.h"#include "dst_priv.h"/**************************************//* Miscellaneous utility definitions *//**************************************/static unsigned int bt878_verbose = 1;static unsigned int bt878_debug;module_param_named(verbose, bt878_verbose, int, 0444);MODULE_PARM_DESC(verbose, "verbose startup messages, default is 1 (yes)");module_param_named(debug, bt878_debug, int, 0644);MODULE_PARM_DESC(debug, "Turn on/off debugging, default is 0 (off).");int bt878_num;struct bt878 bt878[BT878_MAX];EXPORT_SYMBOL(bt878_debug);EXPORT_SYMBOL(bt878_verbose);EXPORT_SYMBOL(bt878_num);EXPORT_SYMBOL(bt878);#define btwrite(dat,adr) bmtwrite((dat), (bt->bt878_mem+(adr)))#define btread(adr) bmtread(bt->bt878_mem+(adr))#define btand(dat,adr) btwrite((dat) & btread(adr), adr)#define btor(dat,adr) btwrite((dat) | btread(adr), adr)#define btaor(dat,mask,adr) btwrite((dat) | ((mask) & btread(adr)), adr)#if defined(dprintk)#undef dprintk#endif#define dprintk if(bt878_debug) printkstatic void bt878_mem_free(struct bt878 *bt){ if (bt->buf_cpu) { pci_free_consistent(bt->dev, bt->buf_size, bt->buf_cpu, bt->buf_dma); bt->buf_cpu = NULL; } if (bt->risc_cpu) { pci_free_consistent(bt->dev, bt->risc_size, bt->risc_cpu, bt->risc_dma); bt->risc_cpu = NULL; }}static int bt878_mem_alloc(struct bt878 *bt){ if (!bt->buf_cpu) { bt->buf_size = 128 * 1024; bt->buf_cpu = pci_alloc_consistent(bt->dev, bt->buf_size, &bt->buf_dma); if (!bt->buf_cpu) return -ENOMEM; memset(bt->buf_cpu, 0, bt->buf_size); } if (!bt->risc_cpu) { bt->risc_size = PAGE_SIZE; bt->risc_cpu = pci_alloc_consistent(bt->dev, bt->risc_size, &bt->risc_dma); if (!bt->risc_cpu) { bt878_mem_free(bt); return -ENOMEM; } memset(bt->risc_cpu, 0, bt->risc_size); } return 0;}/* RISC instructions */#define RISC_WRITE (0x01 << 28)#define RISC_JUMP (0x07 << 28)#define RISC_SYNC (0x08 << 28)/* RISC bits */#define RISC_WR_SOL (1 << 27)#define RISC_WR_EOL (1 << 26)#define RISC_IRQ (1 << 24)#define RISC_STATUS(status) ((((~status) & 0x0F) << 20) | ((status & 0x0F) << 16))#define RISC_SYNC_RESYNC (1 << 15)#define RISC_SYNC_FM1 0x06#define RISC_SYNC_VRO 0x0C#define RISC_FLUSH() bt->risc_pos = 0#define RISC_INSTR(instr) bt->risc_cpu[bt->risc_pos++] = cpu_to_le32(instr)static int bt878_make_risc(struct bt878 *bt){ bt->block_bytes = bt->buf_size >> 4; bt->block_count = 1 << 4; bt->line_bytes = bt->block_bytes; bt->line_count = bt->block_count; while (bt->line_bytes > 4095) { bt->line_bytes >>= 1; bt->line_count <<= 1; } if (bt->line_count > 255) { printk("bt878: buffer size error!\n"); return -EINVAL; } return 0;}static void bt878_risc_program(struct bt878 *bt, u32 op_sync_orin){ u32 buf_pos = 0; u32 line; RISC_FLUSH(); RISC_INSTR(RISC_SYNC | RISC_SYNC_FM1 | op_sync_orin); RISC_INSTR(0); dprintk("bt878: risc len lines %u, bytes per line %u\n", bt->line_count, bt->line_bytes); for (line = 0; line < bt->line_count; line++) { // At the beginning of every block we issue an IRQ with previous (finished) block number set if (!(buf_pos % bt->block_bytes)) RISC_INSTR(RISC_WRITE | RISC_WR_SOL | RISC_WR_EOL | RISC_IRQ | RISC_STATUS(((buf_pos / bt->block_bytes) + (bt->block_count - 1)) % bt->block_count) | bt-> line_bytes); else RISC_INSTR(RISC_WRITE | RISC_WR_SOL | RISC_WR_EOL | bt->line_bytes); RISC_INSTR(bt->buf_dma + buf_pos); buf_pos += bt->line_bytes; } RISC_INSTR(RISC_SYNC | op_sync_orin | RISC_SYNC_VRO); RISC_INSTR(0); RISC_INSTR(RISC_JUMP); RISC_INSTR(bt->risc_dma); btwrite((bt->line_count << 16) | bt->line_bytes, BT878_APACK_LEN);}/*****************************//* Start/Stop grabbing funcs *//*****************************/void bt878_start(struct bt878 *bt, u32 controlreg, u32 op_sync_orin, u32 irq_err_ignore){ u32 int_mask; dprintk("bt878 debug: bt878_start (ctl=%8.8x)\n", controlreg); /* complete the writing of the risc dma program now we have * the card specifics */ bt878_risc_program(bt, op_sync_orin); controlreg &= ~0x1f; controlreg |= 0x1b; btwrite(bt->risc_dma, BT878_ARISC_START); /* original int mask had : * 6 2 8 4 0 * 1111 1111 1000 0000 0000 * SCERR|OCERR|PABORT|RIPERR|FDSR|FTRGT|FBUS|RISCI * Hacked for DST to: * SCERR | OCERR | FDSR | FTRGT | FBUS | RISCI */ int_mask = BT878_ASCERR | BT878_AOCERR | BT878_APABORT | BT878_ARIPERR | BT878_APPERR | BT878_AFDSR | BT878_AFTRGT | BT878_AFBUS | BT878_ARISCI; /* ignore pesky bits */ int_mask &= ~irq_err_ignore; btwrite(int_mask, BT878_AINT_MASK); btwrite(controlreg, BT878_AGPIO_DMA_CTL);}void bt878_stop(struct bt878 *bt){ u32 stat; int i = 0; dprintk("bt878 debug: bt878_stop\n"); btwrite(0, BT878_AINT_MASK); btand(~0x13, BT878_AGPIO_DMA_CTL); do { stat = btread(BT878_AINT_STAT); if (!(stat & BT878_ARISC_EN)) break; i++; } while (i < 500); dprintk("bt878(%d) debug: bt878_stop, i=%d, stat=0x%8.8x\n", bt->nr, i, stat);}EXPORT_SYMBOL(bt878_start);EXPORT_SYMBOL(bt878_stop);/*****************************//* Interrupt service routine *//*****************************/static irqreturn_t bt878_irq(int irq, void *dev_id, struct pt_regs *regs){ u32 stat, astat, mask; int count; struct bt878 *bt; bt = (struct bt878 *) dev_id; count = 0; while (1) { stat = btread(BT878_AINT_STAT); mask = btread(BT878_AINT_MASK); if (!(astat = (stat & mask))) return IRQ_NONE; /* this interrupt is not for me *//* dprintk("bt878(%d) debug: irq count %d, stat 0x%8.8x, mask 0x%8.8x\n",bt->nr,count,stat,mask); */ btwrite(astat, BT878_AINT_STAT); /* try to clear interupt condition */ if (astat & (BT878_ASCERR | BT878_AOCERR)) { if (bt878_verbose) { printk("bt878(%d): irq%s%s risc_pc=%08x\n", bt->nr, (astat & BT878_ASCERR) ? " SCERR" : "", (astat & BT878_AOCERR) ? " OCERR" : "", btread(BT878_ARISC_PC)); } } if (astat & (BT878_APABORT | BT878_ARIPERR | BT878_APPERR)) { if (bt878_verbose) { printk ("bt878(%d): irq%s%s%s risc_pc=%08x\n", bt->nr, (astat & BT878_APABORT) ? " PABORT" : "", (astat & BT878_ARIPERR) ? " RIPERR" : "", (astat & BT878_APPERR) ? " PPERR" : "", btread(BT878_ARISC_PC)); } } if (astat & (BT878_AFDSR | BT878_AFTRGT | BT878_AFBUS)) { if (bt878_verbose) { printk ("bt878(%d): irq%s%s%s risc_pc=%08x\n", bt->nr, (astat & BT878_AFDSR) ? " FDSR" : "", (astat & BT878_AFTRGT) ? " FTRGT" : "", (astat & BT878_AFBUS) ? " FBUS" : "", btread(BT878_ARISC_PC)); } } if (astat & BT878_ARISCI) { bt->finished_block = (stat & BT878_ARISCS) >> 28; tasklet_schedule(&bt->tasklet); break; } count++; if (count > 20) { btwrite(0, BT878_AINT_MASK); printk(KERN_ERR "bt878(%d): IRQ lockup, cleared int mask\n", bt->nr); break; } } return IRQ_HANDLED;}intbt878_device_control(struct bt878 *bt, unsigned int cmd, union dst_gpio_packet *mp){ int retval; retval = 0; if (down_interruptible (&bt->gpio_lock)) return -ERESTARTSYS; /* special gpio signal */ switch (cmd) { case DST_IG_ENABLE: // dprintk("dvb_bt8xx: dst enable mask 0x%02x enb 0x%02x \n", mp->dstg.enb.mask, mp->dstg.enb.enable); retval = bttv_gpio_enable(bt->bttv_nr, mp->enb.mask, mp->enb.enable); break; case DST_IG_WRITE: // dprintk("dvb_bt8xx: dst write gpio mask 0x%02x out 0x%02x\n", mp->dstg.outp.mask, mp->dstg.outp.highvals); retval = bttv_write_gpio(bt->bttv_nr, mp->outp.mask, mp->outp.highvals); break; case DST_IG_READ: /* read */ retval = bttv_read_gpio(bt->bttv_nr, &mp->rd.value); // dprintk("dvb_bt8xx: dst read gpio 0x%02x\n", (unsigned)mp->dstg.rd.value); break; case DST_IG_TS: /* Set packet size */ bt->TS_Size = mp->psize; break; default: retval = -EINVAL; break; } up(&bt->gpio_lock); return retval;}EXPORT_SYMBOL(bt878_device_control);/***********************//* PCI device handling *//***********************/static int __devinit bt878_probe(struct pci_dev *dev, const struct pci_device_id *pci_id){ int result; unsigned char lat; struct bt878 *bt;#if defined(__powerpc__) unsigned int cmd;#endif printk(KERN_INFO "bt878: Bt878 AUDIO function found (%d).\n", bt878_num); if (pci_enable_device(dev)) return -EIO; bt = &bt878[bt878_num]; bt->dev = dev; bt->nr = bt878_num; bt->shutdown = 0; bt->id = dev->device; bt->irq = dev->irq; bt->bt878_adr = pci_resource_start(dev, 0); if (!request_mem_region(pci_resource_start(dev, 0), pci_resource_len(dev, 0), "bt878")) { result = -EBUSY; goto fail0; } pci_read_config_byte(dev, PCI_CLASS_REVISION, &bt->revision); pci_read_config_byte(dev, PCI_LATENCY_TIMER, &lat); printk(KERN_INFO "bt878(%d): Bt%x (rev %d) at %02x:%02x.%x, ", bt878_num, bt->id, bt->revision, dev->bus->number, PCI_SLOT(dev->devfn), PCI_FUNC(dev->devfn)); printk("irq: %d, latency: %d, memory: 0x%lx\n", bt->irq, lat, bt->bt878_adr);#if defined(__powerpc__) /* on OpenFirmware machines (PowerMac at least), PCI memory cycle */ /* response on cards with no firmware is not enabled by OF */ pci_read_config_dword(dev, PCI_COMMAND, &cmd); cmd = (cmd | PCI_COMMAND_MEMORY); pci_write_config_dword(dev, PCI_COMMAND, cmd);#endif#ifdef __sparc__ bt->bt878_mem = (unsigned char *) bt->bt878_adr;#else bt->bt878_mem = ioremap(bt->bt878_adr, 0x1000);#endif /* clear interrupt mask */ btwrite(0, BT848_INT_MASK); result = request_irq(bt->irq, bt878_irq, SA_SHIRQ | SA_INTERRUPT, "bt878", (void *) bt); if (result == -EINVAL) { printk(KERN_ERR "bt878(%d): Bad irq number or handler\n", bt878_num); goto fail1; } if (result == -EBUSY) { printk(KERN_ERR "bt878(%d): IRQ %d busy, change your PnP config in BIOS\n", bt878_num, bt->irq); goto fail1; } if (result < 0) goto fail1; pci_set_master(dev); pci_set_drvdata(dev, bt);/* if(init_bt878(btv) < 0) { bt878_remove(dev); return -EIO; }*/ if ((result = bt878_mem_alloc(bt))) { printk("bt878: failed to allocate memory!\n"); goto fail2; } bt878_make_risc(bt); btwrite(0, BT878_AINT_MASK); bt878_num++; return 0; fail2: free_irq(bt->irq, bt); fail1: release_mem_region(pci_resource_start(bt->dev, 0), pci_resource_len(bt->dev, 0)); fail0: pci_disable_device(dev); return result;}static void __devexit bt878_remove(struct pci_dev *pci_dev){ u8 command; struct bt878 *bt = pci_get_drvdata(pci_dev); if (bt878_verbose) printk("bt878(%d): unloading\n", bt->nr); /* turn off all capturing, DMA and IRQs */ btand(~0x13, BT878_AGPIO_DMA_CTL); /* first disable interrupts before unmapping the memory! */ btwrite(0, BT878_AINT_MASK); btwrite(~0U, BT878_AINT_STAT); /* disable PCI bus-mastering */ pci_read_config_byte(bt->dev, PCI_COMMAND, &command); /* Should this be &=~ ?? */ command &= ~PCI_COMMAND_MASTER; pci_write_config_byte(bt->dev, PCI_COMMAND, command); free_irq(bt->irq, bt); printk(KERN_DEBUG "bt878_mem: 0x%p.\n", bt->bt878_mem); if (bt->bt878_mem) iounmap(bt->bt878_mem); release_mem_region(pci_resource_start(bt->dev, 0), pci_resource_len(bt->dev, 0)); /* wake up any waiting processes because shutdown flag is set, no new processes (in this queue) are expected */ bt->shutdown = 1; bt878_mem_free(bt); pci_set_drvdata(pci_dev, NULL); pci_disable_device(pci_dev); return;}static struct pci_device_id bt878_pci_tbl[] __devinitdata = { {PCI_VENDOR_ID_BROOKTREE, PCI_DEVICE_ID_BROOKTREE_878, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, {0,}};MODULE_DEVICE_TABLE(pci, bt878_pci_tbl);static struct pci_driver bt878_pci_driver = { .name = "bt878", .id_table = bt878_pci_tbl, .probe = bt878_probe, .remove = bt878_remove,};static int bt878_pci_driver_registered = 0;/*******************************//* Module management functions *//*******************************/static int bt878_init_module(void){ bt878_num = 0; bt878_pci_driver_registered = 0; printk(KERN_INFO "bt878: AUDIO driver version %d.%d.%d loaded\n", (BT878_VERSION_CODE >> 16) & 0xff, (BT878_VERSION_CODE >> 8) & 0xff, BT878_VERSION_CODE & 0xff);/* bt878_check_chipset();*/ /* later we register inside of bt878_find_audio_dma() * because we may want to ignore certain cards */ bt878_pci_driver_registered = 1; return pci_register_driver(&bt878_pci_driver);}static void bt878_cleanup_module(void){ if (bt878_pci_driver_registered) { bt878_pci_driver_registered = 0; pci_unregister_driver(&bt878_pci_driver); } return;}module_init(bt878_init_module);module_exit(bt878_cleanup_module);//MODULE_AUTHOR("XXX");MODULE_LICENSE("GPL");/* * Local variables: * c-basic-offset: 8 * End: */
⌨️ 快捷键说明
复制代码
Ctrl + C
搜索代码
Ctrl + F
全屏模式
F11
切换主题
Ctrl + Shift + D
显示快捷键
?
增大字号
Ctrl + =
减小字号
Ctrl + -