xref: /openbmc/linux/drivers/net/wan/farsync.c (revision 7ae9fb1b7ecbb5d85d07857943f677fd1a559b18)
12874c5fdSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-or-later
214b9764cSPeng Li /*      FarSync WAN driver for Linux (2.6.x kernel version)
31da177e4SLinus Torvalds  *
41da177e4SLinus Torvalds  *      Actually sync driver for X.21, V.35 and V.24 on FarSync T-series cards
51da177e4SLinus Torvalds  *
61da177e4SLinus Torvalds  *      Copyright (C) 2001-2004 FarSite Communications Ltd.
71da177e4SLinus Torvalds  *      www.farsite.co.uk
81da177e4SLinus Torvalds  *
91da177e4SLinus Torvalds  *      Author:      R.J.Dunlop    <bob.dunlop@farsite.co.uk>
101da177e4SLinus Torvalds  *      Maintainer:  Kevin Curtis  <kevin.curtis@farsite.co.uk>
111da177e4SLinus Torvalds  */
121da177e4SLinus Torvalds 
133f326d40SJoe Perches #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
143f326d40SJoe Perches 
151da177e4SLinus Torvalds #include <linux/module.h>
161da177e4SLinus Torvalds #include <linux/kernel.h>
171da177e4SLinus Torvalds #include <linux/version.h>
181da177e4SLinus Torvalds #include <linux/pci.h>
19d43c36dcSAlexey Dobriyan #include <linux/sched.h>
205a0e3ad6STejun Heo #include <linux/slab.h>
211da177e4SLinus Torvalds #include <linux/ioport.h>
221da177e4SLinus Torvalds #include <linux/init.h>
23a6b7a407SAlexey Dobriyan #include <linux/interrupt.h>
248db4ec66SManuel Schölling #include <linux/delay.h>
251da177e4SLinus Torvalds #include <linux/if.h>
261da177e4SLinus Torvalds #include <linux/hdlc.h>
271da177e4SLinus Torvalds #include <asm/io.h>
287c0f6ba6SLinus Torvalds #include <linux/uaccess.h>
291da177e4SLinus Torvalds 
301da177e4SLinus Torvalds #include "farsync.h"
311da177e4SLinus Torvalds 
3214b9764cSPeng Li /*      Module info
331da177e4SLinus Torvalds  */
341da177e4SLinus Torvalds MODULE_AUTHOR("R.J.Dunlop <bob.dunlop@farsite.co.uk>");
351da177e4SLinus Torvalds MODULE_DESCRIPTION("FarSync T-Series WAN driver. FarSite Communications Ltd.");
361da177e4SLinus Torvalds MODULE_LICENSE("GPL");
371da177e4SLinus Torvalds 
381da177e4SLinus Torvalds /*      Driver configuration and global parameters
391da177e4SLinus Torvalds  *      ==========================================
401da177e4SLinus Torvalds  */
411da177e4SLinus Torvalds 
421da177e4SLinus Torvalds /*      Number of ports (per card) and cards supported
431da177e4SLinus Torvalds  */
441da177e4SLinus Torvalds #define FST_MAX_PORTS           4
451da177e4SLinus Torvalds #define FST_MAX_CARDS           32
461da177e4SLinus Torvalds 
471da177e4SLinus Torvalds /*      Default parameters for the link
481da177e4SLinus Torvalds  */
491da177e4SLinus Torvalds #define FST_TX_QUEUE_LEN        100	/* At 8Mbps a longer queue length is
5014b9764cSPeng Li 					 * useful
5114b9764cSPeng Li 					 */
521da177e4SLinus Torvalds #define FST_TXQ_DEPTH           16	/* This one is for the buffering
531da177e4SLinus Torvalds 					 * of frames on the way down to the card
541da177e4SLinus Torvalds 					 * so that we can keep the card busy
551da177e4SLinus Torvalds 					 * and maximise throughput
561da177e4SLinus Torvalds 					 */
571da177e4SLinus Torvalds #define FST_HIGH_WATER_MARK     12	/* Point at which we flow control
5814b9764cSPeng Li 					 * network layer
5914b9764cSPeng Li 					 */
601da177e4SLinus Torvalds #define FST_LOW_WATER_MARK      8	/* Point at which we remove flow
6114b9764cSPeng Li 					 * control from network layer
6214b9764cSPeng Li 					 */
631da177e4SLinus Torvalds #define FST_MAX_MTU             8000	/* Huge but possible */
641da177e4SLinus Torvalds #define FST_DEF_MTU             1500	/* Common sane value */
651da177e4SLinus Torvalds 
661da177e4SLinus Torvalds #define FST_TX_TIMEOUT          (2 * HZ)
671da177e4SLinus Torvalds 
681da177e4SLinus Torvalds #ifdef ARPHRD_RAWHDLC
691da177e4SLinus Torvalds #define ARPHRD_MYTYPE   ARPHRD_RAWHDLC	/* Raw frames */
701da177e4SLinus Torvalds #else
711da177e4SLinus Torvalds #define ARPHRD_MYTYPE   ARPHRD_HDLC	/* Cisco-HDLC (keepalives etc) */
721da177e4SLinus Torvalds #endif
731da177e4SLinus Torvalds 
7414b9764cSPeng Li /* Modules parameters and associated variables
751da177e4SLinus Torvalds  */
767665a089SAdrian Bunk static int fst_txq_low = FST_LOW_WATER_MARK;
777665a089SAdrian Bunk static int fst_txq_high = FST_HIGH_WATER_MARK;
787665a089SAdrian Bunk static int fst_max_reads = 7;
798ccac4a5SPeng Li static int fst_excluded_cards;
807665a089SAdrian Bunk static int fst_excluded_list[FST_MAX_CARDS];
811da177e4SLinus Torvalds 
821da177e4SLinus Torvalds module_param(fst_txq_low, int, 0);
831da177e4SLinus Torvalds module_param(fst_txq_high, int, 0);
841da177e4SLinus Torvalds module_param(fst_max_reads, int, 0);
851da177e4SLinus Torvalds module_param(fst_excluded_cards, int, 0);
861da177e4SLinus Torvalds module_param_array(fst_excluded_list, int, NULL, 0);
871da177e4SLinus Torvalds 
881da177e4SLinus Torvalds /*      Card shared memory layout
891da177e4SLinus Torvalds  *      =========================
901da177e4SLinus Torvalds  */
911da177e4SLinus Torvalds #pragma pack(1)
921da177e4SLinus Torvalds 
931da177e4SLinus Torvalds /*      This information is derived in part from the FarSite FarSync Smc.h
941da177e4SLinus Torvalds  *      file. Unfortunately various name clashes and the non-portability of the
951da177e4SLinus Torvalds  *      bit field declarations in that file have meant that I have chosen to
961da177e4SLinus Torvalds  *      recreate the information here.
971da177e4SLinus Torvalds  *
981da177e4SLinus Torvalds  *      The SMC (Shared Memory Configuration) has a version number that is
991da177e4SLinus Torvalds  *      incremented every time there is a significant change. This number can
1001da177e4SLinus Torvalds  *      be used to check that we have not got out of step with the firmware
1011da177e4SLinus Torvalds  *      contained in the .CDE files.
1021da177e4SLinus Torvalds  */
1031da177e4SLinus Torvalds #define SMC_VERSION 24
1041da177e4SLinus Torvalds 
1051da177e4SLinus Torvalds #define FST_MEMSIZE 0x100000	/* Size of card memory (1Mb) */
1061da177e4SLinus Torvalds 
1071da177e4SLinus Torvalds #define SMC_BASE 0x00002000L	/* Base offset of the shared memory window main
10814b9764cSPeng Li 				 * configuration structure
10914b9764cSPeng Li 				 */
1101da177e4SLinus Torvalds #define BFM_BASE 0x00010000L	/* Base offset of the shared memory window DMA
11114b9764cSPeng Li 				 * buffers
11214b9764cSPeng Li 				 */
1131da177e4SLinus Torvalds 
1141da177e4SLinus Torvalds #define LEN_TX_BUFFER 8192	/* Size of packet buffers */
1151da177e4SLinus Torvalds #define LEN_RX_BUFFER 8192
1161da177e4SLinus Torvalds 
1171da177e4SLinus Torvalds #define LEN_SMALL_TX_BUFFER 256	/* Size of obsolete buffs used for DOS diags */
1181da177e4SLinus Torvalds #define LEN_SMALL_RX_BUFFER 256
1191da177e4SLinus Torvalds 
1201da177e4SLinus Torvalds #define NUM_TX_BUFFER 2		/* Must be power of 2. Fixed by firmware */
1211da177e4SLinus Torvalds #define NUM_RX_BUFFER 8
1221da177e4SLinus Torvalds 
1231da177e4SLinus Torvalds /* Interrupt retry time in milliseconds */
1241da177e4SLinus Torvalds #define INT_RETRY_TIME 2
1251da177e4SLinus Torvalds 
1261da177e4SLinus Torvalds /*      The Am186CH/CC processors support a SmartDMA mode using circular pools
1271da177e4SLinus Torvalds  *      of buffer descriptors. The structure is almost identical to that used
1281da177e4SLinus Torvalds  *      in the LANCE Ethernet controllers. Details available as PDF from the
129bfe4c403SAlexander A. Klimov  *      AMD web site: https://www.amd.com/products/epd/processors/\
1301da177e4SLinus Torvalds  *                    2.16bitcont/3.am186cxfa/a21914/21914.pdf
1311da177e4SLinus Torvalds  */
1321da177e4SLinus Torvalds struct txdesc {			/* Transmit descriptor */
1331da177e4SLinus Torvalds 	volatile u16 ladr;	/* Low order address of packet. This is a
1341da177e4SLinus Torvalds 				 * linear address in the Am186 memory space
1351da177e4SLinus Torvalds 				 */
1361da177e4SLinus Torvalds 	volatile u8 hadr;	/* High order address. Low 4 bits only, high 4
1371da177e4SLinus Torvalds 				 * bits must be zero
1381da177e4SLinus Torvalds 				 */
1391da177e4SLinus Torvalds 	volatile u8 bits;	/* Status and config */
1401da177e4SLinus Torvalds 	volatile u16 bcnt;	/* 2s complement of packet size in low 15 bits.
1411da177e4SLinus Torvalds 				 * Transmit terminal count interrupt enable in
1421da177e4SLinus Torvalds 				 * top bit.
1431da177e4SLinus Torvalds 				 */
1441da177e4SLinus Torvalds 	u16 unused;		/* Not used in Tx */
1451da177e4SLinus Torvalds };
1461da177e4SLinus Torvalds 
1471da177e4SLinus Torvalds struct rxdesc {			/* Receive descriptor */
1481da177e4SLinus Torvalds 	volatile u16 ladr;	/* Low order address of packet */
1491da177e4SLinus Torvalds 	volatile u8 hadr;	/* High order address */
1501da177e4SLinus Torvalds 	volatile u8 bits;	/* Status and config */
1511da177e4SLinus Torvalds 	volatile u16 bcnt;	/* 2s complement of buffer size in low 15 bits.
1521da177e4SLinus Torvalds 				 * Receive terminal count interrupt enable in
1531da177e4SLinus Torvalds 				 * top bit.
1541da177e4SLinus Torvalds 				 */
1551da177e4SLinus Torvalds 	volatile u16 mcnt;	/* Message byte count (15 bits) */
1561da177e4SLinus Torvalds };
1571da177e4SLinus Torvalds 
1581da177e4SLinus Torvalds /* Convert a length into the 15 bit 2's complement */
1591da177e4SLinus Torvalds /* #define cnv_bcnt(len)   (( ~(len) + 1 ) & 0x7FFF ) */
1601da177e4SLinus Torvalds /* Since we need to set the high bit to enable the completion interrupt this
1611da177e4SLinus Torvalds  * can be made a lot simpler
1621da177e4SLinus Torvalds  */
1631da177e4SLinus Torvalds #define cnv_bcnt(len)   (-(len))
1641da177e4SLinus Torvalds 
1651da177e4SLinus Torvalds /* Status and config bits for the above */
1661da177e4SLinus Torvalds #define DMA_OWN         0x80	/* SmartDMA owns the descriptor */
1671da177e4SLinus Torvalds #define TX_STP          0x02	/* Tx: start of packet */
1681da177e4SLinus Torvalds #define TX_ENP          0x01	/* Tx: end of packet */
1691da177e4SLinus Torvalds #define RX_ERR          0x40	/* Rx: error (OR of next 4 bits) */
1701da177e4SLinus Torvalds #define RX_FRAM         0x20	/* Rx: framing error */
1711da177e4SLinus Torvalds #define RX_OFLO         0x10	/* Rx: overflow error */
1721da177e4SLinus Torvalds #define RX_CRC          0x08	/* Rx: CRC error */
1731da177e4SLinus Torvalds #define RX_HBUF         0x04	/* Rx: buffer error */
1741da177e4SLinus Torvalds #define RX_STP          0x02	/* Rx: start of packet */
1751da177e4SLinus Torvalds #define RX_ENP          0x01	/* Rx: end of packet */
1761da177e4SLinus Torvalds 
1771da177e4SLinus Torvalds /* Interrupts from the card are caused by various events which are presented
1781da177e4SLinus Torvalds  * in a circular buffer as several events may be processed on one physical int
1791da177e4SLinus Torvalds  */
1801da177e4SLinus Torvalds #define MAX_CIRBUFF     32
1811da177e4SLinus Torvalds 
1821da177e4SLinus Torvalds struct cirbuff {
1831da177e4SLinus Torvalds 	u8 rdindex;		/* read, then increment and wrap */
1841da177e4SLinus Torvalds 	u8 wrindex;		/* write, then increment and wrap */
1851da177e4SLinus Torvalds 	u8 evntbuff[MAX_CIRBUFF];
1861da177e4SLinus Torvalds };
1871da177e4SLinus Torvalds 
1881da177e4SLinus Torvalds /* Interrupt event codes.
1891da177e4SLinus Torvalds  * Where appropriate the two low order bits indicate the port number
1901da177e4SLinus Torvalds  */
1911da177e4SLinus Torvalds #define CTLA_CHG        0x18	/* Control signal changed */
1921da177e4SLinus Torvalds #define CTLB_CHG        0x19
1931da177e4SLinus Torvalds #define CTLC_CHG        0x1A
1941da177e4SLinus Torvalds #define CTLD_CHG        0x1B
1951da177e4SLinus Torvalds 
1961da177e4SLinus Torvalds #define INIT_CPLT       0x20	/* Initialisation complete */
1971da177e4SLinus Torvalds #define INIT_FAIL       0x21	/* Initialisation failed */
1981da177e4SLinus Torvalds 
1991da177e4SLinus Torvalds #define ABTA_SENT       0x24	/* Abort sent */
2001da177e4SLinus Torvalds #define ABTB_SENT       0x25
2011da177e4SLinus Torvalds #define ABTC_SENT       0x26
2021da177e4SLinus Torvalds #define ABTD_SENT       0x27
2031da177e4SLinus Torvalds 
2041da177e4SLinus Torvalds #define TXA_UNDF        0x28	/* Transmission underflow */
2051da177e4SLinus Torvalds #define TXB_UNDF        0x29
2061da177e4SLinus Torvalds #define TXC_UNDF        0x2A
2071da177e4SLinus Torvalds #define TXD_UNDF        0x2B
2081da177e4SLinus Torvalds 
2091da177e4SLinus Torvalds #define F56_INT         0x2C
2101da177e4SLinus Torvalds #define M32_INT         0x2D
2111da177e4SLinus Torvalds 
2121da177e4SLinus Torvalds #define TE1_ALMA        0x30
2131da177e4SLinus Torvalds 
2141da177e4SLinus Torvalds /* Port physical configuration. See farsync.h for field values */
2151da177e4SLinus Torvalds struct port_cfg {
2161da177e4SLinus Torvalds 	u16 lineInterface;	/* Physical interface type */
2171da177e4SLinus Torvalds 	u8 x25op;		/* Unused at present */
2181da177e4SLinus Torvalds 	u8 internalClock;	/* 1 => internal clock, 0 => external */
2191da177e4SLinus Torvalds 	u8 transparentMode;	/* 1 => on, 0 => off */
2201da177e4SLinus Torvalds 	u8 invertClock;		/* 0 => normal, 1 => inverted */
2211da177e4SLinus Torvalds 	u8 padBytes[6];		/* Padding */
2221da177e4SLinus Torvalds 	u32 lineSpeed;		/* Speed in bps */
2231da177e4SLinus Torvalds };
2241da177e4SLinus Torvalds 
2251da177e4SLinus Torvalds /* TE1 port physical configuration */
2261da177e4SLinus Torvalds struct su_config {
2271da177e4SLinus Torvalds 	u32 dataRate;
2281da177e4SLinus Torvalds 	u8 clocking;
2291da177e4SLinus Torvalds 	u8 framing;
2301da177e4SLinus Torvalds 	u8 structure;
2311da177e4SLinus Torvalds 	u8 interface;
2321da177e4SLinus Torvalds 	u8 coding;
2331da177e4SLinus Torvalds 	u8 lineBuildOut;
2341da177e4SLinus Torvalds 	u8 equalizer;
2351da177e4SLinus Torvalds 	u8 transparentMode;
2361da177e4SLinus Torvalds 	u8 loopMode;
2371da177e4SLinus Torvalds 	u8 range;
2381da177e4SLinus Torvalds 	u8 txBufferMode;
2391da177e4SLinus Torvalds 	u8 rxBufferMode;
2401da177e4SLinus Torvalds 	u8 startingSlot;
2411da177e4SLinus Torvalds 	u8 losThreshold;
2421da177e4SLinus Torvalds 	u8 enableIdleCode;
2431da177e4SLinus Torvalds 	u8 idleCode;
2441da177e4SLinus Torvalds 	u8 spare[44];
2451da177e4SLinus Torvalds };
2461da177e4SLinus Torvalds 
2471da177e4SLinus Torvalds /* TE1 Status */
2481da177e4SLinus Torvalds struct su_status {
2491da177e4SLinus Torvalds 	u32 receiveBufferDelay;
2501da177e4SLinus Torvalds 	u32 framingErrorCount;
2511da177e4SLinus Torvalds 	u32 codeViolationCount;
2521da177e4SLinus Torvalds 	u32 crcErrorCount;
2531da177e4SLinus Torvalds 	u32 lineAttenuation;
2541da177e4SLinus Torvalds 	u8 portStarted;
2551da177e4SLinus Torvalds 	u8 lossOfSignal;
2561da177e4SLinus Torvalds 	u8 receiveRemoteAlarm;
2571da177e4SLinus Torvalds 	u8 alarmIndicationSignal;
2581da177e4SLinus Torvalds 	u8 spare[40];
2591da177e4SLinus Torvalds };
2601da177e4SLinus Torvalds 
2611da177e4SLinus Torvalds /* Finally sling all the above together into the shared memory structure.
2621da177e4SLinus Torvalds  * Sorry it's a hodge podge of arrays, structures and unused bits, it's been
2631da177e4SLinus Torvalds  * evolving under NT for some time so I guess we're stuck with it.
2641da177e4SLinus Torvalds  * The structure starts at offset SMC_BASE.
2651da177e4SLinus Torvalds  * See farsync.h for some field values.
2661da177e4SLinus Torvalds  */
2671da177e4SLinus Torvalds struct fst_shared {
2681da177e4SLinus Torvalds 	/* DMA descriptor rings */
2691da177e4SLinus Torvalds 	struct rxdesc rxDescrRing[FST_MAX_PORTS][NUM_RX_BUFFER];
2701da177e4SLinus Torvalds 	struct txdesc txDescrRing[FST_MAX_PORTS][NUM_TX_BUFFER];
2711da177e4SLinus Torvalds 
2721da177e4SLinus Torvalds 	/* Obsolete small buffers */
2731da177e4SLinus Torvalds 	u8 smallRxBuffer[FST_MAX_PORTS][NUM_RX_BUFFER][LEN_SMALL_RX_BUFFER];
2741da177e4SLinus Torvalds 	u8 smallTxBuffer[FST_MAX_PORTS][NUM_TX_BUFFER][LEN_SMALL_TX_BUFFER];
2751da177e4SLinus Torvalds 
2761da177e4SLinus Torvalds 	u8 taskStatus;		/* 0x00 => initialising, 0x01 => running,
2771da177e4SLinus Torvalds 				 * 0xFF => halted
2781da177e4SLinus Torvalds 				 */
2791da177e4SLinus Torvalds 
2801da177e4SLinus Torvalds 	u8 interruptHandshake;	/* Set to 0x01 by adapter to signal interrupt,
2811da177e4SLinus Torvalds 				 * set to 0xEE by host to acknowledge interrupt
2821da177e4SLinus Torvalds 				 */
2831da177e4SLinus Torvalds 
2841da177e4SLinus Torvalds 	u16 smcVersion;		/* Must match SMC_VERSION */
2851da177e4SLinus Torvalds 
2861da177e4SLinus Torvalds 	u32 smcFirmwareVersion;	/* 0xIIVVRRBB where II = product ID, VV = major
2871da177e4SLinus Torvalds 				 * version, RR = revision and BB = build
2881da177e4SLinus Torvalds 				 */
2891da177e4SLinus Torvalds 
2901da177e4SLinus Torvalds 	u16 txa_done;		/* Obsolete completion flags */
2911da177e4SLinus Torvalds 	u16 rxa_done;
2921da177e4SLinus Torvalds 	u16 txb_done;
2931da177e4SLinus Torvalds 	u16 rxb_done;
2941da177e4SLinus Torvalds 	u16 txc_done;
2951da177e4SLinus Torvalds 	u16 rxc_done;
2961da177e4SLinus Torvalds 	u16 txd_done;
2971da177e4SLinus Torvalds 	u16 rxd_done;
2981da177e4SLinus Torvalds 
2991da177e4SLinus Torvalds 	u16 mailbox[4];		/* Diagnostics mailbox. Not used */
3001da177e4SLinus Torvalds 
3011da177e4SLinus Torvalds 	struct cirbuff interruptEvent;	/* interrupt causes */
3021da177e4SLinus Torvalds 
3031da177e4SLinus Torvalds 	u32 v24IpSts[FST_MAX_PORTS];	/* V.24 control input status */
3041da177e4SLinus Torvalds 	u32 v24OpSts[FST_MAX_PORTS];	/* V.24 control output status */
3051da177e4SLinus Torvalds 
3061da177e4SLinus Torvalds 	struct port_cfg portConfig[FST_MAX_PORTS];
3071da177e4SLinus Torvalds 
3081da177e4SLinus Torvalds 	u16 clockStatus[FST_MAX_PORTS];	/* lsb: 0=> present, 1=> absent */
3091da177e4SLinus Torvalds 
3101da177e4SLinus Torvalds 	u16 cableStatus;	/* lsb: 0=> present, 1=> absent */
3111da177e4SLinus Torvalds 
3121da177e4SLinus Torvalds 	u16 txDescrIndex[FST_MAX_PORTS];	/* transmit descriptor ring index */
3131da177e4SLinus Torvalds 	u16 rxDescrIndex[FST_MAX_PORTS];	/* receive descriptor ring index */
3141da177e4SLinus Torvalds 
3151da177e4SLinus Torvalds 	u16 portMailbox[FST_MAX_PORTS][2];	/* command, modifier */
3161da177e4SLinus Torvalds 	u16 cardMailbox[4];	/* Not used */
3171da177e4SLinus Torvalds 
3181da177e4SLinus Torvalds 	/* Number of times the card thinks the host has
3191da177e4SLinus Torvalds 	 * missed an interrupt by not acknowledging
3201da177e4SLinus Torvalds 	 * within 2mS (I guess NT has problems)
3211da177e4SLinus Torvalds 	 */
3221da177e4SLinus Torvalds 	u32 interruptRetryCount;
3231da177e4SLinus Torvalds 
3241da177e4SLinus Torvalds 	/* Driver private data used as an ID. We'll not
3251da177e4SLinus Torvalds 	 * use this as I'd rather keep such things
3261da177e4SLinus Torvalds 	 * in main memory rather than on the PCI bus
3271da177e4SLinus Torvalds 	 */
3281da177e4SLinus Torvalds 	u32 portHandle[FST_MAX_PORTS];
3291da177e4SLinus Torvalds 
3301da177e4SLinus Torvalds 	/* Count of Tx underflows for stats */
3311da177e4SLinus Torvalds 	u32 transmitBufferUnderflow[FST_MAX_PORTS];
3321da177e4SLinus Torvalds 
3331da177e4SLinus Torvalds 	/* Debounced V.24 control input status */
3341da177e4SLinus Torvalds 	u32 v24DebouncedSts[FST_MAX_PORTS];
3351da177e4SLinus Torvalds 
3361da177e4SLinus Torvalds 	/* Adapter debounce timers. Don't touch */
3371da177e4SLinus Torvalds 	u32 ctsTimer[FST_MAX_PORTS];
3381da177e4SLinus Torvalds 	u32 ctsTimerRun[FST_MAX_PORTS];
3391da177e4SLinus Torvalds 	u32 dcdTimer[FST_MAX_PORTS];
3401da177e4SLinus Torvalds 	u32 dcdTimerRun[FST_MAX_PORTS];
3411da177e4SLinus Torvalds 
3421da177e4SLinus Torvalds 	u32 numberOfPorts;	/* Number of ports detected at startup */
3431da177e4SLinus Torvalds 
3441da177e4SLinus Torvalds 	u16 _reserved[64];
3451da177e4SLinus Torvalds 
3461da177e4SLinus Torvalds 	u16 cardMode;		/* Bit-mask to enable features:
3471da177e4SLinus Torvalds 				 * Bit 0: 1 enables LED identify mode
3481da177e4SLinus Torvalds 				 */
3491da177e4SLinus Torvalds 
3501da177e4SLinus Torvalds 	u16 portScheduleOffset;
3511da177e4SLinus Torvalds 
3521da177e4SLinus Torvalds 	struct su_config suConfig;	/* TE1 Bits */
3531da177e4SLinus Torvalds 	struct su_status suStatus;
3541da177e4SLinus Torvalds 
3551da177e4SLinus Torvalds 	u32 endOfSmcSignature;	/* endOfSmcSignature MUST be the last member of
3561da177e4SLinus Torvalds 				 * the structure and marks the end of shared
3571da177e4SLinus Torvalds 				 * memory. Adapter code initializes it as
3581da177e4SLinus Torvalds 				 * END_SIG.
3591da177e4SLinus Torvalds 				 */
3601da177e4SLinus Torvalds };
3611da177e4SLinus Torvalds 
3621da177e4SLinus Torvalds /* endOfSmcSignature value */
3631da177e4SLinus Torvalds #define END_SIG                 0x12345678
3641da177e4SLinus Torvalds 
3651da177e4SLinus Torvalds /* Mailbox values. (portMailbox) */
3661da177e4SLinus Torvalds #define NOP             0	/* No operation */
3671da177e4SLinus Torvalds #define ACK             1	/* Positive acknowledgement to PC driver */
3681da177e4SLinus Torvalds #define NAK             2	/* Negative acknowledgement to PC driver */
3691da177e4SLinus Torvalds #define STARTPORT       3	/* Start an HDLC port */
3701da177e4SLinus Torvalds #define STOPPORT        4	/* Stop an HDLC port */
3711da177e4SLinus Torvalds #define ABORTTX         5	/* Abort the transmitter for a port */
3721da177e4SLinus Torvalds #define SETV24O         6	/* Set V24 outputs */
3731da177e4SLinus Torvalds 
3741da177e4SLinus Torvalds /* PLX Chip Register Offsets */
3751da177e4SLinus Torvalds #define CNTRL_9052      0x50	/* Control Register */
3761da177e4SLinus Torvalds #define CNTRL_9054      0x6c	/* Control Register */
3771da177e4SLinus Torvalds 
3781da177e4SLinus Torvalds #define INTCSR_9052     0x4c	/* Interrupt control/status register */
3791da177e4SLinus Torvalds #define INTCSR_9054     0x68	/* Interrupt control/status register */
3801da177e4SLinus Torvalds 
3811da177e4SLinus Torvalds /* 9054 DMA Registers */
38214b9764cSPeng Li /* Note that we will be using DMA Channel 0 for copying rx data
3831da177e4SLinus Torvalds  * and Channel 1 for copying tx data
3841da177e4SLinus Torvalds  */
3851da177e4SLinus Torvalds #define DMAMODE0        0x80
3861da177e4SLinus Torvalds #define DMAPADR0        0x84
3871da177e4SLinus Torvalds #define DMALADR0        0x88
3881da177e4SLinus Torvalds #define DMASIZ0         0x8c
3891da177e4SLinus Torvalds #define DMADPR0         0x90
3901da177e4SLinus Torvalds #define DMAMODE1        0x94
3911da177e4SLinus Torvalds #define DMAPADR1        0x98
3921da177e4SLinus Torvalds #define DMALADR1        0x9c
3931da177e4SLinus Torvalds #define DMASIZ1         0xa0
3941da177e4SLinus Torvalds #define DMADPR1         0xa4
3951da177e4SLinus Torvalds #define DMACSR0         0xa8
3961da177e4SLinus Torvalds #define DMACSR1         0xa9
3971da177e4SLinus Torvalds #define DMAARB          0xac
3981da177e4SLinus Torvalds #define DMATHR          0xb0
3991da177e4SLinus Torvalds #define DMADAC0         0xb4
4001da177e4SLinus Torvalds #define DMADAC1         0xb8
4011da177e4SLinus Torvalds #define DMAMARBR        0xac
4021da177e4SLinus Torvalds 
4031da177e4SLinus Torvalds #define FST_MIN_DMA_LEN 64
4041da177e4SLinus Torvalds #define FST_RX_DMA_INT  0x01
4051da177e4SLinus Torvalds #define FST_TX_DMA_INT  0x02
4061da177e4SLinus Torvalds #define FST_CARD_INT    0x04
4071da177e4SLinus Torvalds 
4081da177e4SLinus Torvalds /* Larger buffers are positioned in memory at offset BFM_BASE */
4091da177e4SLinus Torvalds struct buf_window {
4101da177e4SLinus Torvalds 	u8 txBuffer[FST_MAX_PORTS][NUM_TX_BUFFER][LEN_TX_BUFFER];
4111da177e4SLinus Torvalds 	u8 rxBuffer[FST_MAX_PORTS][NUM_RX_BUFFER][LEN_RX_BUFFER];
4121da177e4SLinus Torvalds };
4131da177e4SLinus Torvalds 
4141da177e4SLinus Torvalds /* Calculate offset of a buffer object within the shared memory window */
4151da177e4SLinus Torvalds #define BUF_OFFSET(X)   (BFM_BASE + offsetof(struct buf_window, X))
4161da177e4SLinus Torvalds 
4171da177e4SLinus Torvalds #pragma pack()
4181da177e4SLinus Torvalds 
4191da177e4SLinus Torvalds /*      Device driver private information
4201da177e4SLinus Torvalds  *      =================================
4211da177e4SLinus Torvalds  */
4221da177e4SLinus Torvalds /*      Per port (line or channel) information
4231da177e4SLinus Torvalds  */
4241da177e4SLinus Torvalds struct fst_port_info {
4251da177e4SLinus Torvalds 	struct net_device *dev; /* Device struct - must be first */
4261da177e4SLinus Torvalds 	struct fst_card_info *card;	/* Card we're associated with */
4271da177e4SLinus Torvalds 	int index;		/* Port index on the card */
4281da177e4SLinus Torvalds 	int hwif;		/* Line hardware (lineInterface copy) */
4291da177e4SLinus Torvalds 	int run;		/* Port is running */
4301da177e4SLinus Torvalds 	int mode;		/* Normal or FarSync raw */
4311da177e4SLinus Torvalds 	int rxpos;		/* Next Rx buffer to use */
4321da177e4SLinus Torvalds 	int txpos;		/* Next Tx buffer to use */
4331da177e4SLinus Torvalds 	int txipos;		/* Next Tx buffer to check for free */
4341da177e4SLinus Torvalds 	int start;		/* Indication of start/stop to network */
43514b9764cSPeng Li 	/* A sixteen entry transmit queue
4361da177e4SLinus Torvalds 	 */
4371da177e4SLinus Torvalds 	int txqs;		/* index to get next buffer to tx */
4381da177e4SLinus Torvalds 	int txqe;		/* index to queue next packet */
4391da177e4SLinus Torvalds 	struct sk_buff *txq[FST_TXQ_DEPTH];	/* The queue */
4401da177e4SLinus Torvalds 	int rxqdepth;
4411da177e4SLinus Torvalds };
4421da177e4SLinus Torvalds 
4431da177e4SLinus Torvalds /*      Per card information
4441da177e4SLinus Torvalds  */
4451da177e4SLinus Torvalds struct fst_card_info {
4461da177e4SLinus Torvalds 	char __iomem *mem;	/* Card memory mapped to kernel space */
4471da177e4SLinus Torvalds 	char __iomem *ctlmem;	/* Control memory for PCI cards */
4481da177e4SLinus Torvalds 	unsigned int phys_mem;	/* Physical memory window address */
4491da177e4SLinus Torvalds 	unsigned int phys_ctlmem;	/* Physical control memory address */
4501da177e4SLinus Torvalds 	unsigned int irq;	/* Interrupt request line number */
4511da177e4SLinus Torvalds 	unsigned int nports;	/* Number of serial ports */
4521da177e4SLinus Torvalds 	unsigned int type;	/* Type index of card */
4531da177e4SLinus Torvalds 	unsigned int state;	/* State of card */
4541da177e4SLinus Torvalds 	spinlock_t card_lock;	/* Lock for SMP access */
4551da177e4SLinus Torvalds 	unsigned short pci_conf;	/* PCI card config in I/O space */
4561da177e4SLinus Torvalds 	/* Per port info */
4571da177e4SLinus Torvalds 	struct fst_port_info ports[FST_MAX_PORTS];
4581da177e4SLinus Torvalds 	struct pci_dev *device;	/* Information about the pci device */
4591da177e4SLinus Torvalds 	int card_no;		/* Inst of the card on the system */
4601da177e4SLinus Torvalds 	int family;		/* TxP or TxU */
4611da177e4SLinus Torvalds 	int dmarx_in_progress;
4621da177e4SLinus Torvalds 	int dmatx_in_progress;
4631da177e4SLinus Torvalds 	unsigned long int_count;
4641da177e4SLinus Torvalds 	unsigned long int_time_ave;
4651da177e4SLinus Torvalds 	void *rx_dma_handle_host;
4661da177e4SLinus Torvalds 	dma_addr_t rx_dma_handle_card;
4671da177e4SLinus Torvalds 	void *tx_dma_handle_host;
4681da177e4SLinus Torvalds 	dma_addr_t tx_dma_handle_card;
4691da177e4SLinus Torvalds 	struct sk_buff *dma_skb_rx;
4701da177e4SLinus Torvalds 	struct fst_port_info *dma_port_rx;
4711da177e4SLinus Torvalds 	struct fst_port_info *dma_port_tx;
4721da177e4SLinus Torvalds 	int dma_len_rx;
4731da177e4SLinus Torvalds 	int dma_len_tx;
4741da177e4SLinus Torvalds 	int dma_txpos;
4751da177e4SLinus Torvalds 	int dma_rxpos;
4761da177e4SLinus Torvalds };
4771da177e4SLinus Torvalds 
4781da177e4SLinus Torvalds /* Convert an HDLC device pointer into a port info pointer and similar */
4791da177e4SLinus Torvalds #define dev_to_port(D)  (dev_to_hdlc(D)->priv)
4801da177e4SLinus Torvalds #define port_to_dev(P)  ((P)->dev)
4811da177e4SLinus Torvalds 
48214b9764cSPeng Li /*      Shared memory window access macros
4831da177e4SLinus Torvalds  *
4841da177e4SLinus Torvalds  *      We have a nice memory based structure above, which could be directly
4851da177e4SLinus Torvalds  *      mapped on i386 but might not work on other architectures unless we use
4861da177e4SLinus Torvalds  *      the readb,w,l and writeb,w,l macros. Unfortunately these macros take
4871da177e4SLinus Torvalds  *      physical offsets so we have to convert. The only saving grace is that
4881da177e4SLinus Torvalds  *      this should all collapse back to a simple indirection eventually.
4891da177e4SLinus Torvalds  */
4901da177e4SLinus Torvalds #define WIN_OFFSET(X)   ((long)&(((struct fst_shared *)SMC_BASE)->X))
4911da177e4SLinus Torvalds 
4927619ab16SPeng Li #define FST_RDB(C, E)    (readb((C)->mem + WIN_OFFSET(E)))
4937619ab16SPeng Li #define FST_RDW(C, E)    (readw((C)->mem + WIN_OFFSET(E)))
4947619ab16SPeng Li #define FST_RDL(C, E)    (readl((C)->mem + WIN_OFFSET(E)))
4951da177e4SLinus Torvalds 
4967619ab16SPeng Li #define FST_WRB(C, E, B)  (writeb((B), (C)->mem + WIN_OFFSET(E)))
4977619ab16SPeng Li #define FST_WRW(C, E, W)  (writew((W), (C)->mem + WIN_OFFSET(E)))
4987619ab16SPeng Li #define FST_WRL(C, E, L)  (writel((L), (C)->mem + WIN_OFFSET(E)))
4991da177e4SLinus Torvalds 
50014b9764cSPeng Li /*      Debug support
5011da177e4SLinus Torvalds  */
5021da177e4SLinus Torvalds #if FST_DEBUG
5031da177e4SLinus Torvalds 
5041da177e4SLinus Torvalds static int fst_debug_mask = { FST_DEBUG };
5051da177e4SLinus Torvalds 
5061da177e4SLinus Torvalds /* Most common debug activity is to print something if the corresponding bit
5071da177e4SLinus Torvalds  * is set in the debug mask. Note: this uses a non-ANSI extension in GCC to
5081da177e4SLinus Torvalds  * support variable numbers of macro parameters. The inverted if prevents us
5091da177e4SLinus Torvalds  * eating someone else's else clause.
5101da177e4SLinus Torvalds  */
5113f326d40SJoe Perches #define dbg(F, fmt, args...)					\
5123f326d40SJoe Perches do {								\
5133f326d40SJoe Perches 	if (fst_debug_mask & (F))				\
5143f326d40SJoe Perches 		printk(KERN_DEBUG pr_fmt(fmt), ##args);		\
5153f326d40SJoe Perches } while (0)
5161da177e4SLinus Torvalds #else
5173f326d40SJoe Perches #define dbg(F, fmt, args...)					\
5183f326d40SJoe Perches do {								\
5193f326d40SJoe Perches 	if (0)							\
5203f326d40SJoe Perches 		printk(KERN_DEBUG pr_fmt(fmt), ##args);		\
5213f326d40SJoe Perches } while (0)
5221da177e4SLinus Torvalds #endif
5231da177e4SLinus Torvalds 
52414b9764cSPeng Li /*      PCI ID lookup table
5251da177e4SLinus Torvalds  */
5269baa3c34SBenoit Taine static const struct pci_device_id fst_pci_dev_id[] = {
5271da177e4SLinus Torvalds 	{PCI_VENDOR_ID_FARSITE, PCI_DEVICE_ID_FARSITE_T2P, PCI_ANY_ID,
5281da177e4SLinus Torvalds 	 PCI_ANY_ID, 0, 0, FST_TYPE_T2P},
5291da177e4SLinus Torvalds 
5301da177e4SLinus Torvalds 	{PCI_VENDOR_ID_FARSITE, PCI_DEVICE_ID_FARSITE_T4P, PCI_ANY_ID,
5311da177e4SLinus Torvalds 	 PCI_ANY_ID, 0, 0, FST_TYPE_T4P},
5321da177e4SLinus Torvalds 
5331da177e4SLinus Torvalds 	{PCI_VENDOR_ID_FARSITE, PCI_DEVICE_ID_FARSITE_T1U, PCI_ANY_ID,
5341da177e4SLinus Torvalds 	 PCI_ANY_ID, 0, 0, FST_TYPE_T1U},
5351da177e4SLinus Torvalds 
5361da177e4SLinus Torvalds 	{PCI_VENDOR_ID_FARSITE, PCI_DEVICE_ID_FARSITE_T2U, PCI_ANY_ID,
5371da177e4SLinus Torvalds 	 PCI_ANY_ID, 0, 0, FST_TYPE_T2U},
5381da177e4SLinus Torvalds 
5391da177e4SLinus Torvalds 	{PCI_VENDOR_ID_FARSITE, PCI_DEVICE_ID_FARSITE_T4U, PCI_ANY_ID,
5401da177e4SLinus Torvalds 	 PCI_ANY_ID, 0, 0, FST_TYPE_T4U},
5411da177e4SLinus Torvalds 
5421da177e4SLinus Torvalds 	{PCI_VENDOR_ID_FARSITE, PCI_DEVICE_ID_FARSITE_TE1, PCI_ANY_ID,
5431da177e4SLinus Torvalds 	 PCI_ANY_ID, 0, 0, FST_TYPE_TE1},
5441da177e4SLinus Torvalds 
5451da177e4SLinus Torvalds 	{PCI_VENDOR_ID_FARSITE, PCI_DEVICE_ID_FARSITE_TE1C, PCI_ANY_ID,
5461da177e4SLinus Torvalds 	 PCI_ANY_ID, 0, 0, FST_TYPE_TE1},
5471da177e4SLinus Torvalds 	{0,}			/* End */
5481da177e4SLinus Torvalds };
5491da177e4SLinus Torvalds 
5501da177e4SLinus Torvalds MODULE_DEVICE_TABLE(pci, fst_pci_dev_id);
5511da177e4SLinus Torvalds 
55214b9764cSPeng Li /*      Device Driver Work Queues
5531da177e4SLinus Torvalds  *
5541da177e4SLinus Torvalds  *      So that we don't spend too much time processing events in the
5551da177e4SLinus Torvalds  *      Interrupt Service routine, we will declare a work queue per Card
5561da177e4SLinus Torvalds  *      and make the ISR schedule a task in the queue for later execution.
5571da177e4SLinus Torvalds  *      In the 2.4 Kernel we used to use the immediate queue for BH's
5581da177e4SLinus Torvalds  *      Now that they are gone, tasklets seem to be much better than work
5591da177e4SLinus Torvalds  *      queues.
5601da177e4SLinus Torvalds  */
5611da177e4SLinus Torvalds 
5621da177e4SLinus Torvalds static void do_bottom_half_tx(struct fst_card_info *card);
5631da177e4SLinus Torvalds static void do_bottom_half_rx(struct fst_card_info *card);
5648cc8993cSEmil Renner Berthing static void fst_process_tx_work_q(struct tasklet_struct *unused);
5658cc8993cSEmil Renner Berthing static void fst_process_int_work_q(struct tasklet_struct *unused);
5661da177e4SLinus Torvalds 
5678cc8993cSEmil Renner Berthing static DECLARE_TASKLET(fst_tx_task, fst_process_tx_work_q);
5688cc8993cSEmil Renner Berthing static DECLARE_TASKLET(fst_int_task, fst_process_int_work_q);
5691da177e4SLinus Torvalds 
5707665a089SAdrian Bunk static struct fst_card_info *fst_card_array[FST_MAX_CARDS];
571a1281601SLiu Jian static DEFINE_SPINLOCK(fst_work_q_lock);
5727665a089SAdrian Bunk static u64 fst_work_txq;
5737665a089SAdrian Bunk static u64 fst_work_intq;
5741da177e4SLinus Torvalds 
5751da177e4SLinus Torvalds static void
fst_q_work_item(u64 * queue,int card_index)5761da177e4SLinus Torvalds fst_q_work_item(u64 *queue, int card_index)
5771da177e4SLinus Torvalds {
5781da177e4SLinus Torvalds 	unsigned long flags;
5791da177e4SLinus Torvalds 	u64 mask;
5801da177e4SLinus Torvalds 
58114b9764cSPeng Li 	/* Grab the queue exclusively
5821da177e4SLinus Torvalds 	 */
5831da177e4SLinus Torvalds 	spin_lock_irqsave(&fst_work_q_lock, flags);
5841da177e4SLinus Torvalds 
58514b9764cSPeng Li 	/* Making an entry in the queue is simply a matter of setting
5861da177e4SLinus Torvalds 	 * a bit for the card indicating that there is work to do in the
5871da177e4SLinus Torvalds 	 * bottom half for the card.  Note the limitation of 64 cards.
5881da177e4SLinus Torvalds 	 * That ought to be enough
5891da177e4SLinus Torvalds 	 */
59050fb47aeSDan Carpenter 	mask = (u64)1 << card_index;
5911da177e4SLinus Torvalds 	*queue |= mask;
5921da177e4SLinus Torvalds 	spin_unlock_irqrestore(&fst_work_q_lock, flags);
5931da177e4SLinus Torvalds }
5941da177e4SLinus Torvalds 
5951da177e4SLinus Torvalds static void
fst_process_tx_work_q(struct tasklet_struct * unused)5968cc8993cSEmil Renner Berthing fst_process_tx_work_q(struct tasklet_struct *unused)
5971da177e4SLinus Torvalds {
5981da177e4SLinus Torvalds 	unsigned long flags;
5991da177e4SLinus Torvalds 	u64 work_txq;
6001da177e4SLinus Torvalds 	int i;
6011da177e4SLinus Torvalds 
60214b9764cSPeng Li 	/* Grab the queue exclusively
6031da177e4SLinus Torvalds 	 */
6041da177e4SLinus Torvalds 	dbg(DBG_TX, "fst_process_tx_work_q\n");
6051da177e4SLinus Torvalds 	spin_lock_irqsave(&fst_work_q_lock, flags);
6061da177e4SLinus Torvalds 	work_txq = fst_work_txq;
6071da177e4SLinus Torvalds 	fst_work_txq = 0;
6081da177e4SLinus Torvalds 	spin_unlock_irqrestore(&fst_work_q_lock, flags);
6091da177e4SLinus Torvalds 
61014b9764cSPeng Li 	/* Call the bottom half for each card with work waiting
6111da177e4SLinus Torvalds 	 */
6121da177e4SLinus Torvalds 	for (i = 0; i < FST_MAX_CARDS; i++) {
6131da177e4SLinus Torvalds 		if (work_txq & 0x01) {
614f23a3da7SPeng Li 			if (fst_card_array[i]) {
6151da177e4SLinus Torvalds 				dbg(DBG_TX, "Calling tx bh for card %d\n", i);
6161da177e4SLinus Torvalds 				do_bottom_half_tx(fst_card_array[i]);
6171da177e4SLinus Torvalds 			}
6181da177e4SLinus Torvalds 		}
6191da177e4SLinus Torvalds 		work_txq = work_txq >> 1;
6201da177e4SLinus Torvalds 	}
6211da177e4SLinus Torvalds }
6221da177e4SLinus Torvalds 
6231da177e4SLinus Torvalds static void
fst_process_int_work_q(struct tasklet_struct * unused)6248cc8993cSEmil Renner Berthing fst_process_int_work_q(struct tasklet_struct *unused)
6251da177e4SLinus Torvalds {
6261da177e4SLinus Torvalds 	unsigned long flags;
6271da177e4SLinus Torvalds 	u64 work_intq;
6281da177e4SLinus Torvalds 	int i;
6291da177e4SLinus Torvalds 
63014b9764cSPeng Li 	/* Grab the queue exclusively
6311da177e4SLinus Torvalds 	 */
6321da177e4SLinus Torvalds 	dbg(DBG_INTR, "fst_process_int_work_q\n");
6331da177e4SLinus Torvalds 	spin_lock_irqsave(&fst_work_q_lock, flags);
6341da177e4SLinus Torvalds 	work_intq = fst_work_intq;
6351da177e4SLinus Torvalds 	fst_work_intq = 0;
6361da177e4SLinus Torvalds 	spin_unlock_irqrestore(&fst_work_q_lock, flags);
6371da177e4SLinus Torvalds 
63814b9764cSPeng Li 	/* Call the bottom half for each card with work waiting
6391da177e4SLinus Torvalds 	 */
6401da177e4SLinus Torvalds 	for (i = 0; i < FST_MAX_CARDS; i++) {
6411da177e4SLinus Torvalds 		if (work_intq & 0x01) {
642f23a3da7SPeng Li 			if (fst_card_array[i]) {
6431da177e4SLinus Torvalds 				dbg(DBG_INTR,
6441da177e4SLinus Torvalds 				    "Calling rx & tx bh for card %d\n", i);
6451da177e4SLinus Torvalds 				do_bottom_half_rx(fst_card_array[i]);
6461da177e4SLinus Torvalds 				do_bottom_half_tx(fst_card_array[i]);
6471da177e4SLinus Torvalds 			}
6481da177e4SLinus Torvalds 		}
6491da177e4SLinus Torvalds 		work_intq = work_intq >> 1;
6501da177e4SLinus Torvalds 	}
6511da177e4SLinus Torvalds }
6521da177e4SLinus Torvalds 
6531da177e4SLinus Torvalds /*      Card control functions
6541da177e4SLinus Torvalds  *      ======================
6551da177e4SLinus Torvalds  */
6561da177e4SLinus Torvalds /*      Place the processor in reset state
6571da177e4SLinus Torvalds  *
6581da177e4SLinus Torvalds  * Used to be a simple write to card control space but a glitch in the latest
6591da177e4SLinus Torvalds  * AMD Am186CH processor means that we now have to do it by asserting and de-
6601da177e4SLinus Torvalds  * asserting the PLX chip PCI Adapter Software Reset. Bit 30 in CNTRL register
6611da177e4SLinus Torvalds  * at offset 9052_CNTRL.  Note the updates for the TXU.
6621da177e4SLinus Torvalds  */
6631da177e4SLinus Torvalds static inline void
fst_cpureset(struct fst_card_info * card)6641da177e4SLinus Torvalds fst_cpureset(struct fst_card_info *card)
6651da177e4SLinus Torvalds {
6661da177e4SLinus Torvalds 	unsigned char interrupt_line_register;
6671da177e4SLinus Torvalds 	unsigned int regval;
6681da177e4SLinus Torvalds 
6691da177e4SLinus Torvalds 	if (card->family == FST_FAMILY_TXU) {
6701da177e4SLinus Torvalds 		if (pci_read_config_byte
6711da177e4SLinus Torvalds 		    (card->device, PCI_INTERRUPT_LINE, &interrupt_line_register)) {
6721da177e4SLinus Torvalds 			dbg(DBG_ASS,
6731da177e4SLinus Torvalds 			    "Error in reading interrupt line register\n");
6741da177e4SLinus Torvalds 		}
67514b9764cSPeng Li 		/* Assert PLX software reset and Am186 hardware reset
6761da177e4SLinus Torvalds 		 * and then deassert the PLX software reset but 186 still in reset
6771da177e4SLinus Torvalds 		 */
6781da177e4SLinus Torvalds 		outw(0x440f, card->pci_conf + CNTRL_9054 + 2);
6791da177e4SLinus Torvalds 		outw(0x040f, card->pci_conf + CNTRL_9054 + 2);
68014b9764cSPeng Li 		/* We are delaying here to allow the 9054 to reset itself
6811da177e4SLinus Torvalds 		 */
6828db4ec66SManuel Schölling 		usleep_range(10, 20);
6831da177e4SLinus Torvalds 		outw(0x240f, card->pci_conf + CNTRL_9054 + 2);
68414b9764cSPeng Li 		/* We are delaying here to allow the 9054 to reload its eeprom
6851da177e4SLinus Torvalds 		 */
6868db4ec66SManuel Schölling 		usleep_range(10, 20);
6871da177e4SLinus Torvalds 		outw(0x040f, card->pci_conf + CNTRL_9054 + 2);
6881da177e4SLinus Torvalds 
6891da177e4SLinus Torvalds 		if (pci_write_config_byte
6901da177e4SLinus Torvalds 		    (card->device, PCI_INTERRUPT_LINE, interrupt_line_register)) {
6911da177e4SLinus Torvalds 			dbg(DBG_ASS,
6921da177e4SLinus Torvalds 			    "Error in writing interrupt line register\n");
6931da177e4SLinus Torvalds 		}
6941da177e4SLinus Torvalds 
6951da177e4SLinus Torvalds 	} else {
6961da177e4SLinus Torvalds 		regval = inl(card->pci_conf + CNTRL_9052);
6971da177e4SLinus Torvalds 
6981da177e4SLinus Torvalds 		outl(regval | 0x40000000, card->pci_conf + CNTRL_9052);
6991da177e4SLinus Torvalds 		outl(regval & ~0x40000000, card->pci_conf + CNTRL_9052);
7001da177e4SLinus Torvalds 	}
7011da177e4SLinus Torvalds }
7021da177e4SLinus Torvalds 
7031da177e4SLinus Torvalds /*      Release the processor from reset
7041da177e4SLinus Torvalds  */
7051da177e4SLinus Torvalds static inline void
fst_cpurelease(struct fst_card_info * card)7061da177e4SLinus Torvalds fst_cpurelease(struct fst_card_info *card)
7071da177e4SLinus Torvalds {
7081da177e4SLinus Torvalds 	if (card->family == FST_FAMILY_TXU) {
70914b9764cSPeng Li 		/* Force posted writes to complete
7101da177e4SLinus Torvalds 		 */
7111da177e4SLinus Torvalds 		(void)readb(card->mem);
7121da177e4SLinus Torvalds 
71314b9764cSPeng Li 		/* Release LRESET DO = 1
7141da177e4SLinus Torvalds 		 * Then release Local Hold, DO = 1
7151da177e4SLinus Torvalds 		 */
7161da177e4SLinus Torvalds 		outw(0x040e, card->pci_conf + CNTRL_9054 + 2);
7171da177e4SLinus Torvalds 		outw(0x040f, card->pci_conf + CNTRL_9054 + 2);
7181da177e4SLinus Torvalds 	} else {
7191da177e4SLinus Torvalds 		(void)readb(card->ctlmem);
7201da177e4SLinus Torvalds 	}
7211da177e4SLinus Torvalds }
7221da177e4SLinus Torvalds 
7231da177e4SLinus Torvalds /*      Clear the cards interrupt flag
7241da177e4SLinus Torvalds  */
7251da177e4SLinus Torvalds static inline void
fst_clear_intr(struct fst_card_info * card)7261da177e4SLinus Torvalds fst_clear_intr(struct fst_card_info *card)
7271da177e4SLinus Torvalds {
7281da177e4SLinus Torvalds 	if (card->family == FST_FAMILY_TXU) {
7291da177e4SLinus Torvalds 		(void)readb(card->ctlmem);
7301da177e4SLinus Torvalds 	} else {
7311da177e4SLinus Torvalds 		/* Poke the appropriate PLX chip register (same as enabling interrupts)
7321da177e4SLinus Torvalds 		 */
7331da177e4SLinus Torvalds 		outw(0x0543, card->pci_conf + INTCSR_9052);
7341da177e4SLinus Torvalds 	}
7351da177e4SLinus Torvalds }
7361da177e4SLinus Torvalds 
7371da177e4SLinus Torvalds /*      Enable card interrupts
7381da177e4SLinus Torvalds  */
7391da177e4SLinus Torvalds static inline void
fst_enable_intr(struct fst_card_info * card)7401da177e4SLinus Torvalds fst_enable_intr(struct fst_card_info *card)
7411da177e4SLinus Torvalds {
742fa8d10b5SPeng Li 	if (card->family == FST_FAMILY_TXU)
7431da177e4SLinus Torvalds 		outl(0x0f0c0900, card->pci_conf + INTCSR_9054);
744fa8d10b5SPeng Li 	else
7451da177e4SLinus Torvalds 		outw(0x0543, card->pci_conf + INTCSR_9052);
7461da177e4SLinus Torvalds }
7471da177e4SLinus Torvalds 
7481da177e4SLinus Torvalds /*      Disable card interrupts
7491da177e4SLinus Torvalds  */
7501da177e4SLinus Torvalds static inline void
fst_disable_intr(struct fst_card_info * card)7511da177e4SLinus Torvalds fst_disable_intr(struct fst_card_info *card)
7521da177e4SLinus Torvalds {
753fa8d10b5SPeng Li 	if (card->family == FST_FAMILY_TXU)
7541da177e4SLinus Torvalds 		outl(0x00000000, card->pci_conf + INTCSR_9054);
755fa8d10b5SPeng Li 	else
7561da177e4SLinus Torvalds 		outw(0x0000, card->pci_conf + INTCSR_9052);
7571da177e4SLinus Torvalds }
7581da177e4SLinus Torvalds 
7591da177e4SLinus Torvalds /*      Process the result of trying to pass a received frame up the stack
7601da177e4SLinus Torvalds  */
7611da177e4SLinus Torvalds static void
fst_process_rx_status(int rx_status,char * name)7621da177e4SLinus Torvalds fst_process_rx_status(int rx_status, char *name)
7631da177e4SLinus Torvalds {
7641da177e4SLinus Torvalds 	switch (rx_status) {
7651da177e4SLinus Torvalds 	case NET_RX_SUCCESS:
7661da177e4SLinus Torvalds 		{
76714b9764cSPeng Li 			/* Nothing to do here
7681da177e4SLinus Torvalds 			 */
7691da177e4SLinus Torvalds 			break;
7701da177e4SLinus Torvalds 		}
7711da177e4SLinus Torvalds 	case NET_RX_DROP:
7721da177e4SLinus Torvalds 		{
7731da177e4SLinus Torvalds 			dbg(DBG_ASS, "%s: Received packet dropped\n", name);
7741da177e4SLinus Torvalds 			break;
7751da177e4SLinus Torvalds 		}
7761da177e4SLinus Torvalds 	}
7771da177e4SLinus Torvalds }
7781da177e4SLinus Torvalds 
7791da177e4SLinus Torvalds /*      Initilaise DMA for PLX 9054
7801da177e4SLinus Torvalds  */
7811da177e4SLinus Torvalds static inline void
fst_init_dma(struct fst_card_info * card)7821da177e4SLinus Torvalds fst_init_dma(struct fst_card_info *card)
7831da177e4SLinus Torvalds {
78414b9764cSPeng Li 	/* This is only required for the PLX 9054
7851da177e4SLinus Torvalds 	 */
7861da177e4SLinus Torvalds 	if (card->family == FST_FAMILY_TXU) {
7871da177e4SLinus Torvalds 		pci_set_master(card->device);
7881da177e4SLinus Torvalds 		outl(0x00020441, card->pci_conf + DMAMODE0);
7891da177e4SLinus Torvalds 		outl(0x00020441, card->pci_conf + DMAMODE1);
7901da177e4SLinus Torvalds 		outl(0x0, card->pci_conf + DMATHR);
7911da177e4SLinus Torvalds 	}
7921da177e4SLinus Torvalds }
7931da177e4SLinus Torvalds 
7941da177e4SLinus Torvalds /*      Tx dma complete interrupt
7951da177e4SLinus Torvalds  */
7961da177e4SLinus Torvalds static void
fst_tx_dma_complete(struct fst_card_info * card,struct fst_port_info * port,int len,int txpos)7971da177e4SLinus Torvalds fst_tx_dma_complete(struct fst_card_info *card, struct fst_port_info *port,
7981da177e4SLinus Torvalds 		    int len, int txpos)
7991da177e4SLinus Torvalds {
8001da177e4SLinus Torvalds 	struct net_device *dev = port_to_dev(port);
8011da177e4SLinus Torvalds 
80214b9764cSPeng Li 	/* Everything is now set, just tell the card to go
8031da177e4SLinus Torvalds 	 */
8041da177e4SLinus Torvalds 	dbg(DBG_TX, "fst_tx_dma_complete\n");
8051da177e4SLinus Torvalds 	FST_WRB(card, txDescrRing[port->index][txpos].bits,
8061da177e4SLinus Torvalds 		DMA_OWN | TX_STP | TX_ENP);
807198191c4SKrzysztof Halasa 	dev->stats.tx_packets++;
808198191c4SKrzysztof Halasa 	dev->stats.tx_bytes += len;
809860e9538SFlorian Westphal 	netif_trans_update(dev);
8101da177e4SLinus Torvalds }
8111da177e4SLinus Torvalds 
81214b9764cSPeng Li /* Mark it for our own raw sockets interface
8131da177e4SLinus Torvalds  */
farsync_type_trans(struct sk_buff * skb,struct net_device * dev)814ab611487SAlexey Dobriyan static __be16 farsync_type_trans(struct sk_buff *skb, struct net_device *dev)
8151da177e4SLinus Torvalds {
8161da177e4SLinus Torvalds 	skb->dev = dev;
817459a98edSArnaldo Carvalho de Melo 	skb_reset_mac_header(skb);
8181da177e4SLinus Torvalds 	skb->pkt_type = PACKET_HOST;
8191da177e4SLinus Torvalds 	return htons(ETH_P_CUST);
8201da177e4SLinus Torvalds }
8211da177e4SLinus Torvalds 
8221da177e4SLinus Torvalds /*      Rx dma complete interrupt
8231da177e4SLinus Torvalds  */
8241da177e4SLinus Torvalds static void
fst_rx_dma_complete(struct fst_card_info * card,struct fst_port_info * port,int len,struct sk_buff * skb,int rxp)8251da177e4SLinus Torvalds fst_rx_dma_complete(struct fst_card_info *card, struct fst_port_info *port,
8261da177e4SLinus Torvalds 		    int len, struct sk_buff *skb, int rxp)
8271da177e4SLinus Torvalds {
8281da177e4SLinus Torvalds 	struct net_device *dev = port_to_dev(port);
8291da177e4SLinus Torvalds 	int pi;
8301da177e4SLinus Torvalds 	int rx_status;
8311da177e4SLinus Torvalds 
8321da177e4SLinus Torvalds 	dbg(DBG_TX, "fst_rx_dma_complete\n");
8331da177e4SLinus Torvalds 	pi = port->index;
83459ae1d12SJohannes Berg 	skb_put_data(skb, card->rx_dma_handle_host, len);
8351da177e4SLinus Torvalds 
8361da177e4SLinus Torvalds 	/* Reset buffer descriptor */
8371da177e4SLinus Torvalds 	FST_WRB(card, rxDescrRing[pi][rxp].bits, DMA_OWN);
8381da177e4SLinus Torvalds 
8391da177e4SLinus Torvalds 	/* Update stats */
840198191c4SKrzysztof Halasa 	dev->stats.rx_packets++;
841198191c4SKrzysztof Halasa 	dev->stats.rx_bytes += len;
8421da177e4SLinus Torvalds 
8431da177e4SLinus Torvalds 	/* Push upstream */
8441da177e4SLinus Torvalds 	dbg(DBG_RX, "Pushing the frame up the stack\n");
8451da177e4SLinus Torvalds 	if (port->mode == FST_RAW)
8461da177e4SLinus Torvalds 		skb->protocol = farsync_type_trans(skb, dev);
8471da177e4SLinus Torvalds 	else
8481da177e4SLinus Torvalds 		skb->protocol = hdlc_type_trans(skb, dev);
8491da177e4SLinus Torvalds 	rx_status = netif_rx(skb);
8501da177e4SLinus Torvalds 	fst_process_rx_status(rx_status, port_to_dev(port)->name);
8511da177e4SLinus Torvalds 	if (rx_status == NET_RX_DROP)
852198191c4SKrzysztof Halasa 		dev->stats.rx_dropped++;
8531da177e4SLinus Torvalds }
8541da177e4SLinus Torvalds 
85514b9764cSPeng Li /*      Receive a frame through the DMA
8561da177e4SLinus Torvalds  */
8571da177e4SLinus Torvalds static inline void
fst_rx_dma(struct fst_card_info * card,dma_addr_t dma,u32 mem,int len)858581d9baaSBen Hutchings fst_rx_dma(struct fst_card_info *card, dma_addr_t dma, u32 mem, int len)
8591da177e4SLinus Torvalds {
86014b9764cSPeng Li 	/* This routine will setup the DMA and start it
8611da177e4SLinus Torvalds 	 */
8621da177e4SLinus Torvalds 
863581d9baaSBen Hutchings 	dbg(DBG_RX, "In fst_rx_dma %x %x %d\n", (u32)dma, mem, len);
864fa8d10b5SPeng Li 	if (card->dmarx_in_progress)
8651da177e4SLinus Torvalds 		dbg(DBG_ASS, "In fst_rx_dma while dma in progress\n");
8661da177e4SLinus Torvalds 
867581d9baaSBen Hutchings 	outl(dma, card->pci_conf + DMAPADR0);	/* Copy to here */
8685d337d6fSDavid S. Miller 	outl(mem, card->pci_conf + DMALADR0);	/* from here */
8691da177e4SLinus Torvalds 	outl(len, card->pci_conf + DMASIZ0);	/* for this length */
8701da177e4SLinus Torvalds 	outl(0x00000000c, card->pci_conf + DMADPR0);	/* In this direction */
8711da177e4SLinus Torvalds 
87214b9764cSPeng Li 	/* We use the dmarx_in_progress flag to flag the channel as busy
8731da177e4SLinus Torvalds 	 */
8741da177e4SLinus Torvalds 	card->dmarx_in_progress = 1;
8751da177e4SLinus Torvalds 	outb(0x03, card->pci_conf + DMACSR0);	/* Start the transfer */
8761da177e4SLinus Torvalds }
8771da177e4SLinus Torvalds 
87814b9764cSPeng Li /*      Send a frame through the DMA
8791da177e4SLinus Torvalds  */
8801da177e4SLinus Torvalds static inline void
fst_tx_dma(struct fst_card_info * card,dma_addr_t dma,u32 mem,int len)881581d9baaSBen Hutchings fst_tx_dma(struct fst_card_info *card, dma_addr_t dma, u32 mem, int len)
8821da177e4SLinus Torvalds {
88314b9764cSPeng Li 	/* This routine will setup the DMA and start it.
8841da177e4SLinus Torvalds 	 */
8851da177e4SLinus Torvalds 
886581d9baaSBen Hutchings 	dbg(DBG_TX, "In fst_tx_dma %x %x %d\n", (u32)dma, mem, len);
887fa8d10b5SPeng Li 	if (card->dmatx_in_progress)
8881da177e4SLinus Torvalds 		dbg(DBG_ASS, "In fst_tx_dma while dma in progress\n");
8891da177e4SLinus Torvalds 
890581d9baaSBen Hutchings 	outl(dma, card->pci_conf + DMAPADR1);	/* Copy from here */
891581d9baaSBen Hutchings 	outl(mem, card->pci_conf + DMALADR1);	/* to here */
8921da177e4SLinus Torvalds 	outl(len, card->pci_conf + DMASIZ1);	/* for this length */
8931da177e4SLinus Torvalds 	outl(0x000000004, card->pci_conf + DMADPR1);	/* In this direction */
8941da177e4SLinus Torvalds 
89514b9764cSPeng Li 	/* We use the dmatx_in_progress to flag the channel as busy
8961da177e4SLinus Torvalds 	 */
8971da177e4SLinus Torvalds 	card->dmatx_in_progress = 1;
8981da177e4SLinus Torvalds 	outb(0x03, card->pci_conf + DMACSR1);	/* Start the transfer */
8991da177e4SLinus Torvalds }
9001da177e4SLinus Torvalds 
9011da177e4SLinus Torvalds /*      Issue a Mailbox command for a port.
9021da177e4SLinus Torvalds  *      Note we issue them on a fire and forget basis, not expecting to see an
9031da177e4SLinus Torvalds  *      error and not waiting for completion.
9041da177e4SLinus Torvalds  */
9051da177e4SLinus Torvalds static void
fst_issue_cmd(struct fst_port_info * port,unsigned short cmd)9061da177e4SLinus Torvalds fst_issue_cmd(struct fst_port_info *port, unsigned short cmd)
9071da177e4SLinus Torvalds {
9081da177e4SLinus Torvalds 	struct fst_card_info *card;
9091da177e4SLinus Torvalds 	unsigned short mbval;
9101da177e4SLinus Torvalds 	unsigned long flags;
9111da177e4SLinus Torvalds 	int safety;
9121da177e4SLinus Torvalds 
9131da177e4SLinus Torvalds 	card = port->card;
9141da177e4SLinus Torvalds 	spin_lock_irqsave(&card->card_lock, flags);
9151da177e4SLinus Torvalds 	mbval = FST_RDW(card, portMailbox[port->index][0]);
9161da177e4SLinus Torvalds 
9171da177e4SLinus Torvalds 	safety = 0;
9181da177e4SLinus Torvalds 	/* Wait for any previous command to complete */
9191da177e4SLinus Torvalds 	while (mbval > NAK) {
9201da177e4SLinus Torvalds 		spin_unlock_irqrestore(&card->card_lock, flags);
9213173c890SNishanth Aravamudan 		schedule_timeout_uninterruptible(1);
9221da177e4SLinus Torvalds 		spin_lock_irqsave(&card->card_lock, flags);
9231da177e4SLinus Torvalds 
9241da177e4SLinus Torvalds 		if (++safety > 2000) {
9253f326d40SJoe Perches 			pr_err("Mailbox safety timeout\n");
9261da177e4SLinus Torvalds 			break;
9271da177e4SLinus Torvalds 		}
9281da177e4SLinus Torvalds 
9291da177e4SLinus Torvalds 		mbval = FST_RDW(card, portMailbox[port->index][0]);
9301da177e4SLinus Torvalds 	}
931fa8d10b5SPeng Li 	if (safety > 0)
9321da177e4SLinus Torvalds 		dbg(DBG_CMD, "Mailbox clear after %d jiffies\n", safety);
933fa8d10b5SPeng Li 
934fa8d10b5SPeng Li 	if (mbval == NAK)
9351da177e4SLinus Torvalds 		dbg(DBG_CMD, "issue_cmd: previous command was NAK'd\n");
9361da177e4SLinus Torvalds 
9371da177e4SLinus Torvalds 	FST_WRW(card, portMailbox[port->index][0], cmd);
9381da177e4SLinus Torvalds 
9391da177e4SLinus Torvalds 	if (cmd == ABORTTX || cmd == STARTPORT) {
9401da177e4SLinus Torvalds 		port->txpos = 0;
9411da177e4SLinus Torvalds 		port->txipos = 0;
9421da177e4SLinus Torvalds 		port->start = 0;
9431da177e4SLinus Torvalds 	}
9441da177e4SLinus Torvalds 
9451da177e4SLinus Torvalds 	spin_unlock_irqrestore(&card->card_lock, flags);
9461da177e4SLinus Torvalds }
9471da177e4SLinus Torvalds 
9481da177e4SLinus Torvalds /*      Port output signals control
9491da177e4SLinus Torvalds  */
9501da177e4SLinus Torvalds static inline void
fst_op_raise(struct fst_port_info * port,unsigned int outputs)9511da177e4SLinus Torvalds fst_op_raise(struct fst_port_info *port, unsigned int outputs)
9521da177e4SLinus Torvalds {
9531da177e4SLinus Torvalds 	outputs |= FST_RDL(port->card, v24OpSts[port->index]);
9541da177e4SLinus Torvalds 	FST_WRL(port->card, v24OpSts[port->index], outputs);
9551da177e4SLinus Torvalds 
9561da177e4SLinus Torvalds 	if (port->run)
9571da177e4SLinus Torvalds 		fst_issue_cmd(port, SETV24O);
9581da177e4SLinus Torvalds }
9591da177e4SLinus Torvalds 
9601da177e4SLinus Torvalds static inline void
fst_op_lower(struct fst_port_info * port,unsigned int outputs)9611da177e4SLinus Torvalds fst_op_lower(struct fst_port_info *port, unsigned int outputs)
9621da177e4SLinus Torvalds {
9631da177e4SLinus Torvalds 	outputs = ~outputs & FST_RDL(port->card, v24OpSts[port->index]);
9641da177e4SLinus Torvalds 	FST_WRL(port->card, v24OpSts[port->index], outputs);
9651da177e4SLinus Torvalds 
9661da177e4SLinus Torvalds 	if (port->run)
9671da177e4SLinus Torvalds 		fst_issue_cmd(port, SETV24O);
9681da177e4SLinus Torvalds }
9691da177e4SLinus Torvalds 
97014b9764cSPeng Li /*      Setup port Rx buffers
9711da177e4SLinus Torvalds  */
9721da177e4SLinus Torvalds static void
fst_rx_config(struct fst_port_info * port)9731da177e4SLinus Torvalds fst_rx_config(struct fst_port_info *port)
9741da177e4SLinus Torvalds {
9751da177e4SLinus Torvalds 	int i;
9761da177e4SLinus Torvalds 	int pi;
9771da177e4SLinus Torvalds 	unsigned int offset;
9781da177e4SLinus Torvalds 	unsigned long flags;
9791da177e4SLinus Torvalds 	struct fst_card_info *card;
9801da177e4SLinus Torvalds 
9811da177e4SLinus Torvalds 	pi = port->index;
9821da177e4SLinus Torvalds 	card = port->card;
9831da177e4SLinus Torvalds 	spin_lock_irqsave(&card->card_lock, flags);
9841da177e4SLinus Torvalds 	for (i = 0; i < NUM_RX_BUFFER; i++) {
9851da177e4SLinus Torvalds 		offset = BUF_OFFSET(rxBuffer[pi][i][0]);
9861da177e4SLinus Torvalds 
9871da177e4SLinus Torvalds 		FST_WRW(card, rxDescrRing[pi][i].ladr, (u16)offset);
9881da177e4SLinus Torvalds 		FST_WRB(card, rxDescrRing[pi][i].hadr, (u8)(offset >> 16));
9891da177e4SLinus Torvalds 		FST_WRW(card, rxDescrRing[pi][i].bcnt, cnv_bcnt(LEN_RX_BUFFER));
9901da177e4SLinus Torvalds 		FST_WRW(card, rxDescrRing[pi][i].mcnt, LEN_RX_BUFFER);
9911da177e4SLinus Torvalds 		FST_WRB(card, rxDescrRing[pi][i].bits, DMA_OWN);
9921da177e4SLinus Torvalds 	}
9931da177e4SLinus Torvalds 	port->rxpos = 0;
9941da177e4SLinus Torvalds 	spin_unlock_irqrestore(&card->card_lock, flags);
9951da177e4SLinus Torvalds }
9961da177e4SLinus Torvalds 
99714b9764cSPeng Li /*      Setup port Tx buffers
9981da177e4SLinus Torvalds  */
9991da177e4SLinus Torvalds static void
fst_tx_config(struct fst_port_info * port)10001da177e4SLinus Torvalds fst_tx_config(struct fst_port_info *port)
10011da177e4SLinus Torvalds {
10021da177e4SLinus Torvalds 	int i;
10031da177e4SLinus Torvalds 	int pi;
10041da177e4SLinus Torvalds 	unsigned int offset;
10051da177e4SLinus Torvalds 	unsigned long flags;
10061da177e4SLinus Torvalds 	struct fst_card_info *card;
10071da177e4SLinus Torvalds 
10081da177e4SLinus Torvalds 	pi = port->index;
10091da177e4SLinus Torvalds 	card = port->card;
10101da177e4SLinus Torvalds 	spin_lock_irqsave(&card->card_lock, flags);
10111da177e4SLinus Torvalds 	for (i = 0; i < NUM_TX_BUFFER; i++) {
10121da177e4SLinus Torvalds 		offset = BUF_OFFSET(txBuffer[pi][i][0]);
10131da177e4SLinus Torvalds 
10141da177e4SLinus Torvalds 		FST_WRW(card, txDescrRing[pi][i].ladr, (u16)offset);
10151da177e4SLinus Torvalds 		FST_WRB(card, txDescrRing[pi][i].hadr, (u8)(offset >> 16));
10161da177e4SLinus Torvalds 		FST_WRW(card, txDescrRing[pi][i].bcnt, 0);
10171da177e4SLinus Torvalds 		FST_WRB(card, txDescrRing[pi][i].bits, 0);
10181da177e4SLinus Torvalds 	}
10191da177e4SLinus Torvalds 	port->txpos = 0;
10201da177e4SLinus Torvalds 	port->txipos = 0;
10211da177e4SLinus Torvalds 	port->start = 0;
10221da177e4SLinus Torvalds 	spin_unlock_irqrestore(&card->card_lock, flags);
10231da177e4SLinus Torvalds }
10241da177e4SLinus Torvalds 
10251da177e4SLinus Torvalds /*      TE1 Alarm change interrupt event
10261da177e4SLinus Torvalds  */
10271da177e4SLinus Torvalds static void
fst_intr_te1_alarm(struct fst_card_info * card,struct fst_port_info * port)10281da177e4SLinus Torvalds fst_intr_te1_alarm(struct fst_card_info *card, struct fst_port_info *port)
10291da177e4SLinus Torvalds {
10301da177e4SLinus Torvalds 	u8 los;
10311da177e4SLinus Torvalds 	u8 rra;
10321da177e4SLinus Torvalds 	u8 ais;
10331da177e4SLinus Torvalds 
10341da177e4SLinus Torvalds 	los = FST_RDB(card, suStatus.lossOfSignal);
10351da177e4SLinus Torvalds 	rra = FST_RDB(card, suStatus.receiveRemoteAlarm);
10361da177e4SLinus Torvalds 	ais = FST_RDB(card, suStatus.alarmIndicationSignal);
10371da177e4SLinus Torvalds 
10381da177e4SLinus Torvalds 	if (los) {
103914b9764cSPeng Li 		/* Lost the link
10401da177e4SLinus Torvalds 		 */
10411da177e4SLinus Torvalds 		if (netif_carrier_ok(port_to_dev(port))) {
10421da177e4SLinus Torvalds 			dbg(DBG_INTR, "Net carrier off\n");
10431da177e4SLinus Torvalds 			netif_carrier_off(port_to_dev(port));
10441da177e4SLinus Torvalds 		}
10451da177e4SLinus Torvalds 	} else {
104614b9764cSPeng Li 		/* Link available
10471da177e4SLinus Torvalds 		 */
10481da177e4SLinus Torvalds 		if (!netif_carrier_ok(port_to_dev(port))) {
10491da177e4SLinus Torvalds 			dbg(DBG_INTR, "Net carrier on\n");
10501da177e4SLinus Torvalds 			netif_carrier_on(port_to_dev(port));
10511da177e4SLinus Torvalds 		}
10521da177e4SLinus Torvalds 	}
10531da177e4SLinus Torvalds 
10541da177e4SLinus Torvalds 	if (los)
10551da177e4SLinus Torvalds 		dbg(DBG_INTR, "Assert LOS Alarm\n");
10561da177e4SLinus Torvalds 	else
10571da177e4SLinus Torvalds 		dbg(DBG_INTR, "De-assert LOS Alarm\n");
10581da177e4SLinus Torvalds 	if (rra)
10591da177e4SLinus Torvalds 		dbg(DBG_INTR, "Assert RRA Alarm\n");
10601da177e4SLinus Torvalds 	else
10611da177e4SLinus Torvalds 		dbg(DBG_INTR, "De-assert RRA Alarm\n");
10621da177e4SLinus Torvalds 
10631da177e4SLinus Torvalds 	if (ais)
10641da177e4SLinus Torvalds 		dbg(DBG_INTR, "Assert AIS Alarm\n");
10651da177e4SLinus Torvalds 	else
10661da177e4SLinus Torvalds 		dbg(DBG_INTR, "De-assert AIS Alarm\n");
10671da177e4SLinus Torvalds }
10681da177e4SLinus Torvalds 
10691da177e4SLinus Torvalds /*      Control signal change interrupt event
10701da177e4SLinus Torvalds  */
10711da177e4SLinus Torvalds static void
fst_intr_ctlchg(struct fst_card_info * card,struct fst_port_info * port)10721da177e4SLinus Torvalds fst_intr_ctlchg(struct fst_card_info *card, struct fst_port_info *port)
10731da177e4SLinus Torvalds {
10741da177e4SLinus Torvalds 	int signals;
10751da177e4SLinus Torvalds 
10761da177e4SLinus Torvalds 	signals = FST_RDL(card, v24DebouncedSts[port->index]);
10771da177e4SLinus Torvalds 
1078ae1be3faSPeng Li 	if (signals & ((port->hwif == X21 || port->hwif == X21D)
10791da177e4SLinus Torvalds 		       ? IPSTS_INDICATE : IPSTS_DCD)) {
10801da177e4SLinus Torvalds 		if (!netif_carrier_ok(port_to_dev(port))) {
10811da177e4SLinus Torvalds 			dbg(DBG_INTR, "DCD active\n");
10821da177e4SLinus Torvalds 			netif_carrier_on(port_to_dev(port));
10831da177e4SLinus Torvalds 		}
10841da177e4SLinus Torvalds 	} else {
10851da177e4SLinus Torvalds 		if (netif_carrier_ok(port_to_dev(port))) {
10861da177e4SLinus Torvalds 			dbg(DBG_INTR, "DCD lost\n");
10871da177e4SLinus Torvalds 			netif_carrier_off(port_to_dev(port));
10881da177e4SLinus Torvalds 		}
10891da177e4SLinus Torvalds 	}
10901da177e4SLinus Torvalds }
10911da177e4SLinus Torvalds 
10921da177e4SLinus Torvalds /*      Log Rx Errors
10931da177e4SLinus Torvalds  */
10941da177e4SLinus Torvalds static void
fst_log_rx_error(struct fst_card_info * card,struct fst_port_info * port,unsigned char dmabits,int rxp,unsigned short len)10951da177e4SLinus Torvalds fst_log_rx_error(struct fst_card_info *card, struct fst_port_info *port,
10961da177e4SLinus Torvalds 		 unsigned char dmabits, int rxp, unsigned short len)
10971da177e4SLinus Torvalds {
10981da177e4SLinus Torvalds 	struct net_device *dev = port_to_dev(port);
10991da177e4SLinus Torvalds 
110014b9764cSPeng Li 	/* Increment the appropriate error counter
11011da177e4SLinus Torvalds 	 */
1102198191c4SKrzysztof Halasa 	dev->stats.rx_errors++;
11031da177e4SLinus Torvalds 	if (dmabits & RX_OFLO) {
1104198191c4SKrzysztof Halasa 		dev->stats.rx_fifo_errors++;
11051da177e4SLinus Torvalds 		dbg(DBG_ASS, "Rx fifo error on card %d port %d buffer %d\n",
11061da177e4SLinus Torvalds 		    card->card_no, port->index, rxp);
11071da177e4SLinus Torvalds 	}
11081da177e4SLinus Torvalds 	if (dmabits & RX_CRC) {
1109198191c4SKrzysztof Halasa 		dev->stats.rx_crc_errors++;
11101da177e4SLinus Torvalds 		dbg(DBG_ASS, "Rx crc error on card %d port %d\n",
11111da177e4SLinus Torvalds 		    card->card_no, port->index);
11121da177e4SLinus Torvalds 	}
11131da177e4SLinus Torvalds 	if (dmabits & RX_FRAM) {
1114198191c4SKrzysztof Halasa 		dev->stats.rx_frame_errors++;
11151da177e4SLinus Torvalds 		dbg(DBG_ASS, "Rx frame error on card %d port %d\n",
11161da177e4SLinus Torvalds 		    card->card_no, port->index);
11171da177e4SLinus Torvalds 	}
11181da177e4SLinus Torvalds 	if (dmabits == (RX_STP | RX_ENP)) {
1119198191c4SKrzysztof Halasa 		dev->stats.rx_length_errors++;
11201da177e4SLinus Torvalds 		dbg(DBG_ASS, "Rx length error (%d) on card %d port %d\n",
11211da177e4SLinus Torvalds 		    len, card->card_no, port->index);
11221da177e4SLinus Torvalds 	}
11231da177e4SLinus Torvalds }
11241da177e4SLinus Torvalds 
11251da177e4SLinus Torvalds /*      Rx Error Recovery
11261da177e4SLinus Torvalds  */
11271da177e4SLinus Torvalds static void
fst_recover_rx_error(struct fst_card_info * card,struct fst_port_info * port,unsigned char dmabits,int rxp,unsigned short len)11281da177e4SLinus Torvalds fst_recover_rx_error(struct fst_card_info *card, struct fst_port_info *port,
11291da177e4SLinus Torvalds 		     unsigned char dmabits, int rxp, unsigned short len)
11301da177e4SLinus Torvalds {
11311da177e4SLinus Torvalds 	int i;
11321da177e4SLinus Torvalds 	int pi;
11331da177e4SLinus Torvalds 
11341da177e4SLinus Torvalds 	pi = port->index;
113514b9764cSPeng Li 	/* Discard buffer descriptors until we see the start of the
11361da177e4SLinus Torvalds 	 * next frame.  Note that for long frames this could be in
11371da177e4SLinus Torvalds 	 * a subsequent interrupt.
11381da177e4SLinus Torvalds 	 */
11391da177e4SLinus Torvalds 	i = 0;
11401da177e4SLinus Torvalds 	while ((dmabits & (DMA_OWN | RX_STP)) == 0) {
11411da177e4SLinus Torvalds 		FST_WRB(card, rxDescrRing[pi][rxp].bits, DMA_OWN);
11421da177e4SLinus Torvalds 		rxp = (rxp + 1) % NUM_RX_BUFFER;
11431da177e4SLinus Torvalds 		if (++i > NUM_RX_BUFFER) {
11441da177e4SLinus Torvalds 			dbg(DBG_ASS, "intr_rx: Discarding more bufs"
11451da177e4SLinus Torvalds 			    " than we have\n");
11461da177e4SLinus Torvalds 			break;
11471da177e4SLinus Torvalds 		}
11481da177e4SLinus Torvalds 		dmabits = FST_RDB(card, rxDescrRing[pi][rxp].bits);
11491da177e4SLinus Torvalds 		dbg(DBG_ASS, "DMA Bits of next buffer was %x\n", dmabits);
11501da177e4SLinus Torvalds 	}
11511da177e4SLinus Torvalds 	dbg(DBG_ASS, "There were %d subsequent buffers in error\n", i);
11521da177e4SLinus Torvalds 
11531da177e4SLinus Torvalds 	/* Discard the terminal buffer */
11541da177e4SLinus Torvalds 	if (!(dmabits & DMA_OWN)) {
11551da177e4SLinus Torvalds 		FST_WRB(card, rxDescrRing[pi][rxp].bits, DMA_OWN);
11561da177e4SLinus Torvalds 		rxp = (rxp + 1) % NUM_RX_BUFFER;
11571da177e4SLinus Torvalds 	}
11581da177e4SLinus Torvalds 	port->rxpos = rxp;
11591da177e4SLinus Torvalds }
11601da177e4SLinus Torvalds 
11611da177e4SLinus Torvalds /*      Rx complete interrupt
11621da177e4SLinus Torvalds  */
11631da177e4SLinus Torvalds static void
fst_intr_rx(struct fst_card_info * card,struct fst_port_info * port)11641da177e4SLinus Torvalds fst_intr_rx(struct fst_card_info *card, struct fst_port_info *port)
11651da177e4SLinus Torvalds {
11661da177e4SLinus Torvalds 	unsigned char dmabits;
11671da177e4SLinus Torvalds 	int pi;
11681da177e4SLinus Torvalds 	int rxp;
11691da177e4SLinus Torvalds 	int rx_status;
11701da177e4SLinus Torvalds 	unsigned short len;
11711da177e4SLinus Torvalds 	struct sk_buff *skb;
11721da177e4SLinus Torvalds 	struct net_device *dev = port_to_dev(port);
11731da177e4SLinus Torvalds 
11741da177e4SLinus Torvalds 	/* Check we have a buffer to process */
11751da177e4SLinus Torvalds 	pi = port->index;
11761da177e4SLinus Torvalds 	rxp = port->rxpos;
11771da177e4SLinus Torvalds 	dmabits = FST_RDB(card, rxDescrRing[pi][rxp].bits);
11781da177e4SLinus Torvalds 	if (dmabits & DMA_OWN) {
11791da177e4SLinus Torvalds 		dbg(DBG_RX | DBG_INTR, "intr_rx: No buffer port %d pos %d\n",
11801da177e4SLinus Torvalds 		    pi, rxp);
11811da177e4SLinus Torvalds 		return;
11821da177e4SLinus Torvalds 	}
1183fa8d10b5SPeng Li 	if (card->dmarx_in_progress)
11841da177e4SLinus Torvalds 		return;
11851da177e4SLinus Torvalds 
11861da177e4SLinus Torvalds 	/* Get buffer length */
11871da177e4SLinus Torvalds 	len = FST_RDW(card, rxDescrRing[pi][rxp].mcnt);
11881da177e4SLinus Torvalds 	/* Discard the CRC */
11891da177e4SLinus Torvalds 	len -= 2;
11901da177e4SLinus Torvalds 	if (len == 0) {
119114b9764cSPeng Li 		/* This seems to happen on the TE1 interface sometimes
11921da177e4SLinus Torvalds 		 * so throw the frame away and log the event.
11931da177e4SLinus Torvalds 		 */
11943f326d40SJoe Perches 		pr_err("Frame received with 0 length. Card %d Port %d\n",
11951da177e4SLinus Torvalds 		       card->card_no, port->index);
11961da177e4SLinus Torvalds 		/* Return descriptor to card */
11971da177e4SLinus Torvalds 		FST_WRB(card, rxDescrRing[pi][rxp].bits, DMA_OWN);
11981da177e4SLinus Torvalds 
11991da177e4SLinus Torvalds 		rxp = (rxp + 1) % NUM_RX_BUFFER;
12001da177e4SLinus Torvalds 		port->rxpos = rxp;
12011da177e4SLinus Torvalds 		return;
12021da177e4SLinus Torvalds 	}
12031da177e4SLinus Torvalds 
12041da177e4SLinus Torvalds 	/* Check buffer length and for other errors. We insist on one packet
12051da177e4SLinus Torvalds 	 * in one buffer. This simplifies things greatly and since we've
12061da177e4SLinus Torvalds 	 * allocated 8K it shouldn't be a real world limitation
12071da177e4SLinus Torvalds 	 */
12081da177e4SLinus Torvalds 	dbg(DBG_RX, "intr_rx: %d,%d: flags %x len %d\n", pi, rxp, dmabits, len);
12091da177e4SLinus Torvalds 	if (dmabits != (RX_STP | RX_ENP) || len > LEN_RX_BUFFER - 2) {
12101da177e4SLinus Torvalds 		fst_log_rx_error(card, port, dmabits, rxp, len);
12111da177e4SLinus Torvalds 		fst_recover_rx_error(card, port, dmabits, rxp, len);
12121da177e4SLinus Torvalds 		return;
12131da177e4SLinus Torvalds 	}
12141da177e4SLinus Torvalds 
12151da177e4SLinus Torvalds 	/* Allocate SKB */
121640996bcfSPeng Li 	skb = dev_alloc_skb(len);
121740996bcfSPeng Li 	if (!skb) {
12181da177e4SLinus Torvalds 		dbg(DBG_RX, "intr_rx: can't allocate buffer\n");
12191da177e4SLinus Torvalds 
1220198191c4SKrzysztof Halasa 		dev->stats.rx_dropped++;
12211da177e4SLinus Torvalds 
12221da177e4SLinus Torvalds 		/* Return descriptor to card */
12231da177e4SLinus Torvalds 		FST_WRB(card, rxDescrRing[pi][rxp].bits, DMA_OWN);
12241da177e4SLinus Torvalds 
12251da177e4SLinus Torvalds 		rxp = (rxp + 1) % NUM_RX_BUFFER;
12261da177e4SLinus Torvalds 		port->rxpos = rxp;
12271da177e4SLinus Torvalds 		return;
12281da177e4SLinus Torvalds 	}
12291da177e4SLinus Torvalds 
123014b9764cSPeng Li 	/* We know the length we need to receive, len.
12311da177e4SLinus Torvalds 	 * It's not worth using the DMA for reads of less than
12321da177e4SLinus Torvalds 	 * FST_MIN_DMA_LEN
12331da177e4SLinus Torvalds 	 */
12341da177e4SLinus Torvalds 
1235ae1be3faSPeng Li 	if (len < FST_MIN_DMA_LEN || card->family == FST_FAMILY_TXP) {
12361da177e4SLinus Torvalds 		memcpy_fromio(skb_put(skb, len),
12371da177e4SLinus Torvalds 			      card->mem + BUF_OFFSET(rxBuffer[pi][rxp][0]),
12381da177e4SLinus Torvalds 			      len);
12391da177e4SLinus Torvalds 
12401da177e4SLinus Torvalds 		/* Reset buffer descriptor */
12411da177e4SLinus Torvalds 		FST_WRB(card, rxDescrRing[pi][rxp].bits, DMA_OWN);
12421da177e4SLinus Torvalds 
12431da177e4SLinus Torvalds 		/* Update stats */
1244198191c4SKrzysztof Halasa 		dev->stats.rx_packets++;
1245198191c4SKrzysztof Halasa 		dev->stats.rx_bytes += len;
12461da177e4SLinus Torvalds 
12471da177e4SLinus Torvalds 		/* Push upstream */
12481da177e4SLinus Torvalds 		dbg(DBG_RX, "Pushing frame up the stack\n");
12491da177e4SLinus Torvalds 		if (port->mode == FST_RAW)
12501da177e4SLinus Torvalds 			skb->protocol = farsync_type_trans(skb, dev);
12511da177e4SLinus Torvalds 		else
12521da177e4SLinus Torvalds 			skb->protocol = hdlc_type_trans(skb, dev);
12531da177e4SLinus Torvalds 		rx_status = netif_rx(skb);
12541da177e4SLinus Torvalds 		fst_process_rx_status(rx_status, port_to_dev(port)->name);
1255198191c4SKrzysztof Halasa 		if (rx_status == NET_RX_DROP)
1256198191c4SKrzysztof Halasa 			dev->stats.rx_dropped++;
12571da177e4SLinus Torvalds 	} else {
12581da177e4SLinus Torvalds 		card->dma_skb_rx = skb;
12591da177e4SLinus Torvalds 		card->dma_port_rx = port;
12601da177e4SLinus Torvalds 		card->dma_len_rx = len;
12611da177e4SLinus Torvalds 		card->dma_rxpos = rxp;
12625d337d6fSDavid S. Miller 		fst_rx_dma(card, card->rx_dma_handle_card,
12635d337d6fSDavid S. Miller 			   BUF_OFFSET(rxBuffer[pi][rxp][0]), len);
12641da177e4SLinus Torvalds 	}
12651da177e4SLinus Torvalds 	if (rxp != port->rxpos) {
12661da177e4SLinus Torvalds 		dbg(DBG_ASS, "About to increment rxpos by more than 1\n");
12671da177e4SLinus Torvalds 		dbg(DBG_ASS, "rxp = %d rxpos = %d\n", rxp, port->rxpos);
12681da177e4SLinus Torvalds 	}
12691da177e4SLinus Torvalds 	rxp = (rxp + 1) % NUM_RX_BUFFER;
12701da177e4SLinus Torvalds 	port->rxpos = rxp;
12711da177e4SLinus Torvalds }
12721da177e4SLinus Torvalds 
127314b9764cSPeng Li /*      The bottom half to the ISR
12741da177e4SLinus Torvalds  *
12751da177e4SLinus Torvalds  */
12761da177e4SLinus Torvalds 
12771da177e4SLinus Torvalds static void
do_bottom_half_tx(struct fst_card_info * card)12781da177e4SLinus Torvalds do_bottom_half_tx(struct fst_card_info *card)
12791da177e4SLinus Torvalds {
12801da177e4SLinus Torvalds 	struct fst_port_info *port;
12811da177e4SLinus Torvalds 	int pi;
12821da177e4SLinus Torvalds 	int txq_length;
12831da177e4SLinus Torvalds 	struct sk_buff *skb;
12841da177e4SLinus Torvalds 	unsigned long flags;
12851da177e4SLinus Torvalds 	struct net_device *dev;
12861da177e4SLinus Torvalds 
128714b9764cSPeng Li 	/*  Find a free buffer for the transmit
12881da177e4SLinus Torvalds 	 *  Step through each port on this card
12891da177e4SLinus Torvalds 	 */
12901da177e4SLinus Torvalds 
12911da177e4SLinus Torvalds 	dbg(DBG_TX, "do_bottom_half_tx\n");
12921da177e4SLinus Torvalds 	for (pi = 0, port = card->ports; pi < card->nports; pi++, port++) {
12931da177e4SLinus Torvalds 		if (!port->run)
12941da177e4SLinus Torvalds 			continue;
12951da177e4SLinus Torvalds 
12961da177e4SLinus Torvalds 		dev = port_to_dev(port);
1297198191c4SKrzysztof Halasa 		while (!(FST_RDB(card, txDescrRing[pi][port->txpos].bits) &
12988e95a202SJoe Perches 			 DMA_OWN) &&
12998e95a202SJoe Perches 		       !(card->dmatx_in_progress)) {
130014b9764cSPeng Li 			/* There doesn't seem to be a txdone event per-se
13011da177e4SLinus Torvalds 			 * We seem to have to deduce it, by checking the DMA_OWN
13021da177e4SLinus Torvalds 			 * bit on the next buffer we think we can use
13031da177e4SLinus Torvalds 			 */
13041da177e4SLinus Torvalds 			spin_lock_irqsave(&card->card_lock, flags);
130540996bcfSPeng Li 			txq_length = port->txqe - port->txqs;
130640996bcfSPeng Li 			if (txq_length < 0) {
130714b9764cSPeng Li 				/* This is the case where one has wrapped and the
13081da177e4SLinus Torvalds 				 * maths gives us a negative number
13091da177e4SLinus Torvalds 				 */
13101da177e4SLinus Torvalds 				txq_length = txq_length + FST_TXQ_DEPTH;
13111da177e4SLinus Torvalds 			}
13121da177e4SLinus Torvalds 			spin_unlock_irqrestore(&card->card_lock, flags);
13131da177e4SLinus Torvalds 			if (txq_length > 0) {
131414b9764cSPeng Li 				/* There is something to send
13151da177e4SLinus Torvalds 				 */
13161da177e4SLinus Torvalds 				spin_lock_irqsave(&card->card_lock, flags);
13171da177e4SLinus Torvalds 				skb = port->txq[port->txqs];
13181da177e4SLinus Torvalds 				port->txqs++;
1319fa8d10b5SPeng Li 				if (port->txqs == FST_TXQ_DEPTH)
13201da177e4SLinus Torvalds 					port->txqs = 0;
1321fa8d10b5SPeng Li 
13221da177e4SLinus Torvalds 				spin_unlock_irqrestore(&card->card_lock, flags);
132314b9764cSPeng Li 				/* copy the data and set the required indicators on the
13241da177e4SLinus Torvalds 				 * card.
13251da177e4SLinus Torvalds 				 */
13261da177e4SLinus Torvalds 				FST_WRW(card, txDescrRing[pi][port->txpos].bcnt,
13271da177e4SLinus Torvalds 					cnv_bcnt(skb->len));
1328ae1be3faSPeng Li 				if (skb->len < FST_MIN_DMA_LEN ||
1329ae1be3faSPeng Li 				    card->family == FST_FAMILY_TXP) {
13301da177e4SLinus Torvalds 					/* Enqueue the packet with normal io */
13311da177e4SLinus Torvalds 					memcpy_toio(card->mem +
13321da177e4SLinus Torvalds 						    BUF_OFFSET(txBuffer[pi]
13331da177e4SLinus Torvalds 							       [port->
13341da177e4SLinus Torvalds 								txpos][0]),
13351da177e4SLinus Torvalds 						    skb->data, skb->len);
13361da177e4SLinus Torvalds 					FST_WRB(card,
13371da177e4SLinus Torvalds 						txDescrRing[pi][port->txpos].
13381da177e4SLinus Torvalds 						bits,
13391da177e4SLinus Torvalds 						DMA_OWN | TX_STP | TX_ENP);
1340198191c4SKrzysztof Halasa 					dev->stats.tx_packets++;
1341198191c4SKrzysztof Halasa 					dev->stats.tx_bytes += skb->len;
1342860e9538SFlorian Westphal 					netif_trans_update(dev);
13431da177e4SLinus Torvalds 				} else {
13441da177e4SLinus Torvalds 					/* Or do it through dma */
13451da177e4SLinus Torvalds 					memcpy(card->tx_dma_handle_host,
13461da177e4SLinus Torvalds 					       skb->data, skb->len);
13471da177e4SLinus Torvalds 					card->dma_port_tx = port;
13481da177e4SLinus Torvalds 					card->dma_len_tx = skb->len;
13491da177e4SLinus Torvalds 					card->dma_txpos = port->txpos;
13501da177e4SLinus Torvalds 					fst_tx_dma(card,
1351581d9baaSBen Hutchings 						   card->tx_dma_handle_card,
13521da177e4SLinus Torvalds 						   BUF_OFFSET(txBuffer[pi]
13531da177e4SLinus Torvalds 							      [port->txpos][0]),
13541da177e4SLinus Torvalds 						   skb->len);
13551da177e4SLinus Torvalds 				}
13561da177e4SLinus Torvalds 				if (++port->txpos >= NUM_TX_BUFFER)
13571da177e4SLinus Torvalds 					port->txpos = 0;
135814b9764cSPeng Li 				/* If we have flow control on, can we now release it?
13591da177e4SLinus Torvalds 				 */
13601da177e4SLinus Torvalds 				if (port->start) {
13611da177e4SLinus Torvalds 					if (txq_length < fst_txq_low) {
13621da177e4SLinus Torvalds 						netif_wake_queue(port_to_dev
13631da177e4SLinus Torvalds 								 (port));
13641da177e4SLinus Torvalds 						port->start = 0;
13651da177e4SLinus Torvalds 					}
13661da177e4SLinus Torvalds 				}
13671da177e4SLinus Torvalds 				dev_kfree_skb(skb);
13681da177e4SLinus Torvalds 			} else {
136914b9764cSPeng Li 				/* Nothing to send so break out of the while loop
13701da177e4SLinus Torvalds 				 */
13711da177e4SLinus Torvalds 				break;
13721da177e4SLinus Torvalds 			}
13731da177e4SLinus Torvalds 		}
13741da177e4SLinus Torvalds 	}
13751da177e4SLinus Torvalds }
13761da177e4SLinus Torvalds 
13771da177e4SLinus Torvalds static void
do_bottom_half_rx(struct fst_card_info * card)13781da177e4SLinus Torvalds do_bottom_half_rx(struct fst_card_info *card)
13791da177e4SLinus Torvalds {
13801da177e4SLinus Torvalds 	struct fst_port_info *port;
13811da177e4SLinus Torvalds 	int pi;
13821da177e4SLinus Torvalds 	int rx_count = 0;
13831da177e4SLinus Torvalds 
13841da177e4SLinus Torvalds 	/* Check for rx completions on all ports on this card */
13851da177e4SLinus Torvalds 	dbg(DBG_RX, "do_bottom_half_rx\n");
13861da177e4SLinus Torvalds 	for (pi = 0, port = card->ports; pi < card->nports; pi++, port++) {
13871da177e4SLinus Torvalds 		if (!port->run)
13881da177e4SLinus Torvalds 			continue;
13891da177e4SLinus Torvalds 
13901da177e4SLinus Torvalds 		while (!(FST_RDB(card, rxDescrRing[pi][port->rxpos].bits)
13911da177e4SLinus Torvalds 			 & DMA_OWN) && !(card->dmarx_in_progress)) {
13921da177e4SLinus Torvalds 			if (rx_count > fst_max_reads) {
139314b9764cSPeng Li 				/* Don't spend forever in receive processing
13941da177e4SLinus Torvalds 				 * Schedule another event
13951da177e4SLinus Torvalds 				 */
13961da177e4SLinus Torvalds 				fst_q_work_item(&fst_work_intq, card->card_no);
13971da177e4SLinus Torvalds 				tasklet_schedule(&fst_int_task);
13981da177e4SLinus Torvalds 				break;	/* Leave the loop */
13991da177e4SLinus Torvalds 			}
14001da177e4SLinus Torvalds 			fst_intr_rx(card, port);
14011da177e4SLinus Torvalds 			rx_count++;
14021da177e4SLinus Torvalds 		}
14031da177e4SLinus Torvalds 	}
14041da177e4SLinus Torvalds }
14051da177e4SLinus Torvalds 
140614b9764cSPeng Li /*      The interrupt service routine
14071da177e4SLinus Torvalds  *      Dev_id is our fst_card_info pointer
14081da177e4SLinus Torvalds  */
14097665a089SAdrian Bunk static irqreturn_t
fst_intr(int dummy,void * dev_id)141028fc1f5aSJeff Garzik fst_intr(int dummy, void *dev_id)
14111da177e4SLinus Torvalds {
141228fc1f5aSJeff Garzik 	struct fst_card_info *card = dev_id;
14131da177e4SLinus Torvalds 	struct fst_port_info *port;
14141da177e4SLinus Torvalds 	int rdidx;		/* Event buffer indices */
14151da177e4SLinus Torvalds 	int wridx;
14161da177e4SLinus Torvalds 	int event;		/* Actual event for processing */
14171da177e4SLinus Torvalds 	unsigned int dma_intcsr = 0;
14181da177e4SLinus Torvalds 	unsigned int do_card_interrupt;
14191da177e4SLinus Torvalds 	unsigned int int_retry_count;
14201da177e4SLinus Torvalds 
142114b9764cSPeng Li 	/* Check to see if the interrupt was for this card
14221da177e4SLinus Torvalds 	 * return if not
14231da177e4SLinus Torvalds 	 * Note that the call to clear the interrupt is important
14241da177e4SLinus Torvalds 	 */
142528fc1f5aSJeff Garzik 	dbg(DBG_INTR, "intr: %d %p\n", card->irq, card);
14261da177e4SLinus Torvalds 	if (card->state != FST_RUNNING) {
14273f326d40SJoe Perches 		pr_err("Interrupt received for card %d in a non running state (%d)\n",
14281da177e4SLinus Torvalds 		       card->card_no, card->state);
14291da177e4SLinus Torvalds 
143014b9764cSPeng Li 		/* It is possible to really be running, i.e. we have re-loaded
14311da177e4SLinus Torvalds 		 * a running card
14321da177e4SLinus Torvalds 		 * Clear and reprime the interrupt source
14331da177e4SLinus Torvalds 		 */
14341da177e4SLinus Torvalds 		fst_clear_intr(card);
14351da177e4SLinus Torvalds 		return IRQ_HANDLED;
14361da177e4SLinus Torvalds 	}
14371da177e4SLinus Torvalds 
14381da177e4SLinus Torvalds 	/* Clear and reprime the interrupt source */
14391da177e4SLinus Torvalds 	fst_clear_intr(card);
14401da177e4SLinus Torvalds 
144114b9764cSPeng Li 	/* Is the interrupt for this card (handshake == 1)
14421da177e4SLinus Torvalds 	 */
14431da177e4SLinus Torvalds 	do_card_interrupt = 0;
14441da177e4SLinus Torvalds 	if (FST_RDB(card, interruptHandshake) == 1) {
14451da177e4SLinus Torvalds 		do_card_interrupt += FST_CARD_INT;
14461da177e4SLinus Torvalds 		/* Set the software acknowledge */
14471da177e4SLinus Torvalds 		FST_WRB(card, interruptHandshake, 0xEE);
14481da177e4SLinus Torvalds 	}
14491da177e4SLinus Torvalds 	if (card->family == FST_FAMILY_TXU) {
145014b9764cSPeng Li 		/* Is it a DMA Interrupt
14511da177e4SLinus Torvalds 		 */
14521da177e4SLinus Torvalds 		dma_intcsr = inl(card->pci_conf + INTCSR_9054);
14531da177e4SLinus Torvalds 		if (dma_intcsr & 0x00200000) {
145414b9764cSPeng Li 			/* DMA Channel 0 (Rx transfer complete)
14551da177e4SLinus Torvalds 			 */
14561da177e4SLinus Torvalds 			dbg(DBG_RX, "DMA Rx xfer complete\n");
14571da177e4SLinus Torvalds 			outb(0x8, card->pci_conf + DMACSR0);
14581da177e4SLinus Torvalds 			fst_rx_dma_complete(card, card->dma_port_rx,
14591da177e4SLinus Torvalds 					    card->dma_len_rx, card->dma_skb_rx,
14601da177e4SLinus Torvalds 					    card->dma_rxpos);
14611da177e4SLinus Torvalds 			card->dmarx_in_progress = 0;
14621da177e4SLinus Torvalds 			do_card_interrupt += FST_RX_DMA_INT;
14631da177e4SLinus Torvalds 		}
14641da177e4SLinus Torvalds 		if (dma_intcsr & 0x00400000) {
146514b9764cSPeng Li 			/* DMA Channel 1 (Tx transfer complete)
14661da177e4SLinus Torvalds 			 */
14671da177e4SLinus Torvalds 			dbg(DBG_TX, "DMA Tx xfer complete\n");
14681da177e4SLinus Torvalds 			outb(0x8, card->pci_conf + DMACSR1);
14691da177e4SLinus Torvalds 			fst_tx_dma_complete(card, card->dma_port_tx,
14701da177e4SLinus Torvalds 					    card->dma_len_tx, card->dma_txpos);
14711da177e4SLinus Torvalds 			card->dmatx_in_progress = 0;
14721da177e4SLinus Torvalds 			do_card_interrupt += FST_TX_DMA_INT;
14731da177e4SLinus Torvalds 		}
14741da177e4SLinus Torvalds 	}
14751da177e4SLinus Torvalds 
147614b9764cSPeng Li 	/* Have we been missing Interrupts
14771da177e4SLinus Torvalds 	 */
14781da177e4SLinus Torvalds 	int_retry_count = FST_RDL(card, interruptRetryCount);
14791da177e4SLinus Torvalds 	if (int_retry_count) {
14801da177e4SLinus Torvalds 		dbg(DBG_ASS, "Card %d int_retry_count is  %d\n",
14811da177e4SLinus Torvalds 		    card->card_no, int_retry_count);
14821da177e4SLinus Torvalds 		FST_WRL(card, interruptRetryCount, 0);
14831da177e4SLinus Torvalds 	}
14841da177e4SLinus Torvalds 
1485fa8d10b5SPeng Li 	if (!do_card_interrupt)
14861da177e4SLinus Torvalds 		return IRQ_HANDLED;
14871da177e4SLinus Torvalds 
14881da177e4SLinus Torvalds 	/* Scehdule the bottom half of the ISR */
14891da177e4SLinus Torvalds 	fst_q_work_item(&fst_work_intq, card->card_no);
14901da177e4SLinus Torvalds 	tasklet_schedule(&fst_int_task);
14911da177e4SLinus Torvalds 
14921da177e4SLinus Torvalds 	/* Drain the event queue */
14931da177e4SLinus Torvalds 	rdidx = FST_RDB(card, interruptEvent.rdindex) & 0x1f;
14941da177e4SLinus Torvalds 	wridx = FST_RDB(card, interruptEvent.wrindex) & 0x1f;
14951da177e4SLinus Torvalds 	while (rdidx != wridx) {
14961da177e4SLinus Torvalds 		event = FST_RDB(card, interruptEvent.evntbuff[rdidx]);
14971da177e4SLinus Torvalds 		port = &card->ports[event & 0x03];
14981da177e4SLinus Torvalds 
14991da177e4SLinus Torvalds 		dbg(DBG_INTR, "Processing Interrupt event: %x\n", event);
15001da177e4SLinus Torvalds 
15011da177e4SLinus Torvalds 		switch (event) {
15021da177e4SLinus Torvalds 		case TE1_ALMA:
15031da177e4SLinus Torvalds 			dbg(DBG_INTR, "TE1 Alarm intr\n");
15041da177e4SLinus Torvalds 			if (port->run)
15051da177e4SLinus Torvalds 				fst_intr_te1_alarm(card, port);
15061da177e4SLinus Torvalds 			break;
15071da177e4SLinus Torvalds 
15081da177e4SLinus Torvalds 		case CTLA_CHG:
15091da177e4SLinus Torvalds 		case CTLB_CHG:
15101da177e4SLinus Torvalds 		case CTLC_CHG:
15111da177e4SLinus Torvalds 		case CTLD_CHG:
15121da177e4SLinus Torvalds 			if (port->run)
15131da177e4SLinus Torvalds 				fst_intr_ctlchg(card, port);
15141da177e4SLinus Torvalds 			break;
15151da177e4SLinus Torvalds 
15161da177e4SLinus Torvalds 		case ABTA_SENT:
15171da177e4SLinus Torvalds 		case ABTB_SENT:
15181da177e4SLinus Torvalds 		case ABTC_SENT:
15191da177e4SLinus Torvalds 		case ABTD_SENT:
15201da177e4SLinus Torvalds 			dbg(DBG_TX, "Abort complete port %d\n", port->index);
15211da177e4SLinus Torvalds 			break;
15221da177e4SLinus Torvalds 
15231da177e4SLinus Torvalds 		case TXA_UNDF:
15241da177e4SLinus Torvalds 		case TXB_UNDF:
15251da177e4SLinus Torvalds 		case TXC_UNDF:
15261da177e4SLinus Torvalds 		case TXD_UNDF:
15271da177e4SLinus Torvalds 			/* Difficult to see how we'd get this given that we
15281da177e4SLinus Torvalds 			 * always load up the entire packet for DMA.
15291da177e4SLinus Torvalds 			 */
15301da177e4SLinus Torvalds 			dbg(DBG_TX, "Tx underflow port %d\n", port->index);
1531198191c4SKrzysztof Halasa 			port_to_dev(port)->stats.tx_errors++;
1532198191c4SKrzysztof Halasa 			port_to_dev(port)->stats.tx_fifo_errors++;
15331da177e4SLinus Torvalds 			dbg(DBG_ASS, "Tx underflow on card %d port %d\n",
15341da177e4SLinus Torvalds 			    card->card_no, port->index);
15351da177e4SLinus Torvalds 			break;
15361da177e4SLinus Torvalds 
15371da177e4SLinus Torvalds 		case INIT_CPLT:
15381da177e4SLinus Torvalds 			dbg(DBG_INIT, "Card init OK intr\n");
15391da177e4SLinus Torvalds 			break;
15401da177e4SLinus Torvalds 
15411da177e4SLinus Torvalds 		case INIT_FAIL:
15421da177e4SLinus Torvalds 			dbg(DBG_INIT, "Card init FAILED intr\n");
15431da177e4SLinus Torvalds 			card->state = FST_IFAILED;
15441da177e4SLinus Torvalds 			break;
15451da177e4SLinus Torvalds 
15461da177e4SLinus Torvalds 		default:
15473f326d40SJoe Perches 			pr_err("intr: unknown card event %d. ignored\n", event);
15481da177e4SLinus Torvalds 			break;
15491da177e4SLinus Torvalds 		}
15501da177e4SLinus Torvalds 
15511da177e4SLinus Torvalds 		/* Bump and wrap the index */
15521da177e4SLinus Torvalds 		if (++rdidx >= MAX_CIRBUFF)
15531da177e4SLinus Torvalds 			rdidx = 0;
15541da177e4SLinus Torvalds 	}
15551da177e4SLinus Torvalds 	FST_WRB(card, interruptEvent.rdindex, rdidx);
15561da177e4SLinus Torvalds 	return IRQ_HANDLED;
15571da177e4SLinus Torvalds }
15581da177e4SLinus Torvalds 
15591da177e4SLinus Torvalds /*      Check that the shared memory configuration is one that we can handle
15601da177e4SLinus Torvalds  *      and that some basic parameters are correct
15611da177e4SLinus Torvalds  */
15621da177e4SLinus Torvalds static void
check_started_ok(struct fst_card_info * card)15631da177e4SLinus Torvalds check_started_ok(struct fst_card_info *card)
15641da177e4SLinus Torvalds {
15651da177e4SLinus Torvalds 	int i;
15661da177e4SLinus Torvalds 
15671da177e4SLinus Torvalds 	/* Check structure version and end marker */
15681da177e4SLinus Torvalds 	if (FST_RDW(card, smcVersion) != SMC_VERSION) {
15693f326d40SJoe Perches 		pr_err("Bad shared memory version %d expected %d\n",
15701da177e4SLinus Torvalds 		       FST_RDW(card, smcVersion), SMC_VERSION);
15711da177e4SLinus Torvalds 		card->state = FST_BADVERSION;
15721da177e4SLinus Torvalds 		return;
15731da177e4SLinus Torvalds 	}
15741da177e4SLinus Torvalds 	if (FST_RDL(card, endOfSmcSignature) != END_SIG) {
15753f326d40SJoe Perches 		pr_err("Missing shared memory signature\n");
15761da177e4SLinus Torvalds 		card->state = FST_BADVERSION;
15771da177e4SLinus Torvalds 		return;
15781da177e4SLinus Torvalds 	}
15791da177e4SLinus Torvalds 	/* Firmware status flag, 0x00 = initialising, 0x01 = OK, 0xFF = fail */
158040996bcfSPeng Li 	i = FST_RDB(card, taskStatus);
158140996bcfSPeng Li 	if (i == 0x01) {
15821da177e4SLinus Torvalds 		card->state = FST_RUNNING;
15831da177e4SLinus Torvalds 	} else if (i == 0xFF) {
15843f326d40SJoe Perches 		pr_err("Firmware initialisation failed. Card halted\n");
15851da177e4SLinus Torvalds 		card->state = FST_HALTED;
15861da177e4SLinus Torvalds 		return;
15871da177e4SLinus Torvalds 	} else if (i != 0x00) {
15883f326d40SJoe Perches 		pr_err("Unknown firmware status 0x%x\n", i);
15891da177e4SLinus Torvalds 		card->state = FST_HALTED;
15901da177e4SLinus Torvalds 		return;
15911da177e4SLinus Torvalds 	}
15921da177e4SLinus Torvalds 
15931da177e4SLinus Torvalds 	/* Finally check the number of ports reported by firmware against the
15941da177e4SLinus Torvalds 	 * number we assumed at card detection. Should never happen with
15951da177e4SLinus Torvalds 	 * existing firmware etc so we just report it for the moment.
15961da177e4SLinus Torvalds 	 */
15971da177e4SLinus Torvalds 	if (FST_RDL(card, numberOfPorts) != card->nports) {
1598e8c122f4SJoe Perches 		pr_warn("Port count mismatch on card %d.  Firmware thinks %d we say %d\n",
15993f326d40SJoe Perches 			card->card_no,
16001da177e4SLinus Torvalds 			FST_RDL(card, numberOfPorts), card->nports);
16011da177e4SLinus Torvalds 	}
16021da177e4SLinus Torvalds }
16031da177e4SLinus Torvalds 
16041da177e4SLinus Torvalds static int
set_conf_from_info(struct fst_card_info * card,struct fst_port_info * port,struct fstioc_info * info)16051da177e4SLinus Torvalds set_conf_from_info(struct fst_card_info *card, struct fst_port_info *port,
16061da177e4SLinus Torvalds 		   struct fstioc_info *info)
16071da177e4SLinus Torvalds {
16081da177e4SLinus Torvalds 	int err;
16091da177e4SLinus Torvalds 	unsigned char my_framing;
16101da177e4SLinus Torvalds 
16111da177e4SLinus Torvalds 	/* Set things according to the user set valid flags
16121da177e4SLinus Torvalds 	 * Several of the old options have been invalidated/replaced by the
16131da177e4SLinus Torvalds 	 * generic hdlc package.
16141da177e4SLinus Torvalds 	 */
16151da177e4SLinus Torvalds 	err = 0;
16161da177e4SLinus Torvalds 	if (info->valid & FSTVAL_PROTO) {
16171da177e4SLinus Torvalds 		if (info->proto == FST_RAW)
16181da177e4SLinus Torvalds 			port->mode = FST_RAW;
16191da177e4SLinus Torvalds 		else
16201da177e4SLinus Torvalds 			port->mode = FST_GEN_HDLC;
16211da177e4SLinus Torvalds 	}
16221da177e4SLinus Torvalds 
16231da177e4SLinus Torvalds 	if (info->valid & FSTVAL_CABLE)
16241da177e4SLinus Torvalds 		err = -EINVAL;
16251da177e4SLinus Torvalds 
16261da177e4SLinus Torvalds 	if (info->valid & FSTVAL_SPEED)
16271da177e4SLinus Torvalds 		err = -EINVAL;
16281da177e4SLinus Torvalds 
16291da177e4SLinus Torvalds 	if (info->valid & FSTVAL_PHASE)
16301da177e4SLinus Torvalds 		FST_WRB(card, portConfig[port->index].invertClock,
16311da177e4SLinus Torvalds 			info->invertClock);
16321da177e4SLinus Torvalds 	if (info->valid & FSTVAL_MODE)
16331da177e4SLinus Torvalds 		FST_WRW(card, cardMode, info->cardMode);
16341da177e4SLinus Torvalds 	if (info->valid & FSTVAL_TE1) {
16351da177e4SLinus Torvalds 		FST_WRL(card, suConfig.dataRate, info->lineSpeed);
16361da177e4SLinus Torvalds 		FST_WRB(card, suConfig.clocking, info->clockSource);
16371da177e4SLinus Torvalds 		my_framing = FRAMING_E1;
16381da177e4SLinus Torvalds 		if (info->framing == E1)
16391da177e4SLinus Torvalds 			my_framing = FRAMING_E1;
16401da177e4SLinus Torvalds 		if (info->framing == T1)
16411da177e4SLinus Torvalds 			my_framing = FRAMING_T1;
16421da177e4SLinus Torvalds 		if (info->framing == J1)
16431da177e4SLinus Torvalds 			my_framing = FRAMING_J1;
16441da177e4SLinus Torvalds 		FST_WRB(card, suConfig.framing, my_framing);
16451da177e4SLinus Torvalds 		FST_WRB(card, suConfig.structure, info->structure);
16461da177e4SLinus Torvalds 		FST_WRB(card, suConfig.interface, info->interface);
16471da177e4SLinus Torvalds 		FST_WRB(card, suConfig.coding, info->coding);
16481da177e4SLinus Torvalds 		FST_WRB(card, suConfig.lineBuildOut, info->lineBuildOut);
16491da177e4SLinus Torvalds 		FST_WRB(card, suConfig.equalizer, info->equalizer);
16501da177e4SLinus Torvalds 		FST_WRB(card, suConfig.transparentMode, info->transparentMode);
16511da177e4SLinus Torvalds 		FST_WRB(card, suConfig.loopMode, info->loopMode);
16521da177e4SLinus Torvalds 		FST_WRB(card, suConfig.range, info->range);
16531da177e4SLinus Torvalds 		FST_WRB(card, suConfig.txBufferMode, info->txBufferMode);
16541da177e4SLinus Torvalds 		FST_WRB(card, suConfig.rxBufferMode, info->rxBufferMode);
16551da177e4SLinus Torvalds 		FST_WRB(card, suConfig.startingSlot, info->startingSlot);
16561da177e4SLinus Torvalds 		FST_WRB(card, suConfig.losThreshold, info->losThreshold);
16571da177e4SLinus Torvalds 		if (info->idleCode)
16581da177e4SLinus Torvalds 			FST_WRB(card, suConfig.enableIdleCode, 1);
16591da177e4SLinus Torvalds 		else
16601da177e4SLinus Torvalds 			FST_WRB(card, suConfig.enableIdleCode, 0);
16611da177e4SLinus Torvalds 		FST_WRB(card, suConfig.idleCode, info->idleCode);
16621da177e4SLinus Torvalds #if FST_DEBUG
16631da177e4SLinus Torvalds 		if (info->valid & FSTVAL_TE1) {
16641da177e4SLinus Torvalds 			printk("Setting TE1 data\n");
16651da177e4SLinus Torvalds 			printk("Line Speed = %d\n", info->lineSpeed);
16661da177e4SLinus Torvalds 			printk("Start slot = %d\n", info->startingSlot);
16671da177e4SLinus Torvalds 			printk("Clock source = %d\n", info->clockSource);
16681da177e4SLinus Torvalds 			printk("Framing = %d\n", my_framing);
16691da177e4SLinus Torvalds 			printk("Structure = %d\n", info->structure);
16701da177e4SLinus Torvalds 			printk("interface = %d\n", info->interface);
16711da177e4SLinus Torvalds 			printk("Coding = %d\n", info->coding);
16721da177e4SLinus Torvalds 			printk("Line build out = %d\n", info->lineBuildOut);
16731da177e4SLinus Torvalds 			printk("Equaliser = %d\n", info->equalizer);
16741da177e4SLinus Torvalds 			printk("Transparent mode = %d\n",
16751da177e4SLinus Torvalds 			       info->transparentMode);
16761da177e4SLinus Torvalds 			printk("Loop mode = %d\n", info->loopMode);
16771da177e4SLinus Torvalds 			printk("Range = %d\n", info->range);
16781da177e4SLinus Torvalds 			printk("Tx Buffer mode = %d\n", info->txBufferMode);
16791da177e4SLinus Torvalds 			printk("Rx Buffer mode = %d\n", info->rxBufferMode);
16801da177e4SLinus Torvalds 			printk("LOS Threshold = %d\n", info->losThreshold);
16811da177e4SLinus Torvalds 			printk("Idle Code = %d\n", info->idleCode);
16821da177e4SLinus Torvalds 		}
16831da177e4SLinus Torvalds #endif
16841da177e4SLinus Torvalds 	}
16851da177e4SLinus Torvalds #if FST_DEBUG
1686fa8d10b5SPeng Li 	if (info->valid & FSTVAL_DEBUG)
16871da177e4SLinus Torvalds 		fst_debug_mask = info->debug;
16881da177e4SLinus Torvalds #endif
16891da177e4SLinus Torvalds 
16901da177e4SLinus Torvalds 	return err;
16911da177e4SLinus Torvalds }
16921da177e4SLinus Torvalds 
16931da177e4SLinus Torvalds static void
gather_conf_info(struct fst_card_info * card,struct fst_port_info * port,struct fstioc_info * info)16941da177e4SLinus Torvalds gather_conf_info(struct fst_card_info *card, struct fst_port_info *port,
16951da177e4SLinus Torvalds 		 struct fstioc_info *info)
16961da177e4SLinus Torvalds {
16971da177e4SLinus Torvalds 	int i;
16981da177e4SLinus Torvalds 
16991da177e4SLinus Torvalds 	memset(info, 0, sizeof(struct fstioc_info));
17001da177e4SLinus Torvalds 
17011da177e4SLinus Torvalds 	i = port->index;
17021da177e4SLinus Torvalds 	info->kernelVersion = LINUX_VERSION_CODE;
17031da177e4SLinus Torvalds 	info->nports = card->nports;
17041da177e4SLinus Torvalds 	info->type = card->type;
17051da177e4SLinus Torvalds 	info->state = card->state;
17061da177e4SLinus Torvalds 	info->proto = FST_GEN_HDLC;
17071da177e4SLinus Torvalds 	info->index = i;
17081da177e4SLinus Torvalds #if FST_DEBUG
17091da177e4SLinus Torvalds 	info->debug = fst_debug_mask;
17101da177e4SLinus Torvalds #endif
17111da177e4SLinus Torvalds 
17121da177e4SLinus Torvalds 	/* Only mark information as valid if card is running.
17131da177e4SLinus Torvalds 	 * Copy the data anyway in case it is useful for diagnostics
17141da177e4SLinus Torvalds 	 */
17151da177e4SLinus Torvalds 	info->valid = ((card->state == FST_RUNNING) ? FSTVAL_ALL : FSTVAL_CARD)
17161da177e4SLinus Torvalds #if FST_DEBUG
17171da177e4SLinus Torvalds 	    | FSTVAL_DEBUG
17181da177e4SLinus Torvalds #endif
17191da177e4SLinus Torvalds 	    ;
17201da177e4SLinus Torvalds 
17211da177e4SLinus Torvalds 	info->lineInterface = FST_RDW(card, portConfig[i].lineInterface);
17221da177e4SLinus Torvalds 	info->internalClock = FST_RDB(card, portConfig[i].internalClock);
17231da177e4SLinus Torvalds 	info->lineSpeed = FST_RDL(card, portConfig[i].lineSpeed);
17241da177e4SLinus Torvalds 	info->invertClock = FST_RDB(card, portConfig[i].invertClock);
17251da177e4SLinus Torvalds 	info->v24IpSts = FST_RDL(card, v24IpSts[i]);
17261da177e4SLinus Torvalds 	info->v24OpSts = FST_RDL(card, v24OpSts[i]);
17271da177e4SLinus Torvalds 	info->clockStatus = FST_RDW(card, clockStatus[i]);
17281da177e4SLinus Torvalds 	info->cableStatus = FST_RDW(card, cableStatus);
17291da177e4SLinus Torvalds 	info->cardMode = FST_RDW(card, cardMode);
17301da177e4SLinus Torvalds 	info->smcFirmwareVersion = FST_RDL(card, smcFirmwareVersion);
17311da177e4SLinus Torvalds 
173214b9764cSPeng Li 	/* The T2U can report cable presence for both A or B
17331da177e4SLinus Torvalds 	 * in bits 0 and 1 of cableStatus.  See which port we are and
17341da177e4SLinus Torvalds 	 * do the mapping.
17351da177e4SLinus Torvalds 	 */
17361da177e4SLinus Torvalds 	if (card->family == FST_FAMILY_TXU) {
17371da177e4SLinus Torvalds 		if (port->index == 0) {
173814b9764cSPeng Li 			/* Port A
17391da177e4SLinus Torvalds 			 */
17401da177e4SLinus Torvalds 			info->cableStatus = info->cableStatus & 1;
17411da177e4SLinus Torvalds 		} else {
174214b9764cSPeng Li 			/* Port B
17431da177e4SLinus Torvalds 			 */
17441da177e4SLinus Torvalds 			info->cableStatus = info->cableStatus >> 1;
17451da177e4SLinus Torvalds 			info->cableStatus = info->cableStatus & 1;
17461da177e4SLinus Torvalds 		}
17471da177e4SLinus Torvalds 	}
174814b9764cSPeng Li 	/* Some additional bits if we are TE1
17491da177e4SLinus Torvalds 	 */
17501da177e4SLinus Torvalds 	if (card->type == FST_TYPE_TE1) {
17511da177e4SLinus Torvalds 		info->lineSpeed = FST_RDL(card, suConfig.dataRate);
17521da177e4SLinus Torvalds 		info->clockSource = FST_RDB(card, suConfig.clocking);
17531da177e4SLinus Torvalds 		info->framing = FST_RDB(card, suConfig.framing);
17541da177e4SLinus Torvalds 		info->structure = FST_RDB(card, suConfig.structure);
17551da177e4SLinus Torvalds 		info->interface = FST_RDB(card, suConfig.interface);
17561da177e4SLinus Torvalds 		info->coding = FST_RDB(card, suConfig.coding);
17571da177e4SLinus Torvalds 		info->lineBuildOut = FST_RDB(card, suConfig.lineBuildOut);
17581da177e4SLinus Torvalds 		info->equalizer = FST_RDB(card, suConfig.equalizer);
17591da177e4SLinus Torvalds 		info->loopMode = FST_RDB(card, suConfig.loopMode);
17601da177e4SLinus Torvalds 		info->range = FST_RDB(card, suConfig.range);
17611da177e4SLinus Torvalds 		info->txBufferMode = FST_RDB(card, suConfig.txBufferMode);
17621da177e4SLinus Torvalds 		info->rxBufferMode = FST_RDB(card, suConfig.rxBufferMode);
17631da177e4SLinus Torvalds 		info->startingSlot = FST_RDB(card, suConfig.startingSlot);
17641da177e4SLinus Torvalds 		info->losThreshold = FST_RDB(card, suConfig.losThreshold);
17651da177e4SLinus Torvalds 		if (FST_RDB(card, suConfig.enableIdleCode))
17661da177e4SLinus Torvalds 			info->idleCode = FST_RDB(card, suConfig.idleCode);
17671da177e4SLinus Torvalds 		else
17681da177e4SLinus Torvalds 			info->idleCode = 0;
17691da177e4SLinus Torvalds 		info->receiveBufferDelay =
17701da177e4SLinus Torvalds 		    FST_RDL(card, suStatus.receiveBufferDelay);
17711da177e4SLinus Torvalds 		info->framingErrorCount =
17721da177e4SLinus Torvalds 		    FST_RDL(card, suStatus.framingErrorCount);
17731da177e4SLinus Torvalds 		info->codeViolationCount =
17741da177e4SLinus Torvalds 		    FST_RDL(card, suStatus.codeViolationCount);
17751da177e4SLinus Torvalds 		info->crcErrorCount = FST_RDL(card, suStatus.crcErrorCount);
17761da177e4SLinus Torvalds 		info->lineAttenuation = FST_RDL(card, suStatus.lineAttenuation);
17771da177e4SLinus Torvalds 		info->lossOfSignal = FST_RDB(card, suStatus.lossOfSignal);
17781da177e4SLinus Torvalds 		info->receiveRemoteAlarm =
17791da177e4SLinus Torvalds 		    FST_RDB(card, suStatus.receiveRemoteAlarm);
17801da177e4SLinus Torvalds 		info->alarmIndicationSignal =
17811da177e4SLinus Torvalds 		    FST_RDB(card, suStatus.alarmIndicationSignal);
17821da177e4SLinus Torvalds 	}
17831da177e4SLinus Torvalds }
17841da177e4SLinus Torvalds 
17851da177e4SLinus Torvalds static int
fst_set_iface(struct fst_card_info * card,struct fst_port_info * port,struct if_settings * ifs)17861da177e4SLinus Torvalds fst_set_iface(struct fst_card_info *card, struct fst_port_info *port,
1787ad7eab2aSArnd Bergmann 	      struct if_settings *ifs)
17881da177e4SLinus Torvalds {
17891da177e4SLinus Torvalds 	sync_serial_settings sync;
17901da177e4SLinus Torvalds 	int i;
17911da177e4SLinus Torvalds 
1792ad7eab2aSArnd Bergmann 	if (ifs->size != sizeof(sync))
17931da177e4SLinus Torvalds 		return -ENOMEM;
17941da177e4SLinus Torvalds 
1795ad7eab2aSArnd Bergmann 	if (copy_from_user(&sync, ifs->ifs_ifsu.sync, sizeof(sync)))
17961da177e4SLinus Torvalds 		return -EFAULT;
17971da177e4SLinus Torvalds 
17981da177e4SLinus Torvalds 	if (sync.loopback)
17991da177e4SLinus Torvalds 		return -EINVAL;
18001da177e4SLinus Torvalds 
18011da177e4SLinus Torvalds 	i = port->index;
18021da177e4SLinus Torvalds 
1803ad7eab2aSArnd Bergmann 	switch (ifs->type) {
18041da177e4SLinus Torvalds 	case IF_IFACE_V35:
18051da177e4SLinus Torvalds 		FST_WRW(card, portConfig[i].lineInterface, V35);
18061da177e4SLinus Torvalds 		port->hwif = V35;
18071da177e4SLinus Torvalds 		break;
18081da177e4SLinus Torvalds 
18091da177e4SLinus Torvalds 	case IF_IFACE_V24:
18101da177e4SLinus Torvalds 		FST_WRW(card, portConfig[i].lineInterface, V24);
18111da177e4SLinus Torvalds 		port->hwif = V24;
18121da177e4SLinus Torvalds 		break;
18131da177e4SLinus Torvalds 
18141da177e4SLinus Torvalds 	case IF_IFACE_X21:
18151da177e4SLinus Torvalds 		FST_WRW(card, portConfig[i].lineInterface, X21);
18161da177e4SLinus Torvalds 		port->hwif = X21;
18171da177e4SLinus Torvalds 		break;
18181da177e4SLinus Torvalds 
18191da177e4SLinus Torvalds 	case IF_IFACE_X21D:
18201da177e4SLinus Torvalds 		FST_WRW(card, portConfig[i].lineInterface, X21D);
18211da177e4SLinus Torvalds 		port->hwif = X21D;
18221da177e4SLinus Torvalds 		break;
18231da177e4SLinus Torvalds 
18241da177e4SLinus Torvalds 	case IF_IFACE_T1:
18251da177e4SLinus Torvalds 		FST_WRW(card, portConfig[i].lineInterface, T1);
18261da177e4SLinus Torvalds 		port->hwif = T1;
18271da177e4SLinus Torvalds 		break;
18281da177e4SLinus Torvalds 
18291da177e4SLinus Torvalds 	case IF_IFACE_E1:
18301da177e4SLinus Torvalds 		FST_WRW(card, portConfig[i].lineInterface, E1);
18311da177e4SLinus Torvalds 		port->hwif = E1;
18321da177e4SLinus Torvalds 		break;
18331da177e4SLinus Torvalds 
18341da177e4SLinus Torvalds 	case IF_IFACE_SYNC_SERIAL:
18351da177e4SLinus Torvalds 		break;
18361da177e4SLinus Torvalds 
18371da177e4SLinus Torvalds 	default:
18381da177e4SLinus Torvalds 		return -EINVAL;
18391da177e4SLinus Torvalds 	}
18401da177e4SLinus Torvalds 
18411da177e4SLinus Torvalds 	switch (sync.clock_type) {
18421da177e4SLinus Torvalds 	case CLOCK_EXT:
18431da177e4SLinus Torvalds 		FST_WRB(card, portConfig[i].internalClock, EXTCLK);
18441da177e4SLinus Torvalds 		break;
18451da177e4SLinus Torvalds 
18461da177e4SLinus Torvalds 	case CLOCK_INT:
18471da177e4SLinus Torvalds 		FST_WRB(card, portConfig[i].internalClock, INTCLK);
18481da177e4SLinus Torvalds 		break;
18491da177e4SLinus Torvalds 
18501da177e4SLinus Torvalds 	default:
18511da177e4SLinus Torvalds 		return -EINVAL;
18521da177e4SLinus Torvalds 	}
18531da177e4SLinus Torvalds 	FST_WRL(card, portConfig[i].lineSpeed, sync.clock_rate);
18541da177e4SLinus Torvalds 	return 0;
18551da177e4SLinus Torvalds }
18561da177e4SLinus Torvalds 
18571da177e4SLinus Torvalds static int
fst_get_iface(struct fst_card_info * card,struct fst_port_info * port,struct if_settings * ifs)18581da177e4SLinus Torvalds fst_get_iface(struct fst_card_info *card, struct fst_port_info *port,
1859ad7eab2aSArnd Bergmann 	      struct if_settings *ifs)
18601da177e4SLinus Torvalds {
18611da177e4SLinus Torvalds 	sync_serial_settings sync;
18621da177e4SLinus Torvalds 	int i;
18631da177e4SLinus Torvalds 
18641da177e4SLinus Torvalds 	/* First check what line type is set, we'll default to reporting X.21
18651da177e4SLinus Torvalds 	 * if nothing is set as IF_IFACE_SYNC_SERIAL implies it can't be
18661da177e4SLinus Torvalds 	 * changed
18671da177e4SLinus Torvalds 	 */
18681da177e4SLinus Torvalds 	switch (port->hwif) {
18691da177e4SLinus Torvalds 	case E1:
1870ad7eab2aSArnd Bergmann 		ifs->type = IF_IFACE_E1;
18711da177e4SLinus Torvalds 		break;
18721da177e4SLinus Torvalds 	case T1:
1873ad7eab2aSArnd Bergmann 		ifs->type = IF_IFACE_T1;
18741da177e4SLinus Torvalds 		break;
18751da177e4SLinus Torvalds 	case V35:
1876ad7eab2aSArnd Bergmann 		ifs->type = IF_IFACE_V35;
18771da177e4SLinus Torvalds 		break;
18781da177e4SLinus Torvalds 	case V24:
1879ad7eab2aSArnd Bergmann 		ifs->type = IF_IFACE_V24;
18801da177e4SLinus Torvalds 		break;
18811da177e4SLinus Torvalds 	case X21D:
1882ad7eab2aSArnd Bergmann 		ifs->type = IF_IFACE_X21D;
18831da177e4SLinus Torvalds 		break;
18841da177e4SLinus Torvalds 	case X21:
18851da177e4SLinus Torvalds 	default:
1886ad7eab2aSArnd Bergmann 		ifs->type = IF_IFACE_X21;
18871da177e4SLinus Torvalds 		break;
18881da177e4SLinus Torvalds 	}
1889ad7eab2aSArnd Bergmann 	if (!ifs->size)
18901da177e4SLinus Torvalds 		return 0;	/* only type requested */
1891fa8d10b5SPeng Li 
1892ad7eab2aSArnd Bergmann 	if (ifs->size < sizeof(sync))
18931da177e4SLinus Torvalds 		return -ENOMEM;
18941da177e4SLinus Torvalds 
18951da177e4SLinus Torvalds 	i = port->index;
189696b34040SSalva Peiró 	memset(&sync, 0, sizeof(sync));
18971da177e4SLinus Torvalds 	sync.clock_rate = FST_RDL(card, portConfig[i].lineSpeed);
18981da177e4SLinus Torvalds 	/* Lucky card and linux use same encoding here */
18991da177e4SLinus Torvalds 	sync.clock_type = FST_RDB(card, portConfig[i].internalClock) ==
19001da177e4SLinus Torvalds 	    INTCLK ? CLOCK_INT : CLOCK_EXT;
19011da177e4SLinus Torvalds 	sync.loopback = 0;
19021da177e4SLinus Torvalds 
1903ad7eab2aSArnd Bergmann 	if (copy_to_user(ifs->ifs_ifsu.sync, &sync, sizeof(sync)))
19041da177e4SLinus Torvalds 		return -EFAULT;
19051da177e4SLinus Torvalds 
1906ad7eab2aSArnd Bergmann 	ifs->size = sizeof(sync);
19071da177e4SLinus Torvalds 	return 0;
19081da177e4SLinus Torvalds }
19091da177e4SLinus Torvalds 
19101da177e4SLinus Torvalds static int
fst_siocdevprivate(struct net_device * dev,struct ifreq * ifr,void __user * data,int cmd)191173d74f61SArnd Bergmann fst_siocdevprivate(struct net_device *dev, struct ifreq *ifr, void __user *data, int cmd)
19121da177e4SLinus Torvalds {
19131da177e4SLinus Torvalds 	struct fst_card_info *card;
19141da177e4SLinus Torvalds 	struct fst_port_info *port;
19151da177e4SLinus Torvalds 	struct fstioc_write wrthdr;
19161da177e4SLinus Torvalds 	struct fstioc_info info;
19171da177e4SLinus Torvalds 	unsigned long flags;
19185ffa6d7fSAl Viro 	void *buf;
19191da177e4SLinus Torvalds 
192073d74f61SArnd Bergmann 	dbg(DBG_IOCTL, "ioctl: %x, %p\n", cmd, data);
19211da177e4SLinus Torvalds 
19221da177e4SLinus Torvalds 	port = dev_to_port(dev);
19231da177e4SLinus Torvalds 	card = port->card;
19241da177e4SLinus Torvalds 
19251da177e4SLinus Torvalds 	if (!capable(CAP_NET_ADMIN))
19261da177e4SLinus Torvalds 		return -EPERM;
19271da177e4SLinus Torvalds 
19281da177e4SLinus Torvalds 	switch (cmd) {
19291da177e4SLinus Torvalds 	case FSTCPURESET:
19301da177e4SLinus Torvalds 		fst_cpureset(card);
19311da177e4SLinus Torvalds 		card->state = FST_RESET;
19321da177e4SLinus Torvalds 		return 0;
19331da177e4SLinus Torvalds 
19341da177e4SLinus Torvalds 	case FSTCPURELEASE:
19351da177e4SLinus Torvalds 		fst_cpurelease(card);
19361da177e4SLinus Torvalds 		card->state = FST_STARTING;
19371da177e4SLinus Torvalds 		return 0;
19381da177e4SLinus Torvalds 
19391da177e4SLinus Torvalds 	case FSTWRITE:		/* Code write (download) */
19401da177e4SLinus Torvalds 
19411da177e4SLinus Torvalds 		/* First copy in the header with the length and offset of data
19421da177e4SLinus Torvalds 		 * to write
19431da177e4SLinus Torvalds 		 */
194473d74f61SArnd Bergmann 		if (!data)
19451da177e4SLinus Torvalds 			return -EINVAL;
1946fa8d10b5SPeng Li 
194773d74f61SArnd Bergmann 		if (copy_from_user(&wrthdr, data, sizeof(struct fstioc_write)))
19481da177e4SLinus Torvalds 			return -EFAULT;
19491da177e4SLinus Torvalds 
19501da177e4SLinus Torvalds 		/* Sanity check the parameters. We don't support partial writes
19511da177e4SLinus Torvalds 		 * when going over the top
19521da177e4SLinus Torvalds 		 */
19538e95a202SJoe Perches 		if (wrthdr.size > FST_MEMSIZE || wrthdr.offset > FST_MEMSIZE ||
1954fa8d10b5SPeng Li 		    wrthdr.size + wrthdr.offset > FST_MEMSIZE)
19551da177e4SLinus Torvalds 			return -ENXIO;
19561da177e4SLinus Torvalds 
19575ffa6d7fSAl Viro 		/* Now copy the data to the card. */
19585ffa6d7fSAl Viro 
195973d74f61SArnd Bergmann 		buf = memdup_user(data + sizeof(struct fstioc_write),
19607d889504SJulia Lawall 				  wrthdr.size);
19617d889504SJulia Lawall 		if (IS_ERR(buf))
19627d889504SJulia Lawall 			return PTR_ERR(buf);
19631da177e4SLinus Torvalds 
19645ffa6d7fSAl Viro 		memcpy_toio(card->mem + wrthdr.offset, buf, wrthdr.size);
19655ffa6d7fSAl Viro 		kfree(buf);
19665ffa6d7fSAl Viro 
19671da177e4SLinus Torvalds 		/* Writes to the memory of a card in the reset state constitute
19681da177e4SLinus Torvalds 		 * a download
19691da177e4SLinus Torvalds 		 */
1970fa8d10b5SPeng Li 		if (card->state == FST_RESET)
19711da177e4SLinus Torvalds 			card->state = FST_DOWNLOAD;
1972fa8d10b5SPeng Li 
19731da177e4SLinus Torvalds 		return 0;
19741da177e4SLinus Torvalds 
19751da177e4SLinus Torvalds 	case FSTGETCONF:
19761da177e4SLinus Torvalds 
19771da177e4SLinus Torvalds 		/* If card has just been started check the shared memory config
19781da177e4SLinus Torvalds 		 * version and marker
19791da177e4SLinus Torvalds 		 */
19801da177e4SLinus Torvalds 		if (card->state == FST_STARTING) {
19811da177e4SLinus Torvalds 			check_started_ok(card);
19821da177e4SLinus Torvalds 
19831da177e4SLinus Torvalds 			/* If everything checked out enable card interrupts */
19841da177e4SLinus Torvalds 			if (card->state == FST_RUNNING) {
19851da177e4SLinus Torvalds 				spin_lock_irqsave(&card->card_lock, flags);
19861da177e4SLinus Torvalds 				fst_enable_intr(card);
19871da177e4SLinus Torvalds 				FST_WRB(card, interruptHandshake, 0xEE);
19881da177e4SLinus Torvalds 				spin_unlock_irqrestore(&card->card_lock, flags);
19891da177e4SLinus Torvalds 			}
19901da177e4SLinus Torvalds 		}
19911da177e4SLinus Torvalds 
199273d74f61SArnd Bergmann 		if (!data)
19931da177e4SLinus Torvalds 			return -EINVAL;
19941da177e4SLinus Torvalds 
19951da177e4SLinus Torvalds 		gather_conf_info(card, port, &info);
19961da177e4SLinus Torvalds 
199773d74f61SArnd Bergmann 		if (copy_to_user(data, &info, sizeof(info)))
19981da177e4SLinus Torvalds 			return -EFAULT;
1999fa8d10b5SPeng Li 
20001da177e4SLinus Torvalds 		return 0;
20011da177e4SLinus Torvalds 
20021da177e4SLinus Torvalds 	case FSTSETCONF:
200314b9764cSPeng Li 		/* Most of the settings have been moved to the generic ioctls
20041da177e4SLinus Torvalds 		 * this just covers debug and board ident now
20051da177e4SLinus Torvalds 		 */
20061da177e4SLinus Torvalds 
20071da177e4SLinus Torvalds 		if (card->state != FST_RUNNING) {
20083f326d40SJoe Perches 			pr_err("Attempt to configure card %d in non-running state (%d)\n",
20091da177e4SLinus Torvalds 			       card->card_no, card->state);
20101da177e4SLinus Torvalds 			return -EIO;
20111da177e4SLinus Torvalds 		}
201273d74f61SArnd Bergmann 		if (copy_from_user(&info, data, sizeof(info)))
20131da177e4SLinus Torvalds 			return -EFAULT;
20141da177e4SLinus Torvalds 
20151da177e4SLinus Torvalds 		return set_conf_from_info(card, port, &info);
201673d74f61SArnd Bergmann 	default:
201773d74f61SArnd Bergmann 		return -EINVAL;
201873d74f61SArnd Bergmann 	}
201973d74f61SArnd Bergmann }
20201da177e4SLinus Torvalds 
202173d74f61SArnd Bergmann static int
fst_ioctl(struct net_device * dev,struct if_settings * ifs)2022ad7eab2aSArnd Bergmann fst_ioctl(struct net_device *dev, struct if_settings *ifs)
202373d74f61SArnd Bergmann {
202473d74f61SArnd Bergmann 	struct fst_card_info *card;
202573d74f61SArnd Bergmann 	struct fst_port_info *port;
202673d74f61SArnd Bergmann 
2027ad7eab2aSArnd Bergmann 	dbg(DBG_IOCTL, "SIOCDEVPRIVATE, %x\n", ifs->type);
202873d74f61SArnd Bergmann 
202973d74f61SArnd Bergmann 	port = dev_to_port(dev);
203073d74f61SArnd Bergmann 	card = port->card;
203173d74f61SArnd Bergmann 
203273d74f61SArnd Bergmann 	if (!capable(CAP_NET_ADMIN))
203373d74f61SArnd Bergmann 		return -EPERM;
203473d74f61SArnd Bergmann 
2035ad7eab2aSArnd Bergmann 	switch (ifs->type) {
20361da177e4SLinus Torvalds 	case IF_GET_IFACE:
2037ad7eab2aSArnd Bergmann 		return fst_get_iface(card, port, ifs);
20381da177e4SLinus Torvalds 
20391da177e4SLinus Torvalds 	case IF_IFACE_SYNC_SERIAL:
20401da177e4SLinus Torvalds 	case IF_IFACE_V35:
20411da177e4SLinus Torvalds 	case IF_IFACE_V24:
20421da177e4SLinus Torvalds 	case IF_IFACE_X21:
20431da177e4SLinus Torvalds 	case IF_IFACE_X21D:
20441da177e4SLinus Torvalds 	case IF_IFACE_T1:
20451da177e4SLinus Torvalds 	case IF_IFACE_E1:
2046ad7eab2aSArnd Bergmann 		return fst_set_iface(card, port, ifs);
20471da177e4SLinus Torvalds 
20481da177e4SLinus Torvalds 	case IF_PROTO_RAW:
20491da177e4SLinus Torvalds 		port->mode = FST_RAW;
20501da177e4SLinus Torvalds 		return 0;
20511da177e4SLinus Torvalds 
20521da177e4SLinus Torvalds 	case IF_GET_PROTO:
20531da177e4SLinus Torvalds 		if (port->mode == FST_RAW) {
2054ad7eab2aSArnd Bergmann 			ifs->type = IF_PROTO_RAW;
20551da177e4SLinus Torvalds 			return 0;
20561da177e4SLinus Torvalds 		}
2057ad7eab2aSArnd Bergmann 		return hdlc_ioctl(dev, ifs);
20581da177e4SLinus Torvalds 
20591da177e4SLinus Torvalds 	default:
20601da177e4SLinus Torvalds 		port->mode = FST_GEN_HDLC;
20611da177e4SLinus Torvalds 		dbg(DBG_IOCTL, "Passing this type to hdlc %x\n",
2062ad7eab2aSArnd Bergmann 		    ifs->type);
2063ad7eab2aSArnd Bergmann 		return hdlc_ioctl(dev, ifs);
20641da177e4SLinus Torvalds 	}
20651da177e4SLinus Torvalds }
20661da177e4SLinus Torvalds 
20671da177e4SLinus Torvalds static void
fst_openport(struct fst_port_info * port)20681da177e4SLinus Torvalds fst_openport(struct fst_port_info *port)
20691da177e4SLinus Torvalds {
20701da177e4SLinus Torvalds 	int signals;
20711da177e4SLinus Torvalds 
20721da177e4SLinus Torvalds 	/* Only init things if card is actually running. This allows open to
20731da177e4SLinus Torvalds 	 * succeed for downloads etc.
20741da177e4SLinus Torvalds 	 */
20751da177e4SLinus Torvalds 	if (port->card->state == FST_RUNNING) {
20761da177e4SLinus Torvalds 		if (port->run) {
20771da177e4SLinus Torvalds 			dbg(DBG_OPEN, "open: found port already running\n");
20781da177e4SLinus Torvalds 
20791da177e4SLinus Torvalds 			fst_issue_cmd(port, STOPPORT);
20801da177e4SLinus Torvalds 			port->run = 0;
20811da177e4SLinus Torvalds 		}
20821da177e4SLinus Torvalds 
20831da177e4SLinus Torvalds 		fst_rx_config(port);
20841da177e4SLinus Torvalds 		fst_tx_config(port);
20851da177e4SLinus Torvalds 		fst_op_raise(port, OPSTS_RTS | OPSTS_DTR);
20861da177e4SLinus Torvalds 
20871da177e4SLinus Torvalds 		fst_issue_cmd(port, STARTPORT);
20881da177e4SLinus Torvalds 		port->run = 1;
20891da177e4SLinus Torvalds 
20901da177e4SLinus Torvalds 		signals = FST_RDL(port->card, v24DebouncedSts[port->index]);
2091ae1be3faSPeng Li 		if (signals & ((port->hwif == X21 || port->hwif == X21D)
20921da177e4SLinus Torvalds 			       ? IPSTS_INDICATE : IPSTS_DCD))
20931da177e4SLinus Torvalds 			netif_carrier_on(port_to_dev(port));
20941da177e4SLinus Torvalds 		else
20951da177e4SLinus Torvalds 			netif_carrier_off(port_to_dev(port));
20961da177e4SLinus Torvalds 
20971da177e4SLinus Torvalds 		port->txqe = 0;
20981da177e4SLinus Torvalds 		port->txqs = 0;
20991da177e4SLinus Torvalds 	}
21001da177e4SLinus Torvalds }
21011da177e4SLinus Torvalds 
21021da177e4SLinus Torvalds static void
fst_closeport(struct fst_port_info * port)21031da177e4SLinus Torvalds fst_closeport(struct fst_port_info *port)
21041da177e4SLinus Torvalds {
21051da177e4SLinus Torvalds 	if (port->card->state == FST_RUNNING) {
21061da177e4SLinus Torvalds 		if (port->run) {
21071da177e4SLinus Torvalds 			port->run = 0;
21081da177e4SLinus Torvalds 			fst_op_lower(port, OPSTS_RTS | OPSTS_DTR);
21091da177e4SLinus Torvalds 
21101da177e4SLinus Torvalds 			fst_issue_cmd(port, STOPPORT);
21111da177e4SLinus Torvalds 		} else {
21121da177e4SLinus Torvalds 			dbg(DBG_OPEN, "close: port not running\n");
21131da177e4SLinus Torvalds 		}
21141da177e4SLinus Torvalds 	}
21151da177e4SLinus Torvalds }
21161da177e4SLinus Torvalds 
21171da177e4SLinus Torvalds static int
fst_open(struct net_device * dev)21181da177e4SLinus Torvalds fst_open(struct net_device *dev)
21191da177e4SLinus Torvalds {
21201da177e4SLinus Torvalds 	int err;
21211da177e4SLinus Torvalds 	struct fst_port_info *port;
21221da177e4SLinus Torvalds 
21231da177e4SLinus Torvalds 	port = dev_to_port(dev);
21241da177e4SLinus Torvalds 	if (!try_module_get(THIS_MODULE))
21251da177e4SLinus Torvalds 		return -EBUSY;
21261da177e4SLinus Torvalds 
21271da177e4SLinus Torvalds 	if (port->mode != FST_RAW) {
21281da177e4SLinus Torvalds 		err = hdlc_open(dev);
2129d0fd64c1SPavel Shved 		if (err) {
2130d0fd64c1SPavel Shved 			module_put(THIS_MODULE);
21311da177e4SLinus Torvalds 			return err;
21321da177e4SLinus Torvalds 		}
2133d0fd64c1SPavel Shved 	}
21341da177e4SLinus Torvalds 
21351da177e4SLinus Torvalds 	fst_openport(port);
21361da177e4SLinus Torvalds 	netif_wake_queue(dev);
21371da177e4SLinus Torvalds 	return 0;
21381da177e4SLinus Torvalds }
21391da177e4SLinus Torvalds 
21401da177e4SLinus Torvalds static int
fst_close(struct net_device * dev)21411da177e4SLinus Torvalds fst_close(struct net_device *dev)
21421da177e4SLinus Torvalds {
21431da177e4SLinus Torvalds 	struct fst_port_info *port;
21441da177e4SLinus Torvalds 	struct fst_card_info *card;
21451da177e4SLinus Torvalds 	unsigned char tx_dma_done;
21461da177e4SLinus Torvalds 	unsigned char rx_dma_done;
21471da177e4SLinus Torvalds 
21481da177e4SLinus Torvalds 	port = dev_to_port(dev);
21491da177e4SLinus Torvalds 	card = port->card;
21501da177e4SLinus Torvalds 
21511da177e4SLinus Torvalds 	tx_dma_done = inb(card->pci_conf + DMACSR1);
21521da177e4SLinus Torvalds 	rx_dma_done = inb(card->pci_conf + DMACSR0);
21531da177e4SLinus Torvalds 	dbg(DBG_OPEN,
21541da177e4SLinus Torvalds 	    "Port Close: tx_dma_in_progress = %d (%x) rx_dma_in_progress = %d (%x)\n",
21551da177e4SLinus Torvalds 	    card->dmatx_in_progress, tx_dma_done, card->dmarx_in_progress,
21561da177e4SLinus Torvalds 	    rx_dma_done);
21571da177e4SLinus Torvalds 
21581da177e4SLinus Torvalds 	netif_stop_queue(dev);
21591da177e4SLinus Torvalds 	fst_closeport(dev_to_port(dev));
2160fa8d10b5SPeng Li 	if (port->mode != FST_RAW)
21611da177e4SLinus Torvalds 		hdlc_close(dev);
2162fa8d10b5SPeng Li 
21631da177e4SLinus Torvalds 	module_put(THIS_MODULE);
21641da177e4SLinus Torvalds 	return 0;
21651da177e4SLinus Torvalds }
21661da177e4SLinus Torvalds 
21671da177e4SLinus Torvalds static int
fst_attach(struct net_device * dev,unsigned short encoding,unsigned short parity)21681da177e4SLinus Torvalds fst_attach(struct net_device *dev, unsigned short encoding, unsigned short parity)
21691da177e4SLinus Torvalds {
217014b9764cSPeng Li 	/* Setting currently fixed in FarSync card so we check and forget
21711da177e4SLinus Torvalds 	 */
21721da177e4SLinus Torvalds 	if (encoding != ENCODING_NRZ || parity != PARITY_CRC16_PR1_CCITT)
21731da177e4SLinus Torvalds 		return -EINVAL;
21741da177e4SLinus Torvalds 	return 0;
21751da177e4SLinus Torvalds }
21761da177e4SLinus Torvalds 
21771da177e4SLinus Torvalds static void
fst_tx_timeout(struct net_device * dev,unsigned int txqueue)21780290bd29SMichael S. Tsirkin fst_tx_timeout(struct net_device *dev, unsigned int txqueue)
21791da177e4SLinus Torvalds {
21801da177e4SLinus Torvalds 	struct fst_port_info *port;
21811da177e4SLinus Torvalds 	struct fst_card_info *card;
21821da177e4SLinus Torvalds 
21831da177e4SLinus Torvalds 	port = dev_to_port(dev);
21841da177e4SLinus Torvalds 	card = port->card;
2185198191c4SKrzysztof Halasa 	dev->stats.tx_errors++;
2186198191c4SKrzysztof Halasa 	dev->stats.tx_aborted_errors++;
21871da177e4SLinus Torvalds 	dbg(DBG_ASS, "Tx timeout card %d port %d\n",
21881da177e4SLinus Torvalds 	    card->card_no, port->index);
21891da177e4SLinus Torvalds 	fst_issue_cmd(port, ABORTTX);
21901da177e4SLinus Torvalds 
2191860e9538SFlorian Westphal 	netif_trans_update(dev);
21921da177e4SLinus Torvalds 	netif_wake_queue(dev);
21931da177e4SLinus Torvalds 	port->start = 0;
21941da177e4SLinus Torvalds }
21951da177e4SLinus Torvalds 
2196d71a6749SStephen Hemminger static netdev_tx_t
fst_start_xmit(struct sk_buff * skb,struct net_device * dev)21971da177e4SLinus Torvalds fst_start_xmit(struct sk_buff *skb, struct net_device *dev)
21981da177e4SLinus Torvalds {
21991da177e4SLinus Torvalds 	struct fst_card_info *card;
22001da177e4SLinus Torvalds 	struct fst_port_info *port;
22011da177e4SLinus Torvalds 	unsigned long flags;
22021da177e4SLinus Torvalds 	int txq_length;
22031da177e4SLinus Torvalds 
22041da177e4SLinus Torvalds 	port = dev_to_port(dev);
22051da177e4SLinus Torvalds 	card = port->card;
22061da177e4SLinus Torvalds 	dbg(DBG_TX, "fst_start_xmit: length = %d\n", skb->len);
22071da177e4SLinus Torvalds 
22081da177e4SLinus Torvalds 	/* Drop packet with error if we don't have carrier */
22091da177e4SLinus Torvalds 	if (!netif_carrier_ok(dev)) {
22101da177e4SLinus Torvalds 		dev_kfree_skb(skb);
2211198191c4SKrzysztof Halasa 		dev->stats.tx_errors++;
2212198191c4SKrzysztof Halasa 		dev->stats.tx_carrier_errors++;
22131da177e4SLinus Torvalds 		dbg(DBG_ASS,
22141da177e4SLinus Torvalds 		    "Tried to transmit but no carrier on card %d port %d\n",
22151da177e4SLinus Torvalds 		    card->card_no, port->index);
2216ec634fe3SPatrick McHardy 		return NETDEV_TX_OK;
22171da177e4SLinus Torvalds 	}
22181da177e4SLinus Torvalds 
22191da177e4SLinus Torvalds 	/* Drop it if it's too big! MTU failure ? */
22201da177e4SLinus Torvalds 	if (skb->len > LEN_TX_BUFFER) {
22211da177e4SLinus Torvalds 		dbg(DBG_ASS, "Packet too large %d vs %d\n", skb->len,
22221da177e4SLinus Torvalds 		    LEN_TX_BUFFER);
22231da177e4SLinus Torvalds 		dev_kfree_skb(skb);
2224198191c4SKrzysztof Halasa 		dev->stats.tx_errors++;
2225ec634fe3SPatrick McHardy 		return NETDEV_TX_OK;
22261da177e4SLinus Torvalds 	}
22271da177e4SLinus Torvalds 
222814b9764cSPeng Li 	/* We are always going to queue the packet
22291da177e4SLinus Torvalds 	 * so that the bottom half is the only place we tx from
22301da177e4SLinus Torvalds 	 * Check there is room in the port txq
22311da177e4SLinus Torvalds 	 */
22321da177e4SLinus Torvalds 	spin_lock_irqsave(&card->card_lock, flags);
223340996bcfSPeng Li 	txq_length = port->txqe - port->txqs;
223440996bcfSPeng Li 	if (txq_length < 0) {
223514b9764cSPeng Li 		/* This is the case where the next free has wrapped but the
22361da177e4SLinus Torvalds 		 * last used hasn't
22371da177e4SLinus Torvalds 		 */
22381da177e4SLinus Torvalds 		txq_length = txq_length + FST_TXQ_DEPTH;
22391da177e4SLinus Torvalds 	}
22401da177e4SLinus Torvalds 	spin_unlock_irqrestore(&card->card_lock, flags);
22411da177e4SLinus Torvalds 	if (txq_length > fst_txq_high) {
224214b9764cSPeng Li 		/* We have got enough buffers in the pipeline.  Ask the network
22431da177e4SLinus Torvalds 		 * layer to stop sending frames down
22441da177e4SLinus Torvalds 		 */
22451da177e4SLinus Torvalds 		netif_stop_queue(dev);
22461da177e4SLinus Torvalds 		port->start = 1;	/* I'm using this to signal stop sent up */
22471da177e4SLinus Torvalds 	}
22481da177e4SLinus Torvalds 
22491da177e4SLinus Torvalds 	if (txq_length == FST_TXQ_DEPTH - 1) {
225014b9764cSPeng Li 		/* This shouldn't have happened but such is life
22511da177e4SLinus Torvalds 		 */
22521da177e4SLinus Torvalds 		dev_kfree_skb(skb);
2253198191c4SKrzysztof Halasa 		dev->stats.tx_errors++;
22541da177e4SLinus Torvalds 		dbg(DBG_ASS, "Tx queue overflow card %d port %d\n",
22551da177e4SLinus Torvalds 		    card->card_no, port->index);
2256ec634fe3SPatrick McHardy 		return NETDEV_TX_OK;
22571da177e4SLinus Torvalds 	}
22581da177e4SLinus Torvalds 
225914b9764cSPeng Li 	/* queue the buffer
22601da177e4SLinus Torvalds 	 */
22611da177e4SLinus Torvalds 	spin_lock_irqsave(&card->card_lock, flags);
22621da177e4SLinus Torvalds 	port->txq[port->txqe] = skb;
22631da177e4SLinus Torvalds 	port->txqe++;
22641da177e4SLinus Torvalds 	if (port->txqe == FST_TXQ_DEPTH)
22651da177e4SLinus Torvalds 		port->txqe = 0;
22661da177e4SLinus Torvalds 	spin_unlock_irqrestore(&card->card_lock, flags);
22671da177e4SLinus Torvalds 
22681da177e4SLinus Torvalds 	/* Scehdule the bottom half which now does transmit processing */
22691da177e4SLinus Torvalds 	fst_q_work_item(&fst_work_txq, card->card_no);
22701da177e4SLinus Torvalds 	tasklet_schedule(&fst_tx_task);
22711da177e4SLinus Torvalds 
2272ec634fe3SPatrick McHardy 	return NETDEV_TX_OK;
22731da177e4SLinus Torvalds }
22741da177e4SLinus Torvalds 
227514b9764cSPeng Li /*      Card setup having checked hardware resources.
22761da177e4SLinus Torvalds  *      Should be pretty bizarre if we get an error here (kernel memory
22771da177e4SLinus Torvalds  *      exhaustion is one possibility). If we do see a problem we report it
22781da177e4SLinus Torvalds  *      via a printk and leave the corresponding interface and all that follow
22791da177e4SLinus Torvalds  *      disabled.
22801da177e4SLinus Torvalds  */
22815a37931fSBill Pemberton static char *type_strings[] = {
22821da177e4SLinus Torvalds 	"no hardware",		/* Should never be seen */
22831da177e4SLinus Torvalds 	"FarSync T2P",
22841da177e4SLinus Torvalds 	"FarSync T4P",
22851da177e4SLinus Torvalds 	"FarSync T1U",
22861da177e4SLinus Torvalds 	"FarSync T2U",
22871da177e4SLinus Torvalds 	"FarSync T4U",
22881da177e4SLinus Torvalds 	"FarSync TE1"
22891da177e4SLinus Torvalds };
22901da177e4SLinus Torvalds 
229119eeb2f9SAlexey Khoroshilov static int
fst_init_card(struct fst_card_info * card)22921da177e4SLinus Torvalds fst_init_card(struct fst_card_info *card)
22931da177e4SLinus Torvalds {
22941da177e4SLinus Torvalds 	int i;
22951da177e4SLinus Torvalds 	int err;
22961da177e4SLinus Torvalds 
22971da177e4SLinus Torvalds 	/* We're working on a number of ports based on the card ID. If the
22981da177e4SLinus Torvalds 	 * firmware detects something different later (should never happen)
22991da177e4SLinus Torvalds 	 * we'll have to revise it in some way then.
23001da177e4SLinus Torvalds 	 */
23011da177e4SLinus Torvalds 	for (i = 0; i < card->nports; i++) {
23021da177e4SLinus Torvalds 		err = register_hdlc_device(card->ports[i].dev);
23031da177e4SLinus Torvalds 		if (err < 0) {
23043f326d40SJoe Perches 			pr_err("Cannot register HDLC device for port %d (errno %d)\n",
23053f326d40SJoe Perches 			       i, -err);
230619eeb2f9SAlexey Khoroshilov 			while (i--)
230719eeb2f9SAlexey Khoroshilov 				unregister_hdlc_device(card->ports[i].dev);
230819eeb2f9SAlexey Khoroshilov 			return err;
23091da177e4SLinus Torvalds 		}
23101da177e4SLinus Torvalds 	}
23111da177e4SLinus Torvalds 
23123f326d40SJoe Perches 	pr_info("%s-%s: %s IRQ%d, %d ports\n",
23131da177e4SLinus Torvalds 		port_to_dev(&card->ports[0])->name,
23141da177e4SLinus Torvalds 		port_to_dev(&card->ports[card->nports - 1])->name,
23151da177e4SLinus Torvalds 		type_strings[card->type], card->irq, card->nports);
231619eeb2f9SAlexey Khoroshilov 	return 0;
23171da177e4SLinus Torvalds }
23181da177e4SLinus Torvalds 
2319991990a1SKrzysztof Hałasa static const struct net_device_ops fst_ops = {
2320991990a1SKrzysztof Hałasa 	.ndo_open       = fst_open,
2321991990a1SKrzysztof Hałasa 	.ndo_stop       = fst_close,
2322991990a1SKrzysztof Hałasa 	.ndo_start_xmit = hdlc_start_xmit,
2323ad7eab2aSArnd Bergmann 	.ndo_siocwandev	= fst_ioctl,
232473d74f61SArnd Bergmann 	.ndo_siocdevprivate = fst_siocdevprivate,
2325991990a1SKrzysztof Hałasa 	.ndo_tx_timeout = fst_tx_timeout,
2326991990a1SKrzysztof Hałasa };
2327991990a1SKrzysztof Hałasa 
232814b9764cSPeng Li /*      Initialise card when detected.
23291da177e4SLinus Torvalds  *      Returns 0 to indicate success, or errno otherwise.
23301da177e4SLinus Torvalds  */
23315a37931fSBill Pemberton static int
fst_add_one(struct pci_dev * pdev,const struct pci_device_id * ent)23321da177e4SLinus Torvalds fst_add_one(struct pci_dev *pdev, const struct pci_device_id *ent)
23331da177e4SLinus Torvalds {
23348ccac4a5SPeng Li 	static int no_of_cards_added;
23351da177e4SLinus Torvalds 	struct fst_card_info *card;
23361da177e4SLinus Torvalds 	int err = 0;
23371da177e4SLinus Torvalds 	int i;
23381da177e4SLinus Torvalds 
23393f326d40SJoe Perches 	printk_once(KERN_INFO
23403f326d40SJoe Perches 		    pr_fmt("FarSync WAN driver " FST_USER_VERSION
23413f326d40SJoe Perches 			   " (c) 2001-2004 FarSite Communications Ltd.\n"));
23423f326d40SJoe Perches #if FST_DEBUG
23431da177e4SLinus Torvalds 	dbg(DBG_ASS, "The value of debug mask is %x\n", fst_debug_mask);
23443f326d40SJoe Perches #endif
234514b9764cSPeng Li 	/* We are going to be clever and allow certain cards not to be
23461da177e4SLinus Torvalds 	 * configured.  An exclude list can be provided in /etc/modules.conf
23471da177e4SLinus Torvalds 	 */
23481da177e4SLinus Torvalds 	if (fst_excluded_cards != 0) {
234914b9764cSPeng Li 		/* There are cards to exclude
23501da177e4SLinus Torvalds 		 *
23511da177e4SLinus Torvalds 		 */
23521da177e4SLinus Torvalds 		for (i = 0; i < fst_excluded_cards; i++) {
2353ae1be3faSPeng Li 			if (pdev->devfn >> 3 == fst_excluded_list[i]) {
23543f326d40SJoe Perches 				pr_info("FarSync PCI device %d not assigned\n",
23551da177e4SLinus Torvalds 					(pdev->devfn) >> 3);
23561da177e4SLinus Torvalds 				return -EBUSY;
23571da177e4SLinus Torvalds 			}
23581da177e4SLinus Torvalds 		}
23591da177e4SLinus Torvalds 	}
23601da177e4SLinus Torvalds 
23611da177e4SLinus Torvalds 	/* Allocate driver private data */
2362dd00cc48SYoann Padioleau 	card = kzalloc(sizeof(struct fst_card_info), GFP_KERNEL);
2363fa8d10b5SPeng Li 	if (!card)
23641da177e4SLinus Torvalds 		return -ENOMEM;
23651da177e4SLinus Torvalds 
23661da177e4SLinus Torvalds 	/* Try to enable the device */
236740996bcfSPeng Li 	err = pci_enable_device(pdev);
236840996bcfSPeng Li 	if (err) {
23693f326d40SJoe Perches 		pr_err("Failed to enable card. Err %d\n", -err);
237019eeb2f9SAlexey Khoroshilov 		goto enable_fail;
23711da177e4SLinus Torvalds 	}
23721da177e4SLinus Torvalds 
237340996bcfSPeng Li 	err = pci_request_regions(pdev, "FarSync");
237440996bcfSPeng Li 	if (err) {
23753f326d40SJoe Perches 		pr_err("Failed to allocate regions. Err %d\n", -err);
237619eeb2f9SAlexey Khoroshilov 		goto regions_fail;
23771da177e4SLinus Torvalds 	}
23781da177e4SLinus Torvalds 
23791da177e4SLinus Torvalds 	/* Get virtual addresses of memory regions */
23801da177e4SLinus Torvalds 	card->pci_conf = pci_resource_start(pdev, 1);
23811da177e4SLinus Torvalds 	card->phys_mem = pci_resource_start(pdev, 2);
23821da177e4SLinus Torvalds 	card->phys_ctlmem = pci_resource_start(pdev, 3);
238340996bcfSPeng Li 	card->mem = ioremap(card->phys_mem, FST_MEMSIZE);
238440996bcfSPeng Li 	if (!card->mem) {
23853f326d40SJoe Perches 		pr_err("Physical memory remap failed\n");
238619eeb2f9SAlexey Khoroshilov 		err = -ENODEV;
238719eeb2f9SAlexey Khoroshilov 		goto ioremap_physmem_fail;
23881da177e4SLinus Torvalds 	}
238940996bcfSPeng Li 	card->ctlmem = ioremap(card->phys_ctlmem, 0x10);
239040996bcfSPeng Li 	if (!card->ctlmem) {
23913f326d40SJoe Perches 		pr_err("Control memory remap failed\n");
239219eeb2f9SAlexey Khoroshilov 		err = -ENODEV;
239319eeb2f9SAlexey Khoroshilov 		goto ioremap_ctlmem_fail;
23941da177e4SLinus Torvalds 	}
23951da177e4SLinus Torvalds 	dbg(DBG_PCI, "kernel mem %p, ctlmem %p\n", card->mem, card->ctlmem);
23961da177e4SLinus Torvalds 
23971da177e4SLinus Torvalds 	/* Register the interrupt handler */
23981fb9df5dSThomas Gleixner 	if (request_irq(pdev->irq, fst_intr, IRQF_SHARED, FST_DEV_NAME, card)) {
23993f326d40SJoe Perches 		pr_err("Unable to register interrupt %d\n", card->irq);
240019eeb2f9SAlexey Khoroshilov 		err = -ENODEV;
240119eeb2f9SAlexey Khoroshilov 		goto irq_fail;
24021da177e4SLinus Torvalds 	}
24031da177e4SLinus Torvalds 
24041da177e4SLinus Torvalds 	/* Record info we need */
24051da177e4SLinus Torvalds 	card->irq = pdev->irq;
24061da177e4SLinus Torvalds 	card->type = ent->driver_data;
24071da177e4SLinus Torvalds 	card->family = ((ent->driver_data == FST_TYPE_T2P) ||
24081da177e4SLinus Torvalds 			(ent->driver_data == FST_TYPE_T4P))
24091da177e4SLinus Torvalds 	    ? FST_FAMILY_TXP : FST_FAMILY_TXU;
2410ae1be3faSPeng Li 	if (ent->driver_data == FST_TYPE_T1U ||
2411ae1be3faSPeng Li 	    ent->driver_data == FST_TYPE_TE1)
24121da177e4SLinus Torvalds 		card->nports = 1;
24131da177e4SLinus Torvalds 	else
24141da177e4SLinus Torvalds 		card->nports = ((ent->driver_data == FST_TYPE_T2P) ||
24151da177e4SLinus Torvalds 				(ent->driver_data == FST_TYPE_T2U)) ? 2 : 4;
24161da177e4SLinus Torvalds 
24171da177e4SLinus Torvalds 	card->state = FST_UNINIT;
24181da177e4SLinus Torvalds 	spin_lock_init(&card->card_lock);
24191da177e4SLinus Torvalds 
24201da177e4SLinus Torvalds 	for (i = 0; i < card->nports; i++) {
24211da177e4SLinus Torvalds 		struct net_device *dev = alloc_hdlcdev(&card->ports[i]);
24221da177e4SLinus Torvalds 		hdlc_device *hdlc;
242350d4c363SPeng Li 
24241da177e4SLinus Torvalds 		if (!dev) {
24251da177e4SLinus Torvalds 			while (i--)
24261da177e4SLinus Torvalds 				free_netdev(card->ports[i].dev);
24273f326d40SJoe Perches 			pr_err("FarSync: out of memory\n");
242819eeb2f9SAlexey Khoroshilov 			err = -ENOMEM;
242919eeb2f9SAlexey Khoroshilov 			goto hdlcdev_fail;
24301da177e4SLinus Torvalds 		}
24311da177e4SLinus Torvalds 		card->ports[i].dev    = dev;
24321da177e4SLinus Torvalds 		card->ports[i].card   = card;
24331da177e4SLinus Torvalds 		card->ports[i].index  = i;
24341da177e4SLinus Torvalds 		card->ports[i].run    = 0;
24351da177e4SLinus Torvalds 
24361da177e4SLinus Torvalds 		hdlc = dev_to_hdlc(dev);
24371da177e4SLinus Torvalds 
24381da177e4SLinus Torvalds 		/* Fill in the net device info */
24391da177e4SLinus Torvalds 		/* Since this is a PCI setup this is purely
24401da177e4SLinus Torvalds 		 * informational. Give them the buffer addresses
24411da177e4SLinus Torvalds 		 * and basic card I/O.
24421da177e4SLinus Torvalds 		 */
24431da177e4SLinus Torvalds 		dev->mem_start   = card->phys_mem
24441da177e4SLinus Torvalds 				+ BUF_OFFSET(txBuffer[i][0][0]);
24451da177e4SLinus Torvalds 		dev->mem_end     = card->phys_mem
2446e725a66cSArnd Bergmann 				+ BUF_OFFSET(txBuffer[i][NUM_TX_BUFFER - 1][LEN_RX_BUFFER - 1]);
24471da177e4SLinus Torvalds 		dev->base_addr   = card->pci_conf;
24481da177e4SLinus Torvalds 		dev->irq         = card->irq;
24491da177e4SLinus Torvalds 
2450991990a1SKrzysztof Hałasa 		dev->netdev_ops = &fst_ops;
24511da177e4SLinus Torvalds 		dev->tx_queue_len = FST_TX_QUEUE_LEN;
24521da177e4SLinus Torvalds 		dev->watchdog_timeo = FST_TX_TIMEOUT;
24531da177e4SLinus Torvalds 		hdlc->attach = fst_attach;
24541da177e4SLinus Torvalds 		hdlc->xmit   = fst_start_xmit;
24551da177e4SLinus Torvalds 	}
24561da177e4SLinus Torvalds 
24571da177e4SLinus Torvalds 	card->device = pdev;
24581da177e4SLinus Torvalds 
24591da177e4SLinus Torvalds 	dbg(DBG_PCI, "type %d nports %d irq %d\n", card->type,
24601da177e4SLinus Torvalds 	    card->nports, card->irq);
24611da177e4SLinus Torvalds 	dbg(DBG_PCI, "conf %04x mem %08x ctlmem %08x\n",
24621da177e4SLinus Torvalds 	    card->pci_conf, card->phys_mem, card->phys_ctlmem);
24631da177e4SLinus Torvalds 
24641da177e4SLinus Torvalds 	/* Reset the card's processor */
24651da177e4SLinus Torvalds 	fst_cpureset(card);
24661da177e4SLinus Torvalds 	card->state = FST_RESET;
24671da177e4SLinus Torvalds 
24681da177e4SLinus Torvalds 	/* Initialise DMA (if required) */
24691da177e4SLinus Torvalds 	fst_init_dma(card);
24701da177e4SLinus Torvalds 
24711da177e4SLinus Torvalds 	/* Record driver data for later use */
24721da177e4SLinus Torvalds 	pci_set_drvdata(pdev, card);
24731da177e4SLinus Torvalds 
24741da177e4SLinus Torvalds 	/* Remainder of card setup */
247519eeb2f9SAlexey Khoroshilov 	if (no_of_cards_added >= FST_MAX_CARDS) {
247619eeb2f9SAlexey Khoroshilov 		pr_err("FarSync: too many cards\n");
247719eeb2f9SAlexey Khoroshilov 		err = -ENOMEM;
247819eeb2f9SAlexey Khoroshilov 		goto card_array_fail;
247919eeb2f9SAlexey Khoroshilov 	}
24801da177e4SLinus Torvalds 	fst_card_array[no_of_cards_added] = card;
24811da177e4SLinus Torvalds 	card->card_no = no_of_cards_added++;	/* Record instance and bump it */
248219eeb2f9SAlexey Khoroshilov 	err = fst_init_card(card);
248319eeb2f9SAlexey Khoroshilov 	if (err)
248419eeb2f9SAlexey Khoroshilov 		goto init_card_fail;
24851da177e4SLinus Torvalds 	if (card->family == FST_FAMILY_TXU) {
248614b9764cSPeng Li 		/* Allocate a dma buffer for transmit and receives
24871da177e4SLinus Torvalds 		 */
24881da177e4SLinus Torvalds 		card->rx_dma_handle_host =
24894c900a6bSChristophe JAILLET 		    dma_alloc_coherent(&card->device->dev, FST_MAX_MTU,
24904c900a6bSChristophe JAILLET 				       &card->rx_dma_handle_card, GFP_KERNEL);
2491fa8d10b5SPeng Li 		if (!card->rx_dma_handle_host) {
24923f326d40SJoe Perches 			pr_err("Could not allocate rx dma buffer\n");
249319eeb2f9SAlexey Khoroshilov 			err = -ENOMEM;
249419eeb2f9SAlexey Khoroshilov 			goto rx_dma_fail;
24951da177e4SLinus Torvalds 		}
24961da177e4SLinus Torvalds 		card->tx_dma_handle_host =
24974c900a6bSChristophe JAILLET 		    dma_alloc_coherent(&card->device->dev, FST_MAX_MTU,
24984c900a6bSChristophe JAILLET 				       &card->tx_dma_handle_card, GFP_KERNEL);
2499fa8d10b5SPeng Li 		if (!card->tx_dma_handle_host) {
25003f326d40SJoe Perches 			pr_err("Could not allocate tx dma buffer\n");
250119eeb2f9SAlexey Khoroshilov 			err = -ENOMEM;
250219eeb2f9SAlexey Khoroshilov 			goto tx_dma_fail;
25031da177e4SLinus Torvalds 		}
25041da177e4SLinus Torvalds 	}
25051da177e4SLinus Torvalds 	return 0;		/* Success */
250619eeb2f9SAlexey Khoroshilov 
250719eeb2f9SAlexey Khoroshilov tx_dma_fail:
25084c900a6bSChristophe JAILLET 	dma_free_coherent(&card->device->dev, FST_MAX_MTU,
25094c900a6bSChristophe JAILLET 			  card->rx_dma_handle_host, card->rx_dma_handle_card);
251019eeb2f9SAlexey Khoroshilov rx_dma_fail:
251119eeb2f9SAlexey Khoroshilov 	fst_disable_intr(card);
251219eeb2f9SAlexey Khoroshilov 	for (i = 0 ; i < card->nports ; i++)
251319eeb2f9SAlexey Khoroshilov 		unregister_hdlc_device(card->ports[i].dev);
251419eeb2f9SAlexey Khoroshilov init_card_fail:
251519eeb2f9SAlexey Khoroshilov 	fst_card_array[card->card_no] = NULL;
251619eeb2f9SAlexey Khoroshilov card_array_fail:
251719eeb2f9SAlexey Khoroshilov 	for (i = 0 ; i < card->nports ; i++)
251819eeb2f9SAlexey Khoroshilov 		free_netdev(card->ports[i].dev);
251919eeb2f9SAlexey Khoroshilov hdlcdev_fail:
252019eeb2f9SAlexey Khoroshilov 	free_irq(card->irq, card);
252119eeb2f9SAlexey Khoroshilov irq_fail:
252219eeb2f9SAlexey Khoroshilov 	iounmap(card->ctlmem);
252319eeb2f9SAlexey Khoroshilov ioremap_ctlmem_fail:
252419eeb2f9SAlexey Khoroshilov 	iounmap(card->mem);
252519eeb2f9SAlexey Khoroshilov ioremap_physmem_fail:
252619eeb2f9SAlexey Khoroshilov 	pci_release_regions(pdev);
252719eeb2f9SAlexey Khoroshilov regions_fail:
252819eeb2f9SAlexey Khoroshilov 	pci_disable_device(pdev);
252919eeb2f9SAlexey Khoroshilov enable_fail:
253019eeb2f9SAlexey Khoroshilov 	kfree(card);
253119eeb2f9SAlexey Khoroshilov 	return err;
25321da177e4SLinus Torvalds }
25331da177e4SLinus Torvalds 
253414b9764cSPeng Li /*      Cleanup and close down a card
25351da177e4SLinus Torvalds  */
25365a37931fSBill Pemberton static void
fst_remove_one(struct pci_dev * pdev)25371da177e4SLinus Torvalds fst_remove_one(struct pci_dev *pdev)
25381da177e4SLinus Torvalds {
25391da177e4SLinus Torvalds 	struct fst_card_info *card;
25401da177e4SLinus Torvalds 	int i;
25411da177e4SLinus Torvalds 
25421da177e4SLinus Torvalds 	card = pci_get_drvdata(pdev);
25431da177e4SLinus Torvalds 
25441da177e4SLinus Torvalds 	for (i = 0; i < card->nports; i++) {
25451da177e4SLinus Torvalds 		struct net_device *dev = port_to_dev(&card->ports[i]);
254650d4c363SPeng Li 
25471da177e4SLinus Torvalds 		unregister_hdlc_device(dev);
2548*2f623aafSLi Zetao 		free_netdev(dev);
25491da177e4SLinus Torvalds 	}
25501da177e4SLinus Torvalds 
25511da177e4SLinus Torvalds 	fst_disable_intr(card);
25521da177e4SLinus Torvalds 	free_irq(card->irq, card);
25531da177e4SLinus Torvalds 
25541da177e4SLinus Torvalds 	iounmap(card->ctlmem);
25551da177e4SLinus Torvalds 	iounmap(card->mem);
25561da177e4SLinus Torvalds 	pci_release_regions(pdev);
25571da177e4SLinus Torvalds 	if (card->family == FST_FAMILY_TXU) {
255814b9764cSPeng Li 		/* Free dma buffers
25591da177e4SLinus Torvalds 		 */
25604c900a6bSChristophe JAILLET 		dma_free_coherent(&card->device->dev, FST_MAX_MTU,
25611da177e4SLinus Torvalds 				  card->rx_dma_handle_host,
25621da177e4SLinus Torvalds 				  card->rx_dma_handle_card);
25634c900a6bSChristophe JAILLET 		dma_free_coherent(&card->device->dev, FST_MAX_MTU,
25641da177e4SLinus Torvalds 				  card->tx_dma_handle_host,
25651da177e4SLinus Torvalds 				  card->tx_dma_handle_card);
25661da177e4SLinus Torvalds 	}
25671da177e4SLinus Torvalds 	fst_card_array[card->card_no] = NULL;
2568*2f623aafSLi Zetao 	kfree(card);
25691da177e4SLinus Torvalds }
25701da177e4SLinus Torvalds 
25711da177e4SLinus Torvalds static struct pci_driver fst_driver = {
25721da177e4SLinus Torvalds 	.name		= FST_NAME,
25731da177e4SLinus Torvalds 	.id_table	= fst_pci_dev_id,
25741da177e4SLinus Torvalds 	.probe		= fst_add_one,
25755a37931fSBill Pemberton 	.remove		= fst_remove_one,
25761da177e4SLinus Torvalds };
25771da177e4SLinus Torvalds 
25781da177e4SLinus Torvalds static int __init
fst_init(void)25791da177e4SLinus Torvalds fst_init(void)
25801da177e4SLinus Torvalds {
25811da177e4SLinus Torvalds 	int i;
25821da177e4SLinus Torvalds 
25831da177e4SLinus Torvalds 	for (i = 0; i < FST_MAX_CARDS; i++)
25841da177e4SLinus Torvalds 		fst_card_array[i] = NULL;
258529917620SJeff Garzik 	return pci_register_driver(&fst_driver);
25861da177e4SLinus Torvalds }
25871da177e4SLinus Torvalds 
25881da177e4SLinus Torvalds static void __exit
fst_cleanup_module(void)25891da177e4SLinus Torvalds fst_cleanup_module(void)
25901da177e4SLinus Torvalds {
25913f326d40SJoe Perches 	pr_info("FarSync WAN driver unloading\n");
25921da177e4SLinus Torvalds 	pci_unregister_driver(&fst_driver);
25931da177e4SLinus Torvalds }
25941da177e4SLinus Torvalds 
25951da177e4SLinus Torvalds module_init(fst_init);
25961da177e4SLinus Torvalds module_exit(fst_cleanup_module);
2597