ClabureDB: Classified Bug-Reports Database

   /*
    * hfcmulti.c  low level driver for hfc-4s/hfc-8s/hfc-e1 based cards
    *
    * Author        Andreas Eversberg (jolly@eversberg.eu)
    * ported to mqueue mechanism:
    *                Peter Sprenger (sprengermoving-bytes.de)
    *
    * inspired by existing hfc-pci driver:
    * Copyright 1999  by Werner Cornelius (werner@isdn-development.de)
   * Copyright 2008  by Karsten Keil (kkeil@suse.de)
   * Copyright 2008  by Andreas Eversberg (jolly@eversberg.eu)
   *
   * 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, 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., 675 Mass Ave, Cambridge, MA 02139, USA.
   *
   *
   * Thanks to Cologne Chip AG for this great controller!
   */
  
  /*
   * module parameters:
   * type:
   *        By default (0), the card is automatically detected.
   *        Or use the following combinations:
   *        Bit 0-7   = 0x00001 = HFC-E1 (1 port)
   * or        Bit 0-7   = 0x00004 = HFC-4S (4 ports)
   * or        Bit 0-7   = 0x00008 = HFC-8S (8 ports)
   *        Bit 8     = 0x00100 = uLaw (instead of aLaw)
   *        Bit 9     = 0x00200 = Disable DTMF detect on all B-channels via hardware
   *        Bit 10    = spare
   *        Bit 11    = 0x00800 = Force PCM bus into slave mode. (otherwhise auto)
   * or   Bit 12    = 0x01000 = Force PCM bus into master mode. (otherwhise auto)
   *        Bit 13          = spare
   *        Bit 14    = 0x04000 = Use external ram (128K)
   *        Bit 15    = 0x08000 = Use external ram (512K)
   *        Bit 16    = 0x10000 = Use 64 timeslots instead of 32
   * or        Bit 17    = 0x20000 = Use 128 timeslots instead of anything else
   *        Bit 18    = spare
   *        Bit 19    = 0x80000 = Send the Watchdog a Signal (Dual E1 with Watchdog)
   * (all other bits are reserved and shall be 0)
   *        example: 0x20204 one HFC-4S with dtmf detection and 128 timeslots on PCM
   *                 bus (PCM master)
   *
   * port: (optional or required for all ports on all installed cards)
   *        HFC-4S/HFC-8S only bits:
   *        Bit 0          = 0x001 = Use master clock for this S/T interface
   *                            (ony once per chip).
   *        Bit 1     = 0x002 = transmitter line setup (non capacitive mode)
   *                            Don't use this unless you know what you are doing!
   *        Bit 2     = 0x004 = Disable E-channel. (No E-channel processing)
   *        example: 0x0001,0x0000,0x0000,0x0000 one HFC-4S with master clock
   *                 received from port 1
   *
   *        HFC-E1 only bits:
   *        Bit 0     = 0x0001 = interface: 0=copper, 1=optical
   *        Bit 1     = 0x0002 = reserved (later for 32 B-channels transparent mode)
   *        Bit 2     = 0x0004 = Report LOS
   *        Bit 3     = 0x0008 = Report AIS
   *        Bit 4     = 0x0010 = Report SLIP
   *        Bit 5     = 0x0020 = Report RDI
   *        Bit 8     = 0x0100 = Turn off CRC-4 Multiframe Mode, use double frame
   *                             mode instead.
   *        Bit 9          = 0x0200 = Force get clock from interface, even in NT mode.
   * or        Bit 10          = 0x0400 = Force put clock to interface, even in TE mode.
   *        Bit 11    = 0x0800 = Use direct RX clock for PCM sync rather than PLL.
   *                             (E1 only)
   *        Bit 12-13 = 0xX000 = elastic jitter buffer (1-3), Set both bits to 0
   *                             for default.
   * (all other bits are reserved and shall be 0)
   *
   * debug:
   *        NOTE: only one debug value must be given for all cards
   *        enable debugging (see hfc_multi.h for debug options)
   *
   * poll:
   *        NOTE: only one poll value must be given for all cards
   *        Give the number of samples for each fifo process.
   *        By default 128 is used. Decrease to reduce delay, increase to
   *        reduce cpu load. If unsure, don't mess with it!
   *        Valid is 8, 16, 32, 64, 128, 256.
   *
   * pcm:
   *        NOTE: only one pcm value must be given for every card.
   *        The PCM bus id tells the mISDNdsp module about the connected PCM bus.
   *        By default (0), the PCM bus id is 100 for the card that is PCM master.
   *        If multiple cards are PCM master (because they are not interconnected),
   *        each card with PCM master will have increasing PCM id.
   *        All PCM busses with the same ID are expected to be connected and have
  *        common time slots slots.
  *        Only one chip of the PCM bus must be master, the others slave.
  *        -1 means no support of PCM bus not even.
  *        Omit this value, if all cards are interconnected or none is connected.
  *        If unsure, don't give this parameter.
  *
  * dslot:
  *        NOTE: only one poll value must be given for every card.
  *        Also this value must be given for non-E1 cards. If omitted, the E1
  *        card has D-channel on time slot 16, which is default.
  *        If 1..15 or 17..31, an alternate time slot is used for D-channel.
  *        In this case, the application must be able to handle this.
  *        If -1 is given, the D-channel is disabled and all 31 slots can be used
  *        for B-channel. (only for specific applications)
  *        If you don't know how to use it, you don't need it!
  *
  * iomode:
  *        NOTE: only one mode value must be given for every card.
  *        -> See hfc_multi.h for HFC_IO_MODE_* values
  *        By default, the IO mode is pci memory IO (MEMIO).
  *        Some cards requre specific IO mode, so it cannot be changed.
  *        It may be usefull to set IO mode to register io (REGIO) to solve
  *        PCI bridge problems.
  *        If unsure, don't give this parameter.
  *
  * clockdelay_nt:
  *        NOTE: only one clockdelay_nt value must be given once for all cards.
  *        Give the value of the clock control register (A_ST_CLK_DLY)
  *        of the S/T interfaces in NT mode.
  *        This register is needed for the TBR3 certification, so don't change it.
  *
  * clockdelay_te:
  *        NOTE: only one clockdelay_te value must be given once
  *        Give the value of the clock control register (A_ST_CLK_DLY)
  *        of the S/T interfaces in TE mode.
  *        This register is needed for the TBR3 certification, so don't change it.
  */
 
 /*
  * debug register access (never use this, it will flood your system log)
  * #define HFC_REGISTER_DEBUG
  */
 
 static const char *hfcmulti_revision = "2.02";
 
 #include <linux/module.h>
 #include <linux/pci.h>
 #include <linux/delay.h>
 #include <linux/mISDNhw.h>
 #include <linux/mISDNdsp.h>
 
 /*
 #define IRQCOUNT_DEBUG
 #define IRQ_DEBUG
 */
 
 #include "hfc_multi.h"
 #ifdef ECHOPREP
 #include "gaintab.h"
 #endif
 
 #define        MAX_CARDS        8
 #define        MAX_PORTS        (8 * MAX_CARDS)
 
 static LIST_HEAD(HFClist);
 static spinlock_t HFClock; /* global hfc list lock */
 
 static void ph_state_change(struct dchannel *);
 static void (*hfc_interrupt)(void);
 static void (*register_interrupt)(void);
 static int (*unregister_interrupt)(void);
 static int interrupt_registered;
 
 static struct hfc_multi *syncmaster;
 int plxsd_master; /* if we have a master card (yet) */
 static spinlock_t plx_lock; /* may not acquire other lock inside */
 EXPORT_SYMBOL(plx_lock);
 
 #define        TYP_E1                1
 #define        TYP_4S                4
 #define TYP_8S                8
 
 static int poll_timer = 6;        /* default = 128 samples = 16ms */
 /* number of POLL_TIMER interrupts for G2 timeout (ca 1s) */
 static int nt_t1_count[] = { 3840, 1920, 960, 480, 240, 120, 60, 30  };
 #define        CLKDEL_TE        0x0f        /* CLKDEL in TE mode */
 #define        CLKDEL_NT        0x6c        /* CLKDEL in NT mode
                                    (0x60 MUST be included!) */
 static u_char silence =        0xff;        /* silence by LAW */
 
 #define        DIP_4S        0x1                /* DIP Switches for Beronet 1S/2S/4S cards */
 #define        DIP_8S        0x2                /* DIP Switches for Beronet 8S+ cards */
 #define        DIP_E1        0x3                /* DIP Switches for Beronet E1 cards */
 
 /*
  * module stuff
  */
 
 static uint        type[MAX_CARDS];
 static uint        pcm[MAX_CARDS];
 static uint        dslot[MAX_CARDS];
 static uint        iomode[MAX_CARDS];
 static uint        port[MAX_PORTS];
 static uint        debug;
 static uint        poll;
 static uint        timer;
 static uint        clockdelay_te = CLKDEL_TE;
 static uint        clockdelay_nt = CLKDEL_NT;
 
 static int        HFC_cnt, Port_cnt, PCM_cnt = 99;
 
 MODULE_AUTHOR("Andreas Eversberg");
 MODULE_LICENSE("GPL");
 module_param(debug, uint, S_IRUGO | S_IWUSR);
 module_param(poll, uint, S_IRUGO | S_IWUSR);
 module_param(timer, uint, S_IRUGO | S_IWUSR);
 module_param(clockdelay_te, uint, S_IRUGO | S_IWUSR);
 module_param(clockdelay_nt, uint, S_IRUGO | S_IWUSR);
 module_param_array(type, uint, NULL, S_IRUGO | S_IWUSR);
 module_param_array(pcm, uint, NULL, S_IRUGO | S_IWUSR);
 module_param_array(dslot, uint, NULL, S_IRUGO | S_IWUSR);
 module_param_array(iomode, uint, NULL, S_IRUGO | S_IWUSR);
 module_param_array(port, uint, NULL, S_IRUGO | S_IWUSR);
 
 #ifdef HFC_REGISTER_DEBUG
 #define HFC_outb(hc, reg, val) \
         (hc->HFC_outb(hc, reg, val, __func__, __LINE__))
 #define HFC_outb_nodebug(hc, reg, val) \
         (hc->HFC_outb_nodebug(hc, reg, val, __func__, __LINE__))
 #define HFC_inb(hc, reg) \
         (hc->HFC_inb(hc, reg, __func__, __LINE__))
 #define HFC_inb_nodebug(hc, reg) \
         (hc->HFC_inb_nodebug(hc, reg, __func__, __LINE__))
 #define HFC_inw(hc, reg) \
         (hc->HFC_inw(hc, reg, __func__, __LINE__))
 #define HFC_inw_nodebug(hc, reg) \
         (hc->HFC_inw_nodebug(hc, reg, __func__, __LINE__))
 #define HFC_wait(hc) \
         (hc->HFC_wait(hc, __func__, __LINE__))
 #define HFC_wait_nodebug(hc) \
         (hc->HFC_wait_nodebug(hc, __func__, __LINE__))
 #else
 #define HFC_outb(hc, reg, val)                (hc->HFC_outb(hc, reg, val))
 #define HFC_outb_nodebug(hc, reg, val)        (hc->HFC_outb_nodebug(hc, reg, val))
 #define HFC_inb(hc, reg)                (hc->HFC_inb(hc, reg))
 #define HFC_inb_nodebug(hc, reg)        (hc->HFC_inb_nodebug(hc, reg))
 #define HFC_inw(hc, reg)                (hc->HFC_inw(hc, reg))
 #define HFC_inw_nodebug(hc, reg)        (hc->HFC_inw_nodebug(hc, reg))
 #define HFC_wait(hc)                        (hc->HFC_wait(hc))
 #define HFC_wait_nodebug(hc)                (hc->HFC_wait_nodebug(hc))
 #endif
 
 /* HFC_IO_MODE_PCIMEM */
 static void
 #ifdef HFC_REGISTER_DEBUG
 HFC_outb_pcimem(struct hfc_multi *hc, u_char reg, u_char val,
                 const char *function, int line)
 #else
 HFC_outb_pcimem(struct hfc_multi *hc, u_char reg, u_char val)
 #endif
 {
         writeb(val, (hc->pci_membase)+reg);
 }
 static u_char
 #ifdef HFC_REGISTER_DEBUG
 HFC_inb_pcimem(struct hfc_multi *hc, u_char reg, const char *function, int line)
 #else
 HFC_inb_pcimem(struct hfc_multi *hc, u_char reg)
 #endif
 {
         return readb((hc->pci_membase)+reg);
 }
 static u_short
 #ifdef HFC_REGISTER_DEBUG
 HFC_inw_pcimem(struct hfc_multi *hc, u_char reg, const char *function, int line)
 #else
 HFC_inw_pcimem(struct hfc_multi *hc, u_char reg)
 #endif
 {
         return readw((hc->pci_membase)+reg);
 }
 static void
 #ifdef HFC_REGISTER_DEBUG
 HFC_wait_pcimem(struct hfc_multi *hc, const char *function, int line)
 #else
 HFC_wait_pcimem(struct hfc_multi *hc)
 #endif
 {
         while (readb((hc->pci_membase)+R_STATUS) & V_BUSY);
 }
 
 /* HFC_IO_MODE_REGIO */
 static void
 #ifdef HFC_REGISTER_DEBUG
 HFC_outb_regio(struct hfc_multi *hc, u_char reg, u_char val,
         const char *function, int line)
 #else
 HFC_outb_regio(struct hfc_multi *hc, u_char reg, u_char val)
 #endif
 {
         outb(reg, (hc->pci_iobase)+4);
         outb(val, hc->pci_iobase);
 }
 static u_char
 #ifdef HFC_REGISTER_DEBUG
 HFC_inb_regio(struct hfc_multi *hc, u_char reg, const char *function, int line)
 #else
 HFC_inb_regio(struct hfc_multi *hc, u_char reg)
 #endif
 {
         outb(reg, (hc->pci_iobase)+4);
         return inb(hc->pci_iobase);
 }
 static u_short
 #ifdef HFC_REGISTER_DEBUG
 HFC_inw_regio(struct hfc_multi *hc, u_char reg, const char *function, int line)
 #else
 HFC_inw_regio(struct hfc_multi *hc, u_char reg)
 #endif
 {
         outb(reg, (hc->pci_iobase)+4);
         return inw(hc->pci_iobase);
 }
 static void
 #ifdef HFC_REGISTER_DEBUG
 HFC_wait_regio(struct hfc_multi *hc, const char *function, int line)
 #else
 HFC_wait_regio(struct hfc_multi *hc)
 #endif
 {
         outb(R_STATUS, (hc->pci_iobase)+4);
         while (inb(hc->pci_iobase) & V_BUSY);
 }
 
 #ifdef HFC_REGISTER_DEBUG
 static void
 HFC_outb_debug(struct hfc_multi *hc, u_char reg, u_char val,
                 const char *function, int line)
 {
         char regname[256] = "", bits[9] = "xxxxxxxx";
         int i;
 
         i = -1;
         while (hfc_register_names[++i].name) {
                 if (hfc_register_names[i].reg == reg)
                         strcat(regname, hfc_register_names[i].name);
         }
         if (regname[0] == '\0')
                 strcpy(regname, "register");
 
         bits[7] = '0'+(!!(val&1));
         bits[6] = '0'+(!!(val&2));
         bits[5] = '0'+(!!(val&4));
         bits[4] = '0'+(!!(val&8));
         bits[3] = '0'+(!!(val&16));
         bits[2] = '0'+(!!(val&32));
         bits[1] = '0'+(!!(val&64));
         bits[0] = '0'+(!!(val&128));
         printk(KERN_DEBUG
             "HFC_outb(chip %d, %02x=%s, 0x%02x=%s); in %s() line %d\n",
             hc->id, reg, regname, val, bits, function, line);
         HFC_outb_nodebug(hc, reg, val);
 }
 static u_char
 HFC_inb_debug(struct hfc_multi *hc, u_char reg, const char *function, int line)
 {
         char regname[256] = "", bits[9] = "xxxxxxxx";
         u_char val = HFC_inb_nodebug(hc, reg);
         int i;
 
         i = 0;
         while (hfc_register_names[i++].name)
                 ;
         while (hfc_register_names[++i].name) {
                 if (hfc_register_names[i].reg == reg)
                         strcat(regname, hfc_register_names[i].name);
         }
         if (regname[0] == '\0')
                 strcpy(regname, "register");
 
         bits[7] = '0'+(!!(val&1));
         bits[6] = '0'+(!!(val&2));
         bits[5] = '0'+(!!(val&4));
         bits[4] = '0'+(!!(val&8));
         bits[3] = '0'+(!!(val&16));
         bits[2] = '0'+(!!(val&32));
         bits[1] = '0'+(!!(val&64));
         bits[0] = '0'+(!!(val&128));
         printk(KERN_DEBUG
             "HFC_inb(chip %d, %02x=%s) = 0x%02x=%s; in %s() line %d\n",
             hc->id, reg, regname, val, bits, function, line);
         return val;
 }
 static u_short
 HFC_inw_debug(struct hfc_multi *hc, u_char reg, const char *function, int line)
 {
         char regname[256] = "";
         u_short val = HFC_inw_nodebug(hc, reg);
         int i;
 
         i = 0;
         while (hfc_register_names[i++].name)
                 ;
         while (hfc_register_names[++i].name) {
                 if (hfc_register_names[i].reg == reg)
                         strcat(regname, hfc_register_names[i].name);
         }
         if (regname[0] == '\0')
                 strcpy(regname, "register");
 
         printk(KERN_DEBUG
             "HFC_inw(chip %d, %02x=%s) = 0x%04x; in %s() line %d\n",
             hc->id, reg, regname, val, function, line);
         return val;
 }
 static void
 HFC_wait_debug(struct hfc_multi *hc, const char *function, int line)
 {
         printk(KERN_DEBUG "HFC_wait(chip %d); in %s() line %d\n",
             hc->id, function, line);
         HFC_wait_nodebug(hc);
 }
 #endif
 
 /* write fifo data (REGIO) */
 void
 write_fifo_regio(struct hfc_multi *hc, u_char *data, int len)
 {
         outb(A_FIFO_DATA0, (hc->pci_iobase)+4);
         while (len>>2) {
                 outl(cpu_to_le32(*(u32 *)data), hc->pci_iobase);
                 data += 4;
                 len -= 4;
         }
         while (len>>1) {
                 outw(cpu_to_le16(*(u16 *)data), hc->pci_iobase);
                 data += 2;
                 len -= 2;
         }
         while (len) {
                 outb(*data, hc->pci_iobase);
                 data++;
                 len--;
         }
 }
 /* write fifo data (PCIMEM) */
 void
 write_fifo_pcimem(struct hfc_multi *hc, u_char *data, int len)
 {
         while (len>>2) {
                 writel(cpu_to_le32(*(u32 *)data),
                         hc->pci_membase + A_FIFO_DATA0);
                 data += 4;
                 len -= 4;
         }
         while (len>>1) {
                 writew(cpu_to_le16(*(u16 *)data),
                         hc->pci_membase + A_FIFO_DATA0);
                 data += 2;
                 len -= 2;
         }
         while (len) {
                 writeb(*data, hc->pci_membase + A_FIFO_DATA0);
                 data++;
                 len--;
         }
 }
 /* read fifo data (REGIO) */
 void
 read_fifo_regio(struct hfc_multi *hc, u_char *data, int len)
 {
         outb(A_FIFO_DATA0, (hc->pci_iobase)+4);
         while (len>>2) {
                 *(u32 *)data = le32_to_cpu(inl(hc->pci_iobase));
                 data += 4;
                 len -= 4;
         }
         while (len>>1) {
                 *(u16 *)data = le16_to_cpu(inw(hc->pci_iobase));
                 data += 2;
                 len -= 2;
         }
         while (len) {
                 *data = inb(hc->pci_iobase);
                 data++;
                 len--;
         }
 }
 
 /* read fifo data (PCIMEM) */
 void
 read_fifo_pcimem(struct hfc_multi *hc, u_char *data, int len)
 {
         while (len>>2) {
                 *(u32 *)data =
                         le32_to_cpu(readl(hc->pci_membase + A_FIFO_DATA0));
                 data += 4;
                 len -= 4;
         }
         while (len>>1) {
                 *(u16 *)data =
                         le16_to_cpu(readw(hc->pci_membase + A_FIFO_DATA0));
                 data += 2;
                 len -= 2;
         }
         while (len) {
                 *data = readb(hc->pci_membase + A_FIFO_DATA0);
                 data++;
                 len--;
         }
 }
 
 
 static void
 enable_hwirq(struct hfc_multi *hc)
 {
         hc->hw.r_irq_ctrl |= V_GLOB_IRQ_EN;
         HFC_outb(hc, R_IRQ_CTRL, hc->hw.r_irq_ctrl);
 }
 
 static void
 disable_hwirq(struct hfc_multi *hc)
 {
         hc->hw.r_irq_ctrl &= ~((u_char)V_GLOB_IRQ_EN);
         HFC_outb(hc, R_IRQ_CTRL, hc->hw.r_irq_ctrl);
 }
 
 #define        NUM_EC 2
 #define        MAX_TDM_CHAN 32
 
 
 inline void
 enablepcibridge(struct hfc_multi *c)
 {
         HFC_outb(c, R_BRG_PCM_CFG, (0x0 << 6) | 0x3); /* was _io before */
 }
 
 inline void
 disablepcibridge(struct hfc_multi *c)
 {
         HFC_outb(c, R_BRG_PCM_CFG, (0x0 << 6) | 0x2); /* was _io before */
 }
 
 inline unsigned char
 readpcibridge(struct hfc_multi *hc, unsigned char address)
 {
         unsigned short cipv;
         unsigned char data;
 
         if (!hc->pci_iobase)
                 return 0;
 
         /* slow down a PCI read access by 1 PCI clock cycle */
         HFC_outb(hc, R_CTRL, 0x4); /*was _io before*/
 
         if (address == 0)
                 cipv = 0x4000;
         else
                 cipv = 0x5800;
 
         /* select local bridge port address by writing to CIP port */
         /* data = HFC_inb(c, cipv); * was _io before */
         outw(cipv, hc->pci_iobase + 4);
         data = inb(hc->pci_iobase);
 
         /* restore R_CTRL for normal PCI read cycle speed */
         HFC_outb(hc, R_CTRL, 0x0); /* was _io before */
 
         return data;
 }
 
 inline void
 writepcibridge(struct hfc_multi *hc, unsigned char address, unsigned char data)
 {
         unsigned short cipv;
         unsigned int datav;
 
         if (!hc->pci_iobase)
                 return;
 
         if (address == 0)
                 cipv = 0x4000;
         else
                 cipv = 0x5800;
 
         /* select local bridge port address by writing to CIP port */
         outw(cipv, hc->pci_iobase + 4);
         /* define a 32 bit dword with 4 identical bytes for write sequence */
         datav = data | ((__u32) data << 8) | ((__u32) data << 16) |
             ((__u32) data << 24);
 
         /*
          * write this 32 bit dword to the bridge data port
          * this will initiate a write sequence of up to 4 writes to the same
          * address on the local bus interface the number of write accesses
          * is undefined but >=1 and depends on the next PCI transaction
          * during write sequence on the local bus
          */
         outl(datav, hc->pci_iobase);
 }
 
 inline void
 cpld_set_reg(struct hfc_multi *hc, unsigned char reg)
 {
         /* Do data pin read low byte */
         HFC_outb(hc, R_GPIO_OUT1, reg);
 }
 
 inline void
 cpld_write_reg(struct hfc_multi *hc, unsigned char reg, unsigned char val)
 {
         cpld_set_reg(hc, reg);
 
         enablepcibridge(hc);
         writepcibridge(hc, 1, val);
         disablepcibridge(hc);
 
         return;
 }
 
 inline unsigned char
 cpld_read_reg(struct hfc_multi *hc, unsigned char reg)
 {
         unsigned char bytein;
 
         cpld_set_reg(hc, reg);
 
         /* Do data pin read low byte */
         HFC_outb(hc, R_GPIO_OUT1, reg);
 
         enablepcibridge(hc);
         bytein = readpcibridge(hc, 1);
         disablepcibridge(hc);
 
         return bytein;
 }
 
 inline void
 vpm_write_address(struct hfc_multi *hc, unsigned short addr)
 {
         cpld_write_reg(hc, 0, 0xff & addr);
         cpld_write_reg(hc, 1, 0x01 & (addr >> 8));
 }
 
 inline unsigned short
 vpm_read_address(struct hfc_multi *c)
 {
         unsigned short addr;
         unsigned short highbit;
 
         addr = cpld_read_reg(c, 0);
         highbit = cpld_read_reg(c, 1);
 
         addr = addr | (highbit << 8);
 
         return addr & 0x1ff;
 }
 
 inline unsigned char
 vpm_in(struct hfc_multi *c, int which, unsigned short addr)
 {
         unsigned char res;
 
         vpm_write_address(c, addr);
 
         if (!which)
                 cpld_set_reg(c, 2);
         else
                 cpld_set_reg(c, 3);
 
         enablepcibridge(c);
         res = readpcibridge(c, 1);
         disablepcibridge(c);
 
         cpld_set_reg(c, 0);
 
         return res;
 }
 
 inline void
 vpm_out(struct hfc_multi *c, int which, unsigned short addr,
     unsigned char data)
 {
         vpm_write_address(c, addr);
 
         enablepcibridge(c);
 
         if (!which)
                 cpld_set_reg(c, 2);
         else
                 cpld_set_reg(c, 3);
 
         writepcibridge(c, 1, data);
 
         cpld_set_reg(c, 0);
 
         disablepcibridge(c);
 
         {
         unsigned char regin;
         regin = vpm_in(c, which, addr);
         if (regin != data)
                 printk(KERN_DEBUG "Wrote 0x%x to register 0x%x but got back "
                         "0x%x\n", data, addr, regin);
         }
 
 }
 
 
 void
 vpm_init(struct hfc_multi *wc)
 {
         unsigned char reg;
         unsigned int mask;
         unsigned int i, x, y;
         unsigned int ver;
 
         for (x = 0; x < NUM_EC; x++) {
                 /* Setup GPIO's */
                 if (!x) {
                         ver = vpm_in(wc, x, 0x1a0);
                         printk(KERN_DEBUG "VPM: Chip %d: ver %02x\n", x, ver);
                 }
 
                 for (y = 0; y < 4; y++) {
                         vpm_out(wc, x, 0x1a8 + y, 0x00); /* GPIO out */
                         vpm_out(wc, x, 0x1ac + y, 0x00); /* GPIO dir */
                         vpm_out(wc, x, 0x1b0 + y, 0x00); /* GPIO sel */
                 }
 
                 /* Setup TDM path - sets fsync and tdm_clk as inputs */
                 reg = vpm_in(wc, x, 0x1a3); /* misc_con */
                 vpm_out(wc, x, 0x1a3, reg & ~2);
 
                 /* Setup Echo length (256 taps) */
                 vpm_out(wc, x, 0x022, 1);
                 vpm_out(wc, x, 0x023, 0xff);
 
                 /* Setup timeslots */
                 vpm_out(wc, x, 0x02f, 0x00);
                 mask = 0x02020202 << (x * 4);
 
                 /* Setup the tdm channel masks for all chips */
                 for (i = 0; i < 4; i++)
                         vpm_out(wc, x, 0x33 - i, (mask >> (i << 3)) & 0xff);
 
                 /* Setup convergence rate */
                 printk(KERN_DEBUG "VPM: A-law mode\n");
                 reg = 0x00 | 0x10 | 0x01;
                 vpm_out(wc, x, 0x20, reg);
                 printk(KERN_DEBUG "VPM reg 0x20 is %x\n", reg);
                 /*vpm_out(wc, x, 0x20, (0x00 | 0x08 | 0x20 | 0x10)); */
 
                 vpm_out(wc, x, 0x24, 0x02);
                 reg = vpm_in(wc, x, 0x24);
                 printk(KERN_DEBUG "NLP Thresh is set to %d (0x%x)\n", reg, reg);
 
                 /* Initialize echo cans */
                 for (i = 0; i < MAX_TDM_CHAN; i++) {
                         if (mask & (0x00000001 << i))
                                 vpm_out(wc, x, i, 0x00);
                 }
 
                 /*
                  * ARM arch at least disallows a udelay of
                  * more than 2ms... it gives a fake "__bad_udelay"
                  * reference at link-time.
                  * long delays in kernel code are pretty sucky anyway
                  * for now work around it using 5 x 2ms instead of 1 x 10ms
                  */
 
                 udelay(2000);
                 udelay(2000);
                 udelay(2000);
                 udelay(2000);
                 udelay(2000);
 
                 /* Put in bypass mode */
                 for (i = 0; i < MAX_TDM_CHAN; i++) {
                         if (mask & (0x00000001 << i))
                                 vpm_out(wc, x, i, 0x01);
                 }
 
                 /* Enable bypass */
                 for (i = 0; i < MAX_TDM_CHAN; i++) {
                         if (mask & (0x00000001 << i))
                                 vpm_out(wc, x, 0x78 + i, 0x01);
                 }
 
         }
 }
 
 void
 vpm_check(struct hfc_multi *hctmp)
 {
         unsigned char gpi2;
 
         gpi2 = HFC_inb(hctmp, R_GPI_IN2);
 
         if ((gpi2 & 0x3) != 0x3)
                 printk(KERN_DEBUG "Got interrupt 0x%x from VPM!\n", gpi2);
 }
 
 
 /*
  * Interface to enable/disable the HW Echocan
  *
  * these functions are called within a spin_lock_irqsave on
  * the channel instance lock, so we are not disturbed by irqs
  *
  * we can later easily change the interface to make  other
  * things configurable, for now we configure the taps
  *
  */
 
 void
 vpm_echocan_on(struct hfc_multi *hc, int ch, int taps)
 {
         unsigned int timeslot;
         unsigned int unit;
         struct bchannel *bch = hc->chan[ch].bch;
 #ifdef TXADJ
         int txadj = -4;
         struct sk_buff *skb;
 #endif
         if (hc->chan[ch].protocol != ISDN_P_B_RAW)
                 return;
 
         if (!bch)
                 return;
 
 #ifdef TXADJ
         skb = _alloc_mISDN_skb(PH_CONTROL_IND, HFC_VOL_CHANGE_TX,
                 sizeof(int), &txadj, GFP_ATOMIC);
         if (skb)
                 recv_Bchannel_skb(bch, skb);
 #endif
 
         timeslot = ((ch/4)*8) + ((ch%4)*4) + 1;
         unit = ch % 4;
 
         printk(KERN_NOTICE "vpm_echocan_on called taps [%d] on timeslot %d\n",
             taps, timeslot);
 
         vpm_out(hc, unit, timeslot, 0x7e);
 }
 
 void
 vpm_echocan_off(struct hfc_multi *hc, int ch)
 {
         unsigned int timeslot;
         unsigned int unit;
         struct bchannel *bch = hc->chan[ch].bch;
 #ifdef TXADJ
         int txadj = 0;
         struct sk_buff *skb;
 #endif
 
         if (hc->chan[ch].protocol != ISDN_P_B_RAW)
                 return;
 
         if (!bch)
                 return;
 
 #ifdef TXADJ
         skb = _alloc_mISDN_skb(PH_CONTROL_IND, HFC_VOL_CHANGE_TX,
                 sizeof(int), &txadj, GFP_ATOMIC);
         if (skb)
                 recv_Bchannel_skb(bch, skb);
 #endif
 
         timeslot = ((ch/4)*8) + ((ch%4)*4) + 1;
         unit = ch % 4;
 
         printk(KERN_NOTICE "vpm_echocan_off called on timeslot %d\n",
             timeslot);
         /* FILLME */
         vpm_out(hc, unit, timeslot, 0x01);
 }
 
 
 /*
  * Speech Design resync feature
  * NOTE: This is called sometimes outside interrupt handler.
  * We must lock irqsave, so no other interrupt (other card) will occurr!
  * Also multiple interrupts may nest, so must lock each access (lists, card)!
  */
 static inline void
 hfcmulti_resync(struct hfc_multi *locked, struct hfc_multi *newmaster, int rm)
 {
         struct hfc_multi *hc, *next, *pcmmaster = 0;
         u_int *plx_acc_32, pv;
         u_long flags;
 
         spin_lock_irqsave(&HFClock, flags);
         spin_lock(&plx_lock); /* must be locked inside other locks */
 
         if (debug & DEBUG_HFCMULTI_PLXSD)
                 printk(KERN_DEBUG "%s: RESYNC(syncmaster=0x%p)\n",
                         __func__, syncmaster);
 
         /* select new master */
         if (newmaster) {
                 if (debug & DEBUG_HFCMULTI_PLXSD)
                         printk(KERN_DEBUG "using provided controller\n");
         } else {
                 list_for_each_entry_safe(hc, next, &HFClist, list) {
                         if (test_bit(HFC_CHIP_PLXSD, &hc->chip)) {
                                 if (hc->syncronized) {
                                         newmaster = hc;
                                         break;
                                 }
                         }
                 }
         }
 
         /* Disable sync of all cards */
         list_for_each_entry_safe(hc, next, &HFClist, list) {
                 if (test_bit(HFC_CHIP_PLXSD, &hc->chip)) {
                         plx_acc_32 = (u_int *)(hc->plx_membase+PLX_GPIOC);
                         pv = readl(plx_acc_32);
                         pv &= ~PLX_SYNC_O_EN;
                         writel(pv, plx_acc_32);
                         if (test_bit(HFC_CHIP_PCM_MASTER, &hc->chip)) {
                                 pcmmaster = hc;
                                 if (hc->type == 1) {
                                         if (debug & DEBUG_HFCMULTI_PLXSD)
                                                 printk(KERN_DEBUG
                                                         "Schedule SYNC_I\n");
                                         hc->e1_resync |= 1; /* get SYNC_I */
                                 }
                         }
                 }
         }
 
         if (newmaster) {
                 hc = newmaster;
                 if (debug & DEBUG_HFCMULTI_PLXSD)
                         printk(KERN_DEBUG "id=%d (0x%p) = syncronized with "
                                 "interface.\n", hc->id, hc);
                 /* Enable new sync master */
                 plx_acc_32 = (u_int *)(hc->plx_membase+PLX_GPIOC);
                 pv = readl(plx_acc_32);
                 pv |= PLX_SYNC_O_EN;
                 writel(pv, plx_acc_32);
                 /* switch to jatt PLL, if not disabled by RX_SYNC */
                 if (hc->type == 1 && !test_bit(HFC_CHIP_RX_SYNC, &hc->chip)) {
                         if (debug & DEBUG_HFCMULTI_PLXSD)
                                 printk(KERN_DEBUG "Schedule jatt PLL\n");
                         hc->e1_resync |= 2; /* switch to jatt */
                 }
         } else {
                 if (pcmmaster) {
                         hc = pcmmaster;
                         if (debug & DEBUG_HFCMULTI_PLXSD)
                                 printk(KERN_DEBUG
                                         "id=%d (0x%p) = PCM master syncronized "
                                         "with QUARTZ\n", hc->id, hc);
                         if (hc->type == 1) {
                                 /* Use the crystal clock for the PCM
                                    master card */
                                 if (debug & DEBUG_HFCMULTI_PLXSD)
                                         printk(KERN_DEBUG
                                             "Schedule QUARTZ for HFC-E1\n");
                                 hc->e1_resync |= 4; /* switch quartz */
                         } else {
                                 if (debug & DEBUG_HFCMULTI_PLXSD)
                                         printk(KERN_DEBUG
                                             "QUARTZ is automatically "
                                             "enabled by HFC-%dS\n", hc->type);
                         }
                         plx_acc_32 = (u_int *)(hc->plx_membase+PLX_GPIOC);
                         pv = readl(plx_acc_32);
                         pv |= PLX_SYNC_O_EN;
                         writel(pv, plx_acc_32);
                 } else
                         if (!rm)
                                 printk(KERN_ERR "%s no pcm master, this MUST "
                                         "not happen!\n", __func__);
         }
         syncmaster = newmaster;
 
         spin_unlock(&plx_lock);
         spin_unlock_irqrestore(&HFClock, flags);
 }
 
 /* This must be called AND hc must be locked irqsave!!! */
 inline void
 plxsd_checksync(struct hfc_multi *hc, int rm)
 {
         if (hc->syncronized) {
                 if (syncmaster == NULL) {
                         if (debug & DEBUG_HFCMULTI_PLXSD)
                                 printk(KERN_WARNING "%s: GOT sync on card %d"
                                         " (id=%d)\n", __func__, hc->id + 1,
                                         hc->id);
                         hfcmulti_resync(hc, hc, rm);
                 }
         } else {
                 if (syncmaster == hc) {
                        if (debug & DEBUG_HFCMULTI_PLXSD)
                                printk(KERN_WARNING "%s: LOST sync on card %d"
                                        " (id=%d)\n", __func__, hc->id + 1,
                                        hc->id);
                        hfcmulti_resync(hc, NULL, rm);
                }
        }
}


/*
 * free hardware resources used by driver
 */
static void
release_io_hfcmulti(struct hfc_multi *hc)
{
        u_int        *plx_acc_32, pv;
        u_long        plx_flags;

        if (debug & DEBUG_HFCMULTI_INIT)
                printk(KERN_DEBUG "%s: entered\n", __func__);

        /* soft reset also masks all interrupts */
        hc->hw.r_cirm |= V_SRES;
        HFC_outb(hc, R_CIRM, hc->hw.r_cirm);
        udelay(1000);
        hc->hw.r_cirm &= ~V_SRES;
        HFC_outb(hc, R_CIRM, hc->hw.r_cirm);
        udelay(1000); /* instead of 'wait' that may cause locking */

        /* release Speech Design card, if PLX was initialized */
        if (test_bit(HFC_CHIP_PLXSD, &hc->chip) && hc->plx_membase) {
                if (debug & DEBUG_HFCMULTI_PLXSD)
                        printk(KERN_DEBUG "%s: release PLXSD card %d\n",
                            __func__, hc->id + 1);
                spin_lock_irqsave(&plx_lock, plx_flags);
                plx_acc_32 = (u_int *)(hc->plx_membase+PLX_GPIOC);
                writel(PLX_GPIOC_INIT, plx_acc_32);
                pv = readl(plx_acc_32);
                /* Termination off */
                pv &= ~PLX_TERM_ON;
                /* Disconnect the PCM */
                pv |= PLX_SLAVE_EN_N;
                pv &= ~PLX_MASTER_EN;
                pv &= ~PLX_SYNC_O_EN;
                /* Put the DSP in Reset */
                pv &= ~PLX_DSP_RES_N;
                writel(pv, plx_acc_32);
                if (debug & DEBUG_HFCMULTI_INIT)
                        printk(KERN_WARNING "%s: PCM off: PLX_GPIO=%x\n",
                                __func__, pv);
                spin_unlock_irqrestore(&plx_lock, plx_flags);
        }

        /* disable memory mapped ports / io ports */
        test_and_clear_bit(HFC_CHIP_PLXSD, &hc->chip); /* prevent resync */
        pci_write_config_word(hc->pci_dev, PCI_COMMAND, 0);
        if (hc->pci_membase)
                iounmap((void *)hc->pci_membase);
        if (hc->plx_membase)
                iounmap((void *)hc->plx_membase);
        if (hc->pci_iobase)
                release_region(hc->pci_iobase, 8);

        if (hc->pci_dev) {
                pci_disable_device(hc->pci_dev);
                pci_set_drvdata(hc->pci_dev, NULL);
        }
        if (debug & DEBUG_HFCMULTI_INIT)
                printk(KERN_DEBUG "%s: done\n", __func__);
}

/*
 * function called to reset the HFC chip. A complete software reset of chip
 * and fifos is done. All configuration of the chip is done.
 */

static int
init_chip(struct hfc_multi *hc)
{
        u_long                        flags, val, val2 = 0, rev;
        int                        i, err = 0;
        u_char                        r_conf_en, rval;
        u_int                        *plx_acc_32, pv;
        u_long                        plx_flags, hfc_flags;
        int                        plx_count;
        struct hfc_multi        *pos, *next, *plx_last_hc;

        spin_lock_irqsave(&hc->lock, flags);
        /* reset all registers */
        memset(&hc->hw, 0, sizeof(struct hfcm_hw));

        /* revision check */
        if (debug & DEBUG_HFCMULTI_INIT)
                printk(KERN_DEBUG "%s: entered\n", __func__);
        val = HFC_inb(hc, R_CHIP_ID)>>4;
        if (val != 0x8 && val != 0xc && val != 0xe) {
                printk(KERN_INFO "HFC_multi: unknown CHIP_ID:%x\n", (u_int)val);
                err = -EIO;
                goto out;
        }
        rev = HFC_inb(hc, R_CHIP_RV);
        printk(KERN_INFO
            "HFC_multi: detected HFC with chip ID=0x%lx revision=%ld%s\n",
            val, rev, (rev == 0) ? " (old FIFO handling)" : "");
        if (rev == 0) {
                test_and_set_bit(HFC_CHIP_REVISION0, &hc->chip);
                printk(KERN_WARNING
                    "HFC_multi: NOTE: Your chip is revision 0, "
                    "ask Cologne Chip for update. Newer chips "
                    "have a better FIFO handling. Old chips "
                    "still work but may have slightly lower "
                    "HDLC transmit performance.\n");
        }
        if (rev > 1) {
                printk(KERN_WARNING "HFC_multi: WARNING: This driver doesn't "
                    "consider chip revision = %ld. The chip / "
                    "bridge may not work.\n", rev);
        }

        /* set s-ram size */
        hc->Flen = 0x10;
        hc->Zmin = 0x80;
        hc->Zlen = 384;
        hc->DTMFbase = 0x1000;
        if (test_bit(HFC_CHIP_EXRAM_128, &hc->chip)) {
                if (debug & DEBUG_HFCMULTI_INIT)
                        printk(KERN_DEBUG "%s: changing to 128K extenal RAM\n",
                            __func__);
                hc->hw.r_ctrl |= V_EXT_RAM;
                hc->hw.r_ram_sz = 1;
                hc->Flen = 0x20;
                hc->Zmin = 0xc0;
                hc->Zlen = 1856;
                hc->DTMFbase = 0x2000;
        }
        if (test_bit(HFC_CHIP_EXRAM_512, &hc->chip)) {
                if (debug & DEBUG_HFCMULTI_INIT)
                        printk(KERN_DEBUG "%s: changing to 512K extenal RAM\n",
                            __func__);
                hc->hw.r_ctrl |= V_EXT_RAM;
                hc->hw.r_ram_sz = 2;
                hc->Flen = 0x20;
                hc->Zmin = 0xc0;
                hc->Zlen = 8000;
                hc->DTMFbase = 0x2000;
        }
        hc->max_trans = poll << 1;
        if (hc->max_trans > hc->Zlen)
                hc->max_trans = hc->Zlen;

        /* Speech Design PLX bridge */
        if (test_bit(HFC_CHIP_PLXSD, &hc->chip)) {
                if (debug & DEBUG_HFCMULTI_PLXSD)
                        printk(KERN_DEBUG "%s: initializing PLXSD card %d\n",
                            __func__, hc->id + 1);
                spin_lock_irqsave(&plx_lock, plx_flags);
                plx_acc_32 = (u_int *)(hc->plx_membase+PLX_GPIOC);
                writel(PLX_GPIOC_INIT, plx_acc_32);
                pv = readl(plx_acc_32);
                /* The first and the last cards are terminating the PCM bus */
                pv |= PLX_TERM_ON; /* hc is currently the last */
                /* Disconnect the PCM */
                pv |= PLX_SLAVE_EN_N;
                pv &= ~PLX_MASTER_EN;
                pv &= ~PLX_SYNC_O_EN;
                /* Put the DSP in Reset */
                pv &= ~PLX_DSP_RES_N;
                writel(pv, plx_acc_32);
                spin_unlock_irqrestore(&plx_lock, plx_flags);
                if (debug & DEBUG_HFCMULTI_INIT)
                        printk(KERN_WARNING "%s: slave/term: PLX_GPIO=%x\n",
                                __func__, pv);
                /*
                 * If we are the 3rd PLXSD card or higher, we must turn
                 * termination of last PLXSD card off.
                 */
                spin_lock_irqsave(&HFClock, hfc_flags);
                plx_count = 0;
                plx_last_hc = NULL;
                list_for_each_entry_safe(pos, next, &HFClist, list) {
                        if (test_bit(HFC_CHIP_PLXSD, &pos->chip)) {
                                plx_count++;
                                if (pos != hc)
                                        plx_last_hc = pos;
                        }
                }
                if (plx_count >= 3) {
                        if (debug & DEBUG_HFCMULTI_PLXSD)
                                printk(KERN_DEBUG "%s: card %d is between, so "
                                        "we disable termination\n",
                                    __func__, plx_last_hc->id + 1);
                        spin_lock_irqsave(&plx_lock, plx_flags);
                        plx_acc_32 = (u_int *)(plx_last_hc->plx_membase
                                        + PLX_GPIOC);
                        pv = readl(plx_acc_32);
                        pv &= ~PLX_TERM_ON;
                        writel(pv, plx_acc_32);
                        spin_unlock_irqrestore(&plx_lock, plx_flags);
                        if (debug & DEBUG_HFCMULTI_INIT)
                            printk(KERN_WARNING "%s: term off: PLX_GPIO=%x\n",
                                        __func__, pv);
                }
                spin_unlock_irqrestore(&HFClock, hfc_flags);
                hc->hw.r_pcm_md0 = V_F0_LEN; /* shift clock for DSP */
        }

        /* we only want the real Z2 read-pointer for revision > 0 */
        if (!test_bit(HFC_CHIP_REVISION0, &hc->chip))
                hc->hw.r_ram_sz |= V_FZ_MD;

        /* select pcm mode */
        if (test_bit(HFC_CHIP_PCM_SLAVE, &hc->chip)) {
                if (debug & DEBUG_HFCMULTI_INIT)
                        printk(KERN_DEBUG "%s: setting PCM into slave mode\n",
                            __func__);
        } else
        if (test_bit(HFC_CHIP_PCM_MASTER, &hc->chip) && !plxsd_master) {
                if (debug & DEBUG_HFCMULTI_INIT)
                        printk(KERN_DEBUG "%s: setting PCM into master mode\n",
                            __func__);
                hc->hw.r_pcm_md0 |= V_PCM_MD;
        } else {
                if (debug & DEBUG_HFCMULTI_INIT)
                        printk(KERN_DEBUG "%s: performing PCM auto detect\n",
                            __func__);
        }

        /* soft reset */
        HFC_outb(hc, R_CTRL, hc->hw.r_ctrl);
        HFC_outb(hc, R_RAM_SZ, hc->hw.r_ram_sz);
        HFC_outb(hc, R_FIFO_MD, 0);
        hc->hw.r_cirm = V_SRES | V_HFCRES | V_PCMRES | V_STRES | V_RLD_EPR;
        HFC_outb(hc, R_CIRM, hc->hw.r_cirm);
        udelay(100);
        hc->hw.r_cirm = 0;
        HFC_outb(hc, R_CIRM, hc->hw.r_cirm);
        udelay(100);
        HFC_outb(hc, R_RAM_SZ, hc->hw.r_ram_sz);

        /* Speech Design PLX bridge pcm and sync mode */
        if (test_bit(HFC_CHIP_PLXSD, &hc->chip)) {
                spin_lock_irqsave(&plx_lock, plx_flags);
                plx_acc_32 = (u_int *)(hc->plx_membase+PLX_GPIOC);
                pv = readl(plx_acc_32);
                /* Connect PCM */
                if (hc->hw.r_pcm_md0 & V_PCM_MD) {
                        pv |= PLX_MASTER_EN | PLX_SLAVE_EN_N;
                        pv |= PLX_SYNC_O_EN;
                        if (debug & DEBUG_HFCMULTI_INIT)
                                printk(KERN_WARNING "%s: master: PLX_GPIO=%x\n",
                                        __func__, pv);
                } else {
                        pv &= ~(PLX_MASTER_EN | PLX_SLAVE_EN_N);
                        pv &= ~PLX_SYNC_O_EN;
                        if (debug & DEBUG_HFCMULTI_INIT)
                                printk(KERN_WARNING "%s: slave: PLX_GPIO=%x\n",
                                        __func__, pv);
                }
                writel(pv, plx_acc_32);
                spin_unlock_irqrestore(&plx_lock, plx_flags);
        }

        /* PCM setup */
        HFC_outb(hc, R_PCM_MD0, hc->hw.r_pcm_md0 | 0x90);
        if (hc->slots == 32)
                HFC_outb(hc, R_PCM_MD1, 0x00);
        if (hc->slots == 64)
                HFC_outb(hc, R_PCM_MD1, 0x10);
        if (hc->slots == 128)
                HFC_outb(hc, R_PCM_MD1, 0x20);
        HFC_outb(hc, R_PCM_MD0, hc->hw.r_pcm_md0 | 0xa0);
        if (test_bit(HFC_CHIP_PLXSD, &hc->chip))
                HFC_outb(hc, R_PCM_MD2, V_SYNC_SRC); /* sync via SYNC_I / O */
        else
                HFC_outb(hc, R_PCM_MD2, 0x00); /* sync from interface */
        HFC_outb(hc, R_PCM_MD0, hc->hw.r_pcm_md0 | 0x00);
        for (i = 0; i < 256; i++) {
                HFC_outb_nodebug(hc, R_SLOT, i);
                HFC_outb_nodebug(hc, A_SL_CFG, 0);
                HFC_outb_nodebug(hc, A_CONF, 0);
                hc->slot_owner[i] = -1;
        }

        /* set clock speed */
        if (test_bit(HFC_CHIP_CLOCK2, &hc->chip)) {
                if (debug & DEBUG_HFCMULTI_INIT)
                        printk(KERN_DEBUG
                            "%s: setting double clock\n", __func__);
                HFC_outb(hc, R_BRG_PCM_CFG, V_PCM_CLK);
        }

        /* B410P GPIO */
        if (test_bit(HFC_CHIP_B410P, &hc->chip)) {
                printk(KERN_NOTICE "Setting GPIOs\n");
                HFC_outb(hc, R_GPIO_SEL, 0x30);
                HFC_outb(hc, R_GPIO_EN1, 0x3);
                udelay(1000);
                printk(KERN_NOTICE "calling vpm_init\n");
                vpm_init(hc);
        }

        /* check if R_F0_CNT counts (8 kHz frame count) */
        val = HFC_inb(hc, R_F0_CNTL);
        val += HFC_inb(hc, R_F0_CNTH) << 8;
        if (debug & DEBUG_HFCMULTI_INIT)
                printk(KERN_DEBUG
                    "HFC_multi F0_CNT %ld after reset\n", val);
        spin_unlock_irqrestore(&hc->lock, flags);
        set_current_state(TASK_UNINTERRUPTIBLE);
        schedule_timeout((HZ/100)?:1); /* Timeout minimum 10ms */
        spin_lock_irqsave(&hc->lock, flags);
        val2 = HFC_inb(hc, R_F0_CNTL);
        val2 += HFC_inb(hc, R_F0_CNTH) << 8;
        if (debug & DEBUG_HFCMULTI_INIT)
                printk(KERN_DEBUG
                        "HFC_multi F0_CNT %ld after 10 ms (1st try)\n",
                    val2);
        if (val2 >= val+8) { /* 1 ms */
                /* it counts, so we keep the pcm mode */
                if (test_bit(HFC_CHIP_PCM_MASTER, &hc->chip))
                        printk(KERN_INFO "controller is PCM bus MASTER\n");
                else
                if (test_bit(HFC_CHIP_PCM_SLAVE, &hc->chip))
                        printk(KERN_INFO "controller is PCM bus SLAVE\n");
                else {
                        test_and_set_bit(HFC_CHIP_PCM_SLAVE, &hc->chip);
                        printk(KERN_INFO "controller is PCM bus SLAVE "
                                "(auto detected)\n");
                }
        } else {
                /* does not count */
                if (test_bit(HFC_CHIP_PCM_MASTER, &hc->chip)) {
controller_fail:
                        printk(KERN_ERR "HFC_multi ERROR, getting no 125us "
                            "pulse. Seems that controller fails.\n");
                        err = -EIO;
                        goto out;
                }
                if (test_bit(HFC_CHIP_PCM_SLAVE, &hc->chip)) {
                        printk(KERN_INFO "controller is PCM bus SLAVE "
                                "(ignoring missing PCM clock)\n");
                } else {
                        /* only one pcm master */
                        if (test_bit(HFC_CHIP_PLXSD, &hc->chip)
                                && plxsd_master) {
                                printk(KERN_ERR "HFC_multi ERROR, no clock "
                                    "on another Speech Design card found. "
                                    "Please be sure to connect PCM cable.\n");
                                err = -EIO;
                                goto out;
                        }
                        /* retry with master clock */
                        if (test_bit(HFC_CHIP_PLXSD, &hc->chip)) {
                                spin_lock_irqsave(&plx_lock, plx_flags);
                                plx_acc_32 = (u_int *)(hc->plx_membase +
                                        PLX_GPIOC);
                                pv = readl(plx_acc_32);
                                pv |= PLX_MASTER_EN | PLX_SLAVE_EN_N;
                                pv |= PLX_SYNC_O_EN;
                                writel(pv, plx_acc_32);
                                spin_unlock_irqrestore(&plx_lock, plx_flags);
                                if (debug & DEBUG_HFCMULTI_INIT)
                                    printk(KERN_WARNING "%s: master: PLX_GPIO"
                                        "=%x\n", __func__, pv);
                        }
                        hc->hw.r_pcm_md0 |= V_PCM_MD;
                        HFC_outb(hc, R_PCM_MD0, hc->hw.r_pcm_md0 | 0x00);
                        spin_unlock_irqrestore(&hc->lock, flags);
                        set_current_state(TASK_UNINTERRUPTIBLE);
                        schedule_timeout((HZ/100)?:1); /* Timeout min. 10ms */
                        spin_lock_irqsave(&hc->lock, flags);
                        val2 = HFC_inb(hc, R_F0_CNTL);
                        val2 += HFC_inb(hc, R_F0_CNTH) << 8;
                        if (debug & DEBUG_HFCMULTI_INIT)
                                printk(KERN_DEBUG "HFC_multi F0_CNT %ld after "
                                        "10 ms (2nd try)\n", val2);
                        if (val2 >= val+8) { /* 1 ms */
                                test_and_set_bit(HFC_CHIP_PCM_MASTER,
                                        &hc->chip);
                                printk(KERN_INFO "controller is PCM bus MASTER "
                                        "(auto detected)\n");
                        } else
                                goto controller_fail;
                }
        }

        /* Release the DSP Reset */
        if (test_bit(HFC_CHIP_PLXSD, &hc->chip)) {
                if (test_bit(HFC_CHIP_PCM_MASTER, &hc->chip))
                        plxsd_master = 1;
                spin_lock_irqsave(&plx_lock, plx_flags);
                plx_acc_32 = (u_int *)(hc->plx_membase+PLX_GPIOC);
                pv = readl(plx_acc_32);
                pv |=  PLX_DSP_RES_N;
                writel(pv, plx_acc_32);
                spin_unlock_irqrestore(&plx_lock, plx_flags);
                if (debug & DEBUG_HFCMULTI_INIT)
                        printk(KERN_WARNING "%s: reset off: PLX_GPIO=%x\n",
                                __func__, pv);
        }

        /* pcm id */
        if (hc->pcm)
                printk(KERN_INFO "controller has given PCM BUS ID %d\n",
                        hc->pcm);
        else {
                if (test_bit(HFC_CHIP_PCM_MASTER, &hc->chip)
                 || test_bit(HFC_CHIP_PLXSD, &hc->chip)) {
                        PCM_cnt++; /* SD has proprietary bridging */
                }
                hc->pcm = PCM_cnt;
                printk(KERN_INFO "controller has PCM BUS ID %d "
                        "(auto selected)\n", hc->pcm);
        }

        /* set up timer */
        HFC_outb(hc, R_TI_WD, poll_timer);
        hc->hw.r_irqmsk_misc |= V_TI_IRQMSK;

        /*
         * set up 125us interrupt, only if function pointer is available
         * and module parameter timer is set
         */
        if (timer && hfc_interrupt && register_interrupt) {
                /* only one chip should use this interrupt */
                timer = 0;
                interrupt_registered = 1;
                hc->hw.r_irqmsk_misc |= V_PROC_IRQMSK;
                /* deactivate other interrupts in ztdummy */
                register_interrupt();
        }

        /* set E1 state machine IRQ */
        if (hc->type == 1)
                hc->hw.r_irqmsk_misc |= V_STA_IRQMSK;

        /* set DTMF detection */
        if (test_bit(HFC_CHIP_DTMF, &hc->chip)) {
                if (debug & DEBUG_HFCMULTI_INIT)
                        printk(KERN_DEBUG "%s: enabling DTMF detection "
                            "for all B-channel\n", __func__);
                hc->hw.r_dtmf = V_DTMF_EN | V_DTMF_STOP;
                if (test_bit(HFC_CHIP_ULAW, &hc->chip))
                        hc->hw.r_dtmf |= V_ULAW_SEL;
                HFC_outb(hc, R_DTMF_N, 102 - 1);
                hc->hw.r_irqmsk_misc |= V_DTMF_IRQMSK;
        }

        /* conference engine */
        if (test_bit(HFC_CHIP_ULAW, &hc->chip))
                r_conf_en = V_CONF_EN | V_ULAW;
        else
                r_conf_en = V_CONF_EN;
        HFC_outb(hc, R_CONF_EN, r_conf_en);

        /* setting leds */
        switch (hc->leds) {
        case 1: /* HFC-E1 OEM */
                if (test_bit(HFC_CHIP_WATCHDOG, &hc->chip))
                        HFC_outb(hc, R_GPIO_SEL, 0x32);
                else
                        HFC_outb(hc, R_GPIO_SEL, 0x30);

                HFC_outb(hc, R_GPIO_EN1, 0x0f);
                HFC_outb(hc, R_GPIO_OUT1, 0x00);

                HFC_outb(hc, R_GPIO_EN0, V_GPIO_EN2 | V_GPIO_EN3);
                break;

        case 2: /* HFC-4S OEM */
        case 3:
                HFC_outb(hc, R_GPIO_SEL, 0xf0);
                HFC_outb(hc, R_GPIO_EN1, 0xff);
                HFC_outb(hc, R_GPIO_OUT1, 0x00);
                break;
        }

        /* set master clock */
        if (hc->masterclk >= 0) {
                if (debug & DEBUG_HFCMULTI_INIT)
                        printk(KERN_DEBUG "%s: setting ST master clock "
                            "to port %d (0..%d)\n",
                            __func__, hc->masterclk, hc->ports-1);
                hc->hw.r_st_sync = hc->masterclk | V_AUTO_SYNC;
                HFC_outb(hc, R_ST_SYNC, hc->hw.r_st_sync);
        }

        /* setting misc irq */
        HFC_outb(hc, R_IRQMSK_MISC, hc->hw.r_irqmsk_misc);
        if (debug & DEBUG_HFCMULTI_INIT)
                printk(KERN_DEBUG "r_irqmsk_misc.2: 0x%x\n",
                    hc->hw.r_irqmsk_misc);

        /* RAM access test */
        HFC_outb(hc, R_RAM_ADDR0, 0);
        HFC_outb(hc, R_RAM_ADDR1, 0);
        HFC_outb(hc, R_RAM_ADDR2, 0);
        for (i = 0; i < 256; i++) {
                HFC_outb_nodebug(hc, R_RAM_ADDR0, i);
                HFC_outb_nodebug(hc, R_RAM_DATA, ((i*3)&0xff));
        }
        for (i = 0; i < 256; i++) {
                HFC_outb_nodebug(hc, R_RAM_ADDR0, i);
                HFC_inb_nodebug(hc, R_RAM_DATA);
                rval = HFC_inb_nodebug(hc, R_INT_DATA);
                if (rval != ((i * 3) & 0xff)) {
                        printk(KERN_DEBUG
                            "addr:%x val:%x should:%x\n", i, rval,
                            (i * 3) & 0xff);
                        err++;
                }
        }
        if (err) {
                printk(KERN_DEBUG "aborting - %d RAM access errors\n", err);
                err = -EIO;
                goto out;
        }

        if (debug & DEBUG_HFCMULTI_INIT)
                printk(KERN_DEBUG "%s: done\n", __func__);
out:
        spin_unlock_irqrestore(&hc->lock, flags);
        return err;
}


/*
 * control the watchdog
 */
static void
hfcmulti_watchdog(struct hfc_multi *hc)
{
        hc->wdcount++;

        if (hc->wdcount > 10) {
                hc->wdcount = 0;
                hc->wdbyte = hc->wdbyte == V_GPIO_OUT2 ?
                    V_GPIO_OUT3 : V_GPIO_OUT2;

        /* printk("Sending Watchdog Kill %x\n",hc->wdbyte); */
                HFC_outb(hc, R_GPIO_EN0, V_GPIO_EN2 | V_GPIO_EN3);
                HFC_outb(hc, R_GPIO_OUT0, hc->wdbyte);
        }
}



/*
 * output leds
 */
static void
hfcmulti_leds(struct hfc_multi *hc)
{
        unsigned long lled;
        unsigned long leddw;
        int i, state, active, leds;
        struct dchannel *dch;
        int led[4];

        hc->ledcount += poll;
        if (hc->ledcount > 4096) {
                hc->ledcount -= 4096;
                hc->ledstate = 0xAFFEAFFE;
        }

        switch (hc->leds) {
        case 1: /* HFC-E1 OEM */
                /* 2 red blinking: NT mode deactivate
                 * 2 red steady:   TE mode deactivate
                 * left green:     L1 active
                 * left red:       frame sync, but no L1
                 * right green:    L2 active
                 */
                if (hc->chan[hc->dslot].sync != 2) { /* no frame sync */
                        if (hc->chan[hc->dslot].dch->dev.D.protocol
                                != ISDN_P_NT_E1) {
                                led[0] = 1;
                                led[1] = 1;
                        } else if (hc->ledcount>>11) {
                                led[0] = 1;
                                led[1] = 1;
                        } else {
                                led[0] = 0;
                                led[1] = 0;
                        }
                        led[2] = 0;
                        led[3] = 0;
                } else { /* with frame sync */
                        /* TODO make it work */
                        led[0] = 0;
                        led[1] = 0;
                        led[2] = 0;
                        led[3] = 1;
                }
                leds = (led[0] | (led[1]<<2) | (led[2]<<1) | (led[3]<<3))^0xF;
                        /* leds are inverted */
                if (leds != (int)hc->ledstate) {
                        HFC_outb_nodebug(hc, R_GPIO_OUT1, leds);
                        hc->ledstate = leds;
                }
                break;

        case 2: /* HFC-4S OEM */
                /* red blinking = PH_DEACTIVATE NT Mode
                 * red steady   = PH_DEACTIVATE TE Mode
                 * green steady = PH_ACTIVATE
                 */
                for (i = 0; i < 4; i++) {
                        state = 0;
                        active = -1;
                        dch = hc->chan[(i << 2) | 2].dch;
                        if (dch) {
                                state = dch->state;
                                if (dch->dev.D.protocol == ISDN_P_NT_S0)
                                        active = 3;
                                else
                                        active = 7;
                        }
                        if (state) {
                                if (state == active) {
                                        led[i] = 1; /* led green */
                                } else
                                        if (dch->dev.D.protocol == ISDN_P_TE_S0)
                                                /* TE mode: led red */
                                                led[i] = 2;
                                        else
                                                if (hc->ledcount>>11)
                                                        /* led red */
                                                        led[i] = 2;
                                                else
                                                        /* led off */
                                                        led[i] = 0;
                        } else
                                led[i] = 0; /* led off */
                }
                if (test_bit(HFC_CHIP_B410P, &hc->chip)) {
                        leds = 0;
                        for (i = 0; i < 4; i++) {
                                if (led[i] == 1) {
                                        /*green*/
                                        leds |= (0x2 << (i * 2));
                                } else if (led[i] == 2) {
                                        /*red*/
                                        leds |= (0x1 << (i * 2));
                                }
                        }
                        if (leds != (int)hc->ledstate) {
                                vpm_out(hc, 0, 0x1a8 + 3, leds);
                                hc->ledstate = leds;
                        }
                } else {
                        leds = ((led[3] > 0) << 0) | ((led[1] > 0) << 1) |
                            ((led[0] > 0) << 2) | ((led[2] > 0) << 3) |
                            ((led[3] & 1) << 4) | ((led[1] & 1) << 5) |
                            ((led[0] & 1) << 6) | ((led[2] & 1) << 7);
                        if (leds != (int)hc->ledstate) {
                                HFC_outb_nodebug(hc, R_GPIO_EN1, leds & 0x0F);
                                HFC_outb_nodebug(hc, R_GPIO_OUT1, leds >> 4);
                                hc->ledstate = leds;
                        }
                }
                break;

        case 3: /* HFC 1S/2S Beronet */
                /* red blinking = PH_DEACTIVATE NT Mode
                 * red steady   = PH_DEACTIVATE TE Mode
                 * green steady = PH_ACTIVATE
                 */
                for (i = 0; i < 2; i++) {
                        state = 0;
                        active = -1;
                        dch = hc->chan[(i << 2) | 2].dch;
                        if (dch) {
                                state = dch->state;
                                if (dch->dev.D.protocol == ISDN_P_NT_S0)
                                        active = 3;
                                else
                                        active = 7;
                        }
                        if (state) {
                                if (state == active) {
                                        led[i] = 1; /* led green */
                                } else
                                        if (dch->dev.D.protocol == ISDN_P_TE_S0)
                                                /* TE mode: led red */
                                                led[i] = 2;
                                        else
                                                if (hc->ledcount >> 11)
                                                        /* led red */
                                                        led[i] = 2;
                                                else
                                                        /* led off */
                                                        led[i] = 0;
                        } else
                                led[i] = 0; /* led off */
                }


                leds = (led[0] > 0) | ((led[1] > 0)<<1) | ((led[0]&1)<<2)
                        | ((led[1]&1)<<3);
                if (leds != (int)hc->ledstate) {
                        HFC_outb_nodebug(hc, R_GPIO_EN1,
                            ((led[0] > 0) << 2) | ((led[1] > 0) << 3));
                        HFC_outb_nodebug(hc, R_GPIO_OUT1,
                            ((led[0] & 1) << 2) | ((led[1] & 1) << 3));
                        hc->ledstate = leds;
                }
                break;
        case 8: /* HFC 8S+ Beronet */
                lled = 0;

                for (i = 0; i < 8; i++) {
                        state = 0;
                        active = -1;
                        dch = hc->chan[(i << 2) | 2].dch;
                        if (dch) {
                                state = dch->state;
                                if (dch->dev.D.protocol == ISDN_P_NT_S0)
                                        active = 3;
                                else
                                        active = 7;
                        }
                        if (state) {
                                if (state == active) {
                                        lled |= 0 << i;
                                } else
                                        if (hc->ledcount >> 11)
                                                lled |= 0 << i;
                                        else
                                                lled |= 1 << i;
                        } else
                                lled |= 1 << i;
                }
                leddw = lled << 24 | lled << 16 | lled << 8 | lled;
                if (leddw != hc->ledstate) {
                        /* HFC_outb(hc, R_BRG_PCM_CFG, 1);
                        HFC_outb(c, R_BRG_PCM_CFG, (0x0 << 6) | 0x3); */
                        /* was _io before */
                        HFC_outb_nodebug(hc, R_BRG_PCM_CFG, 1 | V_PCM_CLK);
                        outw(0x4000, hc->pci_iobase + 4);
                        outl(leddw, hc->pci_iobase);
                        HFC_outb_nodebug(hc, R_BRG_PCM_CFG, V_PCM_CLK);
                        hc->ledstate = leddw;
                }
                break;
        }
}
/*
 * read dtmf coefficients
 */

static void
hfcmulti_dtmf(struct hfc_multi *hc)
{
        s32                *coeff;
        u_int                mantissa;
        int                co, ch;
        struct bchannel        *bch = NULL;
        u8                exponent;
        int                dtmf = 0;
        int                addr;
        u16                w_float;
        struct sk_buff        *skb;
        struct mISDNhead *hh;

        if (debug & DEBUG_HFCMULTI_DTMF)
                printk(KERN_DEBUG "%s: dtmf detection irq\n", __func__);
        for (ch = 0; ch <= 31; ch++) {
                /* only process enabled B-channels */
                bch = hc->chan[ch].bch;
                if (!bch)
                        continue;
                if (!hc->created[hc->chan[ch].port])
                        continue;
                if (!test_bit(FLG_TRANSPARENT, &bch->Flags))
                        continue;
                if (debug & DEBUG_HFCMULTI_DTMF)
                        printk(KERN_DEBUG "%s: dtmf channel %d:",
                                __func__, ch);
                coeff = &(hc->chan[ch].coeff[hc->chan[ch].coeff_count * 16]);
                dtmf = 1;
                for (co = 0; co < 8; co++) {
                        /* read W(n-1) coefficient */
                        addr = hc->DTMFbase + ((co<<7) | (ch<<2));
                        HFC_outb_nodebug(hc, R_RAM_ADDR0, addr);
                        HFC_outb_nodebug(hc, R_RAM_ADDR1, addr>>8);
                        HFC_outb_nodebug(hc, R_RAM_ADDR2, (addr>>16)
                                | V_ADDR_INC);
                        w_float = HFC_inb_nodebug(hc, R_RAM_DATA);
                        w_float |= (HFC_inb_nodebug(hc, R_RAM_DATA) << 8);
                        if (debug & DEBUG_HFCMULTI_DTMF)
                                printk(" %04x", w_float);

                        /* decode float (see chip doc) */
                        mantissa = w_float & 0x0fff;
                        if (w_float & 0x8000)
                                mantissa |= 0xfffff000;
                        exponent = (w_float>>12) & 0x7;
                        if (exponent) {
                                mantissa ^= 0x1000;
                                mantissa <<= (exponent-1);
                        }

                        /* store coefficient */
                        coeff[co<<1] = mantissa;

                        /* read W(n) coefficient */
                        w_float = HFC_inb_nodebug(hc, R_RAM_DATA);
                        w_float |= (HFC_inb_nodebug(hc, R_RAM_DATA) << 8);
                        if (debug & DEBUG_HFCMULTI_DTMF)
                                printk(" %04x", w_float);

                        /* decode float (see chip doc) */
                        mantissa = w_float & 0x0fff;
                        if (w_float & 0x8000)
                                mantissa |= 0xfffff000;
                        exponent = (w_float>>12) & 0x7;
                        if (exponent) {
                                mantissa ^= 0x1000;
                                mantissa <<= (exponent-1);
                        }

                        /* store coefficient */
                        coeff[(co<<1)|1] = mantissa;
                }
                if (debug & DEBUG_HFCMULTI_DTMF)
                        printk("%s: DTMF ready %08x %08x %08x %08x "
                            "%08x %08x %08x %08x\n", __func__,
                            coeff[0], coeff[1], coeff[2], coeff[3],
                            coeff[4], coeff[5], coeff[6], coeff[7]);
                hc->chan[ch].coeff_count++;
                if (hc->chan[ch].coeff_count == 8) {
                        hc->chan[ch].coeff_count = 0;
                        skb = mI_alloc_skb(512, GFP_ATOMIC);
                        if (!skb) {
                                printk(KERN_WARNING "%s: No memory for skb\n",
                                    __func__);
                                continue;
                        }
                        hh = mISDN_HEAD_P(skb);
                        hh->prim = PH_CONTROL_IND;
                        hh->id = DTMF_HFC_COEF;
                        memcpy(skb_put(skb, 512), hc->chan[ch].coeff, 512);
                        recv_Bchannel_skb(bch, skb);
                }
        }

        /* restart DTMF processing */
        hc->dtmf = dtmf;
        if (dtmf)
                HFC_outb_nodebug(hc, R_DTMF, hc->hw.r_dtmf | V_RST_DTMF);
}


/*
 * fill fifo as much as possible
 */

static void
hfcmulti_tx(struct hfc_multi *hc, int ch)
{
        int i, ii, temp, len = 0;
        int Zspace, z1, z2; /* must be int for calculation */
        int Fspace, f1, f2;
        u_char *d;
        int *txpending, slot_tx;
        struct        bchannel *bch;
        struct  dchannel *dch;
        struct  sk_buff **sp = NULL;
        int *idxp;

        bch = hc->chan[ch].bch;
        dch = hc->chan[ch].dch;
        if ((!dch) && (!bch))
                return;

        txpending = &hc->chan[ch].txpending;
        slot_tx = hc->chan[ch].slot_tx;
        if (dch) {
                if (!test_bit(FLG_ACTIVE, &dch->Flags))
                        return;
                sp = &dch->tx_skb;
                idxp = &dch->tx_idx;
        } else {
                if (!test_bit(FLG_ACTIVE, &bch->Flags))
                        return;
                sp = &bch->tx_skb;
                idxp = &bch->tx_idx;
        }
        if (*sp)
                len = (*sp)->len;

        if ((!len) && *txpending != 1)
                return; /* no data */

        if (test_bit(HFC_CHIP_B410P, &hc->chip) &&
            (hc->chan[ch].protocol == ISDN_P_B_RAW) &&
            (hc->chan[ch].slot_rx < 0) &&
            (hc->chan[ch].slot_tx < 0))
                HFC_outb_nodebug(hc, R_FIFO, 0x20 | (ch << 1));
        else
                HFC_outb_nodebug(hc, R_FIFO, ch << 1);
        HFC_wait_nodebug(hc);

        if (*txpending == 2) {
                /* reset fifo */
                HFC_outb_nodebug(hc, R_INC_RES_FIFO, V_RES_F);
                HFC_wait_nodebug(hc);
                HFC_outb(hc, A_SUBCH_CFG, 0);
                *txpending = 1;
        }
next_frame:
        if (dch || test_bit(FLG_HDLC, &bch->Flags)) {
                f1 = HFC_inb_nodebug(hc, A_F1);
                f2 = HFC_inb_nodebug(hc, A_F2);
                while (f2 != (temp = HFC_inb_nodebug(hc, A_F2))) {
                        if (debug & DEBUG_HFCMULTI_FIFO)
                                printk(KERN_DEBUG
                                    "%s(card %d): reread f2 because %d!=%d\n",
                                    __func__, hc->id + 1, temp, f2);
                        f2 = temp; /* repeat until F2 is equal */
                }
                Fspace = f2 - f1 - 1;
                if (Fspace < 0)
                        Fspace += hc->Flen;
                /*
                 * Old FIFO handling doesn't give us the current Z2 read
                 * pointer, so we cannot send the next frame before the fifo
                 * is empty. It makes no difference except for a slightly
                 * lower performance.
                 */
                if (test_bit(HFC_CHIP_REVISION0, &hc->chip)) {
                        if (f1 != f2)
                                Fspace = 0;
                        else
                                Fspace = 1;
                }
                /* one frame only for ST D-channels, to allow resending */
                if (hc->type != 1 && dch) {
                        if (f1 != f2)
                                Fspace = 0;
                }
                /* F-counter full condition */
                if (Fspace == 0)
                        return;
        }
        z1 = HFC_inw_nodebug(hc, A_Z1) - hc->Zmin;
        z2 = HFC_inw_nodebug(hc, A_Z2) - hc->Zmin;
        while (z2 != (temp = (HFC_inw_nodebug(hc, A_Z2) - hc->Zmin))) {
                if (debug & DEBUG_HFCMULTI_FIFO)
                        printk(KERN_DEBUG "%s(card %d): reread z2 because "
                                "%d!=%d\n", __func__, hc->id + 1, temp, z2);
                z2 = temp; /* repeat unti Z2 is equal */
        }
        Zspace = z2 - z1;
        if (Zspace <= 0)
                Zspace += hc->Zlen;
        Zspace -= 4; /* keep not too full, so pointers will not overrun */
        /* fill transparent data only to maxinum transparent load (minus 4) */
        if (bch && test_bit(FLG_TRANSPARENT, &bch->Flags))
                Zspace = Zspace - hc->Zlen + hc->max_trans;
        if (Zspace <= 0) /* no space of 4 bytes */
                return;

        /* if no data */
        if (!len) {
                if (z1 == z2) { /* empty */
                        /* if done with FIFO audio data during PCM connection */
                        if (bch && (!test_bit(FLG_HDLC, &bch->Flags)) &&
                            *txpending && slot_tx >= 0) {
                                if (debug & DEBUG_HFCMULTI_MODE)
                                        printk(KERN_DEBUG
                                            "%s: reconnecting PCM due to no "
                                            "more FIFO data: channel %d "
                                            "slot_tx %d\n",
                                            __func__, ch, slot_tx);
                                /* connect slot */
                                HFC_outb(hc, A_CON_HDLC, 0xc0 | 0x00 |
                                    V_HDLC_TRP | V_IFF);
                                HFC_outb_nodebug(hc, R_FIFO, ch<<1 | 1);
                                HFC_wait_nodebug(hc);
                                HFC_outb(hc, A_CON_HDLC, 0xc0 | 0x00 |
                                    V_HDLC_TRP | V_IFF);
                                HFC_outb_nodebug(hc, R_FIFO, ch<<1);
                                HFC_wait_nodebug(hc);
                        }
                        *txpending = 0;
                }
                return; /* no data */
        }

        /* if audio data and connected slot */
        if (bch && (!test_bit(FLG_HDLC, &bch->Flags)) && (!*txpending)
                && slot_tx >= 0) {
                if (debug & DEBUG_HFCMULTI_MODE)
                        printk(KERN_DEBUG "%s: disconnecting PCM due to "
                            "FIFO data: channel %d slot_tx %d\n",
                            __func__, ch, slot_tx);
                /* disconnect slot */
                HFC_outb(hc, A_CON_HDLC, 0x80 | 0x00 | V_HDLC_TRP | V_IFF);
                HFC_outb_nodebug(hc, R_FIFO, ch<<1 | 1);
                HFC_wait_nodebug(hc);
                HFC_outb(hc, A_CON_HDLC, 0x80 | 0x00 | V_HDLC_TRP | V_IFF);
                HFC_outb_nodebug(hc, R_FIFO, ch<<1);
                HFC_wait_nodebug(hc);
        }
        *txpending = 1;

        /* show activity */
        hc->activity[hc->chan[ch].port] = 1;

        /* fill fifo to what we have left */
        ii = len;
        if (dch || test_bit(FLG_HDLC, &bch->Flags))
                temp = 1;
        else
                temp = 0;
        i = *idxp;
        d = (*sp)->data + i;
        if (ii - i > Zspace)
                ii = Zspace + i;
        if (debug & DEBUG_HFCMULTI_FIFO)
                printk(KERN_DEBUG "%s(card %d): fifo(%d) has %d bytes space "
                    "left (z1=%04x, z2=%04x) sending %d of %d bytes %s\n",
                        __func__, hc->id + 1, ch, Zspace, z1, z2, ii-i, len-i,
                        temp ? "HDLC":"TRANS");


        /* Have to prep the audio data */
        hc->write_fifo(hc, d, ii - i);
        *idxp = ii;

        /* if not all data has been written */
        if (ii != len) {
                /* NOTE: fifo is started by the calling function */
                return;
        }

        /* if all data has been written, terminate frame */
        if (dch || test_bit(FLG_HDLC, &bch->Flags)) {
                /* increment f-counter */
                HFC_outb_nodebug(hc, R_INC_RES_FIFO, V_INC_F);
                HFC_wait_nodebug(hc);
        }

        /* send confirm, since get_net_bframe will not do it with trans */
        if (bch && test_bit(FLG_TRANSPARENT, &bch->Flags))
                confirm_Bsend(bch);

        /* check for next frame */
        dev_kfree_skb(*sp);
        if (bch && get_next_bframe(bch)) { /* hdlc is confirmed here */
                len = (*sp)->len;
                goto next_frame;
        }
        if (dch && get_next_dframe(dch)) {
                len = (*sp)->len;
                goto next_frame;
        }

        /*
         * now we have no more data, so in case of transparent,
         * we set the last byte in fifo to 'silence' in case we will get
         * no more data at all. this prevents sending an undefined value.
         */
        if (bch && test_bit(FLG_TRANSPARENT, &bch->Flags))
                HFC_outb_nodebug(hc, A_FIFO_DATA0_NOINC, silence);
}


/* NOTE: only called if E1 card is in active state */
static void
hfcmulti_rx(struct hfc_multi *hc, int ch)
{
        int temp;
        int Zsize, z1, z2 = 0; /* = 0, to make GCC happy */
        int f1 = 0, f2 = 0; /* = 0, to make GCC happy */
        int again = 0;
        struct        bchannel *bch;
        struct  dchannel *dch;
        struct sk_buff        *skb, **sp = NULL;
        int        maxlen;

        bch = hc->chan[ch].bch;
        dch = hc->chan[ch].dch;
        if ((!dch) && (!bch))
                return;
        if (dch) {
                if (!test_bit(FLG_ACTIVE, &dch->Flags))
                        return;
                sp = &dch->rx_skb;
                maxlen = dch->maxlen;
        } else {
                if (!test_bit(FLG_ACTIVE, &bch->Flags))
                        return;
                sp = &bch->rx_skb;
                maxlen = bch->maxlen;
        }
next_frame:
        /* on first AND before getting next valid frame, R_FIFO must be written
           to. */
        if (test_bit(HFC_CHIP_B410P, &hc->chip) &&
            (hc->chan[ch].protocol == ISDN_P_B_RAW) &&
            (hc->chan[ch].slot_rx < 0) &&
            (hc->chan[ch].slot_tx < 0))
                HFC_outb_nodebug(hc, R_FIFO, 0x20 | (ch<<1) | 1);
        else
                HFC_outb_nodebug(hc, R_FIFO, (ch<<1)|1);
        HFC_wait_nodebug(hc);

        /* ignore if rx is off BUT change fifo (above) to start pending TX */
        if (hc->chan[ch].rx_off)
                return;

        if (dch || test_bit(FLG_HDLC, &bch->Flags)) {
                f1 = HFC_inb_nodebug(hc, A_F1);
                while (f1 != (temp = HFC_inb_nodebug(hc, A_F1))) {
                        if (debug & DEBUG_HFCMULTI_FIFO)
                                printk(KERN_DEBUG
                                    "%s(card %d): reread f1 because %d!=%d\n",
                                    __func__, hc->id + 1, temp, f1);
                        f1 = temp; /* repeat until F1 is equal */
                }
                f2 = HFC_inb_nodebug(hc, A_F2);
        }
        z1 = HFC_inw_nodebug(hc, A_Z1) - hc->Zmin;
        while (z1 != (temp = (HFC_inw_nodebug(hc, A_Z1) - hc->Zmin))) {
                if (debug & DEBUG_HFCMULTI_FIFO)
                        printk(KERN_DEBUG "%s(card %d): reread z2 because "
                                "%d!=%d\n", __func__, hc->id + 1, temp, z2);
                z1 = temp; /* repeat until Z1 is equal */
        }
        z2 = HFC_inw_nodebug(hc, A_Z2) - hc->Zmin;
        Zsize = z1 - z2;
        if ((dch || test_bit(FLG_HDLC, &bch->Flags)) && f1 != f2)
                /* complete hdlc frame */
                Zsize++;
        if (Zsize < 0)
                Zsize += hc->Zlen;
        /* if buffer is empty */
        if (Zsize <= 0)
                return;

        if (*sp == NULL) {
                *sp = mI_alloc_skb(maxlen + 3, GFP_ATOMIC);
                if (*sp == NULL) {
                        printk(KERN_DEBUG "%s: No mem for rx_skb\n",
                            __func__);
                        return;
                }
        }
        /* show activity */
        hc->activity[hc->chan[ch].port] = 1;

        /* empty fifo with what we have */
        if (dch || test_bit(FLG_HDLC, &bch->Flags)) {
                if (debug & DEBUG_HFCMULTI_FIFO)
                        printk(KERN_DEBUG "%s(card %d): fifo(%d) reading %d "
                            "bytes (z1=%04x, z2=%04x) HDLC %s (f1=%d, f2=%d) "
                            "got=%d (again %d)\n", __func__, hc->id + 1, ch,
                            Zsize, z1, z2, (f1 == f2) ? "fragment" : "COMPLETE",
                            f1, f2, Zsize + (*sp)->len, again);
                /* HDLC */
                if ((Zsize + (*sp)->len) > (maxlen + 3)) {
                        if (debug & DEBUG_HFCMULTI_FIFO)
                                printk(KERN_DEBUG
                                    "%s(card %d): hdlc-frame too large.\n",
                                    __func__, hc->id + 1);
                        skb_trim(*sp, 0);
                        HFC_outb_nodebug(hc, R_INC_RES_FIFO, V_RES_F);
                        HFC_wait_nodebug(hc);
                        return;
                }

                hc->read_fifo(hc, skb_put(*sp, Zsize), Zsize);

                if (f1 != f2) {
                        /* increment Z2,F2-counter */
                        HFC_outb_nodebug(hc, R_INC_RES_FIFO, V_INC_F);
                        HFC_wait_nodebug(hc);
                        /* check size */
                        if ((*sp)->len < 4) {
                                if (debug & DEBUG_HFCMULTI_FIFO)
                                        printk(KERN_DEBUG
                                            "%s(card %d): Frame below minimum "
                                            "size\n", __func__, hc->id + 1);
                                skb_trim(*sp, 0);
                                goto next_frame;
                        }
                        /* there is at least one complete frame, check crc */
                        if ((*sp)->data[(*sp)->len - 1]) {
                                if (debug & DEBUG_HFCMULTI_CRC)
                                        printk(KERN_DEBUG
                                            "%s: CRC-error\n", __func__);
                                skb_trim(*sp, 0);
                                goto next_frame;
                        }
                        skb_trim(*sp, (*sp)->len - 3);
                        if ((*sp)->len < MISDN_COPY_SIZE) {
                                skb = *sp;
                                *sp = mI_alloc_skb(skb->len, GFP_ATOMIC);
                                if (*sp) {
                                        memcpy(skb_put(*sp, skb->len),
                                            skb->data, skb->len);
                                        skb_trim(skb, 0);
                                } else {
                                        printk(KERN_DEBUG "%s: No mem\n",
                                            __func__);
                                        *sp = skb;
                                        skb = NULL;
                                }
                        } else {
                                skb = NULL;
                        }
                        if (debug & DEBUG_HFCMULTI_FIFO) {
                                printk(KERN_DEBUG "%s(card %d):",
                                        __func__, hc->id + 1);
                                temp = 0;
                                while (temp < (*sp)->len)
                                        printk(" %02x", (*sp)->data[temp++]);
                                printk("\n");
                        }
                        if (dch)
                                recv_Dchannel(dch);
                        else
                                recv_Bchannel(bch);
                        *sp = skb;
                        again++;
                        goto next_frame;
                }
                /* there is an incomplete frame */
        } else {
                /* transparent */
                if (Zsize > skb_tailroom(*sp))
                        Zsize = skb_tailroom(*sp);
                hc->read_fifo(hc, skb_put(*sp, Zsize), Zsize);
                if (((*sp)->len) < MISDN_COPY_SIZE) {
                        skb = *sp;
                        *sp = mI_alloc_skb(skb->len, GFP_ATOMIC);
                        if (*sp) {
                                memcpy(skb_put(*sp, skb->len),
                                    skb->data, skb->len);
                                skb_trim(skb, 0);
                        } else {
                                printk(KERN_DEBUG "%s: No mem\n", __func__);
                                *sp = skb;
                                skb = NULL;
                        }
                } else {
                        skb = NULL;
                }
                if (debug & DEBUG_HFCMULTI_FIFO)
                        printk(KERN_DEBUG
                            "%s(card %d): fifo(%d) reading %d bytes "
                            "(z1=%04x, z2=%04x) TRANS\n",
                                __func__, hc->id + 1, ch, Zsize, z1, z2);
                /* only bch is transparent */
                recv_Bchannel(bch);
                *sp = skb;
        }
}


/*
 * Interrupt handler
 */
static void
signal_state_up(struct dchannel *dch, int info, char *msg)
{
        struct sk_buff        *skb;
        int                id, data = info;

        if (debug & DEBUG_HFCMULTI_STATE)
                printk(KERN_DEBUG "%s: %s\n", __func__, msg);

        id = TEI_SAPI | (GROUP_TEI << 8); /* manager address */

        skb = _alloc_mISDN_skb(MPH_INFORMATION_IND, id, sizeof(data), &data,
                GFP_ATOMIC);
        if (!skb)
                return;
        recv_Dchannel_skb(dch, skb);
}

static inline void
handle_timer_irq(struct hfc_multi *hc)
{
        int                ch, temp;
        struct dchannel        *dch;
        u_long                flags;

        /* process queued resync jobs */
        if (hc->e1_resync) {
                /* lock, so e1_resync gets not changed */
                spin_lock_irqsave(&HFClock, flags);
                if (hc->e1_resync & 1) {
                        if (debug & DEBUG_HFCMULTI_PLXSD)
                                printk(KERN_DEBUG "Enable SYNC_I\n");
                        HFC_outb(hc, R_SYNC_CTRL, V_EXT_CLK_SYNC);
                        /* disable JATT, if RX_SYNC is set */
                        if (test_bit(HFC_CHIP_RX_SYNC, &hc->chip))
                                HFC_outb(hc, R_SYNC_OUT, V_SYNC_E1_RX);
                }
                if (hc->e1_resync & 2) {
                        if (debug & DEBUG_HFCMULTI_PLXSD)
                                printk(KERN_DEBUG "Enable jatt PLL\n");
                        HFC_outb(hc, R_SYNC_CTRL, V_SYNC_OFFS);
                }
                if (hc->e1_resync & 4) {
                        if (debug & DEBUG_HFCMULTI_PLXSD)
                                printk(KERN_DEBUG
                                    "Enable QUARTZ for HFC-E1\n");
                        /* set jatt to quartz */
                        HFC_outb(hc, R_SYNC_CTRL, V_EXT_CLK_SYNC
                                | V_JATT_OFF);
                        /* switch to JATT, in case it is not already */
                        HFC_outb(hc, R_SYNC_OUT, 0);
                }
                hc->e1_resync = 0;
                spin_unlock_irqrestore(&HFClock, flags);
        }

        if (hc->type != 1 || hc->e1_state == 1)
                for (ch = 0; ch <= 31; ch++) {
                        if (hc->created[hc->chan[ch].port]) {
                                hfcmulti_tx(hc, ch);
                                /* fifo is started when switching to rx-fifo */
                                hfcmulti_rx(hc, ch);
                                if (hc->chan[ch].dch &&
                                    hc->chan[ch].nt_timer > -1) {
                                        dch = hc->chan[ch].dch;
                                        if (!(--hc->chan[ch].nt_timer)) {
                                                schedule_event(dch,
                                                    FLG_PHCHANGE);
                                                if (debug &
                                                    DEBUG_HFCMULTI_STATE)
                                                        printk(KERN_DEBUG
                                                            "%s: nt_timer at "
                                                            "state %x\n",
                                                            __func__,
                                                            dch->state);
                                        }
                                }
                        }
                }
        if (hc->type == 1 && hc->created[0]) {
                dch = hc->chan[hc->dslot].dch;
                if (test_bit(HFC_CFG_REPORT_LOS, &hc->chan[hc->dslot].cfg)) {
                        /* LOS */
                        temp = HFC_inb_nodebug(hc, R_SYNC_STA) & V_SIG_LOS;
                        if (!temp && hc->chan[hc->dslot].los)
                                signal_state_up(dch, L1_SIGNAL_LOS_ON,
                                    "LOS detected");
                        if (temp && !hc->chan[hc->dslot].los)
                                signal_state_up(dch, L1_SIGNAL_LOS_OFF,
                                    "LOS gone");
                        hc->chan[hc->dslot].los = temp;
                }
                if (test_bit(HFC_CFG_REPORT_AIS, &hc->chan[hc->dslot].cfg)) {
                        /* AIS */
                        temp = HFC_inb_nodebug(hc, R_SYNC_STA) & V_AIS;
                        if (!temp && hc->chan[hc->dslot].ais)
                                signal_state_up(dch, L1_SIGNAL_AIS_ON,
                                    "AIS detected");
                        if (temp && !hc->chan[hc->dslot].ais)
                                signal_state_up(dch, L1_SIGNAL_AIS_OFF,
                                    "AIS gone");
                        hc->chan[hc->dslot].ais = temp;
                }
                if (test_bit(HFC_CFG_REPORT_SLIP, &hc->chan[hc->dslot].cfg)) {
                        /* SLIP */
                        temp = HFC_inb_nodebug(hc, R_SLIP) & V_FOSLIP_RX;
                        if (!temp && hc->chan[hc->dslot].slip_rx)
                                signal_state_up(dch, L1_SIGNAL_SLIP_RX,
                                    " bit SLIP detected RX");
                        hc->chan[hc->dslot].slip_rx = temp;
                        temp = HFC_inb_nodebug(hc, R_SLIP) & V_FOSLIP_TX;
                        if (!temp && hc->chan[hc->dslot].slip_tx)
                                signal_state_up(dch, L1_SIGNAL_SLIP_TX,
                                    " bit SLIP detected TX");
                        hc->chan[hc->dslot].slip_tx = temp;
                }
                if (test_bit(HFC_CFG_REPORT_RDI, &hc->chan[hc->dslot].cfg)) {
                        /* RDI */
                        temp = HFC_inb_nodebug(hc, R_RX_SL0_0) & V_A;
                        if (!temp && hc->chan[hc->dslot].rdi)
                                signal_state_up(dch, L1_SIGNAL_RDI_ON,
                                    "RDI detected");
                        if (temp && !hc->chan[hc->dslot].rdi)
                                signal_state_up(dch, L1_SIGNAL_RDI_OFF,
                                    "RDI gone");
                        hc->chan[hc->dslot].rdi = temp;
                }
                temp = HFC_inb_nodebug(hc, R_JATT_DIR);
                switch (hc->chan[hc->dslot].sync) {
                case 0:
                        if ((temp & 0x60) == 0x60) {
                                if (debug & DEBUG_HFCMULTI_SYNC)
                                        printk(KERN_DEBUG
                                            "%s: (id=%d) E1 now "
                                            "in clock sync\n",
                                            __func__, hc->id);
                                HFC_outb(hc, R_RX_OFF,
                                    hc->chan[hc->dslot].jitter | V_RX_INIT);
                                HFC_outb(hc, R_TX_OFF,
                                    hc->chan[hc->dslot].jitter | V_RX_INIT);
                                hc->chan[hc->dslot].sync = 1;
                                goto check_framesync;
                        }
                        break;
                case 1:
                        if ((temp & 0x60) != 0x60) {
                                if (debug & DEBUG_HFCMULTI_SYNC)
                                        printk(KERN_DEBUG
                                            "%s: (id=%d) E1 "
                                            "lost clock sync\n",
                                            __func__, hc->id);
                                hc->chan[hc->dslot].sync = 0;
                                break;
                        }
check_framesync:
                        temp = HFC_inb_nodebug(hc, R_SYNC_STA);
                        if (temp == 0x27) {
                                if (debug & DEBUG_HFCMULTI_SYNC)
                                        printk(KERN_DEBUG
                                            "%s: (id=%d) E1 "
                                            "now in frame sync\n",
                                            __func__, hc->id);
                                hc->chan[hc->dslot].sync = 2;
                        }
                        break;
                case 2:
                        if ((temp & 0x60) != 0x60) {
                                if (debug & DEBUG_HFCMULTI_SYNC)
                                        printk(KERN_DEBUG
                                            "%s: (id=%d) E1 lost "
                                            "clock & frame sync\n",
                                            __func__, hc->id);
                                hc->chan[hc->dslot].sync = 0;
                                break;
                        }
                        temp = HFC_inb_nodebug(hc, R_SYNC_STA);
                        if (temp != 0x27) {
                                if (debug & DEBUG_HFCMULTI_SYNC)
                                        printk(KERN_DEBUG
                                            "%s: (id=%d) E1 "
                                            "lost frame sync\n",
                                            __func__, hc->id);
                                hc->chan[hc->dslot].sync = 1;
                        }
                        break;
                }
        }

        if (test_bit(HFC_CHIP_WATCHDOG, &hc->chip))
                hfcmulti_watchdog(hc);

        if (hc->leds)
                hfcmulti_leds(hc);
}

static void
ph_state_irq(struct hfc_multi *hc, u_char r_irq_statech)
{
        struct dchannel        *dch;
        int                ch;
        int                active;
        u_char                st_status, temp;

        /* state machine */
        for (ch = 0; ch <= 31; ch++) {
                if (hc->chan[ch].dch) {
                        dch = hc->chan[ch].dch;
                        if (r_irq_statech & 1) {
                                HFC_outb_nodebug(hc, R_ST_SEL,
                                        hc->chan[ch].port);
                                /* undocumented: delay after R_ST_SEL */
                                udelay(1);
                                /* undocumented: status changes during read */
                                st_status = HFC_inb_nodebug(hc, A_ST_RD_STATE);
                                while (st_status != (temp =
                                        HFC_inb_nodebug(hc, A_ST_RD_STATE))) {
                                        if (debug & DEBUG_HFCMULTI_STATE)
                                                printk(KERN_DEBUG "%s: reread "
                                                    "STATE because %d!=%d\n",
                                                    __func__, temp,
                                                    st_status);
                                        st_status = temp; /* repeat */
                                }

                                /* Speech Design TE-sync indication */
                                if (test_bit(HFC_CHIP_PLXSD, &hc->chip) &&
                                        dch->dev.D.protocol == ISDN_P_TE_S0) {
                                        if (st_status & V_FR_SYNC_ST)
                                                hc->syncronized |=
                                                    (1 << hc->chan[ch].port);
                                        else
                                                hc->syncronized &=
                                                   ~(1 << hc->chan[ch].port);
                                }
                                dch->state = st_status & 0x0f;
                                if (dch->dev.D.protocol == ISDN_P_NT_S0)
                                        active = 3;
                                else
                                        active = 7;
                                if (dch->state == active) {
                                        HFC_outb_nodebug(hc, R_FIFO,
                                                (ch << 1) | 1);
                                        HFC_wait_nodebug(hc);
                                        HFC_outb_nodebug(hc,
                                                R_INC_RES_FIFO, V_RES_F);
                                        HFC_wait_nodebug(hc);
                                        dch->tx_idx = 0;
                                }
                                schedule_event(dch, FLG_PHCHANGE);
                                if (debug & DEBUG_HFCMULTI_STATE)
                                        printk(KERN_DEBUG
                                            "%s: S/T newstate %x port %d\n",
                                            __func__, dch->state,
                                            hc->chan[ch].port);
                        }
                        r_irq_statech >>= 1;
                }
        }
        if (test_bit(HFC_CHIP_PLXSD, &hc->chip))
                plxsd_checksync(hc, 0);
}

static void
fifo_irq(struct hfc_multi *hc, int block)
{
        int        ch, j;
        struct dchannel        *dch;
        struct bchannel        *bch;
        u_char r_irq_fifo_bl;

        r_irq_fifo_bl = HFC_inb_nodebug(hc, R_IRQ_FIFO_BL0 + block);
        j = 0;
        while (j < 8) {
                ch = (block << 2) + (j >> 1);
                dch = hc->chan[ch].dch;
                bch = hc->chan[ch].bch;
                if (((!dch) && (!bch)) || (!hc->created[hc->chan[ch].port])) {
                        j += 2;
                        continue;
                }
                if (dch && (r_irq_fifo_bl & (1 << j)) &&
                    test_bit(FLG_ACTIVE, &dch->Flags)) {
                        hfcmulti_tx(hc, ch);
                        /* start fifo */
                        HFC_outb_nodebug(hc, R_FIFO, 0);
                        HFC_wait_nodebug(hc);
                }
                if (bch && (r_irq_fifo_bl & (1 << j)) &&
                    test_bit(FLG_ACTIVE, &bch->Flags)) {
                        hfcmulti_tx(hc, ch);
                        /* start fifo */
                        HFC_outb_nodebug(hc, R_FIFO, 0);
                        HFC_wait_nodebug(hc);
                }
                j++;
                if (dch && (r_irq_fifo_bl & (1 << j)) &&
                    test_bit(FLG_ACTIVE, &dch->Flags)) {
                        hfcmulti_rx(hc, ch);
                }
                if (bch && (r_irq_fifo_bl & (1 << j)) &&
                    test_bit(FLG_ACTIVE, &bch->Flags)) {
                        hfcmulti_rx(hc, ch);
                }
                j++;
        }
}

#ifdef IRQ_DEBUG
int irqsem;
#endif
static irqreturn_t
hfcmulti_interrupt(int intno, void *dev_id)
{
#ifdef IRQCOUNT_DEBUG
        static int iq1 = 0, iq2 = 0, iq3 = 0, iq4 = 0,
            iq5 = 0, iq6 = 0, iqcnt = 0;
#endif
        static int                count;
        struct hfc_multi        *hc = dev_id;
        struct dchannel                *dch;
        u_char                        r_irq_statech, status, r_irq_misc, r_irq_oview;
        int                        i;
        u_short                        *plx_acc, wval;
        u_char                        e1_syncsta, temp;
        u_long                        flags;

        if (!hc) {
                printk(KERN_ERR "HFC-multi: Spurious interrupt!\n");
                return IRQ_NONE;
        }

        spin_lock(&hc->lock);

#ifdef IRQ_DEBUG
        if (irqsem)
                printk(KERN_ERR "irq for card %d during irq from "
                "card %d, this is no bug.\n", hc->id + 1, irqsem);
        irqsem = hc->id + 1;
#endif

        if (test_bit(HFC_CHIP_PLXSD, &hc->chip)) {
                spin_lock_irqsave(&plx_lock, flags);
                plx_acc = (u_short *)(hc->plx_membase + PLX_INTCSR);
                wval = readw(plx_acc);
                spin_unlock_irqrestore(&plx_lock, flags);
                if (!(wval & PLX_INTCSR_LINTI1_STATUS))
                        goto irq_notforus;
        }

        status = HFC_inb_nodebug(hc, R_STATUS);
        r_irq_statech = HFC_inb_nodebug(hc, R_IRQ_STATECH);
#ifdef IRQCOUNT_DEBUG
        if (r_irq_statech)
                iq1++;
        if (status & V_DTMF_STA)
                iq2++;
        if (status & V_LOST_STA)
                iq3++;
        if (status & V_EXT_IRQSTA)
                iq4++;
        if (status & V_MISC_IRQSTA)
                iq5++;
        if (status & V_FR_IRQSTA)
                iq6++;
        if (iqcnt++ > 5000) {
                printk(KERN_ERR "iq1:%x iq2:%x iq3:%x iq4:%x iq5:%x iq6:%x\n",
                    iq1, iq2, iq3, iq4, iq5, iq6);
                iqcnt = 0;
        }
#endif
        if (!r_irq_statech &&
            !(status & (V_DTMF_STA | V_LOST_STA | V_EXT_IRQSTA |
            V_MISC_IRQSTA | V_FR_IRQSTA))) {
                /* irq is not for us */
                goto irq_notforus;
        }
        hc->irqcnt++;
        if (r_irq_statech) {
                if (hc->type != 1)
                        ph_state_irq(hc, r_irq_statech);
        }
        if (status & V_EXT_IRQSTA)
                ; /* external IRQ */
        if (status & V_LOST_STA) {
                /* LOST IRQ */
                HFC_outb(hc, R_INC_RES_FIFO, V_RES_LOST); /* clear irq! */
        }
        if (status & V_MISC_IRQSTA) {
                /* misc IRQ */
                r_irq_misc = HFC_inb_nodebug(hc, R_IRQ_MISC);
                if (r_irq_misc & V_STA_IRQ) {
                        if (hc->type == 1) {
                                /* state machine */
                                dch = hc->chan[hc->dslot].dch;
                                e1_syncsta = HFC_inb_nodebug(hc, R_SYNC_STA);
                                if (test_bit(HFC_CHIP_PLXSD, &hc->chip)
                                 && hc->e1_getclock) {
                                        if (e1_syncsta & V_FR_SYNC_E1)
                                                hc->syncronized = 1;
                                        else
                                                hc->syncronized = 0;
                                }
                                /* undocumented: status changes during read */
                                dch->state = HFC_inb_nodebug(hc, R_E1_RD_STA);
                                while (dch->state != (temp =
                                        HFC_inb_nodebug(hc, R_E1_RD_STA))) {
                                        if (debug & DEBUG_HFCMULTI_STATE)
                                                printk(KERN_DEBUG "%s: reread "
                                                    "STATE because %d!=%d\n",
                                                    __func__, temp,
                                                    dch->state);
                                        dch->state = temp; /* repeat */
                                }
                                dch->state = HFC_inb_nodebug(hc, R_E1_RD_STA)
                                        & 0x7;
                                schedule_event(dch, FLG_PHCHANGE);
                                if (debug & DEBUG_HFCMULTI_STATE)
                                        printk(KERN_DEBUG
                                            "%s: E1 (id=%d) newstate %x\n",
                                            __func__, hc->id, dch->state);
                                if (test_bit(HFC_CHIP_PLXSD, &hc->chip))
                                        plxsd_checksync(hc, 0);
                        }
                }
                if (r_irq_misc & V_TI_IRQ)
                        handle_timer_irq(hc);

                if (r_irq_misc & V_DTMF_IRQ) {
                        /* -> DTMF IRQ */
                        hfcmulti_dtmf(hc);
                }
                /* TODO: REPLACE !!!! 125 us Interrupts are not acceptable  */
                if (r_irq_misc & V_IRQ_PROC) {
                        /* IRQ every 125us */
                        count++;
                        /* generate 1kHz signal */
                        if (count == 8) {
                                if (hfc_interrupt)
                                        hfc_interrupt();
                                count = 0;
                        }
                }

        }
        if (status & V_FR_IRQSTA) {
                /* FIFO IRQ */
                r_irq_oview = HFC_inb_nodebug(hc, R_IRQ_OVIEW);
                for (i = 0; i < 8; i++) {
                        if (r_irq_oview & (1 << i))
                                fifo_irq(hc, i);
                }
        }

#ifdef IRQ_DEBUG
        irqsem = 0;
#endif
        spin_unlock(&hc->lock);
        return IRQ_HANDLED;

irq_notforus:
#ifdef IRQ_DEBUG
        irqsem = 0;
#endif
        spin_unlock(&hc->lock);
        return IRQ_NONE;
}


/*
 * timer callback for D-chan busy resolution. Currently no function
 */

static void
hfcmulti_dbusy_timer(struct hfc_multi *hc)
{
}


/*
 * activate/deactivate hardware for selected channels and mode
 *
 * configure B-channel with the given protocol
 * ch eqals to the HFC-channel (0-31)
 * ch is the number of channel (0-4,4-7,8-11,12-15,16-19,20-23,24-27,28-31
 * for S/T, 1-31 for E1)
 * the hdlc interrupts will be set/unset
 */
static int
mode_hfcmulti(struct hfc_multi *hc, int ch, int protocol, int slot_tx,
    int bank_tx, int slot_rx, int bank_rx)
{
        int flow_tx = 0, flow_rx = 0, routing = 0;
        int oslot_tx, oslot_rx;
        int conf;

        if (ch < 0 || ch > 31)
                return EINVAL;
        oslot_tx = hc->chan[ch].slot_tx;
        oslot_rx = hc->chan[ch].slot_rx;
        conf = hc->chan[ch].conf;

        if (debug & DEBUG_HFCMULTI_MODE)
                printk(KERN_DEBUG
                    "%s: card %d channel %d protocol %x slot old=%d new=%d "
                    "bank new=%d (TX) slot old=%d new=%d bank new=%d (RX)\n",
                    __func__, hc->id, ch, protocol, oslot_tx, slot_tx,
                    bank_tx, oslot_rx, slot_rx, bank_rx);

        if (oslot_tx >= 0 && slot_tx != oslot_tx) {
                /* remove from slot */
                if (debug & DEBUG_HFCMULTI_MODE)
                        printk(KERN_DEBUG "%s: remove from slot %d (TX)\n",
                            __func__, oslot_tx);
                if (hc->slot_owner[oslot_tx<<1] == ch) {
                        HFC_outb(hc, R_SLOT, oslot_tx << 1);
                        HFC_outb(hc, A_SL_CFG, 0);
                        HFC_outb(hc, A_CONF, 0);
                        hc->slot_owner[oslot_tx<<1] = -1;
                } else {
                        if (debug & DEBUG_HFCMULTI_MODE)
                                printk(KERN_DEBUG
                                    "%s: we are not owner of this tx slot "
                                    "anymore, channel %d is.\n",
                                    __func__, hc->slot_owner[oslot_tx<<1]);
                }
        }

        if (oslot_rx >= 0 && slot_rx != oslot_rx) {
                /* remove from slot */
                if (debug & DEBUG_HFCMULTI_MODE)
                        printk(KERN_DEBUG
                            "%s: remove from slot %d (RX)\n",
                            __func__, oslot_rx);
                if (hc->slot_owner[(oslot_rx << 1) | 1] == ch) {
                        HFC_outb(hc, R_SLOT, (oslot_rx << 1) | V_SL_DIR);
                        HFC_outb(hc, A_SL_CFG, 0);
                        hc->slot_owner[(oslot_rx << 1) | 1] = -1;
                } else {
                        if (debug & DEBUG_HFCMULTI_MODE)
                                printk(KERN_DEBUG
                                    "%s: we are not owner of this rx slot "
                                    "anymore, channel %d is.\n",
                                    __func__,
                                    hc->slot_owner[(oslot_rx << 1) | 1]);
                }
        }

        if (slot_tx < 0) {
                flow_tx = 0x80; /* FIFO->ST */
                /* disable pcm slot */
                hc->chan[ch].slot_tx = -1;
                hc->chan[ch].bank_tx = 0;
        } else {
                /* set pcm slot */
                if (hc->chan[ch].txpending)
                        flow_tx = 0x80; /* FIFO->ST */
                else
                        flow_tx = 0xc0; /* PCM->ST */
                /* put on slot */
                routing = bank_tx ? 0xc0 : 0x80;
                if (conf >= 0 || bank_tx > 1)
                        routing = 0x40; /* loop */
                if (debug & DEBUG_HFCMULTI_MODE)
                        printk(KERN_DEBUG "%s: put channel %d to slot %d bank"
                            " %d flow %02x routing %02x conf %d (TX)\n",
                            __func__, ch, slot_tx, bank_tx,
                            flow_tx, routing, conf);
                HFC_outb(hc, R_SLOT, slot_tx << 1);
                HFC_outb(hc, A_SL_CFG, (ch<<1) | routing);
                HFC_outb(hc, A_CONF, (conf < 0) ? 0 : (conf | V_CONF_SL));
                hc->slot_owner[slot_tx << 1] = ch;
                hc->chan[ch].slot_tx = slot_tx;
                hc->chan[ch].bank_tx = bank_tx;
        }
        if (slot_rx < 0) {
                /* disable pcm slot */
                flow_rx = 0x80; /* ST->FIFO */
                hc->chan[ch].slot_rx = -1;
                hc->chan[ch].bank_rx = 0;
        } else {
                /* set pcm slot */
                if (hc->chan[ch].txpending)
                        flow_rx = 0x80; /* ST->FIFO */
                else
                        flow_rx = 0xc0; /* ST->(FIFO,PCM) */
                /* put on slot */
                routing = bank_rx?0x80:0xc0; /* reversed */
                if (conf >= 0 || bank_rx > 1)
                        routing = 0x40; /* loop */
                if (debug & DEBUG_HFCMULTI_MODE)
                        printk(KERN_DEBUG "%s: put channel %d to slot %d bank"
                            " %d flow %02x routing %02x conf %d (RX)\n",
                            __func__, ch, slot_rx, bank_rx,
                            flow_rx, routing, conf);
                HFC_outb(hc, R_SLOT, (slot_rx<<1) | V_SL_DIR);
                HFC_outb(hc, A_SL_CFG, (ch<<1) | V_CH_DIR | routing);
                hc->slot_owner[(slot_rx<<1)|1] = ch;
                hc->chan[ch].slot_rx = slot_rx;
                hc->chan[ch].bank_rx = bank_rx;
        }

        switch (protocol) {
        case (ISDN_P_NONE):
                /* disable TX fifo */
                HFC_outb(hc, R_FIFO, ch << 1);
                HFC_wait(hc);
                HFC_outb(hc, A_CON_HDLC, flow_tx | 0x00 | V_IFF);
                HFC_outb(hc, A_SUBCH_CFG, 0);
                HFC_outb(hc, A_IRQ_MSK, 0);
                HFC_outb(hc, R_INC_RES_FIFO, V_RES_F);
                HFC_wait(hc);
                /* disable RX fifo */
                HFC_outb(hc, R_FIFO, (ch<<1)|1);
                HFC_wait(hc);
                HFC_outb(hc, A_CON_HDLC, flow_rx | 0x00);
                HFC_outb(hc, A_SUBCH_CFG, 0);
                HFC_outb(hc, A_IRQ_MSK, 0);
                HFC_outb(hc, R_INC_RES_FIFO, V_RES_F);
                HFC_wait(hc);
                if (hc->chan[ch].bch && hc->type != 1) {
                        hc->hw.a_st_ctrl0[hc->chan[ch].port] &=
                            ((ch & 0x3) == 0)? ~V_B1_EN: ~V_B2_EN;
                        HFC_outb(hc, R_ST_SEL, hc->chan[ch].port);
                        /* undocumented: delay after R_ST_SEL */
                        udelay(1);
                        HFC_outb(hc, A_ST_CTRL0,
                            hc->hw.a_st_ctrl0[hc->chan[ch].port]);
                }
                if (hc->chan[ch].bch) {
                        test_and_clear_bit(FLG_HDLC, &hc->chan[ch].bch->Flags);
                        test_and_clear_bit(FLG_TRANSPARENT,
                            &hc->chan[ch].bch->Flags);
                }
                break;
        case (ISDN_P_B_RAW): /* B-channel */

                if (test_bit(HFC_CHIP_B410P, &hc->chip) &&
                    (hc->chan[ch].slot_rx < 0) &&
                    (hc->chan[ch].slot_tx < 0)) {

                        printk(KERN_DEBUG
                            "Setting B-channel %d to echo cancelable "
                            "state on PCM slot %d\n", ch,
                            ((ch / 4) * 8) + ((ch % 4) * 4) + 1);
                        printk(KERN_DEBUG
                            "Enabling pass through for channel\n");
                        vpm_out(hc, ch, ((ch / 4) * 8) +
                            ((ch % 4) * 4) + 1, 0x01);
                        /* rx path */
                        /* S/T -> PCM */
                        HFC_outb(hc, R_FIFO, (ch << 1));
                        HFC_wait(hc);
                        HFC_outb(hc, A_CON_HDLC, 0xc0 | V_HDLC_TRP | V_IFF);
                        HFC_outb(hc, R_SLOT, (((ch / 4) * 8) +
                            ((ch % 4) * 4) + 1) << 1);
                        HFC_outb(hc, A_SL_CFG, 0x80 | (ch << 1));

                        /* PCM -> FIFO */
                        HFC_outb(hc, R_FIFO, 0x20 | (ch << 1) | 1);
                        HFC_wait(hc);
                        HFC_outb(hc, A_CON_HDLC, 0x20 | V_HDLC_TRP | V_IFF);
                        HFC_outb(hc, A_SUBCH_CFG, 0);
                        HFC_outb(hc, A_IRQ_MSK, 0);
                        HFC_outb(hc, R_INC_RES_FIFO, V_RES_F);
                        HFC_wait(hc);
                        HFC_outb(hc, R_SLOT, ((((ch / 4) * 8) +
                            ((ch % 4) * 4) + 1) << 1) | 1);
                        HFC_outb(hc, A_SL_CFG, 0x80 | 0x20 | (ch << 1) | 1);

                        /* tx path */
                        /* PCM -> S/T */
                        HFC_outb(hc, R_FIFO, (ch << 1) | 1);
                        HFC_wait(hc);
                        HFC_outb(hc, A_CON_HDLC, 0xc0 | V_HDLC_TRP | V_IFF);
                        HFC_outb(hc, R_SLOT, ((((ch / 4) * 8) +
                            ((ch % 4) * 4)) << 1) | 1);
                        HFC_outb(hc, A_SL_CFG, 0x80 | 0x40 | (ch << 1) | 1);

                        /* FIFO -> PCM */
                        HFC_outb(hc, R_FIFO, 0x20 | (ch << 1));
                        HFC_wait(hc);
                        HFC_outb(hc, A_CON_HDLC, 0x20 | V_HDLC_TRP | V_IFF);
                        HFC_outb(hc, A_SUBCH_CFG, 0);
                        HFC_outb(hc, A_IRQ_MSK, 0);
                        HFC_outb(hc, R_INC_RES_FIFO, V_RES_F);
                        HFC_wait(hc);
                        /* tx silence */
                        HFC_outb_nodebug(hc, A_FIFO_DATA0_NOINC, silence);
                        HFC_outb(hc, R_SLOT, (((ch / 4) * 8) +
                            ((ch % 4) * 4)) << 1);
                        HFC_outb(hc, A_SL_CFG, 0x80 | 0x20 | (ch << 1));
                } else {
                        /* enable TX fifo */
                        HFC_outb(hc, R_FIFO, ch << 1);
                        HFC_wait(hc);
                        HFC_outb(hc, A_CON_HDLC, flow_tx | 0x00 |
                            V_HDLC_TRP | V_IFF);
                        HFC_outb(hc, A_SUBCH_CFG, 0);
                        HFC_outb(hc, A_IRQ_MSK, 0);
                        HFC_outb(hc, R_INC_RES_FIFO, V_RES_F);
                        HFC_wait(hc);
                        /* tx silence */
                        HFC_outb_nodebug(hc, A_FIFO_DATA0_NOINC, silence);
                        /* enable RX fifo */
                        HFC_outb(hc, R_FIFO, (ch<<1)|1);
                        HFC_wait(hc);
                        HFC_outb(hc, A_CON_HDLC, flow_rx | 0x00 | V_HDLC_TRP);
                        HFC_outb(hc, A_SUBCH_CFG, 0);
                        HFC_outb(hc, A_IRQ_MSK, 0);
                        HFC_outb(hc, R_INC_RES_FIFO, V_RES_F);
                        HFC_wait(hc);
                }
                if (hc->type != 1) {
                        hc->hw.a_st_ctrl0[hc->chan[ch].port] |=
                            ((ch & 0x3) == 0) ? V_B1_EN : V_B2_EN;
                        HFC_outb(hc, R_ST_SEL, hc->chan[ch].port);
                        /* undocumented: delay after R_ST_SEL */
                        udelay(1);
                        HFC_outb(hc, A_ST_CTRL0,
                            hc->hw.a_st_ctrl0[hc->chan[ch].port]);
                }
                if (hc->chan[ch].bch)
                        test_and_set_bit(FLG_TRANSPARENT,
                            &hc->chan[ch].bch->Flags);
                break;
        case (ISDN_P_B_HDLC): /* B-channel */
        case (ISDN_P_TE_S0): /* D-channel */
        case (ISDN_P_NT_S0):
        case (ISDN_P_TE_E1):
        case (ISDN_P_NT_E1):
                /* enable TX fifo */
                HFC_outb(hc, R_FIFO, ch<<1);
                HFC_wait(hc);
                if (hc->type == 1 || hc->chan[ch].bch) {
                        /* E1 or B-channel */
                        HFC_outb(hc, A_CON_HDLC, flow_tx | 0x04);
                        HFC_outb(hc, A_SUBCH_CFG, 0);
                } else {
                        /* D-Channel without HDLC fill flags */
                        HFC_outb(hc, A_CON_HDLC, flow_tx | 0x04 | V_IFF);
                        HFC_outb(hc, A_SUBCH_CFG, 2);
                }
                HFC_outb(hc, A_IRQ_MSK, V_IRQ);
                HFC_outb(hc, R_INC_RES_FIFO, V_RES_F);
                HFC_wait(hc);
                /* enable RX fifo */
                HFC_outb(hc, R_FIFO, (ch<<1)|1);
                HFC_wait(hc);
                HFC_outb(hc, A_CON_HDLC, flow_rx | 0x04);
                if (hc->type == 1 || hc->chan[ch].bch)
                        HFC_outb(hc, A_SUBCH_CFG, 0); /* full 8 bits */
                else
                        HFC_outb(hc, A_SUBCH_CFG, 2); /* 2 bits dchannel */
                HFC_outb(hc, A_IRQ_MSK, V_IRQ);
                HFC_outb(hc, R_INC_RES_FIFO, V_RES_F);
                HFC_wait(hc);
                if (hc->chan[ch].bch) {
                        test_and_set_bit(FLG_HDLC, &hc->chan[ch].bch->Flags);
                        if (hc->type != 1) {
                                hc->hw.a_st_ctrl0[hc->chan[ch].port] |=
                                  ((ch&0x3) == 0) ? V_B1_EN : V_B2_EN;
                                HFC_outb(hc, R_ST_SEL, hc->chan[ch].port);
                                /* undocumented: delay after R_ST_SEL */
                                udelay(1);
                                HFC_outb(hc, A_ST_CTRL0,
                                  hc->hw.a_st_ctrl0[hc->chan[ch].port]);
                        }
                }
                break;
        default:
                printk(KERN_DEBUG "%s: protocol not known %x\n",
                    __func__, protocol);
                hc->chan[ch].protocol = ISDN_P_NONE;
                return -ENOPROTOOPT;
        }
        hc->chan[ch].protocol = protocol;
        return 0;
}


/*
 * connect/disconnect PCM
 */

static void
hfcmulti_pcm(struct hfc_multi *hc, int ch, int slot_tx, int bank_tx,
    int slot_rx, int bank_rx)
{
        if (slot_rx < 0 || slot_rx < 0 || bank_tx < 0 || bank_rx < 0) {
                /* disable PCM */
                mode_hfcmulti(hc, ch, hc->chan[ch].protocol, -1, 0, -1, 0);
                return;
        }

        /* enable pcm */
        mode_hfcmulti(hc, ch, hc->chan[ch].protocol, slot_tx, bank_tx,
                slot_rx, bank_rx);
}

/*
 * set/disable conference
 */

static void
hfcmulti_conf(struct hfc_multi *hc, int ch, int num)
{
        if (num >= 0 && num <= 7)
                hc->chan[ch].conf = num;
        else
                hc->chan[ch].conf = -1;
        mode_hfcmulti(hc, ch, hc->chan[ch].protocol, hc->chan[ch].slot_tx,
            hc->chan[ch].bank_tx, hc->chan[ch].slot_rx,
            hc->chan[ch].bank_rx);
}


/*
 * set/disable sample loop
 */

/* NOTE: this function is experimental and therefore disabled */

/*
 * Layer 1 callback function
 */
static int
hfcm_l1callback(struct dchannel *dch, u_int cmd)
{
        struct hfc_multi        *hc = dch->hw;
        u_long        flags;

        switch (cmd) {
        case INFO3_P8:
        case INFO3_P10:
                break;
        case HW_RESET_REQ:
                /* start activation */
                spin_lock_irqsave(&hc->lock, flags);
                if (hc->type == 1) {
                        if (debug & DEBUG_HFCMULTI_MSG)
                                printk(KERN_DEBUG
                                    "%s: HW_RESET_REQ no BRI\n",
                                    __func__);
                } else {
                        HFC_outb(hc, R_ST_SEL, hc->chan[dch->slot].port);
                        /* undocumented: delay after R_ST_SEL */
                        udelay(1);
                        HFC_outb(hc, A_ST_WR_STATE, V_ST_LD_STA | 3); /* F3 */
                        udelay(6); /* wait at least 5,21us */
                        HFC_outb(hc, A_ST_WR_STATE, 3);
                        HFC_outb(hc, A_ST_WR_STATE, 3 | (V_ST_ACT*3));
                                /* activate */
                }
                spin_unlock_irqrestore(&hc->lock, flags);
                l1_event(dch->l1, HW_POWERUP_IND);
                break;
        case HW_DEACT_REQ:
                /* start deactivation */
                spin_lock_irqsave(&hc->lock, flags);
                if (hc->type == 1) {
                        if (debug & DEBUG_HFCMULTI_MSG)
                                printk(KERN_DEBUG
                                    "%s: HW_DEACT_REQ no BRI\n",
                                    __func__);
                } else {
                        HFC_outb(hc, R_ST_SEL, hc->chan[dch->slot].port);
                        /* undocumented: delay after R_ST_SEL */
                        udelay(1);
                        HFC_outb(hc, A_ST_WR_STATE, V_ST_ACT*2);
                                /* deactivate */
                        if (test_bit(HFC_CHIP_PLXSD, &hc->chip)) {
                                hc->syncronized &=
                                   ~(1 << hc->chan[dch->slot].port);
                                plxsd_checksync(hc, 0);
                        }
                }
                skb_queue_purge(&dch->squeue);
                if (dch->tx_skb) {
                        dev_kfree_skb(dch->tx_skb);
                        dch->tx_skb = NULL;
                }
                dch->tx_idx = 0;
                if (dch->rx_skb) {
                        dev_kfree_skb(dch->rx_skb);
                        dch->rx_skb = NULL;
                }
                test_and_clear_bit(FLG_TX_BUSY, &dch->Flags);
                if (test_and_clear_bit(FLG_BUSY_TIMER, &dch->Flags))
                        del_timer(&dch->timer);
                spin_unlock_irqrestore(&hc->lock, flags);
                break;
        case HW_POWERUP_REQ:
                spin_lock_irqsave(&hc->lock, flags);
                if (hc->type == 1) {
                        if (debug & DEBUG_HFCMULTI_MSG)
                                printk(KERN_DEBUG
                                    "%s: HW_POWERUP_REQ no BRI\n",
                                    __func__);
                } else {
                        HFC_outb(hc, R_ST_SEL, hc->chan[dch->slot].port);
                        /* undocumented: delay after R_ST_SEL */
                        udelay(1);
                        HFC_outb(hc, A_ST_WR_STATE, 3 | 0x10); /* activate */
                        udelay(6); /* wait at least 5,21us */
                        HFC_outb(hc, A_ST_WR_STATE, 3); /* activate */
                }
                spin_unlock_irqrestore(&hc->lock, flags);
                break;
        case PH_ACTIVATE_IND:
                test_and_set_bit(FLG_ACTIVE, &dch->Flags);
                _queue_data(&dch->dev.D, cmd, MISDN_ID_ANY, 0, NULL,
                        GFP_ATOMIC);
                break;
        case PH_DEACTIVATE_IND:
                test_and_clear_bit(FLG_ACTIVE, &dch->Flags);
                _queue_data(&dch->dev.D, cmd, MISDN_ID_ANY, 0, NULL,
                        GFP_ATOMIC);
                break;
        default:
                if (dch->debug & DEBUG_HW)
                        printk(KERN_DEBUG "%s: unknown command %x\n",
                            __func__, cmd);
                return -1;
        }
        return 0;
}

/*
 * Layer2 -> Layer 1 Transfer
 */

static int
handle_dmsg(struct mISDNchannel *ch, struct sk_buff *skb)
{
        struct mISDNdevice        *dev = container_of(ch, struct mISDNdevice, D);
        struct dchannel                *dch = container_of(dev, struct dchannel, dev);
        struct hfc_multi        *hc = dch->hw;
        struct mISDNhead        *hh = mISDN_HEAD_P(skb);
        int                        ret = -EINVAL;
        unsigned int                id;
        u_long                        flags;

        switch (hh->prim) {
        case PH_DATA_REQ:
                if (skb->len < 1)
                        break;
                spin_lock_irqsave(&hc->lock, flags);
                ret = dchannel_senddata(dch, skb);
                if (ret > 0) { /* direct TX */
                        id = hh->id; /* skb can be freed */
                        hfcmulti_tx(hc, dch->slot);
                        ret = 0;
                        /* start fifo */
                        HFC_outb(hc, R_FIFO, 0);
                        HFC_wait(hc);
                        spin_unlock_irqrestore(&hc->lock, flags);
                        queue_ch_frame(ch, PH_DATA_CNF, id, NULL);
                } else
                        spin_unlock_irqrestore(&hc->lock, flags);
                return ret;
        case PH_ACTIVATE_REQ:
                if (dch->dev.D.protocol != ISDN_P_TE_S0) {
                        spin_lock_irqsave(&hc->lock, flags);
                        ret = 0;
                        if (debug & DEBUG_HFCMULTI_MSG)
                                printk(KERN_DEBUG
                                    "%s: PH_ACTIVATE port %d (0..%d)\n",
                                    __func__, hc->chan[dch->slot].port,
                                    hc->ports-1);
                        /* start activation */
                        if (hc->type == 1) {
                                ph_state_change(dch);
                                if (debug & DEBUG_HFCMULTI_STATE)
                                        printk(KERN_DEBUG
                                            "%s: E1 report state %x \n",
                                            __func__, dch->state);
                        } else {
                                HFC_outb(hc, R_ST_SEL,
                                    hc->chan[dch->slot].port);
                                /* undocumented: delay after R_ST_SEL */
                                udelay(1);
                                HFC_outb(hc, A_ST_WR_STATE, V_ST_LD_STA | 1);
                                    /* G1 */
                                udelay(6); /* wait at least 5,21us */
                                HFC_outb(hc, A_ST_WR_STATE, 1);
                                HFC_outb(hc, A_ST_WR_STATE, 1 |
                                    (V_ST_ACT*3)); /* activate */
                                dch->state = 1;
                        }
                        spin_unlock_irqrestore(&hc->lock, flags);
                } else
                        ret = l1_event(dch->l1, hh->prim);
                break;
        case PH_DEACTIVATE_REQ:
                test_and_clear_bit(FLG_L2_ACTIVATED, &dch->Flags);
                if (dch->dev.D.protocol != ISDN_P_TE_S0) {
                        spin_lock_irqsave(&hc->lock, flags);
                        if (debug & DEBUG_HFCMULTI_MSG)
                                printk(KERN_DEBUG
                                    "%s: PH_DEACTIVATE port %d (0..%d)\n",
                                    __func__, hc->chan[dch->slot].port,
                                    hc->ports-1);
                        /* start deactivation */
                        if (hc->type == 1) {
                                if (debug & DEBUG_HFCMULTI_MSG)
                                        printk(KERN_DEBUG
                                            "%s: PH_DEACTIVATE no BRI\n",
                                            __func__);
                        } else {
                                HFC_outb(hc, R_ST_SEL,
                                    hc->chan[dch->slot].port);
                                /* undocumented: delay after R_ST_SEL */
                                udelay(1);
                                HFC_outb(hc, A_ST_WR_STATE, V_ST_ACT * 2);
                                    /* deactivate */
                                dch->state = 1;
                        }
                        skb_queue_purge(&dch->squeue);
                        if (dch->tx_skb) {
                                dev_kfree_skb(dch->tx_skb);
                                dch->tx_skb = NULL;
                        }
                        dch->tx_idx = 0;
                        if (dch->rx_skb) {
                                dev_kfree_skb(dch->rx_skb);
                                dch->rx_skb = NULL;
                        }
                        test_and_clear_bit(FLG_TX_BUSY, &dch->Flags);
                        if (test_and_clear_bit(FLG_BUSY_TIMER, &dch->Flags))
                                del_timer(&dch->timer);
#ifdef FIXME
                        if (test_and_clear_bit(FLG_L1_BUSY, &dch->Flags))
                                dchannel_sched_event(&hc->dch, D_CLEARBUSY);
#endif
                        ret = 0;
                        spin_unlock_irqrestore(&hc->lock, flags);
                } else
                        ret = l1_event(dch->l1, hh->prim);
                break;
        }
        if (!ret)
                dev_kfree_skb(skb);
        return ret;
}

static void
deactivate_bchannel(struct bchannel *bch)
{
        struct hfc_multi        *hc = bch->hw;
        u_long                        flags;

        spin_lock_irqsave(&hc->lock, flags);
        if (test_and_clear_bit(FLG_TX_NEXT, &bch->Flags)) {
                dev_kfree_skb(bch->next_skb);
                bch->next_skb = NULL;
        }
        if (bch->tx_skb) {
                dev_kfree_skb(bch->tx_skb);
                bch->tx_skb = NULL;
        }
        bch->tx_idx = 0;
        if (bch->rx_skb) {
                dev_kfree_skb(bch->rx_skb);
                bch->rx_skb = NULL;
        }
        hc->chan[bch->slot].coeff_count = 0;
        test_and_clear_bit(FLG_ACTIVE, &bch->Flags);
        test_and_clear_bit(FLG_TX_BUSY, &bch->Flags);
        hc->chan[bch->slot].rx_off = 0;
        hc->chan[bch->slot].conf = -1;
        mode_hfcmulti(hc, bch->slot, ISDN_P_NONE, -1, 0, -1, 0);
        spin_unlock_irqrestore(&hc->lock, flags);
}

static int
handle_bmsg(struct mISDNchannel *ch, struct sk_buff *skb)
{
        struct bchannel                *bch = container_of(ch, struct bchannel, ch);
        struct hfc_multi        *hc = bch->hw;
        int                        ret = -EINVAL;
        struct mISDNhead        *hh = mISDN_HEAD_P(skb);
        unsigned int                id;
        u_long                        flags;

        switch (hh->prim) {
        case PH_DATA_REQ:
                if (!skb->len)
                        break;
                spin_lock_irqsave(&hc->lock, flags);
                ret = bchannel_senddata(bch, skb);
                if (ret > 0) { /* direct TX */
                        id = hh->id; /* skb can be freed */
                        hfcmulti_tx(hc, bch->slot);
                        ret = 0;
                        /* start fifo */
                        HFC_outb_nodebug(hc, R_FIFO, 0);
                        HFC_wait_nodebug(hc);
                        if (!test_bit(FLG_TRANSPARENT, &bch->Flags)) {
                                spin_unlock_irqrestore(&hc->lock, flags);
                                queue_ch_frame(ch, PH_DATA_CNF, id, NULL);
                        } else
                                spin_unlock_irqrestore(&hc->lock, flags);
                } else
                        spin_unlock_irqrestore(&hc->lock, flags);
                return ret;
        case PH_ACTIVATE_REQ:
                if (debug & DEBUG_HFCMULTI_MSG)
                        printk(KERN_DEBUG "%s: PH_ACTIVATE ch %d (0..32)\n",
                                __func__, bch->slot);
                spin_lock_irqsave(&hc->lock, flags);
                /* activate B-channel if not already activated */
                if (!test_and_set_bit(FLG_ACTIVE, &bch->Flags)) {
                        hc->chan[bch->slot].txpending = 0;
                        ret = mode_hfcmulti(hc, bch->slot,
                                ch->protocol,
                                hc->chan[bch->slot].slot_tx,
                                hc->chan[bch->slot].bank_tx,
                                hc->chan[bch->slot].slot_rx,
                                hc->chan[bch->slot].bank_rx);
                        if (!ret) {
                                if (ch->protocol == ISDN_P_B_RAW && !hc->dtmf
                                        && test_bit(HFC_CHIP_DTMF, &hc->chip)) {
                                        /* start decoder */
                                        hc->dtmf = 1;
                                        if (debug & DEBUG_HFCMULTI_DTMF)
                                                printk(KERN_DEBUG
                                                    "%s: start dtmf decoder\n",
                                                        __func__);
                                        HFC_outb(hc, R_DTMF, hc->hw.r_dtmf |
                                            V_RST_DTMF);
                                }
                        }
                } else
                        ret = 0;
                spin_unlock_irqrestore(&hc->lock, flags);
                if (!ret)
                        _queue_data(ch, PH_ACTIVATE_IND, MISDN_ID_ANY, 0, NULL,
                                GFP_KERNEL);
                break;
        case PH_CONTROL_REQ:
                spin_lock_irqsave(&hc->lock, flags);
                switch (hh->id) {
                case HFC_SPL_LOOP_ON: /* set sample loop */
                        if (debug & DEBUG_HFCMULTI_MSG)
                        printk(KERN_DEBUG
                            "%s: HFC_SPL_LOOP_ON (len = %d)\n",
                            __func__, skb->len);
                        ret = 0;
                        break;
                case HFC_SPL_LOOP_OFF: /* set silence */
                        if (debug & DEBUG_HFCMULTI_MSG)
                                printk(KERN_DEBUG "%s: HFC_SPL_LOOP_OFF\n",
                                    __func__);
                        ret = 0;
                        break;
                default:
                        printk(KERN_ERR
                             "%s: unknown PH_CONTROL_REQ info %x\n",
                             __func__, hh->id);
                        ret = -EINVAL;
                }
                spin_unlock_irqrestore(&hc->lock, flags);
                break;
        case PH_DEACTIVATE_REQ:
                deactivate_bchannel(bch); /* locked there */
                _queue_data(ch, PH_DEACTIVATE_IND, MISDN_ID_ANY, 0, NULL,
                        GFP_KERNEL);
                ret = 0;
                break;
        }
        if (!ret)
                dev_kfree_skb(skb);
        return ret;
}

/*
 * bchannel control function
 */
static int
channel_bctrl(struct bchannel *bch, struct mISDN_ctrl_req *cq)
{
        int                        ret = 0;
        struct dsp_features        *features =
                (struct dsp_features *)(*((u_long *)&cq->p1));
        struct hfc_multi        *hc = bch->hw;
        int                        slot_tx;
        int                        bank_tx;
        int                        slot_rx;
        int                        bank_rx;
        int                        num;

        switch (cq->op) {
        case MISDN_CTRL_GETOP:
                cq->op = MISDN_CTRL_HFC_OP | MISDN_CTRL_HW_FEATURES_OP
                        | MISDN_CTRL_RX_OFF;
                break;
        case MISDN_CTRL_RX_OFF: /* turn off / on rx stream */
                hc->chan[bch->slot].rx_off = !!cq->p1;
                if (!hc->chan[bch->slot].rx_off) {
                        /* reset fifo on rx on */
                        HFC_outb_nodebug(hc, R_FIFO, (bch->slot << 1) | 1);
                        HFC_wait_nodebug(hc);
                        HFC_outb_nodebug(hc, R_INC_RES_FIFO, V_RES_F);
                        HFC_wait_nodebug(hc);
                }
                if (debug & DEBUG_HFCMULTI_MSG)
                        printk(KERN_DEBUG "%s: RX_OFF request (nr=%d off=%d)\n",
                            __func__, bch->nr, hc->chan[bch->slot].rx_off);
                break;
        case MISDN_CTRL_HW_FEATURES: /* fill features structure */
                if (debug & DEBUG_HFCMULTI_MSG)
                        printk(KERN_DEBUG "%s: HW_FEATURE request\n",
                            __func__);
                /* create confirm */
                features->hfc_id = hc->id;
                if (test_bit(HFC_CHIP_DTMF, &hc->chip))
                        features->hfc_dtmf = 1;
                features->hfc_loops = 0;
                if (test_bit(HFC_CHIP_B410P, &hc->chip)) {
                        features->hfc_echocanhw = 1;
                } else {
                        features->pcm_id = hc->pcm;
                        features->pcm_slots = hc->slots;
                        features->pcm_banks = 2;
                }
                break;
        case MISDN_CTRL_HFC_PCM_CONN: /* connect to pcm timeslot (0..N) */
                slot_tx = cq->p1 & 0xff;
                bank_tx = cq->p1 >> 8;
                slot_rx = cq->p2 & 0xff;
                bank_rx = cq->p2 >> 8;
                if (debug & DEBUG_HFCMULTI_MSG)
                        printk(KERN_DEBUG
                            "%s: HFC_PCM_CONN slot %d bank %d (TX) "
                            "slot %d bank %d (RX)\n",
                            __func__, slot_tx, bank_tx,
                            slot_rx, bank_rx);
                if (slot_tx < hc->slots && bank_tx <= 2 &&
                    slot_rx < hc->slots && bank_rx <= 2)
                        hfcmulti_pcm(hc, bch->slot,
                            slot_tx, bank_tx, slot_rx, bank_rx);
                else {
                        printk(KERN_WARNING
                            "%s: HFC_PCM_CONN slot %d bank %d (TX) "
                            "slot %d bank %d (RX) out of range\n",
                            __func__, slot_tx, bank_tx,
                            slot_rx, bank_rx);
                        ret = -EINVAL;
                }
                break;
        case MISDN_CTRL_HFC_PCM_DISC: /* release interface from pcm timeslot */
                if (debug & DEBUG_HFCMULTI_MSG)
                        printk(KERN_DEBUG "%s: HFC_PCM_DISC\n",
                            __func__);
                hfcmulti_pcm(hc, bch->slot, -1, 0, -1, 0);
                break;
        case MISDN_CTRL_HFC_CONF_JOIN: /* join conference (0..7) */
                num = cq->p1 & 0xff;
                if (debug & DEBUG_HFCMULTI_MSG)
                        printk(KERN_DEBUG "%s: HFC_CONF_JOIN conf %d\n",
                            __func__, num);
                if (num <= 7)
                        hfcmulti_conf(hc, bch->slot, num);
                else {
                        printk(KERN_WARNING
                            "%s: HW_CONF_JOIN conf %d out of range\n",
                            __func__, num);
                        ret = -EINVAL;
                }
                break;
        case MISDN_CTRL_HFC_CONF_SPLIT: /* split conference */
                if (debug & DEBUG_HFCMULTI_MSG)
                        printk(KERN_DEBUG "%s: HFC_CONF_SPLIT\n", __func__);
                hfcmulti_conf(hc, bch->slot, -1);
                break;
        case MISDN_CTRL_HFC_ECHOCAN_ON:
                if (debug & DEBUG_HFCMULTI_MSG)
                        printk(KERN_DEBUG "%s: HFC_ECHOCAN_ON\n", __func__);
                if (test_bit(HFC_CHIP_B410P, &hc->chip))
                        vpm_echocan_on(hc, bch->slot, cq->p1);
                else
                        ret = -EINVAL;
                break;

        case MISDN_CTRL_HFC_ECHOCAN_OFF:
                if (debug & DEBUG_HFCMULTI_MSG)
                        printk(KERN_DEBUG "%s: HFC_ECHOCAN_OFF\n",
                                __func__);
                if (test_bit(HFC_CHIP_B410P, &hc->chip))
                        vpm_echocan_off(hc, bch->slot);
                else
                        ret = -EINVAL;
                break;
        default:
                printk(KERN_WARNING "%s: unknown Op %x\n",
                    __func__, cq->op);
                ret = -EINVAL;
                break;
        }
        return ret;
}

static int
hfcm_bctrl(struct mISDNchannel *ch, u_int cmd, void *arg)
{
        struct bchannel                *bch = container_of(ch, struct bchannel, ch);
        struct hfc_multi        *hc = bch->hw;
        int                        err = -EINVAL;
        u_long        flags;

        if (bch->debug & DEBUG_HW)
                printk(KERN_DEBUG "%s: cmd:%x %p\n",
                    __func__, cmd, arg);
        switch (cmd) {
        case CLOSE_CHANNEL:
                test_and_clear_bit(FLG_OPEN, &bch->Flags);
                if (test_bit(FLG_ACTIVE, &bch->Flags))
                        deactivate_bchannel(bch); /* locked there */
                ch->protocol = ISDN_P_NONE;
                ch->peer = NULL;
                module_put(THIS_MODULE);
                err = 0;
                break;
        case CONTROL_CHANNEL:
                spin_lock_irqsave(&hc->lock, flags);
                err = channel_bctrl(bch, arg);
                spin_unlock_irqrestore(&hc->lock, flags);
                break;
        default:
                printk(KERN_WARNING "%s: unknown prim(%x)\n",
                        __func__, cmd);
        }
        return err;
}

/*
 * handle D-channel events
 *
 * handle state change event
 */
static void
ph_state_change(struct dchannel *dch)
{
        struct hfc_multi *hc = dch->hw;
        int ch, i;

        if (!dch) {
                printk(KERN_WARNING "%s: ERROR given dch is NULL\n",
                    __func__);
                return;
        }
        ch = dch->slot;

        if (hc->type == 1) {
                if (dch->dev.D.protocol == ISDN_P_TE_E1) {
                        if (debug & DEBUG_HFCMULTI_STATE)
                                printk(KERN_DEBUG
                                    "%s: E1 TE (id=%d) newstate %x\n",
                                    __func__, hc->id, dch->state);
                } else {
                        if (debug & DEBUG_HFCMULTI_STATE)
                                printk(KERN_DEBUG
                                    "%s: E1 NT (id=%d) newstate %x\n",
                                    __func__, hc->id, dch->state);
                }
                switch (dch->state) {
                case (1):
                        if (hc->e1_state != 1) {
                            for (i = 1; i <= 31; i++) {
                                /* reset fifos on e1 activation */
                                HFC_outb_nodebug(hc, R_FIFO, (i << 1) | 1);
                                HFC_wait_nodebug(hc);
                                HFC_outb_nodebug(hc,
                                        R_INC_RES_FIFO, V_RES_F);
                                HFC_wait_nodebug(hc);
                            }
                        }
                        test_and_set_bit(FLG_ACTIVE, &dch->Flags);
                        _queue_data(&dch->dev.D, PH_ACTIVATE_IND,
                            MISDN_ID_ANY, 0, NULL, GFP_ATOMIC);
                        break;

                default:
                        if (hc->e1_state != 1)
                                return;
                        test_and_clear_bit(FLG_ACTIVE, &dch->Flags);
                        _queue_data(&dch->dev.D, PH_DEACTIVATE_IND,
                            MISDN_ID_ANY, 0, NULL, GFP_ATOMIC);
                }
                hc->e1_state = dch->state;
        } else {
                if (dch->dev.D.protocol == ISDN_P_TE_S0) {
                        if (debug & DEBUG_HFCMULTI_STATE)
                                printk(KERN_DEBUG
                                    "%s: S/T TE newstate %x\n",
                                    __func__, dch->state);
                        switch (dch->state) {
                        case (0):
                                l1_event(dch->l1, HW_RESET_IND);
                                break;
                        case (3):
                                l1_event(dch->l1, HW_DEACT_IND);
                                break;
                        case (5):
                        case (8):
                                l1_event(dch->l1, ANYSIGNAL);
                                break;
                        case (6):
                                l1_event(dch->l1, INFO2);
                                break;
                        case (7):
                                l1_event(dch->l1, INFO4_P8);
                                break;
                        }
                } else {
                        if (debug & DEBUG_HFCMULTI_STATE)
                                printk(KERN_DEBUG "%s: S/T NT newstate %x\n",
                                    __func__, dch->state);
                        switch (dch->state) {
                        case (2):
                                if (hc->chan[ch].nt_timer == 0) {
                                        hc->chan[ch].nt_timer = -1;
                                        HFC_outb(hc, R_ST_SEL,
                                            hc->chan[ch].port);
                                        /* undocumented: delay after R_ST_SEL */
                                        udelay(1);
                                        HFC_outb(hc, A_ST_WR_STATE, 4 |
                                            V_ST_LD_STA); /* G4 */
                                        udelay(6); /* wait at least 5,21us */
                                        HFC_outb(hc, A_ST_WR_STATE, 4);
                                        dch->state = 4;
                                } else {
                                        /* one extra count for the next event */
                                        hc->chan[ch].nt_timer =
                                            nt_t1_count[poll_timer] + 1;
                                        HFC_outb(hc, R_ST_SEL,
                                            hc->chan[ch].port);
                                        /* undocumented: delay after R_ST_SEL */
                                        udelay(1);
                                        /* allow G2 -> G3 transition */
                                        HFC_outb(hc, A_ST_WR_STATE, 2 |
                                            V_SET_G2_G3);
                                }
                                break;
                        case (1):
                                hc->chan[ch].nt_timer = -1;
                                test_and_clear_bit(FLG_ACTIVE, &dch->Flags);
                                _queue_data(&dch->dev.D, PH_DEACTIVATE_IND,
                                    MISDN_ID_ANY, 0, NULL, GFP_ATOMIC);
                                break;
                        case (4):
                                hc->chan[ch].nt_timer = -1;
                                break;
                        case (3):
                                hc->chan[ch].nt_timer = -1;
                                test_and_set_bit(FLG_ACTIVE, &dch->Flags);
                                _queue_data(&dch->dev.D, PH_ACTIVATE_IND,
                                    MISDN_ID_ANY, 0, NULL, GFP_ATOMIC);
                                break;
                        }
                }
        }
}

/*
 * called for card mode init message
 */

static void
hfcmulti_initmode(struct dchannel *dch)
{
        struct hfc_multi *hc = dch->hw;
        u_char                a_st_wr_state, r_e1_wr_sta;
        int                i, pt;

        if (debug & DEBUG_HFCMULTI_INIT)
                printk(KERN_DEBUG "%s: entered\n", __func__);

        if (hc->type == 1) {
                hc->chan[hc->dslot].slot_tx = -1;
                hc->chan[hc->dslot].slot_rx = -1;
                hc->chan[hc->dslot].conf = -1;
                if (hc->dslot) {
                        mode_hfcmulti(hc, hc->dslot, dch->dev.D.protocol,
                                -1, 0, -1, 0);
                        dch->timer.function = (void *) hfcmulti_dbusy_timer;
                        dch->timer.data = (long) dch;
                        init_timer(&dch->timer);
                }
                for (i = 1; i <= 31; i++) {
                        if (i == hc->dslot)
                                continue;
                        hc->chan[i].slot_tx = -1;
                        hc->chan[i].slot_rx = -1;
                        hc->chan[i].conf = -1;
                        mode_hfcmulti(hc, i, ISDN_P_NONE, -1, 0, -1, 0);
                }
                /* E1 */
                if (test_bit(HFC_CFG_REPORT_LOS, &hc->chan[hc->dslot].cfg)) {
                        HFC_outb(hc, R_LOS0, 255); /* 2 ms */
                        HFC_outb(hc, R_LOS1, 255); /* 512 ms */
                }
                if (test_bit(HFC_CFG_OPTICAL, &hc->chan[hc->dslot].cfg)) {
                        HFC_outb(hc, R_RX0, 0);
                        hc->hw.r_tx0 = 0 | V_OUT_EN;
                } else {
                        HFC_outb(hc, R_RX0, 1);
                        hc->hw.r_tx0 = 1 | V_OUT_EN;
                }
                hc->hw.r_tx1 = V_ATX | V_NTRI;
                HFC_outb(hc, R_TX0, hc->hw.r_tx0);
                HFC_outb(hc, R_TX1, hc->hw.r_tx1);
                HFC_outb(hc, R_TX_FR0, 0x00);
                HFC_outb(hc, R_TX_FR1, 0xf8);

                if (test_bit(HFC_CFG_CRC4, &hc->chan[hc->dslot].cfg))
                        HFC_outb(hc, R_TX_FR2, V_TX_MF | V_TX_E | V_NEG_E);

                HFC_outb(hc, R_RX_FR0, V_AUTO_RESYNC | V_AUTO_RECO | 0);

                if (test_bit(HFC_CFG_CRC4, &hc->chan[hc->dslot].cfg))
                        HFC_outb(hc, R_RX_FR1, V_RX_MF | V_RX_MF_SYNC);

                if (dch->dev.D.protocol == ISDN_P_NT_E1) {
                        if (debug & DEBUG_HFCMULTI_INIT)
                                printk(KERN_DEBUG "%s: E1 port is NT-mode\n",
                                    __func__);
                        r_e1_wr_sta = 0; /* G0 */
                        hc->e1_getclock = 0;
                } else {
                        if (debug & DEBUG_HFCMULTI_INIT)
                                printk(KERN_DEBUG "%s: E1 port is TE-mode\n",
                                    __func__);
                        r_e1_wr_sta = 0; /* F0 */
                        hc->e1_getclock = 1;
                }
                if (test_bit(HFC_CHIP_RX_SYNC, &hc->chip))
                        HFC_outb(hc, R_SYNC_OUT, V_SYNC_E1_RX);
                else
                        HFC_outb(hc, R_SYNC_OUT, 0);
                if (test_bit(HFC_CHIP_E1CLOCK_GET, &hc->chip))
                        hc->e1_getclock = 1;
                if (test_bit(HFC_CHIP_E1CLOCK_PUT, &hc->chip))
                        hc->e1_getclock = 0;
                if (test_bit(HFC_CHIP_PCM_SLAVE, &hc->chip)) {
                        /* SLAVE (clock master) */
                        if (debug & DEBUG_HFCMULTI_INIT)
                                printk(KERN_DEBUG
                                    "%s: E1 port is clock master "
                                    "(clock from PCM)\n", __func__);
                        HFC_outb(hc, R_SYNC_CTRL, V_EXT_CLK_SYNC | V_PCM_SYNC);
                } else {
                        if (hc->e1_getclock) {
                                /* MASTER (clock slave) */
                                if (debug & DEBUG_HFCMULTI_INIT)
                                        printk(KERN_DEBUG
                                            "%s: E1 port is clock slave "
                                            "(clock to PCM)\n", __func__);
                                HFC_outb(hc, R_SYNC_CTRL, V_SYNC_OFFS);
                        } else {
                                /* MASTER (clock master) */
                                if (debug & DEBUG_HFCMULTI_INIT)
                                        printk(KERN_DEBUG "%s: E1 port is "
                                            "clock master "
                                            "(clock from QUARTZ)\n",
                                            __func__);
                                HFC_outb(hc, R_SYNC_CTRL, V_EXT_CLK_SYNC |
                                    V_PCM_SYNC | V_JATT_OFF);
                                HFC_outb(hc, R_SYNC_OUT, 0);
                        }
                }
                HFC_outb(hc, R_JATT_ATT, 0x9c); /* undoc register */
                HFC_outb(hc, R_PWM_MD, V_PWM0_MD);
                HFC_outb(hc, R_PWM0, 0x50);
                HFC_outb(hc, R_PWM1, 0xff);
                /* state machine setup */
                HFC_outb(hc, R_E1_WR_STA, r_e1_wr_sta | V_E1_LD_STA);
                udelay(6); /* wait at least 5,21us */
                HFC_outb(hc, R_E1_WR_STA, r_e1_wr_sta);
                if (test_bit(HFC_CHIP_PLXSD, &hc->chip)) {
                        hc->syncronized = 0;
                        plxsd_checksync(hc, 0);
                }
        } else {
                i = dch->slot;
                hc->chan[i].slot_tx = -1;
                hc->chan[i].slot_rx = -1;
                hc->chan[i].conf = -1;
                mode_hfcmulti(hc, i, dch->dev.D.protocol, -1, 0, -1, 0);
                dch->timer.function = (void *)hfcmulti_dbusy_timer;
                dch->timer.data = (long) dch;
                init_timer(&dch->timer);
                hc->chan[i - 2].slot_tx = -1;
                hc->chan[i - 2].slot_rx = -1;
                hc->chan[i - 2].conf = -1;
                mode_hfcmulti(hc, i - 2, ISDN_P_NONE, -1, 0, -1, 0);
                hc->chan[i - 1].slot_tx = -1;
                hc->chan[i - 1].slot_rx = -1;
                hc->chan[i - 1].conf = -1;
                mode_hfcmulti(hc, i - 1, ISDN_P_NONE, -1, 0, -1, 0);
                /* ST */
                pt = hc->chan[i].port;
                /* select interface */
                HFC_outb(hc, R_ST_SEL, pt);
                /* undocumented: delay after R_ST_SEL */
                udelay(1);
                if (dch->dev.D.protocol == ISDN_P_NT_S0) {
                        if (debug & DEBUG_HFCMULTI_INIT)
                                printk(KERN_DEBUG
                                    "%s: ST port %d is NT-mode\n",
                                    __func__, pt);
                        /* clock delay */
                        HFC_outb(hc, A_ST_CLK_DLY, clockdelay_nt);
                        a_st_wr_state = 1; /* G1 */
                        hc->hw.a_st_ctrl0[pt] = V_ST_MD;
                } else {
                        if (debug & DEBUG_HFCMULTI_INIT)
                                printk(KERN_DEBUG
                                    "%s: ST port %d is TE-mode\n",
                                    __func__, pt);
                        /* clock delay */
                        HFC_outb(hc, A_ST_CLK_DLY, clockdelay_te);
                        a_st_wr_state = 2; /* F2 */
                        hc->hw.a_st_ctrl0[pt] = 0;
                }
                if (!test_bit(HFC_CFG_NONCAP_TX, &hc->chan[i].cfg))
                        hc->hw.a_st_ctrl0[pt] |= V_TX_LI;
                /* line setup */
                HFC_outb(hc, A_ST_CTRL0,  hc->hw.a_st_ctrl0[pt]);
                /* disable E-channel */
                if ((dch->dev.D.protocol == ISDN_P_NT_S0) ||
                    test_bit(HFC_CFG_DIS_ECHANNEL, &hc->chan[i].cfg))
                        HFC_outb(hc, A_ST_CTRL1, V_E_IGNO);
                else
                        HFC_outb(hc, A_ST_CTRL1, 0);
                /* enable B-channel receive */
                HFC_outb(hc, A_ST_CTRL2,  V_B1_RX_EN | V_B2_RX_EN);
                /* state machine setup */
                HFC_outb(hc, A_ST_WR_STATE, a_st_wr_state | V_ST_LD_STA);
                udelay(6); /* wait at least 5,21us */
                HFC_outb(hc, A_ST_WR_STATE, a_st_wr_state);
                hc->hw.r_sci_msk |= 1 << pt;
                /* state machine interrupts */
                HFC_outb(hc, R_SCI_MSK, hc->hw.r_sci_msk);
                /* unset sync on port */
                if (test_bit(HFC_CHIP_PLXSD, &hc->chip)) {
                        hc->syncronized &=
                           ~(1 << hc->chan[dch->slot].port);
                        plxsd_checksync(hc, 0);
                }
        }
        if (debug & DEBUG_HFCMULTI_INIT)
                printk("%s: done\n", __func__);
}


static int
open_dchannel(struct hfc_multi *hc, struct dchannel *dch,
    struct channel_req *rq)
{
        int        err = 0;
        u_long        flags;

        if (debug & DEBUG_HW_OPEN)
                printk(KERN_DEBUG "%s: dev(%d) open from %p\n", __func__,
                    dch->dev.id, __builtin_return_address(0));
        if (rq->protocol == ISDN_P_NONE)
                return -EINVAL;
        if ((dch->dev.D.protocol != ISDN_P_NONE) &&
            (dch->dev.D.protocol != rq->protocol)) {
            if (debug & DEBUG_HFCMULTI_MODE)
                printk(KERN_WARNING "%s: change protocol %x to %x\n",
                    __func__, dch->dev.D.protocol, rq->protocol);
        }
        if ((dch->dev.D.protocol == ISDN_P_TE_S0)
         && (rq->protocol != ISDN_P_TE_S0))
                l1_event(dch->l1, CLOSE_CHANNEL);
        if (dch->dev.D.protocol != rq->protocol) {
                if (rq->protocol == ISDN_P_TE_S0) {
                        err = create_l1(dch, hfcm_l1callback);
                        if (err)
                                return err;
                }
                dch->dev.D.protocol = rq->protocol;
                spin_lock_irqsave(&hc->lock, flags);
                hfcmulti_initmode(dch);
                spin_unlock_irqrestore(&hc->lock, flags);
        }

        if (((rq->protocol == ISDN_P_NT_S0) && (dch->state == 3)) ||
            ((rq->protocol == ISDN_P_TE_S0) && (dch->state == 7)) ||
            ((rq->protocol == ISDN_P_NT_E1) && (dch->state == 1)) ||
            ((rq->protocol == ISDN_P_TE_E1) && (dch->state == 1))) {
                _queue_data(&dch->dev.D, PH_ACTIVATE_IND, MISDN_ID_ANY,
                    0, NULL, GFP_KERNEL);
        }
        rq->ch = &dch->dev.D;
        if (!try_module_get(THIS_MODULE))
                printk(KERN_WARNING "%s:cannot get module\n", __func__);
        return 0;
}

static int
open_bchannel(struct hfc_multi *hc, struct dchannel *dch,
    struct channel_req *rq)
{
        struct bchannel        *bch;
        int                ch;

        if (!test_channelmap(rq->adr.channel, dch->dev.channelmap))
                return -EINVAL;
        if (rq->protocol == ISDN_P_NONE)
                return -EINVAL;
        if (hc->type == 1)
                ch = rq->adr.channel;
        else
                ch = (rq->adr.channel - 1) + (dch->slot - 2);
        bch = hc->chan[ch].bch;
        if (!bch) {
                printk(KERN_ERR "%s:internal error ch %d has no bch\n",
                    __func__, ch);
                return -EINVAL;
        }
        if (test_and_set_bit(FLG_OPEN, &bch->Flags))
                return -EBUSY; /* b-channel can be only open once */
        bch->ch.protocol = rq->protocol;
        hc->chan[ch].rx_off = 0;
        rq->ch = &bch->ch;
        if (!try_module_get(THIS_MODULE))
                printk(KERN_WARNING "%s:cannot get module\n", __func__);
        return 0;
}

/*
 * device control function
 */
static int
channel_dctrl(struct dchannel *dch, struct mISDN_ctrl_req *cq)
{
        int        ret = 0;

        switch (cq->op) {
        case MISDN_CTRL_GETOP:
                cq->op = 0;
                break;
        default:
                printk(KERN_WARNING "%s: unknown Op %x\n",
                    __func__, cq->op);
                ret = -EINVAL;
                break;
        }
        return ret;
}

static int
hfcm_dctrl(struct mISDNchannel *ch, u_int cmd, void *arg)
{
        struct mISDNdevice        *dev = container_of(ch, struct mISDNdevice, D);
        struct dchannel                *dch = container_of(dev, struct dchannel, dev);
        struct hfc_multi        *hc = dch->hw;
        struct channel_req        *rq;
        int                        err = 0;
        u_long                        flags;

        if (dch->debug & DEBUG_HW)
                printk(KERN_DEBUG "%s: cmd:%x %p\n",
                    __func__, cmd, arg);
        switch (cmd) {
        case OPEN_CHANNEL:
                rq = arg;
                switch (rq->protocol) {
                case ISDN_P_TE_S0:
                case ISDN_P_NT_S0:
                        if (hc->type == 1) {
                                err = -EINVAL;
                                break;
                        }
                        err = open_dchannel(hc, dch, rq); /* locked there */
                        break;
                case ISDN_P_TE_E1:
                case ISDN_P_NT_E1:
                        if (hc->type != 1) {
                                err = -EINVAL;
                                break;
                        }
                        err = open_dchannel(hc, dch, rq); /* locked there */
                        break;
                default:
                        spin_lock_irqsave(&hc->lock, flags);
                        err = open_bchannel(hc, dch, rq);
                        spin_unlock_irqrestore(&hc->lock, flags);
                }
                break;
        case CLOSE_CHANNEL:
                if (debug & DEBUG_HW_OPEN)
                        printk(KERN_DEBUG "%s: dev(%d) close from %p\n",
                            __func__, dch->dev.id,
                            __builtin_return_address(0));
                module_put(THIS_MODULE);
                break;
        case CONTROL_CHANNEL:
                spin_lock_irqsave(&hc->lock, flags);
                err = channel_dctrl(dch, arg);
                spin_unlock_irqrestore(&hc->lock, flags);
                break;
        default:
                if (dch->debug & DEBUG_HW)
                        printk(KERN_DEBUG "%s: unknown command %x\n",
                            __func__, cmd);
                err = -EINVAL;
        }
        return err;
}

/*
 * initialize the card
 */

/*
 * start timer irq, wait some time and check if we have interrupts.
 * if not, reset chip and try again.
 */
static int
init_card(struct hfc_multi *hc)
{
        int        err = -EIO;
        u_long        flags;
        u_short        *plx_acc;
        u_long        plx_flags;

        if (debug & DEBUG_HFCMULTI_INIT)
                printk(KERN_DEBUG "%s: entered\n", __func__);

        spin_lock_irqsave(&hc->lock, flags);
        /* set interrupts but leave global interrupt disabled */
        hc->hw.r_irq_ctrl = V_FIFO_IRQ;
        disable_hwirq(hc);
        spin_unlock_irqrestore(&hc->lock, flags);

        if (request_irq(hc->pci_dev->irq, hfcmulti_interrupt, IRQF_SHARED,
            "HFC-multi", hc)) {
                printk(KERN_WARNING "mISDN: Could not get interrupt %d.\n",
                    hc->pci_dev->irq);
                return -EIO;
        }
        hc->irq = hc->pci_dev->irq;

        if (test_bit(HFC_CHIP_PLXSD, &hc->chip)) {
                spin_lock_irqsave(&plx_lock, plx_flags);
                plx_acc = (u_short *)(hc->plx_membase+PLX_INTCSR);
                writew((PLX_INTCSR_PCIINT_ENABLE | PLX_INTCSR_LINTI1_ENABLE),
                        plx_acc); /* enable PCI & LINT1 irq */
                spin_unlock_irqrestore(&plx_lock, plx_flags);
        }

        if (debug & DEBUG_HFCMULTI_INIT)
                printk(KERN_DEBUG "%s: IRQ %d count %d\n",
                    __func__, hc->irq, hc->irqcnt);
        err = init_chip(hc);
        if (err)
                goto error;
        /*
         * Finally enable IRQ output
         * this is only allowed, if an IRQ routine is allready
         * established for this HFC, so don't do that earlier
         */
        spin_lock_irqsave(&hc->lock, flags);
        enable_hwirq(hc);
        spin_unlock_irqrestore(&hc->lock, flags);
        /* printk(KERN_DEBUG "no master irq set!!!\n"); */
        set_current_state(TASK_UNINTERRUPTIBLE);
        schedule_timeout((100*HZ)/1000); /* Timeout 100ms */
        /* turn IRQ off until chip is completely initialized */
        spin_lock_irqsave(&hc->lock, flags);
        disable_hwirq(hc);
        spin_unlock_irqrestore(&hc->lock, flags);
        if (debug & DEBUG_HFCMULTI_INIT)
                printk(KERN_DEBUG "%s: IRQ %d count %d\n",
                    __func__, hc->irq, hc->irqcnt);
        if (hc->irqcnt) {
                if (debug & DEBUG_HFCMULTI_INIT)
                        printk(KERN_DEBUG "%s: done\n", __func__);

                return 0;
        }
        if (test_bit(HFC_CHIP_PCM_SLAVE, &hc->chip)) {
                printk(KERN_INFO "ignoring missing interrupts\n");
                return 0;
        }

        printk(KERN_ERR "HFC PCI: IRQ(%d) getting no interrupts during init.\n",
                hc->irq);

        err = -EIO;

error:
        if (test_bit(HFC_CHIP_PLXSD, &hc->chip)) {
                spin_lock_irqsave(&plx_lock, plx_flags);
                plx_acc = (u_short *)(hc->plx_membase+PLX_INTCSR);
                writew(0x00, plx_acc); /*disable IRQs*/
                spin_unlock_irqrestore(&plx_lock, plx_flags);
        }

        if (debug & DEBUG_HFCMULTI_INIT)
                printk(KERN_WARNING "%s: free irq %d\n", __func__, hc->irq);
        if (hc->irq) {
                free_irq(hc->irq, hc);
                hc->irq = 0;
        }

        if (debug & DEBUG_HFCMULTI_INIT)
                printk(KERN_DEBUG "%s: done (err=%d)\n", __func__, err);
        return err;
}

/*
 * find pci device and set it up
 */

static int
setup_pci(struct hfc_multi *hc, struct pci_dev *pdev,
                const struct pci_device_id *ent)
{
        struct hm_map        *m = (struct hm_map *)ent->driver_data;

        printk(KERN_INFO
            "HFC-multi: card manufacturer: '%s' card name: '%s' clock: %s\n",
            m->vendor_name, m->card_name, m->clock2 ? "double" : "normal");

        hc->pci_dev = pdev;
        if (m->clock2)
                test_and_set_bit(HFC_CHIP_CLOCK2, &hc->chip);

        if (ent->device == 0xB410) {
                test_and_set_bit(HFC_CHIP_B410P, &hc->chip);
                test_and_set_bit(HFC_CHIP_PCM_MASTER, &hc->chip);
                test_and_clear_bit(HFC_CHIP_PCM_SLAVE, &hc->chip);
                hc->slots = 32;
        }

        if (hc->pci_dev->irq <= 0) {
                printk(KERN_WARNING "HFC-multi: No IRQ for PCI card found.\n");
                return -EIO;
        }
        if (pci_enable_device(hc->pci_dev)) {
                printk(KERN_WARNING "HFC-multi: Error enabling PCI card.\n");
                return -EIO;
        }
        hc->leds = m->leds;
        hc->ledstate = 0xAFFEAFFE;
        hc->opticalsupport = m->opticalsupport;

        /* set memory access methods */
        if (m->io_mode) /* use mode from card config */
                hc->io_mode = m->io_mode;
        switch (hc->io_mode) {
        case HFC_IO_MODE_PLXSD:
                test_and_set_bit(HFC_CHIP_PLXSD, &hc->chip);
                hc->slots = 128; /* required */
                /* fall through */
        case HFC_IO_MODE_PCIMEM:
                hc->HFC_outb = HFC_outb_pcimem;
                hc->HFC_inb = HFC_inb_pcimem;
                hc->HFC_inw = HFC_inw_pcimem;
                hc->HFC_wait = HFC_wait_pcimem;
                hc->read_fifo = read_fifo_pcimem;
                hc->write_fifo = write_fifo_pcimem;
                break;
        case HFC_IO_MODE_REGIO:
                hc->HFC_outb = HFC_outb_regio;
                hc->HFC_inb = HFC_inb_regio;
                hc->HFC_inw = HFC_inw_regio;
                hc->HFC_wait = HFC_wait_regio;
                hc->read_fifo = read_fifo_regio;
                hc->write_fifo = write_fifo_regio;
                break;
        default:
                printk(KERN_WARNING "HFC-multi: Invalid IO mode.\n");
                pci_disable_device(hc->pci_dev);
                return -EIO;
        }
        hc->HFC_outb_nodebug = hc->HFC_outb;
        hc->HFC_inb_nodebug = hc->HFC_inb;
        hc->HFC_inw_nodebug = hc->HFC_inw;
        hc->HFC_wait_nodebug = hc->HFC_wait;
#ifdef HFC_REGISTER_DEBUG
        hc->HFC_outb = HFC_outb_debug;
        hc->HFC_inb = HFC_inb_debug;
        hc->HFC_inw = HFC_inw_debug;
        hc->HFC_wait = HFC_wait_debug;
#endif
        hc->pci_iobase = 0;
        hc->pci_membase = NULL;
        hc->plx_membase = NULL;

        switch (hc->io_mode) {
        case HFC_IO_MODE_PLXSD:
                hc->plx_origmembase =  hc->pci_dev->resource[0].start;
                /* MEMBASE 1 is PLX PCI Bridge */

                if (!hc->plx_origmembase) {
                        printk(KERN_WARNING
                          "HFC-multi: No IO-Memory for PCI PLX bridge found\n");
                        pci_disable_device(hc->pci_dev);
                        return -EIO;
                }

                hc->plx_membase = ioremap(hc->plx_origmembase, 0x80);
                if (!hc->plx_membase) {
                        printk(KERN_WARNING
                            "HFC-multi: failed to remap plx address space. "
                            "(internal error)\n");
                        pci_disable_device(hc->pci_dev);
                        return -EIO;
                }
                printk(KERN_INFO
                    "HFC-multi: plx_membase:%#lx plx_origmembase:%#lx\n",
                    (u_long)hc->plx_membase, hc->plx_origmembase);

                hc->pci_origmembase =  hc->pci_dev->resource[2].start;
                    /* MEMBASE 1 is PLX PCI Bridge */
                if (!hc->pci_origmembase) {
                        printk(KERN_WARNING
                            "HFC-multi: No IO-Memory for PCI card found\n");
                        pci_disable_device(hc->pci_dev);
                        return -EIO;
                }

                hc->pci_membase = ioremap(hc->pci_origmembase, 0x400);
                if (!hc->pci_membase) {
                        printk(KERN_WARNING "HFC-multi: failed to remap io "
                            "address space. (internal error)\n");
                        pci_disable_device(hc->pci_dev);
                        return -EIO;
                }

                printk(KERN_INFO
                    "card %d: defined at MEMBASE %#lx (%#lx) IRQ %d HZ %d "
                    "leds-type %d\n",
                    hc->id, (u_long)hc->pci_membase, hc->pci_origmembase,
                    hc->pci_dev->irq, HZ, hc->leds);
                pci_write_config_word(hc->pci_dev, PCI_COMMAND, PCI_ENA_MEMIO);
                break;
        case HFC_IO_MODE_PCIMEM:
                hc->pci_origmembase = hc->pci_dev->resource[1].start;
                if (!hc->pci_origmembase) {
                        printk(KERN_WARNING
                            "HFC-multi: No IO-Memory for PCI card found\n");
                        pci_disable_device(hc->pci_dev);
                        return -EIO;
                }

                hc->pci_membase = ioremap(hc->pci_origmembase, 256);
                if (!hc->pci_membase) {
                        printk(KERN_WARNING
                            "HFC-multi: failed to remap io address space. "
                            "(internal error)\n");
                        pci_disable_device(hc->pci_dev);
                        return -EIO;
                }
                printk(KERN_INFO "card %d: defined at MEMBASE %#lx (%#lx) IRQ %d "
                    "HZ %d leds-type %d\n", hc->id, (u_long)hc->pci_membase,
                    hc->pci_origmembase, hc->pci_dev->irq, HZ, hc->leds);
                pci_write_config_word(hc->pci_dev, PCI_COMMAND, PCI_ENA_MEMIO);
                break;
        case HFC_IO_MODE_REGIO:
                hc->pci_iobase = (u_int) hc->pci_dev->resource[0].start;
                if (!hc->pci_iobase) {
                        printk(KERN_WARNING
                                "HFC-multi: No IO for PCI card found\n");
                        pci_disable_device(hc->pci_dev);
                        return -EIO;
                }

                if (!request_region(hc->pci_iobase, 8, "hfcmulti")) {
                        printk(KERN_WARNING "HFC-multi: failed to request "
                            "address space at 0x%08lx (internal error)\n",
                            hc->pci_iobase);
                        pci_disable_device(hc->pci_dev);
                        return -EIO;
                }

                printk(KERN_INFO
                    "%s %s: defined at IOBASE %#x IRQ %d HZ %d leds-type %d\n",
                    m->vendor_name, m->card_name, (u_int) hc->pci_iobase,
                    hc->pci_dev->irq, HZ, hc->leds);
                pci_write_config_word(hc->pci_dev, PCI_COMMAND, PCI_ENA_REGIO);
                break;
        default:
                printk(KERN_WARNING "HFC-multi: Invalid IO mode.\n");
                pci_disable_device(hc->pci_dev);
                return -EIO;
        }

        pci_set_drvdata(hc->pci_dev, hc);

        /* At this point the needed PCI config is done */
        /* fifos are still not enabled */
        return 0;
}


/*
 * remove port
 */

static void
release_port(struct hfc_multi *hc, struct dchannel *dch)
{
        int        pt, ci, i = 0;
        u_long        flags;
        struct bchannel *pb;

        ci = dch->slot;
        pt = hc->chan[ci].port;

        if (debug & DEBUG_HFCMULTI_INIT)
                printk(KERN_DEBUG "%s: entered for port %d\n",
                        __func__, pt + 1);

        if (pt >= hc->ports) {
                printk(KERN_WARNING "%s: ERROR port out of range (%d).\n",
                     __func__, pt + 1);
                return;
        }

        if (debug & DEBUG_HFCMULTI_INIT)
                printk(KERN_DEBUG "%s: releasing port=%d\n",
                    __func__, pt + 1);

        if (dch->dev.D.protocol == ISDN_P_TE_S0)
                l1_event(dch->l1, CLOSE_CHANNEL);

        hc->chan[ci].dch = NULL;

        if (hc->created[pt]) {
                hc->created[pt] = 0;
                mISDN_unregister_device(&dch->dev);
        }

        spin_lock_irqsave(&hc->lock, flags);

        if (dch->timer.function) {
                del_timer(&dch->timer);
                dch->timer.function = NULL;
        }

        if (hc->type == 1) { /* E1 */
                /* remove sync */
                if (test_bit(HFC_CHIP_PLXSD, &hc->chip)) {
                        hc->syncronized = 0;
                        plxsd_checksync(hc, 1);
                }
                /* free channels */
                for (i = 0; i <= 31; i++) {
                        if (hc->chan[i].bch) {
                                if (debug & DEBUG_HFCMULTI_INIT)
                                        printk(KERN_DEBUG
                                            "%s: free port %d channel %d\n",
                                            __func__, hc->chan[i].port+1, i);
                                pb = hc->chan[i].bch;
                                hc->chan[i].bch = NULL;
                                spin_unlock_irqrestore(&hc->lock, flags);
                                mISDN_freebchannel(pb);
                                kfree(pb);
                                kfree(hc->chan[i].coeff);
                                spin_lock_irqsave(&hc->lock, flags);
                        }
                }
        } else {
                /* remove sync */
                if (test_bit(HFC_CHIP_PLXSD, &hc->chip)) {
                        hc->syncronized &=
                           ~(1 << hc->chan[ci].port);
                        plxsd_checksync(hc, 1);
                }
                /* free channels */
                if (hc->chan[ci - 2].bch) {
                        if (debug & DEBUG_HFCMULTI_INIT)
                                printk(KERN_DEBUG
                                    "%s: free port %d channel %d\n",
                                    __func__, hc->chan[ci - 2].port+1,
                                    ci - 2);
                        pb = hc->chan[ci - 2].bch;
                        hc->chan[ci - 2].bch = NULL;
                        spin_unlock_irqrestore(&hc->lock, flags);
                        mISDN_freebchannel(pb);
                        kfree(pb);
                        kfree(hc->chan[ci - 2].coeff);
                        spin_lock_irqsave(&hc->lock, flags);
                }
                if (hc->chan[ci - 1].bch) {
                        if (debug & DEBUG_HFCMULTI_INIT)
                                printk(KERN_DEBUG
                                    "%s: free port %d channel %d\n",
                                    __func__, hc->chan[ci - 1].port+1,
                                    ci - 1);
                        pb = hc->chan[ci - 1].bch;
                        hc->chan[ci - 1].bch = NULL;
                        spin_unlock_irqrestore(&hc->lock, flags);
                        mISDN_freebchannel(pb);
                        kfree(pb);
                        kfree(hc->chan[ci - 1].coeff);
                        spin_lock_irqsave(&hc->lock, flags);
                }
        }

        spin_unlock_irqrestore(&hc->lock, flags);

        if (debug & DEBUG_HFCMULTI_INIT)
                printk(KERN_DEBUG "%s: free port %d channel D\n", __func__, pt);
        mISDN_freedchannel(dch);
        kfree(dch);

        if (debug & DEBUG_HFCMULTI_INIT)
                printk(KERN_DEBUG "%s: done!\n", __func__);
}

static void
release_card(struct hfc_multi *hc)
{
        u_long        flags;
        int        ch;

        if (debug & DEBUG_HFCMULTI_INIT)
                printk(KERN_WARNING "%s: release card (%d) entered\n",
                    __func__, hc->id);

        spin_lock_irqsave(&hc->lock, flags);
        disable_hwirq(hc);
        spin_unlock_irqrestore(&hc->lock, flags);

        udelay(1000);

        /* dimm leds */
        if (hc->leds)
                hfcmulti_leds(hc);

        /* disable D-channels & B-channels */
        if (debug & DEBUG_HFCMULTI_INIT)
                printk(KERN_DEBUG "%s: disable all channels (d and b)\n",
                    __func__);
        for (ch = 0; ch <= 31; ch++) {
                if (hc->chan[ch].dch)
                        release_port(hc, hc->chan[ch].dch);
        }

        /* release hardware & irq */
        if (hc->irq) {
                if (debug & DEBUG_HFCMULTI_INIT)
                        printk(KERN_WARNING "%s: free irq %d\n",
                            __func__, hc->irq);
                free_irq(hc->irq, hc);
                hc->irq = 0;

        }
        release_io_hfcmulti(hc);

        if (debug & DEBUG_HFCMULTI_INIT)
                printk(KERN_WARNING "%s: remove instance from list\n",
                     __func__);
        list_del(&hc->list);

        if (debug & DEBUG_HFCMULTI_INIT)
                printk(KERN_WARNING "%s: delete instance\n", __func__);
        if (hc == syncmaster)
                syncmaster = NULL;
        kfree(hc);
        if (debug & DEBUG_HFCMULTI_INIT)
                printk(KERN_WARNING "%s: card successfully removed\n",
                    __func__);
}

static int
init_e1_port(struct hfc_multi *hc, struct hm_map *m)
{
        struct dchannel        *dch;
        struct bchannel        *bch;
        int                ch, ret = 0;
        char                name[MISDN_MAX_IDLEN];

        dch = kzalloc(sizeof(struct dchannel), GFP_KERNEL);
        if (!dch)
                return -ENOMEM;
        dch->debug = debug;
        mISDN_initdchannel(dch, MAX_DFRAME_LEN_L1, ph_state_change);
        dch->hw = hc;
        dch->dev.Dprotocols = (1 << ISDN_P_TE_E1) | (1 << ISDN_P_NT_E1);
        dch->dev.Bprotocols = (1 << (ISDN_P_B_RAW & ISDN_P_B_MASK)) |
            (1 << (ISDN_P_B_HDLC & ISDN_P_B_MASK));
        dch->dev.D.send = handle_dmsg;
        dch->dev.D.ctrl = hfcm_dctrl;
        dch->dev.nrbchan = (hc->dslot)?30:31;
        dch->slot = hc->dslot;
        hc->chan[hc->dslot].dch = dch;
        hc->chan[hc->dslot].port = 0;
        hc->chan[hc->dslot].nt_timer = -1;
        for (ch = 1; ch <= 31; ch++) {
                if (ch == hc->dslot) /* skip dchannel */
                        continue;
                bch = kzalloc(sizeof(struct bchannel), GFP_KERNEL);
                if (!bch) {
                        printk(KERN_ERR "%s: no memory for bchannel\n",
                            __func__);
                        ret = -ENOMEM;
                        goto free_chan;
                }
                hc->chan[ch].coeff = kzalloc(512, GFP_KERNEL);
                if (!hc->chan[ch].coeff) {
                        printk(KERN_ERR "%s: no memory for coeffs\n",
                            __func__);
                        ret = -ENOMEM;
                        goto free_chan;
                }
                bch->nr = ch;
                bch->slot = ch;
                bch->debug = debug;
                mISDN_initbchannel(bch, MAX_DATA_MEM);
                bch->hw = hc;
                bch->ch.send = handle_bmsg;
                bch->ch.ctrl = hfcm_bctrl;
                bch->ch.nr = ch;
                list_add(&bch->ch.list, &dch->dev.bchannels);
                hc->chan[ch].bch = bch;
                hc->chan[ch].port = 0;
                set_channelmap(bch->nr, dch->dev.channelmap);
        }
        /* set optical line type */
        if (port[Port_cnt] & 0x001) {
                if (!m->opticalsupport)  {
                        printk(KERN_INFO
                            "This board has no optical "
                            "support\n");
                } else {
                        if (debug & DEBUG_HFCMULTI_INIT)
                                printk(KERN_DEBUG
                                    "%s: PORT set optical "
                                    "interfacs: card(%d) "
                                    "port(%d)\n",
                                    __func__,
                                    HFC_cnt + 1, 1);
                        test_and_set_bit(HFC_CFG_OPTICAL,
                            &hc->chan[hc->dslot].cfg);
                }
        }
        /* set LOS report */
        if (port[Port_cnt] & 0x004) {
                if (debug & DEBUG_HFCMULTI_INIT)
                        printk(KERN_DEBUG "%s: PORT set "
                            "LOS report: card(%d) port(%d)\n",
                            __func__, HFC_cnt + 1, 1);
                test_and_set_bit(HFC_CFG_REPORT_LOS,
                    &hc->chan[hc->dslot].cfg);
        }
        /* set AIS report */
        if (port[Port_cnt] & 0x008) {
                if (debug & DEBUG_HFCMULTI_INIT)
                        printk(KERN_DEBUG "%s: PORT set "
                            "AIS report: card(%d) port(%d)\n",
                            __func__, HFC_cnt + 1, 1);
                test_and_set_bit(HFC_CFG_REPORT_AIS,
                    &hc->chan[hc->dslot].cfg);
        }
        /* set SLIP report */
        if (port[Port_cnt] & 0x010) {
                if (debug & DEBUG_HFCMULTI_INIT)
                        printk(KERN_DEBUG
                            "%s: PORT set SLIP report: "
                            "card(%d) port(%d)\n",
                            __func__, HFC_cnt + 1, 1);
                test_and_set_bit(HFC_CFG_REPORT_SLIP,
                    &hc->chan[hc->dslot].cfg);
        }
        /* set RDI report */
        if (port[Port_cnt] & 0x020) {
                if (debug & DEBUG_HFCMULTI_INIT)
                        printk(KERN_DEBUG
                            "%s: PORT set RDI report: "
                            "card(%d) port(%d)\n",
                            __func__, HFC_cnt + 1, 1);
                test_and_set_bit(HFC_CFG_REPORT_RDI,
                    &hc->chan[hc->dslot].cfg);
        }
        /* set CRC-4 Mode */
        if (!(port[Port_cnt] & 0x100)) {
                if (debug & DEBUG_HFCMULTI_INIT)
                        printk(KERN_DEBUG "%s: PORT turn on CRC4 report:"
                                " card(%d) port(%d)\n",
                                __func__, HFC_cnt + 1, 1);
                test_and_set_bit(HFC_CFG_CRC4,
                    &hc->chan[hc->dslot].cfg);
        } else {
                if (debug & DEBUG_HFCMULTI_INIT)
                        printk(KERN_DEBUG "%s: PORT turn off CRC4"
                                " report: card(%d) port(%d)\n",
                                __func__, HFC_cnt + 1, 1);
        }
        /* set forced clock */
        if (port[Port_cnt] & 0x0200) {
                if (debug & DEBUG_HFCMULTI_INIT)
                        printk(KERN_DEBUG "%s: PORT force getting clock from "
                                "E1: card(%d) port(%d)\n",
                                __func__, HFC_cnt + 1, 1);
                test_and_set_bit(HFC_CHIP_E1CLOCK_GET, &hc->chip);
        } else
        if (port[Port_cnt] & 0x0400) {
                if (debug & DEBUG_HFCMULTI_INIT)
                        printk(KERN_DEBUG "%s: PORT force putting clock to "
                                "E1: card(%d) port(%d)\n",
                                __func__, HFC_cnt + 1, 1);
                test_and_set_bit(HFC_CHIP_E1CLOCK_PUT, &hc->chip);
        }
        /* set JATT PLL */
        if (port[Port_cnt] & 0x0800) {
                if (debug & DEBUG_HFCMULTI_INIT)
                        printk(KERN_DEBUG "%s: PORT disable JATT PLL on "
                                "E1: card(%d) port(%d)\n",
                                __func__, HFC_cnt + 1, 1);
                test_and_set_bit(HFC_CHIP_RX_SYNC, &hc->chip);
        }
        /* set elastic jitter buffer */
        if (port[Port_cnt] & 0x3000) {
                hc->chan[hc->dslot].jitter = (port[Port_cnt]>>12) & 0x3;
                if (debug & DEBUG_HFCMULTI_INIT)
                        printk(KERN_DEBUG
                            "%s: PORT set elastic "
                            "buffer to %d: card(%d) port(%d)\n",
                            __func__, hc->chan[hc->dslot].jitter,
                            HFC_cnt + 1, 1);
        } else
                hc->chan[hc->dslot].jitter = 2; /* default */
        snprintf(name, MISDN_MAX_IDLEN - 1, "hfc-e1.%d", HFC_cnt + 1);
        ret = mISDN_register_device(&dch->dev, name);
        if (ret)
                goto free_chan;
        hc->created[0] = 1;
        return ret;
free_chan:
        release_port(hc, dch);
        return ret;
}

static int
init_multi_port(struct hfc_multi *hc, int pt)
{
        struct dchannel        *dch;
        struct bchannel        *bch;
        int                ch, i, ret = 0;
        char                name[MISDN_MAX_IDLEN];

        dch = kzalloc(sizeof(struct dchannel), GFP_KERNEL);
        if (!dch)
                return -ENOMEM;
        dch->debug = debug;
        mISDN_initdchannel(dch, MAX_DFRAME_LEN_L1, ph_state_change);
        dch->hw = hc;
        dch->dev.Dprotocols = (1 << ISDN_P_TE_S0) | (1 << ISDN_P_NT_S0);
        dch->dev.Bprotocols = (1 << (ISDN_P_B_RAW & ISDN_P_B_MASK)) |
            (1 << (ISDN_P_B_HDLC & ISDN_P_B_MASK));
        dch->dev.D.send = handle_dmsg;
        dch->dev.D.ctrl = hfcm_dctrl;
        dch->dev.nrbchan = 2;
        i = pt << 2;
        dch->slot = i + 2;
        hc->chan[i + 2].dch = dch;
        hc->chan[i + 2].port = pt;
        hc->chan[i + 2].nt_timer = -1;
        for (ch = 0; ch < dch->dev.nrbchan; ch++) {
                bch = kzalloc(sizeof(struct bchannel), GFP_KERNEL);
                if (!bch) {
                        printk(KERN_ERR "%s: no memory for bchannel\n",
                            __func__);
                        ret = -ENOMEM;
                        goto free_chan;
                }
                hc->chan[i + ch].coeff = kzalloc(512, GFP_KERNEL);
                if (!hc->chan[i + ch].coeff) {
                        printk(KERN_ERR "%s: no memory for coeffs\n",
                            __func__);
                        ret = -ENOMEM;
                        goto free_chan;
                }
                bch->nr = ch + 1;
                bch->slot = i + ch;
                bch->debug = debug;
                mISDN_initbchannel(bch, MAX_DATA_MEM);
                bch->hw = hc;
                bch->ch.send = handle_bmsg;
                bch->ch.ctrl = hfcm_bctrl;
                bch->ch.nr = ch + 1;
                list_add(&bch->ch.list, &dch->dev.bchannels);
                hc->chan[i + ch].bch = bch;
                hc->chan[i + ch].port = pt;
                set_channelmap(bch->nr, dch->dev.channelmap);
        }
        /* set master clock */
        if (port[Port_cnt] & 0x001) {
                if (debug & DEBUG_HFCMULTI_INIT)
                        printk(KERN_DEBUG
                            "%s: PROTOCOL set master clock: "
                            "card(%d) port(%d)\n",
                            __func__, HFC_cnt + 1, pt + 1);
                if (dch->dev.D.protocol != ISDN_P_TE_S0) {
                        printk(KERN_ERR "Error: Master clock "
                            "for port(%d) of card(%d) is only"
                            " possible with TE-mode\n",
                            pt + 1, HFC_cnt + 1);
                        ret = -EINVAL;
                        goto free_chan;
                }
                if (hc->masterclk >= 0) {
                        printk(KERN_ERR "Error: Master clock "
                            "for port(%d) of card(%d) already "
                            "defined for port(%d)\n",
                            pt + 1, HFC_cnt + 1, hc->masterclk+1);
                        ret = -EINVAL;
                        goto free_chan;
                }
                hc->masterclk = pt;
        }
        /* set transmitter line to non capacitive */
        if (port[Port_cnt] & 0x002) {
                if (debug & DEBUG_HFCMULTI_INIT)
                        printk(KERN_DEBUG
                            "%s: PROTOCOL set non capacitive "
                            "transmitter: card(%d) port(%d)\n",
                            __func__, HFC_cnt + 1, pt + 1);
                test_and_set_bit(HFC_CFG_NONCAP_TX,
                    &hc->chan[i + 2].cfg);
        }
        /* disable E-channel */
        if (port[Port_cnt] & 0x004) {
        if (debug & DEBUG_HFCMULTI_INIT)
                        printk(KERN_DEBUG
                            "%s: PROTOCOL disable E-channel: "
                            "card(%d) port(%d)\n",
                            __func__, HFC_cnt + 1, pt + 1);
                test_and_set_bit(HFC_CFG_DIS_ECHANNEL,
                    &hc->chan[i + 2].cfg);
        }
        snprintf(name, MISDN_MAX_IDLEN - 1, "hfc-%ds.%d/%d",
                hc->type, HFC_cnt + 1, pt + 1);
        ret = mISDN_register_device(&dch->dev, name);
        if (ret)
                goto free_chan;
        hc->created[pt] = 1;
        return ret;
free_chan:
        release_port(hc, dch);
        return ret;
}

static int
hfcmulti_init(struct pci_dev *pdev, const struct pci_device_id *ent)
{
        struct hm_map        *m = (struct hm_map *)ent->driver_data;
        int                ret_err = 0;
        int                pt;
        struct hfc_multi        *hc;
        u_long                flags;
        u_char                dips = 0, pmj = 0; /* dip settings, port mode Jumpers */

        if (HFC_cnt >= MAX_CARDS) {
                printk(KERN_ERR "too many cards (max=%d).\n",
                        MAX_CARDS);
                return -EINVAL;
        }
        if ((type[HFC_cnt] & 0xff) && (type[HFC_cnt] & 0xff) != m->type) {
                printk(KERN_WARNING "HFC-MULTI: Card '%s:%s' type %d found but "
                    "type[%d] %d was supplied as module parameter\n",
                    m->vendor_name, m->card_name, m->type, HFC_cnt,
                    type[HFC_cnt] & 0xff);
                printk(KERN_WARNING "HFC-MULTI: Load module without parameters "
                        "first, to see cards and their types.");
                return -EINVAL;
        }
        if (debug & DEBUG_HFCMULTI_INIT)
                printk(KERN_DEBUG "%s: Registering %s:%s chip type %d (0x%x)\n",
                    __func__, m->vendor_name, m->card_name, m->type,
                    type[HFC_cnt]);

        /* allocate card+fifo structure */
        hc = kzalloc(sizeof(struct hfc_multi), GFP_KERNEL);
        if (!hc) {
                printk(KERN_ERR "No kmem for HFC-Multi card\n");
                return -ENOMEM;
        }
        spin_lock_init(&hc->lock);
        hc->mtyp = m;
        hc->type =  m->type;
        hc->ports = m->ports;
        hc->id = HFC_cnt;
        hc->pcm = pcm[HFC_cnt];
        hc->io_mode = iomode[HFC_cnt];
        if (dslot[HFC_cnt] < 0) {
                hc->dslot = 0;
                printk(KERN_INFO "HFC-E1 card has disabled D-channel, but "
                        "31 B-channels\n");
        } if (dslot[HFC_cnt] > 0 && dslot[HFC_cnt] < 32) {
                hc->dslot = dslot[HFC_cnt];
                printk(KERN_INFO "HFC-E1 card has alternating D-channel on "
                        "time slot %d\n", dslot[HFC_cnt]);
        } else
                hc->dslot = 16;

        /* set chip specific features */
        hc->masterclk = -1;
        if (type[HFC_cnt] & 0x100) {
                test_and_set_bit(HFC_CHIP_ULAW, &hc->chip);
                silence = 0xff; /* ulaw silence */
        } else
                silence = 0x2a; /* alaw silence */
        if (!(type[HFC_cnt] & 0x200))
                test_and_set_bit(HFC_CHIP_DTMF, &hc->chip);

        if (type[HFC_cnt] & 0x800)
                test_and_set_bit(HFC_CHIP_PCM_SLAVE, &hc->chip);
        if (type[HFC_cnt] & 0x1000) {
                test_and_set_bit(HFC_CHIP_PCM_MASTER, &hc->chip);
                test_and_clear_bit(HFC_CHIP_PCM_SLAVE, &hc->chip);
        }
        if (type[HFC_cnt] & 0x4000)
                test_and_set_bit(HFC_CHIP_EXRAM_128, &hc->chip);
        if (type[HFC_cnt] & 0x8000)
                test_and_set_bit(HFC_CHIP_EXRAM_512, &hc->chip);
        hc->slots = 32;
        if (type[HFC_cnt] & 0x10000)
                hc->slots = 64;
        if (type[HFC_cnt] & 0x20000)
                hc->slots = 128;
        if (type[HFC_cnt] & 0x80000) {
                test_and_set_bit(HFC_CHIP_WATCHDOG, &hc->chip);
                hc->wdcount = 0;
                hc->wdbyte = V_GPIO_OUT2;
                printk(KERN_NOTICE "Watchdog enabled\n");
        }

        /* setup pci, hc->slots may change due to PLXSD */
        ret_err = setup_pci(hc, pdev, ent);
        if (ret_err) {
                if (hc == syncmaster)
                        syncmaster = NULL;
                kfree(hc);
                return ret_err;
        }

        /* crate channels */
        for (pt = 0; pt < hc->ports; pt++) {
                if (Port_cnt >= MAX_PORTS) {
                        printk(KERN_ERR "too many ports (max=%d).\n",
                                MAX_PORTS);
                        ret_err = -EINVAL;
                        goto free_card;
                }
                if (hc->type == 1)
                        ret_err = init_e1_port(hc, m);
                else
                        ret_err = init_multi_port(hc, pt);
                if (debug & DEBUG_HFCMULTI_INIT)
                        printk(KERN_DEBUG
                            "%s: Registering D-channel, card(%d) port(%d)"
                            "result %d\n",
                            __func__, HFC_cnt + 1, pt, ret_err);

                if (ret_err) {
                        while (pt) { /* release already registered ports */
                                pt--;
                                release_port(hc, hc->chan[(pt << 2) + 2].dch);
                        }
                        goto free_card;
                }
                Port_cnt++;
        }

        /* disp switches */
        switch (m->dip_type) {
        case DIP_4S:
                /*
                 * get DIP Setting for beroNet 1S/2S/4S cards
                 *  check if Port Jumper config matches
                 * module param 'protocol'
                 * DIP Setting: (collect GPIO 13/14/15 (R_GPIO_IN1) +
                 * GPI 19/23 (R_GPI_IN2))
                 */
                dips = ((~HFC_inb(hc, R_GPIO_IN1) & 0xE0) >> 5) |
                        ((~HFC_inb(hc, R_GPI_IN2) & 0x80) >> 3) |
                        (~HFC_inb(hc, R_GPI_IN2) & 0x08);

                /* Port mode (TE/NT) jumpers */
                pmj = ((HFC_inb(hc, R_GPI_IN3) >> 4)  & 0xf);

                if (test_bit(HFC_CHIP_B410P, &hc->chip))
                        pmj = ~pmj & 0xf;

                printk(KERN_INFO "%s: %s DIPs(0x%x) jumpers(0x%x)\n",
                        m->vendor_name, m->card_name, dips, pmj);
                break;
        case DIP_8S:
                /*
                 * get DIP Setting for beroNet 8S0+ cards
                 *
                 * enable PCI auxbridge function
                 */
                HFC_outb(hc, R_BRG_PCM_CFG, 1 | V_PCM_CLK);
                /* prepare access to auxport */
                outw(0x4000, hc->pci_iobase + 4);
                /*
                 * some dummy reads are required to
                 * read valid DIP switch data
                 */
                dips = inb(hc->pci_iobase);
                dips = inb(hc->pci_iobase);
                dips = inb(hc->pci_iobase);
                dips = ~inb(hc->pci_iobase) & 0x3F;
                outw(0x0, hc->pci_iobase + 4);
                /* disable PCI auxbridge function */
                HFC_outb(hc, R_BRG_PCM_CFG, V_PCM_CLK);
                printk(KERN_INFO "%s: %s DIPs(0x%x)\n",
                    m->vendor_name, m->card_name, dips);
                break;
        case DIP_E1:
                /*
                 * get DIP Setting for beroNet E1 cards
                 * DIP Setting: collect GPI 4/5/6/7 (R_GPI_IN0)
                 */
                dips = (~HFC_inb(hc, R_GPI_IN0) & 0xF0)>>4;
                printk(KERN_INFO "%s: %s DIPs(0x%x)\n",
                    m->vendor_name, m->card_name, dips);
                break;
        }

        /* add to list */
        spin_lock_irqsave(&HFClock, flags);
        list_add_tail(&hc->list, &HFClist);
        spin_unlock_irqrestore(&HFClock, flags);

        /* initialize hardware */
        ret_err = init_card(hc);
        if (ret_err) {
                printk(KERN_ERR "init card returns %d\n", ret_err);
                release_card(hc);
                return ret_err;
        }

        /* start IRQ and return */
        spin_lock_irqsave(&hc->lock, flags);
        enable_hwirq(hc);
        spin_unlock_irqrestore(&hc->lock, flags);
        return 0;

free_card:
        release_io_hfcmulti(hc);
        if (hc == syncmaster)
                syncmaster = NULL;
        kfree(hc);
        return ret_err;
}

static void __devexit hfc_remove_pci(struct pci_dev *pdev)
{
        struct hfc_multi        *card = pci_get_drvdata(pdev);
        u_long                        flags;

        if (debug)
                printk(KERN_INFO "removing hfc_multi card vendor:%x "
                    "device:%x subvendor:%x subdevice:%x\n",
                    pdev->vendor, pdev->device,
                    pdev->subsystem_vendor, pdev->subsystem_device);

        if (card) {
                spin_lock_irqsave(&HFClock, flags);
                release_card(card);
                spin_unlock_irqrestore(&HFClock, flags);
        }  else {
                if (debug)
                        printk(KERN_WARNING "%s: drvdata allready removed\n",
                            __func__);
        }
}

#define        VENDOR_CCD        "Cologne Chip AG"
#define        VENDOR_BN        "beroNet GmbH"
#define        VENDOR_DIG        "Digium Inc."
#define VENDOR_JH        "Junghanns.NET GmbH"
#define VENDOR_PRIM        "PrimuX"

static const struct hm_map hfcm_map[] = {
/*0*/        {VENDOR_BN, "HFC-1S Card (mini PCI)", 4, 1, 1, 3, 0, DIP_4S, 0},
/*1*/        {VENDOR_BN, "HFC-2S Card", 4, 2, 1, 3, 0, DIP_4S, 0},
/*2*/        {VENDOR_BN, "HFC-2S Card (mini PCI)", 4, 2, 1, 3, 0, DIP_4S, 0},
/*3*/        {VENDOR_BN, "HFC-4S Card", 4, 4, 1, 2, 0, DIP_4S, 0},
/*4*/        {VENDOR_BN, "HFC-4S Card (mini PCI)", 4, 4, 1, 2, 0, 0, 0},
/*5*/        {VENDOR_CCD, "HFC-4S Eval (old)", 4, 4, 0, 0, 0, 0, 0},
/*6*/        {VENDOR_CCD, "HFC-4S IOB4ST", 4, 4, 1, 2, 0, DIP_4S, 0},
/*7*/        {VENDOR_CCD, "HFC-4S", 4, 4, 1, 2, 0, 0, 0},
/*8*/        {VENDOR_DIG, "HFC-4S Card", 4, 4, 0, 2, 0, 0, HFC_IO_MODE_REGIO},
/*9*/        {VENDOR_CCD, "HFC-4S Swyx 4xS0 SX2 QuadBri", 4, 4, 1, 2, 0, 0, 0},
/*10*/        {VENDOR_JH, "HFC-4S (junghanns 2.0)", 4, 4, 1, 2, 0, 0, 0},
/*11*/        {VENDOR_PRIM, "HFC-2S Primux Card", 4, 2, 0, 0, 0, 0, 0},

/*12*/        {VENDOR_BN, "HFC-8S Card", 8, 8, 1, 0, 0, 0, 0},
/*13*/        {VENDOR_BN, "HFC-8S Card (+)", 8, 8, 1, 8, 0, DIP_8S,
                HFC_IO_MODE_REGIO},
/*14*/        {VENDOR_CCD, "HFC-8S Eval (old)", 8, 8, 0, 0, 0, 0, 0},
/*15*/        {VENDOR_CCD, "HFC-8S IOB4ST Recording", 8, 8, 1, 0, 0, 0, 0},

/*16*/        {VENDOR_CCD, "HFC-8S IOB8ST", 8, 8, 1, 0, 0, 0, 0},
/*17*/        {VENDOR_CCD, "HFC-8S", 8, 8, 1, 0, 0, 0, 0},
/*18*/        {VENDOR_CCD, "HFC-8S", 8, 8, 1, 0, 0, 0, 0},

/*19*/        {VENDOR_BN, "HFC-E1 Card", 1, 1, 0, 1, 0, DIP_E1, 0},
/*20*/        {VENDOR_BN, "HFC-E1 Card (mini PCI)", 1, 1, 0, 1, 0, 0, 0},
/*21*/        {VENDOR_BN, "HFC-E1+ Card (Dual)", 1, 1, 0, 1, 0, DIP_E1, 0},
/*22*/        {VENDOR_BN, "HFC-E1 Card (Dual)", 1, 1, 0, 1, 0, DIP_E1, 0},

/*23*/        {VENDOR_CCD, "HFC-E1 Eval (old)", 1, 1, 0, 0, 0, 0, 0},
/*24*/        {VENDOR_CCD, "HFC-E1 IOB1E1", 1, 1, 0, 1, 0, 0, 0},
/*25*/        {VENDOR_CCD, "HFC-E1", 1, 1, 0, 1, 0, 0, 0},

/*26*/        {VENDOR_CCD, "HFC-4S Speech Design", 4, 4, 0, 0, 0, 0,
                HFC_IO_MODE_PLXSD},
/*27*/        {VENDOR_CCD, "HFC-E1 Speech Design", 1, 1, 0, 0, 0, 0,
                HFC_IO_MODE_PLXSD},
/*28*/        {VENDOR_CCD, "HFC-4S OpenVox", 4, 4, 1, 0, 0, 0, 0},
/*29*/        {VENDOR_CCD, "HFC-2S OpenVox", 4, 2, 1, 0, 0, 0, 0},
/*30*/        {VENDOR_CCD, "HFC-8S OpenVox", 8, 8, 1, 0, 0, 0, 0},
};

#undef H
#define H(x)        ((unsigned long)&hfcm_map[x])
static struct pci_device_id hfmultipci_ids[] __devinitdata = {

        /* Cards with HFC-4S Chip */
        { PCI_VENDOR_ID_CCD, PCI_DEVICE_ID_CCD_HFC4S, PCI_VENDOR_ID_CCD,
                PCI_SUBDEVICE_ID_CCD_BN1SM, 0, 0, H(0)}, /* BN1S mini PCI */
        { PCI_VENDOR_ID_CCD, PCI_DEVICE_ID_CCD_HFC4S, PCI_VENDOR_ID_CCD,
                PCI_SUBDEVICE_ID_CCD_BN2S, 0, 0, H(1)}, /* BN2S */
        { PCI_VENDOR_ID_CCD, PCI_DEVICE_ID_CCD_HFC4S, PCI_VENDOR_ID_CCD,
                PCI_SUBDEVICE_ID_CCD_BN2SM, 0, 0, H(2)}, /* BN2S mini PCI */
        { PCI_VENDOR_ID_CCD, PCI_DEVICE_ID_CCD_HFC4S, PCI_VENDOR_ID_CCD,
                PCI_SUBDEVICE_ID_CCD_BN4S, 0, 0, H(3)}, /* BN4S */
        { PCI_VENDOR_ID_CCD, PCI_DEVICE_ID_CCD_HFC4S, PCI_VENDOR_ID_CCD,
                PCI_SUBDEVICE_ID_CCD_BN4SM, 0, 0, H(4)}, /* BN4S mini PCI */
        { PCI_VENDOR_ID_CCD, PCI_DEVICE_ID_CCD_HFC4S, PCI_VENDOR_ID_CCD,
                PCI_DEVICE_ID_CCD_HFC4S, 0, 0, H(5)}, /* Old Eval */
        { PCI_VENDOR_ID_CCD, PCI_DEVICE_ID_CCD_HFC4S, PCI_VENDOR_ID_CCD,
                PCI_SUBDEVICE_ID_CCD_IOB4ST, 0, 0, H(6)}, /* IOB4ST */
        { PCI_VENDOR_ID_CCD, PCI_DEVICE_ID_CCD_HFC4S, PCI_VENDOR_ID_CCD,
                PCI_SUBDEVICE_ID_CCD_HFC4S, 0, 0, H(7)}, /* 4S */
        { PCI_VENDOR_ID_DIGIUM, PCI_DEVICE_ID_DIGIUM_HFC4S,
                PCI_VENDOR_ID_DIGIUM, PCI_DEVICE_ID_DIGIUM_HFC4S, 0, 0, H(8)},
        { PCI_VENDOR_ID_CCD, PCI_DEVICE_ID_CCD_HFC4S, PCI_VENDOR_ID_CCD,
                PCI_SUBDEVICE_ID_CCD_SWYX4S, 0, 0, H(9)}, /* 4S Swyx */
        { PCI_VENDOR_ID_CCD, PCI_DEVICE_ID_CCD_HFC4S, PCI_VENDOR_ID_CCD,
                PCI_SUBDEVICE_ID_CCD_JH4S20, 0, 0, H(10)},
        { PCI_VENDOR_ID_CCD, PCI_DEVICE_ID_CCD_HFC4S, PCI_VENDOR_ID_CCD,
                PCI_SUBDEVICE_ID_CCD_PMX2S, 0, 0, H(11)}, /* Primux */
        { PCI_VENDOR_ID_CCD, PCI_DEVICE_ID_CCD_HFC4S, PCI_VENDOR_ID_CCD,
                PCI_SUBDEVICE_ID_CCD_OV4S, 0, 0, H(28)}, /* OpenVox 4 */
        { PCI_VENDOR_ID_CCD, PCI_DEVICE_ID_CCD_HFC4S, PCI_VENDOR_ID_CCD,
                PCI_SUBDEVICE_ID_CCD_OV2S, 0, 0, H(29)}, /* OpenVox 2 */

        /* Cards with HFC-8S Chip */
        { PCI_VENDOR_ID_CCD, PCI_DEVICE_ID_CCD_HFC8S, PCI_VENDOR_ID_CCD,
        PCI_SUBDEVICE_ID_CCD_BN8S, 0, 0, H(12)}, /* BN8S */
        { PCI_VENDOR_ID_CCD, PCI_DEVICE_ID_CCD_HFC8S, PCI_VENDOR_ID_CCD,
        PCI_SUBDEVICE_ID_CCD_BN8SP, 0, 0, H(13)}, /* BN8S+ */
        { PCI_VENDOR_ID_CCD, PCI_DEVICE_ID_CCD_HFC8S, PCI_VENDOR_ID_CCD,
        PCI_DEVICE_ID_CCD_HFC8S, 0, 0, H(14)}, /* old Eval */
        { PCI_VENDOR_ID_CCD, PCI_DEVICE_ID_CCD_HFC8S, PCI_VENDOR_ID_CCD,
        PCI_SUBDEVICE_ID_CCD_IOB8STR, 0, 0, H(15)},
            /* IOB8ST Recording */
        { PCI_VENDOR_ID_CCD, PCI_DEVICE_ID_CCD_HFC8S, PCI_VENDOR_ID_CCD,
                PCI_SUBDEVICE_ID_CCD_IOB8ST, 0, 0, H(16)}, /* IOB8ST  */
        { PCI_VENDOR_ID_CCD, PCI_DEVICE_ID_CCD_HFC8S, PCI_VENDOR_ID_CCD,
                PCI_SUBDEVICE_ID_CCD_IOB8ST_1, 0, 0, H(17)}, /* IOB8ST  */
        { PCI_VENDOR_ID_CCD, PCI_DEVICE_ID_CCD_HFC8S, PCI_VENDOR_ID_CCD,
                PCI_SUBDEVICE_ID_CCD_HFC8S, 0, 0, H(18)}, /* 8S */
        { PCI_VENDOR_ID_CCD, PCI_DEVICE_ID_CCD_HFC8S, PCI_VENDOR_ID_CCD,
                PCI_SUBDEVICE_ID_CCD_OV8S, 0, 0, H(30)}, /* OpenVox 8 */


        /* Cards with HFC-E1 Chip */
        { PCI_VENDOR_ID_CCD, PCI_DEVICE_ID_CCD_HFCE1, PCI_VENDOR_ID_CCD,
                PCI_SUBDEVICE_ID_CCD_BNE1, 0, 0, H(19)}, /* BNE1 */
        { PCI_VENDOR_ID_CCD, PCI_DEVICE_ID_CCD_HFCE1, PCI_VENDOR_ID_CCD,
                PCI_SUBDEVICE_ID_CCD_BNE1M, 0, 0, H(20)}, /* BNE1 mini PCI */
        { PCI_VENDOR_ID_CCD, PCI_DEVICE_ID_CCD_HFCE1, PCI_VENDOR_ID_CCD,
                PCI_SUBDEVICE_ID_CCD_BNE1DP, 0, 0, H(21)}, /* BNE1 + (Dual) */
        { PCI_VENDOR_ID_CCD, PCI_DEVICE_ID_CCD_HFCE1, PCI_VENDOR_ID_CCD,
                PCI_SUBDEVICE_ID_CCD_BNE1D, 0, 0, H(22)}, /* BNE1 (Dual) */

        { PCI_VENDOR_ID_CCD, PCI_DEVICE_ID_CCD_HFCE1, PCI_VENDOR_ID_CCD,
                PCI_DEVICE_ID_CCD_HFCE1, 0, 0, H(23)}, /* Old Eval */
        { PCI_VENDOR_ID_CCD, PCI_DEVICE_ID_CCD_HFCE1, PCI_VENDOR_ID_CCD,
                PCI_SUBDEVICE_ID_CCD_IOB1E1, 0, 0, H(24)}, /* IOB1E1 */
        { PCI_VENDOR_ID_CCD, PCI_DEVICE_ID_CCD_HFCE1, PCI_VENDOR_ID_CCD,
                PCI_SUBDEVICE_ID_CCD_HFCE1, 0, 0, H(25)}, /* E1 */

        { PCI_VENDOR_ID_PLX, PCI_DEVICE_ID_PLX_9030, PCI_VENDOR_ID_CCD,
                PCI_SUBDEVICE_ID_CCD_SPD4S, 0, 0, H(26)}, /* PLX PCI Bridge */
        { PCI_VENDOR_ID_PLX, PCI_DEVICE_ID_PLX_9030, PCI_VENDOR_ID_CCD,
                PCI_SUBDEVICE_ID_CCD_SPDE1, 0, 0, H(27)}, /* PLX PCI Bridge */
        { PCI_VENDOR_ID_CCD, PCI_DEVICE_ID_CCD_HFC4S, PCI_ANY_ID, PCI_ANY_ID,
                0, 0, 0},
        { PCI_VENDOR_ID_CCD, PCI_DEVICE_ID_CCD_HFC8S, PCI_ANY_ID, PCI_ANY_ID,
                0, 0, 0},
        { PCI_VENDOR_ID_CCD, PCI_DEVICE_ID_CCD_HFCE1, PCI_ANY_ID, PCI_ANY_ID,
                0, 0, 0},
        {0, }
};
#undef H

MODULE_DEVICE_TABLE(pci, hfmultipci_ids);

static int
hfcmulti_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
{
        struct hm_map        *m = (struct hm_map *)ent->driver_data;
        int                ret;

        if (m == NULL) {
                if (ent->vendor == PCI_VENDOR_ID_CCD)
                        if (ent->device == PCI_DEVICE_ID_CCD_HFC4S ||
                            ent->device == PCI_DEVICE_ID_CCD_HFC8S ||
                            ent->device == PCI_DEVICE_ID_CCD_HFCE1)
                                printk(KERN_ERR
                                    "unknown HFC multiport controller "
                                    "(vendor:%x device:%x subvendor:%x "
                                    "subdevice:%x) Please contact the "
                                    "driver maintainer for support.\n",
                                    ent->vendor, ent->device,
                                    ent->subvendor, ent->subdevice);
                return -ENODEV;
        }
        ret = hfcmulti_init(pdev, ent);
        if (ret)
                return ret;
        HFC_cnt++;
        printk(KERN_INFO "%d devices registered\n", HFC_cnt);
        return 0;
}

static struct pci_driver hfcmultipci_driver = {
        .name                = "hfc_multi",
        .probe                = hfcmulti_probe,
        .remove                = __devexit_p(hfc_remove_pci),
        .id_table        = hfmultipci_ids,
};

static void __exit
HFCmulti_cleanup(void)
{
        struct hfc_multi *card, *next;

        /* unload interrupt function symbol */
        if (hfc_interrupt)
                symbol_put(ztdummy_extern_interrupt);
        if (register_interrupt)
                symbol_put(ztdummy_register_interrupt);
        if (unregister_interrupt) {
                if (interrupt_registered) {
                        interrupt_registered = 0;
                        unregister_interrupt();
                }
                symbol_put(ztdummy_unregister_interrupt);
        }

        list_for_each_entry_safe(card, next, &HFClist, list)
                release_card(card);
        /* get rid of all devices of this driver */
        pci_unregister_driver(&hfcmultipci_driver);
}

static int __init
HFCmulti_init(void)
{
        int err;

#ifdef IRQ_DEBUG
        printk(KERN_ERR "%s: IRQ_DEBUG IS ENABLED!\n", __func__);
#endif

        spin_lock_init(&HFClock);
        spin_lock_init(&plx_lock);

        if (debug & DEBUG_HFCMULTI_INIT)
                printk(KERN_DEBUG "%s: init entered\n", __func__);

        hfc_interrupt = symbol_get(ztdummy_extern_interrupt);
        register_interrupt = symbol_get(ztdummy_register_interrupt);
        unregister_interrupt = symbol_get(ztdummy_unregister_interrupt);
        printk(KERN_INFO "mISDN: HFC-multi driver %s\n",
            hfcmulti_revision);

        switch (poll) {
        case 0:
                poll_timer = 6;
                poll = 128;
                break;
                /*
                 * wenn dieses break nochmal verschwindet,
                 * gibt es heisse ohren :-)
                 * "without the break you will get hot ears ???"
                 */
        case 8:
                poll_timer = 2;
                break;
        case 16:
                poll_timer = 3;
                break;
        case 32:
                poll_timer = 4;
                break;
        case 64:
                poll_timer = 5;
                break;
        case 128:
                poll_timer = 6;
                break;
        case 256:
                poll_timer = 7;
                break;
        default:
                printk(KERN_ERR
                    "%s: Wrong poll value (%d).\n", __func__, poll);
                err = -EINVAL;
                return err;

        }

        err = pci_register_driver(&hfcmultipci_driver);
        if (err < 0) {
                printk(KERN_ERR "error registering pci driver: %x\n", err);
                if (hfc_interrupt)
                        symbol_put(ztdummy_extern_interrupt);
                if (register_interrupt)
                        symbol_put(ztdummy_register_interrupt);
                if (unregister_interrupt) {
                        if (interrupt_registered) {
                                interrupt_registered = 0;
                                unregister_interrupt();
                        }
                        symbol_put(ztdummy_unregister_interrupt);
                }
                return err;
        }
        return 0;
}


module_init(HFCmulti_init);
module_exit(HFCmulti_cleanup);