xref: /openbmc/linux/drivers/atm/fore200e.c (revision 47ce0b65)
11a59d1b8SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-or-later
21da177e4SLinus Torvalds /*
31da177e4SLinus Torvalds   A FORE Systems 200E-series driver for ATM on Linux.
41da177e4SLinus Torvalds   Christophe Lizzi (lizzi@cnam.fr), October 1999-March 2003.
51da177e4SLinus Torvalds 
61da177e4SLinus Torvalds   Based on the PCA-200E driver from Uwe Dannowski (Uwe.Dannowski@inf.tu-dresden.de).
71da177e4SLinus Torvalds 
81da177e4SLinus Torvalds   This driver simultaneously supports PCA-200E and SBA-200E adapters
91da177e4SLinus Torvalds   on i386, alpha (untested), powerpc, sparc and sparc64 architectures.
101da177e4SLinus Torvalds 
111da177e4SLinus Torvalds */
121da177e4SLinus Torvalds 
131da177e4SLinus Torvalds 
141da177e4SLinus Torvalds #include <linux/kernel.h>
151da177e4SLinus Torvalds #include <linux/slab.h>
161da177e4SLinus Torvalds #include <linux/init.h>
171da177e4SLinus Torvalds #include <linux/capability.h>
181da177e4SLinus Torvalds #include <linux/interrupt.h>
191da177e4SLinus Torvalds #include <linux/bitops.h>
201da177e4SLinus Torvalds #include <linux/pci.h>
211da177e4SLinus Torvalds #include <linux/module.h>
221da177e4SLinus Torvalds #include <linux/atmdev.h>
231da177e4SLinus Torvalds #include <linux/sonet.h>
241da177e4SLinus Torvalds #include <linux/dma-mapping.h>
251da177e4SLinus Torvalds #include <linux/delay.h>
26e92481f9SChas Williams #include <linux/firmware.h>
2765fddcfcSMike Rapoport #include <linux/pgtable.h>
281da177e4SLinus Torvalds #include <asm/io.h>
291da177e4SLinus Torvalds #include <asm/string.h>
301da177e4SLinus Torvalds #include <asm/page.h>
311da177e4SLinus Torvalds #include <asm/irq.h>
321da177e4SLinus Torvalds #include <asm/dma.h>
331da177e4SLinus Torvalds #include <asm/byteorder.h>
347c0f6ba6SLinus Torvalds #include <linux/uaccess.h>
3560063497SArun Sharma #include <linux/atomic.h>
361da177e4SLinus Torvalds 
37e92481f9SChas Williams #ifdef CONFIG_SBUS
38826b6cfcSDavid S. Miller #include <linux/of.h>
39826b6cfcSDavid S. Miller #include <linux/of_device.h>
401da177e4SLinus Torvalds #include <asm/idprom.h>
411da177e4SLinus Torvalds #include <asm/openprom.h>
421da177e4SLinus Torvalds #include <asm/oplib.h>
431da177e4SLinus Torvalds #endif
441da177e4SLinus Torvalds 
451da177e4SLinus Torvalds #if defined(CONFIG_ATM_FORE200E_USE_TASKLET) /* defer interrupt work to a tasklet */
461da177e4SLinus Torvalds #define FORE200E_USE_TASKLET
471da177e4SLinus Torvalds #endif
481da177e4SLinus Torvalds 
491da177e4SLinus Torvalds #if 0 /* enable the debugging code of the buffer supply queues */
501da177e4SLinus Torvalds #define FORE200E_BSQ_DEBUG
511da177e4SLinus Torvalds #endif
521da177e4SLinus Torvalds 
531da177e4SLinus Torvalds #if 1 /* ensure correct handling of 52-byte AAL0 SDUs expected by atmdump-like apps */
541da177e4SLinus Torvalds #define FORE200E_52BYTE_AAL0_SDU
551da177e4SLinus Torvalds #endif
561da177e4SLinus Torvalds 
571da177e4SLinus Torvalds #include "fore200e.h"
581da177e4SLinus Torvalds #include "suni.h"
591da177e4SLinus Torvalds 
601da177e4SLinus Torvalds #define FORE200E_VERSION "0.3e"
611da177e4SLinus Torvalds 
621da177e4SLinus Torvalds #define FORE200E         "fore200e: "
631da177e4SLinus Torvalds 
641da177e4SLinus Torvalds #if 0 /* override .config */
651da177e4SLinus Torvalds #define CONFIG_ATM_FORE200E_DEBUG 1
661da177e4SLinus Torvalds #endif
671da177e4SLinus Torvalds #if defined(CONFIG_ATM_FORE200E_DEBUG) && (CONFIG_ATM_FORE200E_DEBUG > 0)
681da177e4SLinus Torvalds #define DPRINTK(level, format, args...)  do { if (CONFIG_ATM_FORE200E_DEBUG >= (level)) \
691da177e4SLinus Torvalds                                                   printk(FORE200E format, ##args); } while (0)
701da177e4SLinus Torvalds #else
711da177e4SLinus Torvalds #define DPRINTK(level, format, args...)  do {} while (0)
721da177e4SLinus Torvalds #endif
731da177e4SLinus Torvalds 
741da177e4SLinus Torvalds 
751da177e4SLinus Torvalds #define FORE200E_ALIGN(addr, alignment) \
761da177e4SLinus Torvalds         ((((unsigned long)(addr) + (alignment - 1)) & ~(alignment - 1)) - (unsigned long)(addr))
771da177e4SLinus Torvalds 
781da177e4SLinus Torvalds #define FORE200E_DMA_INDEX(dma_addr, type, index)  ((dma_addr) + (index) * sizeof(type))
791da177e4SLinus Torvalds 
801da177e4SLinus Torvalds #define FORE200E_INDEX(virt_addr, type, index)     (&((type *)(virt_addr))[ index ])
811da177e4SLinus Torvalds 
8230dfe2c0SDavid S. Miller #define FORE200E_NEXT_ENTRY(index, modulo)         (index = ((index) + 1) % (modulo))
831da177e4SLinus Torvalds 
841da177e4SLinus Torvalds #if 1
851da177e4SLinus Torvalds #define ASSERT(expr)     if (!(expr)) { \
861da177e4SLinus Torvalds 			     printk(FORE200E "assertion failed! %s[%d]: %s\n", \
875a346a10SHarvey Harrison 				    __func__, __LINE__, #expr); \
885a346a10SHarvey Harrison 			     panic(FORE200E "%s", __func__); \
891da177e4SLinus Torvalds 			 }
901da177e4SLinus Torvalds #else
911da177e4SLinus Torvalds #define ASSERT(expr)     do {} while (0)
921da177e4SLinus Torvalds #endif
931da177e4SLinus Torvalds 
941da177e4SLinus Torvalds 
951da177e4SLinus Torvalds static const struct atmdev_ops   fore200e_ops;
961da177e4SLinus Torvalds 
971da177e4SLinus Torvalds static LIST_HEAD(fore200e_boards);
981da177e4SLinus Torvalds 
991da177e4SLinus Torvalds 
1001da177e4SLinus Torvalds MODULE_AUTHOR("Christophe Lizzi - credits to Uwe Dannowski and Heikki Vatiainen");
1011da177e4SLinus Torvalds MODULE_DESCRIPTION("FORE Systems 200E-series ATM driver - version " FORE200E_VERSION);
1021da177e4SLinus Torvalds 
1031da177e4SLinus Torvalds static const int fore200e_rx_buf_nbr[ BUFFER_SCHEME_NBR ][ BUFFER_MAGN_NBR ] = {
1041da177e4SLinus Torvalds     { BUFFER_S1_NBR, BUFFER_L1_NBR },
1051da177e4SLinus Torvalds     { BUFFER_S2_NBR, BUFFER_L2_NBR }
1061da177e4SLinus Torvalds };
1071da177e4SLinus Torvalds 
1081da177e4SLinus Torvalds static const int fore200e_rx_buf_size[ BUFFER_SCHEME_NBR ][ BUFFER_MAGN_NBR ] = {
1091da177e4SLinus Torvalds     { BUFFER_S1_SIZE, BUFFER_L1_SIZE },
1101da177e4SLinus Torvalds     { BUFFER_S2_SIZE, BUFFER_L2_SIZE }
1111da177e4SLinus Torvalds };
1121da177e4SLinus Torvalds 
1131da177e4SLinus Torvalds 
1141da177e4SLinus Torvalds #if defined(CONFIG_ATM_FORE200E_DEBUG) && (CONFIG_ATM_FORE200E_DEBUG > 0)
1151da177e4SLinus Torvalds static const char* fore200e_traffic_class[] = { "NONE", "UBR", "CBR", "VBR", "ABR", "ANY" };
1161da177e4SLinus Torvalds #endif
1171da177e4SLinus Torvalds 
1181da177e4SLinus Torvalds 
1191da177e4SLinus Torvalds #if 0 /* currently unused */
1201da177e4SLinus Torvalds static int
1211da177e4SLinus Torvalds fore200e_fore2atm_aal(enum fore200e_aal aal)
1221da177e4SLinus Torvalds {
1231da177e4SLinus Torvalds     switch(aal) {
1241da177e4SLinus Torvalds     case FORE200E_AAL0:  return ATM_AAL0;
1251da177e4SLinus Torvalds     case FORE200E_AAL34: return ATM_AAL34;
1261da177e4SLinus Torvalds     case FORE200E_AAL5:  return ATM_AAL5;
1271da177e4SLinus Torvalds     }
1281da177e4SLinus Torvalds 
1291da177e4SLinus Torvalds     return -EINVAL;
1301da177e4SLinus Torvalds }
1311da177e4SLinus Torvalds #endif
1321da177e4SLinus Torvalds 
1331da177e4SLinus Torvalds 
1341da177e4SLinus Torvalds static enum fore200e_aal
fore200e_atm2fore_aal(int aal)1351da177e4SLinus Torvalds fore200e_atm2fore_aal(int aal)
1361da177e4SLinus Torvalds {
1371da177e4SLinus Torvalds     switch(aal) {
1381da177e4SLinus Torvalds     case ATM_AAL0:  return FORE200E_AAL0;
1391da177e4SLinus Torvalds     case ATM_AAL34: return FORE200E_AAL34;
1401da177e4SLinus Torvalds     case ATM_AAL1:
1411da177e4SLinus Torvalds     case ATM_AAL2:
1421da177e4SLinus Torvalds     case ATM_AAL5:  return FORE200E_AAL5;
1431da177e4SLinus Torvalds     }
1441da177e4SLinus Torvalds 
1451da177e4SLinus Torvalds     return -EINVAL;
1461da177e4SLinus Torvalds }
1471da177e4SLinus Torvalds 
1481da177e4SLinus Torvalds 
1491da177e4SLinus Torvalds static char*
fore200e_irq_itoa(int irq)1501da177e4SLinus Torvalds fore200e_irq_itoa(int irq)
1511da177e4SLinus Torvalds {
1521da177e4SLinus Torvalds     static char str[8];
1531da177e4SLinus Torvalds     sprintf(str, "%d", irq);
1541da177e4SLinus Torvalds     return str;
1551da177e4SLinus Torvalds }
1561da177e4SLinus Torvalds 
1571da177e4SLinus Torvalds 
1581da177e4SLinus Torvalds /* allocate and align a chunk of memory intended to hold the data behing exchanged
1591da177e4SLinus Torvalds    between the driver and the adapter (using streaming DVMA) */
1601da177e4SLinus Torvalds 
1611da177e4SLinus Torvalds static int
fore200e_chunk_alloc(struct fore200e * fore200e,struct chunk * chunk,int size,int alignment,int direction)1621da177e4SLinus Torvalds fore200e_chunk_alloc(struct fore200e* fore200e, struct chunk* chunk, int size, int alignment, int direction)
1631da177e4SLinus Torvalds {
1641da177e4SLinus Torvalds     unsigned long offset = 0;
1651da177e4SLinus Torvalds 
1661da177e4SLinus Torvalds     if (alignment <= sizeof(int))
1671da177e4SLinus Torvalds 	alignment = 0;
1681da177e4SLinus Torvalds 
1691da177e4SLinus Torvalds     chunk->alloc_size = size + alignment;
1701da177e4SLinus Torvalds     chunk->direction  = direction;
1711da177e4SLinus Torvalds 
1720e21b225SChristoph Hellwig     chunk->alloc_addr = kzalloc(chunk->alloc_size, GFP_KERNEL);
1731da177e4SLinus Torvalds     if (chunk->alloc_addr == NULL)
1741da177e4SLinus Torvalds 	return -ENOMEM;
1751da177e4SLinus Torvalds 
1761da177e4SLinus Torvalds     if (alignment > 0)
1771da177e4SLinus Torvalds 	offset = FORE200E_ALIGN(chunk->alloc_addr, alignment);
1781da177e4SLinus Torvalds 
1791da177e4SLinus Torvalds     chunk->align_addr = chunk->alloc_addr + offset;
1801da177e4SLinus Torvalds 
181f3fadcb5SChristoph Hellwig     chunk->dma_addr = dma_map_single(fore200e->dev, chunk->align_addr,
182f3fadcb5SChristoph Hellwig 				     size, direction);
1831d9d8be9SChristoph Hellwig     if (dma_mapping_error(fore200e->dev, chunk->dma_addr)) {
1841d9d8be9SChristoph Hellwig 	kfree(chunk->alloc_addr);
1851d9d8be9SChristoph Hellwig 	return -ENOMEM;
1861d9d8be9SChristoph Hellwig     }
1871da177e4SLinus Torvalds     return 0;
1881da177e4SLinus Torvalds }
1891da177e4SLinus Torvalds 
1901da177e4SLinus Torvalds 
1911da177e4SLinus Torvalds /* free a chunk of memory */
1921da177e4SLinus Torvalds 
1931da177e4SLinus Torvalds static void
fore200e_chunk_free(struct fore200e * fore200e,struct chunk * chunk)1941da177e4SLinus Torvalds fore200e_chunk_free(struct fore200e* fore200e, struct chunk* chunk)
1951da177e4SLinus Torvalds {
196f3fadcb5SChristoph Hellwig     dma_unmap_single(fore200e->dev, chunk->dma_addr, chunk->dma_size,
197f3fadcb5SChristoph Hellwig 		     chunk->direction);
1981f8a5fb8SAdrian Bunk     kfree(chunk->alloc_addr);
1991da177e4SLinus Torvalds }
2001da177e4SLinus Torvalds 
2011335d6fdSChristoph Hellwig /*
2021335d6fdSChristoph Hellwig  * Allocate a DMA consistent chunk of memory intended to act as a communication
2031335d6fdSChristoph Hellwig  * mechanism (to hold descriptors, status, queues, etc.) shared by the driver
2041335d6fdSChristoph Hellwig  * and the adapter.
2051335d6fdSChristoph Hellwig  */
2061335d6fdSChristoph Hellwig static int
fore200e_dma_chunk_alloc(struct fore200e * fore200e,struct chunk * chunk,int size,int nbr,int alignment)2071335d6fdSChristoph Hellwig fore200e_dma_chunk_alloc(struct fore200e *fore200e, struct chunk *chunk,
2081335d6fdSChristoph Hellwig 		int size, int nbr, int alignment)
2091335d6fdSChristoph Hellwig {
2101335d6fdSChristoph Hellwig 	/* returned chunks are page-aligned */
2111335d6fdSChristoph Hellwig 	chunk->alloc_size = size * nbr;
2121335d6fdSChristoph Hellwig 	chunk->alloc_addr = dma_alloc_coherent(fore200e->dev, chunk->alloc_size,
2131335d6fdSChristoph Hellwig 					       &chunk->dma_addr, GFP_KERNEL);
2141335d6fdSChristoph Hellwig 	if (!chunk->alloc_addr)
2151335d6fdSChristoph Hellwig 		return -ENOMEM;
2161335d6fdSChristoph Hellwig 	chunk->align_addr = chunk->alloc_addr;
2171335d6fdSChristoph Hellwig 	return 0;
2181335d6fdSChristoph Hellwig }
2191335d6fdSChristoph Hellwig 
2201335d6fdSChristoph Hellwig /*
2211335d6fdSChristoph Hellwig  * Free a DMA consistent chunk of memory.
2221335d6fdSChristoph Hellwig  */
2231335d6fdSChristoph Hellwig static void
fore200e_dma_chunk_free(struct fore200e * fore200e,struct chunk * chunk)2241335d6fdSChristoph Hellwig fore200e_dma_chunk_free(struct fore200e* fore200e, struct chunk* chunk)
2251335d6fdSChristoph Hellwig {
2261335d6fdSChristoph Hellwig 	dma_free_coherent(fore200e->dev, chunk->alloc_size, chunk->alloc_addr,
2271335d6fdSChristoph Hellwig 			  chunk->dma_addr);
2281335d6fdSChristoph Hellwig }
2291da177e4SLinus Torvalds 
2301da177e4SLinus Torvalds static void
fore200e_spin(int msecs)2311da177e4SLinus Torvalds fore200e_spin(int msecs)
2321da177e4SLinus Torvalds {
2331da177e4SLinus Torvalds     unsigned long timeout = jiffies + msecs_to_jiffies(msecs);
2341da177e4SLinus Torvalds     while (time_before(jiffies, timeout));
2351da177e4SLinus Torvalds }
2361da177e4SLinus Torvalds 
2371da177e4SLinus Torvalds 
2381da177e4SLinus Torvalds static int
fore200e_poll(struct fore200e * fore200e,volatile u32 * addr,u32 val,int msecs)2391da177e4SLinus Torvalds fore200e_poll(struct fore200e* fore200e, volatile u32* addr, u32 val, int msecs)
2401da177e4SLinus Torvalds {
2411da177e4SLinus Torvalds     unsigned long timeout = jiffies + msecs_to_jiffies(msecs);
2421da177e4SLinus Torvalds     int           ok;
2431da177e4SLinus Torvalds 
2441da177e4SLinus Torvalds     mb();
2451da177e4SLinus Torvalds     do {
2461da177e4SLinus Torvalds 	if ((ok = (*addr == val)) || (*addr & STATUS_ERROR))
2471da177e4SLinus Torvalds 	    break;
2481da177e4SLinus Torvalds 
2491da177e4SLinus Torvalds     } while (time_before(jiffies, timeout));
2501da177e4SLinus Torvalds 
2511da177e4SLinus Torvalds #if 1
2521da177e4SLinus Torvalds     if (!ok) {
2531da177e4SLinus Torvalds 	printk(FORE200E "cmd polling failed, got status 0x%08x, expected 0x%08x\n",
2541da177e4SLinus Torvalds 	       *addr, val);
2551da177e4SLinus Torvalds     }
2561da177e4SLinus Torvalds #endif
2571da177e4SLinus Torvalds 
2581da177e4SLinus Torvalds     return ok;
2591da177e4SLinus Torvalds }
2601da177e4SLinus Torvalds 
2611da177e4SLinus Torvalds 
2621da177e4SLinus Torvalds static int
fore200e_io_poll(struct fore200e * fore200e,volatile u32 __iomem * addr,u32 val,int msecs)2631da177e4SLinus Torvalds fore200e_io_poll(struct fore200e* fore200e, volatile u32 __iomem *addr, u32 val, int msecs)
2641da177e4SLinus Torvalds {
2651da177e4SLinus Torvalds     unsigned long timeout = jiffies + msecs_to_jiffies(msecs);
2661da177e4SLinus Torvalds     int           ok;
2671da177e4SLinus Torvalds 
2681da177e4SLinus Torvalds     do {
2691da177e4SLinus Torvalds 	if ((ok = (fore200e->bus->read(addr) == val)))
2701da177e4SLinus Torvalds 	    break;
2711da177e4SLinus Torvalds 
2721da177e4SLinus Torvalds     } while (time_before(jiffies, timeout));
2731da177e4SLinus Torvalds 
2741da177e4SLinus Torvalds #if 1
2751da177e4SLinus Torvalds     if (!ok) {
2761da177e4SLinus Torvalds 	printk(FORE200E "I/O polling failed, got status 0x%08x, expected 0x%08x\n",
2771da177e4SLinus Torvalds 	       fore200e->bus->read(addr), val);
2781da177e4SLinus Torvalds     }
2791da177e4SLinus Torvalds #endif
2801da177e4SLinus Torvalds 
2811da177e4SLinus Torvalds     return ok;
2821da177e4SLinus Torvalds }
2831da177e4SLinus Torvalds 
2841da177e4SLinus Torvalds 
2851da177e4SLinus Torvalds static void
fore200e_free_rx_buf(struct fore200e * fore200e)2861da177e4SLinus Torvalds fore200e_free_rx_buf(struct fore200e* fore200e)
2871da177e4SLinus Torvalds {
2881da177e4SLinus Torvalds     int scheme, magn, nbr;
2891da177e4SLinus Torvalds     struct buffer* buffer;
2901da177e4SLinus Torvalds 
2911da177e4SLinus Torvalds     for (scheme = 0; scheme < BUFFER_SCHEME_NBR; scheme++) {
2921da177e4SLinus Torvalds 	for (magn = 0; magn < BUFFER_MAGN_NBR; magn++) {
2931da177e4SLinus Torvalds 
2941da177e4SLinus Torvalds 	    if ((buffer = fore200e->host_bsq[ scheme ][ magn ].buffer) != NULL) {
2951da177e4SLinus Torvalds 
2961da177e4SLinus Torvalds 		for (nbr = 0; nbr < fore200e_rx_buf_nbr[ scheme ][ magn ]; nbr++) {
2971da177e4SLinus Torvalds 
2981da177e4SLinus Torvalds 		    struct chunk* data = &buffer[ nbr ].data;
2991da177e4SLinus Torvalds 
3001da177e4SLinus Torvalds 		    if (data->alloc_addr != NULL)
3011da177e4SLinus Torvalds 			fore200e_chunk_free(fore200e, data);
3021da177e4SLinus Torvalds 		}
3031da177e4SLinus Torvalds 	    }
3041da177e4SLinus Torvalds 	}
3051da177e4SLinus Torvalds     }
3061da177e4SLinus Torvalds }
3071da177e4SLinus Torvalds 
3081da177e4SLinus Torvalds 
3091da177e4SLinus Torvalds static void
fore200e_uninit_bs_queue(struct fore200e * fore200e)3101da177e4SLinus Torvalds fore200e_uninit_bs_queue(struct fore200e* fore200e)
3111da177e4SLinus Torvalds {
3121da177e4SLinus Torvalds     int scheme, magn;
3131da177e4SLinus Torvalds 
3141da177e4SLinus Torvalds     for (scheme = 0; scheme < BUFFER_SCHEME_NBR; scheme++) {
3151da177e4SLinus Torvalds 	for (magn = 0; magn < BUFFER_MAGN_NBR; magn++) {
3161da177e4SLinus Torvalds 
3171da177e4SLinus Torvalds 	    struct chunk* status    = &fore200e->host_bsq[ scheme ][ magn ].status;
3181da177e4SLinus Torvalds 	    struct chunk* rbd_block = &fore200e->host_bsq[ scheme ][ magn ].rbd_block;
3191da177e4SLinus Torvalds 
3201da177e4SLinus Torvalds 	    if (status->alloc_addr)
3211335d6fdSChristoph Hellwig 		fore200e_dma_chunk_free(fore200e, status);
3221da177e4SLinus Torvalds 
3231da177e4SLinus Torvalds 	    if (rbd_block->alloc_addr)
3241335d6fdSChristoph Hellwig 		fore200e_dma_chunk_free(fore200e, rbd_block);
3251da177e4SLinus Torvalds 	}
3261da177e4SLinus Torvalds     }
3271da177e4SLinus Torvalds }
3281da177e4SLinus Torvalds 
3291da177e4SLinus Torvalds 
3301da177e4SLinus Torvalds static int
fore200e_reset(struct fore200e * fore200e,int diag)3311da177e4SLinus Torvalds fore200e_reset(struct fore200e* fore200e, int diag)
3321da177e4SLinus Torvalds {
3331da177e4SLinus Torvalds     int ok;
3341da177e4SLinus Torvalds 
3351da177e4SLinus Torvalds     fore200e->cp_monitor = fore200e->virt_base + FORE200E_CP_MONITOR_OFFSET;
3361da177e4SLinus Torvalds 
3371da177e4SLinus Torvalds     fore200e->bus->write(BSTAT_COLD_START, &fore200e->cp_monitor->bstat);
3381da177e4SLinus Torvalds 
3391da177e4SLinus Torvalds     fore200e->bus->reset(fore200e);
3401da177e4SLinus Torvalds 
3411da177e4SLinus Torvalds     if (diag) {
3421da177e4SLinus Torvalds 	ok = fore200e_io_poll(fore200e, &fore200e->cp_monitor->bstat, BSTAT_SELFTEST_OK, 1000);
3431da177e4SLinus Torvalds 	if (ok == 0) {
3441da177e4SLinus Torvalds 
3451da177e4SLinus Torvalds 	    printk(FORE200E "device %s self-test failed\n", fore200e->name);
3461da177e4SLinus Torvalds 	    return -ENODEV;
3471da177e4SLinus Torvalds 	}
3481da177e4SLinus Torvalds 
3491da177e4SLinus Torvalds 	printk(FORE200E "device %s self-test passed\n", fore200e->name);
3501da177e4SLinus Torvalds 
3511da177e4SLinus Torvalds 	fore200e->state = FORE200E_STATE_RESET;
3521da177e4SLinus Torvalds     }
3531da177e4SLinus Torvalds 
3541da177e4SLinus Torvalds     return 0;
3551da177e4SLinus Torvalds }
3561da177e4SLinus Torvalds 
3571da177e4SLinus Torvalds 
3581da177e4SLinus Torvalds static void
fore200e_shutdown(struct fore200e * fore200e)3591da177e4SLinus Torvalds fore200e_shutdown(struct fore200e* fore200e)
3601da177e4SLinus Torvalds {
3611da177e4SLinus Torvalds     printk(FORE200E "removing device %s at 0x%lx, IRQ %s\n",
3621da177e4SLinus Torvalds 	   fore200e->name, fore200e->phys_base,
3631da177e4SLinus Torvalds 	   fore200e_irq_itoa(fore200e->irq));
3641da177e4SLinus Torvalds 
3651da177e4SLinus Torvalds     if (fore200e->state > FORE200E_STATE_RESET) {
3661da177e4SLinus Torvalds 	/* first, reset the board to prevent further interrupts or data transfers */
3671da177e4SLinus Torvalds 	fore200e_reset(fore200e, 0);
3681da177e4SLinus Torvalds     }
3691da177e4SLinus Torvalds 
3701da177e4SLinus Torvalds     /* then, release all allocated resources */
3711da177e4SLinus Torvalds     switch(fore200e->state) {
3721da177e4SLinus Torvalds 
3731da177e4SLinus Torvalds     case FORE200E_STATE_COMPLETE:
3741da177e4SLinus Torvalds 	kfree(fore200e->stats);
3751da177e4SLinus Torvalds 
376df561f66SGustavo A. R. Silva 	fallthrough;
3771da177e4SLinus Torvalds     case FORE200E_STATE_IRQ:
3781da177e4SLinus Torvalds 	free_irq(fore200e->irq, fore200e->atm_dev);
3791da177e4SLinus Torvalds 
380df561f66SGustavo A. R. Silva 	fallthrough;
3811da177e4SLinus Torvalds     case FORE200E_STATE_ALLOC_BUF:
3821da177e4SLinus Torvalds 	fore200e_free_rx_buf(fore200e);
3831da177e4SLinus Torvalds 
384df561f66SGustavo A. R. Silva 	fallthrough;
3851da177e4SLinus Torvalds     case FORE200E_STATE_INIT_BSQ:
3861da177e4SLinus Torvalds 	fore200e_uninit_bs_queue(fore200e);
3871da177e4SLinus Torvalds 
388df561f66SGustavo A. R. Silva 	fallthrough;
3891da177e4SLinus Torvalds     case FORE200E_STATE_INIT_RXQ:
3901335d6fdSChristoph Hellwig 	fore200e_dma_chunk_free(fore200e, &fore200e->host_rxq.status);
3911335d6fdSChristoph Hellwig 	fore200e_dma_chunk_free(fore200e, &fore200e->host_rxq.rpd);
3921da177e4SLinus Torvalds 
393df561f66SGustavo A. R. Silva 	fallthrough;
3941da177e4SLinus Torvalds     case FORE200E_STATE_INIT_TXQ:
3951335d6fdSChristoph Hellwig 	fore200e_dma_chunk_free(fore200e, &fore200e->host_txq.status);
3961335d6fdSChristoph Hellwig 	fore200e_dma_chunk_free(fore200e, &fore200e->host_txq.tpd);
3971da177e4SLinus Torvalds 
398df561f66SGustavo A. R. Silva 	fallthrough;
3991da177e4SLinus Torvalds     case FORE200E_STATE_INIT_CMDQ:
4001335d6fdSChristoph Hellwig 	fore200e_dma_chunk_free(fore200e, &fore200e->host_cmdq.status);
4011da177e4SLinus Torvalds 
402df561f66SGustavo A. R. Silva 	fallthrough;
4031da177e4SLinus Torvalds     case FORE200E_STATE_INITIALIZE:
4041da177e4SLinus Torvalds 	/* nothing to do for that state */
4051da177e4SLinus Torvalds 
4061da177e4SLinus Torvalds     case FORE200E_STATE_START_FW:
4071da177e4SLinus Torvalds 	/* nothing to do for that state */
4081da177e4SLinus Torvalds 
4091da177e4SLinus Torvalds     case FORE200E_STATE_RESET:
4101da177e4SLinus Torvalds 	/* nothing to do for that state */
4111da177e4SLinus Torvalds 
4121da177e4SLinus Torvalds     case FORE200E_STATE_MAP:
4131da177e4SLinus Torvalds 	fore200e->bus->unmap(fore200e);
4141da177e4SLinus Torvalds 
415df561f66SGustavo A. R. Silva 	fallthrough;
4161da177e4SLinus Torvalds     case FORE200E_STATE_CONFIGURE:
4171da177e4SLinus Torvalds 	/* nothing to do for that state */
4181da177e4SLinus Torvalds 
4191da177e4SLinus Torvalds     case FORE200E_STATE_REGISTER:
4201da177e4SLinus Torvalds 	/* XXX shouldn't we *start* by deregistering the device? */
4211da177e4SLinus Torvalds 	atm_dev_deregister(fore200e->atm_dev);
4221da177e4SLinus Torvalds 
423*47ce0b65SGustavo A. R. Silva 	fallthrough;
4241da177e4SLinus Torvalds     case FORE200E_STATE_BLANK:
4251da177e4SLinus Torvalds 	/* nothing to do for that state */
4261da177e4SLinus Torvalds 	break;
4271da177e4SLinus Torvalds     }
4281da177e4SLinus Torvalds }
4291da177e4SLinus Torvalds 
4301da177e4SLinus Torvalds 
431e92481f9SChas Williams #ifdef CONFIG_PCI
4321da177e4SLinus Torvalds 
fore200e_pca_read(volatile u32 __iomem * addr)4331da177e4SLinus Torvalds static u32 fore200e_pca_read(volatile u32 __iomem *addr)
4341da177e4SLinus Torvalds {
4351da177e4SLinus Torvalds     /* on big-endian hosts, the board is configured to convert
4361da177e4SLinus Torvalds        the endianess of slave RAM accesses  */
4371da177e4SLinus Torvalds     return le32_to_cpu(readl(addr));
4381da177e4SLinus Torvalds }
4391da177e4SLinus Torvalds 
4401da177e4SLinus Torvalds 
fore200e_pca_write(u32 val,volatile u32 __iomem * addr)4411da177e4SLinus Torvalds static void fore200e_pca_write(u32 val, volatile u32 __iomem *addr)
4421da177e4SLinus Torvalds {
4431da177e4SLinus Torvalds     /* on big-endian hosts, the board is configured to convert
4441da177e4SLinus Torvalds        the endianess of slave RAM accesses  */
4451da177e4SLinus Torvalds     writel(cpu_to_le32(val), addr);
4461da177e4SLinus Torvalds }
4471da177e4SLinus Torvalds 
4481da177e4SLinus Torvalds static int
fore200e_pca_irq_check(struct fore200e * fore200e)4491da177e4SLinus Torvalds fore200e_pca_irq_check(struct fore200e* fore200e)
4501da177e4SLinus Torvalds {
4511da177e4SLinus Torvalds     /* this is a 1 bit register */
4521da177e4SLinus Torvalds     int irq_posted = readl(fore200e->regs.pca.psr);
4531da177e4SLinus Torvalds 
4541da177e4SLinus Torvalds #if defined(CONFIG_ATM_FORE200E_DEBUG) && (CONFIG_ATM_FORE200E_DEBUG == 2)
4551da177e4SLinus Torvalds     if (irq_posted && (readl(fore200e->regs.pca.hcr) & PCA200E_HCR_OUTFULL)) {
4561da177e4SLinus Torvalds 	DPRINTK(2,"FIFO OUT full, device %d\n", fore200e->atm_dev->number);
4571da177e4SLinus Torvalds     }
4581da177e4SLinus Torvalds #endif
4591da177e4SLinus Torvalds 
4601da177e4SLinus Torvalds     return irq_posted;
4611da177e4SLinus Torvalds }
4621da177e4SLinus Torvalds 
4631da177e4SLinus Torvalds 
4641da177e4SLinus Torvalds static void
fore200e_pca_irq_ack(struct fore200e * fore200e)4651da177e4SLinus Torvalds fore200e_pca_irq_ack(struct fore200e* fore200e)
4661da177e4SLinus Torvalds {
4671da177e4SLinus Torvalds     writel(PCA200E_HCR_CLRINTR, fore200e->regs.pca.hcr);
4681da177e4SLinus Torvalds }
4691da177e4SLinus Torvalds 
4701da177e4SLinus Torvalds 
4711da177e4SLinus Torvalds static void
fore200e_pca_reset(struct fore200e * fore200e)4721da177e4SLinus Torvalds fore200e_pca_reset(struct fore200e* fore200e)
4731da177e4SLinus Torvalds {
4741da177e4SLinus Torvalds     writel(PCA200E_HCR_RESET, fore200e->regs.pca.hcr);
4751da177e4SLinus Torvalds     fore200e_spin(10);
4761da177e4SLinus Torvalds     writel(0, fore200e->regs.pca.hcr);
4771da177e4SLinus Torvalds }
4781da177e4SLinus Torvalds 
4791da177e4SLinus Torvalds 
fore200e_pca_map(struct fore200e * fore200e)4806c44512dSGreg Kroah-Hartman static int fore200e_pca_map(struct fore200e* fore200e)
4811da177e4SLinus Torvalds {
4821da177e4SLinus Torvalds     DPRINTK(2, "device %s being mapped in memory\n", fore200e->name);
4831da177e4SLinus Torvalds 
4841da177e4SLinus Torvalds     fore200e->virt_base = ioremap(fore200e->phys_base, PCA200E_IOSPACE_LENGTH);
4851da177e4SLinus Torvalds 
4861da177e4SLinus Torvalds     if (fore200e->virt_base == NULL) {
4871da177e4SLinus Torvalds 	printk(FORE200E "can't map device %s\n", fore200e->name);
4881da177e4SLinus Torvalds 	return -EFAULT;
4891da177e4SLinus Torvalds     }
4901da177e4SLinus Torvalds 
4911da177e4SLinus Torvalds     DPRINTK(1, "device %s mapped to 0x%p\n", fore200e->name, fore200e->virt_base);
4921da177e4SLinus Torvalds 
4931da177e4SLinus Torvalds     /* gain access to the PCA specific registers  */
4941da177e4SLinus Torvalds     fore200e->regs.pca.hcr = fore200e->virt_base + PCA200E_HCR_OFFSET;
4951da177e4SLinus Torvalds     fore200e->regs.pca.imr = fore200e->virt_base + PCA200E_IMR_OFFSET;
4961da177e4SLinus Torvalds     fore200e->regs.pca.psr = fore200e->virt_base + PCA200E_PSR_OFFSET;
4971da177e4SLinus Torvalds 
4981da177e4SLinus Torvalds     fore200e->state = FORE200E_STATE_MAP;
4991da177e4SLinus Torvalds     return 0;
5001da177e4SLinus Torvalds }
5011da177e4SLinus Torvalds 
5021da177e4SLinus Torvalds 
5031da177e4SLinus Torvalds static void
fore200e_pca_unmap(struct fore200e * fore200e)5041da177e4SLinus Torvalds fore200e_pca_unmap(struct fore200e* fore200e)
5051da177e4SLinus Torvalds {
5061da177e4SLinus Torvalds     DPRINTK(2, "device %s being unmapped from memory\n", fore200e->name);
5071da177e4SLinus Torvalds 
5081da177e4SLinus Torvalds     if (fore200e->virt_base != NULL)
5091da177e4SLinus Torvalds 	iounmap(fore200e->virt_base);
5101da177e4SLinus Torvalds }
5111da177e4SLinus Torvalds 
5121da177e4SLinus Torvalds 
fore200e_pca_configure(struct fore200e * fore200e)5136c44512dSGreg Kroah-Hartman static int fore200e_pca_configure(struct fore200e *fore200e)
5141da177e4SLinus Torvalds {
515aff9d262SChristoph Hellwig     struct pci_dev *pci_dev = to_pci_dev(fore200e->dev);
5161da177e4SLinus Torvalds     u8              master_ctrl, latency;
5171da177e4SLinus Torvalds 
5181da177e4SLinus Torvalds     DPRINTK(2, "device %s being configured\n", fore200e->name);
5191da177e4SLinus Torvalds 
5201da177e4SLinus Torvalds     if ((pci_dev->irq == 0) || (pci_dev->irq == 0xFF)) {
5211da177e4SLinus Torvalds 	printk(FORE200E "incorrect IRQ setting - misconfigured PCI-PCI bridge?\n");
5221da177e4SLinus Torvalds 	return -EIO;
5231da177e4SLinus Torvalds     }
5241da177e4SLinus Torvalds 
5251da177e4SLinus Torvalds     pci_read_config_byte(pci_dev, PCA200E_PCI_MASTER_CTRL, &master_ctrl);
5261da177e4SLinus Torvalds 
5271da177e4SLinus Torvalds     master_ctrl = master_ctrl
5281da177e4SLinus Torvalds #if defined(__BIG_ENDIAN)
5291da177e4SLinus Torvalds 	/* request the PCA board to convert the endianess of slave RAM accesses */
5301da177e4SLinus Torvalds 	| PCA200E_CTRL_CONVERT_ENDIAN
5311da177e4SLinus Torvalds #endif
5321da177e4SLinus Torvalds #if 0
5331da177e4SLinus Torvalds         | PCA200E_CTRL_DIS_CACHE_RD
5341da177e4SLinus Torvalds         | PCA200E_CTRL_DIS_WRT_INVAL
5351da177e4SLinus Torvalds         | PCA200E_CTRL_ENA_CONT_REQ_MODE
5361da177e4SLinus Torvalds         | PCA200E_CTRL_2_CACHE_WRT_INVAL
5371da177e4SLinus Torvalds #endif
5381da177e4SLinus Torvalds 	| PCA200E_CTRL_LARGE_PCI_BURSTS;
5391da177e4SLinus Torvalds 
5401da177e4SLinus Torvalds     pci_write_config_byte(pci_dev, PCA200E_PCI_MASTER_CTRL, master_ctrl);
5411da177e4SLinus Torvalds 
5421da177e4SLinus Torvalds     /* raise latency from 32 (default) to 192, as this seems to prevent NIC
5431da177e4SLinus Torvalds        lockups (under heavy rx loads) due to continuous 'FIFO OUT full' condition.
5441da177e4SLinus Torvalds        this may impact the performances of other PCI devices on the same bus, though */
5451da177e4SLinus Torvalds     latency = 192;
5461da177e4SLinus Torvalds     pci_write_config_byte(pci_dev, PCI_LATENCY_TIMER, latency);
5471da177e4SLinus Torvalds 
5481da177e4SLinus Torvalds     fore200e->state = FORE200E_STATE_CONFIGURE;
5491da177e4SLinus Torvalds     return 0;
5501da177e4SLinus Torvalds }
5511da177e4SLinus Torvalds 
5521da177e4SLinus Torvalds 
5531da177e4SLinus Torvalds static int __init
fore200e_pca_prom_read(struct fore200e * fore200e,struct prom_data * prom)5541da177e4SLinus Torvalds fore200e_pca_prom_read(struct fore200e* fore200e, struct prom_data* prom)
5551da177e4SLinus Torvalds {
5561da177e4SLinus Torvalds     struct host_cmdq*       cmdq  = &fore200e->host_cmdq;
5571da177e4SLinus Torvalds     struct host_cmdq_entry* entry = &cmdq->host_entry[ cmdq->head ];
5581da177e4SLinus Torvalds     struct prom_opcode      opcode;
5591da177e4SLinus Torvalds     int                     ok;
5601da177e4SLinus Torvalds     u32                     prom_dma;
5611da177e4SLinus Torvalds 
5621da177e4SLinus Torvalds     FORE200E_NEXT_ENTRY(cmdq->head, QUEUE_SIZE_CMD);
5631da177e4SLinus Torvalds 
5641da177e4SLinus Torvalds     opcode.opcode = OPCODE_GET_PROM;
5651da177e4SLinus Torvalds     opcode.pad    = 0;
5661da177e4SLinus Torvalds 
567f3fadcb5SChristoph Hellwig     prom_dma = dma_map_single(fore200e->dev, prom, sizeof(struct prom_data),
568f3fadcb5SChristoph Hellwig 			      DMA_FROM_DEVICE);
5691d9d8be9SChristoph Hellwig     if (dma_mapping_error(fore200e->dev, prom_dma))
5701d9d8be9SChristoph Hellwig 	return -ENOMEM;
5711da177e4SLinus Torvalds 
5721da177e4SLinus Torvalds     fore200e->bus->write(prom_dma, &entry->cp_entry->cmd.prom_block.prom_haddr);
5731da177e4SLinus Torvalds 
5741da177e4SLinus Torvalds     *entry->status = STATUS_PENDING;
5751da177e4SLinus Torvalds 
5761da177e4SLinus Torvalds     fore200e->bus->write(*(u32*)&opcode, (u32 __iomem *)&entry->cp_entry->cmd.prom_block.opcode);
5771da177e4SLinus Torvalds 
5781da177e4SLinus Torvalds     ok = fore200e_poll(fore200e, entry->status, STATUS_COMPLETE, 400);
5791da177e4SLinus Torvalds 
5801da177e4SLinus Torvalds     *entry->status = STATUS_FREE;
5811da177e4SLinus Torvalds 
582f3fadcb5SChristoph Hellwig     dma_unmap_single(fore200e->dev, prom_dma, sizeof(struct prom_data), DMA_FROM_DEVICE);
5831da177e4SLinus Torvalds 
5841da177e4SLinus Torvalds     if (ok == 0) {
5851da177e4SLinus Torvalds 	printk(FORE200E "unable to get PROM data from device %s\n", fore200e->name);
5861da177e4SLinus Torvalds 	return -EIO;
5871da177e4SLinus Torvalds     }
5881da177e4SLinus Torvalds 
5891da177e4SLinus Torvalds #if defined(__BIG_ENDIAN)
5901da177e4SLinus Torvalds 
5911da177e4SLinus Torvalds #define swap_here(addr) (*((u32*)(addr)) = swab32( *((u32*)(addr)) ))
5921da177e4SLinus Torvalds 
5931da177e4SLinus Torvalds     /* MAC address is stored as little-endian */
5941da177e4SLinus Torvalds     swap_here(&prom->mac_addr[0]);
5951da177e4SLinus Torvalds     swap_here(&prom->mac_addr[4]);
5961da177e4SLinus Torvalds #endif
5971da177e4SLinus Torvalds 
5981da177e4SLinus Torvalds     return 0;
5991da177e4SLinus Torvalds }
6001da177e4SLinus Torvalds 
6011da177e4SLinus Torvalds 
6021da177e4SLinus Torvalds static int
fore200e_pca_proc_read(struct fore200e * fore200e,char * page)6031da177e4SLinus Torvalds fore200e_pca_proc_read(struct fore200e* fore200e, char *page)
6041da177e4SLinus Torvalds {
605aff9d262SChristoph Hellwig     struct pci_dev *pci_dev = to_pci_dev(fore200e->dev);
6061da177e4SLinus Torvalds 
6071da177e4SLinus Torvalds     return sprintf(page, "   PCI bus/slot/function:\t%d/%d/%d\n",
6081da177e4SLinus Torvalds 		   pci_dev->bus->number, PCI_SLOT(pci_dev->devfn), PCI_FUNC(pci_dev->devfn));
6091da177e4SLinus Torvalds }
6101da177e4SLinus Torvalds 
6110efe5523SChristoph Hellwig static const struct fore200e_bus fore200e_pci_ops = {
6120efe5523SChristoph Hellwig 	.model_name		= "PCA-200E",
6130efe5523SChristoph Hellwig 	.proc_name		= "pca200e",
6140efe5523SChristoph Hellwig 	.descr_alignment	= 32,
6150efe5523SChristoph Hellwig 	.buffer_alignment	= 4,
6160efe5523SChristoph Hellwig 	.status_alignment	= 32,
6170efe5523SChristoph Hellwig 	.read			= fore200e_pca_read,
6180efe5523SChristoph Hellwig 	.write			= fore200e_pca_write,
6190efe5523SChristoph Hellwig 	.configure		= fore200e_pca_configure,
6200efe5523SChristoph Hellwig 	.map			= fore200e_pca_map,
6210efe5523SChristoph Hellwig 	.reset			= fore200e_pca_reset,
6220efe5523SChristoph Hellwig 	.prom_read		= fore200e_pca_prom_read,
6230efe5523SChristoph Hellwig 	.unmap			= fore200e_pca_unmap,
6240efe5523SChristoph Hellwig 	.irq_check		= fore200e_pca_irq_check,
6250efe5523SChristoph Hellwig 	.irq_ack		= fore200e_pca_irq_ack,
6260efe5523SChristoph Hellwig 	.proc_read		= fore200e_pca_proc_read,
6270efe5523SChristoph Hellwig };
628e92481f9SChas Williams #endif /* CONFIG_PCI */
6291da177e4SLinus Torvalds 
630e92481f9SChas Williams #ifdef CONFIG_SBUS
6311da177e4SLinus Torvalds 
fore200e_sba_read(volatile u32 __iomem * addr)632826b6cfcSDavid S. Miller static u32 fore200e_sba_read(volatile u32 __iomem *addr)
6331da177e4SLinus Torvalds {
6341da177e4SLinus Torvalds     return sbus_readl(addr);
6351da177e4SLinus Torvalds }
6361da177e4SLinus Torvalds 
fore200e_sba_write(u32 val,volatile u32 __iomem * addr)637826b6cfcSDavid S. Miller static void fore200e_sba_write(u32 val, volatile u32 __iomem *addr)
6381da177e4SLinus Torvalds {
6391da177e4SLinus Torvalds     sbus_writel(val, addr);
6401da177e4SLinus Torvalds }
6411da177e4SLinus Torvalds 
fore200e_sba_irq_enable(struct fore200e * fore200e)642826b6cfcSDavid S. Miller static void fore200e_sba_irq_enable(struct fore200e *fore200e)
6431da177e4SLinus Torvalds {
6441da177e4SLinus Torvalds 	u32 hcr = fore200e->bus->read(fore200e->regs.sba.hcr) & SBA200E_HCR_STICKY;
6451da177e4SLinus Torvalds 	fore200e->bus->write(hcr | SBA200E_HCR_INTR_ENA, fore200e->regs.sba.hcr);
6461da177e4SLinus Torvalds }
6471da177e4SLinus Torvalds 
fore200e_sba_irq_check(struct fore200e * fore200e)648826b6cfcSDavid S. Miller static int fore200e_sba_irq_check(struct fore200e *fore200e)
6491da177e4SLinus Torvalds {
6501da177e4SLinus Torvalds 	return fore200e->bus->read(fore200e->regs.sba.hcr) & SBA200E_HCR_INTR_REQ;
6511da177e4SLinus Torvalds }
6521da177e4SLinus Torvalds 
fore200e_sba_irq_ack(struct fore200e * fore200e)653826b6cfcSDavid S. Miller static void fore200e_sba_irq_ack(struct fore200e *fore200e)
6541da177e4SLinus Torvalds {
6551da177e4SLinus Torvalds 	u32 hcr = fore200e->bus->read(fore200e->regs.sba.hcr) & SBA200E_HCR_STICKY;
6561da177e4SLinus Torvalds 	fore200e->bus->write(hcr | SBA200E_HCR_INTR_CLR, fore200e->regs.sba.hcr);
6571da177e4SLinus Torvalds }
6581da177e4SLinus Torvalds 
fore200e_sba_reset(struct fore200e * fore200e)659826b6cfcSDavid S. Miller static void fore200e_sba_reset(struct fore200e *fore200e)
6601da177e4SLinus Torvalds {
6611da177e4SLinus Torvalds 	fore200e->bus->write(SBA200E_HCR_RESET, fore200e->regs.sba.hcr);
6621da177e4SLinus Torvalds 	fore200e_spin(10);
6631da177e4SLinus Torvalds 	fore200e->bus->write(0, fore200e->regs.sba.hcr);
6641da177e4SLinus Torvalds }
6651da177e4SLinus Torvalds 
fore200e_sba_map(struct fore200e * fore200e)666826b6cfcSDavid S. Miller static int __init fore200e_sba_map(struct fore200e *fore200e)
6671da177e4SLinus Torvalds {
668aff9d262SChristoph Hellwig 	struct platform_device *op = to_platform_device(fore200e->dev);
6691da177e4SLinus Torvalds 	unsigned int bursts;
6701da177e4SLinus Torvalds 
6711da177e4SLinus Torvalds 	/* gain access to the SBA specific registers  */
672826b6cfcSDavid S. Miller 	fore200e->regs.sba.hcr = of_ioremap(&op->resource[0], 0, SBA200E_HCR_LENGTH, "SBA HCR");
673826b6cfcSDavid S. Miller 	fore200e->regs.sba.bsr = of_ioremap(&op->resource[1], 0, SBA200E_BSR_LENGTH, "SBA BSR");
674826b6cfcSDavid S. Miller 	fore200e->regs.sba.isr = of_ioremap(&op->resource[2], 0, SBA200E_ISR_LENGTH, "SBA ISR");
675826b6cfcSDavid S. Miller 	fore200e->virt_base    = of_ioremap(&op->resource[3], 0, SBA200E_RAM_LENGTH, "SBA RAM");
6761da177e4SLinus Torvalds 
677826b6cfcSDavid S. Miller 	if (!fore200e->virt_base) {
6781da177e4SLinus Torvalds 		printk(FORE200E "unable to map RAM of device %s\n", fore200e->name);
6791da177e4SLinus Torvalds 		return -EFAULT;
6801da177e4SLinus Torvalds 	}
6811da177e4SLinus Torvalds 
6821da177e4SLinus Torvalds 	DPRINTK(1, "device %s mapped to 0x%p\n", fore200e->name, fore200e->virt_base);
6831da177e4SLinus Torvalds 
6841da177e4SLinus Torvalds 	fore200e->bus->write(0x02, fore200e->regs.sba.isr); /* XXX hardwired interrupt level */
6851da177e4SLinus Torvalds 
6861da177e4SLinus Torvalds 	/* get the supported DVMA burst sizes */
68761c7a080SGrant Likely 	bursts = of_getintprop_default(op->dev.of_node->parent, "burst-sizes", 0x00);
6881da177e4SLinus Torvalds 
68963237eebSDavid S. Miller 	if (sbus_can_dma_64bit())
690826b6cfcSDavid S. Miller 		sbus_set_sbus64(&op->dev, bursts);
6911da177e4SLinus Torvalds 
6921da177e4SLinus Torvalds 	fore200e->state = FORE200E_STATE_MAP;
6931da177e4SLinus Torvalds 	return 0;
6941da177e4SLinus Torvalds }
6951da177e4SLinus Torvalds 
fore200e_sba_unmap(struct fore200e * fore200e)696826b6cfcSDavid S. Miller static void fore200e_sba_unmap(struct fore200e *fore200e)
6971da177e4SLinus Torvalds {
698aff9d262SChristoph Hellwig 	struct platform_device *op = to_platform_device(fore200e->dev);
699826b6cfcSDavid S. Miller 
700826b6cfcSDavid S. Miller 	of_iounmap(&op->resource[0], fore200e->regs.sba.hcr, SBA200E_HCR_LENGTH);
701826b6cfcSDavid S. Miller 	of_iounmap(&op->resource[1], fore200e->regs.sba.bsr, SBA200E_BSR_LENGTH);
702826b6cfcSDavid S. Miller 	of_iounmap(&op->resource[2], fore200e->regs.sba.isr, SBA200E_ISR_LENGTH);
703826b6cfcSDavid S. Miller 	of_iounmap(&op->resource[3], fore200e->virt_base,    SBA200E_RAM_LENGTH);
7041da177e4SLinus Torvalds }
7051da177e4SLinus Torvalds 
fore200e_sba_configure(struct fore200e * fore200e)706826b6cfcSDavid S. Miller static int __init fore200e_sba_configure(struct fore200e *fore200e)
7071da177e4SLinus Torvalds {
7081da177e4SLinus Torvalds 	fore200e->state = FORE200E_STATE_CONFIGURE;
7091da177e4SLinus Torvalds 	return 0;
7101da177e4SLinus Torvalds }
7111da177e4SLinus Torvalds 
fore200e_sba_prom_read(struct fore200e * fore200e,struct prom_data * prom)712826b6cfcSDavid S. Miller static int __init fore200e_sba_prom_read(struct fore200e *fore200e, struct prom_data *prom)
7131da177e4SLinus Torvalds {
714aff9d262SChristoph Hellwig 	struct platform_device *op = to_platform_device(fore200e->dev);
715826b6cfcSDavid S. Miller 	const u8 *prop;
7161da177e4SLinus Torvalds 	int len;
7171da177e4SLinus Torvalds 
71861c7a080SGrant Likely 	prop = of_get_property(op->dev.of_node, "madaddrlo2", &len);
719826b6cfcSDavid S. Miller 	if (!prop)
720826b6cfcSDavid S. Miller 		return -ENODEV;
721826b6cfcSDavid S. Miller 	memcpy(&prom->mac_addr[4], prop, 4);
7221da177e4SLinus Torvalds 
72361c7a080SGrant Likely 	prop = of_get_property(op->dev.of_node, "madaddrhi4", &len);
724826b6cfcSDavid S. Miller 	if (!prop)
725826b6cfcSDavid S. Miller 		return -ENODEV;
726826b6cfcSDavid S. Miller 	memcpy(&prom->mac_addr[2], prop, 4);
7271da177e4SLinus Torvalds 
72861c7a080SGrant Likely 	prom->serial_number = of_getintprop_default(op->dev.of_node,
72961c7a080SGrant Likely 						    "serialnumber", 0);
73061c7a080SGrant Likely 	prom->hw_revision = of_getintprop_default(op->dev.of_node,
73161c7a080SGrant Likely 						  "promversion", 0);
7321da177e4SLinus Torvalds 
7331da177e4SLinus Torvalds 	return 0;
7341da177e4SLinus Torvalds }
7351da177e4SLinus Torvalds 
fore200e_sba_proc_read(struct fore200e * fore200e,char * page)736826b6cfcSDavid S. Miller static int fore200e_sba_proc_read(struct fore200e *fore200e, char *page)
7371da177e4SLinus Torvalds {
738aff9d262SChristoph Hellwig 	struct platform_device *op = to_platform_device(fore200e->dev);
739826b6cfcSDavid S. Miller 	const struct linux_prom_registers *regs;
7401da177e4SLinus Torvalds 
74161c7a080SGrant Likely 	regs = of_get_property(op->dev.of_node, "reg", NULL);
742826b6cfcSDavid S. Miller 
743ee5b60ebSRob Herring 	return sprintf(page, "   SBUS slot/device:\t\t%d/'%pOFn'\n",
744ee5b60ebSRob Herring 		       (regs ? regs->which_io : 0), op->dev.of_node);
7451da177e4SLinus Torvalds }
7461da177e4SLinus Torvalds 
7470efe5523SChristoph Hellwig static const struct fore200e_bus fore200e_sbus_ops = {
7480efe5523SChristoph Hellwig 	.model_name		= "SBA-200E",
7490efe5523SChristoph Hellwig 	.proc_name		= "sba200e",
7500efe5523SChristoph Hellwig 	.descr_alignment	= 32,
75166604641SChristoph Hellwig 	.buffer_alignment	= 64,
7520efe5523SChristoph Hellwig 	.status_alignment	= 32,
7530efe5523SChristoph Hellwig 	.read			= fore200e_sba_read,
7540efe5523SChristoph Hellwig 	.write			= fore200e_sba_write,
7550efe5523SChristoph Hellwig 	.configure		= fore200e_sba_configure,
7560efe5523SChristoph Hellwig 	.map			= fore200e_sba_map,
7570efe5523SChristoph Hellwig 	.reset			= fore200e_sba_reset,
7580efe5523SChristoph Hellwig 	.prom_read		= fore200e_sba_prom_read,
7590efe5523SChristoph Hellwig 	.unmap			= fore200e_sba_unmap,
7600efe5523SChristoph Hellwig 	.irq_enable		= fore200e_sba_irq_enable,
7610efe5523SChristoph Hellwig 	.irq_check		= fore200e_sba_irq_check,
7620efe5523SChristoph Hellwig 	.irq_ack		= fore200e_sba_irq_ack,
7630efe5523SChristoph Hellwig 	.proc_read		= fore200e_sba_proc_read,
7640efe5523SChristoph Hellwig };
7650efe5523SChristoph Hellwig #endif /* CONFIG_SBUS */
7661da177e4SLinus Torvalds 
7671da177e4SLinus Torvalds static void
fore200e_tx_irq(struct fore200e * fore200e)7681da177e4SLinus Torvalds fore200e_tx_irq(struct fore200e* fore200e)
7691da177e4SLinus Torvalds {
7701da177e4SLinus Torvalds     struct host_txq*        txq = &fore200e->host_txq;
7711da177e4SLinus Torvalds     struct host_txq_entry*  entry;
7721da177e4SLinus Torvalds     struct atm_vcc*         vcc;
7731da177e4SLinus Torvalds     struct fore200e_vc_map* vc_map;
7741da177e4SLinus Torvalds 
7751da177e4SLinus Torvalds     if (fore200e->host_txq.txing == 0)
7761da177e4SLinus Torvalds 	return;
7771da177e4SLinus Torvalds 
7781da177e4SLinus Torvalds     for (;;) {
7791da177e4SLinus Torvalds 
7801da177e4SLinus Torvalds 	entry = &txq->host_entry[ txq->tail ];
7811da177e4SLinus Torvalds 
7821da177e4SLinus Torvalds         if ((*entry->status & STATUS_COMPLETE) == 0) {
7831da177e4SLinus Torvalds 	    break;
7841da177e4SLinus Torvalds 	}
7851da177e4SLinus Torvalds 
7861da177e4SLinus Torvalds 	DPRINTK(3, "TX COMPLETED: entry = %p [tail = %d], vc_map = %p, skb = %p\n",
7871da177e4SLinus Torvalds 		entry, txq->tail, entry->vc_map, entry->skb);
7881da177e4SLinus Torvalds 
7891da177e4SLinus Torvalds 	/* free copy of misaligned data */
7901da177e4SLinus Torvalds 	kfree(entry->data);
7911da177e4SLinus Torvalds 
7921da177e4SLinus Torvalds 	/* remove DMA mapping */
793f3fadcb5SChristoph Hellwig 	dma_unmap_single(fore200e->dev, entry->tpd->tsd[ 0 ].buffer, entry->tpd->tsd[ 0 ].length,
7941da177e4SLinus Torvalds 				 DMA_TO_DEVICE);
7951da177e4SLinus Torvalds 
7961da177e4SLinus Torvalds 	vc_map = entry->vc_map;
7971da177e4SLinus Torvalds 
7981da177e4SLinus Torvalds 	/* vcc closed since the time the entry was submitted for tx? */
7991da177e4SLinus Torvalds 	if ((vc_map->vcc == NULL) ||
8001da177e4SLinus Torvalds 	    (test_bit(ATM_VF_READY, &vc_map->vcc->flags) == 0)) {
8011da177e4SLinus Torvalds 
8021da177e4SLinus Torvalds 	    DPRINTK(1, "no ready vcc found for PDU sent on device %d\n",
8031da177e4SLinus Torvalds 		    fore200e->atm_dev->number);
8041da177e4SLinus Torvalds 
8051da177e4SLinus Torvalds 	    dev_kfree_skb_any(entry->skb);
8061da177e4SLinus Torvalds 	}
8071da177e4SLinus Torvalds 	else {
8081da177e4SLinus Torvalds 	    ASSERT(vc_map->vcc);
8091da177e4SLinus Torvalds 
8101da177e4SLinus Torvalds 	    /* vcc closed then immediately re-opened? */
8111da177e4SLinus Torvalds 	    if (vc_map->incarn != entry->incarn) {
8121da177e4SLinus Torvalds 
8131da177e4SLinus Torvalds 		/* when a vcc is closed, some PDUs may be still pending in the tx queue.
8141da177e4SLinus Torvalds 		   if the same vcc is immediately re-opened, those pending PDUs must
8151da177e4SLinus Torvalds 		   not be popped after the completion of their emission, as they refer
8161da177e4SLinus Torvalds 		   to the prior incarnation of that vcc. otherwise, sk_atm(vcc)->sk_wmem_alloc
8171da177e4SLinus Torvalds 		   would be decremented by the size of the (unrelated) skb, possibly
8181da177e4SLinus Torvalds 		   leading to a negative sk->sk_wmem_alloc count, ultimately freezing the vcc.
8191da177e4SLinus Torvalds 		   we thus bind the tx entry to the current incarnation of the vcc
8201da177e4SLinus Torvalds 		   when the entry is submitted for tx. When the tx later completes,
8211da177e4SLinus Torvalds 		   if the incarnation number of the tx entry does not match the one
8221da177e4SLinus Torvalds 		   of the vcc, then this implies that the vcc has been closed then re-opened.
8231da177e4SLinus Torvalds 		   we thus just drop the skb here. */
8241da177e4SLinus Torvalds 
8251da177e4SLinus Torvalds 		DPRINTK(1, "vcc closed-then-re-opened; dropping PDU sent on device %d\n",
8261da177e4SLinus Torvalds 			fore200e->atm_dev->number);
8271da177e4SLinus Torvalds 
8281da177e4SLinus Torvalds 		dev_kfree_skb_any(entry->skb);
8291da177e4SLinus Torvalds 	    }
8301da177e4SLinus Torvalds 	    else {
8311da177e4SLinus Torvalds 		vcc = vc_map->vcc;
8321da177e4SLinus Torvalds 		ASSERT(vcc);
8331da177e4SLinus Torvalds 
8341da177e4SLinus Torvalds 		/* notify tx completion */
8351da177e4SLinus Torvalds 		if (vcc->pop) {
8361da177e4SLinus Torvalds 		    vcc->pop(vcc, entry->skb);
8371da177e4SLinus Torvalds 		}
8381da177e4SLinus Torvalds 		else {
8391da177e4SLinus Torvalds 		    dev_kfree_skb_any(entry->skb);
8401da177e4SLinus Torvalds 		}
84114afee4bSReshetova, Elena 
8421da177e4SLinus Torvalds 		/* check error condition */
8431da177e4SLinus Torvalds 		if (*entry->status & STATUS_ERROR)
8441da177e4SLinus Torvalds 		    atomic_inc(&vcc->stats->tx_err);
8451da177e4SLinus Torvalds 		else
8461da177e4SLinus Torvalds 		    atomic_inc(&vcc->stats->tx);
8471da177e4SLinus Torvalds 	    }
8481da177e4SLinus Torvalds 	}
8491da177e4SLinus Torvalds 
8501da177e4SLinus Torvalds 	*entry->status = STATUS_FREE;
8511da177e4SLinus Torvalds 
8521da177e4SLinus Torvalds 	fore200e->host_txq.txing--;
8531da177e4SLinus Torvalds 
8541da177e4SLinus Torvalds 	FORE200E_NEXT_ENTRY(txq->tail, QUEUE_SIZE_TX);
8551da177e4SLinus Torvalds     }
8561da177e4SLinus Torvalds }
8571da177e4SLinus Torvalds 
8581da177e4SLinus Torvalds 
8591da177e4SLinus Torvalds #ifdef FORE200E_BSQ_DEBUG
bsq_audit(int where,struct host_bsq * bsq,int scheme,int magn)8601da177e4SLinus Torvalds int bsq_audit(int where, struct host_bsq* bsq, int scheme, int magn)
8611da177e4SLinus Torvalds {
8621da177e4SLinus Torvalds     struct buffer* buffer;
8631da177e4SLinus Torvalds     int count = 0;
8641da177e4SLinus Torvalds 
8651da177e4SLinus Torvalds     buffer = bsq->freebuf;
8661da177e4SLinus Torvalds     while (buffer) {
8671da177e4SLinus Torvalds 
8681da177e4SLinus Torvalds 	if (buffer->supplied) {
8691da177e4SLinus Torvalds 	    printk(FORE200E "bsq_audit(%d): queue %d.%d, buffer %ld supplied but in free list!\n",
8701da177e4SLinus Torvalds 		   where, scheme, magn, buffer->index);
8711da177e4SLinus Torvalds 	}
8721da177e4SLinus Torvalds 
8731da177e4SLinus Torvalds 	if (buffer->magn != magn) {
8741da177e4SLinus Torvalds 	    printk(FORE200E "bsq_audit(%d): queue %d.%d, buffer %ld, unexpected magn = %d\n",
8751da177e4SLinus Torvalds 		   where, scheme, magn, buffer->index, buffer->magn);
8761da177e4SLinus Torvalds 	}
8771da177e4SLinus Torvalds 
8781da177e4SLinus Torvalds 	if (buffer->scheme != scheme) {
8791da177e4SLinus Torvalds 	    printk(FORE200E "bsq_audit(%d): queue %d.%d, buffer %ld, unexpected scheme = %d\n",
8801da177e4SLinus Torvalds 		   where, scheme, magn, buffer->index, buffer->scheme);
8811da177e4SLinus Torvalds 	}
8821da177e4SLinus Torvalds 
8831da177e4SLinus Torvalds 	if ((buffer->index < 0) || (buffer->index >= fore200e_rx_buf_nbr[ scheme ][ magn ])) {
8841da177e4SLinus Torvalds 	    printk(FORE200E "bsq_audit(%d): queue %d.%d, out of range buffer index = %ld !\n",
8851da177e4SLinus Torvalds 		   where, scheme, magn, buffer->index);
8861da177e4SLinus Torvalds 	}
8871da177e4SLinus Torvalds 
8881da177e4SLinus Torvalds 	count++;
8891da177e4SLinus Torvalds 	buffer = buffer->next;
8901da177e4SLinus Torvalds     }
8911da177e4SLinus Torvalds 
8921da177e4SLinus Torvalds     if (count != bsq->freebuf_count) {
8931da177e4SLinus Torvalds 	printk(FORE200E "bsq_audit(%d): queue %d.%d, %d bufs in free list, but freebuf_count = %d\n",
8941da177e4SLinus Torvalds 	       where, scheme, magn, count, bsq->freebuf_count);
8951da177e4SLinus Torvalds     }
8961da177e4SLinus Torvalds     return 0;
8971da177e4SLinus Torvalds }
8981da177e4SLinus Torvalds #endif
8991da177e4SLinus Torvalds 
9001da177e4SLinus Torvalds 
9011da177e4SLinus Torvalds static void
fore200e_supply(struct fore200e * fore200e)9021da177e4SLinus Torvalds fore200e_supply(struct fore200e* fore200e)
9031da177e4SLinus Torvalds {
9041da177e4SLinus Torvalds     int  scheme, magn, i;
9051da177e4SLinus Torvalds 
9061da177e4SLinus Torvalds     struct host_bsq*       bsq;
9071da177e4SLinus Torvalds     struct host_bsq_entry* entry;
9081da177e4SLinus Torvalds     struct buffer*         buffer;
9091da177e4SLinus Torvalds 
9101da177e4SLinus Torvalds     for (scheme = 0; scheme < BUFFER_SCHEME_NBR; scheme++) {
9111da177e4SLinus Torvalds 	for (magn = 0; magn < BUFFER_MAGN_NBR; magn++) {
9121da177e4SLinus Torvalds 
9131da177e4SLinus Torvalds 	    bsq = &fore200e->host_bsq[ scheme ][ magn ];
9141da177e4SLinus Torvalds 
9151da177e4SLinus Torvalds #ifdef FORE200E_BSQ_DEBUG
9161da177e4SLinus Torvalds 	    bsq_audit(1, bsq, scheme, magn);
9171da177e4SLinus Torvalds #endif
9181da177e4SLinus Torvalds 	    while (bsq->freebuf_count >= RBD_BLK_SIZE) {
9191da177e4SLinus Torvalds 
9201da177e4SLinus Torvalds 		DPRINTK(2, "supplying %d rx buffers to queue %d / %d, freebuf_count = %d\n",
9211da177e4SLinus Torvalds 			RBD_BLK_SIZE, scheme, magn, bsq->freebuf_count);
9221da177e4SLinus Torvalds 
9231da177e4SLinus Torvalds 		entry = &bsq->host_entry[ bsq->head ];
9241da177e4SLinus Torvalds 
9251da177e4SLinus Torvalds 		for (i = 0; i < RBD_BLK_SIZE; i++) {
9261da177e4SLinus Torvalds 
9271da177e4SLinus Torvalds 		    /* take the first buffer in the free buffer list */
9281da177e4SLinus Torvalds 		    buffer = bsq->freebuf;
9291da177e4SLinus Torvalds 		    if (!buffer) {
9301da177e4SLinus Torvalds 			printk(FORE200E "no more free bufs in queue %d.%d, but freebuf_count = %d\n",
9311da177e4SLinus Torvalds 			       scheme, magn, bsq->freebuf_count);
9321da177e4SLinus Torvalds 			return;
9331da177e4SLinus Torvalds 		    }
9341da177e4SLinus Torvalds 		    bsq->freebuf = buffer->next;
9351da177e4SLinus Torvalds 
9361da177e4SLinus Torvalds #ifdef FORE200E_BSQ_DEBUG
9371da177e4SLinus Torvalds 		    if (buffer->supplied)
9381da177e4SLinus Torvalds 			printk(FORE200E "queue %d.%d, buffer %lu already supplied\n",
9391da177e4SLinus Torvalds 			       scheme, magn, buffer->index);
9401da177e4SLinus Torvalds 		    buffer->supplied = 1;
9411da177e4SLinus Torvalds #endif
9421da177e4SLinus Torvalds 		    entry->rbd_block->rbd[ i ].buffer_haddr = buffer->data.dma_addr;
9431da177e4SLinus Torvalds 		    entry->rbd_block->rbd[ i ].handle       = FORE200E_BUF2HDL(buffer);
9441da177e4SLinus Torvalds 		}
9451da177e4SLinus Torvalds 
9461da177e4SLinus Torvalds 		FORE200E_NEXT_ENTRY(bsq->head, QUEUE_SIZE_BS);
9471da177e4SLinus Torvalds 
9481da177e4SLinus Torvalds  		/* decrease accordingly the number of free rx buffers */
9491da177e4SLinus Torvalds 		bsq->freebuf_count -= RBD_BLK_SIZE;
9501da177e4SLinus Torvalds 
9511da177e4SLinus Torvalds 		*entry->status = STATUS_PENDING;
9521da177e4SLinus Torvalds 		fore200e->bus->write(entry->rbd_block_dma, &entry->cp_entry->rbd_block_haddr);
9531da177e4SLinus Torvalds 	    }
9541da177e4SLinus Torvalds 	}
9551da177e4SLinus Torvalds     }
9561da177e4SLinus Torvalds }
9571da177e4SLinus Torvalds 
9581da177e4SLinus Torvalds 
9591da177e4SLinus Torvalds static int
fore200e_push_rpd(struct fore200e * fore200e,struct atm_vcc * vcc,struct rpd * rpd)9601da177e4SLinus Torvalds fore200e_push_rpd(struct fore200e* fore200e, struct atm_vcc* vcc, struct rpd* rpd)
9611da177e4SLinus Torvalds {
9621da177e4SLinus Torvalds     struct sk_buff*      skb;
9631da177e4SLinus Torvalds     struct buffer*       buffer;
9641da177e4SLinus Torvalds     struct fore200e_vcc* fore200e_vcc;
9651da177e4SLinus Torvalds     int                  i, pdu_len = 0;
9661da177e4SLinus Torvalds #ifdef FORE200E_52BYTE_AAL0_SDU
9671da177e4SLinus Torvalds     u32                  cell_header = 0;
9681da177e4SLinus Torvalds #endif
9691da177e4SLinus Torvalds 
9701da177e4SLinus Torvalds     ASSERT(vcc);
9711da177e4SLinus Torvalds 
9721da177e4SLinus Torvalds     fore200e_vcc = FORE200E_VCC(vcc);
9731da177e4SLinus Torvalds     ASSERT(fore200e_vcc);
9741da177e4SLinus Torvalds 
9751da177e4SLinus Torvalds #ifdef FORE200E_52BYTE_AAL0_SDU
9761da177e4SLinus Torvalds     if ((vcc->qos.aal == ATM_AAL0) && (vcc->qos.rxtp.max_sdu == ATM_AAL0_SDU)) {
9771da177e4SLinus Torvalds 
9781da177e4SLinus Torvalds 	cell_header = (rpd->atm_header.gfc << ATM_HDR_GFC_SHIFT) |
9791da177e4SLinus Torvalds 	              (rpd->atm_header.vpi << ATM_HDR_VPI_SHIFT) |
9801da177e4SLinus Torvalds                       (rpd->atm_header.vci << ATM_HDR_VCI_SHIFT) |
9811da177e4SLinus Torvalds                       (rpd->atm_header.plt << ATM_HDR_PTI_SHIFT) |
9821da177e4SLinus Torvalds                        rpd->atm_header.clp;
9831da177e4SLinus Torvalds 	pdu_len = 4;
9841da177e4SLinus Torvalds     }
9851da177e4SLinus Torvalds #endif
9861da177e4SLinus Torvalds 
9871da177e4SLinus Torvalds     /* compute total PDU length */
9881da177e4SLinus Torvalds     for (i = 0; i < rpd->nseg; i++)
9891da177e4SLinus Torvalds 	pdu_len += rpd->rsd[ i ].length;
9901da177e4SLinus Torvalds 
9911da177e4SLinus Torvalds     skb = alloc_skb(pdu_len, GFP_ATOMIC);
9921da177e4SLinus Torvalds     if (skb == NULL) {
9931da177e4SLinus Torvalds 	DPRINTK(2, "unable to alloc new skb, rx PDU length = %d\n", pdu_len);
9941da177e4SLinus Torvalds 
9951da177e4SLinus Torvalds 	atomic_inc(&vcc->stats->rx_drop);
9961da177e4SLinus Torvalds 	return -ENOMEM;
9971da177e4SLinus Torvalds     }
9981da177e4SLinus Torvalds 
999a61bbcf2SPatrick McHardy     __net_timestamp(skb);
10001da177e4SLinus Torvalds 
10011da177e4SLinus Torvalds #ifdef FORE200E_52BYTE_AAL0_SDU
10021da177e4SLinus Torvalds     if (cell_header) {
10031da177e4SLinus Torvalds 	*((u32*)skb_put(skb, 4)) = cell_header;
10041da177e4SLinus Torvalds     }
10051da177e4SLinus Torvalds #endif
10061da177e4SLinus Torvalds 
10071da177e4SLinus Torvalds     /* reassemble segments */
10081da177e4SLinus Torvalds     for (i = 0; i < rpd->nseg; i++) {
10091da177e4SLinus Torvalds 
10101da177e4SLinus Torvalds 	/* rebuild rx buffer address from rsd handle */
10111da177e4SLinus Torvalds 	buffer = FORE200E_HDL2BUF(rpd->rsd[ i ].handle);
10121da177e4SLinus Torvalds 
10131da177e4SLinus Torvalds 	/* Make device DMA transfer visible to CPU.  */
1014f3fadcb5SChristoph Hellwig 	dma_sync_single_for_cpu(fore200e->dev, buffer->data.dma_addr,
1015f3fadcb5SChristoph Hellwig 				rpd->rsd[i].length, DMA_FROM_DEVICE);
10161da177e4SLinus Torvalds 
101759ae1d12SJohannes Berg 	skb_put_data(skb, buffer->data.align_addr, rpd->rsd[i].length);
10181da177e4SLinus Torvalds 
10191da177e4SLinus Torvalds 	/* Now let the device get at it again.  */
1020f3fadcb5SChristoph Hellwig 	dma_sync_single_for_device(fore200e->dev, buffer->data.dma_addr,
1021f3fadcb5SChristoph Hellwig 				   rpd->rsd[i].length, DMA_FROM_DEVICE);
10221da177e4SLinus Torvalds     }
10231da177e4SLinus Torvalds 
10241da177e4SLinus Torvalds     DPRINTK(3, "rx skb: len = %d, truesize = %d\n", skb->len, skb->truesize);
10251da177e4SLinus Torvalds 
10261da177e4SLinus Torvalds     if (pdu_len < fore200e_vcc->rx_min_pdu)
10271da177e4SLinus Torvalds 	fore200e_vcc->rx_min_pdu = pdu_len;
10281da177e4SLinus Torvalds     if (pdu_len > fore200e_vcc->rx_max_pdu)
10291da177e4SLinus Torvalds 	fore200e_vcc->rx_max_pdu = pdu_len;
10301da177e4SLinus Torvalds     fore200e_vcc->rx_pdu++;
10311da177e4SLinus Torvalds 
10321da177e4SLinus Torvalds     /* push PDU */
10331da177e4SLinus Torvalds     if (atm_charge(vcc, skb->truesize) == 0) {
10341da177e4SLinus Torvalds 
10351da177e4SLinus Torvalds 	DPRINTK(2, "receive buffers saturated for %d.%d.%d - PDU dropped\n",
10361da177e4SLinus Torvalds 		vcc->itf, vcc->vpi, vcc->vci);
10371da177e4SLinus Torvalds 
10381da177e4SLinus Torvalds 	dev_kfree_skb_any(skb);
10391da177e4SLinus Torvalds 
10401da177e4SLinus Torvalds 	atomic_inc(&vcc->stats->rx_drop);
10411da177e4SLinus Torvalds 	return -ENOMEM;
10421da177e4SLinus Torvalds     }
10431da177e4SLinus Torvalds 
10441da177e4SLinus Torvalds     vcc->push(vcc, skb);
10451da177e4SLinus Torvalds     atomic_inc(&vcc->stats->rx);
10461da177e4SLinus Torvalds 
10471da177e4SLinus Torvalds     return 0;
10481da177e4SLinus Torvalds }
10491da177e4SLinus Torvalds 
10501da177e4SLinus Torvalds 
10511da177e4SLinus Torvalds static void
fore200e_collect_rpd(struct fore200e * fore200e,struct rpd * rpd)10521da177e4SLinus Torvalds fore200e_collect_rpd(struct fore200e* fore200e, struct rpd* rpd)
10531da177e4SLinus Torvalds {
10541da177e4SLinus Torvalds     struct host_bsq* bsq;
10551da177e4SLinus Torvalds     struct buffer*   buffer;
10561da177e4SLinus Torvalds     int              i;
10571da177e4SLinus Torvalds 
10581da177e4SLinus Torvalds     for (i = 0; i < rpd->nseg; i++) {
10591da177e4SLinus Torvalds 
10601da177e4SLinus Torvalds 	/* rebuild rx buffer address from rsd handle */
10611da177e4SLinus Torvalds 	buffer = FORE200E_HDL2BUF(rpd->rsd[ i ].handle);
10621da177e4SLinus Torvalds 
10631da177e4SLinus Torvalds 	bsq = &fore200e->host_bsq[ buffer->scheme ][ buffer->magn ];
10641da177e4SLinus Torvalds 
10651da177e4SLinus Torvalds #ifdef FORE200E_BSQ_DEBUG
10661da177e4SLinus Torvalds 	bsq_audit(2, bsq, buffer->scheme, buffer->magn);
10671da177e4SLinus Torvalds 
10681da177e4SLinus Torvalds 	if (buffer->supplied == 0)
10691da177e4SLinus Torvalds 	    printk(FORE200E "queue %d.%d, buffer %ld was not supplied\n",
10701da177e4SLinus Torvalds 		   buffer->scheme, buffer->magn, buffer->index);
10711da177e4SLinus Torvalds 	buffer->supplied = 0;
10721da177e4SLinus Torvalds #endif
10731da177e4SLinus Torvalds 
10741da177e4SLinus Torvalds 	/* re-insert the buffer into the free buffer list */
10751da177e4SLinus Torvalds 	buffer->next = bsq->freebuf;
10761da177e4SLinus Torvalds 	bsq->freebuf = buffer;
10771da177e4SLinus Torvalds 
10781da177e4SLinus Torvalds 	/* then increment the number of free rx buffers */
10791da177e4SLinus Torvalds 	bsq->freebuf_count++;
10801da177e4SLinus Torvalds     }
10811da177e4SLinus Torvalds }
10821da177e4SLinus Torvalds 
10831da177e4SLinus Torvalds 
10841da177e4SLinus Torvalds static void
fore200e_rx_irq(struct fore200e * fore200e)10851da177e4SLinus Torvalds fore200e_rx_irq(struct fore200e* fore200e)
10861da177e4SLinus Torvalds {
10871da177e4SLinus Torvalds     struct host_rxq*        rxq = &fore200e->host_rxq;
10881da177e4SLinus Torvalds     struct host_rxq_entry*  entry;
10891da177e4SLinus Torvalds     struct atm_vcc*         vcc;
10901da177e4SLinus Torvalds     struct fore200e_vc_map* vc_map;
10911da177e4SLinus Torvalds 
10921da177e4SLinus Torvalds     for (;;) {
10931da177e4SLinus Torvalds 
10941da177e4SLinus Torvalds 	entry = &rxq->host_entry[ rxq->head ];
10951da177e4SLinus Torvalds 
10961da177e4SLinus Torvalds 	/* no more received PDUs */
10971da177e4SLinus Torvalds 	if ((*entry->status & STATUS_COMPLETE) == 0)
10981da177e4SLinus Torvalds 	    break;
10991da177e4SLinus Torvalds 
11001da177e4SLinus Torvalds 	vc_map = FORE200E_VC_MAP(fore200e, entry->rpd->atm_header.vpi, entry->rpd->atm_header.vci);
11011da177e4SLinus Torvalds 
11021da177e4SLinus Torvalds 	if ((vc_map->vcc == NULL) ||
11031da177e4SLinus Torvalds 	    (test_bit(ATM_VF_READY, &vc_map->vcc->flags) == 0)) {
11041da177e4SLinus Torvalds 
11051da177e4SLinus Torvalds 	    DPRINTK(1, "no ready VC found for PDU received on %d.%d.%d\n",
11061da177e4SLinus Torvalds 		    fore200e->atm_dev->number,
11071da177e4SLinus Torvalds 		    entry->rpd->atm_header.vpi, entry->rpd->atm_header.vci);
11081da177e4SLinus Torvalds 	}
11091da177e4SLinus Torvalds 	else {
11101da177e4SLinus Torvalds 	    vcc = vc_map->vcc;
11111da177e4SLinus Torvalds 	    ASSERT(vcc);
11121da177e4SLinus Torvalds 
11131da177e4SLinus Torvalds 	    if ((*entry->status & STATUS_ERROR) == 0) {
11141da177e4SLinus Torvalds 
11151da177e4SLinus Torvalds 		fore200e_push_rpd(fore200e, vcc, entry->rpd);
11161da177e4SLinus Torvalds 	    }
11171da177e4SLinus Torvalds 	    else {
11181da177e4SLinus Torvalds 		DPRINTK(2, "damaged PDU on %d.%d.%d\n",
11191da177e4SLinus Torvalds 			fore200e->atm_dev->number,
11201da177e4SLinus Torvalds 			entry->rpd->atm_header.vpi, entry->rpd->atm_header.vci);
11211da177e4SLinus Torvalds 		atomic_inc(&vcc->stats->rx_err);
11221da177e4SLinus Torvalds 	    }
11231da177e4SLinus Torvalds 	}
11241da177e4SLinus Torvalds 
11251da177e4SLinus Torvalds 	FORE200E_NEXT_ENTRY(rxq->head, QUEUE_SIZE_RX);
11261da177e4SLinus Torvalds 
11271da177e4SLinus Torvalds 	fore200e_collect_rpd(fore200e, entry->rpd);
11281da177e4SLinus Torvalds 
11291da177e4SLinus Torvalds 	/* rewrite the rpd address to ack the received PDU */
11301da177e4SLinus Torvalds 	fore200e->bus->write(entry->rpd_dma, &entry->cp_entry->rpd_haddr);
11311da177e4SLinus Torvalds 	*entry->status = STATUS_FREE;
11321da177e4SLinus Torvalds 
11331da177e4SLinus Torvalds 	fore200e_supply(fore200e);
11341da177e4SLinus Torvalds     }
11351da177e4SLinus Torvalds }
11361da177e4SLinus Torvalds 
11371da177e4SLinus Torvalds 
11381da177e4SLinus Torvalds #ifndef FORE200E_USE_TASKLET
11391da177e4SLinus Torvalds static void
fore200e_irq(struct fore200e * fore200e)11401da177e4SLinus Torvalds fore200e_irq(struct fore200e* fore200e)
11411da177e4SLinus Torvalds {
11421da177e4SLinus Torvalds     unsigned long flags;
11431da177e4SLinus Torvalds 
11441da177e4SLinus Torvalds     spin_lock_irqsave(&fore200e->q_lock, flags);
11451da177e4SLinus Torvalds     fore200e_rx_irq(fore200e);
11461da177e4SLinus Torvalds     spin_unlock_irqrestore(&fore200e->q_lock, flags);
11471da177e4SLinus Torvalds 
11481da177e4SLinus Torvalds     spin_lock_irqsave(&fore200e->q_lock, flags);
11491da177e4SLinus Torvalds     fore200e_tx_irq(fore200e);
11501da177e4SLinus Torvalds     spin_unlock_irqrestore(&fore200e->q_lock, flags);
11511da177e4SLinus Torvalds }
11521da177e4SLinus Torvalds #endif
11531da177e4SLinus Torvalds 
11541da177e4SLinus Torvalds 
11551da177e4SLinus Torvalds static irqreturn_t
fore200e_interrupt(int irq,void * dev)11567d12e780SDavid Howells fore200e_interrupt(int irq, void* dev)
11571da177e4SLinus Torvalds {
11581da177e4SLinus Torvalds     struct fore200e* fore200e = FORE200E_DEV((struct atm_dev*)dev);
11591da177e4SLinus Torvalds 
11601da177e4SLinus Torvalds     if (fore200e->bus->irq_check(fore200e) == 0) {
11611da177e4SLinus Torvalds 
11621da177e4SLinus Torvalds 	DPRINTK(3, "interrupt NOT triggered by device %d\n", fore200e->atm_dev->number);
11631da177e4SLinus Torvalds 	return IRQ_NONE;
11641da177e4SLinus Torvalds     }
11651da177e4SLinus Torvalds     DPRINTK(3, "interrupt triggered by device %d\n", fore200e->atm_dev->number);
11661da177e4SLinus Torvalds 
11671da177e4SLinus Torvalds #ifdef FORE200E_USE_TASKLET
11681da177e4SLinus Torvalds     tasklet_schedule(&fore200e->tx_tasklet);
11691da177e4SLinus Torvalds     tasklet_schedule(&fore200e->rx_tasklet);
11701da177e4SLinus Torvalds #else
11711da177e4SLinus Torvalds     fore200e_irq(fore200e);
11721da177e4SLinus Torvalds #endif
11731da177e4SLinus Torvalds 
11741da177e4SLinus Torvalds     fore200e->bus->irq_ack(fore200e);
11751da177e4SLinus Torvalds     return IRQ_HANDLED;
11761da177e4SLinus Torvalds }
11771da177e4SLinus Torvalds 
11781da177e4SLinus Torvalds 
11791da177e4SLinus Torvalds #ifdef FORE200E_USE_TASKLET
11801da177e4SLinus Torvalds static void
fore200e_tx_tasklet(unsigned long data)11811da177e4SLinus Torvalds fore200e_tx_tasklet(unsigned long data)
11821da177e4SLinus Torvalds {
11831da177e4SLinus Torvalds     struct fore200e* fore200e = (struct fore200e*) data;
11841da177e4SLinus Torvalds     unsigned long flags;
11851da177e4SLinus Torvalds 
11861da177e4SLinus Torvalds     DPRINTK(3, "tx tasklet scheduled for device %d\n", fore200e->atm_dev->number);
11871da177e4SLinus Torvalds 
11881da177e4SLinus Torvalds     spin_lock_irqsave(&fore200e->q_lock, flags);
11891da177e4SLinus Torvalds     fore200e_tx_irq(fore200e);
11901da177e4SLinus Torvalds     spin_unlock_irqrestore(&fore200e->q_lock, flags);
11911da177e4SLinus Torvalds }
11921da177e4SLinus Torvalds 
11931da177e4SLinus Torvalds 
11941da177e4SLinus Torvalds static void
fore200e_rx_tasklet(unsigned long data)11951da177e4SLinus Torvalds fore200e_rx_tasklet(unsigned long data)
11961da177e4SLinus Torvalds {
11971da177e4SLinus Torvalds     struct fore200e* fore200e = (struct fore200e*) data;
11981da177e4SLinus Torvalds     unsigned long    flags;
11991da177e4SLinus Torvalds 
12001da177e4SLinus Torvalds     DPRINTK(3, "rx tasklet scheduled for device %d\n", fore200e->atm_dev->number);
12011da177e4SLinus Torvalds 
12021da177e4SLinus Torvalds     spin_lock_irqsave(&fore200e->q_lock, flags);
12031da177e4SLinus Torvalds     fore200e_rx_irq((struct fore200e*) data);
12041da177e4SLinus Torvalds     spin_unlock_irqrestore(&fore200e->q_lock, flags);
12051da177e4SLinus Torvalds }
12061da177e4SLinus Torvalds #endif
12071da177e4SLinus Torvalds 
12081da177e4SLinus Torvalds 
12091da177e4SLinus Torvalds static int
fore200e_select_scheme(struct atm_vcc * vcc)12101da177e4SLinus Torvalds fore200e_select_scheme(struct atm_vcc* vcc)
12111da177e4SLinus Torvalds {
12121da177e4SLinus Torvalds     /* fairly balance the VCs over (identical) buffer schemes */
12131da177e4SLinus Torvalds     int scheme = vcc->vci % 2 ? BUFFER_SCHEME_ONE : BUFFER_SCHEME_TWO;
12141da177e4SLinus Torvalds 
12151da177e4SLinus Torvalds     DPRINTK(1, "VC %d.%d.%d uses buffer scheme %d\n",
12161da177e4SLinus Torvalds 	    vcc->itf, vcc->vpi, vcc->vci, scheme);
12171da177e4SLinus Torvalds 
12181da177e4SLinus Torvalds     return scheme;
12191da177e4SLinus Torvalds }
12201da177e4SLinus Torvalds 
12211da177e4SLinus Torvalds 
12221da177e4SLinus Torvalds static int
fore200e_activate_vcin(struct fore200e * fore200e,int activate,struct atm_vcc * vcc,int mtu)12231da177e4SLinus Torvalds fore200e_activate_vcin(struct fore200e* fore200e, int activate, struct atm_vcc* vcc, int mtu)
12241da177e4SLinus Torvalds {
12251da177e4SLinus Torvalds     struct host_cmdq*        cmdq  = &fore200e->host_cmdq;
12261da177e4SLinus Torvalds     struct host_cmdq_entry*  entry = &cmdq->host_entry[ cmdq->head ];
12271da177e4SLinus Torvalds     struct activate_opcode   activ_opcode;
12281da177e4SLinus Torvalds     struct deactivate_opcode deactiv_opcode;
12291da177e4SLinus Torvalds     struct vpvc              vpvc;
12301da177e4SLinus Torvalds     int                      ok;
12311da177e4SLinus Torvalds     enum fore200e_aal        aal = fore200e_atm2fore_aal(vcc->qos.aal);
12321da177e4SLinus Torvalds 
12331da177e4SLinus Torvalds     FORE200E_NEXT_ENTRY(cmdq->head, QUEUE_SIZE_CMD);
12341da177e4SLinus Torvalds 
12351da177e4SLinus Torvalds     if (activate) {
12361da177e4SLinus Torvalds 	FORE200E_VCC(vcc)->scheme = fore200e_select_scheme(vcc);
12371da177e4SLinus Torvalds 
12381da177e4SLinus Torvalds 	activ_opcode.opcode = OPCODE_ACTIVATE_VCIN;
12391da177e4SLinus Torvalds 	activ_opcode.aal    = aal;
12401da177e4SLinus Torvalds 	activ_opcode.scheme = FORE200E_VCC(vcc)->scheme;
12411da177e4SLinus Torvalds 	activ_opcode.pad    = 0;
12421da177e4SLinus Torvalds     }
12431da177e4SLinus Torvalds     else {
12441da177e4SLinus Torvalds 	deactiv_opcode.opcode = OPCODE_DEACTIVATE_VCIN;
12451da177e4SLinus Torvalds 	deactiv_opcode.pad    = 0;
12461da177e4SLinus Torvalds     }
12471da177e4SLinus Torvalds 
12481da177e4SLinus Torvalds     vpvc.vci = vcc->vci;
12491da177e4SLinus Torvalds     vpvc.vpi = vcc->vpi;
12501da177e4SLinus Torvalds 
12511da177e4SLinus Torvalds     *entry->status = STATUS_PENDING;
12521da177e4SLinus Torvalds 
12531da177e4SLinus Torvalds     if (activate) {
12541da177e4SLinus Torvalds 
12551da177e4SLinus Torvalds #ifdef FORE200E_52BYTE_AAL0_SDU
12561da177e4SLinus Torvalds 	mtu = 48;
12571da177e4SLinus Torvalds #endif
12581da177e4SLinus Torvalds 	/* the MTU is not used by the cp, except in the case of AAL0 */
12591da177e4SLinus Torvalds 	fore200e->bus->write(mtu,                        &entry->cp_entry->cmd.activate_block.mtu);
12601da177e4SLinus Torvalds 	fore200e->bus->write(*(u32*)&vpvc,         (u32 __iomem *)&entry->cp_entry->cmd.activate_block.vpvc);
12611da177e4SLinus Torvalds 	fore200e->bus->write(*(u32*)&activ_opcode, (u32 __iomem *)&entry->cp_entry->cmd.activate_block.opcode);
12621da177e4SLinus Torvalds     }
12631da177e4SLinus Torvalds     else {
12641da177e4SLinus Torvalds 	fore200e->bus->write(*(u32*)&vpvc,         (u32 __iomem *)&entry->cp_entry->cmd.deactivate_block.vpvc);
12651da177e4SLinus Torvalds 	fore200e->bus->write(*(u32*)&deactiv_opcode, (u32 __iomem *)&entry->cp_entry->cmd.deactivate_block.opcode);
12661da177e4SLinus Torvalds     }
12671da177e4SLinus Torvalds 
12681da177e4SLinus Torvalds     ok = fore200e_poll(fore200e, entry->status, STATUS_COMPLETE, 400);
12691da177e4SLinus Torvalds 
12701da177e4SLinus Torvalds     *entry->status = STATUS_FREE;
12711da177e4SLinus Torvalds 
12721da177e4SLinus Torvalds     if (ok == 0) {
12731da177e4SLinus Torvalds 	printk(FORE200E "unable to %s VC %d.%d.%d\n",
12741da177e4SLinus Torvalds 	       activate ? "open" : "close", vcc->itf, vcc->vpi, vcc->vci);
12751da177e4SLinus Torvalds 	return -EIO;
12761da177e4SLinus Torvalds     }
12771da177e4SLinus Torvalds 
12781da177e4SLinus Torvalds     DPRINTK(1, "VC %d.%d.%d %sed\n", vcc->itf, vcc->vpi, vcc->vci,
12791da177e4SLinus Torvalds 	    activate ? "open" : "clos");
12801da177e4SLinus Torvalds 
12811da177e4SLinus Torvalds     return 0;
12821da177e4SLinus Torvalds }
12831da177e4SLinus Torvalds 
12841da177e4SLinus Torvalds 
12851da177e4SLinus Torvalds #define FORE200E_MAX_BACK2BACK_CELLS 255    /* XXX depends on CDVT */
12861da177e4SLinus Torvalds 
12871da177e4SLinus Torvalds static void
fore200e_rate_ctrl(struct atm_qos * qos,struct tpd_rate * rate)12881da177e4SLinus Torvalds fore200e_rate_ctrl(struct atm_qos* qos, struct tpd_rate* rate)
12891da177e4SLinus Torvalds {
12901da177e4SLinus Torvalds     if (qos->txtp.max_pcr < ATM_OC3_PCR) {
12911da177e4SLinus Torvalds 
12921da177e4SLinus Torvalds 	/* compute the data cells to idle cells ratio from the tx PCR */
12931da177e4SLinus Torvalds 	rate->data_cells = qos->txtp.max_pcr * FORE200E_MAX_BACK2BACK_CELLS / ATM_OC3_PCR;
12941da177e4SLinus Torvalds 	rate->idle_cells = FORE200E_MAX_BACK2BACK_CELLS - rate->data_cells;
12951da177e4SLinus Torvalds     }
12961da177e4SLinus Torvalds     else {
12971da177e4SLinus Torvalds 	/* disable rate control */
12981da177e4SLinus Torvalds 	rate->data_cells = rate->idle_cells = 0;
12991da177e4SLinus Torvalds     }
13001da177e4SLinus Torvalds }
13011da177e4SLinus Torvalds 
13021da177e4SLinus Torvalds 
13031da177e4SLinus Torvalds static int
fore200e_open(struct atm_vcc * vcc)13041da177e4SLinus Torvalds fore200e_open(struct atm_vcc *vcc)
13051da177e4SLinus Torvalds {
13061da177e4SLinus Torvalds     struct fore200e*        fore200e = FORE200E_DEV(vcc->dev);
13071da177e4SLinus Torvalds     struct fore200e_vcc*    fore200e_vcc;
13081da177e4SLinus Torvalds     struct fore200e_vc_map* vc_map;
13091da177e4SLinus Torvalds     unsigned long	    flags;
13101da177e4SLinus Torvalds     int			    vci = vcc->vci;
13111da177e4SLinus Torvalds     short		    vpi = vcc->vpi;
13121da177e4SLinus Torvalds 
13131da177e4SLinus Torvalds     ASSERT((vpi >= 0) && (vpi < 1<<FORE200E_VPI_BITS));
13141da177e4SLinus Torvalds     ASSERT((vci >= 0) && (vci < 1<<FORE200E_VCI_BITS));
13151da177e4SLinus Torvalds 
13161da177e4SLinus Torvalds     spin_lock_irqsave(&fore200e->q_lock, flags);
13171da177e4SLinus Torvalds 
13181da177e4SLinus Torvalds     vc_map = FORE200E_VC_MAP(fore200e, vpi, vci);
13191da177e4SLinus Torvalds     if (vc_map->vcc) {
13201da177e4SLinus Torvalds 
13211da177e4SLinus Torvalds 	spin_unlock_irqrestore(&fore200e->q_lock, flags);
13221da177e4SLinus Torvalds 
13231da177e4SLinus Torvalds 	printk(FORE200E "VC %d.%d.%d already in use\n",
13241da177e4SLinus Torvalds 	       fore200e->atm_dev->number, vpi, vci);
13251da177e4SLinus Torvalds 
13261da177e4SLinus Torvalds 	return -EINVAL;
13271da177e4SLinus Torvalds     }
13281da177e4SLinus Torvalds 
13291da177e4SLinus Torvalds     vc_map->vcc = vcc;
13301da177e4SLinus Torvalds 
13311da177e4SLinus Torvalds     spin_unlock_irqrestore(&fore200e->q_lock, flags);
13321da177e4SLinus Torvalds 
13331f8a5fb8SAdrian Bunk     fore200e_vcc = kzalloc(sizeof(struct fore200e_vcc), GFP_ATOMIC);
13341da177e4SLinus Torvalds     if (fore200e_vcc == NULL) {
13351da177e4SLinus Torvalds 	vc_map->vcc = NULL;
13361da177e4SLinus Torvalds 	return -ENOMEM;
13371da177e4SLinus Torvalds     }
13381da177e4SLinus Torvalds 
13391da177e4SLinus Torvalds     DPRINTK(2, "opening %d.%d.%d:%d QoS = (tx: cl=%s, pcr=%d-%d, cdv=%d, max_sdu=%d; "
13401da177e4SLinus Torvalds 	    "rx: cl=%s, pcr=%d-%d, cdv=%d, max_sdu=%d)\n",
13411da177e4SLinus Torvalds 	    vcc->itf, vcc->vpi, vcc->vci, fore200e_atm2fore_aal(vcc->qos.aal),
13421da177e4SLinus Torvalds 	    fore200e_traffic_class[ vcc->qos.txtp.traffic_class ],
13431da177e4SLinus Torvalds 	    vcc->qos.txtp.min_pcr, vcc->qos.txtp.max_pcr, vcc->qos.txtp.max_cdv, vcc->qos.txtp.max_sdu,
13441da177e4SLinus Torvalds 	    fore200e_traffic_class[ vcc->qos.rxtp.traffic_class ],
13451da177e4SLinus Torvalds 	    vcc->qos.rxtp.min_pcr, vcc->qos.rxtp.max_pcr, vcc->qos.rxtp.max_cdv, vcc->qos.rxtp.max_sdu);
13461da177e4SLinus Torvalds 
13471da177e4SLinus Torvalds     /* pseudo-CBR bandwidth requested? */
13481da177e4SLinus Torvalds     if ((vcc->qos.txtp.traffic_class == ATM_CBR) && (vcc->qos.txtp.max_pcr > 0)) {
13491da177e4SLinus Torvalds 
1350bfbf3c09SMatthias Kaehlcke 	mutex_lock(&fore200e->rate_mtx);
13511da177e4SLinus Torvalds 	if (fore200e->available_cell_rate < vcc->qos.txtp.max_pcr) {
1352bfbf3c09SMatthias Kaehlcke 	    mutex_unlock(&fore200e->rate_mtx);
13531da177e4SLinus Torvalds 
13541f8a5fb8SAdrian Bunk 	    kfree(fore200e_vcc);
13551da177e4SLinus Torvalds 	    vc_map->vcc = NULL;
13561da177e4SLinus Torvalds 	    return -EAGAIN;
13571da177e4SLinus Torvalds 	}
13581da177e4SLinus Torvalds 
13591da177e4SLinus Torvalds 	/* reserve bandwidth */
13601da177e4SLinus Torvalds 	fore200e->available_cell_rate -= vcc->qos.txtp.max_pcr;
1361bfbf3c09SMatthias Kaehlcke 	mutex_unlock(&fore200e->rate_mtx);
13621da177e4SLinus Torvalds     }
13631da177e4SLinus Torvalds 
13641da177e4SLinus Torvalds     vcc->itf = vcc->dev->number;
13651da177e4SLinus Torvalds 
13661da177e4SLinus Torvalds     set_bit(ATM_VF_PARTIAL,&vcc->flags);
13671da177e4SLinus Torvalds     set_bit(ATM_VF_ADDR, &vcc->flags);
13681da177e4SLinus Torvalds 
13691da177e4SLinus Torvalds     vcc->dev_data = fore200e_vcc;
13701da177e4SLinus Torvalds 
13711da177e4SLinus Torvalds     if (fore200e_activate_vcin(fore200e, 1, vcc, vcc->qos.rxtp.max_sdu) < 0) {
13721da177e4SLinus Torvalds 
13731da177e4SLinus Torvalds 	vc_map->vcc = NULL;
13741da177e4SLinus Torvalds 
13751da177e4SLinus Torvalds 	clear_bit(ATM_VF_ADDR, &vcc->flags);
13761da177e4SLinus Torvalds 	clear_bit(ATM_VF_PARTIAL,&vcc->flags);
13771da177e4SLinus Torvalds 
13781da177e4SLinus Torvalds 	vcc->dev_data = NULL;
13791da177e4SLinus Torvalds 
13801da177e4SLinus Torvalds 	fore200e->available_cell_rate += vcc->qos.txtp.max_pcr;
13811da177e4SLinus Torvalds 
13821f8a5fb8SAdrian Bunk 	kfree(fore200e_vcc);
13831da177e4SLinus Torvalds 	return -EINVAL;
13841da177e4SLinus Torvalds     }
13851da177e4SLinus Torvalds 
13861da177e4SLinus Torvalds     /* compute rate control parameters */
13871da177e4SLinus Torvalds     if ((vcc->qos.txtp.traffic_class == ATM_CBR) && (vcc->qos.txtp.max_pcr > 0)) {
13881da177e4SLinus Torvalds 
13891da177e4SLinus Torvalds 	fore200e_rate_ctrl(&vcc->qos, &fore200e_vcc->rate);
13901da177e4SLinus Torvalds 	set_bit(ATM_VF_HASQOS, &vcc->flags);
13911da177e4SLinus Torvalds 
13921da177e4SLinus Torvalds 	DPRINTK(3, "tx on %d.%d.%d:%d, tx PCR = %d, rx PCR = %d, data_cells = %u, idle_cells = %u\n",
13931da177e4SLinus Torvalds 		vcc->itf, vcc->vpi, vcc->vci, fore200e_atm2fore_aal(vcc->qos.aal),
13941da177e4SLinus Torvalds 		vcc->qos.txtp.max_pcr, vcc->qos.rxtp.max_pcr,
13951da177e4SLinus Torvalds 		fore200e_vcc->rate.data_cells, fore200e_vcc->rate.idle_cells);
13961da177e4SLinus Torvalds     }
13971da177e4SLinus Torvalds 
13981da177e4SLinus Torvalds     fore200e_vcc->tx_min_pdu = fore200e_vcc->rx_min_pdu = MAX_PDU_SIZE + 1;
13991da177e4SLinus Torvalds     fore200e_vcc->tx_max_pdu = fore200e_vcc->rx_max_pdu = 0;
14001da177e4SLinus Torvalds     fore200e_vcc->tx_pdu     = fore200e_vcc->rx_pdu     = 0;
14011da177e4SLinus Torvalds 
14021da177e4SLinus Torvalds     /* new incarnation of the vcc */
14031da177e4SLinus Torvalds     vc_map->incarn = ++fore200e->incarn_count;
14041da177e4SLinus Torvalds 
14051da177e4SLinus Torvalds     /* VC unusable before this flag is set */
14061da177e4SLinus Torvalds     set_bit(ATM_VF_READY, &vcc->flags);
14071da177e4SLinus Torvalds 
14081da177e4SLinus Torvalds     return 0;
14091da177e4SLinus Torvalds }
14101da177e4SLinus Torvalds 
14111da177e4SLinus Torvalds 
14121da177e4SLinus Torvalds static void
fore200e_close(struct atm_vcc * vcc)14131da177e4SLinus Torvalds fore200e_close(struct atm_vcc* vcc)
14141da177e4SLinus Torvalds {
14151da177e4SLinus Torvalds     struct fore200e_vcc*    fore200e_vcc;
1416bbd20c93SAditya Pakki     struct fore200e*        fore200e;
14171da177e4SLinus Torvalds     struct fore200e_vc_map* vc_map;
14181da177e4SLinus Torvalds     unsigned long           flags;
14191da177e4SLinus Torvalds 
14201da177e4SLinus Torvalds     ASSERT(vcc);
1421bbd20c93SAditya Pakki     fore200e = FORE200E_DEV(vcc->dev);
1422bbd20c93SAditya Pakki 
14231da177e4SLinus Torvalds     ASSERT((vcc->vpi >= 0) && (vcc->vpi < 1<<FORE200E_VPI_BITS));
14241da177e4SLinus Torvalds     ASSERT((vcc->vci >= 0) && (vcc->vci < 1<<FORE200E_VCI_BITS));
14251da177e4SLinus Torvalds 
14261da177e4SLinus Torvalds     DPRINTK(2, "closing %d.%d.%d:%d\n", vcc->itf, vcc->vpi, vcc->vci, fore200e_atm2fore_aal(vcc->qos.aal));
14271da177e4SLinus Torvalds 
14281da177e4SLinus Torvalds     clear_bit(ATM_VF_READY, &vcc->flags);
14291da177e4SLinus Torvalds 
14301da177e4SLinus Torvalds     fore200e_activate_vcin(fore200e, 0, vcc, 0);
14311da177e4SLinus Torvalds 
14321da177e4SLinus Torvalds     spin_lock_irqsave(&fore200e->q_lock, flags);
14331da177e4SLinus Torvalds 
14341da177e4SLinus Torvalds     vc_map = FORE200E_VC_MAP(fore200e, vcc->vpi, vcc->vci);
14351da177e4SLinus Torvalds 
14361da177e4SLinus Torvalds     /* the vc is no longer considered as "in use" by fore200e_open() */
14371da177e4SLinus Torvalds     vc_map->vcc = NULL;
14381da177e4SLinus Torvalds 
14391da177e4SLinus Torvalds     vcc->itf = vcc->vci = vcc->vpi = 0;
14401da177e4SLinus Torvalds 
14411da177e4SLinus Torvalds     fore200e_vcc = FORE200E_VCC(vcc);
14421da177e4SLinus Torvalds     vcc->dev_data = NULL;
14431da177e4SLinus Torvalds 
14441da177e4SLinus Torvalds     spin_unlock_irqrestore(&fore200e->q_lock, flags);
14451da177e4SLinus Torvalds 
14461da177e4SLinus Torvalds     /* release reserved bandwidth, if any */
14471da177e4SLinus Torvalds     if ((vcc->qos.txtp.traffic_class == ATM_CBR) && (vcc->qos.txtp.max_pcr > 0)) {
14481da177e4SLinus Torvalds 
1449bfbf3c09SMatthias Kaehlcke 	mutex_lock(&fore200e->rate_mtx);
14501da177e4SLinus Torvalds 	fore200e->available_cell_rate += vcc->qos.txtp.max_pcr;
1451bfbf3c09SMatthias Kaehlcke 	mutex_unlock(&fore200e->rate_mtx);
14521da177e4SLinus Torvalds 
14531da177e4SLinus Torvalds 	clear_bit(ATM_VF_HASQOS, &vcc->flags);
14541da177e4SLinus Torvalds     }
14551da177e4SLinus Torvalds 
14561da177e4SLinus Torvalds     clear_bit(ATM_VF_ADDR, &vcc->flags);
14571da177e4SLinus Torvalds     clear_bit(ATM_VF_PARTIAL,&vcc->flags);
14581da177e4SLinus Torvalds 
14591da177e4SLinus Torvalds     ASSERT(fore200e_vcc);
14601f8a5fb8SAdrian Bunk     kfree(fore200e_vcc);
14611da177e4SLinus Torvalds }
14621da177e4SLinus Torvalds 
14631da177e4SLinus Torvalds 
14641da177e4SLinus Torvalds static int
fore200e_send(struct atm_vcc * vcc,struct sk_buff * skb)14651da177e4SLinus Torvalds fore200e_send(struct atm_vcc *vcc, struct sk_buff *skb)
14661da177e4SLinus Torvalds {
1467bbd20c93SAditya Pakki     struct fore200e*        fore200e;
1468bbd20c93SAditya Pakki     struct fore200e_vcc*    fore200e_vcc;
14691da177e4SLinus Torvalds     struct fore200e_vc_map* vc_map;
1470bbd20c93SAditya Pakki     struct host_txq*        txq;
14711da177e4SLinus Torvalds     struct host_txq_entry*  entry;
14721da177e4SLinus Torvalds     struct tpd*             tpd;
14731da177e4SLinus Torvalds     struct tpd_haddr        tpd_haddr;
14741da177e4SLinus Torvalds     int                     retry        = CONFIG_ATM_FORE200E_TX_RETRY;
14751da177e4SLinus Torvalds     int                     tx_copy      = 0;
14761da177e4SLinus Torvalds     int                     tx_len       = skb->len;
14771da177e4SLinus Torvalds     u32*                    cell_header  = NULL;
14781da177e4SLinus Torvalds     unsigned char*          skb_data;
14791da177e4SLinus Torvalds     int                     skb_len;
14801da177e4SLinus Torvalds     unsigned char*          data;
14811da177e4SLinus Torvalds     unsigned long           flags;
14821da177e4SLinus Torvalds 
1483bbd20c93SAditya Pakki     if (!vcc)
1484bbd20c93SAditya Pakki         return -EINVAL;
1485bbd20c93SAditya Pakki 
1486bbd20c93SAditya Pakki     fore200e = FORE200E_DEV(vcc->dev);
1487bbd20c93SAditya Pakki     fore200e_vcc = FORE200E_VCC(vcc);
1488bbd20c93SAditya Pakki 
1489bbd20c93SAditya Pakki     if (!fore200e)
1490bbd20c93SAditya Pakki         return -EINVAL;
1491bbd20c93SAditya Pakki 
1492bbd20c93SAditya Pakki     txq = &fore200e->host_txq;
1493bbd20c93SAditya Pakki     if (!fore200e_vcc)
1494bbd20c93SAditya Pakki         return -EINVAL;
14951da177e4SLinus Torvalds 
14961da177e4SLinus Torvalds     if (!test_bit(ATM_VF_READY, &vcc->flags)) {
14971da177e4SLinus Torvalds 	DPRINTK(1, "VC %d.%d.%d not ready for tx\n", vcc->itf, vcc->vpi, vcc->vpi);
14981da177e4SLinus Torvalds 	dev_kfree_skb_any(skb);
14991da177e4SLinus Torvalds 	return -EINVAL;
15001da177e4SLinus Torvalds     }
15011da177e4SLinus Torvalds 
15021da177e4SLinus Torvalds #ifdef FORE200E_52BYTE_AAL0_SDU
15031da177e4SLinus Torvalds     if ((vcc->qos.aal == ATM_AAL0) && (vcc->qos.txtp.max_sdu == ATM_AAL0_SDU)) {
15041da177e4SLinus Torvalds 	cell_header = (u32*) skb->data;
15051da177e4SLinus Torvalds 	skb_data    = skb->data + 4;    /* skip 4-byte cell header */
15061da177e4SLinus Torvalds 	skb_len     = tx_len = skb->len  - 4;
15071da177e4SLinus Torvalds 
15081da177e4SLinus Torvalds 	DPRINTK(3, "user-supplied cell header = 0x%08x\n", *cell_header);
15091da177e4SLinus Torvalds     }
15101da177e4SLinus Torvalds     else
15111da177e4SLinus Torvalds #endif
15121da177e4SLinus Torvalds     {
15131da177e4SLinus Torvalds 	skb_data = skb->data;
15141da177e4SLinus Torvalds 	skb_len  = skb->len;
15151da177e4SLinus Torvalds     }
15161da177e4SLinus Torvalds 
15171da177e4SLinus Torvalds     if (((unsigned long)skb_data) & 0x3) {
15181da177e4SLinus Torvalds 
15191da177e4SLinus Torvalds 	DPRINTK(2, "misaligned tx PDU on device %s\n", fore200e->name);
15201da177e4SLinus Torvalds 	tx_copy = 1;
15211da177e4SLinus Torvalds 	tx_len  = skb_len;
15221da177e4SLinus Torvalds     }
15231da177e4SLinus Torvalds 
15241da177e4SLinus Torvalds     if ((vcc->qos.aal == ATM_AAL0) && (skb_len % ATM_CELL_PAYLOAD)) {
15251da177e4SLinus Torvalds 
15261da177e4SLinus Torvalds         /* this simply NUKES the PCA board */
15271da177e4SLinus Torvalds 	DPRINTK(2, "incomplete tx AAL0 PDU on device %s\n", fore200e->name);
15281da177e4SLinus Torvalds 	tx_copy = 1;
15291da177e4SLinus Torvalds 	tx_len  = ((skb_len / ATM_CELL_PAYLOAD) + 1) * ATM_CELL_PAYLOAD;
15301da177e4SLinus Torvalds     }
15311da177e4SLinus Torvalds 
15321da177e4SLinus Torvalds     if (tx_copy) {
15330e21b225SChristoph Hellwig 	data = kmalloc(tx_len, GFP_ATOMIC);
15341da177e4SLinus Torvalds 	if (data == NULL) {
15351da177e4SLinus Torvalds 	    if (vcc->pop) {
15361da177e4SLinus Torvalds 		vcc->pop(vcc, skb);
15371da177e4SLinus Torvalds 	    }
15381da177e4SLinus Torvalds 	    else {
15391da177e4SLinus Torvalds 		dev_kfree_skb_any(skb);
15401da177e4SLinus Torvalds 	    }
15411da177e4SLinus Torvalds 	    return -ENOMEM;
15421da177e4SLinus Torvalds 	}
15431da177e4SLinus Torvalds 
15441da177e4SLinus Torvalds 	memcpy(data, skb_data, skb_len);
15451da177e4SLinus Torvalds 	if (skb_len < tx_len)
15461da177e4SLinus Torvalds 	    memset(data + skb_len, 0x00, tx_len - skb_len);
15471da177e4SLinus Torvalds     }
15481da177e4SLinus Torvalds     else {
15491da177e4SLinus Torvalds 	data = skb_data;
15501da177e4SLinus Torvalds     }
15511da177e4SLinus Torvalds 
15521da177e4SLinus Torvalds     vc_map = FORE200E_VC_MAP(fore200e, vcc->vpi, vcc->vci);
15531da177e4SLinus Torvalds     ASSERT(vc_map->vcc == vcc);
15541da177e4SLinus Torvalds 
15551da177e4SLinus Torvalds   retry_here:
15561da177e4SLinus Torvalds 
15571da177e4SLinus Torvalds     spin_lock_irqsave(&fore200e->q_lock, flags);
15581da177e4SLinus Torvalds 
15591da177e4SLinus Torvalds     entry = &txq->host_entry[ txq->head ];
15601da177e4SLinus Torvalds 
15611da177e4SLinus Torvalds     if ((*entry->status != STATUS_FREE) || (txq->txing >= QUEUE_SIZE_TX - 2)) {
15621da177e4SLinus Torvalds 
15631da177e4SLinus Torvalds 	/* try to free completed tx queue entries */
15641da177e4SLinus Torvalds 	fore200e_tx_irq(fore200e);
15651da177e4SLinus Torvalds 
15661da177e4SLinus Torvalds 	if (*entry->status != STATUS_FREE) {
15671da177e4SLinus Torvalds 
15681da177e4SLinus Torvalds 	    spin_unlock_irqrestore(&fore200e->q_lock, flags);
15691da177e4SLinus Torvalds 
15701da177e4SLinus Torvalds 	    /* retry once again? */
15711da177e4SLinus Torvalds 	    if (--retry > 0) {
15721da177e4SLinus Torvalds 		udelay(50);
15731da177e4SLinus Torvalds 		goto retry_here;
15741da177e4SLinus Torvalds 	    }
15751da177e4SLinus Torvalds 
15761da177e4SLinus Torvalds 	    atomic_inc(&vcc->stats->tx_err);
15771da177e4SLinus Torvalds 
15781da177e4SLinus Torvalds 	    fore200e->tx_sat++;
15791da177e4SLinus Torvalds 	    DPRINTK(2, "tx queue of device %s is saturated, PDU dropped - heartbeat is %08x\n",
15801da177e4SLinus Torvalds 		    fore200e->name, fore200e->cp_queues->heartbeat);
15811da177e4SLinus Torvalds 	    if (vcc->pop) {
15821da177e4SLinus Torvalds 		vcc->pop(vcc, skb);
15831da177e4SLinus Torvalds 	    }
15841da177e4SLinus Torvalds 	    else {
15851da177e4SLinus Torvalds 		dev_kfree_skb_any(skb);
15861da177e4SLinus Torvalds 	    }
15871da177e4SLinus Torvalds 
15881da177e4SLinus Torvalds 	    if (tx_copy)
15891da177e4SLinus Torvalds 		kfree(data);
15901da177e4SLinus Torvalds 
15911da177e4SLinus Torvalds 	    return -ENOBUFS;
15921da177e4SLinus Torvalds 	}
15931da177e4SLinus Torvalds     }
15941da177e4SLinus Torvalds 
15951da177e4SLinus Torvalds     entry->incarn = vc_map->incarn;
15961da177e4SLinus Torvalds     entry->vc_map = vc_map;
15971da177e4SLinus Torvalds     entry->skb    = skb;
15981da177e4SLinus Torvalds     entry->data   = tx_copy ? data : NULL;
15991da177e4SLinus Torvalds 
16001da177e4SLinus Torvalds     tpd = entry->tpd;
1601f3fadcb5SChristoph Hellwig     tpd->tsd[ 0 ].buffer = dma_map_single(fore200e->dev, data, tx_len,
1602f3fadcb5SChristoph Hellwig 					  DMA_TO_DEVICE);
16031d9d8be9SChristoph Hellwig     if (dma_mapping_error(fore200e->dev, tpd->tsd[0].buffer)) {
16041d9d8be9SChristoph Hellwig 	if (tx_copy)
16051d9d8be9SChristoph Hellwig 	    kfree(data);
1606d275444cSWei Yongjun 	spin_unlock_irqrestore(&fore200e->q_lock, flags);
16071d9d8be9SChristoph Hellwig 	return -ENOMEM;
16081d9d8be9SChristoph Hellwig     }
16091da177e4SLinus Torvalds     tpd->tsd[ 0 ].length = tx_len;
16101da177e4SLinus Torvalds 
16111da177e4SLinus Torvalds     FORE200E_NEXT_ENTRY(txq->head, QUEUE_SIZE_TX);
16121da177e4SLinus Torvalds     txq->txing++;
16131da177e4SLinus Torvalds 
16141da177e4SLinus Torvalds     /* The dma_map call above implies a dma_sync so the device can use it,
16151da177e4SLinus Torvalds      * thus no explicit dma_sync call is necessary here.
16161da177e4SLinus Torvalds      */
16171da177e4SLinus Torvalds 
16181da177e4SLinus Torvalds     DPRINTK(3, "tx on %d.%d.%d:%d, len = %u (%u)\n",
16191da177e4SLinus Torvalds 	    vcc->itf, vcc->vpi, vcc->vci, fore200e_atm2fore_aal(vcc->qos.aal),
16201da177e4SLinus Torvalds 	    tpd->tsd[0].length, skb_len);
16211da177e4SLinus Torvalds 
16221da177e4SLinus Torvalds     if (skb_len < fore200e_vcc->tx_min_pdu)
16231da177e4SLinus Torvalds 	fore200e_vcc->tx_min_pdu = skb_len;
16241da177e4SLinus Torvalds     if (skb_len > fore200e_vcc->tx_max_pdu)
16251da177e4SLinus Torvalds 	fore200e_vcc->tx_max_pdu = skb_len;
16261da177e4SLinus Torvalds     fore200e_vcc->tx_pdu++;
16271da177e4SLinus Torvalds 
16281da177e4SLinus Torvalds     /* set tx rate control information */
16291da177e4SLinus Torvalds     tpd->rate.data_cells = fore200e_vcc->rate.data_cells;
16301da177e4SLinus Torvalds     tpd->rate.idle_cells = fore200e_vcc->rate.idle_cells;
16311da177e4SLinus Torvalds 
16321da177e4SLinus Torvalds     if (cell_header) {
16331da177e4SLinus Torvalds 	tpd->atm_header.clp = (*cell_header & ATM_HDR_CLP);
16341da177e4SLinus Torvalds 	tpd->atm_header.plt = (*cell_header & ATM_HDR_PTI_MASK) >> ATM_HDR_PTI_SHIFT;
16351da177e4SLinus Torvalds 	tpd->atm_header.vci = (*cell_header & ATM_HDR_VCI_MASK) >> ATM_HDR_VCI_SHIFT;
16361da177e4SLinus Torvalds 	tpd->atm_header.vpi = (*cell_header & ATM_HDR_VPI_MASK) >> ATM_HDR_VPI_SHIFT;
16371da177e4SLinus Torvalds 	tpd->atm_header.gfc = (*cell_header & ATM_HDR_GFC_MASK) >> ATM_HDR_GFC_SHIFT;
16381da177e4SLinus Torvalds     }
16391da177e4SLinus Torvalds     else {
16401da177e4SLinus Torvalds 	/* set the ATM header, common to all cells conveying the PDU */
16411da177e4SLinus Torvalds 	tpd->atm_header.clp = 0;
16421da177e4SLinus Torvalds 	tpd->atm_header.plt = 0;
16431da177e4SLinus Torvalds 	tpd->atm_header.vci = vcc->vci;
16441da177e4SLinus Torvalds 	tpd->atm_header.vpi = vcc->vpi;
16451da177e4SLinus Torvalds 	tpd->atm_header.gfc = 0;
16461da177e4SLinus Torvalds     }
16471da177e4SLinus Torvalds 
16481da177e4SLinus Torvalds     tpd->spec.length = tx_len;
16491da177e4SLinus Torvalds     tpd->spec.nseg   = 1;
16501da177e4SLinus Torvalds     tpd->spec.aal    = fore200e_atm2fore_aal(vcc->qos.aal);
16511da177e4SLinus Torvalds     tpd->spec.intr   = 1;
16521da177e4SLinus Torvalds 
16531da177e4SLinus Torvalds     tpd_haddr.size  = sizeof(struct tpd) / (1<<TPD_HADDR_SHIFT);  /* size is expressed in 32 byte blocks */
16541da177e4SLinus Torvalds     tpd_haddr.pad   = 0;
16551da177e4SLinus Torvalds     tpd_haddr.haddr = entry->tpd_dma >> TPD_HADDR_SHIFT;          /* shift the address, as we are in a bitfield */
16561da177e4SLinus Torvalds 
16571da177e4SLinus Torvalds     *entry->status = STATUS_PENDING;
16581da177e4SLinus Torvalds     fore200e->bus->write(*(u32*)&tpd_haddr, (u32 __iomem *)&entry->cp_entry->tpd_haddr);
16591da177e4SLinus Torvalds 
16601da177e4SLinus Torvalds     spin_unlock_irqrestore(&fore200e->q_lock, flags);
16611da177e4SLinus Torvalds 
16621da177e4SLinus Torvalds     return 0;
16631da177e4SLinus Torvalds }
16641da177e4SLinus Torvalds 
16651da177e4SLinus Torvalds 
16661da177e4SLinus Torvalds static int
fore200e_getstats(struct fore200e * fore200e)16671da177e4SLinus Torvalds fore200e_getstats(struct fore200e* fore200e)
16681da177e4SLinus Torvalds {
16691da177e4SLinus Torvalds     struct host_cmdq*       cmdq  = &fore200e->host_cmdq;
16701da177e4SLinus Torvalds     struct host_cmdq_entry* entry = &cmdq->host_entry[ cmdq->head ];
16711da177e4SLinus Torvalds     struct stats_opcode     opcode;
16721da177e4SLinus Torvalds     int                     ok;
16731da177e4SLinus Torvalds     u32                     stats_dma_addr;
16741da177e4SLinus Torvalds 
16751da177e4SLinus Torvalds     if (fore200e->stats == NULL) {
16760e21b225SChristoph Hellwig 	fore200e->stats = kzalloc(sizeof(struct stats), GFP_KERNEL);
16771da177e4SLinus Torvalds 	if (fore200e->stats == NULL)
16781da177e4SLinus Torvalds 	    return -ENOMEM;
16791da177e4SLinus Torvalds     }
16801da177e4SLinus Torvalds 
1681f3fadcb5SChristoph Hellwig     stats_dma_addr = dma_map_single(fore200e->dev, fore200e->stats,
16821da177e4SLinus Torvalds 				    sizeof(struct stats), DMA_FROM_DEVICE);
16831d9d8be9SChristoph Hellwig     if (dma_mapping_error(fore200e->dev, stats_dma_addr))
16841d9d8be9SChristoph Hellwig     	return -ENOMEM;
16851da177e4SLinus Torvalds 
16861da177e4SLinus Torvalds     FORE200E_NEXT_ENTRY(cmdq->head, QUEUE_SIZE_CMD);
16871da177e4SLinus Torvalds 
16881da177e4SLinus Torvalds     opcode.opcode = OPCODE_GET_STATS;
16891da177e4SLinus Torvalds     opcode.pad    = 0;
16901da177e4SLinus Torvalds 
16911da177e4SLinus Torvalds     fore200e->bus->write(stats_dma_addr, &entry->cp_entry->cmd.stats_block.stats_haddr);
16921da177e4SLinus Torvalds 
16931da177e4SLinus Torvalds     *entry->status = STATUS_PENDING;
16941da177e4SLinus Torvalds 
16951da177e4SLinus Torvalds     fore200e->bus->write(*(u32*)&opcode, (u32 __iomem *)&entry->cp_entry->cmd.stats_block.opcode);
16961da177e4SLinus Torvalds 
16971da177e4SLinus Torvalds     ok = fore200e_poll(fore200e, entry->status, STATUS_COMPLETE, 400);
16981da177e4SLinus Torvalds 
16991da177e4SLinus Torvalds     *entry->status = STATUS_FREE;
17001da177e4SLinus Torvalds 
1701f3fadcb5SChristoph Hellwig     dma_unmap_single(fore200e->dev, stats_dma_addr, sizeof(struct stats), DMA_FROM_DEVICE);
17021da177e4SLinus Torvalds 
17031da177e4SLinus Torvalds     if (ok == 0) {
17041da177e4SLinus Torvalds 	printk(FORE200E "unable to get statistics from device %s\n", fore200e->name);
17051da177e4SLinus Torvalds 	return -EIO;
17061da177e4SLinus Torvalds     }
17071da177e4SLinus Torvalds 
17081da177e4SLinus Torvalds     return 0;
17091da177e4SLinus Torvalds }
17101da177e4SLinus Torvalds 
17111da177e4SLinus Torvalds #if 0 /* currently unused */
17121da177e4SLinus Torvalds static int
17131da177e4SLinus Torvalds fore200e_get_oc3(struct fore200e* fore200e, struct oc3_regs* regs)
17141da177e4SLinus Torvalds {
17151da177e4SLinus Torvalds     struct host_cmdq*       cmdq  = &fore200e->host_cmdq;
17161da177e4SLinus Torvalds     struct host_cmdq_entry* entry = &cmdq->host_entry[ cmdq->head ];
17171da177e4SLinus Torvalds     struct oc3_opcode       opcode;
17181da177e4SLinus Torvalds     int                     ok;
17191da177e4SLinus Torvalds     u32                     oc3_regs_dma_addr;
17201da177e4SLinus Torvalds 
17211da177e4SLinus Torvalds     oc3_regs_dma_addr = fore200e->bus->dma_map(fore200e, regs, sizeof(struct oc3_regs), DMA_FROM_DEVICE);
17221da177e4SLinus Torvalds 
17231da177e4SLinus Torvalds     FORE200E_NEXT_ENTRY(cmdq->head, QUEUE_SIZE_CMD);
17241da177e4SLinus Torvalds 
17251da177e4SLinus Torvalds     opcode.opcode = OPCODE_GET_OC3;
17261da177e4SLinus Torvalds     opcode.reg    = 0;
17271da177e4SLinus Torvalds     opcode.value  = 0;
17281da177e4SLinus Torvalds     opcode.mask   = 0;
17291da177e4SLinus Torvalds 
17301da177e4SLinus Torvalds     fore200e->bus->write(oc3_regs_dma_addr, &entry->cp_entry->cmd.oc3_block.regs_haddr);
17311da177e4SLinus Torvalds 
17321da177e4SLinus Torvalds     *entry->status = STATUS_PENDING;
17331da177e4SLinus Torvalds 
17341da177e4SLinus Torvalds     fore200e->bus->write(*(u32*)&opcode, (u32*)&entry->cp_entry->cmd.oc3_block.opcode);
17351da177e4SLinus Torvalds 
17361da177e4SLinus Torvalds     ok = fore200e_poll(fore200e, entry->status, STATUS_COMPLETE, 400);
17371da177e4SLinus Torvalds 
17381da177e4SLinus Torvalds     *entry->status = STATUS_FREE;
17391da177e4SLinus Torvalds 
17401da177e4SLinus Torvalds     fore200e->bus->dma_unmap(fore200e, oc3_regs_dma_addr, sizeof(struct oc3_regs), DMA_FROM_DEVICE);
17411da177e4SLinus Torvalds 
17421da177e4SLinus Torvalds     if (ok == 0) {
17431da177e4SLinus Torvalds 	printk(FORE200E "unable to get OC-3 regs of device %s\n", fore200e->name);
17441da177e4SLinus Torvalds 	return -EIO;
17451da177e4SLinus Torvalds     }
17461da177e4SLinus Torvalds 
17471da177e4SLinus Torvalds     return 0;
17481da177e4SLinus Torvalds }
17491da177e4SLinus Torvalds #endif
17501da177e4SLinus Torvalds 
17511da177e4SLinus Torvalds 
17521da177e4SLinus Torvalds static int
fore200e_set_oc3(struct fore200e * fore200e,u32 reg,u32 value,u32 mask)17531da177e4SLinus Torvalds fore200e_set_oc3(struct fore200e* fore200e, u32 reg, u32 value, u32 mask)
17541da177e4SLinus Torvalds {
17551da177e4SLinus Torvalds     struct host_cmdq*       cmdq  = &fore200e->host_cmdq;
17561da177e4SLinus Torvalds     struct host_cmdq_entry* entry = &cmdq->host_entry[ cmdq->head ];
17571da177e4SLinus Torvalds     struct oc3_opcode       opcode;
17581da177e4SLinus Torvalds     int                     ok;
17591da177e4SLinus Torvalds 
17601da177e4SLinus Torvalds     DPRINTK(2, "set OC-3 reg = 0x%02x, value = 0x%02x, mask = 0x%02x\n", reg, value, mask);
17611da177e4SLinus Torvalds 
17621da177e4SLinus Torvalds     FORE200E_NEXT_ENTRY(cmdq->head, QUEUE_SIZE_CMD);
17631da177e4SLinus Torvalds 
17641da177e4SLinus Torvalds     opcode.opcode = OPCODE_SET_OC3;
17651da177e4SLinus Torvalds     opcode.reg    = reg;
17661da177e4SLinus Torvalds     opcode.value  = value;
17671da177e4SLinus Torvalds     opcode.mask   = mask;
17681da177e4SLinus Torvalds 
17691da177e4SLinus Torvalds     fore200e->bus->write(0, &entry->cp_entry->cmd.oc3_block.regs_haddr);
17701da177e4SLinus Torvalds 
17711da177e4SLinus Torvalds     *entry->status = STATUS_PENDING;
17721da177e4SLinus Torvalds 
17731da177e4SLinus Torvalds     fore200e->bus->write(*(u32*)&opcode, (u32 __iomem *)&entry->cp_entry->cmd.oc3_block.opcode);
17741da177e4SLinus Torvalds 
17751da177e4SLinus Torvalds     ok = fore200e_poll(fore200e, entry->status, STATUS_COMPLETE, 400);
17761da177e4SLinus Torvalds 
17771da177e4SLinus Torvalds     *entry->status = STATUS_FREE;
17781da177e4SLinus Torvalds 
17791da177e4SLinus Torvalds     if (ok == 0) {
17801da177e4SLinus Torvalds 	printk(FORE200E "unable to set OC-3 reg 0x%02x of device %s\n", reg, fore200e->name);
17811da177e4SLinus Torvalds 	return -EIO;
17821da177e4SLinus Torvalds     }
17831da177e4SLinus Torvalds 
17841da177e4SLinus Torvalds     return 0;
17851da177e4SLinus Torvalds }
17861da177e4SLinus Torvalds 
17871da177e4SLinus Torvalds 
17881da177e4SLinus Torvalds static int
fore200e_setloop(struct fore200e * fore200e,int loop_mode)17891da177e4SLinus Torvalds fore200e_setloop(struct fore200e* fore200e, int loop_mode)
17901da177e4SLinus Torvalds {
17911da177e4SLinus Torvalds     u32 mct_value, mct_mask;
17921da177e4SLinus Torvalds     int error;
17931da177e4SLinus Torvalds 
17941da177e4SLinus Torvalds     if (!capable(CAP_NET_ADMIN))
17951da177e4SLinus Torvalds 	return -EPERM;
17961da177e4SLinus Torvalds 
17971da177e4SLinus Torvalds     switch (loop_mode) {
17981da177e4SLinus Torvalds 
17991da177e4SLinus Torvalds     case ATM_LM_NONE:
18001da177e4SLinus Torvalds 	mct_value = 0;
18011da177e4SLinus Torvalds 	mct_mask  = SUNI_MCT_DLE | SUNI_MCT_LLE;
18021da177e4SLinus Torvalds 	break;
18031da177e4SLinus Torvalds 
18041da177e4SLinus Torvalds     case ATM_LM_LOC_PHY:
18051da177e4SLinus Torvalds 	mct_value = mct_mask = SUNI_MCT_DLE;
18061da177e4SLinus Torvalds 	break;
18071da177e4SLinus Torvalds 
18081da177e4SLinus Torvalds     case ATM_LM_RMT_PHY:
18091da177e4SLinus Torvalds 	mct_value = mct_mask = SUNI_MCT_LLE;
18101da177e4SLinus Torvalds 	break;
18111da177e4SLinus Torvalds 
18121da177e4SLinus Torvalds     default:
18131da177e4SLinus Torvalds 	return -EINVAL;
18141da177e4SLinus Torvalds     }
18151da177e4SLinus Torvalds 
18161da177e4SLinus Torvalds     error = fore200e_set_oc3(fore200e, SUNI_MCT, mct_value, mct_mask);
18171da177e4SLinus Torvalds     if (error == 0)
18181da177e4SLinus Torvalds 	fore200e->loop_mode = loop_mode;
18191da177e4SLinus Torvalds 
18201da177e4SLinus Torvalds     return error;
18211da177e4SLinus Torvalds }
18221da177e4SLinus Torvalds 
18231da177e4SLinus Torvalds 
18241da177e4SLinus Torvalds static int
fore200e_fetch_stats(struct fore200e * fore200e,struct sonet_stats __user * arg)18251da177e4SLinus Torvalds fore200e_fetch_stats(struct fore200e* fore200e, struct sonet_stats __user *arg)
18261da177e4SLinus Torvalds {
18271da177e4SLinus Torvalds     struct sonet_stats tmp;
18281da177e4SLinus Torvalds 
18291da177e4SLinus Torvalds     if (fore200e_getstats(fore200e) < 0)
18301da177e4SLinus Torvalds 	return -EIO;
18311da177e4SLinus Torvalds 
183263734a32SAl Viro     tmp.section_bip = be32_to_cpu(fore200e->stats->oc3.section_bip8_errors);
183363734a32SAl Viro     tmp.line_bip    = be32_to_cpu(fore200e->stats->oc3.line_bip24_errors);
183463734a32SAl Viro     tmp.path_bip    = be32_to_cpu(fore200e->stats->oc3.path_bip8_errors);
183563734a32SAl Viro     tmp.line_febe   = be32_to_cpu(fore200e->stats->oc3.line_febe_errors);
183663734a32SAl Viro     tmp.path_febe   = be32_to_cpu(fore200e->stats->oc3.path_febe_errors);
183763734a32SAl Viro     tmp.corr_hcs    = be32_to_cpu(fore200e->stats->oc3.corr_hcs_errors);
183863734a32SAl Viro     tmp.uncorr_hcs  = be32_to_cpu(fore200e->stats->oc3.ucorr_hcs_errors);
183963734a32SAl Viro     tmp.tx_cells    = be32_to_cpu(fore200e->stats->aal0.cells_transmitted)  +
184063734a32SAl Viro 	              be32_to_cpu(fore200e->stats->aal34.cells_transmitted) +
184163734a32SAl Viro 	              be32_to_cpu(fore200e->stats->aal5.cells_transmitted);
184263734a32SAl Viro     tmp.rx_cells    = be32_to_cpu(fore200e->stats->aal0.cells_received)     +
184363734a32SAl Viro 	              be32_to_cpu(fore200e->stats->aal34.cells_received)    +
184463734a32SAl Viro 	              be32_to_cpu(fore200e->stats->aal5.cells_received);
18451da177e4SLinus Torvalds 
18461da177e4SLinus Torvalds     if (arg)
18471da177e4SLinus Torvalds 	return copy_to_user(arg, &tmp, sizeof(struct sonet_stats)) ? -EFAULT : 0;
18481da177e4SLinus Torvalds 
18491da177e4SLinus Torvalds     return 0;
18501da177e4SLinus Torvalds }
18511da177e4SLinus Torvalds 
18521da177e4SLinus Torvalds 
18531da177e4SLinus Torvalds static int
fore200e_ioctl(struct atm_dev * dev,unsigned int cmd,void __user * arg)18541da177e4SLinus Torvalds fore200e_ioctl(struct atm_dev* dev, unsigned int cmd, void __user * arg)
18551da177e4SLinus Torvalds {
18561da177e4SLinus Torvalds     struct fore200e* fore200e = FORE200E_DEV(dev);
18571da177e4SLinus Torvalds 
18581da177e4SLinus Torvalds     DPRINTK(2, "ioctl cmd = 0x%x (%u), arg = 0x%p (%lu)\n", cmd, cmd, arg, (unsigned long)arg);
18591da177e4SLinus Torvalds 
18601da177e4SLinus Torvalds     switch (cmd) {
18611da177e4SLinus Torvalds 
18621da177e4SLinus Torvalds     case SONET_GETSTAT:
18631da177e4SLinus Torvalds 	return fore200e_fetch_stats(fore200e, (struct sonet_stats __user *)arg);
18641da177e4SLinus Torvalds 
18651da177e4SLinus Torvalds     case SONET_GETDIAG:
18661da177e4SLinus Torvalds 	return put_user(0, (int __user *)arg) ? -EFAULT : 0;
18671da177e4SLinus Torvalds 
18681da177e4SLinus Torvalds     case ATM_SETLOOP:
18691da177e4SLinus Torvalds 	return fore200e_setloop(fore200e, (int)(unsigned long)arg);
18701da177e4SLinus Torvalds 
18711da177e4SLinus Torvalds     case ATM_GETLOOP:
18721da177e4SLinus Torvalds 	return put_user(fore200e->loop_mode, (int __user *)arg) ? -EFAULT : 0;
18731da177e4SLinus Torvalds 
18741da177e4SLinus Torvalds     case ATM_QUERYLOOP:
18751da177e4SLinus Torvalds 	return put_user(ATM_LM_LOC_PHY | ATM_LM_RMT_PHY, (int __user *)arg) ? -EFAULT : 0;
18761da177e4SLinus Torvalds     }
18771da177e4SLinus Torvalds 
18781da177e4SLinus Torvalds     return -ENOSYS; /* not implemented */
18791da177e4SLinus Torvalds }
18801da177e4SLinus Torvalds 
18811da177e4SLinus Torvalds 
18821da177e4SLinus Torvalds static int
fore200e_change_qos(struct atm_vcc * vcc,struct atm_qos * qos,int flags)18831da177e4SLinus Torvalds fore200e_change_qos(struct atm_vcc* vcc,struct atm_qos* qos, int flags)
18841da177e4SLinus Torvalds {
18851da177e4SLinus Torvalds     struct fore200e_vcc* fore200e_vcc = FORE200E_VCC(vcc);
18861da177e4SLinus Torvalds     struct fore200e*     fore200e     = FORE200E_DEV(vcc->dev);
18871da177e4SLinus Torvalds 
18881da177e4SLinus Torvalds     if (!test_bit(ATM_VF_READY, &vcc->flags)) {
18891da177e4SLinus Torvalds 	DPRINTK(1, "VC %d.%d.%d not ready for QoS change\n", vcc->itf, vcc->vpi, vcc->vpi);
18901da177e4SLinus Torvalds 	return -EINVAL;
18911da177e4SLinus Torvalds     }
18921da177e4SLinus Torvalds 
18931da177e4SLinus Torvalds     DPRINTK(2, "change_qos %d.%d.%d, "
18941da177e4SLinus Torvalds 	    "(tx: cl=%s, pcr=%d-%d, cdv=%d, max_sdu=%d; "
18951da177e4SLinus Torvalds 	    "rx: cl=%s, pcr=%d-%d, cdv=%d, max_sdu=%d), flags = 0x%x\n"
18961da177e4SLinus Torvalds 	    "available_cell_rate = %u",
18971da177e4SLinus Torvalds 	    vcc->itf, vcc->vpi, vcc->vci,
18981da177e4SLinus Torvalds 	    fore200e_traffic_class[ qos->txtp.traffic_class ],
18991da177e4SLinus Torvalds 	    qos->txtp.min_pcr, qos->txtp.max_pcr, qos->txtp.max_cdv, qos->txtp.max_sdu,
19001da177e4SLinus Torvalds 	    fore200e_traffic_class[ qos->rxtp.traffic_class ],
19011da177e4SLinus Torvalds 	    qos->rxtp.min_pcr, qos->rxtp.max_pcr, qos->rxtp.max_cdv, qos->rxtp.max_sdu,
19021da177e4SLinus Torvalds 	    flags, fore200e->available_cell_rate);
19031da177e4SLinus Torvalds 
19041da177e4SLinus Torvalds     if ((qos->txtp.traffic_class == ATM_CBR) && (qos->txtp.max_pcr > 0)) {
19051da177e4SLinus Torvalds 
1906bfbf3c09SMatthias Kaehlcke 	mutex_lock(&fore200e->rate_mtx);
19071da177e4SLinus Torvalds 	if (fore200e->available_cell_rate + vcc->qos.txtp.max_pcr < qos->txtp.max_pcr) {
1908bfbf3c09SMatthias Kaehlcke 	    mutex_unlock(&fore200e->rate_mtx);
19091da177e4SLinus Torvalds 	    return -EAGAIN;
19101da177e4SLinus Torvalds 	}
19111da177e4SLinus Torvalds 
19121da177e4SLinus Torvalds 	fore200e->available_cell_rate += vcc->qos.txtp.max_pcr;
19131da177e4SLinus Torvalds 	fore200e->available_cell_rate -= qos->txtp.max_pcr;
19141da177e4SLinus Torvalds 
1915bfbf3c09SMatthias Kaehlcke 	mutex_unlock(&fore200e->rate_mtx);
19161da177e4SLinus Torvalds 
19171da177e4SLinus Torvalds 	memcpy(&vcc->qos, qos, sizeof(struct atm_qos));
19181da177e4SLinus Torvalds 
19191da177e4SLinus Torvalds 	/* update rate control parameters */
19201da177e4SLinus Torvalds 	fore200e_rate_ctrl(qos, &fore200e_vcc->rate);
19211da177e4SLinus Torvalds 
19221da177e4SLinus Torvalds 	set_bit(ATM_VF_HASQOS, &vcc->flags);
19231da177e4SLinus Torvalds 
19241da177e4SLinus Torvalds 	return 0;
19251da177e4SLinus Torvalds     }
19261da177e4SLinus Torvalds 
19271da177e4SLinus Torvalds     return -EINVAL;
19281da177e4SLinus Torvalds }
19291da177e4SLinus Torvalds 
19301da177e4SLinus Torvalds 
fore200e_irq_request(struct fore200e * fore200e)19316c44512dSGreg Kroah-Hartman static int fore200e_irq_request(struct fore200e *fore200e)
19321da177e4SLinus Torvalds {
1933dace1453SThomas Gleixner     if (request_irq(fore200e->irq, fore200e_interrupt, IRQF_SHARED, fore200e->name, fore200e->atm_dev) < 0) {
19341da177e4SLinus Torvalds 
19351da177e4SLinus Torvalds 	printk(FORE200E "unable to reserve IRQ %s for device %s\n",
19361da177e4SLinus Torvalds 	       fore200e_irq_itoa(fore200e->irq), fore200e->name);
19371da177e4SLinus Torvalds 	return -EBUSY;
19381da177e4SLinus Torvalds     }
19391da177e4SLinus Torvalds 
19401da177e4SLinus Torvalds     printk(FORE200E "IRQ %s reserved for device %s\n",
19411da177e4SLinus Torvalds 	   fore200e_irq_itoa(fore200e->irq), fore200e->name);
19421da177e4SLinus Torvalds 
19431da177e4SLinus Torvalds #ifdef FORE200E_USE_TASKLET
19441da177e4SLinus Torvalds     tasklet_init(&fore200e->tx_tasklet, fore200e_tx_tasklet, (unsigned long)fore200e);
19451da177e4SLinus Torvalds     tasklet_init(&fore200e->rx_tasklet, fore200e_rx_tasklet, (unsigned long)fore200e);
19461da177e4SLinus Torvalds #endif
19471da177e4SLinus Torvalds 
19481da177e4SLinus Torvalds     fore200e->state = FORE200E_STATE_IRQ;
19491da177e4SLinus Torvalds     return 0;
19501da177e4SLinus Torvalds }
19511da177e4SLinus Torvalds 
19521da177e4SLinus Torvalds 
fore200e_get_esi(struct fore200e * fore200e)19536c44512dSGreg Kroah-Hartman static int fore200e_get_esi(struct fore200e *fore200e)
19541da177e4SLinus Torvalds {
19550e21b225SChristoph Hellwig     struct prom_data* prom = kzalloc(sizeof(struct prom_data), GFP_KERNEL);
19561da177e4SLinus Torvalds     int ok, i;
19571da177e4SLinus Torvalds 
19581da177e4SLinus Torvalds     if (!prom)
19591da177e4SLinus Torvalds 	return -ENOMEM;
19601da177e4SLinus Torvalds 
19611da177e4SLinus Torvalds     ok = fore200e->bus->prom_read(fore200e, prom);
19621da177e4SLinus Torvalds     if (ok < 0) {
19631f8a5fb8SAdrian Bunk 	kfree(prom);
19641da177e4SLinus Torvalds 	return -EBUSY;
19651da177e4SLinus Torvalds     }
19661da177e4SLinus Torvalds 
19673008ab36Shartleys     printk(FORE200E "device %s, rev. %c, S/N: %d, ESI: %pM\n",
19681da177e4SLinus Torvalds 	   fore200e->name,
19691da177e4SLinus Torvalds 	   (prom->hw_revision & 0xFF) + '@',    /* probably meaningless with SBA boards */
19703008ab36Shartleys 	   prom->serial_number & 0xFFFF, &prom->mac_addr[2]);
19711da177e4SLinus Torvalds 
19721da177e4SLinus Torvalds     for (i = 0; i < ESI_LEN; i++) {
19731da177e4SLinus Torvalds 	fore200e->esi[ i ] = fore200e->atm_dev->esi[ i ] = prom->mac_addr[ i + 2 ];
19741da177e4SLinus Torvalds     }
19751da177e4SLinus Torvalds 
19761f8a5fb8SAdrian Bunk     kfree(prom);
19771da177e4SLinus Torvalds 
19781da177e4SLinus Torvalds     return 0;
19791da177e4SLinus Torvalds }
19801da177e4SLinus Torvalds 
19811da177e4SLinus Torvalds 
fore200e_alloc_rx_buf(struct fore200e * fore200e)19826c44512dSGreg Kroah-Hartman static int fore200e_alloc_rx_buf(struct fore200e *fore200e)
19831da177e4SLinus Torvalds {
19841da177e4SLinus Torvalds     int scheme, magn, nbr, size, i;
19851da177e4SLinus Torvalds 
19861da177e4SLinus Torvalds     struct host_bsq* bsq;
19871da177e4SLinus Torvalds     struct buffer*   buffer;
19881da177e4SLinus Torvalds 
19891da177e4SLinus Torvalds     for (scheme = 0; scheme < BUFFER_SCHEME_NBR; scheme++) {
19901da177e4SLinus Torvalds 	for (magn = 0; magn < BUFFER_MAGN_NBR; magn++) {
19911da177e4SLinus Torvalds 
19921da177e4SLinus Torvalds 	    bsq = &fore200e->host_bsq[ scheme ][ magn ];
19931da177e4SLinus Torvalds 
19941da177e4SLinus Torvalds 	    nbr  = fore200e_rx_buf_nbr[ scheme ][ magn ];
19951da177e4SLinus Torvalds 	    size = fore200e_rx_buf_size[ scheme ][ magn ];
19961da177e4SLinus Torvalds 
19971da177e4SLinus Torvalds 	    DPRINTK(2, "rx buffers %d / %d are being allocated\n", scheme, magn);
19981da177e4SLinus Torvalds 
19991da177e4SLinus Torvalds 	    /* allocate the array of receive buffers */
20006396bb22SKees Cook 	    buffer = bsq->buffer = kcalloc(nbr, sizeof(struct buffer),
20016396bb22SKees Cook                                            GFP_KERNEL);
20021da177e4SLinus Torvalds 
20031da177e4SLinus Torvalds 	    if (buffer == NULL)
20041da177e4SLinus Torvalds 		return -ENOMEM;
20051da177e4SLinus Torvalds 
20061da177e4SLinus Torvalds 	    bsq->freebuf = NULL;
20071da177e4SLinus Torvalds 
20081da177e4SLinus Torvalds 	    for (i = 0; i < nbr; i++) {
20091da177e4SLinus Torvalds 
20101da177e4SLinus Torvalds 		buffer[ i ].scheme = scheme;
20111da177e4SLinus Torvalds 		buffer[ i ].magn   = magn;
20121da177e4SLinus Torvalds #ifdef FORE200E_BSQ_DEBUG
20131da177e4SLinus Torvalds 		buffer[ i ].index  = i;
20141da177e4SLinus Torvalds 		buffer[ i ].supplied = 0;
20151da177e4SLinus Torvalds #endif
20161da177e4SLinus Torvalds 
20171da177e4SLinus Torvalds 		/* allocate the receive buffer body */
20181da177e4SLinus Torvalds 		if (fore200e_chunk_alloc(fore200e,
20191da177e4SLinus Torvalds 					 &buffer[ i ].data, size, fore200e->bus->buffer_alignment,
20201da177e4SLinus Torvalds 					 DMA_FROM_DEVICE) < 0) {
20211da177e4SLinus Torvalds 
20221da177e4SLinus Torvalds 		    while (i > 0)
20231da177e4SLinus Torvalds 			fore200e_chunk_free(fore200e, &buffer[ --i ].data);
20241f8a5fb8SAdrian Bunk 		    kfree(buffer);
20251da177e4SLinus Torvalds 
20261da177e4SLinus Torvalds 		    return -ENOMEM;
20271da177e4SLinus Torvalds 		}
20281da177e4SLinus Torvalds 
20291da177e4SLinus Torvalds 		/* insert the buffer into the free buffer list */
20301da177e4SLinus Torvalds 		buffer[ i ].next = bsq->freebuf;
20311da177e4SLinus Torvalds 		bsq->freebuf = &buffer[ i ];
20321da177e4SLinus Torvalds 	    }
20331da177e4SLinus Torvalds 	    /* all the buffers are free, initially */
20341da177e4SLinus Torvalds 	    bsq->freebuf_count = nbr;
20351da177e4SLinus Torvalds 
20361da177e4SLinus Torvalds #ifdef FORE200E_BSQ_DEBUG
20371da177e4SLinus Torvalds 	    bsq_audit(3, bsq, scheme, magn);
20381da177e4SLinus Torvalds #endif
20391da177e4SLinus Torvalds 	}
20401da177e4SLinus Torvalds     }
20411da177e4SLinus Torvalds 
20421da177e4SLinus Torvalds     fore200e->state = FORE200E_STATE_ALLOC_BUF;
20431da177e4SLinus Torvalds     return 0;
20441da177e4SLinus Torvalds }
20451da177e4SLinus Torvalds 
20461da177e4SLinus Torvalds 
fore200e_init_bs_queue(struct fore200e * fore200e)20476c44512dSGreg Kroah-Hartman static int fore200e_init_bs_queue(struct fore200e *fore200e)
20481da177e4SLinus Torvalds {
20491da177e4SLinus Torvalds     int scheme, magn, i;
20501da177e4SLinus Torvalds 
20511da177e4SLinus Torvalds     struct host_bsq*     bsq;
20521da177e4SLinus Torvalds     struct cp_bsq_entry __iomem * cp_entry;
20531da177e4SLinus Torvalds 
20541da177e4SLinus Torvalds     for (scheme = 0; scheme < BUFFER_SCHEME_NBR; scheme++) {
20551da177e4SLinus Torvalds 	for (magn = 0; magn < BUFFER_MAGN_NBR; magn++) {
20561da177e4SLinus Torvalds 
20571da177e4SLinus Torvalds 	    DPRINTK(2, "buffer supply queue %d / %d is being initialized\n", scheme, magn);
20581da177e4SLinus Torvalds 
20591da177e4SLinus Torvalds 	    bsq = &fore200e->host_bsq[ scheme ][ magn ];
20601da177e4SLinus Torvalds 
20611da177e4SLinus Torvalds 	    /* allocate and align the array of status words */
20621335d6fdSChristoph Hellwig 	    if (fore200e_dma_chunk_alloc(fore200e,
20631da177e4SLinus Torvalds 					       &bsq->status,
20641da177e4SLinus Torvalds 					       sizeof(enum status),
20651da177e4SLinus Torvalds 					       QUEUE_SIZE_BS,
20661da177e4SLinus Torvalds 					       fore200e->bus->status_alignment) < 0) {
20671da177e4SLinus Torvalds 		return -ENOMEM;
20681da177e4SLinus Torvalds 	    }
20691da177e4SLinus Torvalds 
20701da177e4SLinus Torvalds 	    /* allocate and align the array of receive buffer descriptors */
20711335d6fdSChristoph Hellwig 	    if (fore200e_dma_chunk_alloc(fore200e,
20721da177e4SLinus Torvalds 					       &bsq->rbd_block,
20731da177e4SLinus Torvalds 					       sizeof(struct rbd_block),
20741da177e4SLinus Torvalds 					       QUEUE_SIZE_BS,
20751da177e4SLinus Torvalds 					       fore200e->bus->descr_alignment) < 0) {
20761da177e4SLinus Torvalds 
20771335d6fdSChristoph Hellwig 		fore200e_dma_chunk_free(fore200e, &bsq->status);
20781da177e4SLinus Torvalds 		return -ENOMEM;
20791da177e4SLinus Torvalds 	    }
20801da177e4SLinus Torvalds 
20811da177e4SLinus Torvalds 	    /* get the base address of the cp resident buffer supply queue entries */
20821da177e4SLinus Torvalds 	    cp_entry = fore200e->virt_base +
20831da177e4SLinus Torvalds 		       fore200e->bus->read(&fore200e->cp_queues->cp_bsq[ scheme ][ magn ]);
20841da177e4SLinus Torvalds 
20851da177e4SLinus Torvalds 	    /* fill the host resident and cp resident buffer supply queue entries */
20861da177e4SLinus Torvalds 	    for (i = 0; i < QUEUE_SIZE_BS; i++) {
20871da177e4SLinus Torvalds 
20881da177e4SLinus Torvalds 		bsq->host_entry[ i ].status =
20891da177e4SLinus Torvalds 		                     FORE200E_INDEX(bsq->status.align_addr, enum status, i);
20901da177e4SLinus Torvalds 	        bsq->host_entry[ i ].rbd_block =
20911da177e4SLinus Torvalds 		                     FORE200E_INDEX(bsq->rbd_block.align_addr, struct rbd_block, i);
20921da177e4SLinus Torvalds 		bsq->host_entry[ i ].rbd_block_dma =
20931da177e4SLinus Torvalds 		                     FORE200E_DMA_INDEX(bsq->rbd_block.dma_addr, struct rbd_block, i);
20941da177e4SLinus Torvalds 		bsq->host_entry[ i ].cp_entry = &cp_entry[ i ];
20951da177e4SLinus Torvalds 
20961da177e4SLinus Torvalds 		*bsq->host_entry[ i ].status = STATUS_FREE;
20971da177e4SLinus Torvalds 
20981da177e4SLinus Torvalds 		fore200e->bus->write(FORE200E_DMA_INDEX(bsq->status.dma_addr, enum status, i),
20991da177e4SLinus Torvalds 				     &cp_entry[ i ].status_haddr);
21001da177e4SLinus Torvalds 	    }
21011da177e4SLinus Torvalds 	}
21021da177e4SLinus Torvalds     }
21031da177e4SLinus Torvalds 
21041da177e4SLinus Torvalds     fore200e->state = FORE200E_STATE_INIT_BSQ;
21051da177e4SLinus Torvalds     return 0;
21061da177e4SLinus Torvalds }
21071da177e4SLinus Torvalds 
21081da177e4SLinus Torvalds 
fore200e_init_rx_queue(struct fore200e * fore200e)21096c44512dSGreg Kroah-Hartman static int fore200e_init_rx_queue(struct fore200e *fore200e)
21101da177e4SLinus Torvalds {
21111da177e4SLinus Torvalds     struct host_rxq*     rxq =  &fore200e->host_rxq;
21121da177e4SLinus Torvalds     struct cp_rxq_entry __iomem * cp_entry;
21131da177e4SLinus Torvalds     int i;
21141da177e4SLinus Torvalds 
21151da177e4SLinus Torvalds     DPRINTK(2, "receive queue is being initialized\n");
21161da177e4SLinus Torvalds 
21171da177e4SLinus Torvalds     /* allocate and align the array of status words */
21181335d6fdSChristoph Hellwig     if (fore200e_dma_chunk_alloc(fore200e,
21191da177e4SLinus Torvalds 				       &rxq->status,
21201da177e4SLinus Torvalds 				       sizeof(enum status),
21211da177e4SLinus Torvalds 				       QUEUE_SIZE_RX,
21221da177e4SLinus Torvalds 				       fore200e->bus->status_alignment) < 0) {
21231da177e4SLinus Torvalds 	return -ENOMEM;
21241da177e4SLinus Torvalds     }
21251da177e4SLinus Torvalds 
21261da177e4SLinus Torvalds     /* allocate and align the array of receive PDU descriptors */
21271335d6fdSChristoph Hellwig     if (fore200e_dma_chunk_alloc(fore200e,
21281da177e4SLinus Torvalds 				       &rxq->rpd,
21291da177e4SLinus Torvalds 				       sizeof(struct rpd),
21301da177e4SLinus Torvalds 				       QUEUE_SIZE_RX,
21311da177e4SLinus Torvalds 				       fore200e->bus->descr_alignment) < 0) {
21321da177e4SLinus Torvalds 
21331335d6fdSChristoph Hellwig 	fore200e_dma_chunk_free(fore200e, &rxq->status);
21341da177e4SLinus Torvalds 	return -ENOMEM;
21351da177e4SLinus Torvalds     }
21361da177e4SLinus Torvalds 
21371da177e4SLinus Torvalds     /* get the base address of the cp resident rx queue entries */
21381da177e4SLinus Torvalds     cp_entry = fore200e->virt_base + fore200e->bus->read(&fore200e->cp_queues->cp_rxq);
21391da177e4SLinus Torvalds 
21401da177e4SLinus Torvalds     /* fill the host resident and cp resident rx entries */
21411da177e4SLinus Torvalds     for (i=0; i < QUEUE_SIZE_RX; i++) {
21421da177e4SLinus Torvalds 
21431da177e4SLinus Torvalds 	rxq->host_entry[ i ].status =
21441da177e4SLinus Torvalds 	                     FORE200E_INDEX(rxq->status.align_addr, enum status, i);
21451da177e4SLinus Torvalds 	rxq->host_entry[ i ].rpd =
21461da177e4SLinus Torvalds 	                     FORE200E_INDEX(rxq->rpd.align_addr, struct rpd, i);
21471da177e4SLinus Torvalds 	rxq->host_entry[ i ].rpd_dma =
21481da177e4SLinus Torvalds 	                     FORE200E_DMA_INDEX(rxq->rpd.dma_addr, struct rpd, i);
21491da177e4SLinus Torvalds 	rxq->host_entry[ i ].cp_entry = &cp_entry[ i ];
21501da177e4SLinus Torvalds 
21511da177e4SLinus Torvalds 	*rxq->host_entry[ i ].status = STATUS_FREE;
21521da177e4SLinus Torvalds 
21531da177e4SLinus Torvalds 	fore200e->bus->write(FORE200E_DMA_INDEX(rxq->status.dma_addr, enum status, i),
21541da177e4SLinus Torvalds 			     &cp_entry[ i ].status_haddr);
21551da177e4SLinus Torvalds 
21561da177e4SLinus Torvalds 	fore200e->bus->write(FORE200E_DMA_INDEX(rxq->rpd.dma_addr, struct rpd, i),
21571da177e4SLinus Torvalds 			     &cp_entry[ i ].rpd_haddr);
21581da177e4SLinus Torvalds     }
21591da177e4SLinus Torvalds 
21601da177e4SLinus Torvalds     /* set the head entry of the queue */
21611da177e4SLinus Torvalds     rxq->head = 0;
21621da177e4SLinus Torvalds 
21631da177e4SLinus Torvalds     fore200e->state = FORE200E_STATE_INIT_RXQ;
21641da177e4SLinus Torvalds     return 0;
21651da177e4SLinus Torvalds }
21661da177e4SLinus Torvalds 
21671da177e4SLinus Torvalds 
fore200e_init_tx_queue(struct fore200e * fore200e)21686c44512dSGreg Kroah-Hartman static int fore200e_init_tx_queue(struct fore200e *fore200e)
21691da177e4SLinus Torvalds {
21701da177e4SLinus Torvalds     struct host_txq*     txq =  &fore200e->host_txq;
21711da177e4SLinus Torvalds     struct cp_txq_entry __iomem * cp_entry;
21721da177e4SLinus Torvalds     int i;
21731da177e4SLinus Torvalds 
21741da177e4SLinus Torvalds     DPRINTK(2, "transmit queue is being initialized\n");
21751da177e4SLinus Torvalds 
21761da177e4SLinus Torvalds     /* allocate and align the array of status words */
21771335d6fdSChristoph Hellwig     if (fore200e_dma_chunk_alloc(fore200e,
21781da177e4SLinus Torvalds 				       &txq->status,
21791da177e4SLinus Torvalds 				       sizeof(enum status),
21801da177e4SLinus Torvalds 				       QUEUE_SIZE_TX,
21811da177e4SLinus Torvalds 				       fore200e->bus->status_alignment) < 0) {
21821da177e4SLinus Torvalds 	return -ENOMEM;
21831da177e4SLinus Torvalds     }
21841da177e4SLinus Torvalds 
21851da177e4SLinus Torvalds     /* allocate and align the array of transmit PDU descriptors */
21861335d6fdSChristoph Hellwig     if (fore200e_dma_chunk_alloc(fore200e,
21871da177e4SLinus Torvalds 				       &txq->tpd,
21881da177e4SLinus Torvalds 				       sizeof(struct tpd),
21891da177e4SLinus Torvalds 				       QUEUE_SIZE_TX,
21901da177e4SLinus Torvalds 				       fore200e->bus->descr_alignment) < 0) {
21911da177e4SLinus Torvalds 
21921335d6fdSChristoph Hellwig 	fore200e_dma_chunk_free(fore200e, &txq->status);
21931da177e4SLinus Torvalds 	return -ENOMEM;
21941da177e4SLinus Torvalds     }
21951da177e4SLinus Torvalds 
21961da177e4SLinus Torvalds     /* get the base address of the cp resident tx queue entries */
21971da177e4SLinus Torvalds     cp_entry = fore200e->virt_base + fore200e->bus->read(&fore200e->cp_queues->cp_txq);
21981da177e4SLinus Torvalds 
21991da177e4SLinus Torvalds     /* fill the host resident and cp resident tx entries */
22001da177e4SLinus Torvalds     for (i=0; i < QUEUE_SIZE_TX; i++) {
22011da177e4SLinus Torvalds 
22021da177e4SLinus Torvalds 	txq->host_entry[ i ].status =
22031da177e4SLinus Torvalds 	                     FORE200E_INDEX(txq->status.align_addr, enum status, i);
22041da177e4SLinus Torvalds 	txq->host_entry[ i ].tpd =
22051da177e4SLinus Torvalds 	                     FORE200E_INDEX(txq->tpd.align_addr, struct tpd, i);
22061da177e4SLinus Torvalds 	txq->host_entry[ i ].tpd_dma  =
22071da177e4SLinus Torvalds                              FORE200E_DMA_INDEX(txq->tpd.dma_addr, struct tpd, i);
22081da177e4SLinus Torvalds 	txq->host_entry[ i ].cp_entry = &cp_entry[ i ];
22091da177e4SLinus Torvalds 
22101da177e4SLinus Torvalds 	*txq->host_entry[ i ].status = STATUS_FREE;
22111da177e4SLinus Torvalds 
22121da177e4SLinus Torvalds 	fore200e->bus->write(FORE200E_DMA_INDEX(txq->status.dma_addr, enum status, i),
22131da177e4SLinus Torvalds 			     &cp_entry[ i ].status_haddr);
22141da177e4SLinus Torvalds 
22151da177e4SLinus Torvalds         /* although there is a one-to-one mapping of tx queue entries and tpds,
22161da177e4SLinus Torvalds 	   we do not write here the DMA (physical) base address of each tpd into
22171da177e4SLinus Torvalds 	   the related cp resident entry, because the cp relies on this write
22181da177e4SLinus Torvalds 	   operation to detect that a new pdu has been submitted for tx */
22191da177e4SLinus Torvalds     }
22201da177e4SLinus Torvalds 
22211da177e4SLinus Torvalds     /* set the head and tail entries of the queue */
22221da177e4SLinus Torvalds     txq->head = 0;
22231da177e4SLinus Torvalds     txq->tail = 0;
22241da177e4SLinus Torvalds 
22251da177e4SLinus Torvalds     fore200e->state = FORE200E_STATE_INIT_TXQ;
22261da177e4SLinus Torvalds     return 0;
22271da177e4SLinus Torvalds }
22281da177e4SLinus Torvalds 
22291da177e4SLinus Torvalds 
fore200e_init_cmd_queue(struct fore200e * fore200e)22306c44512dSGreg Kroah-Hartman static int fore200e_init_cmd_queue(struct fore200e *fore200e)
22311da177e4SLinus Torvalds {
22321da177e4SLinus Torvalds     struct host_cmdq*     cmdq =  &fore200e->host_cmdq;
22331da177e4SLinus Torvalds     struct cp_cmdq_entry __iomem * cp_entry;
22341da177e4SLinus Torvalds     int i;
22351da177e4SLinus Torvalds 
22361da177e4SLinus Torvalds     DPRINTK(2, "command queue is being initialized\n");
22371da177e4SLinus Torvalds 
22381da177e4SLinus Torvalds     /* allocate and align the array of status words */
22391335d6fdSChristoph Hellwig     if (fore200e_dma_chunk_alloc(fore200e,
22401da177e4SLinus Torvalds 				       &cmdq->status,
22411da177e4SLinus Torvalds 				       sizeof(enum status),
22421da177e4SLinus Torvalds 				       QUEUE_SIZE_CMD,
22431da177e4SLinus Torvalds 				       fore200e->bus->status_alignment) < 0) {
22441da177e4SLinus Torvalds 	return -ENOMEM;
22451da177e4SLinus Torvalds     }
22461da177e4SLinus Torvalds 
22471da177e4SLinus Torvalds     /* get the base address of the cp resident cmd queue entries */
22481da177e4SLinus Torvalds     cp_entry = fore200e->virt_base + fore200e->bus->read(&fore200e->cp_queues->cp_cmdq);
22491da177e4SLinus Torvalds 
22501da177e4SLinus Torvalds     /* fill the host resident and cp resident cmd entries */
22511da177e4SLinus Torvalds     for (i=0; i < QUEUE_SIZE_CMD; i++) {
22521da177e4SLinus Torvalds 
22531da177e4SLinus Torvalds 	cmdq->host_entry[ i ].status   =
22541da177e4SLinus Torvalds                               FORE200E_INDEX(cmdq->status.align_addr, enum status, i);
22551da177e4SLinus Torvalds 	cmdq->host_entry[ i ].cp_entry = &cp_entry[ i ];
22561da177e4SLinus Torvalds 
22571da177e4SLinus Torvalds 	*cmdq->host_entry[ i ].status = STATUS_FREE;
22581da177e4SLinus Torvalds 
22591da177e4SLinus Torvalds 	fore200e->bus->write(FORE200E_DMA_INDEX(cmdq->status.dma_addr, enum status, i),
22601da177e4SLinus Torvalds                              &cp_entry[ i ].status_haddr);
22611da177e4SLinus Torvalds     }
22621da177e4SLinus Torvalds 
22631da177e4SLinus Torvalds     /* set the head entry of the queue */
22641da177e4SLinus Torvalds     cmdq->head = 0;
22651da177e4SLinus Torvalds 
22661da177e4SLinus Torvalds     fore200e->state = FORE200E_STATE_INIT_CMDQ;
22671da177e4SLinus Torvalds     return 0;
22681da177e4SLinus Torvalds }
22691da177e4SLinus Torvalds 
22701da177e4SLinus Torvalds 
fore200e_param_bs_queue(struct fore200e * fore200e,enum buffer_scheme scheme,enum buffer_magn magn,int queue_length,int pool_size,int supply_blksize)22716c44512dSGreg Kroah-Hartman static void fore200e_param_bs_queue(struct fore200e *fore200e,
22726c44512dSGreg Kroah-Hartman 				    enum buffer_scheme scheme,
22736c44512dSGreg Kroah-Hartman 				    enum buffer_magn magn, int queue_length,
22746c44512dSGreg Kroah-Hartman 				    int pool_size, int supply_blksize)
22751da177e4SLinus Torvalds {
22761da177e4SLinus Torvalds     struct bs_spec __iomem * bs_spec = &fore200e->cp_queues->init.bs_spec[ scheme ][ magn ];
22771da177e4SLinus Torvalds 
22781da177e4SLinus Torvalds     fore200e->bus->write(queue_length,                           &bs_spec->queue_length);
22791da177e4SLinus Torvalds     fore200e->bus->write(fore200e_rx_buf_size[ scheme ][ magn ], &bs_spec->buffer_size);
22801da177e4SLinus Torvalds     fore200e->bus->write(pool_size,                              &bs_spec->pool_size);
22811da177e4SLinus Torvalds     fore200e->bus->write(supply_blksize,                         &bs_spec->supply_blksize);
22821da177e4SLinus Torvalds }
22831da177e4SLinus Torvalds 
22841da177e4SLinus Torvalds 
fore200e_initialize(struct fore200e * fore200e)22856c44512dSGreg Kroah-Hartman static int fore200e_initialize(struct fore200e *fore200e)
22861da177e4SLinus Torvalds {
22871da177e4SLinus Torvalds     struct cp_queues __iomem * cpq;
22881da177e4SLinus Torvalds     int               ok, scheme, magn;
22891da177e4SLinus Torvalds 
22901da177e4SLinus Torvalds     DPRINTK(2, "device %s being initialized\n", fore200e->name);
22911da177e4SLinus Torvalds 
2292bfbf3c09SMatthias Kaehlcke     mutex_init(&fore200e->rate_mtx);
22931da177e4SLinus Torvalds     spin_lock_init(&fore200e->q_lock);
22941da177e4SLinus Torvalds 
22951da177e4SLinus Torvalds     cpq = fore200e->cp_queues = fore200e->virt_base + FORE200E_CP_QUEUES_OFFSET;
22961da177e4SLinus Torvalds 
22971da177e4SLinus Torvalds     /* enable cp to host interrupts */
22981da177e4SLinus Torvalds     fore200e->bus->write(1, &cpq->imask);
22991da177e4SLinus Torvalds 
23001da177e4SLinus Torvalds     if (fore200e->bus->irq_enable)
23011da177e4SLinus Torvalds 	fore200e->bus->irq_enable(fore200e);
23021da177e4SLinus Torvalds 
23031da177e4SLinus Torvalds     fore200e->bus->write(NBR_CONNECT, &cpq->init.num_connect);
23041da177e4SLinus Torvalds 
23051da177e4SLinus Torvalds     fore200e->bus->write(QUEUE_SIZE_CMD, &cpq->init.cmd_queue_len);
23061da177e4SLinus Torvalds     fore200e->bus->write(QUEUE_SIZE_RX,  &cpq->init.rx_queue_len);
23071da177e4SLinus Torvalds     fore200e->bus->write(QUEUE_SIZE_TX,  &cpq->init.tx_queue_len);
23081da177e4SLinus Torvalds 
23091da177e4SLinus Torvalds     fore200e->bus->write(RSD_EXTENSION,  &cpq->init.rsd_extension);
23101da177e4SLinus Torvalds     fore200e->bus->write(TSD_EXTENSION,  &cpq->init.tsd_extension);
23111da177e4SLinus Torvalds 
23121da177e4SLinus Torvalds     for (scheme = 0; scheme < BUFFER_SCHEME_NBR; scheme++)
23131da177e4SLinus Torvalds 	for (magn = 0; magn < BUFFER_MAGN_NBR; magn++)
23141da177e4SLinus Torvalds 	    fore200e_param_bs_queue(fore200e, scheme, magn,
23151da177e4SLinus Torvalds 				    QUEUE_SIZE_BS,
23161da177e4SLinus Torvalds 				    fore200e_rx_buf_nbr[ scheme ][ magn ],
23171da177e4SLinus Torvalds 				    RBD_BLK_SIZE);
23181da177e4SLinus Torvalds 
23191da177e4SLinus Torvalds     /* issue the initialize command */
23201da177e4SLinus Torvalds     fore200e->bus->write(STATUS_PENDING,    &cpq->init.status);
23211da177e4SLinus Torvalds     fore200e->bus->write(OPCODE_INITIALIZE, &cpq->init.opcode);
23221da177e4SLinus Torvalds 
23231da177e4SLinus Torvalds     ok = fore200e_io_poll(fore200e, &cpq->init.status, STATUS_COMPLETE, 3000);
23241da177e4SLinus Torvalds     if (ok == 0) {
23251da177e4SLinus Torvalds 	printk(FORE200E "device %s initialization failed\n", fore200e->name);
23261da177e4SLinus Torvalds 	return -ENODEV;
23271da177e4SLinus Torvalds     }
23281da177e4SLinus Torvalds 
23291da177e4SLinus Torvalds     printk(FORE200E "device %s initialized\n", fore200e->name);
23301da177e4SLinus Torvalds 
23311da177e4SLinus Torvalds     fore200e->state = FORE200E_STATE_INITIALIZE;
23321da177e4SLinus Torvalds     return 0;
23331da177e4SLinus Torvalds }
23341da177e4SLinus Torvalds 
23351da177e4SLinus Torvalds 
fore200e_monitor_putc(struct fore200e * fore200e,char c)23366c44512dSGreg Kroah-Hartman static void fore200e_monitor_putc(struct fore200e *fore200e, char c)
23371da177e4SLinus Torvalds {
23381da177e4SLinus Torvalds     struct cp_monitor __iomem * monitor = fore200e->cp_monitor;
23391da177e4SLinus Torvalds 
23401da177e4SLinus Torvalds #if 0
23411da177e4SLinus Torvalds     printk("%c", c);
23421da177e4SLinus Torvalds #endif
23431da177e4SLinus Torvalds     fore200e->bus->write(((u32) c) | FORE200E_CP_MONITOR_UART_AVAIL, &monitor->soft_uart.send);
23441da177e4SLinus Torvalds }
23451da177e4SLinus Torvalds 
23461da177e4SLinus Torvalds 
fore200e_monitor_getc(struct fore200e * fore200e)23476c44512dSGreg Kroah-Hartman static int fore200e_monitor_getc(struct fore200e *fore200e)
23481da177e4SLinus Torvalds {
23491da177e4SLinus Torvalds     struct cp_monitor __iomem * monitor = fore200e->cp_monitor;
23501da177e4SLinus Torvalds     unsigned long      timeout = jiffies + msecs_to_jiffies(50);
23511da177e4SLinus Torvalds     int                c;
23521da177e4SLinus Torvalds 
23531da177e4SLinus Torvalds     while (time_before(jiffies, timeout)) {
23541da177e4SLinus Torvalds 
23551da177e4SLinus Torvalds 	c = (int) fore200e->bus->read(&monitor->soft_uart.recv);
23561da177e4SLinus Torvalds 
23571da177e4SLinus Torvalds 	if (c & FORE200E_CP_MONITOR_UART_AVAIL) {
23581da177e4SLinus Torvalds 
23591da177e4SLinus Torvalds 	    fore200e->bus->write(FORE200E_CP_MONITOR_UART_FREE, &monitor->soft_uart.recv);
23601da177e4SLinus Torvalds #if 0
23611da177e4SLinus Torvalds 	    printk("%c", c & 0xFF);
23621da177e4SLinus Torvalds #endif
23631da177e4SLinus Torvalds 	    return c & 0xFF;
23641da177e4SLinus Torvalds 	}
23651da177e4SLinus Torvalds     }
23661da177e4SLinus Torvalds 
23671da177e4SLinus Torvalds     return -1;
23681da177e4SLinus Torvalds }
23691da177e4SLinus Torvalds 
23701da177e4SLinus Torvalds 
fore200e_monitor_puts(struct fore200e * fore200e,char * str)23716c44512dSGreg Kroah-Hartman static void fore200e_monitor_puts(struct fore200e *fore200e, char *str)
23721da177e4SLinus Torvalds {
23731da177e4SLinus Torvalds     while (*str) {
23741da177e4SLinus Torvalds 
23751da177e4SLinus Torvalds 	/* the i960 monitor doesn't accept any new character if it has something to say */
23761da177e4SLinus Torvalds 	while (fore200e_monitor_getc(fore200e) >= 0);
23771da177e4SLinus Torvalds 
23781da177e4SLinus Torvalds 	fore200e_monitor_putc(fore200e, *str++);
23791da177e4SLinus Torvalds     }
23801da177e4SLinus Torvalds 
23811da177e4SLinus Torvalds     while (fore200e_monitor_getc(fore200e) >= 0);
23821da177e4SLinus Torvalds }
23831da177e4SLinus Torvalds 
2384e92481f9SChas Williams #ifdef __LITTLE_ENDIAN
2385e92481f9SChas Williams #define FW_EXT ".bin"
2386e92481f9SChas Williams #else
2387e92481f9SChas Williams #define FW_EXT "_ecd.bin2"
2388e92481f9SChas Williams #endif
23891da177e4SLinus Torvalds 
fore200e_load_and_start_fw(struct fore200e * fore200e)23906c44512dSGreg Kroah-Hartman static int fore200e_load_and_start_fw(struct fore200e *fore200e)
23911da177e4SLinus Torvalds {
2392e92481f9SChas Williams     const struct firmware *firmware;
2393b65b24d4SLABBE Corentin     const struct fw_header *fw_header;
23946f75a9b6SChas Williams     const __le32 *fw_data;
23956f75a9b6SChas Williams     u32 fw_size;
2396e92481f9SChas Williams     u32 __iomem *load_addr;
2397e92481f9SChas Williams     char buf[48];
2398aff9d262SChristoph Hellwig     int err;
2399e92481f9SChas Williams 
2400e92481f9SChas Williams     sprintf(buf, "%s%s", fore200e->bus->proc_name, FW_EXT);
2401aff9d262SChristoph Hellwig     if ((err = request_firmware(&firmware, buf, fore200e->dev)) < 0) {
2402fcffd0d8SMeelis Roos 	printk(FORE200E "problem loading firmware image %s\n", fore200e->bus->model_name);
2403e92481f9SChas Williams 	return err;
2404e92481f9SChas Williams     }
2405e92481f9SChas Williams 
2406b65b24d4SLABBE Corentin     fw_data = (const __le32 *)firmware->data;
2407e92481f9SChas Williams     fw_size = firmware->size / sizeof(u32);
2408b65b24d4SLABBE Corentin     fw_header = (const struct fw_header *)firmware->data;
2409e92481f9SChas Williams     load_addr = fore200e->virt_base + le32_to_cpu(fw_header->load_offset);
2410e92481f9SChas Williams 
2411e92481f9SChas Williams     DPRINTK(2, "device %s firmware being loaded at 0x%p (%d words)\n",
2412e92481f9SChas Williams 	    fore200e->name, load_addr, fw_size);
2413e92481f9SChas Williams 
2414e92481f9SChas Williams     if (le32_to_cpu(fw_header->magic) != FW_HEADER_MAGIC) {
2415e92481f9SChas Williams 	printk(FORE200E "corrupted %s firmware image\n", fore200e->bus->model_name);
2416e92481f9SChas Williams 	goto release;
2417e92481f9SChas Williams     }
2418e92481f9SChas Williams 
2419e92481f9SChas Williams     for (; fw_size--; fw_data++, load_addr++)
2420e92481f9SChas Williams 	fore200e->bus->write(le32_to_cpu(*fw_data), load_addr);
24211da177e4SLinus Torvalds 
24221da177e4SLinus Torvalds     DPRINTK(2, "device %s firmware being started\n", fore200e->name);
24231da177e4SLinus Torvalds 
24241da177e4SLinus Torvalds #if defined(__sparc_v9__)
24251da177e4SLinus Torvalds     /* reported to be required by SBA cards on some sparc64 hosts */
24261da177e4SLinus Torvalds     fore200e_spin(100);
24271da177e4SLinus Torvalds #endif
24281da177e4SLinus Torvalds 
2429e92481f9SChas Williams     sprintf(buf, "\rgo %x\r", le32_to_cpu(fw_header->start_offset));
2430e92481f9SChas Williams     fore200e_monitor_puts(fore200e, buf);
24311da177e4SLinus Torvalds 
2432e92481f9SChas Williams     if (fore200e_io_poll(fore200e, &fore200e->cp_monitor->bstat, BSTAT_CP_RUNNING, 1000) == 0) {
24331da177e4SLinus Torvalds 	printk(FORE200E "device %s firmware didn't start\n", fore200e->name);
2434e92481f9SChas Williams 	goto release;
24351da177e4SLinus Torvalds     }
24361da177e4SLinus Torvalds 
24371da177e4SLinus Torvalds     printk(FORE200E "device %s firmware started\n", fore200e->name);
24381da177e4SLinus Torvalds 
24391da177e4SLinus Torvalds     fore200e->state = FORE200E_STATE_START_FW;
2440e92481f9SChas Williams     err = 0;
24411da177e4SLinus Torvalds 
2442e92481f9SChas Williams release:
2443e92481f9SChas Williams     release_firmware(firmware);
2444e92481f9SChas Williams     return err;
24451da177e4SLinus Torvalds }
24461da177e4SLinus Torvalds 
24471da177e4SLinus Torvalds 
fore200e_register(struct fore200e * fore200e,struct device * parent)24486c44512dSGreg Kroah-Hartman static int fore200e_register(struct fore200e *fore200e, struct device *parent)
24491da177e4SLinus Torvalds {
24501da177e4SLinus Torvalds     struct atm_dev* atm_dev;
24511da177e4SLinus Torvalds 
24521da177e4SLinus Torvalds     DPRINTK(2, "device %s being registered\n", fore200e->name);
24531da177e4SLinus Torvalds 
2454d9ca676bSDan Williams     atm_dev = atm_dev_register(fore200e->bus->proc_name, parent, &fore200e_ops,
2455d9ca676bSDan Williams                                -1, NULL);
24561da177e4SLinus Torvalds     if (atm_dev == NULL) {
24571da177e4SLinus Torvalds 	printk(FORE200E "unable to register device %s\n", fore200e->name);
24581da177e4SLinus Torvalds 	return -ENODEV;
24591da177e4SLinus Torvalds     }
24601da177e4SLinus Torvalds 
24611da177e4SLinus Torvalds     atm_dev->dev_data = fore200e;
24621da177e4SLinus Torvalds     fore200e->atm_dev = atm_dev;
24631da177e4SLinus Torvalds 
24641da177e4SLinus Torvalds     atm_dev->ci_range.vpi_bits = FORE200E_VPI_BITS;
24651da177e4SLinus Torvalds     atm_dev->ci_range.vci_bits = FORE200E_VCI_BITS;
24661da177e4SLinus Torvalds 
24671da177e4SLinus Torvalds     fore200e->available_cell_rate = ATM_OC3_PCR;
24681da177e4SLinus Torvalds 
24691da177e4SLinus Torvalds     fore200e->state = FORE200E_STATE_REGISTER;
24701da177e4SLinus Torvalds     return 0;
24711da177e4SLinus Torvalds }
24721da177e4SLinus Torvalds 
24731da177e4SLinus Torvalds 
fore200e_init(struct fore200e * fore200e,struct device * parent)24746c44512dSGreg Kroah-Hartman static int fore200e_init(struct fore200e *fore200e, struct device *parent)
24751da177e4SLinus Torvalds {
2476d9ca676bSDan Williams     if (fore200e_register(fore200e, parent) < 0)
24771da177e4SLinus Torvalds 	return -ENODEV;
24781da177e4SLinus Torvalds 
24791da177e4SLinus Torvalds     if (fore200e->bus->configure(fore200e) < 0)
24801da177e4SLinus Torvalds 	return -ENODEV;
24811da177e4SLinus Torvalds 
24821da177e4SLinus Torvalds     if (fore200e->bus->map(fore200e) < 0)
24831da177e4SLinus Torvalds 	return -ENODEV;
24841da177e4SLinus Torvalds 
24851da177e4SLinus Torvalds     if (fore200e_reset(fore200e, 1) < 0)
24861da177e4SLinus Torvalds 	return -ENODEV;
24871da177e4SLinus Torvalds 
2488e92481f9SChas Williams     if (fore200e_load_and_start_fw(fore200e) < 0)
24891da177e4SLinus Torvalds 	return -ENODEV;
24901da177e4SLinus Torvalds 
24911da177e4SLinus Torvalds     if (fore200e_initialize(fore200e) < 0)
24921da177e4SLinus Torvalds 	return -ENODEV;
24931da177e4SLinus Torvalds 
24941da177e4SLinus Torvalds     if (fore200e_init_cmd_queue(fore200e) < 0)
24951da177e4SLinus Torvalds 	return -ENOMEM;
24961da177e4SLinus Torvalds 
24971da177e4SLinus Torvalds     if (fore200e_init_tx_queue(fore200e) < 0)
24981da177e4SLinus Torvalds 	return -ENOMEM;
24991da177e4SLinus Torvalds 
25001da177e4SLinus Torvalds     if (fore200e_init_rx_queue(fore200e) < 0)
25011da177e4SLinus Torvalds 	return -ENOMEM;
25021da177e4SLinus Torvalds 
25031da177e4SLinus Torvalds     if (fore200e_init_bs_queue(fore200e) < 0)
25041da177e4SLinus Torvalds 	return -ENOMEM;
25051da177e4SLinus Torvalds 
25061da177e4SLinus Torvalds     if (fore200e_alloc_rx_buf(fore200e) < 0)
25071da177e4SLinus Torvalds 	return -ENOMEM;
25081da177e4SLinus Torvalds 
25091da177e4SLinus Torvalds     if (fore200e_get_esi(fore200e) < 0)
25101da177e4SLinus Torvalds 	return -EIO;
25111da177e4SLinus Torvalds 
25121da177e4SLinus Torvalds     if (fore200e_irq_request(fore200e) < 0)
25131da177e4SLinus Torvalds 	return -EBUSY;
25141da177e4SLinus Torvalds 
25151da177e4SLinus Torvalds     fore200e_supply(fore200e);
25161da177e4SLinus Torvalds 
25171da177e4SLinus Torvalds     /* all done, board initialization is now complete */
25181da177e4SLinus Torvalds     fore200e->state = FORE200E_STATE_COMPLETE;
25191da177e4SLinus Torvalds     return 0;
25201da177e4SLinus Torvalds }
25211da177e4SLinus Torvalds 
2522826b6cfcSDavid S. Miller #ifdef CONFIG_SBUS
2523b1608d69SGrant Likely static const struct of_device_id fore200e_sba_match[];
fore200e_sba_probe(struct platform_device * op)25246c44512dSGreg Kroah-Hartman static int fore200e_sba_probe(struct platform_device *op)
2525826b6cfcSDavid S. Miller {
2526b1608d69SGrant Likely 	const struct of_device_id *match;
2527826b6cfcSDavid S. Miller 	struct fore200e *fore200e;
2528826b6cfcSDavid S. Miller 	static int index = 0;
2529826b6cfcSDavid S. Miller 	int err;
2530826b6cfcSDavid S. Miller 
2531b1608d69SGrant Likely 	match = of_match_device(fore200e_sba_match, &op->dev);
2532b1608d69SGrant Likely 	if (!match)
25331c48a5c9SGrant Likely 		return -EINVAL;
25341c48a5c9SGrant Likely 
2535826b6cfcSDavid S. Miller 	fore200e = kzalloc(sizeof(struct fore200e), GFP_KERNEL);
2536826b6cfcSDavid S. Miller 	if (!fore200e)
2537826b6cfcSDavid S. Miller 		return -ENOMEM;
2538826b6cfcSDavid S. Miller 
25390efe5523SChristoph Hellwig 	fore200e->bus = &fore200e_sbus_ops;
2540aff9d262SChristoph Hellwig 	fore200e->dev = &op->dev;
25411636f8acSGrant Likely 	fore200e->irq = op->archdata.irqs[0];
2542826b6cfcSDavid S. Miller 	fore200e->phys_base = op->resource[0].start;
2543826b6cfcSDavid S. Miller 
25440efe5523SChristoph Hellwig 	sprintf(fore200e->name, "SBA-200E-%d", index);
2545826b6cfcSDavid S. Miller 
2546d9ca676bSDan Williams 	err = fore200e_init(fore200e, &op->dev);
2547826b6cfcSDavid S. Miller 	if (err < 0) {
2548826b6cfcSDavid S. Miller 		fore200e_shutdown(fore200e);
2549826b6cfcSDavid S. Miller 		kfree(fore200e);
2550826b6cfcSDavid S. Miller 		return err;
2551826b6cfcSDavid S. Miller 	}
2552826b6cfcSDavid S. Miller 
2553826b6cfcSDavid S. Miller 	index++;
2554826b6cfcSDavid S. Miller 	dev_set_drvdata(&op->dev, fore200e);
2555826b6cfcSDavid S. Miller 
2556826b6cfcSDavid S. Miller 	return 0;
2557826b6cfcSDavid S. Miller }
2558826b6cfcSDavid S. Miller 
fore200e_sba_remove(struct platform_device * op)25596c44512dSGreg Kroah-Hartman static int fore200e_sba_remove(struct platform_device *op)
2560826b6cfcSDavid S. Miller {
2561826b6cfcSDavid S. Miller 	struct fore200e *fore200e = dev_get_drvdata(&op->dev);
2562826b6cfcSDavid S. Miller 
2563826b6cfcSDavid S. Miller 	fore200e_shutdown(fore200e);
2564826b6cfcSDavid S. Miller 	kfree(fore200e);
2565826b6cfcSDavid S. Miller 
2566826b6cfcSDavid S. Miller 	return 0;
2567826b6cfcSDavid S. Miller }
2568826b6cfcSDavid S. Miller 
2569fd098316SDavid S. Miller static const struct of_device_id fore200e_sba_match[] = {
2570826b6cfcSDavid S. Miller 	{
2571826b6cfcSDavid S. Miller 		.name = SBA200E_PROM_NAME,
2572826b6cfcSDavid S. Miller 	},
2573826b6cfcSDavid S. Miller 	{},
2574826b6cfcSDavid S. Miller };
2575826b6cfcSDavid S. Miller MODULE_DEVICE_TABLE(of, fore200e_sba_match);
2576826b6cfcSDavid S. Miller 
25771c48a5c9SGrant Likely static struct platform_driver fore200e_sba_driver = {
25784018294bSGrant Likely 	.driver = {
2579826b6cfcSDavid S. Miller 		.name = "fore_200e",
25804018294bSGrant Likely 		.of_match_table = fore200e_sba_match,
25814018294bSGrant Likely 	},
2582826b6cfcSDavid S. Miller 	.probe		= fore200e_sba_probe,
25836c44512dSGreg Kroah-Hartman 	.remove		= fore200e_sba_remove,
2584826b6cfcSDavid S. Miller };
2585826b6cfcSDavid S. Miller #endif
2586826b6cfcSDavid S. Miller 
2587e92481f9SChas Williams #ifdef CONFIG_PCI
fore200e_pca_detect(struct pci_dev * pci_dev,const struct pci_device_id * pci_ent)25886c44512dSGreg Kroah-Hartman static int fore200e_pca_detect(struct pci_dev *pci_dev,
25896c44512dSGreg Kroah-Hartman 			       const struct pci_device_id *pci_ent)
25901da177e4SLinus Torvalds {
25911da177e4SLinus Torvalds     struct fore200e* fore200e;
25921da177e4SLinus Torvalds     int err = 0;
25931da177e4SLinus Torvalds     static int index = 0;
25941da177e4SLinus Torvalds 
25951da177e4SLinus Torvalds     if (pci_enable_device(pci_dev)) {
25961da177e4SLinus Torvalds 	err = -EINVAL;
25971da177e4SLinus Torvalds 	goto out;
25981da177e4SLinus Torvalds     }
25991da177e4SLinus Torvalds 
2600ede58ef2Schas williams - CONTRACTOR     if (dma_set_mask_and_coherent(&pci_dev->dev, DMA_BIT_MASK(32))) {
2601ede58ef2Schas williams - CONTRACTOR 	err = -EINVAL;
2602ede58ef2Schas williams - CONTRACTOR 	goto out;
2603ede58ef2Schas williams - CONTRACTOR     }
2604ede58ef2Schas williams - CONTRACTOR 
26051f8a5fb8SAdrian Bunk     fore200e = kzalloc(sizeof(struct fore200e), GFP_KERNEL);
26061da177e4SLinus Torvalds     if (fore200e == NULL) {
26071da177e4SLinus Torvalds 	err = -ENOMEM;
26081da177e4SLinus Torvalds 	goto out_disable;
26091da177e4SLinus Torvalds     }
26101da177e4SLinus Torvalds 
26110efe5523SChristoph Hellwig     fore200e->bus       = &fore200e_pci_ops;
2612aff9d262SChristoph Hellwig     fore200e->dev	= &pci_dev->dev;
26131da177e4SLinus Torvalds     fore200e->irq       = pci_dev->irq;
26141da177e4SLinus Torvalds     fore200e->phys_base = pci_resource_start(pci_dev, 0);
26151da177e4SLinus Torvalds 
26160efe5523SChristoph Hellwig     sprintf(fore200e->name, "PCA-200E-%d", index - 1);
26171da177e4SLinus Torvalds 
26181da177e4SLinus Torvalds     pci_set_master(pci_dev);
26191da177e4SLinus Torvalds 
26200efe5523SChristoph Hellwig     printk(FORE200E "device PCA-200E found at 0x%lx, IRQ %s\n",
26211da177e4SLinus Torvalds 	   fore200e->phys_base, fore200e_irq_itoa(fore200e->irq));
26221da177e4SLinus Torvalds 
26230efe5523SChristoph Hellwig     sprintf(fore200e->name, "PCA-200E-%d", index);
26241da177e4SLinus Torvalds 
2625d9ca676bSDan Williams     err = fore200e_init(fore200e, &pci_dev->dev);
26261da177e4SLinus Torvalds     if (err < 0) {
26271da177e4SLinus Torvalds 	fore200e_shutdown(fore200e);
26281da177e4SLinus Torvalds 	goto out_free;
26291da177e4SLinus Torvalds     }
26301da177e4SLinus Torvalds 
26311da177e4SLinus Torvalds     ++index;
26321da177e4SLinus Torvalds     pci_set_drvdata(pci_dev, fore200e);
26331da177e4SLinus Torvalds 
26341da177e4SLinus Torvalds out:
26351da177e4SLinus Torvalds     return err;
26361da177e4SLinus Torvalds 
26371da177e4SLinus Torvalds out_free:
26381da177e4SLinus Torvalds     kfree(fore200e);
26391da177e4SLinus Torvalds out_disable:
26401da177e4SLinus Torvalds     pci_disable_device(pci_dev);
26411da177e4SLinus Torvalds     goto out;
26421da177e4SLinus Torvalds }
26431da177e4SLinus Torvalds 
26441da177e4SLinus Torvalds 
fore200e_pca_remove_one(struct pci_dev * pci_dev)26456c44512dSGreg Kroah-Hartman static void fore200e_pca_remove_one(struct pci_dev *pci_dev)
26461da177e4SLinus Torvalds {
26471da177e4SLinus Torvalds     struct fore200e *fore200e;
26481da177e4SLinus Torvalds 
26491da177e4SLinus Torvalds     fore200e = pci_get_drvdata(pci_dev);
26501da177e4SLinus Torvalds 
26511da177e4SLinus Torvalds     fore200e_shutdown(fore200e);
26521da177e4SLinus Torvalds     kfree(fore200e);
26531da177e4SLinus Torvalds     pci_disable_device(pci_dev);
26541da177e4SLinus Torvalds }
26551da177e4SLinus Torvalds 
26561da177e4SLinus Torvalds 
2657d5c5665dSArvind Yadav static const struct pci_device_id fore200e_pca_tbl[] = {
26580efe5523SChristoph Hellwig     { PCI_VENDOR_ID_FORE, PCI_DEVICE_ID_FORE_PCA200E, PCI_ANY_ID, PCI_ANY_ID },
26591da177e4SLinus Torvalds     { 0, }
26601da177e4SLinus Torvalds };
26611da177e4SLinus Torvalds 
26621da177e4SLinus Torvalds MODULE_DEVICE_TABLE(pci, fore200e_pca_tbl);
26631da177e4SLinus Torvalds 
26641da177e4SLinus Torvalds static struct pci_driver fore200e_pca_driver = {
26651da177e4SLinus Torvalds     .name =     "fore_200e",
26661da177e4SLinus Torvalds     .probe =    fore200e_pca_detect,
26676c44512dSGreg Kroah-Hartman     .remove =   fore200e_pca_remove_one,
26681da177e4SLinus Torvalds     .id_table = fore200e_pca_tbl,
26691da177e4SLinus Torvalds };
26701da177e4SLinus Torvalds #endif
26711da177e4SLinus Torvalds 
fore200e_module_init(void)2672826b6cfcSDavid S. Miller static int __init fore200e_module_init(void)
26731da177e4SLinus Torvalds {
267474e8ce34SRickard Strandqvist 	int err = 0;
26751da177e4SLinus Torvalds 
26761da177e4SLinus Torvalds 	printk(FORE200E "FORE Systems 200E-series ATM driver - version " FORE200E_VERSION "\n");
26771da177e4SLinus Torvalds 
2678826b6cfcSDavid S. Miller #ifdef CONFIG_SBUS
26791c48a5c9SGrant Likely 	err = platform_driver_register(&fore200e_sba_driver);
2680826b6cfcSDavid S. Miller 	if (err)
2681826b6cfcSDavid S. Miller 		return err;
26821da177e4SLinus Torvalds #endif
26831da177e4SLinus Torvalds 
2684826b6cfcSDavid S. Miller #ifdef CONFIG_PCI
2685826b6cfcSDavid S. Miller 	err = pci_register_driver(&fore200e_pca_driver);
2686826b6cfcSDavid S. Miller #endif
26871da177e4SLinus Torvalds 
2688826b6cfcSDavid S. Miller #ifdef CONFIG_SBUS
2689826b6cfcSDavid S. Miller 	if (err)
26901c48a5c9SGrant Likely 		platform_driver_unregister(&fore200e_sba_driver);
2691826b6cfcSDavid S. Miller #endif
2692826b6cfcSDavid S. Miller 
2693826b6cfcSDavid S. Miller 	return err;
26941da177e4SLinus Torvalds }
26951da177e4SLinus Torvalds 
fore200e_module_cleanup(void)2696826b6cfcSDavid S. Miller static void __exit fore200e_module_cleanup(void)
26971da177e4SLinus Torvalds {
2698e92481f9SChas Williams #ifdef CONFIG_PCI
26991da177e4SLinus Torvalds 	pci_unregister_driver(&fore200e_pca_driver);
27001da177e4SLinus Torvalds #endif
2701826b6cfcSDavid S. Miller #ifdef CONFIG_SBUS
27021c48a5c9SGrant Likely 	platform_driver_unregister(&fore200e_sba_driver);
2703826b6cfcSDavid S. Miller #endif
27041da177e4SLinus Torvalds }
27051da177e4SLinus Torvalds 
27061da177e4SLinus Torvalds static int
fore200e_proc_read(struct atm_dev * dev,loff_t * pos,char * page)27071da177e4SLinus Torvalds fore200e_proc_read(struct atm_dev *dev, loff_t* pos, char* page)
27081da177e4SLinus Torvalds {
27091da177e4SLinus Torvalds     struct fore200e*     fore200e  = FORE200E_DEV(dev);
27101da177e4SLinus Torvalds     struct fore200e_vcc* fore200e_vcc;
27111da177e4SLinus Torvalds     struct atm_vcc*      vcc;
27121da177e4SLinus Torvalds     int                  i, len, left = *pos;
27131da177e4SLinus Torvalds     unsigned long        flags;
27141da177e4SLinus Torvalds 
27151da177e4SLinus Torvalds     if (!left--) {
27161da177e4SLinus Torvalds 
27171da177e4SLinus Torvalds 	if (fore200e_getstats(fore200e) < 0)
27181da177e4SLinus Torvalds 	    return -EIO;
27191da177e4SLinus Torvalds 
27201da177e4SLinus Torvalds 	len = sprintf(page,"\n"
27211da177e4SLinus Torvalds 		       " device:\n"
27221da177e4SLinus Torvalds 		       "   internal name:\t\t%s\n", fore200e->name);
27231da177e4SLinus Torvalds 
27241da177e4SLinus Torvalds 	/* print bus-specific information */
27251da177e4SLinus Torvalds 	if (fore200e->bus->proc_read)
27261da177e4SLinus Torvalds 	    len += fore200e->bus->proc_read(fore200e, page + len);
27271da177e4SLinus Torvalds 
27281da177e4SLinus Torvalds 	len += sprintf(page + len,
27291da177e4SLinus Torvalds 		"   interrupt line:\t\t%s\n"
27301da177e4SLinus Torvalds 		"   physical base address:\t0x%p\n"
27311da177e4SLinus Torvalds 		"   virtual base address:\t0x%p\n"
27323008ab36Shartleys 		"   factory address (ESI):\t%pM\n"
27331da177e4SLinus Torvalds 		"   board serial number:\t\t%d\n\n",
27341da177e4SLinus Torvalds 		fore200e_irq_itoa(fore200e->irq),
27351da177e4SLinus Torvalds 		(void*)fore200e->phys_base,
27361da177e4SLinus Torvalds 		fore200e->virt_base,
27373008ab36Shartleys 		fore200e->esi,
27381da177e4SLinus Torvalds 		fore200e->esi[4] * 256 + fore200e->esi[5]);
27391da177e4SLinus Torvalds 
27401da177e4SLinus Torvalds 	return len;
27411da177e4SLinus Torvalds     }
27421da177e4SLinus Torvalds 
27431da177e4SLinus Torvalds     if (!left--)
27441da177e4SLinus Torvalds 	return sprintf(page,
27451da177e4SLinus Torvalds 		       "   free small bufs, scheme 1:\t%d\n"
27461da177e4SLinus Torvalds 		       "   free large bufs, scheme 1:\t%d\n"
27471da177e4SLinus Torvalds 		       "   free small bufs, scheme 2:\t%d\n"
27481da177e4SLinus Torvalds 		       "   free large bufs, scheme 2:\t%d\n",
27491da177e4SLinus Torvalds 		       fore200e->host_bsq[ BUFFER_SCHEME_ONE ][ BUFFER_MAGN_SMALL ].freebuf_count,
27501da177e4SLinus Torvalds 		       fore200e->host_bsq[ BUFFER_SCHEME_ONE ][ BUFFER_MAGN_LARGE ].freebuf_count,
27511da177e4SLinus Torvalds 		       fore200e->host_bsq[ BUFFER_SCHEME_TWO ][ BUFFER_MAGN_SMALL ].freebuf_count,
27521da177e4SLinus Torvalds 		       fore200e->host_bsq[ BUFFER_SCHEME_TWO ][ BUFFER_MAGN_LARGE ].freebuf_count);
27531da177e4SLinus Torvalds 
27541da177e4SLinus Torvalds     if (!left--) {
27551da177e4SLinus Torvalds 	u32 hb = fore200e->bus->read(&fore200e->cp_queues->heartbeat);
27561da177e4SLinus Torvalds 
27571da177e4SLinus Torvalds 	len = sprintf(page,"\n\n"
27581da177e4SLinus Torvalds 		      " cell processor:\n"
27591da177e4SLinus Torvalds 		      "   heartbeat state:\t\t");
27601da177e4SLinus Torvalds 
27611da177e4SLinus Torvalds 	if (hb >> 16 != 0xDEAD)
27621da177e4SLinus Torvalds 	    len += sprintf(page + len, "0x%08x\n", hb);
27631da177e4SLinus Torvalds 	else
27641da177e4SLinus Torvalds 	    len += sprintf(page + len, "*** FATAL ERROR %04x ***\n", hb & 0xFFFF);
27651da177e4SLinus Torvalds 
27661da177e4SLinus Torvalds 	return len;
27671da177e4SLinus Torvalds     }
27681da177e4SLinus Torvalds 
27691da177e4SLinus Torvalds     if (!left--) {
27701da177e4SLinus Torvalds 	static const char* media_name[] = {
27711da177e4SLinus Torvalds 	    "unshielded twisted pair",
27721da177e4SLinus Torvalds 	    "multimode optical fiber ST",
27731da177e4SLinus Torvalds 	    "multimode optical fiber SC",
27741da177e4SLinus Torvalds 	    "single-mode optical fiber ST",
27751da177e4SLinus Torvalds 	    "single-mode optical fiber SC",
27761da177e4SLinus Torvalds 	    "unknown"
27771da177e4SLinus Torvalds 	};
27781da177e4SLinus Torvalds 
27791da177e4SLinus Torvalds 	static const char* oc3_mode[] = {
27801da177e4SLinus Torvalds 	    "normal operation",
27811da177e4SLinus Torvalds 	    "diagnostic loopback",
27821da177e4SLinus Torvalds 	    "line loopback",
27831da177e4SLinus Torvalds 	    "unknown"
27841da177e4SLinus Torvalds 	};
27851da177e4SLinus Torvalds 
27861da177e4SLinus Torvalds 	u32 fw_release     = fore200e->bus->read(&fore200e->cp_queues->fw_release);
27871da177e4SLinus Torvalds 	u32 mon960_release = fore200e->bus->read(&fore200e->cp_queues->mon960_release);
27881da177e4SLinus Torvalds 	u32 oc3_revision   = fore200e->bus->read(&fore200e->cp_queues->oc3_revision);
27891da177e4SLinus Torvalds 	u32 media_index    = FORE200E_MEDIA_INDEX(fore200e->bus->read(&fore200e->cp_queues->media_type));
27901da177e4SLinus Torvalds 	u32 oc3_index;
27911da177e4SLinus Torvalds 
2792e0c5567dSroel kluin 	if (media_index > 4)
27931da177e4SLinus Torvalds 		media_index = 5;
27941da177e4SLinus Torvalds 
27951da177e4SLinus Torvalds 	switch (fore200e->loop_mode) {
27961da177e4SLinus Torvalds 	    case ATM_LM_NONE:    oc3_index = 0;
27971da177e4SLinus Torvalds 		                 break;
27981da177e4SLinus Torvalds 	    case ATM_LM_LOC_PHY: oc3_index = 1;
27991da177e4SLinus Torvalds 		                 break;
28001da177e4SLinus Torvalds 	    case ATM_LM_RMT_PHY: oc3_index = 2;
28011da177e4SLinus Torvalds 		                 break;
28021da177e4SLinus Torvalds 	    default:             oc3_index = 3;
28031da177e4SLinus Torvalds 	}
28041da177e4SLinus Torvalds 
28051da177e4SLinus Torvalds 	return sprintf(page,
28061da177e4SLinus Torvalds 		       "   firmware release:\t\t%d.%d.%d\n"
28071da177e4SLinus Torvalds 		       "   monitor release:\t\t%d.%d\n"
28081da177e4SLinus Torvalds 		       "   media type:\t\t\t%s\n"
28091da177e4SLinus Torvalds 		       "   OC-3 revision:\t\t0x%x\n"
28101da177e4SLinus Torvalds                        "   OC-3 mode:\t\t\t%s",
28111da177e4SLinus Torvalds 		       fw_release >> 16, fw_release << 16 >> 24,  fw_release << 24 >> 24,
28121da177e4SLinus Torvalds 		       mon960_release >> 16, mon960_release << 16 >> 16,
28131da177e4SLinus Torvalds 		       media_name[ media_index ],
28141da177e4SLinus Torvalds 		       oc3_revision,
28151da177e4SLinus Torvalds 		       oc3_mode[ oc3_index ]);
28161da177e4SLinus Torvalds     }
28171da177e4SLinus Torvalds 
28181da177e4SLinus Torvalds     if (!left--) {
28191da177e4SLinus Torvalds 	struct cp_monitor __iomem * cp_monitor = fore200e->cp_monitor;
28201da177e4SLinus Torvalds 
28211da177e4SLinus Torvalds 	return sprintf(page,
28221da177e4SLinus Torvalds 		       "\n\n"
28231da177e4SLinus Torvalds 		       " monitor:\n"
28241da177e4SLinus Torvalds 		       "   version number:\t\t%d\n"
28251da177e4SLinus Torvalds 		       "   boot status word:\t\t0x%08x\n",
28261da177e4SLinus Torvalds 		       fore200e->bus->read(&cp_monitor->mon_version),
28271da177e4SLinus Torvalds 		       fore200e->bus->read(&cp_monitor->bstat));
28281da177e4SLinus Torvalds     }
28291da177e4SLinus Torvalds 
28301da177e4SLinus Torvalds     if (!left--)
28311da177e4SLinus Torvalds 	return sprintf(page,
28321da177e4SLinus Torvalds 		       "\n"
28331da177e4SLinus Torvalds 		       " device statistics:\n"
28341da177e4SLinus Torvalds 		       "  4b5b:\n"
28351da177e4SLinus Torvalds 		       "     crc_header_errors:\t\t%10u\n"
28361da177e4SLinus Torvalds 		       "     framing_errors:\t\t%10u\n",
283763734a32SAl Viro 		       be32_to_cpu(fore200e->stats->phy.crc_header_errors),
283863734a32SAl Viro 		       be32_to_cpu(fore200e->stats->phy.framing_errors));
28391da177e4SLinus Torvalds 
28401da177e4SLinus Torvalds     if (!left--)
28411da177e4SLinus Torvalds 	return sprintf(page, "\n"
28421da177e4SLinus Torvalds 		       "  OC-3:\n"
28431da177e4SLinus Torvalds 		       "     section_bip8_errors:\t%10u\n"
28441da177e4SLinus Torvalds 		       "     path_bip8_errors:\t\t%10u\n"
28451da177e4SLinus Torvalds 		       "     line_bip24_errors:\t\t%10u\n"
28461da177e4SLinus Torvalds 		       "     line_febe_errors:\t\t%10u\n"
28471da177e4SLinus Torvalds 		       "     path_febe_errors:\t\t%10u\n"
28481da177e4SLinus Torvalds 		       "     corr_hcs_errors:\t\t%10u\n"
28491da177e4SLinus Torvalds 		       "     ucorr_hcs_errors:\t\t%10u\n",
285063734a32SAl Viro 		       be32_to_cpu(fore200e->stats->oc3.section_bip8_errors),
285163734a32SAl Viro 		       be32_to_cpu(fore200e->stats->oc3.path_bip8_errors),
285263734a32SAl Viro 		       be32_to_cpu(fore200e->stats->oc3.line_bip24_errors),
285363734a32SAl Viro 		       be32_to_cpu(fore200e->stats->oc3.line_febe_errors),
285463734a32SAl Viro 		       be32_to_cpu(fore200e->stats->oc3.path_febe_errors),
285563734a32SAl Viro 		       be32_to_cpu(fore200e->stats->oc3.corr_hcs_errors),
285663734a32SAl Viro 		       be32_to_cpu(fore200e->stats->oc3.ucorr_hcs_errors));
28571da177e4SLinus Torvalds 
28581da177e4SLinus Torvalds     if (!left--)
28591da177e4SLinus Torvalds 	return sprintf(page,"\n"
28601da177e4SLinus Torvalds 		       "   ATM:\t\t\t\t     cells\n"
28611da177e4SLinus Torvalds 		       "     TX:\t\t\t%10u\n"
28621da177e4SLinus Torvalds 		       "     RX:\t\t\t%10u\n"
28631da177e4SLinus Torvalds 		       "     vpi out of range:\t\t%10u\n"
28641da177e4SLinus Torvalds 		       "     vpi no conn:\t\t%10u\n"
28651da177e4SLinus Torvalds 		       "     vci out of range:\t\t%10u\n"
28661da177e4SLinus Torvalds 		       "     vci no conn:\t\t%10u\n",
286763734a32SAl Viro 		       be32_to_cpu(fore200e->stats->atm.cells_transmitted),
286863734a32SAl Viro 		       be32_to_cpu(fore200e->stats->atm.cells_received),
286963734a32SAl Viro 		       be32_to_cpu(fore200e->stats->atm.vpi_bad_range),
287063734a32SAl Viro 		       be32_to_cpu(fore200e->stats->atm.vpi_no_conn),
287163734a32SAl Viro 		       be32_to_cpu(fore200e->stats->atm.vci_bad_range),
287263734a32SAl Viro 		       be32_to_cpu(fore200e->stats->atm.vci_no_conn));
28731da177e4SLinus Torvalds 
28741da177e4SLinus Torvalds     if (!left--)
28751da177e4SLinus Torvalds 	return sprintf(page,"\n"
28761da177e4SLinus Torvalds 		       "   AAL0:\t\t\t     cells\n"
28771da177e4SLinus Torvalds 		       "     TX:\t\t\t%10u\n"
28781da177e4SLinus Torvalds 		       "     RX:\t\t\t%10u\n"
28791da177e4SLinus Torvalds 		       "     dropped:\t\t\t%10u\n",
288063734a32SAl Viro 		       be32_to_cpu(fore200e->stats->aal0.cells_transmitted),
288163734a32SAl Viro 		       be32_to_cpu(fore200e->stats->aal0.cells_received),
288263734a32SAl Viro 		       be32_to_cpu(fore200e->stats->aal0.cells_dropped));
28831da177e4SLinus Torvalds 
28841da177e4SLinus Torvalds     if (!left--)
28851da177e4SLinus Torvalds 	return sprintf(page,"\n"
28861da177e4SLinus Torvalds 		       "   AAL3/4:\n"
28871da177e4SLinus Torvalds 		       "     SAR sublayer:\t\t     cells\n"
28881da177e4SLinus Torvalds 		       "       TX:\t\t\t%10u\n"
28891da177e4SLinus Torvalds 		       "       RX:\t\t\t%10u\n"
28901da177e4SLinus Torvalds 		       "       dropped:\t\t\t%10u\n"
28911da177e4SLinus Torvalds 		       "       CRC errors:\t\t%10u\n"
28921da177e4SLinus Torvalds 		       "       protocol errors:\t\t%10u\n\n"
28931da177e4SLinus Torvalds 		       "     CS  sublayer:\t\t      PDUs\n"
28941da177e4SLinus Torvalds 		       "       TX:\t\t\t%10u\n"
28951da177e4SLinus Torvalds 		       "       RX:\t\t\t%10u\n"
28961da177e4SLinus Torvalds 		       "       dropped:\t\t\t%10u\n"
28971da177e4SLinus Torvalds 		       "       protocol errors:\t\t%10u\n",
289863734a32SAl Viro 		       be32_to_cpu(fore200e->stats->aal34.cells_transmitted),
289963734a32SAl Viro 		       be32_to_cpu(fore200e->stats->aal34.cells_received),
290063734a32SAl Viro 		       be32_to_cpu(fore200e->stats->aal34.cells_dropped),
290163734a32SAl Viro 		       be32_to_cpu(fore200e->stats->aal34.cells_crc_errors),
290263734a32SAl Viro 		       be32_to_cpu(fore200e->stats->aal34.cells_protocol_errors),
290363734a32SAl Viro 		       be32_to_cpu(fore200e->stats->aal34.cspdus_transmitted),
290463734a32SAl Viro 		       be32_to_cpu(fore200e->stats->aal34.cspdus_received),
290563734a32SAl Viro 		       be32_to_cpu(fore200e->stats->aal34.cspdus_dropped),
290663734a32SAl Viro 		       be32_to_cpu(fore200e->stats->aal34.cspdus_protocol_errors));
29071da177e4SLinus Torvalds 
29081da177e4SLinus Torvalds     if (!left--)
29091da177e4SLinus Torvalds 	return sprintf(page,"\n"
29101da177e4SLinus Torvalds 		       "   AAL5:\n"
29111da177e4SLinus Torvalds 		       "     SAR sublayer:\t\t     cells\n"
29121da177e4SLinus Torvalds 		       "       TX:\t\t\t%10u\n"
29131da177e4SLinus Torvalds 		       "       RX:\t\t\t%10u\n"
29141da177e4SLinus Torvalds 		       "       dropped:\t\t\t%10u\n"
29151da177e4SLinus Torvalds 		       "       congestions:\t\t%10u\n\n"
29161da177e4SLinus Torvalds 		       "     CS  sublayer:\t\t      PDUs\n"
29171da177e4SLinus Torvalds 		       "       TX:\t\t\t%10u\n"
29181da177e4SLinus Torvalds 		       "       RX:\t\t\t%10u\n"
29191da177e4SLinus Torvalds 		       "       dropped:\t\t\t%10u\n"
29201da177e4SLinus Torvalds 		       "       CRC errors:\t\t%10u\n"
29211da177e4SLinus Torvalds 		       "       protocol errors:\t\t%10u\n",
292263734a32SAl Viro 		       be32_to_cpu(fore200e->stats->aal5.cells_transmitted),
292363734a32SAl Viro 		       be32_to_cpu(fore200e->stats->aal5.cells_received),
292463734a32SAl Viro 		       be32_to_cpu(fore200e->stats->aal5.cells_dropped),
292563734a32SAl Viro 		       be32_to_cpu(fore200e->stats->aal5.congestion_experienced),
292663734a32SAl Viro 		       be32_to_cpu(fore200e->stats->aal5.cspdus_transmitted),
292763734a32SAl Viro 		       be32_to_cpu(fore200e->stats->aal5.cspdus_received),
292863734a32SAl Viro 		       be32_to_cpu(fore200e->stats->aal5.cspdus_dropped),
292963734a32SAl Viro 		       be32_to_cpu(fore200e->stats->aal5.cspdus_crc_errors),
293063734a32SAl Viro 		       be32_to_cpu(fore200e->stats->aal5.cspdus_protocol_errors));
29311da177e4SLinus Torvalds 
29321da177e4SLinus Torvalds     if (!left--)
29331da177e4SLinus Torvalds 	return sprintf(page,"\n"
29341da177e4SLinus Torvalds 		       "   AUX:\t\t       allocation failures\n"
29351da177e4SLinus Torvalds 		       "     small b1:\t\t\t%10u\n"
29361da177e4SLinus Torvalds 		       "     large b1:\t\t\t%10u\n"
29371da177e4SLinus Torvalds 		       "     small b2:\t\t\t%10u\n"
29381da177e4SLinus Torvalds 		       "     large b2:\t\t\t%10u\n"
29391da177e4SLinus Torvalds 		       "     RX PDUs:\t\t\t%10u\n"
29401da177e4SLinus Torvalds 		       "     TX PDUs:\t\t\t%10lu\n",
294163734a32SAl Viro 		       be32_to_cpu(fore200e->stats->aux.small_b1_failed),
294263734a32SAl Viro 		       be32_to_cpu(fore200e->stats->aux.large_b1_failed),
294363734a32SAl Viro 		       be32_to_cpu(fore200e->stats->aux.small_b2_failed),
294463734a32SAl Viro 		       be32_to_cpu(fore200e->stats->aux.large_b2_failed),
294563734a32SAl Viro 		       be32_to_cpu(fore200e->stats->aux.rpd_alloc_failed),
29461da177e4SLinus Torvalds 		       fore200e->tx_sat);
29471da177e4SLinus Torvalds 
29481da177e4SLinus Torvalds     if (!left--)
29491da177e4SLinus Torvalds 	return sprintf(page,"\n"
29501da177e4SLinus Torvalds 		       " receive carrier:\t\t\t%s\n",
29511da177e4SLinus Torvalds 		       fore200e->stats->aux.receive_carrier ? "ON" : "OFF!");
29521da177e4SLinus Torvalds 
29531da177e4SLinus Torvalds     if (!left--) {
29541da177e4SLinus Torvalds         return sprintf(page,"\n"
29551da177e4SLinus Torvalds 		       " VCCs:\n  address   VPI VCI   AAL "
29561da177e4SLinus Torvalds 		       "TX PDUs   TX min/max size  RX PDUs   RX min/max size\n");
29571da177e4SLinus Torvalds     }
29581da177e4SLinus Torvalds 
29591da177e4SLinus Torvalds     for (i = 0; i < NBR_CONNECT; i++) {
29601da177e4SLinus Torvalds 
29611da177e4SLinus Torvalds 	vcc = fore200e->vc_map[i].vcc;
29621da177e4SLinus Torvalds 
29631da177e4SLinus Torvalds 	if (vcc == NULL)
29641da177e4SLinus Torvalds 	    continue;
29651da177e4SLinus Torvalds 
29661da177e4SLinus Torvalds 	spin_lock_irqsave(&fore200e->q_lock, flags);
29671da177e4SLinus Torvalds 
29681da177e4SLinus Torvalds 	if (vcc && test_bit(ATM_VF_READY, &vcc->flags) && !left--) {
29691da177e4SLinus Torvalds 
29701da177e4SLinus Torvalds 	    fore200e_vcc = FORE200E_VCC(vcc);
29711da177e4SLinus Torvalds 	    ASSERT(fore200e_vcc);
29721da177e4SLinus Torvalds 
29731da177e4SLinus Torvalds 	    len = sprintf(page,
297422dac9f1SColin Ian King 			  "  %pK  %03d %05d %1d   %09lu %05d/%05d      %09lu %05d/%05d\n",
297522dac9f1SColin Ian King 			  vcc,
29761da177e4SLinus Torvalds 			  vcc->vpi, vcc->vci, fore200e_atm2fore_aal(vcc->qos.aal),
29771da177e4SLinus Torvalds 			  fore200e_vcc->tx_pdu,
29781da177e4SLinus Torvalds 			  fore200e_vcc->tx_min_pdu > 0xFFFF ? 0 : fore200e_vcc->tx_min_pdu,
29791da177e4SLinus Torvalds 			  fore200e_vcc->tx_max_pdu,
29801da177e4SLinus Torvalds 			  fore200e_vcc->rx_pdu,
29811da177e4SLinus Torvalds 			  fore200e_vcc->rx_min_pdu > 0xFFFF ? 0 : fore200e_vcc->rx_min_pdu,
29821da177e4SLinus Torvalds 			  fore200e_vcc->rx_max_pdu);
29831da177e4SLinus Torvalds 
29841da177e4SLinus Torvalds 	    spin_unlock_irqrestore(&fore200e->q_lock, flags);
29851da177e4SLinus Torvalds 	    return len;
29861da177e4SLinus Torvalds 	}
29871da177e4SLinus Torvalds 
29881da177e4SLinus Torvalds 	spin_unlock_irqrestore(&fore200e->q_lock, flags);
29891da177e4SLinus Torvalds     }
29901da177e4SLinus Torvalds 
29911da177e4SLinus Torvalds     return 0;
29921da177e4SLinus Torvalds }
29931da177e4SLinus Torvalds 
29941da177e4SLinus Torvalds module_init(fore200e_module_init);
29951da177e4SLinus Torvalds module_exit(fore200e_module_cleanup);
29961da177e4SLinus Torvalds 
29971da177e4SLinus Torvalds 
29980efe5523SChristoph Hellwig static const struct atmdev_ops fore200e_ops = {
29991da177e4SLinus Torvalds 	.open       = fore200e_open,
30001da177e4SLinus Torvalds 	.close      = fore200e_close,
30011da177e4SLinus Torvalds 	.ioctl      = fore200e_ioctl,
30021da177e4SLinus Torvalds 	.send       = fore200e_send,
30031da177e4SLinus Torvalds 	.change_qos = fore200e_change_qos,
30041da177e4SLinus Torvalds 	.proc_read  = fore200e_proc_read,
30051da177e4SLinus Torvalds 	.owner      = THIS_MODULE
30061da177e4SLinus Torvalds };
30071da177e4SLinus Torvalds 
30081da177e4SLinus Torvalds MODULE_LICENSE("GPL");
30096f75a9b6SChas Williams #ifdef CONFIG_PCI
30106f75a9b6SChas Williams #ifdef __LITTLE_ENDIAN__
30116f75a9b6SChas Williams MODULE_FIRMWARE("pca200e.bin");
30126f75a9b6SChas Williams #else
30136f75a9b6SChas Williams MODULE_FIRMWARE("pca200e_ecd.bin2");
30146f75a9b6SChas Williams #endif
30156f75a9b6SChas Williams #endif /* CONFIG_PCI */
30166f75a9b6SChas Williams #ifdef CONFIG_SBUS
30176f75a9b6SChas Williams MODULE_FIRMWARE("sba200e_ecd.bin2");
30181da177e4SLinus Torvalds #endif
3019