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