7d12e780e0
Maintain a per-CPU global "struct pt_regs *" variable which can be used instead of passing regs around manually through all ~1800 interrupt handlers in the Linux kernel. The regs pointer is used in few places, but it potentially costs both stack space and code to pass it around. On the FRV arch, removing the regs parameter from all the genirq function results in a 20% speed up of the IRQ exit path (ie: from leaving timer_interrupt() to leaving do_IRQ()). Where appropriate, an arch may override the generic storage facility and do something different with the variable. On FRV, for instance, the address is maintained in GR28 at all times inside the kernel as part of general exception handling. Having looked over the code, it appears that the parameter may be handed down through up to twenty or so layers of functions. Consider a USB character device attached to a USB hub, attached to a USB controller that posts its interrupts through a cascaded auxiliary interrupt controller. A character device driver may want to pass regs to the sysrq handler through the input layer which adds another few layers of parameter passing. I've build this code with allyesconfig for x86_64 and i386. I've runtested the main part of the code on FRV and i386, though I can't test most of the drivers. I've also done partial conversion for powerpc and MIPS - these at least compile with minimal configurations. This will affect all archs. Mostly the changes should be relatively easy. Take do_IRQ(), store the regs pointer at the beginning, saving the old one: struct pt_regs *old_regs = set_irq_regs(regs); And put the old one back at the end: set_irq_regs(old_regs); Don't pass regs through to generic_handle_irq() or __do_IRQ(). In timer_interrupt(), this sort of change will be necessary: - update_process_times(user_mode(regs)); - profile_tick(CPU_PROFILING, regs); + update_process_times(user_mode(get_irq_regs())); + profile_tick(CPU_PROFILING); I'd like to move update_process_times()'s use of get_irq_regs() into itself, except that i386, alone of the archs, uses something other than user_mode(). Some notes on the interrupt handling in the drivers: (*) input_dev() is now gone entirely. The regs pointer is no longer stored in the input_dev struct. (*) finish_unlinks() in drivers/usb/host/ohci-q.c needs checking. It does something different depending on whether it's been supplied with a regs pointer or not. (*) Various IRQ handler function pointers have been moved to type irq_handler_t. Signed-Off-By: David Howells <dhowells@redhat.com> (cherry picked from 1b16e7ac850969f38b375e511e3fa2f474a33867 commit)
636 lines
16 KiB
C
636 lines
16 KiB
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_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) printk
|
|
|
|
static 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)
|
|
{
|
|
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;
|
|
}
|
|
|
|
int
|
|
bt878_device_control(struct bt878 *bt, unsigned int cmd, union dst_gpio_packet *mp)
|
|
{
|
|
int retval;
|
|
|
|
retval = 0;
|
|
if (mutex_lock_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;
|
|
}
|
|
mutex_unlock(&bt->gpio_lock);
|
|
return retval;
|
|
}
|
|
|
|
EXPORT_SYMBOL(bt878_device_control);
|
|
|
|
|
|
static struct cards card_list[] __devinitdata = {
|
|
|
|
{ 0x01010071, BTTV_BOARD_NEBULA_DIGITV, "Nebula Electronics DigiTV" },
|
|
{ 0x07611461, BTTV_BOARD_AVDVBT_761, "AverMedia AverTV DVB-T 761" },
|
|
{ 0x001c11bd, BTTV_BOARD_PINNACLESAT, "Pinnacle PCTV Sat" },
|
|
{ 0x002611bd, BTTV_BOARD_TWINHAN_DST, "Pinnacle PCTV SAT CI" },
|
|
{ 0x00011822, BTTV_BOARD_TWINHAN_DST, "Twinhan VisionPlus DVB" },
|
|
{ 0xfc00270f, BTTV_BOARD_TWINHAN_DST, "ChainTech digitop DST-1000 DVB-S" },
|
|
{ 0x07711461, BTTV_BOARD_AVDVBT_771, "AVermedia AverTV DVB-T 771" },
|
|
{ 0xdb1018ac, BTTV_BOARD_DVICO_DVBT_LITE, "DViCO FusionHDTV DVB-T Lite" },
|
|
{ 0xd50018ac, BTTV_BOARD_DVICO_FUSIONHDTV_5_LITE, "DViCO FusionHDTV 5 Lite" },
|
|
{ 0x20007063, BTTV_BOARD_PC_HDTV, "pcHDTV HD-2000 TV" },
|
|
{ 0x00261822, BTTV_BOARD_TWINHAN_DST, "DNTV Live! Mini" },
|
|
|
|
{ 0, -1, NULL }
|
|
};
|
|
|
|
|
|
/***********************/
|
|
/* PCI device handling */
|
|
/***********************/
|
|
|
|
static int __devinit bt878_probe(struct pci_dev *dev,
|
|
const struct pci_device_id *pci_id)
|
|
{
|
|
int result = 0, has_dvb = 0, i;
|
|
unsigned char lat;
|
|
struct bt878 *bt;
|
|
#if defined(__powerpc__)
|
|
unsigned int cmd;
|
|
#endif
|
|
unsigned int cardid;
|
|
unsigned short id;
|
|
struct cards *dvb_cards;
|
|
|
|
printk(KERN_INFO "bt878: Bt878 AUDIO function found (%d).\n",
|
|
bt878_num);
|
|
if (bt878_num >= BT878_MAX) {
|
|
printk(KERN_ERR "bt878: Too many devices inserted\n");
|
|
result = -ENOMEM;
|
|
goto fail0;
|
|
}
|
|
if (pci_enable_device(dev))
|
|
return -EIO;
|
|
|
|
pci_read_config_word(dev, PCI_SUBSYSTEM_ID, &id);
|
|
cardid = id << 16;
|
|
pci_read_config_word(dev, PCI_SUBSYSTEM_VENDOR_ID, &id);
|
|
cardid |= id;
|
|
|
|
for (i = 0, dvb_cards = card_list; i < ARRAY_SIZE(card_list); i++, dvb_cards++) {
|
|
if (cardid == dvb_cards->pci_id) {
|
|
printk("%s: card id=[0x%x],[ %s ] has DVB functions.\n",
|
|
__func__, cardid, dvb_cards->name);
|
|
has_dvb = 1;
|
|
}
|
|
}
|
|
|
|
if (!has_dvb) {
|
|
printk("%s: card id=[0x%x], Unknown card.\nExiting..\n", __func__, cardid);
|
|
result = -EINVAL;
|
|
|
|
goto fail0;
|
|
}
|
|
|
|
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,
|
|
IRQF_SHARED | IRQF_DISABLED, "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;
|
|
|
|
/*******************************/
|
|
/* 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:
|
|
*/
|