xref: /openbmc/linux/drivers/atm/idt77252.c (revision 881d966b)
11da177e4SLinus Torvalds /*******************************************************************
21da177e4SLinus Torvalds  * ident "$Id: idt77252.c,v 1.2 2001/11/11 08:13:54 ecd Exp $"
31da177e4SLinus Torvalds  *
41da177e4SLinus Torvalds  * $Author: ecd $
51da177e4SLinus Torvalds  * $Date: 2001/11/11 08:13:54 $
61da177e4SLinus Torvalds  *
71da177e4SLinus Torvalds  * Copyright (c) 2000 ATecoM GmbH
81da177e4SLinus Torvalds  *
91da177e4SLinus Torvalds  * The author may be reached at ecd@atecom.com.
101da177e4SLinus Torvalds  *
111da177e4SLinus Torvalds  * This program is free software; you can redistribute  it and/or modify it
121da177e4SLinus Torvalds  * under  the terms of  the GNU General  Public License as published by the
131da177e4SLinus Torvalds  * Free Software Foundation;  either version 2 of the  License, or (at your
141da177e4SLinus Torvalds  * option) any later version.
151da177e4SLinus Torvalds  *
161da177e4SLinus Torvalds  * THIS  SOFTWARE  IS PROVIDED   ``AS  IS'' AND   ANY  EXPRESS OR   IMPLIED
171da177e4SLinus Torvalds  * WARRANTIES,   INCLUDING, BUT NOT  LIMITED  TO, THE IMPLIED WARRANTIES OF
181da177e4SLinus Torvalds  * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.  IN
191da177e4SLinus Torvalds  * NO  EVENT  SHALL   THE AUTHOR  BE    LIABLE FOR ANY   DIRECT,  INDIRECT,
201da177e4SLinus Torvalds  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
211da177e4SLinus Torvalds  * NOT LIMITED   TO, PROCUREMENT OF  SUBSTITUTE GOODS  OR SERVICES; LOSS OF
221da177e4SLinus Torvalds  * USE, DATA,  OR PROFITS; OR  BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
231da177e4SLinus Torvalds  * ANY THEORY OF LIABILITY, WHETHER IN  CONTRACT, STRICT LIABILITY, OR TORT
241da177e4SLinus Torvalds  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
251da177e4SLinus Torvalds  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
261da177e4SLinus Torvalds  *
271da177e4SLinus Torvalds  * You should have received a copy of the  GNU General Public License along
281da177e4SLinus Torvalds  * with this program; if not, write  to the Free Software Foundation, Inc.,
291da177e4SLinus Torvalds  * 675 Mass Ave, Cambridge, MA 02139, USA.
301da177e4SLinus Torvalds  *
311da177e4SLinus Torvalds  *******************************************************************/
321da177e4SLinus Torvalds static char const rcsid[] =
331da177e4SLinus Torvalds "$Id: idt77252.c,v 1.2 2001/11/11 08:13:54 ecd Exp $";
341da177e4SLinus Torvalds 
351da177e4SLinus Torvalds 
361da177e4SLinus Torvalds #include <linux/module.h>
371da177e4SLinus Torvalds #include <linux/pci.h>
383c6b3773SRandy Dunlap #include <linux/poison.h>
391da177e4SLinus Torvalds #include <linux/skbuff.h>
401da177e4SLinus Torvalds #include <linux/kernel.h>
411da177e4SLinus Torvalds #include <linux/vmalloc.h>
421da177e4SLinus Torvalds #include <linux/netdevice.h>
431da177e4SLinus Torvalds #include <linux/atmdev.h>
441da177e4SLinus Torvalds #include <linux/atm.h>
451da177e4SLinus Torvalds #include <linux/delay.h>
461da177e4SLinus Torvalds #include <linux/init.h>
471da177e4SLinus Torvalds #include <linux/bitops.h>
481da177e4SLinus Torvalds #include <linux/wait.h>
49e1bd232bSMarcelo Feitoza Parisi #include <linux/jiffies.h>
507e7a2d07SMatthias Kaehlcke #include <linux/mutex.h>
517e7a2d07SMatthias Kaehlcke 
521da177e4SLinus Torvalds #include <asm/io.h>
531da177e4SLinus Torvalds #include <asm/uaccess.h>
541da177e4SLinus Torvalds #include <asm/atomic.h>
551da177e4SLinus Torvalds #include <asm/byteorder.h>
561da177e4SLinus Torvalds 
571da177e4SLinus Torvalds #ifdef CONFIG_ATM_IDT77252_USE_SUNI
581da177e4SLinus Torvalds #include "suni.h"
591da177e4SLinus Torvalds #endif /* CONFIG_ATM_IDT77252_USE_SUNI */
601da177e4SLinus Torvalds 
611da177e4SLinus Torvalds 
621da177e4SLinus Torvalds #include "idt77252.h"
631da177e4SLinus Torvalds #include "idt77252_tables.h"
641da177e4SLinus Torvalds 
651da177e4SLinus Torvalds static unsigned int vpibits = 1;
661da177e4SLinus Torvalds 
671da177e4SLinus Torvalds 
6844beac00SRobert P. J. Day #define ATM_IDT77252_SEND_IDLE 1
691da177e4SLinus Torvalds 
701da177e4SLinus Torvalds 
711da177e4SLinus Torvalds /*
721da177e4SLinus Torvalds  * Debug HACKs.
731da177e4SLinus Torvalds  */
741da177e4SLinus Torvalds #define DEBUG_MODULE 1
751da177e4SLinus Torvalds #undef HAVE_EEPROM	/* does not work, yet. */
761da177e4SLinus Torvalds 
771da177e4SLinus Torvalds #ifdef CONFIG_ATM_IDT77252_DEBUG
781da177e4SLinus Torvalds static unsigned long debug = DBG_GENERAL;
791da177e4SLinus Torvalds #endif
801da177e4SLinus Torvalds 
811da177e4SLinus Torvalds 
821da177e4SLinus Torvalds #define SAR_RX_DELAY	(SAR_CFG_RXINT_NODELAY)
831da177e4SLinus Torvalds 
841da177e4SLinus Torvalds 
851da177e4SLinus Torvalds /*
861da177e4SLinus Torvalds  * SCQ Handling.
871da177e4SLinus Torvalds  */
881da177e4SLinus Torvalds static struct scq_info *alloc_scq(struct idt77252_dev *, int);
891da177e4SLinus Torvalds static void free_scq(struct idt77252_dev *, struct scq_info *);
901da177e4SLinus Torvalds static int queue_skb(struct idt77252_dev *, struct vc_map *,
911da177e4SLinus Torvalds 		     struct sk_buff *, int oam);
921da177e4SLinus Torvalds static void drain_scq(struct idt77252_dev *, struct vc_map *);
931da177e4SLinus Torvalds static unsigned long get_free_scd(struct idt77252_dev *, struct vc_map *);
941da177e4SLinus Torvalds static void fill_scd(struct idt77252_dev *, struct scq_info *, int);
951da177e4SLinus Torvalds 
961da177e4SLinus Torvalds /*
971da177e4SLinus Torvalds  * FBQ Handling.
981da177e4SLinus Torvalds  */
991da177e4SLinus Torvalds static int push_rx_skb(struct idt77252_dev *,
1001da177e4SLinus Torvalds 		       struct sk_buff *, int queue);
1011da177e4SLinus Torvalds static void recycle_rx_skb(struct idt77252_dev *, struct sk_buff *);
1021da177e4SLinus Torvalds static void flush_rx_pool(struct idt77252_dev *, struct rx_pool *);
1031da177e4SLinus Torvalds static void recycle_rx_pool_skb(struct idt77252_dev *,
1041da177e4SLinus Torvalds 				struct rx_pool *);
1051da177e4SLinus Torvalds static void add_rx_skb(struct idt77252_dev *, int queue,
1061da177e4SLinus Torvalds 		       unsigned int size, unsigned int count);
1071da177e4SLinus Torvalds 
1081da177e4SLinus Torvalds /*
1091da177e4SLinus Torvalds  * RSQ Handling.
1101da177e4SLinus Torvalds  */
1111da177e4SLinus Torvalds static int init_rsq(struct idt77252_dev *);
1121da177e4SLinus Torvalds static void deinit_rsq(struct idt77252_dev *);
1131da177e4SLinus Torvalds static void idt77252_rx(struct idt77252_dev *);
1141da177e4SLinus Torvalds 
1151da177e4SLinus Torvalds /*
1161da177e4SLinus Torvalds  * TSQ handling.
1171da177e4SLinus Torvalds  */
1181da177e4SLinus Torvalds static int init_tsq(struct idt77252_dev *);
1191da177e4SLinus Torvalds static void deinit_tsq(struct idt77252_dev *);
1201da177e4SLinus Torvalds static void idt77252_tx(struct idt77252_dev *);
1211da177e4SLinus Torvalds 
1221da177e4SLinus Torvalds 
1231da177e4SLinus Torvalds /*
1241da177e4SLinus Torvalds  * ATM Interface.
1251da177e4SLinus Torvalds  */
1261da177e4SLinus Torvalds static void idt77252_dev_close(struct atm_dev *dev);
1271da177e4SLinus Torvalds static int idt77252_open(struct atm_vcc *vcc);
1281da177e4SLinus Torvalds static void idt77252_close(struct atm_vcc *vcc);
1291da177e4SLinus Torvalds static int idt77252_send(struct atm_vcc *vcc, struct sk_buff *skb);
1301da177e4SLinus Torvalds static int idt77252_send_oam(struct atm_vcc *vcc, void *cell,
1311da177e4SLinus Torvalds 			     int flags);
1321da177e4SLinus Torvalds static void idt77252_phy_put(struct atm_dev *dev, unsigned char value,
1331da177e4SLinus Torvalds 			     unsigned long addr);
1341da177e4SLinus Torvalds static unsigned char idt77252_phy_get(struct atm_dev *dev, unsigned long addr);
1351da177e4SLinus Torvalds static int idt77252_change_qos(struct atm_vcc *vcc, struct atm_qos *qos,
1361da177e4SLinus Torvalds 			       int flags);
1371da177e4SLinus Torvalds static int idt77252_proc_read(struct atm_dev *dev, loff_t * pos,
1381da177e4SLinus Torvalds 			      char *page);
139c4028958SDavid Howells static void idt77252_softint(struct work_struct *work);
1401da177e4SLinus Torvalds 
1411da177e4SLinus Torvalds 
1421da177e4SLinus Torvalds static struct atmdev_ops idt77252_ops =
1431da177e4SLinus Torvalds {
1441da177e4SLinus Torvalds 	.dev_close	= idt77252_dev_close,
1451da177e4SLinus Torvalds 	.open		= idt77252_open,
1461da177e4SLinus Torvalds 	.close		= idt77252_close,
1471da177e4SLinus Torvalds 	.send		= idt77252_send,
1481da177e4SLinus Torvalds 	.send_oam	= idt77252_send_oam,
1491da177e4SLinus Torvalds 	.phy_put	= idt77252_phy_put,
1501da177e4SLinus Torvalds 	.phy_get	= idt77252_phy_get,
1511da177e4SLinus Torvalds 	.change_qos	= idt77252_change_qos,
1521da177e4SLinus Torvalds 	.proc_read	= idt77252_proc_read,
1531da177e4SLinus Torvalds 	.owner		= THIS_MODULE
1541da177e4SLinus Torvalds };
1551da177e4SLinus Torvalds 
1561da177e4SLinus Torvalds static struct idt77252_dev *idt77252_chain = NULL;
1571da177e4SLinus Torvalds static unsigned int idt77252_sram_write_errors = 0;
1581da177e4SLinus Torvalds 
1591da177e4SLinus Torvalds /*****************************************************************************/
1601da177e4SLinus Torvalds /*                                                                           */
1611da177e4SLinus Torvalds /* I/O and Utility Bus                                                       */
1621da177e4SLinus Torvalds /*                                                                           */
1631da177e4SLinus Torvalds /*****************************************************************************/
1641da177e4SLinus Torvalds 
1651da177e4SLinus Torvalds static void
1661da177e4SLinus Torvalds waitfor_idle(struct idt77252_dev *card)
1671da177e4SLinus Torvalds {
1681da177e4SLinus Torvalds 	u32 stat;
1691da177e4SLinus Torvalds 
1701da177e4SLinus Torvalds 	stat = readl(SAR_REG_STAT);
1711da177e4SLinus Torvalds 	while (stat & SAR_STAT_CMDBZ)
1721da177e4SLinus Torvalds 		stat = readl(SAR_REG_STAT);
1731da177e4SLinus Torvalds }
1741da177e4SLinus Torvalds 
1751da177e4SLinus Torvalds static u32
1761da177e4SLinus Torvalds read_sram(struct idt77252_dev *card, unsigned long addr)
1771da177e4SLinus Torvalds {
1781da177e4SLinus Torvalds 	unsigned long flags;
1791da177e4SLinus Torvalds 	u32 value;
1801da177e4SLinus Torvalds 
1811da177e4SLinus Torvalds 	spin_lock_irqsave(&card->cmd_lock, flags);
1821da177e4SLinus Torvalds 	writel(SAR_CMD_READ_SRAM | (addr << 2), SAR_REG_CMD);
1831da177e4SLinus Torvalds 	waitfor_idle(card);
1841da177e4SLinus Torvalds 	value = readl(SAR_REG_DR0);
1851da177e4SLinus Torvalds 	spin_unlock_irqrestore(&card->cmd_lock, flags);
1861da177e4SLinus Torvalds 	return value;
1871da177e4SLinus Torvalds }
1881da177e4SLinus Torvalds 
1891da177e4SLinus Torvalds static void
1901da177e4SLinus Torvalds write_sram(struct idt77252_dev *card, unsigned long addr, u32 value)
1911da177e4SLinus Torvalds {
1921da177e4SLinus Torvalds 	unsigned long flags;
1931da177e4SLinus Torvalds 
1941da177e4SLinus Torvalds 	if ((idt77252_sram_write_errors == 0) &&
1951da177e4SLinus Torvalds 	    (((addr > card->tst[0] + card->tst_size - 2) &&
1961da177e4SLinus Torvalds 	      (addr < card->tst[0] + card->tst_size)) ||
1971da177e4SLinus Torvalds 	     ((addr > card->tst[1] + card->tst_size - 2) &&
1981da177e4SLinus Torvalds 	      (addr < card->tst[1] + card->tst_size)))) {
1991da177e4SLinus Torvalds 		printk("%s: ERROR: TST JMP section at %08lx written: %08x\n",
2001da177e4SLinus Torvalds 		       card->name, addr, value);
2011da177e4SLinus Torvalds 	}
2021da177e4SLinus Torvalds 
2031da177e4SLinus Torvalds 	spin_lock_irqsave(&card->cmd_lock, flags);
2041da177e4SLinus Torvalds 	writel(value, SAR_REG_DR0);
2051da177e4SLinus Torvalds 	writel(SAR_CMD_WRITE_SRAM | (addr << 2), SAR_REG_CMD);
2061da177e4SLinus Torvalds 	waitfor_idle(card);
2071da177e4SLinus Torvalds 	spin_unlock_irqrestore(&card->cmd_lock, flags);
2081da177e4SLinus Torvalds }
2091da177e4SLinus Torvalds 
2101da177e4SLinus Torvalds static u8
2111da177e4SLinus Torvalds read_utility(void *dev, unsigned long ubus_addr)
2121da177e4SLinus Torvalds {
2131da177e4SLinus Torvalds 	struct idt77252_dev *card = dev;
2141da177e4SLinus Torvalds 	unsigned long flags;
2151da177e4SLinus Torvalds 	u8 value;
2161da177e4SLinus Torvalds 
2171da177e4SLinus Torvalds 	if (!card) {
2181da177e4SLinus Torvalds 		printk("Error: No such device.\n");
2191da177e4SLinus Torvalds 		return -1;
2201da177e4SLinus Torvalds 	}
2211da177e4SLinus Torvalds 
2221da177e4SLinus Torvalds 	spin_lock_irqsave(&card->cmd_lock, flags);
2231da177e4SLinus Torvalds 	writel(SAR_CMD_READ_UTILITY + ubus_addr, SAR_REG_CMD);
2241da177e4SLinus Torvalds 	waitfor_idle(card);
2251da177e4SLinus Torvalds 	value = readl(SAR_REG_DR0);
2261da177e4SLinus Torvalds 	spin_unlock_irqrestore(&card->cmd_lock, flags);
2271da177e4SLinus Torvalds 	return value;
2281da177e4SLinus Torvalds }
2291da177e4SLinus Torvalds 
2301da177e4SLinus Torvalds static void
2311da177e4SLinus Torvalds write_utility(void *dev, unsigned long ubus_addr, u8 value)
2321da177e4SLinus Torvalds {
2331da177e4SLinus Torvalds 	struct idt77252_dev *card = dev;
2341da177e4SLinus Torvalds 	unsigned long flags;
2351da177e4SLinus Torvalds 
2361da177e4SLinus Torvalds 	if (!card) {
2371da177e4SLinus Torvalds 		printk("Error: No such device.\n");
2381da177e4SLinus Torvalds 		return;
2391da177e4SLinus Torvalds 	}
2401da177e4SLinus Torvalds 
2411da177e4SLinus Torvalds 	spin_lock_irqsave(&card->cmd_lock, flags);
2421da177e4SLinus Torvalds 	writel((u32) value, SAR_REG_DR0);
2431da177e4SLinus Torvalds 	writel(SAR_CMD_WRITE_UTILITY + ubus_addr, SAR_REG_CMD);
2441da177e4SLinus Torvalds 	waitfor_idle(card);
2451da177e4SLinus Torvalds 	spin_unlock_irqrestore(&card->cmd_lock, flags);
2461da177e4SLinus Torvalds }
2471da177e4SLinus Torvalds 
2481da177e4SLinus Torvalds #ifdef HAVE_EEPROM
2491da177e4SLinus Torvalds static u32 rdsrtab[] =
2501da177e4SLinus Torvalds {
2511da177e4SLinus Torvalds 	SAR_GP_EECS | SAR_GP_EESCLK,
2521da177e4SLinus Torvalds 	0,
2531da177e4SLinus Torvalds 	SAR_GP_EESCLK,			/* 0 */
2541da177e4SLinus Torvalds 	0,
2551da177e4SLinus Torvalds 	SAR_GP_EESCLK,			/* 0 */
2561da177e4SLinus Torvalds 	0,
2571da177e4SLinus Torvalds 	SAR_GP_EESCLK,			/* 0 */
2581da177e4SLinus Torvalds 	0,
2591da177e4SLinus Torvalds 	SAR_GP_EESCLK,			/* 0 */
2601da177e4SLinus Torvalds 	0,
2611da177e4SLinus Torvalds 	SAR_GP_EESCLK,			/* 0 */
2621da177e4SLinus Torvalds 	SAR_GP_EEDO,
2631da177e4SLinus Torvalds 	SAR_GP_EESCLK | SAR_GP_EEDO,	/* 1 */
2641da177e4SLinus Torvalds 	0,
2651da177e4SLinus Torvalds 	SAR_GP_EESCLK,			/* 0 */
2661da177e4SLinus Torvalds 	SAR_GP_EEDO,
2671da177e4SLinus Torvalds 	SAR_GP_EESCLK | SAR_GP_EEDO	/* 1 */
2681da177e4SLinus Torvalds };
2691da177e4SLinus Torvalds 
2701da177e4SLinus Torvalds static u32 wrentab[] =
2711da177e4SLinus Torvalds {
2721da177e4SLinus Torvalds 	SAR_GP_EECS | SAR_GP_EESCLK,
2731da177e4SLinus Torvalds 	0,
2741da177e4SLinus Torvalds 	SAR_GP_EESCLK,			/* 0 */
2751da177e4SLinus Torvalds 	0,
2761da177e4SLinus Torvalds 	SAR_GP_EESCLK,			/* 0 */
2771da177e4SLinus Torvalds 	0,
2781da177e4SLinus Torvalds 	SAR_GP_EESCLK,			/* 0 */
2791da177e4SLinus Torvalds 	0,
2801da177e4SLinus Torvalds 	SAR_GP_EESCLK,			/* 0 */
2811da177e4SLinus Torvalds 	SAR_GP_EEDO,
2821da177e4SLinus Torvalds 	SAR_GP_EESCLK | SAR_GP_EEDO,	/* 1 */
2831da177e4SLinus Torvalds 	SAR_GP_EEDO,
2841da177e4SLinus Torvalds 	SAR_GP_EESCLK | SAR_GP_EEDO,	/* 1 */
2851da177e4SLinus Torvalds 	0,
2861da177e4SLinus Torvalds 	SAR_GP_EESCLK,			/* 0 */
2871da177e4SLinus Torvalds 	0,
2881da177e4SLinus Torvalds 	SAR_GP_EESCLK			/* 0 */
2891da177e4SLinus Torvalds };
2901da177e4SLinus Torvalds 
2911da177e4SLinus Torvalds static u32 rdtab[] =
2921da177e4SLinus Torvalds {
2931da177e4SLinus Torvalds 	SAR_GP_EECS | SAR_GP_EESCLK,
2941da177e4SLinus Torvalds 	0,
2951da177e4SLinus Torvalds 	SAR_GP_EESCLK,			/* 0 */
2961da177e4SLinus Torvalds 	0,
2971da177e4SLinus Torvalds 	SAR_GP_EESCLK,			/* 0 */
2981da177e4SLinus Torvalds 	0,
2991da177e4SLinus Torvalds 	SAR_GP_EESCLK,			/* 0 */
3001da177e4SLinus Torvalds 	0,
3011da177e4SLinus Torvalds 	SAR_GP_EESCLK,			/* 0 */
3021da177e4SLinus Torvalds 	0,
3031da177e4SLinus Torvalds 	SAR_GP_EESCLK,			/* 0 */
3041da177e4SLinus Torvalds 	0,
3051da177e4SLinus Torvalds 	SAR_GP_EESCLK,			/* 0 */
3061da177e4SLinus Torvalds 	SAR_GP_EEDO,
3071da177e4SLinus Torvalds 	SAR_GP_EESCLK | SAR_GP_EEDO,	/* 1 */
3081da177e4SLinus Torvalds 	SAR_GP_EEDO,
3091da177e4SLinus Torvalds 	SAR_GP_EESCLK | SAR_GP_EEDO	/* 1 */
3101da177e4SLinus Torvalds };
3111da177e4SLinus Torvalds 
3121da177e4SLinus Torvalds static u32 wrtab[] =
3131da177e4SLinus Torvalds {
3141da177e4SLinus Torvalds 	SAR_GP_EECS | SAR_GP_EESCLK,
3151da177e4SLinus Torvalds 	0,
3161da177e4SLinus Torvalds 	SAR_GP_EESCLK,			/* 0 */
3171da177e4SLinus Torvalds 	0,
3181da177e4SLinus Torvalds 	SAR_GP_EESCLK,			/* 0 */
3191da177e4SLinus Torvalds 	0,
3201da177e4SLinus Torvalds 	SAR_GP_EESCLK,			/* 0 */
3211da177e4SLinus Torvalds 	0,
3221da177e4SLinus Torvalds 	SAR_GP_EESCLK,			/* 0 */
3231da177e4SLinus Torvalds 	0,
3241da177e4SLinus Torvalds 	SAR_GP_EESCLK,			/* 0 */
3251da177e4SLinus Torvalds 	0,
3261da177e4SLinus Torvalds 	SAR_GP_EESCLK,			/* 0 */
3271da177e4SLinus Torvalds 	SAR_GP_EEDO,
3281da177e4SLinus Torvalds 	SAR_GP_EESCLK | SAR_GP_EEDO,	/* 1 */
3291da177e4SLinus Torvalds 	0,
3301da177e4SLinus Torvalds 	SAR_GP_EESCLK			/* 0 */
3311da177e4SLinus Torvalds };
3321da177e4SLinus Torvalds 
3331da177e4SLinus Torvalds static u32 clktab[] =
3341da177e4SLinus Torvalds {
3351da177e4SLinus Torvalds 	0,
3361da177e4SLinus Torvalds 	SAR_GP_EESCLK,
3371da177e4SLinus Torvalds 	0,
3381da177e4SLinus Torvalds 	SAR_GP_EESCLK,
3391da177e4SLinus Torvalds 	0,
3401da177e4SLinus Torvalds 	SAR_GP_EESCLK,
3411da177e4SLinus Torvalds 	0,
3421da177e4SLinus Torvalds 	SAR_GP_EESCLK,
3431da177e4SLinus Torvalds 	0,
3441da177e4SLinus Torvalds 	SAR_GP_EESCLK,
3451da177e4SLinus Torvalds 	0,
3461da177e4SLinus Torvalds 	SAR_GP_EESCLK,
3471da177e4SLinus Torvalds 	0,
3481da177e4SLinus Torvalds 	SAR_GP_EESCLK,
3491da177e4SLinus Torvalds 	0,
3501da177e4SLinus Torvalds 	SAR_GP_EESCLK,
3511da177e4SLinus Torvalds 	0
3521da177e4SLinus Torvalds };
3531da177e4SLinus Torvalds 
3541da177e4SLinus Torvalds static u32
3551da177e4SLinus Torvalds idt77252_read_gp(struct idt77252_dev *card)
3561da177e4SLinus Torvalds {
3571da177e4SLinus Torvalds 	u32 gp;
3581da177e4SLinus Torvalds 
3591da177e4SLinus Torvalds 	gp = readl(SAR_REG_GP);
3601da177e4SLinus Torvalds #if 0
3611da177e4SLinus Torvalds 	printk("RD: %s\n", gp & SAR_GP_EEDI ? "1" : "0");
3621da177e4SLinus Torvalds #endif
3631da177e4SLinus Torvalds 	return gp;
3641da177e4SLinus Torvalds }
3651da177e4SLinus Torvalds 
3661da177e4SLinus Torvalds static void
3671da177e4SLinus Torvalds idt77252_write_gp(struct idt77252_dev *card, u32 value)
3681da177e4SLinus Torvalds {
3691da177e4SLinus Torvalds 	unsigned long flags;
3701da177e4SLinus Torvalds 
3711da177e4SLinus Torvalds #if 0
3721da177e4SLinus Torvalds 	printk("WR: %s %s %s\n", value & SAR_GP_EECS ? "   " : "/CS",
3731da177e4SLinus Torvalds 	       value & SAR_GP_EESCLK ? "HIGH" : "LOW ",
3741da177e4SLinus Torvalds 	       value & SAR_GP_EEDO   ? "1" : "0");
3751da177e4SLinus Torvalds #endif
3761da177e4SLinus Torvalds 
3771da177e4SLinus Torvalds 	spin_lock_irqsave(&card->cmd_lock, flags);
3781da177e4SLinus Torvalds 	waitfor_idle(card);
3791da177e4SLinus Torvalds 	writel(value, SAR_REG_GP);
3801da177e4SLinus Torvalds 	spin_unlock_irqrestore(&card->cmd_lock, flags);
3811da177e4SLinus Torvalds }
3821da177e4SLinus Torvalds 
3831da177e4SLinus Torvalds static u8
3841da177e4SLinus Torvalds idt77252_eeprom_read_status(struct idt77252_dev *card)
3851da177e4SLinus Torvalds {
3861da177e4SLinus Torvalds 	u8 byte;
3871da177e4SLinus Torvalds 	u32 gp;
3881da177e4SLinus Torvalds 	int i, j;
3891da177e4SLinus Torvalds 
3901da177e4SLinus Torvalds 	gp = idt77252_read_gp(card) & ~(SAR_GP_EESCLK|SAR_GP_EECS|SAR_GP_EEDO);
3911da177e4SLinus Torvalds 
39236fe55d6SAhmed S. Darwish 	for (i = 0; i < ARRAY_SIZE(rdsrtab); i++) {
3931da177e4SLinus Torvalds 		idt77252_write_gp(card, gp | rdsrtab[i]);
3941da177e4SLinus Torvalds 		udelay(5);
3951da177e4SLinus Torvalds 	}
3961da177e4SLinus Torvalds 	idt77252_write_gp(card, gp | SAR_GP_EECS);
3971da177e4SLinus Torvalds 	udelay(5);
3981da177e4SLinus Torvalds 
3991da177e4SLinus Torvalds 	byte = 0;
4001da177e4SLinus Torvalds 	for (i = 0, j = 0; i < 8; i++) {
4011da177e4SLinus Torvalds 		byte <<= 1;
4021da177e4SLinus Torvalds 
4031da177e4SLinus Torvalds 		idt77252_write_gp(card, gp | clktab[j++]);
4041da177e4SLinus Torvalds 		udelay(5);
4051da177e4SLinus Torvalds 
4061da177e4SLinus Torvalds 		byte |= idt77252_read_gp(card) & SAR_GP_EEDI ? 1 : 0;
4071da177e4SLinus Torvalds 
4081da177e4SLinus Torvalds 		idt77252_write_gp(card, gp | clktab[j++]);
4091da177e4SLinus Torvalds 		udelay(5);
4101da177e4SLinus Torvalds 	}
4111da177e4SLinus Torvalds 	idt77252_write_gp(card, gp | SAR_GP_EECS);
4121da177e4SLinus Torvalds 	udelay(5);
4131da177e4SLinus Torvalds 
4141da177e4SLinus Torvalds 	return byte;
4151da177e4SLinus Torvalds }
4161da177e4SLinus Torvalds 
4171da177e4SLinus Torvalds static u8
4181da177e4SLinus Torvalds idt77252_eeprom_read_byte(struct idt77252_dev *card, u8 offset)
4191da177e4SLinus Torvalds {
4201da177e4SLinus Torvalds 	u8 byte;
4211da177e4SLinus Torvalds 	u32 gp;
4221da177e4SLinus Torvalds 	int i, j;
4231da177e4SLinus Torvalds 
4241da177e4SLinus Torvalds 	gp = idt77252_read_gp(card) & ~(SAR_GP_EESCLK|SAR_GP_EECS|SAR_GP_EEDO);
4251da177e4SLinus Torvalds 
42636fe55d6SAhmed S. Darwish 	for (i = 0; i < ARRAY_SIZE(rdtab); i++) {
4271da177e4SLinus Torvalds 		idt77252_write_gp(card, gp | rdtab[i]);
4281da177e4SLinus Torvalds 		udelay(5);
4291da177e4SLinus Torvalds 	}
4301da177e4SLinus Torvalds 	idt77252_write_gp(card, gp | SAR_GP_EECS);
4311da177e4SLinus Torvalds 	udelay(5);
4321da177e4SLinus Torvalds 
4331da177e4SLinus Torvalds 	for (i = 0, j = 0; i < 8; i++) {
4341da177e4SLinus Torvalds 		idt77252_write_gp(card, gp | clktab[j++] |
4351da177e4SLinus Torvalds 					(offset & 1 ? SAR_GP_EEDO : 0));
4361da177e4SLinus Torvalds 		udelay(5);
4371da177e4SLinus Torvalds 
4381da177e4SLinus Torvalds 		idt77252_write_gp(card, gp | clktab[j++] |
4391da177e4SLinus Torvalds 					(offset & 1 ? SAR_GP_EEDO : 0));
4401da177e4SLinus Torvalds 		udelay(5);
4411da177e4SLinus Torvalds 
4421da177e4SLinus Torvalds 		offset >>= 1;
4431da177e4SLinus Torvalds 	}
4441da177e4SLinus Torvalds 	idt77252_write_gp(card, gp | SAR_GP_EECS);
4451da177e4SLinus Torvalds 	udelay(5);
4461da177e4SLinus Torvalds 
4471da177e4SLinus Torvalds 	byte = 0;
4481da177e4SLinus Torvalds 	for (i = 0, j = 0; i < 8; i++) {
4491da177e4SLinus Torvalds 		byte <<= 1;
4501da177e4SLinus Torvalds 
4511da177e4SLinus Torvalds 		idt77252_write_gp(card, gp | clktab[j++]);
4521da177e4SLinus Torvalds 		udelay(5);
4531da177e4SLinus Torvalds 
4541da177e4SLinus Torvalds 		byte |= idt77252_read_gp(card) & SAR_GP_EEDI ? 1 : 0;
4551da177e4SLinus Torvalds 
4561da177e4SLinus Torvalds 		idt77252_write_gp(card, gp | clktab[j++]);
4571da177e4SLinus Torvalds 		udelay(5);
4581da177e4SLinus Torvalds 	}
4591da177e4SLinus Torvalds 	idt77252_write_gp(card, gp | SAR_GP_EECS);
4601da177e4SLinus Torvalds 	udelay(5);
4611da177e4SLinus Torvalds 
4621da177e4SLinus Torvalds 	return byte;
4631da177e4SLinus Torvalds }
4641da177e4SLinus Torvalds 
4651da177e4SLinus Torvalds static void
4661da177e4SLinus Torvalds idt77252_eeprom_write_byte(struct idt77252_dev *card, u8 offset, u8 data)
4671da177e4SLinus Torvalds {
4681da177e4SLinus Torvalds 	u32 gp;
4691da177e4SLinus Torvalds 	int i, j;
4701da177e4SLinus Torvalds 
4711da177e4SLinus Torvalds 	gp = idt77252_read_gp(card) & ~(SAR_GP_EESCLK|SAR_GP_EECS|SAR_GP_EEDO);
4721da177e4SLinus Torvalds 
47336fe55d6SAhmed S. Darwish 	for (i = 0; i < ARRAY_SIZE(wrentab); i++) {
4741da177e4SLinus Torvalds 		idt77252_write_gp(card, gp | wrentab[i]);
4751da177e4SLinus Torvalds 		udelay(5);
4761da177e4SLinus Torvalds 	}
4771da177e4SLinus Torvalds 	idt77252_write_gp(card, gp | SAR_GP_EECS);
4781da177e4SLinus Torvalds 	udelay(5);
4791da177e4SLinus Torvalds 
48036fe55d6SAhmed S. Darwish 	for (i = 0; i < ARRAY_SIZE(wrtab); i++) {
4811da177e4SLinus Torvalds 		idt77252_write_gp(card, gp | wrtab[i]);
4821da177e4SLinus Torvalds 		udelay(5);
4831da177e4SLinus Torvalds 	}
4841da177e4SLinus Torvalds 	idt77252_write_gp(card, gp | SAR_GP_EECS);
4851da177e4SLinus Torvalds 	udelay(5);
4861da177e4SLinus Torvalds 
4871da177e4SLinus Torvalds 	for (i = 0, j = 0; i < 8; i++) {
4881da177e4SLinus Torvalds 		idt77252_write_gp(card, gp | clktab[j++] |
4891da177e4SLinus Torvalds 					(offset & 1 ? SAR_GP_EEDO : 0));
4901da177e4SLinus Torvalds 		udelay(5);
4911da177e4SLinus Torvalds 
4921da177e4SLinus Torvalds 		idt77252_write_gp(card, gp | clktab[j++] |
4931da177e4SLinus Torvalds 					(offset & 1 ? SAR_GP_EEDO : 0));
4941da177e4SLinus Torvalds 		udelay(5);
4951da177e4SLinus Torvalds 
4961da177e4SLinus Torvalds 		offset >>= 1;
4971da177e4SLinus Torvalds 	}
4981da177e4SLinus Torvalds 	idt77252_write_gp(card, gp | SAR_GP_EECS);
4991da177e4SLinus Torvalds 	udelay(5);
5001da177e4SLinus Torvalds 
5011da177e4SLinus Torvalds 	for (i = 0, j = 0; i < 8; i++) {
5021da177e4SLinus Torvalds 		idt77252_write_gp(card, gp | clktab[j++] |
5031da177e4SLinus Torvalds 					(data & 1 ? SAR_GP_EEDO : 0));
5041da177e4SLinus Torvalds 		udelay(5);
5051da177e4SLinus Torvalds 
5061da177e4SLinus Torvalds 		idt77252_write_gp(card, gp | clktab[j++] |
5071da177e4SLinus Torvalds 					(data & 1 ? SAR_GP_EEDO : 0));
5081da177e4SLinus Torvalds 		udelay(5);
5091da177e4SLinus Torvalds 
5101da177e4SLinus Torvalds 		data >>= 1;
5111da177e4SLinus Torvalds 	}
5121da177e4SLinus Torvalds 	idt77252_write_gp(card, gp | SAR_GP_EECS);
5131da177e4SLinus Torvalds 	udelay(5);
5141da177e4SLinus Torvalds }
5151da177e4SLinus Torvalds 
5161da177e4SLinus Torvalds static void
5171da177e4SLinus Torvalds idt77252_eeprom_init(struct idt77252_dev *card)
5181da177e4SLinus Torvalds {
5191da177e4SLinus Torvalds 	u32 gp;
5201da177e4SLinus Torvalds 
5211da177e4SLinus Torvalds 	gp = idt77252_read_gp(card) & ~(SAR_GP_EESCLK|SAR_GP_EECS|SAR_GP_EEDO);
5221da177e4SLinus Torvalds 
5231da177e4SLinus Torvalds 	idt77252_write_gp(card, gp | SAR_GP_EECS | SAR_GP_EESCLK);
5241da177e4SLinus Torvalds 	udelay(5);
5251da177e4SLinus Torvalds 	idt77252_write_gp(card, gp | SAR_GP_EECS);
5261da177e4SLinus Torvalds 	udelay(5);
5271da177e4SLinus Torvalds 	idt77252_write_gp(card, gp | SAR_GP_EECS | SAR_GP_EESCLK);
5281da177e4SLinus Torvalds 	udelay(5);
5291da177e4SLinus Torvalds 	idt77252_write_gp(card, gp | SAR_GP_EECS);
5301da177e4SLinus Torvalds 	udelay(5);
5311da177e4SLinus Torvalds }
5321da177e4SLinus Torvalds #endif /* HAVE_EEPROM */
5331da177e4SLinus Torvalds 
5341da177e4SLinus Torvalds 
5351da177e4SLinus Torvalds #ifdef CONFIG_ATM_IDT77252_DEBUG
5361da177e4SLinus Torvalds static void
5371da177e4SLinus Torvalds dump_tct(struct idt77252_dev *card, int index)
5381da177e4SLinus Torvalds {
5391da177e4SLinus Torvalds 	unsigned long tct;
5401da177e4SLinus Torvalds 	int i;
5411da177e4SLinus Torvalds 
5421da177e4SLinus Torvalds 	tct = (unsigned long) (card->tct_base + index * SAR_SRAM_TCT_SIZE);
5431da177e4SLinus Torvalds 
5441da177e4SLinus Torvalds 	printk("%s: TCT %x:", card->name, index);
5451da177e4SLinus Torvalds 	for (i = 0; i < 8; i++) {
5461da177e4SLinus Torvalds 		printk(" %08x", read_sram(card, tct + i));
5471da177e4SLinus Torvalds 	}
5481da177e4SLinus Torvalds 	printk("\n");
5491da177e4SLinus Torvalds }
5501da177e4SLinus Torvalds 
5511da177e4SLinus Torvalds static void
5521da177e4SLinus Torvalds idt77252_tx_dump(struct idt77252_dev *card)
5531da177e4SLinus Torvalds {
5541da177e4SLinus Torvalds 	struct atm_vcc *vcc;
5551da177e4SLinus Torvalds 	struct vc_map *vc;
5561da177e4SLinus Torvalds 	int i;
5571da177e4SLinus Torvalds 
5581da177e4SLinus Torvalds 	printk("%s\n", __FUNCTION__);
5591da177e4SLinus Torvalds 	for (i = 0; i < card->tct_size; i++) {
5601da177e4SLinus Torvalds 		vc = card->vcs[i];
5611da177e4SLinus Torvalds 		if (!vc)
5621da177e4SLinus Torvalds 			continue;
5631da177e4SLinus Torvalds 
5641da177e4SLinus Torvalds 		vcc = NULL;
5651da177e4SLinus Torvalds 		if (vc->rx_vcc)
5661da177e4SLinus Torvalds 			vcc = vc->rx_vcc;
5671da177e4SLinus Torvalds 		else if (vc->tx_vcc)
5681da177e4SLinus Torvalds 			vcc = vc->tx_vcc;
5691da177e4SLinus Torvalds 
5701da177e4SLinus Torvalds 		if (!vcc)
5711da177e4SLinus Torvalds 			continue;
5721da177e4SLinus Torvalds 
5731da177e4SLinus Torvalds 		printk("%s: Connection %d:\n", card->name, vc->index);
5741da177e4SLinus Torvalds 		dump_tct(card, vc->index);
5751da177e4SLinus Torvalds 	}
5761da177e4SLinus Torvalds }
5771da177e4SLinus Torvalds #endif
5781da177e4SLinus Torvalds 
5791da177e4SLinus Torvalds 
5801da177e4SLinus Torvalds /*****************************************************************************/
5811da177e4SLinus Torvalds /*                                                                           */
5821da177e4SLinus Torvalds /* SCQ Handling                                                              */
5831da177e4SLinus Torvalds /*                                                                           */
5841da177e4SLinus Torvalds /*****************************************************************************/
5851da177e4SLinus Torvalds 
5861da177e4SLinus Torvalds static int
5871da177e4SLinus Torvalds sb_pool_add(struct idt77252_dev *card, struct sk_buff *skb, int queue)
5881da177e4SLinus Torvalds {
5891da177e4SLinus Torvalds 	struct sb_pool *pool = &card->sbpool[queue];
5901da177e4SLinus Torvalds 	int index;
5911da177e4SLinus Torvalds 
5921da177e4SLinus Torvalds 	index = pool->index;
5931da177e4SLinus Torvalds 	while (pool->skb[index]) {
5941da177e4SLinus Torvalds 		index = (index + 1) & FBQ_MASK;
5951da177e4SLinus Torvalds 		if (index == pool->index)
5961da177e4SLinus Torvalds 			return -ENOBUFS;
5971da177e4SLinus Torvalds 	}
5981da177e4SLinus Torvalds 
5991da177e4SLinus Torvalds 	pool->skb[index] = skb;
6001da177e4SLinus Torvalds 	IDT77252_PRV_POOL(skb) = POOL_HANDLE(queue, index);
6011da177e4SLinus Torvalds 
6021da177e4SLinus Torvalds 	pool->index = (index + 1) & FBQ_MASK;
6031da177e4SLinus Torvalds 	return 0;
6041da177e4SLinus Torvalds }
6051da177e4SLinus Torvalds 
6061da177e4SLinus Torvalds static void
6071da177e4SLinus Torvalds sb_pool_remove(struct idt77252_dev *card, struct sk_buff *skb)
6081da177e4SLinus Torvalds {
6091da177e4SLinus Torvalds 	unsigned int queue, index;
6101da177e4SLinus Torvalds 	u32 handle;
6111da177e4SLinus Torvalds 
6121da177e4SLinus Torvalds 	handle = IDT77252_PRV_POOL(skb);
6131da177e4SLinus Torvalds 
6141da177e4SLinus Torvalds 	queue = POOL_QUEUE(handle);
6151da177e4SLinus Torvalds 	if (queue > 3)
6161da177e4SLinus Torvalds 		return;
6171da177e4SLinus Torvalds 
6181da177e4SLinus Torvalds 	index = POOL_INDEX(handle);
6191da177e4SLinus Torvalds 	if (index > FBQ_SIZE - 1)
6201da177e4SLinus Torvalds 		return;
6211da177e4SLinus Torvalds 
6221da177e4SLinus Torvalds 	card->sbpool[queue].skb[index] = NULL;
6231da177e4SLinus Torvalds }
6241da177e4SLinus Torvalds 
6251da177e4SLinus Torvalds static struct sk_buff *
6261da177e4SLinus Torvalds sb_pool_skb(struct idt77252_dev *card, u32 handle)
6271da177e4SLinus Torvalds {
6281da177e4SLinus Torvalds 	unsigned int queue, index;
6291da177e4SLinus Torvalds 
6301da177e4SLinus Torvalds 	queue = POOL_QUEUE(handle);
6311da177e4SLinus Torvalds 	if (queue > 3)
6321da177e4SLinus Torvalds 		return NULL;
6331da177e4SLinus Torvalds 
6341da177e4SLinus Torvalds 	index = POOL_INDEX(handle);
6351da177e4SLinus Torvalds 	if (index > FBQ_SIZE - 1)
6361da177e4SLinus Torvalds 		return NULL;
6371da177e4SLinus Torvalds 
6381da177e4SLinus Torvalds 	return card->sbpool[queue].skb[index];
6391da177e4SLinus Torvalds }
6401da177e4SLinus Torvalds 
6411da177e4SLinus Torvalds static struct scq_info *
6421da177e4SLinus Torvalds alloc_scq(struct idt77252_dev *card, int class)
6431da177e4SLinus Torvalds {
6441da177e4SLinus Torvalds 	struct scq_info *scq;
6451da177e4SLinus Torvalds 
6460c1cca1dSOm Narasimhan 	scq = kzalloc(sizeof(struct scq_info), GFP_KERNEL);
6471da177e4SLinus Torvalds 	if (!scq)
6481da177e4SLinus Torvalds 		return NULL;
6491da177e4SLinus Torvalds 	scq->base = pci_alloc_consistent(card->pcidev, SCQ_SIZE,
6501da177e4SLinus Torvalds 					 &scq->paddr);
6511da177e4SLinus Torvalds 	if (scq->base == NULL) {
6521da177e4SLinus Torvalds 		kfree(scq);
6531da177e4SLinus Torvalds 		return NULL;
6541da177e4SLinus Torvalds 	}
6551da177e4SLinus Torvalds 	memset(scq->base, 0, SCQ_SIZE);
6561da177e4SLinus Torvalds 
6571da177e4SLinus Torvalds 	scq->next = scq->base;
6581da177e4SLinus Torvalds 	scq->last = scq->base + (SCQ_ENTRIES - 1);
6591da177e4SLinus Torvalds 	atomic_set(&scq->used, 0);
6601da177e4SLinus Torvalds 
6611da177e4SLinus Torvalds 	spin_lock_init(&scq->lock);
6621da177e4SLinus Torvalds 	spin_lock_init(&scq->skblock);
6631da177e4SLinus Torvalds 
6641da177e4SLinus Torvalds 	skb_queue_head_init(&scq->transmit);
6651da177e4SLinus Torvalds 	skb_queue_head_init(&scq->pending);
6661da177e4SLinus Torvalds 
6671da177e4SLinus Torvalds 	TXPRINTK("idt77252: SCQ: base 0x%p, next 0x%p, last 0x%p, paddr %08llx\n",
6681da177e4SLinus Torvalds 		 scq->base, scq->next, scq->last, (unsigned long long)scq->paddr);
6691da177e4SLinus Torvalds 
6701da177e4SLinus Torvalds 	return scq;
6711da177e4SLinus Torvalds }
6721da177e4SLinus Torvalds 
6731da177e4SLinus Torvalds static void
6741da177e4SLinus Torvalds free_scq(struct idt77252_dev *card, struct scq_info *scq)
6751da177e4SLinus Torvalds {
6761da177e4SLinus Torvalds 	struct sk_buff *skb;
6771da177e4SLinus Torvalds 	struct atm_vcc *vcc;
6781da177e4SLinus Torvalds 
6791da177e4SLinus Torvalds 	pci_free_consistent(card->pcidev, SCQ_SIZE,
6801da177e4SLinus Torvalds 			    scq->base, scq->paddr);
6811da177e4SLinus Torvalds 
6821da177e4SLinus Torvalds 	while ((skb = skb_dequeue(&scq->transmit))) {
6831da177e4SLinus Torvalds 		pci_unmap_single(card->pcidev, IDT77252_PRV_PADDR(skb),
6841da177e4SLinus Torvalds 				 skb->len, PCI_DMA_TODEVICE);
6851da177e4SLinus Torvalds 
6861da177e4SLinus Torvalds 		vcc = ATM_SKB(skb)->vcc;
6871da177e4SLinus Torvalds 		if (vcc->pop)
6881da177e4SLinus Torvalds 			vcc->pop(vcc, skb);
6891da177e4SLinus Torvalds 		else
6901da177e4SLinus Torvalds 			dev_kfree_skb(skb);
6911da177e4SLinus Torvalds 	}
6921da177e4SLinus Torvalds 
6931da177e4SLinus Torvalds 	while ((skb = skb_dequeue(&scq->pending))) {
6941da177e4SLinus Torvalds 		pci_unmap_single(card->pcidev, IDT77252_PRV_PADDR(skb),
6951da177e4SLinus Torvalds 				 skb->len, PCI_DMA_TODEVICE);
6961da177e4SLinus Torvalds 
6971da177e4SLinus Torvalds 		vcc = ATM_SKB(skb)->vcc;
6981da177e4SLinus Torvalds 		if (vcc->pop)
6991da177e4SLinus Torvalds 			vcc->pop(vcc, skb);
7001da177e4SLinus Torvalds 		else
7011da177e4SLinus Torvalds 			dev_kfree_skb(skb);
7021da177e4SLinus Torvalds 	}
7031da177e4SLinus Torvalds 
7041da177e4SLinus Torvalds 	kfree(scq);
7051da177e4SLinus Torvalds }
7061da177e4SLinus Torvalds 
7071da177e4SLinus Torvalds 
7081da177e4SLinus Torvalds static int
7091da177e4SLinus Torvalds push_on_scq(struct idt77252_dev *card, struct vc_map *vc, struct sk_buff *skb)
7101da177e4SLinus Torvalds {
7111da177e4SLinus Torvalds 	struct scq_info *scq = vc->scq;
7121da177e4SLinus Torvalds 	unsigned long flags;
7131da177e4SLinus Torvalds 	struct scqe *tbd;
7141da177e4SLinus Torvalds 	int entries;
7151da177e4SLinus Torvalds 
7161da177e4SLinus Torvalds 	TXPRINTK("%s: SCQ: next 0x%p\n", card->name, scq->next);
7171da177e4SLinus Torvalds 
7181da177e4SLinus Torvalds 	atomic_inc(&scq->used);
7191da177e4SLinus Torvalds 	entries = atomic_read(&scq->used);
7201da177e4SLinus Torvalds 	if (entries > (SCQ_ENTRIES - 1)) {
7211da177e4SLinus Torvalds 		atomic_dec(&scq->used);
7221da177e4SLinus Torvalds 		goto out;
7231da177e4SLinus Torvalds 	}
7241da177e4SLinus Torvalds 
7251da177e4SLinus Torvalds 	skb_queue_tail(&scq->transmit, skb);
7261da177e4SLinus Torvalds 
7271da177e4SLinus Torvalds 	spin_lock_irqsave(&vc->lock, flags);
7281da177e4SLinus Torvalds 	if (vc->estimator) {
7291da177e4SLinus Torvalds 		struct atm_vcc *vcc = vc->tx_vcc;
7301da177e4SLinus Torvalds 		struct sock *sk = sk_atm(vcc);
7311da177e4SLinus Torvalds 
7321da177e4SLinus Torvalds 		vc->estimator->cells += (skb->len + 47) / 48;
7331da177e4SLinus Torvalds 		if (atomic_read(&sk->sk_wmem_alloc) >
7341da177e4SLinus Torvalds 		    (sk->sk_sndbuf >> 1)) {
7351da177e4SLinus Torvalds 			u32 cps = vc->estimator->maxcps;
7361da177e4SLinus Torvalds 
7371da177e4SLinus Torvalds 			vc->estimator->cps = cps;
7381da177e4SLinus Torvalds 			vc->estimator->avcps = cps << 5;
7391da177e4SLinus Torvalds 			if (vc->lacr < vc->init_er) {
7401da177e4SLinus Torvalds 				vc->lacr = vc->init_er;
7411da177e4SLinus Torvalds 				writel(TCMDQ_LACR | (vc->lacr << 16) |
7421da177e4SLinus Torvalds 				       vc->index, SAR_REG_TCMDQ);
7431da177e4SLinus Torvalds 			}
7441da177e4SLinus Torvalds 		}
7451da177e4SLinus Torvalds 	}
7461da177e4SLinus Torvalds 	spin_unlock_irqrestore(&vc->lock, flags);
7471da177e4SLinus Torvalds 
7481da177e4SLinus Torvalds 	tbd = &IDT77252_PRV_TBD(skb);
7491da177e4SLinus Torvalds 
7501da177e4SLinus Torvalds 	spin_lock_irqsave(&scq->lock, flags);
7511da177e4SLinus Torvalds 	scq->next->word_1 = cpu_to_le32(tbd->word_1 |
7521da177e4SLinus Torvalds 					SAR_TBD_TSIF | SAR_TBD_GTSI);
7531da177e4SLinus Torvalds 	scq->next->word_2 = cpu_to_le32(tbd->word_2);
7541da177e4SLinus Torvalds 	scq->next->word_3 = cpu_to_le32(tbd->word_3);
7551da177e4SLinus Torvalds 	scq->next->word_4 = cpu_to_le32(tbd->word_4);
7561da177e4SLinus Torvalds 
7571da177e4SLinus Torvalds 	if (scq->next == scq->last)
7581da177e4SLinus Torvalds 		scq->next = scq->base;
7591da177e4SLinus Torvalds 	else
7601da177e4SLinus Torvalds 		scq->next++;
7611da177e4SLinus Torvalds 
7621da177e4SLinus Torvalds 	write_sram(card, scq->scd,
7631da177e4SLinus Torvalds 		   scq->paddr +
7641da177e4SLinus Torvalds 		   (u32)((unsigned long)scq->next - (unsigned long)scq->base));
7651da177e4SLinus Torvalds 	spin_unlock_irqrestore(&scq->lock, flags);
7661da177e4SLinus Torvalds 
7671da177e4SLinus Torvalds 	scq->trans_start = jiffies;
7681da177e4SLinus Torvalds 
7691da177e4SLinus Torvalds 	if (test_and_clear_bit(VCF_IDLE, &vc->flags)) {
7701da177e4SLinus Torvalds 		writel(TCMDQ_START_LACR | (vc->lacr << 16) | vc->index,
7711da177e4SLinus Torvalds 		       SAR_REG_TCMDQ);
7721da177e4SLinus Torvalds 	}
7731da177e4SLinus Torvalds 
7741da177e4SLinus Torvalds 	TXPRINTK("%d entries in SCQ used (push).\n", atomic_read(&scq->used));
7751da177e4SLinus Torvalds 
7761da177e4SLinus Torvalds 	XPRINTK("%s: SCQ (after push %2d) head = 0x%x, next = 0x%p.\n",
7771da177e4SLinus Torvalds 		card->name, atomic_read(&scq->used),
7781da177e4SLinus Torvalds 		read_sram(card, scq->scd + 1), scq->next);
7791da177e4SLinus Torvalds 
7801da177e4SLinus Torvalds 	return 0;
7811da177e4SLinus Torvalds 
7821da177e4SLinus Torvalds out:
783e1bd232bSMarcelo Feitoza Parisi 	if (time_after(jiffies, scq->trans_start + HZ)) {
7841da177e4SLinus Torvalds 		printk("%s: Error pushing TBD for %d.%d\n",
7851da177e4SLinus Torvalds 		       card->name, vc->tx_vcc->vpi, vc->tx_vcc->vci);
7861da177e4SLinus Torvalds #ifdef CONFIG_ATM_IDT77252_DEBUG
7871da177e4SLinus Torvalds 		idt77252_tx_dump(card);
7881da177e4SLinus Torvalds #endif
7891da177e4SLinus Torvalds 		scq->trans_start = jiffies;
7901da177e4SLinus Torvalds 	}
7911da177e4SLinus Torvalds 
7921da177e4SLinus Torvalds 	return -ENOBUFS;
7931da177e4SLinus Torvalds }
7941da177e4SLinus Torvalds 
7951da177e4SLinus Torvalds 
7961da177e4SLinus Torvalds static void
7971da177e4SLinus Torvalds drain_scq(struct idt77252_dev *card, struct vc_map *vc)
7981da177e4SLinus Torvalds {
7991da177e4SLinus Torvalds 	struct scq_info *scq = vc->scq;
8001da177e4SLinus Torvalds 	struct sk_buff *skb;
8011da177e4SLinus Torvalds 	struct atm_vcc *vcc;
8021da177e4SLinus Torvalds 
8031da177e4SLinus Torvalds 	TXPRINTK("%s: SCQ (before drain %2d) next = 0x%p.\n",
8041da177e4SLinus Torvalds 		 card->name, atomic_read(&scq->used), scq->next);
8051da177e4SLinus Torvalds 
8061da177e4SLinus Torvalds 	skb = skb_dequeue(&scq->transmit);
8071da177e4SLinus Torvalds 	if (skb) {
8081da177e4SLinus Torvalds 		TXPRINTK("%s: freeing skb at %p.\n", card->name, skb);
8091da177e4SLinus Torvalds 
8101da177e4SLinus Torvalds 		pci_unmap_single(card->pcidev, IDT77252_PRV_PADDR(skb),
8111da177e4SLinus Torvalds 				 skb->len, PCI_DMA_TODEVICE);
8121da177e4SLinus Torvalds 
8131da177e4SLinus Torvalds 		vcc = ATM_SKB(skb)->vcc;
8141da177e4SLinus Torvalds 
8151da177e4SLinus Torvalds 		if (vcc->pop)
8161da177e4SLinus Torvalds 			vcc->pop(vcc, skb);
8171da177e4SLinus Torvalds 		else
8181da177e4SLinus Torvalds 			dev_kfree_skb(skb);
8191da177e4SLinus Torvalds 
8201da177e4SLinus Torvalds 		atomic_inc(&vcc->stats->tx);
8211da177e4SLinus Torvalds 	}
8221da177e4SLinus Torvalds 
8231da177e4SLinus Torvalds 	atomic_dec(&scq->used);
8241da177e4SLinus Torvalds 
8251da177e4SLinus Torvalds 	spin_lock(&scq->skblock);
8261da177e4SLinus Torvalds 	while ((skb = skb_dequeue(&scq->pending))) {
8271da177e4SLinus Torvalds 		if (push_on_scq(card, vc, skb)) {
8281da177e4SLinus Torvalds 			skb_queue_head(&vc->scq->pending, skb);
8291da177e4SLinus Torvalds 			break;
8301da177e4SLinus Torvalds 		}
8311da177e4SLinus Torvalds 	}
8321da177e4SLinus Torvalds 	spin_unlock(&scq->skblock);
8331da177e4SLinus Torvalds }
8341da177e4SLinus Torvalds 
8351da177e4SLinus Torvalds static int
8361da177e4SLinus Torvalds queue_skb(struct idt77252_dev *card, struct vc_map *vc,
8371da177e4SLinus Torvalds 	  struct sk_buff *skb, int oam)
8381da177e4SLinus Torvalds {
8391da177e4SLinus Torvalds 	struct atm_vcc *vcc;
8401da177e4SLinus Torvalds 	struct scqe *tbd;
8411da177e4SLinus Torvalds 	unsigned long flags;
8421da177e4SLinus Torvalds 	int error;
8431da177e4SLinus Torvalds 	int aal;
8441da177e4SLinus Torvalds 
8451da177e4SLinus Torvalds 	if (skb->len == 0) {
8461da177e4SLinus Torvalds 		printk("%s: invalid skb->len (%d)\n", card->name, skb->len);
8471da177e4SLinus Torvalds 		return -EINVAL;
8481da177e4SLinus Torvalds 	}
8491da177e4SLinus Torvalds 
8501da177e4SLinus Torvalds 	TXPRINTK("%s: Sending %d bytes of data.\n",
8511da177e4SLinus Torvalds 		 card->name, skb->len);
8521da177e4SLinus Torvalds 
8531da177e4SLinus Torvalds 	tbd = &IDT77252_PRV_TBD(skb);
8541da177e4SLinus Torvalds 	vcc = ATM_SKB(skb)->vcc;
8551da177e4SLinus Torvalds 
8561da177e4SLinus Torvalds 	IDT77252_PRV_PADDR(skb) = pci_map_single(card->pcidev, skb->data,
8571da177e4SLinus Torvalds 						 skb->len, PCI_DMA_TODEVICE);
8581da177e4SLinus Torvalds 
8591da177e4SLinus Torvalds 	error = -EINVAL;
8601da177e4SLinus Torvalds 
8611da177e4SLinus Torvalds 	if (oam) {
8621da177e4SLinus Torvalds 		if (skb->len != 52)
8631da177e4SLinus Torvalds 			goto errout;
8641da177e4SLinus Torvalds 
8651da177e4SLinus Torvalds 		tbd->word_1 = SAR_TBD_OAM | ATM_CELL_PAYLOAD | SAR_TBD_EPDU;
8661da177e4SLinus Torvalds 		tbd->word_2 = IDT77252_PRV_PADDR(skb) + 4;
8671da177e4SLinus Torvalds 		tbd->word_3 = 0x00000000;
8681da177e4SLinus Torvalds 		tbd->word_4 = (skb->data[0] << 24) | (skb->data[1] << 16) |
8691da177e4SLinus Torvalds 			      (skb->data[2] <<  8) | (skb->data[3] <<  0);
8701da177e4SLinus Torvalds 
8711da177e4SLinus Torvalds 		if (test_bit(VCF_RSV, &vc->flags))
8721da177e4SLinus Torvalds 			vc = card->vcs[0];
8731da177e4SLinus Torvalds 
8741da177e4SLinus Torvalds 		goto done;
8751da177e4SLinus Torvalds 	}
8761da177e4SLinus Torvalds 
8771da177e4SLinus Torvalds 	if (test_bit(VCF_RSV, &vc->flags)) {
8781da177e4SLinus Torvalds 		printk("%s: Trying to transmit on reserved VC\n", card->name);
8791da177e4SLinus Torvalds 		goto errout;
8801da177e4SLinus Torvalds 	}
8811da177e4SLinus Torvalds 
8821da177e4SLinus Torvalds 	aal = vcc->qos.aal;
8831da177e4SLinus Torvalds 
8841da177e4SLinus Torvalds 	switch (aal) {
8851da177e4SLinus Torvalds 	case ATM_AAL0:
8861da177e4SLinus Torvalds 	case ATM_AAL34:
8871da177e4SLinus Torvalds 		if (skb->len > 52)
8881da177e4SLinus Torvalds 			goto errout;
8891da177e4SLinus Torvalds 
8901da177e4SLinus Torvalds 		if (aal == ATM_AAL0)
8911da177e4SLinus Torvalds 			tbd->word_1 = SAR_TBD_EPDU | SAR_TBD_AAL0 |
8921da177e4SLinus Torvalds 				      ATM_CELL_PAYLOAD;
8931da177e4SLinus Torvalds 		else
8941da177e4SLinus Torvalds 			tbd->word_1 = SAR_TBD_EPDU | SAR_TBD_AAL34 |
8951da177e4SLinus Torvalds 				      ATM_CELL_PAYLOAD;
8961da177e4SLinus Torvalds 
8971da177e4SLinus Torvalds 		tbd->word_2 = IDT77252_PRV_PADDR(skb) + 4;
8981da177e4SLinus Torvalds 		tbd->word_3 = 0x00000000;
8991da177e4SLinus Torvalds 		tbd->word_4 = (skb->data[0] << 24) | (skb->data[1] << 16) |
9001da177e4SLinus Torvalds 			      (skb->data[2] <<  8) | (skb->data[3] <<  0);
9011da177e4SLinus Torvalds 		break;
9021da177e4SLinus Torvalds 
9031da177e4SLinus Torvalds 	case ATM_AAL5:
9041da177e4SLinus Torvalds 		tbd->word_1 = SAR_TBD_EPDU | SAR_TBD_AAL5 | skb->len;
9051da177e4SLinus Torvalds 		tbd->word_2 = IDT77252_PRV_PADDR(skb);
9061da177e4SLinus Torvalds 		tbd->word_3 = skb->len;
9071da177e4SLinus Torvalds 		tbd->word_4 = (vcc->vpi << SAR_TBD_VPI_SHIFT) |
9081da177e4SLinus Torvalds 			      (vcc->vci << SAR_TBD_VCI_SHIFT);
9091da177e4SLinus Torvalds 		break;
9101da177e4SLinus Torvalds 
9111da177e4SLinus Torvalds 	case ATM_AAL1:
9121da177e4SLinus Torvalds 	case ATM_AAL2:
9131da177e4SLinus Torvalds 	default:
9141da177e4SLinus Torvalds 		printk("%s: Traffic type not supported.\n", card->name);
9151da177e4SLinus Torvalds 		error = -EPROTONOSUPPORT;
9161da177e4SLinus Torvalds 		goto errout;
9171da177e4SLinus Torvalds 	}
9181da177e4SLinus Torvalds 
9191da177e4SLinus Torvalds done:
9201da177e4SLinus Torvalds 	spin_lock_irqsave(&vc->scq->skblock, flags);
9211da177e4SLinus Torvalds 	skb_queue_tail(&vc->scq->pending, skb);
9221da177e4SLinus Torvalds 
9231da177e4SLinus Torvalds 	while ((skb = skb_dequeue(&vc->scq->pending))) {
9241da177e4SLinus Torvalds 		if (push_on_scq(card, vc, skb)) {
9251da177e4SLinus Torvalds 			skb_queue_head(&vc->scq->pending, skb);
9261da177e4SLinus Torvalds 			break;
9271da177e4SLinus Torvalds 		}
9281da177e4SLinus Torvalds 	}
9291da177e4SLinus Torvalds 	spin_unlock_irqrestore(&vc->scq->skblock, flags);
9301da177e4SLinus Torvalds 
9311da177e4SLinus Torvalds 	return 0;
9321da177e4SLinus Torvalds 
9331da177e4SLinus Torvalds errout:
9341da177e4SLinus Torvalds 	pci_unmap_single(card->pcidev, IDT77252_PRV_PADDR(skb),
9351da177e4SLinus Torvalds 			 skb->len, PCI_DMA_TODEVICE);
9361da177e4SLinus Torvalds 	return error;
9371da177e4SLinus Torvalds }
9381da177e4SLinus Torvalds 
9391da177e4SLinus Torvalds static unsigned long
9401da177e4SLinus Torvalds get_free_scd(struct idt77252_dev *card, struct vc_map *vc)
9411da177e4SLinus Torvalds {
9421da177e4SLinus Torvalds 	int i;
9431da177e4SLinus Torvalds 
9441da177e4SLinus Torvalds 	for (i = 0; i < card->scd_size; i++) {
9451da177e4SLinus Torvalds 		if (!card->scd2vc[i]) {
9461da177e4SLinus Torvalds 			card->scd2vc[i] = vc;
9471da177e4SLinus Torvalds 			vc->scd_index = i;
9481da177e4SLinus Torvalds 			return card->scd_base + i * SAR_SRAM_SCD_SIZE;
9491da177e4SLinus Torvalds 		}
9501da177e4SLinus Torvalds 	}
9511da177e4SLinus Torvalds 	return 0;
9521da177e4SLinus Torvalds }
9531da177e4SLinus Torvalds 
9541da177e4SLinus Torvalds static void
9551da177e4SLinus Torvalds fill_scd(struct idt77252_dev *card, struct scq_info *scq, int class)
9561da177e4SLinus Torvalds {
9571da177e4SLinus Torvalds 	write_sram(card, scq->scd, scq->paddr);
9581da177e4SLinus Torvalds 	write_sram(card, scq->scd + 1, 0x00000000);
9591da177e4SLinus Torvalds 	write_sram(card, scq->scd + 2, 0xffffffff);
9601da177e4SLinus Torvalds 	write_sram(card, scq->scd + 3, 0x00000000);
9611da177e4SLinus Torvalds }
9621da177e4SLinus Torvalds 
9631da177e4SLinus Torvalds static void
9641da177e4SLinus Torvalds clear_scd(struct idt77252_dev *card, struct scq_info *scq, int class)
9651da177e4SLinus Torvalds {
9661da177e4SLinus Torvalds 	return;
9671da177e4SLinus Torvalds }
9681da177e4SLinus Torvalds 
9691da177e4SLinus Torvalds /*****************************************************************************/
9701da177e4SLinus Torvalds /*                                                                           */
9711da177e4SLinus Torvalds /* RSQ Handling                                                              */
9721da177e4SLinus Torvalds /*                                                                           */
9731da177e4SLinus Torvalds /*****************************************************************************/
9741da177e4SLinus Torvalds 
9751da177e4SLinus Torvalds static int
9761da177e4SLinus Torvalds init_rsq(struct idt77252_dev *card)
9771da177e4SLinus Torvalds {
9781da177e4SLinus Torvalds 	struct rsq_entry *rsqe;
9791da177e4SLinus Torvalds 
9801da177e4SLinus Torvalds 	card->rsq.base = pci_alloc_consistent(card->pcidev, RSQSIZE,
9811da177e4SLinus Torvalds 					      &card->rsq.paddr);
9821da177e4SLinus Torvalds 	if (card->rsq.base == NULL) {
9831da177e4SLinus Torvalds 		printk("%s: can't allocate RSQ.\n", card->name);
9841da177e4SLinus Torvalds 		return -1;
9851da177e4SLinus Torvalds 	}
9861da177e4SLinus Torvalds 	memset(card->rsq.base, 0, RSQSIZE);
9871da177e4SLinus Torvalds 
9881da177e4SLinus Torvalds 	card->rsq.last = card->rsq.base + RSQ_NUM_ENTRIES - 1;
9891da177e4SLinus Torvalds 	card->rsq.next = card->rsq.last;
9901da177e4SLinus Torvalds 	for (rsqe = card->rsq.base; rsqe <= card->rsq.last; rsqe++)
9911da177e4SLinus Torvalds 		rsqe->word_4 = 0;
9921da177e4SLinus Torvalds 
9931da177e4SLinus Torvalds 	writel((unsigned long) card->rsq.last - (unsigned long) card->rsq.base,
9941da177e4SLinus Torvalds 	       SAR_REG_RSQH);
9951da177e4SLinus Torvalds 	writel(card->rsq.paddr, SAR_REG_RSQB);
9961da177e4SLinus Torvalds 
9971da177e4SLinus Torvalds 	IPRINTK("%s: RSQ base at 0x%lx (0x%x).\n", card->name,
9981da177e4SLinus Torvalds 		(unsigned long) card->rsq.base,
9991da177e4SLinus Torvalds 		readl(SAR_REG_RSQB));
10001da177e4SLinus Torvalds 	IPRINTK("%s: RSQ head = 0x%x, base = 0x%x, tail = 0x%x.\n",
10011da177e4SLinus Torvalds 		card->name,
10021da177e4SLinus Torvalds 		readl(SAR_REG_RSQH),
10031da177e4SLinus Torvalds 		readl(SAR_REG_RSQB),
10041da177e4SLinus Torvalds 		readl(SAR_REG_RSQT));
10051da177e4SLinus Torvalds 
10061da177e4SLinus Torvalds 	return 0;
10071da177e4SLinus Torvalds }
10081da177e4SLinus Torvalds 
10091da177e4SLinus Torvalds static void
10101da177e4SLinus Torvalds deinit_rsq(struct idt77252_dev *card)
10111da177e4SLinus Torvalds {
10121da177e4SLinus Torvalds 	pci_free_consistent(card->pcidev, RSQSIZE,
10131da177e4SLinus Torvalds 			    card->rsq.base, card->rsq.paddr);
10141da177e4SLinus Torvalds }
10151da177e4SLinus Torvalds 
10161da177e4SLinus Torvalds static void
10171da177e4SLinus Torvalds dequeue_rx(struct idt77252_dev *card, struct rsq_entry *rsqe)
10181da177e4SLinus Torvalds {
10191da177e4SLinus Torvalds 	struct atm_vcc *vcc;
10201da177e4SLinus Torvalds 	struct sk_buff *skb;
10211da177e4SLinus Torvalds 	struct rx_pool *rpp;
10221da177e4SLinus Torvalds 	struct vc_map *vc;
10231da177e4SLinus Torvalds 	u32 header, vpi, vci;
10241da177e4SLinus Torvalds 	u32 stat;
10251da177e4SLinus Torvalds 	int i;
10261da177e4SLinus Torvalds 
10271da177e4SLinus Torvalds 	stat = le32_to_cpu(rsqe->word_4);
10281da177e4SLinus Torvalds 
10291da177e4SLinus Torvalds 	if (stat & SAR_RSQE_IDLE) {
10301da177e4SLinus Torvalds 		RXPRINTK("%s: message about inactive connection.\n",
10311da177e4SLinus Torvalds 			 card->name);
10321da177e4SLinus Torvalds 		return;
10331da177e4SLinus Torvalds 	}
10341da177e4SLinus Torvalds 
10351da177e4SLinus Torvalds 	skb = sb_pool_skb(card, le32_to_cpu(rsqe->word_2));
10361da177e4SLinus Torvalds 	if (skb == NULL) {
10371da177e4SLinus Torvalds 		printk("%s: NULL skb in %s, rsqe: %08x %08x %08x %08x\n",
10381da177e4SLinus Torvalds 		       card->name, __FUNCTION__,
10391da177e4SLinus Torvalds 		       le32_to_cpu(rsqe->word_1), le32_to_cpu(rsqe->word_2),
10401da177e4SLinus Torvalds 		       le32_to_cpu(rsqe->word_3), le32_to_cpu(rsqe->word_4));
10411da177e4SLinus Torvalds 		return;
10421da177e4SLinus Torvalds 	}
10431da177e4SLinus Torvalds 
10441da177e4SLinus Torvalds 	header = le32_to_cpu(rsqe->word_1);
10451da177e4SLinus Torvalds 	vpi = (header >> 16) & 0x00ff;
10461da177e4SLinus Torvalds 	vci = (header >>  0) & 0xffff;
10471da177e4SLinus Torvalds 
10481da177e4SLinus Torvalds 	RXPRINTK("%s: SDU for %d.%d received in buffer 0x%p (data 0x%p).\n",
10491da177e4SLinus Torvalds 		 card->name, vpi, vci, skb, skb->data);
10501da177e4SLinus Torvalds 
10511da177e4SLinus Torvalds 	if ((vpi >= (1 << card->vpibits)) || (vci != (vci & card->vcimask))) {
10521da177e4SLinus Torvalds 		printk("%s: SDU received for out-of-range vc %u.%u\n",
10531da177e4SLinus Torvalds 		       card->name, vpi, vci);
10541da177e4SLinus Torvalds 		recycle_rx_skb(card, skb);
10551da177e4SLinus Torvalds 		return;
10561da177e4SLinus Torvalds 	}
10571da177e4SLinus Torvalds 
10581da177e4SLinus Torvalds 	vc = card->vcs[VPCI2VC(card, vpi, vci)];
10591da177e4SLinus Torvalds 	if (!vc || !test_bit(VCF_RX, &vc->flags)) {
10601da177e4SLinus Torvalds 		printk("%s: SDU received on non RX vc %u.%u\n",
10611da177e4SLinus Torvalds 		       card->name, vpi, vci);
10621da177e4SLinus Torvalds 		recycle_rx_skb(card, skb);
10631da177e4SLinus Torvalds 		return;
10641da177e4SLinus Torvalds 	}
10651da177e4SLinus Torvalds 
10661da177e4SLinus Torvalds 	vcc = vc->rx_vcc;
10671da177e4SLinus Torvalds 
10681da177e4SLinus Torvalds 	pci_dma_sync_single_for_cpu(card->pcidev, IDT77252_PRV_PADDR(skb),
10694305b541SArnaldo Carvalho de Melo 				    skb_end_pointer(skb) - skb->data,
10704305b541SArnaldo Carvalho de Melo 				    PCI_DMA_FROMDEVICE);
10711da177e4SLinus Torvalds 
10721da177e4SLinus Torvalds 	if ((vcc->qos.aal == ATM_AAL0) ||
10731da177e4SLinus Torvalds 	    (vcc->qos.aal == ATM_AAL34)) {
10741da177e4SLinus Torvalds 		struct sk_buff *sb;
10751da177e4SLinus Torvalds 		unsigned char *cell;
10761da177e4SLinus Torvalds 		u32 aal0;
10771da177e4SLinus Torvalds 
10781da177e4SLinus Torvalds 		cell = skb->data;
10791da177e4SLinus Torvalds 		for (i = (stat & SAR_RSQE_CELLCNT); i; i--) {
10801da177e4SLinus Torvalds 			if ((sb = dev_alloc_skb(64)) == NULL) {
10811da177e4SLinus Torvalds 				printk("%s: Can't allocate buffers for aal0.\n",
10821da177e4SLinus Torvalds 				       card->name);
10831da177e4SLinus Torvalds 				atomic_add(i, &vcc->stats->rx_drop);
10841da177e4SLinus Torvalds 				break;
10851da177e4SLinus Torvalds 			}
10861da177e4SLinus Torvalds 			if (!atm_charge(vcc, sb->truesize)) {
10871da177e4SLinus Torvalds 				RXPRINTK("%s: atm_charge() dropped aal0 packets.\n",
10881da177e4SLinus Torvalds 					 card->name);
10891da177e4SLinus Torvalds 				atomic_add(i - 1, &vcc->stats->rx_drop);
10901da177e4SLinus Torvalds 				dev_kfree_skb(sb);
10911da177e4SLinus Torvalds 				break;
10921da177e4SLinus Torvalds 			}
10931da177e4SLinus Torvalds 			aal0 = (vpi << ATM_HDR_VPI_SHIFT) |
10941da177e4SLinus Torvalds 			       (vci << ATM_HDR_VCI_SHIFT);
10951da177e4SLinus Torvalds 			aal0 |= (stat & SAR_RSQE_EPDU) ? 0x00000002 : 0;
10961da177e4SLinus Torvalds 			aal0 |= (stat & SAR_RSQE_CLP)  ? 0x00000001 : 0;
10971da177e4SLinus Torvalds 
10981da177e4SLinus Torvalds 			*((u32 *) sb->data) = aal0;
10991da177e4SLinus Torvalds 			skb_put(sb, sizeof(u32));
11001da177e4SLinus Torvalds 			memcpy(skb_put(sb, ATM_CELL_PAYLOAD),
11011da177e4SLinus Torvalds 			       cell, ATM_CELL_PAYLOAD);
11021da177e4SLinus Torvalds 
11031da177e4SLinus Torvalds 			ATM_SKB(sb)->vcc = vcc;
1104a61bbcf2SPatrick McHardy 			__net_timestamp(sb);
11051da177e4SLinus Torvalds 			vcc->push(vcc, sb);
11061da177e4SLinus Torvalds 			atomic_inc(&vcc->stats->rx);
11071da177e4SLinus Torvalds 
11081da177e4SLinus Torvalds 			cell += ATM_CELL_PAYLOAD;
11091da177e4SLinus Torvalds 		}
11101da177e4SLinus Torvalds 
11111da177e4SLinus Torvalds 		recycle_rx_skb(card, skb);
11121da177e4SLinus Torvalds 		return;
11131da177e4SLinus Torvalds 	}
11141da177e4SLinus Torvalds 	if (vcc->qos.aal != ATM_AAL5) {
11151da177e4SLinus Torvalds 		printk("%s: Unexpected AAL type in dequeue_rx(): %d.\n",
11161da177e4SLinus Torvalds 		       card->name, vcc->qos.aal);
11171da177e4SLinus Torvalds 		recycle_rx_skb(card, skb);
11181da177e4SLinus Torvalds 		return;
11191da177e4SLinus Torvalds 	}
11201da177e4SLinus Torvalds 	skb->len = (stat & SAR_RSQE_CELLCNT) * ATM_CELL_PAYLOAD;
11211da177e4SLinus Torvalds 
11221da177e4SLinus Torvalds 	rpp = &vc->rcv.rx_pool;
11231da177e4SLinus Torvalds 
11241da177e4SLinus Torvalds 	rpp->len += skb->len;
11251da177e4SLinus Torvalds 	if (!rpp->count++)
11261da177e4SLinus Torvalds 		rpp->first = skb;
11271da177e4SLinus Torvalds 	*rpp->last = skb;
11281da177e4SLinus Torvalds 	rpp->last = &skb->next;
11291da177e4SLinus Torvalds 
11301da177e4SLinus Torvalds 	if (stat & SAR_RSQE_EPDU) {
11311da177e4SLinus Torvalds 		unsigned char *l1l2;
11321da177e4SLinus Torvalds 		unsigned int len;
11331da177e4SLinus Torvalds 
11341da177e4SLinus Torvalds 		l1l2 = (unsigned char *) ((unsigned long) skb->data + skb->len - 6);
11351da177e4SLinus Torvalds 
11361da177e4SLinus Torvalds 		len = (l1l2[0] << 8) | l1l2[1];
11371da177e4SLinus Torvalds 		len = len ? len : 0x10000;
11381da177e4SLinus Torvalds 
11391da177e4SLinus Torvalds 		RXPRINTK("%s: PDU has %d bytes.\n", card->name, len);
11401da177e4SLinus Torvalds 
11411da177e4SLinus Torvalds 		if ((len + 8 > rpp->len) || (len + (47 + 8) < rpp->len)) {
11421da177e4SLinus Torvalds 			RXPRINTK("%s: AAL5 PDU size mismatch: %d != %d. "
11431da177e4SLinus Torvalds 			         "(CDC: %08x)\n",
11441da177e4SLinus Torvalds 			         card->name, len, rpp->len, readl(SAR_REG_CDC));
11451da177e4SLinus Torvalds 			recycle_rx_pool_skb(card, rpp);
11461da177e4SLinus Torvalds 			atomic_inc(&vcc->stats->rx_err);
11471da177e4SLinus Torvalds 			return;
11481da177e4SLinus Torvalds 		}
11491da177e4SLinus Torvalds 		if (stat & SAR_RSQE_CRC) {
11501da177e4SLinus Torvalds 			RXPRINTK("%s: AAL5 CRC error.\n", card->name);
11511da177e4SLinus Torvalds 			recycle_rx_pool_skb(card, rpp);
11521da177e4SLinus Torvalds 			atomic_inc(&vcc->stats->rx_err);
11531da177e4SLinus Torvalds 			return;
11541da177e4SLinus Torvalds 		}
11551da177e4SLinus Torvalds 		if (rpp->count > 1) {
11561da177e4SLinus Torvalds 			struct sk_buff *sb;
11571da177e4SLinus Torvalds 
11581da177e4SLinus Torvalds 			skb = dev_alloc_skb(rpp->len);
11591da177e4SLinus Torvalds 			if (!skb) {
11601da177e4SLinus Torvalds 				RXPRINTK("%s: Can't alloc RX skb.\n",
11611da177e4SLinus Torvalds 					 card->name);
11621da177e4SLinus Torvalds 				recycle_rx_pool_skb(card, rpp);
11631da177e4SLinus Torvalds 				atomic_inc(&vcc->stats->rx_err);
11641da177e4SLinus Torvalds 				return;
11651da177e4SLinus Torvalds 			}
11661da177e4SLinus Torvalds 			if (!atm_charge(vcc, skb->truesize)) {
11671da177e4SLinus Torvalds 				recycle_rx_pool_skb(card, rpp);
11681da177e4SLinus Torvalds 				dev_kfree_skb(skb);
11691da177e4SLinus Torvalds 				return;
11701da177e4SLinus Torvalds 			}
11711da177e4SLinus Torvalds 			sb = rpp->first;
11721da177e4SLinus Torvalds 			for (i = 0; i < rpp->count; i++) {
11731da177e4SLinus Torvalds 				memcpy(skb_put(skb, sb->len),
11741da177e4SLinus Torvalds 				       sb->data, sb->len);
11751da177e4SLinus Torvalds 				sb = sb->next;
11761da177e4SLinus Torvalds 			}
11771da177e4SLinus Torvalds 
11781da177e4SLinus Torvalds 			recycle_rx_pool_skb(card, rpp);
11791da177e4SLinus Torvalds 
11801da177e4SLinus Torvalds 			skb_trim(skb, len);
11811da177e4SLinus Torvalds 			ATM_SKB(skb)->vcc = vcc;
1182a61bbcf2SPatrick McHardy 			__net_timestamp(skb);
11831da177e4SLinus Torvalds 
11841da177e4SLinus Torvalds 			vcc->push(vcc, skb);
11851da177e4SLinus Torvalds 			atomic_inc(&vcc->stats->rx);
11861da177e4SLinus Torvalds 
11871da177e4SLinus Torvalds 			return;
11881da177e4SLinus Torvalds 		}
11891da177e4SLinus Torvalds 
11901da177e4SLinus Torvalds 		skb->next = NULL;
11911da177e4SLinus Torvalds 		flush_rx_pool(card, rpp);
11921da177e4SLinus Torvalds 
11931da177e4SLinus Torvalds 		if (!atm_charge(vcc, skb->truesize)) {
11941da177e4SLinus Torvalds 			recycle_rx_skb(card, skb);
11951da177e4SLinus Torvalds 			return;
11961da177e4SLinus Torvalds 		}
11971da177e4SLinus Torvalds 
11981da177e4SLinus Torvalds 		pci_unmap_single(card->pcidev, IDT77252_PRV_PADDR(skb),
11994305b541SArnaldo Carvalho de Melo 				 skb_end_pointer(skb) - skb->data,
12004305b541SArnaldo Carvalho de Melo 				 PCI_DMA_FROMDEVICE);
12011da177e4SLinus Torvalds 		sb_pool_remove(card, skb);
12021da177e4SLinus Torvalds 
12031da177e4SLinus Torvalds 		skb_trim(skb, len);
12041da177e4SLinus Torvalds 		ATM_SKB(skb)->vcc = vcc;
1205a61bbcf2SPatrick McHardy 		__net_timestamp(skb);
12061da177e4SLinus Torvalds 
12071da177e4SLinus Torvalds 		vcc->push(vcc, skb);
12081da177e4SLinus Torvalds 		atomic_inc(&vcc->stats->rx);
12091da177e4SLinus Torvalds 
12101da177e4SLinus Torvalds 		if (skb->truesize > SAR_FB_SIZE_3)
12111da177e4SLinus Torvalds 			add_rx_skb(card, 3, SAR_FB_SIZE_3, 1);
12121da177e4SLinus Torvalds 		else if (skb->truesize > SAR_FB_SIZE_2)
12131da177e4SLinus Torvalds 			add_rx_skb(card, 2, SAR_FB_SIZE_2, 1);
12141da177e4SLinus Torvalds 		else if (skb->truesize > SAR_FB_SIZE_1)
12151da177e4SLinus Torvalds 			add_rx_skb(card, 1, SAR_FB_SIZE_1, 1);
12161da177e4SLinus Torvalds 		else
12171da177e4SLinus Torvalds 			add_rx_skb(card, 0, SAR_FB_SIZE_0, 1);
12181da177e4SLinus Torvalds 		return;
12191da177e4SLinus Torvalds 	}
12201da177e4SLinus Torvalds }
12211da177e4SLinus Torvalds 
12221da177e4SLinus Torvalds static void
12231da177e4SLinus Torvalds idt77252_rx(struct idt77252_dev *card)
12241da177e4SLinus Torvalds {
12251da177e4SLinus Torvalds 	struct rsq_entry *rsqe;
12261da177e4SLinus Torvalds 
12271da177e4SLinus Torvalds 	if (card->rsq.next == card->rsq.last)
12281da177e4SLinus Torvalds 		rsqe = card->rsq.base;
12291da177e4SLinus Torvalds 	else
12301da177e4SLinus Torvalds 		rsqe = card->rsq.next + 1;
12311da177e4SLinus Torvalds 
12321da177e4SLinus Torvalds 	if (!(le32_to_cpu(rsqe->word_4) & SAR_RSQE_VALID)) {
12331da177e4SLinus Torvalds 		RXPRINTK("%s: no entry in RSQ.\n", card->name);
12341da177e4SLinus Torvalds 		return;
12351da177e4SLinus Torvalds 	}
12361da177e4SLinus Torvalds 
12371da177e4SLinus Torvalds 	do {
12381da177e4SLinus Torvalds 		dequeue_rx(card, rsqe);
12391da177e4SLinus Torvalds 		rsqe->word_4 = 0;
12401da177e4SLinus Torvalds 		card->rsq.next = rsqe;
12411da177e4SLinus Torvalds 		if (card->rsq.next == card->rsq.last)
12421da177e4SLinus Torvalds 			rsqe = card->rsq.base;
12431da177e4SLinus Torvalds 		else
12441da177e4SLinus Torvalds 			rsqe = card->rsq.next + 1;
12451da177e4SLinus Torvalds 	} while (le32_to_cpu(rsqe->word_4) & SAR_RSQE_VALID);
12461da177e4SLinus Torvalds 
12471da177e4SLinus Torvalds 	writel((unsigned long) card->rsq.next - (unsigned long) card->rsq.base,
12481da177e4SLinus Torvalds 	       SAR_REG_RSQH);
12491da177e4SLinus Torvalds }
12501da177e4SLinus Torvalds 
12511da177e4SLinus Torvalds static void
12521da177e4SLinus Torvalds idt77252_rx_raw(struct idt77252_dev *card)
12531da177e4SLinus Torvalds {
12541da177e4SLinus Torvalds 	struct sk_buff	*queue;
12551da177e4SLinus Torvalds 	u32		head, tail;
12561da177e4SLinus Torvalds 	struct atm_vcc	*vcc;
12571da177e4SLinus Torvalds 	struct vc_map	*vc;
12581da177e4SLinus Torvalds 	struct sk_buff	*sb;
12591da177e4SLinus Torvalds 
12601da177e4SLinus Torvalds 	if (card->raw_cell_head == NULL) {
12611da177e4SLinus Torvalds 		u32 handle = le32_to_cpu(*(card->raw_cell_hnd + 1));
12621da177e4SLinus Torvalds 		card->raw_cell_head = sb_pool_skb(card, handle);
12631da177e4SLinus Torvalds 	}
12641da177e4SLinus Torvalds 
12651da177e4SLinus Torvalds 	queue = card->raw_cell_head;
12661da177e4SLinus Torvalds 	if (!queue)
12671da177e4SLinus Torvalds 		return;
12681da177e4SLinus Torvalds 
12691da177e4SLinus Torvalds 	head = IDT77252_PRV_PADDR(queue) + (queue->data - queue->head - 16);
12701da177e4SLinus Torvalds 	tail = readl(SAR_REG_RAWCT);
12711da177e4SLinus Torvalds 
12721da177e4SLinus Torvalds 	pci_dma_sync_single_for_cpu(card->pcidev, IDT77252_PRV_PADDR(queue),
12734305b541SArnaldo Carvalho de Melo 				    skb_end_pointer(queue) - queue->head - 16,
12741da177e4SLinus Torvalds 				    PCI_DMA_FROMDEVICE);
12751da177e4SLinus Torvalds 
12761da177e4SLinus Torvalds 	while (head != tail) {
12771da177e4SLinus Torvalds 		unsigned int vpi, vci, pti;
12781da177e4SLinus Torvalds 		u32 header;
12791da177e4SLinus Torvalds 
12801da177e4SLinus Torvalds 		header = le32_to_cpu(*(u32 *) &queue->data[0]);
12811da177e4SLinus Torvalds 
12821da177e4SLinus Torvalds 		vpi = (header & ATM_HDR_VPI_MASK) >> ATM_HDR_VPI_SHIFT;
12831da177e4SLinus Torvalds 		vci = (header & ATM_HDR_VCI_MASK) >> ATM_HDR_VCI_SHIFT;
12841da177e4SLinus Torvalds 		pti = (header & ATM_HDR_PTI_MASK) >> ATM_HDR_PTI_SHIFT;
12851da177e4SLinus Torvalds 
12861da177e4SLinus Torvalds #ifdef CONFIG_ATM_IDT77252_DEBUG
12871da177e4SLinus Torvalds 		if (debug & DBG_RAW_CELL) {
12881da177e4SLinus Torvalds 			int i;
12891da177e4SLinus Torvalds 
12901da177e4SLinus Torvalds 			printk("%s: raw cell %x.%02x.%04x.%x.%x\n",
12911da177e4SLinus Torvalds 			       card->name, (header >> 28) & 0x000f,
12921da177e4SLinus Torvalds 			       (header >> 20) & 0x00ff,
12931da177e4SLinus Torvalds 			       (header >>  4) & 0xffff,
12941da177e4SLinus Torvalds 			       (header >>  1) & 0x0007,
12951da177e4SLinus Torvalds 			       (header >>  0) & 0x0001);
12961da177e4SLinus Torvalds 			for (i = 16; i < 64; i++)
12971da177e4SLinus Torvalds 				printk(" %02x", queue->data[i]);
12981da177e4SLinus Torvalds 			printk("\n");
12991da177e4SLinus Torvalds 		}
13001da177e4SLinus Torvalds #endif
13011da177e4SLinus Torvalds 
13021da177e4SLinus Torvalds 		if (vpi >= (1<<card->vpibits) || vci >= (1<<card->vcibits)) {
13031da177e4SLinus Torvalds 			RPRINTK("%s: SDU received for out-of-range vc %u.%u\n",
13041da177e4SLinus Torvalds 				card->name, vpi, vci);
13051da177e4SLinus Torvalds 			goto drop;
13061da177e4SLinus Torvalds 		}
13071da177e4SLinus Torvalds 
13081da177e4SLinus Torvalds 		vc = card->vcs[VPCI2VC(card, vpi, vci)];
13091da177e4SLinus Torvalds 		if (!vc || !test_bit(VCF_RX, &vc->flags)) {
13101da177e4SLinus Torvalds 			RPRINTK("%s: SDU received on non RX vc %u.%u\n",
13111da177e4SLinus Torvalds 				card->name, vpi, vci);
13121da177e4SLinus Torvalds 			goto drop;
13131da177e4SLinus Torvalds 		}
13141da177e4SLinus Torvalds 
13151da177e4SLinus Torvalds 		vcc = vc->rx_vcc;
13161da177e4SLinus Torvalds 
13171da177e4SLinus Torvalds 		if (vcc->qos.aal != ATM_AAL0) {
13181da177e4SLinus Torvalds 			RPRINTK("%s: raw cell for non AAL0 vc %u.%u\n",
13191da177e4SLinus Torvalds 				card->name, vpi, vci);
13201da177e4SLinus Torvalds 			atomic_inc(&vcc->stats->rx_drop);
13211da177e4SLinus Torvalds 			goto drop;
13221da177e4SLinus Torvalds 		}
13231da177e4SLinus Torvalds 
13241da177e4SLinus Torvalds 		if ((sb = dev_alloc_skb(64)) == NULL) {
13251da177e4SLinus Torvalds 			printk("%s: Can't allocate buffers for AAL0.\n",
13261da177e4SLinus Torvalds 			       card->name);
13271da177e4SLinus Torvalds 			atomic_inc(&vcc->stats->rx_err);
13281da177e4SLinus Torvalds 			goto drop;
13291da177e4SLinus Torvalds 		}
13301da177e4SLinus Torvalds 
13311da177e4SLinus Torvalds 		if (!atm_charge(vcc, sb->truesize)) {
13321da177e4SLinus Torvalds 			RXPRINTK("%s: atm_charge() dropped AAL0 packets.\n",
13331da177e4SLinus Torvalds 				 card->name);
13341da177e4SLinus Torvalds 			dev_kfree_skb(sb);
13351da177e4SLinus Torvalds 			goto drop;
13361da177e4SLinus Torvalds 		}
13371da177e4SLinus Torvalds 
13381da177e4SLinus Torvalds 		*((u32 *) sb->data) = header;
13391da177e4SLinus Torvalds 		skb_put(sb, sizeof(u32));
13401da177e4SLinus Torvalds 		memcpy(skb_put(sb, ATM_CELL_PAYLOAD), &(queue->data[16]),
13411da177e4SLinus Torvalds 		       ATM_CELL_PAYLOAD);
13421da177e4SLinus Torvalds 
13431da177e4SLinus Torvalds 		ATM_SKB(sb)->vcc = vcc;
1344a61bbcf2SPatrick McHardy 		__net_timestamp(sb);
13451da177e4SLinus Torvalds 		vcc->push(vcc, sb);
13461da177e4SLinus Torvalds 		atomic_inc(&vcc->stats->rx);
13471da177e4SLinus Torvalds 
13481da177e4SLinus Torvalds drop:
13491da177e4SLinus Torvalds 		skb_pull(queue, 64);
13501da177e4SLinus Torvalds 
13511da177e4SLinus Torvalds 		head = IDT77252_PRV_PADDR(queue)
13521da177e4SLinus Torvalds 					+ (queue->data - queue->head - 16);
13531da177e4SLinus Torvalds 
13541da177e4SLinus Torvalds 		if (queue->len < 128) {
13551da177e4SLinus Torvalds 			struct sk_buff *next;
13561da177e4SLinus Torvalds 			u32 handle;
13571da177e4SLinus Torvalds 
13581da177e4SLinus Torvalds 			head = le32_to_cpu(*(u32 *) &queue->data[0]);
13591da177e4SLinus Torvalds 			handle = le32_to_cpu(*(u32 *) &queue->data[4]);
13601da177e4SLinus Torvalds 
13611da177e4SLinus Torvalds 			next = sb_pool_skb(card, handle);
13621da177e4SLinus Torvalds 			recycle_rx_skb(card, queue);
13631da177e4SLinus Torvalds 
13641da177e4SLinus Torvalds 			if (next) {
13651da177e4SLinus Torvalds 				card->raw_cell_head = next;
13661da177e4SLinus Torvalds 				queue = card->raw_cell_head;
13671da177e4SLinus Torvalds 				pci_dma_sync_single_for_cpu(card->pcidev,
13681da177e4SLinus Torvalds 							    IDT77252_PRV_PADDR(queue),
13694305b541SArnaldo Carvalho de Melo 							    (skb_end_pointer(queue) -
13704305b541SArnaldo Carvalho de Melo 							     queue->data),
13711da177e4SLinus Torvalds 							    PCI_DMA_FROMDEVICE);
13721da177e4SLinus Torvalds 			} else {
13731da177e4SLinus Torvalds 				card->raw_cell_head = NULL;
13741da177e4SLinus Torvalds 				printk("%s: raw cell queue overrun\n",
13751da177e4SLinus Torvalds 				       card->name);
13761da177e4SLinus Torvalds 				break;
13771da177e4SLinus Torvalds 			}
13781da177e4SLinus Torvalds 		}
13791da177e4SLinus Torvalds 	}
13801da177e4SLinus Torvalds }
13811da177e4SLinus Torvalds 
13821da177e4SLinus Torvalds 
13831da177e4SLinus Torvalds /*****************************************************************************/
13841da177e4SLinus Torvalds /*                                                                           */
13851da177e4SLinus Torvalds /* TSQ Handling                                                              */
13861da177e4SLinus Torvalds /*                                                                           */
13871da177e4SLinus Torvalds /*****************************************************************************/
13881da177e4SLinus Torvalds 
13891da177e4SLinus Torvalds static int
13901da177e4SLinus Torvalds init_tsq(struct idt77252_dev *card)
13911da177e4SLinus Torvalds {
13921da177e4SLinus Torvalds 	struct tsq_entry *tsqe;
13931da177e4SLinus Torvalds 
13941da177e4SLinus Torvalds 	card->tsq.base = pci_alloc_consistent(card->pcidev, RSQSIZE,
13951da177e4SLinus Torvalds 					      &card->tsq.paddr);
13961da177e4SLinus Torvalds 	if (card->tsq.base == NULL) {
13971da177e4SLinus Torvalds 		printk("%s: can't allocate TSQ.\n", card->name);
13981da177e4SLinus Torvalds 		return -1;
13991da177e4SLinus Torvalds 	}
14001da177e4SLinus Torvalds 	memset(card->tsq.base, 0, TSQSIZE);
14011da177e4SLinus Torvalds 
14021da177e4SLinus Torvalds 	card->tsq.last = card->tsq.base + TSQ_NUM_ENTRIES - 1;
14031da177e4SLinus Torvalds 	card->tsq.next = card->tsq.last;
14041da177e4SLinus Torvalds 	for (tsqe = card->tsq.base; tsqe <= card->tsq.last; tsqe++)
14051da177e4SLinus Torvalds 		tsqe->word_2 = cpu_to_le32(SAR_TSQE_INVALID);
14061da177e4SLinus Torvalds 
14071da177e4SLinus Torvalds 	writel(card->tsq.paddr, SAR_REG_TSQB);
14081da177e4SLinus Torvalds 	writel((unsigned long) card->tsq.next - (unsigned long) card->tsq.base,
14091da177e4SLinus Torvalds 	       SAR_REG_TSQH);
14101da177e4SLinus Torvalds 
14111da177e4SLinus Torvalds 	return 0;
14121da177e4SLinus Torvalds }
14131da177e4SLinus Torvalds 
14141da177e4SLinus Torvalds static void
14151da177e4SLinus Torvalds deinit_tsq(struct idt77252_dev *card)
14161da177e4SLinus Torvalds {
14171da177e4SLinus Torvalds 	pci_free_consistent(card->pcidev, TSQSIZE,
14181da177e4SLinus Torvalds 			    card->tsq.base, card->tsq.paddr);
14191da177e4SLinus Torvalds }
14201da177e4SLinus Torvalds 
14211da177e4SLinus Torvalds static void
14221da177e4SLinus Torvalds idt77252_tx(struct idt77252_dev *card)
14231da177e4SLinus Torvalds {
14241da177e4SLinus Torvalds 	struct tsq_entry *tsqe;
14251da177e4SLinus Torvalds 	unsigned int vpi, vci;
14261da177e4SLinus Torvalds 	struct vc_map *vc;
14271da177e4SLinus Torvalds 	u32 conn, stat;
14281da177e4SLinus Torvalds 
14291da177e4SLinus Torvalds 	if (card->tsq.next == card->tsq.last)
14301da177e4SLinus Torvalds 		tsqe = card->tsq.base;
14311da177e4SLinus Torvalds 	else
14321da177e4SLinus Torvalds 		tsqe = card->tsq.next + 1;
14331da177e4SLinus Torvalds 
14341da177e4SLinus Torvalds 	TXPRINTK("idt77252_tx: tsq  %p: base %p, next %p, last %p\n", tsqe,
14351da177e4SLinus Torvalds 		 card->tsq.base, card->tsq.next, card->tsq.last);
14361da177e4SLinus Torvalds 	TXPRINTK("idt77252_tx: tsqb %08x, tsqt %08x, tsqh %08x, \n",
14371da177e4SLinus Torvalds 		 readl(SAR_REG_TSQB),
14381da177e4SLinus Torvalds 		 readl(SAR_REG_TSQT),
14391da177e4SLinus Torvalds 		 readl(SAR_REG_TSQH));
14401da177e4SLinus Torvalds 
14411da177e4SLinus Torvalds 	stat = le32_to_cpu(tsqe->word_2);
14421da177e4SLinus Torvalds 
14431da177e4SLinus Torvalds 	if (stat & SAR_TSQE_INVALID)
14441da177e4SLinus Torvalds 		return;
14451da177e4SLinus Torvalds 
14461da177e4SLinus Torvalds 	do {
14471da177e4SLinus Torvalds 		TXPRINTK("tsqe: 0x%p [0x%08x 0x%08x]\n", tsqe,
14481da177e4SLinus Torvalds 			 le32_to_cpu(tsqe->word_1),
14491da177e4SLinus Torvalds 			 le32_to_cpu(tsqe->word_2));
14501da177e4SLinus Torvalds 
14511da177e4SLinus Torvalds 		switch (stat & SAR_TSQE_TYPE) {
14521da177e4SLinus Torvalds 		case SAR_TSQE_TYPE_TIMER:
14531da177e4SLinus Torvalds 			TXPRINTK("%s: Timer RollOver detected.\n", card->name);
14541da177e4SLinus Torvalds 			break;
14551da177e4SLinus Torvalds 
14561da177e4SLinus Torvalds 		case SAR_TSQE_TYPE_IDLE:
14571da177e4SLinus Torvalds 
14581da177e4SLinus Torvalds 			conn = le32_to_cpu(tsqe->word_1);
14591da177e4SLinus Torvalds 
14601da177e4SLinus Torvalds 			if (SAR_TSQE_TAG(stat) == 0x10) {
14611da177e4SLinus Torvalds #ifdef	NOTDEF
14621da177e4SLinus Torvalds 				printk("%s: Connection %d halted.\n",
14631da177e4SLinus Torvalds 				       card->name,
14641da177e4SLinus Torvalds 				       le32_to_cpu(tsqe->word_1) & 0x1fff);
14651da177e4SLinus Torvalds #endif
14661da177e4SLinus Torvalds 				break;
14671da177e4SLinus Torvalds 			}
14681da177e4SLinus Torvalds 
14691da177e4SLinus Torvalds 			vc = card->vcs[conn & 0x1fff];
14701da177e4SLinus Torvalds 			if (!vc) {
14711da177e4SLinus Torvalds 				printk("%s: could not find VC from conn %d\n",
14721da177e4SLinus Torvalds 				       card->name, conn & 0x1fff);
14731da177e4SLinus Torvalds 				break;
14741da177e4SLinus Torvalds 			}
14751da177e4SLinus Torvalds 
14761da177e4SLinus Torvalds 			printk("%s: Connection %d IDLE.\n",
14771da177e4SLinus Torvalds 			       card->name, vc->index);
14781da177e4SLinus Torvalds 
14791da177e4SLinus Torvalds 			set_bit(VCF_IDLE, &vc->flags);
14801da177e4SLinus Torvalds 			break;
14811da177e4SLinus Torvalds 
14821da177e4SLinus Torvalds 		case SAR_TSQE_TYPE_TSR:
14831da177e4SLinus Torvalds 
14841da177e4SLinus Torvalds 			conn = le32_to_cpu(tsqe->word_1);
14851da177e4SLinus Torvalds 
14861da177e4SLinus Torvalds 			vc = card->vcs[conn & 0x1fff];
14871da177e4SLinus Torvalds 			if (!vc) {
14881da177e4SLinus Torvalds 				printk("%s: no VC at index %d\n",
14891da177e4SLinus Torvalds 				       card->name,
14901da177e4SLinus Torvalds 				       le32_to_cpu(tsqe->word_1) & 0x1fff);
14911da177e4SLinus Torvalds 				break;
14921da177e4SLinus Torvalds 			}
14931da177e4SLinus Torvalds 
14941da177e4SLinus Torvalds 			drain_scq(card, vc);
14951da177e4SLinus Torvalds 			break;
14961da177e4SLinus Torvalds 
14971da177e4SLinus Torvalds 		case SAR_TSQE_TYPE_TBD_COMP:
14981da177e4SLinus Torvalds 
14991da177e4SLinus Torvalds 			conn = le32_to_cpu(tsqe->word_1);
15001da177e4SLinus Torvalds 
15011da177e4SLinus Torvalds 			vpi = (conn >> SAR_TBD_VPI_SHIFT) & 0x00ff;
15021da177e4SLinus Torvalds 			vci = (conn >> SAR_TBD_VCI_SHIFT) & 0xffff;
15031da177e4SLinus Torvalds 
15041da177e4SLinus Torvalds 			if (vpi >= (1 << card->vpibits) ||
15051da177e4SLinus Torvalds 			    vci >= (1 << card->vcibits)) {
15061da177e4SLinus Torvalds 				printk("%s: TBD complete: "
15071da177e4SLinus Torvalds 				       "out of range VPI.VCI %u.%u\n",
15081da177e4SLinus Torvalds 				       card->name, vpi, vci);
15091da177e4SLinus Torvalds 				break;
15101da177e4SLinus Torvalds 			}
15111da177e4SLinus Torvalds 
15121da177e4SLinus Torvalds 			vc = card->vcs[VPCI2VC(card, vpi, vci)];
15131da177e4SLinus Torvalds 			if (!vc) {
15141da177e4SLinus Torvalds 				printk("%s: TBD complete: "
15151da177e4SLinus Torvalds 				       "no VC at VPI.VCI %u.%u\n",
15161da177e4SLinus Torvalds 				       card->name, vpi, vci);
15171da177e4SLinus Torvalds 				break;
15181da177e4SLinus Torvalds 			}
15191da177e4SLinus Torvalds 
15201da177e4SLinus Torvalds 			drain_scq(card, vc);
15211da177e4SLinus Torvalds 			break;
15221da177e4SLinus Torvalds 		}
15231da177e4SLinus Torvalds 
15241da177e4SLinus Torvalds 		tsqe->word_2 = cpu_to_le32(SAR_TSQE_INVALID);
15251da177e4SLinus Torvalds 
15261da177e4SLinus Torvalds 		card->tsq.next = tsqe;
15271da177e4SLinus Torvalds 		if (card->tsq.next == card->tsq.last)
15281da177e4SLinus Torvalds 			tsqe = card->tsq.base;
15291da177e4SLinus Torvalds 		else
15301da177e4SLinus Torvalds 			tsqe = card->tsq.next + 1;
15311da177e4SLinus Torvalds 
15321da177e4SLinus Torvalds 		TXPRINTK("tsqe: %p: base %p, next %p, last %p\n", tsqe,
15331da177e4SLinus Torvalds 			 card->tsq.base, card->tsq.next, card->tsq.last);
15341da177e4SLinus Torvalds 
15351da177e4SLinus Torvalds 		stat = le32_to_cpu(tsqe->word_2);
15361da177e4SLinus Torvalds 
15371da177e4SLinus Torvalds 	} while (!(stat & SAR_TSQE_INVALID));
15381da177e4SLinus Torvalds 
15391da177e4SLinus Torvalds 	writel((unsigned long)card->tsq.next - (unsigned long)card->tsq.base,
15401da177e4SLinus Torvalds 	       SAR_REG_TSQH);
15411da177e4SLinus Torvalds 
15421da177e4SLinus Torvalds 	XPRINTK("idt77252_tx-after writel%d: TSQ head = 0x%x, tail = 0x%x, next = 0x%p.\n",
15431da177e4SLinus Torvalds 		card->index, readl(SAR_REG_TSQH),
15441da177e4SLinus Torvalds 		readl(SAR_REG_TSQT), card->tsq.next);
15451da177e4SLinus Torvalds }
15461da177e4SLinus Torvalds 
15471da177e4SLinus Torvalds 
15481da177e4SLinus Torvalds static void
15491da177e4SLinus Torvalds tst_timer(unsigned long data)
15501da177e4SLinus Torvalds {
15511da177e4SLinus Torvalds 	struct idt77252_dev *card = (struct idt77252_dev *)data;
15521da177e4SLinus Torvalds 	unsigned long base, idle, jump;
15531da177e4SLinus Torvalds 	unsigned long flags;
15541da177e4SLinus Torvalds 	u32 pc;
15551da177e4SLinus Torvalds 	int e;
15561da177e4SLinus Torvalds 
15571da177e4SLinus Torvalds 	spin_lock_irqsave(&card->tst_lock, flags);
15581da177e4SLinus Torvalds 
15591da177e4SLinus Torvalds 	base = card->tst[card->tst_index];
15601da177e4SLinus Torvalds 	idle = card->tst[card->tst_index ^ 1];
15611da177e4SLinus Torvalds 
15621da177e4SLinus Torvalds 	if (test_bit(TST_SWITCH_WAIT, &card->tst_state)) {
15631da177e4SLinus Torvalds 		jump = base + card->tst_size - 2;
15641da177e4SLinus Torvalds 
15651da177e4SLinus Torvalds 		pc = readl(SAR_REG_NOW) >> 2;
15661da177e4SLinus Torvalds 		if ((pc ^ idle) & ~(card->tst_size - 1)) {
15671da177e4SLinus Torvalds 			mod_timer(&card->tst_timer, jiffies + 1);
15681da177e4SLinus Torvalds 			goto out;
15691da177e4SLinus Torvalds 		}
15701da177e4SLinus Torvalds 
15711da177e4SLinus Torvalds 		clear_bit(TST_SWITCH_WAIT, &card->tst_state);
15721da177e4SLinus Torvalds 
15731da177e4SLinus Torvalds 		card->tst_index ^= 1;
15741da177e4SLinus Torvalds 		write_sram(card, jump, TSTE_OPC_JMP | (base << 2));
15751da177e4SLinus Torvalds 
15761da177e4SLinus Torvalds 		base = card->tst[card->tst_index];
15771da177e4SLinus Torvalds 		idle = card->tst[card->tst_index ^ 1];
15781da177e4SLinus Torvalds 
15791da177e4SLinus Torvalds 		for (e = 0; e < card->tst_size - 2; e++) {
15801da177e4SLinus Torvalds 			if (card->soft_tst[e].tste & TSTE_PUSH_IDLE) {
15811da177e4SLinus Torvalds 				write_sram(card, idle + e,
15821da177e4SLinus Torvalds 					   card->soft_tst[e].tste & TSTE_MASK);
15831da177e4SLinus Torvalds 				card->soft_tst[e].tste &= ~(TSTE_PUSH_IDLE);
15841da177e4SLinus Torvalds 			}
15851da177e4SLinus Torvalds 		}
15861da177e4SLinus Torvalds 	}
15871da177e4SLinus Torvalds 
15881da177e4SLinus Torvalds 	if (test_and_clear_bit(TST_SWITCH_PENDING, &card->tst_state)) {
15891da177e4SLinus Torvalds 
15901da177e4SLinus Torvalds 		for (e = 0; e < card->tst_size - 2; e++) {
15911da177e4SLinus Torvalds 			if (card->soft_tst[e].tste & TSTE_PUSH_ACTIVE) {
15921da177e4SLinus Torvalds 				write_sram(card, idle + e,
15931da177e4SLinus Torvalds 					   card->soft_tst[e].tste & TSTE_MASK);
15941da177e4SLinus Torvalds 				card->soft_tst[e].tste &= ~(TSTE_PUSH_ACTIVE);
15951da177e4SLinus Torvalds 				card->soft_tst[e].tste |= TSTE_PUSH_IDLE;
15961da177e4SLinus Torvalds 			}
15971da177e4SLinus Torvalds 		}
15981da177e4SLinus Torvalds 
15991da177e4SLinus Torvalds 		jump = base + card->tst_size - 2;
16001da177e4SLinus Torvalds 
16011da177e4SLinus Torvalds 		write_sram(card, jump, TSTE_OPC_NULL);
16021da177e4SLinus Torvalds 		set_bit(TST_SWITCH_WAIT, &card->tst_state);
16031da177e4SLinus Torvalds 
16041da177e4SLinus Torvalds 		mod_timer(&card->tst_timer, jiffies + 1);
16051da177e4SLinus Torvalds 	}
16061da177e4SLinus Torvalds 
16071da177e4SLinus Torvalds out:
16081da177e4SLinus Torvalds 	spin_unlock_irqrestore(&card->tst_lock, flags);
16091da177e4SLinus Torvalds }
16101da177e4SLinus Torvalds 
16111da177e4SLinus Torvalds static int
16121da177e4SLinus Torvalds __fill_tst(struct idt77252_dev *card, struct vc_map *vc,
16131da177e4SLinus Torvalds 	   int n, unsigned int opc)
16141da177e4SLinus Torvalds {
16151da177e4SLinus Torvalds 	unsigned long cl, avail;
16161da177e4SLinus Torvalds 	unsigned long idle;
16171da177e4SLinus Torvalds 	int e, r;
16181da177e4SLinus Torvalds 	u32 data;
16191da177e4SLinus Torvalds 
16201da177e4SLinus Torvalds 	avail = card->tst_size - 2;
16211da177e4SLinus Torvalds 	for (e = 0; e < avail; e++) {
16221da177e4SLinus Torvalds 		if (card->soft_tst[e].vc == NULL)
16231da177e4SLinus Torvalds 			break;
16241da177e4SLinus Torvalds 	}
16251da177e4SLinus Torvalds 	if (e >= avail) {
16261da177e4SLinus Torvalds 		printk("%s: No free TST entries found\n", card->name);
16271da177e4SLinus Torvalds 		return -1;
16281da177e4SLinus Torvalds 	}
16291da177e4SLinus Torvalds 
16301da177e4SLinus Torvalds 	NPRINTK("%s: conn %d: first TST entry at %d.\n",
16311da177e4SLinus Torvalds 		card->name, vc ? vc->index : -1, e);
16321da177e4SLinus Torvalds 
16331da177e4SLinus Torvalds 	r = n;
16341da177e4SLinus Torvalds 	cl = avail;
16351da177e4SLinus Torvalds 	data = opc & TSTE_OPC_MASK;
16361da177e4SLinus Torvalds 	if (vc && (opc != TSTE_OPC_NULL))
16371da177e4SLinus Torvalds 		data = opc | vc->index;
16381da177e4SLinus Torvalds 
16391da177e4SLinus Torvalds 	idle = card->tst[card->tst_index ^ 1];
16401da177e4SLinus Torvalds 
16411da177e4SLinus Torvalds 	/*
16421da177e4SLinus Torvalds 	 * Fill Soft TST.
16431da177e4SLinus Torvalds 	 */
16441da177e4SLinus Torvalds 	while (r > 0) {
16451da177e4SLinus Torvalds 		if ((cl >= avail) && (card->soft_tst[e].vc == NULL)) {
16461da177e4SLinus Torvalds 			if (vc)
16471da177e4SLinus Torvalds 				card->soft_tst[e].vc = vc;
16481da177e4SLinus Torvalds 			else
16491da177e4SLinus Torvalds 				card->soft_tst[e].vc = (void *)-1;
16501da177e4SLinus Torvalds 
16511da177e4SLinus Torvalds 			card->soft_tst[e].tste = data;
16521da177e4SLinus Torvalds 			if (timer_pending(&card->tst_timer))
16531da177e4SLinus Torvalds 				card->soft_tst[e].tste |= TSTE_PUSH_ACTIVE;
16541da177e4SLinus Torvalds 			else {
16551da177e4SLinus Torvalds 				write_sram(card, idle + e, data);
16561da177e4SLinus Torvalds 				card->soft_tst[e].tste |= TSTE_PUSH_IDLE;
16571da177e4SLinus Torvalds 			}
16581da177e4SLinus Torvalds 
16591da177e4SLinus Torvalds 			cl -= card->tst_size;
16601da177e4SLinus Torvalds 			r--;
16611da177e4SLinus Torvalds 		}
16621da177e4SLinus Torvalds 
16631da177e4SLinus Torvalds 		if (++e == avail)
16641da177e4SLinus Torvalds 			e = 0;
16651da177e4SLinus Torvalds 		cl += n;
16661da177e4SLinus Torvalds 	}
16671da177e4SLinus Torvalds 
16681da177e4SLinus Torvalds 	return 0;
16691da177e4SLinus Torvalds }
16701da177e4SLinus Torvalds 
16711da177e4SLinus Torvalds static int
16721da177e4SLinus Torvalds fill_tst(struct idt77252_dev *card, struct vc_map *vc, int n, unsigned int opc)
16731da177e4SLinus Torvalds {
16741da177e4SLinus Torvalds 	unsigned long flags;
16751da177e4SLinus Torvalds 	int res;
16761da177e4SLinus Torvalds 
16771da177e4SLinus Torvalds 	spin_lock_irqsave(&card->tst_lock, flags);
16781da177e4SLinus Torvalds 
16791da177e4SLinus Torvalds 	res = __fill_tst(card, vc, n, opc);
16801da177e4SLinus Torvalds 
16811da177e4SLinus Torvalds 	set_bit(TST_SWITCH_PENDING, &card->tst_state);
16821da177e4SLinus Torvalds 	if (!timer_pending(&card->tst_timer))
16831da177e4SLinus Torvalds 		mod_timer(&card->tst_timer, jiffies + 1);
16841da177e4SLinus Torvalds 
16851da177e4SLinus Torvalds 	spin_unlock_irqrestore(&card->tst_lock, flags);
16861da177e4SLinus Torvalds 	return res;
16871da177e4SLinus Torvalds }
16881da177e4SLinus Torvalds 
16891da177e4SLinus Torvalds static int
16901da177e4SLinus Torvalds __clear_tst(struct idt77252_dev *card, struct vc_map *vc)
16911da177e4SLinus Torvalds {
16921da177e4SLinus Torvalds 	unsigned long idle;
16931da177e4SLinus Torvalds 	int e;
16941da177e4SLinus Torvalds 
16951da177e4SLinus Torvalds 	idle = card->tst[card->tst_index ^ 1];
16961da177e4SLinus Torvalds 
16971da177e4SLinus Torvalds 	for (e = 0; e < card->tst_size - 2; e++) {
16981da177e4SLinus Torvalds 		if (card->soft_tst[e].vc == vc) {
16991da177e4SLinus Torvalds 			card->soft_tst[e].vc = NULL;
17001da177e4SLinus Torvalds 
17011da177e4SLinus Torvalds 			card->soft_tst[e].tste = TSTE_OPC_VAR;
17021da177e4SLinus Torvalds 			if (timer_pending(&card->tst_timer))
17031da177e4SLinus Torvalds 				card->soft_tst[e].tste |= TSTE_PUSH_ACTIVE;
17041da177e4SLinus Torvalds 			else {
17051da177e4SLinus Torvalds 				write_sram(card, idle + e, TSTE_OPC_VAR);
17061da177e4SLinus Torvalds 				card->soft_tst[e].tste |= TSTE_PUSH_IDLE;
17071da177e4SLinus Torvalds 			}
17081da177e4SLinus Torvalds 		}
17091da177e4SLinus Torvalds 	}
17101da177e4SLinus Torvalds 
17111da177e4SLinus Torvalds 	return 0;
17121da177e4SLinus Torvalds }
17131da177e4SLinus Torvalds 
17141da177e4SLinus Torvalds static int
17151da177e4SLinus Torvalds clear_tst(struct idt77252_dev *card, struct vc_map *vc)
17161da177e4SLinus Torvalds {
17171da177e4SLinus Torvalds 	unsigned long flags;
17181da177e4SLinus Torvalds 	int res;
17191da177e4SLinus Torvalds 
17201da177e4SLinus Torvalds 	spin_lock_irqsave(&card->tst_lock, flags);
17211da177e4SLinus Torvalds 
17221da177e4SLinus Torvalds 	res = __clear_tst(card, vc);
17231da177e4SLinus Torvalds 
17241da177e4SLinus Torvalds 	set_bit(TST_SWITCH_PENDING, &card->tst_state);
17251da177e4SLinus Torvalds 	if (!timer_pending(&card->tst_timer))
17261da177e4SLinus Torvalds 		mod_timer(&card->tst_timer, jiffies + 1);
17271da177e4SLinus Torvalds 
17281da177e4SLinus Torvalds 	spin_unlock_irqrestore(&card->tst_lock, flags);
17291da177e4SLinus Torvalds 	return res;
17301da177e4SLinus Torvalds }
17311da177e4SLinus Torvalds 
17321da177e4SLinus Torvalds static int
17331da177e4SLinus Torvalds change_tst(struct idt77252_dev *card, struct vc_map *vc,
17341da177e4SLinus Torvalds 	   int n, unsigned int opc)
17351da177e4SLinus Torvalds {
17361da177e4SLinus Torvalds 	unsigned long flags;
17371da177e4SLinus Torvalds 	int res;
17381da177e4SLinus Torvalds 
17391da177e4SLinus Torvalds 	spin_lock_irqsave(&card->tst_lock, flags);
17401da177e4SLinus Torvalds 
17411da177e4SLinus Torvalds 	__clear_tst(card, vc);
17421da177e4SLinus Torvalds 	res = __fill_tst(card, vc, n, opc);
17431da177e4SLinus Torvalds 
17441da177e4SLinus Torvalds 	set_bit(TST_SWITCH_PENDING, &card->tst_state);
17451da177e4SLinus Torvalds 	if (!timer_pending(&card->tst_timer))
17461da177e4SLinus Torvalds 		mod_timer(&card->tst_timer, jiffies + 1);
17471da177e4SLinus Torvalds 
17481da177e4SLinus Torvalds 	spin_unlock_irqrestore(&card->tst_lock, flags);
17491da177e4SLinus Torvalds 	return res;
17501da177e4SLinus Torvalds }
17511da177e4SLinus Torvalds 
17521da177e4SLinus Torvalds 
17531da177e4SLinus Torvalds static int
17541da177e4SLinus Torvalds set_tct(struct idt77252_dev *card, struct vc_map *vc)
17551da177e4SLinus Torvalds {
17561da177e4SLinus Torvalds 	unsigned long tct;
17571da177e4SLinus Torvalds 
17581da177e4SLinus Torvalds 	tct = (unsigned long) (card->tct_base + vc->index * SAR_SRAM_TCT_SIZE);
17591da177e4SLinus Torvalds 
17601da177e4SLinus Torvalds 	switch (vc->class) {
17611da177e4SLinus Torvalds 	case SCHED_CBR:
17621da177e4SLinus Torvalds 		OPRINTK("%s: writing TCT at 0x%lx, SCD 0x%lx.\n",
17631da177e4SLinus Torvalds 		        card->name, tct, vc->scq->scd);
17641da177e4SLinus Torvalds 
17651da177e4SLinus Torvalds 		write_sram(card, tct + 0, TCT_CBR | vc->scq->scd);
17661da177e4SLinus Torvalds 		write_sram(card, tct + 1, 0);
17671da177e4SLinus Torvalds 		write_sram(card, tct + 2, 0);
17681da177e4SLinus Torvalds 		write_sram(card, tct + 3, 0);
17691da177e4SLinus Torvalds 		write_sram(card, tct + 4, 0);
17701da177e4SLinus Torvalds 		write_sram(card, tct + 5, 0);
17711da177e4SLinus Torvalds 		write_sram(card, tct + 6, 0);
17721da177e4SLinus Torvalds 		write_sram(card, tct + 7, 0);
17731da177e4SLinus Torvalds 		break;
17741da177e4SLinus Torvalds 
17751da177e4SLinus Torvalds 	case SCHED_UBR:
17761da177e4SLinus Torvalds 		OPRINTK("%s: writing TCT at 0x%lx, SCD 0x%lx.\n",
17771da177e4SLinus Torvalds 		        card->name, tct, vc->scq->scd);
17781da177e4SLinus Torvalds 
17791da177e4SLinus Torvalds 		write_sram(card, tct + 0, TCT_UBR | vc->scq->scd);
17801da177e4SLinus Torvalds 		write_sram(card, tct + 1, 0);
17811da177e4SLinus Torvalds 		write_sram(card, tct + 2, TCT_TSIF);
17821da177e4SLinus Torvalds 		write_sram(card, tct + 3, TCT_HALT | TCT_IDLE);
17831da177e4SLinus Torvalds 		write_sram(card, tct + 4, 0);
17841da177e4SLinus Torvalds 		write_sram(card, tct + 5, vc->init_er);
17851da177e4SLinus Torvalds 		write_sram(card, tct + 6, 0);
17861da177e4SLinus Torvalds 		write_sram(card, tct + 7, TCT_FLAG_UBR);
17871da177e4SLinus Torvalds 		break;
17881da177e4SLinus Torvalds 
17891da177e4SLinus Torvalds 	case SCHED_VBR:
17901da177e4SLinus Torvalds 	case SCHED_ABR:
17911da177e4SLinus Torvalds 	default:
17921da177e4SLinus Torvalds 		return -ENOSYS;
17931da177e4SLinus Torvalds 	}
17941da177e4SLinus Torvalds 
17951da177e4SLinus Torvalds 	return 0;
17961da177e4SLinus Torvalds }
17971da177e4SLinus Torvalds 
17981da177e4SLinus Torvalds /*****************************************************************************/
17991da177e4SLinus Torvalds /*                                                                           */
18001da177e4SLinus Torvalds /* FBQ Handling                                                              */
18011da177e4SLinus Torvalds /*                                                                           */
18021da177e4SLinus Torvalds /*****************************************************************************/
18031da177e4SLinus Torvalds 
18041da177e4SLinus Torvalds static __inline__ int
18051da177e4SLinus Torvalds idt77252_fbq_level(struct idt77252_dev *card, int queue)
18061da177e4SLinus Torvalds {
18071da177e4SLinus Torvalds 	return (readl(SAR_REG_STAT) >> (16 + (queue << 2))) & 0x0f;
18081da177e4SLinus Torvalds }
18091da177e4SLinus Torvalds 
18101da177e4SLinus Torvalds static __inline__ int
18111da177e4SLinus Torvalds idt77252_fbq_full(struct idt77252_dev *card, int queue)
18121da177e4SLinus Torvalds {
18131da177e4SLinus Torvalds 	return (readl(SAR_REG_STAT) >> (16 + (queue << 2))) == 0x0f;
18141da177e4SLinus Torvalds }
18151da177e4SLinus Torvalds 
18161da177e4SLinus Torvalds static int
18171da177e4SLinus Torvalds push_rx_skb(struct idt77252_dev *card, struct sk_buff *skb, int queue)
18181da177e4SLinus Torvalds {
18191da177e4SLinus Torvalds 	unsigned long flags;
18201da177e4SLinus Torvalds 	u32 handle;
18211da177e4SLinus Torvalds 	u32 addr;
18221da177e4SLinus Torvalds 
182327a884dcSArnaldo Carvalho de Melo 	skb->data = skb->head;
182427a884dcSArnaldo Carvalho de Melo 	skb_reset_tail_pointer(skb);
18251da177e4SLinus Torvalds 	skb->len = 0;
18261da177e4SLinus Torvalds 
18271da177e4SLinus Torvalds 	skb_reserve(skb, 16);
18281da177e4SLinus Torvalds 
18291da177e4SLinus Torvalds 	switch (queue) {
18301da177e4SLinus Torvalds 	case 0:
18311da177e4SLinus Torvalds 		skb_put(skb, SAR_FB_SIZE_0);
18321da177e4SLinus Torvalds 		break;
18331da177e4SLinus Torvalds 	case 1:
18341da177e4SLinus Torvalds 		skb_put(skb, SAR_FB_SIZE_1);
18351da177e4SLinus Torvalds 		break;
18361da177e4SLinus Torvalds 	case 2:
18371da177e4SLinus Torvalds 		skb_put(skb, SAR_FB_SIZE_2);
18381da177e4SLinus Torvalds 		break;
18391da177e4SLinus Torvalds 	case 3:
18401da177e4SLinus Torvalds 		skb_put(skb, SAR_FB_SIZE_3);
18411da177e4SLinus Torvalds 		break;
18421da177e4SLinus Torvalds 	default:
18431da177e4SLinus Torvalds 		return -1;
18441da177e4SLinus Torvalds 	}
18451da177e4SLinus Torvalds 
18461da177e4SLinus Torvalds 	if (idt77252_fbq_full(card, queue))
18471da177e4SLinus Torvalds 		return -1;
18481da177e4SLinus Torvalds 
18491da177e4SLinus Torvalds 	memset(&skb->data[(skb->len & ~(0x3f)) - 64], 0, 2 * sizeof(u32));
18501da177e4SLinus Torvalds 
18511da177e4SLinus Torvalds 	handle = IDT77252_PRV_POOL(skb);
18521da177e4SLinus Torvalds 	addr = IDT77252_PRV_PADDR(skb);
18531da177e4SLinus Torvalds 
18541da177e4SLinus Torvalds 	spin_lock_irqsave(&card->cmd_lock, flags);
18551da177e4SLinus Torvalds 	writel(handle, card->fbq[queue]);
18561da177e4SLinus Torvalds 	writel(addr, card->fbq[queue]);
18571da177e4SLinus Torvalds 	spin_unlock_irqrestore(&card->cmd_lock, flags);
18581da177e4SLinus Torvalds 
18591da177e4SLinus Torvalds 	return 0;
18601da177e4SLinus Torvalds }
18611da177e4SLinus Torvalds 
18621da177e4SLinus Torvalds static void
18631da177e4SLinus Torvalds add_rx_skb(struct idt77252_dev *card, int queue,
18641da177e4SLinus Torvalds 	   unsigned int size, unsigned int count)
18651da177e4SLinus Torvalds {
18661da177e4SLinus Torvalds 	struct sk_buff *skb;
18671da177e4SLinus Torvalds 	dma_addr_t paddr;
18681da177e4SLinus Torvalds 	u32 handle;
18691da177e4SLinus Torvalds 
18701da177e4SLinus Torvalds 	while (count--) {
18711da177e4SLinus Torvalds 		skb = dev_alloc_skb(size);
18721da177e4SLinus Torvalds 		if (!skb)
18731da177e4SLinus Torvalds 			return;
18741da177e4SLinus Torvalds 
18751da177e4SLinus Torvalds 		if (sb_pool_add(card, skb, queue)) {
18761da177e4SLinus Torvalds 			printk("%s: SB POOL full\n", __FUNCTION__);
18771da177e4SLinus Torvalds 			goto outfree;
18781da177e4SLinus Torvalds 		}
18791da177e4SLinus Torvalds 
18801da177e4SLinus Torvalds 		paddr = pci_map_single(card->pcidev, skb->data,
18814305b541SArnaldo Carvalho de Melo 				       skb_end_pointer(skb) - skb->data,
18821da177e4SLinus Torvalds 				       PCI_DMA_FROMDEVICE);
18831da177e4SLinus Torvalds 		IDT77252_PRV_PADDR(skb) = paddr;
18841da177e4SLinus Torvalds 
18851da177e4SLinus Torvalds 		if (push_rx_skb(card, skb, queue)) {
18861da177e4SLinus Torvalds 			printk("%s: FB QUEUE full\n", __FUNCTION__);
18871da177e4SLinus Torvalds 			goto outunmap;
18881da177e4SLinus Torvalds 		}
18891da177e4SLinus Torvalds 	}
18901da177e4SLinus Torvalds 
18911da177e4SLinus Torvalds 	return;
18921da177e4SLinus Torvalds 
18931da177e4SLinus Torvalds outunmap:
18941da177e4SLinus Torvalds 	pci_unmap_single(card->pcidev, IDT77252_PRV_PADDR(skb),
18954305b541SArnaldo Carvalho de Melo 			 skb_end_pointer(skb) - skb->data, PCI_DMA_FROMDEVICE);
18961da177e4SLinus Torvalds 
18971da177e4SLinus Torvalds 	handle = IDT77252_PRV_POOL(skb);
18981da177e4SLinus Torvalds 	card->sbpool[POOL_QUEUE(handle)].skb[POOL_INDEX(handle)] = NULL;
18991da177e4SLinus Torvalds 
19001da177e4SLinus Torvalds outfree:
19011da177e4SLinus Torvalds 	dev_kfree_skb(skb);
19021da177e4SLinus Torvalds }
19031da177e4SLinus Torvalds 
19041da177e4SLinus Torvalds 
19051da177e4SLinus Torvalds static void
19061da177e4SLinus Torvalds recycle_rx_skb(struct idt77252_dev *card, struct sk_buff *skb)
19071da177e4SLinus Torvalds {
19081da177e4SLinus Torvalds 	u32 handle = IDT77252_PRV_POOL(skb);
19091da177e4SLinus Torvalds 	int err;
19101da177e4SLinus Torvalds 
19111da177e4SLinus Torvalds 	pci_dma_sync_single_for_device(card->pcidev, IDT77252_PRV_PADDR(skb),
19124305b541SArnaldo Carvalho de Melo 				       skb_end_pointer(skb) - skb->data,
19134305b541SArnaldo Carvalho de Melo 				       PCI_DMA_FROMDEVICE);
19141da177e4SLinus Torvalds 
19151da177e4SLinus Torvalds 	err = push_rx_skb(card, skb, POOL_QUEUE(handle));
19161da177e4SLinus Torvalds 	if (err) {
19171da177e4SLinus Torvalds 		pci_unmap_single(card->pcidev, IDT77252_PRV_PADDR(skb),
19184305b541SArnaldo Carvalho de Melo 				 skb_end_pointer(skb) - skb->data,
19194305b541SArnaldo Carvalho de Melo 				 PCI_DMA_FROMDEVICE);
19201da177e4SLinus Torvalds 		sb_pool_remove(card, skb);
19211da177e4SLinus Torvalds 		dev_kfree_skb(skb);
19221da177e4SLinus Torvalds 	}
19231da177e4SLinus Torvalds }
19241da177e4SLinus Torvalds 
19251da177e4SLinus Torvalds static void
19261da177e4SLinus Torvalds flush_rx_pool(struct idt77252_dev *card, struct rx_pool *rpp)
19271da177e4SLinus Torvalds {
19281da177e4SLinus Torvalds 	rpp->len = 0;
19291da177e4SLinus Torvalds 	rpp->count = 0;
19301da177e4SLinus Torvalds 	rpp->first = NULL;
19311da177e4SLinus Torvalds 	rpp->last = &rpp->first;
19321da177e4SLinus Torvalds }
19331da177e4SLinus Torvalds 
19341da177e4SLinus Torvalds static void
19351da177e4SLinus Torvalds recycle_rx_pool_skb(struct idt77252_dev *card, struct rx_pool *rpp)
19361da177e4SLinus Torvalds {
19371da177e4SLinus Torvalds 	struct sk_buff *skb, *next;
19381da177e4SLinus Torvalds 	int i;
19391da177e4SLinus Torvalds 
19401da177e4SLinus Torvalds 	skb = rpp->first;
19411da177e4SLinus Torvalds 	for (i = 0; i < rpp->count; i++) {
19421da177e4SLinus Torvalds 		next = skb->next;
19431da177e4SLinus Torvalds 		skb->next = NULL;
19441da177e4SLinus Torvalds 		recycle_rx_skb(card, skb);
19451da177e4SLinus Torvalds 		skb = next;
19461da177e4SLinus Torvalds 	}
19471da177e4SLinus Torvalds 	flush_rx_pool(card, rpp);
19481da177e4SLinus Torvalds }
19491da177e4SLinus Torvalds 
19501da177e4SLinus Torvalds /*****************************************************************************/
19511da177e4SLinus Torvalds /*                                                                           */
19521da177e4SLinus Torvalds /* ATM Interface                                                             */
19531da177e4SLinus Torvalds /*                                                                           */
19541da177e4SLinus Torvalds /*****************************************************************************/
19551da177e4SLinus Torvalds 
19561da177e4SLinus Torvalds static void
19571da177e4SLinus Torvalds idt77252_phy_put(struct atm_dev *dev, unsigned char value, unsigned long addr)
19581da177e4SLinus Torvalds {
19591da177e4SLinus Torvalds 	write_utility(dev->dev_data, 0x100 + (addr & 0x1ff), value);
19601da177e4SLinus Torvalds }
19611da177e4SLinus Torvalds 
19621da177e4SLinus Torvalds static unsigned char
19631da177e4SLinus Torvalds idt77252_phy_get(struct atm_dev *dev, unsigned long addr)
19641da177e4SLinus Torvalds {
19651da177e4SLinus Torvalds 	return read_utility(dev->dev_data, 0x100 + (addr & 0x1ff));
19661da177e4SLinus Torvalds }
19671da177e4SLinus Torvalds 
19681da177e4SLinus Torvalds static inline int
19691da177e4SLinus Torvalds idt77252_send_skb(struct atm_vcc *vcc, struct sk_buff *skb, int oam)
19701da177e4SLinus Torvalds {
19711da177e4SLinus Torvalds 	struct atm_dev *dev = vcc->dev;
19721da177e4SLinus Torvalds 	struct idt77252_dev *card = dev->dev_data;
19731da177e4SLinus Torvalds 	struct vc_map *vc = vcc->dev_data;
19741da177e4SLinus Torvalds 	int err;
19751da177e4SLinus Torvalds 
19761da177e4SLinus Torvalds 	if (vc == NULL) {
19771da177e4SLinus Torvalds 		printk("%s: NULL connection in send().\n", card->name);
19781da177e4SLinus Torvalds 		atomic_inc(&vcc->stats->tx_err);
19791da177e4SLinus Torvalds 		dev_kfree_skb(skb);
19801da177e4SLinus Torvalds 		return -EINVAL;
19811da177e4SLinus Torvalds 	}
19821da177e4SLinus Torvalds 	if (!test_bit(VCF_TX, &vc->flags)) {
19831da177e4SLinus Torvalds 		printk("%s: Trying to transmit on a non-tx VC.\n", card->name);
19841da177e4SLinus Torvalds 		atomic_inc(&vcc->stats->tx_err);
19851da177e4SLinus Torvalds 		dev_kfree_skb(skb);
19861da177e4SLinus Torvalds 		return -EINVAL;
19871da177e4SLinus Torvalds 	}
19881da177e4SLinus Torvalds 
19891da177e4SLinus Torvalds 	switch (vcc->qos.aal) {
19901da177e4SLinus Torvalds 	case ATM_AAL0:
19911da177e4SLinus Torvalds 	case ATM_AAL1:
19921da177e4SLinus Torvalds 	case ATM_AAL5:
19931da177e4SLinus Torvalds 		break;
19941da177e4SLinus Torvalds 	default:
19951da177e4SLinus Torvalds 		printk("%s: Unsupported AAL: %d\n", card->name, vcc->qos.aal);
19961da177e4SLinus Torvalds 		atomic_inc(&vcc->stats->tx_err);
19971da177e4SLinus Torvalds 		dev_kfree_skb(skb);
19981da177e4SLinus Torvalds 		return -EINVAL;
19991da177e4SLinus Torvalds 	}
20001da177e4SLinus Torvalds 
20011da177e4SLinus Torvalds 	if (skb_shinfo(skb)->nr_frags != 0) {
20021da177e4SLinus Torvalds 		printk("%s: No scatter-gather yet.\n", card->name);
20031da177e4SLinus Torvalds 		atomic_inc(&vcc->stats->tx_err);
20041da177e4SLinus Torvalds 		dev_kfree_skb(skb);
20051da177e4SLinus Torvalds 		return -EINVAL;
20061da177e4SLinus Torvalds 	}
20071da177e4SLinus Torvalds 	ATM_SKB(skb)->vcc = vcc;
20081da177e4SLinus Torvalds 
20091da177e4SLinus Torvalds 	err = queue_skb(card, vc, skb, oam);
20101da177e4SLinus Torvalds 	if (err) {
20111da177e4SLinus Torvalds 		atomic_inc(&vcc->stats->tx_err);
20121da177e4SLinus Torvalds 		dev_kfree_skb(skb);
20131da177e4SLinus Torvalds 		return err;
20141da177e4SLinus Torvalds 	}
20151da177e4SLinus Torvalds 
20161da177e4SLinus Torvalds 	return 0;
20171da177e4SLinus Torvalds }
20181da177e4SLinus Torvalds 
20191da177e4SLinus Torvalds int
20201da177e4SLinus Torvalds idt77252_send(struct atm_vcc *vcc, struct sk_buff *skb)
20211da177e4SLinus Torvalds {
20221da177e4SLinus Torvalds 	return idt77252_send_skb(vcc, skb, 0);
20231da177e4SLinus Torvalds }
20241da177e4SLinus Torvalds 
20251da177e4SLinus Torvalds static int
20261da177e4SLinus Torvalds idt77252_send_oam(struct atm_vcc *vcc, void *cell, int flags)
20271da177e4SLinus Torvalds {
20281da177e4SLinus Torvalds 	struct atm_dev *dev = vcc->dev;
20291da177e4SLinus Torvalds 	struct idt77252_dev *card = dev->dev_data;
20301da177e4SLinus Torvalds 	struct sk_buff *skb;
20311da177e4SLinus Torvalds 
20321da177e4SLinus Torvalds 	skb = dev_alloc_skb(64);
20331da177e4SLinus Torvalds 	if (!skb) {
20341da177e4SLinus Torvalds 		printk("%s: Out of memory in send_oam().\n", card->name);
20351da177e4SLinus Torvalds 		atomic_inc(&vcc->stats->tx_err);
20361da177e4SLinus Torvalds 		return -ENOMEM;
20371da177e4SLinus Torvalds 	}
20381da177e4SLinus Torvalds 	atomic_add(skb->truesize, &sk_atm(vcc)->sk_wmem_alloc);
20391da177e4SLinus Torvalds 
20401da177e4SLinus Torvalds 	memcpy(skb_put(skb, 52), cell, 52);
20411da177e4SLinus Torvalds 
20421da177e4SLinus Torvalds 	return idt77252_send_skb(vcc, skb, 1);
20431da177e4SLinus Torvalds }
20441da177e4SLinus Torvalds 
20451da177e4SLinus Torvalds static __inline__ unsigned int
20461da177e4SLinus Torvalds idt77252_fls(unsigned int x)
20471da177e4SLinus Torvalds {
20481da177e4SLinus Torvalds 	int r = 1;
20491da177e4SLinus Torvalds 
20501da177e4SLinus Torvalds 	if (x == 0)
20511da177e4SLinus Torvalds 		return 0;
20521da177e4SLinus Torvalds 	if (x & 0xffff0000) {
20531da177e4SLinus Torvalds 		x >>= 16;
20541da177e4SLinus Torvalds 		r += 16;
20551da177e4SLinus Torvalds 	}
20561da177e4SLinus Torvalds 	if (x & 0xff00) {
20571da177e4SLinus Torvalds 		x >>= 8;
20581da177e4SLinus Torvalds 		r += 8;
20591da177e4SLinus Torvalds 	}
20601da177e4SLinus Torvalds 	if (x & 0xf0) {
20611da177e4SLinus Torvalds 		x >>= 4;
20621da177e4SLinus Torvalds 		r += 4;
20631da177e4SLinus Torvalds 	}
20641da177e4SLinus Torvalds 	if (x & 0xc) {
20651da177e4SLinus Torvalds 		x >>= 2;
20661da177e4SLinus Torvalds 		r += 2;
20671da177e4SLinus Torvalds 	}
20681da177e4SLinus Torvalds 	if (x & 0x2)
20691da177e4SLinus Torvalds 		r += 1;
20701da177e4SLinus Torvalds 	return r;
20711da177e4SLinus Torvalds }
20721da177e4SLinus Torvalds 
20731da177e4SLinus Torvalds static u16
20741da177e4SLinus Torvalds idt77252_int_to_atmfp(unsigned int rate)
20751da177e4SLinus Torvalds {
20761da177e4SLinus Torvalds 	u16 m, e;
20771da177e4SLinus Torvalds 
20781da177e4SLinus Torvalds 	if (rate == 0)
20791da177e4SLinus Torvalds 		return 0;
20801da177e4SLinus Torvalds 	e = idt77252_fls(rate) - 1;
20811da177e4SLinus Torvalds 	if (e < 9)
20821da177e4SLinus Torvalds 		m = (rate - (1 << e)) << (9 - e);
20831da177e4SLinus Torvalds 	else if (e == 9)
20841da177e4SLinus Torvalds 		m = (rate - (1 << e));
20851da177e4SLinus Torvalds 	else /* e > 9 */
20861da177e4SLinus Torvalds 		m = (rate - (1 << e)) >> (e - 9);
20871da177e4SLinus Torvalds 	return 0x4000 | (e << 9) | m;
20881da177e4SLinus Torvalds }
20891da177e4SLinus Torvalds 
20901da177e4SLinus Torvalds static u8
20911da177e4SLinus Torvalds idt77252_rate_logindex(struct idt77252_dev *card, int pcr)
20921da177e4SLinus Torvalds {
20931da177e4SLinus Torvalds 	u16 afp;
20941da177e4SLinus Torvalds 
20951da177e4SLinus Torvalds 	afp = idt77252_int_to_atmfp(pcr < 0 ? -pcr : pcr);
20961da177e4SLinus Torvalds 	if (pcr < 0)
20971da177e4SLinus Torvalds 		return rate_to_log[(afp >> 5) & 0x1ff];
20981da177e4SLinus Torvalds 	return rate_to_log[((afp >> 5) + 1) & 0x1ff];
20991da177e4SLinus Torvalds }
21001da177e4SLinus Torvalds 
21011da177e4SLinus Torvalds static void
21021da177e4SLinus Torvalds idt77252_est_timer(unsigned long data)
21031da177e4SLinus Torvalds {
21041da177e4SLinus Torvalds 	struct vc_map *vc = (struct vc_map *)data;
21051da177e4SLinus Torvalds 	struct idt77252_dev *card = vc->card;
21061da177e4SLinus Torvalds 	struct rate_estimator *est;
21071da177e4SLinus Torvalds 	unsigned long flags;
21081da177e4SLinus Torvalds 	u32 rate, cps;
21091da177e4SLinus Torvalds 	u64 ncells;
21101da177e4SLinus Torvalds 	u8 lacr;
21111da177e4SLinus Torvalds 
21121da177e4SLinus Torvalds 	spin_lock_irqsave(&vc->lock, flags);
21131da177e4SLinus Torvalds 	est = vc->estimator;
21141da177e4SLinus Torvalds 	if (!est)
21151da177e4SLinus Torvalds 		goto out;
21161da177e4SLinus Torvalds 
21171da177e4SLinus Torvalds 	ncells = est->cells;
21181da177e4SLinus Torvalds 
21191da177e4SLinus Torvalds 	rate = ((u32)(ncells - est->last_cells)) << (7 - est->interval);
21201da177e4SLinus Torvalds 	est->last_cells = ncells;
21211da177e4SLinus Torvalds 	est->avcps += ((long)rate - (long)est->avcps) >> est->ewma_log;
21221da177e4SLinus Torvalds 	est->cps = (est->avcps + 0x1f) >> 5;
21231da177e4SLinus Torvalds 
21241da177e4SLinus Torvalds 	cps = est->cps;
21251da177e4SLinus Torvalds 	if (cps < (est->maxcps >> 4))
21261da177e4SLinus Torvalds 		cps = est->maxcps >> 4;
21271da177e4SLinus Torvalds 
21281da177e4SLinus Torvalds 	lacr = idt77252_rate_logindex(card, cps);
21291da177e4SLinus Torvalds 	if (lacr > vc->max_er)
21301da177e4SLinus Torvalds 		lacr = vc->max_er;
21311da177e4SLinus Torvalds 
21321da177e4SLinus Torvalds 	if (lacr != vc->lacr) {
21331da177e4SLinus Torvalds 		vc->lacr = lacr;
21341da177e4SLinus Torvalds 		writel(TCMDQ_LACR|(vc->lacr << 16)|vc->index, SAR_REG_TCMDQ);
21351da177e4SLinus Torvalds 	}
21361da177e4SLinus Torvalds 
21371da177e4SLinus Torvalds 	est->timer.expires = jiffies + ((HZ / 4) << est->interval);
21381da177e4SLinus Torvalds 	add_timer(&est->timer);
21391da177e4SLinus Torvalds 
21401da177e4SLinus Torvalds out:
21411da177e4SLinus Torvalds 	spin_unlock_irqrestore(&vc->lock, flags);
21421da177e4SLinus Torvalds }
21431da177e4SLinus Torvalds 
21441da177e4SLinus Torvalds static struct rate_estimator *
21451da177e4SLinus Torvalds idt77252_init_est(struct vc_map *vc, int pcr)
21461da177e4SLinus Torvalds {
21471da177e4SLinus Torvalds 	struct rate_estimator *est;
21481da177e4SLinus Torvalds 
21490c1cca1dSOm Narasimhan 	est = kzalloc(sizeof(struct rate_estimator), GFP_KERNEL);
21501da177e4SLinus Torvalds 	if (!est)
21511da177e4SLinus Torvalds 		return NULL;
21521da177e4SLinus Torvalds 	est->maxcps = pcr < 0 ? -pcr : pcr;
21531da177e4SLinus Torvalds 	est->cps = est->maxcps;
21541da177e4SLinus Torvalds 	est->avcps = est->cps << 5;
21551da177e4SLinus Torvalds 
21561da177e4SLinus Torvalds 	est->interval = 2;		/* XXX: make this configurable */
21571da177e4SLinus Torvalds 	est->ewma_log = 2;		/* XXX: make this configurable */
21581da177e4SLinus Torvalds 	init_timer(&est->timer);
21591da177e4SLinus Torvalds 	est->timer.data = (unsigned long)vc;
21601da177e4SLinus Torvalds 	est->timer.function = idt77252_est_timer;
21611da177e4SLinus Torvalds 
21621da177e4SLinus Torvalds 	est->timer.expires = jiffies + ((HZ / 4) << est->interval);
21631da177e4SLinus Torvalds 	add_timer(&est->timer);
21641da177e4SLinus Torvalds 
21651da177e4SLinus Torvalds 	return est;
21661da177e4SLinus Torvalds }
21671da177e4SLinus Torvalds 
21681da177e4SLinus Torvalds static int
21691da177e4SLinus Torvalds idt77252_init_cbr(struct idt77252_dev *card, struct vc_map *vc,
21701da177e4SLinus Torvalds 		  struct atm_vcc *vcc, struct atm_qos *qos)
21711da177e4SLinus Torvalds {
21721da177e4SLinus Torvalds 	int tst_free, tst_used, tst_entries;
21731da177e4SLinus Torvalds 	unsigned long tmpl, modl;
21741da177e4SLinus Torvalds 	int tcr, tcra;
21751da177e4SLinus Torvalds 
21761da177e4SLinus Torvalds 	if ((qos->txtp.max_pcr == 0) &&
21771da177e4SLinus Torvalds 	    (qos->txtp.pcr == 0) && (qos->txtp.min_pcr == 0)) {
21781da177e4SLinus Torvalds 		printk("%s: trying to open a CBR VC with cell rate = 0\n",
21791da177e4SLinus Torvalds 		       card->name);
21801da177e4SLinus Torvalds 		return -EINVAL;
21811da177e4SLinus Torvalds 	}
21821da177e4SLinus Torvalds 
21831da177e4SLinus Torvalds 	tst_used = 0;
21841da177e4SLinus Torvalds 	tst_free = card->tst_free;
21851da177e4SLinus Torvalds 	if (test_bit(VCF_TX, &vc->flags))
21861da177e4SLinus Torvalds 		tst_used = vc->ntste;
21871da177e4SLinus Torvalds 	tst_free += tst_used;
21881da177e4SLinus Torvalds 
21891da177e4SLinus Torvalds 	tcr = atm_pcr_goal(&qos->txtp);
21901da177e4SLinus Torvalds 	tcra = tcr >= 0 ? tcr : -tcr;
21911da177e4SLinus Torvalds 
21921da177e4SLinus Torvalds 	TXPRINTK("%s: CBR target cell rate = %d\n", card->name, tcra);
21931da177e4SLinus Torvalds 
21941da177e4SLinus Torvalds 	tmpl = (unsigned long) tcra * ((unsigned long) card->tst_size - 2);
21951da177e4SLinus Torvalds 	modl = tmpl % (unsigned long)card->utopia_pcr;
21961da177e4SLinus Torvalds 
21971da177e4SLinus Torvalds 	tst_entries = (int) (tmpl / card->utopia_pcr);
21981da177e4SLinus Torvalds 	if (tcr > 0) {
21991da177e4SLinus Torvalds 		if (modl > 0)
22001da177e4SLinus Torvalds 			tst_entries++;
22011da177e4SLinus Torvalds 	} else if (tcr == 0) {
22021da177e4SLinus Torvalds 		tst_entries = tst_free - SAR_TST_RESERVED;
22031da177e4SLinus Torvalds 		if (tst_entries <= 0) {
22041da177e4SLinus Torvalds 			printk("%s: no CBR bandwidth free.\n", card->name);
22051da177e4SLinus Torvalds 			return -ENOSR;
22061da177e4SLinus Torvalds 		}
22071da177e4SLinus Torvalds 	}
22081da177e4SLinus Torvalds 
22091da177e4SLinus Torvalds 	if (tst_entries == 0) {
22101da177e4SLinus Torvalds 		printk("%s: selected CBR bandwidth < granularity.\n",
22111da177e4SLinus Torvalds 		       card->name);
22121da177e4SLinus Torvalds 		return -EINVAL;
22131da177e4SLinus Torvalds 	}
22141da177e4SLinus Torvalds 
22151da177e4SLinus Torvalds 	if (tst_entries > (tst_free - SAR_TST_RESERVED)) {
22161da177e4SLinus Torvalds 		printk("%s: not enough CBR bandwidth free.\n", card->name);
22171da177e4SLinus Torvalds 		return -ENOSR;
22181da177e4SLinus Torvalds 	}
22191da177e4SLinus Torvalds 
22201da177e4SLinus Torvalds 	vc->ntste = tst_entries;
22211da177e4SLinus Torvalds 
22221da177e4SLinus Torvalds 	card->tst_free = tst_free - tst_entries;
22231da177e4SLinus Torvalds 	if (test_bit(VCF_TX, &vc->flags)) {
22241da177e4SLinus Torvalds 		if (tst_used == tst_entries)
22251da177e4SLinus Torvalds 			return 0;
22261da177e4SLinus Torvalds 
22271da177e4SLinus Torvalds 		OPRINTK("%s: modify %d -> %d entries in TST.\n",
22281da177e4SLinus Torvalds 			card->name, tst_used, tst_entries);
22291da177e4SLinus Torvalds 		change_tst(card, vc, tst_entries, TSTE_OPC_CBR);
22301da177e4SLinus Torvalds 		return 0;
22311da177e4SLinus Torvalds 	}
22321da177e4SLinus Torvalds 
22331da177e4SLinus Torvalds 	OPRINTK("%s: setting %d entries in TST.\n", card->name, tst_entries);
22341da177e4SLinus Torvalds 	fill_tst(card, vc, tst_entries, TSTE_OPC_CBR);
22351da177e4SLinus Torvalds 	return 0;
22361da177e4SLinus Torvalds }
22371da177e4SLinus Torvalds 
22381da177e4SLinus Torvalds static int
22391da177e4SLinus Torvalds idt77252_init_ubr(struct idt77252_dev *card, struct vc_map *vc,
22401da177e4SLinus Torvalds 		  struct atm_vcc *vcc, struct atm_qos *qos)
22411da177e4SLinus Torvalds {
22421da177e4SLinus Torvalds 	unsigned long flags;
22431da177e4SLinus Torvalds 	int tcr;
22441da177e4SLinus Torvalds 
22451da177e4SLinus Torvalds 	spin_lock_irqsave(&vc->lock, flags);
22461da177e4SLinus Torvalds 	if (vc->estimator) {
22471da177e4SLinus Torvalds 		del_timer(&vc->estimator->timer);
22481da177e4SLinus Torvalds 		kfree(vc->estimator);
22491da177e4SLinus Torvalds 		vc->estimator = NULL;
22501da177e4SLinus Torvalds 	}
22511da177e4SLinus Torvalds 	spin_unlock_irqrestore(&vc->lock, flags);
22521da177e4SLinus Torvalds 
22531da177e4SLinus Torvalds 	tcr = atm_pcr_goal(&qos->txtp);
22541da177e4SLinus Torvalds 	if (tcr == 0)
22551da177e4SLinus Torvalds 		tcr = card->link_pcr;
22561da177e4SLinus Torvalds 
22571da177e4SLinus Torvalds 	vc->estimator = idt77252_init_est(vc, tcr);
22581da177e4SLinus Torvalds 
22591da177e4SLinus Torvalds 	vc->class = SCHED_UBR;
22601da177e4SLinus Torvalds 	vc->init_er = idt77252_rate_logindex(card, tcr);
22611da177e4SLinus Torvalds 	vc->lacr = vc->init_er;
22621da177e4SLinus Torvalds 	if (tcr < 0)
22631da177e4SLinus Torvalds 		vc->max_er = vc->init_er;
22641da177e4SLinus Torvalds 	else
22651da177e4SLinus Torvalds 		vc->max_er = 0xff;
22661da177e4SLinus Torvalds 
22671da177e4SLinus Torvalds 	return 0;
22681da177e4SLinus Torvalds }
22691da177e4SLinus Torvalds 
22701da177e4SLinus Torvalds static int
22711da177e4SLinus Torvalds idt77252_init_tx(struct idt77252_dev *card, struct vc_map *vc,
22721da177e4SLinus Torvalds 		 struct atm_vcc *vcc, struct atm_qos *qos)
22731da177e4SLinus Torvalds {
22741da177e4SLinus Torvalds 	int error;
22751da177e4SLinus Torvalds 
22761da177e4SLinus Torvalds 	if (test_bit(VCF_TX, &vc->flags))
22771da177e4SLinus Torvalds 		return -EBUSY;
22781da177e4SLinus Torvalds 
22791da177e4SLinus Torvalds 	switch (qos->txtp.traffic_class) {
22801da177e4SLinus Torvalds 		case ATM_CBR:
22811da177e4SLinus Torvalds 			vc->class = SCHED_CBR;
22821da177e4SLinus Torvalds 			break;
22831da177e4SLinus Torvalds 
22841da177e4SLinus Torvalds 		case ATM_UBR:
22851da177e4SLinus Torvalds 			vc->class = SCHED_UBR;
22861da177e4SLinus Torvalds 			break;
22871da177e4SLinus Torvalds 
22881da177e4SLinus Torvalds 		case ATM_VBR:
22891da177e4SLinus Torvalds 		case ATM_ABR:
22901da177e4SLinus Torvalds 		default:
22911da177e4SLinus Torvalds 			return -EPROTONOSUPPORT;
22921da177e4SLinus Torvalds 	}
22931da177e4SLinus Torvalds 
22941da177e4SLinus Torvalds 	vc->scq = alloc_scq(card, vc->class);
22951da177e4SLinus Torvalds 	if (!vc->scq) {
22961da177e4SLinus Torvalds 		printk("%s: can't get SCQ.\n", card->name);
22971da177e4SLinus Torvalds 		return -ENOMEM;
22981da177e4SLinus Torvalds 	}
22991da177e4SLinus Torvalds 
23001da177e4SLinus Torvalds 	vc->scq->scd = get_free_scd(card, vc);
23011da177e4SLinus Torvalds 	if (vc->scq->scd == 0) {
23021da177e4SLinus Torvalds 		printk("%s: no SCD available.\n", card->name);
23031da177e4SLinus Torvalds 		free_scq(card, vc->scq);
23041da177e4SLinus Torvalds 		return -ENOMEM;
23051da177e4SLinus Torvalds 	}
23061da177e4SLinus Torvalds 
23071da177e4SLinus Torvalds 	fill_scd(card, vc->scq, vc->class);
23081da177e4SLinus Torvalds 
23091da177e4SLinus Torvalds 	if (set_tct(card, vc)) {
23101da177e4SLinus Torvalds 		printk("%s: class %d not supported.\n",
23111da177e4SLinus Torvalds 		       card->name, qos->txtp.traffic_class);
23121da177e4SLinus Torvalds 
23131da177e4SLinus Torvalds 		card->scd2vc[vc->scd_index] = NULL;
23141da177e4SLinus Torvalds 		free_scq(card, vc->scq);
23151da177e4SLinus Torvalds 		return -EPROTONOSUPPORT;
23161da177e4SLinus Torvalds 	}
23171da177e4SLinus Torvalds 
23181da177e4SLinus Torvalds 	switch (vc->class) {
23191da177e4SLinus Torvalds 		case SCHED_CBR:
23201da177e4SLinus Torvalds 			error = idt77252_init_cbr(card, vc, vcc, qos);
23211da177e4SLinus Torvalds 			if (error) {
23221da177e4SLinus Torvalds 				card->scd2vc[vc->scd_index] = NULL;
23231da177e4SLinus Torvalds 				free_scq(card, vc->scq);
23241da177e4SLinus Torvalds 				return error;
23251da177e4SLinus Torvalds 			}
23261da177e4SLinus Torvalds 
23271da177e4SLinus Torvalds 			clear_bit(VCF_IDLE, &vc->flags);
23281da177e4SLinus Torvalds 			writel(TCMDQ_START | vc->index, SAR_REG_TCMDQ);
23291da177e4SLinus Torvalds 			break;
23301da177e4SLinus Torvalds 
23311da177e4SLinus Torvalds 		case SCHED_UBR:
23321da177e4SLinus Torvalds 			error = idt77252_init_ubr(card, vc, vcc, qos);
23331da177e4SLinus Torvalds 			if (error) {
23341da177e4SLinus Torvalds 				card->scd2vc[vc->scd_index] = NULL;
23351da177e4SLinus Torvalds 				free_scq(card, vc->scq);
23361da177e4SLinus Torvalds 				return error;
23371da177e4SLinus Torvalds 			}
23381da177e4SLinus Torvalds 
23391da177e4SLinus Torvalds 			set_bit(VCF_IDLE, &vc->flags);
23401da177e4SLinus Torvalds 			break;
23411da177e4SLinus Torvalds 	}
23421da177e4SLinus Torvalds 
23431da177e4SLinus Torvalds 	vc->tx_vcc = vcc;
23441da177e4SLinus Torvalds 	set_bit(VCF_TX, &vc->flags);
23451da177e4SLinus Torvalds 	return 0;
23461da177e4SLinus Torvalds }
23471da177e4SLinus Torvalds 
23481da177e4SLinus Torvalds static int
23491da177e4SLinus Torvalds idt77252_init_rx(struct idt77252_dev *card, struct vc_map *vc,
23501da177e4SLinus Torvalds 		 struct atm_vcc *vcc, struct atm_qos *qos)
23511da177e4SLinus Torvalds {
23521da177e4SLinus Torvalds 	unsigned long flags;
23531da177e4SLinus Torvalds 	unsigned long addr;
23541da177e4SLinus Torvalds 	u32 rcte = 0;
23551da177e4SLinus Torvalds 
23561da177e4SLinus Torvalds 	if (test_bit(VCF_RX, &vc->flags))
23571da177e4SLinus Torvalds 		return -EBUSY;
23581da177e4SLinus Torvalds 
23591da177e4SLinus Torvalds 	vc->rx_vcc = vcc;
23601da177e4SLinus Torvalds 	set_bit(VCF_RX, &vc->flags);
23611da177e4SLinus Torvalds 
23621da177e4SLinus Torvalds 	if ((vcc->vci == 3) || (vcc->vci == 4))
23631da177e4SLinus Torvalds 		return 0;
23641da177e4SLinus Torvalds 
23651da177e4SLinus Torvalds 	flush_rx_pool(card, &vc->rcv.rx_pool);
23661da177e4SLinus Torvalds 
23671da177e4SLinus Torvalds 	rcte |= SAR_RCTE_CONNECTOPEN;
23681da177e4SLinus Torvalds 	rcte |= SAR_RCTE_RAWCELLINTEN;
23691da177e4SLinus Torvalds 
23701da177e4SLinus Torvalds 	switch (qos->aal) {
23711da177e4SLinus Torvalds 		case ATM_AAL0:
23721da177e4SLinus Torvalds 			rcte |= SAR_RCTE_RCQ;
23731da177e4SLinus Torvalds 			break;
23741da177e4SLinus Torvalds 		case ATM_AAL1:
23751da177e4SLinus Torvalds 			rcte |= SAR_RCTE_OAM; /* Let SAR drop Video */
23761da177e4SLinus Torvalds 			break;
23771da177e4SLinus Torvalds 		case ATM_AAL34:
23781da177e4SLinus Torvalds 			rcte |= SAR_RCTE_AAL34;
23791da177e4SLinus Torvalds 			break;
23801da177e4SLinus Torvalds 		case ATM_AAL5:
23811da177e4SLinus Torvalds 			rcte |= SAR_RCTE_AAL5;
23821da177e4SLinus Torvalds 			break;
23831da177e4SLinus Torvalds 		default:
23841da177e4SLinus Torvalds 			rcte |= SAR_RCTE_RCQ;
23851da177e4SLinus Torvalds 			break;
23861da177e4SLinus Torvalds 	}
23871da177e4SLinus Torvalds 
23881da177e4SLinus Torvalds 	if (qos->aal != ATM_AAL5)
23891da177e4SLinus Torvalds 		rcte |= SAR_RCTE_FBP_1;
23901da177e4SLinus Torvalds 	else if (qos->rxtp.max_sdu > SAR_FB_SIZE_2)
23911da177e4SLinus Torvalds 		rcte |= SAR_RCTE_FBP_3;
23921da177e4SLinus Torvalds 	else if (qos->rxtp.max_sdu > SAR_FB_SIZE_1)
23931da177e4SLinus Torvalds 		rcte |= SAR_RCTE_FBP_2;
23941da177e4SLinus Torvalds 	else if (qos->rxtp.max_sdu > SAR_FB_SIZE_0)
23951da177e4SLinus Torvalds 		rcte |= SAR_RCTE_FBP_1;
23961da177e4SLinus Torvalds 	else
23971da177e4SLinus Torvalds 		rcte |= SAR_RCTE_FBP_01;
23981da177e4SLinus Torvalds 
23991da177e4SLinus Torvalds 	addr = card->rct_base + (vc->index << 2);
24001da177e4SLinus Torvalds 
24011da177e4SLinus Torvalds 	OPRINTK("%s: writing RCT at 0x%lx\n", card->name, addr);
24021da177e4SLinus Torvalds 	write_sram(card, addr, rcte);
24031da177e4SLinus Torvalds 
24041da177e4SLinus Torvalds 	spin_lock_irqsave(&card->cmd_lock, flags);
24051da177e4SLinus Torvalds 	writel(SAR_CMD_OPEN_CONNECTION | (addr << 2), SAR_REG_CMD);
24061da177e4SLinus Torvalds 	waitfor_idle(card);
24071da177e4SLinus Torvalds 	spin_unlock_irqrestore(&card->cmd_lock, flags);
24081da177e4SLinus Torvalds 
24091da177e4SLinus Torvalds 	return 0;
24101da177e4SLinus Torvalds }
24111da177e4SLinus Torvalds 
24121da177e4SLinus Torvalds static int
24131da177e4SLinus Torvalds idt77252_open(struct atm_vcc *vcc)
24141da177e4SLinus Torvalds {
24151da177e4SLinus Torvalds 	struct atm_dev *dev = vcc->dev;
24161da177e4SLinus Torvalds 	struct idt77252_dev *card = dev->dev_data;
24171da177e4SLinus Torvalds 	struct vc_map *vc;
24181da177e4SLinus Torvalds 	unsigned int index;
24191da177e4SLinus Torvalds 	unsigned int inuse;
24201da177e4SLinus Torvalds 	int error;
24211da177e4SLinus Torvalds 	int vci = vcc->vci;
24221da177e4SLinus Torvalds 	short vpi = vcc->vpi;
24231da177e4SLinus Torvalds 
24241da177e4SLinus Torvalds 	if (vpi == ATM_VPI_UNSPEC || vci == ATM_VCI_UNSPEC)
24251da177e4SLinus Torvalds 		return 0;
24261da177e4SLinus Torvalds 
24271da177e4SLinus Torvalds 	if (vpi >= (1 << card->vpibits)) {
24281da177e4SLinus Torvalds 		printk("%s: unsupported VPI: %d\n", card->name, vpi);
24291da177e4SLinus Torvalds 		return -EINVAL;
24301da177e4SLinus Torvalds 	}
24311da177e4SLinus Torvalds 
24321da177e4SLinus Torvalds 	if (vci >= (1 << card->vcibits)) {
24331da177e4SLinus Torvalds 		printk("%s: unsupported VCI: %d\n", card->name, vci);
24341da177e4SLinus Torvalds 		return -EINVAL;
24351da177e4SLinus Torvalds 	}
24361da177e4SLinus Torvalds 
24371da177e4SLinus Torvalds 	set_bit(ATM_VF_ADDR, &vcc->flags);
24381da177e4SLinus Torvalds 
24397e7a2d07SMatthias Kaehlcke 	mutex_lock(&card->mutex);
24401da177e4SLinus Torvalds 
24411da177e4SLinus Torvalds 	OPRINTK("%s: opening vpi.vci: %d.%d\n", card->name, vpi, vci);
24421da177e4SLinus Torvalds 
24431da177e4SLinus Torvalds 	switch (vcc->qos.aal) {
24441da177e4SLinus Torvalds 	case ATM_AAL0:
24451da177e4SLinus Torvalds 	case ATM_AAL1:
24461da177e4SLinus Torvalds 	case ATM_AAL5:
24471da177e4SLinus Torvalds 		break;
24481da177e4SLinus Torvalds 	default:
24491da177e4SLinus Torvalds 		printk("%s: Unsupported AAL: %d\n", card->name, vcc->qos.aal);
24507e7a2d07SMatthias Kaehlcke 		mutex_unlock(&card->mutex);
24511da177e4SLinus Torvalds 		return -EPROTONOSUPPORT;
24521da177e4SLinus Torvalds 	}
24531da177e4SLinus Torvalds 
24541da177e4SLinus Torvalds 	index = VPCI2VC(card, vpi, vci);
24551da177e4SLinus Torvalds 	if (!card->vcs[index]) {
24560c1cca1dSOm Narasimhan 		card->vcs[index] = kzalloc(sizeof(struct vc_map), GFP_KERNEL);
24571da177e4SLinus Torvalds 		if (!card->vcs[index]) {
24581da177e4SLinus Torvalds 			printk("%s: can't alloc vc in open()\n", card->name);
24597e7a2d07SMatthias Kaehlcke 			mutex_unlock(&card->mutex);
24601da177e4SLinus Torvalds 			return -ENOMEM;
24611da177e4SLinus Torvalds 		}
24621da177e4SLinus Torvalds 		card->vcs[index]->card = card;
24631da177e4SLinus Torvalds 		card->vcs[index]->index = index;
24641da177e4SLinus Torvalds 
24651da177e4SLinus Torvalds 		spin_lock_init(&card->vcs[index]->lock);
24661da177e4SLinus Torvalds 	}
24671da177e4SLinus Torvalds 	vc = card->vcs[index];
24681da177e4SLinus Torvalds 
24691da177e4SLinus Torvalds 	vcc->dev_data = vc;
24701da177e4SLinus Torvalds 
24711da177e4SLinus Torvalds 	IPRINTK("%s: idt77252_open: vc = %d (%d.%d) %s/%s (max RX SDU: %u)\n",
24721da177e4SLinus Torvalds 	        card->name, vc->index, vcc->vpi, vcc->vci,
24731da177e4SLinus Torvalds 	        vcc->qos.rxtp.traffic_class != ATM_NONE ? "rx" : "--",
24741da177e4SLinus Torvalds 	        vcc->qos.txtp.traffic_class != ATM_NONE ? "tx" : "--",
24751da177e4SLinus Torvalds 	        vcc->qos.rxtp.max_sdu);
24761da177e4SLinus Torvalds 
24771da177e4SLinus Torvalds 	inuse = 0;
24781da177e4SLinus Torvalds 	if (vcc->qos.txtp.traffic_class != ATM_NONE &&
24791da177e4SLinus Torvalds 	    test_bit(VCF_TX, &vc->flags))
24801da177e4SLinus Torvalds 		inuse = 1;
24811da177e4SLinus Torvalds 	if (vcc->qos.rxtp.traffic_class != ATM_NONE &&
24821da177e4SLinus Torvalds 	    test_bit(VCF_RX, &vc->flags))
24831da177e4SLinus Torvalds 		inuse += 2;
24841da177e4SLinus Torvalds 
24851da177e4SLinus Torvalds 	if (inuse) {
24861da177e4SLinus Torvalds 		printk("%s: %s vci already in use.\n", card->name,
24871da177e4SLinus Torvalds 		       inuse == 1 ? "tx" : inuse == 2 ? "rx" : "tx and rx");
24887e7a2d07SMatthias Kaehlcke 		mutex_unlock(&card->mutex);
24891da177e4SLinus Torvalds 		return -EADDRINUSE;
24901da177e4SLinus Torvalds 	}
24911da177e4SLinus Torvalds 
24921da177e4SLinus Torvalds 	if (vcc->qos.txtp.traffic_class != ATM_NONE) {
24931da177e4SLinus Torvalds 		error = idt77252_init_tx(card, vc, vcc, &vcc->qos);
24941da177e4SLinus Torvalds 		if (error) {
24957e7a2d07SMatthias Kaehlcke 			mutex_unlock(&card->mutex);
24961da177e4SLinus Torvalds 			return error;
24971da177e4SLinus Torvalds 		}
24981da177e4SLinus Torvalds 	}
24991da177e4SLinus Torvalds 
25001da177e4SLinus Torvalds 	if (vcc->qos.rxtp.traffic_class != ATM_NONE) {
25011da177e4SLinus Torvalds 		error = idt77252_init_rx(card, vc, vcc, &vcc->qos);
25021da177e4SLinus Torvalds 		if (error) {
25037e7a2d07SMatthias Kaehlcke 			mutex_unlock(&card->mutex);
25041da177e4SLinus Torvalds 			return error;
25051da177e4SLinus Torvalds 		}
25061da177e4SLinus Torvalds 	}
25071da177e4SLinus Torvalds 
25081da177e4SLinus Torvalds 	set_bit(ATM_VF_READY, &vcc->flags);
25091da177e4SLinus Torvalds 
25107e7a2d07SMatthias Kaehlcke 	mutex_unlock(&card->mutex);
25111da177e4SLinus Torvalds 	return 0;
25121da177e4SLinus Torvalds }
25131da177e4SLinus Torvalds 
25141da177e4SLinus Torvalds static void
25151da177e4SLinus Torvalds idt77252_close(struct atm_vcc *vcc)
25161da177e4SLinus Torvalds {
25171da177e4SLinus Torvalds 	struct atm_dev *dev = vcc->dev;
25181da177e4SLinus Torvalds 	struct idt77252_dev *card = dev->dev_data;
25191da177e4SLinus Torvalds 	struct vc_map *vc = vcc->dev_data;
25201da177e4SLinus Torvalds 	unsigned long flags;
25211da177e4SLinus Torvalds 	unsigned long addr;
25221da177e4SLinus Torvalds 	unsigned long timeout;
25231da177e4SLinus Torvalds 
25247e7a2d07SMatthias Kaehlcke 	mutex_lock(&card->mutex);
25251da177e4SLinus Torvalds 
25261da177e4SLinus Torvalds 	IPRINTK("%s: idt77252_close: vc = %d (%d.%d)\n",
25271da177e4SLinus Torvalds 		card->name, vc->index, vcc->vpi, vcc->vci);
25281da177e4SLinus Torvalds 
25291da177e4SLinus Torvalds 	clear_bit(ATM_VF_READY, &vcc->flags);
25301da177e4SLinus Torvalds 
25311da177e4SLinus Torvalds 	if (vcc->qos.rxtp.traffic_class != ATM_NONE) {
25321da177e4SLinus Torvalds 
25331da177e4SLinus Torvalds 		spin_lock_irqsave(&vc->lock, flags);
25341da177e4SLinus Torvalds 		clear_bit(VCF_RX, &vc->flags);
25351da177e4SLinus Torvalds 		vc->rx_vcc = NULL;
25361da177e4SLinus Torvalds 		spin_unlock_irqrestore(&vc->lock, flags);
25371da177e4SLinus Torvalds 
25381da177e4SLinus Torvalds 		if ((vcc->vci == 3) || (vcc->vci == 4))
25391da177e4SLinus Torvalds 			goto done;
25401da177e4SLinus Torvalds 
25411da177e4SLinus Torvalds 		addr = card->rct_base + vc->index * SAR_SRAM_RCT_SIZE;
25421da177e4SLinus Torvalds 
25431da177e4SLinus Torvalds 		spin_lock_irqsave(&card->cmd_lock, flags);
25441da177e4SLinus Torvalds 		writel(SAR_CMD_CLOSE_CONNECTION | (addr << 2), SAR_REG_CMD);
25451da177e4SLinus Torvalds 		waitfor_idle(card);
25461da177e4SLinus Torvalds 		spin_unlock_irqrestore(&card->cmd_lock, flags);
25471da177e4SLinus Torvalds 
25481da177e4SLinus Torvalds 		if (vc->rcv.rx_pool.count) {
25491da177e4SLinus Torvalds 			DPRINTK("%s: closing a VC with pending rx buffers.\n",
25501da177e4SLinus Torvalds 				card->name);
25511da177e4SLinus Torvalds 
25521da177e4SLinus Torvalds 			recycle_rx_pool_skb(card, &vc->rcv.rx_pool);
25531da177e4SLinus Torvalds 		}
25541da177e4SLinus Torvalds 	}
25551da177e4SLinus Torvalds 
25561da177e4SLinus Torvalds done:
25571da177e4SLinus Torvalds 	if (vcc->qos.txtp.traffic_class != ATM_NONE) {
25581da177e4SLinus Torvalds 
25591da177e4SLinus Torvalds 		spin_lock_irqsave(&vc->lock, flags);
25601da177e4SLinus Torvalds 		clear_bit(VCF_TX, &vc->flags);
25611da177e4SLinus Torvalds 		clear_bit(VCF_IDLE, &vc->flags);
25621da177e4SLinus Torvalds 		clear_bit(VCF_RSV, &vc->flags);
25631da177e4SLinus Torvalds 		vc->tx_vcc = NULL;
25641da177e4SLinus Torvalds 
25651da177e4SLinus Torvalds 		if (vc->estimator) {
25661da177e4SLinus Torvalds 			del_timer(&vc->estimator->timer);
25671da177e4SLinus Torvalds 			kfree(vc->estimator);
25681da177e4SLinus Torvalds 			vc->estimator = NULL;
25691da177e4SLinus Torvalds 		}
25701da177e4SLinus Torvalds 		spin_unlock_irqrestore(&vc->lock, flags);
25711da177e4SLinus Torvalds 
25721da177e4SLinus Torvalds 		timeout = 5 * 1000;
25731da177e4SLinus Torvalds 		while (atomic_read(&vc->scq->used) > 0) {
25741da177e4SLinus Torvalds 			timeout = msleep_interruptible(timeout);
25751da177e4SLinus Torvalds 			if (!timeout)
25761da177e4SLinus Torvalds 				break;
25771da177e4SLinus Torvalds 		}
25781da177e4SLinus Torvalds 		if (!timeout)
25791da177e4SLinus Torvalds 			printk("%s: SCQ drain timeout: %u used\n",
25801da177e4SLinus Torvalds 			       card->name, atomic_read(&vc->scq->used));
25811da177e4SLinus Torvalds 
25821da177e4SLinus Torvalds 		writel(TCMDQ_HALT | vc->index, SAR_REG_TCMDQ);
25831da177e4SLinus Torvalds 		clear_scd(card, vc->scq, vc->class);
25841da177e4SLinus Torvalds 
25851da177e4SLinus Torvalds 		if (vc->class == SCHED_CBR) {
25861da177e4SLinus Torvalds 			clear_tst(card, vc);
25871da177e4SLinus Torvalds 			card->tst_free += vc->ntste;
25881da177e4SLinus Torvalds 			vc->ntste = 0;
25891da177e4SLinus Torvalds 		}
25901da177e4SLinus Torvalds 
25911da177e4SLinus Torvalds 		card->scd2vc[vc->scd_index] = NULL;
25921da177e4SLinus Torvalds 		free_scq(card, vc->scq);
25931da177e4SLinus Torvalds 	}
25941da177e4SLinus Torvalds 
25957e7a2d07SMatthias Kaehlcke 	mutex_unlock(&card->mutex);
25961da177e4SLinus Torvalds }
25971da177e4SLinus Torvalds 
25981da177e4SLinus Torvalds static int
25991da177e4SLinus Torvalds idt77252_change_qos(struct atm_vcc *vcc, struct atm_qos *qos, int flags)
26001da177e4SLinus Torvalds {
26011da177e4SLinus Torvalds 	struct atm_dev *dev = vcc->dev;
26021da177e4SLinus Torvalds 	struct idt77252_dev *card = dev->dev_data;
26031da177e4SLinus Torvalds 	struct vc_map *vc = vcc->dev_data;
26041da177e4SLinus Torvalds 	int error = 0;
26051da177e4SLinus Torvalds 
26067e7a2d07SMatthias Kaehlcke 	mutex_lock(&card->mutex);
26071da177e4SLinus Torvalds 
26081da177e4SLinus Torvalds 	if (qos->txtp.traffic_class != ATM_NONE) {
26091da177e4SLinus Torvalds 	    	if (!test_bit(VCF_TX, &vc->flags)) {
26101da177e4SLinus Torvalds 			error = idt77252_init_tx(card, vc, vcc, qos);
26111da177e4SLinus Torvalds 			if (error)
26121da177e4SLinus Torvalds 				goto out;
26131da177e4SLinus Torvalds 		} else {
26141da177e4SLinus Torvalds 			switch (qos->txtp.traffic_class) {
26151da177e4SLinus Torvalds 			case ATM_CBR:
26161da177e4SLinus Torvalds 				error = idt77252_init_cbr(card, vc, vcc, qos);
26171da177e4SLinus Torvalds 				if (error)
26181da177e4SLinus Torvalds 					goto out;
26191da177e4SLinus Torvalds 				break;
26201da177e4SLinus Torvalds 
26211da177e4SLinus Torvalds 			case ATM_UBR:
26221da177e4SLinus Torvalds 				error = idt77252_init_ubr(card, vc, vcc, qos);
26231da177e4SLinus Torvalds 				if (error)
26241da177e4SLinus Torvalds 					goto out;
26251da177e4SLinus Torvalds 
26261da177e4SLinus Torvalds 				if (!test_bit(VCF_IDLE, &vc->flags)) {
26271da177e4SLinus Torvalds 					writel(TCMDQ_LACR | (vc->lacr << 16) |
26281da177e4SLinus Torvalds 					       vc->index, SAR_REG_TCMDQ);
26291da177e4SLinus Torvalds 				}
26301da177e4SLinus Torvalds 				break;
26311da177e4SLinus Torvalds 
26321da177e4SLinus Torvalds 			case ATM_VBR:
26331da177e4SLinus Torvalds 			case ATM_ABR:
26341da177e4SLinus Torvalds 				error = -EOPNOTSUPP;
26351da177e4SLinus Torvalds 				goto out;
26361da177e4SLinus Torvalds 			}
26371da177e4SLinus Torvalds 		}
26381da177e4SLinus Torvalds 	}
26391da177e4SLinus Torvalds 
26401da177e4SLinus Torvalds 	if ((qos->rxtp.traffic_class != ATM_NONE) &&
26411da177e4SLinus Torvalds 	    !test_bit(VCF_RX, &vc->flags)) {
26421da177e4SLinus Torvalds 		error = idt77252_init_rx(card, vc, vcc, qos);
26431da177e4SLinus Torvalds 		if (error)
26441da177e4SLinus Torvalds 			goto out;
26451da177e4SLinus Torvalds 	}
26461da177e4SLinus Torvalds 
26471da177e4SLinus Torvalds 	memcpy(&vcc->qos, qos, sizeof(struct atm_qos));
26481da177e4SLinus Torvalds 
26491da177e4SLinus Torvalds 	set_bit(ATM_VF_HASQOS, &vcc->flags);
26501da177e4SLinus Torvalds 
26511da177e4SLinus Torvalds out:
26527e7a2d07SMatthias Kaehlcke 	mutex_unlock(&card->mutex);
26531da177e4SLinus Torvalds 	return error;
26541da177e4SLinus Torvalds }
26551da177e4SLinus Torvalds 
26561da177e4SLinus Torvalds static int
26571da177e4SLinus Torvalds idt77252_proc_read(struct atm_dev *dev, loff_t * pos, char *page)
26581da177e4SLinus Torvalds {
26591da177e4SLinus Torvalds 	struct idt77252_dev *card = dev->dev_data;
26601da177e4SLinus Torvalds 	int i, left;
26611da177e4SLinus Torvalds 
26621da177e4SLinus Torvalds 	left = (int) *pos;
26631da177e4SLinus Torvalds 	if (!left--)
26641da177e4SLinus Torvalds 		return sprintf(page, "IDT77252 Interrupts:\n");
26651da177e4SLinus Torvalds 	if (!left--)
26661da177e4SLinus Torvalds 		return sprintf(page, "TSIF:  %lu\n", card->irqstat[15]);
26671da177e4SLinus Torvalds 	if (!left--)
26681da177e4SLinus Torvalds 		return sprintf(page, "TXICP: %lu\n", card->irqstat[14]);
26691da177e4SLinus Torvalds 	if (!left--)
26701da177e4SLinus Torvalds 		return sprintf(page, "TSQF:  %lu\n", card->irqstat[12]);
26711da177e4SLinus Torvalds 	if (!left--)
26721da177e4SLinus Torvalds 		return sprintf(page, "TMROF: %lu\n", card->irqstat[11]);
26731da177e4SLinus Torvalds 	if (!left--)
26741da177e4SLinus Torvalds 		return sprintf(page, "PHYI:  %lu\n", card->irqstat[10]);
26751da177e4SLinus Torvalds 	if (!left--)
26761da177e4SLinus Torvalds 		return sprintf(page, "FBQ3A: %lu\n", card->irqstat[8]);
26771da177e4SLinus Torvalds 	if (!left--)
26781da177e4SLinus Torvalds 		return sprintf(page, "FBQ2A: %lu\n", card->irqstat[7]);
26791da177e4SLinus Torvalds 	if (!left--)
26801da177e4SLinus Torvalds 		return sprintf(page, "RSQF:  %lu\n", card->irqstat[6]);
26811da177e4SLinus Torvalds 	if (!left--)
26821da177e4SLinus Torvalds 		return sprintf(page, "EPDU:  %lu\n", card->irqstat[5]);
26831da177e4SLinus Torvalds 	if (!left--)
26841da177e4SLinus Torvalds 		return sprintf(page, "RAWCF: %lu\n", card->irqstat[4]);
26851da177e4SLinus Torvalds 	if (!left--)
26861da177e4SLinus Torvalds 		return sprintf(page, "FBQ1A: %lu\n", card->irqstat[3]);
26871da177e4SLinus Torvalds 	if (!left--)
26881da177e4SLinus Torvalds 		return sprintf(page, "FBQ0A: %lu\n", card->irqstat[2]);
26891da177e4SLinus Torvalds 	if (!left--)
26901da177e4SLinus Torvalds 		return sprintf(page, "RSQAF: %lu\n", card->irqstat[1]);
26911da177e4SLinus Torvalds 	if (!left--)
26921da177e4SLinus Torvalds 		return sprintf(page, "IDT77252 Transmit Connection Table:\n");
26931da177e4SLinus Torvalds 
26941da177e4SLinus Torvalds 	for (i = 0; i < card->tct_size; i++) {
26951da177e4SLinus Torvalds 		unsigned long tct;
26961da177e4SLinus Torvalds 		struct atm_vcc *vcc;
26971da177e4SLinus Torvalds 		struct vc_map *vc;
26981da177e4SLinus Torvalds 		char *p;
26991da177e4SLinus Torvalds 
27001da177e4SLinus Torvalds 		vc = card->vcs[i];
27011da177e4SLinus Torvalds 		if (!vc)
27021da177e4SLinus Torvalds 			continue;
27031da177e4SLinus Torvalds 
27041da177e4SLinus Torvalds 		vcc = NULL;
27051da177e4SLinus Torvalds 		if (vc->tx_vcc)
27061da177e4SLinus Torvalds 			vcc = vc->tx_vcc;
27071da177e4SLinus Torvalds 		if (!vcc)
27081da177e4SLinus Torvalds 			continue;
27091da177e4SLinus Torvalds 		if (left--)
27101da177e4SLinus Torvalds 			continue;
27111da177e4SLinus Torvalds 
27121da177e4SLinus Torvalds 		p = page;
27131da177e4SLinus Torvalds 		p += sprintf(p, "  %4u: %u.%u: ", i, vcc->vpi, vcc->vci);
27141da177e4SLinus Torvalds 		tct = (unsigned long) (card->tct_base + i * SAR_SRAM_TCT_SIZE);
27151da177e4SLinus Torvalds 
27161da177e4SLinus Torvalds 		for (i = 0; i < 8; i++)
27171da177e4SLinus Torvalds 			p += sprintf(p, " %08x", read_sram(card, tct + i));
27181da177e4SLinus Torvalds 		p += sprintf(p, "\n");
27191da177e4SLinus Torvalds 		return p - page;
27201da177e4SLinus Torvalds 	}
27211da177e4SLinus Torvalds 	return 0;
27221da177e4SLinus Torvalds }
27231da177e4SLinus Torvalds 
27241da177e4SLinus Torvalds /*****************************************************************************/
27251da177e4SLinus Torvalds /*                                                                           */
27261da177e4SLinus Torvalds /* Interrupt handler                                                         */
27271da177e4SLinus Torvalds /*                                                                           */
27281da177e4SLinus Torvalds /*****************************************************************************/
27291da177e4SLinus Torvalds 
27301da177e4SLinus Torvalds static void
27311da177e4SLinus Torvalds idt77252_collect_stat(struct idt77252_dev *card)
27321da177e4SLinus Torvalds {
27331da177e4SLinus Torvalds 	u32 cdc, vpec, icc;
27341da177e4SLinus Torvalds 
27351da177e4SLinus Torvalds 	cdc = readl(SAR_REG_CDC);
27361da177e4SLinus Torvalds 	vpec = readl(SAR_REG_VPEC);
27371da177e4SLinus Torvalds 	icc = readl(SAR_REG_ICC);
27381da177e4SLinus Torvalds 
27391da177e4SLinus Torvalds #ifdef	NOTDEF
27401da177e4SLinus Torvalds 	printk("%s:", card->name);
27411da177e4SLinus Torvalds 
27421da177e4SLinus Torvalds 	if (cdc & 0x7f0000) {
27431da177e4SLinus Torvalds 		char *s = "";
27441da177e4SLinus Torvalds 
27451da177e4SLinus Torvalds 		printk(" [");
27461da177e4SLinus Torvalds 		if (cdc & (1 << 22)) {
27471da177e4SLinus Torvalds 			printk("%sRM ID", s);
27481da177e4SLinus Torvalds 			s = " | ";
27491da177e4SLinus Torvalds 		}
27501da177e4SLinus Torvalds 		if (cdc & (1 << 21)) {
27511da177e4SLinus Torvalds 			printk("%sCON TAB", s);
27521da177e4SLinus Torvalds 			s = " | ";
27531da177e4SLinus Torvalds 		}
27541da177e4SLinus Torvalds 		if (cdc & (1 << 20)) {
27551da177e4SLinus Torvalds 			printk("%sNO FB", s);
27561da177e4SLinus Torvalds 			s = " | ";
27571da177e4SLinus Torvalds 		}
27581da177e4SLinus Torvalds 		if (cdc & (1 << 19)) {
27591da177e4SLinus Torvalds 			printk("%sOAM CRC", s);
27601da177e4SLinus Torvalds 			s = " | ";
27611da177e4SLinus Torvalds 		}
27621da177e4SLinus Torvalds 		if (cdc & (1 << 18)) {
27631da177e4SLinus Torvalds 			printk("%sRM CRC", s);
27641da177e4SLinus Torvalds 			s = " | ";
27651da177e4SLinus Torvalds 		}
27661da177e4SLinus Torvalds 		if (cdc & (1 << 17)) {
27671da177e4SLinus Torvalds 			printk("%sRM FIFO", s);
27681da177e4SLinus Torvalds 			s = " | ";
27691da177e4SLinus Torvalds 		}
27701da177e4SLinus Torvalds 		if (cdc & (1 << 16)) {
27711da177e4SLinus Torvalds 			printk("%sRX FIFO", s);
27721da177e4SLinus Torvalds 			s = " | ";
27731da177e4SLinus Torvalds 		}
27741da177e4SLinus Torvalds 		printk("]");
27751da177e4SLinus Torvalds 	}
27761da177e4SLinus Torvalds 
27771da177e4SLinus Torvalds 	printk(" CDC %04x, VPEC %04x, ICC: %04x\n",
27781da177e4SLinus Torvalds 	       cdc & 0xffff, vpec & 0xffff, icc & 0xffff);
27791da177e4SLinus Torvalds #endif
27801da177e4SLinus Torvalds }
27811da177e4SLinus Torvalds 
27821da177e4SLinus Torvalds static irqreturn_t
27837d12e780SDavid Howells idt77252_interrupt(int irq, void *dev_id)
27841da177e4SLinus Torvalds {
27851da177e4SLinus Torvalds 	struct idt77252_dev *card = dev_id;
27861da177e4SLinus Torvalds 	u32 stat;
27871da177e4SLinus Torvalds 
27881da177e4SLinus Torvalds 	stat = readl(SAR_REG_STAT) & 0xffff;
27891da177e4SLinus Torvalds 	if (!stat)	/* no interrupt for us */
27901da177e4SLinus Torvalds 		return IRQ_NONE;
27911da177e4SLinus Torvalds 
27921da177e4SLinus Torvalds 	if (test_and_set_bit(IDT77252_BIT_INTERRUPT, &card->flags)) {
27931da177e4SLinus Torvalds 		printk("%s: Re-entering irq_handler()\n", card->name);
27941da177e4SLinus Torvalds 		goto out;
27951da177e4SLinus Torvalds 	}
27961da177e4SLinus Torvalds 
27971da177e4SLinus Torvalds 	writel(stat, SAR_REG_STAT);	/* reset interrupt */
27981da177e4SLinus Torvalds 
27991da177e4SLinus Torvalds 	if (stat & SAR_STAT_TSIF) {	/* entry written to TSQ  */
28001da177e4SLinus Torvalds 		INTPRINTK("%s: TSIF\n", card->name);
28011da177e4SLinus Torvalds 		card->irqstat[15]++;
28021da177e4SLinus Torvalds 		idt77252_tx(card);
28031da177e4SLinus Torvalds 	}
28041da177e4SLinus Torvalds 	if (stat & SAR_STAT_TXICP) {	/* Incomplete CS-PDU has  */
28051da177e4SLinus Torvalds 		INTPRINTK("%s: TXICP\n", card->name);
28061da177e4SLinus Torvalds 		card->irqstat[14]++;
28071da177e4SLinus Torvalds #ifdef CONFIG_ATM_IDT77252_DEBUG
28081da177e4SLinus Torvalds 		idt77252_tx_dump(card);
28091da177e4SLinus Torvalds #endif
28101da177e4SLinus Torvalds 	}
28111da177e4SLinus Torvalds 	if (stat & SAR_STAT_TSQF) {	/* TSQ 7/8 full           */
28121da177e4SLinus Torvalds 		INTPRINTK("%s: TSQF\n", card->name);
28131da177e4SLinus Torvalds 		card->irqstat[12]++;
28141da177e4SLinus Torvalds 		idt77252_tx(card);
28151da177e4SLinus Torvalds 	}
28161da177e4SLinus Torvalds 	if (stat & SAR_STAT_TMROF) {	/* Timer overflow         */
28171da177e4SLinus Torvalds 		INTPRINTK("%s: TMROF\n", card->name);
28181da177e4SLinus Torvalds 		card->irqstat[11]++;
28191da177e4SLinus Torvalds 		idt77252_collect_stat(card);
28201da177e4SLinus Torvalds 	}
28211da177e4SLinus Torvalds 
28221da177e4SLinus Torvalds 	if (stat & SAR_STAT_EPDU) {	/* Got complete CS-PDU    */
28231da177e4SLinus Torvalds 		INTPRINTK("%s: EPDU\n", card->name);
28241da177e4SLinus Torvalds 		card->irqstat[5]++;
28251da177e4SLinus Torvalds 		idt77252_rx(card);
28261da177e4SLinus Torvalds 	}
28271da177e4SLinus Torvalds 	if (stat & SAR_STAT_RSQAF) {	/* RSQ is 7/8 full        */
28281da177e4SLinus Torvalds 		INTPRINTK("%s: RSQAF\n", card->name);
28291da177e4SLinus Torvalds 		card->irqstat[1]++;
28301da177e4SLinus Torvalds 		idt77252_rx(card);
28311da177e4SLinus Torvalds 	}
28321da177e4SLinus Torvalds 	if (stat & SAR_STAT_RSQF) {	/* RSQ is full            */
28331da177e4SLinus Torvalds 		INTPRINTK("%s: RSQF\n", card->name);
28341da177e4SLinus Torvalds 		card->irqstat[6]++;
28351da177e4SLinus Torvalds 		idt77252_rx(card);
28361da177e4SLinus Torvalds 	}
28371da177e4SLinus Torvalds 	if (stat & SAR_STAT_RAWCF) {	/* Raw cell received      */
28381da177e4SLinus Torvalds 		INTPRINTK("%s: RAWCF\n", card->name);
28391da177e4SLinus Torvalds 		card->irqstat[4]++;
28401da177e4SLinus Torvalds 		idt77252_rx_raw(card);
28411da177e4SLinus Torvalds 	}
28421da177e4SLinus Torvalds 
28431da177e4SLinus Torvalds 	if (stat & SAR_STAT_PHYI) {	/* PHY device interrupt   */
28441da177e4SLinus Torvalds 		INTPRINTK("%s: PHYI", card->name);
28451da177e4SLinus Torvalds 		card->irqstat[10]++;
28461da177e4SLinus Torvalds 		if (card->atmdev->phy && card->atmdev->phy->interrupt)
28471da177e4SLinus Torvalds 			card->atmdev->phy->interrupt(card->atmdev);
28481da177e4SLinus Torvalds 	}
28491da177e4SLinus Torvalds 
28501da177e4SLinus Torvalds 	if (stat & (SAR_STAT_FBQ0A | SAR_STAT_FBQ1A |
28511da177e4SLinus Torvalds 		    SAR_STAT_FBQ2A | SAR_STAT_FBQ3A)) {
28521da177e4SLinus Torvalds 
28531da177e4SLinus Torvalds 		writel(readl(SAR_REG_CFG) & ~(SAR_CFG_FBIE), SAR_REG_CFG);
28541da177e4SLinus Torvalds 
28551da177e4SLinus Torvalds 		INTPRINTK("%s: FBQA: %04x\n", card->name, stat);
28561da177e4SLinus Torvalds 
28571da177e4SLinus Torvalds 		if (stat & SAR_STAT_FBQ0A)
28581da177e4SLinus Torvalds 			card->irqstat[2]++;
28591da177e4SLinus Torvalds 		if (stat & SAR_STAT_FBQ1A)
28601da177e4SLinus Torvalds 			card->irqstat[3]++;
28611da177e4SLinus Torvalds 		if (stat & SAR_STAT_FBQ2A)
28621da177e4SLinus Torvalds 			card->irqstat[7]++;
28631da177e4SLinus Torvalds 		if (stat & SAR_STAT_FBQ3A)
28641da177e4SLinus Torvalds 			card->irqstat[8]++;
28651da177e4SLinus Torvalds 
28661da177e4SLinus Torvalds 		schedule_work(&card->tqueue);
28671da177e4SLinus Torvalds 	}
28681da177e4SLinus Torvalds 
28691da177e4SLinus Torvalds out:
28701da177e4SLinus Torvalds 	clear_bit(IDT77252_BIT_INTERRUPT, &card->flags);
28711da177e4SLinus Torvalds 	return IRQ_HANDLED;
28721da177e4SLinus Torvalds }
28731da177e4SLinus Torvalds 
28741da177e4SLinus Torvalds static void
2875c4028958SDavid Howells idt77252_softint(struct work_struct *work)
28761da177e4SLinus Torvalds {
2877c4028958SDavid Howells 	struct idt77252_dev *card =
2878c4028958SDavid Howells 		container_of(work, struct idt77252_dev, tqueue);
28791da177e4SLinus Torvalds 	u32 stat;
28801da177e4SLinus Torvalds 	int done;
28811da177e4SLinus Torvalds 
28821da177e4SLinus Torvalds 	for (done = 1; ; done = 1) {
28831da177e4SLinus Torvalds 		stat = readl(SAR_REG_STAT) >> 16;
28841da177e4SLinus Torvalds 
28851da177e4SLinus Torvalds 		if ((stat & 0x0f) < SAR_FBQ0_HIGH) {
28861da177e4SLinus Torvalds 			add_rx_skb(card, 0, SAR_FB_SIZE_0, 32);
28871da177e4SLinus Torvalds 			done = 0;
28881da177e4SLinus Torvalds 		}
28891da177e4SLinus Torvalds 
28901da177e4SLinus Torvalds 		stat >>= 4;
28911da177e4SLinus Torvalds 		if ((stat & 0x0f) < SAR_FBQ1_HIGH) {
28921da177e4SLinus Torvalds 			add_rx_skb(card, 1, SAR_FB_SIZE_1, 32);
28931da177e4SLinus Torvalds 			done = 0;
28941da177e4SLinus Torvalds 		}
28951da177e4SLinus Torvalds 
28961da177e4SLinus Torvalds 		stat >>= 4;
28971da177e4SLinus Torvalds 		if ((stat & 0x0f) < SAR_FBQ2_HIGH) {
28981da177e4SLinus Torvalds 			add_rx_skb(card, 2, SAR_FB_SIZE_2, 32);
28991da177e4SLinus Torvalds 			done = 0;
29001da177e4SLinus Torvalds 		}
29011da177e4SLinus Torvalds 
29021da177e4SLinus Torvalds 		stat >>= 4;
29031da177e4SLinus Torvalds 		if ((stat & 0x0f) < SAR_FBQ3_HIGH) {
29041da177e4SLinus Torvalds 			add_rx_skb(card, 3, SAR_FB_SIZE_3, 32);
29051da177e4SLinus Torvalds 			done = 0;
29061da177e4SLinus Torvalds 		}
29071da177e4SLinus Torvalds 
29081da177e4SLinus Torvalds 		if (done)
29091da177e4SLinus Torvalds 			break;
29101da177e4SLinus Torvalds 	}
29111da177e4SLinus Torvalds 
29121da177e4SLinus Torvalds 	writel(readl(SAR_REG_CFG) | SAR_CFG_FBIE, SAR_REG_CFG);
29131da177e4SLinus Torvalds }
29141da177e4SLinus Torvalds 
29151da177e4SLinus Torvalds 
29161da177e4SLinus Torvalds static int
29171da177e4SLinus Torvalds open_card_oam(struct idt77252_dev *card)
29181da177e4SLinus Torvalds {
29191da177e4SLinus Torvalds 	unsigned long flags;
29201da177e4SLinus Torvalds 	unsigned long addr;
29211da177e4SLinus Torvalds 	struct vc_map *vc;
29221da177e4SLinus Torvalds 	int vpi, vci;
29231da177e4SLinus Torvalds 	int index;
29241da177e4SLinus Torvalds 	u32 rcte;
29251da177e4SLinus Torvalds 
29261da177e4SLinus Torvalds 	for (vpi = 0; vpi < (1 << card->vpibits); vpi++) {
29271da177e4SLinus Torvalds 		for (vci = 3; vci < 5; vci++) {
29281da177e4SLinus Torvalds 			index = VPCI2VC(card, vpi, vci);
29291da177e4SLinus Torvalds 
29300c1cca1dSOm Narasimhan 			vc = kzalloc(sizeof(struct vc_map), GFP_KERNEL);
29311da177e4SLinus Torvalds 			if (!vc) {
29321da177e4SLinus Torvalds 				printk("%s: can't alloc vc\n", card->name);
29331da177e4SLinus Torvalds 				return -ENOMEM;
29341da177e4SLinus Torvalds 			}
29351da177e4SLinus Torvalds 			vc->index = index;
29361da177e4SLinus Torvalds 			card->vcs[index] = vc;
29371da177e4SLinus Torvalds 
29381da177e4SLinus Torvalds 			flush_rx_pool(card, &vc->rcv.rx_pool);
29391da177e4SLinus Torvalds 
29401da177e4SLinus Torvalds 			rcte = SAR_RCTE_CONNECTOPEN |
29411da177e4SLinus Torvalds 			       SAR_RCTE_RAWCELLINTEN |
29421da177e4SLinus Torvalds 			       SAR_RCTE_RCQ |
29431da177e4SLinus Torvalds 			       SAR_RCTE_FBP_1;
29441da177e4SLinus Torvalds 
29451da177e4SLinus Torvalds 			addr = card->rct_base + (vc->index << 2);
29461da177e4SLinus Torvalds 			write_sram(card, addr, rcte);
29471da177e4SLinus Torvalds 
29481da177e4SLinus Torvalds 			spin_lock_irqsave(&card->cmd_lock, flags);
29491da177e4SLinus Torvalds 			writel(SAR_CMD_OPEN_CONNECTION | (addr << 2),
29501da177e4SLinus Torvalds 			       SAR_REG_CMD);
29511da177e4SLinus Torvalds 			waitfor_idle(card);
29521da177e4SLinus Torvalds 			spin_unlock_irqrestore(&card->cmd_lock, flags);
29531da177e4SLinus Torvalds 		}
29541da177e4SLinus Torvalds 	}
29551da177e4SLinus Torvalds 
29561da177e4SLinus Torvalds 	return 0;
29571da177e4SLinus Torvalds }
29581da177e4SLinus Torvalds 
29591da177e4SLinus Torvalds static void
29601da177e4SLinus Torvalds close_card_oam(struct idt77252_dev *card)
29611da177e4SLinus Torvalds {
29621da177e4SLinus Torvalds 	unsigned long flags;
29631da177e4SLinus Torvalds 	unsigned long addr;
29641da177e4SLinus Torvalds 	struct vc_map *vc;
29651da177e4SLinus Torvalds 	int vpi, vci;
29661da177e4SLinus Torvalds 	int index;
29671da177e4SLinus Torvalds 
29681da177e4SLinus Torvalds 	for (vpi = 0; vpi < (1 << card->vpibits); vpi++) {
29691da177e4SLinus Torvalds 		for (vci = 3; vci < 5; vci++) {
29701da177e4SLinus Torvalds 			index = VPCI2VC(card, vpi, vci);
29711da177e4SLinus Torvalds 			vc = card->vcs[index];
29721da177e4SLinus Torvalds 
29731da177e4SLinus Torvalds 			addr = card->rct_base + vc->index * SAR_SRAM_RCT_SIZE;
29741da177e4SLinus Torvalds 
29751da177e4SLinus Torvalds 			spin_lock_irqsave(&card->cmd_lock, flags);
29761da177e4SLinus Torvalds 			writel(SAR_CMD_CLOSE_CONNECTION | (addr << 2),
29771da177e4SLinus Torvalds 			       SAR_REG_CMD);
29781da177e4SLinus Torvalds 			waitfor_idle(card);
29791da177e4SLinus Torvalds 			spin_unlock_irqrestore(&card->cmd_lock, flags);
29801da177e4SLinus Torvalds 
29811da177e4SLinus Torvalds 			if (vc->rcv.rx_pool.count) {
29821da177e4SLinus Torvalds 				DPRINTK("%s: closing a VC "
29831da177e4SLinus Torvalds 					"with pending rx buffers.\n",
29841da177e4SLinus Torvalds 					card->name);
29851da177e4SLinus Torvalds 
29861da177e4SLinus Torvalds 				recycle_rx_pool_skb(card, &vc->rcv.rx_pool);
29871da177e4SLinus Torvalds 			}
29881da177e4SLinus Torvalds 		}
29891da177e4SLinus Torvalds 	}
29901da177e4SLinus Torvalds }
29911da177e4SLinus Torvalds 
29921da177e4SLinus Torvalds static int
29931da177e4SLinus Torvalds open_card_ubr0(struct idt77252_dev *card)
29941da177e4SLinus Torvalds {
29951da177e4SLinus Torvalds 	struct vc_map *vc;
29961da177e4SLinus Torvalds 
29970c1cca1dSOm Narasimhan 	vc = kzalloc(sizeof(struct vc_map), GFP_KERNEL);
29981da177e4SLinus Torvalds 	if (!vc) {
29991da177e4SLinus Torvalds 		printk("%s: can't alloc vc\n", card->name);
30001da177e4SLinus Torvalds 		return -ENOMEM;
30011da177e4SLinus Torvalds 	}
30021da177e4SLinus Torvalds 	card->vcs[0] = vc;
30031da177e4SLinus Torvalds 	vc->class = SCHED_UBR0;
30041da177e4SLinus Torvalds 
30051da177e4SLinus Torvalds 	vc->scq = alloc_scq(card, vc->class);
30061da177e4SLinus Torvalds 	if (!vc->scq) {
30071da177e4SLinus Torvalds 		printk("%s: can't get SCQ.\n", card->name);
30081da177e4SLinus Torvalds 		return -ENOMEM;
30091da177e4SLinus Torvalds 	}
30101da177e4SLinus Torvalds 
30111da177e4SLinus Torvalds 	card->scd2vc[0] = vc;
30121da177e4SLinus Torvalds 	vc->scd_index = 0;
30131da177e4SLinus Torvalds 	vc->scq->scd = card->scd_base;
30141da177e4SLinus Torvalds 
30151da177e4SLinus Torvalds 	fill_scd(card, vc->scq, vc->class);
30161da177e4SLinus Torvalds 
30171da177e4SLinus Torvalds 	write_sram(card, card->tct_base + 0, TCT_UBR | card->scd_base);
30181da177e4SLinus Torvalds 	write_sram(card, card->tct_base + 1, 0);
30191da177e4SLinus Torvalds 	write_sram(card, card->tct_base + 2, 0);
30201da177e4SLinus Torvalds 	write_sram(card, card->tct_base + 3, 0);
30211da177e4SLinus Torvalds 	write_sram(card, card->tct_base + 4, 0);
30221da177e4SLinus Torvalds 	write_sram(card, card->tct_base + 5, 0);
30231da177e4SLinus Torvalds 	write_sram(card, card->tct_base + 6, 0);
30241da177e4SLinus Torvalds 	write_sram(card, card->tct_base + 7, TCT_FLAG_UBR);
30251da177e4SLinus Torvalds 
30261da177e4SLinus Torvalds 	clear_bit(VCF_IDLE, &vc->flags);
30271da177e4SLinus Torvalds 	writel(TCMDQ_START | 0, SAR_REG_TCMDQ);
30281da177e4SLinus Torvalds 	return 0;
30291da177e4SLinus Torvalds }
30301da177e4SLinus Torvalds 
30311da177e4SLinus Torvalds static int
30321da177e4SLinus Torvalds idt77252_dev_open(struct idt77252_dev *card)
30331da177e4SLinus Torvalds {
30341da177e4SLinus Torvalds 	u32 conf;
30351da177e4SLinus Torvalds 
30361da177e4SLinus Torvalds 	if (!test_bit(IDT77252_BIT_INIT, &card->flags)) {
30371da177e4SLinus Torvalds 		printk("%s: SAR not yet initialized.\n", card->name);
30381da177e4SLinus Torvalds 		return -1;
30391da177e4SLinus Torvalds 	}
30401da177e4SLinus Torvalds 
30411da177e4SLinus Torvalds 	conf = SAR_CFG_RXPTH|	/* enable receive path                  */
30421da177e4SLinus Torvalds 	    SAR_RX_DELAY |	/* interrupt on complete PDU		*/
30431da177e4SLinus Torvalds 	    SAR_CFG_RAWIE |	/* interrupt enable on raw cells        */
30441da177e4SLinus Torvalds 	    SAR_CFG_RQFIE |	/* interrupt on RSQ almost full         */
30451da177e4SLinus Torvalds 	    SAR_CFG_TMOIE |	/* interrupt on timer overflow          */
30461da177e4SLinus Torvalds 	    SAR_CFG_FBIE |	/* interrupt on low free buffers        */
30471da177e4SLinus Torvalds 	    SAR_CFG_TXEN |	/* transmit operation enable            */
30481da177e4SLinus Torvalds 	    SAR_CFG_TXINT |	/* interrupt on transmit status         */
30491da177e4SLinus Torvalds 	    SAR_CFG_TXUIE |	/* interrupt on transmit underrun       */
30501da177e4SLinus Torvalds 	    SAR_CFG_TXSFI |	/* interrupt on TSQ almost full         */
30511da177e4SLinus Torvalds 	    SAR_CFG_PHYIE	/* enable PHY interrupts		*/
30521da177e4SLinus Torvalds 	    ;
30531da177e4SLinus Torvalds 
30541da177e4SLinus Torvalds #ifdef CONFIG_ATM_IDT77252_RCV_ALL
30551da177e4SLinus Torvalds 	/* Test RAW cell receive. */
30561da177e4SLinus Torvalds 	conf |= SAR_CFG_VPECA;
30571da177e4SLinus Torvalds #endif
30581da177e4SLinus Torvalds 
30591da177e4SLinus Torvalds 	writel(readl(SAR_REG_CFG) | conf, SAR_REG_CFG);
30601da177e4SLinus Torvalds 
30611da177e4SLinus Torvalds 	if (open_card_oam(card)) {
30621da177e4SLinus Torvalds 		printk("%s: Error initializing OAM.\n", card->name);
30631da177e4SLinus Torvalds 		return -1;
30641da177e4SLinus Torvalds 	}
30651da177e4SLinus Torvalds 
30661da177e4SLinus Torvalds 	if (open_card_ubr0(card)) {
30671da177e4SLinus Torvalds 		printk("%s: Error initializing UBR0.\n", card->name);
30681da177e4SLinus Torvalds 		return -1;
30691da177e4SLinus Torvalds 	}
30701da177e4SLinus Torvalds 
30711da177e4SLinus Torvalds 	IPRINTK("%s: opened IDT77252 ABR SAR.\n", card->name);
30721da177e4SLinus Torvalds 	return 0;
30731da177e4SLinus Torvalds }
30741da177e4SLinus Torvalds 
30751da177e4SLinus Torvalds void
30761da177e4SLinus Torvalds idt77252_dev_close(struct atm_dev *dev)
30771da177e4SLinus Torvalds {
30781da177e4SLinus Torvalds 	struct idt77252_dev *card = dev->dev_data;
30791da177e4SLinus Torvalds 	u32 conf;
30801da177e4SLinus Torvalds 
30811da177e4SLinus Torvalds 	close_card_oam(card);
30821da177e4SLinus Torvalds 
30831da177e4SLinus Torvalds 	conf = SAR_CFG_RXPTH |	/* enable receive path           */
30841da177e4SLinus Torvalds 	    SAR_RX_DELAY |	/* interrupt on complete PDU     */
30851da177e4SLinus Torvalds 	    SAR_CFG_RAWIE |	/* interrupt enable on raw cells */
30861da177e4SLinus Torvalds 	    SAR_CFG_RQFIE |	/* interrupt on RSQ almost full  */
30871da177e4SLinus Torvalds 	    SAR_CFG_TMOIE |	/* interrupt on timer overflow   */
30881da177e4SLinus Torvalds 	    SAR_CFG_FBIE |	/* interrupt on low free buffers */
30891da177e4SLinus Torvalds 	    SAR_CFG_TXEN |	/* transmit operation enable     */
30901da177e4SLinus Torvalds 	    SAR_CFG_TXINT |	/* interrupt on transmit status  */
30911da177e4SLinus Torvalds 	    SAR_CFG_TXUIE |	/* interrupt on xmit underrun    */
30921da177e4SLinus Torvalds 	    SAR_CFG_TXSFI	/* interrupt on TSQ almost full  */
30931da177e4SLinus Torvalds 	    ;
30941da177e4SLinus Torvalds 
30951da177e4SLinus Torvalds 	writel(readl(SAR_REG_CFG) & ~(conf), SAR_REG_CFG);
30961da177e4SLinus Torvalds 
30971da177e4SLinus Torvalds 	DIPRINTK("%s: closed IDT77252 ABR SAR.\n", card->name);
30981da177e4SLinus Torvalds }
30991da177e4SLinus Torvalds 
31001da177e4SLinus Torvalds 
31011da177e4SLinus Torvalds /*****************************************************************************/
31021da177e4SLinus Torvalds /*                                                                           */
31031da177e4SLinus Torvalds /* Initialisation and Deinitialization of IDT77252                           */
31041da177e4SLinus Torvalds /*                                                                           */
31051da177e4SLinus Torvalds /*****************************************************************************/
31061da177e4SLinus Torvalds 
31071da177e4SLinus Torvalds 
31081da177e4SLinus Torvalds static void
31091da177e4SLinus Torvalds deinit_card(struct idt77252_dev *card)
31101da177e4SLinus Torvalds {
31111da177e4SLinus Torvalds 	struct sk_buff *skb;
31121da177e4SLinus Torvalds 	int i, j;
31131da177e4SLinus Torvalds 
31141da177e4SLinus Torvalds 	if (!test_bit(IDT77252_BIT_INIT, &card->flags)) {
31151da177e4SLinus Torvalds 		printk("%s: SAR not yet initialized.\n", card->name);
31161da177e4SLinus Torvalds 		return;
31171da177e4SLinus Torvalds 	}
31181da177e4SLinus Torvalds 	DIPRINTK("idt77252: deinitialize card %u\n", card->index);
31191da177e4SLinus Torvalds 
31201da177e4SLinus Torvalds 	writel(0, SAR_REG_CFG);
31211da177e4SLinus Torvalds 
31221da177e4SLinus Torvalds 	if (card->atmdev)
31231da177e4SLinus Torvalds 		atm_dev_deregister(card->atmdev);
31241da177e4SLinus Torvalds 
31251da177e4SLinus Torvalds 	for (i = 0; i < 4; i++) {
31261da177e4SLinus Torvalds 		for (j = 0; j < FBQ_SIZE; j++) {
31271da177e4SLinus Torvalds 			skb = card->sbpool[i].skb[j];
31281da177e4SLinus Torvalds 			if (skb) {
31291da177e4SLinus Torvalds 				pci_unmap_single(card->pcidev,
31301da177e4SLinus Torvalds 						 IDT77252_PRV_PADDR(skb),
31314305b541SArnaldo Carvalho de Melo 						 (skb_end_pointer(skb) -
31324305b541SArnaldo Carvalho de Melo 						  skb->data),
31331da177e4SLinus Torvalds 						 PCI_DMA_FROMDEVICE);
31341da177e4SLinus Torvalds 				card->sbpool[i].skb[j] = NULL;
31351da177e4SLinus Torvalds 				dev_kfree_skb(skb);
31361da177e4SLinus Torvalds 			}
31371da177e4SLinus Torvalds 		}
31381da177e4SLinus Torvalds 	}
31391da177e4SLinus Torvalds 
31401da177e4SLinus Torvalds 	vfree(card->soft_tst);
31411da177e4SLinus Torvalds 
31421da177e4SLinus Torvalds 	vfree(card->scd2vc);
31431da177e4SLinus Torvalds 
31441da177e4SLinus Torvalds 	vfree(card->vcs);
31451da177e4SLinus Torvalds 
31461da177e4SLinus Torvalds 	if (card->raw_cell_hnd) {
31471da177e4SLinus Torvalds 		pci_free_consistent(card->pcidev, 2 * sizeof(u32),
31481da177e4SLinus Torvalds 				    card->raw_cell_hnd, card->raw_cell_paddr);
31491da177e4SLinus Torvalds 	}
31501da177e4SLinus Torvalds 
31511da177e4SLinus Torvalds 	if (card->rsq.base) {
31521da177e4SLinus Torvalds 		DIPRINTK("%s: Release RSQ ...\n", card->name);
31531da177e4SLinus Torvalds 		deinit_rsq(card);
31541da177e4SLinus Torvalds 	}
31551da177e4SLinus Torvalds 
31561da177e4SLinus Torvalds 	if (card->tsq.base) {
31571da177e4SLinus Torvalds 		DIPRINTK("%s: Release TSQ ...\n", card->name);
31581da177e4SLinus Torvalds 		deinit_tsq(card);
31591da177e4SLinus Torvalds 	}
31601da177e4SLinus Torvalds 
31611da177e4SLinus Torvalds 	DIPRINTK("idt77252: Release IRQ.\n");
31621da177e4SLinus Torvalds 	free_irq(card->pcidev->irq, card);
31631da177e4SLinus Torvalds 
31641da177e4SLinus Torvalds 	for (i = 0; i < 4; i++) {
31651da177e4SLinus Torvalds 		if (card->fbq[i])
31661da177e4SLinus Torvalds 			iounmap(card->fbq[i]);
31671da177e4SLinus Torvalds 	}
31681da177e4SLinus Torvalds 
31691da177e4SLinus Torvalds 	if (card->membase)
31701da177e4SLinus Torvalds 		iounmap(card->membase);
31711da177e4SLinus Torvalds 
31721da177e4SLinus Torvalds 	clear_bit(IDT77252_BIT_INIT, &card->flags);
31731da177e4SLinus Torvalds 	DIPRINTK("%s: Card deinitialized.\n", card->name);
31741da177e4SLinus Torvalds }
31751da177e4SLinus Torvalds 
31761da177e4SLinus Torvalds 
31771da177e4SLinus Torvalds static int __devinit
31781da177e4SLinus Torvalds init_sram(struct idt77252_dev *card)
31791da177e4SLinus Torvalds {
31801da177e4SLinus Torvalds 	int i;
31811da177e4SLinus Torvalds 
31821da177e4SLinus Torvalds 	for (i = 0; i < card->sramsize; i += 4)
31831da177e4SLinus Torvalds 		write_sram(card, (i >> 2), 0);
31841da177e4SLinus Torvalds 
31851da177e4SLinus Torvalds 	/* set SRAM layout for THIS card */
31861da177e4SLinus Torvalds 	if (card->sramsize == (512 * 1024)) {
31871da177e4SLinus Torvalds 		card->tct_base = SAR_SRAM_TCT_128_BASE;
31881da177e4SLinus Torvalds 		card->tct_size = (SAR_SRAM_TCT_128_TOP - card->tct_base + 1)
31891da177e4SLinus Torvalds 		    / SAR_SRAM_TCT_SIZE;
31901da177e4SLinus Torvalds 		card->rct_base = SAR_SRAM_RCT_128_BASE;
31911da177e4SLinus Torvalds 		card->rct_size = (SAR_SRAM_RCT_128_TOP - card->rct_base + 1)
31921da177e4SLinus Torvalds 		    / SAR_SRAM_RCT_SIZE;
31931da177e4SLinus Torvalds 		card->rt_base = SAR_SRAM_RT_128_BASE;
31941da177e4SLinus Torvalds 		card->scd_base = SAR_SRAM_SCD_128_BASE;
31951da177e4SLinus Torvalds 		card->scd_size = (SAR_SRAM_SCD_128_TOP - card->scd_base + 1)
31961da177e4SLinus Torvalds 		    / SAR_SRAM_SCD_SIZE;
31971da177e4SLinus Torvalds 		card->tst[0] = SAR_SRAM_TST1_128_BASE;
31981da177e4SLinus Torvalds 		card->tst[1] = SAR_SRAM_TST2_128_BASE;
31991da177e4SLinus Torvalds 		card->tst_size = SAR_SRAM_TST1_128_TOP - card->tst[0] + 1;
32001da177e4SLinus Torvalds 		card->abrst_base = SAR_SRAM_ABRSTD_128_BASE;
32011da177e4SLinus Torvalds 		card->abrst_size = SAR_ABRSTD_SIZE_8K;
32021da177e4SLinus Torvalds 		card->fifo_base = SAR_SRAM_FIFO_128_BASE;
32031da177e4SLinus Torvalds 		card->fifo_size = SAR_RXFD_SIZE_32K;
32041da177e4SLinus Torvalds 	} else {
32051da177e4SLinus Torvalds 		card->tct_base = SAR_SRAM_TCT_32_BASE;
32061da177e4SLinus Torvalds 		card->tct_size = (SAR_SRAM_TCT_32_TOP - card->tct_base + 1)
32071da177e4SLinus Torvalds 		    / SAR_SRAM_TCT_SIZE;
32081da177e4SLinus Torvalds 		card->rct_base = SAR_SRAM_RCT_32_BASE;
32091da177e4SLinus Torvalds 		card->rct_size = (SAR_SRAM_RCT_32_TOP - card->rct_base + 1)
32101da177e4SLinus Torvalds 		    / SAR_SRAM_RCT_SIZE;
32111da177e4SLinus Torvalds 		card->rt_base = SAR_SRAM_RT_32_BASE;
32121da177e4SLinus Torvalds 		card->scd_base = SAR_SRAM_SCD_32_BASE;
32131da177e4SLinus Torvalds 		card->scd_size = (SAR_SRAM_SCD_32_TOP - card->scd_base + 1)
32141da177e4SLinus Torvalds 		    / SAR_SRAM_SCD_SIZE;
32151da177e4SLinus Torvalds 		card->tst[0] = SAR_SRAM_TST1_32_BASE;
32161da177e4SLinus Torvalds 		card->tst[1] = SAR_SRAM_TST2_32_BASE;
32171da177e4SLinus Torvalds 		card->tst_size = (SAR_SRAM_TST1_32_TOP - card->tst[0] + 1);
32181da177e4SLinus Torvalds 		card->abrst_base = SAR_SRAM_ABRSTD_32_BASE;
32191da177e4SLinus Torvalds 		card->abrst_size = SAR_ABRSTD_SIZE_1K;
32201da177e4SLinus Torvalds 		card->fifo_base = SAR_SRAM_FIFO_32_BASE;
32211da177e4SLinus Torvalds 		card->fifo_size = SAR_RXFD_SIZE_4K;
32221da177e4SLinus Torvalds 	}
32231da177e4SLinus Torvalds 
32241da177e4SLinus Torvalds 	/* Initialize TCT */
32251da177e4SLinus Torvalds 	for (i = 0; i < card->tct_size; i++) {
32261da177e4SLinus Torvalds 		write_sram(card, i * SAR_SRAM_TCT_SIZE + 0, 0);
32271da177e4SLinus Torvalds 		write_sram(card, i * SAR_SRAM_TCT_SIZE + 1, 0);
32281da177e4SLinus Torvalds 		write_sram(card, i * SAR_SRAM_TCT_SIZE + 2, 0);
32291da177e4SLinus Torvalds 		write_sram(card, i * SAR_SRAM_TCT_SIZE + 3, 0);
32301da177e4SLinus Torvalds 		write_sram(card, i * SAR_SRAM_TCT_SIZE + 4, 0);
32311da177e4SLinus Torvalds 		write_sram(card, i * SAR_SRAM_TCT_SIZE + 5, 0);
32321da177e4SLinus Torvalds 		write_sram(card, i * SAR_SRAM_TCT_SIZE + 6, 0);
32331da177e4SLinus Torvalds 		write_sram(card, i * SAR_SRAM_TCT_SIZE + 7, 0);
32341da177e4SLinus Torvalds 	}
32351da177e4SLinus Torvalds 
32361da177e4SLinus Torvalds 	/* Initialize RCT */
32371da177e4SLinus Torvalds 	for (i = 0; i < card->rct_size; i++) {
32381da177e4SLinus Torvalds 		write_sram(card, card->rct_base + i * SAR_SRAM_RCT_SIZE,
32391da177e4SLinus Torvalds 				    (u32) SAR_RCTE_RAWCELLINTEN);
32401da177e4SLinus Torvalds 		write_sram(card, card->rct_base + i * SAR_SRAM_RCT_SIZE + 1,
32411da177e4SLinus Torvalds 				    (u32) 0);
32421da177e4SLinus Torvalds 		write_sram(card, card->rct_base + i * SAR_SRAM_RCT_SIZE + 2,
32431da177e4SLinus Torvalds 				    (u32) 0);
32441da177e4SLinus Torvalds 		write_sram(card, card->rct_base + i * SAR_SRAM_RCT_SIZE + 3,
32451da177e4SLinus Torvalds 				    (u32) 0xffffffff);
32461da177e4SLinus Torvalds 	}
32471da177e4SLinus Torvalds 
32481da177e4SLinus Torvalds 	writel((SAR_FBQ0_LOW << 28) | 0x00000000 | 0x00000000 |
32491da177e4SLinus Torvalds 	       (SAR_FB_SIZE_0 / 48), SAR_REG_FBQS0);
32501da177e4SLinus Torvalds 	writel((SAR_FBQ1_LOW << 28) | 0x00000000 | 0x00000000 |
32511da177e4SLinus Torvalds 	       (SAR_FB_SIZE_1 / 48), SAR_REG_FBQS1);
32521da177e4SLinus Torvalds 	writel((SAR_FBQ2_LOW << 28) | 0x00000000 | 0x00000000 |
32531da177e4SLinus Torvalds 	       (SAR_FB_SIZE_2 / 48), SAR_REG_FBQS2);
32541da177e4SLinus Torvalds 	writel((SAR_FBQ3_LOW << 28) | 0x00000000 | 0x00000000 |
32551da177e4SLinus Torvalds 	       (SAR_FB_SIZE_3 / 48), SAR_REG_FBQS3);
32561da177e4SLinus Torvalds 
32571da177e4SLinus Torvalds 	/* Initialize rate table  */
32581da177e4SLinus Torvalds 	for (i = 0; i < 256; i++) {
32591da177e4SLinus Torvalds 		write_sram(card, card->rt_base + i, log_to_rate[i]);
32601da177e4SLinus Torvalds 	}
32611da177e4SLinus Torvalds 
32621da177e4SLinus Torvalds 	for (i = 0; i < 128; i++) {
32631da177e4SLinus Torvalds 		unsigned int tmp;
32641da177e4SLinus Torvalds 
32651da177e4SLinus Torvalds 		tmp  = rate_to_log[(i << 2) + 0] << 0;
32661da177e4SLinus Torvalds 		tmp |= rate_to_log[(i << 2) + 1] << 8;
32671da177e4SLinus Torvalds 		tmp |= rate_to_log[(i << 2) + 2] << 16;
32681da177e4SLinus Torvalds 		tmp |= rate_to_log[(i << 2) + 3] << 24;
32691da177e4SLinus Torvalds 		write_sram(card, card->rt_base + 256 + i, tmp);
32701da177e4SLinus Torvalds 	}
32711da177e4SLinus Torvalds 
32721da177e4SLinus Torvalds #if 0 /* Fill RDF and AIR tables. */
32731da177e4SLinus Torvalds 	for (i = 0; i < 128; i++) {
32741da177e4SLinus Torvalds 		unsigned int tmp;
32751da177e4SLinus Torvalds 
32761da177e4SLinus Torvalds 		tmp = RDF[0][(i << 1) + 0] << 16;
32771da177e4SLinus Torvalds 		tmp |= RDF[0][(i << 1) + 1] << 0;
32781da177e4SLinus Torvalds 		write_sram(card, card->rt_base + 512 + i, tmp);
32791da177e4SLinus Torvalds 	}
32801da177e4SLinus Torvalds 
32811da177e4SLinus Torvalds 	for (i = 0; i < 128; i++) {
32821da177e4SLinus Torvalds 		unsigned int tmp;
32831da177e4SLinus Torvalds 
32841da177e4SLinus Torvalds 		tmp = AIR[0][(i << 1) + 0] << 16;
32851da177e4SLinus Torvalds 		tmp |= AIR[0][(i << 1) + 1] << 0;
32861da177e4SLinus Torvalds 		write_sram(card, card->rt_base + 640 + i, tmp);
32871da177e4SLinus Torvalds 	}
32881da177e4SLinus Torvalds #endif
32891da177e4SLinus Torvalds 
32901da177e4SLinus Torvalds 	IPRINTK("%s: initialize rate table ...\n", card->name);
32911da177e4SLinus Torvalds 	writel(card->rt_base << 2, SAR_REG_RTBL);
32921da177e4SLinus Torvalds 
32931da177e4SLinus Torvalds 	/* Initialize TSTs */
32941da177e4SLinus Torvalds 	IPRINTK("%s: initialize TST ...\n", card->name);
32951da177e4SLinus Torvalds 	card->tst_free = card->tst_size - 2;	/* last two are jumps */
32961da177e4SLinus Torvalds 
32971da177e4SLinus Torvalds 	for (i = card->tst[0]; i < card->tst[0] + card->tst_size - 2; i++)
32981da177e4SLinus Torvalds 		write_sram(card, i, TSTE_OPC_VAR);
32991da177e4SLinus Torvalds 	write_sram(card, i++, TSTE_OPC_JMP | (card->tst[0] << 2));
33001da177e4SLinus Torvalds 	idt77252_sram_write_errors = 1;
33011da177e4SLinus Torvalds 	write_sram(card, i++, TSTE_OPC_JMP | (card->tst[1] << 2));
33021da177e4SLinus Torvalds 	idt77252_sram_write_errors = 0;
33031da177e4SLinus Torvalds 	for (i = card->tst[1]; i < card->tst[1] + card->tst_size - 2; i++)
33041da177e4SLinus Torvalds 		write_sram(card, i, TSTE_OPC_VAR);
33051da177e4SLinus Torvalds 	write_sram(card, i++, TSTE_OPC_JMP | (card->tst[1] << 2));
33061da177e4SLinus Torvalds 	idt77252_sram_write_errors = 1;
33071da177e4SLinus Torvalds 	write_sram(card, i++, TSTE_OPC_JMP | (card->tst[0] << 2));
33081da177e4SLinus Torvalds 	idt77252_sram_write_errors = 0;
33091da177e4SLinus Torvalds 
33101da177e4SLinus Torvalds 	card->tst_index = 0;
33111da177e4SLinus Torvalds 	writel(card->tst[0] << 2, SAR_REG_TSTB);
33121da177e4SLinus Torvalds 
33131da177e4SLinus Torvalds 	/* Initialize ABRSTD and Receive FIFO */
33141da177e4SLinus Torvalds 	IPRINTK("%s: initialize ABRSTD ...\n", card->name);
33151da177e4SLinus Torvalds 	writel(card->abrst_size | (card->abrst_base << 2),
33161da177e4SLinus Torvalds 	       SAR_REG_ABRSTD);
33171da177e4SLinus Torvalds 
33181da177e4SLinus Torvalds 	IPRINTK("%s: initialize receive fifo ...\n", card->name);
33191da177e4SLinus Torvalds 	writel(card->fifo_size | (card->fifo_base << 2),
33201da177e4SLinus Torvalds 	       SAR_REG_RXFD);
33211da177e4SLinus Torvalds 
33221da177e4SLinus Torvalds 	IPRINTK("%s: SRAM initialization complete.\n", card->name);
33231da177e4SLinus Torvalds 	return 0;
33241da177e4SLinus Torvalds }
33251da177e4SLinus Torvalds 
33261da177e4SLinus Torvalds static int __devinit
33271da177e4SLinus Torvalds init_card(struct atm_dev *dev)
33281da177e4SLinus Torvalds {
33291da177e4SLinus Torvalds 	struct idt77252_dev *card = dev->dev_data;
33301da177e4SLinus Torvalds 	struct pci_dev *pcidev = card->pcidev;
33311da177e4SLinus Torvalds 	unsigned long tmpl, modl;
33321da177e4SLinus Torvalds 	unsigned int linkrate, rsvdcr;
33331da177e4SLinus Torvalds 	unsigned int tst_entries;
33341da177e4SLinus Torvalds 	struct net_device *tmp;
33351da177e4SLinus Torvalds 	char tname[10];
33361da177e4SLinus Torvalds 
33371da177e4SLinus Torvalds 	u32 size;
33381da177e4SLinus Torvalds 	u_char pci_byte;
33391da177e4SLinus Torvalds 	u32 conf;
33401da177e4SLinus Torvalds 	int i, k;
33411da177e4SLinus Torvalds 
33421da177e4SLinus Torvalds 	if (test_bit(IDT77252_BIT_INIT, &card->flags)) {
33431da177e4SLinus Torvalds 		printk("Error: SAR already initialized.\n");
33441da177e4SLinus Torvalds 		return -1;
33451da177e4SLinus Torvalds 	}
33461da177e4SLinus Torvalds 
33471da177e4SLinus Torvalds /*****************************************************************/
33481da177e4SLinus Torvalds /*   P C I   C O N F I G U R A T I O N                           */
33491da177e4SLinus Torvalds /*****************************************************************/
33501da177e4SLinus Torvalds 
33511da177e4SLinus Torvalds 	/* Set PCI Retry-Timeout and TRDY timeout */
33521da177e4SLinus Torvalds 	IPRINTK("%s: Checking PCI retries.\n", card->name);
33531da177e4SLinus Torvalds 	if (pci_read_config_byte(pcidev, 0x40, &pci_byte) != 0) {
33541da177e4SLinus Torvalds 		printk("%s: can't read PCI retry timeout.\n", card->name);
33551da177e4SLinus Torvalds 		deinit_card(card);
33561da177e4SLinus Torvalds 		return -1;
33571da177e4SLinus Torvalds 	}
33581da177e4SLinus Torvalds 	if (pci_byte != 0) {
33591da177e4SLinus Torvalds 		IPRINTK("%s: PCI retry timeout: %d, set to 0.\n",
33601da177e4SLinus Torvalds 			card->name, pci_byte);
33611da177e4SLinus Torvalds 		if (pci_write_config_byte(pcidev, 0x40, 0) != 0) {
33621da177e4SLinus Torvalds 			printk("%s: can't set PCI retry timeout.\n",
33631da177e4SLinus Torvalds 			       card->name);
33641da177e4SLinus Torvalds 			deinit_card(card);
33651da177e4SLinus Torvalds 			return -1;
33661da177e4SLinus Torvalds 		}
33671da177e4SLinus Torvalds 	}
33681da177e4SLinus Torvalds 	IPRINTK("%s: Checking PCI TRDY.\n", card->name);
33691da177e4SLinus Torvalds 	if (pci_read_config_byte(pcidev, 0x41, &pci_byte) != 0) {
33701da177e4SLinus Torvalds 		printk("%s: can't read PCI TRDY timeout.\n", card->name);
33711da177e4SLinus Torvalds 		deinit_card(card);
33721da177e4SLinus Torvalds 		return -1;
33731da177e4SLinus Torvalds 	}
33741da177e4SLinus Torvalds 	if (pci_byte != 0) {
33751da177e4SLinus Torvalds 		IPRINTK("%s: PCI TRDY timeout: %d, set to 0.\n",
33761da177e4SLinus Torvalds 		        card->name, pci_byte);
33771da177e4SLinus Torvalds 		if (pci_write_config_byte(pcidev, 0x41, 0) != 0) {
33781da177e4SLinus Torvalds 			printk("%s: can't set PCI TRDY timeout.\n", card->name);
33791da177e4SLinus Torvalds 			deinit_card(card);
33801da177e4SLinus Torvalds 			return -1;
33811da177e4SLinus Torvalds 		}
33821da177e4SLinus Torvalds 	}
33831da177e4SLinus Torvalds 	/* Reset Timer register */
33841da177e4SLinus Torvalds 	if (readl(SAR_REG_STAT) & SAR_STAT_TMROF) {
33851da177e4SLinus Torvalds 		printk("%s: resetting timer overflow.\n", card->name);
33861da177e4SLinus Torvalds 		writel(SAR_STAT_TMROF, SAR_REG_STAT);
33871da177e4SLinus Torvalds 	}
33881da177e4SLinus Torvalds 	IPRINTK("%s: Request IRQ ... ", card->name);
3389dace1453SThomas Gleixner 	if (request_irq(pcidev->irq, idt77252_interrupt, IRQF_DISABLED|IRQF_SHARED,
33901da177e4SLinus Torvalds 			card->name, card) != 0) {
33911da177e4SLinus Torvalds 		printk("%s: can't allocate IRQ.\n", card->name);
33921da177e4SLinus Torvalds 		deinit_card(card);
33931da177e4SLinus Torvalds 		return -1;
33941da177e4SLinus Torvalds 	}
33951da177e4SLinus Torvalds 	IPRINTK("got %d.\n", pcidev->irq);
33961da177e4SLinus Torvalds 
33971da177e4SLinus Torvalds /*****************************************************************/
33981da177e4SLinus Torvalds /*   C H E C K   A N D   I N I T   S R A M                       */
33991da177e4SLinus Torvalds /*****************************************************************/
34001da177e4SLinus Torvalds 
34011da177e4SLinus Torvalds 	IPRINTK("%s: Initializing SRAM\n", card->name);
34021da177e4SLinus Torvalds 
34031da177e4SLinus Torvalds 	/* preset size of connecton table, so that init_sram() knows about it */
34041da177e4SLinus Torvalds 	conf =	SAR_CFG_TX_FIFO_SIZE_9 |	/* Use maximum fifo size */
34051da177e4SLinus Torvalds 		SAR_CFG_RXSTQ_SIZE_8k |		/* Receive Status Queue is 8k */
34061da177e4SLinus Torvalds 		SAR_CFG_IDLE_CLP |		/* Set CLP on idle cells */
340744beac00SRobert P. J. Day #ifndef ATM_IDT77252_SEND_IDLE
34081da177e4SLinus Torvalds 		SAR_CFG_NO_IDLE |		/* Do not send idle cells */
34091da177e4SLinus Torvalds #endif
34101da177e4SLinus Torvalds 		0;
34111da177e4SLinus Torvalds 
34121da177e4SLinus Torvalds 	if (card->sramsize == (512 * 1024))
34131da177e4SLinus Torvalds 		conf |= SAR_CFG_CNTBL_1k;
34141da177e4SLinus Torvalds 	else
34151da177e4SLinus Torvalds 		conf |= SAR_CFG_CNTBL_512;
34161da177e4SLinus Torvalds 
34171da177e4SLinus Torvalds 	switch (vpibits) {
34181da177e4SLinus Torvalds 	case 0:
34191da177e4SLinus Torvalds 		conf |= SAR_CFG_VPVCS_0;
34201da177e4SLinus Torvalds 		break;
34211da177e4SLinus Torvalds 	default:
34221da177e4SLinus Torvalds 	case 1:
34231da177e4SLinus Torvalds 		conf |= SAR_CFG_VPVCS_1;
34241da177e4SLinus Torvalds 		break;
34251da177e4SLinus Torvalds 	case 2:
34261da177e4SLinus Torvalds 		conf |= SAR_CFG_VPVCS_2;
34271da177e4SLinus Torvalds 		break;
34281da177e4SLinus Torvalds 	case 8:
34291da177e4SLinus Torvalds 		conf |= SAR_CFG_VPVCS_8;
34301da177e4SLinus Torvalds 		break;
34311da177e4SLinus Torvalds 	}
34321da177e4SLinus Torvalds 
34331da177e4SLinus Torvalds 	writel(readl(SAR_REG_CFG) | conf, SAR_REG_CFG);
34341da177e4SLinus Torvalds 
34351da177e4SLinus Torvalds 	if (init_sram(card) < 0)
34361da177e4SLinus Torvalds 		return -1;
34371da177e4SLinus Torvalds 
34381da177e4SLinus Torvalds /********************************************************************/
34391da177e4SLinus Torvalds /*  A L L O C   R A M   A N D   S E T   V A R I O U S   T H I N G S */
34401da177e4SLinus Torvalds /********************************************************************/
34411da177e4SLinus Torvalds 	/* Initialize TSQ */
34421da177e4SLinus Torvalds 	if (0 != init_tsq(card)) {
34431da177e4SLinus Torvalds 		deinit_card(card);
34441da177e4SLinus Torvalds 		return -1;
34451da177e4SLinus Torvalds 	}
34461da177e4SLinus Torvalds 	/* Initialize RSQ */
34471da177e4SLinus Torvalds 	if (0 != init_rsq(card)) {
34481da177e4SLinus Torvalds 		deinit_card(card);
34491da177e4SLinus Torvalds 		return -1;
34501da177e4SLinus Torvalds 	}
34511da177e4SLinus Torvalds 
34521da177e4SLinus Torvalds 	card->vpibits = vpibits;
34531da177e4SLinus Torvalds 	if (card->sramsize == (512 * 1024)) {
34541da177e4SLinus Torvalds 		card->vcibits = 10 - card->vpibits;
34551da177e4SLinus Torvalds 	} else {
34561da177e4SLinus Torvalds 		card->vcibits = 9 - card->vpibits;
34571da177e4SLinus Torvalds 	}
34581da177e4SLinus Torvalds 
34591da177e4SLinus Torvalds 	card->vcimask = 0;
34601da177e4SLinus Torvalds 	for (k = 0, i = 1; k < card->vcibits; k++) {
34611da177e4SLinus Torvalds 		card->vcimask |= i;
34621da177e4SLinus Torvalds 		i <<= 1;
34631da177e4SLinus Torvalds 	}
34641da177e4SLinus Torvalds 
34651da177e4SLinus Torvalds 	IPRINTK("%s: Setting VPI/VCI mask to zero.\n", card->name);
34661da177e4SLinus Torvalds 	writel(0, SAR_REG_VPM);
34671da177e4SLinus Torvalds 
34681da177e4SLinus Torvalds 	/* Little Endian Order   */
34691da177e4SLinus Torvalds 	writel(0, SAR_REG_GP);
34701da177e4SLinus Torvalds 
34711da177e4SLinus Torvalds 	/* Initialize RAW Cell Handle Register  */
34721da177e4SLinus Torvalds 	card->raw_cell_hnd = pci_alloc_consistent(card->pcidev, 2 * sizeof(u32),
34731da177e4SLinus Torvalds 						  &card->raw_cell_paddr);
34741da177e4SLinus Torvalds 	if (!card->raw_cell_hnd) {
34751da177e4SLinus Torvalds 		printk("%s: memory allocation failure.\n", card->name);
34761da177e4SLinus Torvalds 		deinit_card(card);
34771da177e4SLinus Torvalds 		return -1;
34781da177e4SLinus Torvalds 	}
34791da177e4SLinus Torvalds 	memset(card->raw_cell_hnd, 0, 2 * sizeof(u32));
34801da177e4SLinus Torvalds 	writel(card->raw_cell_paddr, SAR_REG_RAWHND);
34811da177e4SLinus Torvalds 	IPRINTK("%s: raw cell handle is at 0x%p.\n", card->name,
34821da177e4SLinus Torvalds 		card->raw_cell_hnd);
34831da177e4SLinus Torvalds 
34841da177e4SLinus Torvalds 	size = sizeof(struct vc_map *) * card->tct_size;
34851da177e4SLinus Torvalds 	IPRINTK("%s: allocate %d byte for VC map.\n", card->name, size);
34861da177e4SLinus Torvalds 	if (NULL == (card->vcs = vmalloc(size))) {
34871da177e4SLinus Torvalds 		printk("%s: memory allocation failure.\n", card->name);
34881da177e4SLinus Torvalds 		deinit_card(card);
34891da177e4SLinus Torvalds 		return -1;
34901da177e4SLinus Torvalds 	}
34911da177e4SLinus Torvalds 	memset(card->vcs, 0, size);
34921da177e4SLinus Torvalds 
34931da177e4SLinus Torvalds 	size = sizeof(struct vc_map *) * card->scd_size;
34941da177e4SLinus Torvalds 	IPRINTK("%s: allocate %d byte for SCD to VC mapping.\n",
34951da177e4SLinus Torvalds 	        card->name, size);
34961da177e4SLinus Torvalds 	if (NULL == (card->scd2vc = vmalloc(size))) {
34971da177e4SLinus Torvalds 		printk("%s: memory allocation failure.\n", card->name);
34981da177e4SLinus Torvalds 		deinit_card(card);
34991da177e4SLinus Torvalds 		return -1;
35001da177e4SLinus Torvalds 	}
35011da177e4SLinus Torvalds 	memset(card->scd2vc, 0, size);
35021da177e4SLinus Torvalds 
35031da177e4SLinus Torvalds 	size = sizeof(struct tst_info) * (card->tst_size - 2);
35041da177e4SLinus Torvalds 	IPRINTK("%s: allocate %d byte for TST to VC mapping.\n",
35051da177e4SLinus Torvalds 		card->name, size);
35061da177e4SLinus Torvalds 	if (NULL == (card->soft_tst = vmalloc(size))) {
35071da177e4SLinus Torvalds 		printk("%s: memory allocation failure.\n", card->name);
35081da177e4SLinus Torvalds 		deinit_card(card);
35091da177e4SLinus Torvalds 		return -1;
35101da177e4SLinus Torvalds 	}
35111da177e4SLinus Torvalds 	for (i = 0; i < card->tst_size - 2; i++) {
35121da177e4SLinus Torvalds 		card->soft_tst[i].tste = TSTE_OPC_VAR;
35131da177e4SLinus Torvalds 		card->soft_tst[i].vc = NULL;
35141da177e4SLinus Torvalds 	}
35151da177e4SLinus Torvalds 
35161da177e4SLinus Torvalds 	if (dev->phy == NULL) {
35171da177e4SLinus Torvalds 		printk("%s: No LT device defined.\n", card->name);
35181da177e4SLinus Torvalds 		deinit_card(card);
35191da177e4SLinus Torvalds 		return -1;
35201da177e4SLinus Torvalds 	}
35211da177e4SLinus Torvalds 	if (dev->phy->ioctl == NULL) {
35221da177e4SLinus Torvalds 		printk("%s: LT had no IOCTL funtion defined.\n", card->name);
35231da177e4SLinus Torvalds 		deinit_card(card);
35241da177e4SLinus Torvalds 		return -1;
35251da177e4SLinus Torvalds 	}
35261da177e4SLinus Torvalds 
35271da177e4SLinus Torvalds #ifdef	CONFIG_ATM_IDT77252_USE_SUNI
35281da177e4SLinus Torvalds 	/*
35291da177e4SLinus Torvalds 	 * this is a jhs hack to get around special functionality in the
35301da177e4SLinus Torvalds 	 * phy driver for the atecom hardware; the functionality doesn't
35311da177e4SLinus Torvalds 	 * exist in the linux atm suni driver
35321da177e4SLinus Torvalds 	 *
35331da177e4SLinus Torvalds 	 * it isn't the right way to do things, but as the guy from NIST
35341da177e4SLinus Torvalds 	 * said, talking about their measurement of the fine structure
35351da177e4SLinus Torvalds 	 * constant, "it's good enough for government work."
35361da177e4SLinus Torvalds 	 */
35371da177e4SLinus Torvalds 	linkrate = 149760000;
35381da177e4SLinus Torvalds #endif
35391da177e4SLinus Torvalds 
35401da177e4SLinus Torvalds 	card->link_pcr = (linkrate / 8 / 53);
35411da177e4SLinus Torvalds 	printk("%s: Linkrate on ATM line : %u bit/s, %u cell/s.\n",
35421da177e4SLinus Torvalds 	       card->name, linkrate, card->link_pcr);
35431da177e4SLinus Torvalds 
354444beac00SRobert P. J. Day #ifdef ATM_IDT77252_SEND_IDLE
35451da177e4SLinus Torvalds 	card->utopia_pcr = card->link_pcr;
35461da177e4SLinus Torvalds #else
35471da177e4SLinus Torvalds 	card->utopia_pcr = (160000000 / 8 / 54);
35481da177e4SLinus Torvalds #endif
35491da177e4SLinus Torvalds 
35501da177e4SLinus Torvalds 	rsvdcr = 0;
35511da177e4SLinus Torvalds 	if (card->utopia_pcr > card->link_pcr)
35521da177e4SLinus Torvalds 		rsvdcr = card->utopia_pcr - card->link_pcr;
35531da177e4SLinus Torvalds 
35541da177e4SLinus Torvalds 	tmpl = (unsigned long) rsvdcr * ((unsigned long) card->tst_size - 2);
35551da177e4SLinus Torvalds 	modl = tmpl % (unsigned long)card->utopia_pcr;
35561da177e4SLinus Torvalds 	tst_entries = (int) (tmpl / (unsigned long)card->utopia_pcr);
35571da177e4SLinus Torvalds 	if (modl)
35581da177e4SLinus Torvalds 		tst_entries++;
35591da177e4SLinus Torvalds 	card->tst_free -= tst_entries;
35601da177e4SLinus Torvalds 	fill_tst(card, NULL, tst_entries, TSTE_OPC_NULL);
35611da177e4SLinus Torvalds 
35621da177e4SLinus Torvalds #ifdef HAVE_EEPROM
35631da177e4SLinus Torvalds 	idt77252_eeprom_init(card);
35641da177e4SLinus Torvalds 	printk("%s: EEPROM: %02x:", card->name,
35651da177e4SLinus Torvalds 		idt77252_eeprom_read_status(card));
35661da177e4SLinus Torvalds 
35671da177e4SLinus Torvalds 	for (i = 0; i < 0x80; i++) {
35681da177e4SLinus Torvalds 		printk(" %02x",
35691da177e4SLinus Torvalds 		idt77252_eeprom_read_byte(card, i)
35701da177e4SLinus Torvalds 		);
35711da177e4SLinus Torvalds 	}
35721da177e4SLinus Torvalds 	printk("\n");
35731da177e4SLinus Torvalds #endif /* HAVE_EEPROM */
35741da177e4SLinus Torvalds 
35751da177e4SLinus Torvalds 	/*
35761da177e4SLinus Torvalds 	 * XXX: <hack>
35771da177e4SLinus Torvalds 	 */
35781da177e4SLinus Torvalds 	sprintf(tname, "eth%d", card->index);
3579881d966bSEric W. Biederman 	tmp = dev_get_by_name(&init_net, tname);	/* jhs: was "tmp = dev_get(tname);" */
35801da177e4SLinus Torvalds 	if (tmp) {
35811da177e4SLinus Torvalds 		memcpy(card->atmdev->esi, tmp->dev_addr, 6);
35821da177e4SLinus Torvalds 
35831da177e4SLinus Torvalds 		printk("%s: ESI %02x:%02x:%02x:%02x:%02x:%02x\n",
35841da177e4SLinus Torvalds 		       card->name, card->atmdev->esi[0], card->atmdev->esi[1],
35851da177e4SLinus Torvalds 		       card->atmdev->esi[2], card->atmdev->esi[3],
35861da177e4SLinus Torvalds 		       card->atmdev->esi[4], card->atmdev->esi[5]);
35871da177e4SLinus Torvalds 	}
35881da177e4SLinus Torvalds 	/*
35891da177e4SLinus Torvalds 	 * XXX: </hack>
35901da177e4SLinus Torvalds 	 */
35911da177e4SLinus Torvalds 
35921da177e4SLinus Torvalds 	/* Set Maximum Deficit Count for now. */
35931da177e4SLinus Torvalds 	writel(0xffff, SAR_REG_MDFCT);
35941da177e4SLinus Torvalds 
35951da177e4SLinus Torvalds 	set_bit(IDT77252_BIT_INIT, &card->flags);
35961da177e4SLinus Torvalds 
35971da177e4SLinus Torvalds 	XPRINTK("%s: IDT77252 ABR SAR initialization complete.\n", card->name);
35981da177e4SLinus Torvalds 	return 0;
35991da177e4SLinus Torvalds }
36001da177e4SLinus Torvalds 
36011da177e4SLinus Torvalds 
36021da177e4SLinus Torvalds /*****************************************************************************/
36031da177e4SLinus Torvalds /*                                                                           */
36041da177e4SLinus Torvalds /* Probing of IDT77252 ABR SAR                                               */
36051da177e4SLinus Torvalds /*                                                                           */
36061da177e4SLinus Torvalds /*****************************************************************************/
36071da177e4SLinus Torvalds 
36081da177e4SLinus Torvalds 
36091da177e4SLinus Torvalds static int __devinit
36101da177e4SLinus Torvalds idt77252_preset(struct idt77252_dev *card)
36111da177e4SLinus Torvalds {
36121da177e4SLinus Torvalds 	u16 pci_command;
36131da177e4SLinus Torvalds 
36141da177e4SLinus Torvalds /*****************************************************************/
36151da177e4SLinus Torvalds /*   P C I   C O N F I G U R A T I O N                           */
36161da177e4SLinus Torvalds /*****************************************************************/
36171da177e4SLinus Torvalds 
36181da177e4SLinus Torvalds 	XPRINTK("%s: Enable PCI master and memory access for SAR.\n",
36191da177e4SLinus Torvalds 		card->name);
36201da177e4SLinus Torvalds 	if (pci_read_config_word(card->pcidev, PCI_COMMAND, &pci_command)) {
36211da177e4SLinus Torvalds 		printk("%s: can't read PCI_COMMAND.\n", card->name);
36221da177e4SLinus Torvalds 		deinit_card(card);
36231da177e4SLinus Torvalds 		return -1;
36241da177e4SLinus Torvalds 	}
36251da177e4SLinus Torvalds 	if (!(pci_command & PCI_COMMAND_IO)) {
36261da177e4SLinus Torvalds 		printk("%s: PCI_COMMAND: %04x (???)\n",
36271da177e4SLinus Torvalds 		       card->name, pci_command);
36281da177e4SLinus Torvalds 		deinit_card(card);
36291da177e4SLinus Torvalds 		return (-1);
36301da177e4SLinus Torvalds 	}
36311da177e4SLinus Torvalds 	pci_command |= (PCI_COMMAND_MEMORY | PCI_COMMAND_MASTER);
36321da177e4SLinus Torvalds 	if (pci_write_config_word(card->pcidev, PCI_COMMAND, pci_command)) {
36331da177e4SLinus Torvalds 		printk("%s: can't write PCI_COMMAND.\n", card->name);
36341da177e4SLinus Torvalds 		deinit_card(card);
36351da177e4SLinus Torvalds 		return -1;
36361da177e4SLinus Torvalds 	}
36371da177e4SLinus Torvalds /*****************************************************************/
36381da177e4SLinus Torvalds /*   G E N E R I C   R E S E T                                   */
36391da177e4SLinus Torvalds /*****************************************************************/
36401da177e4SLinus Torvalds 
36411da177e4SLinus Torvalds 	/* Software reset */
36421da177e4SLinus Torvalds 	writel(SAR_CFG_SWRST, SAR_REG_CFG);
36431da177e4SLinus Torvalds 	mdelay(1);
36441da177e4SLinus Torvalds 	writel(0, SAR_REG_CFG);
36451da177e4SLinus Torvalds 
36461da177e4SLinus Torvalds 	IPRINTK("%s: Software resetted.\n", card->name);
36471da177e4SLinus Torvalds 	return 0;
36481da177e4SLinus Torvalds }
36491da177e4SLinus Torvalds 
36501da177e4SLinus Torvalds 
36511da177e4SLinus Torvalds static unsigned long __devinit
36521da177e4SLinus Torvalds probe_sram(struct idt77252_dev *card)
36531da177e4SLinus Torvalds {
36541da177e4SLinus Torvalds 	u32 data, addr;
36551da177e4SLinus Torvalds 
36561da177e4SLinus Torvalds 	writel(0, SAR_REG_DR0);
36571da177e4SLinus Torvalds 	writel(SAR_CMD_WRITE_SRAM | (0 << 2), SAR_REG_CMD);
36581da177e4SLinus Torvalds 
36591da177e4SLinus Torvalds 	for (addr = 0x4000; addr < 0x80000; addr += 0x4000) {
36603c6b3773SRandy Dunlap 		writel(ATM_POISON, SAR_REG_DR0);
36611da177e4SLinus Torvalds 		writel(SAR_CMD_WRITE_SRAM | (addr << 2), SAR_REG_CMD);
36621da177e4SLinus Torvalds 
36631da177e4SLinus Torvalds 		writel(SAR_CMD_READ_SRAM | (0 << 2), SAR_REG_CMD);
36641da177e4SLinus Torvalds 		data = readl(SAR_REG_DR0);
36651da177e4SLinus Torvalds 
36661da177e4SLinus Torvalds 		if (data != 0)
36671da177e4SLinus Torvalds 			break;
36681da177e4SLinus Torvalds 	}
36691da177e4SLinus Torvalds 
36701da177e4SLinus Torvalds 	return addr * sizeof(u32);
36711da177e4SLinus Torvalds }
36721da177e4SLinus Torvalds 
36731da177e4SLinus Torvalds static int __devinit
36741da177e4SLinus Torvalds idt77252_init_one(struct pci_dev *pcidev, const struct pci_device_id *id)
36751da177e4SLinus Torvalds {
36761da177e4SLinus Torvalds 	static struct idt77252_dev **last = &idt77252_chain;
36771da177e4SLinus Torvalds 	static int index = 0;
36781da177e4SLinus Torvalds 
36791da177e4SLinus Torvalds 	unsigned long membase, srambase;
36801da177e4SLinus Torvalds 	struct idt77252_dev *card;
36811da177e4SLinus Torvalds 	struct atm_dev *dev;
36821da177e4SLinus Torvalds 	int i, err;
36831da177e4SLinus Torvalds 
36841da177e4SLinus Torvalds 
36851da177e4SLinus Torvalds 	if ((err = pci_enable_device(pcidev))) {
36861da177e4SLinus Torvalds 		printk("idt77252: can't enable PCI device at %s\n", pci_name(pcidev));
36871da177e4SLinus Torvalds 		return err;
36881da177e4SLinus Torvalds 	}
36891da177e4SLinus Torvalds 
36900c1cca1dSOm Narasimhan 	card = kzalloc(sizeof(struct idt77252_dev), GFP_KERNEL);
36911da177e4SLinus Torvalds 	if (!card) {
36921da177e4SLinus Torvalds 		printk("idt77252-%d: can't allocate private data\n", index);
36931da177e4SLinus Torvalds 		err = -ENOMEM;
36941da177e4SLinus Torvalds 		goto err_out_disable_pdev;
36951da177e4SLinus Torvalds 	}
369644c10138SAuke Kok 	card->revision = pcidev->revision;
36971da177e4SLinus Torvalds 	card->index = index;
36981da177e4SLinus Torvalds 	card->pcidev = pcidev;
36991da177e4SLinus Torvalds 	sprintf(card->name, "idt77252-%d", card->index);
37001da177e4SLinus Torvalds 
3701c4028958SDavid Howells 	INIT_WORK(&card->tqueue, idt77252_softint);
37021da177e4SLinus Torvalds 
37031da177e4SLinus Torvalds 	membase = pci_resource_start(pcidev, 1);
37041da177e4SLinus Torvalds 	srambase = pci_resource_start(pcidev, 2);
37051da177e4SLinus Torvalds 
37067e7a2d07SMatthias Kaehlcke 	mutex_init(&card->mutex);
37071da177e4SLinus Torvalds 	spin_lock_init(&card->cmd_lock);
37081da177e4SLinus Torvalds 	spin_lock_init(&card->tst_lock);
37091da177e4SLinus Torvalds 
37101da177e4SLinus Torvalds 	init_timer(&card->tst_timer);
37111da177e4SLinus Torvalds 	card->tst_timer.data = (unsigned long)card;
37121da177e4SLinus Torvalds 	card->tst_timer.function = tst_timer;
37131da177e4SLinus Torvalds 
37141da177e4SLinus Torvalds 	/* Do the I/O remapping... */
37151da177e4SLinus Torvalds 	card->membase = ioremap(membase, 1024);
37161da177e4SLinus Torvalds 	if (!card->membase) {
37171da177e4SLinus Torvalds 		printk("%s: can't ioremap() membase\n", card->name);
37181da177e4SLinus Torvalds 		err = -EIO;
37191da177e4SLinus Torvalds 		goto err_out_free_card;
37201da177e4SLinus Torvalds 	}
37211da177e4SLinus Torvalds 
37221da177e4SLinus Torvalds 	if (idt77252_preset(card)) {
37231da177e4SLinus Torvalds 		printk("%s: preset failed\n", card->name);
37241da177e4SLinus Torvalds 		err = -EIO;
37251da177e4SLinus Torvalds 		goto err_out_iounmap;
37261da177e4SLinus Torvalds 	}
37271da177e4SLinus Torvalds 
37281da177e4SLinus Torvalds 	dev = atm_dev_register("idt77252", &idt77252_ops, -1, NULL);
37291da177e4SLinus Torvalds 	if (!dev) {
37301da177e4SLinus Torvalds 		printk("%s: can't register atm device\n", card->name);
37311da177e4SLinus Torvalds 		err = -EIO;
37321da177e4SLinus Torvalds 		goto err_out_iounmap;
37331da177e4SLinus Torvalds 	}
37341da177e4SLinus Torvalds 	dev->dev_data = card;
37351da177e4SLinus Torvalds 	card->atmdev = dev;
37361da177e4SLinus Torvalds 
37371da177e4SLinus Torvalds #ifdef	CONFIG_ATM_IDT77252_USE_SUNI
37381da177e4SLinus Torvalds 	suni_init(dev);
37391da177e4SLinus Torvalds 	if (!dev->phy) {
37401da177e4SLinus Torvalds 		printk("%s: can't init SUNI\n", card->name);
37411da177e4SLinus Torvalds 		err = -EIO;
37421da177e4SLinus Torvalds 		goto err_out_deinit_card;
37431da177e4SLinus Torvalds 	}
37441da177e4SLinus Torvalds #endif	/* CONFIG_ATM_IDT77252_USE_SUNI */
37451da177e4SLinus Torvalds 
37461da177e4SLinus Torvalds 	card->sramsize = probe_sram(card);
37471da177e4SLinus Torvalds 
37481da177e4SLinus Torvalds 	for (i = 0; i < 4; i++) {
37491da177e4SLinus Torvalds 		card->fbq[i] = ioremap(srambase | 0x200000 | (i << 18), 4);
37501da177e4SLinus Torvalds 		if (!card->fbq[i]) {
37511da177e4SLinus Torvalds 			printk("%s: can't ioremap() FBQ%d\n", card->name, i);
37521da177e4SLinus Torvalds 			err = -EIO;
37531da177e4SLinus Torvalds 			goto err_out_deinit_card;
37541da177e4SLinus Torvalds 		}
37551da177e4SLinus Torvalds 	}
37561da177e4SLinus Torvalds 
37571da177e4SLinus Torvalds 	printk("%s: ABR SAR (Rev %c): MEM %08lx SRAM %08lx [%u KB]\n",
375844c10138SAuke Kok 	       card->name, ((card->revision > 1) && (card->revision < 25)) ?
375944c10138SAuke Kok 	       'A' + card->revision - 1 : '?', membase, srambase,
37601da177e4SLinus Torvalds 	       card->sramsize / 1024);
37611da177e4SLinus Torvalds 
37621da177e4SLinus Torvalds 	if (init_card(dev)) {
37631da177e4SLinus Torvalds 		printk("%s: init_card failed\n", card->name);
37641da177e4SLinus Torvalds 		err = -EIO;
37651da177e4SLinus Torvalds 		goto err_out_deinit_card;
37661da177e4SLinus Torvalds 	}
37671da177e4SLinus Torvalds 
37681da177e4SLinus Torvalds 	dev->ci_range.vpi_bits = card->vpibits;
37691da177e4SLinus Torvalds 	dev->ci_range.vci_bits = card->vcibits;
37701da177e4SLinus Torvalds 	dev->link_rate = card->link_pcr;
37711da177e4SLinus Torvalds 
37721da177e4SLinus Torvalds 	if (dev->phy->start)
37731da177e4SLinus Torvalds 		dev->phy->start(dev);
37741da177e4SLinus Torvalds 
37751da177e4SLinus Torvalds 	if (idt77252_dev_open(card)) {
37761da177e4SLinus Torvalds 		printk("%s: dev_open failed\n", card->name);
37771da177e4SLinus Torvalds 		err = -EIO;
37781da177e4SLinus Torvalds 		goto err_out_stop;
37791da177e4SLinus Torvalds 	}
37801da177e4SLinus Torvalds 
37811da177e4SLinus Torvalds 	*last = card;
37821da177e4SLinus Torvalds 	last = &card->next;
37831da177e4SLinus Torvalds 	index++;
37841da177e4SLinus Torvalds 
37851da177e4SLinus Torvalds 	return 0;
37861da177e4SLinus Torvalds 
37871da177e4SLinus Torvalds err_out_stop:
37881da177e4SLinus Torvalds 	if (dev->phy->stop)
37891da177e4SLinus Torvalds 		dev->phy->stop(dev);
37901da177e4SLinus Torvalds 
37911da177e4SLinus Torvalds err_out_deinit_card:
37921da177e4SLinus Torvalds 	deinit_card(card);
37931da177e4SLinus Torvalds 
37941da177e4SLinus Torvalds err_out_iounmap:
37951da177e4SLinus Torvalds 	iounmap(card->membase);
37961da177e4SLinus Torvalds 
37971da177e4SLinus Torvalds err_out_free_card:
37981da177e4SLinus Torvalds 	kfree(card);
37991da177e4SLinus Torvalds 
38001da177e4SLinus Torvalds err_out_disable_pdev:
38011da177e4SLinus Torvalds 	pci_disable_device(pcidev);
38021da177e4SLinus Torvalds 	return err;
38031da177e4SLinus Torvalds }
38041da177e4SLinus Torvalds 
38051da177e4SLinus Torvalds static struct pci_device_id idt77252_pci_tbl[] =
38061da177e4SLinus Torvalds {
38071da177e4SLinus Torvalds 	{ PCI_VENDOR_ID_IDT, PCI_DEVICE_ID_IDT_IDT77252,
38081da177e4SLinus Torvalds 	  PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 },
38091da177e4SLinus Torvalds 	{ 0, }
38101da177e4SLinus Torvalds };
38111da177e4SLinus Torvalds 
38121da177e4SLinus Torvalds MODULE_DEVICE_TABLE(pci, idt77252_pci_tbl);
38131da177e4SLinus Torvalds 
38141da177e4SLinus Torvalds static struct pci_driver idt77252_driver = {
38151da177e4SLinus Torvalds 	.name		= "idt77252",
38161da177e4SLinus Torvalds 	.id_table	= idt77252_pci_tbl,
38171da177e4SLinus Torvalds 	.probe		= idt77252_init_one,
38181da177e4SLinus Torvalds };
38191da177e4SLinus Torvalds 
38201da177e4SLinus Torvalds static int __init idt77252_init(void)
38211da177e4SLinus Torvalds {
38221da177e4SLinus Torvalds 	struct sk_buff *skb;
38231da177e4SLinus Torvalds 
38241da177e4SLinus Torvalds 	printk("%s: at %p\n", __FUNCTION__, idt77252_init);
38251da177e4SLinus Torvalds 
38261da177e4SLinus Torvalds 	if (sizeof(skb->cb) < sizeof(struct atm_skb_data) +
38271da177e4SLinus Torvalds 			      sizeof(struct idt77252_skb_prv)) {
38281da177e4SLinus Torvalds 		printk(KERN_ERR "%s: skb->cb is too small (%lu < %lu)\n",
38291da177e4SLinus Torvalds 		       __FUNCTION__, (unsigned long) sizeof(skb->cb),
38301da177e4SLinus Torvalds 		       (unsigned long) sizeof(struct atm_skb_data) +
38311da177e4SLinus Torvalds 				       sizeof(struct idt77252_skb_prv));
38321da177e4SLinus Torvalds 		return -EIO;
38331da177e4SLinus Torvalds 	}
38341da177e4SLinus Torvalds 
38351da177e4SLinus Torvalds 	return pci_register_driver(&idt77252_driver);
38361da177e4SLinus Torvalds }
38371da177e4SLinus Torvalds 
38381da177e4SLinus Torvalds static void __exit idt77252_exit(void)
38391da177e4SLinus Torvalds {
38401da177e4SLinus Torvalds 	struct idt77252_dev *card;
38411da177e4SLinus Torvalds 	struct atm_dev *dev;
38421da177e4SLinus Torvalds 
38431da177e4SLinus Torvalds 	pci_unregister_driver(&idt77252_driver);
38441da177e4SLinus Torvalds 
38451da177e4SLinus Torvalds 	while (idt77252_chain) {
38461da177e4SLinus Torvalds 		card = idt77252_chain;
38471da177e4SLinus Torvalds 		dev = card->atmdev;
38481da177e4SLinus Torvalds 		idt77252_chain = card->next;
38491da177e4SLinus Torvalds 
38501da177e4SLinus Torvalds 		if (dev->phy->stop)
38511da177e4SLinus Torvalds 			dev->phy->stop(dev);
38521da177e4SLinus Torvalds 		deinit_card(card);
38531da177e4SLinus Torvalds 		pci_disable_device(card->pcidev);
38541da177e4SLinus Torvalds 		kfree(card);
38551da177e4SLinus Torvalds 	}
38561da177e4SLinus Torvalds 
38571da177e4SLinus Torvalds 	DIPRINTK("idt77252: finished cleanup-module().\n");
38581da177e4SLinus Torvalds }
38591da177e4SLinus Torvalds 
38601da177e4SLinus Torvalds module_init(idt77252_init);
38611da177e4SLinus Torvalds module_exit(idt77252_exit);
38621da177e4SLinus Torvalds 
38631da177e4SLinus Torvalds MODULE_LICENSE("GPL");
38641da177e4SLinus Torvalds 
38651da177e4SLinus Torvalds module_param(vpibits, uint, 0);
38661da177e4SLinus Torvalds MODULE_PARM_DESC(vpibits, "number of VPI bits supported (0, 1, or 2)");
38671da177e4SLinus Torvalds #ifdef CONFIG_ATM_IDT77252_DEBUG
38681da177e4SLinus Torvalds module_param(debug, ulong, 0644);
38691da177e4SLinus Torvalds MODULE_PARM_DESC(debug,   "debug bitmap, see drivers/atm/idt77252.h");
38701da177e4SLinus Torvalds #endif
38711da177e4SLinus Torvalds 
38721da177e4SLinus Torvalds MODULE_AUTHOR("Eddie C. Dost <ecd@atecom.com>");
38731da177e4SLinus Torvalds MODULE_DESCRIPTION("IDT77252 ABR SAR Driver");
3874