⭐ 欢迎来到虫虫下载站! | 📦 资源下载 📁 资源专辑 ℹ️ 关于我们
⭐ 虫虫下载站

📄 bt878.c

📁 linux-2.6.15.6
💻 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 + -