xref: /openbmc/linux/drivers/atm/eni.c (revision 78e4be16)
11da177e4SLinus Torvalds /* drivers/atm/eni.c - Efficient Networks ENI155P device driver */
21da177e4SLinus Torvalds 
31da177e4SLinus Torvalds /* Written 1995-2000 by Werner Almesberger, EPFL LRC/ICA */
41da177e4SLinus Torvalds 
51da177e4SLinus Torvalds 
61da177e4SLinus Torvalds #include <linux/module.h>
71da177e4SLinus Torvalds #include <linux/kernel.h>
81da177e4SLinus Torvalds #include <linux/mm.h>
91da177e4SLinus Torvalds #include <linux/pci.h>
101da177e4SLinus Torvalds #include <linux/errno.h>
111da177e4SLinus Torvalds #include <linux/atm.h>
121da177e4SLinus Torvalds #include <linux/atmdev.h>
131da177e4SLinus Torvalds #include <linux/sonet.h>
141da177e4SLinus Torvalds #include <linux/skbuff.h>
151da177e4SLinus Torvalds #include <linux/time.h>
161da177e4SLinus Torvalds #include <linux/delay.h>
171da177e4SLinus Torvalds #include <linux/uio.h>
181da177e4SLinus Torvalds #include <linux/init.h>
191da177e4SLinus Torvalds #include <linux/atm_eni.h>
201da177e4SLinus Torvalds #include <linux/bitops.h>
211da177e4SLinus Torvalds #include <asm/system.h>
221da177e4SLinus Torvalds #include <asm/io.h>
231da177e4SLinus Torvalds #include <asm/atomic.h>
241da177e4SLinus Torvalds #include <asm/uaccess.h>
251da177e4SLinus Torvalds #include <asm/string.h>
261da177e4SLinus Torvalds #include <asm/byteorder.h>
271da177e4SLinus Torvalds 
281da177e4SLinus Torvalds #include "tonga.h"
291da177e4SLinus Torvalds #include "midway.h"
301da177e4SLinus Torvalds #include "suni.h"
311da177e4SLinus Torvalds #include "eni.h"
321da177e4SLinus Torvalds 
331da177e4SLinus Torvalds #if !defined(__i386__) && !defined(__x86_64__)
341da177e4SLinus Torvalds #ifndef ioremap_nocache
351da177e4SLinus Torvalds #define ioremap_nocache(X,Y) ioremap(X,Y)
361da177e4SLinus Torvalds #endif
371da177e4SLinus Torvalds #endif
381da177e4SLinus Torvalds 
391da177e4SLinus Torvalds /*
401da177e4SLinus Torvalds  * TODO:
411da177e4SLinus Torvalds  *
421da177e4SLinus Torvalds  * Show stoppers
431da177e4SLinus Torvalds  *  none
441da177e4SLinus Torvalds  *
451da177e4SLinus Torvalds  * Minor
461da177e4SLinus Torvalds  *  - OAM support
471da177e4SLinus Torvalds  *  - fix bugs listed below
481da177e4SLinus Torvalds  */
491da177e4SLinus Torvalds 
501da177e4SLinus Torvalds /*
511da177e4SLinus Torvalds  * KNOWN BUGS:
521da177e4SLinus Torvalds  *
531da177e4SLinus Torvalds  * - may run into JK-JK bug and deadlock
541da177e4SLinus Torvalds  * - should allocate UBR channel first
551da177e4SLinus Torvalds  * - buffer space allocation algorithm is stupid
561da177e4SLinus Torvalds  *   (RX: should be maxSDU+maxdelay*rate
571da177e4SLinus Torvalds  *    TX: should be maxSDU+min(maxSDU,maxdelay*rate) )
581da177e4SLinus Torvalds  * - doesn't support OAM cells
591da177e4SLinus Torvalds  * - eni_put_free may hang if not putting memory fragments that _complete_
601da177e4SLinus Torvalds  *   2^n block (never happens in real life, though)
611da177e4SLinus Torvalds  */
621da177e4SLinus Torvalds 
631da177e4SLinus Torvalds 
641da177e4SLinus Torvalds #if 0
651da177e4SLinus Torvalds #define DPRINTK(format,args...) printk(KERN_DEBUG format,##args)
661da177e4SLinus Torvalds #else
671da177e4SLinus Torvalds #define DPRINTK(format,args...)
681da177e4SLinus Torvalds #endif
691da177e4SLinus Torvalds 
701da177e4SLinus Torvalds 
711da177e4SLinus Torvalds #ifndef CONFIG_ATM_ENI_TUNE_BURST
721da177e4SLinus Torvalds #define CONFIG_ATM_ENI_BURST_TX_8W
731da177e4SLinus Torvalds #define CONFIG_ATM_ENI_BURST_RX_4W
741da177e4SLinus Torvalds #endif
751da177e4SLinus Torvalds 
761da177e4SLinus Torvalds 
771da177e4SLinus Torvalds #ifndef CONFIG_ATM_ENI_DEBUG
781da177e4SLinus Torvalds 
791da177e4SLinus Torvalds 
801da177e4SLinus Torvalds #define NULLCHECK(x)
811da177e4SLinus Torvalds 
821da177e4SLinus Torvalds #define EVENT(s,a,b)
831da177e4SLinus Torvalds 
841da177e4SLinus Torvalds 
851da177e4SLinus Torvalds static void event_dump(void)
861da177e4SLinus Torvalds {
871da177e4SLinus Torvalds }
881da177e4SLinus Torvalds 
891da177e4SLinus Torvalds 
901da177e4SLinus Torvalds #else
911da177e4SLinus Torvalds 
921da177e4SLinus Torvalds 
931da177e4SLinus Torvalds /*
941da177e4SLinus Torvalds  * NULL pointer checking
951da177e4SLinus Torvalds  */
961da177e4SLinus Torvalds 
971da177e4SLinus Torvalds #define NULLCHECK(x) \
981da177e4SLinus Torvalds 	if ((unsigned long) (x) < 0x30) \
991da177e4SLinus Torvalds 		printk(KERN_CRIT #x "==0x%lx\n",(unsigned long) (x))
1001da177e4SLinus Torvalds 
1011da177e4SLinus Torvalds /*
1021da177e4SLinus Torvalds  * Very extensive activity logging. Greatly improves bug detection speed but
1031da177e4SLinus Torvalds  * costs a few Mbps if enabled.
1041da177e4SLinus Torvalds  */
1051da177e4SLinus Torvalds 
1061da177e4SLinus Torvalds #define EV 64
1071da177e4SLinus Torvalds 
1081da177e4SLinus Torvalds static const char *ev[EV];
1091da177e4SLinus Torvalds static unsigned long ev_a[EV],ev_b[EV];
1101da177e4SLinus Torvalds static int ec = 0;
1111da177e4SLinus Torvalds 
1121da177e4SLinus Torvalds 
1131da177e4SLinus Torvalds static void EVENT(const char *s,unsigned long a,unsigned long b)
1141da177e4SLinus Torvalds {
1151da177e4SLinus Torvalds 	ev[ec] = s;
1161da177e4SLinus Torvalds 	ev_a[ec] = a;
1171da177e4SLinus Torvalds 	ev_b[ec] = b;
1181da177e4SLinus Torvalds 	ec = (ec+1) % EV;
1191da177e4SLinus Torvalds }
1201da177e4SLinus Torvalds 
1211da177e4SLinus Torvalds 
1221da177e4SLinus Torvalds static void event_dump(void)
1231da177e4SLinus Torvalds {
1241da177e4SLinus Torvalds 	int n,i;
1251da177e4SLinus Torvalds 
1261da177e4SLinus Torvalds 	for (n = 0; n < EV; n++) {
1271da177e4SLinus Torvalds 		i = (ec+n) % EV;
1281da177e4SLinus Torvalds 		printk(KERN_NOTICE);
1291da177e4SLinus Torvalds 		printk(ev[i] ? ev[i] : "(null)",ev_a[i],ev_b[i]);
1301da177e4SLinus Torvalds 	}
1311da177e4SLinus Torvalds }
1321da177e4SLinus Torvalds 
1331da177e4SLinus Torvalds 
1341da177e4SLinus Torvalds #endif /* CONFIG_ATM_ENI_DEBUG */
1351da177e4SLinus Torvalds 
1361da177e4SLinus Torvalds 
1371da177e4SLinus Torvalds /*
1381da177e4SLinus Torvalds  * NExx   must not be equal at end
1391da177e4SLinus Torvalds  * EExx   may be equal at end
1401da177e4SLinus Torvalds  * xxPJOK verify validity of pointer jumps
1411da177e4SLinus Torvalds  * xxPMOK operating on a circular buffer of "c" words
1421da177e4SLinus Torvalds  */
1431da177e4SLinus Torvalds 
1441da177e4SLinus Torvalds #define NEPJOK(a0,a1,b) \
1451da177e4SLinus Torvalds     ((a0) < (a1) ? (b) <= (a0) || (b) > (a1) : (b) <= (a0) && (b) > (a1))
1461da177e4SLinus Torvalds #define EEPJOK(a0,a1,b) \
1471da177e4SLinus Torvalds     ((a0) < (a1) ? (b) < (a0) || (b) >= (a1) : (b) < (a0) && (b) >= (a1))
1481da177e4SLinus Torvalds #define NEPMOK(a0,d,b,c) NEPJOK(a0,(a0+d) & (c-1),b)
1491da177e4SLinus Torvalds #define EEPMOK(a0,d,b,c) EEPJOK(a0,(a0+d) & (c-1),b)
1501da177e4SLinus Torvalds 
1511da177e4SLinus Torvalds 
1521da177e4SLinus Torvalds static int tx_complete = 0,dma_complete = 0,queued = 0,requeued = 0,
1531da177e4SLinus Torvalds   backlogged = 0,rx_enqueued = 0,rx_dequeued = 0,pushed = 0,submitted = 0,
1541da177e4SLinus Torvalds   putting = 0;
1551da177e4SLinus Torvalds 
1561da177e4SLinus Torvalds static struct atm_dev *eni_boards = NULL;
1571da177e4SLinus Torvalds 
1581da177e4SLinus Torvalds static u32 *cpu_zeroes = NULL; /* aligned "magic" zeroes */
1591da177e4SLinus Torvalds static dma_addr_t zeroes;
1601da177e4SLinus Torvalds 
1611da177e4SLinus Torvalds /* Read/write registers on card */
1621da177e4SLinus Torvalds #define eni_in(r)	readl(eni_dev->reg+(r)*4)
1631da177e4SLinus Torvalds #define eni_out(v,r)	writel((v),eni_dev->reg+(r)*4)
1641da177e4SLinus Torvalds 
1651da177e4SLinus Torvalds 
1661da177e4SLinus Torvalds /*-------------------------------- utilities --------------------------------*/
1671da177e4SLinus Torvalds 
1681da177e4SLinus Torvalds 
1691da177e4SLinus Torvalds static void dump_mem(struct eni_dev *eni_dev)
1701da177e4SLinus Torvalds {
1711da177e4SLinus Torvalds 	int i;
1721da177e4SLinus Torvalds 
1731da177e4SLinus Torvalds 	for (i = 0; i < eni_dev->free_len; i++)
1741da177e4SLinus Torvalds 		printk(KERN_DEBUG "  %d: %p %d\n",i,
1751da177e4SLinus Torvalds 		    eni_dev->free_list[i].start,
1761da177e4SLinus Torvalds 		    1 << eni_dev->free_list[i].order);
1771da177e4SLinus Torvalds }
1781da177e4SLinus Torvalds 
1791da177e4SLinus Torvalds 
1801da177e4SLinus Torvalds static void dump(struct atm_dev *dev)
1811da177e4SLinus Torvalds {
1821da177e4SLinus Torvalds 	struct eni_dev *eni_dev;
1831da177e4SLinus Torvalds 
1841da177e4SLinus Torvalds 	int i;
1851da177e4SLinus Torvalds 
1861da177e4SLinus Torvalds 	eni_dev = ENI_DEV(dev);
1871da177e4SLinus Torvalds 	printk(KERN_NOTICE "Free memory\n");
1881da177e4SLinus Torvalds 	dump_mem(eni_dev);
1891da177e4SLinus Torvalds 	printk(KERN_NOTICE "TX buffers\n");
1901da177e4SLinus Torvalds 	for (i = 0; i < NR_CHAN; i++)
1911da177e4SLinus Torvalds 		if (eni_dev->tx[i].send)
1921da177e4SLinus Torvalds 			printk(KERN_NOTICE "  TX %d @ %p: %ld\n",i,
1931da177e4SLinus Torvalds 			    eni_dev->tx[i].send,eni_dev->tx[i].words*4);
1941da177e4SLinus Torvalds 	printk(KERN_NOTICE "RX buffers\n");
1951da177e4SLinus Torvalds 	for (i = 0; i < 1024; i++)
1961da177e4SLinus Torvalds 		if (eni_dev->rx_map[i] && ENI_VCC(eni_dev->rx_map[i])->rx)
1971da177e4SLinus Torvalds 			printk(KERN_NOTICE "  RX %d @ %p: %ld\n",i,
1981da177e4SLinus Torvalds 			    ENI_VCC(eni_dev->rx_map[i])->recv,
1991da177e4SLinus Torvalds 			    ENI_VCC(eni_dev->rx_map[i])->words*4);
2001da177e4SLinus Torvalds 	printk(KERN_NOTICE "----\n");
2011da177e4SLinus Torvalds }
2021da177e4SLinus Torvalds 
2031da177e4SLinus Torvalds 
2041da177e4SLinus Torvalds static void eni_put_free(struct eni_dev *eni_dev, void __iomem *start,
2051da177e4SLinus Torvalds     unsigned long size)
2061da177e4SLinus Torvalds {
2071da177e4SLinus Torvalds 	struct eni_free *list;
2081da177e4SLinus Torvalds 	int len,order;
2091da177e4SLinus Torvalds 
2101da177e4SLinus Torvalds 	DPRINTK("init 0x%lx+%ld(0x%lx)\n",start,size,size);
2111da177e4SLinus Torvalds 	start += eni_dev->base_diff;
2121da177e4SLinus Torvalds 	list = eni_dev->free_list;
2131da177e4SLinus Torvalds 	len = eni_dev->free_len;
2141da177e4SLinus Torvalds 	while (size) {
2151da177e4SLinus Torvalds 		if (len >= eni_dev->free_list_size) {
2161da177e4SLinus Torvalds 			printk(KERN_CRIT "eni_put_free overflow (%p,%ld)\n",
2171da177e4SLinus Torvalds 			    start,size);
2181da177e4SLinus Torvalds 			break;
2191da177e4SLinus Torvalds 		}
2201da177e4SLinus Torvalds 		for (order = 0; !(((unsigned long)start | size) & (1 << order)); order++);
2211da177e4SLinus Torvalds 		if (MID_MIN_BUF_SIZE > (1 << order)) {
2221da177e4SLinus Torvalds 			printk(KERN_CRIT "eni_put_free: order %d too small\n",
2231da177e4SLinus Torvalds 			    order);
2241da177e4SLinus Torvalds 			break;
2251da177e4SLinus Torvalds 		}
2261da177e4SLinus Torvalds 		list[len].start = (void __iomem *) start;
2271da177e4SLinus Torvalds 		list[len].order = order;
2281da177e4SLinus Torvalds 		len++;
2291da177e4SLinus Torvalds 		start += 1 << order;
2301da177e4SLinus Torvalds 		size -= 1 << order;
2311da177e4SLinus Torvalds 	}
2321da177e4SLinus Torvalds 	eni_dev->free_len = len;
2331da177e4SLinus Torvalds 	/*dump_mem(eni_dev);*/
2341da177e4SLinus Torvalds }
2351da177e4SLinus Torvalds 
2361da177e4SLinus Torvalds 
2371da177e4SLinus Torvalds static void __iomem *eni_alloc_mem(struct eni_dev *eni_dev, unsigned long *size)
2381da177e4SLinus Torvalds {
2391da177e4SLinus Torvalds 	struct eni_free *list;
2401da177e4SLinus Torvalds 	void __iomem *start;
2411da177e4SLinus Torvalds 	int len,i,order,best_order,index;
2421da177e4SLinus Torvalds 
2431da177e4SLinus Torvalds 	list = eni_dev->free_list;
2441da177e4SLinus Torvalds 	len = eni_dev->free_len;
2451da177e4SLinus Torvalds 	if (*size < MID_MIN_BUF_SIZE) *size = MID_MIN_BUF_SIZE;
2461da177e4SLinus Torvalds 	if (*size > MID_MAX_BUF_SIZE) return NULL;
2471da177e4SLinus Torvalds 	for (order = 0; (1 << order) < *size; order++);
2481da177e4SLinus Torvalds 	DPRINTK("trying: %ld->%d\n",*size,order);
2491da177e4SLinus Torvalds 	best_order = 65; /* we don't have more than 2^64 of anything ... */
2501da177e4SLinus Torvalds 	index = 0; /* silence GCC */
2511da177e4SLinus Torvalds 	for (i = 0; i < len; i++)
2521da177e4SLinus Torvalds 		if (list[i].order == order) {
2531da177e4SLinus Torvalds 			best_order = order;
2541da177e4SLinus Torvalds 			index = i;
2551da177e4SLinus Torvalds 			break;
2561da177e4SLinus Torvalds 		}
2571da177e4SLinus Torvalds 		else if (best_order > list[i].order && list[i].order > order) {
2581da177e4SLinus Torvalds 				best_order = list[i].order;
2591da177e4SLinus Torvalds 				index = i;
2601da177e4SLinus Torvalds 			}
2611da177e4SLinus Torvalds 	if (best_order == 65) return NULL;
2621da177e4SLinus Torvalds 	start = list[index].start-eni_dev->base_diff;
2631da177e4SLinus Torvalds 	list[index] = list[--len];
2641da177e4SLinus Torvalds 	eni_dev->free_len = len;
2651da177e4SLinus Torvalds 	*size = 1 << order;
2661da177e4SLinus Torvalds 	eni_put_free(eni_dev,start+*size,(1 << best_order)-*size);
2671da177e4SLinus Torvalds 	DPRINTK("%ld bytes (order %d) at 0x%lx\n",*size,order,start);
2681da177e4SLinus Torvalds 	memset_io(start,0,*size);       /* never leak data */
2691da177e4SLinus Torvalds 	/*dump_mem(eni_dev);*/
2701da177e4SLinus Torvalds 	return start;
2711da177e4SLinus Torvalds }
2721da177e4SLinus Torvalds 
2731da177e4SLinus Torvalds 
2741da177e4SLinus Torvalds static void eni_free_mem(struct eni_dev *eni_dev, void __iomem *start,
2751da177e4SLinus Torvalds     unsigned long size)
2761da177e4SLinus Torvalds {
2771da177e4SLinus Torvalds 	struct eni_free *list;
2781da177e4SLinus Torvalds 	int len,i,order;
2791da177e4SLinus Torvalds 
2801da177e4SLinus Torvalds 	start += eni_dev->base_diff;
2811da177e4SLinus Torvalds 	list = eni_dev->free_list;
2821da177e4SLinus Torvalds 	len = eni_dev->free_len;
2831da177e4SLinus Torvalds 	for (order = -1; size; order++) size >>= 1;
2841da177e4SLinus Torvalds 	DPRINTK("eni_free_mem: %p+0x%lx (order %d)\n",start,size,order);
2851da177e4SLinus Torvalds 	for (i = 0; i < len; i++)
2861da177e4SLinus Torvalds 		if (((unsigned long) list[i].start) == ((unsigned long)start^(1 << order)) &&
2871da177e4SLinus Torvalds 		    list[i].order == order) {
2881da177e4SLinus Torvalds 			DPRINTK("match[%d]: 0x%lx/0x%lx(0x%x), %d/%d\n",i,
2891da177e4SLinus Torvalds 			    list[i].start,start,1 << order,list[i].order,order);
2901da177e4SLinus Torvalds 			list[i] = list[--len];
2911da177e4SLinus Torvalds 			start = (void __iomem *) ((unsigned long) start & ~(unsigned long) (1 << order));
2921da177e4SLinus Torvalds 			order++;
2931da177e4SLinus Torvalds 			i = -1;
2941da177e4SLinus Torvalds 			continue;
2951da177e4SLinus Torvalds 		}
2961da177e4SLinus Torvalds 	if (len >= eni_dev->free_list_size) {
2971da177e4SLinus Torvalds 		printk(KERN_ALERT "eni_free_mem overflow (%p,%d)\n",start,
2981da177e4SLinus Torvalds 		    order);
2991da177e4SLinus Torvalds 		return;
3001da177e4SLinus Torvalds 	}
3011da177e4SLinus Torvalds 	list[len].start = start;
3021da177e4SLinus Torvalds 	list[len].order = order;
3031da177e4SLinus Torvalds 	eni_dev->free_len = len+1;
3041da177e4SLinus Torvalds 	/*dump_mem(eni_dev);*/
3051da177e4SLinus Torvalds }
3061da177e4SLinus Torvalds 
3071da177e4SLinus Torvalds 
3081da177e4SLinus Torvalds /*----------------------------------- RX ------------------------------------*/
3091da177e4SLinus Torvalds 
3101da177e4SLinus Torvalds 
3111da177e4SLinus Torvalds #define ENI_VCC_NOS ((struct atm_vcc *) 1)
3121da177e4SLinus Torvalds 
3131da177e4SLinus Torvalds 
3141da177e4SLinus Torvalds static void rx_ident_err(struct atm_vcc *vcc)
3151da177e4SLinus Torvalds {
3161da177e4SLinus Torvalds 	struct atm_dev *dev;
3171da177e4SLinus Torvalds 	struct eni_dev *eni_dev;
3181da177e4SLinus Torvalds 	struct eni_vcc *eni_vcc;
3191da177e4SLinus Torvalds 
3201da177e4SLinus Torvalds 	dev = vcc->dev;
3211da177e4SLinus Torvalds 	eni_dev = ENI_DEV(dev);
3221da177e4SLinus Torvalds 	/* immediately halt adapter */
3231da177e4SLinus Torvalds 	eni_out(eni_in(MID_MC_S) &
3241da177e4SLinus Torvalds 	    ~(MID_DMA_ENABLE | MID_TX_ENABLE | MID_RX_ENABLE),MID_MC_S);
3251da177e4SLinus Torvalds 	/* dump useful information */
3261da177e4SLinus Torvalds 	eni_vcc = ENI_VCC(vcc);
3271da177e4SLinus Torvalds 	printk(KERN_ALERT DEV_LABEL "(itf %d): driver error - RX ident "
3281da177e4SLinus Torvalds 	    "mismatch\n",dev->number);
3291da177e4SLinus Torvalds 	printk(KERN_ALERT "  VCI %d, rxing %d, words %ld\n",vcc->vci,
3301da177e4SLinus Torvalds 	    eni_vcc->rxing,eni_vcc->words);
3311da177e4SLinus Torvalds 	printk(KERN_ALERT "  host descr 0x%lx, rx pos 0x%lx, descr value "
3321da177e4SLinus Torvalds 	    "0x%x\n",eni_vcc->descr,eni_vcc->rx_pos,
3331da177e4SLinus Torvalds 	    (unsigned) readl(eni_vcc->recv+eni_vcc->descr*4));
3341da177e4SLinus Torvalds 	printk(KERN_ALERT "  last %p, servicing %d\n",eni_vcc->last,
3351da177e4SLinus Torvalds 	    eni_vcc->servicing);
3361da177e4SLinus Torvalds 	EVENT("---dump ends here---\n",0,0);
3371da177e4SLinus Torvalds 	printk(KERN_NOTICE "---recent events---\n");
3381da177e4SLinus Torvalds 	event_dump();
3391da177e4SLinus Torvalds 	ENI_DEV(dev)->fast = NULL; /* really stop it */
3401da177e4SLinus Torvalds 	ENI_DEV(dev)->slow = NULL;
3411da177e4SLinus Torvalds 	skb_queue_head_init(&ENI_DEV(dev)->rx_queue);
3421da177e4SLinus Torvalds }
3431da177e4SLinus Torvalds 
3441da177e4SLinus Torvalds 
3451da177e4SLinus Torvalds static int do_rx_dma(struct atm_vcc *vcc,struct sk_buff *skb,
3461da177e4SLinus Torvalds     unsigned long skip,unsigned long size,unsigned long eff)
3471da177e4SLinus Torvalds {
3481da177e4SLinus Torvalds 	struct eni_dev *eni_dev;
3491da177e4SLinus Torvalds 	struct eni_vcc *eni_vcc;
3501da177e4SLinus Torvalds 	u32 dma_rd,dma_wr;
3511da177e4SLinus Torvalds 	u32 dma[RX_DMA_BUF*2];
3521da177e4SLinus Torvalds 	dma_addr_t paddr;
3531da177e4SLinus Torvalds 	unsigned long here;
3541da177e4SLinus Torvalds 	int i,j;
3551da177e4SLinus Torvalds 
3561da177e4SLinus Torvalds 	eni_dev = ENI_DEV(vcc->dev);
3571da177e4SLinus Torvalds 	eni_vcc = ENI_VCC(vcc);
3581da177e4SLinus Torvalds 	paddr = 0; /* GCC, shut up */
3591da177e4SLinus Torvalds 	if (skb) {
3601da177e4SLinus Torvalds 		paddr = pci_map_single(eni_dev->pci_dev,skb->data,skb->len,
3611da177e4SLinus Torvalds 		    PCI_DMA_FROMDEVICE);
3621da177e4SLinus Torvalds 		ENI_PRV_PADDR(skb) = paddr;
3631da177e4SLinus Torvalds 		if (paddr & 3)
3641da177e4SLinus Torvalds 			printk(KERN_CRIT DEV_LABEL "(itf %d): VCI %d has "
3651da177e4SLinus Torvalds 			    "mis-aligned RX data (0x%lx)\n",vcc->dev->number,
3661da177e4SLinus Torvalds 			    vcc->vci,(unsigned long) paddr);
3671da177e4SLinus Torvalds 		ENI_PRV_SIZE(skb) = size+skip;
3681da177e4SLinus Torvalds 		    /* PDU plus descriptor */
3691da177e4SLinus Torvalds 		ATM_SKB(skb)->vcc = vcc;
3701da177e4SLinus Torvalds 	}
3711da177e4SLinus Torvalds 	j = 0;
3721da177e4SLinus Torvalds 	if ((eff && skip) || 1) { /* @@@ actually, skip is always == 1 ... */
3731da177e4SLinus Torvalds 		here = (eni_vcc->descr+skip) & (eni_vcc->words-1);
3741da177e4SLinus Torvalds 		dma[j++] = (here << MID_DMA_COUNT_SHIFT) | (vcc->vci
3751da177e4SLinus Torvalds 		    << MID_DMA_VCI_SHIFT) | MID_DT_JK;
3761da177e4SLinus Torvalds 		j++;
3771da177e4SLinus Torvalds 	}
3781da177e4SLinus Torvalds 	here = (eni_vcc->descr+size+skip) & (eni_vcc->words-1);
3791da177e4SLinus Torvalds 	if (!eff) size += skip;
3801da177e4SLinus Torvalds 	else {
3811da177e4SLinus Torvalds 		unsigned long words;
3821da177e4SLinus Torvalds 
3831da177e4SLinus Torvalds 		if (!size) {
3841da177e4SLinus Torvalds 			DPRINTK("strange things happen ...\n");
3851da177e4SLinus Torvalds 			EVENT("strange things happen ... (skip=%ld,eff=%ld)\n",
3861da177e4SLinus Torvalds 			    size,eff);
3871da177e4SLinus Torvalds 		}
3881da177e4SLinus Torvalds 		words = eff;
3891da177e4SLinus Torvalds 		if (paddr & 15) {
3901da177e4SLinus Torvalds 			unsigned long init;
3911da177e4SLinus Torvalds 
3921da177e4SLinus Torvalds 			init = 4-((paddr & 15) >> 2);
3931da177e4SLinus Torvalds 			if (init > words) init = words;
3941da177e4SLinus Torvalds 			dma[j++] = MID_DT_WORD | (init << MID_DMA_COUNT_SHIFT) |
3951da177e4SLinus Torvalds 			    (vcc->vci << MID_DMA_VCI_SHIFT);
3961da177e4SLinus Torvalds 			dma[j++] = paddr;
3971da177e4SLinus Torvalds 			paddr += init << 2;
3981da177e4SLinus Torvalds 			words -= init;
3991da177e4SLinus Torvalds 		}
4001da177e4SLinus Torvalds #ifdef CONFIG_ATM_ENI_BURST_RX_16W /* may work with some PCI chipsets ... */
4011da177e4SLinus Torvalds 		if (words & ~15) {
4021da177e4SLinus Torvalds 			dma[j++] = MID_DT_16W | ((words >> 4) <<
4031da177e4SLinus Torvalds 			    MID_DMA_COUNT_SHIFT) | (vcc->vci <<
4041da177e4SLinus Torvalds 			    MID_DMA_VCI_SHIFT);
4051da177e4SLinus Torvalds 			dma[j++] = paddr;
4061da177e4SLinus Torvalds 			paddr += (words & ~15) << 2;
4071da177e4SLinus Torvalds 			words &= 15;
4081da177e4SLinus Torvalds 		}
4091da177e4SLinus Torvalds #endif
4101da177e4SLinus Torvalds #ifdef CONFIG_ATM_ENI_BURST_RX_8W  /* works only with *some* PCI chipsets ... */
4111da177e4SLinus Torvalds 		if (words & ~7) {
4121da177e4SLinus Torvalds 			dma[j++] = MID_DT_8W | ((words >> 3) <<
4131da177e4SLinus Torvalds 			    MID_DMA_COUNT_SHIFT) | (vcc->vci <<
4141da177e4SLinus Torvalds 			    MID_DMA_VCI_SHIFT);
4151da177e4SLinus Torvalds 			dma[j++] = paddr;
4161da177e4SLinus Torvalds 			paddr += (words & ~7) << 2;
4171da177e4SLinus Torvalds 			words &= 7;
4181da177e4SLinus Torvalds 		}
4191da177e4SLinus Torvalds #endif
4201da177e4SLinus Torvalds #ifdef CONFIG_ATM_ENI_BURST_RX_4W /* recommended */
4211da177e4SLinus Torvalds 		if (words & ~3) {
4221da177e4SLinus Torvalds 			dma[j++] = MID_DT_4W | ((words >> 2) <<
4231da177e4SLinus Torvalds 			    MID_DMA_COUNT_SHIFT) | (vcc->vci <<
4241da177e4SLinus Torvalds 			    MID_DMA_VCI_SHIFT);
4251da177e4SLinus Torvalds 			dma[j++] = paddr;
4261da177e4SLinus Torvalds 			paddr += (words & ~3) << 2;
4271da177e4SLinus Torvalds 			words &= 3;
4281da177e4SLinus Torvalds 		}
4291da177e4SLinus Torvalds #endif
4301da177e4SLinus Torvalds #ifdef CONFIG_ATM_ENI_BURST_RX_2W /* probably useless if RX_4W, RX_8W, ... */
4311da177e4SLinus Torvalds 		if (words & ~1) {
4321da177e4SLinus Torvalds 			dma[j++] = MID_DT_2W | ((words >> 1) <<
4331da177e4SLinus Torvalds 			    MID_DMA_COUNT_SHIFT) | (vcc->vci <<
4341da177e4SLinus Torvalds 			    MID_DMA_VCI_SHIFT);
4351da177e4SLinus Torvalds 			dma[j++] = paddr;
4361da177e4SLinus Torvalds 			paddr += (words & ~1) << 2;
4371da177e4SLinus Torvalds 			words &= 1;
4381da177e4SLinus Torvalds 		}
4391da177e4SLinus Torvalds #endif
4401da177e4SLinus Torvalds 		if (words) {
4411da177e4SLinus Torvalds 			dma[j++] = MID_DT_WORD | (words << MID_DMA_COUNT_SHIFT)
4421da177e4SLinus Torvalds 			    | (vcc->vci << MID_DMA_VCI_SHIFT);
4431da177e4SLinus Torvalds 			dma[j++] = paddr;
4441da177e4SLinus Torvalds 		}
4451da177e4SLinus Torvalds 	}
4461da177e4SLinus Torvalds 	if (size != eff) {
4471da177e4SLinus Torvalds 		dma[j++] = (here << MID_DMA_COUNT_SHIFT) |
4481da177e4SLinus Torvalds 		    (vcc->vci << MID_DMA_VCI_SHIFT) | MID_DT_JK;
4491da177e4SLinus Torvalds 		j++;
4501da177e4SLinus Torvalds 	}
4511da177e4SLinus Torvalds 	if (!j || j > 2*RX_DMA_BUF) {
4521da177e4SLinus Torvalds 		printk(KERN_CRIT DEV_LABEL "!j or j too big!!!\n");
4531da177e4SLinus Torvalds 		goto trouble;
4541da177e4SLinus Torvalds 	}
4551da177e4SLinus Torvalds 	dma[j-2] |= MID_DMA_END;
4561da177e4SLinus Torvalds 	j = j >> 1;
4571da177e4SLinus Torvalds 	dma_wr = eni_in(MID_DMA_WR_RX);
4581da177e4SLinus Torvalds 	dma_rd = eni_in(MID_DMA_RD_RX);
4591da177e4SLinus Torvalds 	/*
4601da177e4SLinus Torvalds 	 * Can I move the dma_wr pointer by 2j+1 positions without overwriting
4611da177e4SLinus Torvalds 	 * data that hasn't been read (position of dma_rd) yet ?
4621da177e4SLinus Torvalds 	 */
4631da177e4SLinus Torvalds 	if (!NEPMOK(dma_wr,j+j+1,dma_rd,NR_DMA_RX)) { /* @@@ +1 is ugly */
4641da177e4SLinus Torvalds 		printk(KERN_WARNING DEV_LABEL "(itf %d): RX DMA full\n",
4651da177e4SLinus Torvalds 		    vcc->dev->number);
4661da177e4SLinus Torvalds 		goto trouble;
4671da177e4SLinus Torvalds 	}
4681da177e4SLinus Torvalds         for (i = 0; i < j; i++) {
4691da177e4SLinus Torvalds 		writel(dma[i*2],eni_dev->rx_dma+dma_wr*8);
4701da177e4SLinus Torvalds 		writel(dma[i*2+1],eni_dev->rx_dma+dma_wr*8+4);
4711da177e4SLinus Torvalds 		dma_wr = (dma_wr+1) & (NR_DMA_RX-1);
4721da177e4SLinus Torvalds         }
4731da177e4SLinus Torvalds 	if (skb) {
4741da177e4SLinus Torvalds 		ENI_PRV_POS(skb) = eni_vcc->descr+size+1;
4751da177e4SLinus Torvalds 		skb_queue_tail(&eni_dev->rx_queue,skb);
4761da177e4SLinus Torvalds 		eni_vcc->last = skb;
4771da177e4SLinus Torvalds rx_enqueued++;
4781da177e4SLinus Torvalds 	}
4791da177e4SLinus Torvalds 	eni_vcc->descr = here;
4801da177e4SLinus Torvalds 	eni_out(dma_wr,MID_DMA_WR_RX);
4811da177e4SLinus Torvalds 	return 0;
4821da177e4SLinus Torvalds 
4831da177e4SLinus Torvalds trouble:
4841da177e4SLinus Torvalds 	if (paddr)
4851da177e4SLinus Torvalds 		pci_unmap_single(eni_dev->pci_dev,paddr,skb->len,
4861da177e4SLinus Torvalds 		    PCI_DMA_FROMDEVICE);
4871da177e4SLinus Torvalds 	if (skb) dev_kfree_skb_irq(skb);
4881da177e4SLinus Torvalds 	return -1;
4891da177e4SLinus Torvalds }
4901da177e4SLinus Torvalds 
4911da177e4SLinus Torvalds 
4921da177e4SLinus Torvalds static void discard(struct atm_vcc *vcc,unsigned long size)
4931da177e4SLinus Torvalds {
4941da177e4SLinus Torvalds 	struct eni_vcc *eni_vcc;
4951da177e4SLinus Torvalds 
4961da177e4SLinus Torvalds 	eni_vcc = ENI_VCC(vcc);
4971da177e4SLinus Torvalds 	EVENT("discard (size=%ld)\n",size,0);
4981da177e4SLinus Torvalds 	while (do_rx_dma(vcc,NULL,1,size,0)) EVENT("BUSY LOOP",0,0);
4991da177e4SLinus Torvalds 	    /* could do a full fallback, but that might be more expensive */
5001da177e4SLinus Torvalds 	if (eni_vcc->rxing) ENI_PRV_POS(eni_vcc->last) += size+1;
5011da177e4SLinus Torvalds 	else eni_vcc->rx_pos = (eni_vcc->rx_pos+size+1) & (eni_vcc->words-1);
5021da177e4SLinus Torvalds }
5031da177e4SLinus Torvalds 
5041da177e4SLinus Torvalds 
5051da177e4SLinus Torvalds /*
5061da177e4SLinus Torvalds  * TODO: should check whether direct copies (without DMA setup, dequeuing on
5071da177e4SLinus Torvalds  * interrupt, etc.) aren't much faster for AAL0
5081da177e4SLinus Torvalds  */
5091da177e4SLinus Torvalds 
5101da177e4SLinus Torvalds static int rx_aal0(struct atm_vcc *vcc)
5111da177e4SLinus Torvalds {
5121da177e4SLinus Torvalds 	struct eni_vcc *eni_vcc;
5131da177e4SLinus Torvalds 	unsigned long descr;
5141da177e4SLinus Torvalds 	unsigned long length;
5151da177e4SLinus Torvalds 	struct sk_buff *skb;
5161da177e4SLinus Torvalds 
5171da177e4SLinus Torvalds 	DPRINTK(">rx_aal0\n");
5181da177e4SLinus Torvalds 	eni_vcc = ENI_VCC(vcc);
5191da177e4SLinus Torvalds 	descr = readl(eni_vcc->recv+eni_vcc->descr*4);
5201da177e4SLinus Torvalds 	if ((descr & MID_RED_IDEN) != (MID_RED_RX_ID << MID_RED_SHIFT)) {
5211da177e4SLinus Torvalds 		rx_ident_err(vcc);
5221da177e4SLinus Torvalds 		return 1;
5231da177e4SLinus Torvalds 	}
5241da177e4SLinus Torvalds 	if (descr & MID_RED_T) {
5251da177e4SLinus Torvalds 		DPRINTK(DEV_LABEL "(itf %d): trashing empty cell\n",
5261da177e4SLinus Torvalds 		    vcc->dev->number);
5271da177e4SLinus Torvalds 		length = 0;
5281da177e4SLinus Torvalds 		atomic_inc(&vcc->stats->rx_err);
5291da177e4SLinus Torvalds 	}
5301da177e4SLinus Torvalds 	else {
5311da177e4SLinus Torvalds 		length = ATM_CELL_SIZE-1; /* no HEC */
5321da177e4SLinus Torvalds 	}
5331da177e4SLinus Torvalds 	skb = length ? atm_alloc_charge(vcc,length,GFP_ATOMIC) : NULL;
5341da177e4SLinus Torvalds 	if (!skb) {
5351da177e4SLinus Torvalds 		discard(vcc,length >> 2);
5361da177e4SLinus Torvalds 		return 0;
5371da177e4SLinus Torvalds 	}
5381da177e4SLinus Torvalds 	skb_put(skb,length);
5398570419fSYOSHIFUJI Hideaki 	skb->tstamp = eni_vcc->timestamp;
5401da177e4SLinus Torvalds 	DPRINTK("got len %ld\n",length);
5411da177e4SLinus Torvalds 	if (do_rx_dma(vcc,skb,1,length >> 2,length >> 2)) return 1;
5421da177e4SLinus Torvalds 	eni_vcc->rxing++;
5431da177e4SLinus Torvalds 	return 0;
5441da177e4SLinus Torvalds }
5451da177e4SLinus Torvalds 
5461da177e4SLinus Torvalds 
5471da177e4SLinus Torvalds static int rx_aal5(struct atm_vcc *vcc)
5481da177e4SLinus Torvalds {
5491da177e4SLinus Torvalds 	struct eni_vcc *eni_vcc;
5501da177e4SLinus Torvalds 	unsigned long descr;
5511da177e4SLinus Torvalds 	unsigned long size,eff,length;
5521da177e4SLinus Torvalds 	struct sk_buff *skb;
5531da177e4SLinus Torvalds 
5541da177e4SLinus Torvalds 	EVENT("rx_aal5\n",0,0);
5551da177e4SLinus Torvalds 	DPRINTK(">rx_aal5\n");
5561da177e4SLinus Torvalds 	eni_vcc = ENI_VCC(vcc);
5571da177e4SLinus Torvalds 	descr = readl(eni_vcc->recv+eni_vcc->descr*4);
5581da177e4SLinus Torvalds 	if ((descr & MID_RED_IDEN) != (MID_RED_RX_ID << MID_RED_SHIFT)) {
5591da177e4SLinus Torvalds 		rx_ident_err(vcc);
5601da177e4SLinus Torvalds 		return 1;
5611da177e4SLinus Torvalds 	}
5621da177e4SLinus Torvalds 	if (descr & (MID_RED_T | MID_RED_CRC_ERR)) {
5631da177e4SLinus Torvalds 		if (descr & MID_RED_T) {
5641da177e4SLinus Torvalds 			EVENT("empty cell (descr=0x%lx)\n",descr,0);
5651da177e4SLinus Torvalds 			DPRINTK(DEV_LABEL "(itf %d): trashing empty cell\n",
5661da177e4SLinus Torvalds 			    vcc->dev->number);
5671da177e4SLinus Torvalds 			size = 0;
5681da177e4SLinus Torvalds 		}
5691da177e4SLinus Torvalds 		else {
5701da177e4SLinus Torvalds 			static unsigned long silence = 0;
5711da177e4SLinus Torvalds 
5721da177e4SLinus Torvalds 			if (time_after(jiffies, silence) || silence == 0) {
5731da177e4SLinus Torvalds 				printk(KERN_WARNING DEV_LABEL "(itf %d): "
5741da177e4SLinus Torvalds 				    "discarding PDU(s) with CRC error\n",
5751da177e4SLinus Torvalds 				    vcc->dev->number);
5761da177e4SLinus Torvalds 				silence = (jiffies+2*HZ)|1;
5771da177e4SLinus Torvalds 			}
5781da177e4SLinus Torvalds 			size = (descr & MID_RED_COUNT)*(ATM_CELL_PAYLOAD >> 2);
5791da177e4SLinus Torvalds 			EVENT("CRC error (descr=0x%lx,size=%ld)\n",descr,
5801da177e4SLinus Torvalds 			    size);
5811da177e4SLinus Torvalds 		}
5821da177e4SLinus Torvalds 		eff = length = 0;
5831da177e4SLinus Torvalds 		atomic_inc(&vcc->stats->rx_err);
5841da177e4SLinus Torvalds 	}
5851da177e4SLinus Torvalds 	else {
5861da177e4SLinus Torvalds 		size = (descr & MID_RED_COUNT)*(ATM_CELL_PAYLOAD >> 2);
5871da177e4SLinus Torvalds 		DPRINTK("size=%ld\n",size);
5881da177e4SLinus Torvalds 		length = readl(eni_vcc->recv+(((eni_vcc->descr+size-1) &
5891da177e4SLinus Torvalds 		    (eni_vcc->words-1)))*4) & 0xffff;
5901da177e4SLinus Torvalds 				/* -trailer(2)+header(1) */
5911da177e4SLinus Torvalds 		if (length && length <= (size << 2)-8 && length <=
5921da177e4SLinus Torvalds 		  ATM_MAX_AAL5_PDU) eff = (length+3) >> 2;
5931da177e4SLinus Torvalds 		else {				 /* ^ trailer length (8) */
5941da177e4SLinus Torvalds 			EVENT("bad PDU (descr=0x08%lx,length=%ld)\n",descr,
5951da177e4SLinus Torvalds 			    length);
5961da177e4SLinus Torvalds 			printk(KERN_ERR DEV_LABEL "(itf %d): bad AAL5 PDU "
5971da177e4SLinus Torvalds 			    "(VCI=%d,length=%ld,size=%ld (descr 0x%lx))\n",
5981da177e4SLinus Torvalds 			    vcc->dev->number,vcc->vci,length,size << 2,descr);
5991da177e4SLinus Torvalds 			length = eff = 0;
6001da177e4SLinus Torvalds 			atomic_inc(&vcc->stats->rx_err);
6011da177e4SLinus Torvalds 		}
6021da177e4SLinus Torvalds 	}
6031da177e4SLinus Torvalds 	skb = eff ? atm_alloc_charge(vcc,eff << 2,GFP_ATOMIC) : NULL;
6041da177e4SLinus Torvalds 	if (!skb) {
6051da177e4SLinus Torvalds 		discard(vcc,size);
6061da177e4SLinus Torvalds 		return 0;
6071da177e4SLinus Torvalds 	}
6081da177e4SLinus Torvalds 	skb_put(skb,length);
6091da177e4SLinus Torvalds 	DPRINTK("got len %ld\n",length);
6101da177e4SLinus Torvalds 	if (do_rx_dma(vcc,skb,1,size,eff)) return 1;
6111da177e4SLinus Torvalds 	eni_vcc->rxing++;
6121da177e4SLinus Torvalds 	return 0;
6131da177e4SLinus Torvalds }
6141da177e4SLinus Torvalds 
6151da177e4SLinus Torvalds 
6161da177e4SLinus Torvalds static inline int rx_vcc(struct atm_vcc *vcc)
6171da177e4SLinus Torvalds {
6181da177e4SLinus Torvalds 	void __iomem *vci_dsc;
6191da177e4SLinus Torvalds 	unsigned long tmp;
6201da177e4SLinus Torvalds 	struct eni_vcc *eni_vcc;
6211da177e4SLinus Torvalds 
6221da177e4SLinus Torvalds 	eni_vcc = ENI_VCC(vcc);
6231da177e4SLinus Torvalds 	vci_dsc = ENI_DEV(vcc->dev)->vci+vcc->vci*16;
6241da177e4SLinus Torvalds 	EVENT("rx_vcc(1)\n",0,0);
6251da177e4SLinus Torvalds 	while (eni_vcc->descr != (tmp = (readl(vci_dsc+4) & MID_VCI_DESCR) >>
6261da177e4SLinus Torvalds 	    MID_VCI_DESCR_SHIFT)) {
6271da177e4SLinus Torvalds 		EVENT("rx_vcc(2: host dsc=0x%lx, nic dsc=0x%lx)\n",
6281da177e4SLinus Torvalds 		    eni_vcc->descr,tmp);
6291da177e4SLinus Torvalds 		DPRINTK("CB_DESCR %ld REG_DESCR %d\n",ENI_VCC(vcc)->descr,
6301da177e4SLinus Torvalds 		    (((unsigned) readl(vci_dsc+4) & MID_VCI_DESCR) >>
6311da177e4SLinus Torvalds 		    MID_VCI_DESCR_SHIFT));
6321da177e4SLinus Torvalds 		if (ENI_VCC(vcc)->rx(vcc)) return 1;
6331da177e4SLinus Torvalds 	}
6341da177e4SLinus Torvalds 	/* clear IN_SERVICE flag */
6351da177e4SLinus Torvalds 	writel(readl(vci_dsc) & ~MID_VCI_IN_SERVICE,vci_dsc);
6361da177e4SLinus Torvalds 	/*
6371da177e4SLinus Torvalds 	 * If new data has arrived between evaluating the while condition and
6381da177e4SLinus Torvalds 	 * clearing IN_SERVICE, we wouldn't be notified until additional data
6391da177e4SLinus Torvalds 	 * follows. So we have to loop again to be sure.
6401da177e4SLinus Torvalds 	 */
6411da177e4SLinus Torvalds 	EVENT("rx_vcc(3)\n",0,0);
6421da177e4SLinus Torvalds 	while (ENI_VCC(vcc)->descr != (tmp = (readl(vci_dsc+4) & MID_VCI_DESCR)
6431da177e4SLinus Torvalds 	    >> MID_VCI_DESCR_SHIFT)) {
6441da177e4SLinus Torvalds 		EVENT("rx_vcc(4: host dsc=0x%lx, nic dsc=0x%lx)\n",
6451da177e4SLinus Torvalds 		    eni_vcc->descr,tmp);
6461da177e4SLinus Torvalds 		DPRINTK("CB_DESCR %ld REG_DESCR %d\n",ENI_VCC(vcc)->descr,
6471da177e4SLinus Torvalds 		    (((unsigned) readl(vci_dsc+4) & MID_VCI_DESCR) >>
6481da177e4SLinus Torvalds 		    MID_VCI_DESCR_SHIFT));
6491da177e4SLinus Torvalds 		if (ENI_VCC(vcc)->rx(vcc)) return 1;
6501da177e4SLinus Torvalds 	}
6511da177e4SLinus Torvalds 	return 0;
6521da177e4SLinus Torvalds }
6531da177e4SLinus Torvalds 
6541da177e4SLinus Torvalds 
6551da177e4SLinus Torvalds static void poll_rx(struct atm_dev *dev)
6561da177e4SLinus Torvalds {
6571da177e4SLinus Torvalds 	struct eni_dev *eni_dev;
6581da177e4SLinus Torvalds 	struct atm_vcc *curr;
6591da177e4SLinus Torvalds 
6601da177e4SLinus Torvalds 	eni_dev = ENI_DEV(dev);
6611da177e4SLinus Torvalds 	while ((curr = eni_dev->fast)) {
6621da177e4SLinus Torvalds 		EVENT("poll_rx.fast\n",0,0);
6631da177e4SLinus Torvalds 		if (rx_vcc(curr)) return;
6641da177e4SLinus Torvalds 		eni_dev->fast = ENI_VCC(curr)->next;
6651da177e4SLinus Torvalds 		ENI_VCC(curr)->next = ENI_VCC_NOS;
6661da177e4SLinus Torvalds 		barrier();
6671da177e4SLinus Torvalds 		ENI_VCC(curr)->servicing--;
6681da177e4SLinus Torvalds 	}
6691da177e4SLinus Torvalds 	while ((curr = eni_dev->slow)) {
6701da177e4SLinus Torvalds 		EVENT("poll_rx.slow\n",0,0);
6711da177e4SLinus Torvalds 		if (rx_vcc(curr)) return;
6721da177e4SLinus Torvalds 		eni_dev->slow = ENI_VCC(curr)->next;
6731da177e4SLinus Torvalds 		ENI_VCC(curr)->next = ENI_VCC_NOS;
6741da177e4SLinus Torvalds 		barrier();
6751da177e4SLinus Torvalds 		ENI_VCC(curr)->servicing--;
6761da177e4SLinus Torvalds 	}
6771da177e4SLinus Torvalds }
6781da177e4SLinus Torvalds 
6791da177e4SLinus Torvalds 
6801da177e4SLinus Torvalds static void get_service(struct atm_dev *dev)
6811da177e4SLinus Torvalds {
6821da177e4SLinus Torvalds 	struct eni_dev *eni_dev;
6831da177e4SLinus Torvalds 	struct atm_vcc *vcc;
6841da177e4SLinus Torvalds 	unsigned long vci;
6851da177e4SLinus Torvalds 
6861da177e4SLinus Torvalds 	DPRINTK(">get_service\n");
6871da177e4SLinus Torvalds 	eni_dev = ENI_DEV(dev);
6881da177e4SLinus Torvalds 	while (eni_in(MID_SERV_WRITE) != eni_dev->serv_read) {
6891da177e4SLinus Torvalds 		vci = readl(eni_dev->service+eni_dev->serv_read*4);
6901da177e4SLinus Torvalds 		eni_dev->serv_read = (eni_dev->serv_read+1) & (NR_SERVICE-1);
6911da177e4SLinus Torvalds 		vcc = eni_dev->rx_map[vci & 1023];
6921da177e4SLinus Torvalds 		if (!vcc) {
6931da177e4SLinus Torvalds 			printk(KERN_CRIT DEV_LABEL "(itf %d): VCI %ld not "
6941da177e4SLinus Torvalds 			    "found\n",dev->number,vci);
6951da177e4SLinus Torvalds 			continue; /* nasty but we try to go on anyway */
6961da177e4SLinus Torvalds 			/* @@@ nope, doesn't work */
6971da177e4SLinus Torvalds 		}
6981da177e4SLinus Torvalds 		EVENT("getting from service\n",0,0);
6991da177e4SLinus Torvalds 		if (ENI_VCC(vcc)->next != ENI_VCC_NOS) {
7001da177e4SLinus Torvalds 			EVENT("double service\n",0,0);
7011da177e4SLinus Torvalds 			DPRINTK("Grr, servicing VCC %ld twice\n",vci);
7021da177e4SLinus Torvalds 			continue;
7031da177e4SLinus Torvalds 		}
7048570419fSYOSHIFUJI Hideaki 		ENI_VCC(vcc)->timestamp = ktime_get_real();
7051da177e4SLinus Torvalds 		ENI_VCC(vcc)->next = NULL;
7061da177e4SLinus Torvalds 		if (vcc->qos.rxtp.traffic_class == ATM_CBR) {
7071da177e4SLinus Torvalds 			if (eni_dev->fast)
7081da177e4SLinus Torvalds 				ENI_VCC(eni_dev->last_fast)->next = vcc;
7091da177e4SLinus Torvalds 			else eni_dev->fast = vcc;
7101da177e4SLinus Torvalds 			eni_dev->last_fast = vcc;
7111da177e4SLinus Torvalds 		}
7121da177e4SLinus Torvalds 		else {
7131da177e4SLinus Torvalds 			if (eni_dev->slow)
7141da177e4SLinus Torvalds 				ENI_VCC(eni_dev->last_slow)->next = vcc;
7151da177e4SLinus Torvalds 			else eni_dev->slow = vcc;
7161da177e4SLinus Torvalds 			eni_dev->last_slow = vcc;
7171da177e4SLinus Torvalds 		}
7181da177e4SLinus Torvalds putting++;
7191da177e4SLinus Torvalds 		ENI_VCC(vcc)->servicing++;
7201da177e4SLinus Torvalds 	}
7211da177e4SLinus Torvalds }
7221da177e4SLinus Torvalds 
7231da177e4SLinus Torvalds 
7241da177e4SLinus Torvalds static void dequeue_rx(struct atm_dev *dev)
7251da177e4SLinus Torvalds {
7261da177e4SLinus Torvalds 	struct eni_dev *eni_dev;
7271da177e4SLinus Torvalds 	struct eni_vcc *eni_vcc;
7281da177e4SLinus Torvalds 	struct atm_vcc *vcc;
7291da177e4SLinus Torvalds 	struct sk_buff *skb;
7301da177e4SLinus Torvalds 	void __iomem *vci_dsc;
7311da177e4SLinus Torvalds 	int first;
7321da177e4SLinus Torvalds 
7331da177e4SLinus Torvalds 	eni_dev = ENI_DEV(dev);
7341da177e4SLinus Torvalds 	first = 1;
7351da177e4SLinus Torvalds 	while (1) {
7361da177e4SLinus Torvalds 		skb = skb_dequeue(&eni_dev->rx_queue);
7371da177e4SLinus Torvalds 		if (!skb) {
7381da177e4SLinus Torvalds 			if (first) {
7391da177e4SLinus Torvalds 				DPRINTK(DEV_LABEL "(itf %d): RX but not "
7401da177e4SLinus Torvalds 				    "rxing\n",dev->number);
7411da177e4SLinus Torvalds 				EVENT("nothing to dequeue\n",0,0);
7421da177e4SLinus Torvalds 			}
7431da177e4SLinus Torvalds 			break;
7441da177e4SLinus Torvalds 		}
7451da177e4SLinus Torvalds 		EVENT("dequeued (size=%ld,pos=0x%lx)\n",ENI_PRV_SIZE(skb),
7461da177e4SLinus Torvalds 		    ENI_PRV_POS(skb));
7471da177e4SLinus Torvalds rx_dequeued++;
7481da177e4SLinus Torvalds 		vcc = ATM_SKB(skb)->vcc;
7491da177e4SLinus Torvalds 		eni_vcc = ENI_VCC(vcc);
7501da177e4SLinus Torvalds 		first = 0;
7511da177e4SLinus Torvalds 		vci_dsc = eni_dev->vci+vcc->vci*16;
7521da177e4SLinus Torvalds 		if (!EEPMOK(eni_vcc->rx_pos,ENI_PRV_SIZE(skb),
7531da177e4SLinus Torvalds 		    (readl(vci_dsc+4) & MID_VCI_READ) >> MID_VCI_READ_SHIFT,
7541da177e4SLinus Torvalds 		    eni_vcc->words)) {
7551da177e4SLinus Torvalds 			EVENT("requeuing\n",0,0);
7561da177e4SLinus Torvalds 			skb_queue_head(&eni_dev->rx_queue,skb);
7571da177e4SLinus Torvalds 			break;
7581da177e4SLinus Torvalds 		}
7591da177e4SLinus Torvalds 		eni_vcc->rxing--;
7601da177e4SLinus Torvalds 		eni_vcc->rx_pos = ENI_PRV_POS(skb) & (eni_vcc->words-1);
7611da177e4SLinus Torvalds 		pci_unmap_single(eni_dev->pci_dev,ENI_PRV_PADDR(skb),skb->len,
7621da177e4SLinus Torvalds 		    PCI_DMA_TODEVICE);
7631da177e4SLinus Torvalds 		if (!skb->len) dev_kfree_skb_irq(skb);
7641da177e4SLinus Torvalds 		else {
7651da177e4SLinus Torvalds 			EVENT("pushing (len=%ld)\n",skb->len,0);
7661da177e4SLinus Torvalds 			if (vcc->qos.aal == ATM_AAL0)
7671da177e4SLinus Torvalds 				*(unsigned long *) skb->data =
7681da177e4SLinus Torvalds 				    ntohl(*(unsigned long *) skb->data);
7691da177e4SLinus Torvalds 			memset(skb->cb,0,sizeof(struct eni_skb_prv));
7701da177e4SLinus Torvalds 			vcc->push(vcc,skb);
7711da177e4SLinus Torvalds 			pushed++;
7721da177e4SLinus Torvalds 		}
7731da177e4SLinus Torvalds 		atomic_inc(&vcc->stats->rx);
7741da177e4SLinus Torvalds 	}
7751da177e4SLinus Torvalds 	wake_up(&eni_dev->rx_wait);
7761da177e4SLinus Torvalds }
7771da177e4SLinus Torvalds 
7781da177e4SLinus Torvalds 
7791da177e4SLinus Torvalds static int open_rx_first(struct atm_vcc *vcc)
7801da177e4SLinus Torvalds {
7811da177e4SLinus Torvalds 	struct eni_dev *eni_dev;
7821da177e4SLinus Torvalds 	struct eni_vcc *eni_vcc;
7831da177e4SLinus Torvalds 	unsigned long size;
7841da177e4SLinus Torvalds 
7851da177e4SLinus Torvalds 	DPRINTK("open_rx_first\n");
7861da177e4SLinus Torvalds 	eni_dev = ENI_DEV(vcc->dev);
7871da177e4SLinus Torvalds 	eni_vcc = ENI_VCC(vcc);
7881da177e4SLinus Torvalds 	eni_vcc->rx = NULL;
7891da177e4SLinus Torvalds 	if (vcc->qos.rxtp.traffic_class == ATM_NONE) return 0;
7901da177e4SLinus Torvalds 	size = vcc->qos.rxtp.max_sdu*eni_dev->rx_mult/100;
7911da177e4SLinus Torvalds 	if (size > MID_MAX_BUF_SIZE && vcc->qos.rxtp.max_sdu <=
7921da177e4SLinus Torvalds 	    MID_MAX_BUF_SIZE)
7931da177e4SLinus Torvalds 		size = MID_MAX_BUF_SIZE;
7941da177e4SLinus Torvalds 	eni_vcc->recv = eni_alloc_mem(eni_dev,&size);
7951da177e4SLinus Torvalds 	DPRINTK("rx at 0x%lx\n",eni_vcc->recv);
7961da177e4SLinus Torvalds 	eni_vcc->words = size >> 2;
7971da177e4SLinus Torvalds 	if (!eni_vcc->recv) return -ENOBUFS;
7981da177e4SLinus Torvalds 	eni_vcc->rx = vcc->qos.aal == ATM_AAL5 ? rx_aal5 : rx_aal0;
7991da177e4SLinus Torvalds 	eni_vcc->descr = 0;
8001da177e4SLinus Torvalds 	eni_vcc->rx_pos = 0;
8011da177e4SLinus Torvalds 	eni_vcc->rxing = 0;
8021da177e4SLinus Torvalds 	eni_vcc->servicing = 0;
8031da177e4SLinus Torvalds 	eni_vcc->next = ENI_VCC_NOS;
8041da177e4SLinus Torvalds 	return 0;
8051da177e4SLinus Torvalds }
8061da177e4SLinus Torvalds 
8071da177e4SLinus Torvalds 
8081da177e4SLinus Torvalds static int open_rx_second(struct atm_vcc *vcc)
8091da177e4SLinus Torvalds {
8101da177e4SLinus Torvalds 	void __iomem *here;
8111da177e4SLinus Torvalds 	struct eni_dev *eni_dev;
8121da177e4SLinus Torvalds 	struct eni_vcc *eni_vcc;
8131da177e4SLinus Torvalds 	unsigned long size;
8141da177e4SLinus Torvalds 	int order;
8151da177e4SLinus Torvalds 
8161da177e4SLinus Torvalds 	DPRINTK("open_rx_second\n");
8171da177e4SLinus Torvalds 	eni_dev = ENI_DEV(vcc->dev);
8181da177e4SLinus Torvalds 	eni_vcc = ENI_VCC(vcc);
8191da177e4SLinus Torvalds 	if (!eni_vcc->rx) return 0;
8201da177e4SLinus Torvalds 	/* set up VCI descriptor */
8211da177e4SLinus Torvalds 	here = eni_dev->vci+vcc->vci*16;
8221da177e4SLinus Torvalds 	DPRINTK("loc 0x%x\n",(unsigned) (eni_vcc->recv-eni_dev->ram)/4);
8231da177e4SLinus Torvalds 	size = eni_vcc->words >> 8;
8241da177e4SLinus Torvalds 	for (order = -1; size; order++) size >>= 1;
8251da177e4SLinus Torvalds 	writel(0,here+4); /* descr, read = 0 */
8261da177e4SLinus Torvalds 	writel(0,here+8); /* write, state, count = 0 */
8271da177e4SLinus Torvalds 	if (eni_dev->rx_map[vcc->vci])
8281da177e4SLinus Torvalds 		printk(KERN_CRIT DEV_LABEL "(itf %d): BUG - VCI %d already "
8291da177e4SLinus Torvalds 		    "in use\n",vcc->dev->number,vcc->vci);
8301da177e4SLinus Torvalds 	eni_dev->rx_map[vcc->vci] = vcc; /* now it counts */
8311da177e4SLinus Torvalds 	writel(((vcc->qos.aal != ATM_AAL5 ? MID_MODE_RAW : MID_MODE_AAL5) <<
8321da177e4SLinus Torvalds 	    MID_VCI_MODE_SHIFT) | MID_VCI_PTI_MODE |
8331da177e4SLinus Torvalds 	    (((eni_vcc->recv-eni_dev->ram) >> (MID_LOC_SKIP+2)) <<
8341da177e4SLinus Torvalds 	    MID_VCI_LOCATION_SHIFT) | (order << MID_VCI_SIZE_SHIFT),here);
8351da177e4SLinus Torvalds 	return 0;
8361da177e4SLinus Torvalds }
8371da177e4SLinus Torvalds 
8381da177e4SLinus Torvalds 
8391da177e4SLinus Torvalds static void close_rx(struct atm_vcc *vcc)
8401da177e4SLinus Torvalds {
8411da177e4SLinus Torvalds 	DECLARE_WAITQUEUE(wait,current);
8421da177e4SLinus Torvalds 	void __iomem *here;
8431da177e4SLinus Torvalds 	struct eni_dev *eni_dev;
8441da177e4SLinus Torvalds 	struct eni_vcc *eni_vcc;
8451da177e4SLinus Torvalds 
8461da177e4SLinus Torvalds 	eni_vcc = ENI_VCC(vcc);
8471da177e4SLinus Torvalds 	if (!eni_vcc->rx) return;
8481da177e4SLinus Torvalds 	eni_dev = ENI_DEV(vcc->dev);
8491da177e4SLinus Torvalds 	if (vcc->vpi != ATM_VPI_UNSPEC && vcc->vci != ATM_VCI_UNSPEC) {
8501da177e4SLinus Torvalds 		here = eni_dev->vci+vcc->vci*16;
8511da177e4SLinus Torvalds 		/* block receiver */
8521da177e4SLinus Torvalds 		writel((readl(here) & ~MID_VCI_MODE) | (MID_MODE_TRASH <<
8531da177e4SLinus Torvalds 		    MID_VCI_MODE_SHIFT),here);
8541da177e4SLinus Torvalds 		/* wait for receiver to become idle */
8551da177e4SLinus Torvalds 		udelay(27);
8561da177e4SLinus Torvalds 		/* discard pending cell */
8571da177e4SLinus Torvalds 		writel(readl(here) & ~MID_VCI_IN_SERVICE,here);
8581da177e4SLinus Torvalds 		/* don't accept any new ones */
8591da177e4SLinus Torvalds 		eni_dev->rx_map[vcc->vci] = NULL;
8601da177e4SLinus Torvalds 		/* wait for RX queue to drain */
8611da177e4SLinus Torvalds 		DPRINTK("eni_close: waiting for RX ...\n");
8621da177e4SLinus Torvalds 		EVENT("RX closing\n",0,0);
8631da177e4SLinus Torvalds 		add_wait_queue(&eni_dev->rx_wait,&wait);
8641da177e4SLinus Torvalds 		set_current_state(TASK_UNINTERRUPTIBLE);
8651da177e4SLinus Torvalds 		barrier();
8661da177e4SLinus Torvalds 		for (;;) {
8671da177e4SLinus Torvalds 			/* transition service->rx: rxing++, servicing-- */
8681da177e4SLinus Torvalds 			if (!eni_vcc->servicing) {
8691da177e4SLinus Torvalds 				barrier();
8701da177e4SLinus Torvalds 				if (!eni_vcc->rxing) break;
8711da177e4SLinus Torvalds 			}
8721da177e4SLinus Torvalds 			EVENT("drain PDUs (rx %ld, serv %ld)\n",eni_vcc->rxing,
8731da177e4SLinus Torvalds 			    eni_vcc->servicing);
8741da177e4SLinus Torvalds 			printk(KERN_INFO "%d+%d RX left\n",eni_vcc->servicing,
8751da177e4SLinus Torvalds 			    eni_vcc->rxing);
8761da177e4SLinus Torvalds 			schedule();
8771da177e4SLinus Torvalds 			set_current_state(TASK_UNINTERRUPTIBLE);
8781da177e4SLinus Torvalds 		}
8791da177e4SLinus Torvalds 		for (;;) {
8801da177e4SLinus Torvalds 			int at_end;
8811da177e4SLinus Torvalds 			u32 tmp;
8821da177e4SLinus Torvalds 
8831da177e4SLinus Torvalds 			tasklet_disable(&eni_dev->task);
8841da177e4SLinus Torvalds 			tmp = readl(eni_dev->vci+vcc->vci*16+4) & MID_VCI_READ;
8851da177e4SLinus Torvalds 			at_end = eni_vcc->rx_pos == tmp >> MID_VCI_READ_SHIFT;
8861da177e4SLinus Torvalds 			tasklet_enable(&eni_dev->task);
8871da177e4SLinus Torvalds 			if (at_end) break;
8881da177e4SLinus Torvalds 			EVENT("drain discard (host 0x%lx, nic 0x%lx)\n",
8891da177e4SLinus Torvalds 			    eni_vcc->rx_pos,tmp);
8901da177e4SLinus Torvalds 			printk(KERN_INFO "draining RX: host 0x%lx, nic 0x%x\n",
8911da177e4SLinus Torvalds 			    eni_vcc->rx_pos,tmp);
8921da177e4SLinus Torvalds 			schedule();
8931da177e4SLinus Torvalds 			set_current_state(TASK_UNINTERRUPTIBLE);
8941da177e4SLinus Torvalds 		}
8951da177e4SLinus Torvalds 		set_current_state(TASK_RUNNING);
8961da177e4SLinus Torvalds 		remove_wait_queue(&eni_dev->rx_wait,&wait);
8971da177e4SLinus Torvalds 	}
8981da177e4SLinus Torvalds 	eni_free_mem(eni_dev,eni_vcc->recv,eni_vcc->words << 2);
8991da177e4SLinus Torvalds 	eni_vcc->rx = NULL;
9001da177e4SLinus Torvalds }
9011da177e4SLinus Torvalds 
9021da177e4SLinus Torvalds 
9031da177e4SLinus Torvalds static int start_rx(struct atm_dev *dev)
9041da177e4SLinus Torvalds {
9051da177e4SLinus Torvalds 	struct eni_dev *eni_dev;
9061da177e4SLinus Torvalds 
9071da177e4SLinus Torvalds 	eni_dev = ENI_DEV(dev);
9081da177e4SLinus Torvalds 	eni_dev->rx_map = (struct atm_vcc **) get_zeroed_page(GFP_KERNEL);
9091da177e4SLinus Torvalds 	if (!eni_dev->rx_map) {
9101da177e4SLinus Torvalds 		printk(KERN_ERR DEV_LABEL "(itf %d): couldn't get free page\n",
9111da177e4SLinus Torvalds 		    dev->number);
9121da177e4SLinus Torvalds 		free_page((unsigned long) eni_dev->free_list);
9131da177e4SLinus Torvalds 		return -ENOMEM;
9141da177e4SLinus Torvalds 	}
9151da177e4SLinus Torvalds 	eni_dev->rx_mult = DEFAULT_RX_MULT;
9161da177e4SLinus Torvalds 	eni_dev->fast = eni_dev->last_fast = NULL;
9171da177e4SLinus Torvalds 	eni_dev->slow = eni_dev->last_slow = NULL;
9181da177e4SLinus Torvalds 	init_waitqueue_head(&eni_dev->rx_wait);
9191da177e4SLinus Torvalds 	skb_queue_head_init(&eni_dev->rx_queue);
9201da177e4SLinus Torvalds 	eni_dev->serv_read = eni_in(MID_SERV_WRITE);
9211da177e4SLinus Torvalds 	eni_out(0,MID_DMA_WR_RX);
9221da177e4SLinus Torvalds 	return 0;
9231da177e4SLinus Torvalds }
9241da177e4SLinus Torvalds 
9251da177e4SLinus Torvalds 
9261da177e4SLinus Torvalds /*----------------------------------- TX ------------------------------------*/
9271da177e4SLinus Torvalds 
9281da177e4SLinus Torvalds 
9291da177e4SLinus Torvalds enum enq_res { enq_ok,enq_next,enq_jam };
9301da177e4SLinus Torvalds 
9311da177e4SLinus Torvalds 
9321da177e4SLinus Torvalds static inline void put_dma(int chan,u32 *dma,int *j,dma_addr_t paddr,
9331da177e4SLinus Torvalds     u32 size)
9341da177e4SLinus Torvalds {
9351da177e4SLinus Torvalds 	u32 init,words;
9361da177e4SLinus Torvalds 
9371da177e4SLinus Torvalds 	DPRINTK("put_dma: 0x%lx+0x%x\n",(unsigned long) paddr,size);
9381da177e4SLinus Torvalds 	EVENT("put_dma: 0x%lx+0x%lx\n",(unsigned long) paddr,size);
9391da177e4SLinus Torvalds #if 0 /* don't complain anymore */
9401da177e4SLinus Torvalds 	if (paddr & 3)
9411da177e4SLinus Torvalds 		printk(KERN_ERR "put_dma: unaligned addr (0x%lx)\n",paddr);
9421da177e4SLinus Torvalds 	if (size & 3)
9431da177e4SLinus Torvalds 		printk(KERN_ERR "put_dma: unaligned size (0x%lx)\n",size);
9441da177e4SLinus Torvalds #endif
9451da177e4SLinus Torvalds 	if (paddr & 3) {
9461da177e4SLinus Torvalds 		init = 4-(paddr & 3);
9471da177e4SLinus Torvalds 		if (init > size || size < 7) init = size;
9481da177e4SLinus Torvalds 		DPRINTK("put_dma: %lx DMA: %d/%d bytes\n",
9491da177e4SLinus Torvalds 		    (unsigned long) paddr,init,size);
9501da177e4SLinus Torvalds 		dma[(*j)++] = MID_DT_BYTE | (init << MID_DMA_COUNT_SHIFT) |
9511da177e4SLinus Torvalds 		    (chan << MID_DMA_CHAN_SHIFT);
9521da177e4SLinus Torvalds 		dma[(*j)++] = paddr;
9531da177e4SLinus Torvalds 		paddr += init;
9541da177e4SLinus Torvalds 		size -= init;
9551da177e4SLinus Torvalds 	}
9561da177e4SLinus Torvalds 	words = size >> 2;
9571da177e4SLinus Torvalds 	size &= 3;
9581da177e4SLinus Torvalds 	if (words && (paddr & 31)) {
9591da177e4SLinus Torvalds 		init = 8-((paddr & 31) >> 2);
9601da177e4SLinus Torvalds 		if (init > words) init = words;
9611da177e4SLinus Torvalds 		DPRINTK("put_dma: %lx DMA: %d/%d words\n",
9621da177e4SLinus Torvalds 		    (unsigned long) paddr,init,words);
9631da177e4SLinus Torvalds 		dma[(*j)++] = MID_DT_WORD | (init << MID_DMA_COUNT_SHIFT) |
9641da177e4SLinus Torvalds 		    (chan << MID_DMA_CHAN_SHIFT);
9651da177e4SLinus Torvalds 		dma[(*j)++] = paddr;
9661da177e4SLinus Torvalds 		paddr += init << 2;
9671da177e4SLinus Torvalds 		words -= init;
9681da177e4SLinus Torvalds 	}
9691da177e4SLinus Torvalds #ifdef CONFIG_ATM_ENI_BURST_TX_16W /* may work with some PCI chipsets ... */
9701da177e4SLinus Torvalds 	if (words & ~15) {
9711da177e4SLinus Torvalds 		DPRINTK("put_dma: %lx DMA: %d*16/%d words\n",
9721da177e4SLinus Torvalds 		    (unsigned long) paddr,words >> 4,words);
9731da177e4SLinus Torvalds 		dma[(*j)++] = MID_DT_16W | ((words >> 4) << MID_DMA_COUNT_SHIFT)
9741da177e4SLinus Torvalds 		    | (chan << MID_DMA_CHAN_SHIFT);
9751da177e4SLinus Torvalds 		dma[(*j)++] = paddr;
9761da177e4SLinus Torvalds 		paddr += (words & ~15) << 2;
9771da177e4SLinus Torvalds 		words &= 15;
9781da177e4SLinus Torvalds 	}
9791da177e4SLinus Torvalds #endif
9801da177e4SLinus Torvalds #ifdef CONFIG_ATM_ENI_BURST_TX_8W /* recommended */
9811da177e4SLinus Torvalds 	if (words & ~7) {
9821da177e4SLinus Torvalds 		DPRINTK("put_dma: %lx DMA: %d*8/%d words\n",
9831da177e4SLinus Torvalds 		    (unsigned long) paddr,words >> 3,words);
9841da177e4SLinus Torvalds 		dma[(*j)++] = MID_DT_8W | ((words >> 3) << MID_DMA_COUNT_SHIFT)
9851da177e4SLinus Torvalds 		    | (chan << MID_DMA_CHAN_SHIFT);
9861da177e4SLinus Torvalds 		dma[(*j)++] = paddr;
9871da177e4SLinus Torvalds 		paddr += (words & ~7) << 2;
9881da177e4SLinus Torvalds 		words &= 7;
9891da177e4SLinus Torvalds 	}
9901da177e4SLinus Torvalds #endif
9911da177e4SLinus Torvalds #ifdef CONFIG_ATM_ENI_BURST_TX_4W /* probably useless if TX_8W or TX_16W */
9921da177e4SLinus Torvalds 	if (words & ~3) {
9931da177e4SLinus Torvalds 		DPRINTK("put_dma: %lx DMA: %d*4/%d words\n",
9941da177e4SLinus Torvalds 		    (unsigned long) paddr,words >> 2,words);
9951da177e4SLinus Torvalds 		dma[(*j)++] = MID_DT_4W | ((words >> 2) << MID_DMA_COUNT_SHIFT)
9961da177e4SLinus Torvalds 		    | (chan << MID_DMA_CHAN_SHIFT);
9971da177e4SLinus Torvalds 		dma[(*j)++] = paddr;
9981da177e4SLinus Torvalds 		paddr += (words & ~3) << 2;
9991da177e4SLinus Torvalds 		words &= 3;
10001da177e4SLinus Torvalds 	}
10011da177e4SLinus Torvalds #endif
10021da177e4SLinus Torvalds #ifdef CONFIG_ATM_ENI_BURST_TX_2W /* probably useless if TX_4W, TX_8W, ... */
10031da177e4SLinus Torvalds 	if (words & ~1) {
10041da177e4SLinus Torvalds 		DPRINTK("put_dma: %lx DMA: %d*2/%d words\n",
10051da177e4SLinus Torvalds 		    (unsigned long) paddr,words >> 1,words);
10061da177e4SLinus Torvalds 		dma[(*j)++] = MID_DT_2W | ((words >> 1) << MID_DMA_COUNT_SHIFT)
10071da177e4SLinus Torvalds 		    | (chan << MID_DMA_CHAN_SHIFT);
10081da177e4SLinus Torvalds 		dma[(*j)++] = paddr;
10091da177e4SLinus Torvalds 		paddr += (words & ~1) << 2;
10101da177e4SLinus Torvalds 		words &= 1;
10111da177e4SLinus Torvalds 	}
10121da177e4SLinus Torvalds #endif
10131da177e4SLinus Torvalds 	if (words) {
10141da177e4SLinus Torvalds 		DPRINTK("put_dma: %lx DMA: %d words\n",(unsigned long) paddr,
10151da177e4SLinus Torvalds 		    words);
10161da177e4SLinus Torvalds 		dma[(*j)++] = MID_DT_WORD | (words << MID_DMA_COUNT_SHIFT) |
10171da177e4SLinus Torvalds 		    (chan << MID_DMA_CHAN_SHIFT);
10181da177e4SLinus Torvalds 		dma[(*j)++] = paddr;
10191da177e4SLinus Torvalds 		paddr += words << 2;
10201da177e4SLinus Torvalds 	}
10211da177e4SLinus Torvalds 	if (size) {
10221da177e4SLinus Torvalds 		DPRINTK("put_dma: %lx DMA: %d bytes\n",(unsigned long) paddr,
10231da177e4SLinus Torvalds 		    size);
10241da177e4SLinus Torvalds 		dma[(*j)++] = MID_DT_BYTE | (size << MID_DMA_COUNT_SHIFT) |
10251da177e4SLinus Torvalds 		    (chan << MID_DMA_CHAN_SHIFT);
10261da177e4SLinus Torvalds 		dma[(*j)++] = paddr;
10271da177e4SLinus Torvalds 	}
10281da177e4SLinus Torvalds }
10291da177e4SLinus Torvalds 
10301da177e4SLinus Torvalds 
10311da177e4SLinus Torvalds static enum enq_res do_tx(struct sk_buff *skb)
10321da177e4SLinus Torvalds {
10331da177e4SLinus Torvalds 	struct atm_vcc *vcc;
10341da177e4SLinus Torvalds 	struct eni_dev *eni_dev;
10351da177e4SLinus Torvalds 	struct eni_vcc *eni_vcc;
10361da177e4SLinus Torvalds 	struct eni_tx *tx;
10371da177e4SLinus Torvalds 	dma_addr_t paddr;
10381da177e4SLinus Torvalds 	u32 dma_rd,dma_wr;
10391da177e4SLinus Torvalds 	u32 size; /* in words */
10401da177e4SLinus Torvalds 	int aal5,dma_size,i,j;
10411da177e4SLinus Torvalds 
10421da177e4SLinus Torvalds 	DPRINTK(">do_tx\n");
10431da177e4SLinus Torvalds 	NULLCHECK(skb);
10441da177e4SLinus Torvalds 	EVENT("do_tx: skb=0x%lx, %ld bytes\n",(unsigned long) skb,skb->len);
10451da177e4SLinus Torvalds 	vcc = ATM_SKB(skb)->vcc;
10461da177e4SLinus Torvalds 	NULLCHECK(vcc);
10471da177e4SLinus Torvalds 	eni_dev = ENI_DEV(vcc->dev);
10481da177e4SLinus Torvalds 	NULLCHECK(eni_dev);
10491da177e4SLinus Torvalds 	eni_vcc = ENI_VCC(vcc);
10501da177e4SLinus Torvalds 	tx = eni_vcc->tx;
10511da177e4SLinus Torvalds 	NULLCHECK(tx);
10521da177e4SLinus Torvalds #if 0 /* Enable this for testing with the "align" program */
10531da177e4SLinus Torvalds 	{
10541da177e4SLinus Torvalds 		unsigned int hack = *((char *) skb->data)-'0';
10551da177e4SLinus Torvalds 
10561da177e4SLinus Torvalds 		if (hack < 8) {
10571da177e4SLinus Torvalds 			skb->data += hack;
10581da177e4SLinus Torvalds 			skb->len -= hack;
10591da177e4SLinus Torvalds 		}
10601da177e4SLinus Torvalds 	}
10611da177e4SLinus Torvalds #endif
10621da177e4SLinus Torvalds #if 0 /* should work now */
10631da177e4SLinus Torvalds 	if ((unsigned long) skb->data & 3)
10641da177e4SLinus Torvalds 		printk(KERN_ERR DEV_LABEL "(itf %d): VCI %d has mis-aligned "
10651da177e4SLinus Torvalds 		    "TX data\n",vcc->dev->number,vcc->vci);
10661da177e4SLinus Torvalds #endif
10671da177e4SLinus Torvalds 	/*
10681da177e4SLinus Torvalds 	 * Potential future IP speedup: make hard_header big enough to put
10691da177e4SLinus Torvalds 	 * segmentation descriptor directly into PDU. Saves: 4 slave writes,
10701da177e4SLinus Torvalds 	 * 1 DMA xfer & 2 DMA'ed bytes (protocol layering is for wimps :-)
10711da177e4SLinus Torvalds 	 */
10721da177e4SLinus Torvalds 
10731da177e4SLinus Torvalds 	aal5 = vcc->qos.aal == ATM_AAL5;
10741da177e4SLinus Torvalds 	/* check space in buffer */
10751da177e4SLinus Torvalds 	if (!aal5)
10761da177e4SLinus Torvalds 		size = (ATM_CELL_PAYLOAD >> 2)+TX_DESCR_SIZE;
10771da177e4SLinus Torvalds 			/* cell without HEC plus segmentation header (includes
10781da177e4SLinus Torvalds 			   four-byte cell header) */
10791da177e4SLinus Torvalds 	else {
10801da177e4SLinus Torvalds 		size = skb->len+4*AAL5_TRAILER+ATM_CELL_PAYLOAD-1;
10811da177e4SLinus Torvalds 			/* add AAL5 trailer */
10821da177e4SLinus Torvalds 		size = ((size-(size % ATM_CELL_PAYLOAD)) >> 2)+TX_DESCR_SIZE;
10831da177e4SLinus Torvalds 						/* add segmentation header */
10841da177e4SLinus Torvalds 	}
10851da177e4SLinus Torvalds 	/*
10861da177e4SLinus Torvalds 	 * Can I move tx_pos by size bytes without getting closer than TX_GAP
10871da177e4SLinus Torvalds 	 * to the read pointer ? TX_GAP means to leave some space for what
10881da177e4SLinus Torvalds 	 * the manual calls "too close".
10891da177e4SLinus Torvalds 	 */
10901da177e4SLinus Torvalds 	if (!NEPMOK(tx->tx_pos,size+TX_GAP,
10911da177e4SLinus Torvalds 	    eni_in(MID_TX_RDPTR(tx->index)),tx->words)) {
10921da177e4SLinus Torvalds 		DPRINTK(DEV_LABEL "(itf %d): TX full (size %d)\n",
10931da177e4SLinus Torvalds 		    vcc->dev->number,size);
10941da177e4SLinus Torvalds 		return enq_next;
10951da177e4SLinus Torvalds 	}
10961da177e4SLinus Torvalds 	/* check DMA */
10971da177e4SLinus Torvalds 	dma_wr = eni_in(MID_DMA_WR_TX);
10981da177e4SLinus Torvalds 	dma_rd = eni_in(MID_DMA_RD_TX);
10991da177e4SLinus Torvalds 	dma_size = 3; /* JK for descriptor and final fill, plus final size
11001da177e4SLinus Torvalds 			 mis-alignment fix */
11011da177e4SLinus Torvalds DPRINTK("iovcnt = %d\n",skb_shinfo(skb)->nr_frags);
11021da177e4SLinus Torvalds 	if (!skb_shinfo(skb)->nr_frags) dma_size += 5;
11031da177e4SLinus Torvalds 	else dma_size += 5*(skb_shinfo(skb)->nr_frags+1);
11041da177e4SLinus Torvalds 	if (dma_size > TX_DMA_BUF) {
11051da177e4SLinus Torvalds 		printk(KERN_CRIT DEV_LABEL "(itf %d): needs %d DMA entries "
11061da177e4SLinus Torvalds 		    "(got only %d)\n",vcc->dev->number,dma_size,TX_DMA_BUF);
11071da177e4SLinus Torvalds 	}
11081da177e4SLinus Torvalds 	DPRINTK("dma_wr is %d, tx_pos is %ld\n",dma_wr,tx->tx_pos);
11091da177e4SLinus Torvalds 	if (dma_wr != dma_rd && ((dma_rd+NR_DMA_TX-dma_wr) & (NR_DMA_TX-1)) <
11101da177e4SLinus Torvalds 	     dma_size) {
11111da177e4SLinus Torvalds 		printk(KERN_WARNING DEV_LABEL "(itf %d): TX DMA full\n",
11121da177e4SLinus Torvalds 		    vcc->dev->number);
11131da177e4SLinus Torvalds 		return enq_jam;
11141da177e4SLinus Torvalds 	}
11151da177e4SLinus Torvalds 	paddr = pci_map_single(eni_dev->pci_dev,skb->data,skb->len,
11161da177e4SLinus Torvalds 	    PCI_DMA_TODEVICE);
11171da177e4SLinus Torvalds 	ENI_PRV_PADDR(skb) = paddr;
11181da177e4SLinus Torvalds 	/* prepare DMA queue entries */
11191da177e4SLinus Torvalds 	j = 0;
11201da177e4SLinus Torvalds 	eni_dev->dma[j++] = (((tx->tx_pos+TX_DESCR_SIZE) & (tx->words-1)) <<
11211da177e4SLinus Torvalds 	     MID_DMA_COUNT_SHIFT) | (tx->index << MID_DMA_CHAN_SHIFT) |
11221da177e4SLinus Torvalds 	     MID_DT_JK;
11231da177e4SLinus Torvalds 	j++;
11241da177e4SLinus Torvalds 	if (!skb_shinfo(skb)->nr_frags)
11251da177e4SLinus Torvalds 		if (aal5) put_dma(tx->index,eni_dev->dma,&j,paddr,skb->len);
11261da177e4SLinus Torvalds 		else put_dma(tx->index,eni_dev->dma,&j,paddr+4,skb->len-4);
11271da177e4SLinus Torvalds 	else {
11281da177e4SLinus Torvalds DPRINTK("doing direct send\n"); /* @@@ well, this doesn't work anyway */
11291da177e4SLinus Torvalds 		for (i = -1; i < skb_shinfo(skb)->nr_frags; i++)
11301da177e4SLinus Torvalds 			if (i == -1)
11311da177e4SLinus Torvalds 				put_dma(tx->index,eni_dev->dma,&j,(unsigned long)
11321da177e4SLinus Torvalds 				    skb->data,
11331da177e4SLinus Torvalds 				    skb->len - skb->data_len);
11341da177e4SLinus Torvalds 			else
11351da177e4SLinus Torvalds 				put_dma(tx->index,eni_dev->dma,&j,(unsigned long)
11361da177e4SLinus Torvalds 				    skb_shinfo(skb)->frags[i].page + skb_shinfo(skb)->frags[i].page_offset,
11371da177e4SLinus Torvalds 				    skb_shinfo(skb)->frags[i].size);
11381da177e4SLinus Torvalds 	}
11391da177e4SLinus Torvalds 	if (skb->len & 3)
11401da177e4SLinus Torvalds 		put_dma(tx->index,eni_dev->dma,&j,zeroes,4-(skb->len & 3));
11411da177e4SLinus Torvalds 	/* JK for AAL5 trailer - AAL0 doesn't need it, but who cares ... */
11421da177e4SLinus Torvalds 	eni_dev->dma[j++] = (((tx->tx_pos+size) & (tx->words-1)) <<
11431da177e4SLinus Torvalds 	     MID_DMA_COUNT_SHIFT) | (tx->index << MID_DMA_CHAN_SHIFT) |
11441da177e4SLinus Torvalds 	     MID_DMA_END | MID_DT_JK;
11451da177e4SLinus Torvalds 	j++;
11461da177e4SLinus Torvalds 	DPRINTK("DMA at end: %d\n",j);
11471da177e4SLinus Torvalds 	/* store frame */
11481da177e4SLinus Torvalds 	writel((MID_SEG_TX_ID << MID_SEG_ID_SHIFT) |
11491da177e4SLinus Torvalds 	    (aal5 ? MID_SEG_AAL5 : 0) | (tx->prescaler << MID_SEG_PR_SHIFT) |
11501da177e4SLinus Torvalds 	    (tx->resolution << MID_SEG_RATE_SHIFT) |
11511da177e4SLinus Torvalds 	    (size/(ATM_CELL_PAYLOAD/4)),tx->send+tx->tx_pos*4);
11521da177e4SLinus Torvalds /*printk("dsc = 0x%08lx\n",(unsigned long) readl(tx->send+tx->tx_pos*4));*/
11531da177e4SLinus Torvalds 	writel((vcc->vci << MID_SEG_VCI_SHIFT) |
11541da177e4SLinus Torvalds             (aal5 ? 0 : (skb->data[3] & 0xf)) |
11551da177e4SLinus Torvalds 	    (ATM_SKB(skb)->atm_options & ATM_ATMOPT_CLP ? MID_SEG_CLP : 0),
11561da177e4SLinus Torvalds 	    tx->send+((tx->tx_pos+1) & (tx->words-1))*4);
11571da177e4SLinus Torvalds 	DPRINTK("size: %d, len:%d\n",size,skb->len);
11581da177e4SLinus Torvalds 	if (aal5)
11591da177e4SLinus Torvalds 		writel(skb->len,tx->send+
11601da177e4SLinus Torvalds                     ((tx->tx_pos+size-AAL5_TRAILER) & (tx->words-1))*4);
11611da177e4SLinus Torvalds 	j = j >> 1;
11621da177e4SLinus Torvalds 	for (i = 0; i < j; i++) {
11631da177e4SLinus Torvalds 		writel(eni_dev->dma[i*2],eni_dev->tx_dma+dma_wr*8);
11641da177e4SLinus Torvalds 		writel(eni_dev->dma[i*2+1],eni_dev->tx_dma+dma_wr*8+4);
11651da177e4SLinus Torvalds 		dma_wr = (dma_wr+1) & (NR_DMA_TX-1);
11661da177e4SLinus Torvalds 	}
11671da177e4SLinus Torvalds 	ENI_PRV_POS(skb) = tx->tx_pos;
11681da177e4SLinus Torvalds 	ENI_PRV_SIZE(skb) = size;
11691da177e4SLinus Torvalds 	ENI_VCC(vcc)->txing += size;
11701da177e4SLinus Torvalds 	tx->tx_pos = (tx->tx_pos+size) & (tx->words-1);
11711da177e4SLinus Torvalds 	DPRINTK("dma_wr set to %d, tx_pos is now %ld\n",dma_wr,tx->tx_pos);
11721da177e4SLinus Torvalds 	eni_out(dma_wr,MID_DMA_WR_TX);
11731da177e4SLinus Torvalds 	skb_queue_tail(&eni_dev->tx_queue,skb);
11741da177e4SLinus Torvalds queued++;
11751da177e4SLinus Torvalds 	return enq_ok;
11761da177e4SLinus Torvalds }
11771da177e4SLinus Torvalds 
11781da177e4SLinus Torvalds 
11791da177e4SLinus Torvalds static void poll_tx(struct atm_dev *dev)
11801da177e4SLinus Torvalds {
11811da177e4SLinus Torvalds 	struct eni_tx *tx;
11821da177e4SLinus Torvalds 	struct sk_buff *skb;
11831da177e4SLinus Torvalds 	enum enq_res res;
11841da177e4SLinus Torvalds 	int i;
11851da177e4SLinus Torvalds 
11861da177e4SLinus Torvalds 	DPRINTK(">poll_tx\n");
11871da177e4SLinus Torvalds 	for (i = NR_CHAN-1; i >= 0; i--) {
11881da177e4SLinus Torvalds 		tx = &ENI_DEV(dev)->tx[i];
11891da177e4SLinus Torvalds 		if (tx->send)
11901da177e4SLinus Torvalds 			while ((skb = skb_dequeue(&tx->backlog))) {
11911da177e4SLinus Torvalds 				res = do_tx(skb);
11921da177e4SLinus Torvalds 				if (res == enq_ok) continue;
11931da177e4SLinus Torvalds 				DPRINTK("re-queuing TX PDU\n");
11941da177e4SLinus Torvalds 				skb_queue_head(&tx->backlog,skb);
11951da177e4SLinus Torvalds requeued++;
11961da177e4SLinus Torvalds 				if (res == enq_jam) return;
11971da177e4SLinus Torvalds 				break;
11981da177e4SLinus Torvalds 			}
11991da177e4SLinus Torvalds 	}
12001da177e4SLinus Torvalds }
12011da177e4SLinus Torvalds 
12021da177e4SLinus Torvalds 
12031da177e4SLinus Torvalds static void dequeue_tx(struct atm_dev *dev)
12041da177e4SLinus Torvalds {
12051da177e4SLinus Torvalds 	struct eni_dev *eni_dev;
12061da177e4SLinus Torvalds 	struct atm_vcc *vcc;
12071da177e4SLinus Torvalds 	struct sk_buff *skb;
12081da177e4SLinus Torvalds 	struct eni_tx *tx;
12091da177e4SLinus Torvalds 
12101da177e4SLinus Torvalds 	NULLCHECK(dev);
12111da177e4SLinus Torvalds 	eni_dev = ENI_DEV(dev);
12121da177e4SLinus Torvalds 	NULLCHECK(eni_dev);
12131da177e4SLinus Torvalds 	while ((skb = skb_dequeue(&eni_dev->tx_queue))) {
12141da177e4SLinus Torvalds 		vcc = ATM_SKB(skb)->vcc;
12151da177e4SLinus Torvalds 		NULLCHECK(vcc);
12161da177e4SLinus Torvalds 		tx = ENI_VCC(vcc)->tx;
12171da177e4SLinus Torvalds 		NULLCHECK(ENI_VCC(vcc)->tx);
12181da177e4SLinus Torvalds 		DPRINTK("dequeue_tx: next 0x%lx curr 0x%x\n",ENI_PRV_POS(skb),
12191da177e4SLinus Torvalds 		    (unsigned) eni_in(MID_TX_DESCRSTART(tx->index)));
12201da177e4SLinus Torvalds 		if (ENI_VCC(vcc)->txing < tx->words && ENI_PRV_POS(skb) ==
12211da177e4SLinus Torvalds 		    eni_in(MID_TX_DESCRSTART(tx->index))) {
12221da177e4SLinus Torvalds 			skb_queue_head(&eni_dev->tx_queue,skb);
12231da177e4SLinus Torvalds 			break;
12241da177e4SLinus Torvalds 		}
12251da177e4SLinus Torvalds 		ENI_VCC(vcc)->txing -= ENI_PRV_SIZE(skb);
12261da177e4SLinus Torvalds 		pci_unmap_single(eni_dev->pci_dev,ENI_PRV_PADDR(skb),skb->len,
12271da177e4SLinus Torvalds 		    PCI_DMA_TODEVICE);
12281da177e4SLinus Torvalds 		if (vcc->pop) vcc->pop(vcc,skb);
12291da177e4SLinus Torvalds 		else dev_kfree_skb_irq(skb);
12301da177e4SLinus Torvalds 		atomic_inc(&vcc->stats->tx);
12311da177e4SLinus Torvalds 		wake_up(&eni_dev->tx_wait);
12321da177e4SLinus Torvalds dma_complete++;
12331da177e4SLinus Torvalds 	}
12341da177e4SLinus Torvalds }
12351da177e4SLinus Torvalds 
12361da177e4SLinus Torvalds 
12371da177e4SLinus Torvalds static struct eni_tx *alloc_tx(struct eni_dev *eni_dev,int ubr)
12381da177e4SLinus Torvalds {
12391da177e4SLinus Torvalds 	int i;
12401da177e4SLinus Torvalds 
12411da177e4SLinus Torvalds 	for (i = !ubr; i < NR_CHAN; i++)
12421da177e4SLinus Torvalds 		if (!eni_dev->tx[i].send) return eni_dev->tx+i;
12431da177e4SLinus Torvalds 	return NULL;
12441da177e4SLinus Torvalds }
12451da177e4SLinus Torvalds 
12461da177e4SLinus Torvalds 
12471da177e4SLinus Torvalds static int comp_tx(struct eni_dev *eni_dev,int *pcr,int reserved,int *pre,
12481da177e4SLinus Torvalds     int *res,int unlimited)
12491da177e4SLinus Torvalds {
12501da177e4SLinus Torvalds 	static const int pre_div[] = { 4,16,128,2048 };
12511da177e4SLinus Torvalds 	    /* 2^(((x+2)^2-(x+2))/2+1) */
12521da177e4SLinus Torvalds 
12531da177e4SLinus Torvalds 	if (unlimited) *pre = *res = 0;
12541da177e4SLinus Torvalds 	else {
12551da177e4SLinus Torvalds 		if (*pcr > 0) {
12561da177e4SLinus Torvalds 			int div;
12571da177e4SLinus Torvalds 
12581da177e4SLinus Torvalds 			for (*pre = 0; *pre < 3; (*pre)++)
12591da177e4SLinus Torvalds 				if (TS_CLOCK/pre_div[*pre]/64 <= *pcr) break;
12601da177e4SLinus Torvalds 			div = pre_div[*pre]**pcr;
12611da177e4SLinus Torvalds 			DPRINTK("min div %d\n",div);
12621da177e4SLinus Torvalds 			*res = TS_CLOCK/div-1;
12631da177e4SLinus Torvalds 		}
12641da177e4SLinus Torvalds 		else {
12651da177e4SLinus Torvalds 			int div;
12661da177e4SLinus Torvalds 
12671da177e4SLinus Torvalds 			if (!*pcr) *pcr = eni_dev->tx_bw+reserved;
12681da177e4SLinus Torvalds 			for (*pre = 3; *pre >= 0; (*pre)--)
12691da177e4SLinus Torvalds 				if (TS_CLOCK/pre_div[*pre]/64 > -*pcr) break;
12701da177e4SLinus Torvalds 			if (*pre < 3) (*pre)++; /* else fail later */
12711da177e4SLinus Torvalds 			div = pre_div[*pre]*-*pcr;
12721da177e4SLinus Torvalds 			DPRINTK("max div %d\n",div);
12731da177e4SLinus Torvalds 			*res = (TS_CLOCK+div-1)/div-1;
12741da177e4SLinus Torvalds 		}
12751da177e4SLinus Torvalds 		if (*res < 0) *res = 0;
12761da177e4SLinus Torvalds 		if (*res > MID_SEG_MAX_RATE) *res = MID_SEG_MAX_RATE;
12771da177e4SLinus Torvalds 	}
12781da177e4SLinus Torvalds 	*pcr = TS_CLOCK/pre_div[*pre]/(*res+1);
12791da177e4SLinus Torvalds 	DPRINTK("out pcr: %d (%d:%d)\n",*pcr,*pre,*res);
12801da177e4SLinus Torvalds 	return 0;
12811da177e4SLinus Torvalds }
12821da177e4SLinus Torvalds 
12831da177e4SLinus Torvalds 
12841da177e4SLinus Torvalds static int reserve_or_set_tx(struct atm_vcc *vcc,struct atm_trafprm *txtp,
12851da177e4SLinus Torvalds     int set_rsv,int set_shp)
12861da177e4SLinus Torvalds {
12871da177e4SLinus Torvalds 	struct eni_dev *eni_dev = ENI_DEV(vcc->dev);
12881da177e4SLinus Torvalds 	struct eni_vcc *eni_vcc = ENI_VCC(vcc);
12891da177e4SLinus Torvalds 	struct eni_tx *tx;
12901da177e4SLinus Torvalds 	unsigned long size;
12911da177e4SLinus Torvalds 	void __iomem *mem;
12921da177e4SLinus Torvalds 	int rate,ubr,unlimited,new_tx;
12931da177e4SLinus Torvalds 	int pre,res,order;
12941da177e4SLinus Torvalds 	int error;
12951da177e4SLinus Torvalds 
12961da177e4SLinus Torvalds 	rate = atm_pcr_goal(txtp);
12971da177e4SLinus Torvalds 	ubr = txtp->traffic_class == ATM_UBR;
12981da177e4SLinus Torvalds 	unlimited = ubr && (!rate || rate <= -ATM_OC3_PCR ||
12991da177e4SLinus Torvalds 	    rate >= ATM_OC3_PCR);
13001da177e4SLinus Torvalds 	if (!unlimited) {
13011da177e4SLinus Torvalds 		size = txtp->max_sdu*eni_dev->tx_mult/100;
13021da177e4SLinus Torvalds 		if (size > MID_MAX_BUF_SIZE && txtp->max_sdu <=
13031da177e4SLinus Torvalds 		    MID_MAX_BUF_SIZE)
13041da177e4SLinus Torvalds 			size = MID_MAX_BUF_SIZE;
13051da177e4SLinus Torvalds 	}
13061da177e4SLinus Torvalds 	else {
13071da177e4SLinus Torvalds 		if (eni_dev->ubr) {
13081da177e4SLinus Torvalds 			eni_vcc->tx = eni_dev->ubr;
13091da177e4SLinus Torvalds 			txtp->pcr = ATM_OC3_PCR;
13101da177e4SLinus Torvalds 			return 0;
13111da177e4SLinus Torvalds 		}
13121da177e4SLinus Torvalds 		size = UBR_BUFFER;
13131da177e4SLinus Torvalds 	}
13141da177e4SLinus Torvalds 	new_tx = !eni_vcc->tx;
13151da177e4SLinus Torvalds 	mem = NULL; /* for gcc */
13161da177e4SLinus Torvalds 	if (!new_tx) tx = eni_vcc->tx;
13171da177e4SLinus Torvalds 	else {
13181da177e4SLinus Torvalds 		mem = eni_alloc_mem(eni_dev,&size);
13191da177e4SLinus Torvalds 		if (!mem) return -ENOBUFS;
13201da177e4SLinus Torvalds 		tx = alloc_tx(eni_dev,unlimited);
13211da177e4SLinus Torvalds 		if (!tx) {
13221da177e4SLinus Torvalds 			eni_free_mem(eni_dev,mem,size);
13231da177e4SLinus Torvalds 			return -EBUSY;
13241da177e4SLinus Torvalds 		}
13251da177e4SLinus Torvalds 		DPRINTK("got chan %d\n",tx->index);
13261da177e4SLinus Torvalds 		tx->reserved = tx->shaping = 0;
13271da177e4SLinus Torvalds 		tx->send = mem;
13281da177e4SLinus Torvalds 		tx->words = size >> 2;
13291da177e4SLinus Torvalds 		skb_queue_head_init(&tx->backlog);
13301da177e4SLinus Torvalds 		for (order = 0; size > (1 << (order+10)); order++);
13311da177e4SLinus Torvalds 		eni_out((order << MID_SIZE_SHIFT) |
13321da177e4SLinus Torvalds 		    ((tx->send-eni_dev->ram) >> (MID_LOC_SKIP+2)),
13331da177e4SLinus Torvalds 		    MID_TX_PLACE(tx->index));
13341da177e4SLinus Torvalds 		tx->tx_pos = eni_in(MID_TX_DESCRSTART(tx->index)) &
13351da177e4SLinus Torvalds 		    MID_DESCR_START;
13361da177e4SLinus Torvalds 	}
13371da177e4SLinus Torvalds 	error = comp_tx(eni_dev,&rate,tx->reserved,&pre,&res,unlimited);
13381da177e4SLinus Torvalds 	if (!error  && txtp->min_pcr > rate) error = -EINVAL;
13391da177e4SLinus Torvalds 	if (!error && txtp->max_pcr && txtp->max_pcr != ATM_MAX_PCR &&
13401da177e4SLinus Torvalds 	    txtp->max_pcr < rate) error = -EINVAL;
13411da177e4SLinus Torvalds 	if (!error && !ubr && rate > eni_dev->tx_bw+tx->reserved)
13421da177e4SLinus Torvalds 		error = -EINVAL;
13431da177e4SLinus Torvalds 	if (!error && set_rsv && !set_shp && rate < tx->shaping)
13441da177e4SLinus Torvalds 		error = -EINVAL;
13451da177e4SLinus Torvalds 	if (!error && !set_rsv && rate > tx->reserved && !ubr)
13461da177e4SLinus Torvalds 		error = -EINVAL;
13471da177e4SLinus Torvalds 	if (error) {
13481da177e4SLinus Torvalds 		if (new_tx) {
13491da177e4SLinus Torvalds 			tx->send = NULL;
13501da177e4SLinus Torvalds 			eni_free_mem(eni_dev,mem,size);
13511da177e4SLinus Torvalds 		}
13521da177e4SLinus Torvalds 		return error;
13531da177e4SLinus Torvalds 	}
13541da177e4SLinus Torvalds 	txtp->pcr = rate;
13551da177e4SLinus Torvalds 	if (set_rsv && !ubr) {
13561da177e4SLinus Torvalds 		eni_dev->tx_bw += tx->reserved;
13571da177e4SLinus Torvalds 		tx->reserved = rate;
13581da177e4SLinus Torvalds 		eni_dev->tx_bw -= rate;
13591da177e4SLinus Torvalds 	}
13601da177e4SLinus Torvalds 	if (set_shp || (unlimited && new_tx)) {
13611da177e4SLinus Torvalds 		if (unlimited && new_tx) eni_dev->ubr = tx;
13621da177e4SLinus Torvalds 		tx->prescaler = pre;
13631da177e4SLinus Torvalds 		tx->resolution = res;
13641da177e4SLinus Torvalds 		tx->shaping = rate;
13651da177e4SLinus Torvalds 	}
13661da177e4SLinus Torvalds 	if (set_shp) eni_vcc->tx = tx;
13671da177e4SLinus Torvalds 	DPRINTK("rsv %d shp %d\n",tx->reserved,tx->shaping);
13681da177e4SLinus Torvalds 	return 0;
13691da177e4SLinus Torvalds }
13701da177e4SLinus Torvalds 
13711da177e4SLinus Torvalds 
13721da177e4SLinus Torvalds static int open_tx_first(struct atm_vcc *vcc)
13731da177e4SLinus Torvalds {
13741da177e4SLinus Torvalds 	ENI_VCC(vcc)->tx = NULL;
13751da177e4SLinus Torvalds 	if (vcc->qos.txtp.traffic_class == ATM_NONE) return 0;
13761da177e4SLinus Torvalds 	ENI_VCC(vcc)->txing = 0;
13771da177e4SLinus Torvalds 	return reserve_or_set_tx(vcc,&vcc->qos.txtp,1,1);
13781da177e4SLinus Torvalds }
13791da177e4SLinus Torvalds 
13801da177e4SLinus Torvalds 
13811da177e4SLinus Torvalds static int open_tx_second(struct atm_vcc *vcc)
13821da177e4SLinus Torvalds {
13831da177e4SLinus Torvalds 	return 0; /* nothing to do */
13841da177e4SLinus Torvalds }
13851da177e4SLinus Torvalds 
13861da177e4SLinus Torvalds 
13871da177e4SLinus Torvalds static void close_tx(struct atm_vcc *vcc)
13881da177e4SLinus Torvalds {
13891da177e4SLinus Torvalds 	DECLARE_WAITQUEUE(wait,current);
13901da177e4SLinus Torvalds 	struct eni_dev *eni_dev;
13911da177e4SLinus Torvalds 	struct eni_vcc *eni_vcc;
13921da177e4SLinus Torvalds 
13931da177e4SLinus Torvalds 	eni_vcc = ENI_VCC(vcc);
13941da177e4SLinus Torvalds 	if (!eni_vcc->tx) return;
13951da177e4SLinus Torvalds 	eni_dev = ENI_DEV(vcc->dev);
13961da177e4SLinus Torvalds 	/* wait for TX queue to drain */
13971da177e4SLinus Torvalds 	DPRINTK("eni_close: waiting for TX ...\n");
13981da177e4SLinus Torvalds 	add_wait_queue(&eni_dev->tx_wait,&wait);
13991da177e4SLinus Torvalds 	set_current_state(TASK_UNINTERRUPTIBLE);
14001da177e4SLinus Torvalds 	for (;;) {
14011da177e4SLinus Torvalds 		int txing;
14021da177e4SLinus Torvalds 
14031da177e4SLinus Torvalds 		tasklet_disable(&eni_dev->task);
14041da177e4SLinus Torvalds 		txing = skb_peek(&eni_vcc->tx->backlog) || eni_vcc->txing;
14051da177e4SLinus Torvalds 		tasklet_enable(&eni_dev->task);
14061da177e4SLinus Torvalds 		if (!txing) break;
14071da177e4SLinus Torvalds 		DPRINTK("%d TX left\n",eni_vcc->txing);
14081da177e4SLinus Torvalds 		schedule();
14091da177e4SLinus Torvalds 		set_current_state(TASK_UNINTERRUPTIBLE);
14101da177e4SLinus Torvalds 	}
14111da177e4SLinus Torvalds 	set_current_state(TASK_RUNNING);
14121da177e4SLinus Torvalds 	remove_wait_queue(&eni_dev->tx_wait,&wait);
14131da177e4SLinus Torvalds 	if (eni_vcc->tx != eni_dev->ubr) {
14141da177e4SLinus Torvalds 		/*
14151da177e4SLinus Torvalds 		 * Looping a few times in here is probably far cheaper than
14161da177e4SLinus Torvalds 		 * keeping track of TX completions all the time, so let's poll
14171da177e4SLinus Torvalds 		 * a bit ...
14181da177e4SLinus Torvalds 		 */
14191da177e4SLinus Torvalds 		while (eni_in(MID_TX_RDPTR(eni_vcc->tx->index)) !=
14201da177e4SLinus Torvalds 		    eni_in(MID_TX_DESCRSTART(eni_vcc->tx->index)))
14211da177e4SLinus Torvalds 			schedule();
14221da177e4SLinus Torvalds 		eni_free_mem(eni_dev,eni_vcc->tx->send,eni_vcc->tx->words << 2);
14231da177e4SLinus Torvalds 		eni_vcc->tx->send = NULL;
14241da177e4SLinus Torvalds 		eni_dev->tx_bw += eni_vcc->tx->reserved;
14251da177e4SLinus Torvalds 	}
14261da177e4SLinus Torvalds 	eni_vcc->tx = NULL;
14271da177e4SLinus Torvalds }
14281da177e4SLinus Torvalds 
14291da177e4SLinus Torvalds 
14301da177e4SLinus Torvalds static int start_tx(struct atm_dev *dev)
14311da177e4SLinus Torvalds {
14321da177e4SLinus Torvalds 	struct eni_dev *eni_dev;
14331da177e4SLinus Torvalds 	int i;
14341da177e4SLinus Torvalds 
14351da177e4SLinus Torvalds 	eni_dev = ENI_DEV(dev);
14361da177e4SLinus Torvalds 	eni_dev->lost = 0;
14371da177e4SLinus Torvalds 	eni_dev->tx_bw = ATM_OC3_PCR;
14381da177e4SLinus Torvalds 	eni_dev->tx_mult = DEFAULT_TX_MULT;
14391da177e4SLinus Torvalds 	init_waitqueue_head(&eni_dev->tx_wait);
14401da177e4SLinus Torvalds 	eni_dev->ubr = NULL;
14411da177e4SLinus Torvalds 	skb_queue_head_init(&eni_dev->tx_queue);
14421da177e4SLinus Torvalds 	eni_out(0,MID_DMA_WR_TX);
14431da177e4SLinus Torvalds 	for (i = 0; i < NR_CHAN; i++) {
14441da177e4SLinus Torvalds 		eni_dev->tx[i].send = NULL;
14451da177e4SLinus Torvalds 		eni_dev->tx[i].index = i;
14461da177e4SLinus Torvalds 	}
14471da177e4SLinus Torvalds 	return 0;
14481da177e4SLinus Torvalds }
14491da177e4SLinus Torvalds 
14501da177e4SLinus Torvalds 
14511da177e4SLinus Torvalds /*--------------------------------- common ----------------------------------*/
14521da177e4SLinus Torvalds 
14531da177e4SLinus Torvalds 
14541da177e4SLinus Torvalds #if 0 /* may become useful again when tuning things */
14551da177e4SLinus Torvalds 
14561da177e4SLinus Torvalds static void foo(void)
14571da177e4SLinus Torvalds {
14581da177e4SLinus Torvalds printk(KERN_INFO
14591da177e4SLinus Torvalds   "tx_complete=%d,dma_complete=%d,queued=%d,requeued=%d,sub=%d,\n"
14601da177e4SLinus Torvalds   "backlogged=%d,rx_enqueued=%d,rx_dequeued=%d,putting=%d,pushed=%d\n",
14611da177e4SLinus Torvalds   tx_complete,dma_complete,queued,requeued,submitted,backlogged,
14621da177e4SLinus Torvalds   rx_enqueued,rx_dequeued,putting,pushed);
14631da177e4SLinus Torvalds if (eni_boards) printk(KERN_INFO "loss: %ld\n",ENI_DEV(eni_boards)->lost);
14641da177e4SLinus Torvalds }
14651da177e4SLinus Torvalds 
14661da177e4SLinus Torvalds #endif
14671da177e4SLinus Torvalds 
14681da177e4SLinus Torvalds 
14691da177e4SLinus Torvalds static void bug_int(struct atm_dev *dev,unsigned long reason)
14701da177e4SLinus Torvalds {
14711da177e4SLinus Torvalds 	struct eni_dev *eni_dev;
14721da177e4SLinus Torvalds 
14731da177e4SLinus Torvalds 	DPRINTK(">bug_int\n");
14741da177e4SLinus Torvalds 	eni_dev = ENI_DEV(dev);
14751da177e4SLinus Torvalds 	if (reason & MID_DMA_ERR_ACK)
14761da177e4SLinus Torvalds 		printk(KERN_CRIT DEV_LABEL "(itf %d): driver error - DMA "
14771da177e4SLinus Torvalds 		    "error\n",dev->number);
14781da177e4SLinus Torvalds 	if (reason & MID_TX_IDENT_MISM)
14791da177e4SLinus Torvalds 		printk(KERN_CRIT DEV_LABEL "(itf %d): driver error - ident "
14801da177e4SLinus Torvalds 		    "mismatch\n",dev->number);
14811da177e4SLinus Torvalds 	if (reason & MID_TX_DMA_OVFL)
14821da177e4SLinus Torvalds 		printk(KERN_CRIT DEV_LABEL "(itf %d): driver error - DMA "
14831da177e4SLinus Torvalds 		    "overflow\n",dev->number);
14841da177e4SLinus Torvalds 	EVENT("---dump ends here---\n",0,0);
14851da177e4SLinus Torvalds 	printk(KERN_NOTICE "---recent events---\n");
14861da177e4SLinus Torvalds 	event_dump();
14871da177e4SLinus Torvalds }
14881da177e4SLinus Torvalds 
14891da177e4SLinus Torvalds 
14907d12e780SDavid Howells static irqreturn_t eni_int(int irq,void *dev_id)
14911da177e4SLinus Torvalds {
14921da177e4SLinus Torvalds 	struct atm_dev *dev;
14931da177e4SLinus Torvalds 	struct eni_dev *eni_dev;
14941da177e4SLinus Torvalds 	u32 reason;
14951da177e4SLinus Torvalds 
14961da177e4SLinus Torvalds 	DPRINTK(">eni_int\n");
14971da177e4SLinus Torvalds 	dev = dev_id;
14981da177e4SLinus Torvalds 	eni_dev = ENI_DEV(dev);
14991da177e4SLinus Torvalds 	reason = eni_in(MID_ISA);
15001da177e4SLinus Torvalds 	DPRINTK(DEV_LABEL ": int 0x%lx\n",(unsigned long) reason);
15011da177e4SLinus Torvalds 	/*
15021da177e4SLinus Torvalds 	 * Must handle these two right now, because reading ISA doesn't clear
15031da177e4SLinus Torvalds 	 * them, so they re-occur and we never make it to the tasklet. Since
15041da177e4SLinus Torvalds 	 * they're rare, we don't mind the occasional invocation of eni_tasklet
15051da177e4SLinus Torvalds 	 * with eni_dev->events == 0.
15061da177e4SLinus Torvalds 	 */
15071da177e4SLinus Torvalds 	if (reason & MID_STAT_OVFL) {
15081da177e4SLinus Torvalds 		EVENT("stat overflow\n",0,0);
15091da177e4SLinus Torvalds 		eni_dev->lost += eni_in(MID_STAT) & MID_OVFL_TRASH;
15101da177e4SLinus Torvalds 	}
15111da177e4SLinus Torvalds 	if (reason & MID_SUNI_INT) {
15121da177e4SLinus Torvalds 		EVENT("SUNI int\n",0,0);
15131da177e4SLinus Torvalds 		dev->phy->interrupt(dev);
15141da177e4SLinus Torvalds #if 0
15151da177e4SLinus Torvalds 		foo();
15161da177e4SLinus Torvalds #endif
15171da177e4SLinus Torvalds 	}
15181da177e4SLinus Torvalds 	spin_lock(&eni_dev->lock);
15191da177e4SLinus Torvalds 	eni_dev->events |= reason;
15201da177e4SLinus Torvalds 	spin_unlock(&eni_dev->lock);
15211da177e4SLinus Torvalds 	tasklet_schedule(&eni_dev->task);
15221da177e4SLinus Torvalds 	return IRQ_HANDLED;
15231da177e4SLinus Torvalds }
15241da177e4SLinus Torvalds 
15251da177e4SLinus Torvalds 
15261da177e4SLinus Torvalds static void eni_tasklet(unsigned long data)
15271da177e4SLinus Torvalds {
15281da177e4SLinus Torvalds 	struct atm_dev *dev = (struct atm_dev *) data;
15291da177e4SLinus Torvalds 	struct eni_dev *eni_dev = ENI_DEV(dev);
15301da177e4SLinus Torvalds 	unsigned long flags;
15311da177e4SLinus Torvalds 	u32 events;
15321da177e4SLinus Torvalds 
15331da177e4SLinus Torvalds 	DPRINTK("eni_tasklet (dev %p)\n",dev);
15341da177e4SLinus Torvalds 	spin_lock_irqsave(&eni_dev->lock,flags);
15351da177e4SLinus Torvalds 	events = xchg(&eni_dev->events,0);
15361da177e4SLinus Torvalds 	spin_unlock_irqrestore(&eni_dev->lock,flags);
15371da177e4SLinus Torvalds 	if (events & MID_RX_DMA_COMPLETE) {
15381da177e4SLinus Torvalds 		EVENT("INT: RX DMA complete, starting dequeue_rx\n",0,0);
15391da177e4SLinus Torvalds 		dequeue_rx(dev);
15401da177e4SLinus Torvalds 		EVENT("dequeue_rx done, starting poll_rx\n",0,0);
15411da177e4SLinus Torvalds 		poll_rx(dev);
15421da177e4SLinus Torvalds 		EVENT("poll_rx done\n",0,0);
15431da177e4SLinus Torvalds 		/* poll_tx ? */
15441da177e4SLinus Torvalds 	}
15451da177e4SLinus Torvalds 	if (events & MID_SERVICE) {
15461da177e4SLinus Torvalds 		EVENT("INT: service, starting get_service\n",0,0);
15471da177e4SLinus Torvalds 		get_service(dev);
15481da177e4SLinus Torvalds 		EVENT("get_service done, starting poll_rx\n",0,0);
15491da177e4SLinus Torvalds 		poll_rx(dev);
15501da177e4SLinus Torvalds 		EVENT("poll_rx done\n",0,0);
15511da177e4SLinus Torvalds 	}
15521da177e4SLinus Torvalds  	if (events & MID_TX_DMA_COMPLETE) {
15531da177e4SLinus Torvalds 		EVENT("INT: TX DMA COMPLETE\n",0,0);
15541da177e4SLinus Torvalds 		dequeue_tx(dev);
15551da177e4SLinus Torvalds 	}
15561da177e4SLinus Torvalds 	if (events & MID_TX_COMPLETE) {
15571da177e4SLinus Torvalds 		EVENT("INT: TX COMPLETE\n",0,0);
15581da177e4SLinus Torvalds tx_complete++;
15591da177e4SLinus Torvalds 		wake_up(&eni_dev->tx_wait);
15601da177e4SLinus Torvalds 		/* poll_rx ? */
15611da177e4SLinus Torvalds 	}
15621da177e4SLinus Torvalds 	if (events & (MID_DMA_ERR_ACK | MID_TX_IDENT_MISM | MID_TX_DMA_OVFL)) {
15631da177e4SLinus Torvalds 		EVENT("bug interrupt\n",0,0);
15641da177e4SLinus Torvalds 		bug_int(dev,events);
15651da177e4SLinus Torvalds 	}
15661da177e4SLinus Torvalds 	poll_tx(dev);
15671da177e4SLinus Torvalds }
15681da177e4SLinus Torvalds 
15691da177e4SLinus Torvalds 
15701da177e4SLinus Torvalds /*--------------------------------- entries ---------------------------------*/
15711da177e4SLinus Torvalds 
15721da177e4SLinus Torvalds 
15731da177e4SLinus Torvalds static const char *media_name[] __devinitdata = {
15741da177e4SLinus Torvalds     "MMF", "SMF", "MMF", "03?", /*  0- 3 */
15751da177e4SLinus Torvalds     "UTP", "05?", "06?", "07?", /*  4- 7 */
15761da177e4SLinus Torvalds     "TAXI","09?", "10?", "11?", /*  8-11 */
15771da177e4SLinus Torvalds     "12?", "13?", "14?", "15?", /* 12-15 */
15781da177e4SLinus Torvalds     "MMF", "SMF", "18?", "19?", /* 16-19 */
15791da177e4SLinus Torvalds     "UTP", "21?", "22?", "23?", /* 20-23 */
15801da177e4SLinus Torvalds     "24?", "25?", "26?", "27?", /* 24-27 */
15811da177e4SLinus Torvalds     "28?", "29?", "30?", "31?"  /* 28-31 */
15821da177e4SLinus Torvalds };
15831da177e4SLinus Torvalds 
15841da177e4SLinus Torvalds 
15851da177e4SLinus Torvalds #define SET_SEPROM \
15861da177e4SLinus Torvalds   ({ if (!error && !pci_error) { \
15871da177e4SLinus Torvalds     pci_error = pci_write_config_byte(eni_dev->pci_dev,PCI_TONGA_CTRL,tonga); \
15881da177e4SLinus Torvalds     udelay(10); /* 10 usecs */ \
15891da177e4SLinus Torvalds   } })
15901da177e4SLinus Torvalds #define GET_SEPROM \
15911da177e4SLinus Torvalds   ({ if (!error && !pci_error) { \
15921da177e4SLinus Torvalds     pci_error = pci_read_config_byte(eni_dev->pci_dev,PCI_TONGA_CTRL,&tonga); \
15931da177e4SLinus Torvalds     udelay(10); /* 10 usecs */ \
15941da177e4SLinus Torvalds   } })
15951da177e4SLinus Torvalds 
15961da177e4SLinus Torvalds 
15971da177e4SLinus Torvalds static int __devinit get_esi_asic(struct atm_dev *dev)
15981da177e4SLinus Torvalds {
15991da177e4SLinus Torvalds 	struct eni_dev *eni_dev;
16001da177e4SLinus Torvalds 	unsigned char tonga;
16011da177e4SLinus Torvalds 	int error,failed,pci_error;
16021da177e4SLinus Torvalds 	int address,i,j;
16031da177e4SLinus Torvalds 
16041da177e4SLinus Torvalds 	eni_dev = ENI_DEV(dev);
16051da177e4SLinus Torvalds 	error = pci_error = 0;
16061da177e4SLinus Torvalds 	tonga = SEPROM_MAGIC | SEPROM_DATA | SEPROM_CLK;
16071da177e4SLinus Torvalds 	SET_SEPROM;
16081da177e4SLinus Torvalds 	for (i = 0; i < ESI_LEN && !error && !pci_error; i++) {
16091da177e4SLinus Torvalds 		/* start operation */
16101da177e4SLinus Torvalds 		tonga |= SEPROM_DATA;
16111da177e4SLinus Torvalds 		SET_SEPROM;
16121da177e4SLinus Torvalds 		tonga |= SEPROM_CLK;
16131da177e4SLinus Torvalds 		SET_SEPROM;
16141da177e4SLinus Torvalds 		tonga &= ~SEPROM_DATA;
16151da177e4SLinus Torvalds 		SET_SEPROM;
16161da177e4SLinus Torvalds 		tonga &= ~SEPROM_CLK;
16171da177e4SLinus Torvalds 		SET_SEPROM;
16181da177e4SLinus Torvalds 		/* send address */
16191da177e4SLinus Torvalds 		address = ((i+SEPROM_ESI_BASE) << 1)+1;
16201da177e4SLinus Torvalds 		for (j = 7; j >= 0; j--) {
16211da177e4SLinus Torvalds 			tonga = (address >> j) & 1 ? tonga | SEPROM_DATA :
16221da177e4SLinus Torvalds 			    tonga & ~SEPROM_DATA;
16231da177e4SLinus Torvalds 			SET_SEPROM;
16241da177e4SLinus Torvalds 			tonga |= SEPROM_CLK;
16251da177e4SLinus Torvalds 			SET_SEPROM;
16261da177e4SLinus Torvalds 			tonga &= ~SEPROM_CLK;
16271da177e4SLinus Torvalds 			SET_SEPROM;
16281da177e4SLinus Torvalds 		}
16291da177e4SLinus Torvalds 		/* get ack */
16301da177e4SLinus Torvalds 		tonga |= SEPROM_DATA;
16311da177e4SLinus Torvalds 		SET_SEPROM;
16321da177e4SLinus Torvalds 		tonga |= SEPROM_CLK;
16331da177e4SLinus Torvalds 		SET_SEPROM;
16341da177e4SLinus Torvalds 		GET_SEPROM;
16351da177e4SLinus Torvalds 		failed = tonga & SEPROM_DATA;
16361da177e4SLinus Torvalds 		tonga &= ~SEPROM_CLK;
16371da177e4SLinus Torvalds 		SET_SEPROM;
16381da177e4SLinus Torvalds 		tonga |= SEPROM_DATA;
16391da177e4SLinus Torvalds 		SET_SEPROM;
16401da177e4SLinus Torvalds 		if (failed) error = -EIO;
16411da177e4SLinus Torvalds 		else {
16421da177e4SLinus Torvalds 			dev->esi[i] = 0;
16431da177e4SLinus Torvalds 			for (j = 7; j >= 0; j--) {
16441da177e4SLinus Torvalds 				dev->esi[i] <<= 1;
16451da177e4SLinus Torvalds 				tonga |= SEPROM_DATA;
16461da177e4SLinus Torvalds 				SET_SEPROM;
16471da177e4SLinus Torvalds 				tonga |= SEPROM_CLK;
16481da177e4SLinus Torvalds 				SET_SEPROM;
16491da177e4SLinus Torvalds 				GET_SEPROM;
16501da177e4SLinus Torvalds 				if (tonga & SEPROM_DATA) dev->esi[i] |= 1;
16511da177e4SLinus Torvalds 				tonga &= ~SEPROM_CLK;
16521da177e4SLinus Torvalds 				SET_SEPROM;
16531da177e4SLinus Torvalds 				tonga |= SEPROM_DATA;
16541da177e4SLinus Torvalds 				SET_SEPROM;
16551da177e4SLinus Torvalds 			}
16561da177e4SLinus Torvalds 			/* get ack */
16571da177e4SLinus Torvalds 			tonga |= SEPROM_DATA;
16581da177e4SLinus Torvalds 			SET_SEPROM;
16591da177e4SLinus Torvalds 			tonga |= SEPROM_CLK;
16601da177e4SLinus Torvalds 			SET_SEPROM;
16611da177e4SLinus Torvalds 			GET_SEPROM;
16621da177e4SLinus Torvalds 			if (!(tonga & SEPROM_DATA)) error = -EIO;
16631da177e4SLinus Torvalds 			tonga &= ~SEPROM_CLK;
16641da177e4SLinus Torvalds 			SET_SEPROM;
16651da177e4SLinus Torvalds 			tonga |= SEPROM_DATA;
16661da177e4SLinus Torvalds 			SET_SEPROM;
16671da177e4SLinus Torvalds 		}
16681da177e4SLinus Torvalds 		/* stop operation */
16691da177e4SLinus Torvalds 		tonga &= ~SEPROM_DATA;
16701da177e4SLinus Torvalds 		SET_SEPROM;
16711da177e4SLinus Torvalds 		tonga |= SEPROM_CLK;
16721da177e4SLinus Torvalds 		SET_SEPROM;
16731da177e4SLinus Torvalds 		tonga |= SEPROM_DATA;
16741da177e4SLinus Torvalds 		SET_SEPROM;
16751da177e4SLinus Torvalds 	}
16761da177e4SLinus Torvalds 	if (pci_error) {
16771da177e4SLinus Torvalds 		printk(KERN_ERR DEV_LABEL "(itf %d): error reading ESI "
16781da177e4SLinus Torvalds 		    "(0x%02x)\n",dev->number,pci_error);
16791da177e4SLinus Torvalds 		error = -EIO;
16801da177e4SLinus Torvalds 	}
16811da177e4SLinus Torvalds 	return error;
16821da177e4SLinus Torvalds }
16831da177e4SLinus Torvalds 
16841da177e4SLinus Torvalds 
16851da177e4SLinus Torvalds #undef SET_SEPROM
16861da177e4SLinus Torvalds #undef GET_SEPROM
16871da177e4SLinus Torvalds 
16881da177e4SLinus Torvalds 
16891da177e4SLinus Torvalds static int __devinit get_esi_fpga(struct atm_dev *dev, void __iomem *base)
16901da177e4SLinus Torvalds {
16911da177e4SLinus Torvalds 	void __iomem *mac_base;
16921da177e4SLinus Torvalds 	int i;
16931da177e4SLinus Torvalds 
16941da177e4SLinus Torvalds 	mac_base = base+EPROM_SIZE-sizeof(struct midway_eprom);
16951da177e4SLinus Torvalds 	for (i = 0; i < ESI_LEN; i++) dev->esi[i] = readb(mac_base+(i^3));
16961da177e4SLinus Torvalds 	return 0;
16971da177e4SLinus Torvalds }
16981da177e4SLinus Torvalds 
16991da177e4SLinus Torvalds 
17001da177e4SLinus Torvalds static int __devinit eni_do_init(struct atm_dev *dev)
17011da177e4SLinus Torvalds {
17021da177e4SLinus Torvalds 	struct midway_eprom __iomem *eprom;
17031da177e4SLinus Torvalds 	struct eni_dev *eni_dev;
17041da177e4SLinus Torvalds 	struct pci_dev *pci_dev;
17051da177e4SLinus Torvalds 	unsigned long real_base;
17061da177e4SLinus Torvalds 	void __iomem *base;
17071da177e4SLinus Torvalds 	int error,i,last;
17081da177e4SLinus Torvalds 
17091da177e4SLinus Torvalds 	DPRINTK(">eni_init\n");
17101da177e4SLinus Torvalds 	dev->ci_range.vpi_bits = 0;
17111da177e4SLinus Torvalds 	dev->ci_range.vci_bits = NR_VCI_LD;
17121da177e4SLinus Torvalds 	dev->link_rate = ATM_OC3_PCR;
17131da177e4SLinus Torvalds 	eni_dev = ENI_DEV(dev);
17141da177e4SLinus Torvalds 	pci_dev = eni_dev->pci_dev;
17151da177e4SLinus Torvalds 	real_base = pci_resource_start(pci_dev, 0);
17161da177e4SLinus Torvalds 	eni_dev->irq = pci_dev->irq;
17171da177e4SLinus Torvalds 	if ((error = pci_write_config_word(pci_dev,PCI_COMMAND,
17181da177e4SLinus Torvalds 	    PCI_COMMAND_MEMORY |
17191da177e4SLinus Torvalds 	    (eni_dev->asic ? PCI_COMMAND_PARITY | PCI_COMMAND_SERR : 0)))) {
17201da177e4SLinus Torvalds 		printk(KERN_ERR DEV_LABEL "(itf %d): can't enable memory "
17211da177e4SLinus Torvalds 		    "(0x%02x)\n",dev->number,error);
17221da177e4SLinus Torvalds 		return -EIO;
17231da177e4SLinus Torvalds 	}
17241da177e4SLinus Torvalds 	printk(KERN_NOTICE DEV_LABEL "(itf %d): rev.%d,base=0x%lx,irq=%d,",
172544c10138SAuke Kok 	    dev->number,pci_dev->revision,real_base,eni_dev->irq);
17261da177e4SLinus Torvalds 	if (!(base = ioremap_nocache(real_base,MAP_MAX_SIZE))) {
17271da177e4SLinus Torvalds 		printk("\n");
17281da177e4SLinus Torvalds 		printk(KERN_ERR DEV_LABEL "(itf %d): can't set up page "
17291da177e4SLinus Torvalds 		    "mapping\n",dev->number);
17301da177e4SLinus Torvalds 		return error;
17311da177e4SLinus Torvalds 	}
17321da177e4SLinus Torvalds 	eni_dev->base_diff = real_base - (unsigned long) base;
17331da177e4SLinus Torvalds 	/* id may not be present in ASIC Tonga boards - check this @@@ */
17341da177e4SLinus Torvalds 	if (!eni_dev->asic) {
17351da177e4SLinus Torvalds 		eprom = (base+EPROM_SIZE-sizeof(struct midway_eprom));
17361da177e4SLinus Torvalds 		if (readl(&eprom->magic) != ENI155_MAGIC) {
17371da177e4SLinus Torvalds 			printk("\n");
17381da177e4SLinus Torvalds 			printk(KERN_ERR KERN_ERR DEV_LABEL "(itf %d): bad "
17391da177e4SLinus Torvalds 			    "magic - expected 0x%x, got 0x%x\n",dev->number,
17401da177e4SLinus Torvalds 			    ENI155_MAGIC,(unsigned) readl(&eprom->magic));
174178e4be16SAmol Lad 			error = -EINVAL;
174278e4be16SAmol Lad 			goto unmap;
17431da177e4SLinus Torvalds 		}
17441da177e4SLinus Torvalds 	}
17451da177e4SLinus Torvalds 	eni_dev->phy = base+PHY_BASE;
17461da177e4SLinus Torvalds 	eni_dev->reg = base+REG_BASE;
17471da177e4SLinus Torvalds 	eni_dev->ram = base+RAM_BASE;
17481da177e4SLinus Torvalds 	last = MAP_MAX_SIZE-RAM_BASE;
17491da177e4SLinus Torvalds 	for (i = last-RAM_INCREMENT; i >= 0; i -= RAM_INCREMENT) {
17501da177e4SLinus Torvalds 		writel(0x55555555,eni_dev->ram+i);
17511da177e4SLinus Torvalds 		if (readl(eni_dev->ram+i) != 0x55555555) last = i;
17521da177e4SLinus Torvalds 		else {
17531da177e4SLinus Torvalds 			writel(0xAAAAAAAA,eni_dev->ram+i);
17541da177e4SLinus Torvalds 			if (readl(eni_dev->ram+i) != 0xAAAAAAAA) last = i;
17551da177e4SLinus Torvalds 			else writel(i,eni_dev->ram+i);
17561da177e4SLinus Torvalds 		}
17571da177e4SLinus Torvalds 	}
17581da177e4SLinus Torvalds 	for (i = 0; i < last; i += RAM_INCREMENT)
17591da177e4SLinus Torvalds 		if (readl(eni_dev->ram+i) != i) break;
17601da177e4SLinus Torvalds 	eni_dev->mem = i;
17611da177e4SLinus Torvalds 	memset_io(eni_dev->ram,0,eni_dev->mem);
17621da177e4SLinus Torvalds 	/* TODO: should shrink allocation now */
17631da177e4SLinus Torvalds 	printk("mem=%dkB (",eni_dev->mem >> 10);
17641da177e4SLinus Torvalds 	/* TODO: check for non-SUNI, check for TAXI ? */
17651da177e4SLinus Torvalds 	if (!(eni_in(MID_RES_ID_MCON) & 0x200) != !eni_dev->asic) {
17661da177e4SLinus Torvalds 		printk(")\n");
17671da177e4SLinus Torvalds 		printk(KERN_ERR DEV_LABEL "(itf %d): ERROR - wrong id 0x%x\n",
17681da177e4SLinus Torvalds 		    dev->number,(unsigned) eni_in(MID_RES_ID_MCON));
176978e4be16SAmol Lad 		error = -EINVAL;
177078e4be16SAmol Lad 		goto unmap;
17711da177e4SLinus Torvalds 	}
17721da177e4SLinus Torvalds 	error = eni_dev->asic ? get_esi_asic(dev) : get_esi_fpga(dev,base);
177378e4be16SAmol Lad 	if (error)
177478e4be16SAmol Lad 		goto unmap;
17751da177e4SLinus Torvalds 	for (i = 0; i < ESI_LEN; i++)
17761da177e4SLinus Torvalds 		printk("%s%02X",i ? "-" : "",dev->esi[i]);
17771da177e4SLinus Torvalds 	printk(")\n");
17781da177e4SLinus Torvalds 	printk(KERN_NOTICE DEV_LABEL "(itf %d): %s,%s\n",dev->number,
17791da177e4SLinus Torvalds 	    eni_in(MID_RES_ID_MCON) & 0x200 ? "ASIC" : "FPGA",
17801da177e4SLinus Torvalds 	    media_name[eni_in(MID_RES_ID_MCON) & DAUGTHER_ID]);
178178e4be16SAmol Lad 
178278e4be16SAmol Lad 	error = suni_init(dev);
178378e4be16SAmol Lad 	if (error)
178478e4be16SAmol Lad 		goto unmap;
178578e4be16SAmol Lad out:
178678e4be16SAmol Lad 	return error;
178778e4be16SAmol Lad unmap:
178878e4be16SAmol Lad 	iounmap(base);
178978e4be16SAmol Lad 	goto out;
17901da177e4SLinus Torvalds }
17911da177e4SLinus Torvalds 
17921da177e4SLinus Torvalds 
17931da177e4SLinus Torvalds static int __devinit eni_start(struct atm_dev *dev)
17941da177e4SLinus Torvalds {
17951da177e4SLinus Torvalds 	struct eni_dev *eni_dev;
17961da177e4SLinus Torvalds 
17971da177e4SLinus Torvalds 	void __iomem *buf;
17981da177e4SLinus Torvalds 	unsigned long buffer_mem;
17991da177e4SLinus Torvalds 	int error;
18001da177e4SLinus Torvalds 
18011da177e4SLinus Torvalds 	DPRINTK(">eni_start\n");
18021da177e4SLinus Torvalds 	eni_dev = ENI_DEV(dev);
1803dace1453SThomas Gleixner 	if (request_irq(eni_dev->irq,&eni_int,IRQF_SHARED,DEV_LABEL,dev)) {
18041da177e4SLinus Torvalds 		printk(KERN_ERR DEV_LABEL "(itf %d): IRQ%d is already in use\n",
18051da177e4SLinus Torvalds 		    dev->number,eni_dev->irq);
1806758d11bfSAndrew Morton 		error = -EAGAIN;
1807758d11bfSAndrew Morton 		goto out;
18081da177e4SLinus Torvalds 	}
18091da177e4SLinus Torvalds 	pci_set_master(eni_dev->pci_dev);
18101da177e4SLinus Torvalds 	if ((error = pci_write_config_word(eni_dev->pci_dev,PCI_COMMAND,
18111da177e4SLinus Torvalds 	    PCI_COMMAND_MEMORY | PCI_COMMAND_MASTER |
18121da177e4SLinus Torvalds 	    (eni_dev->asic ? PCI_COMMAND_PARITY | PCI_COMMAND_SERR : 0)))) {
18131da177e4SLinus Torvalds 		printk(KERN_ERR DEV_LABEL "(itf %d): can't enable memory+"
18141da177e4SLinus Torvalds 		    "master (0x%02x)\n",dev->number,error);
1815758d11bfSAndrew Morton 		goto free_irq;
18161da177e4SLinus Torvalds 	}
18171da177e4SLinus Torvalds 	if ((error = pci_write_config_byte(eni_dev->pci_dev,PCI_TONGA_CTRL,
18181da177e4SLinus Torvalds 	    END_SWAP_DMA))) {
18191da177e4SLinus Torvalds 		printk(KERN_ERR DEV_LABEL "(itf %d): can't set endian swap "
18201da177e4SLinus Torvalds 		    "(0x%02x)\n",dev->number,error);
1821758d11bfSAndrew Morton 		goto free_irq;
18221da177e4SLinus Torvalds 	}
18231da177e4SLinus Torvalds 	/* determine addresses of internal tables */
18241da177e4SLinus Torvalds 	eni_dev->vci = eni_dev->ram;
18251da177e4SLinus Torvalds 	eni_dev->rx_dma = eni_dev->ram+NR_VCI*16;
18261da177e4SLinus Torvalds 	eni_dev->tx_dma = eni_dev->rx_dma+NR_DMA_RX*8;
18271da177e4SLinus Torvalds 	eni_dev->service = eni_dev->tx_dma+NR_DMA_TX*8;
18281da177e4SLinus Torvalds 	buf = eni_dev->service+NR_SERVICE*4;
18291da177e4SLinus Torvalds 	DPRINTK("vci 0x%lx,rx 0x%lx, tx 0x%lx,srv 0x%lx,buf 0x%lx\n",
18301da177e4SLinus Torvalds 	     eni_dev->vci,eni_dev->rx_dma,eni_dev->tx_dma,
18311da177e4SLinus Torvalds 	     eni_dev->service,buf);
18321da177e4SLinus Torvalds 	spin_lock_init(&eni_dev->lock);
18331da177e4SLinus Torvalds 	tasklet_init(&eni_dev->task,eni_tasklet,(unsigned long) dev);
18341da177e4SLinus Torvalds 	eni_dev->events = 0;
18351da177e4SLinus Torvalds 	/* initialize memory management */
18361da177e4SLinus Torvalds 	buffer_mem = eni_dev->mem - (buf - eni_dev->ram);
18371da177e4SLinus Torvalds 	eni_dev->free_list_size = buffer_mem/MID_MIN_BUF_SIZE/2;
18385cbded58SRobert P. J. Day 	eni_dev->free_list = kmalloc(
18391da177e4SLinus Torvalds 	    sizeof(struct eni_free)*(eni_dev->free_list_size+1),GFP_KERNEL);
18401da177e4SLinus Torvalds 	if (!eni_dev->free_list) {
18411da177e4SLinus Torvalds 		printk(KERN_ERR DEV_LABEL "(itf %d): couldn't get free page\n",
18421da177e4SLinus Torvalds 		    dev->number);
1843758d11bfSAndrew Morton 		error = -ENOMEM;
1844758d11bfSAndrew Morton 		goto free_irq;
18451da177e4SLinus Torvalds 	}
18461da177e4SLinus Torvalds 	eni_dev->free_len = 0;
18471da177e4SLinus Torvalds 	eni_put_free(eni_dev,buf,buffer_mem);
18481da177e4SLinus Torvalds 	memset_io(eni_dev->vci,0,16*NR_VCI); /* clear VCI table */
18491da177e4SLinus Torvalds 	/*
18501da177e4SLinus Torvalds 	 * byte_addr  free (k)
18511da177e4SLinus Torvalds 	 * 0x00000000     512  VCI table
18521da177e4SLinus Torvalds 	 * 0x00004000	  496  RX DMA
18531da177e4SLinus Torvalds 	 * 0x00005000	  492  TX DMA
18541da177e4SLinus Torvalds 	 * 0x00006000	  488  service list
18551da177e4SLinus Torvalds 	 * 0x00007000	  484  buffers
18561da177e4SLinus Torvalds 	 * 0x00080000	    0  end (512kB)
18571da177e4SLinus Torvalds 	 */
18581da177e4SLinus Torvalds 	eni_out(0xffffffff,MID_IE);
18591da177e4SLinus Torvalds 	error = start_tx(dev);
1860758d11bfSAndrew Morton 	if (error) goto free_list;
18611da177e4SLinus Torvalds 	error = start_rx(dev);
1862758d11bfSAndrew Morton 	if (error) goto free_list;
18631da177e4SLinus Torvalds 	error = dev->phy->start(dev);
1864758d11bfSAndrew Morton 	if (error) goto free_list;
18651da177e4SLinus Torvalds 	eni_out(eni_in(MID_MC_S) | (1 << MID_INT_SEL_SHIFT) |
18661da177e4SLinus Torvalds 	    MID_TX_LOCK_MODE | MID_DMA_ENABLE | MID_TX_ENABLE | MID_RX_ENABLE,
18671da177e4SLinus Torvalds 	    MID_MC_S);
18681da177e4SLinus Torvalds 	    /* Tonga uses SBus INTReq1 */
18691da177e4SLinus Torvalds 	(void) eni_in(MID_ISA); /* clear Midway interrupts */
18701da177e4SLinus Torvalds 	return 0;
1871758d11bfSAndrew Morton 
1872758d11bfSAndrew Morton free_list:
1873758d11bfSAndrew Morton 	kfree(eni_dev->free_list);
1874758d11bfSAndrew Morton 
1875758d11bfSAndrew Morton free_irq:
1876758d11bfSAndrew Morton 	free_irq(eni_dev->irq, eni_dev);
1877758d11bfSAndrew Morton 
1878758d11bfSAndrew Morton out:
1879758d11bfSAndrew Morton 	return error;
18801da177e4SLinus Torvalds }
18811da177e4SLinus Torvalds 
18821da177e4SLinus Torvalds 
18831da177e4SLinus Torvalds static void eni_close(struct atm_vcc *vcc)
18841da177e4SLinus Torvalds {
18851da177e4SLinus Torvalds 	DPRINTK(">eni_close\n");
18861da177e4SLinus Torvalds 	if (!ENI_VCC(vcc)) return;
18871da177e4SLinus Torvalds 	clear_bit(ATM_VF_READY,&vcc->flags);
18881da177e4SLinus Torvalds 	close_rx(vcc);
18891da177e4SLinus Torvalds 	close_tx(vcc);
18901da177e4SLinus Torvalds 	DPRINTK("eni_close: done waiting\n");
18911da177e4SLinus Torvalds 	/* deallocate memory */
18921da177e4SLinus Torvalds 	kfree(ENI_VCC(vcc));
18931da177e4SLinus Torvalds 	vcc->dev_data = NULL;
18941da177e4SLinus Torvalds 	clear_bit(ATM_VF_ADDR,&vcc->flags);
18951da177e4SLinus Torvalds 	/*foo();*/
18961da177e4SLinus Torvalds }
18971da177e4SLinus Torvalds 
18981da177e4SLinus Torvalds 
18991da177e4SLinus Torvalds static int eni_open(struct atm_vcc *vcc)
19001da177e4SLinus Torvalds {
19011da177e4SLinus Torvalds 	struct eni_dev *eni_dev;
19021da177e4SLinus Torvalds 	struct eni_vcc *eni_vcc;
19031da177e4SLinus Torvalds 	int error;
19041da177e4SLinus Torvalds 	short vpi = vcc->vpi;
19051da177e4SLinus Torvalds 	int vci = vcc->vci;
19061da177e4SLinus Torvalds 
19071da177e4SLinus Torvalds 	DPRINTK(">eni_open\n");
19081da177e4SLinus Torvalds 	EVENT("eni_open\n",0,0);
19091da177e4SLinus Torvalds 	if (!test_bit(ATM_VF_PARTIAL,&vcc->flags))
19101da177e4SLinus Torvalds 		vcc->dev_data = NULL;
19111da177e4SLinus Torvalds 	eni_dev = ENI_DEV(vcc->dev);
19121da177e4SLinus Torvalds 	if (vci != ATM_VPI_UNSPEC && vpi != ATM_VCI_UNSPEC)
19131da177e4SLinus Torvalds 		set_bit(ATM_VF_ADDR,&vcc->flags);
19141da177e4SLinus Torvalds 	if (vcc->qos.aal != ATM_AAL0 && vcc->qos.aal != ATM_AAL5)
19151da177e4SLinus Torvalds 		return -EINVAL;
19161da177e4SLinus Torvalds 	DPRINTK(DEV_LABEL "(itf %d): open %d.%d\n",vcc->dev->number,vcc->vpi,
19171da177e4SLinus Torvalds 	    vcc->vci);
19181da177e4SLinus Torvalds 	if (!test_bit(ATM_VF_PARTIAL,&vcc->flags)) {
19191da177e4SLinus Torvalds 		eni_vcc = kmalloc(sizeof(struct eni_vcc),GFP_KERNEL);
19201da177e4SLinus Torvalds 		if (!eni_vcc) return -ENOMEM;
19211da177e4SLinus Torvalds 		vcc->dev_data = eni_vcc;
19221da177e4SLinus Torvalds 		eni_vcc->tx = NULL; /* for eni_close after open_rx */
19231da177e4SLinus Torvalds 		if ((error = open_rx_first(vcc))) {
19241da177e4SLinus Torvalds 			eni_close(vcc);
19251da177e4SLinus Torvalds 			return error;
19261da177e4SLinus Torvalds 		}
19271da177e4SLinus Torvalds 		if ((error = open_tx_first(vcc))) {
19281da177e4SLinus Torvalds 			eni_close(vcc);
19291da177e4SLinus Torvalds 			return error;
19301da177e4SLinus Torvalds 		}
19311da177e4SLinus Torvalds 	}
19321da177e4SLinus Torvalds 	if (vci == ATM_VPI_UNSPEC || vpi == ATM_VCI_UNSPEC) return 0;
19331da177e4SLinus Torvalds 	if ((error = open_rx_second(vcc))) {
19341da177e4SLinus Torvalds 		eni_close(vcc);
19351da177e4SLinus Torvalds 		return error;
19361da177e4SLinus Torvalds 	}
19371da177e4SLinus Torvalds 	if ((error = open_tx_second(vcc))) {
19381da177e4SLinus Torvalds 		eni_close(vcc);
19391da177e4SLinus Torvalds 		return error;
19401da177e4SLinus Torvalds 	}
19411da177e4SLinus Torvalds 	set_bit(ATM_VF_READY,&vcc->flags);
19421da177e4SLinus Torvalds 	/* should power down SUNI while !ref_count @@@ */
19431da177e4SLinus Torvalds 	return 0;
19441da177e4SLinus Torvalds }
19451da177e4SLinus Torvalds 
19461da177e4SLinus Torvalds 
19471da177e4SLinus Torvalds static int eni_change_qos(struct atm_vcc *vcc,struct atm_qos *qos,int flgs)
19481da177e4SLinus Torvalds {
19491da177e4SLinus Torvalds 	struct eni_dev *eni_dev = ENI_DEV(vcc->dev);
19501da177e4SLinus Torvalds 	struct eni_tx *tx = ENI_VCC(vcc)->tx;
19511da177e4SLinus Torvalds 	struct sk_buff *skb;
19521da177e4SLinus Torvalds 	int error,rate,rsv,shp;
19531da177e4SLinus Torvalds 
19541da177e4SLinus Torvalds 	if (qos->txtp.traffic_class == ATM_NONE) return 0;
19551da177e4SLinus Torvalds 	if (tx == eni_dev->ubr) return -EBADFD;
19561da177e4SLinus Torvalds 	rate = atm_pcr_goal(&qos->txtp);
19571da177e4SLinus Torvalds 	if (rate < 0) rate = -rate;
19581da177e4SLinus Torvalds 	rsv = shp = 0;
19591da177e4SLinus Torvalds 	if ((flgs & ATM_MF_DEC_RSV) && rate && rate < tx->reserved) rsv = 1;
19601da177e4SLinus Torvalds 	if ((flgs & ATM_MF_INC_RSV) && (!rate || rate > tx->reserved)) rsv = 1;
19611da177e4SLinus Torvalds 	if ((flgs & ATM_MF_DEC_SHP) && rate && rate < tx->shaping) shp = 1;
19621da177e4SLinus Torvalds 	if ((flgs & ATM_MF_INC_SHP) && (!rate || rate > tx->shaping)) shp = 1;
19631da177e4SLinus Torvalds 	if (!rsv && !shp) return 0;
19641da177e4SLinus Torvalds 	error = reserve_or_set_tx(vcc,&qos->txtp,rsv,shp);
19651da177e4SLinus Torvalds 	if (error) return error;
19661da177e4SLinus Torvalds 	if (shp && !(flgs & ATM_MF_IMMED)) return 0;
19671da177e4SLinus Torvalds 	/*
19681da177e4SLinus Torvalds 	 * Walk through the send buffer and patch the rate information in all
19691da177e4SLinus Torvalds 	 * segmentation buffer descriptors of this VCC.
19701da177e4SLinus Torvalds 	 */
19711da177e4SLinus Torvalds 	tasklet_disable(&eni_dev->task);
19721da177e4SLinus Torvalds 	skb_queue_walk(&eni_dev->tx_queue, skb) {
19731da177e4SLinus Torvalds 		void __iomem *dsc;
19741da177e4SLinus Torvalds 
19751da177e4SLinus Torvalds 		if (ATM_SKB(skb)->vcc != vcc) continue;
19761da177e4SLinus Torvalds 		dsc = tx->send+ENI_PRV_POS(skb)*4;
19771da177e4SLinus Torvalds 		writel((readl(dsc) & ~(MID_SEG_RATE | MID_SEG_PR)) |
19781da177e4SLinus Torvalds 		    (tx->prescaler << MID_SEG_PR_SHIFT) |
19791da177e4SLinus Torvalds 		    (tx->resolution << MID_SEG_RATE_SHIFT), dsc);
19801da177e4SLinus Torvalds 	}
19811da177e4SLinus Torvalds 	tasklet_enable(&eni_dev->task);
19821da177e4SLinus Torvalds 	return 0;
19831da177e4SLinus Torvalds }
19841da177e4SLinus Torvalds 
19851da177e4SLinus Torvalds 
19861da177e4SLinus Torvalds static int eni_ioctl(struct atm_dev *dev,unsigned int cmd,void __user *arg)
19871da177e4SLinus Torvalds {
19881da177e4SLinus Torvalds 	struct eni_dev *eni_dev = ENI_DEV(dev);
19891da177e4SLinus Torvalds 
19901da177e4SLinus Torvalds 	if (cmd == ENI_MEMDUMP) {
19911da177e4SLinus Torvalds 		if (!capable(CAP_NET_ADMIN)) return -EPERM;
19921da177e4SLinus Torvalds 		printk(KERN_WARNING "Please use /proc/atm/" DEV_LABEL ":%d "
19931da177e4SLinus Torvalds 		    "instead of obsolete ioctl ENI_MEMDUMP\n",dev->number);
19941da177e4SLinus Torvalds 		dump(dev);
19951da177e4SLinus Torvalds 		return 0;
19961da177e4SLinus Torvalds 	}
19971da177e4SLinus Torvalds 	if (cmd == ENI_SETMULT) {
19981da177e4SLinus Torvalds 		struct eni_multipliers mult;
19991da177e4SLinus Torvalds 
20001da177e4SLinus Torvalds 		if (!capable(CAP_NET_ADMIN)) return -EPERM;
20011da177e4SLinus Torvalds 		if (copy_from_user(&mult, arg,
20021da177e4SLinus Torvalds 		    sizeof(struct eni_multipliers)))
20031da177e4SLinus Torvalds 			return -EFAULT;
20041da177e4SLinus Torvalds 		if ((mult.tx && mult.tx <= 100) || (mult.rx &&mult.rx <= 100) ||
20051da177e4SLinus Torvalds 		    mult.tx > 65536 || mult.rx > 65536)
20061da177e4SLinus Torvalds 			return -EINVAL;
20071da177e4SLinus Torvalds 		if (mult.tx) eni_dev->tx_mult = mult.tx;
20081da177e4SLinus Torvalds 		if (mult.rx) eni_dev->rx_mult = mult.rx;
20091da177e4SLinus Torvalds 		return 0;
20101da177e4SLinus Torvalds 	}
20111da177e4SLinus Torvalds 	if (cmd == ATM_SETCIRANGE) {
20121da177e4SLinus Torvalds 		struct atm_cirange ci;
20131da177e4SLinus Torvalds 
20141da177e4SLinus Torvalds 		if (copy_from_user(&ci, arg,sizeof(struct atm_cirange)))
20151da177e4SLinus Torvalds 			return -EFAULT;
20161da177e4SLinus Torvalds 		if ((ci.vpi_bits == 0 || ci.vpi_bits == ATM_CI_MAX) &&
20171da177e4SLinus Torvalds 		    (ci.vci_bits == NR_VCI_LD || ci.vpi_bits == ATM_CI_MAX))
20181da177e4SLinus Torvalds 		    return 0;
20191da177e4SLinus Torvalds 		return -EINVAL;
20201da177e4SLinus Torvalds 	}
20211da177e4SLinus Torvalds 	if (!dev->phy->ioctl) return -ENOIOCTLCMD;
20221da177e4SLinus Torvalds 	return dev->phy->ioctl(dev,cmd,arg);
20231da177e4SLinus Torvalds }
20241da177e4SLinus Torvalds 
20251da177e4SLinus Torvalds 
20261da177e4SLinus Torvalds static int eni_getsockopt(struct atm_vcc *vcc,int level,int optname,
20271da177e4SLinus Torvalds     void __user *optval,int optlen)
20281da177e4SLinus Torvalds {
20291da177e4SLinus Torvalds 	return -EINVAL;
20301da177e4SLinus Torvalds }
20311da177e4SLinus Torvalds 
20321da177e4SLinus Torvalds 
20331da177e4SLinus Torvalds static int eni_setsockopt(struct atm_vcc *vcc,int level,int optname,
20341da177e4SLinus Torvalds     void __user *optval,int optlen)
20351da177e4SLinus Torvalds {
20361da177e4SLinus Torvalds 	return -EINVAL;
20371da177e4SLinus Torvalds }
20381da177e4SLinus Torvalds 
20391da177e4SLinus Torvalds 
20401da177e4SLinus Torvalds static int eni_send(struct atm_vcc *vcc,struct sk_buff *skb)
20411da177e4SLinus Torvalds {
20421da177e4SLinus Torvalds 	enum enq_res res;
20431da177e4SLinus Torvalds 
20441da177e4SLinus Torvalds 	DPRINTK(">eni_send\n");
20451da177e4SLinus Torvalds 	if (!ENI_VCC(vcc)->tx) {
20461da177e4SLinus Torvalds 		if (vcc->pop) vcc->pop(vcc,skb);
20471da177e4SLinus Torvalds 		else dev_kfree_skb(skb);
20481da177e4SLinus Torvalds 		return -EINVAL;
20491da177e4SLinus Torvalds 	}
20501da177e4SLinus Torvalds 	if (!skb) {
20511da177e4SLinus Torvalds 		printk(KERN_CRIT "!skb in eni_send ?\n");
20521da177e4SLinus Torvalds 		if (vcc->pop) vcc->pop(vcc,skb);
20531da177e4SLinus Torvalds 		return -EINVAL;
20541da177e4SLinus Torvalds 	}
20551da177e4SLinus Torvalds 	if (vcc->qos.aal == ATM_AAL0) {
20561da177e4SLinus Torvalds 		if (skb->len != ATM_CELL_SIZE-1) {
20571da177e4SLinus Torvalds 			if (vcc->pop) vcc->pop(vcc,skb);
20581da177e4SLinus Torvalds 			else dev_kfree_skb(skb);
20591da177e4SLinus Torvalds 			return -EINVAL;
20601da177e4SLinus Torvalds 		}
20611da177e4SLinus Torvalds 		*(u32 *) skb->data = htonl(*(u32 *) skb->data);
20621da177e4SLinus Torvalds 	}
20631da177e4SLinus Torvalds submitted++;
20641da177e4SLinus Torvalds 	ATM_SKB(skb)->vcc = vcc;
20651da177e4SLinus Torvalds 	tasklet_disable(&ENI_DEV(vcc->dev)->task);
20661da177e4SLinus Torvalds 	res = do_tx(skb);
20671da177e4SLinus Torvalds 	tasklet_enable(&ENI_DEV(vcc->dev)->task);
20681da177e4SLinus Torvalds 	if (res == enq_ok) return 0;
20691da177e4SLinus Torvalds 	skb_queue_tail(&ENI_VCC(vcc)->tx->backlog,skb);
20701da177e4SLinus Torvalds backlogged++;
20711da177e4SLinus Torvalds 	tasklet_schedule(&ENI_DEV(vcc->dev)->task);
20721da177e4SLinus Torvalds 	return 0;
20731da177e4SLinus Torvalds }
20741da177e4SLinus Torvalds 
20751da177e4SLinus Torvalds static void eni_phy_put(struct atm_dev *dev,unsigned char value,
20761da177e4SLinus Torvalds     unsigned long addr)
20771da177e4SLinus Torvalds {
20781da177e4SLinus Torvalds 	writel(value,ENI_DEV(dev)->phy+addr*4);
20791da177e4SLinus Torvalds }
20801da177e4SLinus Torvalds 
20811da177e4SLinus Torvalds 
20821da177e4SLinus Torvalds 
20831da177e4SLinus Torvalds static unsigned char eni_phy_get(struct atm_dev *dev,unsigned long addr)
20841da177e4SLinus Torvalds {
20851da177e4SLinus Torvalds 	return readl(ENI_DEV(dev)->phy+addr*4);
20861da177e4SLinus Torvalds }
20871da177e4SLinus Torvalds 
20881da177e4SLinus Torvalds 
20891da177e4SLinus Torvalds static int eni_proc_read(struct atm_dev *dev,loff_t *pos,char *page)
20901da177e4SLinus Torvalds {
20911da177e4SLinus Torvalds 	struct hlist_node *node;
20921da177e4SLinus Torvalds 	struct sock *s;
20931da177e4SLinus Torvalds 	static const char *signal[] = { "LOST","unknown","okay" };
20941da177e4SLinus Torvalds 	struct eni_dev *eni_dev = ENI_DEV(dev);
20951da177e4SLinus Torvalds 	struct atm_vcc *vcc;
20961da177e4SLinus Torvalds 	int left,i;
20971da177e4SLinus Torvalds 
20981da177e4SLinus Torvalds 	left = *pos;
20991da177e4SLinus Torvalds 	if (!left)
21001da177e4SLinus Torvalds 		return sprintf(page,DEV_LABEL "(itf %d) signal %s, %dkB, "
21011da177e4SLinus Torvalds 		    "%d cps remaining\n",dev->number,signal[(int) dev->signal],
21021da177e4SLinus Torvalds 		    eni_dev->mem >> 10,eni_dev->tx_bw);
21031da177e4SLinus Torvalds 	if (!--left)
21041da177e4SLinus Torvalds 		return sprintf(page,"%4sBursts: TX"
21051da177e4SLinus Torvalds #if !defined(CONFIG_ATM_ENI_BURST_TX_16W) && \
21061da177e4SLinus Torvalds     !defined(CONFIG_ATM_ENI_BURST_TX_8W) && \
21071da177e4SLinus Torvalds     !defined(CONFIG_ATM_ENI_BURST_TX_4W) && \
21081da177e4SLinus Torvalds     !defined(CONFIG_ATM_ENI_BURST_TX_2W)
21091da177e4SLinus Torvalds 		    " none"
21101da177e4SLinus Torvalds #endif
21111da177e4SLinus Torvalds #ifdef CONFIG_ATM_ENI_BURST_TX_16W
21121da177e4SLinus Torvalds 		    " 16W"
21131da177e4SLinus Torvalds #endif
21141da177e4SLinus Torvalds #ifdef CONFIG_ATM_ENI_BURST_TX_8W
21151da177e4SLinus Torvalds 		    " 8W"
21161da177e4SLinus Torvalds #endif
21171da177e4SLinus Torvalds #ifdef CONFIG_ATM_ENI_BURST_TX_4W
21181da177e4SLinus Torvalds 		    " 4W"
21191da177e4SLinus Torvalds #endif
21201da177e4SLinus Torvalds #ifdef CONFIG_ATM_ENI_BURST_TX_2W
21211da177e4SLinus Torvalds 		    " 2W"
21221da177e4SLinus Torvalds #endif
21231da177e4SLinus Torvalds 		    ", RX"
21241da177e4SLinus Torvalds #if !defined(CONFIG_ATM_ENI_BURST_RX_16W) && \
21251da177e4SLinus Torvalds     !defined(CONFIG_ATM_ENI_BURST_RX_8W) && \
21261da177e4SLinus Torvalds     !defined(CONFIG_ATM_ENI_BURST_RX_4W) && \
21271da177e4SLinus Torvalds     !defined(CONFIG_ATM_ENI_BURST_RX_2W)
21281da177e4SLinus Torvalds 		    " none"
21291da177e4SLinus Torvalds #endif
21301da177e4SLinus Torvalds #ifdef CONFIG_ATM_ENI_BURST_RX_16W
21311da177e4SLinus Torvalds 		    " 16W"
21321da177e4SLinus Torvalds #endif
21331da177e4SLinus Torvalds #ifdef CONFIG_ATM_ENI_BURST_RX_8W
21341da177e4SLinus Torvalds 		    " 8W"
21351da177e4SLinus Torvalds #endif
21361da177e4SLinus Torvalds #ifdef CONFIG_ATM_ENI_BURST_RX_4W
21371da177e4SLinus Torvalds 		    " 4W"
21381da177e4SLinus Torvalds #endif
21391da177e4SLinus Torvalds #ifdef CONFIG_ATM_ENI_BURST_RX_2W
21401da177e4SLinus Torvalds 		    " 2W"
21411da177e4SLinus Torvalds #endif
21421da177e4SLinus Torvalds #ifndef CONFIG_ATM_ENI_TUNE_BURST
21431da177e4SLinus Torvalds 		    " (default)"
21441da177e4SLinus Torvalds #endif
21451da177e4SLinus Torvalds 		    "\n","");
21461da177e4SLinus Torvalds 	if (!--left)
21471da177e4SLinus Torvalds 		return sprintf(page,"%4sBuffer multipliers: tx %d%%, rx %d%%\n",
21481da177e4SLinus Torvalds 		    "",eni_dev->tx_mult,eni_dev->rx_mult);
21491da177e4SLinus Torvalds 	for (i = 0; i < NR_CHAN; i++) {
21501da177e4SLinus Torvalds 		struct eni_tx *tx = eni_dev->tx+i;
21511da177e4SLinus Torvalds 
21521da177e4SLinus Torvalds 		if (!tx->send) continue;
21531da177e4SLinus Torvalds 		if (!--left) {
21541da177e4SLinus Torvalds 			return sprintf(page,"tx[%d]:    0x%ld-0x%ld "
21551da177e4SLinus Torvalds 			    "(%6ld bytes), rsv %d cps, shp %d cps%s\n",i,
21561da177e4SLinus Torvalds 			    (unsigned long) (tx->send - eni_dev->ram),
21571da177e4SLinus Torvalds 			    tx->send-eni_dev->ram+tx->words*4-1,tx->words*4,
21581da177e4SLinus Torvalds 			    tx->reserved,tx->shaping,
21591da177e4SLinus Torvalds 			    tx == eni_dev->ubr ? " (UBR)" : "");
21601da177e4SLinus Torvalds 		}
21611da177e4SLinus Torvalds 		if (--left) continue;
21621da177e4SLinus Torvalds 		return sprintf(page,"%10sbacklog %u packets\n","",
21631da177e4SLinus Torvalds 		    skb_queue_len(&tx->backlog));
21641da177e4SLinus Torvalds 	}
21651da177e4SLinus Torvalds 	read_lock(&vcc_sklist_lock);
21661da177e4SLinus Torvalds 	for(i = 0; i < VCC_HTABLE_SIZE; ++i) {
21671da177e4SLinus Torvalds 		struct hlist_head *head = &vcc_hash[i];
21681da177e4SLinus Torvalds 
21691da177e4SLinus Torvalds 		sk_for_each(s, node, head) {
21701da177e4SLinus Torvalds 			struct eni_vcc *eni_vcc;
21711da177e4SLinus Torvalds 			int length;
21721da177e4SLinus Torvalds 
21731da177e4SLinus Torvalds 			vcc = atm_sk(s);
21741da177e4SLinus Torvalds 			if (vcc->dev != dev)
21751da177e4SLinus Torvalds 				continue;
21761da177e4SLinus Torvalds 			eni_vcc = ENI_VCC(vcc);
21771da177e4SLinus Torvalds 			if (--left) continue;
21781da177e4SLinus Torvalds 			length = sprintf(page,"vcc %4d: ",vcc->vci);
21791da177e4SLinus Torvalds 			if (eni_vcc->rx) {
21801da177e4SLinus Torvalds 				length += sprintf(page+length,"0x%ld-0x%ld "
21811da177e4SLinus Torvalds 				    "(%6ld bytes)",
21821da177e4SLinus Torvalds 				    (unsigned long) (eni_vcc->recv - eni_dev->ram),
21831da177e4SLinus Torvalds 				    eni_vcc->recv-eni_dev->ram+eni_vcc->words*4-1,
21841da177e4SLinus Torvalds 				    eni_vcc->words*4);
21851da177e4SLinus Torvalds 				if (eni_vcc->tx) length += sprintf(page+length,", ");
21861da177e4SLinus Torvalds 			}
21871da177e4SLinus Torvalds 			if (eni_vcc->tx)
21881da177e4SLinus Torvalds 				length += sprintf(page+length,"tx[%d], txing %d bytes",
21891da177e4SLinus Torvalds 				    eni_vcc->tx->index,eni_vcc->txing);
21901da177e4SLinus Torvalds 			page[length] = '\n';
21911da177e4SLinus Torvalds 			read_unlock(&vcc_sklist_lock);
21921da177e4SLinus Torvalds 			return length+1;
21931da177e4SLinus Torvalds 		}
21941da177e4SLinus Torvalds 	}
21951da177e4SLinus Torvalds 	read_unlock(&vcc_sklist_lock);
21961da177e4SLinus Torvalds 	for (i = 0; i < eni_dev->free_len; i++) {
21971da177e4SLinus Torvalds 		struct eni_free *fe = eni_dev->free_list+i;
21981da177e4SLinus Torvalds 		unsigned long offset;
21991da177e4SLinus Torvalds 
22001da177e4SLinus Torvalds 		if (--left) continue;
22011da177e4SLinus Torvalds 		offset = (unsigned long) eni_dev->ram+eni_dev->base_diff;
22021da177e4SLinus Torvalds 		return sprintf(page,"free      %p-%p (%6d bytes)\n",
22031da177e4SLinus Torvalds 		    fe->start-offset,fe->start-offset+(1 << fe->order)-1,
22041da177e4SLinus Torvalds 		    1 << fe->order);
22051da177e4SLinus Torvalds 	}
22061da177e4SLinus Torvalds 	return 0;
22071da177e4SLinus Torvalds }
22081da177e4SLinus Torvalds 
22091da177e4SLinus Torvalds 
22101da177e4SLinus Torvalds static const struct atmdev_ops ops = {
22111da177e4SLinus Torvalds 	.open		= eni_open,
22121da177e4SLinus Torvalds 	.close		= eni_close,
22131da177e4SLinus Torvalds 	.ioctl		= eni_ioctl,
22141da177e4SLinus Torvalds 	.getsockopt	= eni_getsockopt,
22151da177e4SLinus Torvalds 	.setsockopt	= eni_setsockopt,
22161da177e4SLinus Torvalds 	.send		= eni_send,
22171da177e4SLinus Torvalds 	.phy_put	= eni_phy_put,
22181da177e4SLinus Torvalds 	.phy_get	= eni_phy_get,
22191da177e4SLinus Torvalds 	.change_qos	= eni_change_qos,
22201da177e4SLinus Torvalds 	.proc_read	= eni_proc_read
22211da177e4SLinus Torvalds };
22221da177e4SLinus Torvalds 
22231da177e4SLinus Torvalds 
22241da177e4SLinus Torvalds static int __devinit eni_init_one(struct pci_dev *pci_dev,
22251da177e4SLinus Torvalds     const struct pci_device_id *ent)
22261da177e4SLinus Torvalds {
22271da177e4SLinus Torvalds 	struct atm_dev *dev;
22281da177e4SLinus Torvalds 	struct eni_dev *eni_dev;
22291da177e4SLinus Torvalds 	int error = -ENOMEM;
22301da177e4SLinus Torvalds 
22311da177e4SLinus Torvalds 	DPRINTK("eni_init_one\n");
22321da177e4SLinus Torvalds 
22331da177e4SLinus Torvalds 	if (pci_enable_device(pci_dev)) {
22341da177e4SLinus Torvalds 		error = -EIO;
22351da177e4SLinus Torvalds 		goto out0;
22361da177e4SLinus Torvalds 	}
22371da177e4SLinus Torvalds 
22385cbded58SRobert P. J. Day 	eni_dev = kmalloc(sizeof(struct eni_dev),GFP_KERNEL);
22391da177e4SLinus Torvalds 	if (!eni_dev) goto out0;
22401da177e4SLinus Torvalds 	if (!cpu_zeroes) {
22411da177e4SLinus Torvalds 		cpu_zeroes = pci_alloc_consistent(pci_dev,ENI_ZEROES_SIZE,
22421da177e4SLinus Torvalds 		    &zeroes);
22431da177e4SLinus Torvalds 		if (!cpu_zeroes) goto out1;
22441da177e4SLinus Torvalds 	}
22451da177e4SLinus Torvalds 	dev = atm_dev_register(DEV_LABEL,&ops,-1,NULL);
22461da177e4SLinus Torvalds 	if (!dev) goto out2;
22471da177e4SLinus Torvalds 	pci_set_drvdata(pci_dev, dev);
22481da177e4SLinus Torvalds 	eni_dev->pci_dev = pci_dev;
22491da177e4SLinus Torvalds 	dev->dev_data = eni_dev;
22501da177e4SLinus Torvalds 	eni_dev->asic = ent->driver_data;
22511da177e4SLinus Torvalds 	error = eni_do_init(dev);
22521da177e4SLinus Torvalds 	if (error) goto out3;
22531da177e4SLinus Torvalds 	error = eni_start(dev);
22541da177e4SLinus Torvalds 	if (error) goto out3;
22551da177e4SLinus Torvalds 	eni_dev->more = eni_boards;
22561da177e4SLinus Torvalds 	eni_boards = dev;
22571da177e4SLinus Torvalds 	return 0;
22581da177e4SLinus Torvalds out3:
22591da177e4SLinus Torvalds 	atm_dev_deregister(dev);
22601da177e4SLinus Torvalds out2:
22611da177e4SLinus Torvalds 	pci_free_consistent(eni_dev->pci_dev,ENI_ZEROES_SIZE,cpu_zeroes,zeroes);
22621da177e4SLinus Torvalds 	cpu_zeroes = NULL;
22631da177e4SLinus Torvalds out1:
22641da177e4SLinus Torvalds 	kfree(eni_dev);
22651da177e4SLinus Torvalds out0:
22661da177e4SLinus Torvalds 	return error;
22671da177e4SLinus Torvalds }
22681da177e4SLinus Torvalds 
22691da177e4SLinus Torvalds 
22701da177e4SLinus Torvalds static struct pci_device_id eni_pci_tbl[] = {
22711da177e4SLinus Torvalds 	{ PCI_VENDOR_ID_EF, PCI_DEVICE_ID_EF_ATM_FPGA, PCI_ANY_ID, PCI_ANY_ID,
22721da177e4SLinus Torvalds 	  0, 0, 0 /* FPGA */ },
22731da177e4SLinus Torvalds 	{ PCI_VENDOR_ID_EF, PCI_DEVICE_ID_EF_ATM_ASIC, PCI_ANY_ID, PCI_ANY_ID,
22741da177e4SLinus Torvalds 	  0, 0, 1 /* ASIC */ },
22751da177e4SLinus Torvalds 	{ 0, }
22761da177e4SLinus Torvalds };
22771da177e4SLinus Torvalds MODULE_DEVICE_TABLE(pci,eni_pci_tbl);
22781da177e4SLinus Torvalds 
22791da177e4SLinus Torvalds 
22801da177e4SLinus Torvalds static void __devexit eni_remove_one(struct pci_dev *pci_dev)
22811da177e4SLinus Torvalds {
22821da177e4SLinus Torvalds 	/* grrr */
22831da177e4SLinus Torvalds }
22841da177e4SLinus Torvalds 
22851da177e4SLinus Torvalds 
22861da177e4SLinus Torvalds static struct pci_driver eni_driver = {
22871da177e4SLinus Torvalds 	.name		= DEV_LABEL,
22881da177e4SLinus Torvalds 	.id_table	= eni_pci_tbl,
22891da177e4SLinus Torvalds 	.probe		= eni_init_one,
22901da177e4SLinus Torvalds 	.remove		= __devexit_p(eni_remove_one),
22911da177e4SLinus Torvalds };
22921da177e4SLinus Torvalds 
22931da177e4SLinus Torvalds 
22941da177e4SLinus Torvalds static int __init eni_init(void)
22951da177e4SLinus Torvalds {
22961da177e4SLinus Torvalds 	struct sk_buff *skb; /* dummy for sizeof */
22971da177e4SLinus Torvalds 
22981da177e4SLinus Torvalds 	if (sizeof(skb->cb) < sizeof(struct eni_skb_prv)) {
22991da177e4SLinus Torvalds 		printk(KERN_ERR "eni_detect: skb->cb is too small (%Zd < %Zd)\n",
23001da177e4SLinus Torvalds 		    sizeof(skb->cb),sizeof(struct eni_skb_prv));
23011da177e4SLinus Torvalds 		return -EIO;
23021da177e4SLinus Torvalds 	}
23031da177e4SLinus Torvalds 	return pci_register_driver(&eni_driver);
23041da177e4SLinus Torvalds }
23051da177e4SLinus Torvalds 
23061da177e4SLinus Torvalds 
23071da177e4SLinus Torvalds module_init(eni_init);
23081da177e4SLinus Torvalds /* @@@ since exit routine not defined, this module can not be unloaded */
23091da177e4SLinus Torvalds 
23101da177e4SLinus Torvalds MODULE_LICENSE("GPL");
2311