drivers/net/wan/pc300_drv.c

   1 #define USE_PCI_CLOCK
   2 static char rcsid[] =
   3 "Revision: 3.4.5 Date: 2002/03/07 ";
   4
   5 /*
   6  * pc300.c      Cyclades-PC300(tm) Driver.
   7  *
   8  * Author:      Ivan Passos <ivan@cyclades.com>
   9  * Maintainer:  PC300 Maintainer <pc300@cyclades.com>
  10  *
  11  * Copyright:   (c) 1999-2003 Cyclades Corp.
  12  *
  13  *      This program is free software; you can redistribute it and/or
  14  *      modify it under the terms of the GNU General Public License
  15  *      as published by the Free Software Foundation; either version
  16  *      2 of the License, or (at your option) any later version.
  17  *
  18  *      Using tabstop = 4.
  19  *
  20  * $Log: pc300_drv.c,v $
  21  * Revision 3.23  2002/03/20 13:58:40  henrique
  22  * Fixed ortographic mistakes
  23  *
  24  * Revision 3.22  2002/03/13 16:56:56  henrique
  25  * Take out the debug messages
  26  *
  27  * Revision 3.21  2002/03/07 14:17:09  henrique
  28  * License data fixed
  29  *
  30  * Revision 3.20  2002/01/17 17:58:52  ivan
  31  * Support for PC300-TE/M (PMC).
  32  *
  33  * Revision 3.19  2002/01/03 17:08:47  daniela
  34  * Enables DMA reception when the SCA-II disables it improperly.
  35  *
  36  * Revision 3.18  2001/12/03 18:47:50  daniela
  37  * Esthetic changes.
  38  *
  39  * Revision 3.17  2001/10/19 16:50:13  henrique
  40  * Patch to kernel 2.4.12 and new generic hdlc.
  41  *
  42  * Revision 3.16  2001/10/16 15:12:31  regina
  43  * clear statistics
  44  *
  45  * Revision 3.11 to 3.15  2001/10/11 20:26:04  daniela
  46  * More DMA fixes for noisy lines.
  47  * Return the size of bad frames in dma_get_rx_frame_size, so that the Rx buffer
  48  * descriptors can be cleaned by dma_buf_read (called in cpc_net_rx).
  49  * Renamed dma_start routine to rx_dma_start. Improved Rx statistics.
  50  * Fixed BOF interrupt treatment. Created dma_start routine.
  51  * Changed min and max to cpc_min and cpc_max.
  52  *
  53  * Revision 3.10  2001/08/06 12:01:51  regina
  54  * Fixed problem in DSR_DE bit.
  55  *
  56  * Revision 3.9  2001/07/18 19:27:26  daniela
  57  * Added some history comments.
  58  *
  59  * Revision 3.8  2001/07/12 13:11:19  regina
  60  * bug fix - DCD-OFF in pc300 tty driver
  61  *
  62  * Revision 3.3 to 3.7  2001/07/06 15:00:20  daniela
  63  * Removing kernel 2.4.3 and previous support.
  64  * DMA transmission bug fix.
  65  * MTU check in cpc_net_rx fixed.
  66  * Boot messages reviewed.
  67  * New configuration parameters (line code, CRC calculation and clock).
  68  *
  69  * Revision 3.2 2001/06/22 13:13:02  regina
  70  * MLPPP implementation. Changed the header of message trace to include
  71  * the device name. New format : "hdlcX[R/T]: ".
  72  * Default configuration changed.
  73  *
  74  * Revision 3.1 2001/06/15 regina
  75  * in cpc_queue_xmit, netif_stop_queue is called if don't have free descriptor
  76  * upping major version number
  77  *
  78  * Revision 1.1.1.1  2001/06/13 20:25:04  daniela
  79  * PC300 initial CVS version (3.4.0-pre1)
  80  *
  81  * Revision 3.0.1.2 2001/06/08 daniela
  82  * Did some changes in the DMA programming implementation to avoid the
  83  * occurrence of a SCA-II bug when CDA is accessed during a DMA transfer.
  84  *
  85  * Revision 3.0.1.1 2001/05/02 daniela
  86  * Added kernel 2.4.3 support.
  87  *
  88  * Revision 3.0.1.0 2001/03/13 daniela, henrique
  89  * Added Frame Relay Support.
  90  * Driver now uses HDLC generic driver to provide protocol support.
  91  *
  92  * Revision 3.0.0.8 2001/03/02 daniela
  93  * Fixed ram size detection.
  94  * Changed SIOCGPC300CONF ioctl, to give hw information to pc300util.
  95  *
  96  * Revision 3.0.0.7 2001/02/23 daniela
  97  * netif_stop_queue called before the SCA-II transmition commands in
  98  * cpc_queue_xmit, and with interrupts disabled to avoid race conditions with
  99  * transmition interrupts.
 100  * Fixed falc_check_status for Unframed E1.
 101  *
 102  * Revision 3.0.0.6 2000/12/13 daniela
 103  * Implemented pc300util support: trace, statistics, status and loopback
 104  * tests for the PC300 TE boards.
 105  *
 106  * Revision 3.0.0.5 2000/12/12 ivan
 107  * Added support for Unframed E1.
 108  * Implemented monitor mode.
 109  * Fixed DCD sensitivity on the second channel.
 110  * Driver now complies with new PCI kernel architecture.
 111  *
 112  * Revision 3.0.0.4 2000/09/28 ivan
 113  * Implemented DCD sensitivity.
 114  * Moved hardware-specific open to the end of cpc_open, to avoid race
 115  * conditions with early reception interrupts.
 116  * Included code for [request|release]_mem_region().
 117  * Changed location of pc300.h .
 118  * Minor code revision (contrib. of Jeff Garzik).
 119  *
 120  * Revision 3.0.0.3 2000/07/03 ivan
 121  * Previous bugfix for the framing errors with external clock made X21
 122  * boards stop working. This version fixes it.
 123  *
 124  * Revision 3.0.0.2 2000/06/23 ivan
 125  * Revisited cpc_queue_xmit to prevent race conditions on Tx DMA buffer
 126  * handling when Tx timeouts occur.
 127  * Revisited Rx statistics.
 128  * Fixed a bug in the SCA-II programming that would cause framing errors
 129  * when external clock was configured.
 130  *
 131  * Revision 3.0.0.1 2000/05/26 ivan
 132  * Added logic in the SCA interrupt handler so that no board can monopolize
 133  * the driver.
 134  * Request PLX I/O region, although driver doesn't use it, to avoid
 135  * problems with other drivers accessing it.
 136  *
 137  * Revision 3.0.0.0 2000/05/15 ivan
 138  * Did some changes in the DMA programming implementation to avoid the
 139  * occurrence of a SCA-II bug in the second channel.
 140  * Implemented workaround for PLX9050 bug that would cause a system lockup
 141  * in certain systems, depending on the MMIO addresses allocated to the
 142  * board.
 143  * Fixed the FALC chip programming to avoid synchronization problems in the
 144  * second channel (TE only).
 145  * Implemented a cleaner and faster Tx DMA descriptor cleanup procedure in
 146  * cpc_queue_xmit().
 147  * Changed the built-in driver implementation so that the driver can use the
 148  * general 'hdlcN' naming convention instead of proprietary device names.
 149  * Driver load messages are now device-centric, instead of board-centric.
 150  * Dynamic allocation of net_device structures.
 151  * Code is now compliant with the new module interface (module_[init|exit]).
 152  * Make use of the PCI helper functions to access PCI resources.
 153  *
 154  * Revision 2.0.0.0 2000/04/15 ivan
 155  * Added support for the PC300/TE boards (T1/FT1/E1/FE1).
 156  *
 157  * Revision 1.1.0.0 2000/02/28 ivan
 158  * Major changes in the driver architecture.
 159  * Softnet compliancy implemented.
 160  * Driver now reports physical instead of virtual memory addresses.
 161  * Added cpc_change_mtu function.
 162  *
 163  * Revision 1.0.0.0 1999/12/16 ivan
 164  * First official release.
 165  * Support for 1- and 2-channel boards (which use distinct PCI Device ID's).
 166  * Support for monolythic installation (i.e., drv built into the kernel).
 167  * X.25 additional checking when lapb_[dis]connect_request returns an error.
 168  * SCA programming now covers X.21 as well.
 169  *
 170  * Revision 0.3.1.0 1999/11/18 ivan
 171  * Made X.25 support configuration-dependent (as it depends on external
 172  * modules to work).
 173  * Changed X.25-specific function names to comply with adopted convention.
 174  * Fixed typos in X.25 functions that would cause compile errors (Daniela).
 175  * Fixed bug in ch_config that would disable interrupts on a previously
 176  * enabled channel if the other channel on the same board was enabled later.
 177  *
 178  * Revision 0.3.0.0 1999/11/16 daniela
 179  * X.25 support.
 180  *
 181  * Revision 0.2.3.0 1999/11/15 ivan
 182  * Function cpc_ch_status now provides more detailed information.
 183  * Added support for X.21 clock configuration.
 184  * Changed TNR1 setting in order to prevent Tx FIFO overaccesses by the SCA.
 185  * Now using PCI clock instead of internal oscillator clock for the SCA.
 186  *
 187  * Revision 0.2.2.0 1999/11/10 ivan
 188  * Changed the *_dma_buf_check functions so that they would print only
 189  * the useful info instead of the whole buffer descriptor bank.
 190  * Fixed bug in cpc_queue_xmit that would eventually crash the system
 191  * in case of a packet drop.
 192  * Implemented TX underrun handling.
 193  * Improved SCA fine tuning to boost up its performance.
 194  *
 195  * Revision 0.2.1.0 1999/11/03 ivan
 196  * Added functions *dma_buf_pt_init to allow independent initialization
 197  * of the next-descr. and DMA buffer pointers on the DMA descriptors.
 198  * Kernel buffer release and tbusy clearing is now done in the interrupt
 199  * handler.
 200  * Fixed bug in cpc_open that would cause an interface reopen to fail.
 201  * Added a protocol-specific code section in cpc_net_rx.
 202  * Removed printk level defs (they might be added back after the beta phase).
 203  *
 204  * Revision 0.2.0.0 1999/10/28 ivan
 205  * Revisited the code so that new protocols can be easily added / supported.
 206  *
 207  * Revision 0.1.0.1 1999/10/20 ivan
 208  * Mostly "esthetic" changes.
 209  *
 210  * Revision 0.1.0.0 1999/10/11 ivan
 211  * Initial version.
 212  *
 213  */
 214
 215 #include <linux/module.h>
 216 #include <linux/kernel.h>
 217 #include <linux/mm.h>
 218 #include <linux/ioport.h>
 219 #include <linux/pci.h>
 220 #include <linux/errno.h>
 221 #include <linux/string.h>
 222 #include <linux/init.h>
 223 #include <linux/delay.h>
 224 #include <linux/net.h>
 225 #include <linux/skbuff.h>
 226 #include <linux/if_arp.h>
 227 #include <linux/netdevice.h>
 228 #include <linux/spinlock.h>
 229 #include <linux/if.h>
 230
 231 #include <net/syncppp.h>
 232 #include <net/arp.h>
 233
 234 #include <asm/io.h>
 235 #include <asm/uaccess.h>
 236
 237 #include "pc300.h"
 238
 239 #define CPC_LOCK(card,flags)            \
 240                 do {                                            \
 241                 spin_lock_irqsave(&card->card_lock, flags);     \
 242                 } while (0)
 243
 244 #define CPC_UNLOCK(card,flags)                  \
 245                 do {                                                    \
 246                 spin_unlock_irqrestore(&card->card_lock, flags);        \
 247                 } while (0)
 248
 249 #undef  PC300_DEBUG_PCI
 250 #undef  PC300_DEBUG_INTR
 251 #undef  PC300_DEBUG_TX
 252 #undef  PC300_DEBUG_RX
 253 #undef  PC300_DEBUG_OTHER
 254
 255 static struct pci_device_id cpc_pci_dev_id[] __devinitdata = {
 256         /* PC300/RSV or PC300/X21, 2 chan */
 257         {0x120e, 0x300, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0x300},
 258         /* PC300/RSV or PC300/X21, 1 chan */
 259         {0x120e, 0x301, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0x301},
 260         /* PC300/TE, 2 chan */
 261         {0x120e, 0x310, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0x310},
 262         /* PC300/TE, 1 chan */
 263         {0x120e, 0x311, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0x311},
 264         /* PC300/TE-M, 2 chan */
 265         {0x120e, 0x320, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0x320},
 266         /* PC300/TE-M, 1 chan */
 267         {0x120e, 0x321, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0x321},
 268         /* End of table */
 269         {0,},
 270 };
 271 MODULE_DEVICE_TABLE(pci, cpc_pci_dev_id);
 272
 273 #ifndef cpc_min
 274 #define cpc_min(a,b)    (((a)<(b))?(a):(b))
 275 #endif
 276 #ifndef cpc_max
 277 #define cpc_max(a,b)    (((a)>(b))?(a):(b))
 278 #endif
 279
 280 /* prototypes */
 281 static void tx_dma_buf_pt_init(pc300_t *, int);
 282 static void tx_dma_buf_init(pc300_t *, int);
 283 static void rx_dma_buf_pt_init(pc300_t *, int);
 284 static void rx_dma_buf_init(pc300_t *, int);
 285 static void tx_dma_buf_check(pc300_t *, int);
 286 static void rx_dma_buf_check(pc300_t *, int);
 287 static irqreturn_t cpc_intr(int, void *, struct pt_regs *);
 288 static struct net_device_stats *cpc_get_stats(struct net_device *);
 289 static int clock_rate_calc(uclong, uclong, int *);
 290 static uclong detect_ram(pc300_t *);
 291 static void plx_init(pc300_t *);
 292 static void cpc_trace(struct net_device *, struct sk_buff *, char);
 293 static int cpc_attach(struct net_device *, unsigned short, unsigned short);
 294
 295 #ifdef CONFIG_PC300_MLPPP
 296 void cpc_tty_init(pc300dev_t * dev);
 297 void cpc_tty_unregister_service(pc300dev_t * pc300dev);
 298 void cpc_tty_receive(pc300dev_t * pc300dev);
 299 void cpc_tty_trigger_poll(pc300dev_t * pc300dev);
 300 void cpc_tty_reset_var(void);
 301 #endif
 302
 303 /************************/
 304 /***   DMA Routines   ***/
 305 /************************/
 306 static void tx_dma_buf_pt_init(pc300_t * card, int ch)
 307 {
 308         int i;
 309         int ch_factor = ch * N_DMA_TX_BUF;
 310         volatile pcsca_bd_t *ptdescr = (pcsca_bd_t *) (card->hw.rambase
 311                                        + DMA_TX_BD_BASE + ch_factor * sizeof(pcsca_bd_t));
 312
 313         for (i = 0; i < N_DMA_TX_BUF; i++, ptdescr++) {
 314                 cpc_writel(&ptdescr->next, (uclong) (DMA_TX_BD_BASE +
 315                         (ch_factor + ((i + 1) & (N_DMA_TX_BUF - 1))) * sizeof(pcsca_bd_t)));
 316                 cpc_writel(&ptdescr->ptbuf,
 317                                                 (uclong) (DMA_TX_BASE + (ch_factor + i) * BD_DEF_LEN));
 318         }
 319 }
 320
 321 static void tx_dma_buf_init(pc300_t * card, int ch)
 322 {
 323         int i;
 324         int ch_factor = ch * N_DMA_TX_BUF;
 325         volatile pcsca_bd_t *ptdescr = (pcsca_bd_t *) (card->hw.rambase
 326                                + DMA_TX_BD_BASE + ch_factor * sizeof(pcsca_bd_t));
 327
 328         for (i = 0; i < N_DMA_TX_BUF; i++, ptdescr++) {
 329                 memset_io(ptdescr, 0, sizeof(pcsca_bd_t));
 330                 cpc_writew(&ptdescr->len, 0);
 331                 cpc_writeb(&ptdescr->status, DST_OSB);
 332         }
 333         tx_dma_buf_pt_init(card, ch);
 334 }
 335
 336 static void rx_dma_buf_pt_init(pc300_t * card, int ch)
 337 {
 338         int i;
 339         int ch_factor = ch * N_DMA_RX_BUF;
 340         volatile pcsca_bd_t *ptdescr = (pcsca_bd_t *) (card->hw.rambase
 341                                        + DMA_RX_BD_BASE + ch_factor * sizeof(pcsca_bd_t));
 342
 343         for (i = 0; i < N_DMA_RX_BUF; i++, ptdescr++) {
 344                 cpc_writel(&ptdescr->next, (uclong) (DMA_RX_BD_BASE +
 345                 (ch_factor + ((i + 1) & (N_DMA_RX_BUF - 1))) * sizeof(pcsca_bd_t)));
 346                 cpc_writel(&ptdescr->ptbuf,
 347                            (uclong) (DMA_RX_BASE + (ch_factor + i) * BD_DEF_LEN));
 348         }
 349 }
 350
 351 static void rx_dma_buf_init(pc300_t * card, int ch)
 352 {
 353         int i;
 354         int ch_factor = ch * N_DMA_RX_BUF;
 355         volatile pcsca_bd_t *ptdescr = (pcsca_bd_t *) (card->hw.rambase
 356                                        + DMA_RX_BD_BASE + ch_factor * sizeof(pcsca_bd_t));
 357
 358         for (i = 0; i < N_DMA_RX_BUF; i++, ptdescr++) {
 359                 memset_io(ptdescr, 0, sizeof(pcsca_bd_t));
 360                 cpc_writew(&ptdescr->len, 0);
 361                 cpc_writeb(&ptdescr->status, 0);
 362         }
 363         rx_dma_buf_pt_init(card, ch);
 364 }
 365
 366 static void tx_dma_buf_check(pc300_t * card, int ch)
 367 {
 368         volatile pcsca_bd_t *ptdescr;
 369         int i;
 370         ucshort first_bd = card->chan[ch].tx_first_bd;
 371         ucshort next_bd = card->chan[ch].tx_next_bd;
 372
 373         printk("#CH%d: f_bd = %d(0x%08zx), n_bd = %d(0x%08zx)\n", ch,
 374                first_bd, TX_BD_ADDR(ch, first_bd),
 375                next_bd, TX_BD_ADDR(ch, next_bd));
 376         for (i = first_bd,
 377              ptdescr = (pcsca_bd_t *) (card->hw.rambase + TX_BD_ADDR(ch, first_bd));
 378              i != ((next_bd + 1) & (N_DMA_TX_BUF - 1));
 379              i = (i + 1) & (N_DMA_TX_BUF - 1),
 380                  ptdescr = (pcsca_bd_t *) (card->hw.rambase + TX_BD_ADDR(ch, i))) {
 381                 printk("\n CH%d TX%d: next=0x%lx, ptbuf=0x%lx, ST=0x%x, len=%d",
 382                        ch, i, (uclong) cpc_readl(&ptdescr->next),
 383                        (uclong) cpc_readl(&ptdescr->ptbuf),
 384                        cpc_readb(&ptdescr->status), cpc_readw(&ptdescr->len));
 385         }
 386         printk("\n");
 387 }
 388
 389 #ifdef  PC300_DEBUG_OTHER
 390 /* Show all TX buffer descriptors */
 391 static void tx1_dma_buf_check(pc300_t * card, int ch)
 392 {
 393         volatile pcsca_bd_t *ptdescr;
 394         int i;
 395         ucshort first_bd = card->chan[ch].tx_first_bd;
 396         ucshort next_bd = card->chan[ch].tx_next_bd;
 397         uclong scabase = card->hw.scabase;
 398
 399         printk ("\nnfree_tx_bd = %d \n", card->chan[ch].nfree_tx_bd);
 400         printk("#CH%d: f_bd = %d(0x%08x), n_bd = %d(0x%08x)\n", ch,
 401                first_bd, TX_BD_ADDR(ch, first_bd),
 402                next_bd, TX_BD_ADDR(ch, next_bd));
 403         printk("TX_CDA=0x%08lx, TX_EDA=0x%08lx\n",
 404                (uclong) cpc_readl(scabase + DTX_REG(CDAL, ch)),
 405                (uclong) cpc_readl(scabase + DTX_REG(EDAL, ch)));
 406         for (i = 0; i < N_DMA_TX_BUF; i++) {
 407                 ptdescr = (pcsca_bd_t *) (card->hw.rambase + TX_BD_ADDR(ch, i));
 408                 printk("\n CH%d TX%d: next=0x%lx, ptbuf=0x%lx, ST=0x%x, len=%d",
 409                        ch, i, (uclong) cpc_readl(&ptdescr->next),
 410                        (uclong) cpc_readl(&ptdescr->ptbuf),
 411                        cpc_readb(&ptdescr->status), cpc_readw(&ptdescr->len));
 412         }
 413         printk("\n");
 414 }
 415 #endif
 416
 417 static void rx_dma_buf_check(pc300_t * card, int ch)
 418 {
 419         volatile pcsca_bd_t *ptdescr;
 420         int i;
 421         ucshort first_bd = card->chan[ch].rx_first_bd;
 422         ucshort last_bd = card->chan[ch].rx_last_bd;
 423         int ch_factor;
 424
 425         ch_factor = ch * N_DMA_RX_BUF;
 426         printk("#CH%d: f_bd = %d, l_bd = %d\n", ch, first_bd, last_bd);
 427         for (i = 0, ptdescr = (pcsca_bd_t *) (card->hw.rambase +
 428                                               DMA_RX_BD_BASE + ch_factor * sizeof(pcsca_bd_t));
 429              i < N_DMA_RX_BUF; i++, ptdescr++) {
 430                 if (cpc_readb(&ptdescr->status) & DST_OSB)
 431                         printk ("\n CH%d RX%d: next=0x%lx, ptbuf=0x%lx, ST=0x%x, len=%d",
 432                                  ch, i, (uclong) cpc_readl(&ptdescr->next),
 433                                  (uclong) cpc_readl(&ptdescr->ptbuf),
 434                                  cpc_readb(&ptdescr->status),
 435                                  cpc_readw(&ptdescr->len));
 436         }
 437         printk("\n");
 438 }
 439
 440 int dma_get_rx_frame_size(pc300_t * card, int ch)
 441 {
 442         volatile pcsca_bd_t *ptdescr;
 443         ucshort first_bd = card->chan[ch].rx_first_bd;
 444         int rcvd = 0;
 445         volatile ucchar status;
 446
 447         ptdescr = (pcsca_bd_t *)(card->hw.rambase + RX_BD_ADDR(ch, first_bd));
 448         while ((status = cpc_readb(&ptdescr->status)) & DST_OSB) {
 449                 rcvd += cpc_readw(&ptdescr->len);
 450                 first_bd = (first_bd + 1) & (N_DMA_RX_BUF - 1);
 451                 if ((status & DST_EOM) || (first_bd == card->chan[ch].rx_last_bd)) {
 452                         /* Return the size of a good frame or incomplete bad frame
 453                         * (dma_buf_read will clean the buffer descriptors in this case). */
 454                         return (rcvd);
 455                 }
 456                 ptdescr = (pcsca_bd_t *)(card->hw.rambase + cpc_readl(&ptdescr->next));
 457         }
 458         return (-1);
 459 }
 460
 461 /*
 462  * dma_buf_write: writes a frame to the Tx DMA buffers
 463  * NOTE: this function writes one frame at a time.
 464  */
 465 int dma_buf_write(pc300_t * card, int ch, ucchar * ptdata, int len)
 466 {
 467         int i, nchar;
 468         volatile pcsca_bd_t *ptdescr;
 469         int tosend = len;
 470         ucchar nbuf = ((len - 1) / BD_DEF_LEN) + 1;
 471
 472         if (nbuf >= card->chan[ch].nfree_tx_bd) {
 473                 return -ENOMEM;
 474         }
 475
 476         for (i = 0; i < nbuf; i++) {
 477                 ptdescr = (pcsca_bd_t *) (card->hw.rambase +
 478                                           TX_BD_ADDR(ch, card->chan[ch].tx_next_bd));
 479                 nchar = cpc_min(BD_DEF_LEN, tosend);
 480                 if (cpc_readb(&ptdescr->status) & DST_OSB) {
 481                         memcpy_toio((void *)(card->hw.rambase + cpc_readl(&ptdescr->ptbuf)),
 482                                     &ptdata[len - tosend], nchar);
 483                         cpc_writew(&ptdescr->len, nchar);
 484                         card->chan[ch].nfree_tx_bd--;
 485                         if ((i + 1) == nbuf) {
 486                                 /* This must be the last BD to be used */
 487                                 cpc_writeb(&ptdescr->status, DST_EOM);
 488                         } else {
 489                                 cpc_writeb(&ptdescr->status, 0);
 490                         }
 491                 } else {
 492                         return -ENOMEM;
 493                 }
 494                 tosend -= nchar;
 495                 card->chan[ch].tx_next_bd =
 496                         (card->chan[ch].tx_next_bd + 1) & (N_DMA_TX_BUF - 1);
 497         }
 498         /* If it gets to here, it means we have sent the whole frame */
 499         return 0;
 500 }
 501
 502 /*
 503  * dma_buf_read: reads a frame from the Rx DMA buffers
 504  * NOTE: this function reads one frame at a time.
 505  */
 506 int dma_buf_read(pc300_t * card, int ch, struct sk_buff *skb)
 507 {
 508         int nchar;
 509         pc300ch_t *chan = (pc300ch_t *) & card->chan[ch];
 510         volatile pcsca_bd_t *ptdescr;
 511         int rcvd = 0;
 512         volatile ucchar status;
 513
 514         ptdescr = (pcsca_bd_t *) (card->hw.rambase +
 515                                   RX_BD_ADDR(ch, chan->rx_first_bd));
 516         while ((status = cpc_readb(&ptdescr->status)) & DST_OSB) {
 517                 nchar = cpc_readw(&ptdescr->len);
 518                 if ((status & (DST_OVR | DST_CRC | DST_RBIT | DST_SHRT | DST_ABT))
 519                     || (nchar > BD_DEF_LEN)) {
 520
 521                         if (nchar > BD_DEF_LEN)
 522                                 status |= DST_RBIT;
 523                         rcvd = -status;
 524                         /* Discard remaining descriptors used by the bad frame */
 525                         while (chan->rx_first_bd != chan->rx_last_bd) {
 526                                 cpc_writeb(&ptdescr->status, 0);
 527                                 chan->rx_first_bd = (chan->rx_first_bd+1) & (N_DMA_RX_BUF-1);
 528                                 if (status & DST_EOM)
 529                                         break;
 530                                 ptdescr = (pcsca_bd_t *) (card->hw.rambase +
 531                                                           cpc_readl(&ptdescr->next));
 532                                 status = cpc_readb(&ptdescr->status);
 533                         }
 534                         break;
 535                 }
 536                 if (nchar != 0) {
 537                         if (skb) {
 538                                 memcpy_fromio(skb_put(skb, nchar),
 539                                  (void *)(card->hw.rambase+cpc_readl(&ptdescr->ptbuf)),nchar);
 540                         }
 541                         rcvd += nchar;
 542                 }
 543                 cpc_writeb(&ptdescr->status, 0);
 544                 cpc_writeb(&ptdescr->len, 0);
 545                 chan->rx_first_bd = (chan->rx_first_bd + 1) & (N_DMA_RX_BUF - 1);
 546
 547                 if (status & DST_EOM)
 548                         break;
 549
 550                 ptdescr = (pcsca_bd_t *) (card->hw.rambase + cpc_readl(&ptdescr->next));
 551         }
 552
 553         if (rcvd != 0) {
 554                 /* Update pointer */
 555                 chan->rx_last_bd = (chan->rx_first_bd - 1) & (N_DMA_RX_BUF - 1);
 556                 /* Update EDA */
 557                 cpc_writel(card->hw.scabase + DRX_REG(EDAL, ch),
 558                            RX_BD_ADDR(ch, chan->rx_last_bd));
 559         }
 560         return (rcvd);
 561 }
 562
 563 void tx_dma_stop(pc300_t * card, int ch)
 564 {
 565         uclong scabase = card->hw.scabase;
 566         ucchar drr_ena_bit = 1 << (5 + 2 * ch);
 567         ucchar drr_rst_bit = 1 << (1 + 2 * ch);
 568
 569         /* Disable DMA */
 570         cpc_writeb(scabase + DRR, drr_ena_bit);
 571         cpc_writeb(scabase + DRR, drr_rst_bit & ~drr_ena_bit);
 572 }
 573
 574 void rx_dma_stop(pc300_t * card, int ch)
 575 {
 576         uclong scabase = card->hw.scabase;
 577         ucchar drr_ena_bit = 1 << (4 + 2 * ch);
 578         ucchar drr_rst_bit = 1 << (2 * ch);
 579
 580         /* Disable DMA */
 581         cpc_writeb(scabase + DRR, drr_ena_bit);
 582         cpc_writeb(scabase + DRR, drr_rst_bit & ~drr_ena_bit);
 583 }
 584
 585 void rx_dma_start(pc300_t * card, int ch)
 586 {
 587         uclong scabase = card->hw.scabase;
 588         pc300ch_t *chan = (pc300ch_t *) & card->chan[ch];
 589
 590         /* Start DMA */
 591         cpc_writel(scabase + DRX_REG(CDAL, ch),
 592                    RX_BD_ADDR(ch, chan->rx_first_bd));
 593         if (cpc_readl(scabase + DRX_REG(CDAL,ch)) !=
 594                                   RX_BD_ADDR(ch, chan->rx_first_bd)) {
 595                 cpc_writel(scabase + DRX_REG(CDAL, ch),
 596                                    RX_BD_ADDR(ch, chan->rx_first_bd));
 597         }
 598         cpc_writel(scabase + DRX_REG(EDAL, ch),
 599                    RX_BD_ADDR(ch, chan->rx_last_bd));
 600         cpc_writew(scabase + DRX_REG(BFLL, ch), BD_DEF_LEN);
 601         cpc_writeb(scabase + DSR_RX(ch), DSR_DE);
 602         if (!(cpc_readb(scabase + DSR_RX(ch)) & DSR_DE)) {
 603         cpc_writeb(scabase + DSR_RX(ch), DSR_DE);
 604         }
 605 }
 606
 607 /*************************/
 608 /***   FALC Routines   ***/
 609 /*************************/
 610 void falc_issue_cmd(pc300_t * card, int ch, ucchar cmd)
 611 {
 612         uclong falcbase = card->hw.falcbase;
 613         unsigned long i = 0;
 614
 615         while (cpc_readb(falcbase + F_REG(SIS, ch)) & SIS_CEC) {
 616                 if (i++ >= PC300_FALC_MAXLOOP) {
 617                         printk("%s: FALC command locked(cmd=0x%x).\n",
 618                                card->chan[ch].d.name, cmd);
 619                         break;
 620                 }
 621         }
 622         cpc_writeb(falcbase + F_REG(CMDR, ch), cmd);
 623 }
 624
 625 void falc_intr_enable(pc300_t * card, int ch)
 626 {
 627         pc300ch_t *chan = (pc300ch_t *) & card->chan[ch];
 628         pc300chconf_t *conf = (pc300chconf_t *) & chan->conf;
 629         falc_t *pfalc = (falc_t *) & chan->falc;
 630         uclong falcbase = card->hw.falcbase;
 631
 632         /* Interrupt pins are open-drain */
 633         cpc_writeb(falcbase + F_REG(IPC, ch),
 634                    cpc_readb(falcbase + F_REG(IPC, ch)) & ~IPC_IC0);
 635         /* Conters updated each second */
 636         cpc_writeb(falcbase + F_REG(FMR1, ch),
 637                    cpc_readb(falcbase + F_REG(FMR1, ch)) | FMR1_ECM);
 638         /* Enable SEC and ES interrupts  */
 639         cpc_writeb(falcbase + F_REG(IMR3, ch),
 640                    cpc_readb(falcbase + F_REG(IMR3, ch)) & ~(IMR3_SEC | IMR3_ES));
 641         if (conf->fr_mode == PC300_FR_UNFRAMED) {
 642                 cpc_writeb(falcbase + F_REG(IMR4, ch),
 643                            cpc_readb(falcbase + F_REG(IMR4, ch)) & ~(IMR4_LOS));
 644         } else {
 645                 cpc_writeb(falcbase + F_REG(IMR4, ch),
 646                            cpc_readb(falcbase + F_REG(IMR4, ch)) &
 647                            ~(IMR4_LFA | IMR4_AIS | IMR4_LOS | IMR4_SLIP));
 648         }
 649         if (conf->media == IF_IFACE_T1) {
 650                 cpc_writeb(falcbase + F_REG(IMR3, ch),
 651                            cpc_readb(falcbase + F_REG(IMR3, ch)) & ~IMR3_LLBSC);
 652         } else {
 653                 cpc_writeb(falcbase + F_REG(IPC, ch),
 654                            cpc_readb(falcbase + F_REG(IPC, ch)) | IPC_SCI);
 655                 if (conf->fr_mode == PC300_FR_UNFRAMED) {
 656                         cpc_writeb(falcbase + F_REG(IMR2, ch),
 657                                    cpc_readb(falcbase + F_REG(IMR2, ch)) & ~(IMR2_LOS));
 658                 } else {
 659                         cpc_writeb(falcbase + F_REG(IMR2, ch),
 660                                    cpc_readb(falcbase + F_REG(IMR2, ch)) &
 661                                    ~(IMR2_FAR | IMR2_LFA | IMR2_AIS | IMR2_LOS));
 662                         if (pfalc->multiframe_mode) {
 663                                 cpc_writeb(falcbase + F_REG(IMR2, ch),
 664                                            cpc_readb(falcbase + F_REG(IMR2, ch)) &
 665                                            ~(IMR2_T400MS | IMR2_MFAR));
 666                         } else {
 667                                 cpc_writeb(falcbase + F_REG(IMR2, ch),
 668                                            cpc_readb(falcbase + F_REG(IMR2, ch)) |
 669                                            IMR2_T400MS | IMR2_MFAR);
 670                         }
 671                 }
 672         }
 673 }
 674
 675 void falc_open_timeslot(pc300_t * card, int ch, int timeslot)
 676 {
 677         uclong falcbase = card->hw.falcbase;
 678         ucchar tshf = card->chan[ch].falc.offset;
 679
 680         cpc_writeb(falcbase + F_REG((ICB1 + (timeslot - tshf) / 8), ch),
 681                    cpc_readb(falcbase + F_REG((ICB1 + (timeslot - tshf) / 8), ch)) &
 682                         ~(0x80 >> ((timeslot - tshf) & 0x07)));
 683         cpc_writeb(falcbase + F_REG((TTR1 + timeslot / 8), ch),
 684                    cpc_readb(falcbase + F_REG((TTR1 + timeslot / 8), ch)) |
 685                         (0x80 >> (timeslot & 0x07)));
 686         cpc_writeb(falcbase + F_REG((RTR1 + timeslot / 8), ch),
 687                    cpc_readb(falcbase + F_REG((RTR1 + timeslot / 8), ch)) |
 688                         (0x80 >> (timeslot & 0x07)));
 689 }
 690
 691 void falc_close_timeslot(pc300_t * card, int ch, int timeslot)
 692 {
 693         uclong falcbase = card->hw.falcbase;
 694         ucchar tshf = card->chan[ch].falc.offset;
 695
 696         cpc_writeb(falcbase + F_REG((ICB1 + (timeslot - tshf) / 8), ch),
 697                    cpc_readb(falcbase + F_REG((ICB1 + (timeslot - tshf) / 8), ch)) |
 698                    (0x80 >> ((timeslot - tshf) & 0x07)));
 699         cpc_writeb(falcbase + F_REG((TTR1 + timeslot / 8), ch),
 700                    cpc_readb(falcbase + F_REG((TTR1 + timeslot / 8), ch)) &
 701                    ~(0x80 >> (timeslot & 0x07)));
 702         cpc_writeb(falcbase + F_REG((RTR1 + timeslot / 8), ch),
 703                    cpc_readb(falcbase + F_REG((RTR1 + timeslot / 8), ch)) &
 704                    ~(0x80 >> (timeslot & 0x07)));
 705 }
 706
 707 void falc_close_all_timeslots(pc300_t * card, int ch)
 708 {
 709         pc300ch_t *chan = (pc300ch_t *) & card->chan[ch];
 710         pc300chconf_t *conf = (pc300chconf_t *) & chan->conf;
 711         uclong falcbase = card->hw.falcbase;
 712
 713         cpc_writeb(falcbase + F_REG(ICB1, ch), 0xff);
 714         cpc_writeb(falcbase + F_REG(TTR1, ch), 0);
 715         cpc_writeb(falcbase + F_REG(RTR1, ch), 0);
 716         cpc_writeb(falcbase + F_REG(ICB2, ch), 0xff);
 717         cpc_writeb(falcbase + F_REG(TTR2, ch), 0);
 718         cpc_writeb(falcbase + F_REG(RTR2, ch), 0);
 719         cpc_writeb(falcbase + F_REG(ICB3, ch), 0xff);
 720         cpc_writeb(falcbase + F_REG(TTR3, ch), 0);
 721         cpc_writeb(falcbase + F_REG(RTR3, ch), 0);
 722         if (conf->media == IF_IFACE_E1) {
 723                 cpc_writeb(falcbase + F_REG(ICB4, ch), 0xff);
 724                 cpc_writeb(falcbase + F_REG(TTR4, ch), 0);
 725                 cpc_writeb(falcbase + F_REG(RTR4, ch), 0);
 726         }
 727 }
 728
 729 void falc_open_all_timeslots(pc300_t * card, int ch)
 730 {
 731         pc300ch_t *chan = (pc300ch_t *) & card->chan[ch];
 732         pc300chconf_t *conf = (pc300chconf_t *) & chan->conf;
 733         uclong falcbase = card->hw.falcbase;
 734
 735         cpc_writeb(falcbase + F_REG(ICB1, ch), 0);
 736         if (conf->fr_mode == PC300_FR_UNFRAMED) {
 737                 cpc_writeb(falcbase + F_REG(TTR1, ch), 0xff);
 738                 cpc_writeb(falcbase + F_REG(RTR1, ch), 0xff);
 739         } else {
 740                 /* Timeslot 0 is never enabled */
 741                 cpc_writeb(falcbase + F_REG(TTR1, ch), 0x7f);
 742                 cpc_writeb(falcbase + F_REG(RTR1, ch), 0x7f);
 743         }
 744         cpc_writeb(falcbase + F_REG(ICB2, ch), 0);
 745         cpc_writeb(falcbase + F_REG(TTR2, ch), 0xff);
 746         cpc_writeb(falcbase + F_REG(RTR2, ch), 0xff);
 747         cpc_writeb(falcbase + F_REG(ICB3, ch), 0);
 748         cpc_writeb(falcbase + F_REG(TTR3, ch), 0xff);
 749         cpc_writeb(falcbase + F_REG(RTR3, ch), 0xff);
 750         if (conf->media == IF_IFACE_E1) {
 751                 cpc_writeb(falcbase + F_REG(ICB4, ch), 0);
 752                 cpc_writeb(falcbase + F_REG(TTR4, ch), 0xff);
 753                 cpc_writeb(falcbase + F_REG(RTR4, ch), 0xff);
 754         } else {
 755                 cpc_writeb(falcbase + F_REG(ICB4, ch), 0xff);
 756                 cpc_writeb(falcbase + F_REG(TTR4, ch), 0x80);
 757                 cpc_writeb(falcbase + F_REG(RTR4, ch), 0x80);
 758         }
 759 }
 760
 761 void falc_init_timeslot(pc300_t * card, int ch)
 762 {
 763         pc300ch_t *chan = (pc300ch_t *) & card->chan[ch];
 764         pc300chconf_t *conf = (pc300chconf_t *) & chan->conf;
 765         falc_t *pfalc = (falc_t *) & chan->falc;
 766         int tslot;
 767
 768         for (tslot = 0; tslot < pfalc->num_channels; tslot++) {
 769                 if (conf->tslot_bitmap & (1 << tslot)) {
 770                         // Channel enabled
 771                         falc_open_timeslot(card, ch, tslot + 1);
 772                 } else {
 773                         // Channel disabled
 774                         falc_close_timeslot(card, ch, tslot + 1);
 775                 }
 776         }
 777 }
 778
 779 void falc_enable_comm(pc300_t * card, int ch)
 780 {
 781         pc300ch_t *chan = (pc300ch_t *) & card->chan[ch];
 782         falc_t *pfalc = (falc_t *) & chan->falc;
 783
 784         if (pfalc->full_bandwidth) {
 785                 falc_open_all_timeslots(card, ch);
 786         } else {
 787                 falc_init_timeslot(card, ch);
 788         }
 789         // CTS/DCD ON
 790         cpc_writeb(card->hw.falcbase + card->hw.cpld_reg1,
 791                    cpc_readb(card->hw.falcbase + card->hw.cpld_reg1) &
 792                    ~((CPLD_REG1_FALC_DCD | CPLD_REG1_FALC_CTS) << (2 * ch)));
 793 }
 794
 795 void falc_disable_comm(pc300_t * card, int ch)
 796 {
 797         pc300ch_t *chan = (pc300ch_t *) & card->chan[ch];
 798         falc_t *pfalc = (falc_t *) & chan->falc;
 799
 800         if (pfalc->loop_active != 2) {
 801                 falc_close_all_timeslots(card, ch);
 802         }
 803         // CTS/DCD OFF
 804         cpc_writeb(card->hw.falcbase + card->hw.cpld_reg1,
 805                    cpc_readb(card->hw.falcbase + card->hw.cpld_reg1) |
 806                    ((CPLD_REG1_FALC_DCD | CPLD_REG1_FALC_CTS) << (2 * ch)));
 807 }
 808
 809 void falc_init_t1(pc300_t * card, int ch)
 810 {
 811         pc300ch_t *chan = (pc300ch_t *) & card->chan[ch];
 812         pc300chconf_t *conf = (pc300chconf_t *) & chan->conf;
 813         falc_t *pfalc = (falc_t *) & chan->falc;
 814         uclong falcbase = card->hw.falcbase;
 815         ucchar dja = (ch ? (LIM2_DJA2 | LIM2_DJA1) : 0);
 816
 817         /* Switch to T1 mode (PCM 24) */
 818         cpc_writeb(falcbase + F_REG(FMR1, ch), FMR1_PMOD);
 819
 820         /* Wait 20 us for setup */
 821         udelay(20);
 822
 823         /* Transmit Buffer Size (1 frame) */
 824         cpc_writeb(falcbase + F_REG(SIC1, ch), SIC1_XBS0);
 825
 826         /* Clock mode */
 827         if (conf->phys_settings.clock_type == CLOCK_INT) { /* Master mode */
 828                 cpc_writeb(falcbase + F_REG(LIM0, ch),
 829                            cpc_readb(falcbase + F_REG(LIM0, ch)) | LIM0_MAS);
 830         } else { /* Slave mode */
 831                 cpc_writeb(falcbase + F_REG(LIM0, ch),
 832                            cpc_readb(falcbase + F_REG(LIM0, ch)) & ~LIM0_MAS);
 833                 cpc_writeb(falcbase + F_REG(LOOP, ch),
 834                            cpc_readb(falcbase + F_REG(LOOP, ch)) & ~LOOP_RTM);
 835         }
 836
 837         cpc_writeb(falcbase + F_REG(IPC, ch), IPC_SCI);
 838         cpc_writeb(falcbase + F_REG(FMR0, ch),
 839                    cpc_readb(falcbase + F_REG(FMR0, ch)) &
 840                    ~(FMR0_XC0 | FMR0_XC1 | FMR0_RC0 | FMR0_RC1));
 841
 842         switch (conf->lcode) {
 843                 case PC300_LC_AMI:
 844                         cpc_writeb(falcbase + F_REG(FMR0, ch),
 845                                    cpc_readb(falcbase + F_REG(FMR0, ch)) |
 846                                    FMR0_XC1 | FMR0_RC1);
 847                         /* Clear Channel register to ON for all channels */
 848                         cpc_writeb(falcbase + F_REG(CCB1, ch), 0xff);
 849                         cpc_writeb(falcbase + F_REG(CCB2, ch), 0xff);
 850                         cpc_writeb(falcbase + F_REG(CCB3, ch), 0xff);
 851                         break;
 852
 853                 case PC300_LC_B8ZS:
 854                         cpc_writeb(falcbase + F_REG(FMR0, ch),
 855                                    cpc_readb(falcbase + F_REG(FMR0, ch)) |
 856                                    FMR0_XC0 | FMR0_XC1 | FMR0_RC0 | FMR0_RC1);
 857                         break;
 858
 859                 case PC300_LC_NRZ:
 860                         cpc_writeb(falcbase + F_REG(FMR0, ch),
 861                                    cpc_readb(falcbase + F_REG(FMR0, ch)) | 0x00);
 862                         break;
 863         }
 864
 865         cpc_writeb(falcbase + F_REG(LIM0, ch),
 866                    cpc_readb(falcbase + F_REG(LIM0, ch)) | LIM0_ELOS);
 867         cpc_writeb(falcbase + F_REG(LIM0, ch),
 868                    cpc_readb(falcbase + F_REG(LIM0, ch)) & ~(LIM0_SCL1 | LIM0_SCL0));
 869         /* Set interface mode to 2 MBPS */
 870         cpc_writeb(falcbase + F_REG(FMR1, ch),
 871                    cpc_readb(falcbase + F_REG(FMR1, ch)) | FMR1_IMOD);
 872
 873         switch (conf->fr_mode) {
 874                 case PC300_FR_ESF:
 875                         pfalc->multiframe_mode = 0;
 876                         cpc_writeb(falcbase + F_REG(FMR4, ch),
 877                                    cpc_readb(falcbase + F_REG(FMR4, ch)) | FMR4_FM1);
 878                         cpc_writeb(falcbase + F_REG(FMR1, ch),
 879                                    cpc_readb(falcbase + F_REG(FMR1, ch)) |
 880                                    FMR1_CRC | FMR1_EDL);
 881                         cpc_writeb(falcbase + F_REG(XDL1, ch), 0);
 882                         cpc_writeb(falcbase + F_REG(XDL2, ch), 0);
 883                         cpc_writeb(falcbase + F_REG(XDL3, ch), 0);
 884                         cpc_writeb(falcbase + F_REG(FMR0, ch),
 885                                    cpc_readb(falcbase + F_REG(FMR0, ch)) & ~FMR0_SRAF);
 886                         cpc_writeb(falcbase + F_REG(FMR2, ch),
 887                                    cpc_readb(falcbase + F_REG(FMR2,ch)) | FMR2_MCSP | FMR2_SSP);
 888                         break;
 889
 890                 case PC300_FR_D4:
 891                         pfalc->multiframe_mode = 1;
 892                         cpc_writeb(falcbase + F_REG(FMR4, ch),
 893                                    cpc_readb(falcbase + F_REG(FMR4, ch)) &
 894                                    ~(FMR4_FM1 | FMR4_FM0));
 895                         cpc_writeb(falcbase + F_REG(FMR0, ch),
 896                                    cpc_readb(falcbase + F_REG(FMR0, ch)) | FMR0_SRAF);
 897                         cpc_writeb(falcbase + F_REG(FMR2, ch),
 898                                    cpc_readb(falcbase + F_REG(FMR2, ch)) & ~FMR2_SSP);
 899                         break;
 900         }
 901
 902         /* Enable Automatic Resynchronization */
 903         cpc_writeb(falcbase + F_REG(FMR4, ch),
 904                    cpc_readb(falcbase + F_REG(FMR4, ch)) | FMR4_AUTO);
 905
 906         /* Transmit Automatic Remote Alarm */
 907         cpc_writeb(falcbase + F_REG(FMR2, ch),
 908                    cpc_readb(falcbase + F_REG(FMR2, ch)) | FMR2_AXRA);
 909
 910         /* Channel translation mode 1 : one to one */
 911         cpc_writeb(falcbase + F_REG(FMR1, ch),
 912                    cpc_readb(falcbase + F_REG(FMR1, ch)) | FMR1_CTM);
 913
 914         /* No signaling */
 915         cpc_writeb(falcbase + F_REG(FMR1, ch),
 916                    cpc_readb(falcbase + F_REG(FMR1, ch)) & ~FMR1_SIGM);
 917         cpc_writeb(falcbase + F_REG(FMR5, ch),
 918                    cpc_readb(falcbase + F_REG(FMR5, ch)) &
 919                    ~(FMR5_EIBR | FMR5_SRS));
 920         cpc_writeb(falcbase + F_REG(CCR1, ch), 0);
 921
 922         cpc_writeb(falcbase + F_REG(LIM1, ch),
 923                    cpc_readb(falcbase + F_REG(LIM1, ch)) | LIM1_RIL0 | LIM1_RIL1);
 924
 925         switch (conf->lbo) {
 926                         /* Provides proper Line Build Out */
 927                 case PC300_LBO_0_DB:
 928                         cpc_writeb(falcbase + F_REG(LIM2, ch), (LIM2_LOS1 | dja));
 929                         cpc_writeb(falcbase + F_REG(XPM0, ch), 0x5a);
 930                         cpc_writeb(falcbase + F_REG(XPM1, ch), 0x8f);
 931                         cpc_writeb(falcbase + F_REG(XPM2, ch), 0x20);
 932                         break;
 933                 case PC300_LBO_7_5_DB:
 934                         cpc_writeb(falcbase + F_REG(LIM2, ch), (0x40 | LIM2_LOS1 | dja));
 935                         cpc_writeb(falcbase + F_REG(XPM0, ch), 0x11);
 936                         cpc_writeb(falcbase + F_REG(XPM1, ch), 0x02);
 937                         cpc_writeb(falcbase + F_REG(XPM2, ch), 0x20);
 938                         break;
 939                 case PC300_LBO_15_DB:
 940                         cpc_writeb(falcbase + F_REG(LIM2, ch), (0x80 | LIM2_LOS1 | dja));
 941                         cpc_writeb(falcbase + F_REG(XPM0, ch), 0x8e);
 942                         cpc_writeb(falcbase + F_REG(XPM1, ch), 0x01);
 943                         cpc_writeb(falcbase + F_REG(XPM2, ch), 0x20);
 944                         break;
 945                 case PC300_LBO_22_5_DB:
 946                         cpc_writeb(falcbase + F_REG(LIM2, ch), (0xc0 | LIM2_LOS1 | dja));
 947                         cpc_writeb(falcbase + F_REG(XPM0, ch), 0x09);
 948                         cpc_writeb(falcbase + F_REG(XPM1, ch), 0x01);
 949                         cpc_writeb(falcbase + F_REG(XPM2, ch), 0x20);
 950                         break;
 951         }
 952
 953         /* Transmit Clock-Slot Offset */
 954         cpc_writeb(falcbase + F_REG(XC0, ch),
 955                    cpc_readb(falcbase + F_REG(XC0, ch)) | 0x01);
 956         /* Transmit Time-slot Offset */
 957         cpc_writeb(falcbase + F_REG(XC1, ch), 0x3e);
 958         /* Receive  Clock-Slot offset */
 959         cpc_writeb(falcbase + F_REG(RC0, ch), 0x05);
 960         /* Receive  Time-slot offset */
 961         cpc_writeb(falcbase + F_REG(RC1, ch), 0x00);
 962
 963         /* LOS Detection after 176 consecutive 0s */
 964         cpc_writeb(falcbase + F_REG(PCDR, ch), 0x0a);
 965         /* LOS Recovery after 22 ones in the time window of PCD */
 966         cpc_writeb(falcbase + F_REG(PCRR, ch), 0x15);
 967
 968         cpc_writeb(falcbase + F_REG(IDLE, ch), 0x7f);
 969
 970         if (conf->fr_mode == PC300_FR_ESF_JAPAN) {
 971                 cpc_writeb(falcbase + F_REG(RC1, ch),
 972                            cpc_readb(falcbase + F_REG(RC1, ch)) | 0x80);
 973         }
 974
 975         falc_close_all_timeslots(card, ch);
 976 }
 977
 978 void falc_init_e1(pc300_t * card, int ch)
 979 {
 980         pc300ch_t *chan = (pc300ch_t *) & card->chan[ch];
 981         pc300chconf_t *conf = (pc300chconf_t *) & chan->conf;
 982         falc_t *pfalc = (falc_t *) & chan->falc;
 983         uclong falcbase = card->hw.falcbase;
 984         ucchar dja = (ch ? (LIM2_DJA2 | LIM2_DJA1) : 0);
 985
 986         /* Switch to E1 mode (PCM 30) */
 987         cpc_writeb(falcbase + F_REG(FMR1, ch),
 988                    cpc_readb(falcbase + F_REG(FMR1, ch)) & ~FMR1_PMOD);
 989
 990         /* Clock mode */
 991         if (conf->phys_settings.clock_type == CLOCK_INT) { /* Master mode */
 992                 cpc_writeb(falcbase + F_REG(LIM0, ch),
 993                            cpc_readb(falcbase + F_REG(LIM0, ch)) | LIM0_MAS);
 994         } else { /* Slave mode */
 995                 cpc_writeb(falcbase + F_REG(LIM0, ch),
 996                            cpc_readb(falcbase + F_REG(LIM0, ch)) & ~LIM0_MAS);
 997         }
 998         cpc_writeb(falcbase + F_REG(LOOP, ch),
 999                    cpc_readb(falcbase + F_REG(LOOP, ch)) & ~LOOP_SFM);
1000
1001         cpc_writeb(falcbase + F_REG(IPC, ch), IPC_SCI);
1002         cpc_writeb(falcbase + F_REG(FMR0, ch),
1003                    cpc_readb(falcbase + F_REG(FMR0, ch)) &
1004                    ~(FMR0_XC0 | FMR0_XC1 | FMR0_RC0 | FMR0_RC1));
1005
1006         switch (conf->lcode) {
1007                 case PC300_LC_AMI:
1008                         cpc_writeb(falcbase + F_REG(FMR0, ch),
1009                                    cpc_readb(falcbase + F_REG(FMR0, ch)) |
1010                                    FMR0_XC1 | FMR0_RC1);
1011                         break;
1012
1013                 case PC300_LC_HDB3:
1014                         cpc_writeb(falcbase + F_REG(FMR0, ch),
1015                                    cpc_readb(falcbase + F_REG(FMR0, ch)) |
1016                                    FMR0_XC0 | FMR0_XC1 | FMR0_RC0 | FMR0_RC1);
1017                         break;
1018
1019                 case PC300_LC_NRZ:
1020                         break;
1021         }
1022
1023         cpc_writeb(falcbase + F_REG(LIM0, ch),
1024                    cpc_readb(falcbase + F_REG(LIM0, ch)) & ~(LIM0_SCL1 | LIM0_SCL0));
1025         /* Set interface mode to 2 MBPS */
1026         cpc_writeb(falcbase + F_REG(FMR1, ch),
1027                    cpc_readb(falcbase + F_REG(FMR1, ch)) | FMR1_IMOD);
1028
1029         cpc_writeb(falcbase + F_REG(XPM0, ch), 0x18);
1030         cpc_writeb(falcbase + F_REG(XPM1, ch), 0x03);
1031         cpc_writeb(falcbase + F_REG(XPM2, ch), 0x00);
1032
1033         switch (conf->fr_mode) {
1034                 case PC300_FR_MF_CRC4:
1035                         pfalc->multiframe_mode = 1;
1036                         cpc_writeb(falcbase + F_REG(FMR1, ch),
1037                                    cpc_readb(falcbase + F_REG(FMR1, ch)) | FMR1_XFS);
1038                         cpc_writeb(falcbase + F_REG(FMR2, ch),
1039                                    cpc_readb(falcbase + F_REG(FMR2, ch)) | FMR2_RFS1);
1040                         cpc_writeb(falcbase + F_REG(FMR2, ch),
1041                                    cpc_readb(falcbase + F_REG(FMR2, ch)) & ~FMR2_RFS0);
1042                         cpc_writeb(falcbase + F_REG(FMR3, ch),
1043                                    cpc_readb(falcbase + F_REG(FMR3, ch)) & ~FMR3_EXTIW);
1044
1045                         /* MultiFrame Resynchronization */
1046                         cpc_writeb(falcbase + F_REG(FMR1, ch),
1047                                    cpc_readb(falcbase + F_REG(FMR1, ch)) | FMR1_MFCS);
1048
1049                         /* Automatic Loss of Multiframe > 914 CRC errors */
1050                         cpc_writeb(falcbase + F_REG(FMR2, ch),
1051                                    cpc_readb(falcbase + F_REG(FMR2, ch)) | FMR2_ALMF);
1052
1053                         /* S1 and SI1/SI2 spare Bits set to 1 */
1054                         cpc_writeb(falcbase + F_REG(XSP, ch),
1055                                    cpc_readb(falcbase + F_REG(XSP, ch)) & ~XSP_AXS);
1056                         cpc_writeb(falcbase + F_REG(XSP, ch),
1057                                    cpc_readb(falcbase + F_REG(XSP, ch)) | XSP_EBP);
1058                         cpc_writeb(falcbase + F_REG(XSP, ch),
1059                                    cpc_readb(falcbase + F_REG(XSP, ch)) | XSP_XS13 | XSP_XS15);
1060
1061                         /* Automatic Force Resynchronization */
1062                         cpc_writeb(falcbase + F_REG(FMR1, ch),
1063                                    cpc_readb(falcbase + F_REG(FMR1, ch)) | FMR1_AFR);
1064
1065                         /* Transmit Automatic Remote Alarm */
1066                         cpc_writeb(falcbase + F_REG(FMR2, ch),
1067                                    cpc_readb(falcbase + F_REG(FMR2, ch)) | FMR2_AXRA);
1068
1069                         /* Transmit Spare Bits for National Use (Y, Sn, Sa) */
1070                         cpc_writeb(falcbase + F_REG(XSW, ch),
1071                                    cpc_readb(falcbase + F_REG(XSW, ch)) |
1072                                    XSW_XY0 | XSW_XY1 | XSW_XY2 | XSW_XY3 | XSW_XY4);
1073                         break;
1074
1075                 case PC300_FR_MF_NON_CRC4:
1076                 case PC300_FR_D4:
1077                         pfalc->multiframe_mode = 0;
1078                         cpc_writeb(falcbase + F_REG(FMR1, ch),
1079                                    cpc_readb(falcbase + F_REG(FMR1, ch)) & ~FMR1_XFS);
1080                         cpc_writeb(falcbase + F_REG(FMR2, ch),
1081                                    cpc_readb(falcbase + F_REG(FMR2, ch)) &
1082                                    ~(FMR2_RFS1 | FMR2_RFS0));
1083                         cpc_writeb(falcbase + F_REG(XSW, ch),
1084                                    cpc_readb(falcbase + F_REG(XSW, ch)) | XSW_XSIS);
1085                         cpc_writeb(falcbase + F_REG(XSP, ch),
1086                                    cpc_readb(falcbase + F_REG(XSP, ch)) | XSP_XSIF);
1087
1088                         /* Automatic Force Resynchronization */
1089                         cpc_writeb(falcbase + F_REG(FMR1, ch),
1090                                    cpc_readb(falcbase + F_REG(FMR1, ch)) | FMR1_AFR);
1091
1092                         /* Transmit Automatic Remote Alarm */
1093                         cpc_writeb(falcbase + F_REG(FMR2, ch),
1094                                    cpc_readb(falcbase + F_REG(FMR2, ch)) | FMR2_AXRA);
1095
1096                         /* Transmit Spare Bits for National Use (Y, Sn, Sa) */
1097                         cpc_writeb(falcbase + F_REG(XSW, ch),
1098                                    cpc_readb(falcbase + F_REG(XSW, ch)) |
1099                                    XSW_XY0 | XSW_XY1 | XSW_XY2 | XSW_XY3 | XSW_XY4);
1100                         break;
1101
1102                 case PC300_FR_UNFRAMED:
1103                         pfalc->multiframe_mode = 0;
1104                         cpc_writeb(falcbase + F_REG(FMR1, ch),
1105                                    cpc_readb(falcbase + F_REG(FMR1, ch)) & ~FMR1_XFS);
1106                         cpc_writeb(falcbase + F_REG(FMR2, ch),
1107                                    cpc_readb(falcbase + F_REG(FMR2, ch)) &
1108                                    ~(FMR2_RFS1 | FMR2_RFS0));
1109                         cpc_writeb(falcbase + F_REG(XSP, ch),
1110                                    cpc_readb(falcbase + F_REG(XSP, ch)) | XSP_TT0);
1111                         cpc_writeb(falcbase + F_REG(XSW, ch),
1112                                    cpc_readb(falcbase + F_REG(XSW, ch)) &
1113                                    ~(XSW_XTM|XSW_XY0|XSW_XY1|XSW_XY2|XSW_XY3|XSW_XY4));
1114                         cpc_writeb(falcbase + F_REG(TSWM, ch), 0xff);
1115                         cpc_writeb(falcbase + F_REG(FMR2, ch),
1116                                    cpc_readb(falcbase + F_REG(FMR2, ch)) |
1117                                    (FMR2_RTM | FMR2_DAIS));
1118                         cpc_writeb(falcbase + F_REG(FMR2, ch),
1119                                    cpc_readb(falcbase + F_REG(FMR2, ch)) & ~FMR2_AXRA);
1120                         cpc_writeb(falcbase + F_REG(FMR1, ch),
1121                                    cpc_readb(falcbase + F_REG(FMR1, ch)) & ~FMR1_AFR);
1122                         pfalc->sync = 1;
1123                         cpc_writeb(falcbase + card->hw.cpld_reg2,
1124                                    cpc_readb(falcbase + card->hw.cpld_reg2) |
1125                                    (CPLD_REG2_FALC_LED2 << (2 * ch)));
1126                         break;
1127         }
1128
1129         /* No signaling */
1130         cpc_writeb(falcbase + F_REG(XSP, ch),
1131                    cpc_readb(falcbase + F_REG(XSP, ch)) & ~XSP_CASEN);
1132         cpc_writeb(falcbase + F_REG(CCR1, ch), 0);
1133
1134         cpc_writeb(falcbase + F_REG(LIM1, ch),
1135                    cpc_readb(falcbase + F_REG(LIM1, ch)) | LIM1_RIL0 | LIM1_RIL1);
1136         cpc_writeb(falcbase + F_REG(LIM2, ch), (LIM2_LOS1 | dja));
1137
1138         /* Transmit Clock-Slot Offset */
1139         cpc_writeb(falcbase + F_REG(XC0, ch),
1140                    cpc_readb(falcbase + F_REG(XC0, ch)) | 0x01);
1141         /* Transmit Time-slot Offset */
1142         cpc_writeb(falcbase + F_REG(XC1, ch), 0x3e);
1143         /* Receive  Clock-Slot offset */
1144         cpc_writeb(falcbase + F_REG(RC0, ch), 0x05);
1145         /* Receive  Time-slot offset */
1146         cpc_writeb(falcbase + F_REG(RC1, ch), 0x00);
1147
1148         /* LOS Detection after 176 consecutive 0s */
1149         cpc_writeb(falcbase + F_REG(PCDR, ch), 0x0a);
1150         /* LOS Recovery after 22 ones in the time window of PCD */
1151         cpc_writeb(falcbase + F_REG(PCRR, ch), 0x15);
1152
1153         cpc_writeb(falcbase + F_REG(IDLE, ch), 0x7f);
1154
1155         falc_close_all_timeslots(card, ch);
1156 }
1157
1158 void falc_init_hdlc(pc300_t * card, int ch)
1159 {
1160         uclong falcbase = card->hw.falcbase;
1161         pc300ch_t *chan = (pc300ch_t *) & card->chan[ch];
1162         pc300chconf_t *conf = (pc300chconf_t *) & chan->conf;
1163
1164         /* Enable transparent data transfer */
1165         if (conf->fr_mode == PC300_FR_UNFRAMED) {
1166                 cpc_writeb(falcbase + F_REG(MODE, ch), 0);
1167         } else {
1168                 cpc_writeb(falcbase + F_REG(MODE, ch),
1169                            cpc_readb(falcbase + F_REG(MODE, ch)) |
1170                            (MODE_HRAC | MODE_MDS2));
1171                 cpc_writeb(falcbase + F_REG(RAH2, ch), 0xff);
1172                 cpc_writeb(falcbase + F_REG(RAH1, ch), 0xff);
1173                 cpc_writeb(falcbase + F_REG(RAL2, ch), 0xff);
1174                 cpc_writeb(falcbase + F_REG(RAL1, ch), 0xff);
1175         }
1176
1177         /* Tx/Rx reset  */
1178         falc_issue_cmd(card, ch, CMDR_RRES | CMDR_XRES | CMDR_SRES);
1179
1180         /* Enable interrupt sources */
1181         falc_intr_enable(card, ch);
1182 }
1183
1184 void te_config(pc300_t * card, int ch)
1185 {
1186         pc300ch_t *chan = (pc300ch_t *) & card->chan[ch];
1187         pc300chconf_t *conf = (pc300chconf_t *) & chan->conf;
1188         falc_t *pfalc = (falc_t *) & chan->falc;
1189         uclong falcbase = card->hw.falcbase;
1190         ucchar dummy;
1191         unsigned long flags;
1192
1193         memset(pfalc, 0, sizeof(falc_t));
1194         switch (conf->media) {
1195                 case IF_IFACE_T1:
1196                         pfalc->num_channels = NUM_OF_T1_CHANNELS;
1197                         pfalc->offset = 1;
1198                         break;
1199                 case IF_IFACE_E1:
1200                         pfalc->num_channels = NUM_OF_E1_CHANNELS;
1201                         pfalc->offset = 0;
1202                         break;
1203         }
1204         if (conf->tslot_bitmap == 0xffffffffUL)
1205                 pfalc->full_bandwidth = 1;
1206         else
1207                 pfalc->full_bandwidth = 0;
1208
1209         CPC_LOCK(card, flags);
1210         /* Reset the FALC chip */
1211         cpc_writeb(card->hw.falcbase + card->hw.cpld_reg1,
1212                    cpc_readb(card->hw.falcbase + card->hw.cpld_reg1) |
1213                    (CPLD_REG1_FALC_RESET << (2 * ch)));
1214         udelay(10000);
1215         cpc_writeb(card->hw.falcbase + card->hw.cpld_reg1,
1216                    cpc_readb(card->hw.falcbase + card->hw.cpld_reg1) &
1217                    ~(CPLD_REG1_FALC_RESET << (2 * ch)));
1218
1219         if (conf->media == IF_IFACE_T1) {
1220                 falc_init_t1(card, ch);
1221         } else {
1222                 falc_init_e1(card, ch);
1223         }
1224         falc_init_hdlc(card, ch);
1225         if (conf->rx_sens == PC300_RX_SENS_SH) {
1226                 cpc_writeb(falcbase + F_REG(LIM0, ch),
1227                            cpc_readb(falcbase + F_REG(LIM0, ch)) & ~LIM0_EQON);
1228         } else {
1229                 cpc_writeb(falcbase + F_REG(LIM0, ch),
1230                            cpc_readb(falcbase + F_REG(LIM0, ch)) | LIM0_EQON);
1231         }
1232         cpc_writeb(card->hw.falcbase + card->hw.cpld_reg2,
1233                    cpc_readb(card->hw.falcbase + card->hw.cpld_reg2) |
1234                    ((CPLD_REG2_FALC_TX_CLK | CPLD_REG2_FALC_RX_CLK) << (2 * ch)));
1235
1236         /* Clear all interrupt registers */
1237         dummy = cpc_readb(falcbase + F_REG(FISR0, ch)) +
1238                 cpc_readb(falcbase + F_REG(FISR1, ch)) +
1239                 cpc_readb(falcbase + F_REG(FISR2, ch)) +
1240                 cpc_readb(falcbase + F_REG(FISR3, ch));
1241         CPC_UNLOCK(card, flags);
1242 }
1243
1244 void falc_check_status(pc300_t * card, int ch, unsigned char frs0)
1245 {
1246         pc300ch_t *chan = (pc300ch_t *) & card->chan[ch];
1247         pc300chconf_t *conf = (pc300chconf_t *) & chan->conf;
1248         falc_t *pfalc = (falc_t *) & chan->falc;
1249         uclong falcbase = card->hw.falcbase;
1250
1251         /* Verify LOS */
1252         if (frs0 & FRS0_LOS) {
1253                 if (!pfalc->red_alarm) {
1254                         pfalc->red_alarm = 1;
1255                         pfalc->los++;
1256                         if (!pfalc->blue_alarm) {
1257                                 // EVENT_FALC_ABNORMAL
1258                                 if (conf->media == IF_IFACE_T1) {
1259                                         /* Disable this interrupt as it may otherwise interfere
1260                                          * with other working boards. */
1261                                         cpc_writeb(falcbase + F_REG(IMR0, ch),
1262                                                    cpc_readb(falcbase + F_REG(IMR0, ch))
1263                                                    | IMR0_PDEN);
1264                                 }
1265                                 falc_disable_comm(card, ch);
1266                                 // EVENT_FALC_ABNORMAL
1267                         }
1268                 }
1269         } else {
1270                 if (pfalc->red_alarm) {
1271                         pfalc->red_alarm = 0;
1272                         pfalc->losr++;
1273                 }
1274         }
1275
1276         if (conf->fr_mode != PC300_FR_UNFRAMED) {
1277                 /* Verify AIS alarm */
1278                 if (frs0 & FRS0_AIS) {
1279                         if (!pfalc->blue_alarm) {
1280                                 pfalc->blue_alarm = 1;
1281                                 pfalc->ais++;
1282                                 // EVENT_AIS
1283                                 if (conf->media == IF_IFACE_T1) {
1284                                         /* Disable this interrupt as it may otherwise interfere with                       other working boards. */
1285                                         cpc_writeb(falcbase + F_REG(IMR0, ch),
1286                                                    cpc_readb(falcbase + F_REG(IMR0, ch)) | IMR0_PDEN);
1287                                 }
1288                                 falc_disable_comm(card, ch);
1289                                 // EVENT_AIS
1290                         }
1291                 } else {
1292                         pfalc->blue_alarm = 0;
1293                 }
1294
1295                 /* Verify LFA */
1296                 if (frs0 & FRS0_LFA) {
1297                         if (!pfalc->loss_fa) {
1298                                 pfalc->loss_fa = 1;
1299                                 pfalc->lfa++;
1300                                 if (!pfalc->blue_alarm && !pfalc->red_alarm) {
1301                                         // EVENT_FALC_ABNORMAL
1302                                         if (conf->media == IF_IFACE_T1) {
1303                                                 /* Disable this interrupt as it may otherwise
1304                                                  * interfere with other working boards. */
1305                                                 cpc_writeb(falcbase + F_REG(IMR0, ch),
1306                                                            cpc_readb(falcbase + F_REG(IMR0, ch))
1307                                                            | IMR0_PDEN);
1308                                         }
1309                                         falc_disable_comm(card, ch);
1310                                         // EVENT_FALC_ABNORMAL
1311                                 }
1312                         }
1313                 } else {
1314                         if (pfalc->loss_fa) {
1315                                 pfalc->loss_fa = 0;
1316                                 pfalc->farec++;
1317                         }
1318                 }
1319
1320                 /* Verify LMFA */
1321                 if (pfalc->multiframe_mode && (frs0 & FRS0_LMFA)) {
1322                         /* D4 or CRC4 frame mode */
1323                         if (!pfalc->loss_mfa) {
1324                                 pfalc->loss_mfa = 1;
1325                                 pfalc->lmfa++;
1326                                 if (!pfalc->blue_alarm && !pfalc->red_alarm &&
1327                                     !pfalc->loss_fa) {
1328                                         // EVENT_FALC_ABNORMAL
1329                                         if (conf->media == IF_IFACE_T1) {
1330                                                 /* Disable this interrupt as it may otherwise
1331                                                  * interfere with other working boards. */
1332                                                 cpc_writeb(falcbase + F_REG(IMR0, ch),
1333                                                            cpc_readb(falcbase + F_REG(IMR0, ch))
1334                                                            | IMR0_PDEN);
1335                                         }
1336                                         falc_disable_comm(card, ch);
1337                                         // EVENT_FALC_ABNORMAL
1338                                 }
1339                         }
1340                 } else {
1341                         pfalc->loss_mfa = 0;
1342                 }
1343
1344                 /* Verify Remote Alarm */
1345                 if (frs0 & FRS0_RRA) {
1346                         if (!pfalc->yellow_alarm) {
1347                                 pfalc->yellow_alarm = 1;
1348                                 pfalc->rai++;
1349                                 if (pfalc->sync) {
1350                                         // EVENT_RAI
1351                                         falc_disable_comm(card, ch);
1352                                         // EVENT_RAI
1353                                 }
1354                         }
1355                 } else {
1356                         pfalc->yellow_alarm = 0;
1357                 }
1358         } /* if !PC300_UNFRAMED */
1359
1360         if (pfalc->red_alarm || pfalc->loss_fa ||
1361             pfalc->loss_mfa || pfalc->blue_alarm) {
1362                 if (pfalc->sync) {
1363                         pfalc->sync = 0;
1364                         chan->d.line_off++;
1365                         cpc_writeb(falcbase + card->hw.cpld_reg2,
1366                                    cpc_readb(falcbase + card->hw.cpld_reg2) &
1367                                    ~(CPLD_REG2_FALC_LED2 << (2 * ch)));
1368                 }
1369         } else {
1370                 if (!pfalc->sync) {
1371                         pfalc->sync = 1;
1372                         chan->d.line_on++;
1373                         cpc_writeb(falcbase + card->hw.cpld_reg2,
1374                                    cpc_readb(falcbase + card->hw.cpld_reg2) |
1375                                    (CPLD_REG2_FALC_LED2 << (2 * ch)));
1376                 }
1377         }
1378
1379         if (pfalc->sync && !pfalc->yellow_alarm) {
1380                 if (!pfalc->active) {
1381                         // EVENT_FALC_NORMAL
1382                         if (pfalc->loop_active) {
1383                                 return;
1384                         }
1385                         if (conf->media == IF_IFACE_T1) {
1386                                 cpc_writeb(falcbase + F_REG(IMR0, ch),
1387                                            cpc_readb(falcbase + F_REG(IMR0, ch)) & ~IMR0_PDEN);
1388                         }
1389                         falc_enable_comm(card, ch);
1390                         // EVENT_FALC_NORMAL
1391                         pfalc->active = 1;
1392                 }
1393         } else {
1394                 if (pfalc->active) {
1395                         pfalc->active = 0;
1396                 }
1397         }
1398 }
1399
1400 void falc_update_stats(pc300_t * card, int ch)
1401 {
1402         pc300ch_t *chan = (pc300ch_t *) & card->chan[ch];
1403         pc300chconf_t *conf = (pc300chconf_t *) & chan->conf;
1404         falc_t *pfalc = (falc_t *) & chan->falc;
1405         uclong falcbase = card->hw.falcbase;
1406         ucshort counter;
1407
1408         counter = cpc_readb(falcbase + F_REG(FECL, ch));
1409         counter |= cpc_readb(falcbase + F_REG(FECH, ch)) << 8;
1410         pfalc->fec += counter;
1411
1412         counter = cpc_readb(falcbase + F_REG(CVCL, ch));
1413         counter |= cpc_readb(falcbase + F_REG(CVCH, ch)) << 8;
1414         pfalc->cvc += counter;
1415
1416         counter = cpc_readb(falcbase + F_REG(CECL, ch));
1417         counter |= cpc_readb(falcbase + F_REG(CECH, ch)) << 8;
1418         pfalc->cec += counter;
1419
1420         counter = cpc_readb(falcbase + F_REG(EBCL, ch));
1421         counter |= cpc_readb(falcbase + F_REG(EBCH, ch)) << 8;
1422         pfalc->ebc += counter;
1423
1424         if (cpc_readb(falcbase + F_REG(LCR1, ch)) & LCR1_EPRM) {
1425                 mdelay(10);
1426                 counter = cpc_readb(falcbase + F_REG(BECL, ch));
1427                 counter |= cpc_readb(falcbase + F_REG(BECH, ch)) << 8;
1428                 pfalc->bec += counter;
1429
1430                 if (((conf->media == IF_IFACE_T1) &&
1431                      (cpc_readb(falcbase + F_REG(FRS1, ch)) & FRS1_LLBAD) &&
1432                      (!(cpc_readb(falcbase + F_REG(FRS1, ch)) & FRS1_PDEN)))
1433                     ||
1434                     ((conf->media == IF_IFACE_E1) &&
1435                      (cpc_readb(falcbase + F_REG(RSP, ch)) & RSP_LLBAD))) {
1436                         pfalc->prbs = 2;
1437                 } else {
1438                         pfalc->prbs = 1;
1439                 }
1440         }
1441 }
1442
1443 /*----------------------------------------------------------------------------
1444  * falc_remote_loop
1445  *----------------------------------------------------------------------------
1446  * Description: In the remote loopback mode the clock and data recovered
1447  *              from the line inputs RL1/2 or RDIP/RDIN are routed back
1448  *              to the line outputs XL1/2 or XDOP/XDON via the analog
1449  *              transmitter. As in normal mode they are processsed by
1450  *              the synchronizer and then sent to the system interface.
1451  *----------------------------------------------------------------------------
1452  */
1453 void falc_remote_loop(pc300_t * card, int ch, int loop_on)
1454 {
1455         pc300ch_t *chan = (pc300ch_t *) & card->chan[ch];
1456         pc300chconf_t *conf = (pc300chconf_t *) & chan->conf;
1457         falc_t *pfalc = (falc_t *) & chan->falc;
1458         uclong falcbase = card->hw.falcbase;
1459
1460         if (loop_on) {
1461                 // EVENT_FALC_ABNORMAL
1462                 if (conf->media == IF_IFACE_T1) {
1463                         /* Disable this interrupt as it may otherwise interfere with
1464                          * other working boards. */
1465                         cpc_writeb(falcbase + F_REG(IMR0, ch),
1466                                    cpc_readb(falcbase + F_REG(IMR0, ch)) | IMR0_PDEN);
1467                 }
1468                 falc_disable_comm(card, ch);
1469                 // EVENT_FALC_ABNORMAL
1470                 cpc_writeb(falcbase + F_REG(LIM1, ch),
1471                            cpc_readb(falcbase + F_REG(LIM1, ch)) | LIM1_RL);
1472                 pfalc->loop_active = 1;
1473         } else {
1474                 cpc_writeb(falcbase + F_REG(LIM1, ch),
1475                            cpc_readb(falcbase + F_REG(LIM1, ch)) & ~LIM1_RL);
1476                 pfalc->sync = 0;
1477                 cpc_writeb(falcbase + card->hw.cpld_reg2,
1478                            cpc_readb(falcbase + card->hw.cpld_reg2) &
1479                            ~(CPLD_REG2_FALC_LED2 << (2 * ch)));
1480                 pfalc->active = 0;
1481                 falc_issue_cmd(card, ch, CMDR_XRES);
1482                 pfalc->loop_active = 0;
1483         }
1484 }
1485
1486 /*----------------------------------------------------------------------------
1487  * falc_local_loop
1488  *----------------------------------------------------------------------------
1489  * Description: The local loopback mode disconnects the receive lines
1490  *              RL1/RL2 resp. RDIP/RDIN from the receiver. Instead of the
1491  *              signals coming from the line the data provided by system
1492  *              interface are routed through the analog receiver back to
1493  *              the system interface. The unipolar bit stream will be
1494  *              undisturbed transmitted on the line. Receiver and transmitter
1495  *              coding must be identical.
1496  *----------------------------------------------------------------------------
1497  */
1498 void falc_local_loop(pc300_t * card, int ch, int loop_on)
1499 {
1500         pc300ch_t *chan = (pc300ch_t *) & card->chan[ch];
1501         falc_t *pfalc = (falc_t *) & chan->falc;
1502         uclong falcbase = card->hw.falcbase;
1503
1504         if (loop_on) {
1505                 cpc_writeb(falcbase + F_REG(LIM0, ch),
1506                            cpc_readb(falcbase + F_REG(LIM0, ch)) | LIM0_LL);
1507                 pfalc->loop_active = 1;
1508         } else {
1509                 cpc_writeb(falcbase + F_REG(LIM0, ch),
1510                            cpc_readb(falcbase + F_REG(LIM0, ch)) & ~LIM0_LL);
1511                 pfalc->loop_active = 0;
1512         }
1513 }
1514
1515 /*----------------------------------------------------------------------------
1516  * falc_payload_loop
1517  *----------------------------------------------------------------------------
1518  * Description: This routine allows to enable/disable payload loopback.
1519  *              When the payload loop is activated, the received 192 bits
1520  *              of payload data will be looped back to the transmit
1521  *              direction. The framing bits, CRC6 and DL bits are not
1522  *              looped. They are originated by the FALC-LH transmitter.
1523  *----------------------------------------------------------------------------
1524  */
1525 void falc_payload_loop(pc300_t * card, int ch, int loop_on)
1526 {
1527         pc300ch_t *chan = (pc300ch_t *) & card->chan[ch];
1528         pc300chconf_t *conf = (pc300chconf_t *) & chan->conf;
1529         falc_t *pfalc = (falc_t *) & chan->falc;
1530         uclong falcbase = card->hw.falcbase;
1531
1532         if (loop_on) {
1533                 // EVENT_FALC_ABNORMAL
1534                 if (conf->media == IF_IFACE_T1) {
1535                         /* Disable this interrupt as it may otherwise interfere with
1536                          * other working boards. */
1537                         cpc_writeb(falcbase + F_REG(IMR0, ch),
1538                                    cpc_readb(falcbase + F_REG(IMR0, ch)) | IMR0_PDEN);
1539                 }
1540                 falc_disable_comm(card, ch);
1541                 // EVENT_FALC_ABNORMAL
1542                 cpc_writeb(falcbase + F_REG(FMR2, ch),
1543                            cpc_readb(falcbase + F_REG(FMR2, ch)) | FMR2_PLB);
1544                 if (conf->media == IF_IFACE_T1) {
1545                         cpc_writeb(falcbase + F_REG(FMR4, ch),
1546                                    cpc_readb(falcbase + F_REG(FMR4, ch)) | FMR4_TM);
1547                 } else {
1548                         cpc_writeb(falcbase + F_REG(FMR5, ch),
1549                                    cpc_readb(falcbase + F_REG(FMR5, ch)) | XSP_TT0);
1550                 }
1551                 falc_open_all_timeslots(card, ch);
1552                 pfalc->loop_active = 2;
1553         } else {
1554                 cpc_writeb(falcbase + F_REG(FMR2, ch),
1555                            cpc_readb(falcbase + F_REG(FMR2, ch)) & ~FMR2_PLB);
1556                 if (conf->media == IF_IFACE_T1) {
1557                         cpc_writeb(falcbase + F_REG(FMR4, ch),
1558                                    cpc_readb(falcbase + F_REG(FMR4, ch)) & ~FMR4_TM);
1559                 } else {
1560                         cpc_writeb(falcbase + F_REG(FMR5, ch),
1561                                    cpc_readb(falcbase + F_REG(FMR5, ch)) & ~XSP_TT0);
1562                 }
1563                 pfalc->sync = 0;
1564                 cpc_writeb(falcbase + card->hw.cpld_reg2,
1565                            cpc_readb(falcbase + card->hw.cpld_reg2) &
1566                            ~(CPLD_REG2_FALC_LED2 << (2 * ch)));
1567                 pfalc->active = 0;
1568                 falc_issue_cmd(card, ch, CMDR_XRES);
1569                 pfalc->loop_active = 0;
1570         }
1571 }
1572
1573 /*----------------------------------------------------------------------------
1574  * turn_off_xlu
1575  *----------------------------------------------------------------------------
1576  * Description: Turns XLU bit off in the proper register
1577  *----------------------------------------------------------------------------
1578  */
1579 void turn_off_xlu(pc300_t * card, int ch)
1580 {
1581         pc300ch_t *chan = (pc300ch_t *) & card->chan[ch];
1582         pc300chconf_t *conf = (pc300chconf_t *) & chan->conf;
1583         uclong falcbase = card->hw.falcbase;
1584
1585         if (conf->media == IF_IFACE_T1) {
1586                 cpc_writeb(falcbase + F_REG(FMR5, ch),
1587                            cpc_readb(falcbase + F_REG(FMR5, ch)) & ~FMR5_XLU);
1588         } else {
1589                 cpc_writeb(falcbase + F_REG(FMR3, ch),
1590                            cpc_readb(falcbase + F_REG(FMR3, ch)) & ~FMR3_XLU);
1591         }
1592 }
1593
1594 /*----------------------------------------------------------------------------
1595  * turn_off_xld
1596  *----------------------------------------------------------------------------
1597  * Description: Turns XLD bit off in the proper register
1598  *----------------------------------------------------------------------------
1599  */
1600 void turn_off_xld(pc300_t * card, int ch)
1601 {
1602         pc300ch_t *chan = (pc300ch_t *) & card->chan[ch];
1603         pc300chconf_t *conf = (pc300chconf_t *) & chan->conf;
1604         uclong falcbase = card->hw.falcbase;
1605
1606         if (conf->media == IF_IFACE_T1) {
1607                 cpc_writeb(falcbase + F_REG(FMR5, ch),
1608                            cpc_readb(falcbase + F_REG(FMR5, ch)) & ~FMR5_XLD);
1609         } else {
1610                 cpc_writeb(falcbase + F_REG(FMR3, ch),
1611                            cpc_readb(falcbase + F_REG(FMR3, ch)) & ~FMR3_XLD);
1612         }
1613 }
1614
1615 /*----------------------------------------------------------------------------
1616  * falc_generate_loop_up_code
1617  *----------------------------------------------------------------------------
1618  * Description: This routine writes the proper FALC chip register in order
1619  *              to generate a LOOP activation code over a T1/E1 line.
1620  *----------------------------------------------------------------------------
1621  */
1622 void falc_generate_loop_up_code(pc300_t * card, int ch)
1623 {
1624         pc300ch_t *chan = (pc300ch_t *) & card->chan[ch];
1625         pc300chconf_t *conf = (pc300chconf_t *) & chan->conf;
1626         falc_t *pfalc = (falc_t *) & chan->falc;
1627         uclong falcbase = card->hw.falcbase;
1628
1629         if (conf->media == IF_IFACE_T1) {
1630                 cpc_writeb(falcbase + F_REG(FMR5, ch),
1631                            cpc_readb(falcbase + F_REG(FMR5, ch)) | FMR5_XLU);
1632         } else {
1633                 cpc_writeb(falcbase + F_REG(FMR3, ch),
1634                            cpc_readb(falcbase + F_REG(FMR3, ch)) | FMR3_XLU);
1635         }
1636         // EVENT_FALC_ABNORMAL
1637         if (conf->media == IF_IFACE_T1) {
1638                 /* Disable this interrupt as it may otherwise interfere with
1639                  * other working boards. */
1640                 cpc_writeb(falcbase + F_REG(IMR0, ch),
1641                            cpc_readb(falcbase + F_REG(IMR0, ch)) | IMR0_PDEN);
1642         }
1643         falc_disable_comm(card, ch);
1644         // EVENT_FALC_ABNORMAL
1645         pfalc->loop_gen = 1;
1646 }
1647
1648 /*----------------------------------------------------------------------------
1649  * falc_generate_loop_down_code
1650  *----------------------------------------------------------------------------
1651  * Description: This routine writes the proper FALC chip register in order
1652  *              to generate a LOOP deactivation code over a T1/E1 line.
1653  *----------------------------------------------------------------------------
1654  */
1655 void falc_generate_loop_down_code(pc300_t * card, int ch)
1656 {
1657         pc300ch_t *chan = (pc300ch_t *) & card->chan[ch];
1658         pc300chconf_t *conf = (pc300chconf_t *) & chan->conf;
1659         falc_t *pfalc = (falc_t *) & chan->falc;
1660         uclong falcbase = card->hw.falcbase;
1661
1662         if (conf->media == IF_IFACE_T1) {
1663                 cpc_writeb(falcbase + F_REG(FMR5, ch),
1664                            cpc_readb(falcbase + F_REG(FMR5, ch)) | FMR5_XLD);
1665         } else {
1666                 cpc_writeb(falcbase + F_REG(FMR3, ch),
1667                            cpc_readb(falcbase + F_REG(FMR3, ch)) | FMR3_XLD);
1668         }
1669         pfalc->sync = 0;
1670         cpc_writeb(falcbase + card->hw.cpld_reg2,
1671                    cpc_readb(falcbase + card->hw.cpld_reg2) &
1672                    ~(CPLD_REG2_FALC_LED2 << (2 * ch)));
1673         pfalc->active = 0;
1674 //?    falc_issue_cmd(card, ch, CMDR_XRES);
1675         pfalc->loop_gen = 0;
1676 }
1677
1678 /*----------------------------------------------------------------------------
1679  * falc_pattern_test
1680  *----------------------------------------------------------------------------
1681  * Description: This routine generates a pattern code and checks
1682  *              it on the reception side.
1683  *----------------------------------------------------------------------------
1684  */
1685 void falc_pattern_test(pc300_t * card, int ch, unsigned int activate)
1686 {
1687         pc300ch_t *chan = (pc300ch_t *) & card->chan[ch];
1688         pc300chconf_t *conf = (pc300chconf_t *) & chan->conf;
1689         falc_t *pfalc = (falc_t *) & chan->falc;
1690         uclong falcbase = card->hw.falcbase;
1691
1692         if (activate) {
1693                 pfalc->prbs = 1;
1694                 pfalc->bec = 0;
1695                 if (conf->media == IF_IFACE_T1) {
1696                         /* Disable local loop activation/deactivation detect */
1697                         cpc_writeb(falcbase + F_REG(IMR3, ch),
1698                                    cpc_readb(falcbase + F_REG(IMR3, ch)) | IMR3_LLBSC);
1699                 } else {
1700                         /* Disable local loop activation/deactivation detect */
1701                         cpc_writeb(falcbase + F_REG(IMR1, ch),
1702                                    cpc_readb(falcbase + F_REG(IMR1, ch)) | IMR1_LLBSC);
1703                 }
1704                 /* Activates generation and monitoring of PRBS
1705                  * (Pseudo Random Bit Sequence) */
1706                 cpc_writeb(falcbase + F_REG(LCR1, ch),
1707                            cpc_readb(falcbase + F_REG(LCR1, ch)) | LCR1_EPRM | LCR1_XPRBS);
1708         } else {
1709                 pfalc->prbs = 0;
1710                 /* Deactivates generation and monitoring of PRBS
1711                  * (Pseudo Random Bit Sequence) */
1712                 cpc_writeb(falcbase + F_REG(LCR1, ch),
1713                            cpc_readb(falcbase+F_REG(LCR1,ch)) & ~(LCR1_EPRM | LCR1_XPRBS));
1714                 if (conf->media == IF_IFACE_T1) {
1715                         /* Enable local loop activation/deactivation detect */
1716                         cpc_writeb(falcbase + F_REG(IMR3, ch),
1717                                    cpc_readb(falcbase + F_REG(IMR3, ch)) & ~IMR3_LLBSC);
1718                 } else {
1719                         /* Enable local loop activation/deactivation detect */
1720                         cpc_writeb(falcbase + F_REG(IMR1, ch),
1721                                    cpc_readb(falcbase + F_REG(IMR1, ch)) & ~IMR1_LLBSC);
1722                 }
1723         }
1724 }
1725
1726 /*----------------------------------------------------------------------------
1727  * falc_pattern_test_error
1728  *----------------------------------------------------------------------------
1729  * Description: This routine returns the bit error counter value
1730  *----------------------------------------------------------------------------
1731  */
1732 ucshort falc_pattern_test_error(pc300_t * card, int ch)
1733 {
1734         pc300ch_t *chan = (pc300ch_t *) & card->chan[ch];
1735         falc_t *pfalc = (falc_t *) & chan->falc;
1736
1737         return (pfalc->bec);
1738 }
1739
1740 /**********************************/
1741 /***   Net Interface Routines   ***/
1742 /**********************************/
1743
1744 static void
1745 cpc_trace(struct net_device *dev, struct sk_buff *skb_main, char rx_tx)
1746 {
1747         struct sk_buff *skb;
1748
1749         if ((skb = dev_alloc_skb(10 + skb_main->len)) == NULL) {
1750                 printk("%s: out of memory\n", dev->name);
1751                 return;
1752         }
1753         skb_put(skb, 10 + skb_main->len);
1754
1755         skb->dev = dev;
1756         skb->protocol = htons(ETH_P_CUST);
1757         skb->mac.raw = skb->data;
1758         skb->pkt_type = PACKET_HOST;
1759         skb->len = 10 + skb_main->len;
1760
1761         memcpy(skb->data, dev->name, 5);
1762         skb->data[5] = '[';
1763         skb->data[6] = rx_tx;
1764         skb->data[7] = ']';
1765         skb->data[8] = ':';
1766         skb->data[9] = ' ';
1767         memcpy(&skb->data[10], skb_main->data, skb_main->len);
1768
1769         netif_rx(skb);
1770 }
1771
1772 void cpc_tx_timeout(struct net_device *dev)
1773 {
1774         pc300dev_t *d = (pc300dev_t *) dev->priv;
1775         pc300ch_t *chan = (pc300ch_t *) d->chan;
1776         pc300_t *card = (pc300_t *) chan->card;
1777         struct net_device_stats *stats = hdlc_stats(dev);
1778         int ch = chan->channel;
1779         uclong flags;
1780         ucchar ilar;
1781
1782         stats->tx_errors++;
1783         stats->tx_aborted_errors++;
1784         CPC_LOCK(card, flags);
1785         if ((ilar = cpc_readb(card->hw.scabase + ILAR)) != 0) {
1786                 printk("%s: ILAR=0x%x\n", dev->name, ilar);
1787                 cpc_writeb(card->hw.scabase + ILAR, ilar);
1788                 cpc_writeb(card->hw.scabase + DMER, 0x80);
1789         }
1790         if (card->hw.type == PC300_TE) {
1791                 cpc_writeb(card->hw.falcbase + card->hw.cpld_reg2,
1792                            cpc_readb(card->hw.falcbase + card->hw.cpld_reg2) &
1793                            ~(CPLD_REG2_FALC_LED1 << (2 * ch)));
1794         }
1795         dev->trans_start = jiffies;
1796         CPC_UNLOCK(card, flags);
1797         netif_wake_queue(dev);
1798 }
1799
1800 int cpc_queue_xmit(struct sk_buff *skb, struct net_device *dev)
1801 {
1802         pc300dev_t *d = (pc300dev_t *) dev->priv;
1803         pc300ch_t *chan = (pc300ch_t *) d->chan;
1804         pc300_t *card = (pc300_t *) chan->card;
1805         struct net_device_stats *stats = hdlc_stats(dev);
1806         int ch = chan->channel;
1807         uclong flags;
1808 #ifdef PC300_DEBUG_TX
1809         int i;
1810 #endif
1811
1812         if (chan->conf.monitor) {
1813                 /* In monitor mode no Tx is done: ignore packet */
1814                 dev_kfree_skb(skb);
1815                 return 0;
1816         } else if (!netif_carrier_ok(dev)) {
1817                 /* DCD must be OFF: drop packet */
1818                 dev_kfree_skb(skb);
1819                 stats->tx_errors++;
1820                 stats->tx_carrier_errors++;
1821                 return 0;
1822         } else if (cpc_readb(card->hw.scabase + M_REG(ST3, ch)) & ST3_DCD) {
1823                 printk("%s: DCD is OFF. Going administrative down.\n", dev->name);
1824                 stats->tx_errors++;
1825                 stats->tx_carrier_errors++;
1826                 dev_kfree_skb(skb);
1827                 netif_carrier_off(dev);
1828                 CPC_LOCK(card, flags);
1829                 cpc_writeb(card->hw.scabase + M_REG(CMD, ch), CMD_TX_BUF_CLR);
1830                 if (card->hw.type == PC300_TE) {
1831                         cpc_writeb(card->hw.falcbase + card->hw.cpld_reg2,
1832                                    cpc_readb(card->hw.falcbase + card->hw.cpld_reg2) &
1833                                                         ~(CPLD_REG2_FALC_LED1 << (2 * ch)));
1834                 }
1835                 CPC_UNLOCK(card, flags);
1836                 netif_wake_queue(dev);
1837                 return 0;
1838         }
1839
1840         /* Write buffer to DMA buffers */
1841         if (dma_buf_write(card, ch, (ucchar *) skb->data, skb->len) != 0) {
1842 //              printk("%s: write error. Dropping TX packet.\n", dev->name);
1843                 netif_stop_queue(dev);
1844                 dev_kfree_skb(skb);
1845                 stats->tx_errors++;
1846                 stats->tx_dropped++;
1847                 return 0;
1848         }
1849 #ifdef PC300_DEBUG_TX
1850         printk("%s T:", dev->name);
1851         for (i = 0; i < skb->len; i++)
1852                 printk(" %02x", *(skb->data + i));
1853         printk("\n");
1854 #endif
1855
1856         if (d->trace_on) {
1857                 cpc_trace(dev, skb, 'T');
1858         }
1859         dev->trans_start = jiffies;
1860
1861         /* Start transmission */
1862         CPC_LOCK(card, flags);
1863         /* verify if it has more than one free descriptor */
1864         if (card->chan[ch].nfree_tx_bd <= 1) {
1865                 /* don't have so stop the queue */
1866                 netif_stop_queue(dev);
1867         }
1868         cpc_writel(card->hw.scabase + DTX_REG(EDAL, ch),
1869                    TX_BD_ADDR(ch, chan->tx_next_bd));
1870         cpc_writeb(card->hw.scabase + M_REG(CMD, ch), CMD_TX_ENA);
1871         cpc_writeb(card->hw.scabase + DSR_TX(ch), DSR_DE);
1872         if (card->hw.type == PC300_TE) {
1873                 cpc_writeb(card->hw.falcbase + card->hw.cpld_reg2,
1874                            cpc_readb(card->hw.falcbase + card->hw.cpld_reg2) |
1875                            (CPLD_REG2_FALC_LED1 << (2 * ch)));
1876         }
1877         CPC_UNLOCK(card, flags);
1878         dev_kfree_skb(skb);
1879
1880         return 0;
1881 }
1882
1883 void cpc_net_rx(struct net_device *dev)
1884 {
1885         pc300dev_t *d = (pc300dev_t *) dev->priv;
1886         pc300ch_t *chan = (pc300ch_t *) d->chan;
1887         pc300_t *card = (pc300_t *) chan->card;
1888         struct net_device_stats *stats = hdlc_stats(dev);
1889         int ch = chan->channel;
1890 #ifdef PC300_DEBUG_RX
1891         int i;
1892 #endif
1893         int rxb;
1894         struct sk_buff *skb;
1895
1896         while (1) {
1897                 if ((rxb = dma_get_rx_frame_size(card, ch)) == -1)
1898                         return;
1899
1900                 if (!netif_carrier_ok(dev)) {
1901                         /* DCD must be OFF: drop packet */
1902                     printk("%s : DCD is OFF - drop %d rx bytes\n", dev->name, rxb);
1903                         skb = NULL;
1904                 } else {
1905                         if (rxb > (dev->mtu + 40)) { /* add headers */
1906                                 printk("%s : MTU exceeded %d\n", dev->name, rxb);
1907                                 skb = NULL;
1908                         } else {
1909                                 skb = dev_alloc_skb(rxb);
1910                                 if (skb == NULL) {
1911                                         printk("%s: Memory squeeze!!\n", dev->name);
1912                                         return;
1913                                 }
1914                                 skb->dev = dev;
1915                         }
1916                 }
1917
1918                 if (((rxb = dma_buf_read(card, ch, skb)) <= 0) || (skb == NULL)) {
1919 #ifdef PC300_DEBUG_RX
1920                         printk("%s: rxb = %x\n", dev->name, rxb);
1921 #endif
1922                         if ((skb == NULL) && (rxb > 0)) {
1923                                 /* rxb > dev->mtu */
1924                                 stats->rx_errors++;
1925                                 stats->rx_length_errors++;
1926                                 continue;
1927                         }
1928
1929                         if (rxb < 0) {  /* Invalid frame */
1930                                 rxb = -rxb;
1931                                 if (rxb & DST_OVR) {
1932                                         stats->rx_errors++;
1933                                         stats->rx_fifo_errors++;
1934                                 }
1935                                 if (rxb & DST_CRC) {
1936                                         stats->rx_errors++;
1937                                         stats->rx_crc_errors++;
1938                                 }
1939                                 if (rxb & (DST_RBIT | DST_SHRT | DST_ABT)) {
1940                                         stats->rx_errors++;
1941                                         stats->rx_frame_errors++;
1942                                 }
1943                         }
1944                         if (skb) {
1945                                 dev_kfree_skb_irq(skb);
1946                         }
1947                         continue;
1948                 }
1949
1950                 stats->rx_bytes += rxb;
1951
1952 #ifdef PC300_DEBUG_RX
1953                 printk("%s R:", dev->name);
1954                 for (i = 0; i < skb->len; i++)
1955                         printk(" %02x", *(skb->data + i));
1956                 printk("\n");
1957 #endif
1958                 if (d->trace_on) {
1959                         cpc_trace(dev, skb, 'R');
1960                 }
1961                 stats->rx_packets++;
1962                 skb->mac.raw = skb->data;
1963                 skb->protocol = hdlc_type_trans(skb, dev);
1964                 netif_rx(skb);
1965         }
1966 }
1967
1968 /************************************/
1969 /***   PC300 Interrupt Routines   ***/
1970 /************************************/
1971 static void sca_tx_intr(pc300dev_t *dev)
1972 {
1973         pc300ch_t *chan = (pc300ch_t *)dev->chan;
1974         pc300_t *card = (pc300_t *)chan->card;
1975         int ch = chan->channel;
1976         volatile pcsca_bd_t * ptdescr;
1977         struct net_device_stats *stats = hdlc_stats(dev->dev);
1978
1979     /* Clean up descriptors from previous transmission */
1980         ptdescr = (pcsca_bd_t *)(card->hw.rambase +
1981                                                 TX_BD_ADDR(ch,chan->tx_first_bd));
1982         while ((cpc_readl(card->hw.scabase + DTX_REG(CDAL,ch)) !=
1983                                                         TX_BD_ADDR(ch,chan->tx_first_bd)) &&
1984                         (cpc_readb(&ptdescr->status) & DST_OSB)) {
1985                 stats->tx_packets++;
1986                 stats->tx_bytes += cpc_readw(&ptdescr->len);
1987                 cpc_writeb(&ptdescr->status, DST_OSB);
1988                 cpc_writew(&ptdescr->len, 0);
1989                 chan->nfree_tx_bd++;
1990                 chan->tx_first_bd = (chan->tx_first_bd + 1) & (N_DMA_TX_BUF - 1);
1991                 ptdescr = (pcsca_bd_t *)(card->hw.rambase +
1992                                                 TX_BD_ADDR(ch,chan->tx_first_bd));
1993     }
1994
1995 #ifdef CONFIG_PC300_MLPPP
1996         if (chan->conf.proto == PC300_PROTO_MLPPP) {
1997                         cpc_tty_trigger_poll(dev);
1998         } else {
1999 #endif
2000         /* Tell the upper layer we are ready to transmit more packets */
2001                 netif_wake_queue(dev->dev);
2002 #ifdef CONFIG_PC300_MLPPP
2003         }
2004 #endif
2005 }
2006
2007 static void sca_intr(pc300_t * card)
2008 {
2009         uclong scabase = card->hw.scabase;
2010         volatile uclong status;
2011         int ch;
2012         int intr_count = 0;
2013         unsigned char dsr_rx;
2014
2015         while ((status = cpc_readl(scabase + ISR0)) != 0) {
2016                 for (ch = 0; ch < card->hw.nchan; ch++) {
2017                         pc300ch_t *chan = &card->chan[ch];
2018                         pc300dev_t *d = &chan->d;
2019                         struct net_device *dev = d->dev;
2020                         hdlc_device *hdlc = dev_to_hdlc(dev);
2021
2022                         spin_lock(&card->card_lock);
2023
2024             /**** Reception ****/
2025                         if (status & IR0_DRX((IR0_DMIA | IR0_DMIB), ch)) {
2026                                 ucchar drx_stat = cpc_readb(scabase + DSR_RX(ch));
2027
2028                                 /* Clear RX interrupts */
2029                                 cpc_writeb(scabase + DSR_RX(ch), drx_stat | DSR_DWE);
2030
2031 #ifdef PC300_DEBUG_INTR
2032                                 printk ("sca_intr: RX intr chan[%d] (st=0x%08lx, dsr=0x%02x)\n",
2033                                          ch, status, drx_stat);
2034 #endif
2035                                 if (status & IR0_DRX(IR0_DMIA, ch)) {
2036                                         if (drx_stat & DSR_BOF) {
2037 #ifdef CONFIG_PC300_MLPPP
2038                                                 if (chan->conf.proto == PC300_PROTO_MLPPP) {
2039                                                         /* verify if driver is TTY */
2040                                                         if ((cpc_readb(scabase + DSR_RX(ch)) & DSR_DE)) {
2041                                                                 rx_dma_stop(card, ch);
2042                                                         }
2043                                                         cpc_tty_receive(d);
2044                                                         rx_dma_start(card, ch);
2045                                                 } else
2046 #endif
2047                                                 {
2048                                                         if ((cpc_readb(scabase + DSR_RX(ch)) & DSR_DE)) {
2049                                                                 rx_dma_stop(card, ch);
2050                                                         }
2051                                                         cpc_net_rx(dev);
2052                                                         /* Discard invalid frames */
2053                                                         hdlc->stats.rx_errors++;
2054                                                         hdlc->stats.rx_over_errors++;
2055                                                         chan->rx_first_bd = 0;
2056                                                         chan->rx_last_bd = N_DMA_RX_BUF - 1;
2057                                                         rx_dma_start(card, ch);
2058                                                 }
2059                                         }
2060                                 }
2061                                 if (status & IR0_DRX(IR0_DMIB, ch)) {
2062                                         if (drx_stat & DSR_EOM) {
2063                                                 if (card->hw.type == PC300_TE) {
2064                                                         cpc_writeb(card->hw.falcbase +
2065                                                                    card->hw.cpld_reg2,
2066                                                                    cpc_readb (card->hw.falcbase +
2067                                                                         card->hw.cpld_reg2) |
2068                                                                    (CPLD_REG2_FALC_LED1 << (2 * ch)));
2069                                                 }
2070 #ifdef CONFIG_PC300_MLPPP
2071                                                 if (chan->conf.proto == PC300_PROTO_MLPPP) {
2072                                                         /* verify if driver is TTY */
2073                                                         cpc_tty_receive(d);
2074                                                 } else {
2075                                                         cpc_net_rx(dev);
2076                                                 }
2077 #else
2078                                                 cpc_net_rx(dev);
2079 #endif
2080                                                 if (card->hw.type == PC300_TE) {
2081                                                         cpc_writeb(card->hw.falcbase +
2082                                                                    card->hw.cpld_reg2,
2083                                                                    cpc_readb (card->hw.falcbase +
2084                                                                                 card->hw.cpld_reg2) &
2085                                                                    ~ (CPLD_REG2_FALC_LED1 << (2 * ch)));
2086                                                 }
2087                                         }
2088                                 }
2089                                 if (!(dsr_rx = cpc_readb(scabase + DSR_RX(ch)) & DSR_DE)) {
2090 #ifdef PC300_DEBUG_INTR
2091                 printk("%s: RX intr chan[%d] (st=0x%08lx, dsr=0x%02x, dsr2=0x%02x)\n",
2092                         dev->name, ch, status, drx_stat, dsr_rx);
2093 #endif
2094                                         cpc_writeb(scabase + DSR_RX(ch), (dsr_rx | DSR_DE) & 0xfe);
2095                                 }
2096                         }
2097
2098             /**** Transmission ****/
2099                         if (status & IR0_DTX((IR0_EFT | IR0_DMIA | IR0_DMIB), ch)) {
2100                                 ucchar dtx_stat = cpc_readb(scabase + DSR_TX(ch));
2101
2102                                 /* Clear TX interrupts */
2103                                 cpc_writeb(scabase + DSR_TX(ch), dtx_stat | DSR_DWE);
2104
2105 #ifdef PC300_DEBUG_INTR
2106                                 printk ("sca_intr: TX intr chan[%d] (st=0x%08lx, dsr=0x%02x)\n",
2107                                          ch, status, dtx_stat);
2108 #endif
2109                                 if (status & IR0_DTX(IR0_EFT, ch)) {
2110                                         if (dtx_stat & DSR_UDRF) {
2111                                                 if (cpc_readb (scabase + M_REG(TBN, ch)) != 0) {
2112                                                         cpc_writeb(scabase + M_REG(CMD,ch), CMD_TX_BUF_CLR);
2113                                                 }
2114                                                 if (card->hw.type == PC300_TE) {
2115                                                         cpc_writeb(card->hw.falcbase + card->hw.cpld_reg2,
2116                                                                    cpc_readb (card->hw.falcbase +
2117                                                                                    card->hw.cpld_reg2) &
2118                                                                    ~ (CPLD_REG2_FALC_LED1 << (2 * ch)));
2119                                                 }
2120                                                 hdlc->stats.tx_errors++;
2121                                                 hdlc->stats.tx_fifo_errors++;
2122                                                 sca_tx_intr(d);
2123                                         }
2124                                 }
2125                                 if (status & IR0_DTX(IR0_DMIA, ch)) {
2126                                         if (dtx_stat & DSR_BOF) {
2127                                         }
2128                                 }
2129                                 if (status & IR0_DTX(IR0_DMIB, ch)) {
2130                                         if (dtx_stat & DSR_EOM) {
2131                                                 if (card->hw.type == PC300_TE) {
2132                                                         cpc_writeb(card->hw.falcbase + card->hw.cpld_reg2,
2133                                                                    cpc_readb (card->hw.falcbase +
2134                                                                                         card->hw.cpld_reg2) &
2135                                                                    ~ (CPLD_REG2_FALC_LED1 << (2 * ch)));
2136                                                 }
2137                                                 sca_tx_intr(d);
2138                                         }
2139                                 }
2140                         }
2141
2142             /**** MSCI ****/
2143                         if (status & IR0_M(IR0_RXINTA, ch)) {
2144                                 ucchar st1 = cpc_readb(scabase + M_REG(ST1, ch));
2145
2146                                 /* Clear MSCI interrupts */
2147                                 cpc_writeb(scabase + M_REG(ST1, ch), st1);
2148
2149 #ifdef PC300_DEBUG_INTR
2150                                 printk("sca_intr: MSCI intr chan[%d] (st=0x%08lx, st1=0x%02x)\n",
2151                                          ch, status, st1);
2152 #endif
2153                                 if (st1 & ST1_CDCD) {   /* DCD changed */
2154                                         if (cpc_readb(scabase + M_REG(ST3, ch)) & ST3_DCD) {
2155                                                 printk ("%s: DCD is OFF. Going administrative down.\n",
2156                                                          dev->name);
2157 #ifdef CONFIG_PC300_MLPPP
2158                                                 if (chan->conf.proto != PC300_PROTO_MLPPP) {
2159                                                         netif_carrier_off(dev);
2160                                                 }
2161 #else
2162                                                 netif_carrier_off(dev);
2163
2164 #endif
2165                                                 card->chan[ch].d.line_off++;
2166                                         } else {        /* DCD = 1 */
2167                                                 printk ("%s: DCD is ON. Going administrative up.\n",
2168                                                          dev->name);
2169 #ifdef CONFIG_PC300_MLPPP
2170                                                 if (chan->conf.proto != PC300_PROTO_MLPPP)
2171                                                         /* verify if driver is not TTY */
2172 #endif
2173                                                         netif_carrier_on(dev);
2174                                                 card->chan[ch].d.line_on++;
2175                                         }
2176                                 }
2177                         }
2178                         spin_unlock(&card->card_lock);
2179                 }
2180                 if (++intr_count == 10)
2181                         /* Too much work at this board. Force exit */
2182                         break;
2183         }
2184 }
2185
2186 static void falc_t1_loop_detection(pc300_t * card, int ch, ucchar frs1)
2187 {
2188         pc300ch_t *chan = (pc300ch_t *) & card->chan[ch];
2189         falc_t *pfalc = (falc_t *) & chan->falc;
2190         uclong falcbase = card->hw.falcbase;
2191
2192         if (((cpc_readb(falcbase + F_REG(LCR1, ch)) & LCR1_XPRBS) == 0) &&
2193             !pfalc->loop_gen) {
2194                 if (frs1 & FRS1_LLBDD) {
2195                         // A Line Loop Back Deactivation signal detected
2196                         if (pfalc->loop_active) {
2197                                 falc_remote_loop(card, ch, 0);
2198                         }
2199                 } else {
2200                         if ((frs1 & FRS1_LLBAD) &&
2201                             ((cpc_readb(falcbase + F_REG(LCR1, ch)) & LCR1_EPRM) == 0)) {
2202                                 // A Line Loop Back Activation signal detected
2203                                 if (!pfalc->loop_active) {
2204                                         falc_remote_loop(card, ch, 1);
2205                                 }
2206                         }
2207                 }
2208         }
2209 }
2210
2211 static void falc_e1_loop_detection(pc300_t * card, int ch, ucchar rsp)
2212 {
2213         pc300ch_t *chan = (pc300ch_t *) & card->chan[ch];
2214         falc_t *pfalc = (falc_t *) & chan->falc;
2215         uclong falcbase = card->hw.falcbase;
2216
2217         if (((cpc_readb(falcbase + F_REG(LCR1, ch)) & LCR1_XPRBS) == 0) &&
2218             !pfalc->loop_gen) {
2219                 if (rsp & RSP_LLBDD) {
2220                         // A Line Loop Back Deactivation signal detected
2221                         if (pfalc->loop_active) {
2222                                 falc_remote_loop(card, ch, 0);
2223                         }
2224                 } else {
2225                         if ((rsp & RSP_LLBAD) &&
2226                             ((cpc_readb(falcbase + F_REG(LCR1, ch)) & LCR1_EPRM) == 0)) {
2227                                 // A Line Loop Back Activation signal detected
2228                                 if (!pfalc->loop_active) {
2229                                         falc_remote_loop(card, ch, 1);
2230                                 }
2231                         }
2232                 }
2233         }
2234 }
2235
2236 static void falc_t1_intr(pc300_t * card, int ch)
2237 {
2238         pc300ch_t *chan = (pc300ch_t *) & card->chan[ch];
2239         falc_t *pfalc = (falc_t *) & chan->falc;
2240         uclong falcbase = card->hw.falcbase;
2241         ucchar isr0, isr3, gis;
2242         ucchar dummy;
2243
2244         while ((gis = cpc_readb(falcbase + F_REG(GIS, ch))) != 0) {
2245                 if (gis & GIS_ISR0) {
2246                         isr0 = cpc_readb(falcbase + F_REG(FISR0, ch));
2247                         if (isr0 & FISR0_PDEN) {
2248                                 /* Read the bit to clear the situation */
2249                                 if (cpc_readb(falcbase + F_REG(FRS1, ch)) &
2250                                     FRS1_PDEN) {
2251                                         pfalc->pden++;
2252                                 }
2253                         }
2254                 }
2255
2256                 if (gis & GIS_ISR1) {
2257                         dummy = cpc_readb(falcbase + F_REG(FISR1, ch));
2258                 }
2259
2260                 if (gis & GIS_ISR2) {
2261                         dummy = cpc_readb(falcbase + F_REG(FISR2, ch));
2262                 }
2263
2264                 if (gis & GIS_ISR3) {
2265                         isr3 = cpc_readb(falcbase + F_REG(FISR3, ch));
2266                         if (isr3 & FISR3_SEC) {
2267                                 pfalc->sec++;
2268                                 falc_update_stats(card, ch);
2269                                 falc_check_status(card, ch,
2270                                                   cpc_readb(falcbase + F_REG(FRS0, ch)));
2271                         }
2272                         if (isr3 & FISR3_ES) {
2273                                 pfalc->es++;
2274                         }
2275                         if (isr3 & FISR3_LLBSC) {
2276                                 falc_t1_loop_detection(card, ch,
2277                                                        cpc_readb(falcbase + F_REG(FRS1, ch)));
2278                         }
2279                 }
2280         }
2281 }
2282
2283 static void falc_e1_intr(pc300_t * card, int ch)
2284 {
2285         pc300ch_t *chan = (pc300ch_t *) & card->chan[ch];
2286         falc_t *pfalc = (falc_t *) & chan->falc;
2287         uclong falcbase = card->hw.falcbase;
2288         ucchar isr1, isr2, isr3, gis, rsp;
2289         ucchar dummy;
2290
2291         while ((gis = cpc_readb(falcbase + F_REG(GIS, ch))) != 0) {
2292                 rsp = cpc_readb(falcbase + F_REG(RSP, ch));
2293
2294                 if (gis & GIS_ISR0) {
2295                         dummy = cpc_readb(falcbase + F_REG(FISR0, ch));
2296                 }
2297                 if (gis & GIS_ISR1) {
2298                         isr1 = cpc_readb(falcbase + F_REG(FISR1, ch));
2299                         if (isr1 & FISR1_XMB) {
2300                                 if ((pfalc->xmb_cause & 2)
2301                                     && pfalc->multiframe_mode) {
2302                                         if (cpc_readb (falcbase + F_REG(FRS0, ch)) &
2303                                                                         (FRS0_LOS | FRS0_AIS | FRS0_LFA)) {
2304                                                 cpc_writeb(falcbase + F_REG(XSP, ch),
2305                                                            cpc_readb(falcbase + F_REG(XSP, ch))
2306                                                            & ~XSP_AXS);
2307                                         } else {
2308                                                 cpc_writeb(falcbase + F_REG(XSP, ch),
2309                                                            cpc_readb(falcbase + F_REG(XSP, ch))
2310                                                            | XSP_AXS);
2311                                         }
2312                                 }
2313                                 pfalc->xmb_cause = 0;
2314                                 cpc_writeb(falcbase + F_REG(IMR1, ch),
2315                                            cpc_readb(falcbase + F_REG(IMR1, ch)) | IMR1_XMB);
2316                         }
2317                         if (isr1 & FISR1_LLBSC) {
2318                                 falc_e1_loop_detection(card, ch, rsp);
2319                         }
2320                 }
2321                 if (gis & GIS_ISR2) {
2322                         isr2 = cpc_readb(falcbase + F_REG(FISR2, ch));
2323                         if (isr2 & FISR2_T400MS) {
2324                                 cpc_writeb(falcbase + F_REG(XSW, ch),
2325                                            cpc_readb(falcbase + F_REG(XSW, ch)) | XSW_XRA);
2326                         }
2327                         if (isr2 & FISR2_MFAR) {
2328                                 cpc_writeb(falcbase + F_REG(XSW, ch),
2329                                            cpc_readb(falcbase + F_REG(XSW, ch)) & ~XSW_XRA);
2330                         }
2331                         if (isr2 & (FISR2_FAR | FISR2_LFA | FISR2_AIS | FISR2_LOS)) {
2332                                 pfalc->xmb_cause |= 2;
2333                                 cpc_writeb(falcbase + F_REG(IMR1, ch),
2334                                            cpc_readb(falcbase + F_REG(IMR1, ch)) & ~IMR1_XMB);
2335                         }
2336                 }
2337                 if (gis & GIS_ISR3) {
2338                         isr3 = cpc_readb(falcbase + F_REG(FISR3, ch));
2339                         if (isr3 & FISR3_SEC) {
2340                                 pfalc->sec++;
2341                                 falc_update_stats(card, ch);
2342                                 falc_check_status(card, ch,
2343                                                   cpc_readb(falcbase + F_REG(FRS0, ch)));
2344                         }
2345                         if (isr3 & FISR3_ES) {
2346                                 pfalc->es++;
2347                         }
2348                 }
2349         }
2350 }
2351
2352 static void falc_intr(pc300_t * card)
2353 {
2354         int ch;
2355
2356         for (ch = 0; ch < card->hw.nchan; ch++) {
2357                 pc300ch_t *chan = &card->chan[ch];
2358                 pc300chconf_t *conf = (pc300chconf_t *) & chan->conf;
2359
2360                 if (conf->media == IF_IFACE_T1) {
2361                         falc_t1_intr(card, ch);
2362                 } else {
2363                         falc_e1_intr(card, ch);
2364                 }
2365         }
2366 }
2367
2368 static irqreturn_t cpc_intr(int irq, void *dev_id, struct pt_regs *regs)
2369 {
2370         pc300_t *card;
2371         volatile ucchar plx_status;
2372
2373         if ((card = (pc300_t *) dev_id) == 0) {
2374 #ifdef PC300_DEBUG_INTR
2375                 printk("cpc_intr: spurious intr %d\n", irq);
2376 #endif
2377                 return IRQ_NONE;                /* spurious intr */
2378         }
2379
2380         if (card->hw.rambase == 0) {
2381 #ifdef PC300_DEBUG_INTR
2382                 printk("cpc_intr: spurious intr2 %d\n", irq);
2383 #endif
2384                 return IRQ_NONE;                /* spurious intr */
2385         }
2386
2387         switch (card->hw.type) {
2388                 case PC300_RSV:
2389                 case PC300_X21:
2390                         sca_intr(card);
2391                         break;
2392
2393                 case PC300_TE:
2394                         while ( (plx_status = (cpc_readb(card->hw.plxbase + card->hw.intctl_reg) &
2395                                  (PLX_9050_LINT1_STATUS | PLX_9050_LINT2_STATUS))) != 0) {
2396                                 if (plx_status & PLX_9050_LINT1_STATUS) {       /* SCA Interrupt */
2397                                         sca_intr(card);
2398                                 }
2399                                 if (plx_status & PLX_9050_LINT2_STATUS) {       /* FALC Interrupt */
2400                                         falc_intr(card);
2401                                 }
2402                         }
2403                         break;
2404         }
2405         return IRQ_HANDLED;
2406 }
2407
2408 void cpc_sca_status(pc300_t * card, int ch)
2409 {
2410         ucchar ilar;
2411         uclong scabase = card->hw.scabase;
2412         uclong flags;
2413
2414         tx_dma_buf_check(card, ch);
2415         rx_dma_buf_check(card, ch);
2416         ilar = cpc_readb(scabase + ILAR);
2417         printk ("ILAR=0x%02x, WCRL=0x%02x, PCR=0x%02x, BTCR=0x%02x, BOLR=0x%02x\n",
2418                  ilar, cpc_readb(scabase + WCRL), cpc_readb(scabase + PCR),
2419                  cpc_readb(scabase + BTCR), cpc_readb(scabase + BOLR));
2420         printk("TX_CDA=0x%08lx, TX_EDA=0x%08lx\n",
2421                (uclong) cpc_readl(scabase + DTX_REG(CDAL, ch)),
2422                (uclong) cpc_readl(scabase + DTX_REG(EDAL, ch)));
2423         printk("RX_CDA=0x%08lx, RX_EDA=0x%08lx, BFL=0x%04x\n",
2424                (uclong) cpc_readl(scabase + DRX_REG(CDAL, ch)),
2425                (uclong) cpc_readl(scabase + DRX_REG(EDAL, ch)),
2426                cpc_readw(scabase + DRX_REG(BFLL, ch)));
2427         printk("DMER=0x%02x, DSR_TX=0x%02x, DSR_RX=0x%02x\n",
2428                cpc_readb(scabase + DMER), cpc_readb(scabase + DSR_TX(ch)),
2429                cpc_readb(scabase + DSR_RX(ch)));
2430         printk("DMR_TX=0x%02x, DMR_RX=0x%02x, DIR_TX=0x%02x, DIR_RX=0x%02x\n",
2431                cpc_readb(scabase + DMR_TX(ch)), cpc_readb(scabase + DMR_RX(ch)),
2432                cpc_readb(scabase + DIR_TX(ch)),
2433                cpc_readb(scabase + DIR_RX(ch)));
2434         printk("DCR_TX=0x%02x, DCR_RX=0x%02x, FCT_TX=0x%02x, FCT_RX=0x%02x\n",
2435                cpc_readb(scabase + DCR_TX(ch)), cpc_readb(scabase + DCR_RX(ch)),
2436                cpc_readb(scabase + FCT_TX(ch)),
2437                cpc_readb(scabase + FCT_RX(ch)));
2438         printk("MD0=0x%02x, MD1=0x%02x, MD2=0x%02x, MD3=0x%02x, IDL=0x%02x\n",
2439                cpc_readb(scabase + M_REG(MD0, ch)),
2440                cpc_readb(scabase + M_REG(MD1, ch)),
2441                cpc_readb(scabase + M_REG(MD2, ch)),
2442                cpc_readb(scabase + M_REG(MD3, ch)),
2443                cpc_readb(scabase + M_REG(IDL, ch)));
2444         printk("CMD=0x%02x, SA0=0x%02x, SA1=0x%02x, TFN=0x%02x, CTL=0x%02x\n",
2445                cpc_readb(scabase + M_REG(CMD, ch)),
2446                cpc_readb(scabase + M_REG(SA0, ch)),
2447                cpc_readb(scabase + M_REG(SA1, ch)),
2448                cpc_readb(scabase + M_REG(TFN, ch)),
2449                cpc_readb(scabase + M_REG(CTL, ch)));
2450         printk("ST0=0x%02x, ST1=0x%02x, ST2=0x%02x, ST3=0x%02x, ST4=0x%02x\n",
2451                cpc_readb(scabase + M_REG(ST0, ch)),
2452                cpc_readb(scabase + M_REG(ST1, ch)),
2453                cpc_readb(scabase + M_REG(ST2, ch)),
2454                cpc_readb(scabase + M_REG(ST3, ch)),
2455                cpc_readb(scabase + M_REG(ST4, ch)));
2456         printk ("CST0=0x%02x, CST1=0x%02x, CST2=0x%02x, CST3=0x%02x, FST=0x%02x\n",
2457                  cpc_readb(scabase + M_REG(CST0, ch)),
2458                  cpc_readb(scabase + M_REG(CST1, ch)),
2459                  cpc_readb(scabase + M_REG(CST2, ch)),
2460                  cpc_readb(scabase + M_REG(CST3, ch)),
2461                  cpc_readb(scabase + M_REG(FST, ch)));
2462         printk("TRC0=0x%02x, TRC1=0x%02x, RRC=0x%02x, TBN=0x%02x, RBN=0x%02x\n",
2463                cpc_readb(scabase + M_REG(TRC0, ch)),
2464                cpc_readb(scabase + M_REG(TRC1, ch)),
2465                cpc_readb(scabase + M_REG(RRC, ch)),
2466                cpc_readb(scabase + M_REG(TBN, ch)),
2467                cpc_readb(scabase + M_REG(RBN, ch)));
2468         printk("TFS=0x%02x, TNR0=0x%02x, TNR1=0x%02x, RNR=0x%02x\n",
2469                cpc_readb(scabase + M_REG(TFS, ch)),
2470                cpc_readb(scabase + M_REG(TNR0, ch)),
2471                cpc_readb(scabase + M_REG(TNR1, ch)),
2472                cpc_readb(scabase + M_REG(RNR, ch)));
2473         printk("TCR=0x%02x, RCR=0x%02x, TNR1=0x%02x, RNR=0x%02x\n",
2474                cpc_readb(scabase + M_REG(TCR, ch)),
2475                cpc_readb(scabase + M_REG(RCR, ch)),
2476                cpc_readb(scabase + M_REG(TNR1, ch)),
2477                cpc_readb(scabase + M_REG(RNR, ch)));
2478         printk("TXS=0x%02x, RXS=0x%02x, EXS=0x%02x, TMCT=0x%02x, TMCR=0x%02x\n",
2479                cpc_readb(scabase + M_REG(TXS, ch)),
2480                cpc_readb(scabase + M_REG(RXS, ch)),
2481                cpc_readb(scabase + M_REG(EXS, ch)),
2482                cpc_readb(scabase + M_REG(TMCT, ch)),
2483                cpc_readb(scabase + M_REG(TMCR, ch)));
2484         printk("IE0=0x%02x, IE1=0x%02x, IE2=0x%02x, IE4=0x%02x, FIE=0x%02x\n",
2485                cpc_readb(scabase + M_REG(IE0, ch)),
2486                cpc_readb(scabase + M_REG(IE1, ch)),
2487                cpc_readb(scabase + M_REG(IE2, ch)),
2488                cpc_readb(scabase + M_REG(IE4, ch)),
2489                cpc_readb(scabase + M_REG(FIE, ch)));
2490         printk("IER0=0x%08lx\n", (uclong) cpc_readl(scabase + IER0));
2491
2492         if (ilar != 0) {
2493                 CPC_LOCK(card, flags);
2494                 cpc_writeb(scabase + ILAR, ilar);
2495                 cpc_writeb(scabase + DMER, 0x80);
2496                 CPC_UNLOCK(card, flags);
2497         }
2498 }
2499
2500 void cpc_falc_status(pc300_t * card, int ch)
2501 {
2502         pc300ch_t *chan = &card->chan[ch];
2503         falc_t *pfalc = (falc_t *) & chan->falc;
2504         uclong flags;
2505
2506         CPC_LOCK(card, flags);
2507         printk("CH%d:   %s %s  %d channels\n",
2508                ch, (pfalc->sync ? "SYNC" : ""), (pfalc->active ? "ACTIVE" : ""),
2509                pfalc->num_channels);
2510
2511         printk("        pden=%d,  los=%d,  losr=%d,  lfa=%d,  farec=%d\n",
2512                pfalc->pden, pfalc->los, pfalc->losr, pfalc->lfa, pfalc->farec);
2513         printk("        lmfa=%d,  ais=%d,  sec=%d,  es=%d,  rai=%d\n",
2514                pfalc->lmfa, pfalc->ais, pfalc->sec, pfalc->es, pfalc->rai);
2515         printk("        bec=%d,  fec=%d,  cvc=%d,  cec=%d,  ebc=%d\n",
2516                pfalc->bec, pfalc->fec, pfalc->cvc, pfalc->cec, pfalc->ebc);
2517
2518         printk("\n");
2519         printk("        STATUS: %s  %s  %s  %s  %s  %s\n",
2520                (pfalc->red_alarm ? "RED" : ""),
2521                (pfalc->blue_alarm ? "BLU" : ""),
2522                (pfalc->yellow_alarm ? "YEL" : ""),
2523                (pfalc->loss_fa ? "LFA" : ""),
2524                (pfalc->loss_mfa ? "LMF" : ""), (pfalc->prbs ? "PRB" : ""));
2525         CPC_UNLOCK(card, flags);
2526 }
2527
2528 int cpc_change_mtu(struct net_device *dev, int new_mtu)
2529 {
2530         if ((new_mtu < 128) || (new_mtu > PC300_DEF_MTU))
2531                 return -EINVAL;
2532         dev->mtu = new_mtu;
2533         return 0;
2534 }
2535
2536 int cpc_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd)
2537 {
2538         hdlc_device *hdlc = dev_to_hdlc(dev);
2539         pc300dev_t *d = (pc300dev_t *) dev->priv;
2540         pc300ch_t *chan = (pc300ch_t *) d->chan;
2541         pc300_t *card = (pc300_t *) chan->card;
2542         pc300conf_t conf_aux;
2543         pc300chconf_t *conf = (pc300chconf_t *) & chan->conf;
2544         int ch = chan->channel;
2545         void __user *arg = ifr->ifr_data;
2546         struct if_settings *settings = &ifr->ifr_settings;
2547         uclong scabase = card->hw.scabase;
2548
2549         if (!capable(CAP_NET_ADMIN))
2550                 return -EPERM;
2551
2552         switch (cmd) {
2553                 case SIOCGPC300CONF:
2554 #ifdef CONFIG_PC300_MLPPP
2555                         if (conf->proto != PC300_PROTO_MLPPP) {
2556                                 conf->proto = hdlc->proto.id;
2557                         }
2558 #else
2559                         conf->proto = hdlc->proto.id;
2560 #endif
2561                         memcpy(&conf_aux.conf, conf, sizeof(pc300chconf_t));
2562                         memcpy(&conf_aux.hw, &card->hw, sizeof(pc300hw_t));
2563                         if (!arg ||
2564                                 copy_to_user(arg, &conf_aux, sizeof(pc300conf_t)))
2565                                 return -EINVAL;
2566                         return 0;
2567                 case SIOCSPC300CONF:
2568                         if (!capable(CAP_NET_ADMIN))
2569                                 return -EPERM;
2570                         if (!arg ||
2571                                 copy_from_user(&conf_aux.conf, arg, sizeof(pc300chconf_t)))
2572                                 return -EINVAL;
2573                         if (card->hw.cpld_id < 0x02 &&
2574                             conf_aux.conf.fr_mode == PC300_FR_UNFRAMED) {
2575                                 /* CPLD_ID < 0x02 doesn't support Unframed E1 */
2576                                 return -EINVAL;
2577                         }
2578 #ifdef CONFIG_PC300_MLPPP
2579                         if (conf_aux.conf.proto == PC300_PROTO_MLPPP) {
2580                                 if (conf->proto != PC300_PROTO_MLPPP) {
2581                                         memcpy(conf, &conf_aux.conf, sizeof(pc300chconf_t));
2582                                         cpc_tty_init(d);        /* init TTY driver */
2583                                 }
2584                         } else {
2585                                 if (conf_aux.conf.proto == 0xffff) {
2586                                         if (conf->proto == PC300_PROTO_MLPPP){
2587                                                 /* ifdown interface */
2588                                                 cpc_close(dev);
2589                                         }
2590                                 } else {
2591                                         memcpy(conf, &conf_aux.conf, sizeof(pc300chconf_t));
2592                                         hdlc->proto.id = conf->proto;
2593                                 }
2594                         }
2595 #else
2596                         memcpy(conf, &conf_aux.conf, sizeof(pc300chconf_t));
2597                         hdlc->proto.id = conf->proto;
2598 #endif
2599                         return 0;
2600                 case SIOCGPC300STATUS:
2601                         cpc_sca_status(card, ch);
2602                         return 0;
2603                 case SIOCGPC300FALCSTATUS:
2604                         cpc_falc_status(card, ch);
2605                         return 0;
2606
2607                 case SIOCGPC300UTILSTATS:
2608                         {
2609                                 if (!arg) {     /* clear statistics */
2610                                         memset(&hdlc->stats, 0, sizeof(struct net_device_stats));
2611                                         if (card->hw.type == PC300_TE) {
2612                                                 memset(&chan->falc, 0, sizeof(falc_t));
2613                                         }
2614                                 } else {
2615                                         pc300stats_t pc300stats;
2616
2617                                         memset(&pc300stats, 0, sizeof(pc300stats_t));
2618                                         pc300stats.hw_type = card->hw.type;
2619                                         pc300stats.line_on = card->chan[ch].d.line_on;
2620                                         pc300stats.line_off = card->chan[ch].d.line_off;
2621                                         memcpy(&pc300stats.gen_stats, &hdlc->stats,
2622                                                sizeof(struct net_device_stats));
2623                                         if (card->hw.type == PC300_TE)
2624                                                 memcpy(&pc300stats.te_stats,&chan->falc,sizeof(falc_t));
2625                                         if (copy_to_user(arg, &pc300stats, sizeof(pc300stats_t)))
2626                                                 return -EFAULT;
2627                                 }
2628                                 return 0;
2629                         }
2630
2631                 case SIOCGPC300UTILSTATUS:
2632                         {
2633                                 struct pc300status pc300status;
2634
2635                                 pc300status.hw_type = card->hw.type;
2636                                 if (card->hw.type == PC300_TE) {
2637                                         pc300status.te_status.sync = chan->falc.sync;
2638                                         pc300status.te_status.red_alarm = chan->falc.red_alarm;
2639                                         pc300status.te_status.blue_alarm = chan->falc.blue_alarm;
2640                                         pc300status.te_status.loss_fa = chan->falc.loss_fa;
2641                                         pc300status.te_status.yellow_alarm =chan->falc.yellow_alarm;
2642                                         pc300status.te_status.loss_mfa = chan->falc.loss_mfa;
2643                                         pc300status.te_status.prbs = chan->falc.prbs;
2644                                 } else {
2645                                         pc300status.gen_status.dcd =
2646                                                 !(cpc_readb (scabase + M_REG(ST3, ch)) & ST3_DCD);
2647                                         pc300status.gen_status.cts =
2648                                                 !(cpc_readb (scabase + M_REG(ST3, ch)) & ST3_CTS);
2649                                         pc300status.gen_status.rts =
2650                                                 !(cpc_readb (scabase + M_REG(CTL, ch)) & CTL_RTS);
2651                                         pc300status.gen_status.dtr =
2652                                                 !(cpc_readb (scabase + M_REG(CTL, ch)) & CTL_DTR);
2653                                         /* There is no DSR in HD64572 */
2654                                 }
2655                                 if (!arg
2656                                     || copy_to_user(arg, &pc300status, sizeof(pc300status_t)))
2657                                                 return -EINVAL;
2658                                 return 0;
2659                         }
2660
2661                 case SIOCSPC300TRACE:
2662                         /* Sets/resets a trace_flag for the respective device */
2663                         if (!arg || copy_from_user(&d->trace_on, arg,sizeof(unsigned char)))
2664                                         return -EINVAL;
2665                         return 0;
2666
2667                 case SIOCSPC300LOOPBACK:
2668                         {
2669                                 struct pc300loopback pc300loop;
2670
2671                                 /* TE boards only */
2672                                 if (card->hw.type != PC300_TE)
2673                                         return -EINVAL;
2674
2675                                 if (!arg ||
2676                                         copy_from_user(&pc300loop, arg, sizeof(pc300loopback_t)))
2677                                                 return -EINVAL;
2678                                 switch (pc300loop.loop_type) {
2679                                         case PC300LOCLOOP:      /* Turn the local loop on/off */
2680                                                 falc_local_loop(card, ch, pc300loop.loop_on);
2681                                                 return 0;
2682
2683                                         case PC300REMLOOP:      /* Turn the remote loop on/off */
2684                                                 falc_remote_loop(card, ch, pc300loop.loop_on);
2685                                                 return 0;
2686
2687                                         case PC300PAYLOADLOOP:  /* Turn the payload loop on/off */
2688                                                 falc_payload_loop(card, ch, pc300loop.loop_on);
2689                                                 return 0;
2690
2691                                         case PC300GENLOOPUP:    /* Generate loop UP */
2692                                                 if (pc300loop.loop_on) {
2693                                                         falc_generate_loop_up_code (card, ch);
2694                                                 } else {
2695                                                         turn_off_xlu(card, ch);
2696                                                 }
2697                                                 return 0;
2698
2699                                         case PC300GENLOOPDOWN:  /* Generate loop DOWN */
2700                                                 if (pc300loop.loop_on) {
2701                                                         falc_generate_loop_down_code (card, ch);
2702                                                 } else {
2703                                                         turn_off_xld(card, ch);
2704                                                 }
2705                                                 return 0;
2706
2707                                         default:
2708                                                 return -EINVAL;
2709                                 }
2710                         }
2711
2712                 case SIOCSPC300PATTERNTEST:
2713                         /* Turn the pattern test on/off and show the errors counter */
2714                         {
2715                                 struct pc300patterntst pc300patrntst;
2716
2717                                 /* TE boards only */
2718                                 if (card->hw.type != PC300_TE)
2719                                         return -EINVAL;
2720
2721                                 if (card->hw.cpld_id < 0x02) {
2722                                         /* CPLD_ID < 0x02 doesn't support pattern test */
2723                                         return -EINVAL;
2724                                 }
2725
2726                                 if (!arg ||
2727                                         copy_from_user(&pc300patrntst,arg,sizeof(pc300patterntst_t)))
2728                                                 return -EINVAL;
2729                                 if (pc300patrntst.patrntst_on == 2) {
2730                                         if (chan->falc.prbs == 0) {
2731                                                 falc_pattern_test(card, ch, 1);
2732                                         }
2733                                         pc300patrntst.num_errors =
2734                                                 falc_pattern_test_error(card, ch);
2735                                         if (!arg
2736                                             || copy_to_user(arg, &pc300patrntst,
2737                                                             sizeof (pc300patterntst_t)))
2738                                                         return -EINVAL;
2739                                 } else {
2740                                         falc_pattern_test(card, ch, pc300patrntst.patrntst_on);
2741                                 }
2742                                 return 0;
2743                         }
2744
2745                 case SIOCWANDEV:
2746                         switch (ifr->ifr_settings.type) {
2747                                 case IF_GET_IFACE:
2748                                 {
2749                                         const size_t size = sizeof(sync_serial_settings);
2750                                         ifr->ifr_settings.type = conf->media;
2751                                         if (ifr->ifr_settings.size < size) {
2752                                                 /* data size wanted */
2753                                                 ifr->ifr_settings.size = size;
2754                                                 return -ENOBUFS;
2755                                         }
2756
2757                                         if (copy_to_user(settings->ifs_ifsu.sync,
2758                                                          &conf->phys_settings, size)) {
2759                                                 return -EFAULT;
2760                                         }
2761                                         return 0;
2762                                 }
2763
2764                                 case IF_IFACE_V35:
2765                                 case IF_IFACE_V24:
2766                                 case IF_IFACE_X21:
2767                                 {
2768                                         const size_t size = sizeof(sync_serial_settings);
2769
2770                                         if (!capable(CAP_NET_ADMIN)) {
2771                                                 return -EPERM;
2772                                         }
2773                                         /* incorrect data len? */
2774                                         if (ifr->ifr_settings.size != size) {
2775                                                 return -ENOBUFS;
2776                                         }
2777
2778                                         if (copy_from_user(&conf->phys_settings,
2779                                                            settings->ifs_ifsu.sync, size)) {
2780                                                 return -EFAULT;
2781                                         }
2782
2783                                         if (conf->phys_settings.loopback) {
2784                                                 cpc_writeb(card->hw.scabase + M_REG(MD2, ch),
2785                                                         cpc_readb(card->hw.scabase + M_REG(MD2, ch)) |
2786                                                         MD2_LOOP_MIR);
2787                                         }
2788                                         conf->media = ifr->ifr_settings.type;
2789                                         return 0;
2790                                 }
2791
2792                                 case IF_IFACE_T1:
2793                                 case IF_IFACE_E1:
2794                                 {
2795                                         const size_t te_size = sizeof(te1_settings);
2796                                         const size_t size = sizeof(sync_serial_settings);
2797
2798                                         if (!capable(CAP_NET_ADMIN)) {
2799                                                 return -EPERM;
2800                                         }
2801
2802                                         /* incorrect data len? */
2803                                         if (ifr->ifr_settings.size != te_size) {
2804                                                 return -ENOBUFS;
2805                                         }
2806
2807                                         if (copy_from_user(&conf->phys_settings,
2808                                                            settings->ifs_ifsu.te1, size)) {
2809                                                 return -EFAULT;
2810                                         }/* Ignoring HDLC slot_map for a while */
2811
2812                                         if (conf->phys_settings.loopback) {
2813                                                 cpc_writeb(card->hw.scabase + M_REG(MD2, ch),
2814                                                         cpc_readb(card->hw.scabase + M_REG(MD2, ch)) |
2815                                                         MD2_LOOP_MIR);
2816                                         }
2817                                         conf->media = ifr->ifr_settings.type;
2818                                         return 0;
2819                                 }
2820                                 default:
2821                                         return hdlc_ioctl(dev, ifr, cmd);
2822                         }
2823
2824                 default:
2825                         return hdlc_ioctl(dev, ifr, cmd);
2826         }
2827 }
2828
2829 static struct net_device_stats *cpc_get_stats(struct net_device *dev)
2830 {
2831         return hdlc_stats(dev);
2832 }
2833
2834 static int clock_rate_calc(uclong rate, uclong clock, int *br_io)
2835 {
2836         int br, tc;
2837         int br_pwr, error;
2838
2839         if (rate == 0)
2840                 return (0);
2841
2842         for (br = 0, br_pwr = 1; br <= 9; br++, br_pwr <<= 1) {
2843                 if ((tc = clock / br_pwr / rate) <= 0xff) {
2844                         *br_io = br;
2845                         break;
2846                 }
2847         }
2848
2849         if (tc <= 0xff) {
2850                 error = ((rate - (clock / br_pwr / rate)) / rate) * 1000;
2851                 /* Errors bigger than +/- 1% won't be tolerated */
2852                 if (error < -10 || error > 10)
2853                         return (-1);
2854                 else
2855                         return (tc);
2856         } else {
2857                 return (-1);
2858         }
2859 }
2860
2861 int ch_config(pc300dev_t * d)
2862 {
2863         pc300ch_t *chan = (pc300ch_t *) d->chan;
2864         pc300chconf_t *conf = (pc300chconf_t *) & chan->conf;
2865         pc300_t *card = (pc300_t *) chan->card;
2866         uclong scabase = card->hw.scabase;
2867         uclong plxbase = card->hw.plxbase;
2868         int ch = chan->channel;
2869         uclong clkrate = chan->conf.phys_settings.clock_rate;
2870         uclong clktype = chan->conf.phys_settings.clock_type;
2871         ucshort encoding = chan->conf.proto_settings.encoding;
2872         ucshort parity = chan->conf.proto_settings.parity;
2873         int tmc, br;
2874         ucchar md0, md2;
2875
2876         /* Reset the channel */
2877         cpc_writeb(scabase + M_REG(CMD, ch), CMD_CH_RST);
2878
2879         /* Configure the SCA registers */
2880         switch (parity) {
2881                 case PARITY_NONE:
2882                         md0 = MD0_BIT_SYNC;
2883                         break;
2884                 case PARITY_CRC16_PR0:
2885                         md0 = MD0_CRC16_0|MD0_CRCC0|MD0_BIT_SYNC;
2886                         break;
2887                 case PARITY_CRC16_PR1:
2888                         md0 = MD0_CRC16_1|MD0_CRCC0|MD0_BIT_SYNC;
2889                         break;
2890                 case PARITY_CRC32_PR1_CCITT:
2891                         md0 = MD0_CRC32|MD0_CRCC0|MD0_BIT_SYNC;
2892                         break;
2893                 case PARITY_CRC16_PR1_CCITT:
2894                 default:
2895                         md0 = MD0_CRC_CCITT|MD0_CRCC0|MD0_BIT_SYNC;
2896                         break;
2897         }
2898         switch (encoding) {
2899                 case ENCODING_NRZI:
2900                         md2 = MD2_F_DUPLEX|MD2_ADPLL_X8|MD2_NRZI;
2901                         break;
2902                 case ENCODING_FM_MARK:  /* FM1 */
2903                         md2 = MD2_F_DUPLEX|MD2_ADPLL_X8|MD2_FM|MD2_FM1;
2904                         break;
2905                 case ENCODING_FM_SPACE: /* FM0 */
2906                         md2 = MD2_F_DUPLEX|MD2_ADPLL_X8|MD2_FM|MD2_FM0;
2907                         break;
2908                 case ENCODING_MANCHESTER: /* It's not working... */
2909                         md2 = MD2_F_DUPLEX|MD2_ADPLL_X8|MD2_FM|MD2_MANCH;
2910                         break;
2911                 case ENCODING_NRZ:
2912                 default:
2913                         md2 = MD2_F_DUPLEX|MD2_ADPLL_X8|MD2_NRZ;
2914                         break;
2915         }
2916         cpc_writeb(scabase + M_REG(MD0, ch), md0);
2917         cpc_writeb(scabase + M_REG(MD1, ch), 0);
2918         cpc_writeb(scabase + M_REG(MD2, ch), md2);
2919         cpc_writeb(scabase + M_REG(IDL, ch), 0x7e);
2920         cpc_writeb(scabase + M_REG(CTL, ch), CTL_URSKP | CTL_IDLC);
2921
2922         /* Configure HW media */
2923         switch (card->hw.type) {
2924                 case PC300_RSV:
2925                         if (conf->media == IF_IFACE_V35) {
2926                                 cpc_writel((plxbase + card->hw.gpioc_reg),
2927                                            cpc_readl(plxbase + card->hw.gpioc_reg) | PC300_CHMEDIA_MASK(ch));
2928                         } else {
2929                                 cpc_writel((plxbase + card->hw.gpioc_reg),
2930                                            cpc_readl(plxbase + card->hw.gpioc_reg) & ~PC300_CHMEDIA_MASK(ch));
2931                         }
2932                         break;
2933
2934                 case PC300_X21:
2935                         break;
2936
2937                 case PC300_TE:
2938                         te_config(card, ch);
2939                         break;
2940         }
2941
2942         switch (card->hw.type) {
2943                 case PC300_RSV:
2944                 case PC300_X21:
2945                         if (clktype == CLOCK_INT || clktype == CLOCK_TXINT) {
2946                                 /* Calculate the clkrate parameters */
2947                                 tmc = clock_rate_calc(clkrate, card->hw.clock, &br);
2948                                 cpc_writeb(scabase + M_REG(TMCT, ch), tmc);
2949                                 cpc_writeb(scabase + M_REG(TXS, ch),
2950                                            (TXS_DTRXC | TXS_IBRG | br));
2951                                 if (clktype == CLOCK_INT) {
2952                                         cpc_writeb(scabase + M_REG(TMCR, ch), tmc);
2953                                         cpc_writeb(scabase + M_REG(RXS, ch),
2954                                                    (RXS_IBRG | br));
2955                                 } else {
2956                                         cpc_writeb(scabase + M_REG(TMCR, ch), 1);
2957                                         cpc_writeb(scabase + M_REG(RXS, ch), 0);
2958                                 }
2959                                 if (card->hw.type == PC300_X21) {
2960                                         cpc_writeb(scabase + M_REG(GPO, ch), 1);
2961                                         cpc_writeb(scabase + M_REG(EXS, ch), EXS_TES1 | EXS_RES1);
2962                                 } else {
2963                                         cpc_writeb(scabase + M_REG(EXS, ch), EXS_TES1);
2964                                 }
2965                         } else {
2966                                 cpc_writeb(scabase + M_REG(TMCT, ch), 1);
2967                                 if (clktype == CLOCK_EXT) {
2968                                         cpc_writeb(scabase + M_REG(TXS, ch),
2969                                                    TXS_DTRXC);
2970                                 } else {
2971                                         cpc_writeb(scabase + M_REG(TXS, ch),
2972                                                    TXS_DTRXC|TXS_RCLK);
2973                                 }
2974                                 cpc_writeb(scabase + M_REG(TMCR, ch), 1);
2975                                 cpc_writeb(scabase + M_REG(RXS, ch), 0);
2976                                 if (card->hw.type == PC300_X21) {
2977                                         cpc_writeb(scabase + M_REG(GPO, ch), 0);
2978                                         cpc_writeb(scabase + M_REG(EXS, ch), EXS_TES1 | EXS_RES1);
2979                                 } else {
2980                                         cpc_writeb(scabase + M_REG(EXS, ch), EXS_TES1);
2981                                 }
2982                         }
2983                         break;
2984
2985                 case PC300_TE:
2986                         /* SCA always receives clock from the FALC chip */
2987                         cpc_writeb(scabase + M_REG(TMCT, ch), 1);
2988                         cpc_writeb(scabase + M_REG(TXS, ch), 0);
2989                         cpc_writeb(scabase + M_REG(TMCR, ch), 1);
2990                         cpc_writeb(scabase + M_REG(RXS, ch), 0);
2991                         cpc_writeb(scabase + M_REG(EXS, ch), 0);
2992                         break;
2993         }
2994
2995         /* Enable Interrupts */
2996         cpc_writel(scabase + IER0,
2997                    cpc_readl(scabase + IER0) |
2998                    IR0_M(IR0_RXINTA, ch) |
2999                    IR0_DRX(IR0_EFT | IR0_DMIA | IR0_DMIB, ch) |
3000                    IR0_DTX(IR0_EFT | IR0_DMIA | IR0_DMIB, ch));
3001         cpc_writeb(scabase + M_REG(IE0, ch),
3002                    cpc_readl(scabase + M_REG(IE0, ch)) | IE0_RXINTA);
3003         cpc_writeb(scabase + M_REG(IE1, ch),
3004                    cpc_readl(scabase + M_REG(IE1, ch)) | IE1_CDCD);
3005
3006         return 0;
3007 }
3008
3009 int rx_config(pc300dev_t * d)
3010 {
3011         pc300ch_t *chan = (pc300ch_t *) d->chan;
3012         pc300_t *card = (pc300_t *) chan->card;
3013         uclong scabase = card->hw.scabase;
3014         int ch = chan->channel;
3015
3016         cpc_writeb(scabase + DSR_RX(ch), 0);
3017
3018         /* General RX settings */
3019         cpc_writeb(scabase + M_REG(RRC, ch), 0);
3020         cpc_writeb(scabase + M_REG(RNR, ch), 16);
3021
3022         /* Enable reception */
3023         cpc_writeb(scabase + M_REG(CMD, ch), CMD_RX_CRC_INIT);
3024         cpc_writeb(scabase + M_REG(CMD, ch), CMD_RX_ENA);
3025
3026         /* Initialize DMA stuff */
3027         chan->rx_first_bd = 0;
3028         chan->rx_last_bd = N_DMA_RX_BUF - 1;
3029         rx_dma_buf_init(card, ch);
3030         cpc_writeb(scabase + DCR_RX(ch), DCR_FCT_CLR);
3031         cpc_writeb(scabase + DMR_RX(ch), (DMR_TMOD | DMR_NF));
3032         cpc_writeb(scabase + DIR_RX(ch), (DIR_EOM | DIR_BOF));
3033
3034         /* Start DMA */
3035         rx_dma_start(card, ch);
3036
3037         return 0;
3038 }
3039
3040 int tx_config(pc300dev_t * d)
3041 {
3042         pc300ch_t *chan = (pc300ch_t *) d->chan;
3043         pc300_t *card = (pc300_t *) chan->card;
3044         uclong scabase = card->hw.scabase;
3045         int ch = chan->channel;
3046
3047         cpc_writeb(scabase + DSR_TX(ch), 0);
3048
3049         /* General TX settings */
3050         cpc_writeb(scabase + M_REG(TRC0, ch), 0);
3051         cpc_writeb(scabase + M_REG(TFS, ch), 32);
3052         cpc_writeb(scabase + M_REG(TNR0, ch), 20);
3053         cpc_writeb(scabase + M_REG(TNR1, ch), 48);
3054         cpc_writeb(scabase + M_REG(TCR, ch), 8);
3055
3056         /* Enable transmission */
3057         cpc_writeb(scabase + M_REG(CMD, ch), CMD_TX_CRC_INIT);
3058
3059         /* Initialize DMA stuff */
3060         chan->tx_first_bd = 0;
3061         chan->tx_next_bd = 0;
3062         tx_dma_buf_init(card, ch);
3063         cpc_writeb(scabase + DCR_TX(ch), DCR_FCT_CLR);
3064         cpc_writeb(scabase + DMR_TX(ch), (DMR_TMOD | DMR_NF));
3065         cpc_writeb(scabase + DIR_TX(ch), (DIR_EOM | DIR_BOF | DIR_UDRF));
3066         cpc_writel(scabase + DTX_REG(CDAL, ch), TX_BD_ADDR(ch, chan->tx_first_bd));
3067         cpc_writel(scabase + DTX_REG(EDAL, ch), TX_BD_ADDR(ch, chan->tx_next_bd));
3068
3069         return 0;
3070 }
3071
3072 static int cpc_attach(struct net_device *dev, unsigned short encoding,
3073                       unsigned short parity)
3074 {
3075         pc300dev_t *d = (pc300dev_t *)dev->priv;
3076         pc300ch_t *chan = (pc300ch_t *)d->chan;
3077         pc300_t *card = (pc300_t *)chan->card;
3078         pc300chconf_t *conf = (pc300chconf_t *)&chan->conf;
3079
3080         if (card->hw.type == PC300_TE) {
3081                 if (encoding != ENCODING_NRZ && encoding != ENCODING_NRZI) {
3082                         return -EINVAL;
3083                 }
3084         } else {
3085                 if (encoding != ENCODING_NRZ && encoding != ENCODING_NRZI &&
3086                     encoding != ENCODING_FM_MARK && encoding != ENCODING_FM_SPACE) {
3087                         /* Driver doesn't support ENCODING_MANCHESTER yet */
3088                         return -EINVAL;
3089                 }
3090         }
3091
3092         if (parity != PARITY_NONE && parity != PARITY_CRC16_PR0 &&
3093             parity != PARITY_CRC16_PR1 && parity != PARITY_CRC32_PR1_CCITT &&
3094             parity != PARITY_CRC16_PR1_CCITT) {
3095                 return -EINVAL;
3096         }
3097
3098         conf->proto_settings.encoding = encoding;
3099         conf->proto_settings.parity = parity;
3100         return 0;
3101 }
3102
3103 void cpc_opench(pc300dev_t * d)
3104 {
3105         pc300ch_t *chan = (pc300ch_t *) d->chan;
3106         pc300_t *card = (pc300_t *) chan->card;
3107         int ch = chan->channel;
3108         uclong scabase = card->hw.scabase;
3109
3110         ch_config(d);
3111
3112         rx_config(d);
3113
3114         tx_config(d);
3115
3116         /* Assert RTS and DTR */
3117         cpc_writeb(scabase + M_REG(CTL, ch),
3118                    cpc_readb(scabase + M_REG(CTL, ch)) & ~(CTL_RTS | CTL_DTR));
3119 }
3120
3121 void cpc_closech(pc300dev_t * d)
3122 {
3123         pc300ch_t *chan = (pc300ch_t *) d->chan;
3124         pc300_t *card = (pc300_t *) chan->card;
3125         falc_t *pfalc = (falc_t *) & chan->falc;
3126         int ch = chan->channel;
3127
3128         cpc_writeb(card->hw.scabase + M_REG(CMD, ch), CMD_CH_RST);
3129         rx_dma_stop(card, ch);
3130         tx_dma_stop(card, ch);
3131
3132         if (card->hw.type == PC300_TE) {
3133                 memset(pfalc, 0, sizeof(falc_t));
3134                 cpc_writeb(card->hw.falcbase + card->hw.cpld_reg2,
3135                            cpc_readb(card->hw.falcbase + card->hw.cpld_reg2) &
3136                            ~((CPLD_REG2_FALC_TX_CLK | CPLD_REG2_FALC_RX_CLK |
3137                               CPLD_REG2_FALC_LED2) << (2 * ch)));
3138                 /* Reset the FALC chip */
3139                 cpc_writeb(card->hw.falcbase + card->hw.cpld_reg1,
3140                            cpc_readb(card->hw.falcbase + card->hw.cpld_reg1) |
3141                            (CPLD_REG1_FALC_RESET << (2 * ch)));
3142                 udelay(10000);
3143                 cpc_writeb(card->hw.falcbase + card->hw.cpld_reg1,
3144                            cpc_readb(card->hw.falcbase + card->hw.cpld_reg1) &
3145                            ~(CPLD_REG1_FALC_RESET << (2 * ch)));
3146         }
3147 }
3148
3149 int cpc_open(struct net_device *dev)
3150 {
3151         hdlc_device *hdlc = dev_to_hdlc(dev);
3152         pc300dev_t *d = (pc300dev_t *) dev->priv;
3153         struct ifreq ifr;
3154         int result;
3155
3156 #ifdef  PC300_DEBUG_OTHER
3157         printk("pc300: cpc_open");
3158 #endif
3159
3160         if (hdlc->proto.id == IF_PROTO_PPP) {
3161                 d->if_ptr = &hdlc->state.ppp.pppdev;
3162         }
3163
3164         result = hdlc_open(dev);
3165         if (hdlc->proto.id == IF_PROTO_PPP) {
3166                 dev->priv = d;
3167         }
3168         if (result) {
3169                 return result;
3170         }
3171
3172         sprintf(ifr.ifr_name, "%s", dev->name);
3173         cpc_opench(d);
3174         netif_start_queue(dev);
3175         return 0;
3176 }
3177
3178 int cpc_close(struct net_device *dev)
3179 {
3180         hdlc_device *hdlc = dev_to_hdlc(dev);
3181         pc300dev_t *d = (pc300dev_t *) dev->priv;
3182         pc300ch_t *chan = (pc300ch_t *) d->chan;
3183         pc300_t *card = (pc300_t *) chan->card;
3184         uclong flags;
3185
3186 #ifdef  PC300_DEBUG_OTHER
3187         printk("pc300: cpc_close");
3188 #endif
3189
3190         netif_stop_queue(dev);
3191
3192         CPC_LOCK(card, flags);
3193         cpc_closech(d);
3194         CPC_UNLOCK(card, flags);
3195
3196         hdlc_close(dev);
3197         if (hdlc->proto.id == IF_PROTO_PPP) {
3198                 d->if_ptr = NULL;
3199         }
3200 #ifdef CONFIG_PC300_MLPPP
3201         if (chan->conf.proto == PC300_PROTO_MLPPP) {
3202                 cpc_tty_unregister_service(d);
3203                 chan->conf.proto = 0xffff;
3204         }
3205 #endif
3206
3207         return 0;
3208 }
3209
3210 static uclong detect_ram(pc300_t * card)
3211 {
3212         uclong i;
3213         ucchar data;
3214         uclong rambase = card->hw.rambase;
3215
3216         card->hw.ramsize = PC300_RAMSIZE;
3217         /* Let's find out how much RAM is present on this board */
3218         for (i = 0; i < card->hw.ramsize; i++) {
3219                 data = (ucchar) (i & 0xff);
3220                 cpc_writeb(rambase + i, data);
3221                 if (cpc_readb(rambase + i) != data) {
3222                         break;
3223                 }
3224         }
3225         return (i);
3226 }
3227
3228 static void plx_init(pc300_t * card)
3229 {
3230         struct RUNTIME_9050 *plx_ctl = (struct RUNTIME_9050 *) card->hw.plxbase;
3231
3232         /* Reset PLX */
3233         cpc_writel(&plx_ctl->init_ctrl,
3234                    cpc_readl(&plx_ctl->init_ctrl) | 0x40000000);
3235         udelay(10000L);
3236         cpc_writel(&plx_ctl->init_ctrl,
3237                    cpc_readl(&plx_ctl->init_ctrl) & ~0x40000000);
3238
3239         /* Reload Config. Registers from EEPROM */
3240         cpc_writel(&plx_ctl->init_ctrl,
3241                    cpc_readl(&plx_ctl->init_ctrl) | 0x20000000);
3242         udelay(10000L);
3243         cpc_writel(&plx_ctl->init_ctrl,
3244                    cpc_readl(&plx_ctl->init_ctrl) & ~0x20000000);
3245
3246 }
3247
3248 static inline void show_version(void)
3249 {
3250         char *rcsvers, *rcsdate, *tmp;
3251
3252         rcsvers = strchr(rcsid, ' ');
3253         rcsvers++;
3254         tmp = strchr(rcsvers, ' ');
3255         *tmp++ = '\0';
3256         rcsdate = strchr(tmp, ' ');
3257         rcsdate++;
3258         tmp = strrchr(rcsdate, ' ');
3259         *tmp = '\0';
3260         printk(KERN_INFO "Cyclades-PC300 driver %s %s (built %s %s)\n",
3261                 rcsvers, rcsdate, __DATE__, __TIME__);
3262 }                               /* show_version */
3263
3264 static void cpc_init_card(pc300_t * card)
3265 {
3266         int i, devcount = 0;
3267         static int board_nbr = 1;
3268
3269         /* Enable interrupts on the PCI bridge */
3270         plx_init(card);
3271         cpc_writew(card->hw.plxbase + card->hw.intctl_reg,
3272                    cpc_readw(card->hw.plxbase + card->hw.intctl_reg) | 0x0040);
3273
3274 #ifdef USE_PCI_CLOCK
3275         /* Set board clock to PCI clock */
3276         cpc_writel(card->hw.plxbase + card->hw.gpioc_reg,
3277                    cpc_readl(card->hw.plxbase + card->hw.gpioc_reg) | 0x00000004UL);
3278         card->hw.clock = PC300_PCI_CLOCK;
3279 #else
3280         /* Set board clock to internal oscillator clock */
3281         cpc_writel(card->hw.plxbase + card->hw.gpioc_reg,
3282                    cpc_readl(card->hw.plxbase + card->hw.gpioc_reg) & ~0x00000004UL);
3283         card->hw.clock = PC300_OSC_CLOCK;
3284 #endif
3285
3286         /* Detect actual on-board RAM size */
3287         card->hw.ramsize = detect_ram(card);
3288
3289         /* Set Global SCA-II registers */
3290         cpc_writeb(card->hw.scabase + PCR, PCR_PR2);
3291         cpc_writeb(card->hw.scabase + BTCR, 0x10);
3292         cpc_writeb(card->hw.scabase + WCRL, 0);
3293         cpc_writeb(card->hw.scabase + DMER, 0x80);
3294
3295         if (card->hw.type == PC300_TE) {
3296                 ucchar reg1;
3297
3298                 /* Check CPLD version */
3299                 reg1 = cpc_readb(card->hw.falcbase + CPLD_REG1);
3300                 cpc_writeb(card->hw.falcbase + CPLD_REG1, (reg1 + 0x5a));
3301                 if (cpc_readb(card->hw.falcbase + CPLD_REG1) == reg1) {
3302                         /* New CPLD */
3303                         card->hw.cpld_id = cpc_readb(card->hw.falcbase + CPLD_ID_REG);
3304                         card->hw.cpld_reg1 = CPLD_V2_REG1;
3305                         card->hw.cpld_reg2 = CPLD_V2_REG2;
3306                 } else {
3307                         /* old CPLD */
3308                         card->hw.cpld_id = 0;
3309                         card->hw.cpld_reg1 = CPLD_REG1;
3310                         card->hw.cpld_reg2 = CPLD_REG2;
3311                         cpc_writeb(card->hw.falcbase + CPLD_REG1, reg1);
3312                 }
3313
3314                 /* Enable the board's global clock */
3315                 cpc_writeb(card->hw.falcbase + card->hw.cpld_reg1,
3316                            cpc_readb(card->hw.falcbase + card->hw.cpld_reg1) |
3317                            CPLD_REG1_GLOBAL_CLK);
3318
3319         }
3320
3321         for (i = 0; i < card->hw.nchan; i++) {
3322                 pc300ch_t *chan = &card->chan[i];
3323                 pc300dev_t *d = &chan->d;
3324                 hdlc_device *hdlc;
3325                 struct net_device *dev;
3326
3327                 chan->card = card;
3328                 chan->channel = i;
3329                 chan->conf.phys_settings.clock_rate = 0;
3330                 chan->conf.phys_settings.clock_type = CLOCK_EXT;
3331                 chan->conf.proto_settings.encoding = ENCODING_NRZ;
3332                 chan->conf.proto_settings.parity = PARITY_CRC16_PR1_CCITT;
3333                 switch (card->hw.type) {
3334                         case PC300_TE:
3335                                 chan->conf.media = IF_IFACE_T1;
3336                                 chan->conf.lcode = PC300_LC_B8ZS;
3337                                 chan->conf.fr_mode = PC300_FR_ESF;
3338                                 chan->conf.lbo = PC300_LBO_0_DB;
3339                                 chan->conf.rx_sens = PC300_RX_SENS_SH;
3340                                 chan->conf.tslot_bitmap = 0xffffffffUL;
3341                                 break;
3342
3343                         case PC300_X21:
3344                                 chan->conf.media = IF_IFACE_X21;
3345                                 break;
3346
3347                         case PC300_RSV:
3348                         default:
3349                                 chan->conf.media = IF_IFACE_V35;
3350                                 break;
3351                 }
3352                 chan->conf.proto = IF_PROTO_PPP;
3353                 chan->tx_first_bd = 0;
3354                 chan->tx_next_bd = 0;
3355                 chan->rx_first_bd = 0;
3356                 chan->rx_last_bd = N_DMA_RX_BUF - 1;
3357                 chan->nfree_tx_bd = N_DMA_TX_BUF;
3358
3359                 d->chan = chan;
3360                 d->tx_skb = NULL;
3361                 d->trace_on = 0;
3362                 d->line_on = 0;
3363                 d->line_off = 0;
3364
3365                 dev = alloc_hdlcdev(NULL);
3366                 if (dev == NULL)
3367                         continue;
3368
3369                 hdlc = dev_to_hdlc(dev);
3370                 hdlc->xmit = cpc_queue_xmit;
3371                 hdlc->attach = cpc_attach;
3372                 d->dev = dev;
3373                 dev->mem_start = card->hw.ramphys;
3374                 dev->mem_end = card->hw.ramphys + card->hw.ramsize - 1;
3375                 dev->irq = card->hw.irq;
3376                 dev->init = NULL;
3377                 dev->tx_queue_len = PC300_TX_QUEUE_LEN;
3378                 dev->mtu = PC300_DEF_MTU;
3379
3380                 dev->open = cpc_open;
3381                 dev->stop = cpc_close;
3382                 dev->tx_timeout = cpc_tx_timeout;
3383                 dev->watchdog_timeo = PC300_TX_TIMEOUT;
3384                 dev->get_stats = cpc_get_stats;
3385                 dev->set_multicast_list = NULL;
3386                 dev->set_mac_address = NULL;
3387                 dev->change_mtu = cpc_change_mtu;
3388                 dev->do_ioctl = cpc_ioctl;
3389
3390                 if (register_hdlc_device(dev) == 0) {
3391                         dev->priv = d;  /* We need 'priv', hdlc doesn't */
3392                         printk("%s: Cyclades-PC300/", dev->name);
3393                         switch (card->hw.type) {
3394                                 case PC300_TE:
3395                                         if (card->hw.bus == PC300_PMC) {
3396                                                 printk("TE-M");
3397                                         } else {
3398                                                 printk("TE  ");
3399                                         }
3400                                         break;
3401
3402                                 case PC300_X21:
3403                                         printk("X21 ");
3404                                         break;
3405
3406                                 case PC300_RSV:
3407                                 default:
3408                                         printk("RSV ");
3409                                         break;
3410                         }
3411                         printk (" #%d, %ldKB of RAM at 0x%08lx, IRQ%d, channel %d.\n",
3412                                  board_nbr, card->hw.ramsize / 1024,
3413                                  card->hw.ramphys, card->hw.irq, i + 1);
3414                         devcount++;
3415                 } else {
3416                         printk ("Dev%d on card(0x%08lx): unable to allocate i/f name.\n",
3417                                  i + 1, card->hw.ramphys);
3418                         free_netdev(dev);
3419                         continue;
3420                 }
3421         }
3422         spin_lock_init(&card->card_lock);
3423
3424         board_nbr++;
3425 }
3426
3427 static int __devinit
3428 cpc_init_one(struct pci_dev *pdev, const struct pci_device_id *ent)
3429 {
3430         static int first_time = 1;
3431         ucchar cpc_rev_id;
3432         int err = 0, eeprom_outdated = 0;
3433         ucshort device_id;
3434         pc300_t *card;
3435
3436         if (first_time) {
3437                 first_time = 0;
3438                 show_version();
3439 #ifdef CONFIG_PC300_MLPPP
3440                 cpc_tty_reset_var();
3441 #endif
3442         }
3443
3444         card = (pc300_t *) kmalloc(sizeof(pc300_t), GFP_KERNEL);
3445         if (card == NULL) {
3446                 printk("PC300 found at RAM 0x%08lx, "
3447                        "but could not allocate card structure.\n",
3448                        pci_resource_start(pdev, 3));
3449                 return -ENOMEM;
3450         }
3451         memset(card, 0, sizeof(pc300_t));
3452
3453         /* read PCI configuration area */
3454         device_id = ent->device;
3455         card->hw.irq = pdev->irq;
3456         card->hw.iophys = pci_resource_start(pdev, 1);
3457         card->hw.iosize = pci_resource_len(pdev, 1);
3458         card->hw.scaphys = pci_resource_start(pdev, 2);
3459         card->hw.scasize = pci_resource_len(pdev, 2);
3460         card->hw.ramphys = pci_resource_start(pdev, 3);
3461         card->hw.alloc_ramsize = pci_resource_len(pdev, 3);
3462         card->hw.falcphys = pci_resource_start(pdev, 4);
3463         card->hw.falcsize = pci_resource_len(pdev, 4);
3464         card->hw.plxphys = pci_resource_start(pdev, 5);
3465         card->hw.plxsize = pci_resource_len(pdev, 5);
3466         pci_read_config_byte(pdev, PCI_REVISION_ID, &cpc_rev_id);
3467
3468         switch (device_id) {
3469                 case PCI_DEVICE_ID_PC300_RX_1:
3470                 case PCI_DEVICE_ID_PC300_TE_1:
3471                 case PCI_DEVICE_ID_PC300_TE_M_1:
3472                         card->hw.nchan = 1;
3473                         break;
3474
3475                 case PCI_DEVICE_ID_PC300_RX_2:
3476                 case PCI_DEVICE_ID_PC300_TE_2:
3477                 case PCI_DEVICE_ID_PC300_TE_M_2:
3478                 default:
3479                         card->hw.nchan = PC300_MAXCHAN;
3480                         break;
3481         }
3482 #ifdef PC300_DEBUG_PCI
3483         printk("cpc (bus=0x0%x,pci_id=0x%x,", pdev->bus->number, pdev->devfn);
3484         printk("rev_id=%d) IRQ%d\n", cpc_rev_id, card->hw.irq);
3485         printk("cpc:found  ramaddr=0x%08lx plxaddr=0x%08lx "
3486                "ctladdr=0x%08lx falcaddr=0x%08lx\n",
3487                card->hw.ramphys, card->hw.plxphys, card->hw.scaphys,
3488                card->hw.falcphys);
3489 #endif
3490         /* Although we don't use this I/O region, we should
3491          * request it from the kernel anyway, to avoid problems
3492          * with other drivers accessing it. */
3493         if (!request_region(card->hw.iophys, card->hw.iosize, "PLX Registers")) {
3494                 /* In case we can't allocate it, warn user */
3495                 printk("WARNING: couldn't allocate I/O region for PC300 board "
3496                        "at 0x%08lx!\n", card->hw.ramphys);
3497         }
3498
3499         if (card->hw.plxphys) {
3500                 pci_write_config_dword(pdev, PCI_BASE_ADDRESS_0, card->hw.plxphys);
3501         } else {
3502                 eeprom_outdated = 1;
3503                 card->hw.plxphys = pci_resource_start(pdev, 0);
3504                 card->hw.plxsize = pci_resource_len(pdev, 0);
3505         }
3506
3507         if (!request_mem_region(card->hw.plxphys, card->hw.plxsize,
3508                                 "PLX Registers")) {
3509                 printk("PC300 found at RAM 0x%08lx, "
3510                        "but could not allocate PLX mem region.\n",
3511                        card->hw.ramphys);
3512                 err = -ENODEV;
3513                 goto err_release_io;
3514         }
3515         if (!request_mem_region(card->hw.ramphys, card->hw.alloc_ramsize,
3516                                 "On-board RAM")) {
3517                 printk("PC300 found at RAM 0x%08lx, "
3518                        "but could not allocate RAM mem region.\n",
3519                        card->hw.ramphys);
3520                 err = -ENODEV;
3521                 goto err_release_plx;
3522         }
3523         if (!request_mem_region(card->hw.scaphys, card->hw.scasize,
3524                                 "SCA-II Registers")) {
3525                 printk("PC300 found at RAM 0x%08lx, "
3526                        "but could not allocate SCA mem region.\n",
3527                        card->hw.ramphys);
3528                 err = -ENODEV;
3529                 goto err_release_ram;
3530         }
3531
3532         if ((err = pci_enable_device(pdev)) != 0)
3533                 goto err_release_sca;
3534
3535         card->hw.plxbase = (uclong) ioremap(card->hw.plxphys, card->hw.plxsize);
3536         card->hw.rambase = (uclong) ioremap(card->hw.ramphys,
3537                                             card->hw.alloc_ramsize);
3538         card->hw.scabase = (uclong) ioremap(card->hw.scaphys, card->hw.scasize);
3539         switch (device_id) {
3540                 case PCI_DEVICE_ID_PC300_TE_1:
3541                 case PCI_DEVICE_ID_PC300_TE_2:
3542                 case PCI_DEVICE_ID_PC300_TE_M_1:
3543                 case PCI_DEVICE_ID_PC300_TE_M_2:
3544                         request_mem_region(card->hw.falcphys, card->hw.falcsize,
3545                                            "FALC Registers");
3546                         card->hw.falcbase = (uclong) ioremap(card->hw.falcphys,
3547                                                              card->hw.falcsize);
3548                         break;
3549
3550                 case PCI_DEVICE_ID_PC300_RX_1:
3551                 case PCI_DEVICE_ID_PC300_RX_2:
3552                 default:
3553                         card->hw.falcbase = 0;
3554                         break;
3555         }
3556
3557 #ifdef PC300_DEBUG_PCI
3558         printk("cpc: relocate ramaddr=0x%08lx plxaddr=0x%08lx "
3559                "ctladdr=0x%08lx falcaddr=0x%08lx\n",
3560                card->hw.rambase, card->hw.plxbase, card->hw.scabase,
3561                card->hw.falcbase);
3562 #endif
3563
3564         /* Set PCI drv pointer to the card structure */
3565         pci_set_drvdata(pdev, card);
3566
3567         /* Set board type */
3568         switch (device_id) {
3569                 case PCI_DEVICE_ID_PC300_TE_1:
3570                 case PCI_DEVICE_ID_PC300_TE_2:
3571                 case PCI_DEVICE_ID_PC300_TE_M_1:
3572                 case PCI_DEVICE_ID_PC300_TE_M_2:
3573                         card->hw.type = PC300_TE;
3574
3575                         if ((device_id == PCI_DEVICE_ID_PC300_TE_M_1) ||
3576                             (device_id == PCI_DEVICE_ID_PC300_TE_M_2)) {
3577                                 card->hw.bus = PC300_PMC;
3578                                 /* Set PLX register offsets */
3579                                 card->hw.gpioc_reg = 0x54;
3580                                 card->hw.intctl_reg = 0x4c;
3581                         } else {
3582                                 card->hw.bus = PC300_PCI;
3583                                 /* Set PLX register offsets */
3584                                 card->hw.gpioc_reg = 0x50;
3585                                 card->hw.intctl_reg = 0x4c;
3586                         }
3587                         break;
3588
3589                 case PCI_DEVICE_ID_PC300_RX_1:
3590                 case PCI_DEVICE_ID_PC300_RX_2:
3591                 default:
3592                         card->hw.bus = PC300_PCI;
3593                         /* Set PLX register offsets */
3594                         card->hw.gpioc_reg = 0x50;
3595                         card->hw.intctl_reg = 0x4c;
3596
3597                         if ((cpc_readl(card->hw.plxbase + card->hw.gpioc_reg) & PC300_CTYPE_MASK)) {
3598                                 card->hw.type = PC300_X21;
3599                         } else {
3600                                 card->hw.type = PC300_RSV;
3601                         }
3602                         break;
3603         }
3604
3605         /* Allocate IRQ */
3606         if (request_irq(card->hw.irq, cpc_intr, SA_SHIRQ, "Cyclades-PC300", card)) {
3607                 printk ("PC300 found at RAM 0x%08lx, but could not allocate IRQ%d.\n",
3608                          card->hw.ramphys, card->hw.irq);
3609                 goto err_io_unmap;
3610         }
3611
3612         cpc_init_card(card);
3613
3614         if (eeprom_outdated)
3615                 printk("WARNING: PC300 with outdated EEPROM.\n");
3616         return 0;
3617
3618 err_io_unmap:
3619         iounmap((void *) card->hw.plxbase);
3620         iounmap((void *) card->hw.scabase);
3621         iounmap((void *) card->hw.rambase);
3622         if (card->hw.type == PC300_TE) {
3623                 iounmap((void *) card->hw.falcbase);
3624                 release_mem_region(card->hw.falcphys, card->hw.falcsize);
3625         }
3626 err_release_sca:
3627         release_mem_region(card->hw.scaphys, card->hw.scasize);
3628 err_release_ram:
3629         release_mem_region(card->hw.ramphys, card->hw.alloc_ramsize);
3630 err_release_plx:
3631         release_mem_region(card->hw.plxphys, card->hw.plxsize);
3632 err_release_io:
3633         release_region(card->hw.iophys, card->hw.iosize);
3634         kfree(card);
3635         return -ENODEV;
3636 }
3637
3638 static void __devexit cpc_remove_one(struct pci_dev *pdev)
3639 {
3640         pc300_t *card = pci_get_drvdata(pdev);
3641
3642         if (card->hw.rambase != 0) {
3643                 int i;
3644
3645                 /* Disable interrupts on the PCI bridge */
3646                 cpc_writew(card->hw.plxbase + card->hw.intctl_reg,
3647                            cpc_readw(card->hw.plxbase + card->hw.intctl_reg) & ~(0x0040));
3648
3649                 for (i = 0; i < card->hw.nchan; i++) {
3650                         unregister_hdlc_device(card->chan[i].d.dev);
3651                 }
3652                 iounmap((void *) card->hw.plxbase);
3653                 iounmap((void *) card->hw.scabase);
3654                 iounmap((void *) card->hw.rambase);
3655                 release_mem_region(card->hw.plxphys, card->hw.plxsize);
3656                 release_mem_region(card->hw.ramphys, card->hw.alloc_ramsize);
3657                 release_mem_region(card->hw.scaphys, card->hw.scasize);
3658                 release_region(card->hw.iophys, card->hw.iosize);
3659                 if (card->hw.type == PC300_TE) {
3660                         iounmap((void *) card->hw.falcbase);
3661                         release_mem_region(card->hw.falcphys, card->hw.falcsize);
3662                 }
3663                 for (i = 0; i < card->hw.nchan; i++)
3664                         if (card->chan[i].d.dev)
3665                                 free_netdev(card->chan[i].d.dev);
3666                 if (card->hw.irq)
3667                         free_irq(card->hw.irq, card);
3668                 kfree(card);
3669         }
3670 }
3671
3672 static struct pci_driver cpc_driver = {
3673         .name           = "pc300",
3674         .id_table       = cpc_pci_dev_id,
3675         .probe          = cpc_init_one,
3676         .remove         = __devexit_p(cpc_remove_one),
3677 };
3678
3679 static int __init cpc_init(void)
3680 {
3681         return pci_module_init(&cpc_driver);
3682 }
3683
3684 static void __exit cpc_cleanup_module(void)
3685 {
3686         pci_unregister_driver(&cpc_driver);
3687 }
3688
3689 module_init(cpc_init);
3690 module_exit(cpc_cleanup_module);
3691
3692 MODULE_DESCRIPTION("Cyclades-PC300 cards driver");
3693 MODULE_AUTHOR(  "Author: Ivan Passos <ivan@cyclades.com>\r\n"
3694                 "Maintainer: PC300 Maintainer <pc300@cyclades.com");
3695 MODULE_LICENSE("GPL");
3696