18c2ecf20Sopenharmony_ci/*******************************************************************
28c2ecf20Sopenharmony_ci *
38c2ecf20Sopenharmony_ci * Copyright (c) 2000 ATecoM GmbH
48c2ecf20Sopenharmony_ci *
58c2ecf20Sopenharmony_ci * The author may be reached at ecd@atecom.com.
68c2ecf20Sopenharmony_ci *
78c2ecf20Sopenharmony_ci * This program is free software; you can redistribute  it and/or modify it
88c2ecf20Sopenharmony_ci * under  the terms of  the GNU General  Public License as published by the
98c2ecf20Sopenharmony_ci * Free Software Foundation;  either version 2 of the  License, or (at your
108c2ecf20Sopenharmony_ci * option) any later version.
118c2ecf20Sopenharmony_ci *
128c2ecf20Sopenharmony_ci * THIS  SOFTWARE  IS PROVIDED   ``AS  IS'' AND   ANY  EXPRESS OR   IMPLIED
138c2ecf20Sopenharmony_ci * WARRANTIES,   INCLUDING, BUT NOT  LIMITED  TO, THE IMPLIED WARRANTIES OF
148c2ecf20Sopenharmony_ci * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.  IN
158c2ecf20Sopenharmony_ci * NO  EVENT  SHALL   THE AUTHOR  BE    LIABLE FOR ANY   DIRECT,  INDIRECT,
168c2ecf20Sopenharmony_ci * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
178c2ecf20Sopenharmony_ci * NOT LIMITED   TO, PROCUREMENT OF  SUBSTITUTE GOODS  OR SERVICES; LOSS OF
188c2ecf20Sopenharmony_ci * USE, DATA,  OR PROFITS; OR  BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
198c2ecf20Sopenharmony_ci * ANY THEORY OF LIABILITY, WHETHER IN  CONTRACT, STRICT LIABILITY, OR TORT
208c2ecf20Sopenharmony_ci * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
218c2ecf20Sopenharmony_ci * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
228c2ecf20Sopenharmony_ci *
238c2ecf20Sopenharmony_ci * You should have received a copy of the  GNU General Public License along
248c2ecf20Sopenharmony_ci * with this program; if not, write  to the Free Software Foundation, Inc.,
258c2ecf20Sopenharmony_ci * 675 Mass Ave, Cambridge, MA 02139, USA.
268c2ecf20Sopenharmony_ci *
278c2ecf20Sopenharmony_ci *******************************************************************/
288c2ecf20Sopenharmony_ci
298c2ecf20Sopenharmony_ci#include <linux/module.h>
308c2ecf20Sopenharmony_ci#include <linux/pci.h>
318c2ecf20Sopenharmony_ci#include <linux/poison.h>
328c2ecf20Sopenharmony_ci#include <linux/skbuff.h>
338c2ecf20Sopenharmony_ci#include <linux/kernel.h>
348c2ecf20Sopenharmony_ci#include <linux/vmalloc.h>
358c2ecf20Sopenharmony_ci#include <linux/netdevice.h>
368c2ecf20Sopenharmony_ci#include <linux/atmdev.h>
378c2ecf20Sopenharmony_ci#include <linux/atm.h>
388c2ecf20Sopenharmony_ci#include <linux/delay.h>
398c2ecf20Sopenharmony_ci#include <linux/init.h>
408c2ecf20Sopenharmony_ci#include <linux/interrupt.h>
418c2ecf20Sopenharmony_ci#include <linux/bitops.h>
428c2ecf20Sopenharmony_ci#include <linux/wait.h>
438c2ecf20Sopenharmony_ci#include <linux/jiffies.h>
448c2ecf20Sopenharmony_ci#include <linux/mutex.h>
458c2ecf20Sopenharmony_ci#include <linux/slab.h>
468c2ecf20Sopenharmony_ci
478c2ecf20Sopenharmony_ci#include <asm/io.h>
488c2ecf20Sopenharmony_ci#include <linux/uaccess.h>
498c2ecf20Sopenharmony_ci#include <linux/atomic.h>
508c2ecf20Sopenharmony_ci#include <asm/byteorder.h>
518c2ecf20Sopenharmony_ci
528c2ecf20Sopenharmony_ci#ifdef CONFIG_ATM_IDT77252_USE_SUNI
538c2ecf20Sopenharmony_ci#include "suni.h"
548c2ecf20Sopenharmony_ci#endif /* CONFIG_ATM_IDT77252_USE_SUNI */
558c2ecf20Sopenharmony_ci
568c2ecf20Sopenharmony_ci
578c2ecf20Sopenharmony_ci#include "idt77252.h"
588c2ecf20Sopenharmony_ci#include "idt77252_tables.h"
598c2ecf20Sopenharmony_ci
608c2ecf20Sopenharmony_cistatic unsigned int vpibits = 1;
618c2ecf20Sopenharmony_ci
628c2ecf20Sopenharmony_ci
638c2ecf20Sopenharmony_ci#define ATM_IDT77252_SEND_IDLE 1
648c2ecf20Sopenharmony_ci
658c2ecf20Sopenharmony_ci
668c2ecf20Sopenharmony_ci/*
678c2ecf20Sopenharmony_ci * Debug HACKs.
688c2ecf20Sopenharmony_ci */
698c2ecf20Sopenharmony_ci#define DEBUG_MODULE 1
708c2ecf20Sopenharmony_ci#undef HAVE_EEPROM	/* does not work, yet. */
718c2ecf20Sopenharmony_ci
728c2ecf20Sopenharmony_ci#ifdef CONFIG_ATM_IDT77252_DEBUG
738c2ecf20Sopenharmony_cistatic unsigned long debug = DBG_GENERAL;
748c2ecf20Sopenharmony_ci#endif
758c2ecf20Sopenharmony_ci
768c2ecf20Sopenharmony_ci
778c2ecf20Sopenharmony_ci#define SAR_RX_DELAY	(SAR_CFG_RXINT_NODELAY)
788c2ecf20Sopenharmony_ci
798c2ecf20Sopenharmony_ci
808c2ecf20Sopenharmony_ci/*
818c2ecf20Sopenharmony_ci * SCQ Handling.
828c2ecf20Sopenharmony_ci */
838c2ecf20Sopenharmony_cistatic struct scq_info *alloc_scq(struct idt77252_dev *, int);
848c2ecf20Sopenharmony_cistatic void free_scq(struct idt77252_dev *, struct scq_info *);
858c2ecf20Sopenharmony_cistatic int queue_skb(struct idt77252_dev *, struct vc_map *,
868c2ecf20Sopenharmony_ci		     struct sk_buff *, int oam);
878c2ecf20Sopenharmony_cistatic void drain_scq(struct idt77252_dev *, struct vc_map *);
888c2ecf20Sopenharmony_cistatic unsigned long get_free_scd(struct idt77252_dev *, struct vc_map *);
898c2ecf20Sopenharmony_cistatic void fill_scd(struct idt77252_dev *, struct scq_info *, int);
908c2ecf20Sopenharmony_ci
918c2ecf20Sopenharmony_ci/*
928c2ecf20Sopenharmony_ci * FBQ Handling.
938c2ecf20Sopenharmony_ci */
948c2ecf20Sopenharmony_cistatic int push_rx_skb(struct idt77252_dev *,
958c2ecf20Sopenharmony_ci		       struct sk_buff *, int queue);
968c2ecf20Sopenharmony_cistatic void recycle_rx_skb(struct idt77252_dev *, struct sk_buff *);
978c2ecf20Sopenharmony_cistatic void flush_rx_pool(struct idt77252_dev *, struct rx_pool *);
988c2ecf20Sopenharmony_cistatic void recycle_rx_pool_skb(struct idt77252_dev *,
998c2ecf20Sopenharmony_ci				struct rx_pool *);
1008c2ecf20Sopenharmony_cistatic void add_rx_skb(struct idt77252_dev *, int queue,
1018c2ecf20Sopenharmony_ci		       unsigned int size, unsigned int count);
1028c2ecf20Sopenharmony_ci
1038c2ecf20Sopenharmony_ci/*
1048c2ecf20Sopenharmony_ci * RSQ Handling.
1058c2ecf20Sopenharmony_ci */
1068c2ecf20Sopenharmony_cistatic int init_rsq(struct idt77252_dev *);
1078c2ecf20Sopenharmony_cistatic void deinit_rsq(struct idt77252_dev *);
1088c2ecf20Sopenharmony_cistatic void idt77252_rx(struct idt77252_dev *);
1098c2ecf20Sopenharmony_ci
1108c2ecf20Sopenharmony_ci/*
1118c2ecf20Sopenharmony_ci * TSQ handling.
1128c2ecf20Sopenharmony_ci */
1138c2ecf20Sopenharmony_cistatic int init_tsq(struct idt77252_dev *);
1148c2ecf20Sopenharmony_cistatic void deinit_tsq(struct idt77252_dev *);
1158c2ecf20Sopenharmony_cistatic void idt77252_tx(struct idt77252_dev *);
1168c2ecf20Sopenharmony_ci
1178c2ecf20Sopenharmony_ci
1188c2ecf20Sopenharmony_ci/*
1198c2ecf20Sopenharmony_ci * ATM Interface.
1208c2ecf20Sopenharmony_ci */
1218c2ecf20Sopenharmony_cistatic void idt77252_dev_close(struct atm_dev *dev);
1228c2ecf20Sopenharmony_cistatic int idt77252_open(struct atm_vcc *vcc);
1238c2ecf20Sopenharmony_cistatic void idt77252_close(struct atm_vcc *vcc);
1248c2ecf20Sopenharmony_cistatic int idt77252_send(struct atm_vcc *vcc, struct sk_buff *skb);
1258c2ecf20Sopenharmony_cistatic int idt77252_send_oam(struct atm_vcc *vcc, void *cell,
1268c2ecf20Sopenharmony_ci			     int flags);
1278c2ecf20Sopenharmony_cistatic void idt77252_phy_put(struct atm_dev *dev, unsigned char value,
1288c2ecf20Sopenharmony_ci			     unsigned long addr);
1298c2ecf20Sopenharmony_cistatic unsigned char idt77252_phy_get(struct atm_dev *dev, unsigned long addr);
1308c2ecf20Sopenharmony_cistatic int idt77252_change_qos(struct atm_vcc *vcc, struct atm_qos *qos,
1318c2ecf20Sopenharmony_ci			       int flags);
1328c2ecf20Sopenharmony_cistatic int idt77252_proc_read(struct atm_dev *dev, loff_t * pos,
1338c2ecf20Sopenharmony_ci			      char *page);
1348c2ecf20Sopenharmony_cistatic void idt77252_softint(struct work_struct *work);
1358c2ecf20Sopenharmony_ci
1368c2ecf20Sopenharmony_ci
1378c2ecf20Sopenharmony_cistatic const struct atmdev_ops idt77252_ops =
1388c2ecf20Sopenharmony_ci{
1398c2ecf20Sopenharmony_ci	.dev_close	= idt77252_dev_close,
1408c2ecf20Sopenharmony_ci	.open		= idt77252_open,
1418c2ecf20Sopenharmony_ci	.close		= idt77252_close,
1428c2ecf20Sopenharmony_ci	.send		= idt77252_send,
1438c2ecf20Sopenharmony_ci	.send_oam	= idt77252_send_oam,
1448c2ecf20Sopenharmony_ci	.phy_put	= idt77252_phy_put,
1458c2ecf20Sopenharmony_ci	.phy_get	= idt77252_phy_get,
1468c2ecf20Sopenharmony_ci	.change_qos	= idt77252_change_qos,
1478c2ecf20Sopenharmony_ci	.proc_read	= idt77252_proc_read,
1488c2ecf20Sopenharmony_ci	.owner		= THIS_MODULE
1498c2ecf20Sopenharmony_ci};
1508c2ecf20Sopenharmony_ci
1518c2ecf20Sopenharmony_cistatic struct idt77252_dev *idt77252_chain = NULL;
1528c2ecf20Sopenharmony_cistatic unsigned int idt77252_sram_write_errors = 0;
1538c2ecf20Sopenharmony_ci
1548c2ecf20Sopenharmony_ci/*****************************************************************************/
1558c2ecf20Sopenharmony_ci/*                                                                           */
1568c2ecf20Sopenharmony_ci/* I/O and Utility Bus                                                       */
1578c2ecf20Sopenharmony_ci/*                                                                           */
1588c2ecf20Sopenharmony_ci/*****************************************************************************/
1598c2ecf20Sopenharmony_ci
1608c2ecf20Sopenharmony_cistatic void
1618c2ecf20Sopenharmony_ciwaitfor_idle(struct idt77252_dev *card)
1628c2ecf20Sopenharmony_ci{
1638c2ecf20Sopenharmony_ci	u32 stat;
1648c2ecf20Sopenharmony_ci
1658c2ecf20Sopenharmony_ci	stat = readl(SAR_REG_STAT);
1668c2ecf20Sopenharmony_ci	while (stat & SAR_STAT_CMDBZ)
1678c2ecf20Sopenharmony_ci		stat = readl(SAR_REG_STAT);
1688c2ecf20Sopenharmony_ci}
1698c2ecf20Sopenharmony_ci
1708c2ecf20Sopenharmony_cistatic u32
1718c2ecf20Sopenharmony_ciread_sram(struct idt77252_dev *card, unsigned long addr)
1728c2ecf20Sopenharmony_ci{
1738c2ecf20Sopenharmony_ci	unsigned long flags;
1748c2ecf20Sopenharmony_ci	u32 value;
1758c2ecf20Sopenharmony_ci
1768c2ecf20Sopenharmony_ci	spin_lock_irqsave(&card->cmd_lock, flags);
1778c2ecf20Sopenharmony_ci	writel(SAR_CMD_READ_SRAM | (addr << 2), SAR_REG_CMD);
1788c2ecf20Sopenharmony_ci	waitfor_idle(card);
1798c2ecf20Sopenharmony_ci	value = readl(SAR_REG_DR0);
1808c2ecf20Sopenharmony_ci	spin_unlock_irqrestore(&card->cmd_lock, flags);
1818c2ecf20Sopenharmony_ci	return value;
1828c2ecf20Sopenharmony_ci}
1838c2ecf20Sopenharmony_ci
1848c2ecf20Sopenharmony_cistatic void
1858c2ecf20Sopenharmony_ciwrite_sram(struct idt77252_dev *card, unsigned long addr, u32 value)
1868c2ecf20Sopenharmony_ci{
1878c2ecf20Sopenharmony_ci	unsigned long flags;
1888c2ecf20Sopenharmony_ci
1898c2ecf20Sopenharmony_ci	if ((idt77252_sram_write_errors == 0) &&
1908c2ecf20Sopenharmony_ci	    (((addr > card->tst[0] + card->tst_size - 2) &&
1918c2ecf20Sopenharmony_ci	      (addr < card->tst[0] + card->tst_size)) ||
1928c2ecf20Sopenharmony_ci	     ((addr > card->tst[1] + card->tst_size - 2) &&
1938c2ecf20Sopenharmony_ci	      (addr < card->tst[1] + card->tst_size)))) {
1948c2ecf20Sopenharmony_ci		printk("%s: ERROR: TST JMP section at %08lx written: %08x\n",
1958c2ecf20Sopenharmony_ci		       card->name, addr, value);
1968c2ecf20Sopenharmony_ci	}
1978c2ecf20Sopenharmony_ci
1988c2ecf20Sopenharmony_ci	spin_lock_irqsave(&card->cmd_lock, flags);
1998c2ecf20Sopenharmony_ci	writel(value, SAR_REG_DR0);
2008c2ecf20Sopenharmony_ci	writel(SAR_CMD_WRITE_SRAM | (addr << 2), SAR_REG_CMD);
2018c2ecf20Sopenharmony_ci	waitfor_idle(card);
2028c2ecf20Sopenharmony_ci	spin_unlock_irqrestore(&card->cmd_lock, flags);
2038c2ecf20Sopenharmony_ci}
2048c2ecf20Sopenharmony_ci
2058c2ecf20Sopenharmony_cistatic u8
2068c2ecf20Sopenharmony_ciread_utility(void *dev, unsigned long ubus_addr)
2078c2ecf20Sopenharmony_ci{
2088c2ecf20Sopenharmony_ci	struct idt77252_dev *card = dev;
2098c2ecf20Sopenharmony_ci	unsigned long flags;
2108c2ecf20Sopenharmony_ci	u8 value;
2118c2ecf20Sopenharmony_ci
2128c2ecf20Sopenharmony_ci	if (!card) {
2138c2ecf20Sopenharmony_ci		printk("Error: No such device.\n");
2148c2ecf20Sopenharmony_ci		return -1;
2158c2ecf20Sopenharmony_ci	}
2168c2ecf20Sopenharmony_ci
2178c2ecf20Sopenharmony_ci	spin_lock_irqsave(&card->cmd_lock, flags);
2188c2ecf20Sopenharmony_ci	writel(SAR_CMD_READ_UTILITY + ubus_addr, SAR_REG_CMD);
2198c2ecf20Sopenharmony_ci	waitfor_idle(card);
2208c2ecf20Sopenharmony_ci	value = readl(SAR_REG_DR0);
2218c2ecf20Sopenharmony_ci	spin_unlock_irqrestore(&card->cmd_lock, flags);
2228c2ecf20Sopenharmony_ci	return value;
2238c2ecf20Sopenharmony_ci}
2248c2ecf20Sopenharmony_ci
2258c2ecf20Sopenharmony_cistatic void
2268c2ecf20Sopenharmony_ciwrite_utility(void *dev, unsigned long ubus_addr, u8 value)
2278c2ecf20Sopenharmony_ci{
2288c2ecf20Sopenharmony_ci	struct idt77252_dev *card = dev;
2298c2ecf20Sopenharmony_ci	unsigned long flags;
2308c2ecf20Sopenharmony_ci
2318c2ecf20Sopenharmony_ci	if (!card) {
2328c2ecf20Sopenharmony_ci		printk("Error: No such device.\n");
2338c2ecf20Sopenharmony_ci		return;
2348c2ecf20Sopenharmony_ci	}
2358c2ecf20Sopenharmony_ci
2368c2ecf20Sopenharmony_ci	spin_lock_irqsave(&card->cmd_lock, flags);
2378c2ecf20Sopenharmony_ci	writel((u32) value, SAR_REG_DR0);
2388c2ecf20Sopenharmony_ci	writel(SAR_CMD_WRITE_UTILITY + ubus_addr, SAR_REG_CMD);
2398c2ecf20Sopenharmony_ci	waitfor_idle(card);
2408c2ecf20Sopenharmony_ci	spin_unlock_irqrestore(&card->cmd_lock, flags);
2418c2ecf20Sopenharmony_ci}
2428c2ecf20Sopenharmony_ci
2438c2ecf20Sopenharmony_ci#ifdef HAVE_EEPROM
2448c2ecf20Sopenharmony_cistatic u32 rdsrtab[] =
2458c2ecf20Sopenharmony_ci{
2468c2ecf20Sopenharmony_ci	SAR_GP_EECS | SAR_GP_EESCLK,
2478c2ecf20Sopenharmony_ci	0,
2488c2ecf20Sopenharmony_ci	SAR_GP_EESCLK,			/* 0 */
2498c2ecf20Sopenharmony_ci	0,
2508c2ecf20Sopenharmony_ci	SAR_GP_EESCLK,			/* 0 */
2518c2ecf20Sopenharmony_ci	0,
2528c2ecf20Sopenharmony_ci	SAR_GP_EESCLK,			/* 0 */
2538c2ecf20Sopenharmony_ci	0,
2548c2ecf20Sopenharmony_ci	SAR_GP_EESCLK,			/* 0 */
2558c2ecf20Sopenharmony_ci	0,
2568c2ecf20Sopenharmony_ci	SAR_GP_EESCLK,			/* 0 */
2578c2ecf20Sopenharmony_ci	SAR_GP_EEDO,
2588c2ecf20Sopenharmony_ci	SAR_GP_EESCLK | SAR_GP_EEDO,	/* 1 */
2598c2ecf20Sopenharmony_ci	0,
2608c2ecf20Sopenharmony_ci	SAR_GP_EESCLK,			/* 0 */
2618c2ecf20Sopenharmony_ci	SAR_GP_EEDO,
2628c2ecf20Sopenharmony_ci	SAR_GP_EESCLK | SAR_GP_EEDO	/* 1 */
2638c2ecf20Sopenharmony_ci};
2648c2ecf20Sopenharmony_ci
2658c2ecf20Sopenharmony_cistatic u32 wrentab[] =
2668c2ecf20Sopenharmony_ci{
2678c2ecf20Sopenharmony_ci	SAR_GP_EECS | SAR_GP_EESCLK,
2688c2ecf20Sopenharmony_ci	0,
2698c2ecf20Sopenharmony_ci	SAR_GP_EESCLK,			/* 0 */
2708c2ecf20Sopenharmony_ci	0,
2718c2ecf20Sopenharmony_ci	SAR_GP_EESCLK,			/* 0 */
2728c2ecf20Sopenharmony_ci	0,
2738c2ecf20Sopenharmony_ci	SAR_GP_EESCLK,			/* 0 */
2748c2ecf20Sopenharmony_ci	0,
2758c2ecf20Sopenharmony_ci	SAR_GP_EESCLK,			/* 0 */
2768c2ecf20Sopenharmony_ci	SAR_GP_EEDO,
2778c2ecf20Sopenharmony_ci	SAR_GP_EESCLK | SAR_GP_EEDO,	/* 1 */
2788c2ecf20Sopenharmony_ci	SAR_GP_EEDO,
2798c2ecf20Sopenharmony_ci	SAR_GP_EESCLK | SAR_GP_EEDO,	/* 1 */
2808c2ecf20Sopenharmony_ci	0,
2818c2ecf20Sopenharmony_ci	SAR_GP_EESCLK,			/* 0 */
2828c2ecf20Sopenharmony_ci	0,
2838c2ecf20Sopenharmony_ci	SAR_GP_EESCLK			/* 0 */
2848c2ecf20Sopenharmony_ci};
2858c2ecf20Sopenharmony_ci
2868c2ecf20Sopenharmony_cistatic u32 rdtab[] =
2878c2ecf20Sopenharmony_ci{
2888c2ecf20Sopenharmony_ci	SAR_GP_EECS | SAR_GP_EESCLK,
2898c2ecf20Sopenharmony_ci	0,
2908c2ecf20Sopenharmony_ci	SAR_GP_EESCLK,			/* 0 */
2918c2ecf20Sopenharmony_ci	0,
2928c2ecf20Sopenharmony_ci	SAR_GP_EESCLK,			/* 0 */
2938c2ecf20Sopenharmony_ci	0,
2948c2ecf20Sopenharmony_ci	SAR_GP_EESCLK,			/* 0 */
2958c2ecf20Sopenharmony_ci	0,
2968c2ecf20Sopenharmony_ci	SAR_GP_EESCLK,			/* 0 */
2978c2ecf20Sopenharmony_ci	0,
2988c2ecf20Sopenharmony_ci	SAR_GP_EESCLK,			/* 0 */
2998c2ecf20Sopenharmony_ci	0,
3008c2ecf20Sopenharmony_ci	SAR_GP_EESCLK,			/* 0 */
3018c2ecf20Sopenharmony_ci	SAR_GP_EEDO,
3028c2ecf20Sopenharmony_ci	SAR_GP_EESCLK | SAR_GP_EEDO,	/* 1 */
3038c2ecf20Sopenharmony_ci	SAR_GP_EEDO,
3048c2ecf20Sopenharmony_ci	SAR_GP_EESCLK | SAR_GP_EEDO	/* 1 */
3058c2ecf20Sopenharmony_ci};
3068c2ecf20Sopenharmony_ci
3078c2ecf20Sopenharmony_cistatic u32 wrtab[] =
3088c2ecf20Sopenharmony_ci{
3098c2ecf20Sopenharmony_ci	SAR_GP_EECS | SAR_GP_EESCLK,
3108c2ecf20Sopenharmony_ci	0,
3118c2ecf20Sopenharmony_ci	SAR_GP_EESCLK,			/* 0 */
3128c2ecf20Sopenharmony_ci	0,
3138c2ecf20Sopenharmony_ci	SAR_GP_EESCLK,			/* 0 */
3148c2ecf20Sopenharmony_ci	0,
3158c2ecf20Sopenharmony_ci	SAR_GP_EESCLK,			/* 0 */
3168c2ecf20Sopenharmony_ci	0,
3178c2ecf20Sopenharmony_ci	SAR_GP_EESCLK,			/* 0 */
3188c2ecf20Sopenharmony_ci	0,
3198c2ecf20Sopenharmony_ci	SAR_GP_EESCLK,			/* 0 */
3208c2ecf20Sopenharmony_ci	0,
3218c2ecf20Sopenharmony_ci	SAR_GP_EESCLK,			/* 0 */
3228c2ecf20Sopenharmony_ci	SAR_GP_EEDO,
3238c2ecf20Sopenharmony_ci	SAR_GP_EESCLK | SAR_GP_EEDO,	/* 1 */
3248c2ecf20Sopenharmony_ci	0,
3258c2ecf20Sopenharmony_ci	SAR_GP_EESCLK			/* 0 */
3268c2ecf20Sopenharmony_ci};
3278c2ecf20Sopenharmony_ci
3288c2ecf20Sopenharmony_cistatic u32 clktab[] =
3298c2ecf20Sopenharmony_ci{
3308c2ecf20Sopenharmony_ci	0,
3318c2ecf20Sopenharmony_ci	SAR_GP_EESCLK,
3328c2ecf20Sopenharmony_ci	0,
3338c2ecf20Sopenharmony_ci	SAR_GP_EESCLK,
3348c2ecf20Sopenharmony_ci	0,
3358c2ecf20Sopenharmony_ci	SAR_GP_EESCLK,
3368c2ecf20Sopenharmony_ci	0,
3378c2ecf20Sopenharmony_ci	SAR_GP_EESCLK,
3388c2ecf20Sopenharmony_ci	0,
3398c2ecf20Sopenharmony_ci	SAR_GP_EESCLK,
3408c2ecf20Sopenharmony_ci	0,
3418c2ecf20Sopenharmony_ci	SAR_GP_EESCLK,
3428c2ecf20Sopenharmony_ci	0,
3438c2ecf20Sopenharmony_ci	SAR_GP_EESCLK,
3448c2ecf20Sopenharmony_ci	0,
3458c2ecf20Sopenharmony_ci	SAR_GP_EESCLK,
3468c2ecf20Sopenharmony_ci	0
3478c2ecf20Sopenharmony_ci};
3488c2ecf20Sopenharmony_ci
3498c2ecf20Sopenharmony_cistatic u32
3508c2ecf20Sopenharmony_ciidt77252_read_gp(struct idt77252_dev *card)
3518c2ecf20Sopenharmony_ci{
3528c2ecf20Sopenharmony_ci	u32 gp;
3538c2ecf20Sopenharmony_ci
3548c2ecf20Sopenharmony_ci	gp = readl(SAR_REG_GP);
3558c2ecf20Sopenharmony_ci#if 0
3568c2ecf20Sopenharmony_ci	printk("RD: %s\n", gp & SAR_GP_EEDI ? "1" : "0");
3578c2ecf20Sopenharmony_ci#endif
3588c2ecf20Sopenharmony_ci	return gp;
3598c2ecf20Sopenharmony_ci}
3608c2ecf20Sopenharmony_ci
3618c2ecf20Sopenharmony_cistatic void
3628c2ecf20Sopenharmony_ciidt77252_write_gp(struct idt77252_dev *card, u32 value)
3638c2ecf20Sopenharmony_ci{
3648c2ecf20Sopenharmony_ci	unsigned long flags;
3658c2ecf20Sopenharmony_ci
3668c2ecf20Sopenharmony_ci#if 0
3678c2ecf20Sopenharmony_ci	printk("WR: %s %s %s\n", value & SAR_GP_EECS ? "   " : "/CS",
3688c2ecf20Sopenharmony_ci	       value & SAR_GP_EESCLK ? "HIGH" : "LOW ",
3698c2ecf20Sopenharmony_ci	       value & SAR_GP_EEDO   ? "1" : "0");
3708c2ecf20Sopenharmony_ci#endif
3718c2ecf20Sopenharmony_ci
3728c2ecf20Sopenharmony_ci	spin_lock_irqsave(&card->cmd_lock, flags);
3738c2ecf20Sopenharmony_ci	waitfor_idle(card);
3748c2ecf20Sopenharmony_ci	writel(value, SAR_REG_GP);
3758c2ecf20Sopenharmony_ci	spin_unlock_irqrestore(&card->cmd_lock, flags);
3768c2ecf20Sopenharmony_ci}
3778c2ecf20Sopenharmony_ci
3788c2ecf20Sopenharmony_cistatic u8
3798c2ecf20Sopenharmony_ciidt77252_eeprom_read_status(struct idt77252_dev *card)
3808c2ecf20Sopenharmony_ci{
3818c2ecf20Sopenharmony_ci	u8 byte;
3828c2ecf20Sopenharmony_ci	u32 gp;
3838c2ecf20Sopenharmony_ci	int i, j;
3848c2ecf20Sopenharmony_ci
3858c2ecf20Sopenharmony_ci	gp = idt77252_read_gp(card) & ~(SAR_GP_EESCLK|SAR_GP_EECS|SAR_GP_EEDO);
3868c2ecf20Sopenharmony_ci
3878c2ecf20Sopenharmony_ci	for (i = 0; i < ARRAY_SIZE(rdsrtab); i++) {
3888c2ecf20Sopenharmony_ci		idt77252_write_gp(card, gp | rdsrtab[i]);
3898c2ecf20Sopenharmony_ci		udelay(5);
3908c2ecf20Sopenharmony_ci	}
3918c2ecf20Sopenharmony_ci	idt77252_write_gp(card, gp | SAR_GP_EECS);
3928c2ecf20Sopenharmony_ci	udelay(5);
3938c2ecf20Sopenharmony_ci
3948c2ecf20Sopenharmony_ci	byte = 0;
3958c2ecf20Sopenharmony_ci	for (i = 0, j = 0; i < 8; i++) {
3968c2ecf20Sopenharmony_ci		byte <<= 1;
3978c2ecf20Sopenharmony_ci
3988c2ecf20Sopenharmony_ci		idt77252_write_gp(card, gp | clktab[j++]);
3998c2ecf20Sopenharmony_ci		udelay(5);
4008c2ecf20Sopenharmony_ci
4018c2ecf20Sopenharmony_ci		byte |= idt77252_read_gp(card) & SAR_GP_EEDI ? 1 : 0;
4028c2ecf20Sopenharmony_ci
4038c2ecf20Sopenharmony_ci		idt77252_write_gp(card, gp | clktab[j++]);
4048c2ecf20Sopenharmony_ci		udelay(5);
4058c2ecf20Sopenharmony_ci	}
4068c2ecf20Sopenharmony_ci	idt77252_write_gp(card, gp | SAR_GP_EECS);
4078c2ecf20Sopenharmony_ci	udelay(5);
4088c2ecf20Sopenharmony_ci
4098c2ecf20Sopenharmony_ci	return byte;
4108c2ecf20Sopenharmony_ci}
4118c2ecf20Sopenharmony_ci
4128c2ecf20Sopenharmony_cistatic u8
4138c2ecf20Sopenharmony_ciidt77252_eeprom_read_byte(struct idt77252_dev *card, u8 offset)
4148c2ecf20Sopenharmony_ci{
4158c2ecf20Sopenharmony_ci	u8 byte;
4168c2ecf20Sopenharmony_ci	u32 gp;
4178c2ecf20Sopenharmony_ci	int i, j;
4188c2ecf20Sopenharmony_ci
4198c2ecf20Sopenharmony_ci	gp = idt77252_read_gp(card) & ~(SAR_GP_EESCLK|SAR_GP_EECS|SAR_GP_EEDO);
4208c2ecf20Sopenharmony_ci
4218c2ecf20Sopenharmony_ci	for (i = 0; i < ARRAY_SIZE(rdtab); i++) {
4228c2ecf20Sopenharmony_ci		idt77252_write_gp(card, gp | rdtab[i]);
4238c2ecf20Sopenharmony_ci		udelay(5);
4248c2ecf20Sopenharmony_ci	}
4258c2ecf20Sopenharmony_ci	idt77252_write_gp(card, gp | SAR_GP_EECS);
4268c2ecf20Sopenharmony_ci	udelay(5);
4278c2ecf20Sopenharmony_ci
4288c2ecf20Sopenharmony_ci	for (i = 0, j = 0; i < 8; i++) {
4298c2ecf20Sopenharmony_ci		idt77252_write_gp(card, gp | clktab[j++] |
4308c2ecf20Sopenharmony_ci					(offset & 1 ? SAR_GP_EEDO : 0));
4318c2ecf20Sopenharmony_ci		udelay(5);
4328c2ecf20Sopenharmony_ci
4338c2ecf20Sopenharmony_ci		idt77252_write_gp(card, gp | clktab[j++] |
4348c2ecf20Sopenharmony_ci					(offset & 1 ? SAR_GP_EEDO : 0));
4358c2ecf20Sopenharmony_ci		udelay(5);
4368c2ecf20Sopenharmony_ci
4378c2ecf20Sopenharmony_ci		offset >>= 1;
4388c2ecf20Sopenharmony_ci	}
4398c2ecf20Sopenharmony_ci	idt77252_write_gp(card, gp | SAR_GP_EECS);
4408c2ecf20Sopenharmony_ci	udelay(5);
4418c2ecf20Sopenharmony_ci
4428c2ecf20Sopenharmony_ci	byte = 0;
4438c2ecf20Sopenharmony_ci	for (i = 0, j = 0; i < 8; i++) {
4448c2ecf20Sopenharmony_ci		byte <<= 1;
4458c2ecf20Sopenharmony_ci
4468c2ecf20Sopenharmony_ci		idt77252_write_gp(card, gp | clktab[j++]);
4478c2ecf20Sopenharmony_ci		udelay(5);
4488c2ecf20Sopenharmony_ci
4498c2ecf20Sopenharmony_ci		byte |= idt77252_read_gp(card) & SAR_GP_EEDI ? 1 : 0;
4508c2ecf20Sopenharmony_ci
4518c2ecf20Sopenharmony_ci		idt77252_write_gp(card, gp | clktab[j++]);
4528c2ecf20Sopenharmony_ci		udelay(5);
4538c2ecf20Sopenharmony_ci	}
4548c2ecf20Sopenharmony_ci	idt77252_write_gp(card, gp | SAR_GP_EECS);
4558c2ecf20Sopenharmony_ci	udelay(5);
4568c2ecf20Sopenharmony_ci
4578c2ecf20Sopenharmony_ci	return byte;
4588c2ecf20Sopenharmony_ci}
4598c2ecf20Sopenharmony_ci
4608c2ecf20Sopenharmony_cistatic void
4618c2ecf20Sopenharmony_ciidt77252_eeprom_write_byte(struct idt77252_dev *card, u8 offset, u8 data)
4628c2ecf20Sopenharmony_ci{
4638c2ecf20Sopenharmony_ci	u32 gp;
4648c2ecf20Sopenharmony_ci	int i, j;
4658c2ecf20Sopenharmony_ci
4668c2ecf20Sopenharmony_ci	gp = idt77252_read_gp(card) & ~(SAR_GP_EESCLK|SAR_GP_EECS|SAR_GP_EEDO);
4678c2ecf20Sopenharmony_ci
4688c2ecf20Sopenharmony_ci	for (i = 0; i < ARRAY_SIZE(wrentab); i++) {
4698c2ecf20Sopenharmony_ci		idt77252_write_gp(card, gp | wrentab[i]);
4708c2ecf20Sopenharmony_ci		udelay(5);
4718c2ecf20Sopenharmony_ci	}
4728c2ecf20Sopenharmony_ci	idt77252_write_gp(card, gp | SAR_GP_EECS);
4738c2ecf20Sopenharmony_ci	udelay(5);
4748c2ecf20Sopenharmony_ci
4758c2ecf20Sopenharmony_ci	for (i = 0; i < ARRAY_SIZE(wrtab); i++) {
4768c2ecf20Sopenharmony_ci		idt77252_write_gp(card, gp | wrtab[i]);
4778c2ecf20Sopenharmony_ci		udelay(5);
4788c2ecf20Sopenharmony_ci	}
4798c2ecf20Sopenharmony_ci	idt77252_write_gp(card, gp | SAR_GP_EECS);
4808c2ecf20Sopenharmony_ci	udelay(5);
4818c2ecf20Sopenharmony_ci
4828c2ecf20Sopenharmony_ci	for (i = 0, j = 0; i < 8; i++) {
4838c2ecf20Sopenharmony_ci		idt77252_write_gp(card, gp | clktab[j++] |
4848c2ecf20Sopenharmony_ci					(offset & 1 ? SAR_GP_EEDO : 0));
4858c2ecf20Sopenharmony_ci		udelay(5);
4868c2ecf20Sopenharmony_ci
4878c2ecf20Sopenharmony_ci		idt77252_write_gp(card, gp | clktab[j++] |
4888c2ecf20Sopenharmony_ci					(offset & 1 ? SAR_GP_EEDO : 0));
4898c2ecf20Sopenharmony_ci		udelay(5);
4908c2ecf20Sopenharmony_ci
4918c2ecf20Sopenharmony_ci		offset >>= 1;
4928c2ecf20Sopenharmony_ci	}
4938c2ecf20Sopenharmony_ci	idt77252_write_gp(card, gp | SAR_GP_EECS);
4948c2ecf20Sopenharmony_ci	udelay(5);
4958c2ecf20Sopenharmony_ci
4968c2ecf20Sopenharmony_ci	for (i = 0, j = 0; i < 8; i++) {
4978c2ecf20Sopenharmony_ci		idt77252_write_gp(card, gp | clktab[j++] |
4988c2ecf20Sopenharmony_ci					(data & 1 ? SAR_GP_EEDO : 0));
4998c2ecf20Sopenharmony_ci		udelay(5);
5008c2ecf20Sopenharmony_ci
5018c2ecf20Sopenharmony_ci		idt77252_write_gp(card, gp | clktab[j++] |
5028c2ecf20Sopenharmony_ci					(data & 1 ? SAR_GP_EEDO : 0));
5038c2ecf20Sopenharmony_ci		udelay(5);
5048c2ecf20Sopenharmony_ci
5058c2ecf20Sopenharmony_ci		data >>= 1;
5068c2ecf20Sopenharmony_ci	}
5078c2ecf20Sopenharmony_ci	idt77252_write_gp(card, gp | SAR_GP_EECS);
5088c2ecf20Sopenharmony_ci	udelay(5);
5098c2ecf20Sopenharmony_ci}
5108c2ecf20Sopenharmony_ci
5118c2ecf20Sopenharmony_cistatic void
5128c2ecf20Sopenharmony_ciidt77252_eeprom_init(struct idt77252_dev *card)
5138c2ecf20Sopenharmony_ci{
5148c2ecf20Sopenharmony_ci	u32 gp;
5158c2ecf20Sopenharmony_ci
5168c2ecf20Sopenharmony_ci	gp = idt77252_read_gp(card) & ~(SAR_GP_EESCLK|SAR_GP_EECS|SAR_GP_EEDO);
5178c2ecf20Sopenharmony_ci
5188c2ecf20Sopenharmony_ci	idt77252_write_gp(card, gp | SAR_GP_EECS | SAR_GP_EESCLK);
5198c2ecf20Sopenharmony_ci	udelay(5);
5208c2ecf20Sopenharmony_ci	idt77252_write_gp(card, gp | SAR_GP_EECS);
5218c2ecf20Sopenharmony_ci	udelay(5);
5228c2ecf20Sopenharmony_ci	idt77252_write_gp(card, gp | SAR_GP_EECS | SAR_GP_EESCLK);
5238c2ecf20Sopenharmony_ci	udelay(5);
5248c2ecf20Sopenharmony_ci	idt77252_write_gp(card, gp | SAR_GP_EECS);
5258c2ecf20Sopenharmony_ci	udelay(5);
5268c2ecf20Sopenharmony_ci}
5278c2ecf20Sopenharmony_ci#endif /* HAVE_EEPROM */
5288c2ecf20Sopenharmony_ci
5298c2ecf20Sopenharmony_ci
5308c2ecf20Sopenharmony_ci#ifdef CONFIG_ATM_IDT77252_DEBUG
5318c2ecf20Sopenharmony_cistatic void
5328c2ecf20Sopenharmony_cidump_tct(struct idt77252_dev *card, int index)
5338c2ecf20Sopenharmony_ci{
5348c2ecf20Sopenharmony_ci	unsigned long tct;
5358c2ecf20Sopenharmony_ci	int i;
5368c2ecf20Sopenharmony_ci
5378c2ecf20Sopenharmony_ci	tct = (unsigned long) (card->tct_base + index * SAR_SRAM_TCT_SIZE);
5388c2ecf20Sopenharmony_ci
5398c2ecf20Sopenharmony_ci	printk("%s: TCT %x:", card->name, index);
5408c2ecf20Sopenharmony_ci	for (i = 0; i < 8; i++) {
5418c2ecf20Sopenharmony_ci		printk(" %08x", read_sram(card, tct + i));
5428c2ecf20Sopenharmony_ci	}
5438c2ecf20Sopenharmony_ci	printk("\n");
5448c2ecf20Sopenharmony_ci}
5458c2ecf20Sopenharmony_ci
5468c2ecf20Sopenharmony_cistatic void
5478c2ecf20Sopenharmony_ciidt77252_tx_dump(struct idt77252_dev *card)
5488c2ecf20Sopenharmony_ci{
5498c2ecf20Sopenharmony_ci	struct atm_vcc *vcc;
5508c2ecf20Sopenharmony_ci	struct vc_map *vc;
5518c2ecf20Sopenharmony_ci	int i;
5528c2ecf20Sopenharmony_ci
5538c2ecf20Sopenharmony_ci	printk("%s\n", __func__);
5548c2ecf20Sopenharmony_ci	for (i = 0; i < card->tct_size; i++) {
5558c2ecf20Sopenharmony_ci		vc = card->vcs[i];
5568c2ecf20Sopenharmony_ci		if (!vc)
5578c2ecf20Sopenharmony_ci			continue;
5588c2ecf20Sopenharmony_ci
5598c2ecf20Sopenharmony_ci		vcc = NULL;
5608c2ecf20Sopenharmony_ci		if (vc->rx_vcc)
5618c2ecf20Sopenharmony_ci			vcc = vc->rx_vcc;
5628c2ecf20Sopenharmony_ci		else if (vc->tx_vcc)
5638c2ecf20Sopenharmony_ci			vcc = vc->tx_vcc;
5648c2ecf20Sopenharmony_ci
5658c2ecf20Sopenharmony_ci		if (!vcc)
5668c2ecf20Sopenharmony_ci			continue;
5678c2ecf20Sopenharmony_ci
5688c2ecf20Sopenharmony_ci		printk("%s: Connection %d:\n", card->name, vc->index);
5698c2ecf20Sopenharmony_ci		dump_tct(card, vc->index);
5708c2ecf20Sopenharmony_ci	}
5718c2ecf20Sopenharmony_ci}
5728c2ecf20Sopenharmony_ci#endif
5738c2ecf20Sopenharmony_ci
5748c2ecf20Sopenharmony_ci
5758c2ecf20Sopenharmony_ci/*****************************************************************************/
5768c2ecf20Sopenharmony_ci/*                                                                           */
5778c2ecf20Sopenharmony_ci/* SCQ Handling                                                              */
5788c2ecf20Sopenharmony_ci/*                                                                           */
5798c2ecf20Sopenharmony_ci/*****************************************************************************/
5808c2ecf20Sopenharmony_ci
5818c2ecf20Sopenharmony_cistatic int
5828c2ecf20Sopenharmony_cisb_pool_add(struct idt77252_dev *card, struct sk_buff *skb, int queue)
5838c2ecf20Sopenharmony_ci{
5848c2ecf20Sopenharmony_ci	struct sb_pool *pool = &card->sbpool[queue];
5858c2ecf20Sopenharmony_ci	int index;
5868c2ecf20Sopenharmony_ci
5878c2ecf20Sopenharmony_ci	index = pool->index;
5888c2ecf20Sopenharmony_ci	while (pool->skb[index]) {
5898c2ecf20Sopenharmony_ci		index = (index + 1) & FBQ_MASK;
5908c2ecf20Sopenharmony_ci		if (index == pool->index)
5918c2ecf20Sopenharmony_ci			return -ENOBUFS;
5928c2ecf20Sopenharmony_ci	}
5938c2ecf20Sopenharmony_ci
5948c2ecf20Sopenharmony_ci	pool->skb[index] = skb;
5958c2ecf20Sopenharmony_ci	IDT77252_PRV_POOL(skb) = POOL_HANDLE(queue, index);
5968c2ecf20Sopenharmony_ci
5978c2ecf20Sopenharmony_ci	pool->index = (index + 1) & FBQ_MASK;
5988c2ecf20Sopenharmony_ci	return 0;
5998c2ecf20Sopenharmony_ci}
6008c2ecf20Sopenharmony_ci
6018c2ecf20Sopenharmony_cistatic void
6028c2ecf20Sopenharmony_cisb_pool_remove(struct idt77252_dev *card, struct sk_buff *skb)
6038c2ecf20Sopenharmony_ci{
6048c2ecf20Sopenharmony_ci	unsigned int queue, index;
6058c2ecf20Sopenharmony_ci	u32 handle;
6068c2ecf20Sopenharmony_ci
6078c2ecf20Sopenharmony_ci	handle = IDT77252_PRV_POOL(skb);
6088c2ecf20Sopenharmony_ci
6098c2ecf20Sopenharmony_ci	queue = POOL_QUEUE(handle);
6108c2ecf20Sopenharmony_ci	if (queue > 3)
6118c2ecf20Sopenharmony_ci		return;
6128c2ecf20Sopenharmony_ci
6138c2ecf20Sopenharmony_ci	index = POOL_INDEX(handle);
6148c2ecf20Sopenharmony_ci	if (index > FBQ_SIZE - 1)
6158c2ecf20Sopenharmony_ci		return;
6168c2ecf20Sopenharmony_ci
6178c2ecf20Sopenharmony_ci	card->sbpool[queue].skb[index] = NULL;
6188c2ecf20Sopenharmony_ci}
6198c2ecf20Sopenharmony_ci
6208c2ecf20Sopenharmony_cistatic struct sk_buff *
6218c2ecf20Sopenharmony_cisb_pool_skb(struct idt77252_dev *card, u32 handle)
6228c2ecf20Sopenharmony_ci{
6238c2ecf20Sopenharmony_ci	unsigned int queue, index;
6248c2ecf20Sopenharmony_ci
6258c2ecf20Sopenharmony_ci	queue = POOL_QUEUE(handle);
6268c2ecf20Sopenharmony_ci	if (queue > 3)
6278c2ecf20Sopenharmony_ci		return NULL;
6288c2ecf20Sopenharmony_ci
6298c2ecf20Sopenharmony_ci	index = POOL_INDEX(handle);
6308c2ecf20Sopenharmony_ci	if (index > FBQ_SIZE - 1)
6318c2ecf20Sopenharmony_ci		return NULL;
6328c2ecf20Sopenharmony_ci
6338c2ecf20Sopenharmony_ci	return card->sbpool[queue].skb[index];
6348c2ecf20Sopenharmony_ci}
6358c2ecf20Sopenharmony_ci
6368c2ecf20Sopenharmony_cistatic struct scq_info *
6378c2ecf20Sopenharmony_cialloc_scq(struct idt77252_dev *card, int class)
6388c2ecf20Sopenharmony_ci{
6398c2ecf20Sopenharmony_ci	struct scq_info *scq;
6408c2ecf20Sopenharmony_ci
6418c2ecf20Sopenharmony_ci	scq = kzalloc(sizeof(struct scq_info), GFP_KERNEL);
6428c2ecf20Sopenharmony_ci	if (!scq)
6438c2ecf20Sopenharmony_ci		return NULL;
6448c2ecf20Sopenharmony_ci	scq->base = dma_alloc_coherent(&card->pcidev->dev, SCQ_SIZE,
6458c2ecf20Sopenharmony_ci				       &scq->paddr, GFP_KERNEL);
6468c2ecf20Sopenharmony_ci	if (scq->base == NULL) {
6478c2ecf20Sopenharmony_ci		kfree(scq);
6488c2ecf20Sopenharmony_ci		return NULL;
6498c2ecf20Sopenharmony_ci	}
6508c2ecf20Sopenharmony_ci
6518c2ecf20Sopenharmony_ci	scq->next = scq->base;
6528c2ecf20Sopenharmony_ci	scq->last = scq->base + (SCQ_ENTRIES - 1);
6538c2ecf20Sopenharmony_ci	atomic_set(&scq->used, 0);
6548c2ecf20Sopenharmony_ci
6558c2ecf20Sopenharmony_ci	spin_lock_init(&scq->lock);
6568c2ecf20Sopenharmony_ci	spin_lock_init(&scq->skblock);
6578c2ecf20Sopenharmony_ci
6588c2ecf20Sopenharmony_ci	skb_queue_head_init(&scq->transmit);
6598c2ecf20Sopenharmony_ci	skb_queue_head_init(&scq->pending);
6608c2ecf20Sopenharmony_ci
6618c2ecf20Sopenharmony_ci	TXPRINTK("idt77252: SCQ: base 0x%p, next 0x%p, last 0x%p, paddr %08llx\n",
6628c2ecf20Sopenharmony_ci		 scq->base, scq->next, scq->last, (unsigned long long)scq->paddr);
6638c2ecf20Sopenharmony_ci
6648c2ecf20Sopenharmony_ci	return scq;
6658c2ecf20Sopenharmony_ci}
6668c2ecf20Sopenharmony_ci
6678c2ecf20Sopenharmony_cistatic void
6688c2ecf20Sopenharmony_cifree_scq(struct idt77252_dev *card, struct scq_info *scq)
6698c2ecf20Sopenharmony_ci{
6708c2ecf20Sopenharmony_ci	struct sk_buff *skb;
6718c2ecf20Sopenharmony_ci	struct atm_vcc *vcc;
6728c2ecf20Sopenharmony_ci
6738c2ecf20Sopenharmony_ci	dma_free_coherent(&card->pcidev->dev, SCQ_SIZE,
6748c2ecf20Sopenharmony_ci			  scq->base, scq->paddr);
6758c2ecf20Sopenharmony_ci
6768c2ecf20Sopenharmony_ci	while ((skb = skb_dequeue(&scq->transmit))) {
6778c2ecf20Sopenharmony_ci		dma_unmap_single(&card->pcidev->dev, IDT77252_PRV_PADDR(skb),
6788c2ecf20Sopenharmony_ci				 skb->len, DMA_TO_DEVICE);
6798c2ecf20Sopenharmony_ci
6808c2ecf20Sopenharmony_ci		vcc = ATM_SKB(skb)->vcc;
6818c2ecf20Sopenharmony_ci		if (vcc->pop)
6828c2ecf20Sopenharmony_ci			vcc->pop(vcc, skb);
6838c2ecf20Sopenharmony_ci		else
6848c2ecf20Sopenharmony_ci			dev_kfree_skb(skb);
6858c2ecf20Sopenharmony_ci	}
6868c2ecf20Sopenharmony_ci
6878c2ecf20Sopenharmony_ci	while ((skb = skb_dequeue(&scq->pending))) {
6888c2ecf20Sopenharmony_ci		dma_unmap_single(&card->pcidev->dev, IDT77252_PRV_PADDR(skb),
6898c2ecf20Sopenharmony_ci				 skb->len, DMA_TO_DEVICE);
6908c2ecf20Sopenharmony_ci
6918c2ecf20Sopenharmony_ci		vcc = ATM_SKB(skb)->vcc;
6928c2ecf20Sopenharmony_ci		if (vcc->pop)
6938c2ecf20Sopenharmony_ci			vcc->pop(vcc, skb);
6948c2ecf20Sopenharmony_ci		else
6958c2ecf20Sopenharmony_ci			dev_kfree_skb(skb);
6968c2ecf20Sopenharmony_ci	}
6978c2ecf20Sopenharmony_ci
6988c2ecf20Sopenharmony_ci	kfree(scq);
6998c2ecf20Sopenharmony_ci}
7008c2ecf20Sopenharmony_ci
7018c2ecf20Sopenharmony_ci
7028c2ecf20Sopenharmony_cistatic int
7038c2ecf20Sopenharmony_cipush_on_scq(struct idt77252_dev *card, struct vc_map *vc, struct sk_buff *skb)
7048c2ecf20Sopenharmony_ci{
7058c2ecf20Sopenharmony_ci	struct scq_info *scq = vc->scq;
7068c2ecf20Sopenharmony_ci	unsigned long flags;
7078c2ecf20Sopenharmony_ci	struct scqe *tbd;
7088c2ecf20Sopenharmony_ci	int entries;
7098c2ecf20Sopenharmony_ci
7108c2ecf20Sopenharmony_ci	TXPRINTK("%s: SCQ: next 0x%p\n", card->name, scq->next);
7118c2ecf20Sopenharmony_ci
7128c2ecf20Sopenharmony_ci	atomic_inc(&scq->used);
7138c2ecf20Sopenharmony_ci	entries = atomic_read(&scq->used);
7148c2ecf20Sopenharmony_ci	if (entries > (SCQ_ENTRIES - 1)) {
7158c2ecf20Sopenharmony_ci		atomic_dec(&scq->used);
7168c2ecf20Sopenharmony_ci		goto out;
7178c2ecf20Sopenharmony_ci	}
7188c2ecf20Sopenharmony_ci
7198c2ecf20Sopenharmony_ci	skb_queue_tail(&scq->transmit, skb);
7208c2ecf20Sopenharmony_ci
7218c2ecf20Sopenharmony_ci	spin_lock_irqsave(&vc->lock, flags);
7228c2ecf20Sopenharmony_ci	if (vc->estimator) {
7238c2ecf20Sopenharmony_ci		struct atm_vcc *vcc = vc->tx_vcc;
7248c2ecf20Sopenharmony_ci		struct sock *sk = sk_atm(vcc);
7258c2ecf20Sopenharmony_ci
7268c2ecf20Sopenharmony_ci		vc->estimator->cells += (skb->len + 47) / 48;
7278c2ecf20Sopenharmony_ci		if (refcount_read(&sk->sk_wmem_alloc) >
7288c2ecf20Sopenharmony_ci		    (sk->sk_sndbuf >> 1)) {
7298c2ecf20Sopenharmony_ci			u32 cps = vc->estimator->maxcps;
7308c2ecf20Sopenharmony_ci
7318c2ecf20Sopenharmony_ci			vc->estimator->cps = cps;
7328c2ecf20Sopenharmony_ci			vc->estimator->avcps = cps << 5;
7338c2ecf20Sopenharmony_ci			if (vc->lacr < vc->init_er) {
7348c2ecf20Sopenharmony_ci				vc->lacr = vc->init_er;
7358c2ecf20Sopenharmony_ci				writel(TCMDQ_LACR | (vc->lacr << 16) |
7368c2ecf20Sopenharmony_ci				       vc->index, SAR_REG_TCMDQ);
7378c2ecf20Sopenharmony_ci			}
7388c2ecf20Sopenharmony_ci		}
7398c2ecf20Sopenharmony_ci	}
7408c2ecf20Sopenharmony_ci	spin_unlock_irqrestore(&vc->lock, flags);
7418c2ecf20Sopenharmony_ci
7428c2ecf20Sopenharmony_ci	tbd = &IDT77252_PRV_TBD(skb);
7438c2ecf20Sopenharmony_ci
7448c2ecf20Sopenharmony_ci	spin_lock_irqsave(&scq->lock, flags);
7458c2ecf20Sopenharmony_ci	scq->next->word_1 = cpu_to_le32(tbd->word_1 |
7468c2ecf20Sopenharmony_ci					SAR_TBD_TSIF | SAR_TBD_GTSI);
7478c2ecf20Sopenharmony_ci	scq->next->word_2 = cpu_to_le32(tbd->word_2);
7488c2ecf20Sopenharmony_ci	scq->next->word_3 = cpu_to_le32(tbd->word_3);
7498c2ecf20Sopenharmony_ci	scq->next->word_4 = cpu_to_le32(tbd->word_4);
7508c2ecf20Sopenharmony_ci
7518c2ecf20Sopenharmony_ci	if (scq->next == scq->last)
7528c2ecf20Sopenharmony_ci		scq->next = scq->base;
7538c2ecf20Sopenharmony_ci	else
7548c2ecf20Sopenharmony_ci		scq->next++;
7558c2ecf20Sopenharmony_ci
7568c2ecf20Sopenharmony_ci	write_sram(card, scq->scd,
7578c2ecf20Sopenharmony_ci		   scq->paddr +
7588c2ecf20Sopenharmony_ci		   (u32)((unsigned long)scq->next - (unsigned long)scq->base));
7598c2ecf20Sopenharmony_ci	spin_unlock_irqrestore(&scq->lock, flags);
7608c2ecf20Sopenharmony_ci
7618c2ecf20Sopenharmony_ci	scq->trans_start = jiffies;
7628c2ecf20Sopenharmony_ci
7638c2ecf20Sopenharmony_ci	if (test_and_clear_bit(VCF_IDLE, &vc->flags)) {
7648c2ecf20Sopenharmony_ci		writel(TCMDQ_START_LACR | (vc->lacr << 16) | vc->index,
7658c2ecf20Sopenharmony_ci		       SAR_REG_TCMDQ);
7668c2ecf20Sopenharmony_ci	}
7678c2ecf20Sopenharmony_ci
7688c2ecf20Sopenharmony_ci	TXPRINTK("%d entries in SCQ used (push).\n", atomic_read(&scq->used));
7698c2ecf20Sopenharmony_ci
7708c2ecf20Sopenharmony_ci	XPRINTK("%s: SCQ (after push %2d) head = 0x%x, next = 0x%p.\n",
7718c2ecf20Sopenharmony_ci		card->name, atomic_read(&scq->used),
7728c2ecf20Sopenharmony_ci		read_sram(card, scq->scd + 1), scq->next);
7738c2ecf20Sopenharmony_ci
7748c2ecf20Sopenharmony_ci	return 0;
7758c2ecf20Sopenharmony_ci
7768c2ecf20Sopenharmony_ciout:
7778c2ecf20Sopenharmony_ci	if (time_after(jiffies, scq->trans_start + HZ)) {
7788c2ecf20Sopenharmony_ci		printk("%s: Error pushing TBD for %d.%d\n",
7798c2ecf20Sopenharmony_ci		       card->name, vc->tx_vcc->vpi, vc->tx_vcc->vci);
7808c2ecf20Sopenharmony_ci#ifdef CONFIG_ATM_IDT77252_DEBUG
7818c2ecf20Sopenharmony_ci		idt77252_tx_dump(card);
7828c2ecf20Sopenharmony_ci#endif
7838c2ecf20Sopenharmony_ci		scq->trans_start = jiffies;
7848c2ecf20Sopenharmony_ci	}
7858c2ecf20Sopenharmony_ci
7868c2ecf20Sopenharmony_ci	return -ENOBUFS;
7878c2ecf20Sopenharmony_ci}
7888c2ecf20Sopenharmony_ci
7898c2ecf20Sopenharmony_ci
7908c2ecf20Sopenharmony_cistatic void
7918c2ecf20Sopenharmony_cidrain_scq(struct idt77252_dev *card, struct vc_map *vc)
7928c2ecf20Sopenharmony_ci{
7938c2ecf20Sopenharmony_ci	struct scq_info *scq = vc->scq;
7948c2ecf20Sopenharmony_ci	struct sk_buff *skb;
7958c2ecf20Sopenharmony_ci	struct atm_vcc *vcc;
7968c2ecf20Sopenharmony_ci
7978c2ecf20Sopenharmony_ci	TXPRINTK("%s: SCQ (before drain %2d) next = 0x%p.\n",
7988c2ecf20Sopenharmony_ci		 card->name, atomic_read(&scq->used), scq->next);
7998c2ecf20Sopenharmony_ci
8008c2ecf20Sopenharmony_ci	skb = skb_dequeue(&scq->transmit);
8018c2ecf20Sopenharmony_ci	if (skb) {
8028c2ecf20Sopenharmony_ci		TXPRINTK("%s: freeing skb at %p.\n", card->name, skb);
8038c2ecf20Sopenharmony_ci
8048c2ecf20Sopenharmony_ci		dma_unmap_single(&card->pcidev->dev, IDT77252_PRV_PADDR(skb),
8058c2ecf20Sopenharmony_ci				 skb->len, DMA_TO_DEVICE);
8068c2ecf20Sopenharmony_ci
8078c2ecf20Sopenharmony_ci		vcc = ATM_SKB(skb)->vcc;
8088c2ecf20Sopenharmony_ci
8098c2ecf20Sopenharmony_ci		if (vcc->pop)
8108c2ecf20Sopenharmony_ci			vcc->pop(vcc, skb);
8118c2ecf20Sopenharmony_ci		else
8128c2ecf20Sopenharmony_ci			dev_kfree_skb(skb);
8138c2ecf20Sopenharmony_ci
8148c2ecf20Sopenharmony_ci		atomic_inc(&vcc->stats->tx);
8158c2ecf20Sopenharmony_ci	}
8168c2ecf20Sopenharmony_ci
8178c2ecf20Sopenharmony_ci	atomic_dec(&scq->used);
8188c2ecf20Sopenharmony_ci
8198c2ecf20Sopenharmony_ci	spin_lock(&scq->skblock);
8208c2ecf20Sopenharmony_ci	while ((skb = skb_dequeue(&scq->pending))) {
8218c2ecf20Sopenharmony_ci		if (push_on_scq(card, vc, skb)) {
8228c2ecf20Sopenharmony_ci			skb_queue_head(&vc->scq->pending, skb);
8238c2ecf20Sopenharmony_ci			break;
8248c2ecf20Sopenharmony_ci		}
8258c2ecf20Sopenharmony_ci	}
8268c2ecf20Sopenharmony_ci	spin_unlock(&scq->skblock);
8278c2ecf20Sopenharmony_ci}
8288c2ecf20Sopenharmony_ci
8298c2ecf20Sopenharmony_cistatic int
8308c2ecf20Sopenharmony_ciqueue_skb(struct idt77252_dev *card, struct vc_map *vc,
8318c2ecf20Sopenharmony_ci	  struct sk_buff *skb, int oam)
8328c2ecf20Sopenharmony_ci{
8338c2ecf20Sopenharmony_ci	struct atm_vcc *vcc;
8348c2ecf20Sopenharmony_ci	struct scqe *tbd;
8358c2ecf20Sopenharmony_ci	unsigned long flags;
8368c2ecf20Sopenharmony_ci	int error;
8378c2ecf20Sopenharmony_ci	int aal;
8388c2ecf20Sopenharmony_ci	u32 word4;
8398c2ecf20Sopenharmony_ci
8408c2ecf20Sopenharmony_ci	if (skb->len == 0) {
8418c2ecf20Sopenharmony_ci		printk("%s: invalid skb->len (%d)\n", card->name, skb->len);
8428c2ecf20Sopenharmony_ci		return -EINVAL;
8438c2ecf20Sopenharmony_ci	}
8448c2ecf20Sopenharmony_ci
8458c2ecf20Sopenharmony_ci	TXPRINTK("%s: Sending %d bytes of data.\n",
8468c2ecf20Sopenharmony_ci		 card->name, skb->len);
8478c2ecf20Sopenharmony_ci
8488c2ecf20Sopenharmony_ci	tbd = &IDT77252_PRV_TBD(skb);
8498c2ecf20Sopenharmony_ci	vcc = ATM_SKB(skb)->vcc;
8508c2ecf20Sopenharmony_ci	word4 = (skb->data[0] << 24) | (skb->data[1] << 16) |
8518c2ecf20Sopenharmony_ci			(skb->data[2] <<  8) | (skb->data[3] <<  0);
8528c2ecf20Sopenharmony_ci
8538c2ecf20Sopenharmony_ci	IDT77252_PRV_PADDR(skb) = dma_map_single(&card->pcidev->dev, skb->data,
8548c2ecf20Sopenharmony_ci						 skb->len, DMA_TO_DEVICE);
8558c2ecf20Sopenharmony_ci
8568c2ecf20Sopenharmony_ci	error = -EINVAL;
8578c2ecf20Sopenharmony_ci
8588c2ecf20Sopenharmony_ci	if (oam) {
8598c2ecf20Sopenharmony_ci		if (skb->len != 52)
8608c2ecf20Sopenharmony_ci			goto errout;
8618c2ecf20Sopenharmony_ci
8628c2ecf20Sopenharmony_ci		tbd->word_1 = SAR_TBD_OAM | ATM_CELL_PAYLOAD | SAR_TBD_EPDU;
8638c2ecf20Sopenharmony_ci		tbd->word_2 = IDT77252_PRV_PADDR(skb) + 4;
8648c2ecf20Sopenharmony_ci		tbd->word_3 = 0x00000000;
8658c2ecf20Sopenharmony_ci		tbd->word_4 = word4;
8668c2ecf20Sopenharmony_ci
8678c2ecf20Sopenharmony_ci		if (test_bit(VCF_RSV, &vc->flags))
8688c2ecf20Sopenharmony_ci			vc = card->vcs[0];
8698c2ecf20Sopenharmony_ci
8708c2ecf20Sopenharmony_ci		goto done;
8718c2ecf20Sopenharmony_ci	}
8728c2ecf20Sopenharmony_ci
8738c2ecf20Sopenharmony_ci	if (test_bit(VCF_RSV, &vc->flags)) {
8748c2ecf20Sopenharmony_ci		printk("%s: Trying to transmit on reserved VC\n", card->name);
8758c2ecf20Sopenharmony_ci		goto errout;
8768c2ecf20Sopenharmony_ci	}
8778c2ecf20Sopenharmony_ci
8788c2ecf20Sopenharmony_ci	aal = vcc->qos.aal;
8798c2ecf20Sopenharmony_ci
8808c2ecf20Sopenharmony_ci	switch (aal) {
8818c2ecf20Sopenharmony_ci	case ATM_AAL0:
8828c2ecf20Sopenharmony_ci	case ATM_AAL34:
8838c2ecf20Sopenharmony_ci		if (skb->len > 52)
8848c2ecf20Sopenharmony_ci			goto errout;
8858c2ecf20Sopenharmony_ci
8868c2ecf20Sopenharmony_ci		if (aal == ATM_AAL0)
8878c2ecf20Sopenharmony_ci			tbd->word_1 = SAR_TBD_EPDU | SAR_TBD_AAL0 |
8888c2ecf20Sopenharmony_ci				      ATM_CELL_PAYLOAD;
8898c2ecf20Sopenharmony_ci		else
8908c2ecf20Sopenharmony_ci			tbd->word_1 = SAR_TBD_EPDU | SAR_TBD_AAL34 |
8918c2ecf20Sopenharmony_ci				      ATM_CELL_PAYLOAD;
8928c2ecf20Sopenharmony_ci
8938c2ecf20Sopenharmony_ci		tbd->word_2 = IDT77252_PRV_PADDR(skb) + 4;
8948c2ecf20Sopenharmony_ci		tbd->word_3 = 0x00000000;
8958c2ecf20Sopenharmony_ci		tbd->word_4 = word4;
8968c2ecf20Sopenharmony_ci		break;
8978c2ecf20Sopenharmony_ci
8988c2ecf20Sopenharmony_ci	case ATM_AAL5:
8998c2ecf20Sopenharmony_ci		tbd->word_1 = SAR_TBD_EPDU | SAR_TBD_AAL5 | skb->len;
9008c2ecf20Sopenharmony_ci		tbd->word_2 = IDT77252_PRV_PADDR(skb);
9018c2ecf20Sopenharmony_ci		tbd->word_3 = skb->len;
9028c2ecf20Sopenharmony_ci		tbd->word_4 = (vcc->vpi << SAR_TBD_VPI_SHIFT) |
9038c2ecf20Sopenharmony_ci			      (vcc->vci << SAR_TBD_VCI_SHIFT);
9048c2ecf20Sopenharmony_ci		break;
9058c2ecf20Sopenharmony_ci
9068c2ecf20Sopenharmony_ci	case ATM_AAL1:
9078c2ecf20Sopenharmony_ci	case ATM_AAL2:
9088c2ecf20Sopenharmony_ci	default:
9098c2ecf20Sopenharmony_ci		printk("%s: Traffic type not supported.\n", card->name);
9108c2ecf20Sopenharmony_ci		error = -EPROTONOSUPPORT;
9118c2ecf20Sopenharmony_ci		goto errout;
9128c2ecf20Sopenharmony_ci	}
9138c2ecf20Sopenharmony_ci
9148c2ecf20Sopenharmony_cidone:
9158c2ecf20Sopenharmony_ci	spin_lock_irqsave(&vc->scq->skblock, flags);
9168c2ecf20Sopenharmony_ci	skb_queue_tail(&vc->scq->pending, skb);
9178c2ecf20Sopenharmony_ci
9188c2ecf20Sopenharmony_ci	while ((skb = skb_dequeue(&vc->scq->pending))) {
9198c2ecf20Sopenharmony_ci		if (push_on_scq(card, vc, skb)) {
9208c2ecf20Sopenharmony_ci			skb_queue_head(&vc->scq->pending, skb);
9218c2ecf20Sopenharmony_ci			break;
9228c2ecf20Sopenharmony_ci		}
9238c2ecf20Sopenharmony_ci	}
9248c2ecf20Sopenharmony_ci	spin_unlock_irqrestore(&vc->scq->skblock, flags);
9258c2ecf20Sopenharmony_ci
9268c2ecf20Sopenharmony_ci	return 0;
9278c2ecf20Sopenharmony_ci
9288c2ecf20Sopenharmony_cierrout:
9298c2ecf20Sopenharmony_ci	dma_unmap_single(&card->pcidev->dev, IDT77252_PRV_PADDR(skb),
9308c2ecf20Sopenharmony_ci			 skb->len, DMA_TO_DEVICE);
9318c2ecf20Sopenharmony_ci	return error;
9328c2ecf20Sopenharmony_ci}
9338c2ecf20Sopenharmony_ci
9348c2ecf20Sopenharmony_cistatic unsigned long
9358c2ecf20Sopenharmony_ciget_free_scd(struct idt77252_dev *card, struct vc_map *vc)
9368c2ecf20Sopenharmony_ci{
9378c2ecf20Sopenharmony_ci	int i;
9388c2ecf20Sopenharmony_ci
9398c2ecf20Sopenharmony_ci	for (i = 0; i < card->scd_size; i++) {
9408c2ecf20Sopenharmony_ci		if (!card->scd2vc[i]) {
9418c2ecf20Sopenharmony_ci			card->scd2vc[i] = vc;
9428c2ecf20Sopenharmony_ci			vc->scd_index = i;
9438c2ecf20Sopenharmony_ci			return card->scd_base + i * SAR_SRAM_SCD_SIZE;
9448c2ecf20Sopenharmony_ci		}
9458c2ecf20Sopenharmony_ci	}
9468c2ecf20Sopenharmony_ci	return 0;
9478c2ecf20Sopenharmony_ci}
9488c2ecf20Sopenharmony_ci
9498c2ecf20Sopenharmony_cistatic void
9508c2ecf20Sopenharmony_cifill_scd(struct idt77252_dev *card, struct scq_info *scq, int class)
9518c2ecf20Sopenharmony_ci{
9528c2ecf20Sopenharmony_ci	write_sram(card, scq->scd, scq->paddr);
9538c2ecf20Sopenharmony_ci	write_sram(card, scq->scd + 1, 0x00000000);
9548c2ecf20Sopenharmony_ci	write_sram(card, scq->scd + 2, 0xffffffff);
9558c2ecf20Sopenharmony_ci	write_sram(card, scq->scd + 3, 0x00000000);
9568c2ecf20Sopenharmony_ci}
9578c2ecf20Sopenharmony_ci
9588c2ecf20Sopenharmony_cistatic void
9598c2ecf20Sopenharmony_ciclear_scd(struct idt77252_dev *card, struct scq_info *scq, int class)
9608c2ecf20Sopenharmony_ci{
9618c2ecf20Sopenharmony_ci	return;
9628c2ecf20Sopenharmony_ci}
9638c2ecf20Sopenharmony_ci
9648c2ecf20Sopenharmony_ci/*****************************************************************************/
9658c2ecf20Sopenharmony_ci/*                                                                           */
9668c2ecf20Sopenharmony_ci/* RSQ Handling                                                              */
9678c2ecf20Sopenharmony_ci/*                                                                           */
9688c2ecf20Sopenharmony_ci/*****************************************************************************/
9698c2ecf20Sopenharmony_ci
9708c2ecf20Sopenharmony_cistatic int
9718c2ecf20Sopenharmony_ciinit_rsq(struct idt77252_dev *card)
9728c2ecf20Sopenharmony_ci{
9738c2ecf20Sopenharmony_ci	struct rsq_entry *rsqe;
9748c2ecf20Sopenharmony_ci
9758c2ecf20Sopenharmony_ci	card->rsq.base = dma_alloc_coherent(&card->pcidev->dev, RSQSIZE,
9768c2ecf20Sopenharmony_ci					    &card->rsq.paddr, GFP_KERNEL);
9778c2ecf20Sopenharmony_ci	if (card->rsq.base == NULL) {
9788c2ecf20Sopenharmony_ci		printk("%s: can't allocate RSQ.\n", card->name);
9798c2ecf20Sopenharmony_ci		return -1;
9808c2ecf20Sopenharmony_ci	}
9818c2ecf20Sopenharmony_ci
9828c2ecf20Sopenharmony_ci	card->rsq.last = card->rsq.base + RSQ_NUM_ENTRIES - 1;
9838c2ecf20Sopenharmony_ci	card->rsq.next = card->rsq.last;
9848c2ecf20Sopenharmony_ci	for (rsqe = card->rsq.base; rsqe <= card->rsq.last; rsqe++)
9858c2ecf20Sopenharmony_ci		rsqe->word_4 = 0;
9868c2ecf20Sopenharmony_ci
9878c2ecf20Sopenharmony_ci	writel((unsigned long) card->rsq.last - (unsigned long) card->rsq.base,
9888c2ecf20Sopenharmony_ci	       SAR_REG_RSQH);
9898c2ecf20Sopenharmony_ci	writel(card->rsq.paddr, SAR_REG_RSQB);
9908c2ecf20Sopenharmony_ci
9918c2ecf20Sopenharmony_ci	IPRINTK("%s: RSQ base at 0x%lx (0x%x).\n", card->name,
9928c2ecf20Sopenharmony_ci		(unsigned long) card->rsq.base,
9938c2ecf20Sopenharmony_ci		readl(SAR_REG_RSQB));
9948c2ecf20Sopenharmony_ci	IPRINTK("%s: RSQ head = 0x%x, base = 0x%x, tail = 0x%x.\n",
9958c2ecf20Sopenharmony_ci		card->name,
9968c2ecf20Sopenharmony_ci		readl(SAR_REG_RSQH),
9978c2ecf20Sopenharmony_ci		readl(SAR_REG_RSQB),
9988c2ecf20Sopenharmony_ci		readl(SAR_REG_RSQT));
9998c2ecf20Sopenharmony_ci
10008c2ecf20Sopenharmony_ci	return 0;
10018c2ecf20Sopenharmony_ci}
10028c2ecf20Sopenharmony_ci
10038c2ecf20Sopenharmony_cistatic void
10048c2ecf20Sopenharmony_cideinit_rsq(struct idt77252_dev *card)
10058c2ecf20Sopenharmony_ci{
10068c2ecf20Sopenharmony_ci	dma_free_coherent(&card->pcidev->dev, RSQSIZE,
10078c2ecf20Sopenharmony_ci			  card->rsq.base, card->rsq.paddr);
10088c2ecf20Sopenharmony_ci}
10098c2ecf20Sopenharmony_ci
10108c2ecf20Sopenharmony_cistatic void
10118c2ecf20Sopenharmony_cidequeue_rx(struct idt77252_dev *card, struct rsq_entry *rsqe)
10128c2ecf20Sopenharmony_ci{
10138c2ecf20Sopenharmony_ci	struct atm_vcc *vcc;
10148c2ecf20Sopenharmony_ci	struct sk_buff *skb;
10158c2ecf20Sopenharmony_ci	struct rx_pool *rpp;
10168c2ecf20Sopenharmony_ci	struct vc_map *vc;
10178c2ecf20Sopenharmony_ci	u32 header, vpi, vci;
10188c2ecf20Sopenharmony_ci	u32 stat;
10198c2ecf20Sopenharmony_ci	int i;
10208c2ecf20Sopenharmony_ci
10218c2ecf20Sopenharmony_ci	stat = le32_to_cpu(rsqe->word_4);
10228c2ecf20Sopenharmony_ci
10238c2ecf20Sopenharmony_ci	if (stat & SAR_RSQE_IDLE) {
10248c2ecf20Sopenharmony_ci		RXPRINTK("%s: message about inactive connection.\n",
10258c2ecf20Sopenharmony_ci			 card->name);
10268c2ecf20Sopenharmony_ci		return;
10278c2ecf20Sopenharmony_ci	}
10288c2ecf20Sopenharmony_ci
10298c2ecf20Sopenharmony_ci	skb = sb_pool_skb(card, le32_to_cpu(rsqe->word_2));
10308c2ecf20Sopenharmony_ci	if (skb == NULL) {
10318c2ecf20Sopenharmony_ci		printk("%s: NULL skb in %s, rsqe: %08x %08x %08x %08x\n",
10328c2ecf20Sopenharmony_ci		       card->name, __func__,
10338c2ecf20Sopenharmony_ci		       le32_to_cpu(rsqe->word_1), le32_to_cpu(rsqe->word_2),
10348c2ecf20Sopenharmony_ci		       le32_to_cpu(rsqe->word_3), le32_to_cpu(rsqe->word_4));
10358c2ecf20Sopenharmony_ci		return;
10368c2ecf20Sopenharmony_ci	}
10378c2ecf20Sopenharmony_ci
10388c2ecf20Sopenharmony_ci	header = le32_to_cpu(rsqe->word_1);
10398c2ecf20Sopenharmony_ci	vpi = (header >> 16) & 0x00ff;
10408c2ecf20Sopenharmony_ci	vci = (header >>  0) & 0xffff;
10418c2ecf20Sopenharmony_ci
10428c2ecf20Sopenharmony_ci	RXPRINTK("%s: SDU for %d.%d received in buffer 0x%p (data 0x%p).\n",
10438c2ecf20Sopenharmony_ci		 card->name, vpi, vci, skb, skb->data);
10448c2ecf20Sopenharmony_ci
10458c2ecf20Sopenharmony_ci	if ((vpi >= (1 << card->vpibits)) || (vci != (vci & card->vcimask))) {
10468c2ecf20Sopenharmony_ci		printk("%s: SDU received for out-of-range vc %u.%u\n",
10478c2ecf20Sopenharmony_ci		       card->name, vpi, vci);
10488c2ecf20Sopenharmony_ci		recycle_rx_skb(card, skb);
10498c2ecf20Sopenharmony_ci		return;
10508c2ecf20Sopenharmony_ci	}
10518c2ecf20Sopenharmony_ci
10528c2ecf20Sopenharmony_ci	vc = card->vcs[VPCI2VC(card, vpi, vci)];
10538c2ecf20Sopenharmony_ci	if (!vc || !test_bit(VCF_RX, &vc->flags)) {
10548c2ecf20Sopenharmony_ci		printk("%s: SDU received on non RX vc %u.%u\n",
10558c2ecf20Sopenharmony_ci		       card->name, vpi, vci);
10568c2ecf20Sopenharmony_ci		recycle_rx_skb(card, skb);
10578c2ecf20Sopenharmony_ci		return;
10588c2ecf20Sopenharmony_ci	}
10598c2ecf20Sopenharmony_ci
10608c2ecf20Sopenharmony_ci	vcc = vc->rx_vcc;
10618c2ecf20Sopenharmony_ci
10628c2ecf20Sopenharmony_ci	dma_sync_single_for_cpu(&card->pcidev->dev, IDT77252_PRV_PADDR(skb),
10638c2ecf20Sopenharmony_ci				skb_end_pointer(skb) - skb->data,
10648c2ecf20Sopenharmony_ci				DMA_FROM_DEVICE);
10658c2ecf20Sopenharmony_ci
10668c2ecf20Sopenharmony_ci	if ((vcc->qos.aal == ATM_AAL0) ||
10678c2ecf20Sopenharmony_ci	    (vcc->qos.aal == ATM_AAL34)) {
10688c2ecf20Sopenharmony_ci		struct sk_buff *sb;
10698c2ecf20Sopenharmony_ci		unsigned char *cell;
10708c2ecf20Sopenharmony_ci		u32 aal0;
10718c2ecf20Sopenharmony_ci
10728c2ecf20Sopenharmony_ci		cell = skb->data;
10738c2ecf20Sopenharmony_ci		for (i = (stat & SAR_RSQE_CELLCNT); i; i--) {
10748c2ecf20Sopenharmony_ci			if ((sb = dev_alloc_skb(64)) == NULL) {
10758c2ecf20Sopenharmony_ci				printk("%s: Can't allocate buffers for aal0.\n",
10768c2ecf20Sopenharmony_ci				       card->name);
10778c2ecf20Sopenharmony_ci				atomic_add(i, &vcc->stats->rx_drop);
10788c2ecf20Sopenharmony_ci				break;
10798c2ecf20Sopenharmony_ci			}
10808c2ecf20Sopenharmony_ci			if (!atm_charge(vcc, sb->truesize)) {
10818c2ecf20Sopenharmony_ci				RXPRINTK("%s: atm_charge() dropped aal0 packets.\n",
10828c2ecf20Sopenharmony_ci					 card->name);
10838c2ecf20Sopenharmony_ci				atomic_add(i - 1, &vcc->stats->rx_drop);
10848c2ecf20Sopenharmony_ci				dev_kfree_skb(sb);
10858c2ecf20Sopenharmony_ci				break;
10868c2ecf20Sopenharmony_ci			}
10878c2ecf20Sopenharmony_ci			aal0 = (vpi << ATM_HDR_VPI_SHIFT) |
10888c2ecf20Sopenharmony_ci			       (vci << ATM_HDR_VCI_SHIFT);
10898c2ecf20Sopenharmony_ci			aal0 |= (stat & SAR_RSQE_EPDU) ? 0x00000002 : 0;
10908c2ecf20Sopenharmony_ci			aal0 |= (stat & SAR_RSQE_CLP)  ? 0x00000001 : 0;
10918c2ecf20Sopenharmony_ci
10928c2ecf20Sopenharmony_ci			*((u32 *) sb->data) = aal0;
10938c2ecf20Sopenharmony_ci			skb_put(sb, sizeof(u32));
10948c2ecf20Sopenharmony_ci			skb_put_data(sb, cell, ATM_CELL_PAYLOAD);
10958c2ecf20Sopenharmony_ci
10968c2ecf20Sopenharmony_ci			ATM_SKB(sb)->vcc = vcc;
10978c2ecf20Sopenharmony_ci			__net_timestamp(sb);
10988c2ecf20Sopenharmony_ci			vcc->push(vcc, sb);
10998c2ecf20Sopenharmony_ci			atomic_inc(&vcc->stats->rx);
11008c2ecf20Sopenharmony_ci
11018c2ecf20Sopenharmony_ci			cell += ATM_CELL_PAYLOAD;
11028c2ecf20Sopenharmony_ci		}
11038c2ecf20Sopenharmony_ci
11048c2ecf20Sopenharmony_ci		recycle_rx_skb(card, skb);
11058c2ecf20Sopenharmony_ci		return;
11068c2ecf20Sopenharmony_ci	}
11078c2ecf20Sopenharmony_ci	if (vcc->qos.aal != ATM_AAL5) {
11088c2ecf20Sopenharmony_ci		printk("%s: Unexpected AAL type in dequeue_rx(): %d.\n",
11098c2ecf20Sopenharmony_ci		       card->name, vcc->qos.aal);
11108c2ecf20Sopenharmony_ci		recycle_rx_skb(card, skb);
11118c2ecf20Sopenharmony_ci		return;
11128c2ecf20Sopenharmony_ci	}
11138c2ecf20Sopenharmony_ci	skb->len = (stat & SAR_RSQE_CELLCNT) * ATM_CELL_PAYLOAD;
11148c2ecf20Sopenharmony_ci
11158c2ecf20Sopenharmony_ci	rpp = &vc->rcv.rx_pool;
11168c2ecf20Sopenharmony_ci
11178c2ecf20Sopenharmony_ci	__skb_queue_tail(&rpp->queue, skb);
11188c2ecf20Sopenharmony_ci	rpp->len += skb->len;
11198c2ecf20Sopenharmony_ci
11208c2ecf20Sopenharmony_ci	if (stat & SAR_RSQE_EPDU) {
11218c2ecf20Sopenharmony_ci		unsigned int len, truesize;
11228c2ecf20Sopenharmony_ci		unsigned char *l1l2;
11238c2ecf20Sopenharmony_ci
11248c2ecf20Sopenharmony_ci		l1l2 = (unsigned char *) ((unsigned long) skb->data + skb->len - 6);
11258c2ecf20Sopenharmony_ci
11268c2ecf20Sopenharmony_ci		len = (l1l2[0] << 8) | l1l2[1];
11278c2ecf20Sopenharmony_ci		len = len ? len : 0x10000;
11288c2ecf20Sopenharmony_ci
11298c2ecf20Sopenharmony_ci		RXPRINTK("%s: PDU has %d bytes.\n", card->name, len);
11308c2ecf20Sopenharmony_ci
11318c2ecf20Sopenharmony_ci		if ((len + 8 > rpp->len) || (len + (47 + 8) < rpp->len)) {
11328c2ecf20Sopenharmony_ci			RXPRINTK("%s: AAL5 PDU size mismatch: %d != %d. "
11338c2ecf20Sopenharmony_ci			         "(CDC: %08x)\n",
11348c2ecf20Sopenharmony_ci			         card->name, len, rpp->len, readl(SAR_REG_CDC));
11358c2ecf20Sopenharmony_ci			recycle_rx_pool_skb(card, rpp);
11368c2ecf20Sopenharmony_ci			atomic_inc(&vcc->stats->rx_err);
11378c2ecf20Sopenharmony_ci			return;
11388c2ecf20Sopenharmony_ci		}
11398c2ecf20Sopenharmony_ci		if (stat & SAR_RSQE_CRC) {
11408c2ecf20Sopenharmony_ci			RXPRINTK("%s: AAL5 CRC error.\n", card->name);
11418c2ecf20Sopenharmony_ci			recycle_rx_pool_skb(card, rpp);
11428c2ecf20Sopenharmony_ci			atomic_inc(&vcc->stats->rx_err);
11438c2ecf20Sopenharmony_ci			return;
11448c2ecf20Sopenharmony_ci		}
11458c2ecf20Sopenharmony_ci		if (skb_queue_len(&rpp->queue) > 1) {
11468c2ecf20Sopenharmony_ci			struct sk_buff *sb;
11478c2ecf20Sopenharmony_ci
11488c2ecf20Sopenharmony_ci			skb = dev_alloc_skb(rpp->len);
11498c2ecf20Sopenharmony_ci			if (!skb) {
11508c2ecf20Sopenharmony_ci				RXPRINTK("%s: Can't alloc RX skb.\n",
11518c2ecf20Sopenharmony_ci					 card->name);
11528c2ecf20Sopenharmony_ci				recycle_rx_pool_skb(card, rpp);
11538c2ecf20Sopenharmony_ci				atomic_inc(&vcc->stats->rx_err);
11548c2ecf20Sopenharmony_ci				return;
11558c2ecf20Sopenharmony_ci			}
11568c2ecf20Sopenharmony_ci			if (!atm_charge(vcc, skb->truesize)) {
11578c2ecf20Sopenharmony_ci				recycle_rx_pool_skb(card, rpp);
11588c2ecf20Sopenharmony_ci				dev_kfree_skb(skb);
11598c2ecf20Sopenharmony_ci				return;
11608c2ecf20Sopenharmony_ci			}
11618c2ecf20Sopenharmony_ci			skb_queue_walk(&rpp->queue, sb)
11628c2ecf20Sopenharmony_ci				skb_put_data(skb, sb->data, sb->len);
11638c2ecf20Sopenharmony_ci
11648c2ecf20Sopenharmony_ci			recycle_rx_pool_skb(card, rpp);
11658c2ecf20Sopenharmony_ci
11668c2ecf20Sopenharmony_ci			skb_trim(skb, len);
11678c2ecf20Sopenharmony_ci			ATM_SKB(skb)->vcc = vcc;
11688c2ecf20Sopenharmony_ci			__net_timestamp(skb);
11698c2ecf20Sopenharmony_ci
11708c2ecf20Sopenharmony_ci			vcc->push(vcc, skb);
11718c2ecf20Sopenharmony_ci			atomic_inc(&vcc->stats->rx);
11728c2ecf20Sopenharmony_ci
11738c2ecf20Sopenharmony_ci			return;
11748c2ecf20Sopenharmony_ci		}
11758c2ecf20Sopenharmony_ci
11768c2ecf20Sopenharmony_ci		flush_rx_pool(card, rpp);
11778c2ecf20Sopenharmony_ci
11788c2ecf20Sopenharmony_ci		if (!atm_charge(vcc, skb->truesize)) {
11798c2ecf20Sopenharmony_ci			recycle_rx_skb(card, skb);
11808c2ecf20Sopenharmony_ci			return;
11818c2ecf20Sopenharmony_ci		}
11828c2ecf20Sopenharmony_ci
11838c2ecf20Sopenharmony_ci		dma_unmap_single(&card->pcidev->dev, IDT77252_PRV_PADDR(skb),
11848c2ecf20Sopenharmony_ci				 skb_end_pointer(skb) - skb->data,
11858c2ecf20Sopenharmony_ci				 DMA_FROM_DEVICE);
11868c2ecf20Sopenharmony_ci		sb_pool_remove(card, skb);
11878c2ecf20Sopenharmony_ci
11888c2ecf20Sopenharmony_ci		skb_trim(skb, len);
11898c2ecf20Sopenharmony_ci		ATM_SKB(skb)->vcc = vcc;
11908c2ecf20Sopenharmony_ci		__net_timestamp(skb);
11918c2ecf20Sopenharmony_ci
11928c2ecf20Sopenharmony_ci		truesize = skb->truesize;
11938c2ecf20Sopenharmony_ci		vcc->push(vcc, skb);
11948c2ecf20Sopenharmony_ci		atomic_inc(&vcc->stats->rx);
11958c2ecf20Sopenharmony_ci
11968c2ecf20Sopenharmony_ci		if (truesize > SAR_FB_SIZE_3)
11978c2ecf20Sopenharmony_ci			add_rx_skb(card, 3, SAR_FB_SIZE_3, 1);
11988c2ecf20Sopenharmony_ci		else if (truesize > SAR_FB_SIZE_2)
11998c2ecf20Sopenharmony_ci			add_rx_skb(card, 2, SAR_FB_SIZE_2, 1);
12008c2ecf20Sopenharmony_ci		else if (truesize > SAR_FB_SIZE_1)
12018c2ecf20Sopenharmony_ci			add_rx_skb(card, 1, SAR_FB_SIZE_1, 1);
12028c2ecf20Sopenharmony_ci		else
12038c2ecf20Sopenharmony_ci			add_rx_skb(card, 0, SAR_FB_SIZE_0, 1);
12048c2ecf20Sopenharmony_ci		return;
12058c2ecf20Sopenharmony_ci	}
12068c2ecf20Sopenharmony_ci}
12078c2ecf20Sopenharmony_ci
12088c2ecf20Sopenharmony_cistatic void
12098c2ecf20Sopenharmony_ciidt77252_rx(struct idt77252_dev *card)
12108c2ecf20Sopenharmony_ci{
12118c2ecf20Sopenharmony_ci	struct rsq_entry *rsqe;
12128c2ecf20Sopenharmony_ci
12138c2ecf20Sopenharmony_ci	if (card->rsq.next == card->rsq.last)
12148c2ecf20Sopenharmony_ci		rsqe = card->rsq.base;
12158c2ecf20Sopenharmony_ci	else
12168c2ecf20Sopenharmony_ci		rsqe = card->rsq.next + 1;
12178c2ecf20Sopenharmony_ci
12188c2ecf20Sopenharmony_ci	if (!(le32_to_cpu(rsqe->word_4) & SAR_RSQE_VALID)) {
12198c2ecf20Sopenharmony_ci		RXPRINTK("%s: no entry in RSQ.\n", card->name);
12208c2ecf20Sopenharmony_ci		return;
12218c2ecf20Sopenharmony_ci	}
12228c2ecf20Sopenharmony_ci
12238c2ecf20Sopenharmony_ci	do {
12248c2ecf20Sopenharmony_ci		dequeue_rx(card, rsqe);
12258c2ecf20Sopenharmony_ci		rsqe->word_4 = 0;
12268c2ecf20Sopenharmony_ci		card->rsq.next = rsqe;
12278c2ecf20Sopenharmony_ci		if (card->rsq.next == card->rsq.last)
12288c2ecf20Sopenharmony_ci			rsqe = card->rsq.base;
12298c2ecf20Sopenharmony_ci		else
12308c2ecf20Sopenharmony_ci			rsqe = card->rsq.next + 1;
12318c2ecf20Sopenharmony_ci	} while (le32_to_cpu(rsqe->word_4) & SAR_RSQE_VALID);
12328c2ecf20Sopenharmony_ci
12338c2ecf20Sopenharmony_ci	writel((unsigned long) card->rsq.next - (unsigned long) card->rsq.base,
12348c2ecf20Sopenharmony_ci	       SAR_REG_RSQH);
12358c2ecf20Sopenharmony_ci}
12368c2ecf20Sopenharmony_ci
12378c2ecf20Sopenharmony_cistatic void
12388c2ecf20Sopenharmony_ciidt77252_rx_raw(struct idt77252_dev *card)
12398c2ecf20Sopenharmony_ci{
12408c2ecf20Sopenharmony_ci	struct sk_buff	*queue;
12418c2ecf20Sopenharmony_ci	u32		head, tail;
12428c2ecf20Sopenharmony_ci	struct atm_vcc	*vcc;
12438c2ecf20Sopenharmony_ci	struct vc_map	*vc;
12448c2ecf20Sopenharmony_ci	struct sk_buff	*sb;
12458c2ecf20Sopenharmony_ci
12468c2ecf20Sopenharmony_ci	if (card->raw_cell_head == NULL) {
12478c2ecf20Sopenharmony_ci		u32 handle = le32_to_cpu(*(card->raw_cell_hnd + 1));
12488c2ecf20Sopenharmony_ci		card->raw_cell_head = sb_pool_skb(card, handle);
12498c2ecf20Sopenharmony_ci	}
12508c2ecf20Sopenharmony_ci
12518c2ecf20Sopenharmony_ci	queue = card->raw_cell_head;
12528c2ecf20Sopenharmony_ci	if (!queue)
12538c2ecf20Sopenharmony_ci		return;
12548c2ecf20Sopenharmony_ci
12558c2ecf20Sopenharmony_ci	head = IDT77252_PRV_PADDR(queue) + (queue->data - queue->head - 16);
12568c2ecf20Sopenharmony_ci	tail = readl(SAR_REG_RAWCT);
12578c2ecf20Sopenharmony_ci
12588c2ecf20Sopenharmony_ci	dma_sync_single_for_cpu(&card->pcidev->dev, IDT77252_PRV_PADDR(queue),
12598c2ecf20Sopenharmony_ci				skb_end_offset(queue) - 16,
12608c2ecf20Sopenharmony_ci				DMA_FROM_DEVICE);
12618c2ecf20Sopenharmony_ci
12628c2ecf20Sopenharmony_ci	while (head != tail) {
12638c2ecf20Sopenharmony_ci		unsigned int vpi, vci;
12648c2ecf20Sopenharmony_ci		u32 header;
12658c2ecf20Sopenharmony_ci
12668c2ecf20Sopenharmony_ci		header = le32_to_cpu(*(u32 *) &queue->data[0]);
12678c2ecf20Sopenharmony_ci
12688c2ecf20Sopenharmony_ci		vpi = (header & ATM_HDR_VPI_MASK) >> ATM_HDR_VPI_SHIFT;
12698c2ecf20Sopenharmony_ci		vci = (header & ATM_HDR_VCI_MASK) >> ATM_HDR_VCI_SHIFT;
12708c2ecf20Sopenharmony_ci
12718c2ecf20Sopenharmony_ci#ifdef CONFIG_ATM_IDT77252_DEBUG
12728c2ecf20Sopenharmony_ci		if (debug & DBG_RAW_CELL) {
12738c2ecf20Sopenharmony_ci			int i;
12748c2ecf20Sopenharmony_ci
12758c2ecf20Sopenharmony_ci			printk("%s: raw cell %x.%02x.%04x.%x.%x\n",
12768c2ecf20Sopenharmony_ci			       card->name, (header >> 28) & 0x000f,
12778c2ecf20Sopenharmony_ci			       (header >> 20) & 0x00ff,
12788c2ecf20Sopenharmony_ci			       (header >>  4) & 0xffff,
12798c2ecf20Sopenharmony_ci			       (header >>  1) & 0x0007,
12808c2ecf20Sopenharmony_ci			       (header >>  0) & 0x0001);
12818c2ecf20Sopenharmony_ci			for (i = 16; i < 64; i++)
12828c2ecf20Sopenharmony_ci				printk(" %02x", queue->data[i]);
12838c2ecf20Sopenharmony_ci			printk("\n");
12848c2ecf20Sopenharmony_ci		}
12858c2ecf20Sopenharmony_ci#endif
12868c2ecf20Sopenharmony_ci
12878c2ecf20Sopenharmony_ci		if (vpi >= (1<<card->vpibits) || vci >= (1<<card->vcibits)) {
12888c2ecf20Sopenharmony_ci			RPRINTK("%s: SDU received for out-of-range vc %u.%u\n",
12898c2ecf20Sopenharmony_ci				card->name, vpi, vci);
12908c2ecf20Sopenharmony_ci			goto drop;
12918c2ecf20Sopenharmony_ci		}
12928c2ecf20Sopenharmony_ci
12938c2ecf20Sopenharmony_ci		vc = card->vcs[VPCI2VC(card, vpi, vci)];
12948c2ecf20Sopenharmony_ci		if (!vc || !test_bit(VCF_RX, &vc->flags)) {
12958c2ecf20Sopenharmony_ci			RPRINTK("%s: SDU received on non RX vc %u.%u\n",
12968c2ecf20Sopenharmony_ci				card->name, vpi, vci);
12978c2ecf20Sopenharmony_ci			goto drop;
12988c2ecf20Sopenharmony_ci		}
12998c2ecf20Sopenharmony_ci
13008c2ecf20Sopenharmony_ci		vcc = vc->rx_vcc;
13018c2ecf20Sopenharmony_ci
13028c2ecf20Sopenharmony_ci		if (vcc->qos.aal != ATM_AAL0) {
13038c2ecf20Sopenharmony_ci			RPRINTK("%s: raw cell for non AAL0 vc %u.%u\n",
13048c2ecf20Sopenharmony_ci				card->name, vpi, vci);
13058c2ecf20Sopenharmony_ci			atomic_inc(&vcc->stats->rx_drop);
13068c2ecf20Sopenharmony_ci			goto drop;
13078c2ecf20Sopenharmony_ci		}
13088c2ecf20Sopenharmony_ci
13098c2ecf20Sopenharmony_ci		if ((sb = dev_alloc_skb(64)) == NULL) {
13108c2ecf20Sopenharmony_ci			printk("%s: Can't allocate buffers for AAL0.\n",
13118c2ecf20Sopenharmony_ci			       card->name);
13128c2ecf20Sopenharmony_ci			atomic_inc(&vcc->stats->rx_err);
13138c2ecf20Sopenharmony_ci			goto drop;
13148c2ecf20Sopenharmony_ci		}
13158c2ecf20Sopenharmony_ci
13168c2ecf20Sopenharmony_ci		if (!atm_charge(vcc, sb->truesize)) {
13178c2ecf20Sopenharmony_ci			RXPRINTK("%s: atm_charge() dropped AAL0 packets.\n",
13188c2ecf20Sopenharmony_ci				 card->name);
13198c2ecf20Sopenharmony_ci			dev_kfree_skb(sb);
13208c2ecf20Sopenharmony_ci			goto drop;
13218c2ecf20Sopenharmony_ci		}
13228c2ecf20Sopenharmony_ci
13238c2ecf20Sopenharmony_ci		*((u32 *) sb->data) = header;
13248c2ecf20Sopenharmony_ci		skb_put(sb, sizeof(u32));
13258c2ecf20Sopenharmony_ci		skb_put_data(sb, &(queue->data[16]), ATM_CELL_PAYLOAD);
13268c2ecf20Sopenharmony_ci
13278c2ecf20Sopenharmony_ci		ATM_SKB(sb)->vcc = vcc;
13288c2ecf20Sopenharmony_ci		__net_timestamp(sb);
13298c2ecf20Sopenharmony_ci		vcc->push(vcc, sb);
13308c2ecf20Sopenharmony_ci		atomic_inc(&vcc->stats->rx);
13318c2ecf20Sopenharmony_ci
13328c2ecf20Sopenharmony_cidrop:
13338c2ecf20Sopenharmony_ci		skb_pull(queue, 64);
13348c2ecf20Sopenharmony_ci
13358c2ecf20Sopenharmony_ci		head = IDT77252_PRV_PADDR(queue)
13368c2ecf20Sopenharmony_ci					+ (queue->data - queue->head - 16);
13378c2ecf20Sopenharmony_ci
13388c2ecf20Sopenharmony_ci		if (queue->len < 128) {
13398c2ecf20Sopenharmony_ci			struct sk_buff *next;
13408c2ecf20Sopenharmony_ci			u32 handle;
13418c2ecf20Sopenharmony_ci
13428c2ecf20Sopenharmony_ci			head = le32_to_cpu(*(u32 *) &queue->data[0]);
13438c2ecf20Sopenharmony_ci			handle = le32_to_cpu(*(u32 *) &queue->data[4]);
13448c2ecf20Sopenharmony_ci
13458c2ecf20Sopenharmony_ci			next = sb_pool_skb(card, handle);
13468c2ecf20Sopenharmony_ci			recycle_rx_skb(card, queue);
13478c2ecf20Sopenharmony_ci
13488c2ecf20Sopenharmony_ci			if (next) {
13498c2ecf20Sopenharmony_ci				card->raw_cell_head = next;
13508c2ecf20Sopenharmony_ci				queue = card->raw_cell_head;
13518c2ecf20Sopenharmony_ci				dma_sync_single_for_cpu(&card->pcidev->dev,
13528c2ecf20Sopenharmony_ci							IDT77252_PRV_PADDR(queue),
13538c2ecf20Sopenharmony_ci							(skb_end_pointer(queue) -
13548c2ecf20Sopenharmony_ci							 queue->data),
13558c2ecf20Sopenharmony_ci							DMA_FROM_DEVICE);
13568c2ecf20Sopenharmony_ci			} else {
13578c2ecf20Sopenharmony_ci				card->raw_cell_head = NULL;
13588c2ecf20Sopenharmony_ci				printk("%s: raw cell queue overrun\n",
13598c2ecf20Sopenharmony_ci				       card->name);
13608c2ecf20Sopenharmony_ci				break;
13618c2ecf20Sopenharmony_ci			}
13628c2ecf20Sopenharmony_ci		}
13638c2ecf20Sopenharmony_ci	}
13648c2ecf20Sopenharmony_ci}
13658c2ecf20Sopenharmony_ci
13668c2ecf20Sopenharmony_ci
13678c2ecf20Sopenharmony_ci/*****************************************************************************/
13688c2ecf20Sopenharmony_ci/*                                                                           */
13698c2ecf20Sopenharmony_ci/* TSQ Handling                                                              */
13708c2ecf20Sopenharmony_ci/*                                                                           */
13718c2ecf20Sopenharmony_ci/*****************************************************************************/
13728c2ecf20Sopenharmony_ci
13738c2ecf20Sopenharmony_cistatic int
13748c2ecf20Sopenharmony_ciinit_tsq(struct idt77252_dev *card)
13758c2ecf20Sopenharmony_ci{
13768c2ecf20Sopenharmony_ci	struct tsq_entry *tsqe;
13778c2ecf20Sopenharmony_ci
13788c2ecf20Sopenharmony_ci	card->tsq.base = dma_alloc_coherent(&card->pcidev->dev, RSQSIZE,
13798c2ecf20Sopenharmony_ci					    &card->tsq.paddr, GFP_KERNEL);
13808c2ecf20Sopenharmony_ci	if (card->tsq.base == NULL) {
13818c2ecf20Sopenharmony_ci		printk("%s: can't allocate TSQ.\n", card->name);
13828c2ecf20Sopenharmony_ci		return -1;
13838c2ecf20Sopenharmony_ci	}
13848c2ecf20Sopenharmony_ci
13858c2ecf20Sopenharmony_ci	card->tsq.last = card->tsq.base + TSQ_NUM_ENTRIES - 1;
13868c2ecf20Sopenharmony_ci	card->tsq.next = card->tsq.last;
13878c2ecf20Sopenharmony_ci	for (tsqe = card->tsq.base; tsqe <= card->tsq.last; tsqe++)
13888c2ecf20Sopenharmony_ci		tsqe->word_2 = cpu_to_le32(SAR_TSQE_INVALID);
13898c2ecf20Sopenharmony_ci
13908c2ecf20Sopenharmony_ci	writel(card->tsq.paddr, SAR_REG_TSQB);
13918c2ecf20Sopenharmony_ci	writel((unsigned long) card->tsq.next - (unsigned long) card->tsq.base,
13928c2ecf20Sopenharmony_ci	       SAR_REG_TSQH);
13938c2ecf20Sopenharmony_ci
13948c2ecf20Sopenharmony_ci	return 0;
13958c2ecf20Sopenharmony_ci}
13968c2ecf20Sopenharmony_ci
13978c2ecf20Sopenharmony_cistatic void
13988c2ecf20Sopenharmony_cideinit_tsq(struct idt77252_dev *card)
13998c2ecf20Sopenharmony_ci{
14008c2ecf20Sopenharmony_ci	dma_free_coherent(&card->pcidev->dev, TSQSIZE,
14018c2ecf20Sopenharmony_ci			  card->tsq.base, card->tsq.paddr);
14028c2ecf20Sopenharmony_ci}
14038c2ecf20Sopenharmony_ci
14048c2ecf20Sopenharmony_cistatic void
14058c2ecf20Sopenharmony_ciidt77252_tx(struct idt77252_dev *card)
14068c2ecf20Sopenharmony_ci{
14078c2ecf20Sopenharmony_ci	struct tsq_entry *tsqe;
14088c2ecf20Sopenharmony_ci	unsigned int vpi, vci;
14098c2ecf20Sopenharmony_ci	struct vc_map *vc;
14108c2ecf20Sopenharmony_ci	u32 conn, stat;
14118c2ecf20Sopenharmony_ci
14128c2ecf20Sopenharmony_ci	if (card->tsq.next == card->tsq.last)
14138c2ecf20Sopenharmony_ci		tsqe = card->tsq.base;
14148c2ecf20Sopenharmony_ci	else
14158c2ecf20Sopenharmony_ci		tsqe = card->tsq.next + 1;
14168c2ecf20Sopenharmony_ci
14178c2ecf20Sopenharmony_ci	TXPRINTK("idt77252_tx: tsq  %p: base %p, next %p, last %p\n", tsqe,
14188c2ecf20Sopenharmony_ci		 card->tsq.base, card->tsq.next, card->tsq.last);
14198c2ecf20Sopenharmony_ci	TXPRINTK("idt77252_tx: tsqb %08x, tsqt %08x, tsqh %08x, \n",
14208c2ecf20Sopenharmony_ci		 readl(SAR_REG_TSQB),
14218c2ecf20Sopenharmony_ci		 readl(SAR_REG_TSQT),
14228c2ecf20Sopenharmony_ci		 readl(SAR_REG_TSQH));
14238c2ecf20Sopenharmony_ci
14248c2ecf20Sopenharmony_ci	stat = le32_to_cpu(tsqe->word_2);
14258c2ecf20Sopenharmony_ci
14268c2ecf20Sopenharmony_ci	if (stat & SAR_TSQE_INVALID)
14278c2ecf20Sopenharmony_ci		return;
14288c2ecf20Sopenharmony_ci
14298c2ecf20Sopenharmony_ci	do {
14308c2ecf20Sopenharmony_ci		TXPRINTK("tsqe: 0x%p [0x%08x 0x%08x]\n", tsqe,
14318c2ecf20Sopenharmony_ci			 le32_to_cpu(tsqe->word_1),
14328c2ecf20Sopenharmony_ci			 le32_to_cpu(tsqe->word_2));
14338c2ecf20Sopenharmony_ci
14348c2ecf20Sopenharmony_ci		switch (stat & SAR_TSQE_TYPE) {
14358c2ecf20Sopenharmony_ci		case SAR_TSQE_TYPE_TIMER:
14368c2ecf20Sopenharmony_ci			TXPRINTK("%s: Timer RollOver detected.\n", card->name);
14378c2ecf20Sopenharmony_ci			break;
14388c2ecf20Sopenharmony_ci
14398c2ecf20Sopenharmony_ci		case SAR_TSQE_TYPE_IDLE:
14408c2ecf20Sopenharmony_ci
14418c2ecf20Sopenharmony_ci			conn = le32_to_cpu(tsqe->word_1);
14428c2ecf20Sopenharmony_ci
14438c2ecf20Sopenharmony_ci			if (SAR_TSQE_TAG(stat) == 0x10) {
14448c2ecf20Sopenharmony_ci#ifdef	NOTDEF
14458c2ecf20Sopenharmony_ci				printk("%s: Connection %d halted.\n",
14468c2ecf20Sopenharmony_ci				       card->name,
14478c2ecf20Sopenharmony_ci				       le32_to_cpu(tsqe->word_1) & 0x1fff);
14488c2ecf20Sopenharmony_ci#endif
14498c2ecf20Sopenharmony_ci				break;
14508c2ecf20Sopenharmony_ci			}
14518c2ecf20Sopenharmony_ci
14528c2ecf20Sopenharmony_ci			vc = card->vcs[conn & 0x1fff];
14538c2ecf20Sopenharmony_ci			if (!vc) {
14548c2ecf20Sopenharmony_ci				printk("%s: could not find VC from conn %d\n",
14558c2ecf20Sopenharmony_ci				       card->name, conn & 0x1fff);
14568c2ecf20Sopenharmony_ci				break;
14578c2ecf20Sopenharmony_ci			}
14588c2ecf20Sopenharmony_ci
14598c2ecf20Sopenharmony_ci			printk("%s: Connection %d IDLE.\n",
14608c2ecf20Sopenharmony_ci			       card->name, vc->index);
14618c2ecf20Sopenharmony_ci
14628c2ecf20Sopenharmony_ci			set_bit(VCF_IDLE, &vc->flags);
14638c2ecf20Sopenharmony_ci			break;
14648c2ecf20Sopenharmony_ci
14658c2ecf20Sopenharmony_ci		case SAR_TSQE_TYPE_TSR:
14668c2ecf20Sopenharmony_ci
14678c2ecf20Sopenharmony_ci			conn = le32_to_cpu(tsqe->word_1);
14688c2ecf20Sopenharmony_ci
14698c2ecf20Sopenharmony_ci			vc = card->vcs[conn & 0x1fff];
14708c2ecf20Sopenharmony_ci			if (!vc) {
14718c2ecf20Sopenharmony_ci				printk("%s: no VC at index %d\n",
14728c2ecf20Sopenharmony_ci				       card->name,
14738c2ecf20Sopenharmony_ci				       le32_to_cpu(tsqe->word_1) & 0x1fff);
14748c2ecf20Sopenharmony_ci				break;
14758c2ecf20Sopenharmony_ci			}
14768c2ecf20Sopenharmony_ci
14778c2ecf20Sopenharmony_ci			drain_scq(card, vc);
14788c2ecf20Sopenharmony_ci			break;
14798c2ecf20Sopenharmony_ci
14808c2ecf20Sopenharmony_ci		case SAR_TSQE_TYPE_TBD_COMP:
14818c2ecf20Sopenharmony_ci
14828c2ecf20Sopenharmony_ci			conn = le32_to_cpu(tsqe->word_1);
14838c2ecf20Sopenharmony_ci
14848c2ecf20Sopenharmony_ci			vpi = (conn >> SAR_TBD_VPI_SHIFT) & 0x00ff;
14858c2ecf20Sopenharmony_ci			vci = (conn >> SAR_TBD_VCI_SHIFT) & 0xffff;
14868c2ecf20Sopenharmony_ci
14878c2ecf20Sopenharmony_ci			if (vpi >= (1 << card->vpibits) ||
14888c2ecf20Sopenharmony_ci			    vci >= (1 << card->vcibits)) {
14898c2ecf20Sopenharmony_ci				printk("%s: TBD complete: "
14908c2ecf20Sopenharmony_ci				       "out of range VPI.VCI %u.%u\n",
14918c2ecf20Sopenharmony_ci				       card->name, vpi, vci);
14928c2ecf20Sopenharmony_ci				break;
14938c2ecf20Sopenharmony_ci			}
14948c2ecf20Sopenharmony_ci
14958c2ecf20Sopenharmony_ci			vc = card->vcs[VPCI2VC(card, vpi, vci)];
14968c2ecf20Sopenharmony_ci			if (!vc) {
14978c2ecf20Sopenharmony_ci				printk("%s: TBD complete: "
14988c2ecf20Sopenharmony_ci				       "no VC at VPI.VCI %u.%u\n",
14998c2ecf20Sopenharmony_ci				       card->name, vpi, vci);
15008c2ecf20Sopenharmony_ci				break;
15018c2ecf20Sopenharmony_ci			}
15028c2ecf20Sopenharmony_ci
15038c2ecf20Sopenharmony_ci			drain_scq(card, vc);
15048c2ecf20Sopenharmony_ci			break;
15058c2ecf20Sopenharmony_ci		}
15068c2ecf20Sopenharmony_ci
15078c2ecf20Sopenharmony_ci		tsqe->word_2 = cpu_to_le32(SAR_TSQE_INVALID);
15088c2ecf20Sopenharmony_ci
15098c2ecf20Sopenharmony_ci		card->tsq.next = tsqe;
15108c2ecf20Sopenharmony_ci		if (card->tsq.next == card->tsq.last)
15118c2ecf20Sopenharmony_ci			tsqe = card->tsq.base;
15128c2ecf20Sopenharmony_ci		else
15138c2ecf20Sopenharmony_ci			tsqe = card->tsq.next + 1;
15148c2ecf20Sopenharmony_ci
15158c2ecf20Sopenharmony_ci		TXPRINTK("tsqe: %p: base %p, next %p, last %p\n", tsqe,
15168c2ecf20Sopenharmony_ci			 card->tsq.base, card->tsq.next, card->tsq.last);
15178c2ecf20Sopenharmony_ci
15188c2ecf20Sopenharmony_ci		stat = le32_to_cpu(tsqe->word_2);
15198c2ecf20Sopenharmony_ci
15208c2ecf20Sopenharmony_ci	} while (!(stat & SAR_TSQE_INVALID));
15218c2ecf20Sopenharmony_ci
15228c2ecf20Sopenharmony_ci	writel((unsigned long)card->tsq.next - (unsigned long)card->tsq.base,
15238c2ecf20Sopenharmony_ci	       SAR_REG_TSQH);
15248c2ecf20Sopenharmony_ci
15258c2ecf20Sopenharmony_ci	XPRINTK("idt77252_tx-after writel%d: TSQ head = 0x%x, tail = 0x%x, next = 0x%p.\n",
15268c2ecf20Sopenharmony_ci		card->index, readl(SAR_REG_TSQH),
15278c2ecf20Sopenharmony_ci		readl(SAR_REG_TSQT), card->tsq.next);
15288c2ecf20Sopenharmony_ci}
15298c2ecf20Sopenharmony_ci
15308c2ecf20Sopenharmony_ci
15318c2ecf20Sopenharmony_cistatic void
15328c2ecf20Sopenharmony_citst_timer(struct timer_list *t)
15338c2ecf20Sopenharmony_ci{
15348c2ecf20Sopenharmony_ci	struct idt77252_dev *card = from_timer(card, t, tst_timer);
15358c2ecf20Sopenharmony_ci	unsigned long base, idle, jump;
15368c2ecf20Sopenharmony_ci	unsigned long flags;
15378c2ecf20Sopenharmony_ci	u32 pc;
15388c2ecf20Sopenharmony_ci	int e;
15398c2ecf20Sopenharmony_ci
15408c2ecf20Sopenharmony_ci	spin_lock_irqsave(&card->tst_lock, flags);
15418c2ecf20Sopenharmony_ci
15428c2ecf20Sopenharmony_ci	base = card->tst[card->tst_index];
15438c2ecf20Sopenharmony_ci	idle = card->tst[card->tst_index ^ 1];
15448c2ecf20Sopenharmony_ci
15458c2ecf20Sopenharmony_ci	if (test_bit(TST_SWITCH_WAIT, &card->tst_state)) {
15468c2ecf20Sopenharmony_ci		jump = base + card->tst_size - 2;
15478c2ecf20Sopenharmony_ci
15488c2ecf20Sopenharmony_ci		pc = readl(SAR_REG_NOW) >> 2;
15498c2ecf20Sopenharmony_ci		if ((pc ^ idle) & ~(card->tst_size - 1)) {
15508c2ecf20Sopenharmony_ci			mod_timer(&card->tst_timer, jiffies + 1);
15518c2ecf20Sopenharmony_ci			goto out;
15528c2ecf20Sopenharmony_ci		}
15538c2ecf20Sopenharmony_ci
15548c2ecf20Sopenharmony_ci		clear_bit(TST_SWITCH_WAIT, &card->tst_state);
15558c2ecf20Sopenharmony_ci
15568c2ecf20Sopenharmony_ci		card->tst_index ^= 1;
15578c2ecf20Sopenharmony_ci		write_sram(card, jump, TSTE_OPC_JMP | (base << 2));
15588c2ecf20Sopenharmony_ci
15598c2ecf20Sopenharmony_ci		base = card->tst[card->tst_index];
15608c2ecf20Sopenharmony_ci		idle = card->tst[card->tst_index ^ 1];
15618c2ecf20Sopenharmony_ci
15628c2ecf20Sopenharmony_ci		for (e = 0; e < card->tst_size - 2; e++) {
15638c2ecf20Sopenharmony_ci			if (card->soft_tst[e].tste & TSTE_PUSH_IDLE) {
15648c2ecf20Sopenharmony_ci				write_sram(card, idle + e,
15658c2ecf20Sopenharmony_ci					   card->soft_tst[e].tste & TSTE_MASK);
15668c2ecf20Sopenharmony_ci				card->soft_tst[e].tste &= ~(TSTE_PUSH_IDLE);
15678c2ecf20Sopenharmony_ci			}
15688c2ecf20Sopenharmony_ci		}
15698c2ecf20Sopenharmony_ci	}
15708c2ecf20Sopenharmony_ci
15718c2ecf20Sopenharmony_ci	if (test_and_clear_bit(TST_SWITCH_PENDING, &card->tst_state)) {
15728c2ecf20Sopenharmony_ci
15738c2ecf20Sopenharmony_ci		for (e = 0; e < card->tst_size - 2; e++) {
15748c2ecf20Sopenharmony_ci			if (card->soft_tst[e].tste & TSTE_PUSH_ACTIVE) {
15758c2ecf20Sopenharmony_ci				write_sram(card, idle + e,
15768c2ecf20Sopenharmony_ci					   card->soft_tst[e].tste & TSTE_MASK);
15778c2ecf20Sopenharmony_ci				card->soft_tst[e].tste &= ~(TSTE_PUSH_ACTIVE);
15788c2ecf20Sopenharmony_ci				card->soft_tst[e].tste |= TSTE_PUSH_IDLE;
15798c2ecf20Sopenharmony_ci			}
15808c2ecf20Sopenharmony_ci		}
15818c2ecf20Sopenharmony_ci
15828c2ecf20Sopenharmony_ci		jump = base + card->tst_size - 2;
15838c2ecf20Sopenharmony_ci
15848c2ecf20Sopenharmony_ci		write_sram(card, jump, TSTE_OPC_NULL);
15858c2ecf20Sopenharmony_ci		set_bit(TST_SWITCH_WAIT, &card->tst_state);
15868c2ecf20Sopenharmony_ci
15878c2ecf20Sopenharmony_ci		mod_timer(&card->tst_timer, jiffies + 1);
15888c2ecf20Sopenharmony_ci	}
15898c2ecf20Sopenharmony_ci
15908c2ecf20Sopenharmony_ciout:
15918c2ecf20Sopenharmony_ci	spin_unlock_irqrestore(&card->tst_lock, flags);
15928c2ecf20Sopenharmony_ci}
15938c2ecf20Sopenharmony_ci
15948c2ecf20Sopenharmony_cistatic int
15958c2ecf20Sopenharmony_ci__fill_tst(struct idt77252_dev *card, struct vc_map *vc,
15968c2ecf20Sopenharmony_ci	   int n, unsigned int opc)
15978c2ecf20Sopenharmony_ci{
15988c2ecf20Sopenharmony_ci	unsigned long cl, avail;
15998c2ecf20Sopenharmony_ci	unsigned long idle;
16008c2ecf20Sopenharmony_ci	int e, r;
16018c2ecf20Sopenharmony_ci	u32 data;
16028c2ecf20Sopenharmony_ci
16038c2ecf20Sopenharmony_ci	avail = card->tst_size - 2;
16048c2ecf20Sopenharmony_ci	for (e = 0; e < avail; e++) {
16058c2ecf20Sopenharmony_ci		if (card->soft_tst[e].vc == NULL)
16068c2ecf20Sopenharmony_ci			break;
16078c2ecf20Sopenharmony_ci	}
16088c2ecf20Sopenharmony_ci	if (e >= avail) {
16098c2ecf20Sopenharmony_ci		printk("%s: No free TST entries found\n", card->name);
16108c2ecf20Sopenharmony_ci		return -1;
16118c2ecf20Sopenharmony_ci	}
16128c2ecf20Sopenharmony_ci
16138c2ecf20Sopenharmony_ci	NPRINTK("%s: conn %d: first TST entry at %d.\n",
16148c2ecf20Sopenharmony_ci		card->name, vc ? vc->index : -1, e);
16158c2ecf20Sopenharmony_ci
16168c2ecf20Sopenharmony_ci	r = n;
16178c2ecf20Sopenharmony_ci	cl = avail;
16188c2ecf20Sopenharmony_ci	data = opc & TSTE_OPC_MASK;
16198c2ecf20Sopenharmony_ci	if (vc && (opc != TSTE_OPC_NULL))
16208c2ecf20Sopenharmony_ci		data = opc | vc->index;
16218c2ecf20Sopenharmony_ci
16228c2ecf20Sopenharmony_ci	idle = card->tst[card->tst_index ^ 1];
16238c2ecf20Sopenharmony_ci
16248c2ecf20Sopenharmony_ci	/*
16258c2ecf20Sopenharmony_ci	 * Fill Soft TST.
16268c2ecf20Sopenharmony_ci	 */
16278c2ecf20Sopenharmony_ci	while (r > 0) {
16288c2ecf20Sopenharmony_ci		if ((cl >= avail) && (card->soft_tst[e].vc == NULL)) {
16298c2ecf20Sopenharmony_ci			if (vc)
16308c2ecf20Sopenharmony_ci				card->soft_tst[e].vc = vc;
16318c2ecf20Sopenharmony_ci			else
16328c2ecf20Sopenharmony_ci				card->soft_tst[e].vc = (void *)-1;
16338c2ecf20Sopenharmony_ci
16348c2ecf20Sopenharmony_ci			card->soft_tst[e].tste = data;
16358c2ecf20Sopenharmony_ci			if (timer_pending(&card->tst_timer))
16368c2ecf20Sopenharmony_ci				card->soft_tst[e].tste |= TSTE_PUSH_ACTIVE;
16378c2ecf20Sopenharmony_ci			else {
16388c2ecf20Sopenharmony_ci				write_sram(card, idle + e, data);
16398c2ecf20Sopenharmony_ci				card->soft_tst[e].tste |= TSTE_PUSH_IDLE;
16408c2ecf20Sopenharmony_ci			}
16418c2ecf20Sopenharmony_ci
16428c2ecf20Sopenharmony_ci			cl -= card->tst_size;
16438c2ecf20Sopenharmony_ci			r--;
16448c2ecf20Sopenharmony_ci		}
16458c2ecf20Sopenharmony_ci
16468c2ecf20Sopenharmony_ci		if (++e == avail)
16478c2ecf20Sopenharmony_ci			e = 0;
16488c2ecf20Sopenharmony_ci		cl += n;
16498c2ecf20Sopenharmony_ci	}
16508c2ecf20Sopenharmony_ci
16518c2ecf20Sopenharmony_ci	return 0;
16528c2ecf20Sopenharmony_ci}
16538c2ecf20Sopenharmony_ci
16548c2ecf20Sopenharmony_cistatic int
16558c2ecf20Sopenharmony_cifill_tst(struct idt77252_dev *card, struct vc_map *vc, int n, unsigned int opc)
16568c2ecf20Sopenharmony_ci{
16578c2ecf20Sopenharmony_ci	unsigned long flags;
16588c2ecf20Sopenharmony_ci	int res;
16598c2ecf20Sopenharmony_ci
16608c2ecf20Sopenharmony_ci	spin_lock_irqsave(&card->tst_lock, flags);
16618c2ecf20Sopenharmony_ci
16628c2ecf20Sopenharmony_ci	res = __fill_tst(card, vc, n, opc);
16638c2ecf20Sopenharmony_ci
16648c2ecf20Sopenharmony_ci	set_bit(TST_SWITCH_PENDING, &card->tst_state);
16658c2ecf20Sopenharmony_ci	if (!timer_pending(&card->tst_timer))
16668c2ecf20Sopenharmony_ci		mod_timer(&card->tst_timer, jiffies + 1);
16678c2ecf20Sopenharmony_ci
16688c2ecf20Sopenharmony_ci	spin_unlock_irqrestore(&card->tst_lock, flags);
16698c2ecf20Sopenharmony_ci	return res;
16708c2ecf20Sopenharmony_ci}
16718c2ecf20Sopenharmony_ci
16728c2ecf20Sopenharmony_cistatic int
16738c2ecf20Sopenharmony_ci__clear_tst(struct idt77252_dev *card, struct vc_map *vc)
16748c2ecf20Sopenharmony_ci{
16758c2ecf20Sopenharmony_ci	unsigned long idle;
16768c2ecf20Sopenharmony_ci	int e;
16778c2ecf20Sopenharmony_ci
16788c2ecf20Sopenharmony_ci	idle = card->tst[card->tst_index ^ 1];
16798c2ecf20Sopenharmony_ci
16808c2ecf20Sopenharmony_ci	for (e = 0; e < card->tst_size - 2; e++) {
16818c2ecf20Sopenharmony_ci		if (card->soft_tst[e].vc == vc) {
16828c2ecf20Sopenharmony_ci			card->soft_tst[e].vc = NULL;
16838c2ecf20Sopenharmony_ci
16848c2ecf20Sopenharmony_ci			card->soft_tst[e].tste = TSTE_OPC_VAR;
16858c2ecf20Sopenharmony_ci			if (timer_pending(&card->tst_timer))
16868c2ecf20Sopenharmony_ci				card->soft_tst[e].tste |= TSTE_PUSH_ACTIVE;
16878c2ecf20Sopenharmony_ci			else {
16888c2ecf20Sopenharmony_ci				write_sram(card, idle + e, TSTE_OPC_VAR);
16898c2ecf20Sopenharmony_ci				card->soft_tst[e].tste |= TSTE_PUSH_IDLE;
16908c2ecf20Sopenharmony_ci			}
16918c2ecf20Sopenharmony_ci		}
16928c2ecf20Sopenharmony_ci	}
16938c2ecf20Sopenharmony_ci
16948c2ecf20Sopenharmony_ci	return 0;
16958c2ecf20Sopenharmony_ci}
16968c2ecf20Sopenharmony_ci
16978c2ecf20Sopenharmony_cistatic int
16988c2ecf20Sopenharmony_ciclear_tst(struct idt77252_dev *card, struct vc_map *vc)
16998c2ecf20Sopenharmony_ci{
17008c2ecf20Sopenharmony_ci	unsigned long flags;
17018c2ecf20Sopenharmony_ci	int res;
17028c2ecf20Sopenharmony_ci
17038c2ecf20Sopenharmony_ci	spin_lock_irqsave(&card->tst_lock, flags);
17048c2ecf20Sopenharmony_ci
17058c2ecf20Sopenharmony_ci	res = __clear_tst(card, vc);
17068c2ecf20Sopenharmony_ci
17078c2ecf20Sopenharmony_ci	set_bit(TST_SWITCH_PENDING, &card->tst_state);
17088c2ecf20Sopenharmony_ci	if (!timer_pending(&card->tst_timer))
17098c2ecf20Sopenharmony_ci		mod_timer(&card->tst_timer, jiffies + 1);
17108c2ecf20Sopenharmony_ci
17118c2ecf20Sopenharmony_ci	spin_unlock_irqrestore(&card->tst_lock, flags);
17128c2ecf20Sopenharmony_ci	return res;
17138c2ecf20Sopenharmony_ci}
17148c2ecf20Sopenharmony_ci
17158c2ecf20Sopenharmony_cistatic int
17168c2ecf20Sopenharmony_cichange_tst(struct idt77252_dev *card, struct vc_map *vc,
17178c2ecf20Sopenharmony_ci	   int n, unsigned int opc)
17188c2ecf20Sopenharmony_ci{
17198c2ecf20Sopenharmony_ci	unsigned long flags;
17208c2ecf20Sopenharmony_ci	int res;
17218c2ecf20Sopenharmony_ci
17228c2ecf20Sopenharmony_ci	spin_lock_irqsave(&card->tst_lock, flags);
17238c2ecf20Sopenharmony_ci
17248c2ecf20Sopenharmony_ci	__clear_tst(card, vc);
17258c2ecf20Sopenharmony_ci	res = __fill_tst(card, vc, n, opc);
17268c2ecf20Sopenharmony_ci
17278c2ecf20Sopenharmony_ci	set_bit(TST_SWITCH_PENDING, &card->tst_state);
17288c2ecf20Sopenharmony_ci	if (!timer_pending(&card->tst_timer))
17298c2ecf20Sopenharmony_ci		mod_timer(&card->tst_timer, jiffies + 1);
17308c2ecf20Sopenharmony_ci
17318c2ecf20Sopenharmony_ci	spin_unlock_irqrestore(&card->tst_lock, flags);
17328c2ecf20Sopenharmony_ci	return res;
17338c2ecf20Sopenharmony_ci}
17348c2ecf20Sopenharmony_ci
17358c2ecf20Sopenharmony_ci
17368c2ecf20Sopenharmony_cistatic int
17378c2ecf20Sopenharmony_ciset_tct(struct idt77252_dev *card, struct vc_map *vc)
17388c2ecf20Sopenharmony_ci{
17398c2ecf20Sopenharmony_ci	unsigned long tct;
17408c2ecf20Sopenharmony_ci
17418c2ecf20Sopenharmony_ci	tct = (unsigned long) (card->tct_base + vc->index * SAR_SRAM_TCT_SIZE);
17428c2ecf20Sopenharmony_ci
17438c2ecf20Sopenharmony_ci	switch (vc->class) {
17448c2ecf20Sopenharmony_ci	case SCHED_CBR:
17458c2ecf20Sopenharmony_ci		OPRINTK("%s: writing TCT at 0x%lx, SCD 0x%lx.\n",
17468c2ecf20Sopenharmony_ci		        card->name, tct, vc->scq->scd);
17478c2ecf20Sopenharmony_ci
17488c2ecf20Sopenharmony_ci		write_sram(card, tct + 0, TCT_CBR | vc->scq->scd);
17498c2ecf20Sopenharmony_ci		write_sram(card, tct + 1, 0);
17508c2ecf20Sopenharmony_ci		write_sram(card, tct + 2, 0);
17518c2ecf20Sopenharmony_ci		write_sram(card, tct + 3, 0);
17528c2ecf20Sopenharmony_ci		write_sram(card, tct + 4, 0);
17538c2ecf20Sopenharmony_ci		write_sram(card, tct + 5, 0);
17548c2ecf20Sopenharmony_ci		write_sram(card, tct + 6, 0);
17558c2ecf20Sopenharmony_ci		write_sram(card, tct + 7, 0);
17568c2ecf20Sopenharmony_ci		break;
17578c2ecf20Sopenharmony_ci
17588c2ecf20Sopenharmony_ci	case SCHED_UBR:
17598c2ecf20Sopenharmony_ci		OPRINTK("%s: writing TCT at 0x%lx, SCD 0x%lx.\n",
17608c2ecf20Sopenharmony_ci		        card->name, tct, vc->scq->scd);
17618c2ecf20Sopenharmony_ci
17628c2ecf20Sopenharmony_ci		write_sram(card, tct + 0, TCT_UBR | vc->scq->scd);
17638c2ecf20Sopenharmony_ci		write_sram(card, tct + 1, 0);
17648c2ecf20Sopenharmony_ci		write_sram(card, tct + 2, TCT_TSIF);
17658c2ecf20Sopenharmony_ci		write_sram(card, tct + 3, TCT_HALT | TCT_IDLE);
17668c2ecf20Sopenharmony_ci		write_sram(card, tct + 4, 0);
17678c2ecf20Sopenharmony_ci		write_sram(card, tct + 5, vc->init_er);
17688c2ecf20Sopenharmony_ci		write_sram(card, tct + 6, 0);
17698c2ecf20Sopenharmony_ci		write_sram(card, tct + 7, TCT_FLAG_UBR);
17708c2ecf20Sopenharmony_ci		break;
17718c2ecf20Sopenharmony_ci
17728c2ecf20Sopenharmony_ci	case SCHED_VBR:
17738c2ecf20Sopenharmony_ci	case SCHED_ABR:
17748c2ecf20Sopenharmony_ci	default:
17758c2ecf20Sopenharmony_ci		return -ENOSYS;
17768c2ecf20Sopenharmony_ci	}
17778c2ecf20Sopenharmony_ci
17788c2ecf20Sopenharmony_ci	return 0;
17798c2ecf20Sopenharmony_ci}
17808c2ecf20Sopenharmony_ci
17818c2ecf20Sopenharmony_ci/*****************************************************************************/
17828c2ecf20Sopenharmony_ci/*                                                                           */
17838c2ecf20Sopenharmony_ci/* FBQ Handling                                                              */
17848c2ecf20Sopenharmony_ci/*                                                                           */
17858c2ecf20Sopenharmony_ci/*****************************************************************************/
17868c2ecf20Sopenharmony_ci
17878c2ecf20Sopenharmony_cistatic __inline__ int
17888c2ecf20Sopenharmony_ciidt77252_fbq_level(struct idt77252_dev *card, int queue)
17898c2ecf20Sopenharmony_ci{
17908c2ecf20Sopenharmony_ci	return (readl(SAR_REG_STAT) >> (16 + (queue << 2))) & 0x0f;
17918c2ecf20Sopenharmony_ci}
17928c2ecf20Sopenharmony_ci
17938c2ecf20Sopenharmony_cistatic __inline__ int
17948c2ecf20Sopenharmony_ciidt77252_fbq_full(struct idt77252_dev *card, int queue)
17958c2ecf20Sopenharmony_ci{
17968c2ecf20Sopenharmony_ci	return (readl(SAR_REG_STAT) >> (16 + (queue << 2))) == 0x0f;
17978c2ecf20Sopenharmony_ci}
17988c2ecf20Sopenharmony_ci
17998c2ecf20Sopenharmony_cistatic int
18008c2ecf20Sopenharmony_cipush_rx_skb(struct idt77252_dev *card, struct sk_buff *skb, int queue)
18018c2ecf20Sopenharmony_ci{
18028c2ecf20Sopenharmony_ci	unsigned long flags;
18038c2ecf20Sopenharmony_ci	u32 handle;
18048c2ecf20Sopenharmony_ci	u32 addr;
18058c2ecf20Sopenharmony_ci
18068c2ecf20Sopenharmony_ci	skb->data = skb->head;
18078c2ecf20Sopenharmony_ci	skb_reset_tail_pointer(skb);
18088c2ecf20Sopenharmony_ci	skb->len = 0;
18098c2ecf20Sopenharmony_ci
18108c2ecf20Sopenharmony_ci	skb_reserve(skb, 16);
18118c2ecf20Sopenharmony_ci
18128c2ecf20Sopenharmony_ci	switch (queue) {
18138c2ecf20Sopenharmony_ci	case 0:
18148c2ecf20Sopenharmony_ci		skb_put(skb, SAR_FB_SIZE_0);
18158c2ecf20Sopenharmony_ci		break;
18168c2ecf20Sopenharmony_ci	case 1:
18178c2ecf20Sopenharmony_ci		skb_put(skb, SAR_FB_SIZE_1);
18188c2ecf20Sopenharmony_ci		break;
18198c2ecf20Sopenharmony_ci	case 2:
18208c2ecf20Sopenharmony_ci		skb_put(skb, SAR_FB_SIZE_2);
18218c2ecf20Sopenharmony_ci		break;
18228c2ecf20Sopenharmony_ci	case 3:
18238c2ecf20Sopenharmony_ci		skb_put(skb, SAR_FB_SIZE_3);
18248c2ecf20Sopenharmony_ci		break;
18258c2ecf20Sopenharmony_ci	default:
18268c2ecf20Sopenharmony_ci		return -1;
18278c2ecf20Sopenharmony_ci	}
18288c2ecf20Sopenharmony_ci
18298c2ecf20Sopenharmony_ci	if (idt77252_fbq_full(card, queue))
18308c2ecf20Sopenharmony_ci		return -1;
18318c2ecf20Sopenharmony_ci
18328c2ecf20Sopenharmony_ci	memset(&skb->data[(skb->len & ~(0x3f)) - 64], 0, 2 * sizeof(u32));
18338c2ecf20Sopenharmony_ci
18348c2ecf20Sopenharmony_ci	handle = IDT77252_PRV_POOL(skb);
18358c2ecf20Sopenharmony_ci	addr = IDT77252_PRV_PADDR(skb);
18368c2ecf20Sopenharmony_ci
18378c2ecf20Sopenharmony_ci	spin_lock_irqsave(&card->cmd_lock, flags);
18388c2ecf20Sopenharmony_ci	writel(handle, card->fbq[queue]);
18398c2ecf20Sopenharmony_ci	writel(addr, card->fbq[queue]);
18408c2ecf20Sopenharmony_ci	spin_unlock_irqrestore(&card->cmd_lock, flags);
18418c2ecf20Sopenharmony_ci
18428c2ecf20Sopenharmony_ci	return 0;
18438c2ecf20Sopenharmony_ci}
18448c2ecf20Sopenharmony_ci
18458c2ecf20Sopenharmony_cistatic void
18468c2ecf20Sopenharmony_ciadd_rx_skb(struct idt77252_dev *card, int queue,
18478c2ecf20Sopenharmony_ci	   unsigned int size, unsigned int count)
18488c2ecf20Sopenharmony_ci{
18498c2ecf20Sopenharmony_ci	struct sk_buff *skb;
18508c2ecf20Sopenharmony_ci	dma_addr_t paddr;
18518c2ecf20Sopenharmony_ci	u32 handle;
18528c2ecf20Sopenharmony_ci
18538c2ecf20Sopenharmony_ci	while (count--) {
18548c2ecf20Sopenharmony_ci		skb = dev_alloc_skb(size);
18558c2ecf20Sopenharmony_ci		if (!skb)
18568c2ecf20Sopenharmony_ci			return;
18578c2ecf20Sopenharmony_ci
18588c2ecf20Sopenharmony_ci		if (sb_pool_add(card, skb, queue)) {
18598c2ecf20Sopenharmony_ci			printk("%s: SB POOL full\n", __func__);
18608c2ecf20Sopenharmony_ci			goto outfree;
18618c2ecf20Sopenharmony_ci		}
18628c2ecf20Sopenharmony_ci
18638c2ecf20Sopenharmony_ci		paddr = dma_map_single(&card->pcidev->dev, skb->data,
18648c2ecf20Sopenharmony_ci				       skb_end_pointer(skb) - skb->data,
18658c2ecf20Sopenharmony_ci				       DMA_FROM_DEVICE);
18668c2ecf20Sopenharmony_ci		IDT77252_PRV_PADDR(skb) = paddr;
18678c2ecf20Sopenharmony_ci
18688c2ecf20Sopenharmony_ci		if (push_rx_skb(card, skb, queue)) {
18698c2ecf20Sopenharmony_ci			printk("%s: FB QUEUE full\n", __func__);
18708c2ecf20Sopenharmony_ci			goto outunmap;
18718c2ecf20Sopenharmony_ci		}
18728c2ecf20Sopenharmony_ci	}
18738c2ecf20Sopenharmony_ci
18748c2ecf20Sopenharmony_ci	return;
18758c2ecf20Sopenharmony_ci
18768c2ecf20Sopenharmony_cioutunmap:
18778c2ecf20Sopenharmony_ci	dma_unmap_single(&card->pcidev->dev, IDT77252_PRV_PADDR(skb),
18788c2ecf20Sopenharmony_ci			 skb_end_pointer(skb) - skb->data, DMA_FROM_DEVICE);
18798c2ecf20Sopenharmony_ci
18808c2ecf20Sopenharmony_ci	handle = IDT77252_PRV_POOL(skb);
18818c2ecf20Sopenharmony_ci	card->sbpool[POOL_QUEUE(handle)].skb[POOL_INDEX(handle)] = NULL;
18828c2ecf20Sopenharmony_ci
18838c2ecf20Sopenharmony_cioutfree:
18848c2ecf20Sopenharmony_ci	dev_kfree_skb(skb);
18858c2ecf20Sopenharmony_ci}
18868c2ecf20Sopenharmony_ci
18878c2ecf20Sopenharmony_ci
18888c2ecf20Sopenharmony_cistatic void
18898c2ecf20Sopenharmony_cirecycle_rx_skb(struct idt77252_dev *card, struct sk_buff *skb)
18908c2ecf20Sopenharmony_ci{
18918c2ecf20Sopenharmony_ci	u32 handle = IDT77252_PRV_POOL(skb);
18928c2ecf20Sopenharmony_ci	int err;
18938c2ecf20Sopenharmony_ci
18948c2ecf20Sopenharmony_ci	dma_sync_single_for_device(&card->pcidev->dev, IDT77252_PRV_PADDR(skb),
18958c2ecf20Sopenharmony_ci				   skb_end_pointer(skb) - skb->data,
18968c2ecf20Sopenharmony_ci				   DMA_FROM_DEVICE);
18978c2ecf20Sopenharmony_ci
18988c2ecf20Sopenharmony_ci	err = push_rx_skb(card, skb, POOL_QUEUE(handle));
18998c2ecf20Sopenharmony_ci	if (err) {
19008c2ecf20Sopenharmony_ci		dma_unmap_single(&card->pcidev->dev, IDT77252_PRV_PADDR(skb),
19018c2ecf20Sopenharmony_ci				 skb_end_pointer(skb) - skb->data,
19028c2ecf20Sopenharmony_ci				 DMA_FROM_DEVICE);
19038c2ecf20Sopenharmony_ci		sb_pool_remove(card, skb);
19048c2ecf20Sopenharmony_ci		dev_kfree_skb(skb);
19058c2ecf20Sopenharmony_ci	}
19068c2ecf20Sopenharmony_ci}
19078c2ecf20Sopenharmony_ci
19088c2ecf20Sopenharmony_cistatic void
19098c2ecf20Sopenharmony_ciflush_rx_pool(struct idt77252_dev *card, struct rx_pool *rpp)
19108c2ecf20Sopenharmony_ci{
19118c2ecf20Sopenharmony_ci	skb_queue_head_init(&rpp->queue);
19128c2ecf20Sopenharmony_ci	rpp->len = 0;
19138c2ecf20Sopenharmony_ci}
19148c2ecf20Sopenharmony_ci
19158c2ecf20Sopenharmony_cistatic void
19168c2ecf20Sopenharmony_cirecycle_rx_pool_skb(struct idt77252_dev *card, struct rx_pool *rpp)
19178c2ecf20Sopenharmony_ci{
19188c2ecf20Sopenharmony_ci	struct sk_buff *skb, *tmp;
19198c2ecf20Sopenharmony_ci
19208c2ecf20Sopenharmony_ci	skb_queue_walk_safe(&rpp->queue, skb, tmp)
19218c2ecf20Sopenharmony_ci		recycle_rx_skb(card, skb);
19228c2ecf20Sopenharmony_ci
19238c2ecf20Sopenharmony_ci	flush_rx_pool(card, rpp);
19248c2ecf20Sopenharmony_ci}
19258c2ecf20Sopenharmony_ci
19268c2ecf20Sopenharmony_ci/*****************************************************************************/
19278c2ecf20Sopenharmony_ci/*                                                                           */
19288c2ecf20Sopenharmony_ci/* ATM Interface                                                             */
19298c2ecf20Sopenharmony_ci/*                                                                           */
19308c2ecf20Sopenharmony_ci/*****************************************************************************/
19318c2ecf20Sopenharmony_ci
19328c2ecf20Sopenharmony_cistatic void
19338c2ecf20Sopenharmony_ciidt77252_phy_put(struct atm_dev *dev, unsigned char value, unsigned long addr)
19348c2ecf20Sopenharmony_ci{
19358c2ecf20Sopenharmony_ci	write_utility(dev->dev_data, 0x100 + (addr & 0x1ff), value);
19368c2ecf20Sopenharmony_ci}
19378c2ecf20Sopenharmony_ci
19388c2ecf20Sopenharmony_cistatic unsigned char
19398c2ecf20Sopenharmony_ciidt77252_phy_get(struct atm_dev *dev, unsigned long addr)
19408c2ecf20Sopenharmony_ci{
19418c2ecf20Sopenharmony_ci	return read_utility(dev->dev_data, 0x100 + (addr & 0x1ff));
19428c2ecf20Sopenharmony_ci}
19438c2ecf20Sopenharmony_ci
19448c2ecf20Sopenharmony_cistatic inline int
19458c2ecf20Sopenharmony_ciidt77252_send_skb(struct atm_vcc *vcc, struct sk_buff *skb, int oam)
19468c2ecf20Sopenharmony_ci{
19478c2ecf20Sopenharmony_ci	struct atm_dev *dev = vcc->dev;
19488c2ecf20Sopenharmony_ci	struct idt77252_dev *card = dev->dev_data;
19498c2ecf20Sopenharmony_ci	struct vc_map *vc = vcc->dev_data;
19508c2ecf20Sopenharmony_ci	int err;
19518c2ecf20Sopenharmony_ci
19528c2ecf20Sopenharmony_ci	if (vc == NULL) {
19538c2ecf20Sopenharmony_ci		printk("%s: NULL connection in send().\n", card->name);
19548c2ecf20Sopenharmony_ci		atomic_inc(&vcc->stats->tx_err);
19558c2ecf20Sopenharmony_ci		dev_kfree_skb(skb);
19568c2ecf20Sopenharmony_ci		return -EINVAL;
19578c2ecf20Sopenharmony_ci	}
19588c2ecf20Sopenharmony_ci	if (!test_bit(VCF_TX, &vc->flags)) {
19598c2ecf20Sopenharmony_ci		printk("%s: Trying to transmit on a non-tx VC.\n", card->name);
19608c2ecf20Sopenharmony_ci		atomic_inc(&vcc->stats->tx_err);
19618c2ecf20Sopenharmony_ci		dev_kfree_skb(skb);
19628c2ecf20Sopenharmony_ci		return -EINVAL;
19638c2ecf20Sopenharmony_ci	}
19648c2ecf20Sopenharmony_ci
19658c2ecf20Sopenharmony_ci	switch (vcc->qos.aal) {
19668c2ecf20Sopenharmony_ci	case ATM_AAL0:
19678c2ecf20Sopenharmony_ci	case ATM_AAL1:
19688c2ecf20Sopenharmony_ci	case ATM_AAL5:
19698c2ecf20Sopenharmony_ci		break;
19708c2ecf20Sopenharmony_ci	default:
19718c2ecf20Sopenharmony_ci		printk("%s: Unsupported AAL: %d\n", card->name, vcc->qos.aal);
19728c2ecf20Sopenharmony_ci		atomic_inc(&vcc->stats->tx_err);
19738c2ecf20Sopenharmony_ci		dev_kfree_skb(skb);
19748c2ecf20Sopenharmony_ci		return -EINVAL;
19758c2ecf20Sopenharmony_ci	}
19768c2ecf20Sopenharmony_ci
19778c2ecf20Sopenharmony_ci	if (skb_shinfo(skb)->nr_frags != 0) {
19788c2ecf20Sopenharmony_ci		printk("%s: No scatter-gather yet.\n", card->name);
19798c2ecf20Sopenharmony_ci		atomic_inc(&vcc->stats->tx_err);
19808c2ecf20Sopenharmony_ci		dev_kfree_skb(skb);
19818c2ecf20Sopenharmony_ci		return -EINVAL;
19828c2ecf20Sopenharmony_ci	}
19838c2ecf20Sopenharmony_ci	ATM_SKB(skb)->vcc = vcc;
19848c2ecf20Sopenharmony_ci
19858c2ecf20Sopenharmony_ci	err = queue_skb(card, vc, skb, oam);
19868c2ecf20Sopenharmony_ci	if (err) {
19878c2ecf20Sopenharmony_ci		atomic_inc(&vcc->stats->tx_err);
19888c2ecf20Sopenharmony_ci		dev_kfree_skb(skb);
19898c2ecf20Sopenharmony_ci		return err;
19908c2ecf20Sopenharmony_ci	}
19918c2ecf20Sopenharmony_ci
19928c2ecf20Sopenharmony_ci	return 0;
19938c2ecf20Sopenharmony_ci}
19948c2ecf20Sopenharmony_ci
19958c2ecf20Sopenharmony_cistatic int idt77252_send(struct atm_vcc *vcc, struct sk_buff *skb)
19968c2ecf20Sopenharmony_ci{
19978c2ecf20Sopenharmony_ci	return idt77252_send_skb(vcc, skb, 0);
19988c2ecf20Sopenharmony_ci}
19998c2ecf20Sopenharmony_ci
20008c2ecf20Sopenharmony_cistatic int
20018c2ecf20Sopenharmony_ciidt77252_send_oam(struct atm_vcc *vcc, void *cell, int flags)
20028c2ecf20Sopenharmony_ci{
20038c2ecf20Sopenharmony_ci	struct atm_dev *dev = vcc->dev;
20048c2ecf20Sopenharmony_ci	struct idt77252_dev *card = dev->dev_data;
20058c2ecf20Sopenharmony_ci	struct sk_buff *skb;
20068c2ecf20Sopenharmony_ci
20078c2ecf20Sopenharmony_ci	skb = dev_alloc_skb(64);
20088c2ecf20Sopenharmony_ci	if (!skb) {
20098c2ecf20Sopenharmony_ci		printk("%s: Out of memory in send_oam().\n", card->name);
20108c2ecf20Sopenharmony_ci		atomic_inc(&vcc->stats->tx_err);
20118c2ecf20Sopenharmony_ci		return -ENOMEM;
20128c2ecf20Sopenharmony_ci	}
20138c2ecf20Sopenharmony_ci	refcount_add(skb->truesize, &sk_atm(vcc)->sk_wmem_alloc);
20148c2ecf20Sopenharmony_ci
20158c2ecf20Sopenharmony_ci	skb_put_data(skb, cell, 52);
20168c2ecf20Sopenharmony_ci
20178c2ecf20Sopenharmony_ci	return idt77252_send_skb(vcc, skb, 1);
20188c2ecf20Sopenharmony_ci}
20198c2ecf20Sopenharmony_ci
20208c2ecf20Sopenharmony_cistatic __inline__ unsigned int
20218c2ecf20Sopenharmony_ciidt77252_fls(unsigned int x)
20228c2ecf20Sopenharmony_ci{
20238c2ecf20Sopenharmony_ci	int r = 1;
20248c2ecf20Sopenharmony_ci
20258c2ecf20Sopenharmony_ci	if (x == 0)
20268c2ecf20Sopenharmony_ci		return 0;
20278c2ecf20Sopenharmony_ci	if (x & 0xffff0000) {
20288c2ecf20Sopenharmony_ci		x >>= 16;
20298c2ecf20Sopenharmony_ci		r += 16;
20308c2ecf20Sopenharmony_ci	}
20318c2ecf20Sopenharmony_ci	if (x & 0xff00) {
20328c2ecf20Sopenharmony_ci		x >>= 8;
20338c2ecf20Sopenharmony_ci		r += 8;
20348c2ecf20Sopenharmony_ci	}
20358c2ecf20Sopenharmony_ci	if (x & 0xf0) {
20368c2ecf20Sopenharmony_ci		x >>= 4;
20378c2ecf20Sopenharmony_ci		r += 4;
20388c2ecf20Sopenharmony_ci	}
20398c2ecf20Sopenharmony_ci	if (x & 0xc) {
20408c2ecf20Sopenharmony_ci		x >>= 2;
20418c2ecf20Sopenharmony_ci		r += 2;
20428c2ecf20Sopenharmony_ci	}
20438c2ecf20Sopenharmony_ci	if (x & 0x2)
20448c2ecf20Sopenharmony_ci		r += 1;
20458c2ecf20Sopenharmony_ci	return r;
20468c2ecf20Sopenharmony_ci}
20478c2ecf20Sopenharmony_ci
20488c2ecf20Sopenharmony_cistatic u16
20498c2ecf20Sopenharmony_ciidt77252_int_to_atmfp(unsigned int rate)
20508c2ecf20Sopenharmony_ci{
20518c2ecf20Sopenharmony_ci	u16 m, e;
20528c2ecf20Sopenharmony_ci
20538c2ecf20Sopenharmony_ci	if (rate == 0)
20548c2ecf20Sopenharmony_ci		return 0;
20558c2ecf20Sopenharmony_ci	e = idt77252_fls(rate) - 1;
20568c2ecf20Sopenharmony_ci	if (e < 9)
20578c2ecf20Sopenharmony_ci		m = (rate - (1 << e)) << (9 - e);
20588c2ecf20Sopenharmony_ci	else if (e == 9)
20598c2ecf20Sopenharmony_ci		m = (rate - (1 << e));
20608c2ecf20Sopenharmony_ci	else /* e > 9 */
20618c2ecf20Sopenharmony_ci		m = (rate - (1 << e)) >> (e - 9);
20628c2ecf20Sopenharmony_ci	return 0x4000 | (e << 9) | m;
20638c2ecf20Sopenharmony_ci}
20648c2ecf20Sopenharmony_ci
20658c2ecf20Sopenharmony_cistatic u8
20668c2ecf20Sopenharmony_ciidt77252_rate_logindex(struct idt77252_dev *card, int pcr)
20678c2ecf20Sopenharmony_ci{
20688c2ecf20Sopenharmony_ci	u16 afp;
20698c2ecf20Sopenharmony_ci
20708c2ecf20Sopenharmony_ci	afp = idt77252_int_to_atmfp(pcr < 0 ? -pcr : pcr);
20718c2ecf20Sopenharmony_ci	if (pcr < 0)
20728c2ecf20Sopenharmony_ci		return rate_to_log[(afp >> 5) & 0x1ff];
20738c2ecf20Sopenharmony_ci	return rate_to_log[((afp >> 5) + 1) & 0x1ff];
20748c2ecf20Sopenharmony_ci}
20758c2ecf20Sopenharmony_ci
20768c2ecf20Sopenharmony_cistatic void
20778c2ecf20Sopenharmony_ciidt77252_est_timer(struct timer_list *t)
20788c2ecf20Sopenharmony_ci{
20798c2ecf20Sopenharmony_ci	struct rate_estimator *est = from_timer(est, t, timer);
20808c2ecf20Sopenharmony_ci	struct vc_map *vc = est->vc;
20818c2ecf20Sopenharmony_ci	struct idt77252_dev *card = vc->card;
20828c2ecf20Sopenharmony_ci	unsigned long flags;
20838c2ecf20Sopenharmony_ci	u32 rate, cps;
20848c2ecf20Sopenharmony_ci	u64 ncells;
20858c2ecf20Sopenharmony_ci	u8 lacr;
20868c2ecf20Sopenharmony_ci
20878c2ecf20Sopenharmony_ci	spin_lock_irqsave(&vc->lock, flags);
20888c2ecf20Sopenharmony_ci	if (!vc->estimator)
20898c2ecf20Sopenharmony_ci		goto out;
20908c2ecf20Sopenharmony_ci	ncells = est->cells;
20918c2ecf20Sopenharmony_ci
20928c2ecf20Sopenharmony_ci	rate = ((u32)(ncells - est->last_cells)) << (7 - est->interval);
20938c2ecf20Sopenharmony_ci	est->last_cells = ncells;
20948c2ecf20Sopenharmony_ci	est->avcps += ((long)rate - (long)est->avcps) >> est->ewma_log;
20958c2ecf20Sopenharmony_ci	est->cps = (est->avcps + 0x1f) >> 5;
20968c2ecf20Sopenharmony_ci
20978c2ecf20Sopenharmony_ci	cps = est->cps;
20988c2ecf20Sopenharmony_ci	if (cps < (est->maxcps >> 4))
20998c2ecf20Sopenharmony_ci		cps = est->maxcps >> 4;
21008c2ecf20Sopenharmony_ci
21018c2ecf20Sopenharmony_ci	lacr = idt77252_rate_logindex(card, cps);
21028c2ecf20Sopenharmony_ci	if (lacr > vc->max_er)
21038c2ecf20Sopenharmony_ci		lacr = vc->max_er;
21048c2ecf20Sopenharmony_ci
21058c2ecf20Sopenharmony_ci	if (lacr != vc->lacr) {
21068c2ecf20Sopenharmony_ci		vc->lacr = lacr;
21078c2ecf20Sopenharmony_ci		writel(TCMDQ_LACR|(vc->lacr << 16)|vc->index, SAR_REG_TCMDQ);
21088c2ecf20Sopenharmony_ci	}
21098c2ecf20Sopenharmony_ci
21108c2ecf20Sopenharmony_ci	est->timer.expires = jiffies + ((HZ / 4) << est->interval);
21118c2ecf20Sopenharmony_ci	add_timer(&est->timer);
21128c2ecf20Sopenharmony_ci
21138c2ecf20Sopenharmony_ciout:
21148c2ecf20Sopenharmony_ci	spin_unlock_irqrestore(&vc->lock, flags);
21158c2ecf20Sopenharmony_ci}
21168c2ecf20Sopenharmony_ci
21178c2ecf20Sopenharmony_cistatic struct rate_estimator *
21188c2ecf20Sopenharmony_ciidt77252_init_est(struct vc_map *vc, int pcr)
21198c2ecf20Sopenharmony_ci{
21208c2ecf20Sopenharmony_ci	struct rate_estimator *est;
21218c2ecf20Sopenharmony_ci
21228c2ecf20Sopenharmony_ci	est = kzalloc(sizeof(struct rate_estimator), GFP_KERNEL);
21238c2ecf20Sopenharmony_ci	if (!est)
21248c2ecf20Sopenharmony_ci		return NULL;
21258c2ecf20Sopenharmony_ci	est->maxcps = pcr < 0 ? -pcr : pcr;
21268c2ecf20Sopenharmony_ci	est->cps = est->maxcps;
21278c2ecf20Sopenharmony_ci	est->avcps = est->cps << 5;
21288c2ecf20Sopenharmony_ci	est->vc = vc;
21298c2ecf20Sopenharmony_ci
21308c2ecf20Sopenharmony_ci	est->interval = 2;		/* XXX: make this configurable */
21318c2ecf20Sopenharmony_ci	est->ewma_log = 2;		/* XXX: make this configurable */
21328c2ecf20Sopenharmony_ci	timer_setup(&est->timer, idt77252_est_timer, 0);
21338c2ecf20Sopenharmony_ci	mod_timer(&est->timer, jiffies + ((HZ / 4) << est->interval));
21348c2ecf20Sopenharmony_ci
21358c2ecf20Sopenharmony_ci	return est;
21368c2ecf20Sopenharmony_ci}
21378c2ecf20Sopenharmony_ci
21388c2ecf20Sopenharmony_cistatic int
21398c2ecf20Sopenharmony_ciidt77252_init_cbr(struct idt77252_dev *card, struct vc_map *vc,
21408c2ecf20Sopenharmony_ci		  struct atm_vcc *vcc, struct atm_qos *qos)
21418c2ecf20Sopenharmony_ci{
21428c2ecf20Sopenharmony_ci	int tst_free, tst_used, tst_entries;
21438c2ecf20Sopenharmony_ci	unsigned long tmpl, modl;
21448c2ecf20Sopenharmony_ci	int tcr, tcra;
21458c2ecf20Sopenharmony_ci
21468c2ecf20Sopenharmony_ci	if ((qos->txtp.max_pcr == 0) &&
21478c2ecf20Sopenharmony_ci	    (qos->txtp.pcr == 0) && (qos->txtp.min_pcr == 0)) {
21488c2ecf20Sopenharmony_ci		printk("%s: trying to open a CBR VC with cell rate = 0\n",
21498c2ecf20Sopenharmony_ci		       card->name);
21508c2ecf20Sopenharmony_ci		return -EINVAL;
21518c2ecf20Sopenharmony_ci	}
21528c2ecf20Sopenharmony_ci
21538c2ecf20Sopenharmony_ci	tst_used = 0;
21548c2ecf20Sopenharmony_ci	tst_free = card->tst_free;
21558c2ecf20Sopenharmony_ci	if (test_bit(VCF_TX, &vc->flags))
21568c2ecf20Sopenharmony_ci		tst_used = vc->ntste;
21578c2ecf20Sopenharmony_ci	tst_free += tst_used;
21588c2ecf20Sopenharmony_ci
21598c2ecf20Sopenharmony_ci	tcr = atm_pcr_goal(&qos->txtp);
21608c2ecf20Sopenharmony_ci	tcra = tcr >= 0 ? tcr : -tcr;
21618c2ecf20Sopenharmony_ci
21628c2ecf20Sopenharmony_ci	TXPRINTK("%s: CBR target cell rate = %d\n", card->name, tcra);
21638c2ecf20Sopenharmony_ci
21648c2ecf20Sopenharmony_ci	tmpl = (unsigned long) tcra * ((unsigned long) card->tst_size - 2);
21658c2ecf20Sopenharmony_ci	modl = tmpl % (unsigned long)card->utopia_pcr;
21668c2ecf20Sopenharmony_ci
21678c2ecf20Sopenharmony_ci	tst_entries = (int) (tmpl / card->utopia_pcr);
21688c2ecf20Sopenharmony_ci	if (tcr > 0) {
21698c2ecf20Sopenharmony_ci		if (modl > 0)
21708c2ecf20Sopenharmony_ci			tst_entries++;
21718c2ecf20Sopenharmony_ci	} else if (tcr == 0) {
21728c2ecf20Sopenharmony_ci		tst_entries = tst_free - SAR_TST_RESERVED;
21738c2ecf20Sopenharmony_ci		if (tst_entries <= 0) {
21748c2ecf20Sopenharmony_ci			printk("%s: no CBR bandwidth free.\n", card->name);
21758c2ecf20Sopenharmony_ci			return -ENOSR;
21768c2ecf20Sopenharmony_ci		}
21778c2ecf20Sopenharmony_ci	}
21788c2ecf20Sopenharmony_ci
21798c2ecf20Sopenharmony_ci	if (tst_entries == 0) {
21808c2ecf20Sopenharmony_ci		printk("%s: selected CBR bandwidth < granularity.\n",
21818c2ecf20Sopenharmony_ci		       card->name);
21828c2ecf20Sopenharmony_ci		return -EINVAL;
21838c2ecf20Sopenharmony_ci	}
21848c2ecf20Sopenharmony_ci
21858c2ecf20Sopenharmony_ci	if (tst_entries > (tst_free - SAR_TST_RESERVED)) {
21868c2ecf20Sopenharmony_ci		printk("%s: not enough CBR bandwidth free.\n", card->name);
21878c2ecf20Sopenharmony_ci		return -ENOSR;
21888c2ecf20Sopenharmony_ci	}
21898c2ecf20Sopenharmony_ci
21908c2ecf20Sopenharmony_ci	vc->ntste = tst_entries;
21918c2ecf20Sopenharmony_ci
21928c2ecf20Sopenharmony_ci	card->tst_free = tst_free - tst_entries;
21938c2ecf20Sopenharmony_ci	if (test_bit(VCF_TX, &vc->flags)) {
21948c2ecf20Sopenharmony_ci		if (tst_used == tst_entries)
21958c2ecf20Sopenharmony_ci			return 0;
21968c2ecf20Sopenharmony_ci
21978c2ecf20Sopenharmony_ci		OPRINTK("%s: modify %d -> %d entries in TST.\n",
21988c2ecf20Sopenharmony_ci			card->name, tst_used, tst_entries);
21998c2ecf20Sopenharmony_ci		change_tst(card, vc, tst_entries, TSTE_OPC_CBR);
22008c2ecf20Sopenharmony_ci		return 0;
22018c2ecf20Sopenharmony_ci	}
22028c2ecf20Sopenharmony_ci
22038c2ecf20Sopenharmony_ci	OPRINTK("%s: setting %d entries in TST.\n", card->name, tst_entries);
22048c2ecf20Sopenharmony_ci	fill_tst(card, vc, tst_entries, TSTE_OPC_CBR);
22058c2ecf20Sopenharmony_ci	return 0;
22068c2ecf20Sopenharmony_ci}
22078c2ecf20Sopenharmony_ci
22088c2ecf20Sopenharmony_cistatic int
22098c2ecf20Sopenharmony_ciidt77252_init_ubr(struct idt77252_dev *card, struct vc_map *vc,
22108c2ecf20Sopenharmony_ci		  struct atm_vcc *vcc, struct atm_qos *qos)
22118c2ecf20Sopenharmony_ci{
22128c2ecf20Sopenharmony_ci	struct rate_estimator *est = NULL;
22138c2ecf20Sopenharmony_ci	unsigned long flags;
22148c2ecf20Sopenharmony_ci	int tcr;
22158c2ecf20Sopenharmony_ci
22168c2ecf20Sopenharmony_ci	spin_lock_irqsave(&vc->lock, flags);
22178c2ecf20Sopenharmony_ci	if (vc->estimator) {
22188c2ecf20Sopenharmony_ci		est = vc->estimator;
22198c2ecf20Sopenharmony_ci		vc->estimator = NULL;
22208c2ecf20Sopenharmony_ci	}
22218c2ecf20Sopenharmony_ci	spin_unlock_irqrestore(&vc->lock, flags);
22228c2ecf20Sopenharmony_ci	if (est) {
22238c2ecf20Sopenharmony_ci		del_timer_sync(&est->timer);
22248c2ecf20Sopenharmony_ci		kfree(est);
22258c2ecf20Sopenharmony_ci	}
22268c2ecf20Sopenharmony_ci
22278c2ecf20Sopenharmony_ci	tcr = atm_pcr_goal(&qos->txtp);
22288c2ecf20Sopenharmony_ci	if (tcr == 0)
22298c2ecf20Sopenharmony_ci		tcr = card->link_pcr;
22308c2ecf20Sopenharmony_ci
22318c2ecf20Sopenharmony_ci	vc->estimator = idt77252_init_est(vc, tcr);
22328c2ecf20Sopenharmony_ci
22338c2ecf20Sopenharmony_ci	vc->class = SCHED_UBR;
22348c2ecf20Sopenharmony_ci	vc->init_er = idt77252_rate_logindex(card, tcr);
22358c2ecf20Sopenharmony_ci	vc->lacr = vc->init_er;
22368c2ecf20Sopenharmony_ci	if (tcr < 0)
22378c2ecf20Sopenharmony_ci		vc->max_er = vc->init_er;
22388c2ecf20Sopenharmony_ci	else
22398c2ecf20Sopenharmony_ci		vc->max_er = 0xff;
22408c2ecf20Sopenharmony_ci
22418c2ecf20Sopenharmony_ci	return 0;
22428c2ecf20Sopenharmony_ci}
22438c2ecf20Sopenharmony_ci
22448c2ecf20Sopenharmony_cistatic int
22458c2ecf20Sopenharmony_ciidt77252_init_tx(struct idt77252_dev *card, struct vc_map *vc,
22468c2ecf20Sopenharmony_ci		 struct atm_vcc *vcc, struct atm_qos *qos)
22478c2ecf20Sopenharmony_ci{
22488c2ecf20Sopenharmony_ci	int error;
22498c2ecf20Sopenharmony_ci
22508c2ecf20Sopenharmony_ci	if (test_bit(VCF_TX, &vc->flags))
22518c2ecf20Sopenharmony_ci		return -EBUSY;
22528c2ecf20Sopenharmony_ci
22538c2ecf20Sopenharmony_ci	switch (qos->txtp.traffic_class) {
22548c2ecf20Sopenharmony_ci		case ATM_CBR:
22558c2ecf20Sopenharmony_ci			vc->class = SCHED_CBR;
22568c2ecf20Sopenharmony_ci			break;
22578c2ecf20Sopenharmony_ci
22588c2ecf20Sopenharmony_ci		case ATM_UBR:
22598c2ecf20Sopenharmony_ci			vc->class = SCHED_UBR;
22608c2ecf20Sopenharmony_ci			break;
22618c2ecf20Sopenharmony_ci
22628c2ecf20Sopenharmony_ci		case ATM_VBR:
22638c2ecf20Sopenharmony_ci		case ATM_ABR:
22648c2ecf20Sopenharmony_ci		default:
22658c2ecf20Sopenharmony_ci			return -EPROTONOSUPPORT;
22668c2ecf20Sopenharmony_ci	}
22678c2ecf20Sopenharmony_ci
22688c2ecf20Sopenharmony_ci	vc->scq = alloc_scq(card, vc->class);
22698c2ecf20Sopenharmony_ci	if (!vc->scq) {
22708c2ecf20Sopenharmony_ci		printk("%s: can't get SCQ.\n", card->name);
22718c2ecf20Sopenharmony_ci		return -ENOMEM;
22728c2ecf20Sopenharmony_ci	}
22738c2ecf20Sopenharmony_ci
22748c2ecf20Sopenharmony_ci	vc->scq->scd = get_free_scd(card, vc);
22758c2ecf20Sopenharmony_ci	if (vc->scq->scd == 0) {
22768c2ecf20Sopenharmony_ci		printk("%s: no SCD available.\n", card->name);
22778c2ecf20Sopenharmony_ci		free_scq(card, vc->scq);
22788c2ecf20Sopenharmony_ci		return -ENOMEM;
22798c2ecf20Sopenharmony_ci	}
22808c2ecf20Sopenharmony_ci
22818c2ecf20Sopenharmony_ci	fill_scd(card, vc->scq, vc->class);
22828c2ecf20Sopenharmony_ci
22838c2ecf20Sopenharmony_ci	if (set_tct(card, vc)) {
22848c2ecf20Sopenharmony_ci		printk("%s: class %d not supported.\n",
22858c2ecf20Sopenharmony_ci		       card->name, qos->txtp.traffic_class);
22868c2ecf20Sopenharmony_ci
22878c2ecf20Sopenharmony_ci		card->scd2vc[vc->scd_index] = NULL;
22888c2ecf20Sopenharmony_ci		free_scq(card, vc->scq);
22898c2ecf20Sopenharmony_ci		return -EPROTONOSUPPORT;
22908c2ecf20Sopenharmony_ci	}
22918c2ecf20Sopenharmony_ci
22928c2ecf20Sopenharmony_ci	switch (vc->class) {
22938c2ecf20Sopenharmony_ci		case SCHED_CBR:
22948c2ecf20Sopenharmony_ci			error = idt77252_init_cbr(card, vc, vcc, qos);
22958c2ecf20Sopenharmony_ci			if (error) {
22968c2ecf20Sopenharmony_ci				card->scd2vc[vc->scd_index] = NULL;
22978c2ecf20Sopenharmony_ci				free_scq(card, vc->scq);
22988c2ecf20Sopenharmony_ci				return error;
22998c2ecf20Sopenharmony_ci			}
23008c2ecf20Sopenharmony_ci
23018c2ecf20Sopenharmony_ci			clear_bit(VCF_IDLE, &vc->flags);
23028c2ecf20Sopenharmony_ci			writel(TCMDQ_START | vc->index, SAR_REG_TCMDQ);
23038c2ecf20Sopenharmony_ci			break;
23048c2ecf20Sopenharmony_ci
23058c2ecf20Sopenharmony_ci		case SCHED_UBR:
23068c2ecf20Sopenharmony_ci			error = idt77252_init_ubr(card, vc, vcc, qos);
23078c2ecf20Sopenharmony_ci			if (error) {
23088c2ecf20Sopenharmony_ci				card->scd2vc[vc->scd_index] = NULL;
23098c2ecf20Sopenharmony_ci				free_scq(card, vc->scq);
23108c2ecf20Sopenharmony_ci				return error;
23118c2ecf20Sopenharmony_ci			}
23128c2ecf20Sopenharmony_ci
23138c2ecf20Sopenharmony_ci			set_bit(VCF_IDLE, &vc->flags);
23148c2ecf20Sopenharmony_ci			break;
23158c2ecf20Sopenharmony_ci	}
23168c2ecf20Sopenharmony_ci
23178c2ecf20Sopenharmony_ci	vc->tx_vcc = vcc;
23188c2ecf20Sopenharmony_ci	set_bit(VCF_TX, &vc->flags);
23198c2ecf20Sopenharmony_ci	return 0;
23208c2ecf20Sopenharmony_ci}
23218c2ecf20Sopenharmony_ci
23228c2ecf20Sopenharmony_cistatic int
23238c2ecf20Sopenharmony_ciidt77252_init_rx(struct idt77252_dev *card, struct vc_map *vc,
23248c2ecf20Sopenharmony_ci		 struct atm_vcc *vcc, struct atm_qos *qos)
23258c2ecf20Sopenharmony_ci{
23268c2ecf20Sopenharmony_ci	unsigned long flags;
23278c2ecf20Sopenharmony_ci	unsigned long addr;
23288c2ecf20Sopenharmony_ci	u32 rcte = 0;
23298c2ecf20Sopenharmony_ci
23308c2ecf20Sopenharmony_ci	if (test_bit(VCF_RX, &vc->flags))
23318c2ecf20Sopenharmony_ci		return -EBUSY;
23328c2ecf20Sopenharmony_ci
23338c2ecf20Sopenharmony_ci	vc->rx_vcc = vcc;
23348c2ecf20Sopenharmony_ci	set_bit(VCF_RX, &vc->flags);
23358c2ecf20Sopenharmony_ci
23368c2ecf20Sopenharmony_ci	if ((vcc->vci == 3) || (vcc->vci == 4))
23378c2ecf20Sopenharmony_ci		return 0;
23388c2ecf20Sopenharmony_ci
23398c2ecf20Sopenharmony_ci	flush_rx_pool(card, &vc->rcv.rx_pool);
23408c2ecf20Sopenharmony_ci
23418c2ecf20Sopenharmony_ci	rcte |= SAR_RCTE_CONNECTOPEN;
23428c2ecf20Sopenharmony_ci	rcte |= SAR_RCTE_RAWCELLINTEN;
23438c2ecf20Sopenharmony_ci
23448c2ecf20Sopenharmony_ci	switch (qos->aal) {
23458c2ecf20Sopenharmony_ci		case ATM_AAL0:
23468c2ecf20Sopenharmony_ci			rcte |= SAR_RCTE_RCQ;
23478c2ecf20Sopenharmony_ci			break;
23488c2ecf20Sopenharmony_ci		case ATM_AAL1:
23498c2ecf20Sopenharmony_ci			rcte |= SAR_RCTE_OAM; /* Let SAR drop Video */
23508c2ecf20Sopenharmony_ci			break;
23518c2ecf20Sopenharmony_ci		case ATM_AAL34:
23528c2ecf20Sopenharmony_ci			rcte |= SAR_RCTE_AAL34;
23538c2ecf20Sopenharmony_ci			break;
23548c2ecf20Sopenharmony_ci		case ATM_AAL5:
23558c2ecf20Sopenharmony_ci			rcte |= SAR_RCTE_AAL5;
23568c2ecf20Sopenharmony_ci			break;
23578c2ecf20Sopenharmony_ci		default:
23588c2ecf20Sopenharmony_ci			rcte |= SAR_RCTE_RCQ;
23598c2ecf20Sopenharmony_ci			break;
23608c2ecf20Sopenharmony_ci	}
23618c2ecf20Sopenharmony_ci
23628c2ecf20Sopenharmony_ci	if (qos->aal != ATM_AAL5)
23638c2ecf20Sopenharmony_ci		rcte |= SAR_RCTE_FBP_1;
23648c2ecf20Sopenharmony_ci	else if (qos->rxtp.max_sdu > SAR_FB_SIZE_2)
23658c2ecf20Sopenharmony_ci		rcte |= SAR_RCTE_FBP_3;
23668c2ecf20Sopenharmony_ci	else if (qos->rxtp.max_sdu > SAR_FB_SIZE_1)
23678c2ecf20Sopenharmony_ci		rcte |= SAR_RCTE_FBP_2;
23688c2ecf20Sopenharmony_ci	else if (qos->rxtp.max_sdu > SAR_FB_SIZE_0)
23698c2ecf20Sopenharmony_ci		rcte |= SAR_RCTE_FBP_1;
23708c2ecf20Sopenharmony_ci	else
23718c2ecf20Sopenharmony_ci		rcte |= SAR_RCTE_FBP_01;
23728c2ecf20Sopenharmony_ci
23738c2ecf20Sopenharmony_ci	addr = card->rct_base + (vc->index << 2);
23748c2ecf20Sopenharmony_ci
23758c2ecf20Sopenharmony_ci	OPRINTK("%s: writing RCT at 0x%lx\n", card->name, addr);
23768c2ecf20Sopenharmony_ci	write_sram(card, addr, rcte);
23778c2ecf20Sopenharmony_ci
23788c2ecf20Sopenharmony_ci	spin_lock_irqsave(&card->cmd_lock, flags);
23798c2ecf20Sopenharmony_ci	writel(SAR_CMD_OPEN_CONNECTION | (addr << 2), SAR_REG_CMD);
23808c2ecf20Sopenharmony_ci	waitfor_idle(card);
23818c2ecf20Sopenharmony_ci	spin_unlock_irqrestore(&card->cmd_lock, flags);
23828c2ecf20Sopenharmony_ci
23838c2ecf20Sopenharmony_ci	return 0;
23848c2ecf20Sopenharmony_ci}
23858c2ecf20Sopenharmony_ci
23868c2ecf20Sopenharmony_cistatic int
23878c2ecf20Sopenharmony_ciidt77252_open(struct atm_vcc *vcc)
23888c2ecf20Sopenharmony_ci{
23898c2ecf20Sopenharmony_ci	struct atm_dev *dev = vcc->dev;
23908c2ecf20Sopenharmony_ci	struct idt77252_dev *card = dev->dev_data;
23918c2ecf20Sopenharmony_ci	struct vc_map *vc;
23928c2ecf20Sopenharmony_ci	unsigned int index;
23938c2ecf20Sopenharmony_ci	unsigned int inuse;
23948c2ecf20Sopenharmony_ci	int error;
23958c2ecf20Sopenharmony_ci	int vci = vcc->vci;
23968c2ecf20Sopenharmony_ci	short vpi = vcc->vpi;
23978c2ecf20Sopenharmony_ci
23988c2ecf20Sopenharmony_ci	if (vpi == ATM_VPI_UNSPEC || vci == ATM_VCI_UNSPEC)
23998c2ecf20Sopenharmony_ci		return 0;
24008c2ecf20Sopenharmony_ci
24018c2ecf20Sopenharmony_ci	if (vpi >= (1 << card->vpibits)) {
24028c2ecf20Sopenharmony_ci		printk("%s: unsupported VPI: %d\n", card->name, vpi);
24038c2ecf20Sopenharmony_ci		return -EINVAL;
24048c2ecf20Sopenharmony_ci	}
24058c2ecf20Sopenharmony_ci
24068c2ecf20Sopenharmony_ci	if (vci >= (1 << card->vcibits)) {
24078c2ecf20Sopenharmony_ci		printk("%s: unsupported VCI: %d\n", card->name, vci);
24088c2ecf20Sopenharmony_ci		return -EINVAL;
24098c2ecf20Sopenharmony_ci	}
24108c2ecf20Sopenharmony_ci
24118c2ecf20Sopenharmony_ci	set_bit(ATM_VF_ADDR, &vcc->flags);
24128c2ecf20Sopenharmony_ci
24138c2ecf20Sopenharmony_ci	mutex_lock(&card->mutex);
24148c2ecf20Sopenharmony_ci
24158c2ecf20Sopenharmony_ci	OPRINTK("%s: opening vpi.vci: %d.%d\n", card->name, vpi, vci);
24168c2ecf20Sopenharmony_ci
24178c2ecf20Sopenharmony_ci	switch (vcc->qos.aal) {
24188c2ecf20Sopenharmony_ci	case ATM_AAL0:
24198c2ecf20Sopenharmony_ci	case ATM_AAL1:
24208c2ecf20Sopenharmony_ci	case ATM_AAL5:
24218c2ecf20Sopenharmony_ci		break;
24228c2ecf20Sopenharmony_ci	default:
24238c2ecf20Sopenharmony_ci		printk("%s: Unsupported AAL: %d\n", card->name, vcc->qos.aal);
24248c2ecf20Sopenharmony_ci		mutex_unlock(&card->mutex);
24258c2ecf20Sopenharmony_ci		return -EPROTONOSUPPORT;
24268c2ecf20Sopenharmony_ci	}
24278c2ecf20Sopenharmony_ci
24288c2ecf20Sopenharmony_ci	index = VPCI2VC(card, vpi, vci);
24298c2ecf20Sopenharmony_ci	if (!card->vcs[index]) {
24308c2ecf20Sopenharmony_ci		card->vcs[index] = kzalloc(sizeof(struct vc_map), GFP_KERNEL);
24318c2ecf20Sopenharmony_ci		if (!card->vcs[index]) {
24328c2ecf20Sopenharmony_ci			printk("%s: can't alloc vc in open()\n", card->name);
24338c2ecf20Sopenharmony_ci			mutex_unlock(&card->mutex);
24348c2ecf20Sopenharmony_ci			return -ENOMEM;
24358c2ecf20Sopenharmony_ci		}
24368c2ecf20Sopenharmony_ci		card->vcs[index]->card = card;
24378c2ecf20Sopenharmony_ci		card->vcs[index]->index = index;
24388c2ecf20Sopenharmony_ci
24398c2ecf20Sopenharmony_ci		spin_lock_init(&card->vcs[index]->lock);
24408c2ecf20Sopenharmony_ci	}
24418c2ecf20Sopenharmony_ci	vc = card->vcs[index];
24428c2ecf20Sopenharmony_ci
24438c2ecf20Sopenharmony_ci	vcc->dev_data = vc;
24448c2ecf20Sopenharmony_ci
24458c2ecf20Sopenharmony_ci	IPRINTK("%s: idt77252_open: vc = %d (%d.%d) %s/%s (max RX SDU: %u)\n",
24468c2ecf20Sopenharmony_ci	        card->name, vc->index, vcc->vpi, vcc->vci,
24478c2ecf20Sopenharmony_ci	        vcc->qos.rxtp.traffic_class != ATM_NONE ? "rx" : "--",
24488c2ecf20Sopenharmony_ci	        vcc->qos.txtp.traffic_class != ATM_NONE ? "tx" : "--",
24498c2ecf20Sopenharmony_ci	        vcc->qos.rxtp.max_sdu);
24508c2ecf20Sopenharmony_ci
24518c2ecf20Sopenharmony_ci	inuse = 0;
24528c2ecf20Sopenharmony_ci	if (vcc->qos.txtp.traffic_class != ATM_NONE &&
24538c2ecf20Sopenharmony_ci	    test_bit(VCF_TX, &vc->flags))
24548c2ecf20Sopenharmony_ci		inuse = 1;
24558c2ecf20Sopenharmony_ci	if (vcc->qos.rxtp.traffic_class != ATM_NONE &&
24568c2ecf20Sopenharmony_ci	    test_bit(VCF_RX, &vc->flags))
24578c2ecf20Sopenharmony_ci		inuse += 2;
24588c2ecf20Sopenharmony_ci
24598c2ecf20Sopenharmony_ci	if (inuse) {
24608c2ecf20Sopenharmony_ci		printk("%s: %s vci already in use.\n", card->name,
24618c2ecf20Sopenharmony_ci		       inuse == 1 ? "tx" : inuse == 2 ? "rx" : "tx and rx");
24628c2ecf20Sopenharmony_ci		mutex_unlock(&card->mutex);
24638c2ecf20Sopenharmony_ci		return -EADDRINUSE;
24648c2ecf20Sopenharmony_ci	}
24658c2ecf20Sopenharmony_ci
24668c2ecf20Sopenharmony_ci	if (vcc->qos.txtp.traffic_class != ATM_NONE) {
24678c2ecf20Sopenharmony_ci		error = idt77252_init_tx(card, vc, vcc, &vcc->qos);
24688c2ecf20Sopenharmony_ci		if (error) {
24698c2ecf20Sopenharmony_ci			mutex_unlock(&card->mutex);
24708c2ecf20Sopenharmony_ci			return error;
24718c2ecf20Sopenharmony_ci		}
24728c2ecf20Sopenharmony_ci	}
24738c2ecf20Sopenharmony_ci
24748c2ecf20Sopenharmony_ci	if (vcc->qos.rxtp.traffic_class != ATM_NONE) {
24758c2ecf20Sopenharmony_ci		error = idt77252_init_rx(card, vc, vcc, &vcc->qos);
24768c2ecf20Sopenharmony_ci		if (error) {
24778c2ecf20Sopenharmony_ci			mutex_unlock(&card->mutex);
24788c2ecf20Sopenharmony_ci			return error;
24798c2ecf20Sopenharmony_ci		}
24808c2ecf20Sopenharmony_ci	}
24818c2ecf20Sopenharmony_ci
24828c2ecf20Sopenharmony_ci	set_bit(ATM_VF_READY, &vcc->flags);
24838c2ecf20Sopenharmony_ci
24848c2ecf20Sopenharmony_ci	mutex_unlock(&card->mutex);
24858c2ecf20Sopenharmony_ci	return 0;
24868c2ecf20Sopenharmony_ci}
24878c2ecf20Sopenharmony_ci
24888c2ecf20Sopenharmony_cistatic void
24898c2ecf20Sopenharmony_ciidt77252_close(struct atm_vcc *vcc)
24908c2ecf20Sopenharmony_ci{
24918c2ecf20Sopenharmony_ci	struct atm_dev *dev = vcc->dev;
24928c2ecf20Sopenharmony_ci	struct idt77252_dev *card = dev->dev_data;
24938c2ecf20Sopenharmony_ci	struct vc_map *vc = vcc->dev_data;
24948c2ecf20Sopenharmony_ci	unsigned long flags;
24958c2ecf20Sopenharmony_ci	unsigned long addr;
24968c2ecf20Sopenharmony_ci	unsigned long timeout;
24978c2ecf20Sopenharmony_ci
24988c2ecf20Sopenharmony_ci	mutex_lock(&card->mutex);
24998c2ecf20Sopenharmony_ci
25008c2ecf20Sopenharmony_ci	IPRINTK("%s: idt77252_close: vc = %d (%d.%d)\n",
25018c2ecf20Sopenharmony_ci		card->name, vc->index, vcc->vpi, vcc->vci);
25028c2ecf20Sopenharmony_ci
25038c2ecf20Sopenharmony_ci	clear_bit(ATM_VF_READY, &vcc->flags);
25048c2ecf20Sopenharmony_ci
25058c2ecf20Sopenharmony_ci	if (vcc->qos.rxtp.traffic_class != ATM_NONE) {
25068c2ecf20Sopenharmony_ci
25078c2ecf20Sopenharmony_ci		spin_lock_irqsave(&vc->lock, flags);
25088c2ecf20Sopenharmony_ci		clear_bit(VCF_RX, &vc->flags);
25098c2ecf20Sopenharmony_ci		vc->rx_vcc = NULL;
25108c2ecf20Sopenharmony_ci		spin_unlock_irqrestore(&vc->lock, flags);
25118c2ecf20Sopenharmony_ci
25128c2ecf20Sopenharmony_ci		if ((vcc->vci == 3) || (vcc->vci == 4))
25138c2ecf20Sopenharmony_ci			goto done;
25148c2ecf20Sopenharmony_ci
25158c2ecf20Sopenharmony_ci		addr = card->rct_base + vc->index * SAR_SRAM_RCT_SIZE;
25168c2ecf20Sopenharmony_ci
25178c2ecf20Sopenharmony_ci		spin_lock_irqsave(&card->cmd_lock, flags);
25188c2ecf20Sopenharmony_ci		writel(SAR_CMD_CLOSE_CONNECTION | (addr << 2), SAR_REG_CMD);
25198c2ecf20Sopenharmony_ci		waitfor_idle(card);
25208c2ecf20Sopenharmony_ci		spin_unlock_irqrestore(&card->cmd_lock, flags);
25218c2ecf20Sopenharmony_ci
25228c2ecf20Sopenharmony_ci		if (skb_queue_len(&vc->rcv.rx_pool.queue) != 0) {
25238c2ecf20Sopenharmony_ci			DPRINTK("%s: closing a VC with pending rx buffers.\n",
25248c2ecf20Sopenharmony_ci				card->name);
25258c2ecf20Sopenharmony_ci
25268c2ecf20Sopenharmony_ci			recycle_rx_pool_skb(card, &vc->rcv.rx_pool);
25278c2ecf20Sopenharmony_ci		}
25288c2ecf20Sopenharmony_ci	}
25298c2ecf20Sopenharmony_ci
25308c2ecf20Sopenharmony_cidone:
25318c2ecf20Sopenharmony_ci	if (vcc->qos.txtp.traffic_class != ATM_NONE) {
25328c2ecf20Sopenharmony_ci
25338c2ecf20Sopenharmony_ci		spin_lock_irqsave(&vc->lock, flags);
25348c2ecf20Sopenharmony_ci		clear_bit(VCF_TX, &vc->flags);
25358c2ecf20Sopenharmony_ci		clear_bit(VCF_IDLE, &vc->flags);
25368c2ecf20Sopenharmony_ci		clear_bit(VCF_RSV, &vc->flags);
25378c2ecf20Sopenharmony_ci		vc->tx_vcc = NULL;
25388c2ecf20Sopenharmony_ci
25398c2ecf20Sopenharmony_ci		if (vc->estimator) {
25408c2ecf20Sopenharmony_ci			del_timer(&vc->estimator->timer);
25418c2ecf20Sopenharmony_ci			kfree(vc->estimator);
25428c2ecf20Sopenharmony_ci			vc->estimator = NULL;
25438c2ecf20Sopenharmony_ci		}
25448c2ecf20Sopenharmony_ci		spin_unlock_irqrestore(&vc->lock, flags);
25458c2ecf20Sopenharmony_ci
25468c2ecf20Sopenharmony_ci		timeout = 5 * 1000;
25478c2ecf20Sopenharmony_ci		while (atomic_read(&vc->scq->used) > 0) {
25488c2ecf20Sopenharmony_ci			timeout = msleep_interruptible(timeout);
25498c2ecf20Sopenharmony_ci			if (!timeout) {
25508c2ecf20Sopenharmony_ci				pr_warn("%s: SCQ drain timeout: %u used\n",
25518c2ecf20Sopenharmony_ci					card->name, atomic_read(&vc->scq->used));
25528c2ecf20Sopenharmony_ci				break;
25538c2ecf20Sopenharmony_ci			}
25548c2ecf20Sopenharmony_ci		}
25558c2ecf20Sopenharmony_ci
25568c2ecf20Sopenharmony_ci		writel(TCMDQ_HALT | vc->index, SAR_REG_TCMDQ);
25578c2ecf20Sopenharmony_ci		clear_scd(card, vc->scq, vc->class);
25588c2ecf20Sopenharmony_ci
25598c2ecf20Sopenharmony_ci		if (vc->class == SCHED_CBR) {
25608c2ecf20Sopenharmony_ci			clear_tst(card, vc);
25618c2ecf20Sopenharmony_ci			card->tst_free += vc->ntste;
25628c2ecf20Sopenharmony_ci			vc->ntste = 0;
25638c2ecf20Sopenharmony_ci		}
25648c2ecf20Sopenharmony_ci
25658c2ecf20Sopenharmony_ci		card->scd2vc[vc->scd_index] = NULL;
25668c2ecf20Sopenharmony_ci		free_scq(card, vc->scq);
25678c2ecf20Sopenharmony_ci	}
25688c2ecf20Sopenharmony_ci
25698c2ecf20Sopenharmony_ci	mutex_unlock(&card->mutex);
25708c2ecf20Sopenharmony_ci}
25718c2ecf20Sopenharmony_ci
25728c2ecf20Sopenharmony_cistatic int
25738c2ecf20Sopenharmony_ciidt77252_change_qos(struct atm_vcc *vcc, struct atm_qos *qos, int flags)
25748c2ecf20Sopenharmony_ci{
25758c2ecf20Sopenharmony_ci	struct atm_dev *dev = vcc->dev;
25768c2ecf20Sopenharmony_ci	struct idt77252_dev *card = dev->dev_data;
25778c2ecf20Sopenharmony_ci	struct vc_map *vc = vcc->dev_data;
25788c2ecf20Sopenharmony_ci	int error = 0;
25798c2ecf20Sopenharmony_ci
25808c2ecf20Sopenharmony_ci	mutex_lock(&card->mutex);
25818c2ecf20Sopenharmony_ci
25828c2ecf20Sopenharmony_ci	if (qos->txtp.traffic_class != ATM_NONE) {
25838c2ecf20Sopenharmony_ci	    	if (!test_bit(VCF_TX, &vc->flags)) {
25848c2ecf20Sopenharmony_ci			error = idt77252_init_tx(card, vc, vcc, qos);
25858c2ecf20Sopenharmony_ci			if (error)
25868c2ecf20Sopenharmony_ci				goto out;
25878c2ecf20Sopenharmony_ci		} else {
25888c2ecf20Sopenharmony_ci			switch (qos->txtp.traffic_class) {
25898c2ecf20Sopenharmony_ci			case ATM_CBR:
25908c2ecf20Sopenharmony_ci				error = idt77252_init_cbr(card, vc, vcc, qos);
25918c2ecf20Sopenharmony_ci				if (error)
25928c2ecf20Sopenharmony_ci					goto out;
25938c2ecf20Sopenharmony_ci				break;
25948c2ecf20Sopenharmony_ci
25958c2ecf20Sopenharmony_ci			case ATM_UBR:
25968c2ecf20Sopenharmony_ci				error = idt77252_init_ubr(card, vc, vcc, qos);
25978c2ecf20Sopenharmony_ci				if (error)
25988c2ecf20Sopenharmony_ci					goto out;
25998c2ecf20Sopenharmony_ci
26008c2ecf20Sopenharmony_ci				if (!test_bit(VCF_IDLE, &vc->flags)) {
26018c2ecf20Sopenharmony_ci					writel(TCMDQ_LACR | (vc->lacr << 16) |
26028c2ecf20Sopenharmony_ci					       vc->index, SAR_REG_TCMDQ);
26038c2ecf20Sopenharmony_ci				}
26048c2ecf20Sopenharmony_ci				break;
26058c2ecf20Sopenharmony_ci
26068c2ecf20Sopenharmony_ci			case ATM_VBR:
26078c2ecf20Sopenharmony_ci			case ATM_ABR:
26088c2ecf20Sopenharmony_ci				error = -EOPNOTSUPP;
26098c2ecf20Sopenharmony_ci				goto out;
26108c2ecf20Sopenharmony_ci			}
26118c2ecf20Sopenharmony_ci		}
26128c2ecf20Sopenharmony_ci	}
26138c2ecf20Sopenharmony_ci
26148c2ecf20Sopenharmony_ci	if ((qos->rxtp.traffic_class != ATM_NONE) &&
26158c2ecf20Sopenharmony_ci	    !test_bit(VCF_RX, &vc->flags)) {
26168c2ecf20Sopenharmony_ci		error = idt77252_init_rx(card, vc, vcc, qos);
26178c2ecf20Sopenharmony_ci		if (error)
26188c2ecf20Sopenharmony_ci			goto out;
26198c2ecf20Sopenharmony_ci	}
26208c2ecf20Sopenharmony_ci
26218c2ecf20Sopenharmony_ci	memcpy(&vcc->qos, qos, sizeof(struct atm_qos));
26228c2ecf20Sopenharmony_ci
26238c2ecf20Sopenharmony_ci	set_bit(ATM_VF_HASQOS, &vcc->flags);
26248c2ecf20Sopenharmony_ci
26258c2ecf20Sopenharmony_ciout:
26268c2ecf20Sopenharmony_ci	mutex_unlock(&card->mutex);
26278c2ecf20Sopenharmony_ci	return error;
26288c2ecf20Sopenharmony_ci}
26298c2ecf20Sopenharmony_ci
26308c2ecf20Sopenharmony_cistatic int
26318c2ecf20Sopenharmony_ciidt77252_proc_read(struct atm_dev *dev, loff_t * pos, char *page)
26328c2ecf20Sopenharmony_ci{
26338c2ecf20Sopenharmony_ci	struct idt77252_dev *card = dev->dev_data;
26348c2ecf20Sopenharmony_ci	int i, left;
26358c2ecf20Sopenharmony_ci
26368c2ecf20Sopenharmony_ci	left = (int) *pos;
26378c2ecf20Sopenharmony_ci	if (!left--)
26388c2ecf20Sopenharmony_ci		return sprintf(page, "IDT77252 Interrupts:\n");
26398c2ecf20Sopenharmony_ci	if (!left--)
26408c2ecf20Sopenharmony_ci		return sprintf(page, "TSIF:  %lu\n", card->irqstat[15]);
26418c2ecf20Sopenharmony_ci	if (!left--)
26428c2ecf20Sopenharmony_ci		return sprintf(page, "TXICP: %lu\n", card->irqstat[14]);
26438c2ecf20Sopenharmony_ci	if (!left--)
26448c2ecf20Sopenharmony_ci		return sprintf(page, "TSQF:  %lu\n", card->irqstat[12]);
26458c2ecf20Sopenharmony_ci	if (!left--)
26468c2ecf20Sopenharmony_ci		return sprintf(page, "TMROF: %lu\n", card->irqstat[11]);
26478c2ecf20Sopenharmony_ci	if (!left--)
26488c2ecf20Sopenharmony_ci		return sprintf(page, "PHYI:  %lu\n", card->irqstat[10]);
26498c2ecf20Sopenharmony_ci	if (!left--)
26508c2ecf20Sopenharmony_ci		return sprintf(page, "FBQ3A: %lu\n", card->irqstat[8]);
26518c2ecf20Sopenharmony_ci	if (!left--)
26528c2ecf20Sopenharmony_ci		return sprintf(page, "FBQ2A: %lu\n", card->irqstat[7]);
26538c2ecf20Sopenharmony_ci	if (!left--)
26548c2ecf20Sopenharmony_ci		return sprintf(page, "RSQF:  %lu\n", card->irqstat[6]);
26558c2ecf20Sopenharmony_ci	if (!left--)
26568c2ecf20Sopenharmony_ci		return sprintf(page, "EPDU:  %lu\n", card->irqstat[5]);
26578c2ecf20Sopenharmony_ci	if (!left--)
26588c2ecf20Sopenharmony_ci		return sprintf(page, "RAWCF: %lu\n", card->irqstat[4]);
26598c2ecf20Sopenharmony_ci	if (!left--)
26608c2ecf20Sopenharmony_ci		return sprintf(page, "FBQ1A: %lu\n", card->irqstat[3]);
26618c2ecf20Sopenharmony_ci	if (!left--)
26628c2ecf20Sopenharmony_ci		return sprintf(page, "FBQ0A: %lu\n", card->irqstat[2]);
26638c2ecf20Sopenharmony_ci	if (!left--)
26648c2ecf20Sopenharmony_ci		return sprintf(page, "RSQAF: %lu\n", card->irqstat[1]);
26658c2ecf20Sopenharmony_ci	if (!left--)
26668c2ecf20Sopenharmony_ci		return sprintf(page, "IDT77252 Transmit Connection Table:\n");
26678c2ecf20Sopenharmony_ci
26688c2ecf20Sopenharmony_ci	for (i = 0; i < card->tct_size; i++) {
26698c2ecf20Sopenharmony_ci		unsigned long tct;
26708c2ecf20Sopenharmony_ci		struct atm_vcc *vcc;
26718c2ecf20Sopenharmony_ci		struct vc_map *vc;
26728c2ecf20Sopenharmony_ci		char *p;
26738c2ecf20Sopenharmony_ci
26748c2ecf20Sopenharmony_ci		vc = card->vcs[i];
26758c2ecf20Sopenharmony_ci		if (!vc)
26768c2ecf20Sopenharmony_ci			continue;
26778c2ecf20Sopenharmony_ci
26788c2ecf20Sopenharmony_ci		vcc = NULL;
26798c2ecf20Sopenharmony_ci		if (vc->tx_vcc)
26808c2ecf20Sopenharmony_ci			vcc = vc->tx_vcc;
26818c2ecf20Sopenharmony_ci		if (!vcc)
26828c2ecf20Sopenharmony_ci			continue;
26838c2ecf20Sopenharmony_ci		if (left--)
26848c2ecf20Sopenharmony_ci			continue;
26858c2ecf20Sopenharmony_ci
26868c2ecf20Sopenharmony_ci		p = page;
26878c2ecf20Sopenharmony_ci		p += sprintf(p, "  %4u: %u.%u: ", i, vcc->vpi, vcc->vci);
26888c2ecf20Sopenharmony_ci		tct = (unsigned long) (card->tct_base + i * SAR_SRAM_TCT_SIZE);
26898c2ecf20Sopenharmony_ci
26908c2ecf20Sopenharmony_ci		for (i = 0; i < 8; i++)
26918c2ecf20Sopenharmony_ci			p += sprintf(p, " %08x", read_sram(card, tct + i));
26928c2ecf20Sopenharmony_ci		p += sprintf(p, "\n");
26938c2ecf20Sopenharmony_ci		return p - page;
26948c2ecf20Sopenharmony_ci	}
26958c2ecf20Sopenharmony_ci	return 0;
26968c2ecf20Sopenharmony_ci}
26978c2ecf20Sopenharmony_ci
26988c2ecf20Sopenharmony_ci/*****************************************************************************/
26998c2ecf20Sopenharmony_ci/*                                                                           */
27008c2ecf20Sopenharmony_ci/* Interrupt handler                                                         */
27018c2ecf20Sopenharmony_ci/*                                                                           */
27028c2ecf20Sopenharmony_ci/*****************************************************************************/
27038c2ecf20Sopenharmony_ci
27048c2ecf20Sopenharmony_cistatic void
27058c2ecf20Sopenharmony_ciidt77252_collect_stat(struct idt77252_dev *card)
27068c2ecf20Sopenharmony_ci{
27078c2ecf20Sopenharmony_ci	(void) readl(SAR_REG_CDC);
27088c2ecf20Sopenharmony_ci	(void) readl(SAR_REG_VPEC);
27098c2ecf20Sopenharmony_ci	(void) readl(SAR_REG_ICC);
27108c2ecf20Sopenharmony_ci
27118c2ecf20Sopenharmony_ci}
27128c2ecf20Sopenharmony_ci
27138c2ecf20Sopenharmony_cistatic irqreturn_t
27148c2ecf20Sopenharmony_ciidt77252_interrupt(int irq, void *dev_id)
27158c2ecf20Sopenharmony_ci{
27168c2ecf20Sopenharmony_ci	struct idt77252_dev *card = dev_id;
27178c2ecf20Sopenharmony_ci	u32 stat;
27188c2ecf20Sopenharmony_ci
27198c2ecf20Sopenharmony_ci	stat = readl(SAR_REG_STAT) & 0xffff;
27208c2ecf20Sopenharmony_ci	if (!stat)	/* no interrupt for us */
27218c2ecf20Sopenharmony_ci		return IRQ_NONE;
27228c2ecf20Sopenharmony_ci
27238c2ecf20Sopenharmony_ci	if (test_and_set_bit(IDT77252_BIT_INTERRUPT, &card->flags)) {
27248c2ecf20Sopenharmony_ci		printk("%s: Re-entering irq_handler()\n", card->name);
27258c2ecf20Sopenharmony_ci		goto out;
27268c2ecf20Sopenharmony_ci	}
27278c2ecf20Sopenharmony_ci
27288c2ecf20Sopenharmony_ci	writel(stat, SAR_REG_STAT);	/* reset interrupt */
27298c2ecf20Sopenharmony_ci
27308c2ecf20Sopenharmony_ci	if (stat & SAR_STAT_TSIF) {	/* entry written to TSQ  */
27318c2ecf20Sopenharmony_ci		INTPRINTK("%s: TSIF\n", card->name);
27328c2ecf20Sopenharmony_ci		card->irqstat[15]++;
27338c2ecf20Sopenharmony_ci		idt77252_tx(card);
27348c2ecf20Sopenharmony_ci	}
27358c2ecf20Sopenharmony_ci	if (stat & SAR_STAT_TXICP) {	/* Incomplete CS-PDU has  */
27368c2ecf20Sopenharmony_ci		INTPRINTK("%s: TXICP\n", card->name);
27378c2ecf20Sopenharmony_ci		card->irqstat[14]++;
27388c2ecf20Sopenharmony_ci#ifdef CONFIG_ATM_IDT77252_DEBUG
27398c2ecf20Sopenharmony_ci		idt77252_tx_dump(card);
27408c2ecf20Sopenharmony_ci#endif
27418c2ecf20Sopenharmony_ci	}
27428c2ecf20Sopenharmony_ci	if (stat & SAR_STAT_TSQF) {	/* TSQ 7/8 full           */
27438c2ecf20Sopenharmony_ci		INTPRINTK("%s: TSQF\n", card->name);
27448c2ecf20Sopenharmony_ci		card->irqstat[12]++;
27458c2ecf20Sopenharmony_ci		idt77252_tx(card);
27468c2ecf20Sopenharmony_ci	}
27478c2ecf20Sopenharmony_ci	if (stat & SAR_STAT_TMROF) {	/* Timer overflow         */
27488c2ecf20Sopenharmony_ci		INTPRINTK("%s: TMROF\n", card->name);
27498c2ecf20Sopenharmony_ci		card->irqstat[11]++;
27508c2ecf20Sopenharmony_ci		idt77252_collect_stat(card);
27518c2ecf20Sopenharmony_ci	}
27528c2ecf20Sopenharmony_ci
27538c2ecf20Sopenharmony_ci	if (stat & SAR_STAT_EPDU) {	/* Got complete CS-PDU    */
27548c2ecf20Sopenharmony_ci		INTPRINTK("%s: EPDU\n", card->name);
27558c2ecf20Sopenharmony_ci		card->irqstat[5]++;
27568c2ecf20Sopenharmony_ci		idt77252_rx(card);
27578c2ecf20Sopenharmony_ci	}
27588c2ecf20Sopenharmony_ci	if (stat & SAR_STAT_RSQAF) {	/* RSQ is 7/8 full        */
27598c2ecf20Sopenharmony_ci		INTPRINTK("%s: RSQAF\n", card->name);
27608c2ecf20Sopenharmony_ci		card->irqstat[1]++;
27618c2ecf20Sopenharmony_ci		idt77252_rx(card);
27628c2ecf20Sopenharmony_ci	}
27638c2ecf20Sopenharmony_ci	if (stat & SAR_STAT_RSQF) {	/* RSQ is full            */
27648c2ecf20Sopenharmony_ci		INTPRINTK("%s: RSQF\n", card->name);
27658c2ecf20Sopenharmony_ci		card->irqstat[6]++;
27668c2ecf20Sopenharmony_ci		idt77252_rx(card);
27678c2ecf20Sopenharmony_ci	}
27688c2ecf20Sopenharmony_ci	if (stat & SAR_STAT_RAWCF) {	/* Raw cell received      */
27698c2ecf20Sopenharmony_ci		INTPRINTK("%s: RAWCF\n", card->name);
27708c2ecf20Sopenharmony_ci		card->irqstat[4]++;
27718c2ecf20Sopenharmony_ci		idt77252_rx_raw(card);
27728c2ecf20Sopenharmony_ci	}
27738c2ecf20Sopenharmony_ci
27748c2ecf20Sopenharmony_ci	if (stat & SAR_STAT_PHYI) {	/* PHY device interrupt   */
27758c2ecf20Sopenharmony_ci		INTPRINTK("%s: PHYI", card->name);
27768c2ecf20Sopenharmony_ci		card->irqstat[10]++;
27778c2ecf20Sopenharmony_ci		if (card->atmdev->phy && card->atmdev->phy->interrupt)
27788c2ecf20Sopenharmony_ci			card->atmdev->phy->interrupt(card->atmdev);
27798c2ecf20Sopenharmony_ci	}
27808c2ecf20Sopenharmony_ci
27818c2ecf20Sopenharmony_ci	if (stat & (SAR_STAT_FBQ0A | SAR_STAT_FBQ1A |
27828c2ecf20Sopenharmony_ci		    SAR_STAT_FBQ2A | SAR_STAT_FBQ3A)) {
27838c2ecf20Sopenharmony_ci
27848c2ecf20Sopenharmony_ci		writel(readl(SAR_REG_CFG) & ~(SAR_CFG_FBIE), SAR_REG_CFG);
27858c2ecf20Sopenharmony_ci
27868c2ecf20Sopenharmony_ci		INTPRINTK("%s: FBQA: %04x\n", card->name, stat);
27878c2ecf20Sopenharmony_ci
27888c2ecf20Sopenharmony_ci		if (stat & SAR_STAT_FBQ0A)
27898c2ecf20Sopenharmony_ci			card->irqstat[2]++;
27908c2ecf20Sopenharmony_ci		if (stat & SAR_STAT_FBQ1A)
27918c2ecf20Sopenharmony_ci			card->irqstat[3]++;
27928c2ecf20Sopenharmony_ci		if (stat & SAR_STAT_FBQ2A)
27938c2ecf20Sopenharmony_ci			card->irqstat[7]++;
27948c2ecf20Sopenharmony_ci		if (stat & SAR_STAT_FBQ3A)
27958c2ecf20Sopenharmony_ci			card->irqstat[8]++;
27968c2ecf20Sopenharmony_ci
27978c2ecf20Sopenharmony_ci		schedule_work(&card->tqueue);
27988c2ecf20Sopenharmony_ci	}
27998c2ecf20Sopenharmony_ci
28008c2ecf20Sopenharmony_ciout:
28018c2ecf20Sopenharmony_ci	clear_bit(IDT77252_BIT_INTERRUPT, &card->flags);
28028c2ecf20Sopenharmony_ci	return IRQ_HANDLED;
28038c2ecf20Sopenharmony_ci}
28048c2ecf20Sopenharmony_ci
28058c2ecf20Sopenharmony_cistatic void
28068c2ecf20Sopenharmony_ciidt77252_softint(struct work_struct *work)
28078c2ecf20Sopenharmony_ci{
28088c2ecf20Sopenharmony_ci	struct idt77252_dev *card =
28098c2ecf20Sopenharmony_ci		container_of(work, struct idt77252_dev, tqueue);
28108c2ecf20Sopenharmony_ci	u32 stat;
28118c2ecf20Sopenharmony_ci	int done;
28128c2ecf20Sopenharmony_ci
28138c2ecf20Sopenharmony_ci	for (done = 1; ; done = 1) {
28148c2ecf20Sopenharmony_ci		stat = readl(SAR_REG_STAT) >> 16;
28158c2ecf20Sopenharmony_ci
28168c2ecf20Sopenharmony_ci		if ((stat & 0x0f) < SAR_FBQ0_HIGH) {
28178c2ecf20Sopenharmony_ci			add_rx_skb(card, 0, SAR_FB_SIZE_0, 32);
28188c2ecf20Sopenharmony_ci			done = 0;
28198c2ecf20Sopenharmony_ci		}
28208c2ecf20Sopenharmony_ci
28218c2ecf20Sopenharmony_ci		stat >>= 4;
28228c2ecf20Sopenharmony_ci		if ((stat & 0x0f) < SAR_FBQ1_HIGH) {
28238c2ecf20Sopenharmony_ci			add_rx_skb(card, 1, SAR_FB_SIZE_1, 32);
28248c2ecf20Sopenharmony_ci			done = 0;
28258c2ecf20Sopenharmony_ci		}
28268c2ecf20Sopenharmony_ci
28278c2ecf20Sopenharmony_ci		stat >>= 4;
28288c2ecf20Sopenharmony_ci		if ((stat & 0x0f) < SAR_FBQ2_HIGH) {
28298c2ecf20Sopenharmony_ci			add_rx_skb(card, 2, SAR_FB_SIZE_2, 32);
28308c2ecf20Sopenharmony_ci			done = 0;
28318c2ecf20Sopenharmony_ci		}
28328c2ecf20Sopenharmony_ci
28338c2ecf20Sopenharmony_ci		stat >>= 4;
28348c2ecf20Sopenharmony_ci		if ((stat & 0x0f) < SAR_FBQ3_HIGH) {
28358c2ecf20Sopenharmony_ci			add_rx_skb(card, 3, SAR_FB_SIZE_3, 32);
28368c2ecf20Sopenharmony_ci			done = 0;
28378c2ecf20Sopenharmony_ci		}
28388c2ecf20Sopenharmony_ci
28398c2ecf20Sopenharmony_ci		if (done)
28408c2ecf20Sopenharmony_ci			break;
28418c2ecf20Sopenharmony_ci	}
28428c2ecf20Sopenharmony_ci
28438c2ecf20Sopenharmony_ci	writel(readl(SAR_REG_CFG) | SAR_CFG_FBIE, SAR_REG_CFG);
28448c2ecf20Sopenharmony_ci}
28458c2ecf20Sopenharmony_ci
28468c2ecf20Sopenharmony_ci
28478c2ecf20Sopenharmony_cistatic int
28488c2ecf20Sopenharmony_ciopen_card_oam(struct idt77252_dev *card)
28498c2ecf20Sopenharmony_ci{
28508c2ecf20Sopenharmony_ci	unsigned long flags;
28518c2ecf20Sopenharmony_ci	unsigned long addr;
28528c2ecf20Sopenharmony_ci	struct vc_map *vc;
28538c2ecf20Sopenharmony_ci	int vpi, vci;
28548c2ecf20Sopenharmony_ci	int index;
28558c2ecf20Sopenharmony_ci	u32 rcte;
28568c2ecf20Sopenharmony_ci
28578c2ecf20Sopenharmony_ci	for (vpi = 0; vpi < (1 << card->vpibits); vpi++) {
28588c2ecf20Sopenharmony_ci		for (vci = 3; vci < 5; vci++) {
28598c2ecf20Sopenharmony_ci			index = VPCI2VC(card, vpi, vci);
28608c2ecf20Sopenharmony_ci
28618c2ecf20Sopenharmony_ci			vc = kzalloc(sizeof(struct vc_map), GFP_KERNEL);
28628c2ecf20Sopenharmony_ci			if (!vc) {
28638c2ecf20Sopenharmony_ci				printk("%s: can't alloc vc\n", card->name);
28648c2ecf20Sopenharmony_ci				return -ENOMEM;
28658c2ecf20Sopenharmony_ci			}
28668c2ecf20Sopenharmony_ci			vc->index = index;
28678c2ecf20Sopenharmony_ci			card->vcs[index] = vc;
28688c2ecf20Sopenharmony_ci
28698c2ecf20Sopenharmony_ci			flush_rx_pool(card, &vc->rcv.rx_pool);
28708c2ecf20Sopenharmony_ci
28718c2ecf20Sopenharmony_ci			rcte = SAR_RCTE_CONNECTOPEN |
28728c2ecf20Sopenharmony_ci			       SAR_RCTE_RAWCELLINTEN |
28738c2ecf20Sopenharmony_ci			       SAR_RCTE_RCQ |
28748c2ecf20Sopenharmony_ci			       SAR_RCTE_FBP_1;
28758c2ecf20Sopenharmony_ci
28768c2ecf20Sopenharmony_ci			addr = card->rct_base + (vc->index << 2);
28778c2ecf20Sopenharmony_ci			write_sram(card, addr, rcte);
28788c2ecf20Sopenharmony_ci
28798c2ecf20Sopenharmony_ci			spin_lock_irqsave(&card->cmd_lock, flags);
28808c2ecf20Sopenharmony_ci			writel(SAR_CMD_OPEN_CONNECTION | (addr << 2),
28818c2ecf20Sopenharmony_ci			       SAR_REG_CMD);
28828c2ecf20Sopenharmony_ci			waitfor_idle(card);
28838c2ecf20Sopenharmony_ci			spin_unlock_irqrestore(&card->cmd_lock, flags);
28848c2ecf20Sopenharmony_ci		}
28858c2ecf20Sopenharmony_ci	}
28868c2ecf20Sopenharmony_ci
28878c2ecf20Sopenharmony_ci	return 0;
28888c2ecf20Sopenharmony_ci}
28898c2ecf20Sopenharmony_ci
28908c2ecf20Sopenharmony_cistatic void
28918c2ecf20Sopenharmony_ciclose_card_oam(struct idt77252_dev *card)
28928c2ecf20Sopenharmony_ci{
28938c2ecf20Sopenharmony_ci	unsigned long flags;
28948c2ecf20Sopenharmony_ci	unsigned long addr;
28958c2ecf20Sopenharmony_ci	struct vc_map *vc;
28968c2ecf20Sopenharmony_ci	int vpi, vci;
28978c2ecf20Sopenharmony_ci	int index;
28988c2ecf20Sopenharmony_ci
28998c2ecf20Sopenharmony_ci	for (vpi = 0; vpi < (1 << card->vpibits); vpi++) {
29008c2ecf20Sopenharmony_ci		for (vci = 3; vci < 5; vci++) {
29018c2ecf20Sopenharmony_ci			index = VPCI2VC(card, vpi, vci);
29028c2ecf20Sopenharmony_ci			vc = card->vcs[index];
29038c2ecf20Sopenharmony_ci
29048c2ecf20Sopenharmony_ci			addr = card->rct_base + vc->index * SAR_SRAM_RCT_SIZE;
29058c2ecf20Sopenharmony_ci
29068c2ecf20Sopenharmony_ci			spin_lock_irqsave(&card->cmd_lock, flags);
29078c2ecf20Sopenharmony_ci			writel(SAR_CMD_CLOSE_CONNECTION | (addr << 2),
29088c2ecf20Sopenharmony_ci			       SAR_REG_CMD);
29098c2ecf20Sopenharmony_ci			waitfor_idle(card);
29108c2ecf20Sopenharmony_ci			spin_unlock_irqrestore(&card->cmd_lock, flags);
29118c2ecf20Sopenharmony_ci
29128c2ecf20Sopenharmony_ci			if (skb_queue_len(&vc->rcv.rx_pool.queue) != 0) {
29138c2ecf20Sopenharmony_ci				DPRINTK("%s: closing a VC "
29148c2ecf20Sopenharmony_ci					"with pending rx buffers.\n",
29158c2ecf20Sopenharmony_ci					card->name);
29168c2ecf20Sopenharmony_ci
29178c2ecf20Sopenharmony_ci				recycle_rx_pool_skb(card, &vc->rcv.rx_pool);
29188c2ecf20Sopenharmony_ci			}
29198c2ecf20Sopenharmony_ci			kfree(vc);
29208c2ecf20Sopenharmony_ci		}
29218c2ecf20Sopenharmony_ci	}
29228c2ecf20Sopenharmony_ci}
29238c2ecf20Sopenharmony_ci
29248c2ecf20Sopenharmony_cistatic int
29258c2ecf20Sopenharmony_ciopen_card_ubr0(struct idt77252_dev *card)
29268c2ecf20Sopenharmony_ci{
29278c2ecf20Sopenharmony_ci	struct vc_map *vc;
29288c2ecf20Sopenharmony_ci
29298c2ecf20Sopenharmony_ci	vc = kzalloc(sizeof(struct vc_map), GFP_KERNEL);
29308c2ecf20Sopenharmony_ci	if (!vc) {
29318c2ecf20Sopenharmony_ci		printk("%s: can't alloc vc\n", card->name);
29328c2ecf20Sopenharmony_ci		return -ENOMEM;
29338c2ecf20Sopenharmony_ci	}
29348c2ecf20Sopenharmony_ci	card->vcs[0] = vc;
29358c2ecf20Sopenharmony_ci	vc->class = SCHED_UBR0;
29368c2ecf20Sopenharmony_ci
29378c2ecf20Sopenharmony_ci	vc->scq = alloc_scq(card, vc->class);
29388c2ecf20Sopenharmony_ci	if (!vc->scq) {
29398c2ecf20Sopenharmony_ci		printk("%s: can't get SCQ.\n", card->name);
29408c2ecf20Sopenharmony_ci		kfree(card->vcs[0]);
29418c2ecf20Sopenharmony_ci		card->vcs[0] = NULL;
29428c2ecf20Sopenharmony_ci		return -ENOMEM;
29438c2ecf20Sopenharmony_ci	}
29448c2ecf20Sopenharmony_ci
29458c2ecf20Sopenharmony_ci	card->scd2vc[0] = vc;
29468c2ecf20Sopenharmony_ci	vc->scd_index = 0;
29478c2ecf20Sopenharmony_ci	vc->scq->scd = card->scd_base;
29488c2ecf20Sopenharmony_ci
29498c2ecf20Sopenharmony_ci	fill_scd(card, vc->scq, vc->class);
29508c2ecf20Sopenharmony_ci
29518c2ecf20Sopenharmony_ci	write_sram(card, card->tct_base + 0, TCT_UBR | card->scd_base);
29528c2ecf20Sopenharmony_ci	write_sram(card, card->tct_base + 1, 0);
29538c2ecf20Sopenharmony_ci	write_sram(card, card->tct_base + 2, 0);
29548c2ecf20Sopenharmony_ci	write_sram(card, card->tct_base + 3, 0);
29558c2ecf20Sopenharmony_ci	write_sram(card, card->tct_base + 4, 0);
29568c2ecf20Sopenharmony_ci	write_sram(card, card->tct_base + 5, 0);
29578c2ecf20Sopenharmony_ci	write_sram(card, card->tct_base + 6, 0);
29588c2ecf20Sopenharmony_ci	write_sram(card, card->tct_base + 7, TCT_FLAG_UBR);
29598c2ecf20Sopenharmony_ci
29608c2ecf20Sopenharmony_ci	clear_bit(VCF_IDLE, &vc->flags);
29618c2ecf20Sopenharmony_ci	writel(TCMDQ_START | 0, SAR_REG_TCMDQ);
29628c2ecf20Sopenharmony_ci	return 0;
29638c2ecf20Sopenharmony_ci}
29648c2ecf20Sopenharmony_ci
29658c2ecf20Sopenharmony_cistatic void
29668c2ecf20Sopenharmony_ciclose_card_ubr0(struct idt77252_dev *card)
29678c2ecf20Sopenharmony_ci{
29688c2ecf20Sopenharmony_ci	struct vc_map *vc = card->vcs[0];
29698c2ecf20Sopenharmony_ci
29708c2ecf20Sopenharmony_ci	free_scq(card, vc->scq);
29718c2ecf20Sopenharmony_ci	kfree(vc);
29728c2ecf20Sopenharmony_ci}
29738c2ecf20Sopenharmony_ci
29748c2ecf20Sopenharmony_cistatic int
29758c2ecf20Sopenharmony_ciidt77252_dev_open(struct idt77252_dev *card)
29768c2ecf20Sopenharmony_ci{
29778c2ecf20Sopenharmony_ci	u32 conf;
29788c2ecf20Sopenharmony_ci
29798c2ecf20Sopenharmony_ci	if (!test_bit(IDT77252_BIT_INIT, &card->flags)) {
29808c2ecf20Sopenharmony_ci		printk("%s: SAR not yet initialized.\n", card->name);
29818c2ecf20Sopenharmony_ci		return -1;
29828c2ecf20Sopenharmony_ci	}
29838c2ecf20Sopenharmony_ci
29848c2ecf20Sopenharmony_ci	conf = SAR_CFG_RXPTH|	/* enable receive path                  */
29858c2ecf20Sopenharmony_ci	    SAR_RX_DELAY |	/* interrupt on complete PDU		*/
29868c2ecf20Sopenharmony_ci	    SAR_CFG_RAWIE |	/* interrupt enable on raw cells        */
29878c2ecf20Sopenharmony_ci	    SAR_CFG_RQFIE |	/* interrupt on RSQ almost full         */
29888c2ecf20Sopenharmony_ci	    SAR_CFG_TMOIE |	/* interrupt on timer overflow          */
29898c2ecf20Sopenharmony_ci	    SAR_CFG_FBIE |	/* interrupt on low free buffers        */
29908c2ecf20Sopenharmony_ci	    SAR_CFG_TXEN |	/* transmit operation enable            */
29918c2ecf20Sopenharmony_ci	    SAR_CFG_TXINT |	/* interrupt on transmit status         */
29928c2ecf20Sopenharmony_ci	    SAR_CFG_TXUIE |	/* interrupt on transmit underrun       */
29938c2ecf20Sopenharmony_ci	    SAR_CFG_TXSFI |	/* interrupt on TSQ almost full         */
29948c2ecf20Sopenharmony_ci	    SAR_CFG_PHYIE	/* enable PHY interrupts		*/
29958c2ecf20Sopenharmony_ci	    ;
29968c2ecf20Sopenharmony_ci
29978c2ecf20Sopenharmony_ci#ifdef CONFIG_ATM_IDT77252_RCV_ALL
29988c2ecf20Sopenharmony_ci	/* Test RAW cell receive. */
29998c2ecf20Sopenharmony_ci	conf |= SAR_CFG_VPECA;
30008c2ecf20Sopenharmony_ci#endif
30018c2ecf20Sopenharmony_ci
30028c2ecf20Sopenharmony_ci	writel(readl(SAR_REG_CFG) | conf, SAR_REG_CFG);
30038c2ecf20Sopenharmony_ci
30048c2ecf20Sopenharmony_ci	if (open_card_oam(card)) {
30058c2ecf20Sopenharmony_ci		printk("%s: Error initializing OAM.\n", card->name);
30068c2ecf20Sopenharmony_ci		return -1;
30078c2ecf20Sopenharmony_ci	}
30088c2ecf20Sopenharmony_ci
30098c2ecf20Sopenharmony_ci	if (open_card_ubr0(card)) {
30108c2ecf20Sopenharmony_ci		printk("%s: Error initializing UBR0.\n", card->name);
30118c2ecf20Sopenharmony_ci		return -1;
30128c2ecf20Sopenharmony_ci	}
30138c2ecf20Sopenharmony_ci
30148c2ecf20Sopenharmony_ci	IPRINTK("%s: opened IDT77252 ABR SAR.\n", card->name);
30158c2ecf20Sopenharmony_ci	return 0;
30168c2ecf20Sopenharmony_ci}
30178c2ecf20Sopenharmony_ci
30188c2ecf20Sopenharmony_cistatic void idt77252_dev_close(struct atm_dev *dev)
30198c2ecf20Sopenharmony_ci{
30208c2ecf20Sopenharmony_ci	struct idt77252_dev *card = dev->dev_data;
30218c2ecf20Sopenharmony_ci	u32 conf;
30228c2ecf20Sopenharmony_ci
30238c2ecf20Sopenharmony_ci	close_card_ubr0(card);
30248c2ecf20Sopenharmony_ci	close_card_oam(card);
30258c2ecf20Sopenharmony_ci
30268c2ecf20Sopenharmony_ci	conf = SAR_CFG_RXPTH |	/* enable receive path           */
30278c2ecf20Sopenharmony_ci	    SAR_RX_DELAY |	/* interrupt on complete PDU     */
30288c2ecf20Sopenharmony_ci	    SAR_CFG_RAWIE |	/* interrupt enable on raw cells */
30298c2ecf20Sopenharmony_ci	    SAR_CFG_RQFIE |	/* interrupt on RSQ almost full  */
30308c2ecf20Sopenharmony_ci	    SAR_CFG_TMOIE |	/* interrupt on timer overflow   */
30318c2ecf20Sopenharmony_ci	    SAR_CFG_FBIE |	/* interrupt on low free buffers */
30328c2ecf20Sopenharmony_ci	    SAR_CFG_TXEN |	/* transmit operation enable     */
30338c2ecf20Sopenharmony_ci	    SAR_CFG_TXINT |	/* interrupt on transmit status  */
30348c2ecf20Sopenharmony_ci	    SAR_CFG_TXUIE |	/* interrupt on xmit underrun    */
30358c2ecf20Sopenharmony_ci	    SAR_CFG_TXSFI	/* interrupt on TSQ almost full  */
30368c2ecf20Sopenharmony_ci	    ;
30378c2ecf20Sopenharmony_ci
30388c2ecf20Sopenharmony_ci	writel(readl(SAR_REG_CFG) & ~(conf), SAR_REG_CFG);
30398c2ecf20Sopenharmony_ci
30408c2ecf20Sopenharmony_ci	DIPRINTK("%s: closed IDT77252 ABR SAR.\n", card->name);
30418c2ecf20Sopenharmony_ci}
30428c2ecf20Sopenharmony_ci
30438c2ecf20Sopenharmony_ci
30448c2ecf20Sopenharmony_ci/*****************************************************************************/
30458c2ecf20Sopenharmony_ci/*                                                                           */
30468c2ecf20Sopenharmony_ci/* Initialisation and Deinitialization of IDT77252                           */
30478c2ecf20Sopenharmony_ci/*                                                                           */
30488c2ecf20Sopenharmony_ci/*****************************************************************************/
30498c2ecf20Sopenharmony_ci
30508c2ecf20Sopenharmony_ci
30518c2ecf20Sopenharmony_cistatic void
30528c2ecf20Sopenharmony_cideinit_card(struct idt77252_dev *card)
30538c2ecf20Sopenharmony_ci{
30548c2ecf20Sopenharmony_ci	struct sk_buff *skb;
30558c2ecf20Sopenharmony_ci	int i, j;
30568c2ecf20Sopenharmony_ci
30578c2ecf20Sopenharmony_ci	if (!test_bit(IDT77252_BIT_INIT, &card->flags)) {
30588c2ecf20Sopenharmony_ci		printk("%s: SAR not yet initialized.\n", card->name);
30598c2ecf20Sopenharmony_ci		return;
30608c2ecf20Sopenharmony_ci	}
30618c2ecf20Sopenharmony_ci	DIPRINTK("idt77252: deinitialize card %u\n", card->index);
30628c2ecf20Sopenharmony_ci
30638c2ecf20Sopenharmony_ci	writel(0, SAR_REG_CFG);
30648c2ecf20Sopenharmony_ci
30658c2ecf20Sopenharmony_ci	if (card->atmdev)
30668c2ecf20Sopenharmony_ci		atm_dev_deregister(card->atmdev);
30678c2ecf20Sopenharmony_ci
30688c2ecf20Sopenharmony_ci	for (i = 0; i < 4; i++) {
30698c2ecf20Sopenharmony_ci		for (j = 0; j < FBQ_SIZE; j++) {
30708c2ecf20Sopenharmony_ci			skb = card->sbpool[i].skb[j];
30718c2ecf20Sopenharmony_ci			if (skb) {
30728c2ecf20Sopenharmony_ci				dma_unmap_single(&card->pcidev->dev,
30738c2ecf20Sopenharmony_ci						 IDT77252_PRV_PADDR(skb),
30748c2ecf20Sopenharmony_ci						 (skb_end_pointer(skb) -
30758c2ecf20Sopenharmony_ci						  skb->data),
30768c2ecf20Sopenharmony_ci						 DMA_FROM_DEVICE);
30778c2ecf20Sopenharmony_ci				card->sbpool[i].skb[j] = NULL;
30788c2ecf20Sopenharmony_ci				dev_kfree_skb(skb);
30798c2ecf20Sopenharmony_ci			}
30808c2ecf20Sopenharmony_ci		}
30818c2ecf20Sopenharmony_ci	}
30828c2ecf20Sopenharmony_ci
30838c2ecf20Sopenharmony_ci	vfree(card->soft_tst);
30848c2ecf20Sopenharmony_ci
30858c2ecf20Sopenharmony_ci	vfree(card->scd2vc);
30868c2ecf20Sopenharmony_ci
30878c2ecf20Sopenharmony_ci	vfree(card->vcs);
30888c2ecf20Sopenharmony_ci
30898c2ecf20Sopenharmony_ci	if (card->raw_cell_hnd) {
30908c2ecf20Sopenharmony_ci		dma_free_coherent(&card->pcidev->dev, 2 * sizeof(u32),
30918c2ecf20Sopenharmony_ci				  card->raw_cell_hnd, card->raw_cell_paddr);
30928c2ecf20Sopenharmony_ci	}
30938c2ecf20Sopenharmony_ci
30948c2ecf20Sopenharmony_ci	if (card->rsq.base) {
30958c2ecf20Sopenharmony_ci		DIPRINTK("%s: Release RSQ ...\n", card->name);
30968c2ecf20Sopenharmony_ci		deinit_rsq(card);
30978c2ecf20Sopenharmony_ci	}
30988c2ecf20Sopenharmony_ci
30998c2ecf20Sopenharmony_ci	if (card->tsq.base) {
31008c2ecf20Sopenharmony_ci		DIPRINTK("%s: Release TSQ ...\n", card->name);
31018c2ecf20Sopenharmony_ci		deinit_tsq(card);
31028c2ecf20Sopenharmony_ci	}
31038c2ecf20Sopenharmony_ci
31048c2ecf20Sopenharmony_ci	DIPRINTK("idt77252: Release IRQ.\n");
31058c2ecf20Sopenharmony_ci	free_irq(card->pcidev->irq, card);
31068c2ecf20Sopenharmony_ci
31078c2ecf20Sopenharmony_ci	for (i = 0; i < 4; i++) {
31088c2ecf20Sopenharmony_ci		if (card->fbq[i])
31098c2ecf20Sopenharmony_ci			iounmap(card->fbq[i]);
31108c2ecf20Sopenharmony_ci	}
31118c2ecf20Sopenharmony_ci
31128c2ecf20Sopenharmony_ci	if (card->membase)
31138c2ecf20Sopenharmony_ci		iounmap(card->membase);
31148c2ecf20Sopenharmony_ci
31158c2ecf20Sopenharmony_ci	clear_bit(IDT77252_BIT_INIT, &card->flags);
31168c2ecf20Sopenharmony_ci	DIPRINTK("%s: Card deinitialized.\n", card->name);
31178c2ecf20Sopenharmony_ci}
31188c2ecf20Sopenharmony_ci
31198c2ecf20Sopenharmony_ci
31208c2ecf20Sopenharmony_cistatic void init_sram(struct idt77252_dev *card)
31218c2ecf20Sopenharmony_ci{
31228c2ecf20Sopenharmony_ci	int i;
31238c2ecf20Sopenharmony_ci
31248c2ecf20Sopenharmony_ci	for (i = 0; i < card->sramsize; i += 4)
31258c2ecf20Sopenharmony_ci		write_sram(card, (i >> 2), 0);
31268c2ecf20Sopenharmony_ci
31278c2ecf20Sopenharmony_ci	/* set SRAM layout for THIS card */
31288c2ecf20Sopenharmony_ci	if (card->sramsize == (512 * 1024)) {
31298c2ecf20Sopenharmony_ci		card->tct_base = SAR_SRAM_TCT_128_BASE;
31308c2ecf20Sopenharmony_ci		card->tct_size = (SAR_SRAM_TCT_128_TOP - card->tct_base + 1)
31318c2ecf20Sopenharmony_ci		    / SAR_SRAM_TCT_SIZE;
31328c2ecf20Sopenharmony_ci		card->rct_base = SAR_SRAM_RCT_128_BASE;
31338c2ecf20Sopenharmony_ci		card->rct_size = (SAR_SRAM_RCT_128_TOP - card->rct_base + 1)
31348c2ecf20Sopenharmony_ci		    / SAR_SRAM_RCT_SIZE;
31358c2ecf20Sopenharmony_ci		card->rt_base = SAR_SRAM_RT_128_BASE;
31368c2ecf20Sopenharmony_ci		card->scd_base = SAR_SRAM_SCD_128_BASE;
31378c2ecf20Sopenharmony_ci		card->scd_size = (SAR_SRAM_SCD_128_TOP - card->scd_base + 1)
31388c2ecf20Sopenharmony_ci		    / SAR_SRAM_SCD_SIZE;
31398c2ecf20Sopenharmony_ci		card->tst[0] = SAR_SRAM_TST1_128_BASE;
31408c2ecf20Sopenharmony_ci		card->tst[1] = SAR_SRAM_TST2_128_BASE;
31418c2ecf20Sopenharmony_ci		card->tst_size = SAR_SRAM_TST1_128_TOP - card->tst[0] + 1;
31428c2ecf20Sopenharmony_ci		card->abrst_base = SAR_SRAM_ABRSTD_128_BASE;
31438c2ecf20Sopenharmony_ci		card->abrst_size = SAR_ABRSTD_SIZE_8K;
31448c2ecf20Sopenharmony_ci		card->fifo_base = SAR_SRAM_FIFO_128_BASE;
31458c2ecf20Sopenharmony_ci		card->fifo_size = SAR_RXFD_SIZE_32K;
31468c2ecf20Sopenharmony_ci	} else {
31478c2ecf20Sopenharmony_ci		card->tct_base = SAR_SRAM_TCT_32_BASE;
31488c2ecf20Sopenharmony_ci		card->tct_size = (SAR_SRAM_TCT_32_TOP - card->tct_base + 1)
31498c2ecf20Sopenharmony_ci		    / SAR_SRAM_TCT_SIZE;
31508c2ecf20Sopenharmony_ci		card->rct_base = SAR_SRAM_RCT_32_BASE;
31518c2ecf20Sopenharmony_ci		card->rct_size = (SAR_SRAM_RCT_32_TOP - card->rct_base + 1)
31528c2ecf20Sopenharmony_ci		    / SAR_SRAM_RCT_SIZE;
31538c2ecf20Sopenharmony_ci		card->rt_base = SAR_SRAM_RT_32_BASE;
31548c2ecf20Sopenharmony_ci		card->scd_base = SAR_SRAM_SCD_32_BASE;
31558c2ecf20Sopenharmony_ci		card->scd_size = (SAR_SRAM_SCD_32_TOP - card->scd_base + 1)
31568c2ecf20Sopenharmony_ci		    / SAR_SRAM_SCD_SIZE;
31578c2ecf20Sopenharmony_ci		card->tst[0] = SAR_SRAM_TST1_32_BASE;
31588c2ecf20Sopenharmony_ci		card->tst[1] = SAR_SRAM_TST2_32_BASE;
31598c2ecf20Sopenharmony_ci		card->tst_size = (SAR_SRAM_TST1_32_TOP - card->tst[0] + 1);
31608c2ecf20Sopenharmony_ci		card->abrst_base = SAR_SRAM_ABRSTD_32_BASE;
31618c2ecf20Sopenharmony_ci		card->abrst_size = SAR_ABRSTD_SIZE_1K;
31628c2ecf20Sopenharmony_ci		card->fifo_base = SAR_SRAM_FIFO_32_BASE;
31638c2ecf20Sopenharmony_ci		card->fifo_size = SAR_RXFD_SIZE_4K;
31648c2ecf20Sopenharmony_ci	}
31658c2ecf20Sopenharmony_ci
31668c2ecf20Sopenharmony_ci	/* Initialize TCT */
31678c2ecf20Sopenharmony_ci	for (i = 0; i < card->tct_size; i++) {
31688c2ecf20Sopenharmony_ci		write_sram(card, i * SAR_SRAM_TCT_SIZE + 0, 0);
31698c2ecf20Sopenharmony_ci		write_sram(card, i * SAR_SRAM_TCT_SIZE + 1, 0);
31708c2ecf20Sopenharmony_ci		write_sram(card, i * SAR_SRAM_TCT_SIZE + 2, 0);
31718c2ecf20Sopenharmony_ci		write_sram(card, i * SAR_SRAM_TCT_SIZE + 3, 0);
31728c2ecf20Sopenharmony_ci		write_sram(card, i * SAR_SRAM_TCT_SIZE + 4, 0);
31738c2ecf20Sopenharmony_ci		write_sram(card, i * SAR_SRAM_TCT_SIZE + 5, 0);
31748c2ecf20Sopenharmony_ci		write_sram(card, i * SAR_SRAM_TCT_SIZE + 6, 0);
31758c2ecf20Sopenharmony_ci		write_sram(card, i * SAR_SRAM_TCT_SIZE + 7, 0);
31768c2ecf20Sopenharmony_ci	}
31778c2ecf20Sopenharmony_ci
31788c2ecf20Sopenharmony_ci	/* Initialize RCT */
31798c2ecf20Sopenharmony_ci	for (i = 0; i < card->rct_size; i++) {
31808c2ecf20Sopenharmony_ci		write_sram(card, card->rct_base + i * SAR_SRAM_RCT_SIZE,
31818c2ecf20Sopenharmony_ci				    (u32) SAR_RCTE_RAWCELLINTEN);
31828c2ecf20Sopenharmony_ci		write_sram(card, card->rct_base + i * SAR_SRAM_RCT_SIZE + 1,
31838c2ecf20Sopenharmony_ci				    (u32) 0);
31848c2ecf20Sopenharmony_ci		write_sram(card, card->rct_base + i * SAR_SRAM_RCT_SIZE + 2,
31858c2ecf20Sopenharmony_ci				    (u32) 0);
31868c2ecf20Sopenharmony_ci		write_sram(card, card->rct_base + i * SAR_SRAM_RCT_SIZE + 3,
31878c2ecf20Sopenharmony_ci				    (u32) 0xffffffff);
31888c2ecf20Sopenharmony_ci	}
31898c2ecf20Sopenharmony_ci
31908c2ecf20Sopenharmony_ci	writel((SAR_FBQ0_LOW << 28) | (SAR_FB_SIZE_0 / 48), SAR_REG_FBQS0);
31918c2ecf20Sopenharmony_ci	writel((SAR_FBQ1_LOW << 28) | (SAR_FB_SIZE_1 / 48), SAR_REG_FBQS1);
31928c2ecf20Sopenharmony_ci	writel((SAR_FBQ2_LOW << 28) | (SAR_FB_SIZE_2 / 48), SAR_REG_FBQS2);
31938c2ecf20Sopenharmony_ci	writel((SAR_FBQ3_LOW << 28) | (SAR_FB_SIZE_3 / 48), SAR_REG_FBQS3);
31948c2ecf20Sopenharmony_ci
31958c2ecf20Sopenharmony_ci	/* Initialize rate table  */
31968c2ecf20Sopenharmony_ci	for (i = 0; i < 256; i++) {
31978c2ecf20Sopenharmony_ci		write_sram(card, card->rt_base + i, log_to_rate[i]);
31988c2ecf20Sopenharmony_ci	}
31998c2ecf20Sopenharmony_ci
32008c2ecf20Sopenharmony_ci	for (i = 0; i < 128; i++) {
32018c2ecf20Sopenharmony_ci		unsigned int tmp;
32028c2ecf20Sopenharmony_ci
32038c2ecf20Sopenharmony_ci		tmp  = rate_to_log[(i << 2) + 0] << 0;
32048c2ecf20Sopenharmony_ci		tmp |= rate_to_log[(i << 2) + 1] << 8;
32058c2ecf20Sopenharmony_ci		tmp |= rate_to_log[(i << 2) + 2] << 16;
32068c2ecf20Sopenharmony_ci		tmp |= rate_to_log[(i << 2) + 3] << 24;
32078c2ecf20Sopenharmony_ci		write_sram(card, card->rt_base + 256 + i, tmp);
32088c2ecf20Sopenharmony_ci	}
32098c2ecf20Sopenharmony_ci
32108c2ecf20Sopenharmony_ci#if 0 /* Fill RDF and AIR tables. */
32118c2ecf20Sopenharmony_ci	for (i = 0; i < 128; i++) {
32128c2ecf20Sopenharmony_ci		unsigned int tmp;
32138c2ecf20Sopenharmony_ci
32148c2ecf20Sopenharmony_ci		tmp = RDF[0][(i << 1) + 0] << 16;
32158c2ecf20Sopenharmony_ci		tmp |= RDF[0][(i << 1) + 1] << 0;
32168c2ecf20Sopenharmony_ci		write_sram(card, card->rt_base + 512 + i, tmp);
32178c2ecf20Sopenharmony_ci	}
32188c2ecf20Sopenharmony_ci
32198c2ecf20Sopenharmony_ci	for (i = 0; i < 128; i++) {
32208c2ecf20Sopenharmony_ci		unsigned int tmp;
32218c2ecf20Sopenharmony_ci
32228c2ecf20Sopenharmony_ci		tmp = AIR[0][(i << 1) + 0] << 16;
32238c2ecf20Sopenharmony_ci		tmp |= AIR[0][(i << 1) + 1] << 0;
32248c2ecf20Sopenharmony_ci		write_sram(card, card->rt_base + 640 + i, tmp);
32258c2ecf20Sopenharmony_ci	}
32268c2ecf20Sopenharmony_ci#endif
32278c2ecf20Sopenharmony_ci
32288c2ecf20Sopenharmony_ci	IPRINTK("%s: initialize rate table ...\n", card->name);
32298c2ecf20Sopenharmony_ci	writel(card->rt_base << 2, SAR_REG_RTBL);
32308c2ecf20Sopenharmony_ci
32318c2ecf20Sopenharmony_ci	/* Initialize TSTs */
32328c2ecf20Sopenharmony_ci	IPRINTK("%s: initialize TST ...\n", card->name);
32338c2ecf20Sopenharmony_ci	card->tst_free = card->tst_size - 2;	/* last two are jumps */
32348c2ecf20Sopenharmony_ci
32358c2ecf20Sopenharmony_ci	for (i = card->tst[0]; i < card->tst[0] + card->tst_size - 2; i++)
32368c2ecf20Sopenharmony_ci		write_sram(card, i, TSTE_OPC_VAR);
32378c2ecf20Sopenharmony_ci	write_sram(card, i++, TSTE_OPC_JMP | (card->tst[0] << 2));
32388c2ecf20Sopenharmony_ci	idt77252_sram_write_errors = 1;
32398c2ecf20Sopenharmony_ci	write_sram(card, i++, TSTE_OPC_JMP | (card->tst[1] << 2));
32408c2ecf20Sopenharmony_ci	idt77252_sram_write_errors = 0;
32418c2ecf20Sopenharmony_ci	for (i = card->tst[1]; i < card->tst[1] + card->tst_size - 2; i++)
32428c2ecf20Sopenharmony_ci		write_sram(card, i, TSTE_OPC_VAR);
32438c2ecf20Sopenharmony_ci	write_sram(card, i++, TSTE_OPC_JMP | (card->tst[1] << 2));
32448c2ecf20Sopenharmony_ci	idt77252_sram_write_errors = 1;
32458c2ecf20Sopenharmony_ci	write_sram(card, i++, TSTE_OPC_JMP | (card->tst[0] << 2));
32468c2ecf20Sopenharmony_ci	idt77252_sram_write_errors = 0;
32478c2ecf20Sopenharmony_ci
32488c2ecf20Sopenharmony_ci	card->tst_index = 0;
32498c2ecf20Sopenharmony_ci	writel(card->tst[0] << 2, SAR_REG_TSTB);
32508c2ecf20Sopenharmony_ci
32518c2ecf20Sopenharmony_ci	/* Initialize ABRSTD and Receive FIFO */
32528c2ecf20Sopenharmony_ci	IPRINTK("%s: initialize ABRSTD ...\n", card->name);
32538c2ecf20Sopenharmony_ci	writel(card->abrst_size | (card->abrst_base << 2),
32548c2ecf20Sopenharmony_ci	       SAR_REG_ABRSTD);
32558c2ecf20Sopenharmony_ci
32568c2ecf20Sopenharmony_ci	IPRINTK("%s: initialize receive fifo ...\n", card->name);
32578c2ecf20Sopenharmony_ci	writel(card->fifo_size | (card->fifo_base << 2),
32588c2ecf20Sopenharmony_ci	       SAR_REG_RXFD);
32598c2ecf20Sopenharmony_ci
32608c2ecf20Sopenharmony_ci	IPRINTK("%s: SRAM initialization complete.\n", card->name);
32618c2ecf20Sopenharmony_ci}
32628c2ecf20Sopenharmony_ci
32638c2ecf20Sopenharmony_cistatic int init_card(struct atm_dev *dev)
32648c2ecf20Sopenharmony_ci{
32658c2ecf20Sopenharmony_ci	struct idt77252_dev *card = dev->dev_data;
32668c2ecf20Sopenharmony_ci	struct pci_dev *pcidev = card->pcidev;
32678c2ecf20Sopenharmony_ci	unsigned long tmpl, modl;
32688c2ecf20Sopenharmony_ci	unsigned int linkrate, rsvdcr;
32698c2ecf20Sopenharmony_ci	unsigned int tst_entries;
32708c2ecf20Sopenharmony_ci	struct net_device *tmp;
32718c2ecf20Sopenharmony_ci	char tname[10];
32728c2ecf20Sopenharmony_ci
32738c2ecf20Sopenharmony_ci	u32 size;
32748c2ecf20Sopenharmony_ci	u_char pci_byte;
32758c2ecf20Sopenharmony_ci	u32 conf;
32768c2ecf20Sopenharmony_ci	int i, k;
32778c2ecf20Sopenharmony_ci
32788c2ecf20Sopenharmony_ci	if (test_bit(IDT77252_BIT_INIT, &card->flags)) {
32798c2ecf20Sopenharmony_ci		printk("Error: SAR already initialized.\n");
32808c2ecf20Sopenharmony_ci		return -1;
32818c2ecf20Sopenharmony_ci	}
32828c2ecf20Sopenharmony_ci
32838c2ecf20Sopenharmony_ci/*****************************************************************/
32848c2ecf20Sopenharmony_ci/*   P C I   C O N F I G U R A T I O N                           */
32858c2ecf20Sopenharmony_ci/*****************************************************************/
32868c2ecf20Sopenharmony_ci
32878c2ecf20Sopenharmony_ci	/* Set PCI Retry-Timeout and TRDY timeout */
32888c2ecf20Sopenharmony_ci	IPRINTK("%s: Checking PCI retries.\n", card->name);
32898c2ecf20Sopenharmony_ci	if (pci_read_config_byte(pcidev, 0x40, &pci_byte) != 0) {
32908c2ecf20Sopenharmony_ci		printk("%s: can't read PCI retry timeout.\n", card->name);
32918c2ecf20Sopenharmony_ci		deinit_card(card);
32928c2ecf20Sopenharmony_ci		return -1;
32938c2ecf20Sopenharmony_ci	}
32948c2ecf20Sopenharmony_ci	if (pci_byte != 0) {
32958c2ecf20Sopenharmony_ci		IPRINTK("%s: PCI retry timeout: %d, set to 0.\n",
32968c2ecf20Sopenharmony_ci			card->name, pci_byte);
32978c2ecf20Sopenharmony_ci		if (pci_write_config_byte(pcidev, 0x40, 0) != 0) {
32988c2ecf20Sopenharmony_ci			printk("%s: can't set PCI retry timeout.\n",
32998c2ecf20Sopenharmony_ci			       card->name);
33008c2ecf20Sopenharmony_ci			deinit_card(card);
33018c2ecf20Sopenharmony_ci			return -1;
33028c2ecf20Sopenharmony_ci		}
33038c2ecf20Sopenharmony_ci	}
33048c2ecf20Sopenharmony_ci	IPRINTK("%s: Checking PCI TRDY.\n", card->name);
33058c2ecf20Sopenharmony_ci	if (pci_read_config_byte(pcidev, 0x41, &pci_byte) != 0) {
33068c2ecf20Sopenharmony_ci		printk("%s: can't read PCI TRDY timeout.\n", card->name);
33078c2ecf20Sopenharmony_ci		deinit_card(card);
33088c2ecf20Sopenharmony_ci		return -1;
33098c2ecf20Sopenharmony_ci	}
33108c2ecf20Sopenharmony_ci	if (pci_byte != 0) {
33118c2ecf20Sopenharmony_ci		IPRINTK("%s: PCI TRDY timeout: %d, set to 0.\n",
33128c2ecf20Sopenharmony_ci		        card->name, pci_byte);
33138c2ecf20Sopenharmony_ci		if (pci_write_config_byte(pcidev, 0x41, 0) != 0) {
33148c2ecf20Sopenharmony_ci			printk("%s: can't set PCI TRDY timeout.\n", card->name);
33158c2ecf20Sopenharmony_ci			deinit_card(card);
33168c2ecf20Sopenharmony_ci			return -1;
33178c2ecf20Sopenharmony_ci		}
33188c2ecf20Sopenharmony_ci	}
33198c2ecf20Sopenharmony_ci	/* Reset Timer register */
33208c2ecf20Sopenharmony_ci	if (readl(SAR_REG_STAT) & SAR_STAT_TMROF) {
33218c2ecf20Sopenharmony_ci		printk("%s: resetting timer overflow.\n", card->name);
33228c2ecf20Sopenharmony_ci		writel(SAR_STAT_TMROF, SAR_REG_STAT);
33238c2ecf20Sopenharmony_ci	}
33248c2ecf20Sopenharmony_ci	IPRINTK("%s: Request IRQ ... ", card->name);
33258c2ecf20Sopenharmony_ci	if (request_irq(pcidev->irq, idt77252_interrupt, IRQF_SHARED,
33268c2ecf20Sopenharmony_ci			card->name, card) != 0) {
33278c2ecf20Sopenharmony_ci		printk("%s: can't allocate IRQ.\n", card->name);
33288c2ecf20Sopenharmony_ci		deinit_card(card);
33298c2ecf20Sopenharmony_ci		return -1;
33308c2ecf20Sopenharmony_ci	}
33318c2ecf20Sopenharmony_ci	IPRINTK("got %d.\n", pcidev->irq);
33328c2ecf20Sopenharmony_ci
33338c2ecf20Sopenharmony_ci/*****************************************************************/
33348c2ecf20Sopenharmony_ci/*   C H E C K   A N D   I N I T   S R A M                       */
33358c2ecf20Sopenharmony_ci/*****************************************************************/
33368c2ecf20Sopenharmony_ci
33378c2ecf20Sopenharmony_ci	IPRINTK("%s: Initializing SRAM\n", card->name);
33388c2ecf20Sopenharmony_ci
33398c2ecf20Sopenharmony_ci	/* preset size of connecton table, so that init_sram() knows about it */
33408c2ecf20Sopenharmony_ci	conf =	SAR_CFG_TX_FIFO_SIZE_9 |	/* Use maximum fifo size */
33418c2ecf20Sopenharmony_ci		SAR_CFG_RXSTQ_SIZE_8k |		/* Receive Status Queue is 8k */
33428c2ecf20Sopenharmony_ci		SAR_CFG_IDLE_CLP |		/* Set CLP on idle cells */
33438c2ecf20Sopenharmony_ci#ifndef ATM_IDT77252_SEND_IDLE
33448c2ecf20Sopenharmony_ci		SAR_CFG_NO_IDLE |		/* Do not send idle cells */
33458c2ecf20Sopenharmony_ci#endif
33468c2ecf20Sopenharmony_ci		0;
33478c2ecf20Sopenharmony_ci
33488c2ecf20Sopenharmony_ci	if (card->sramsize == (512 * 1024))
33498c2ecf20Sopenharmony_ci		conf |= SAR_CFG_CNTBL_1k;
33508c2ecf20Sopenharmony_ci	else
33518c2ecf20Sopenharmony_ci		conf |= SAR_CFG_CNTBL_512;
33528c2ecf20Sopenharmony_ci
33538c2ecf20Sopenharmony_ci	switch (vpibits) {
33548c2ecf20Sopenharmony_ci	case 0:
33558c2ecf20Sopenharmony_ci		conf |= SAR_CFG_VPVCS_0;
33568c2ecf20Sopenharmony_ci		break;
33578c2ecf20Sopenharmony_ci	default:
33588c2ecf20Sopenharmony_ci	case 1:
33598c2ecf20Sopenharmony_ci		conf |= SAR_CFG_VPVCS_1;
33608c2ecf20Sopenharmony_ci		break;
33618c2ecf20Sopenharmony_ci	case 2:
33628c2ecf20Sopenharmony_ci		conf |= SAR_CFG_VPVCS_2;
33638c2ecf20Sopenharmony_ci		break;
33648c2ecf20Sopenharmony_ci	case 8:
33658c2ecf20Sopenharmony_ci		conf |= SAR_CFG_VPVCS_8;
33668c2ecf20Sopenharmony_ci		break;
33678c2ecf20Sopenharmony_ci	}
33688c2ecf20Sopenharmony_ci
33698c2ecf20Sopenharmony_ci	writel(readl(SAR_REG_CFG) | conf, SAR_REG_CFG);
33708c2ecf20Sopenharmony_ci
33718c2ecf20Sopenharmony_ci	init_sram(card);
33728c2ecf20Sopenharmony_ci
33738c2ecf20Sopenharmony_ci/********************************************************************/
33748c2ecf20Sopenharmony_ci/*  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 */
33758c2ecf20Sopenharmony_ci/********************************************************************/
33768c2ecf20Sopenharmony_ci	/* Initialize TSQ */
33778c2ecf20Sopenharmony_ci	if (0 != init_tsq(card)) {
33788c2ecf20Sopenharmony_ci		deinit_card(card);
33798c2ecf20Sopenharmony_ci		return -1;
33808c2ecf20Sopenharmony_ci	}
33818c2ecf20Sopenharmony_ci	/* Initialize RSQ */
33828c2ecf20Sopenharmony_ci	if (0 != init_rsq(card)) {
33838c2ecf20Sopenharmony_ci		deinit_card(card);
33848c2ecf20Sopenharmony_ci		return -1;
33858c2ecf20Sopenharmony_ci	}
33868c2ecf20Sopenharmony_ci
33878c2ecf20Sopenharmony_ci	card->vpibits = vpibits;
33888c2ecf20Sopenharmony_ci	if (card->sramsize == (512 * 1024)) {
33898c2ecf20Sopenharmony_ci		card->vcibits = 10 - card->vpibits;
33908c2ecf20Sopenharmony_ci	} else {
33918c2ecf20Sopenharmony_ci		card->vcibits = 9 - card->vpibits;
33928c2ecf20Sopenharmony_ci	}
33938c2ecf20Sopenharmony_ci
33948c2ecf20Sopenharmony_ci	card->vcimask = 0;
33958c2ecf20Sopenharmony_ci	for (k = 0, i = 1; k < card->vcibits; k++) {
33968c2ecf20Sopenharmony_ci		card->vcimask |= i;
33978c2ecf20Sopenharmony_ci		i <<= 1;
33988c2ecf20Sopenharmony_ci	}
33998c2ecf20Sopenharmony_ci
34008c2ecf20Sopenharmony_ci	IPRINTK("%s: Setting VPI/VCI mask to zero.\n", card->name);
34018c2ecf20Sopenharmony_ci	writel(0, SAR_REG_VPM);
34028c2ecf20Sopenharmony_ci
34038c2ecf20Sopenharmony_ci	/* Little Endian Order   */
34048c2ecf20Sopenharmony_ci	writel(0, SAR_REG_GP);
34058c2ecf20Sopenharmony_ci
34068c2ecf20Sopenharmony_ci	/* Initialize RAW Cell Handle Register  */
34078c2ecf20Sopenharmony_ci	card->raw_cell_hnd = dma_alloc_coherent(&card->pcidev->dev,
34088c2ecf20Sopenharmony_ci						2 * sizeof(u32),
34098c2ecf20Sopenharmony_ci						&card->raw_cell_paddr,
34108c2ecf20Sopenharmony_ci						GFP_KERNEL);
34118c2ecf20Sopenharmony_ci	if (!card->raw_cell_hnd) {
34128c2ecf20Sopenharmony_ci		printk("%s: memory allocation failure.\n", card->name);
34138c2ecf20Sopenharmony_ci		deinit_card(card);
34148c2ecf20Sopenharmony_ci		return -1;
34158c2ecf20Sopenharmony_ci	}
34168c2ecf20Sopenharmony_ci	writel(card->raw_cell_paddr, SAR_REG_RAWHND);
34178c2ecf20Sopenharmony_ci	IPRINTK("%s: raw cell handle is at 0x%p.\n", card->name,
34188c2ecf20Sopenharmony_ci		card->raw_cell_hnd);
34198c2ecf20Sopenharmony_ci
34208c2ecf20Sopenharmony_ci	size = sizeof(struct vc_map *) * card->tct_size;
34218c2ecf20Sopenharmony_ci	IPRINTK("%s: allocate %d byte for VC map.\n", card->name, size);
34228c2ecf20Sopenharmony_ci	card->vcs = vzalloc(size);
34238c2ecf20Sopenharmony_ci	if (!card->vcs) {
34248c2ecf20Sopenharmony_ci		printk("%s: memory allocation failure.\n", card->name);
34258c2ecf20Sopenharmony_ci		deinit_card(card);
34268c2ecf20Sopenharmony_ci		return -1;
34278c2ecf20Sopenharmony_ci	}
34288c2ecf20Sopenharmony_ci
34298c2ecf20Sopenharmony_ci	size = sizeof(struct vc_map *) * card->scd_size;
34308c2ecf20Sopenharmony_ci	IPRINTK("%s: allocate %d byte for SCD to VC mapping.\n",
34318c2ecf20Sopenharmony_ci	        card->name, size);
34328c2ecf20Sopenharmony_ci	card->scd2vc = vzalloc(size);
34338c2ecf20Sopenharmony_ci	if (!card->scd2vc) {
34348c2ecf20Sopenharmony_ci		printk("%s: memory allocation failure.\n", card->name);
34358c2ecf20Sopenharmony_ci		deinit_card(card);
34368c2ecf20Sopenharmony_ci		return -1;
34378c2ecf20Sopenharmony_ci	}
34388c2ecf20Sopenharmony_ci
34398c2ecf20Sopenharmony_ci	size = sizeof(struct tst_info) * (card->tst_size - 2);
34408c2ecf20Sopenharmony_ci	IPRINTK("%s: allocate %d byte for TST to VC mapping.\n",
34418c2ecf20Sopenharmony_ci		card->name, size);
34428c2ecf20Sopenharmony_ci	card->soft_tst = vmalloc(size);
34438c2ecf20Sopenharmony_ci	if (!card->soft_tst) {
34448c2ecf20Sopenharmony_ci		printk("%s: memory allocation failure.\n", card->name);
34458c2ecf20Sopenharmony_ci		deinit_card(card);
34468c2ecf20Sopenharmony_ci		return -1;
34478c2ecf20Sopenharmony_ci	}
34488c2ecf20Sopenharmony_ci	for (i = 0; i < card->tst_size - 2; i++) {
34498c2ecf20Sopenharmony_ci		card->soft_tst[i].tste = TSTE_OPC_VAR;
34508c2ecf20Sopenharmony_ci		card->soft_tst[i].vc = NULL;
34518c2ecf20Sopenharmony_ci	}
34528c2ecf20Sopenharmony_ci
34538c2ecf20Sopenharmony_ci	if (dev->phy == NULL) {
34548c2ecf20Sopenharmony_ci		printk("%s: No LT device defined.\n", card->name);
34558c2ecf20Sopenharmony_ci		deinit_card(card);
34568c2ecf20Sopenharmony_ci		return -1;
34578c2ecf20Sopenharmony_ci	}
34588c2ecf20Sopenharmony_ci	if (dev->phy->ioctl == NULL) {
34598c2ecf20Sopenharmony_ci		printk("%s: LT had no IOCTL function defined.\n", card->name);
34608c2ecf20Sopenharmony_ci		deinit_card(card);
34618c2ecf20Sopenharmony_ci		return -1;
34628c2ecf20Sopenharmony_ci	}
34638c2ecf20Sopenharmony_ci
34648c2ecf20Sopenharmony_ci#ifdef	CONFIG_ATM_IDT77252_USE_SUNI
34658c2ecf20Sopenharmony_ci	/*
34668c2ecf20Sopenharmony_ci	 * this is a jhs hack to get around special functionality in the
34678c2ecf20Sopenharmony_ci	 * phy driver for the atecom hardware; the functionality doesn't
34688c2ecf20Sopenharmony_ci	 * exist in the linux atm suni driver
34698c2ecf20Sopenharmony_ci	 *
34708c2ecf20Sopenharmony_ci	 * it isn't the right way to do things, but as the guy from NIST
34718c2ecf20Sopenharmony_ci	 * said, talking about their measurement of the fine structure
34728c2ecf20Sopenharmony_ci	 * constant, "it's good enough for government work."
34738c2ecf20Sopenharmony_ci	 */
34748c2ecf20Sopenharmony_ci	linkrate = 149760000;
34758c2ecf20Sopenharmony_ci#endif
34768c2ecf20Sopenharmony_ci
34778c2ecf20Sopenharmony_ci	card->link_pcr = (linkrate / 8 / 53);
34788c2ecf20Sopenharmony_ci	printk("%s: Linkrate on ATM line : %u bit/s, %u cell/s.\n",
34798c2ecf20Sopenharmony_ci	       card->name, linkrate, card->link_pcr);
34808c2ecf20Sopenharmony_ci
34818c2ecf20Sopenharmony_ci#ifdef ATM_IDT77252_SEND_IDLE
34828c2ecf20Sopenharmony_ci	card->utopia_pcr = card->link_pcr;
34838c2ecf20Sopenharmony_ci#else
34848c2ecf20Sopenharmony_ci	card->utopia_pcr = (160000000 / 8 / 54);
34858c2ecf20Sopenharmony_ci#endif
34868c2ecf20Sopenharmony_ci
34878c2ecf20Sopenharmony_ci	rsvdcr = 0;
34888c2ecf20Sopenharmony_ci	if (card->utopia_pcr > card->link_pcr)
34898c2ecf20Sopenharmony_ci		rsvdcr = card->utopia_pcr - card->link_pcr;
34908c2ecf20Sopenharmony_ci
34918c2ecf20Sopenharmony_ci	tmpl = (unsigned long) rsvdcr * ((unsigned long) card->tst_size - 2);
34928c2ecf20Sopenharmony_ci	modl = tmpl % (unsigned long)card->utopia_pcr;
34938c2ecf20Sopenharmony_ci	tst_entries = (int) (tmpl / (unsigned long)card->utopia_pcr);
34948c2ecf20Sopenharmony_ci	if (modl)
34958c2ecf20Sopenharmony_ci		tst_entries++;
34968c2ecf20Sopenharmony_ci	card->tst_free -= tst_entries;
34978c2ecf20Sopenharmony_ci	fill_tst(card, NULL, tst_entries, TSTE_OPC_NULL);
34988c2ecf20Sopenharmony_ci
34998c2ecf20Sopenharmony_ci#ifdef HAVE_EEPROM
35008c2ecf20Sopenharmony_ci	idt77252_eeprom_init(card);
35018c2ecf20Sopenharmony_ci	printk("%s: EEPROM: %02x:", card->name,
35028c2ecf20Sopenharmony_ci		idt77252_eeprom_read_status(card));
35038c2ecf20Sopenharmony_ci
35048c2ecf20Sopenharmony_ci	for (i = 0; i < 0x80; i++) {
35058c2ecf20Sopenharmony_ci		printk(" %02x",
35068c2ecf20Sopenharmony_ci		idt77252_eeprom_read_byte(card, i)
35078c2ecf20Sopenharmony_ci		);
35088c2ecf20Sopenharmony_ci	}
35098c2ecf20Sopenharmony_ci	printk("\n");
35108c2ecf20Sopenharmony_ci#endif /* HAVE_EEPROM */
35118c2ecf20Sopenharmony_ci
35128c2ecf20Sopenharmony_ci	/*
35138c2ecf20Sopenharmony_ci	 * XXX: <hack>
35148c2ecf20Sopenharmony_ci	 */
35158c2ecf20Sopenharmony_ci	sprintf(tname, "eth%d", card->index);
35168c2ecf20Sopenharmony_ci	tmp = dev_get_by_name(&init_net, tname);	/* jhs: was "tmp = dev_get(tname);" */
35178c2ecf20Sopenharmony_ci	if (tmp) {
35188c2ecf20Sopenharmony_ci		memcpy(card->atmdev->esi, tmp->dev_addr, 6);
35198c2ecf20Sopenharmony_ci		dev_put(tmp);
35208c2ecf20Sopenharmony_ci		printk("%s: ESI %pM\n", card->name, card->atmdev->esi);
35218c2ecf20Sopenharmony_ci	}
35228c2ecf20Sopenharmony_ci	/*
35238c2ecf20Sopenharmony_ci	 * XXX: </hack>
35248c2ecf20Sopenharmony_ci	 */
35258c2ecf20Sopenharmony_ci
35268c2ecf20Sopenharmony_ci	/* Set Maximum Deficit Count for now. */
35278c2ecf20Sopenharmony_ci	writel(0xffff, SAR_REG_MDFCT);
35288c2ecf20Sopenharmony_ci
35298c2ecf20Sopenharmony_ci	set_bit(IDT77252_BIT_INIT, &card->flags);
35308c2ecf20Sopenharmony_ci
35318c2ecf20Sopenharmony_ci	XPRINTK("%s: IDT77252 ABR SAR initialization complete.\n", card->name);
35328c2ecf20Sopenharmony_ci	return 0;
35338c2ecf20Sopenharmony_ci}
35348c2ecf20Sopenharmony_ci
35358c2ecf20Sopenharmony_ci
35368c2ecf20Sopenharmony_ci/*****************************************************************************/
35378c2ecf20Sopenharmony_ci/*                                                                           */
35388c2ecf20Sopenharmony_ci/* Probing of IDT77252 ABR SAR                                               */
35398c2ecf20Sopenharmony_ci/*                                                                           */
35408c2ecf20Sopenharmony_ci/*****************************************************************************/
35418c2ecf20Sopenharmony_ci
35428c2ecf20Sopenharmony_ci
35438c2ecf20Sopenharmony_cistatic int idt77252_preset(struct idt77252_dev *card)
35448c2ecf20Sopenharmony_ci{
35458c2ecf20Sopenharmony_ci	u16 pci_command;
35468c2ecf20Sopenharmony_ci
35478c2ecf20Sopenharmony_ci/*****************************************************************/
35488c2ecf20Sopenharmony_ci/*   P C I   C O N F I G U R A T I O N                           */
35498c2ecf20Sopenharmony_ci/*****************************************************************/
35508c2ecf20Sopenharmony_ci
35518c2ecf20Sopenharmony_ci	XPRINTK("%s: Enable PCI master and memory access for SAR.\n",
35528c2ecf20Sopenharmony_ci		card->name);
35538c2ecf20Sopenharmony_ci	if (pci_read_config_word(card->pcidev, PCI_COMMAND, &pci_command)) {
35548c2ecf20Sopenharmony_ci		printk("%s: can't read PCI_COMMAND.\n", card->name);
35558c2ecf20Sopenharmony_ci		deinit_card(card);
35568c2ecf20Sopenharmony_ci		return -1;
35578c2ecf20Sopenharmony_ci	}
35588c2ecf20Sopenharmony_ci	if (!(pci_command & PCI_COMMAND_IO)) {
35598c2ecf20Sopenharmony_ci		printk("%s: PCI_COMMAND: %04x (???)\n",
35608c2ecf20Sopenharmony_ci		       card->name, pci_command);
35618c2ecf20Sopenharmony_ci		deinit_card(card);
35628c2ecf20Sopenharmony_ci		return (-1);
35638c2ecf20Sopenharmony_ci	}
35648c2ecf20Sopenharmony_ci	pci_command |= (PCI_COMMAND_MEMORY | PCI_COMMAND_MASTER);
35658c2ecf20Sopenharmony_ci	if (pci_write_config_word(card->pcidev, PCI_COMMAND, pci_command)) {
35668c2ecf20Sopenharmony_ci		printk("%s: can't write PCI_COMMAND.\n", card->name);
35678c2ecf20Sopenharmony_ci		deinit_card(card);
35688c2ecf20Sopenharmony_ci		return -1;
35698c2ecf20Sopenharmony_ci	}
35708c2ecf20Sopenharmony_ci/*****************************************************************/
35718c2ecf20Sopenharmony_ci/*   G E N E R I C   R E S E T                                   */
35728c2ecf20Sopenharmony_ci/*****************************************************************/
35738c2ecf20Sopenharmony_ci
35748c2ecf20Sopenharmony_ci	/* Software reset */
35758c2ecf20Sopenharmony_ci	writel(SAR_CFG_SWRST, SAR_REG_CFG);
35768c2ecf20Sopenharmony_ci	mdelay(1);
35778c2ecf20Sopenharmony_ci	writel(0, SAR_REG_CFG);
35788c2ecf20Sopenharmony_ci
35798c2ecf20Sopenharmony_ci	IPRINTK("%s: Software resetted.\n", card->name);
35808c2ecf20Sopenharmony_ci	return 0;
35818c2ecf20Sopenharmony_ci}
35828c2ecf20Sopenharmony_ci
35838c2ecf20Sopenharmony_ci
35848c2ecf20Sopenharmony_cistatic unsigned long probe_sram(struct idt77252_dev *card)
35858c2ecf20Sopenharmony_ci{
35868c2ecf20Sopenharmony_ci	u32 data, addr;
35878c2ecf20Sopenharmony_ci
35888c2ecf20Sopenharmony_ci	writel(0, SAR_REG_DR0);
35898c2ecf20Sopenharmony_ci	writel(SAR_CMD_WRITE_SRAM | (0 << 2), SAR_REG_CMD);
35908c2ecf20Sopenharmony_ci
35918c2ecf20Sopenharmony_ci	for (addr = 0x4000; addr < 0x80000; addr += 0x4000) {
35928c2ecf20Sopenharmony_ci		writel(ATM_POISON, SAR_REG_DR0);
35938c2ecf20Sopenharmony_ci		writel(SAR_CMD_WRITE_SRAM | (addr << 2), SAR_REG_CMD);
35948c2ecf20Sopenharmony_ci
35958c2ecf20Sopenharmony_ci		writel(SAR_CMD_READ_SRAM | (0 << 2), SAR_REG_CMD);
35968c2ecf20Sopenharmony_ci		data = readl(SAR_REG_DR0);
35978c2ecf20Sopenharmony_ci
35988c2ecf20Sopenharmony_ci		if (data != 0)
35998c2ecf20Sopenharmony_ci			break;
36008c2ecf20Sopenharmony_ci	}
36018c2ecf20Sopenharmony_ci
36028c2ecf20Sopenharmony_ci	return addr * sizeof(u32);
36038c2ecf20Sopenharmony_ci}
36048c2ecf20Sopenharmony_ci
36058c2ecf20Sopenharmony_cistatic int idt77252_init_one(struct pci_dev *pcidev,
36068c2ecf20Sopenharmony_ci			     const struct pci_device_id *id)
36078c2ecf20Sopenharmony_ci{
36088c2ecf20Sopenharmony_ci	static struct idt77252_dev **last = &idt77252_chain;
36098c2ecf20Sopenharmony_ci	static int index = 0;
36108c2ecf20Sopenharmony_ci
36118c2ecf20Sopenharmony_ci	unsigned long membase, srambase;
36128c2ecf20Sopenharmony_ci	struct idt77252_dev *card;
36138c2ecf20Sopenharmony_ci	struct atm_dev *dev;
36148c2ecf20Sopenharmony_ci	int i, err;
36158c2ecf20Sopenharmony_ci
36168c2ecf20Sopenharmony_ci
36178c2ecf20Sopenharmony_ci	if ((err = pci_enable_device(pcidev))) {
36188c2ecf20Sopenharmony_ci		printk("idt77252: can't enable PCI device at %s\n", pci_name(pcidev));
36198c2ecf20Sopenharmony_ci		return err;
36208c2ecf20Sopenharmony_ci	}
36218c2ecf20Sopenharmony_ci
36228c2ecf20Sopenharmony_ci	if ((err = dma_set_mask_and_coherent(&pcidev->dev, DMA_BIT_MASK(32)))) {
36238c2ecf20Sopenharmony_ci		printk("idt77252: can't enable DMA for PCI device at %s\n", pci_name(pcidev));
36248c2ecf20Sopenharmony_ci		goto err_out_disable_pdev;
36258c2ecf20Sopenharmony_ci	}
36268c2ecf20Sopenharmony_ci
36278c2ecf20Sopenharmony_ci	card = kzalloc(sizeof(struct idt77252_dev), GFP_KERNEL);
36288c2ecf20Sopenharmony_ci	if (!card) {
36298c2ecf20Sopenharmony_ci		printk("idt77252-%d: can't allocate private data\n", index);
36308c2ecf20Sopenharmony_ci		err = -ENOMEM;
36318c2ecf20Sopenharmony_ci		goto err_out_disable_pdev;
36328c2ecf20Sopenharmony_ci	}
36338c2ecf20Sopenharmony_ci	card->revision = pcidev->revision;
36348c2ecf20Sopenharmony_ci	card->index = index;
36358c2ecf20Sopenharmony_ci	card->pcidev = pcidev;
36368c2ecf20Sopenharmony_ci	sprintf(card->name, "idt77252-%d", card->index);
36378c2ecf20Sopenharmony_ci
36388c2ecf20Sopenharmony_ci	INIT_WORK(&card->tqueue, idt77252_softint);
36398c2ecf20Sopenharmony_ci
36408c2ecf20Sopenharmony_ci	membase = pci_resource_start(pcidev, 1);
36418c2ecf20Sopenharmony_ci	srambase = pci_resource_start(pcidev, 2);
36428c2ecf20Sopenharmony_ci
36438c2ecf20Sopenharmony_ci	mutex_init(&card->mutex);
36448c2ecf20Sopenharmony_ci	spin_lock_init(&card->cmd_lock);
36458c2ecf20Sopenharmony_ci	spin_lock_init(&card->tst_lock);
36468c2ecf20Sopenharmony_ci
36478c2ecf20Sopenharmony_ci	timer_setup(&card->tst_timer, tst_timer, 0);
36488c2ecf20Sopenharmony_ci
36498c2ecf20Sopenharmony_ci	/* Do the I/O remapping... */
36508c2ecf20Sopenharmony_ci	card->membase = ioremap(membase, 1024);
36518c2ecf20Sopenharmony_ci	if (!card->membase) {
36528c2ecf20Sopenharmony_ci		printk("%s: can't ioremap() membase\n", card->name);
36538c2ecf20Sopenharmony_ci		err = -EIO;
36548c2ecf20Sopenharmony_ci		goto err_out_free_card;
36558c2ecf20Sopenharmony_ci	}
36568c2ecf20Sopenharmony_ci
36578c2ecf20Sopenharmony_ci	if (idt77252_preset(card)) {
36588c2ecf20Sopenharmony_ci		printk("%s: preset failed\n", card->name);
36598c2ecf20Sopenharmony_ci		err = -EIO;
36608c2ecf20Sopenharmony_ci		goto err_out_iounmap;
36618c2ecf20Sopenharmony_ci	}
36628c2ecf20Sopenharmony_ci
36638c2ecf20Sopenharmony_ci	dev = atm_dev_register("idt77252", &pcidev->dev, &idt77252_ops, -1,
36648c2ecf20Sopenharmony_ci			       NULL);
36658c2ecf20Sopenharmony_ci	if (!dev) {
36668c2ecf20Sopenharmony_ci		printk("%s: can't register atm device\n", card->name);
36678c2ecf20Sopenharmony_ci		err = -EIO;
36688c2ecf20Sopenharmony_ci		goto err_out_iounmap;
36698c2ecf20Sopenharmony_ci	}
36708c2ecf20Sopenharmony_ci	dev->dev_data = card;
36718c2ecf20Sopenharmony_ci	card->atmdev = dev;
36728c2ecf20Sopenharmony_ci
36738c2ecf20Sopenharmony_ci#ifdef	CONFIG_ATM_IDT77252_USE_SUNI
36748c2ecf20Sopenharmony_ci	suni_init(dev);
36758c2ecf20Sopenharmony_ci	if (!dev->phy) {
36768c2ecf20Sopenharmony_ci		printk("%s: can't init SUNI\n", card->name);
36778c2ecf20Sopenharmony_ci		err = -EIO;
36788c2ecf20Sopenharmony_ci		goto err_out_deinit_card;
36798c2ecf20Sopenharmony_ci	}
36808c2ecf20Sopenharmony_ci#endif	/* CONFIG_ATM_IDT77252_USE_SUNI */
36818c2ecf20Sopenharmony_ci
36828c2ecf20Sopenharmony_ci	card->sramsize = probe_sram(card);
36838c2ecf20Sopenharmony_ci
36848c2ecf20Sopenharmony_ci	for (i = 0; i < 4; i++) {
36858c2ecf20Sopenharmony_ci		card->fbq[i] = ioremap(srambase | 0x200000 | (i << 18), 4);
36868c2ecf20Sopenharmony_ci		if (!card->fbq[i]) {
36878c2ecf20Sopenharmony_ci			printk("%s: can't ioremap() FBQ%d\n", card->name, i);
36888c2ecf20Sopenharmony_ci			err = -EIO;
36898c2ecf20Sopenharmony_ci			goto err_out_deinit_card;
36908c2ecf20Sopenharmony_ci		}
36918c2ecf20Sopenharmony_ci	}
36928c2ecf20Sopenharmony_ci
36938c2ecf20Sopenharmony_ci	printk("%s: ABR SAR (Rev %c): MEM %08lx SRAM %08lx [%u KB]\n",
36948c2ecf20Sopenharmony_ci	       card->name, ((card->revision > 1) && (card->revision < 25)) ?
36958c2ecf20Sopenharmony_ci	       'A' + card->revision - 1 : '?', membase, srambase,
36968c2ecf20Sopenharmony_ci	       card->sramsize / 1024);
36978c2ecf20Sopenharmony_ci
36988c2ecf20Sopenharmony_ci	if (init_card(dev)) {
36998c2ecf20Sopenharmony_ci		printk("%s: init_card failed\n", card->name);
37008c2ecf20Sopenharmony_ci		err = -EIO;
37018c2ecf20Sopenharmony_ci		goto err_out_deinit_card;
37028c2ecf20Sopenharmony_ci	}
37038c2ecf20Sopenharmony_ci
37048c2ecf20Sopenharmony_ci	dev->ci_range.vpi_bits = card->vpibits;
37058c2ecf20Sopenharmony_ci	dev->ci_range.vci_bits = card->vcibits;
37068c2ecf20Sopenharmony_ci	dev->link_rate = card->link_pcr;
37078c2ecf20Sopenharmony_ci
37088c2ecf20Sopenharmony_ci	if (dev->phy->start)
37098c2ecf20Sopenharmony_ci		dev->phy->start(dev);
37108c2ecf20Sopenharmony_ci
37118c2ecf20Sopenharmony_ci	if (idt77252_dev_open(card)) {
37128c2ecf20Sopenharmony_ci		printk("%s: dev_open failed\n", card->name);
37138c2ecf20Sopenharmony_ci		err = -EIO;
37148c2ecf20Sopenharmony_ci		goto err_out_stop;
37158c2ecf20Sopenharmony_ci	}
37168c2ecf20Sopenharmony_ci
37178c2ecf20Sopenharmony_ci	*last = card;
37188c2ecf20Sopenharmony_ci	last = &card->next;
37198c2ecf20Sopenharmony_ci	index++;
37208c2ecf20Sopenharmony_ci
37218c2ecf20Sopenharmony_ci	return 0;
37228c2ecf20Sopenharmony_ci
37238c2ecf20Sopenharmony_cierr_out_stop:
37248c2ecf20Sopenharmony_ci	if (dev->phy->stop)
37258c2ecf20Sopenharmony_ci		dev->phy->stop(dev);
37268c2ecf20Sopenharmony_ci
37278c2ecf20Sopenharmony_cierr_out_deinit_card:
37288c2ecf20Sopenharmony_ci	deinit_card(card);
37298c2ecf20Sopenharmony_ci
37308c2ecf20Sopenharmony_cierr_out_iounmap:
37318c2ecf20Sopenharmony_ci	iounmap(card->membase);
37328c2ecf20Sopenharmony_ci
37338c2ecf20Sopenharmony_cierr_out_free_card:
37348c2ecf20Sopenharmony_ci	kfree(card);
37358c2ecf20Sopenharmony_ci
37368c2ecf20Sopenharmony_cierr_out_disable_pdev:
37378c2ecf20Sopenharmony_ci	pci_disable_device(pcidev);
37388c2ecf20Sopenharmony_ci	return err;
37398c2ecf20Sopenharmony_ci}
37408c2ecf20Sopenharmony_ci
37418c2ecf20Sopenharmony_cistatic const struct pci_device_id idt77252_pci_tbl[] =
37428c2ecf20Sopenharmony_ci{
37438c2ecf20Sopenharmony_ci	{ PCI_VDEVICE(IDT, PCI_DEVICE_ID_IDT_IDT77252), 0 },
37448c2ecf20Sopenharmony_ci	{ 0, }
37458c2ecf20Sopenharmony_ci};
37468c2ecf20Sopenharmony_ci
37478c2ecf20Sopenharmony_ciMODULE_DEVICE_TABLE(pci, idt77252_pci_tbl);
37488c2ecf20Sopenharmony_ci
37498c2ecf20Sopenharmony_cistatic struct pci_driver idt77252_driver = {
37508c2ecf20Sopenharmony_ci	.name		= "idt77252",
37518c2ecf20Sopenharmony_ci	.id_table	= idt77252_pci_tbl,
37528c2ecf20Sopenharmony_ci	.probe		= idt77252_init_one,
37538c2ecf20Sopenharmony_ci};
37548c2ecf20Sopenharmony_ci
37558c2ecf20Sopenharmony_cistatic int __init idt77252_init(void)
37568c2ecf20Sopenharmony_ci{
37578c2ecf20Sopenharmony_ci	struct sk_buff *skb;
37588c2ecf20Sopenharmony_ci
37598c2ecf20Sopenharmony_ci	printk("%s: at %p\n", __func__, idt77252_init);
37608c2ecf20Sopenharmony_ci
37618c2ecf20Sopenharmony_ci	if (sizeof(skb->cb) < sizeof(struct atm_skb_data) +
37628c2ecf20Sopenharmony_ci			      sizeof(struct idt77252_skb_prv)) {
37638c2ecf20Sopenharmony_ci		printk(KERN_ERR "%s: skb->cb is too small (%lu < %lu)\n",
37648c2ecf20Sopenharmony_ci		       __func__, (unsigned long) sizeof(skb->cb),
37658c2ecf20Sopenharmony_ci		       (unsigned long) sizeof(struct atm_skb_data) +
37668c2ecf20Sopenharmony_ci				       sizeof(struct idt77252_skb_prv));
37678c2ecf20Sopenharmony_ci		return -EIO;
37688c2ecf20Sopenharmony_ci	}
37698c2ecf20Sopenharmony_ci
37708c2ecf20Sopenharmony_ci	return pci_register_driver(&idt77252_driver);
37718c2ecf20Sopenharmony_ci}
37728c2ecf20Sopenharmony_ci
37738c2ecf20Sopenharmony_cistatic void __exit idt77252_exit(void)
37748c2ecf20Sopenharmony_ci{
37758c2ecf20Sopenharmony_ci	struct idt77252_dev *card;
37768c2ecf20Sopenharmony_ci	struct atm_dev *dev;
37778c2ecf20Sopenharmony_ci
37788c2ecf20Sopenharmony_ci	pci_unregister_driver(&idt77252_driver);
37798c2ecf20Sopenharmony_ci
37808c2ecf20Sopenharmony_ci	while (idt77252_chain) {
37818c2ecf20Sopenharmony_ci		card = idt77252_chain;
37828c2ecf20Sopenharmony_ci		dev = card->atmdev;
37838c2ecf20Sopenharmony_ci		idt77252_chain = card->next;
37848c2ecf20Sopenharmony_ci		del_timer_sync(&card->tst_timer);
37858c2ecf20Sopenharmony_ci
37868c2ecf20Sopenharmony_ci		if (dev->phy->stop)
37878c2ecf20Sopenharmony_ci			dev->phy->stop(dev);
37888c2ecf20Sopenharmony_ci		deinit_card(card);
37898c2ecf20Sopenharmony_ci		pci_disable_device(card->pcidev);
37908c2ecf20Sopenharmony_ci		kfree(card);
37918c2ecf20Sopenharmony_ci	}
37928c2ecf20Sopenharmony_ci
37938c2ecf20Sopenharmony_ci	DIPRINTK("idt77252: finished cleanup-module().\n");
37948c2ecf20Sopenharmony_ci}
37958c2ecf20Sopenharmony_ci
37968c2ecf20Sopenharmony_cimodule_init(idt77252_init);
37978c2ecf20Sopenharmony_cimodule_exit(idt77252_exit);
37988c2ecf20Sopenharmony_ci
37998c2ecf20Sopenharmony_ciMODULE_LICENSE("GPL");
38008c2ecf20Sopenharmony_ci
38018c2ecf20Sopenharmony_cimodule_param(vpibits, uint, 0);
38028c2ecf20Sopenharmony_ciMODULE_PARM_DESC(vpibits, "number of VPI bits supported (0, 1, or 2)");
38038c2ecf20Sopenharmony_ci#ifdef CONFIG_ATM_IDT77252_DEBUG
38048c2ecf20Sopenharmony_cimodule_param(debug, ulong, 0644);
38058c2ecf20Sopenharmony_ciMODULE_PARM_DESC(debug,   "debug bitmap, see drivers/atm/idt77252.h");
38068c2ecf20Sopenharmony_ci#endif
38078c2ecf20Sopenharmony_ci
38088c2ecf20Sopenharmony_ciMODULE_AUTHOR("Eddie C. Dost <ecd@atecom.com>");
38098c2ecf20Sopenharmony_ciMODULE_DESCRIPTION("IDT77252 ABR SAR Driver");
3810