11da177e4SLinus Torvalds /* 21da177e4SLinus Torvalds A FORE Systems 200E-series driver for ATM on Linux. 31da177e4SLinus Torvalds Christophe Lizzi (lizzi@cnam.fr), October 1999-March 2003. 41da177e4SLinus Torvalds 51da177e4SLinus Torvalds Based on the PCA-200E driver from Uwe Dannowski (Uwe.Dannowski@inf.tu-dresden.de). 61da177e4SLinus Torvalds 71da177e4SLinus Torvalds This driver simultaneously supports PCA-200E and SBA-200E adapters 81da177e4SLinus Torvalds on i386, alpha (untested), powerpc, sparc and sparc64 architectures. 91da177e4SLinus Torvalds 101da177e4SLinus Torvalds This program is free software; you can redistribute it and/or modify 111da177e4SLinus Torvalds it under the terms of the GNU General Public License as published by 121da177e4SLinus Torvalds the Free Software Foundation; either version 2 of the License, or 131da177e4SLinus Torvalds (at your option) any later version. 141da177e4SLinus Torvalds 151da177e4SLinus Torvalds This program is distributed in the hope that it will be useful, 161da177e4SLinus Torvalds but WITHOUT ANY WARRANTY; without even the implied warranty of 171da177e4SLinus Torvalds MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 181da177e4SLinus Torvalds GNU General Public License for more details. 191da177e4SLinus Torvalds 201da177e4SLinus Torvalds You should have received a copy of the GNU General Public License 211da177e4SLinus Torvalds along with this program; if not, write to the Free Software 221da177e4SLinus Torvalds Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA 231da177e4SLinus Torvalds */ 241da177e4SLinus Torvalds 251da177e4SLinus Torvalds 261da177e4SLinus Torvalds #include <linux/kernel.h> 271da177e4SLinus Torvalds #include <linux/slab.h> 281da177e4SLinus Torvalds #include <linux/init.h> 291da177e4SLinus Torvalds #include <linux/capability.h> 301da177e4SLinus Torvalds #include <linux/interrupt.h> 311da177e4SLinus Torvalds #include <linux/bitops.h> 321da177e4SLinus Torvalds #include <linux/pci.h> 331da177e4SLinus Torvalds #include <linux/module.h> 341da177e4SLinus Torvalds #include <linux/atmdev.h> 351da177e4SLinus Torvalds #include <linux/sonet.h> 361da177e4SLinus Torvalds #include <linux/atm_suni.h> 371da177e4SLinus Torvalds #include <linux/dma-mapping.h> 381da177e4SLinus Torvalds #include <linux/delay.h> 39e92481f9SChas Williams #include <linux/firmware.h> 401da177e4SLinus Torvalds #include <asm/io.h> 411da177e4SLinus Torvalds #include <asm/string.h> 421da177e4SLinus Torvalds #include <asm/page.h> 431da177e4SLinus Torvalds #include <asm/irq.h> 441da177e4SLinus Torvalds #include <asm/dma.h> 451da177e4SLinus Torvalds #include <asm/byteorder.h> 461da177e4SLinus Torvalds #include <asm/uaccess.h> 471da177e4SLinus Torvalds #include <asm/atomic.h> 481da177e4SLinus Torvalds 49e92481f9SChas Williams #ifdef CONFIG_SBUS 50826b6cfcSDavid S. Miller #include <linux/of.h> 51826b6cfcSDavid S. Miller #include <linux/of_device.h> 521da177e4SLinus Torvalds #include <asm/idprom.h> 531da177e4SLinus Torvalds #include <asm/openprom.h> 541da177e4SLinus Torvalds #include <asm/oplib.h> 551da177e4SLinus Torvalds #include <asm/pgtable.h> 561da177e4SLinus Torvalds #endif 571da177e4SLinus Torvalds 581da177e4SLinus Torvalds #if defined(CONFIG_ATM_FORE200E_USE_TASKLET) /* defer interrupt work to a tasklet */ 591da177e4SLinus Torvalds #define FORE200E_USE_TASKLET 601da177e4SLinus Torvalds #endif 611da177e4SLinus Torvalds 621da177e4SLinus Torvalds #if 0 /* enable the debugging code of the buffer supply queues */ 631da177e4SLinus Torvalds #define FORE200E_BSQ_DEBUG 641da177e4SLinus Torvalds #endif 651da177e4SLinus Torvalds 661da177e4SLinus Torvalds #if 1 /* ensure correct handling of 52-byte AAL0 SDUs expected by atmdump-like apps */ 671da177e4SLinus Torvalds #define FORE200E_52BYTE_AAL0_SDU 681da177e4SLinus Torvalds #endif 691da177e4SLinus Torvalds 701da177e4SLinus Torvalds #include "fore200e.h" 711da177e4SLinus Torvalds #include "suni.h" 721da177e4SLinus Torvalds 731da177e4SLinus Torvalds #define FORE200E_VERSION "0.3e" 741da177e4SLinus Torvalds 751da177e4SLinus Torvalds #define FORE200E "fore200e: " 761da177e4SLinus Torvalds 771da177e4SLinus Torvalds #if 0 /* override .config */ 781da177e4SLinus Torvalds #define CONFIG_ATM_FORE200E_DEBUG 1 791da177e4SLinus Torvalds #endif 801da177e4SLinus Torvalds #if defined(CONFIG_ATM_FORE200E_DEBUG) && (CONFIG_ATM_FORE200E_DEBUG > 0) 811da177e4SLinus Torvalds #define DPRINTK(level, format, args...) do { if (CONFIG_ATM_FORE200E_DEBUG >= (level)) \ 821da177e4SLinus Torvalds printk(FORE200E format, ##args); } while (0) 831da177e4SLinus Torvalds #else 841da177e4SLinus Torvalds #define DPRINTK(level, format, args...) do {} while (0) 851da177e4SLinus Torvalds #endif 861da177e4SLinus Torvalds 871da177e4SLinus Torvalds 881da177e4SLinus Torvalds #define FORE200E_ALIGN(addr, alignment) \ 891da177e4SLinus Torvalds ((((unsigned long)(addr) + (alignment - 1)) & ~(alignment - 1)) - (unsigned long)(addr)) 901da177e4SLinus Torvalds 911da177e4SLinus Torvalds #define FORE200E_DMA_INDEX(dma_addr, type, index) ((dma_addr) + (index) * sizeof(type)) 921da177e4SLinus Torvalds 931da177e4SLinus Torvalds #define FORE200E_INDEX(virt_addr, type, index) (&((type *)(virt_addr))[ index ]) 941da177e4SLinus Torvalds 951da177e4SLinus Torvalds #define FORE200E_NEXT_ENTRY(index, modulo) (index = ++(index) % (modulo)) 961da177e4SLinus Torvalds 971da177e4SLinus Torvalds #if 1 981da177e4SLinus Torvalds #define ASSERT(expr) if (!(expr)) { \ 991da177e4SLinus Torvalds printk(FORE200E "assertion failed! %s[%d]: %s\n", \ 1005a346a10SHarvey Harrison __func__, __LINE__, #expr); \ 1015a346a10SHarvey Harrison panic(FORE200E "%s", __func__); \ 1021da177e4SLinus Torvalds } 1031da177e4SLinus Torvalds #else 1041da177e4SLinus Torvalds #define ASSERT(expr) do {} while (0) 1051da177e4SLinus Torvalds #endif 1061da177e4SLinus Torvalds 1071da177e4SLinus Torvalds 1081da177e4SLinus Torvalds static const struct atmdev_ops fore200e_ops; 1091da177e4SLinus Torvalds static const struct fore200e_bus fore200e_bus[]; 1101da177e4SLinus Torvalds 1111da177e4SLinus Torvalds static LIST_HEAD(fore200e_boards); 1121da177e4SLinus Torvalds 1131da177e4SLinus Torvalds 1141da177e4SLinus Torvalds MODULE_AUTHOR("Christophe Lizzi - credits to Uwe Dannowski and Heikki Vatiainen"); 1151da177e4SLinus Torvalds MODULE_DESCRIPTION("FORE Systems 200E-series ATM driver - version " FORE200E_VERSION); 1161da177e4SLinus Torvalds MODULE_SUPPORTED_DEVICE("PCA-200E, SBA-200E"); 1171da177e4SLinus Torvalds 1181da177e4SLinus Torvalds 1191da177e4SLinus Torvalds static const int fore200e_rx_buf_nbr[ BUFFER_SCHEME_NBR ][ BUFFER_MAGN_NBR ] = { 1201da177e4SLinus Torvalds { BUFFER_S1_NBR, BUFFER_L1_NBR }, 1211da177e4SLinus Torvalds { BUFFER_S2_NBR, BUFFER_L2_NBR } 1221da177e4SLinus Torvalds }; 1231da177e4SLinus Torvalds 1241da177e4SLinus Torvalds static const int fore200e_rx_buf_size[ BUFFER_SCHEME_NBR ][ BUFFER_MAGN_NBR ] = { 1251da177e4SLinus Torvalds { BUFFER_S1_SIZE, BUFFER_L1_SIZE }, 1261da177e4SLinus Torvalds { BUFFER_S2_SIZE, BUFFER_L2_SIZE } 1271da177e4SLinus Torvalds }; 1281da177e4SLinus Torvalds 1291da177e4SLinus Torvalds 1301da177e4SLinus Torvalds #if defined(CONFIG_ATM_FORE200E_DEBUG) && (CONFIG_ATM_FORE200E_DEBUG > 0) 1311da177e4SLinus Torvalds static const char* fore200e_traffic_class[] = { "NONE", "UBR", "CBR", "VBR", "ABR", "ANY" }; 1321da177e4SLinus Torvalds #endif 1331da177e4SLinus Torvalds 1341da177e4SLinus Torvalds 1351da177e4SLinus Torvalds #if 0 /* currently unused */ 1361da177e4SLinus Torvalds static int 1371da177e4SLinus Torvalds fore200e_fore2atm_aal(enum fore200e_aal aal) 1381da177e4SLinus Torvalds { 1391da177e4SLinus Torvalds switch(aal) { 1401da177e4SLinus Torvalds case FORE200E_AAL0: return ATM_AAL0; 1411da177e4SLinus Torvalds case FORE200E_AAL34: return ATM_AAL34; 1421da177e4SLinus Torvalds case FORE200E_AAL5: return ATM_AAL5; 1431da177e4SLinus Torvalds } 1441da177e4SLinus Torvalds 1451da177e4SLinus Torvalds return -EINVAL; 1461da177e4SLinus Torvalds } 1471da177e4SLinus Torvalds #endif 1481da177e4SLinus Torvalds 1491da177e4SLinus Torvalds 1501da177e4SLinus Torvalds static enum fore200e_aal 1511da177e4SLinus Torvalds fore200e_atm2fore_aal(int aal) 1521da177e4SLinus Torvalds { 1531da177e4SLinus Torvalds switch(aal) { 1541da177e4SLinus Torvalds case ATM_AAL0: return FORE200E_AAL0; 1551da177e4SLinus Torvalds case ATM_AAL34: return FORE200E_AAL34; 1561da177e4SLinus Torvalds case ATM_AAL1: 1571da177e4SLinus Torvalds case ATM_AAL2: 1581da177e4SLinus Torvalds case ATM_AAL5: return FORE200E_AAL5; 1591da177e4SLinus Torvalds } 1601da177e4SLinus Torvalds 1611da177e4SLinus Torvalds return -EINVAL; 1621da177e4SLinus Torvalds } 1631da177e4SLinus Torvalds 1641da177e4SLinus Torvalds 1651da177e4SLinus Torvalds static char* 1661da177e4SLinus Torvalds fore200e_irq_itoa(int irq) 1671da177e4SLinus Torvalds { 1681da177e4SLinus Torvalds static char str[8]; 1691da177e4SLinus Torvalds sprintf(str, "%d", irq); 1701da177e4SLinus Torvalds return str; 1711da177e4SLinus Torvalds } 1721da177e4SLinus Torvalds 1731da177e4SLinus Torvalds 1741da177e4SLinus Torvalds /* allocate and align a chunk of memory intended to hold the data behing exchanged 1751da177e4SLinus Torvalds between the driver and the adapter (using streaming DVMA) */ 1761da177e4SLinus Torvalds 1771da177e4SLinus Torvalds static int 1781da177e4SLinus Torvalds fore200e_chunk_alloc(struct fore200e* fore200e, struct chunk* chunk, int size, int alignment, int direction) 1791da177e4SLinus Torvalds { 1801da177e4SLinus Torvalds unsigned long offset = 0; 1811da177e4SLinus Torvalds 1821da177e4SLinus Torvalds if (alignment <= sizeof(int)) 1831da177e4SLinus Torvalds alignment = 0; 1841da177e4SLinus Torvalds 1851da177e4SLinus Torvalds chunk->alloc_size = size + alignment; 1861da177e4SLinus Torvalds chunk->align_size = size; 1871da177e4SLinus Torvalds chunk->direction = direction; 1881da177e4SLinus Torvalds 1891f8a5fb8SAdrian Bunk chunk->alloc_addr = kzalloc(chunk->alloc_size, GFP_KERNEL | GFP_DMA); 1901da177e4SLinus Torvalds if (chunk->alloc_addr == NULL) 1911da177e4SLinus Torvalds return -ENOMEM; 1921da177e4SLinus Torvalds 1931da177e4SLinus Torvalds if (alignment > 0) 1941da177e4SLinus Torvalds offset = FORE200E_ALIGN(chunk->alloc_addr, alignment); 1951da177e4SLinus Torvalds 1961da177e4SLinus Torvalds chunk->align_addr = chunk->alloc_addr + offset; 1971da177e4SLinus Torvalds 1981da177e4SLinus Torvalds chunk->dma_addr = fore200e->bus->dma_map(fore200e, chunk->align_addr, chunk->align_size, direction); 1991da177e4SLinus Torvalds 2001da177e4SLinus Torvalds return 0; 2011da177e4SLinus Torvalds } 2021da177e4SLinus Torvalds 2031da177e4SLinus Torvalds 2041da177e4SLinus Torvalds /* free a chunk of memory */ 2051da177e4SLinus Torvalds 2061da177e4SLinus Torvalds static void 2071da177e4SLinus Torvalds fore200e_chunk_free(struct fore200e* fore200e, struct chunk* chunk) 2081da177e4SLinus Torvalds { 2091da177e4SLinus Torvalds fore200e->bus->dma_unmap(fore200e, chunk->dma_addr, chunk->dma_size, chunk->direction); 2101da177e4SLinus Torvalds 2111f8a5fb8SAdrian Bunk kfree(chunk->alloc_addr); 2121da177e4SLinus Torvalds } 2131da177e4SLinus Torvalds 2141da177e4SLinus Torvalds 2151da177e4SLinus Torvalds static void 2161da177e4SLinus Torvalds fore200e_spin(int msecs) 2171da177e4SLinus Torvalds { 2181da177e4SLinus Torvalds unsigned long timeout = jiffies + msecs_to_jiffies(msecs); 2191da177e4SLinus Torvalds while (time_before(jiffies, timeout)); 2201da177e4SLinus Torvalds } 2211da177e4SLinus Torvalds 2221da177e4SLinus Torvalds 2231da177e4SLinus Torvalds static int 2241da177e4SLinus Torvalds fore200e_poll(struct fore200e* fore200e, volatile u32* addr, u32 val, int msecs) 2251da177e4SLinus Torvalds { 2261da177e4SLinus Torvalds unsigned long timeout = jiffies + msecs_to_jiffies(msecs); 2271da177e4SLinus Torvalds int ok; 2281da177e4SLinus Torvalds 2291da177e4SLinus Torvalds mb(); 2301da177e4SLinus Torvalds do { 2311da177e4SLinus Torvalds if ((ok = (*addr == val)) || (*addr & STATUS_ERROR)) 2321da177e4SLinus Torvalds break; 2331da177e4SLinus Torvalds 2341da177e4SLinus Torvalds } while (time_before(jiffies, timeout)); 2351da177e4SLinus Torvalds 2361da177e4SLinus Torvalds #if 1 2371da177e4SLinus Torvalds if (!ok) { 2381da177e4SLinus Torvalds printk(FORE200E "cmd polling failed, got status 0x%08x, expected 0x%08x\n", 2391da177e4SLinus Torvalds *addr, val); 2401da177e4SLinus Torvalds } 2411da177e4SLinus Torvalds #endif 2421da177e4SLinus Torvalds 2431da177e4SLinus Torvalds return ok; 2441da177e4SLinus Torvalds } 2451da177e4SLinus Torvalds 2461da177e4SLinus Torvalds 2471da177e4SLinus Torvalds static int 2481da177e4SLinus Torvalds fore200e_io_poll(struct fore200e* fore200e, volatile u32 __iomem *addr, u32 val, int msecs) 2491da177e4SLinus Torvalds { 2501da177e4SLinus Torvalds unsigned long timeout = jiffies + msecs_to_jiffies(msecs); 2511da177e4SLinus Torvalds int ok; 2521da177e4SLinus Torvalds 2531da177e4SLinus Torvalds do { 2541da177e4SLinus Torvalds if ((ok = (fore200e->bus->read(addr) == val))) 2551da177e4SLinus Torvalds break; 2561da177e4SLinus Torvalds 2571da177e4SLinus Torvalds } while (time_before(jiffies, timeout)); 2581da177e4SLinus Torvalds 2591da177e4SLinus Torvalds #if 1 2601da177e4SLinus Torvalds if (!ok) { 2611da177e4SLinus Torvalds printk(FORE200E "I/O polling failed, got status 0x%08x, expected 0x%08x\n", 2621da177e4SLinus Torvalds fore200e->bus->read(addr), val); 2631da177e4SLinus Torvalds } 2641da177e4SLinus Torvalds #endif 2651da177e4SLinus Torvalds 2661da177e4SLinus Torvalds return ok; 2671da177e4SLinus Torvalds } 2681da177e4SLinus Torvalds 2691da177e4SLinus Torvalds 2701da177e4SLinus Torvalds static void 2711da177e4SLinus Torvalds fore200e_free_rx_buf(struct fore200e* fore200e) 2721da177e4SLinus Torvalds { 2731da177e4SLinus Torvalds int scheme, magn, nbr; 2741da177e4SLinus Torvalds struct buffer* buffer; 2751da177e4SLinus Torvalds 2761da177e4SLinus Torvalds for (scheme = 0; scheme < BUFFER_SCHEME_NBR; scheme++) { 2771da177e4SLinus Torvalds for (magn = 0; magn < BUFFER_MAGN_NBR; magn++) { 2781da177e4SLinus Torvalds 2791da177e4SLinus Torvalds if ((buffer = fore200e->host_bsq[ scheme ][ magn ].buffer) != NULL) { 2801da177e4SLinus Torvalds 2811da177e4SLinus Torvalds for (nbr = 0; nbr < fore200e_rx_buf_nbr[ scheme ][ magn ]; nbr++) { 2821da177e4SLinus Torvalds 2831da177e4SLinus Torvalds struct chunk* data = &buffer[ nbr ].data; 2841da177e4SLinus Torvalds 2851da177e4SLinus Torvalds if (data->alloc_addr != NULL) 2861da177e4SLinus Torvalds fore200e_chunk_free(fore200e, data); 2871da177e4SLinus Torvalds } 2881da177e4SLinus Torvalds } 2891da177e4SLinus Torvalds } 2901da177e4SLinus Torvalds } 2911da177e4SLinus Torvalds } 2921da177e4SLinus Torvalds 2931da177e4SLinus Torvalds 2941da177e4SLinus Torvalds static void 2951da177e4SLinus Torvalds fore200e_uninit_bs_queue(struct fore200e* fore200e) 2961da177e4SLinus Torvalds { 2971da177e4SLinus Torvalds int scheme, magn; 2981da177e4SLinus Torvalds 2991da177e4SLinus Torvalds for (scheme = 0; scheme < BUFFER_SCHEME_NBR; scheme++) { 3001da177e4SLinus Torvalds for (magn = 0; magn < BUFFER_MAGN_NBR; magn++) { 3011da177e4SLinus Torvalds 3021da177e4SLinus Torvalds struct chunk* status = &fore200e->host_bsq[ scheme ][ magn ].status; 3031da177e4SLinus Torvalds struct chunk* rbd_block = &fore200e->host_bsq[ scheme ][ magn ].rbd_block; 3041da177e4SLinus Torvalds 3051da177e4SLinus Torvalds if (status->alloc_addr) 3061da177e4SLinus Torvalds fore200e->bus->dma_chunk_free(fore200e, status); 3071da177e4SLinus Torvalds 3081da177e4SLinus Torvalds if (rbd_block->alloc_addr) 3091da177e4SLinus Torvalds fore200e->bus->dma_chunk_free(fore200e, rbd_block); 3101da177e4SLinus Torvalds } 3111da177e4SLinus Torvalds } 3121da177e4SLinus Torvalds } 3131da177e4SLinus Torvalds 3141da177e4SLinus Torvalds 3151da177e4SLinus Torvalds static int 3161da177e4SLinus Torvalds fore200e_reset(struct fore200e* fore200e, int diag) 3171da177e4SLinus Torvalds { 3181da177e4SLinus Torvalds int ok; 3191da177e4SLinus Torvalds 3201da177e4SLinus Torvalds fore200e->cp_monitor = fore200e->virt_base + FORE200E_CP_MONITOR_OFFSET; 3211da177e4SLinus Torvalds 3221da177e4SLinus Torvalds fore200e->bus->write(BSTAT_COLD_START, &fore200e->cp_monitor->bstat); 3231da177e4SLinus Torvalds 3241da177e4SLinus Torvalds fore200e->bus->reset(fore200e); 3251da177e4SLinus Torvalds 3261da177e4SLinus Torvalds if (diag) { 3271da177e4SLinus Torvalds ok = fore200e_io_poll(fore200e, &fore200e->cp_monitor->bstat, BSTAT_SELFTEST_OK, 1000); 3281da177e4SLinus Torvalds if (ok == 0) { 3291da177e4SLinus Torvalds 3301da177e4SLinus Torvalds printk(FORE200E "device %s self-test failed\n", fore200e->name); 3311da177e4SLinus Torvalds return -ENODEV; 3321da177e4SLinus Torvalds } 3331da177e4SLinus Torvalds 3341da177e4SLinus Torvalds printk(FORE200E "device %s self-test passed\n", fore200e->name); 3351da177e4SLinus Torvalds 3361da177e4SLinus Torvalds fore200e->state = FORE200E_STATE_RESET; 3371da177e4SLinus Torvalds } 3381da177e4SLinus Torvalds 3391da177e4SLinus Torvalds return 0; 3401da177e4SLinus Torvalds } 3411da177e4SLinus Torvalds 3421da177e4SLinus Torvalds 3431da177e4SLinus Torvalds static void 3441da177e4SLinus Torvalds fore200e_shutdown(struct fore200e* fore200e) 3451da177e4SLinus Torvalds { 3461da177e4SLinus Torvalds printk(FORE200E "removing device %s at 0x%lx, IRQ %s\n", 3471da177e4SLinus Torvalds fore200e->name, fore200e->phys_base, 3481da177e4SLinus Torvalds fore200e_irq_itoa(fore200e->irq)); 3491da177e4SLinus Torvalds 3501da177e4SLinus Torvalds if (fore200e->state > FORE200E_STATE_RESET) { 3511da177e4SLinus Torvalds /* first, reset the board to prevent further interrupts or data transfers */ 3521da177e4SLinus Torvalds fore200e_reset(fore200e, 0); 3531da177e4SLinus Torvalds } 3541da177e4SLinus Torvalds 3551da177e4SLinus Torvalds /* then, release all allocated resources */ 3561da177e4SLinus Torvalds switch(fore200e->state) { 3571da177e4SLinus Torvalds 3581da177e4SLinus Torvalds case FORE200E_STATE_COMPLETE: 3591da177e4SLinus Torvalds kfree(fore200e->stats); 3601da177e4SLinus Torvalds 3611da177e4SLinus Torvalds case FORE200E_STATE_IRQ: 3621da177e4SLinus Torvalds free_irq(fore200e->irq, fore200e->atm_dev); 3631da177e4SLinus Torvalds 3641da177e4SLinus Torvalds case FORE200E_STATE_ALLOC_BUF: 3651da177e4SLinus Torvalds fore200e_free_rx_buf(fore200e); 3661da177e4SLinus Torvalds 3671da177e4SLinus Torvalds case FORE200E_STATE_INIT_BSQ: 3681da177e4SLinus Torvalds fore200e_uninit_bs_queue(fore200e); 3691da177e4SLinus Torvalds 3701da177e4SLinus Torvalds case FORE200E_STATE_INIT_RXQ: 3711da177e4SLinus Torvalds fore200e->bus->dma_chunk_free(fore200e, &fore200e->host_rxq.status); 3721da177e4SLinus Torvalds fore200e->bus->dma_chunk_free(fore200e, &fore200e->host_rxq.rpd); 3731da177e4SLinus Torvalds 3741da177e4SLinus Torvalds case FORE200E_STATE_INIT_TXQ: 3751da177e4SLinus Torvalds fore200e->bus->dma_chunk_free(fore200e, &fore200e->host_txq.status); 3761da177e4SLinus Torvalds fore200e->bus->dma_chunk_free(fore200e, &fore200e->host_txq.tpd); 3771da177e4SLinus Torvalds 3781da177e4SLinus Torvalds case FORE200E_STATE_INIT_CMDQ: 3791da177e4SLinus Torvalds fore200e->bus->dma_chunk_free(fore200e, &fore200e->host_cmdq.status); 3801da177e4SLinus Torvalds 3811da177e4SLinus Torvalds case FORE200E_STATE_INITIALIZE: 3821da177e4SLinus Torvalds /* nothing to do for that state */ 3831da177e4SLinus Torvalds 3841da177e4SLinus Torvalds case FORE200E_STATE_START_FW: 3851da177e4SLinus Torvalds /* nothing to do for that state */ 3861da177e4SLinus Torvalds 3871da177e4SLinus Torvalds case FORE200E_STATE_RESET: 3881da177e4SLinus Torvalds /* nothing to do for that state */ 3891da177e4SLinus Torvalds 3901da177e4SLinus Torvalds case FORE200E_STATE_MAP: 3911da177e4SLinus Torvalds fore200e->bus->unmap(fore200e); 3921da177e4SLinus Torvalds 3931da177e4SLinus Torvalds case FORE200E_STATE_CONFIGURE: 3941da177e4SLinus Torvalds /* nothing to do for that state */ 3951da177e4SLinus Torvalds 3961da177e4SLinus Torvalds case FORE200E_STATE_REGISTER: 3971da177e4SLinus Torvalds /* XXX shouldn't we *start* by deregistering the device? */ 3981da177e4SLinus Torvalds atm_dev_deregister(fore200e->atm_dev); 3991da177e4SLinus Torvalds 4001da177e4SLinus Torvalds case FORE200E_STATE_BLANK: 4011da177e4SLinus Torvalds /* nothing to do for that state */ 4021da177e4SLinus Torvalds break; 4031da177e4SLinus Torvalds } 4041da177e4SLinus Torvalds } 4051da177e4SLinus Torvalds 4061da177e4SLinus Torvalds 407e92481f9SChas Williams #ifdef CONFIG_PCI 4081da177e4SLinus Torvalds 4091da177e4SLinus Torvalds static u32 fore200e_pca_read(volatile u32 __iomem *addr) 4101da177e4SLinus Torvalds { 4111da177e4SLinus Torvalds /* on big-endian hosts, the board is configured to convert 4121da177e4SLinus Torvalds the endianess of slave RAM accesses */ 4131da177e4SLinus Torvalds return le32_to_cpu(readl(addr)); 4141da177e4SLinus Torvalds } 4151da177e4SLinus Torvalds 4161da177e4SLinus Torvalds 4171da177e4SLinus Torvalds static void fore200e_pca_write(u32 val, volatile u32 __iomem *addr) 4181da177e4SLinus Torvalds { 4191da177e4SLinus Torvalds /* on big-endian hosts, the board is configured to convert 4201da177e4SLinus Torvalds the endianess of slave RAM accesses */ 4211da177e4SLinus Torvalds writel(cpu_to_le32(val), addr); 4221da177e4SLinus Torvalds } 4231da177e4SLinus Torvalds 4241da177e4SLinus Torvalds 4251da177e4SLinus Torvalds static u32 4261da177e4SLinus Torvalds fore200e_pca_dma_map(struct fore200e* fore200e, void* virt_addr, int size, int direction) 4271da177e4SLinus Torvalds { 4281da177e4SLinus Torvalds u32 dma_addr = pci_map_single((struct pci_dev*)fore200e->bus_dev, virt_addr, size, direction); 4291da177e4SLinus Torvalds 4301da177e4SLinus Torvalds DPRINTK(3, "PCI DVMA mapping: virt_addr = 0x%p, size = %d, direction = %d, --> dma_addr = 0x%08x\n", 4311da177e4SLinus Torvalds virt_addr, size, direction, dma_addr); 4321da177e4SLinus Torvalds 4331da177e4SLinus Torvalds return dma_addr; 4341da177e4SLinus Torvalds } 4351da177e4SLinus Torvalds 4361da177e4SLinus Torvalds 4371da177e4SLinus Torvalds static void 4381da177e4SLinus Torvalds fore200e_pca_dma_unmap(struct fore200e* fore200e, u32 dma_addr, int size, int direction) 4391da177e4SLinus Torvalds { 4401da177e4SLinus Torvalds DPRINTK(3, "PCI DVMA unmapping: dma_addr = 0x%08x, size = %d, direction = %d\n", 4411da177e4SLinus Torvalds dma_addr, size, direction); 4421da177e4SLinus Torvalds 4431da177e4SLinus Torvalds pci_unmap_single((struct pci_dev*)fore200e->bus_dev, dma_addr, size, direction); 4441da177e4SLinus Torvalds } 4451da177e4SLinus Torvalds 4461da177e4SLinus Torvalds 4471da177e4SLinus Torvalds static void 4481da177e4SLinus Torvalds fore200e_pca_dma_sync_for_cpu(struct fore200e* fore200e, u32 dma_addr, int size, int direction) 4491da177e4SLinus Torvalds { 4501da177e4SLinus Torvalds DPRINTK(3, "PCI DVMA sync: dma_addr = 0x%08x, size = %d, direction = %d\n", dma_addr, size, direction); 4511da177e4SLinus Torvalds 4521da177e4SLinus Torvalds pci_dma_sync_single_for_cpu((struct pci_dev*)fore200e->bus_dev, dma_addr, size, direction); 4531da177e4SLinus Torvalds } 4541da177e4SLinus Torvalds 4551da177e4SLinus Torvalds static void 4561da177e4SLinus Torvalds fore200e_pca_dma_sync_for_device(struct fore200e* fore200e, u32 dma_addr, int size, int direction) 4571da177e4SLinus Torvalds { 4581da177e4SLinus Torvalds DPRINTK(3, "PCI DVMA sync: dma_addr = 0x%08x, size = %d, direction = %d\n", dma_addr, size, direction); 4591da177e4SLinus Torvalds 4601da177e4SLinus Torvalds pci_dma_sync_single_for_device((struct pci_dev*)fore200e->bus_dev, dma_addr, size, direction); 4611da177e4SLinus Torvalds } 4621da177e4SLinus Torvalds 4631da177e4SLinus Torvalds 4641da177e4SLinus Torvalds /* allocate a DMA consistent chunk of memory intended to act as a communication mechanism 4651da177e4SLinus Torvalds (to hold descriptors, status, queues, etc.) shared by the driver and the adapter */ 4661da177e4SLinus Torvalds 4671da177e4SLinus Torvalds static int 4681da177e4SLinus Torvalds fore200e_pca_dma_chunk_alloc(struct fore200e* fore200e, struct chunk* chunk, 4691da177e4SLinus Torvalds int size, int nbr, int alignment) 4701da177e4SLinus Torvalds { 4711da177e4SLinus Torvalds /* returned chunks are page-aligned */ 4721da177e4SLinus Torvalds chunk->alloc_size = size * nbr; 4731da177e4SLinus Torvalds chunk->alloc_addr = pci_alloc_consistent((struct pci_dev*)fore200e->bus_dev, 4741da177e4SLinus Torvalds chunk->alloc_size, 4751da177e4SLinus Torvalds &chunk->dma_addr); 4761da177e4SLinus Torvalds 4771da177e4SLinus Torvalds if ((chunk->alloc_addr == NULL) || (chunk->dma_addr == 0)) 4781da177e4SLinus Torvalds return -ENOMEM; 4791da177e4SLinus Torvalds 4801da177e4SLinus Torvalds chunk->align_addr = chunk->alloc_addr; 4811da177e4SLinus Torvalds 4821da177e4SLinus Torvalds return 0; 4831da177e4SLinus Torvalds } 4841da177e4SLinus Torvalds 4851da177e4SLinus Torvalds 4861da177e4SLinus Torvalds /* free a DMA consistent chunk of memory */ 4871da177e4SLinus Torvalds 4881da177e4SLinus Torvalds static void 4891da177e4SLinus Torvalds fore200e_pca_dma_chunk_free(struct fore200e* fore200e, struct chunk* chunk) 4901da177e4SLinus Torvalds { 4911da177e4SLinus Torvalds pci_free_consistent((struct pci_dev*)fore200e->bus_dev, 4921da177e4SLinus Torvalds chunk->alloc_size, 4931da177e4SLinus Torvalds chunk->alloc_addr, 4941da177e4SLinus Torvalds chunk->dma_addr); 4951da177e4SLinus Torvalds } 4961da177e4SLinus Torvalds 4971da177e4SLinus Torvalds 4981da177e4SLinus Torvalds static int 4991da177e4SLinus Torvalds fore200e_pca_irq_check(struct fore200e* fore200e) 5001da177e4SLinus Torvalds { 5011da177e4SLinus Torvalds /* this is a 1 bit register */ 5021da177e4SLinus Torvalds int irq_posted = readl(fore200e->regs.pca.psr); 5031da177e4SLinus Torvalds 5041da177e4SLinus Torvalds #if defined(CONFIG_ATM_FORE200E_DEBUG) && (CONFIG_ATM_FORE200E_DEBUG == 2) 5051da177e4SLinus Torvalds if (irq_posted && (readl(fore200e->regs.pca.hcr) & PCA200E_HCR_OUTFULL)) { 5061da177e4SLinus Torvalds DPRINTK(2,"FIFO OUT full, device %d\n", fore200e->atm_dev->number); 5071da177e4SLinus Torvalds } 5081da177e4SLinus Torvalds #endif 5091da177e4SLinus Torvalds 5101da177e4SLinus Torvalds return irq_posted; 5111da177e4SLinus Torvalds } 5121da177e4SLinus Torvalds 5131da177e4SLinus Torvalds 5141da177e4SLinus Torvalds static void 5151da177e4SLinus Torvalds fore200e_pca_irq_ack(struct fore200e* fore200e) 5161da177e4SLinus Torvalds { 5171da177e4SLinus Torvalds writel(PCA200E_HCR_CLRINTR, fore200e->regs.pca.hcr); 5181da177e4SLinus Torvalds } 5191da177e4SLinus Torvalds 5201da177e4SLinus Torvalds 5211da177e4SLinus Torvalds static void 5221da177e4SLinus Torvalds fore200e_pca_reset(struct fore200e* fore200e) 5231da177e4SLinus Torvalds { 5241da177e4SLinus Torvalds writel(PCA200E_HCR_RESET, fore200e->regs.pca.hcr); 5251da177e4SLinus Torvalds fore200e_spin(10); 5261da177e4SLinus Torvalds writel(0, fore200e->regs.pca.hcr); 5271da177e4SLinus Torvalds } 5281da177e4SLinus Torvalds 5291da177e4SLinus Torvalds 530c027f5f9SSam Ravnborg static int __devinit 5311da177e4SLinus Torvalds fore200e_pca_map(struct fore200e* fore200e) 5321da177e4SLinus Torvalds { 5331da177e4SLinus Torvalds DPRINTK(2, "device %s being mapped in memory\n", fore200e->name); 5341da177e4SLinus Torvalds 5351da177e4SLinus Torvalds fore200e->virt_base = ioremap(fore200e->phys_base, PCA200E_IOSPACE_LENGTH); 5361da177e4SLinus Torvalds 5371da177e4SLinus Torvalds if (fore200e->virt_base == NULL) { 5381da177e4SLinus Torvalds printk(FORE200E "can't map device %s\n", fore200e->name); 5391da177e4SLinus Torvalds return -EFAULT; 5401da177e4SLinus Torvalds } 5411da177e4SLinus Torvalds 5421da177e4SLinus Torvalds DPRINTK(1, "device %s mapped to 0x%p\n", fore200e->name, fore200e->virt_base); 5431da177e4SLinus Torvalds 5441da177e4SLinus Torvalds /* gain access to the PCA specific registers */ 5451da177e4SLinus Torvalds fore200e->regs.pca.hcr = fore200e->virt_base + PCA200E_HCR_OFFSET; 5461da177e4SLinus Torvalds fore200e->regs.pca.imr = fore200e->virt_base + PCA200E_IMR_OFFSET; 5471da177e4SLinus Torvalds fore200e->regs.pca.psr = fore200e->virt_base + PCA200E_PSR_OFFSET; 5481da177e4SLinus Torvalds 5491da177e4SLinus Torvalds fore200e->state = FORE200E_STATE_MAP; 5501da177e4SLinus Torvalds return 0; 5511da177e4SLinus Torvalds } 5521da177e4SLinus Torvalds 5531da177e4SLinus Torvalds 5541da177e4SLinus Torvalds static void 5551da177e4SLinus Torvalds fore200e_pca_unmap(struct fore200e* fore200e) 5561da177e4SLinus Torvalds { 5571da177e4SLinus Torvalds DPRINTK(2, "device %s being unmapped from memory\n", fore200e->name); 5581da177e4SLinus Torvalds 5591da177e4SLinus Torvalds if (fore200e->virt_base != NULL) 5601da177e4SLinus Torvalds iounmap(fore200e->virt_base); 5611da177e4SLinus Torvalds } 5621da177e4SLinus Torvalds 5631da177e4SLinus Torvalds 564c027f5f9SSam Ravnborg static int __devinit 5651da177e4SLinus Torvalds fore200e_pca_configure(struct fore200e* fore200e) 5661da177e4SLinus Torvalds { 5671da177e4SLinus Torvalds struct pci_dev* pci_dev = (struct pci_dev*)fore200e->bus_dev; 5681da177e4SLinus Torvalds u8 master_ctrl, latency; 5691da177e4SLinus Torvalds 5701da177e4SLinus Torvalds DPRINTK(2, "device %s being configured\n", fore200e->name); 5711da177e4SLinus Torvalds 5721da177e4SLinus Torvalds if ((pci_dev->irq == 0) || (pci_dev->irq == 0xFF)) { 5731da177e4SLinus Torvalds printk(FORE200E "incorrect IRQ setting - misconfigured PCI-PCI bridge?\n"); 5741da177e4SLinus Torvalds return -EIO; 5751da177e4SLinus Torvalds } 5761da177e4SLinus Torvalds 5771da177e4SLinus Torvalds pci_read_config_byte(pci_dev, PCA200E_PCI_MASTER_CTRL, &master_ctrl); 5781da177e4SLinus Torvalds 5791da177e4SLinus Torvalds master_ctrl = master_ctrl 5801da177e4SLinus Torvalds #if defined(__BIG_ENDIAN) 5811da177e4SLinus Torvalds /* request the PCA board to convert the endianess of slave RAM accesses */ 5821da177e4SLinus Torvalds | PCA200E_CTRL_CONVERT_ENDIAN 5831da177e4SLinus Torvalds #endif 5841da177e4SLinus Torvalds #if 0 5851da177e4SLinus Torvalds | PCA200E_CTRL_DIS_CACHE_RD 5861da177e4SLinus Torvalds | PCA200E_CTRL_DIS_WRT_INVAL 5871da177e4SLinus Torvalds | PCA200E_CTRL_ENA_CONT_REQ_MODE 5881da177e4SLinus Torvalds | PCA200E_CTRL_2_CACHE_WRT_INVAL 5891da177e4SLinus Torvalds #endif 5901da177e4SLinus Torvalds | PCA200E_CTRL_LARGE_PCI_BURSTS; 5911da177e4SLinus Torvalds 5921da177e4SLinus Torvalds pci_write_config_byte(pci_dev, PCA200E_PCI_MASTER_CTRL, master_ctrl); 5931da177e4SLinus Torvalds 5941da177e4SLinus Torvalds /* raise latency from 32 (default) to 192, as this seems to prevent NIC 5951da177e4SLinus Torvalds lockups (under heavy rx loads) due to continuous 'FIFO OUT full' condition. 5961da177e4SLinus Torvalds this may impact the performances of other PCI devices on the same bus, though */ 5971da177e4SLinus Torvalds latency = 192; 5981da177e4SLinus Torvalds pci_write_config_byte(pci_dev, PCI_LATENCY_TIMER, latency); 5991da177e4SLinus Torvalds 6001da177e4SLinus Torvalds fore200e->state = FORE200E_STATE_CONFIGURE; 6011da177e4SLinus Torvalds return 0; 6021da177e4SLinus Torvalds } 6031da177e4SLinus Torvalds 6041da177e4SLinus Torvalds 6051da177e4SLinus Torvalds static int __init 6061da177e4SLinus Torvalds fore200e_pca_prom_read(struct fore200e* fore200e, struct prom_data* prom) 6071da177e4SLinus Torvalds { 6081da177e4SLinus Torvalds struct host_cmdq* cmdq = &fore200e->host_cmdq; 6091da177e4SLinus Torvalds struct host_cmdq_entry* entry = &cmdq->host_entry[ cmdq->head ]; 6101da177e4SLinus Torvalds struct prom_opcode opcode; 6111da177e4SLinus Torvalds int ok; 6121da177e4SLinus Torvalds u32 prom_dma; 6131da177e4SLinus Torvalds 6141da177e4SLinus Torvalds FORE200E_NEXT_ENTRY(cmdq->head, QUEUE_SIZE_CMD); 6151da177e4SLinus Torvalds 6161da177e4SLinus Torvalds opcode.opcode = OPCODE_GET_PROM; 6171da177e4SLinus Torvalds opcode.pad = 0; 6181da177e4SLinus Torvalds 6191da177e4SLinus Torvalds prom_dma = fore200e->bus->dma_map(fore200e, prom, sizeof(struct prom_data), DMA_FROM_DEVICE); 6201da177e4SLinus Torvalds 6211da177e4SLinus Torvalds fore200e->bus->write(prom_dma, &entry->cp_entry->cmd.prom_block.prom_haddr); 6221da177e4SLinus Torvalds 6231da177e4SLinus Torvalds *entry->status = STATUS_PENDING; 6241da177e4SLinus Torvalds 6251da177e4SLinus Torvalds fore200e->bus->write(*(u32*)&opcode, (u32 __iomem *)&entry->cp_entry->cmd.prom_block.opcode); 6261da177e4SLinus Torvalds 6271da177e4SLinus Torvalds ok = fore200e_poll(fore200e, entry->status, STATUS_COMPLETE, 400); 6281da177e4SLinus Torvalds 6291da177e4SLinus Torvalds *entry->status = STATUS_FREE; 6301da177e4SLinus Torvalds 6311da177e4SLinus Torvalds fore200e->bus->dma_unmap(fore200e, prom_dma, sizeof(struct prom_data), DMA_FROM_DEVICE); 6321da177e4SLinus Torvalds 6331da177e4SLinus Torvalds if (ok == 0) { 6341da177e4SLinus Torvalds printk(FORE200E "unable to get PROM data from device %s\n", fore200e->name); 6351da177e4SLinus Torvalds return -EIO; 6361da177e4SLinus Torvalds } 6371da177e4SLinus Torvalds 6381da177e4SLinus Torvalds #if defined(__BIG_ENDIAN) 6391da177e4SLinus Torvalds 6401da177e4SLinus Torvalds #define swap_here(addr) (*((u32*)(addr)) = swab32( *((u32*)(addr)) )) 6411da177e4SLinus Torvalds 6421da177e4SLinus Torvalds /* MAC address is stored as little-endian */ 6431da177e4SLinus Torvalds swap_here(&prom->mac_addr[0]); 6441da177e4SLinus Torvalds swap_here(&prom->mac_addr[4]); 6451da177e4SLinus Torvalds #endif 6461da177e4SLinus Torvalds 6471da177e4SLinus Torvalds return 0; 6481da177e4SLinus Torvalds } 6491da177e4SLinus Torvalds 6501da177e4SLinus Torvalds 6511da177e4SLinus Torvalds static int 6521da177e4SLinus Torvalds fore200e_pca_proc_read(struct fore200e* fore200e, char *page) 6531da177e4SLinus Torvalds { 6541da177e4SLinus Torvalds struct pci_dev* pci_dev = (struct pci_dev*)fore200e->bus_dev; 6551da177e4SLinus Torvalds 6561da177e4SLinus Torvalds return sprintf(page, " PCI bus/slot/function:\t%d/%d/%d\n", 6571da177e4SLinus Torvalds pci_dev->bus->number, PCI_SLOT(pci_dev->devfn), PCI_FUNC(pci_dev->devfn)); 6581da177e4SLinus Torvalds } 6591da177e4SLinus Torvalds 660e92481f9SChas Williams #endif /* CONFIG_PCI */ 6611da177e4SLinus Torvalds 6621da177e4SLinus Torvalds 663e92481f9SChas Williams #ifdef CONFIG_SBUS 6641da177e4SLinus Torvalds 665826b6cfcSDavid S. Miller static u32 fore200e_sba_read(volatile u32 __iomem *addr) 6661da177e4SLinus Torvalds { 6671da177e4SLinus Torvalds return sbus_readl(addr); 6681da177e4SLinus Torvalds } 6691da177e4SLinus Torvalds 670826b6cfcSDavid S. Miller static void fore200e_sba_write(u32 val, volatile u32 __iomem *addr) 6711da177e4SLinus Torvalds { 6721da177e4SLinus Torvalds sbus_writel(val, addr); 6731da177e4SLinus Torvalds } 6741da177e4SLinus Torvalds 675826b6cfcSDavid S. Miller static u32 fore200e_sba_dma_map(struct fore200e *fore200e, void* virt_addr, int size, int direction) 6761da177e4SLinus Torvalds { 677826b6cfcSDavid S. Miller struct of_device *op = fore200e->bus_dev; 678826b6cfcSDavid S. Miller u32 dma_addr; 679826b6cfcSDavid S. Miller 680826b6cfcSDavid S. Miller dma_addr = dma_map_single(&op->dev, virt_addr, size, direction); 6811da177e4SLinus Torvalds 6821da177e4SLinus Torvalds DPRINTK(3, "SBUS DVMA mapping: virt_addr = 0x%p, size = %d, direction = %d --> dma_addr = 0x%08x\n", 6831da177e4SLinus Torvalds virt_addr, size, direction, dma_addr); 6841da177e4SLinus Torvalds 6851da177e4SLinus Torvalds return dma_addr; 6861da177e4SLinus Torvalds } 6871da177e4SLinus Torvalds 688826b6cfcSDavid S. Miller static void fore200e_sba_dma_unmap(struct fore200e *fore200e, u32 dma_addr, int size, int direction) 6891da177e4SLinus Torvalds { 690826b6cfcSDavid S. Miller struct of_device *op = fore200e->bus_dev; 6917a715f46SDavid S. Miller 6921da177e4SLinus Torvalds DPRINTK(3, "SBUS DVMA unmapping: dma_addr = 0x%08x, size = %d, direction = %d,\n", 6931da177e4SLinus Torvalds dma_addr, size, direction); 6941da177e4SLinus Torvalds 695826b6cfcSDavid S. Miller dma_unmap_single(&op->dev, dma_addr, size, direction); 6961da177e4SLinus Torvalds } 6971da177e4SLinus Torvalds 698826b6cfcSDavid S. Miller static void fore200e_sba_dma_sync_for_cpu(struct fore200e *fore200e, u32 dma_addr, int size, int direction) 6991da177e4SLinus Torvalds { 700826b6cfcSDavid S. Miller struct of_device *op = fore200e->bus_dev; 7017a715f46SDavid S. Miller 7021da177e4SLinus Torvalds DPRINTK(3, "SBUS DVMA sync: dma_addr = 0x%08x, size = %d, direction = %d\n", dma_addr, size, direction); 7031da177e4SLinus Torvalds 704826b6cfcSDavid S. Miller dma_sync_single_for_cpu(&op->dev, dma_addr, size, direction); 7051da177e4SLinus Torvalds } 7061da177e4SLinus Torvalds 707826b6cfcSDavid S. Miller static void fore200e_sba_dma_sync_for_device(struct fore200e *fore200e, u32 dma_addr, int size, int direction) 7081da177e4SLinus Torvalds { 709826b6cfcSDavid S. Miller struct of_device *op = fore200e->bus_dev; 7107a715f46SDavid S. Miller 7111da177e4SLinus Torvalds DPRINTK(3, "SBUS DVMA sync: dma_addr = 0x%08x, size = %d, direction = %d\n", dma_addr, size, direction); 7121da177e4SLinus Torvalds 713826b6cfcSDavid S. Miller dma_sync_single_for_device(&op->dev, dma_addr, size, direction); 7141da177e4SLinus Torvalds } 7151da177e4SLinus Torvalds 716826b6cfcSDavid S. Miller /* Allocate a DVMA consistent chunk of memory intended to act as a communication mechanism 717826b6cfcSDavid S. Miller * (to hold descriptors, status, queues, etc.) shared by the driver and the adapter. 718826b6cfcSDavid S. Miller */ 719826b6cfcSDavid S. Miller static int fore200e_sba_dma_chunk_alloc(struct fore200e *fore200e, struct chunk *chunk, 7201da177e4SLinus Torvalds int size, int nbr, int alignment) 7211da177e4SLinus Torvalds { 722826b6cfcSDavid S. Miller struct of_device *op = fore200e->bus_dev; 7237a715f46SDavid S. Miller 7241da177e4SLinus Torvalds chunk->alloc_size = chunk->align_size = size * nbr; 7251da177e4SLinus Torvalds 7261da177e4SLinus Torvalds /* returned chunks are page-aligned */ 727826b6cfcSDavid S. Miller chunk->alloc_addr = dma_alloc_coherent(&op->dev, chunk->alloc_size, 728738f2b7bSDavid S. Miller &chunk->dma_addr, GFP_ATOMIC); 7291da177e4SLinus Torvalds 7301da177e4SLinus Torvalds if ((chunk->alloc_addr == NULL) || (chunk->dma_addr == 0)) 7311da177e4SLinus Torvalds return -ENOMEM; 7321da177e4SLinus Torvalds 7331da177e4SLinus Torvalds chunk->align_addr = chunk->alloc_addr; 7341da177e4SLinus Torvalds 7351da177e4SLinus Torvalds return 0; 7361da177e4SLinus Torvalds } 7371da177e4SLinus Torvalds 7381da177e4SLinus Torvalds /* free a DVMA consistent chunk of memory */ 739826b6cfcSDavid S. Miller static void fore200e_sba_dma_chunk_free(struct fore200e *fore200e, struct chunk *chunk) 7401da177e4SLinus Torvalds { 741826b6cfcSDavid S. Miller struct of_device *op = fore200e->bus_dev; 7427a715f46SDavid S. Miller 743826b6cfcSDavid S. Miller dma_free_coherent(&op->dev, chunk->alloc_size, 7447a715f46SDavid S. Miller chunk->alloc_addr, chunk->dma_addr); 7451da177e4SLinus Torvalds } 7461da177e4SLinus Torvalds 747826b6cfcSDavid S. Miller static void fore200e_sba_irq_enable(struct fore200e *fore200e) 7481da177e4SLinus Torvalds { 7491da177e4SLinus Torvalds u32 hcr = fore200e->bus->read(fore200e->regs.sba.hcr) & SBA200E_HCR_STICKY; 7501da177e4SLinus Torvalds fore200e->bus->write(hcr | SBA200E_HCR_INTR_ENA, fore200e->regs.sba.hcr); 7511da177e4SLinus Torvalds } 7521da177e4SLinus Torvalds 753826b6cfcSDavid S. Miller static int fore200e_sba_irq_check(struct fore200e *fore200e) 7541da177e4SLinus Torvalds { 7551da177e4SLinus Torvalds return fore200e->bus->read(fore200e->regs.sba.hcr) & SBA200E_HCR_INTR_REQ; 7561da177e4SLinus Torvalds } 7571da177e4SLinus Torvalds 758826b6cfcSDavid S. Miller static void fore200e_sba_irq_ack(struct fore200e *fore200e) 7591da177e4SLinus Torvalds { 7601da177e4SLinus Torvalds u32 hcr = fore200e->bus->read(fore200e->regs.sba.hcr) & SBA200E_HCR_STICKY; 7611da177e4SLinus Torvalds fore200e->bus->write(hcr | SBA200E_HCR_INTR_CLR, fore200e->regs.sba.hcr); 7621da177e4SLinus Torvalds } 7631da177e4SLinus Torvalds 764826b6cfcSDavid S. Miller static void fore200e_sba_reset(struct fore200e *fore200e) 7651da177e4SLinus Torvalds { 7661da177e4SLinus Torvalds fore200e->bus->write(SBA200E_HCR_RESET, fore200e->regs.sba.hcr); 7671da177e4SLinus Torvalds fore200e_spin(10); 7681da177e4SLinus Torvalds fore200e->bus->write(0, fore200e->regs.sba.hcr); 7691da177e4SLinus Torvalds } 7701da177e4SLinus Torvalds 771826b6cfcSDavid S. Miller static int __init fore200e_sba_map(struct fore200e *fore200e) 7721da177e4SLinus Torvalds { 773826b6cfcSDavid S. Miller struct of_device *op = fore200e->bus_dev; 7741da177e4SLinus Torvalds unsigned int bursts; 7751da177e4SLinus Torvalds 7761da177e4SLinus Torvalds /* gain access to the SBA specific registers */ 777826b6cfcSDavid S. Miller fore200e->regs.sba.hcr = of_ioremap(&op->resource[0], 0, SBA200E_HCR_LENGTH, "SBA HCR"); 778826b6cfcSDavid S. Miller fore200e->regs.sba.bsr = of_ioremap(&op->resource[1], 0, SBA200E_BSR_LENGTH, "SBA BSR"); 779826b6cfcSDavid S. Miller fore200e->regs.sba.isr = of_ioremap(&op->resource[2], 0, SBA200E_ISR_LENGTH, "SBA ISR"); 780826b6cfcSDavid S. Miller fore200e->virt_base = of_ioremap(&op->resource[3], 0, SBA200E_RAM_LENGTH, "SBA RAM"); 7811da177e4SLinus Torvalds 782826b6cfcSDavid S. Miller if (!fore200e->virt_base) { 7831da177e4SLinus Torvalds printk(FORE200E "unable to map RAM of device %s\n", fore200e->name); 7841da177e4SLinus Torvalds return -EFAULT; 7851da177e4SLinus Torvalds } 7861da177e4SLinus Torvalds 7871da177e4SLinus Torvalds DPRINTK(1, "device %s mapped to 0x%p\n", fore200e->name, fore200e->virt_base); 7881da177e4SLinus Torvalds 7891da177e4SLinus Torvalds fore200e->bus->write(0x02, fore200e->regs.sba.isr); /* XXX hardwired interrupt level */ 7901da177e4SLinus Torvalds 7911da177e4SLinus Torvalds /* get the supported DVMA burst sizes */ 79261c7a080SGrant Likely bursts = of_getintprop_default(op->dev.of_node->parent, "burst-sizes", 0x00); 7931da177e4SLinus Torvalds 79463237eebSDavid S. Miller if (sbus_can_dma_64bit()) 795826b6cfcSDavid S. Miller sbus_set_sbus64(&op->dev, bursts); 7961da177e4SLinus Torvalds 7971da177e4SLinus Torvalds fore200e->state = FORE200E_STATE_MAP; 7981da177e4SLinus Torvalds return 0; 7991da177e4SLinus Torvalds } 8001da177e4SLinus Torvalds 801826b6cfcSDavid S. Miller static void fore200e_sba_unmap(struct fore200e *fore200e) 8021da177e4SLinus Torvalds { 803826b6cfcSDavid S. Miller struct of_device *op = fore200e->bus_dev; 804826b6cfcSDavid S. Miller 805826b6cfcSDavid S. Miller of_iounmap(&op->resource[0], fore200e->regs.sba.hcr, SBA200E_HCR_LENGTH); 806826b6cfcSDavid S. Miller of_iounmap(&op->resource[1], fore200e->regs.sba.bsr, SBA200E_BSR_LENGTH); 807826b6cfcSDavid S. Miller of_iounmap(&op->resource[2], fore200e->regs.sba.isr, SBA200E_ISR_LENGTH); 808826b6cfcSDavid S. Miller of_iounmap(&op->resource[3], fore200e->virt_base, SBA200E_RAM_LENGTH); 8091da177e4SLinus Torvalds } 8101da177e4SLinus Torvalds 811826b6cfcSDavid S. Miller static int __init fore200e_sba_configure(struct fore200e *fore200e) 8121da177e4SLinus Torvalds { 8131da177e4SLinus Torvalds fore200e->state = FORE200E_STATE_CONFIGURE; 8141da177e4SLinus Torvalds return 0; 8151da177e4SLinus Torvalds } 8161da177e4SLinus Torvalds 817826b6cfcSDavid S. Miller static int __init fore200e_sba_prom_read(struct fore200e *fore200e, struct prom_data *prom) 8181da177e4SLinus Torvalds { 819826b6cfcSDavid S. Miller struct of_device *op = fore200e->bus_dev; 820826b6cfcSDavid S. Miller const u8 *prop; 8211da177e4SLinus Torvalds int len; 8221da177e4SLinus Torvalds 82361c7a080SGrant Likely prop = of_get_property(op->dev.of_node, "madaddrlo2", &len); 824826b6cfcSDavid S. Miller if (!prop) 825826b6cfcSDavid S. Miller return -ENODEV; 826826b6cfcSDavid S. Miller memcpy(&prom->mac_addr[4], prop, 4); 8271da177e4SLinus Torvalds 82861c7a080SGrant Likely prop = of_get_property(op->dev.of_node, "madaddrhi4", &len); 829826b6cfcSDavid S. Miller if (!prop) 830826b6cfcSDavid S. Miller return -ENODEV; 831826b6cfcSDavid S. Miller memcpy(&prom->mac_addr[2], prop, 4); 8321da177e4SLinus Torvalds 83361c7a080SGrant Likely prom->serial_number = of_getintprop_default(op->dev.of_node, 83461c7a080SGrant Likely "serialnumber", 0); 83561c7a080SGrant Likely prom->hw_revision = of_getintprop_default(op->dev.of_node, 83661c7a080SGrant Likely "promversion", 0); 8371da177e4SLinus Torvalds 8381da177e4SLinus Torvalds return 0; 8391da177e4SLinus Torvalds } 8401da177e4SLinus Torvalds 841826b6cfcSDavid S. Miller static int fore200e_sba_proc_read(struct fore200e *fore200e, char *page) 8421da177e4SLinus Torvalds { 843826b6cfcSDavid S. Miller struct of_device *op = fore200e->bus_dev; 844826b6cfcSDavid S. Miller const struct linux_prom_registers *regs; 8451da177e4SLinus Torvalds 84661c7a080SGrant Likely regs = of_get_property(op->dev.of_node, "reg", NULL); 847826b6cfcSDavid S. Miller 848826b6cfcSDavid S. Miller return sprintf(page, " SBUS slot/device:\t\t%d/'%s'\n", 84961c7a080SGrant Likely (regs ? regs->which_io : 0), op->dev.of_node->name); 8501da177e4SLinus Torvalds } 851e92481f9SChas Williams #endif /* CONFIG_SBUS */ 8521da177e4SLinus Torvalds 8531da177e4SLinus Torvalds 8541da177e4SLinus Torvalds static void 8551da177e4SLinus Torvalds fore200e_tx_irq(struct fore200e* fore200e) 8561da177e4SLinus Torvalds { 8571da177e4SLinus Torvalds struct host_txq* txq = &fore200e->host_txq; 8581da177e4SLinus Torvalds struct host_txq_entry* entry; 8591da177e4SLinus Torvalds struct atm_vcc* vcc; 8601da177e4SLinus Torvalds struct fore200e_vc_map* vc_map; 8611da177e4SLinus Torvalds 8621da177e4SLinus Torvalds if (fore200e->host_txq.txing == 0) 8631da177e4SLinus Torvalds return; 8641da177e4SLinus Torvalds 8651da177e4SLinus Torvalds for (;;) { 8661da177e4SLinus Torvalds 8671da177e4SLinus Torvalds entry = &txq->host_entry[ txq->tail ]; 8681da177e4SLinus Torvalds 8691da177e4SLinus Torvalds if ((*entry->status & STATUS_COMPLETE) == 0) { 8701da177e4SLinus Torvalds break; 8711da177e4SLinus Torvalds } 8721da177e4SLinus Torvalds 8731da177e4SLinus Torvalds DPRINTK(3, "TX COMPLETED: entry = %p [tail = %d], vc_map = %p, skb = %p\n", 8741da177e4SLinus Torvalds entry, txq->tail, entry->vc_map, entry->skb); 8751da177e4SLinus Torvalds 8761da177e4SLinus Torvalds /* free copy of misaligned data */ 8771da177e4SLinus Torvalds kfree(entry->data); 8781da177e4SLinus Torvalds 8791da177e4SLinus Torvalds /* remove DMA mapping */ 8801da177e4SLinus Torvalds fore200e->bus->dma_unmap(fore200e, entry->tpd->tsd[ 0 ].buffer, entry->tpd->tsd[ 0 ].length, 8811da177e4SLinus Torvalds DMA_TO_DEVICE); 8821da177e4SLinus Torvalds 8831da177e4SLinus Torvalds vc_map = entry->vc_map; 8841da177e4SLinus Torvalds 8851da177e4SLinus Torvalds /* vcc closed since the time the entry was submitted for tx? */ 8861da177e4SLinus Torvalds if ((vc_map->vcc == NULL) || 8871da177e4SLinus Torvalds (test_bit(ATM_VF_READY, &vc_map->vcc->flags) == 0)) { 8881da177e4SLinus Torvalds 8891da177e4SLinus Torvalds DPRINTK(1, "no ready vcc found for PDU sent on device %d\n", 8901da177e4SLinus Torvalds fore200e->atm_dev->number); 8911da177e4SLinus Torvalds 8921da177e4SLinus Torvalds dev_kfree_skb_any(entry->skb); 8931da177e4SLinus Torvalds } 8941da177e4SLinus Torvalds else { 8951da177e4SLinus Torvalds ASSERT(vc_map->vcc); 8961da177e4SLinus Torvalds 8971da177e4SLinus Torvalds /* vcc closed then immediately re-opened? */ 8981da177e4SLinus Torvalds if (vc_map->incarn != entry->incarn) { 8991da177e4SLinus Torvalds 9001da177e4SLinus Torvalds /* when a vcc is closed, some PDUs may be still pending in the tx queue. 9011da177e4SLinus Torvalds if the same vcc is immediately re-opened, those pending PDUs must 9021da177e4SLinus Torvalds not be popped after the completion of their emission, as they refer 9031da177e4SLinus Torvalds to the prior incarnation of that vcc. otherwise, sk_atm(vcc)->sk_wmem_alloc 9041da177e4SLinus Torvalds would be decremented by the size of the (unrelated) skb, possibly 9051da177e4SLinus Torvalds leading to a negative sk->sk_wmem_alloc count, ultimately freezing the vcc. 9061da177e4SLinus Torvalds we thus bind the tx entry to the current incarnation of the vcc 9071da177e4SLinus Torvalds when the entry is submitted for tx. When the tx later completes, 9081da177e4SLinus Torvalds if the incarnation number of the tx entry does not match the one 9091da177e4SLinus Torvalds of the vcc, then this implies that the vcc has been closed then re-opened. 9101da177e4SLinus Torvalds we thus just drop the skb here. */ 9111da177e4SLinus Torvalds 9121da177e4SLinus Torvalds DPRINTK(1, "vcc closed-then-re-opened; dropping PDU sent on device %d\n", 9131da177e4SLinus Torvalds fore200e->atm_dev->number); 9141da177e4SLinus Torvalds 9151da177e4SLinus Torvalds dev_kfree_skb_any(entry->skb); 9161da177e4SLinus Torvalds } 9171da177e4SLinus Torvalds else { 9181da177e4SLinus Torvalds vcc = vc_map->vcc; 9191da177e4SLinus Torvalds ASSERT(vcc); 9201da177e4SLinus Torvalds 9211da177e4SLinus Torvalds /* notify tx completion */ 9221da177e4SLinus Torvalds if (vcc->pop) { 9231da177e4SLinus Torvalds vcc->pop(vcc, entry->skb); 9241da177e4SLinus Torvalds } 9251da177e4SLinus Torvalds else { 9261da177e4SLinus Torvalds dev_kfree_skb_any(entry->skb); 9271da177e4SLinus Torvalds } 9281da177e4SLinus Torvalds #if 1 9291da177e4SLinus Torvalds /* race fixed by the above incarnation mechanism, but... */ 9301da177e4SLinus Torvalds if (atomic_read(&sk_atm(vcc)->sk_wmem_alloc) < 0) { 9311da177e4SLinus Torvalds atomic_set(&sk_atm(vcc)->sk_wmem_alloc, 0); 9321da177e4SLinus Torvalds } 9331da177e4SLinus Torvalds #endif 9341da177e4SLinus Torvalds /* check error condition */ 9351da177e4SLinus Torvalds if (*entry->status & STATUS_ERROR) 9361da177e4SLinus Torvalds atomic_inc(&vcc->stats->tx_err); 9371da177e4SLinus Torvalds else 9381da177e4SLinus Torvalds atomic_inc(&vcc->stats->tx); 9391da177e4SLinus Torvalds } 9401da177e4SLinus Torvalds } 9411da177e4SLinus Torvalds 9421da177e4SLinus Torvalds *entry->status = STATUS_FREE; 9431da177e4SLinus Torvalds 9441da177e4SLinus Torvalds fore200e->host_txq.txing--; 9451da177e4SLinus Torvalds 9461da177e4SLinus Torvalds FORE200E_NEXT_ENTRY(txq->tail, QUEUE_SIZE_TX); 9471da177e4SLinus Torvalds } 9481da177e4SLinus Torvalds } 9491da177e4SLinus Torvalds 9501da177e4SLinus Torvalds 9511da177e4SLinus Torvalds #ifdef FORE200E_BSQ_DEBUG 9521da177e4SLinus Torvalds int bsq_audit(int where, struct host_bsq* bsq, int scheme, int magn) 9531da177e4SLinus Torvalds { 9541da177e4SLinus Torvalds struct buffer* buffer; 9551da177e4SLinus Torvalds int count = 0; 9561da177e4SLinus Torvalds 9571da177e4SLinus Torvalds buffer = bsq->freebuf; 9581da177e4SLinus Torvalds while (buffer) { 9591da177e4SLinus Torvalds 9601da177e4SLinus Torvalds if (buffer->supplied) { 9611da177e4SLinus Torvalds printk(FORE200E "bsq_audit(%d): queue %d.%d, buffer %ld supplied but in free list!\n", 9621da177e4SLinus Torvalds where, scheme, magn, buffer->index); 9631da177e4SLinus Torvalds } 9641da177e4SLinus Torvalds 9651da177e4SLinus Torvalds if (buffer->magn != magn) { 9661da177e4SLinus Torvalds printk(FORE200E "bsq_audit(%d): queue %d.%d, buffer %ld, unexpected magn = %d\n", 9671da177e4SLinus Torvalds where, scheme, magn, buffer->index, buffer->magn); 9681da177e4SLinus Torvalds } 9691da177e4SLinus Torvalds 9701da177e4SLinus Torvalds if (buffer->scheme != scheme) { 9711da177e4SLinus Torvalds printk(FORE200E "bsq_audit(%d): queue %d.%d, buffer %ld, unexpected scheme = %d\n", 9721da177e4SLinus Torvalds where, scheme, magn, buffer->index, buffer->scheme); 9731da177e4SLinus Torvalds } 9741da177e4SLinus Torvalds 9751da177e4SLinus Torvalds if ((buffer->index < 0) || (buffer->index >= fore200e_rx_buf_nbr[ scheme ][ magn ])) { 9761da177e4SLinus Torvalds printk(FORE200E "bsq_audit(%d): queue %d.%d, out of range buffer index = %ld !\n", 9771da177e4SLinus Torvalds where, scheme, magn, buffer->index); 9781da177e4SLinus Torvalds } 9791da177e4SLinus Torvalds 9801da177e4SLinus Torvalds count++; 9811da177e4SLinus Torvalds buffer = buffer->next; 9821da177e4SLinus Torvalds } 9831da177e4SLinus Torvalds 9841da177e4SLinus Torvalds if (count != bsq->freebuf_count) { 9851da177e4SLinus Torvalds printk(FORE200E "bsq_audit(%d): queue %d.%d, %d bufs in free list, but freebuf_count = %d\n", 9861da177e4SLinus Torvalds where, scheme, magn, count, bsq->freebuf_count); 9871da177e4SLinus Torvalds } 9881da177e4SLinus Torvalds return 0; 9891da177e4SLinus Torvalds } 9901da177e4SLinus Torvalds #endif 9911da177e4SLinus Torvalds 9921da177e4SLinus Torvalds 9931da177e4SLinus Torvalds static void 9941da177e4SLinus Torvalds fore200e_supply(struct fore200e* fore200e) 9951da177e4SLinus Torvalds { 9961da177e4SLinus Torvalds int scheme, magn, i; 9971da177e4SLinus Torvalds 9981da177e4SLinus Torvalds struct host_bsq* bsq; 9991da177e4SLinus Torvalds struct host_bsq_entry* entry; 10001da177e4SLinus Torvalds struct buffer* buffer; 10011da177e4SLinus Torvalds 10021da177e4SLinus Torvalds for (scheme = 0; scheme < BUFFER_SCHEME_NBR; scheme++) { 10031da177e4SLinus Torvalds for (magn = 0; magn < BUFFER_MAGN_NBR; magn++) { 10041da177e4SLinus Torvalds 10051da177e4SLinus Torvalds bsq = &fore200e->host_bsq[ scheme ][ magn ]; 10061da177e4SLinus Torvalds 10071da177e4SLinus Torvalds #ifdef FORE200E_BSQ_DEBUG 10081da177e4SLinus Torvalds bsq_audit(1, bsq, scheme, magn); 10091da177e4SLinus Torvalds #endif 10101da177e4SLinus Torvalds while (bsq->freebuf_count >= RBD_BLK_SIZE) { 10111da177e4SLinus Torvalds 10121da177e4SLinus Torvalds DPRINTK(2, "supplying %d rx buffers to queue %d / %d, freebuf_count = %d\n", 10131da177e4SLinus Torvalds RBD_BLK_SIZE, scheme, magn, bsq->freebuf_count); 10141da177e4SLinus Torvalds 10151da177e4SLinus Torvalds entry = &bsq->host_entry[ bsq->head ]; 10161da177e4SLinus Torvalds 10171da177e4SLinus Torvalds for (i = 0; i < RBD_BLK_SIZE; i++) { 10181da177e4SLinus Torvalds 10191da177e4SLinus Torvalds /* take the first buffer in the free buffer list */ 10201da177e4SLinus Torvalds buffer = bsq->freebuf; 10211da177e4SLinus Torvalds if (!buffer) { 10221da177e4SLinus Torvalds printk(FORE200E "no more free bufs in queue %d.%d, but freebuf_count = %d\n", 10231da177e4SLinus Torvalds scheme, magn, bsq->freebuf_count); 10241da177e4SLinus Torvalds return; 10251da177e4SLinus Torvalds } 10261da177e4SLinus Torvalds bsq->freebuf = buffer->next; 10271da177e4SLinus Torvalds 10281da177e4SLinus Torvalds #ifdef FORE200E_BSQ_DEBUG 10291da177e4SLinus Torvalds if (buffer->supplied) 10301da177e4SLinus Torvalds printk(FORE200E "queue %d.%d, buffer %lu already supplied\n", 10311da177e4SLinus Torvalds scheme, magn, buffer->index); 10321da177e4SLinus Torvalds buffer->supplied = 1; 10331da177e4SLinus Torvalds #endif 10341da177e4SLinus Torvalds entry->rbd_block->rbd[ i ].buffer_haddr = buffer->data.dma_addr; 10351da177e4SLinus Torvalds entry->rbd_block->rbd[ i ].handle = FORE200E_BUF2HDL(buffer); 10361da177e4SLinus Torvalds } 10371da177e4SLinus Torvalds 10381da177e4SLinus Torvalds FORE200E_NEXT_ENTRY(bsq->head, QUEUE_SIZE_BS); 10391da177e4SLinus Torvalds 10401da177e4SLinus Torvalds /* decrease accordingly the number of free rx buffers */ 10411da177e4SLinus Torvalds bsq->freebuf_count -= RBD_BLK_SIZE; 10421da177e4SLinus Torvalds 10431da177e4SLinus Torvalds *entry->status = STATUS_PENDING; 10441da177e4SLinus Torvalds fore200e->bus->write(entry->rbd_block_dma, &entry->cp_entry->rbd_block_haddr); 10451da177e4SLinus Torvalds } 10461da177e4SLinus Torvalds } 10471da177e4SLinus Torvalds } 10481da177e4SLinus Torvalds } 10491da177e4SLinus Torvalds 10501da177e4SLinus Torvalds 10511da177e4SLinus Torvalds static int 10521da177e4SLinus Torvalds fore200e_push_rpd(struct fore200e* fore200e, struct atm_vcc* vcc, struct rpd* rpd) 10531da177e4SLinus Torvalds { 10541da177e4SLinus Torvalds struct sk_buff* skb; 10551da177e4SLinus Torvalds struct buffer* buffer; 10561da177e4SLinus Torvalds struct fore200e_vcc* fore200e_vcc; 10571da177e4SLinus Torvalds int i, pdu_len = 0; 10581da177e4SLinus Torvalds #ifdef FORE200E_52BYTE_AAL0_SDU 10591da177e4SLinus Torvalds u32 cell_header = 0; 10601da177e4SLinus Torvalds #endif 10611da177e4SLinus Torvalds 10621da177e4SLinus Torvalds ASSERT(vcc); 10631da177e4SLinus Torvalds 10641da177e4SLinus Torvalds fore200e_vcc = FORE200E_VCC(vcc); 10651da177e4SLinus Torvalds ASSERT(fore200e_vcc); 10661da177e4SLinus Torvalds 10671da177e4SLinus Torvalds #ifdef FORE200E_52BYTE_AAL0_SDU 10681da177e4SLinus Torvalds if ((vcc->qos.aal == ATM_AAL0) && (vcc->qos.rxtp.max_sdu == ATM_AAL0_SDU)) { 10691da177e4SLinus Torvalds 10701da177e4SLinus Torvalds cell_header = (rpd->atm_header.gfc << ATM_HDR_GFC_SHIFT) | 10711da177e4SLinus Torvalds (rpd->atm_header.vpi << ATM_HDR_VPI_SHIFT) | 10721da177e4SLinus Torvalds (rpd->atm_header.vci << ATM_HDR_VCI_SHIFT) | 10731da177e4SLinus Torvalds (rpd->atm_header.plt << ATM_HDR_PTI_SHIFT) | 10741da177e4SLinus Torvalds rpd->atm_header.clp; 10751da177e4SLinus Torvalds pdu_len = 4; 10761da177e4SLinus Torvalds } 10771da177e4SLinus Torvalds #endif 10781da177e4SLinus Torvalds 10791da177e4SLinus Torvalds /* compute total PDU length */ 10801da177e4SLinus Torvalds for (i = 0; i < rpd->nseg; i++) 10811da177e4SLinus Torvalds pdu_len += rpd->rsd[ i ].length; 10821da177e4SLinus Torvalds 10831da177e4SLinus Torvalds skb = alloc_skb(pdu_len, GFP_ATOMIC); 10841da177e4SLinus Torvalds if (skb == NULL) { 10851da177e4SLinus Torvalds DPRINTK(2, "unable to alloc new skb, rx PDU length = %d\n", pdu_len); 10861da177e4SLinus Torvalds 10871da177e4SLinus Torvalds atomic_inc(&vcc->stats->rx_drop); 10881da177e4SLinus Torvalds return -ENOMEM; 10891da177e4SLinus Torvalds } 10901da177e4SLinus Torvalds 1091a61bbcf2SPatrick McHardy __net_timestamp(skb); 10921da177e4SLinus Torvalds 10931da177e4SLinus Torvalds #ifdef FORE200E_52BYTE_AAL0_SDU 10941da177e4SLinus Torvalds if (cell_header) { 10951da177e4SLinus Torvalds *((u32*)skb_put(skb, 4)) = cell_header; 10961da177e4SLinus Torvalds } 10971da177e4SLinus Torvalds #endif 10981da177e4SLinus Torvalds 10991da177e4SLinus Torvalds /* reassemble segments */ 11001da177e4SLinus Torvalds for (i = 0; i < rpd->nseg; i++) { 11011da177e4SLinus Torvalds 11021da177e4SLinus Torvalds /* rebuild rx buffer address from rsd handle */ 11031da177e4SLinus Torvalds buffer = FORE200E_HDL2BUF(rpd->rsd[ i ].handle); 11041da177e4SLinus Torvalds 11051da177e4SLinus Torvalds /* Make device DMA transfer visible to CPU. */ 11061da177e4SLinus Torvalds fore200e->bus->dma_sync_for_cpu(fore200e, buffer->data.dma_addr, rpd->rsd[ i ].length, DMA_FROM_DEVICE); 11071da177e4SLinus Torvalds 11081da177e4SLinus Torvalds memcpy(skb_put(skb, rpd->rsd[ i ].length), buffer->data.align_addr, rpd->rsd[ i ].length); 11091da177e4SLinus Torvalds 11101da177e4SLinus Torvalds /* Now let the device get at it again. */ 11111da177e4SLinus Torvalds fore200e->bus->dma_sync_for_device(fore200e, buffer->data.dma_addr, rpd->rsd[ i ].length, DMA_FROM_DEVICE); 11121da177e4SLinus Torvalds } 11131da177e4SLinus Torvalds 11141da177e4SLinus Torvalds DPRINTK(3, "rx skb: len = %d, truesize = %d\n", skb->len, skb->truesize); 11151da177e4SLinus Torvalds 11161da177e4SLinus Torvalds if (pdu_len < fore200e_vcc->rx_min_pdu) 11171da177e4SLinus Torvalds fore200e_vcc->rx_min_pdu = pdu_len; 11181da177e4SLinus Torvalds if (pdu_len > fore200e_vcc->rx_max_pdu) 11191da177e4SLinus Torvalds fore200e_vcc->rx_max_pdu = pdu_len; 11201da177e4SLinus Torvalds fore200e_vcc->rx_pdu++; 11211da177e4SLinus Torvalds 11221da177e4SLinus Torvalds /* push PDU */ 11231da177e4SLinus Torvalds if (atm_charge(vcc, skb->truesize) == 0) { 11241da177e4SLinus Torvalds 11251da177e4SLinus Torvalds DPRINTK(2, "receive buffers saturated for %d.%d.%d - PDU dropped\n", 11261da177e4SLinus Torvalds vcc->itf, vcc->vpi, vcc->vci); 11271da177e4SLinus Torvalds 11281da177e4SLinus Torvalds dev_kfree_skb_any(skb); 11291da177e4SLinus Torvalds 11301da177e4SLinus Torvalds atomic_inc(&vcc->stats->rx_drop); 11311da177e4SLinus Torvalds return -ENOMEM; 11321da177e4SLinus Torvalds } 11331da177e4SLinus Torvalds 11341da177e4SLinus Torvalds ASSERT(atomic_read(&sk_atm(vcc)->sk_wmem_alloc) >= 0); 11351da177e4SLinus Torvalds 11361da177e4SLinus Torvalds vcc->push(vcc, skb); 11371da177e4SLinus Torvalds atomic_inc(&vcc->stats->rx); 11381da177e4SLinus Torvalds 11391da177e4SLinus Torvalds ASSERT(atomic_read(&sk_atm(vcc)->sk_wmem_alloc) >= 0); 11401da177e4SLinus Torvalds 11411da177e4SLinus Torvalds return 0; 11421da177e4SLinus Torvalds } 11431da177e4SLinus Torvalds 11441da177e4SLinus Torvalds 11451da177e4SLinus Torvalds static void 11461da177e4SLinus Torvalds fore200e_collect_rpd(struct fore200e* fore200e, struct rpd* rpd) 11471da177e4SLinus Torvalds { 11481da177e4SLinus Torvalds struct host_bsq* bsq; 11491da177e4SLinus Torvalds struct buffer* buffer; 11501da177e4SLinus Torvalds int i; 11511da177e4SLinus Torvalds 11521da177e4SLinus Torvalds for (i = 0; i < rpd->nseg; i++) { 11531da177e4SLinus Torvalds 11541da177e4SLinus Torvalds /* rebuild rx buffer address from rsd handle */ 11551da177e4SLinus Torvalds buffer = FORE200E_HDL2BUF(rpd->rsd[ i ].handle); 11561da177e4SLinus Torvalds 11571da177e4SLinus Torvalds bsq = &fore200e->host_bsq[ buffer->scheme ][ buffer->magn ]; 11581da177e4SLinus Torvalds 11591da177e4SLinus Torvalds #ifdef FORE200E_BSQ_DEBUG 11601da177e4SLinus Torvalds bsq_audit(2, bsq, buffer->scheme, buffer->magn); 11611da177e4SLinus Torvalds 11621da177e4SLinus Torvalds if (buffer->supplied == 0) 11631da177e4SLinus Torvalds printk(FORE200E "queue %d.%d, buffer %ld was not supplied\n", 11641da177e4SLinus Torvalds buffer->scheme, buffer->magn, buffer->index); 11651da177e4SLinus Torvalds buffer->supplied = 0; 11661da177e4SLinus Torvalds #endif 11671da177e4SLinus Torvalds 11681da177e4SLinus Torvalds /* re-insert the buffer into the free buffer list */ 11691da177e4SLinus Torvalds buffer->next = bsq->freebuf; 11701da177e4SLinus Torvalds bsq->freebuf = buffer; 11711da177e4SLinus Torvalds 11721da177e4SLinus Torvalds /* then increment the number of free rx buffers */ 11731da177e4SLinus Torvalds bsq->freebuf_count++; 11741da177e4SLinus Torvalds } 11751da177e4SLinus Torvalds } 11761da177e4SLinus Torvalds 11771da177e4SLinus Torvalds 11781da177e4SLinus Torvalds static void 11791da177e4SLinus Torvalds fore200e_rx_irq(struct fore200e* fore200e) 11801da177e4SLinus Torvalds { 11811da177e4SLinus Torvalds struct host_rxq* rxq = &fore200e->host_rxq; 11821da177e4SLinus Torvalds struct host_rxq_entry* entry; 11831da177e4SLinus Torvalds struct atm_vcc* vcc; 11841da177e4SLinus Torvalds struct fore200e_vc_map* vc_map; 11851da177e4SLinus Torvalds 11861da177e4SLinus Torvalds for (;;) { 11871da177e4SLinus Torvalds 11881da177e4SLinus Torvalds entry = &rxq->host_entry[ rxq->head ]; 11891da177e4SLinus Torvalds 11901da177e4SLinus Torvalds /* no more received PDUs */ 11911da177e4SLinus Torvalds if ((*entry->status & STATUS_COMPLETE) == 0) 11921da177e4SLinus Torvalds break; 11931da177e4SLinus Torvalds 11941da177e4SLinus Torvalds vc_map = FORE200E_VC_MAP(fore200e, entry->rpd->atm_header.vpi, entry->rpd->atm_header.vci); 11951da177e4SLinus Torvalds 11961da177e4SLinus Torvalds if ((vc_map->vcc == NULL) || 11971da177e4SLinus Torvalds (test_bit(ATM_VF_READY, &vc_map->vcc->flags) == 0)) { 11981da177e4SLinus Torvalds 11991da177e4SLinus Torvalds DPRINTK(1, "no ready VC found for PDU received on %d.%d.%d\n", 12001da177e4SLinus Torvalds fore200e->atm_dev->number, 12011da177e4SLinus Torvalds entry->rpd->atm_header.vpi, entry->rpd->atm_header.vci); 12021da177e4SLinus Torvalds } 12031da177e4SLinus Torvalds else { 12041da177e4SLinus Torvalds vcc = vc_map->vcc; 12051da177e4SLinus Torvalds ASSERT(vcc); 12061da177e4SLinus Torvalds 12071da177e4SLinus Torvalds if ((*entry->status & STATUS_ERROR) == 0) { 12081da177e4SLinus Torvalds 12091da177e4SLinus Torvalds fore200e_push_rpd(fore200e, vcc, entry->rpd); 12101da177e4SLinus Torvalds } 12111da177e4SLinus Torvalds else { 12121da177e4SLinus Torvalds DPRINTK(2, "damaged PDU on %d.%d.%d\n", 12131da177e4SLinus Torvalds fore200e->atm_dev->number, 12141da177e4SLinus Torvalds entry->rpd->atm_header.vpi, entry->rpd->atm_header.vci); 12151da177e4SLinus Torvalds atomic_inc(&vcc->stats->rx_err); 12161da177e4SLinus Torvalds } 12171da177e4SLinus Torvalds } 12181da177e4SLinus Torvalds 12191da177e4SLinus Torvalds FORE200E_NEXT_ENTRY(rxq->head, QUEUE_SIZE_RX); 12201da177e4SLinus Torvalds 12211da177e4SLinus Torvalds fore200e_collect_rpd(fore200e, entry->rpd); 12221da177e4SLinus Torvalds 12231da177e4SLinus Torvalds /* rewrite the rpd address to ack the received PDU */ 12241da177e4SLinus Torvalds fore200e->bus->write(entry->rpd_dma, &entry->cp_entry->rpd_haddr); 12251da177e4SLinus Torvalds *entry->status = STATUS_FREE; 12261da177e4SLinus Torvalds 12271da177e4SLinus Torvalds fore200e_supply(fore200e); 12281da177e4SLinus Torvalds } 12291da177e4SLinus Torvalds } 12301da177e4SLinus Torvalds 12311da177e4SLinus Torvalds 12321da177e4SLinus Torvalds #ifndef FORE200E_USE_TASKLET 12331da177e4SLinus Torvalds static void 12341da177e4SLinus Torvalds fore200e_irq(struct fore200e* fore200e) 12351da177e4SLinus Torvalds { 12361da177e4SLinus Torvalds unsigned long flags; 12371da177e4SLinus Torvalds 12381da177e4SLinus Torvalds spin_lock_irqsave(&fore200e->q_lock, flags); 12391da177e4SLinus Torvalds fore200e_rx_irq(fore200e); 12401da177e4SLinus Torvalds spin_unlock_irqrestore(&fore200e->q_lock, flags); 12411da177e4SLinus Torvalds 12421da177e4SLinus Torvalds spin_lock_irqsave(&fore200e->q_lock, flags); 12431da177e4SLinus Torvalds fore200e_tx_irq(fore200e); 12441da177e4SLinus Torvalds spin_unlock_irqrestore(&fore200e->q_lock, flags); 12451da177e4SLinus Torvalds } 12461da177e4SLinus Torvalds #endif 12471da177e4SLinus Torvalds 12481da177e4SLinus Torvalds 12491da177e4SLinus Torvalds static irqreturn_t 12507d12e780SDavid Howells fore200e_interrupt(int irq, void* dev) 12511da177e4SLinus Torvalds { 12521da177e4SLinus Torvalds struct fore200e* fore200e = FORE200E_DEV((struct atm_dev*)dev); 12531da177e4SLinus Torvalds 12541da177e4SLinus Torvalds if (fore200e->bus->irq_check(fore200e) == 0) { 12551da177e4SLinus Torvalds 12561da177e4SLinus Torvalds DPRINTK(3, "interrupt NOT triggered by device %d\n", fore200e->atm_dev->number); 12571da177e4SLinus Torvalds return IRQ_NONE; 12581da177e4SLinus Torvalds } 12591da177e4SLinus Torvalds DPRINTK(3, "interrupt triggered by device %d\n", fore200e->atm_dev->number); 12601da177e4SLinus Torvalds 12611da177e4SLinus Torvalds #ifdef FORE200E_USE_TASKLET 12621da177e4SLinus Torvalds tasklet_schedule(&fore200e->tx_tasklet); 12631da177e4SLinus Torvalds tasklet_schedule(&fore200e->rx_tasklet); 12641da177e4SLinus Torvalds #else 12651da177e4SLinus Torvalds fore200e_irq(fore200e); 12661da177e4SLinus Torvalds #endif 12671da177e4SLinus Torvalds 12681da177e4SLinus Torvalds fore200e->bus->irq_ack(fore200e); 12691da177e4SLinus Torvalds return IRQ_HANDLED; 12701da177e4SLinus Torvalds } 12711da177e4SLinus Torvalds 12721da177e4SLinus Torvalds 12731da177e4SLinus Torvalds #ifdef FORE200E_USE_TASKLET 12741da177e4SLinus Torvalds static void 12751da177e4SLinus Torvalds fore200e_tx_tasklet(unsigned long data) 12761da177e4SLinus Torvalds { 12771da177e4SLinus Torvalds struct fore200e* fore200e = (struct fore200e*) data; 12781da177e4SLinus Torvalds unsigned long flags; 12791da177e4SLinus Torvalds 12801da177e4SLinus Torvalds DPRINTK(3, "tx tasklet scheduled for device %d\n", fore200e->atm_dev->number); 12811da177e4SLinus Torvalds 12821da177e4SLinus Torvalds spin_lock_irqsave(&fore200e->q_lock, flags); 12831da177e4SLinus Torvalds fore200e_tx_irq(fore200e); 12841da177e4SLinus Torvalds spin_unlock_irqrestore(&fore200e->q_lock, flags); 12851da177e4SLinus Torvalds } 12861da177e4SLinus Torvalds 12871da177e4SLinus Torvalds 12881da177e4SLinus Torvalds static void 12891da177e4SLinus Torvalds fore200e_rx_tasklet(unsigned long data) 12901da177e4SLinus Torvalds { 12911da177e4SLinus Torvalds struct fore200e* fore200e = (struct fore200e*) data; 12921da177e4SLinus Torvalds unsigned long flags; 12931da177e4SLinus Torvalds 12941da177e4SLinus Torvalds DPRINTK(3, "rx tasklet scheduled for device %d\n", fore200e->atm_dev->number); 12951da177e4SLinus Torvalds 12961da177e4SLinus Torvalds spin_lock_irqsave(&fore200e->q_lock, flags); 12971da177e4SLinus Torvalds fore200e_rx_irq((struct fore200e*) data); 12981da177e4SLinus Torvalds spin_unlock_irqrestore(&fore200e->q_lock, flags); 12991da177e4SLinus Torvalds } 13001da177e4SLinus Torvalds #endif 13011da177e4SLinus Torvalds 13021da177e4SLinus Torvalds 13031da177e4SLinus Torvalds static int 13041da177e4SLinus Torvalds fore200e_select_scheme(struct atm_vcc* vcc) 13051da177e4SLinus Torvalds { 13061da177e4SLinus Torvalds /* fairly balance the VCs over (identical) buffer schemes */ 13071da177e4SLinus Torvalds int scheme = vcc->vci % 2 ? BUFFER_SCHEME_ONE : BUFFER_SCHEME_TWO; 13081da177e4SLinus Torvalds 13091da177e4SLinus Torvalds DPRINTK(1, "VC %d.%d.%d uses buffer scheme %d\n", 13101da177e4SLinus Torvalds vcc->itf, vcc->vpi, vcc->vci, scheme); 13111da177e4SLinus Torvalds 13121da177e4SLinus Torvalds return scheme; 13131da177e4SLinus Torvalds } 13141da177e4SLinus Torvalds 13151da177e4SLinus Torvalds 13161da177e4SLinus Torvalds static int 13171da177e4SLinus Torvalds fore200e_activate_vcin(struct fore200e* fore200e, int activate, struct atm_vcc* vcc, int mtu) 13181da177e4SLinus Torvalds { 13191da177e4SLinus Torvalds struct host_cmdq* cmdq = &fore200e->host_cmdq; 13201da177e4SLinus Torvalds struct host_cmdq_entry* entry = &cmdq->host_entry[ cmdq->head ]; 13211da177e4SLinus Torvalds struct activate_opcode activ_opcode; 13221da177e4SLinus Torvalds struct deactivate_opcode deactiv_opcode; 13231da177e4SLinus Torvalds struct vpvc vpvc; 13241da177e4SLinus Torvalds int ok; 13251da177e4SLinus Torvalds enum fore200e_aal aal = fore200e_atm2fore_aal(vcc->qos.aal); 13261da177e4SLinus Torvalds 13271da177e4SLinus Torvalds FORE200E_NEXT_ENTRY(cmdq->head, QUEUE_SIZE_CMD); 13281da177e4SLinus Torvalds 13291da177e4SLinus Torvalds if (activate) { 13301da177e4SLinus Torvalds FORE200E_VCC(vcc)->scheme = fore200e_select_scheme(vcc); 13311da177e4SLinus Torvalds 13321da177e4SLinus Torvalds activ_opcode.opcode = OPCODE_ACTIVATE_VCIN; 13331da177e4SLinus Torvalds activ_opcode.aal = aal; 13341da177e4SLinus Torvalds activ_opcode.scheme = FORE200E_VCC(vcc)->scheme; 13351da177e4SLinus Torvalds activ_opcode.pad = 0; 13361da177e4SLinus Torvalds } 13371da177e4SLinus Torvalds else { 13381da177e4SLinus Torvalds deactiv_opcode.opcode = OPCODE_DEACTIVATE_VCIN; 13391da177e4SLinus Torvalds deactiv_opcode.pad = 0; 13401da177e4SLinus Torvalds } 13411da177e4SLinus Torvalds 13421da177e4SLinus Torvalds vpvc.vci = vcc->vci; 13431da177e4SLinus Torvalds vpvc.vpi = vcc->vpi; 13441da177e4SLinus Torvalds 13451da177e4SLinus Torvalds *entry->status = STATUS_PENDING; 13461da177e4SLinus Torvalds 13471da177e4SLinus Torvalds if (activate) { 13481da177e4SLinus Torvalds 13491da177e4SLinus Torvalds #ifdef FORE200E_52BYTE_AAL0_SDU 13501da177e4SLinus Torvalds mtu = 48; 13511da177e4SLinus Torvalds #endif 13521da177e4SLinus Torvalds /* the MTU is not used by the cp, except in the case of AAL0 */ 13531da177e4SLinus Torvalds fore200e->bus->write(mtu, &entry->cp_entry->cmd.activate_block.mtu); 13541da177e4SLinus Torvalds fore200e->bus->write(*(u32*)&vpvc, (u32 __iomem *)&entry->cp_entry->cmd.activate_block.vpvc); 13551da177e4SLinus Torvalds fore200e->bus->write(*(u32*)&activ_opcode, (u32 __iomem *)&entry->cp_entry->cmd.activate_block.opcode); 13561da177e4SLinus Torvalds } 13571da177e4SLinus Torvalds else { 13581da177e4SLinus Torvalds fore200e->bus->write(*(u32*)&vpvc, (u32 __iomem *)&entry->cp_entry->cmd.deactivate_block.vpvc); 13591da177e4SLinus Torvalds fore200e->bus->write(*(u32*)&deactiv_opcode, (u32 __iomem *)&entry->cp_entry->cmd.deactivate_block.opcode); 13601da177e4SLinus Torvalds } 13611da177e4SLinus Torvalds 13621da177e4SLinus Torvalds ok = fore200e_poll(fore200e, entry->status, STATUS_COMPLETE, 400); 13631da177e4SLinus Torvalds 13641da177e4SLinus Torvalds *entry->status = STATUS_FREE; 13651da177e4SLinus Torvalds 13661da177e4SLinus Torvalds if (ok == 0) { 13671da177e4SLinus Torvalds printk(FORE200E "unable to %s VC %d.%d.%d\n", 13681da177e4SLinus Torvalds activate ? "open" : "close", vcc->itf, vcc->vpi, vcc->vci); 13691da177e4SLinus Torvalds return -EIO; 13701da177e4SLinus Torvalds } 13711da177e4SLinus Torvalds 13721da177e4SLinus Torvalds DPRINTK(1, "VC %d.%d.%d %sed\n", vcc->itf, vcc->vpi, vcc->vci, 13731da177e4SLinus Torvalds activate ? "open" : "clos"); 13741da177e4SLinus Torvalds 13751da177e4SLinus Torvalds return 0; 13761da177e4SLinus Torvalds } 13771da177e4SLinus Torvalds 13781da177e4SLinus Torvalds 13791da177e4SLinus Torvalds #define FORE200E_MAX_BACK2BACK_CELLS 255 /* XXX depends on CDVT */ 13801da177e4SLinus Torvalds 13811da177e4SLinus Torvalds static void 13821da177e4SLinus Torvalds fore200e_rate_ctrl(struct atm_qos* qos, struct tpd_rate* rate) 13831da177e4SLinus Torvalds { 13841da177e4SLinus Torvalds if (qos->txtp.max_pcr < ATM_OC3_PCR) { 13851da177e4SLinus Torvalds 13861da177e4SLinus Torvalds /* compute the data cells to idle cells ratio from the tx PCR */ 13871da177e4SLinus Torvalds rate->data_cells = qos->txtp.max_pcr * FORE200E_MAX_BACK2BACK_CELLS / ATM_OC3_PCR; 13881da177e4SLinus Torvalds rate->idle_cells = FORE200E_MAX_BACK2BACK_CELLS - rate->data_cells; 13891da177e4SLinus Torvalds } 13901da177e4SLinus Torvalds else { 13911da177e4SLinus Torvalds /* disable rate control */ 13921da177e4SLinus Torvalds rate->data_cells = rate->idle_cells = 0; 13931da177e4SLinus Torvalds } 13941da177e4SLinus Torvalds } 13951da177e4SLinus Torvalds 13961da177e4SLinus Torvalds 13971da177e4SLinus Torvalds static int 13981da177e4SLinus Torvalds fore200e_open(struct atm_vcc *vcc) 13991da177e4SLinus Torvalds { 14001da177e4SLinus Torvalds struct fore200e* fore200e = FORE200E_DEV(vcc->dev); 14011da177e4SLinus Torvalds struct fore200e_vcc* fore200e_vcc; 14021da177e4SLinus Torvalds struct fore200e_vc_map* vc_map; 14031da177e4SLinus Torvalds unsigned long flags; 14041da177e4SLinus Torvalds int vci = vcc->vci; 14051da177e4SLinus Torvalds short vpi = vcc->vpi; 14061da177e4SLinus Torvalds 14071da177e4SLinus Torvalds ASSERT((vpi >= 0) && (vpi < 1<<FORE200E_VPI_BITS)); 14081da177e4SLinus Torvalds ASSERT((vci >= 0) && (vci < 1<<FORE200E_VCI_BITS)); 14091da177e4SLinus Torvalds 14101da177e4SLinus Torvalds spin_lock_irqsave(&fore200e->q_lock, flags); 14111da177e4SLinus Torvalds 14121da177e4SLinus Torvalds vc_map = FORE200E_VC_MAP(fore200e, vpi, vci); 14131da177e4SLinus Torvalds if (vc_map->vcc) { 14141da177e4SLinus Torvalds 14151da177e4SLinus Torvalds spin_unlock_irqrestore(&fore200e->q_lock, flags); 14161da177e4SLinus Torvalds 14171da177e4SLinus Torvalds printk(FORE200E "VC %d.%d.%d already in use\n", 14181da177e4SLinus Torvalds fore200e->atm_dev->number, vpi, vci); 14191da177e4SLinus Torvalds 14201da177e4SLinus Torvalds return -EINVAL; 14211da177e4SLinus Torvalds } 14221da177e4SLinus Torvalds 14231da177e4SLinus Torvalds vc_map->vcc = vcc; 14241da177e4SLinus Torvalds 14251da177e4SLinus Torvalds spin_unlock_irqrestore(&fore200e->q_lock, flags); 14261da177e4SLinus Torvalds 14271f8a5fb8SAdrian Bunk fore200e_vcc = kzalloc(sizeof(struct fore200e_vcc), GFP_ATOMIC); 14281da177e4SLinus Torvalds if (fore200e_vcc == NULL) { 14291da177e4SLinus Torvalds vc_map->vcc = NULL; 14301da177e4SLinus Torvalds return -ENOMEM; 14311da177e4SLinus Torvalds } 14321da177e4SLinus Torvalds 14331da177e4SLinus Torvalds DPRINTK(2, "opening %d.%d.%d:%d QoS = (tx: cl=%s, pcr=%d-%d, cdv=%d, max_sdu=%d; " 14341da177e4SLinus Torvalds "rx: cl=%s, pcr=%d-%d, cdv=%d, max_sdu=%d)\n", 14351da177e4SLinus Torvalds vcc->itf, vcc->vpi, vcc->vci, fore200e_atm2fore_aal(vcc->qos.aal), 14361da177e4SLinus Torvalds fore200e_traffic_class[ vcc->qos.txtp.traffic_class ], 14371da177e4SLinus Torvalds vcc->qos.txtp.min_pcr, vcc->qos.txtp.max_pcr, vcc->qos.txtp.max_cdv, vcc->qos.txtp.max_sdu, 14381da177e4SLinus Torvalds fore200e_traffic_class[ vcc->qos.rxtp.traffic_class ], 14391da177e4SLinus Torvalds vcc->qos.rxtp.min_pcr, vcc->qos.rxtp.max_pcr, vcc->qos.rxtp.max_cdv, vcc->qos.rxtp.max_sdu); 14401da177e4SLinus Torvalds 14411da177e4SLinus Torvalds /* pseudo-CBR bandwidth requested? */ 14421da177e4SLinus Torvalds if ((vcc->qos.txtp.traffic_class == ATM_CBR) && (vcc->qos.txtp.max_pcr > 0)) { 14431da177e4SLinus Torvalds 1444bfbf3c09SMatthias Kaehlcke mutex_lock(&fore200e->rate_mtx); 14451da177e4SLinus Torvalds if (fore200e->available_cell_rate < vcc->qos.txtp.max_pcr) { 1446bfbf3c09SMatthias Kaehlcke mutex_unlock(&fore200e->rate_mtx); 14471da177e4SLinus Torvalds 14481f8a5fb8SAdrian Bunk kfree(fore200e_vcc); 14491da177e4SLinus Torvalds vc_map->vcc = NULL; 14501da177e4SLinus Torvalds return -EAGAIN; 14511da177e4SLinus Torvalds } 14521da177e4SLinus Torvalds 14531da177e4SLinus Torvalds /* reserve bandwidth */ 14541da177e4SLinus Torvalds fore200e->available_cell_rate -= vcc->qos.txtp.max_pcr; 1455bfbf3c09SMatthias Kaehlcke mutex_unlock(&fore200e->rate_mtx); 14561da177e4SLinus Torvalds } 14571da177e4SLinus Torvalds 14581da177e4SLinus Torvalds vcc->itf = vcc->dev->number; 14591da177e4SLinus Torvalds 14601da177e4SLinus Torvalds set_bit(ATM_VF_PARTIAL,&vcc->flags); 14611da177e4SLinus Torvalds set_bit(ATM_VF_ADDR, &vcc->flags); 14621da177e4SLinus Torvalds 14631da177e4SLinus Torvalds vcc->dev_data = fore200e_vcc; 14641da177e4SLinus Torvalds 14651da177e4SLinus Torvalds if (fore200e_activate_vcin(fore200e, 1, vcc, vcc->qos.rxtp.max_sdu) < 0) { 14661da177e4SLinus Torvalds 14671da177e4SLinus Torvalds vc_map->vcc = NULL; 14681da177e4SLinus Torvalds 14691da177e4SLinus Torvalds clear_bit(ATM_VF_ADDR, &vcc->flags); 14701da177e4SLinus Torvalds clear_bit(ATM_VF_PARTIAL,&vcc->flags); 14711da177e4SLinus Torvalds 14721da177e4SLinus Torvalds vcc->dev_data = NULL; 14731da177e4SLinus Torvalds 14741da177e4SLinus Torvalds fore200e->available_cell_rate += vcc->qos.txtp.max_pcr; 14751da177e4SLinus Torvalds 14761f8a5fb8SAdrian Bunk kfree(fore200e_vcc); 14771da177e4SLinus Torvalds return -EINVAL; 14781da177e4SLinus Torvalds } 14791da177e4SLinus Torvalds 14801da177e4SLinus Torvalds /* compute rate control parameters */ 14811da177e4SLinus Torvalds if ((vcc->qos.txtp.traffic_class == ATM_CBR) && (vcc->qos.txtp.max_pcr > 0)) { 14821da177e4SLinus Torvalds 14831da177e4SLinus Torvalds fore200e_rate_ctrl(&vcc->qos, &fore200e_vcc->rate); 14841da177e4SLinus Torvalds set_bit(ATM_VF_HASQOS, &vcc->flags); 14851da177e4SLinus Torvalds 14861da177e4SLinus Torvalds DPRINTK(3, "tx on %d.%d.%d:%d, tx PCR = %d, rx PCR = %d, data_cells = %u, idle_cells = %u\n", 14871da177e4SLinus Torvalds vcc->itf, vcc->vpi, vcc->vci, fore200e_atm2fore_aal(vcc->qos.aal), 14881da177e4SLinus Torvalds vcc->qos.txtp.max_pcr, vcc->qos.rxtp.max_pcr, 14891da177e4SLinus Torvalds fore200e_vcc->rate.data_cells, fore200e_vcc->rate.idle_cells); 14901da177e4SLinus Torvalds } 14911da177e4SLinus Torvalds 14921da177e4SLinus Torvalds fore200e_vcc->tx_min_pdu = fore200e_vcc->rx_min_pdu = MAX_PDU_SIZE + 1; 14931da177e4SLinus Torvalds fore200e_vcc->tx_max_pdu = fore200e_vcc->rx_max_pdu = 0; 14941da177e4SLinus Torvalds fore200e_vcc->tx_pdu = fore200e_vcc->rx_pdu = 0; 14951da177e4SLinus Torvalds 14961da177e4SLinus Torvalds /* new incarnation of the vcc */ 14971da177e4SLinus Torvalds vc_map->incarn = ++fore200e->incarn_count; 14981da177e4SLinus Torvalds 14991da177e4SLinus Torvalds /* VC unusable before this flag is set */ 15001da177e4SLinus Torvalds set_bit(ATM_VF_READY, &vcc->flags); 15011da177e4SLinus Torvalds 15021da177e4SLinus Torvalds return 0; 15031da177e4SLinus Torvalds } 15041da177e4SLinus Torvalds 15051da177e4SLinus Torvalds 15061da177e4SLinus Torvalds static void 15071da177e4SLinus Torvalds fore200e_close(struct atm_vcc* vcc) 15081da177e4SLinus Torvalds { 15091da177e4SLinus Torvalds struct fore200e* fore200e = FORE200E_DEV(vcc->dev); 15101da177e4SLinus Torvalds struct fore200e_vcc* fore200e_vcc; 15111da177e4SLinus Torvalds struct fore200e_vc_map* vc_map; 15121da177e4SLinus Torvalds unsigned long flags; 15131da177e4SLinus Torvalds 15141da177e4SLinus Torvalds ASSERT(vcc); 15151da177e4SLinus Torvalds ASSERT((vcc->vpi >= 0) && (vcc->vpi < 1<<FORE200E_VPI_BITS)); 15161da177e4SLinus Torvalds ASSERT((vcc->vci >= 0) && (vcc->vci < 1<<FORE200E_VCI_BITS)); 15171da177e4SLinus Torvalds 15181da177e4SLinus Torvalds DPRINTK(2, "closing %d.%d.%d:%d\n", vcc->itf, vcc->vpi, vcc->vci, fore200e_atm2fore_aal(vcc->qos.aal)); 15191da177e4SLinus Torvalds 15201da177e4SLinus Torvalds clear_bit(ATM_VF_READY, &vcc->flags); 15211da177e4SLinus Torvalds 15221da177e4SLinus Torvalds fore200e_activate_vcin(fore200e, 0, vcc, 0); 15231da177e4SLinus Torvalds 15241da177e4SLinus Torvalds spin_lock_irqsave(&fore200e->q_lock, flags); 15251da177e4SLinus Torvalds 15261da177e4SLinus Torvalds vc_map = FORE200E_VC_MAP(fore200e, vcc->vpi, vcc->vci); 15271da177e4SLinus Torvalds 15281da177e4SLinus Torvalds /* the vc is no longer considered as "in use" by fore200e_open() */ 15291da177e4SLinus Torvalds vc_map->vcc = NULL; 15301da177e4SLinus Torvalds 15311da177e4SLinus Torvalds vcc->itf = vcc->vci = vcc->vpi = 0; 15321da177e4SLinus Torvalds 15331da177e4SLinus Torvalds fore200e_vcc = FORE200E_VCC(vcc); 15341da177e4SLinus Torvalds vcc->dev_data = NULL; 15351da177e4SLinus Torvalds 15361da177e4SLinus Torvalds spin_unlock_irqrestore(&fore200e->q_lock, flags); 15371da177e4SLinus Torvalds 15381da177e4SLinus Torvalds /* release reserved bandwidth, if any */ 15391da177e4SLinus Torvalds if ((vcc->qos.txtp.traffic_class == ATM_CBR) && (vcc->qos.txtp.max_pcr > 0)) { 15401da177e4SLinus Torvalds 1541bfbf3c09SMatthias Kaehlcke mutex_lock(&fore200e->rate_mtx); 15421da177e4SLinus Torvalds fore200e->available_cell_rate += vcc->qos.txtp.max_pcr; 1543bfbf3c09SMatthias Kaehlcke mutex_unlock(&fore200e->rate_mtx); 15441da177e4SLinus Torvalds 15451da177e4SLinus Torvalds clear_bit(ATM_VF_HASQOS, &vcc->flags); 15461da177e4SLinus Torvalds } 15471da177e4SLinus Torvalds 15481da177e4SLinus Torvalds clear_bit(ATM_VF_ADDR, &vcc->flags); 15491da177e4SLinus Torvalds clear_bit(ATM_VF_PARTIAL,&vcc->flags); 15501da177e4SLinus Torvalds 15511da177e4SLinus Torvalds ASSERT(fore200e_vcc); 15521f8a5fb8SAdrian Bunk kfree(fore200e_vcc); 15531da177e4SLinus Torvalds } 15541da177e4SLinus Torvalds 15551da177e4SLinus Torvalds 15561da177e4SLinus Torvalds static int 15571da177e4SLinus Torvalds fore200e_send(struct atm_vcc *vcc, struct sk_buff *skb) 15581da177e4SLinus Torvalds { 15591da177e4SLinus Torvalds struct fore200e* fore200e = FORE200E_DEV(vcc->dev); 15601da177e4SLinus Torvalds struct fore200e_vcc* fore200e_vcc = FORE200E_VCC(vcc); 15611da177e4SLinus Torvalds struct fore200e_vc_map* vc_map; 15621da177e4SLinus Torvalds struct host_txq* txq = &fore200e->host_txq; 15631da177e4SLinus Torvalds struct host_txq_entry* entry; 15641da177e4SLinus Torvalds struct tpd* tpd; 15651da177e4SLinus Torvalds struct tpd_haddr tpd_haddr; 15661da177e4SLinus Torvalds int retry = CONFIG_ATM_FORE200E_TX_RETRY; 15671da177e4SLinus Torvalds int tx_copy = 0; 15681da177e4SLinus Torvalds int tx_len = skb->len; 15691da177e4SLinus Torvalds u32* cell_header = NULL; 15701da177e4SLinus Torvalds unsigned char* skb_data; 15711da177e4SLinus Torvalds int skb_len; 15721da177e4SLinus Torvalds unsigned char* data; 15731da177e4SLinus Torvalds unsigned long flags; 15741da177e4SLinus Torvalds 15751da177e4SLinus Torvalds ASSERT(vcc); 15761da177e4SLinus Torvalds ASSERT(atomic_read(&sk_atm(vcc)->sk_wmem_alloc) >= 0); 15771da177e4SLinus Torvalds ASSERT(fore200e); 15781da177e4SLinus Torvalds ASSERT(fore200e_vcc); 15791da177e4SLinus Torvalds 15801da177e4SLinus Torvalds if (!test_bit(ATM_VF_READY, &vcc->flags)) { 15811da177e4SLinus Torvalds DPRINTK(1, "VC %d.%d.%d not ready for tx\n", vcc->itf, vcc->vpi, vcc->vpi); 15821da177e4SLinus Torvalds dev_kfree_skb_any(skb); 15831da177e4SLinus Torvalds return -EINVAL; 15841da177e4SLinus Torvalds } 15851da177e4SLinus Torvalds 15861da177e4SLinus Torvalds #ifdef FORE200E_52BYTE_AAL0_SDU 15871da177e4SLinus Torvalds if ((vcc->qos.aal == ATM_AAL0) && (vcc->qos.txtp.max_sdu == ATM_AAL0_SDU)) { 15881da177e4SLinus Torvalds cell_header = (u32*) skb->data; 15891da177e4SLinus Torvalds skb_data = skb->data + 4; /* skip 4-byte cell header */ 15901da177e4SLinus Torvalds skb_len = tx_len = skb->len - 4; 15911da177e4SLinus Torvalds 15921da177e4SLinus Torvalds DPRINTK(3, "user-supplied cell header = 0x%08x\n", *cell_header); 15931da177e4SLinus Torvalds } 15941da177e4SLinus Torvalds else 15951da177e4SLinus Torvalds #endif 15961da177e4SLinus Torvalds { 15971da177e4SLinus Torvalds skb_data = skb->data; 15981da177e4SLinus Torvalds skb_len = skb->len; 15991da177e4SLinus Torvalds } 16001da177e4SLinus Torvalds 16011da177e4SLinus Torvalds if (((unsigned long)skb_data) & 0x3) { 16021da177e4SLinus Torvalds 16031da177e4SLinus Torvalds DPRINTK(2, "misaligned tx PDU on device %s\n", fore200e->name); 16041da177e4SLinus Torvalds tx_copy = 1; 16051da177e4SLinus Torvalds tx_len = skb_len; 16061da177e4SLinus Torvalds } 16071da177e4SLinus Torvalds 16081da177e4SLinus Torvalds if ((vcc->qos.aal == ATM_AAL0) && (skb_len % ATM_CELL_PAYLOAD)) { 16091da177e4SLinus Torvalds 16101da177e4SLinus Torvalds /* this simply NUKES the PCA board */ 16111da177e4SLinus Torvalds DPRINTK(2, "incomplete tx AAL0 PDU on device %s\n", fore200e->name); 16121da177e4SLinus Torvalds tx_copy = 1; 16131da177e4SLinus Torvalds tx_len = ((skb_len / ATM_CELL_PAYLOAD) + 1) * ATM_CELL_PAYLOAD; 16141da177e4SLinus Torvalds } 16151da177e4SLinus Torvalds 16161da177e4SLinus Torvalds if (tx_copy) { 16171da177e4SLinus Torvalds data = kmalloc(tx_len, GFP_ATOMIC | GFP_DMA); 16181da177e4SLinus Torvalds if (data == NULL) { 16191da177e4SLinus Torvalds if (vcc->pop) { 16201da177e4SLinus Torvalds vcc->pop(vcc, skb); 16211da177e4SLinus Torvalds } 16221da177e4SLinus Torvalds else { 16231da177e4SLinus Torvalds dev_kfree_skb_any(skb); 16241da177e4SLinus Torvalds } 16251da177e4SLinus Torvalds return -ENOMEM; 16261da177e4SLinus Torvalds } 16271da177e4SLinus Torvalds 16281da177e4SLinus Torvalds memcpy(data, skb_data, skb_len); 16291da177e4SLinus Torvalds if (skb_len < tx_len) 16301da177e4SLinus Torvalds memset(data + skb_len, 0x00, tx_len - skb_len); 16311da177e4SLinus Torvalds } 16321da177e4SLinus Torvalds else { 16331da177e4SLinus Torvalds data = skb_data; 16341da177e4SLinus Torvalds } 16351da177e4SLinus Torvalds 16361da177e4SLinus Torvalds vc_map = FORE200E_VC_MAP(fore200e, vcc->vpi, vcc->vci); 16371da177e4SLinus Torvalds ASSERT(vc_map->vcc == vcc); 16381da177e4SLinus Torvalds 16391da177e4SLinus Torvalds retry_here: 16401da177e4SLinus Torvalds 16411da177e4SLinus Torvalds spin_lock_irqsave(&fore200e->q_lock, flags); 16421da177e4SLinus Torvalds 16431da177e4SLinus Torvalds entry = &txq->host_entry[ txq->head ]; 16441da177e4SLinus Torvalds 16451da177e4SLinus Torvalds if ((*entry->status != STATUS_FREE) || (txq->txing >= QUEUE_SIZE_TX - 2)) { 16461da177e4SLinus Torvalds 16471da177e4SLinus Torvalds /* try to free completed tx queue entries */ 16481da177e4SLinus Torvalds fore200e_tx_irq(fore200e); 16491da177e4SLinus Torvalds 16501da177e4SLinus Torvalds if (*entry->status != STATUS_FREE) { 16511da177e4SLinus Torvalds 16521da177e4SLinus Torvalds spin_unlock_irqrestore(&fore200e->q_lock, flags); 16531da177e4SLinus Torvalds 16541da177e4SLinus Torvalds /* retry once again? */ 16551da177e4SLinus Torvalds if (--retry > 0) { 16561da177e4SLinus Torvalds udelay(50); 16571da177e4SLinus Torvalds goto retry_here; 16581da177e4SLinus Torvalds } 16591da177e4SLinus Torvalds 16601da177e4SLinus Torvalds atomic_inc(&vcc->stats->tx_err); 16611da177e4SLinus Torvalds 16621da177e4SLinus Torvalds fore200e->tx_sat++; 16631da177e4SLinus Torvalds DPRINTK(2, "tx queue of device %s is saturated, PDU dropped - heartbeat is %08x\n", 16641da177e4SLinus Torvalds fore200e->name, fore200e->cp_queues->heartbeat); 16651da177e4SLinus Torvalds if (vcc->pop) { 16661da177e4SLinus Torvalds vcc->pop(vcc, skb); 16671da177e4SLinus Torvalds } 16681da177e4SLinus Torvalds else { 16691da177e4SLinus Torvalds dev_kfree_skb_any(skb); 16701da177e4SLinus Torvalds } 16711da177e4SLinus Torvalds 16721da177e4SLinus Torvalds if (tx_copy) 16731da177e4SLinus Torvalds kfree(data); 16741da177e4SLinus Torvalds 16751da177e4SLinus Torvalds return -ENOBUFS; 16761da177e4SLinus Torvalds } 16771da177e4SLinus Torvalds } 16781da177e4SLinus Torvalds 16791da177e4SLinus Torvalds entry->incarn = vc_map->incarn; 16801da177e4SLinus Torvalds entry->vc_map = vc_map; 16811da177e4SLinus Torvalds entry->skb = skb; 16821da177e4SLinus Torvalds entry->data = tx_copy ? data : NULL; 16831da177e4SLinus Torvalds 16841da177e4SLinus Torvalds tpd = entry->tpd; 16851da177e4SLinus Torvalds tpd->tsd[ 0 ].buffer = fore200e->bus->dma_map(fore200e, data, tx_len, DMA_TO_DEVICE); 16861da177e4SLinus Torvalds tpd->tsd[ 0 ].length = tx_len; 16871da177e4SLinus Torvalds 16881da177e4SLinus Torvalds FORE200E_NEXT_ENTRY(txq->head, QUEUE_SIZE_TX); 16891da177e4SLinus Torvalds txq->txing++; 16901da177e4SLinus Torvalds 16911da177e4SLinus Torvalds /* The dma_map call above implies a dma_sync so the device can use it, 16921da177e4SLinus Torvalds * thus no explicit dma_sync call is necessary here. 16931da177e4SLinus Torvalds */ 16941da177e4SLinus Torvalds 16951da177e4SLinus Torvalds DPRINTK(3, "tx on %d.%d.%d:%d, len = %u (%u)\n", 16961da177e4SLinus Torvalds vcc->itf, vcc->vpi, vcc->vci, fore200e_atm2fore_aal(vcc->qos.aal), 16971da177e4SLinus Torvalds tpd->tsd[0].length, skb_len); 16981da177e4SLinus Torvalds 16991da177e4SLinus Torvalds if (skb_len < fore200e_vcc->tx_min_pdu) 17001da177e4SLinus Torvalds fore200e_vcc->tx_min_pdu = skb_len; 17011da177e4SLinus Torvalds if (skb_len > fore200e_vcc->tx_max_pdu) 17021da177e4SLinus Torvalds fore200e_vcc->tx_max_pdu = skb_len; 17031da177e4SLinus Torvalds fore200e_vcc->tx_pdu++; 17041da177e4SLinus Torvalds 17051da177e4SLinus Torvalds /* set tx rate control information */ 17061da177e4SLinus Torvalds tpd->rate.data_cells = fore200e_vcc->rate.data_cells; 17071da177e4SLinus Torvalds tpd->rate.idle_cells = fore200e_vcc->rate.idle_cells; 17081da177e4SLinus Torvalds 17091da177e4SLinus Torvalds if (cell_header) { 17101da177e4SLinus Torvalds tpd->atm_header.clp = (*cell_header & ATM_HDR_CLP); 17111da177e4SLinus Torvalds tpd->atm_header.plt = (*cell_header & ATM_HDR_PTI_MASK) >> ATM_HDR_PTI_SHIFT; 17121da177e4SLinus Torvalds tpd->atm_header.vci = (*cell_header & ATM_HDR_VCI_MASK) >> ATM_HDR_VCI_SHIFT; 17131da177e4SLinus Torvalds tpd->atm_header.vpi = (*cell_header & ATM_HDR_VPI_MASK) >> ATM_HDR_VPI_SHIFT; 17141da177e4SLinus Torvalds tpd->atm_header.gfc = (*cell_header & ATM_HDR_GFC_MASK) >> ATM_HDR_GFC_SHIFT; 17151da177e4SLinus Torvalds } 17161da177e4SLinus Torvalds else { 17171da177e4SLinus Torvalds /* set the ATM header, common to all cells conveying the PDU */ 17181da177e4SLinus Torvalds tpd->atm_header.clp = 0; 17191da177e4SLinus Torvalds tpd->atm_header.plt = 0; 17201da177e4SLinus Torvalds tpd->atm_header.vci = vcc->vci; 17211da177e4SLinus Torvalds tpd->atm_header.vpi = vcc->vpi; 17221da177e4SLinus Torvalds tpd->atm_header.gfc = 0; 17231da177e4SLinus Torvalds } 17241da177e4SLinus Torvalds 17251da177e4SLinus Torvalds tpd->spec.length = tx_len; 17261da177e4SLinus Torvalds tpd->spec.nseg = 1; 17271da177e4SLinus Torvalds tpd->spec.aal = fore200e_atm2fore_aal(vcc->qos.aal); 17281da177e4SLinus Torvalds tpd->spec.intr = 1; 17291da177e4SLinus Torvalds 17301da177e4SLinus Torvalds tpd_haddr.size = sizeof(struct tpd) / (1<<TPD_HADDR_SHIFT); /* size is expressed in 32 byte blocks */ 17311da177e4SLinus Torvalds tpd_haddr.pad = 0; 17321da177e4SLinus Torvalds tpd_haddr.haddr = entry->tpd_dma >> TPD_HADDR_SHIFT; /* shift the address, as we are in a bitfield */ 17331da177e4SLinus Torvalds 17341da177e4SLinus Torvalds *entry->status = STATUS_PENDING; 17351da177e4SLinus Torvalds fore200e->bus->write(*(u32*)&tpd_haddr, (u32 __iomem *)&entry->cp_entry->tpd_haddr); 17361da177e4SLinus Torvalds 17371da177e4SLinus Torvalds spin_unlock_irqrestore(&fore200e->q_lock, flags); 17381da177e4SLinus Torvalds 17391da177e4SLinus Torvalds return 0; 17401da177e4SLinus Torvalds } 17411da177e4SLinus Torvalds 17421da177e4SLinus Torvalds 17431da177e4SLinus Torvalds static int 17441da177e4SLinus Torvalds fore200e_getstats(struct fore200e* fore200e) 17451da177e4SLinus Torvalds { 17461da177e4SLinus Torvalds struct host_cmdq* cmdq = &fore200e->host_cmdq; 17471da177e4SLinus Torvalds struct host_cmdq_entry* entry = &cmdq->host_entry[ cmdq->head ]; 17481da177e4SLinus Torvalds struct stats_opcode opcode; 17491da177e4SLinus Torvalds int ok; 17501da177e4SLinus Torvalds u32 stats_dma_addr; 17511da177e4SLinus Torvalds 17521da177e4SLinus Torvalds if (fore200e->stats == NULL) { 17531f8a5fb8SAdrian Bunk fore200e->stats = kzalloc(sizeof(struct stats), GFP_KERNEL | GFP_DMA); 17541da177e4SLinus Torvalds if (fore200e->stats == NULL) 17551da177e4SLinus Torvalds return -ENOMEM; 17561da177e4SLinus Torvalds } 17571da177e4SLinus Torvalds 17581da177e4SLinus Torvalds stats_dma_addr = fore200e->bus->dma_map(fore200e, fore200e->stats, 17591da177e4SLinus Torvalds sizeof(struct stats), DMA_FROM_DEVICE); 17601da177e4SLinus Torvalds 17611da177e4SLinus Torvalds FORE200E_NEXT_ENTRY(cmdq->head, QUEUE_SIZE_CMD); 17621da177e4SLinus Torvalds 17631da177e4SLinus Torvalds opcode.opcode = OPCODE_GET_STATS; 17641da177e4SLinus Torvalds opcode.pad = 0; 17651da177e4SLinus Torvalds 17661da177e4SLinus Torvalds fore200e->bus->write(stats_dma_addr, &entry->cp_entry->cmd.stats_block.stats_haddr); 17671da177e4SLinus Torvalds 17681da177e4SLinus Torvalds *entry->status = STATUS_PENDING; 17691da177e4SLinus Torvalds 17701da177e4SLinus Torvalds fore200e->bus->write(*(u32*)&opcode, (u32 __iomem *)&entry->cp_entry->cmd.stats_block.opcode); 17711da177e4SLinus Torvalds 17721da177e4SLinus Torvalds ok = fore200e_poll(fore200e, entry->status, STATUS_COMPLETE, 400); 17731da177e4SLinus Torvalds 17741da177e4SLinus Torvalds *entry->status = STATUS_FREE; 17751da177e4SLinus Torvalds 17761da177e4SLinus Torvalds fore200e->bus->dma_unmap(fore200e, stats_dma_addr, sizeof(struct stats), DMA_FROM_DEVICE); 17771da177e4SLinus Torvalds 17781da177e4SLinus Torvalds if (ok == 0) { 17791da177e4SLinus Torvalds printk(FORE200E "unable to get statistics from device %s\n", fore200e->name); 17801da177e4SLinus Torvalds return -EIO; 17811da177e4SLinus Torvalds } 17821da177e4SLinus Torvalds 17831da177e4SLinus Torvalds return 0; 17841da177e4SLinus Torvalds } 17851da177e4SLinus Torvalds 17861da177e4SLinus Torvalds 17871da177e4SLinus Torvalds static int 17881da177e4SLinus Torvalds fore200e_getsockopt(struct atm_vcc* vcc, int level, int optname, void __user *optval, int optlen) 17891da177e4SLinus Torvalds { 17901da177e4SLinus Torvalds /* struct fore200e* fore200e = FORE200E_DEV(vcc->dev); */ 17911da177e4SLinus Torvalds 17921da177e4SLinus Torvalds DPRINTK(2, "getsockopt %d.%d.%d, level = %d, optname = 0x%x, optval = 0x%p, optlen = %d\n", 17931da177e4SLinus Torvalds vcc->itf, vcc->vpi, vcc->vci, level, optname, optval, optlen); 17941da177e4SLinus Torvalds 17951da177e4SLinus Torvalds return -EINVAL; 17961da177e4SLinus Torvalds } 17971da177e4SLinus Torvalds 17981da177e4SLinus Torvalds 17991da177e4SLinus Torvalds static int 1800b7058842SDavid S. Miller fore200e_setsockopt(struct atm_vcc* vcc, int level, int optname, void __user *optval, unsigned int optlen) 18011da177e4SLinus Torvalds { 18021da177e4SLinus Torvalds /* struct fore200e* fore200e = FORE200E_DEV(vcc->dev); */ 18031da177e4SLinus Torvalds 18041da177e4SLinus Torvalds DPRINTK(2, "setsockopt %d.%d.%d, level = %d, optname = 0x%x, optval = 0x%p, optlen = %d\n", 18051da177e4SLinus Torvalds vcc->itf, vcc->vpi, vcc->vci, level, optname, optval, optlen); 18061da177e4SLinus Torvalds 18071da177e4SLinus Torvalds return -EINVAL; 18081da177e4SLinus Torvalds } 18091da177e4SLinus Torvalds 18101da177e4SLinus Torvalds 18111da177e4SLinus Torvalds #if 0 /* currently unused */ 18121da177e4SLinus Torvalds static int 18131da177e4SLinus Torvalds fore200e_get_oc3(struct fore200e* fore200e, struct oc3_regs* regs) 18141da177e4SLinus Torvalds { 18151da177e4SLinus Torvalds struct host_cmdq* cmdq = &fore200e->host_cmdq; 18161da177e4SLinus Torvalds struct host_cmdq_entry* entry = &cmdq->host_entry[ cmdq->head ]; 18171da177e4SLinus Torvalds struct oc3_opcode opcode; 18181da177e4SLinus Torvalds int ok; 18191da177e4SLinus Torvalds u32 oc3_regs_dma_addr; 18201da177e4SLinus Torvalds 18211da177e4SLinus Torvalds oc3_regs_dma_addr = fore200e->bus->dma_map(fore200e, regs, sizeof(struct oc3_regs), DMA_FROM_DEVICE); 18221da177e4SLinus Torvalds 18231da177e4SLinus Torvalds FORE200E_NEXT_ENTRY(cmdq->head, QUEUE_SIZE_CMD); 18241da177e4SLinus Torvalds 18251da177e4SLinus Torvalds opcode.opcode = OPCODE_GET_OC3; 18261da177e4SLinus Torvalds opcode.reg = 0; 18271da177e4SLinus Torvalds opcode.value = 0; 18281da177e4SLinus Torvalds opcode.mask = 0; 18291da177e4SLinus Torvalds 18301da177e4SLinus Torvalds fore200e->bus->write(oc3_regs_dma_addr, &entry->cp_entry->cmd.oc3_block.regs_haddr); 18311da177e4SLinus Torvalds 18321da177e4SLinus Torvalds *entry->status = STATUS_PENDING; 18331da177e4SLinus Torvalds 18341da177e4SLinus Torvalds fore200e->bus->write(*(u32*)&opcode, (u32*)&entry->cp_entry->cmd.oc3_block.opcode); 18351da177e4SLinus Torvalds 18361da177e4SLinus Torvalds ok = fore200e_poll(fore200e, entry->status, STATUS_COMPLETE, 400); 18371da177e4SLinus Torvalds 18381da177e4SLinus Torvalds *entry->status = STATUS_FREE; 18391da177e4SLinus Torvalds 18401da177e4SLinus Torvalds fore200e->bus->dma_unmap(fore200e, oc3_regs_dma_addr, sizeof(struct oc3_regs), DMA_FROM_DEVICE); 18411da177e4SLinus Torvalds 18421da177e4SLinus Torvalds if (ok == 0) { 18431da177e4SLinus Torvalds printk(FORE200E "unable to get OC-3 regs of device %s\n", fore200e->name); 18441da177e4SLinus Torvalds return -EIO; 18451da177e4SLinus Torvalds } 18461da177e4SLinus Torvalds 18471da177e4SLinus Torvalds return 0; 18481da177e4SLinus Torvalds } 18491da177e4SLinus Torvalds #endif 18501da177e4SLinus Torvalds 18511da177e4SLinus Torvalds 18521da177e4SLinus Torvalds static int 18531da177e4SLinus Torvalds fore200e_set_oc3(struct fore200e* fore200e, u32 reg, u32 value, u32 mask) 18541da177e4SLinus Torvalds { 18551da177e4SLinus Torvalds struct host_cmdq* cmdq = &fore200e->host_cmdq; 18561da177e4SLinus Torvalds struct host_cmdq_entry* entry = &cmdq->host_entry[ cmdq->head ]; 18571da177e4SLinus Torvalds struct oc3_opcode opcode; 18581da177e4SLinus Torvalds int ok; 18591da177e4SLinus Torvalds 18601da177e4SLinus Torvalds DPRINTK(2, "set OC-3 reg = 0x%02x, value = 0x%02x, mask = 0x%02x\n", reg, value, mask); 18611da177e4SLinus Torvalds 18621da177e4SLinus Torvalds FORE200E_NEXT_ENTRY(cmdq->head, QUEUE_SIZE_CMD); 18631da177e4SLinus Torvalds 18641da177e4SLinus Torvalds opcode.opcode = OPCODE_SET_OC3; 18651da177e4SLinus Torvalds opcode.reg = reg; 18661da177e4SLinus Torvalds opcode.value = value; 18671da177e4SLinus Torvalds opcode.mask = mask; 18681da177e4SLinus Torvalds 18691da177e4SLinus Torvalds fore200e->bus->write(0, &entry->cp_entry->cmd.oc3_block.regs_haddr); 18701da177e4SLinus Torvalds 18711da177e4SLinus Torvalds *entry->status = STATUS_PENDING; 18721da177e4SLinus Torvalds 18731da177e4SLinus Torvalds fore200e->bus->write(*(u32*)&opcode, (u32 __iomem *)&entry->cp_entry->cmd.oc3_block.opcode); 18741da177e4SLinus Torvalds 18751da177e4SLinus Torvalds ok = fore200e_poll(fore200e, entry->status, STATUS_COMPLETE, 400); 18761da177e4SLinus Torvalds 18771da177e4SLinus Torvalds *entry->status = STATUS_FREE; 18781da177e4SLinus Torvalds 18791da177e4SLinus Torvalds if (ok == 0) { 18801da177e4SLinus Torvalds printk(FORE200E "unable to set OC-3 reg 0x%02x of device %s\n", reg, fore200e->name); 18811da177e4SLinus Torvalds return -EIO; 18821da177e4SLinus Torvalds } 18831da177e4SLinus Torvalds 18841da177e4SLinus Torvalds return 0; 18851da177e4SLinus Torvalds } 18861da177e4SLinus Torvalds 18871da177e4SLinus Torvalds 18881da177e4SLinus Torvalds static int 18891da177e4SLinus Torvalds fore200e_setloop(struct fore200e* fore200e, int loop_mode) 18901da177e4SLinus Torvalds { 18911da177e4SLinus Torvalds u32 mct_value, mct_mask; 18921da177e4SLinus Torvalds int error; 18931da177e4SLinus Torvalds 18941da177e4SLinus Torvalds if (!capable(CAP_NET_ADMIN)) 18951da177e4SLinus Torvalds return -EPERM; 18961da177e4SLinus Torvalds 18971da177e4SLinus Torvalds switch (loop_mode) { 18981da177e4SLinus Torvalds 18991da177e4SLinus Torvalds case ATM_LM_NONE: 19001da177e4SLinus Torvalds mct_value = 0; 19011da177e4SLinus Torvalds mct_mask = SUNI_MCT_DLE | SUNI_MCT_LLE; 19021da177e4SLinus Torvalds break; 19031da177e4SLinus Torvalds 19041da177e4SLinus Torvalds case ATM_LM_LOC_PHY: 19051da177e4SLinus Torvalds mct_value = mct_mask = SUNI_MCT_DLE; 19061da177e4SLinus Torvalds break; 19071da177e4SLinus Torvalds 19081da177e4SLinus Torvalds case ATM_LM_RMT_PHY: 19091da177e4SLinus Torvalds mct_value = mct_mask = SUNI_MCT_LLE; 19101da177e4SLinus Torvalds break; 19111da177e4SLinus Torvalds 19121da177e4SLinus Torvalds default: 19131da177e4SLinus Torvalds return -EINVAL; 19141da177e4SLinus Torvalds } 19151da177e4SLinus Torvalds 19161da177e4SLinus Torvalds error = fore200e_set_oc3(fore200e, SUNI_MCT, mct_value, mct_mask); 19171da177e4SLinus Torvalds if (error == 0) 19181da177e4SLinus Torvalds fore200e->loop_mode = loop_mode; 19191da177e4SLinus Torvalds 19201da177e4SLinus Torvalds return error; 19211da177e4SLinus Torvalds } 19221da177e4SLinus Torvalds 19231da177e4SLinus Torvalds 19241da177e4SLinus Torvalds static int 19251da177e4SLinus Torvalds fore200e_fetch_stats(struct fore200e* fore200e, struct sonet_stats __user *arg) 19261da177e4SLinus Torvalds { 19271da177e4SLinus Torvalds struct sonet_stats tmp; 19281da177e4SLinus Torvalds 19291da177e4SLinus Torvalds if (fore200e_getstats(fore200e) < 0) 19301da177e4SLinus Torvalds return -EIO; 19311da177e4SLinus Torvalds 193263734a32SAl Viro tmp.section_bip = be32_to_cpu(fore200e->stats->oc3.section_bip8_errors); 193363734a32SAl Viro tmp.line_bip = be32_to_cpu(fore200e->stats->oc3.line_bip24_errors); 193463734a32SAl Viro tmp.path_bip = be32_to_cpu(fore200e->stats->oc3.path_bip8_errors); 193563734a32SAl Viro tmp.line_febe = be32_to_cpu(fore200e->stats->oc3.line_febe_errors); 193663734a32SAl Viro tmp.path_febe = be32_to_cpu(fore200e->stats->oc3.path_febe_errors); 193763734a32SAl Viro tmp.corr_hcs = be32_to_cpu(fore200e->stats->oc3.corr_hcs_errors); 193863734a32SAl Viro tmp.uncorr_hcs = be32_to_cpu(fore200e->stats->oc3.ucorr_hcs_errors); 193963734a32SAl Viro tmp.tx_cells = be32_to_cpu(fore200e->stats->aal0.cells_transmitted) + 194063734a32SAl Viro be32_to_cpu(fore200e->stats->aal34.cells_transmitted) + 194163734a32SAl Viro be32_to_cpu(fore200e->stats->aal5.cells_transmitted); 194263734a32SAl Viro tmp.rx_cells = be32_to_cpu(fore200e->stats->aal0.cells_received) + 194363734a32SAl Viro be32_to_cpu(fore200e->stats->aal34.cells_received) + 194463734a32SAl Viro be32_to_cpu(fore200e->stats->aal5.cells_received); 19451da177e4SLinus Torvalds 19461da177e4SLinus Torvalds if (arg) 19471da177e4SLinus Torvalds return copy_to_user(arg, &tmp, sizeof(struct sonet_stats)) ? -EFAULT : 0; 19481da177e4SLinus Torvalds 19491da177e4SLinus Torvalds return 0; 19501da177e4SLinus Torvalds } 19511da177e4SLinus Torvalds 19521da177e4SLinus Torvalds 19531da177e4SLinus Torvalds static int 19541da177e4SLinus Torvalds fore200e_ioctl(struct atm_dev* dev, unsigned int cmd, void __user * arg) 19551da177e4SLinus Torvalds { 19561da177e4SLinus Torvalds struct fore200e* fore200e = FORE200E_DEV(dev); 19571da177e4SLinus Torvalds 19581da177e4SLinus Torvalds DPRINTK(2, "ioctl cmd = 0x%x (%u), arg = 0x%p (%lu)\n", cmd, cmd, arg, (unsigned long)arg); 19591da177e4SLinus Torvalds 19601da177e4SLinus Torvalds switch (cmd) { 19611da177e4SLinus Torvalds 19621da177e4SLinus Torvalds case SONET_GETSTAT: 19631da177e4SLinus Torvalds return fore200e_fetch_stats(fore200e, (struct sonet_stats __user *)arg); 19641da177e4SLinus Torvalds 19651da177e4SLinus Torvalds case SONET_GETDIAG: 19661da177e4SLinus Torvalds return put_user(0, (int __user *)arg) ? -EFAULT : 0; 19671da177e4SLinus Torvalds 19681da177e4SLinus Torvalds case ATM_SETLOOP: 19691da177e4SLinus Torvalds return fore200e_setloop(fore200e, (int)(unsigned long)arg); 19701da177e4SLinus Torvalds 19711da177e4SLinus Torvalds case ATM_GETLOOP: 19721da177e4SLinus Torvalds return put_user(fore200e->loop_mode, (int __user *)arg) ? -EFAULT : 0; 19731da177e4SLinus Torvalds 19741da177e4SLinus Torvalds case ATM_QUERYLOOP: 19751da177e4SLinus Torvalds return put_user(ATM_LM_LOC_PHY | ATM_LM_RMT_PHY, (int __user *)arg) ? -EFAULT : 0; 19761da177e4SLinus Torvalds } 19771da177e4SLinus Torvalds 19781da177e4SLinus Torvalds return -ENOSYS; /* not implemented */ 19791da177e4SLinus Torvalds } 19801da177e4SLinus Torvalds 19811da177e4SLinus Torvalds 19821da177e4SLinus Torvalds static int 19831da177e4SLinus Torvalds fore200e_change_qos(struct atm_vcc* vcc,struct atm_qos* qos, int flags) 19841da177e4SLinus Torvalds { 19851da177e4SLinus Torvalds struct fore200e_vcc* fore200e_vcc = FORE200E_VCC(vcc); 19861da177e4SLinus Torvalds struct fore200e* fore200e = FORE200E_DEV(vcc->dev); 19871da177e4SLinus Torvalds 19881da177e4SLinus Torvalds if (!test_bit(ATM_VF_READY, &vcc->flags)) { 19891da177e4SLinus Torvalds DPRINTK(1, "VC %d.%d.%d not ready for QoS change\n", vcc->itf, vcc->vpi, vcc->vpi); 19901da177e4SLinus Torvalds return -EINVAL; 19911da177e4SLinus Torvalds } 19921da177e4SLinus Torvalds 19931da177e4SLinus Torvalds DPRINTK(2, "change_qos %d.%d.%d, " 19941da177e4SLinus Torvalds "(tx: cl=%s, pcr=%d-%d, cdv=%d, max_sdu=%d; " 19951da177e4SLinus Torvalds "rx: cl=%s, pcr=%d-%d, cdv=%d, max_sdu=%d), flags = 0x%x\n" 19961da177e4SLinus Torvalds "available_cell_rate = %u", 19971da177e4SLinus Torvalds vcc->itf, vcc->vpi, vcc->vci, 19981da177e4SLinus Torvalds fore200e_traffic_class[ qos->txtp.traffic_class ], 19991da177e4SLinus Torvalds qos->txtp.min_pcr, qos->txtp.max_pcr, qos->txtp.max_cdv, qos->txtp.max_sdu, 20001da177e4SLinus Torvalds fore200e_traffic_class[ qos->rxtp.traffic_class ], 20011da177e4SLinus Torvalds qos->rxtp.min_pcr, qos->rxtp.max_pcr, qos->rxtp.max_cdv, qos->rxtp.max_sdu, 20021da177e4SLinus Torvalds flags, fore200e->available_cell_rate); 20031da177e4SLinus Torvalds 20041da177e4SLinus Torvalds if ((qos->txtp.traffic_class == ATM_CBR) && (qos->txtp.max_pcr > 0)) { 20051da177e4SLinus Torvalds 2006bfbf3c09SMatthias Kaehlcke mutex_lock(&fore200e->rate_mtx); 20071da177e4SLinus Torvalds if (fore200e->available_cell_rate + vcc->qos.txtp.max_pcr < qos->txtp.max_pcr) { 2008bfbf3c09SMatthias Kaehlcke mutex_unlock(&fore200e->rate_mtx); 20091da177e4SLinus Torvalds return -EAGAIN; 20101da177e4SLinus Torvalds } 20111da177e4SLinus Torvalds 20121da177e4SLinus Torvalds fore200e->available_cell_rate += vcc->qos.txtp.max_pcr; 20131da177e4SLinus Torvalds fore200e->available_cell_rate -= qos->txtp.max_pcr; 20141da177e4SLinus Torvalds 2015bfbf3c09SMatthias Kaehlcke mutex_unlock(&fore200e->rate_mtx); 20161da177e4SLinus Torvalds 20171da177e4SLinus Torvalds memcpy(&vcc->qos, qos, sizeof(struct atm_qos)); 20181da177e4SLinus Torvalds 20191da177e4SLinus Torvalds /* update rate control parameters */ 20201da177e4SLinus Torvalds fore200e_rate_ctrl(qos, &fore200e_vcc->rate); 20211da177e4SLinus Torvalds 20221da177e4SLinus Torvalds set_bit(ATM_VF_HASQOS, &vcc->flags); 20231da177e4SLinus Torvalds 20241da177e4SLinus Torvalds return 0; 20251da177e4SLinus Torvalds } 20261da177e4SLinus Torvalds 20271da177e4SLinus Torvalds return -EINVAL; 20281da177e4SLinus Torvalds } 20291da177e4SLinus Torvalds 20301da177e4SLinus Torvalds 2031c027f5f9SSam Ravnborg static int __devinit 20321da177e4SLinus Torvalds fore200e_irq_request(struct fore200e* fore200e) 20331da177e4SLinus Torvalds { 2034dace1453SThomas Gleixner if (request_irq(fore200e->irq, fore200e_interrupt, IRQF_SHARED, fore200e->name, fore200e->atm_dev) < 0) { 20351da177e4SLinus Torvalds 20361da177e4SLinus Torvalds printk(FORE200E "unable to reserve IRQ %s for device %s\n", 20371da177e4SLinus Torvalds fore200e_irq_itoa(fore200e->irq), fore200e->name); 20381da177e4SLinus Torvalds return -EBUSY; 20391da177e4SLinus Torvalds } 20401da177e4SLinus Torvalds 20411da177e4SLinus Torvalds printk(FORE200E "IRQ %s reserved for device %s\n", 20421da177e4SLinus Torvalds fore200e_irq_itoa(fore200e->irq), fore200e->name); 20431da177e4SLinus Torvalds 20441da177e4SLinus Torvalds #ifdef FORE200E_USE_TASKLET 20451da177e4SLinus Torvalds tasklet_init(&fore200e->tx_tasklet, fore200e_tx_tasklet, (unsigned long)fore200e); 20461da177e4SLinus Torvalds tasklet_init(&fore200e->rx_tasklet, fore200e_rx_tasklet, (unsigned long)fore200e); 20471da177e4SLinus Torvalds #endif 20481da177e4SLinus Torvalds 20491da177e4SLinus Torvalds fore200e->state = FORE200E_STATE_IRQ; 20501da177e4SLinus Torvalds return 0; 20511da177e4SLinus Torvalds } 20521da177e4SLinus Torvalds 20531da177e4SLinus Torvalds 2054c027f5f9SSam Ravnborg static int __devinit 20551da177e4SLinus Torvalds fore200e_get_esi(struct fore200e* fore200e) 20561da177e4SLinus Torvalds { 20571f8a5fb8SAdrian Bunk struct prom_data* prom = kzalloc(sizeof(struct prom_data), GFP_KERNEL | GFP_DMA); 20581da177e4SLinus Torvalds int ok, i; 20591da177e4SLinus Torvalds 20601da177e4SLinus Torvalds if (!prom) 20611da177e4SLinus Torvalds return -ENOMEM; 20621da177e4SLinus Torvalds 20631da177e4SLinus Torvalds ok = fore200e->bus->prom_read(fore200e, prom); 20641da177e4SLinus Torvalds if (ok < 0) { 20651f8a5fb8SAdrian Bunk kfree(prom); 20661da177e4SLinus Torvalds return -EBUSY; 20671da177e4SLinus Torvalds } 20681da177e4SLinus Torvalds 20693008ab36Shartleys printk(FORE200E "device %s, rev. %c, S/N: %d, ESI: %pM\n", 20701da177e4SLinus Torvalds fore200e->name, 20711da177e4SLinus Torvalds (prom->hw_revision & 0xFF) + '@', /* probably meaningless with SBA boards */ 20723008ab36Shartleys prom->serial_number & 0xFFFF, &prom->mac_addr[2]); 20731da177e4SLinus Torvalds 20741da177e4SLinus Torvalds for (i = 0; i < ESI_LEN; i++) { 20751da177e4SLinus Torvalds fore200e->esi[ i ] = fore200e->atm_dev->esi[ i ] = prom->mac_addr[ i + 2 ]; 20761da177e4SLinus Torvalds } 20771da177e4SLinus Torvalds 20781f8a5fb8SAdrian Bunk kfree(prom); 20791da177e4SLinus Torvalds 20801da177e4SLinus Torvalds return 0; 20811da177e4SLinus Torvalds } 20821da177e4SLinus Torvalds 20831da177e4SLinus Torvalds 2084c027f5f9SSam Ravnborg static int __devinit 20851da177e4SLinus Torvalds fore200e_alloc_rx_buf(struct fore200e* fore200e) 20861da177e4SLinus Torvalds { 20871da177e4SLinus Torvalds int scheme, magn, nbr, size, i; 20881da177e4SLinus Torvalds 20891da177e4SLinus Torvalds struct host_bsq* bsq; 20901da177e4SLinus Torvalds struct buffer* buffer; 20911da177e4SLinus Torvalds 20921da177e4SLinus Torvalds for (scheme = 0; scheme < BUFFER_SCHEME_NBR; scheme++) { 20931da177e4SLinus Torvalds for (magn = 0; magn < BUFFER_MAGN_NBR; magn++) { 20941da177e4SLinus Torvalds 20951da177e4SLinus Torvalds bsq = &fore200e->host_bsq[ scheme ][ magn ]; 20961da177e4SLinus Torvalds 20971da177e4SLinus Torvalds nbr = fore200e_rx_buf_nbr[ scheme ][ magn ]; 20981da177e4SLinus Torvalds size = fore200e_rx_buf_size[ scheme ][ magn ]; 20991da177e4SLinus Torvalds 21001da177e4SLinus Torvalds DPRINTK(2, "rx buffers %d / %d are being allocated\n", scheme, magn); 21011da177e4SLinus Torvalds 21021da177e4SLinus Torvalds /* allocate the array of receive buffers */ 21031f8a5fb8SAdrian Bunk buffer = bsq->buffer = kzalloc(nbr * sizeof(struct buffer), GFP_KERNEL); 21041da177e4SLinus Torvalds 21051da177e4SLinus Torvalds if (buffer == NULL) 21061da177e4SLinus Torvalds return -ENOMEM; 21071da177e4SLinus Torvalds 21081da177e4SLinus Torvalds bsq->freebuf = NULL; 21091da177e4SLinus Torvalds 21101da177e4SLinus Torvalds for (i = 0; i < nbr; i++) { 21111da177e4SLinus Torvalds 21121da177e4SLinus Torvalds buffer[ i ].scheme = scheme; 21131da177e4SLinus Torvalds buffer[ i ].magn = magn; 21141da177e4SLinus Torvalds #ifdef FORE200E_BSQ_DEBUG 21151da177e4SLinus Torvalds buffer[ i ].index = i; 21161da177e4SLinus Torvalds buffer[ i ].supplied = 0; 21171da177e4SLinus Torvalds #endif 21181da177e4SLinus Torvalds 21191da177e4SLinus Torvalds /* allocate the receive buffer body */ 21201da177e4SLinus Torvalds if (fore200e_chunk_alloc(fore200e, 21211da177e4SLinus Torvalds &buffer[ i ].data, size, fore200e->bus->buffer_alignment, 21221da177e4SLinus Torvalds DMA_FROM_DEVICE) < 0) { 21231da177e4SLinus Torvalds 21241da177e4SLinus Torvalds while (i > 0) 21251da177e4SLinus Torvalds fore200e_chunk_free(fore200e, &buffer[ --i ].data); 21261f8a5fb8SAdrian Bunk kfree(buffer); 21271da177e4SLinus Torvalds 21281da177e4SLinus Torvalds return -ENOMEM; 21291da177e4SLinus Torvalds } 21301da177e4SLinus Torvalds 21311da177e4SLinus Torvalds /* insert the buffer into the free buffer list */ 21321da177e4SLinus Torvalds buffer[ i ].next = bsq->freebuf; 21331da177e4SLinus Torvalds bsq->freebuf = &buffer[ i ]; 21341da177e4SLinus Torvalds } 21351da177e4SLinus Torvalds /* all the buffers are free, initially */ 21361da177e4SLinus Torvalds bsq->freebuf_count = nbr; 21371da177e4SLinus Torvalds 21381da177e4SLinus Torvalds #ifdef FORE200E_BSQ_DEBUG 21391da177e4SLinus Torvalds bsq_audit(3, bsq, scheme, magn); 21401da177e4SLinus Torvalds #endif 21411da177e4SLinus Torvalds } 21421da177e4SLinus Torvalds } 21431da177e4SLinus Torvalds 21441da177e4SLinus Torvalds fore200e->state = FORE200E_STATE_ALLOC_BUF; 21451da177e4SLinus Torvalds return 0; 21461da177e4SLinus Torvalds } 21471da177e4SLinus Torvalds 21481da177e4SLinus Torvalds 2149c027f5f9SSam Ravnborg static int __devinit 21501da177e4SLinus Torvalds fore200e_init_bs_queue(struct fore200e* fore200e) 21511da177e4SLinus Torvalds { 21521da177e4SLinus Torvalds int scheme, magn, i; 21531da177e4SLinus Torvalds 21541da177e4SLinus Torvalds struct host_bsq* bsq; 21551da177e4SLinus Torvalds struct cp_bsq_entry __iomem * cp_entry; 21561da177e4SLinus Torvalds 21571da177e4SLinus Torvalds for (scheme = 0; scheme < BUFFER_SCHEME_NBR; scheme++) { 21581da177e4SLinus Torvalds for (magn = 0; magn < BUFFER_MAGN_NBR; magn++) { 21591da177e4SLinus Torvalds 21601da177e4SLinus Torvalds DPRINTK(2, "buffer supply queue %d / %d is being initialized\n", scheme, magn); 21611da177e4SLinus Torvalds 21621da177e4SLinus Torvalds bsq = &fore200e->host_bsq[ scheme ][ magn ]; 21631da177e4SLinus Torvalds 21641da177e4SLinus Torvalds /* allocate and align the array of status words */ 21651da177e4SLinus Torvalds if (fore200e->bus->dma_chunk_alloc(fore200e, 21661da177e4SLinus Torvalds &bsq->status, 21671da177e4SLinus Torvalds sizeof(enum status), 21681da177e4SLinus Torvalds QUEUE_SIZE_BS, 21691da177e4SLinus Torvalds fore200e->bus->status_alignment) < 0) { 21701da177e4SLinus Torvalds return -ENOMEM; 21711da177e4SLinus Torvalds } 21721da177e4SLinus Torvalds 21731da177e4SLinus Torvalds /* allocate and align the array of receive buffer descriptors */ 21741da177e4SLinus Torvalds if (fore200e->bus->dma_chunk_alloc(fore200e, 21751da177e4SLinus Torvalds &bsq->rbd_block, 21761da177e4SLinus Torvalds sizeof(struct rbd_block), 21771da177e4SLinus Torvalds QUEUE_SIZE_BS, 21781da177e4SLinus Torvalds fore200e->bus->descr_alignment) < 0) { 21791da177e4SLinus Torvalds 21801da177e4SLinus Torvalds fore200e->bus->dma_chunk_free(fore200e, &bsq->status); 21811da177e4SLinus Torvalds return -ENOMEM; 21821da177e4SLinus Torvalds } 21831da177e4SLinus Torvalds 21841da177e4SLinus Torvalds /* get the base address of the cp resident buffer supply queue entries */ 21851da177e4SLinus Torvalds cp_entry = fore200e->virt_base + 21861da177e4SLinus Torvalds fore200e->bus->read(&fore200e->cp_queues->cp_bsq[ scheme ][ magn ]); 21871da177e4SLinus Torvalds 21881da177e4SLinus Torvalds /* fill the host resident and cp resident buffer supply queue entries */ 21891da177e4SLinus Torvalds for (i = 0; i < QUEUE_SIZE_BS; i++) { 21901da177e4SLinus Torvalds 21911da177e4SLinus Torvalds bsq->host_entry[ i ].status = 21921da177e4SLinus Torvalds FORE200E_INDEX(bsq->status.align_addr, enum status, i); 21931da177e4SLinus Torvalds bsq->host_entry[ i ].rbd_block = 21941da177e4SLinus Torvalds FORE200E_INDEX(bsq->rbd_block.align_addr, struct rbd_block, i); 21951da177e4SLinus Torvalds bsq->host_entry[ i ].rbd_block_dma = 21961da177e4SLinus Torvalds FORE200E_DMA_INDEX(bsq->rbd_block.dma_addr, struct rbd_block, i); 21971da177e4SLinus Torvalds bsq->host_entry[ i ].cp_entry = &cp_entry[ i ]; 21981da177e4SLinus Torvalds 21991da177e4SLinus Torvalds *bsq->host_entry[ i ].status = STATUS_FREE; 22001da177e4SLinus Torvalds 22011da177e4SLinus Torvalds fore200e->bus->write(FORE200E_DMA_INDEX(bsq->status.dma_addr, enum status, i), 22021da177e4SLinus Torvalds &cp_entry[ i ].status_haddr); 22031da177e4SLinus Torvalds } 22041da177e4SLinus Torvalds } 22051da177e4SLinus Torvalds } 22061da177e4SLinus Torvalds 22071da177e4SLinus Torvalds fore200e->state = FORE200E_STATE_INIT_BSQ; 22081da177e4SLinus Torvalds return 0; 22091da177e4SLinus Torvalds } 22101da177e4SLinus Torvalds 22111da177e4SLinus Torvalds 2212c027f5f9SSam Ravnborg static int __devinit 22131da177e4SLinus Torvalds fore200e_init_rx_queue(struct fore200e* fore200e) 22141da177e4SLinus Torvalds { 22151da177e4SLinus Torvalds struct host_rxq* rxq = &fore200e->host_rxq; 22161da177e4SLinus Torvalds struct cp_rxq_entry __iomem * cp_entry; 22171da177e4SLinus Torvalds int i; 22181da177e4SLinus Torvalds 22191da177e4SLinus Torvalds DPRINTK(2, "receive queue is being initialized\n"); 22201da177e4SLinus Torvalds 22211da177e4SLinus Torvalds /* allocate and align the array of status words */ 22221da177e4SLinus Torvalds if (fore200e->bus->dma_chunk_alloc(fore200e, 22231da177e4SLinus Torvalds &rxq->status, 22241da177e4SLinus Torvalds sizeof(enum status), 22251da177e4SLinus Torvalds QUEUE_SIZE_RX, 22261da177e4SLinus Torvalds fore200e->bus->status_alignment) < 0) { 22271da177e4SLinus Torvalds return -ENOMEM; 22281da177e4SLinus Torvalds } 22291da177e4SLinus Torvalds 22301da177e4SLinus Torvalds /* allocate and align the array of receive PDU descriptors */ 22311da177e4SLinus Torvalds if (fore200e->bus->dma_chunk_alloc(fore200e, 22321da177e4SLinus Torvalds &rxq->rpd, 22331da177e4SLinus Torvalds sizeof(struct rpd), 22341da177e4SLinus Torvalds QUEUE_SIZE_RX, 22351da177e4SLinus Torvalds fore200e->bus->descr_alignment) < 0) { 22361da177e4SLinus Torvalds 22371da177e4SLinus Torvalds fore200e->bus->dma_chunk_free(fore200e, &rxq->status); 22381da177e4SLinus Torvalds return -ENOMEM; 22391da177e4SLinus Torvalds } 22401da177e4SLinus Torvalds 22411da177e4SLinus Torvalds /* get the base address of the cp resident rx queue entries */ 22421da177e4SLinus Torvalds cp_entry = fore200e->virt_base + fore200e->bus->read(&fore200e->cp_queues->cp_rxq); 22431da177e4SLinus Torvalds 22441da177e4SLinus Torvalds /* fill the host resident and cp resident rx entries */ 22451da177e4SLinus Torvalds for (i=0; i < QUEUE_SIZE_RX; i++) { 22461da177e4SLinus Torvalds 22471da177e4SLinus Torvalds rxq->host_entry[ i ].status = 22481da177e4SLinus Torvalds FORE200E_INDEX(rxq->status.align_addr, enum status, i); 22491da177e4SLinus Torvalds rxq->host_entry[ i ].rpd = 22501da177e4SLinus Torvalds FORE200E_INDEX(rxq->rpd.align_addr, struct rpd, i); 22511da177e4SLinus Torvalds rxq->host_entry[ i ].rpd_dma = 22521da177e4SLinus Torvalds FORE200E_DMA_INDEX(rxq->rpd.dma_addr, struct rpd, i); 22531da177e4SLinus Torvalds rxq->host_entry[ i ].cp_entry = &cp_entry[ i ]; 22541da177e4SLinus Torvalds 22551da177e4SLinus Torvalds *rxq->host_entry[ i ].status = STATUS_FREE; 22561da177e4SLinus Torvalds 22571da177e4SLinus Torvalds fore200e->bus->write(FORE200E_DMA_INDEX(rxq->status.dma_addr, enum status, i), 22581da177e4SLinus Torvalds &cp_entry[ i ].status_haddr); 22591da177e4SLinus Torvalds 22601da177e4SLinus Torvalds fore200e->bus->write(FORE200E_DMA_INDEX(rxq->rpd.dma_addr, struct rpd, i), 22611da177e4SLinus Torvalds &cp_entry[ i ].rpd_haddr); 22621da177e4SLinus Torvalds } 22631da177e4SLinus Torvalds 22641da177e4SLinus Torvalds /* set the head entry of the queue */ 22651da177e4SLinus Torvalds rxq->head = 0; 22661da177e4SLinus Torvalds 22671da177e4SLinus Torvalds fore200e->state = FORE200E_STATE_INIT_RXQ; 22681da177e4SLinus Torvalds return 0; 22691da177e4SLinus Torvalds } 22701da177e4SLinus Torvalds 22711da177e4SLinus Torvalds 2272c027f5f9SSam Ravnborg static int __devinit 22731da177e4SLinus Torvalds fore200e_init_tx_queue(struct fore200e* fore200e) 22741da177e4SLinus Torvalds { 22751da177e4SLinus Torvalds struct host_txq* txq = &fore200e->host_txq; 22761da177e4SLinus Torvalds struct cp_txq_entry __iomem * cp_entry; 22771da177e4SLinus Torvalds int i; 22781da177e4SLinus Torvalds 22791da177e4SLinus Torvalds DPRINTK(2, "transmit queue is being initialized\n"); 22801da177e4SLinus Torvalds 22811da177e4SLinus Torvalds /* allocate and align the array of status words */ 22821da177e4SLinus Torvalds if (fore200e->bus->dma_chunk_alloc(fore200e, 22831da177e4SLinus Torvalds &txq->status, 22841da177e4SLinus Torvalds sizeof(enum status), 22851da177e4SLinus Torvalds QUEUE_SIZE_TX, 22861da177e4SLinus Torvalds fore200e->bus->status_alignment) < 0) { 22871da177e4SLinus Torvalds return -ENOMEM; 22881da177e4SLinus Torvalds } 22891da177e4SLinus Torvalds 22901da177e4SLinus Torvalds /* allocate and align the array of transmit PDU descriptors */ 22911da177e4SLinus Torvalds if (fore200e->bus->dma_chunk_alloc(fore200e, 22921da177e4SLinus Torvalds &txq->tpd, 22931da177e4SLinus Torvalds sizeof(struct tpd), 22941da177e4SLinus Torvalds QUEUE_SIZE_TX, 22951da177e4SLinus Torvalds fore200e->bus->descr_alignment) < 0) { 22961da177e4SLinus Torvalds 22971da177e4SLinus Torvalds fore200e->bus->dma_chunk_free(fore200e, &txq->status); 22981da177e4SLinus Torvalds return -ENOMEM; 22991da177e4SLinus Torvalds } 23001da177e4SLinus Torvalds 23011da177e4SLinus Torvalds /* get the base address of the cp resident tx queue entries */ 23021da177e4SLinus Torvalds cp_entry = fore200e->virt_base + fore200e->bus->read(&fore200e->cp_queues->cp_txq); 23031da177e4SLinus Torvalds 23041da177e4SLinus Torvalds /* fill the host resident and cp resident tx entries */ 23051da177e4SLinus Torvalds for (i=0; i < QUEUE_SIZE_TX; i++) { 23061da177e4SLinus Torvalds 23071da177e4SLinus Torvalds txq->host_entry[ i ].status = 23081da177e4SLinus Torvalds FORE200E_INDEX(txq->status.align_addr, enum status, i); 23091da177e4SLinus Torvalds txq->host_entry[ i ].tpd = 23101da177e4SLinus Torvalds FORE200E_INDEX(txq->tpd.align_addr, struct tpd, i); 23111da177e4SLinus Torvalds txq->host_entry[ i ].tpd_dma = 23121da177e4SLinus Torvalds FORE200E_DMA_INDEX(txq->tpd.dma_addr, struct tpd, i); 23131da177e4SLinus Torvalds txq->host_entry[ i ].cp_entry = &cp_entry[ i ]; 23141da177e4SLinus Torvalds 23151da177e4SLinus Torvalds *txq->host_entry[ i ].status = STATUS_FREE; 23161da177e4SLinus Torvalds 23171da177e4SLinus Torvalds fore200e->bus->write(FORE200E_DMA_INDEX(txq->status.dma_addr, enum status, i), 23181da177e4SLinus Torvalds &cp_entry[ i ].status_haddr); 23191da177e4SLinus Torvalds 23201da177e4SLinus Torvalds /* although there is a one-to-one mapping of tx queue entries and tpds, 23211da177e4SLinus Torvalds we do not write here the DMA (physical) base address of each tpd into 23221da177e4SLinus Torvalds the related cp resident entry, because the cp relies on this write 23231da177e4SLinus Torvalds operation to detect that a new pdu has been submitted for tx */ 23241da177e4SLinus Torvalds } 23251da177e4SLinus Torvalds 23261da177e4SLinus Torvalds /* set the head and tail entries of the queue */ 23271da177e4SLinus Torvalds txq->head = 0; 23281da177e4SLinus Torvalds txq->tail = 0; 23291da177e4SLinus Torvalds 23301da177e4SLinus Torvalds fore200e->state = FORE200E_STATE_INIT_TXQ; 23311da177e4SLinus Torvalds return 0; 23321da177e4SLinus Torvalds } 23331da177e4SLinus Torvalds 23341da177e4SLinus Torvalds 2335c027f5f9SSam Ravnborg static int __devinit 23361da177e4SLinus Torvalds fore200e_init_cmd_queue(struct fore200e* fore200e) 23371da177e4SLinus Torvalds { 23381da177e4SLinus Torvalds struct host_cmdq* cmdq = &fore200e->host_cmdq; 23391da177e4SLinus Torvalds struct cp_cmdq_entry __iomem * cp_entry; 23401da177e4SLinus Torvalds int i; 23411da177e4SLinus Torvalds 23421da177e4SLinus Torvalds DPRINTK(2, "command queue is being initialized\n"); 23431da177e4SLinus Torvalds 23441da177e4SLinus Torvalds /* allocate and align the array of status words */ 23451da177e4SLinus Torvalds if (fore200e->bus->dma_chunk_alloc(fore200e, 23461da177e4SLinus Torvalds &cmdq->status, 23471da177e4SLinus Torvalds sizeof(enum status), 23481da177e4SLinus Torvalds QUEUE_SIZE_CMD, 23491da177e4SLinus Torvalds fore200e->bus->status_alignment) < 0) { 23501da177e4SLinus Torvalds return -ENOMEM; 23511da177e4SLinus Torvalds } 23521da177e4SLinus Torvalds 23531da177e4SLinus Torvalds /* get the base address of the cp resident cmd queue entries */ 23541da177e4SLinus Torvalds cp_entry = fore200e->virt_base + fore200e->bus->read(&fore200e->cp_queues->cp_cmdq); 23551da177e4SLinus Torvalds 23561da177e4SLinus Torvalds /* fill the host resident and cp resident cmd entries */ 23571da177e4SLinus Torvalds for (i=0; i < QUEUE_SIZE_CMD; i++) { 23581da177e4SLinus Torvalds 23591da177e4SLinus Torvalds cmdq->host_entry[ i ].status = 23601da177e4SLinus Torvalds FORE200E_INDEX(cmdq->status.align_addr, enum status, i); 23611da177e4SLinus Torvalds cmdq->host_entry[ i ].cp_entry = &cp_entry[ i ]; 23621da177e4SLinus Torvalds 23631da177e4SLinus Torvalds *cmdq->host_entry[ i ].status = STATUS_FREE; 23641da177e4SLinus Torvalds 23651da177e4SLinus Torvalds fore200e->bus->write(FORE200E_DMA_INDEX(cmdq->status.dma_addr, enum status, i), 23661da177e4SLinus Torvalds &cp_entry[ i ].status_haddr); 23671da177e4SLinus Torvalds } 23681da177e4SLinus Torvalds 23691da177e4SLinus Torvalds /* set the head entry of the queue */ 23701da177e4SLinus Torvalds cmdq->head = 0; 23711da177e4SLinus Torvalds 23721da177e4SLinus Torvalds fore200e->state = FORE200E_STATE_INIT_CMDQ; 23731da177e4SLinus Torvalds return 0; 23741da177e4SLinus Torvalds } 23751da177e4SLinus Torvalds 23761da177e4SLinus Torvalds 23778aee929eSAdrian Bunk static void __devinit 23781da177e4SLinus Torvalds fore200e_param_bs_queue(struct fore200e* fore200e, 23791da177e4SLinus Torvalds enum buffer_scheme scheme, enum buffer_magn magn, 23801da177e4SLinus Torvalds int queue_length, int pool_size, int supply_blksize) 23811da177e4SLinus Torvalds { 23821da177e4SLinus Torvalds struct bs_spec __iomem * bs_spec = &fore200e->cp_queues->init.bs_spec[ scheme ][ magn ]; 23831da177e4SLinus Torvalds 23841da177e4SLinus Torvalds fore200e->bus->write(queue_length, &bs_spec->queue_length); 23851da177e4SLinus Torvalds fore200e->bus->write(fore200e_rx_buf_size[ scheme ][ magn ], &bs_spec->buffer_size); 23861da177e4SLinus Torvalds fore200e->bus->write(pool_size, &bs_spec->pool_size); 23871da177e4SLinus Torvalds fore200e->bus->write(supply_blksize, &bs_spec->supply_blksize); 23881da177e4SLinus Torvalds } 23891da177e4SLinus Torvalds 23901da177e4SLinus Torvalds 2391c027f5f9SSam Ravnborg static int __devinit 23921da177e4SLinus Torvalds fore200e_initialize(struct fore200e* fore200e) 23931da177e4SLinus Torvalds { 23941da177e4SLinus Torvalds struct cp_queues __iomem * cpq; 23951da177e4SLinus Torvalds int ok, scheme, magn; 23961da177e4SLinus Torvalds 23971da177e4SLinus Torvalds DPRINTK(2, "device %s being initialized\n", fore200e->name); 23981da177e4SLinus Torvalds 2399bfbf3c09SMatthias Kaehlcke mutex_init(&fore200e->rate_mtx); 24001da177e4SLinus Torvalds spin_lock_init(&fore200e->q_lock); 24011da177e4SLinus Torvalds 24021da177e4SLinus Torvalds cpq = fore200e->cp_queues = fore200e->virt_base + FORE200E_CP_QUEUES_OFFSET; 24031da177e4SLinus Torvalds 24041da177e4SLinus Torvalds /* enable cp to host interrupts */ 24051da177e4SLinus Torvalds fore200e->bus->write(1, &cpq->imask); 24061da177e4SLinus Torvalds 24071da177e4SLinus Torvalds if (fore200e->bus->irq_enable) 24081da177e4SLinus Torvalds fore200e->bus->irq_enable(fore200e); 24091da177e4SLinus Torvalds 24101da177e4SLinus Torvalds fore200e->bus->write(NBR_CONNECT, &cpq->init.num_connect); 24111da177e4SLinus Torvalds 24121da177e4SLinus Torvalds fore200e->bus->write(QUEUE_SIZE_CMD, &cpq->init.cmd_queue_len); 24131da177e4SLinus Torvalds fore200e->bus->write(QUEUE_SIZE_RX, &cpq->init.rx_queue_len); 24141da177e4SLinus Torvalds fore200e->bus->write(QUEUE_SIZE_TX, &cpq->init.tx_queue_len); 24151da177e4SLinus Torvalds 24161da177e4SLinus Torvalds fore200e->bus->write(RSD_EXTENSION, &cpq->init.rsd_extension); 24171da177e4SLinus Torvalds fore200e->bus->write(TSD_EXTENSION, &cpq->init.tsd_extension); 24181da177e4SLinus Torvalds 24191da177e4SLinus Torvalds for (scheme = 0; scheme < BUFFER_SCHEME_NBR; scheme++) 24201da177e4SLinus Torvalds for (magn = 0; magn < BUFFER_MAGN_NBR; magn++) 24211da177e4SLinus Torvalds fore200e_param_bs_queue(fore200e, scheme, magn, 24221da177e4SLinus Torvalds QUEUE_SIZE_BS, 24231da177e4SLinus Torvalds fore200e_rx_buf_nbr[ scheme ][ magn ], 24241da177e4SLinus Torvalds RBD_BLK_SIZE); 24251da177e4SLinus Torvalds 24261da177e4SLinus Torvalds /* issue the initialize command */ 24271da177e4SLinus Torvalds fore200e->bus->write(STATUS_PENDING, &cpq->init.status); 24281da177e4SLinus Torvalds fore200e->bus->write(OPCODE_INITIALIZE, &cpq->init.opcode); 24291da177e4SLinus Torvalds 24301da177e4SLinus Torvalds ok = fore200e_io_poll(fore200e, &cpq->init.status, STATUS_COMPLETE, 3000); 24311da177e4SLinus Torvalds if (ok == 0) { 24321da177e4SLinus Torvalds printk(FORE200E "device %s initialization failed\n", fore200e->name); 24331da177e4SLinus Torvalds return -ENODEV; 24341da177e4SLinus Torvalds } 24351da177e4SLinus Torvalds 24361da177e4SLinus Torvalds printk(FORE200E "device %s initialized\n", fore200e->name); 24371da177e4SLinus Torvalds 24381da177e4SLinus Torvalds fore200e->state = FORE200E_STATE_INITIALIZE; 24391da177e4SLinus Torvalds return 0; 24401da177e4SLinus Torvalds } 24411da177e4SLinus Torvalds 24421da177e4SLinus Torvalds 2443c027f5f9SSam Ravnborg static void __devinit 24441da177e4SLinus Torvalds fore200e_monitor_putc(struct fore200e* fore200e, char c) 24451da177e4SLinus Torvalds { 24461da177e4SLinus Torvalds struct cp_monitor __iomem * monitor = fore200e->cp_monitor; 24471da177e4SLinus Torvalds 24481da177e4SLinus Torvalds #if 0 24491da177e4SLinus Torvalds printk("%c", c); 24501da177e4SLinus Torvalds #endif 24511da177e4SLinus Torvalds fore200e->bus->write(((u32) c) | FORE200E_CP_MONITOR_UART_AVAIL, &monitor->soft_uart.send); 24521da177e4SLinus Torvalds } 24531da177e4SLinus Torvalds 24541da177e4SLinus Torvalds 2455c027f5f9SSam Ravnborg static int __devinit 24561da177e4SLinus Torvalds fore200e_monitor_getc(struct fore200e* fore200e) 24571da177e4SLinus Torvalds { 24581da177e4SLinus Torvalds struct cp_monitor __iomem * monitor = fore200e->cp_monitor; 24591da177e4SLinus Torvalds unsigned long timeout = jiffies + msecs_to_jiffies(50); 24601da177e4SLinus Torvalds int c; 24611da177e4SLinus Torvalds 24621da177e4SLinus Torvalds while (time_before(jiffies, timeout)) { 24631da177e4SLinus Torvalds 24641da177e4SLinus Torvalds c = (int) fore200e->bus->read(&monitor->soft_uart.recv); 24651da177e4SLinus Torvalds 24661da177e4SLinus Torvalds if (c & FORE200E_CP_MONITOR_UART_AVAIL) { 24671da177e4SLinus Torvalds 24681da177e4SLinus Torvalds fore200e->bus->write(FORE200E_CP_MONITOR_UART_FREE, &monitor->soft_uart.recv); 24691da177e4SLinus Torvalds #if 0 24701da177e4SLinus Torvalds printk("%c", c & 0xFF); 24711da177e4SLinus Torvalds #endif 24721da177e4SLinus Torvalds return c & 0xFF; 24731da177e4SLinus Torvalds } 24741da177e4SLinus Torvalds } 24751da177e4SLinus Torvalds 24761da177e4SLinus Torvalds return -1; 24771da177e4SLinus Torvalds } 24781da177e4SLinus Torvalds 24791da177e4SLinus Torvalds 2480c027f5f9SSam Ravnborg static void __devinit 24811da177e4SLinus Torvalds fore200e_monitor_puts(struct fore200e* fore200e, char* str) 24821da177e4SLinus Torvalds { 24831da177e4SLinus Torvalds while (*str) { 24841da177e4SLinus Torvalds 24851da177e4SLinus Torvalds /* the i960 monitor doesn't accept any new character if it has something to say */ 24861da177e4SLinus Torvalds while (fore200e_monitor_getc(fore200e) >= 0); 24871da177e4SLinus Torvalds 24881da177e4SLinus Torvalds fore200e_monitor_putc(fore200e, *str++); 24891da177e4SLinus Torvalds } 24901da177e4SLinus Torvalds 24911da177e4SLinus Torvalds while (fore200e_monitor_getc(fore200e) >= 0); 24921da177e4SLinus Torvalds } 24931da177e4SLinus Torvalds 2494e92481f9SChas Williams #ifdef __LITTLE_ENDIAN 2495e92481f9SChas Williams #define FW_EXT ".bin" 2496e92481f9SChas Williams #else 2497e92481f9SChas Williams #define FW_EXT "_ecd.bin2" 2498e92481f9SChas Williams #endif 24991da177e4SLinus Torvalds 2500c027f5f9SSam Ravnborg static int __devinit 2501e92481f9SChas Williams fore200e_load_and_start_fw(struct fore200e* fore200e) 25021da177e4SLinus Torvalds { 2503e92481f9SChas Williams const struct firmware *firmware; 2504e92481f9SChas Williams struct device *device; 2505e92481f9SChas Williams struct fw_header *fw_header; 25066f75a9b6SChas Williams const __le32 *fw_data; 25076f75a9b6SChas Williams u32 fw_size; 2508e92481f9SChas Williams u32 __iomem *load_addr; 2509e92481f9SChas Williams char buf[48]; 2510e92481f9SChas Williams int err = -ENODEV; 2511e92481f9SChas Williams 2512e92481f9SChas Williams if (strcmp(fore200e->bus->model_name, "PCA-200E") == 0) 2513e92481f9SChas Williams device = &((struct pci_dev *) fore200e->bus_dev)->dev; 2514e92481f9SChas Williams #ifdef CONFIG_SBUS 2515e92481f9SChas Williams else if (strcmp(fore200e->bus->model_name, "SBA-200E") == 0) 2516826b6cfcSDavid S. Miller device = &((struct of_device *) fore200e->bus_dev)->dev; 2517e92481f9SChas Williams #endif 2518e92481f9SChas Williams else 2519e92481f9SChas Williams return err; 2520e92481f9SChas Williams 2521e92481f9SChas Williams sprintf(buf, "%s%s", fore200e->bus->proc_name, FW_EXT); 2522fcffd0d8SMeelis Roos if ((err = request_firmware(&firmware, buf, device)) < 0) { 2523fcffd0d8SMeelis Roos printk(FORE200E "problem loading firmware image %s\n", fore200e->bus->model_name); 2524e92481f9SChas Williams return err; 2525e92481f9SChas Williams } 2526e92481f9SChas Williams 25276f75a9b6SChas Williams fw_data = (__le32 *) firmware->data; 2528e92481f9SChas Williams fw_size = firmware->size / sizeof(u32); 2529e92481f9SChas Williams fw_header = (struct fw_header *) firmware->data; 2530e92481f9SChas Williams load_addr = fore200e->virt_base + le32_to_cpu(fw_header->load_offset); 2531e92481f9SChas Williams 2532e92481f9SChas Williams DPRINTK(2, "device %s firmware being loaded at 0x%p (%d words)\n", 2533e92481f9SChas Williams fore200e->name, load_addr, fw_size); 2534e92481f9SChas Williams 2535e92481f9SChas Williams if (le32_to_cpu(fw_header->magic) != FW_HEADER_MAGIC) { 2536e92481f9SChas Williams printk(FORE200E "corrupted %s firmware image\n", fore200e->bus->model_name); 2537e92481f9SChas Williams goto release; 2538e92481f9SChas Williams } 2539e92481f9SChas Williams 2540e92481f9SChas Williams for (; fw_size--; fw_data++, load_addr++) 2541e92481f9SChas Williams fore200e->bus->write(le32_to_cpu(*fw_data), load_addr); 25421da177e4SLinus Torvalds 25431da177e4SLinus Torvalds DPRINTK(2, "device %s firmware being started\n", fore200e->name); 25441da177e4SLinus Torvalds 25451da177e4SLinus Torvalds #if defined(__sparc_v9__) 25461da177e4SLinus Torvalds /* reported to be required by SBA cards on some sparc64 hosts */ 25471da177e4SLinus Torvalds fore200e_spin(100); 25481da177e4SLinus Torvalds #endif 25491da177e4SLinus Torvalds 2550e92481f9SChas Williams sprintf(buf, "\rgo %x\r", le32_to_cpu(fw_header->start_offset)); 2551e92481f9SChas Williams fore200e_monitor_puts(fore200e, buf); 25521da177e4SLinus Torvalds 2553e92481f9SChas Williams if (fore200e_io_poll(fore200e, &fore200e->cp_monitor->bstat, BSTAT_CP_RUNNING, 1000) == 0) { 25541da177e4SLinus Torvalds printk(FORE200E "device %s firmware didn't start\n", fore200e->name); 2555e92481f9SChas Williams goto release; 25561da177e4SLinus Torvalds } 25571da177e4SLinus Torvalds 25581da177e4SLinus Torvalds printk(FORE200E "device %s firmware started\n", fore200e->name); 25591da177e4SLinus Torvalds 25601da177e4SLinus Torvalds fore200e->state = FORE200E_STATE_START_FW; 2561e92481f9SChas Williams err = 0; 25621da177e4SLinus Torvalds 2563e92481f9SChas Williams release: 2564e92481f9SChas Williams release_firmware(firmware); 2565e92481f9SChas Williams return err; 25661da177e4SLinus Torvalds } 25671da177e4SLinus Torvalds 25681da177e4SLinus Torvalds 2569c027f5f9SSam Ravnborg static int __devinit 25701da177e4SLinus Torvalds fore200e_register(struct fore200e* fore200e) 25711da177e4SLinus Torvalds { 25721da177e4SLinus Torvalds struct atm_dev* atm_dev; 25731da177e4SLinus Torvalds 25741da177e4SLinus Torvalds DPRINTK(2, "device %s being registered\n", fore200e->name); 25751da177e4SLinus Torvalds 25761da177e4SLinus Torvalds atm_dev = atm_dev_register(fore200e->bus->proc_name, &fore200e_ops, -1, 25771da177e4SLinus Torvalds NULL); 25781da177e4SLinus Torvalds if (atm_dev == NULL) { 25791da177e4SLinus Torvalds printk(FORE200E "unable to register device %s\n", fore200e->name); 25801da177e4SLinus Torvalds return -ENODEV; 25811da177e4SLinus Torvalds } 25821da177e4SLinus Torvalds 25831da177e4SLinus Torvalds atm_dev->dev_data = fore200e; 25841da177e4SLinus Torvalds fore200e->atm_dev = atm_dev; 25851da177e4SLinus Torvalds 25861da177e4SLinus Torvalds atm_dev->ci_range.vpi_bits = FORE200E_VPI_BITS; 25871da177e4SLinus Torvalds atm_dev->ci_range.vci_bits = FORE200E_VCI_BITS; 25881da177e4SLinus Torvalds 25891da177e4SLinus Torvalds fore200e->available_cell_rate = ATM_OC3_PCR; 25901da177e4SLinus Torvalds 25911da177e4SLinus Torvalds fore200e->state = FORE200E_STATE_REGISTER; 25921da177e4SLinus Torvalds return 0; 25931da177e4SLinus Torvalds } 25941da177e4SLinus Torvalds 25951da177e4SLinus Torvalds 2596c027f5f9SSam Ravnborg static int __devinit 25971da177e4SLinus Torvalds fore200e_init(struct fore200e* fore200e) 25981da177e4SLinus Torvalds { 25991da177e4SLinus Torvalds if (fore200e_register(fore200e) < 0) 26001da177e4SLinus Torvalds return -ENODEV; 26011da177e4SLinus Torvalds 26021da177e4SLinus Torvalds if (fore200e->bus->configure(fore200e) < 0) 26031da177e4SLinus Torvalds return -ENODEV; 26041da177e4SLinus Torvalds 26051da177e4SLinus Torvalds if (fore200e->bus->map(fore200e) < 0) 26061da177e4SLinus Torvalds return -ENODEV; 26071da177e4SLinus Torvalds 26081da177e4SLinus Torvalds if (fore200e_reset(fore200e, 1) < 0) 26091da177e4SLinus Torvalds return -ENODEV; 26101da177e4SLinus Torvalds 2611e92481f9SChas Williams if (fore200e_load_and_start_fw(fore200e) < 0) 26121da177e4SLinus Torvalds return -ENODEV; 26131da177e4SLinus Torvalds 26141da177e4SLinus Torvalds if (fore200e_initialize(fore200e) < 0) 26151da177e4SLinus Torvalds return -ENODEV; 26161da177e4SLinus Torvalds 26171da177e4SLinus Torvalds if (fore200e_init_cmd_queue(fore200e) < 0) 26181da177e4SLinus Torvalds return -ENOMEM; 26191da177e4SLinus Torvalds 26201da177e4SLinus Torvalds if (fore200e_init_tx_queue(fore200e) < 0) 26211da177e4SLinus Torvalds return -ENOMEM; 26221da177e4SLinus Torvalds 26231da177e4SLinus Torvalds if (fore200e_init_rx_queue(fore200e) < 0) 26241da177e4SLinus Torvalds return -ENOMEM; 26251da177e4SLinus Torvalds 26261da177e4SLinus Torvalds if (fore200e_init_bs_queue(fore200e) < 0) 26271da177e4SLinus Torvalds return -ENOMEM; 26281da177e4SLinus Torvalds 26291da177e4SLinus Torvalds if (fore200e_alloc_rx_buf(fore200e) < 0) 26301da177e4SLinus Torvalds return -ENOMEM; 26311da177e4SLinus Torvalds 26321da177e4SLinus Torvalds if (fore200e_get_esi(fore200e) < 0) 26331da177e4SLinus Torvalds return -EIO; 26341da177e4SLinus Torvalds 26351da177e4SLinus Torvalds if (fore200e_irq_request(fore200e) < 0) 26361da177e4SLinus Torvalds return -EBUSY; 26371da177e4SLinus Torvalds 26381da177e4SLinus Torvalds fore200e_supply(fore200e); 26391da177e4SLinus Torvalds 26401da177e4SLinus Torvalds /* all done, board initialization is now complete */ 26411da177e4SLinus Torvalds fore200e->state = FORE200E_STATE_COMPLETE; 26421da177e4SLinus Torvalds return 0; 26431da177e4SLinus Torvalds } 26441da177e4SLinus Torvalds 2645826b6cfcSDavid S. Miller #ifdef CONFIG_SBUS 2646826b6cfcSDavid S. Miller static int __devinit fore200e_sba_probe(struct of_device *op, 2647826b6cfcSDavid S. Miller const struct of_device_id *match) 2648826b6cfcSDavid S. Miller { 2649826b6cfcSDavid S. Miller const struct fore200e_bus *bus = match->data; 2650826b6cfcSDavid S. Miller struct fore200e *fore200e; 2651826b6cfcSDavid S. Miller static int index = 0; 2652826b6cfcSDavid S. Miller int err; 2653826b6cfcSDavid S. Miller 2654826b6cfcSDavid S. Miller fore200e = kzalloc(sizeof(struct fore200e), GFP_KERNEL); 2655826b6cfcSDavid S. Miller if (!fore200e) 2656826b6cfcSDavid S. Miller return -ENOMEM; 2657826b6cfcSDavid S. Miller 2658826b6cfcSDavid S. Miller fore200e->bus = bus; 2659826b6cfcSDavid S. Miller fore200e->bus_dev = op; 2660826b6cfcSDavid S. Miller fore200e->irq = op->irqs[0]; 2661826b6cfcSDavid S. Miller fore200e->phys_base = op->resource[0].start; 2662826b6cfcSDavid S. Miller 2663826b6cfcSDavid S. Miller sprintf(fore200e->name, "%s-%d", bus->model_name, index); 2664826b6cfcSDavid S. Miller 2665826b6cfcSDavid S. Miller err = fore200e_init(fore200e); 2666826b6cfcSDavid S. Miller if (err < 0) { 2667826b6cfcSDavid S. Miller fore200e_shutdown(fore200e); 2668826b6cfcSDavid S. Miller kfree(fore200e); 2669826b6cfcSDavid S. Miller return err; 2670826b6cfcSDavid S. Miller } 2671826b6cfcSDavid S. Miller 2672826b6cfcSDavid S. Miller index++; 2673826b6cfcSDavid S. Miller dev_set_drvdata(&op->dev, fore200e); 2674826b6cfcSDavid S. Miller 2675826b6cfcSDavid S. Miller return 0; 2676826b6cfcSDavid S. Miller } 2677826b6cfcSDavid S. Miller 2678826b6cfcSDavid S. Miller static int __devexit fore200e_sba_remove(struct of_device *op) 2679826b6cfcSDavid S. Miller { 2680826b6cfcSDavid S. Miller struct fore200e *fore200e = dev_get_drvdata(&op->dev); 2681826b6cfcSDavid S. Miller 2682826b6cfcSDavid S. Miller fore200e_shutdown(fore200e); 2683826b6cfcSDavid S. Miller kfree(fore200e); 2684826b6cfcSDavid S. Miller 2685826b6cfcSDavid S. Miller return 0; 2686826b6cfcSDavid S. Miller } 2687826b6cfcSDavid S. Miller 2688fd098316SDavid S. Miller static const struct of_device_id fore200e_sba_match[] = { 2689826b6cfcSDavid S. Miller { 2690826b6cfcSDavid S. Miller .name = SBA200E_PROM_NAME, 2691826b6cfcSDavid S. Miller .data = (void *) &fore200e_bus[1], 2692826b6cfcSDavid S. Miller }, 2693826b6cfcSDavid S. Miller {}, 2694826b6cfcSDavid S. Miller }; 2695826b6cfcSDavid S. Miller MODULE_DEVICE_TABLE(of, fore200e_sba_match); 2696826b6cfcSDavid S. Miller 2697826b6cfcSDavid S. Miller static struct of_platform_driver fore200e_sba_driver = { 26984018294bSGrant Likely .driver = { 2699826b6cfcSDavid S. Miller .name = "fore_200e", 27004018294bSGrant Likely .owner = THIS_MODULE, 27014018294bSGrant Likely .of_match_table = fore200e_sba_match, 27024018294bSGrant Likely }, 2703826b6cfcSDavid S. Miller .probe = fore200e_sba_probe, 2704826b6cfcSDavid S. Miller .remove = __devexit_p(fore200e_sba_remove), 2705826b6cfcSDavid S. Miller }; 2706826b6cfcSDavid S. Miller #endif 2707826b6cfcSDavid S. Miller 2708e92481f9SChas Williams #ifdef CONFIG_PCI 27091da177e4SLinus Torvalds static int __devinit 27101da177e4SLinus Torvalds fore200e_pca_detect(struct pci_dev *pci_dev, const struct pci_device_id *pci_ent) 27111da177e4SLinus Torvalds { 27121da177e4SLinus Torvalds const struct fore200e_bus* bus = (struct fore200e_bus*) pci_ent->driver_data; 27131da177e4SLinus Torvalds struct fore200e* fore200e; 27141da177e4SLinus Torvalds int err = 0; 27151da177e4SLinus Torvalds static int index = 0; 27161da177e4SLinus Torvalds 27171da177e4SLinus Torvalds if (pci_enable_device(pci_dev)) { 27181da177e4SLinus Torvalds err = -EINVAL; 27191da177e4SLinus Torvalds goto out; 27201da177e4SLinus Torvalds } 27211da177e4SLinus Torvalds 27221f8a5fb8SAdrian Bunk fore200e = kzalloc(sizeof(struct fore200e), GFP_KERNEL); 27231da177e4SLinus Torvalds if (fore200e == NULL) { 27241da177e4SLinus Torvalds err = -ENOMEM; 27251da177e4SLinus Torvalds goto out_disable; 27261da177e4SLinus Torvalds } 27271da177e4SLinus Torvalds 27281da177e4SLinus Torvalds fore200e->bus = bus; 27291da177e4SLinus Torvalds fore200e->bus_dev = pci_dev; 27301da177e4SLinus Torvalds fore200e->irq = pci_dev->irq; 27311da177e4SLinus Torvalds fore200e->phys_base = pci_resource_start(pci_dev, 0); 27321da177e4SLinus Torvalds 27331da177e4SLinus Torvalds sprintf(fore200e->name, "%s-%d", bus->model_name, index - 1); 27341da177e4SLinus Torvalds 27351da177e4SLinus Torvalds pci_set_master(pci_dev); 27361da177e4SLinus Torvalds 27371da177e4SLinus Torvalds printk(FORE200E "device %s found at 0x%lx, IRQ %s\n", 27381da177e4SLinus Torvalds fore200e->bus->model_name, 27391da177e4SLinus Torvalds fore200e->phys_base, fore200e_irq_itoa(fore200e->irq)); 27401da177e4SLinus Torvalds 27411da177e4SLinus Torvalds sprintf(fore200e->name, "%s-%d", bus->model_name, index); 27421da177e4SLinus Torvalds 27431da177e4SLinus Torvalds err = fore200e_init(fore200e); 27441da177e4SLinus Torvalds if (err < 0) { 27451da177e4SLinus Torvalds fore200e_shutdown(fore200e); 27461da177e4SLinus Torvalds goto out_free; 27471da177e4SLinus Torvalds } 27481da177e4SLinus Torvalds 27491da177e4SLinus Torvalds ++index; 27501da177e4SLinus Torvalds pci_set_drvdata(pci_dev, fore200e); 27511da177e4SLinus Torvalds 27521da177e4SLinus Torvalds out: 27531da177e4SLinus Torvalds return err; 27541da177e4SLinus Torvalds 27551da177e4SLinus Torvalds out_free: 27561da177e4SLinus Torvalds kfree(fore200e); 27571da177e4SLinus Torvalds out_disable: 27581da177e4SLinus Torvalds pci_disable_device(pci_dev); 27591da177e4SLinus Torvalds goto out; 27601da177e4SLinus Torvalds } 27611da177e4SLinus Torvalds 27621da177e4SLinus Torvalds 27631da177e4SLinus Torvalds static void __devexit fore200e_pca_remove_one(struct pci_dev *pci_dev) 27641da177e4SLinus Torvalds { 27651da177e4SLinus Torvalds struct fore200e *fore200e; 27661da177e4SLinus Torvalds 27671da177e4SLinus Torvalds fore200e = pci_get_drvdata(pci_dev); 27681da177e4SLinus Torvalds 27691da177e4SLinus Torvalds fore200e_shutdown(fore200e); 27701da177e4SLinus Torvalds kfree(fore200e); 27711da177e4SLinus Torvalds pci_disable_device(pci_dev); 27721da177e4SLinus Torvalds } 27731da177e4SLinus Torvalds 27741da177e4SLinus Torvalds 27751da177e4SLinus Torvalds static struct pci_device_id fore200e_pca_tbl[] = { 27761da177e4SLinus Torvalds { PCI_VENDOR_ID_FORE, PCI_DEVICE_ID_FORE_PCA200E, PCI_ANY_ID, PCI_ANY_ID, 27771da177e4SLinus Torvalds 0, 0, (unsigned long) &fore200e_bus[0] }, 27781da177e4SLinus Torvalds { 0, } 27791da177e4SLinus Torvalds }; 27801da177e4SLinus Torvalds 27811da177e4SLinus Torvalds MODULE_DEVICE_TABLE(pci, fore200e_pca_tbl); 27821da177e4SLinus Torvalds 27831da177e4SLinus Torvalds static struct pci_driver fore200e_pca_driver = { 27841da177e4SLinus Torvalds .name = "fore_200e", 27851da177e4SLinus Torvalds .probe = fore200e_pca_detect, 27861da177e4SLinus Torvalds .remove = __devexit_p(fore200e_pca_remove_one), 27871da177e4SLinus Torvalds .id_table = fore200e_pca_tbl, 27881da177e4SLinus Torvalds }; 27891da177e4SLinus Torvalds #endif 27901da177e4SLinus Torvalds 2791826b6cfcSDavid S. Miller static int __init fore200e_module_init(void) 27921da177e4SLinus Torvalds { 2793826b6cfcSDavid S. Miller int err; 27941da177e4SLinus Torvalds 27951da177e4SLinus Torvalds printk(FORE200E "FORE Systems 200E-series ATM driver - version " FORE200E_VERSION "\n"); 27961da177e4SLinus Torvalds 2797826b6cfcSDavid S. Miller #ifdef CONFIG_SBUS 2798826b6cfcSDavid S. Miller err = of_register_driver(&fore200e_sba_driver, &of_bus_type); 2799826b6cfcSDavid S. Miller if (err) 2800826b6cfcSDavid S. Miller return err; 28011da177e4SLinus Torvalds #endif 28021da177e4SLinus Torvalds 2803826b6cfcSDavid S. Miller #ifdef CONFIG_PCI 2804826b6cfcSDavid S. Miller err = pci_register_driver(&fore200e_pca_driver); 2805826b6cfcSDavid S. Miller #endif 28061da177e4SLinus Torvalds 2807826b6cfcSDavid S. Miller #ifdef CONFIG_SBUS 2808826b6cfcSDavid S. Miller if (err) 2809826b6cfcSDavid S. Miller of_unregister_driver(&fore200e_sba_driver); 2810826b6cfcSDavid S. Miller #endif 2811826b6cfcSDavid S. Miller 2812826b6cfcSDavid S. Miller return err; 28131da177e4SLinus Torvalds } 28141da177e4SLinus Torvalds 2815826b6cfcSDavid S. Miller static void __exit fore200e_module_cleanup(void) 28161da177e4SLinus Torvalds { 2817e92481f9SChas Williams #ifdef CONFIG_PCI 28181da177e4SLinus Torvalds pci_unregister_driver(&fore200e_pca_driver); 28191da177e4SLinus Torvalds #endif 2820826b6cfcSDavid S. Miller #ifdef CONFIG_SBUS 2821826b6cfcSDavid S. Miller of_unregister_driver(&fore200e_sba_driver); 2822826b6cfcSDavid S. Miller #endif 28231da177e4SLinus Torvalds } 28241da177e4SLinus Torvalds 28251da177e4SLinus Torvalds static int 28261da177e4SLinus Torvalds fore200e_proc_read(struct atm_dev *dev, loff_t* pos, char* page) 28271da177e4SLinus Torvalds { 28281da177e4SLinus Torvalds struct fore200e* fore200e = FORE200E_DEV(dev); 28291da177e4SLinus Torvalds struct fore200e_vcc* fore200e_vcc; 28301da177e4SLinus Torvalds struct atm_vcc* vcc; 28311da177e4SLinus Torvalds int i, len, left = *pos; 28321da177e4SLinus Torvalds unsigned long flags; 28331da177e4SLinus Torvalds 28341da177e4SLinus Torvalds if (!left--) { 28351da177e4SLinus Torvalds 28361da177e4SLinus Torvalds if (fore200e_getstats(fore200e) < 0) 28371da177e4SLinus Torvalds return -EIO; 28381da177e4SLinus Torvalds 28391da177e4SLinus Torvalds len = sprintf(page,"\n" 28401da177e4SLinus Torvalds " device:\n" 28411da177e4SLinus Torvalds " internal name:\t\t%s\n", fore200e->name); 28421da177e4SLinus Torvalds 28431da177e4SLinus Torvalds /* print bus-specific information */ 28441da177e4SLinus Torvalds if (fore200e->bus->proc_read) 28451da177e4SLinus Torvalds len += fore200e->bus->proc_read(fore200e, page + len); 28461da177e4SLinus Torvalds 28471da177e4SLinus Torvalds len += sprintf(page + len, 28481da177e4SLinus Torvalds " interrupt line:\t\t%s\n" 28491da177e4SLinus Torvalds " physical base address:\t0x%p\n" 28501da177e4SLinus Torvalds " virtual base address:\t0x%p\n" 28513008ab36Shartleys " factory address (ESI):\t%pM\n" 28521da177e4SLinus Torvalds " board serial number:\t\t%d\n\n", 28531da177e4SLinus Torvalds fore200e_irq_itoa(fore200e->irq), 28541da177e4SLinus Torvalds (void*)fore200e->phys_base, 28551da177e4SLinus Torvalds fore200e->virt_base, 28563008ab36Shartleys fore200e->esi, 28571da177e4SLinus Torvalds fore200e->esi[4] * 256 + fore200e->esi[5]); 28581da177e4SLinus Torvalds 28591da177e4SLinus Torvalds return len; 28601da177e4SLinus Torvalds } 28611da177e4SLinus Torvalds 28621da177e4SLinus Torvalds if (!left--) 28631da177e4SLinus Torvalds return sprintf(page, 28641da177e4SLinus Torvalds " free small bufs, scheme 1:\t%d\n" 28651da177e4SLinus Torvalds " free large bufs, scheme 1:\t%d\n" 28661da177e4SLinus Torvalds " free small bufs, scheme 2:\t%d\n" 28671da177e4SLinus Torvalds " free large bufs, scheme 2:\t%d\n", 28681da177e4SLinus Torvalds fore200e->host_bsq[ BUFFER_SCHEME_ONE ][ BUFFER_MAGN_SMALL ].freebuf_count, 28691da177e4SLinus Torvalds fore200e->host_bsq[ BUFFER_SCHEME_ONE ][ BUFFER_MAGN_LARGE ].freebuf_count, 28701da177e4SLinus Torvalds fore200e->host_bsq[ BUFFER_SCHEME_TWO ][ BUFFER_MAGN_SMALL ].freebuf_count, 28711da177e4SLinus Torvalds fore200e->host_bsq[ BUFFER_SCHEME_TWO ][ BUFFER_MAGN_LARGE ].freebuf_count); 28721da177e4SLinus Torvalds 28731da177e4SLinus Torvalds if (!left--) { 28741da177e4SLinus Torvalds u32 hb = fore200e->bus->read(&fore200e->cp_queues->heartbeat); 28751da177e4SLinus Torvalds 28761da177e4SLinus Torvalds len = sprintf(page,"\n\n" 28771da177e4SLinus Torvalds " cell processor:\n" 28781da177e4SLinus Torvalds " heartbeat state:\t\t"); 28791da177e4SLinus Torvalds 28801da177e4SLinus Torvalds if (hb >> 16 != 0xDEAD) 28811da177e4SLinus Torvalds len += sprintf(page + len, "0x%08x\n", hb); 28821da177e4SLinus Torvalds else 28831da177e4SLinus Torvalds len += sprintf(page + len, "*** FATAL ERROR %04x ***\n", hb & 0xFFFF); 28841da177e4SLinus Torvalds 28851da177e4SLinus Torvalds return len; 28861da177e4SLinus Torvalds } 28871da177e4SLinus Torvalds 28881da177e4SLinus Torvalds if (!left--) { 28891da177e4SLinus Torvalds static const char* media_name[] = { 28901da177e4SLinus Torvalds "unshielded twisted pair", 28911da177e4SLinus Torvalds "multimode optical fiber ST", 28921da177e4SLinus Torvalds "multimode optical fiber SC", 28931da177e4SLinus Torvalds "single-mode optical fiber ST", 28941da177e4SLinus Torvalds "single-mode optical fiber SC", 28951da177e4SLinus Torvalds "unknown" 28961da177e4SLinus Torvalds }; 28971da177e4SLinus Torvalds 28981da177e4SLinus Torvalds static const char* oc3_mode[] = { 28991da177e4SLinus Torvalds "normal operation", 29001da177e4SLinus Torvalds "diagnostic loopback", 29011da177e4SLinus Torvalds "line loopback", 29021da177e4SLinus Torvalds "unknown" 29031da177e4SLinus Torvalds }; 29041da177e4SLinus Torvalds 29051da177e4SLinus Torvalds u32 fw_release = fore200e->bus->read(&fore200e->cp_queues->fw_release); 29061da177e4SLinus Torvalds u32 mon960_release = fore200e->bus->read(&fore200e->cp_queues->mon960_release); 29071da177e4SLinus Torvalds u32 oc3_revision = fore200e->bus->read(&fore200e->cp_queues->oc3_revision); 29081da177e4SLinus Torvalds u32 media_index = FORE200E_MEDIA_INDEX(fore200e->bus->read(&fore200e->cp_queues->media_type)); 29091da177e4SLinus Torvalds u32 oc3_index; 29101da177e4SLinus Torvalds 2911e0c5567dSroel kluin if (media_index > 4) 29121da177e4SLinus Torvalds media_index = 5; 29131da177e4SLinus Torvalds 29141da177e4SLinus Torvalds switch (fore200e->loop_mode) { 29151da177e4SLinus Torvalds case ATM_LM_NONE: oc3_index = 0; 29161da177e4SLinus Torvalds break; 29171da177e4SLinus Torvalds case ATM_LM_LOC_PHY: oc3_index = 1; 29181da177e4SLinus Torvalds break; 29191da177e4SLinus Torvalds case ATM_LM_RMT_PHY: oc3_index = 2; 29201da177e4SLinus Torvalds break; 29211da177e4SLinus Torvalds default: oc3_index = 3; 29221da177e4SLinus Torvalds } 29231da177e4SLinus Torvalds 29241da177e4SLinus Torvalds return sprintf(page, 29251da177e4SLinus Torvalds " firmware release:\t\t%d.%d.%d\n" 29261da177e4SLinus Torvalds " monitor release:\t\t%d.%d\n" 29271da177e4SLinus Torvalds " media type:\t\t\t%s\n" 29281da177e4SLinus Torvalds " OC-3 revision:\t\t0x%x\n" 29291da177e4SLinus Torvalds " OC-3 mode:\t\t\t%s", 29301da177e4SLinus Torvalds fw_release >> 16, fw_release << 16 >> 24, fw_release << 24 >> 24, 29311da177e4SLinus Torvalds mon960_release >> 16, mon960_release << 16 >> 16, 29321da177e4SLinus Torvalds media_name[ media_index ], 29331da177e4SLinus Torvalds oc3_revision, 29341da177e4SLinus Torvalds oc3_mode[ oc3_index ]); 29351da177e4SLinus Torvalds } 29361da177e4SLinus Torvalds 29371da177e4SLinus Torvalds if (!left--) { 29381da177e4SLinus Torvalds struct cp_monitor __iomem * cp_monitor = fore200e->cp_monitor; 29391da177e4SLinus Torvalds 29401da177e4SLinus Torvalds return sprintf(page, 29411da177e4SLinus Torvalds "\n\n" 29421da177e4SLinus Torvalds " monitor:\n" 29431da177e4SLinus Torvalds " version number:\t\t%d\n" 29441da177e4SLinus Torvalds " boot status word:\t\t0x%08x\n", 29451da177e4SLinus Torvalds fore200e->bus->read(&cp_monitor->mon_version), 29461da177e4SLinus Torvalds fore200e->bus->read(&cp_monitor->bstat)); 29471da177e4SLinus Torvalds } 29481da177e4SLinus Torvalds 29491da177e4SLinus Torvalds if (!left--) 29501da177e4SLinus Torvalds return sprintf(page, 29511da177e4SLinus Torvalds "\n" 29521da177e4SLinus Torvalds " device statistics:\n" 29531da177e4SLinus Torvalds " 4b5b:\n" 29541da177e4SLinus Torvalds " crc_header_errors:\t\t%10u\n" 29551da177e4SLinus Torvalds " framing_errors:\t\t%10u\n", 295663734a32SAl Viro be32_to_cpu(fore200e->stats->phy.crc_header_errors), 295763734a32SAl Viro be32_to_cpu(fore200e->stats->phy.framing_errors)); 29581da177e4SLinus Torvalds 29591da177e4SLinus Torvalds if (!left--) 29601da177e4SLinus Torvalds return sprintf(page, "\n" 29611da177e4SLinus Torvalds " OC-3:\n" 29621da177e4SLinus Torvalds " section_bip8_errors:\t%10u\n" 29631da177e4SLinus Torvalds " path_bip8_errors:\t\t%10u\n" 29641da177e4SLinus Torvalds " line_bip24_errors:\t\t%10u\n" 29651da177e4SLinus Torvalds " line_febe_errors:\t\t%10u\n" 29661da177e4SLinus Torvalds " path_febe_errors:\t\t%10u\n" 29671da177e4SLinus Torvalds " corr_hcs_errors:\t\t%10u\n" 29681da177e4SLinus Torvalds " ucorr_hcs_errors:\t\t%10u\n", 296963734a32SAl Viro be32_to_cpu(fore200e->stats->oc3.section_bip8_errors), 297063734a32SAl Viro be32_to_cpu(fore200e->stats->oc3.path_bip8_errors), 297163734a32SAl Viro be32_to_cpu(fore200e->stats->oc3.line_bip24_errors), 297263734a32SAl Viro be32_to_cpu(fore200e->stats->oc3.line_febe_errors), 297363734a32SAl Viro be32_to_cpu(fore200e->stats->oc3.path_febe_errors), 297463734a32SAl Viro be32_to_cpu(fore200e->stats->oc3.corr_hcs_errors), 297563734a32SAl Viro be32_to_cpu(fore200e->stats->oc3.ucorr_hcs_errors)); 29761da177e4SLinus Torvalds 29771da177e4SLinus Torvalds if (!left--) 29781da177e4SLinus Torvalds return sprintf(page,"\n" 29791da177e4SLinus Torvalds " ATM:\t\t\t\t cells\n" 29801da177e4SLinus Torvalds " TX:\t\t\t%10u\n" 29811da177e4SLinus Torvalds " RX:\t\t\t%10u\n" 29821da177e4SLinus Torvalds " vpi out of range:\t\t%10u\n" 29831da177e4SLinus Torvalds " vpi no conn:\t\t%10u\n" 29841da177e4SLinus Torvalds " vci out of range:\t\t%10u\n" 29851da177e4SLinus Torvalds " vci no conn:\t\t%10u\n", 298663734a32SAl Viro be32_to_cpu(fore200e->stats->atm.cells_transmitted), 298763734a32SAl Viro be32_to_cpu(fore200e->stats->atm.cells_received), 298863734a32SAl Viro be32_to_cpu(fore200e->stats->atm.vpi_bad_range), 298963734a32SAl Viro be32_to_cpu(fore200e->stats->atm.vpi_no_conn), 299063734a32SAl Viro be32_to_cpu(fore200e->stats->atm.vci_bad_range), 299163734a32SAl Viro be32_to_cpu(fore200e->stats->atm.vci_no_conn)); 29921da177e4SLinus Torvalds 29931da177e4SLinus Torvalds if (!left--) 29941da177e4SLinus Torvalds return sprintf(page,"\n" 29951da177e4SLinus Torvalds " AAL0:\t\t\t cells\n" 29961da177e4SLinus Torvalds " TX:\t\t\t%10u\n" 29971da177e4SLinus Torvalds " RX:\t\t\t%10u\n" 29981da177e4SLinus Torvalds " dropped:\t\t\t%10u\n", 299963734a32SAl Viro be32_to_cpu(fore200e->stats->aal0.cells_transmitted), 300063734a32SAl Viro be32_to_cpu(fore200e->stats->aal0.cells_received), 300163734a32SAl Viro be32_to_cpu(fore200e->stats->aal0.cells_dropped)); 30021da177e4SLinus Torvalds 30031da177e4SLinus Torvalds if (!left--) 30041da177e4SLinus Torvalds return sprintf(page,"\n" 30051da177e4SLinus Torvalds " AAL3/4:\n" 30061da177e4SLinus Torvalds " SAR sublayer:\t\t cells\n" 30071da177e4SLinus Torvalds " TX:\t\t\t%10u\n" 30081da177e4SLinus Torvalds " RX:\t\t\t%10u\n" 30091da177e4SLinus Torvalds " dropped:\t\t\t%10u\n" 30101da177e4SLinus Torvalds " CRC errors:\t\t%10u\n" 30111da177e4SLinus Torvalds " protocol errors:\t\t%10u\n\n" 30121da177e4SLinus Torvalds " CS sublayer:\t\t PDUs\n" 30131da177e4SLinus Torvalds " TX:\t\t\t%10u\n" 30141da177e4SLinus Torvalds " RX:\t\t\t%10u\n" 30151da177e4SLinus Torvalds " dropped:\t\t\t%10u\n" 30161da177e4SLinus Torvalds " protocol errors:\t\t%10u\n", 301763734a32SAl Viro be32_to_cpu(fore200e->stats->aal34.cells_transmitted), 301863734a32SAl Viro be32_to_cpu(fore200e->stats->aal34.cells_received), 301963734a32SAl Viro be32_to_cpu(fore200e->stats->aal34.cells_dropped), 302063734a32SAl Viro be32_to_cpu(fore200e->stats->aal34.cells_crc_errors), 302163734a32SAl Viro be32_to_cpu(fore200e->stats->aal34.cells_protocol_errors), 302263734a32SAl Viro be32_to_cpu(fore200e->stats->aal34.cspdus_transmitted), 302363734a32SAl Viro be32_to_cpu(fore200e->stats->aal34.cspdus_received), 302463734a32SAl Viro be32_to_cpu(fore200e->stats->aal34.cspdus_dropped), 302563734a32SAl Viro be32_to_cpu(fore200e->stats->aal34.cspdus_protocol_errors)); 30261da177e4SLinus Torvalds 30271da177e4SLinus Torvalds if (!left--) 30281da177e4SLinus Torvalds return sprintf(page,"\n" 30291da177e4SLinus Torvalds " AAL5:\n" 30301da177e4SLinus Torvalds " SAR sublayer:\t\t cells\n" 30311da177e4SLinus Torvalds " TX:\t\t\t%10u\n" 30321da177e4SLinus Torvalds " RX:\t\t\t%10u\n" 30331da177e4SLinus Torvalds " dropped:\t\t\t%10u\n" 30341da177e4SLinus Torvalds " congestions:\t\t%10u\n\n" 30351da177e4SLinus Torvalds " CS sublayer:\t\t PDUs\n" 30361da177e4SLinus Torvalds " TX:\t\t\t%10u\n" 30371da177e4SLinus Torvalds " RX:\t\t\t%10u\n" 30381da177e4SLinus Torvalds " dropped:\t\t\t%10u\n" 30391da177e4SLinus Torvalds " CRC errors:\t\t%10u\n" 30401da177e4SLinus Torvalds " protocol errors:\t\t%10u\n", 304163734a32SAl Viro be32_to_cpu(fore200e->stats->aal5.cells_transmitted), 304263734a32SAl Viro be32_to_cpu(fore200e->stats->aal5.cells_received), 304363734a32SAl Viro be32_to_cpu(fore200e->stats->aal5.cells_dropped), 304463734a32SAl Viro be32_to_cpu(fore200e->stats->aal5.congestion_experienced), 304563734a32SAl Viro be32_to_cpu(fore200e->stats->aal5.cspdus_transmitted), 304663734a32SAl Viro be32_to_cpu(fore200e->stats->aal5.cspdus_received), 304763734a32SAl Viro be32_to_cpu(fore200e->stats->aal5.cspdus_dropped), 304863734a32SAl Viro be32_to_cpu(fore200e->stats->aal5.cspdus_crc_errors), 304963734a32SAl Viro be32_to_cpu(fore200e->stats->aal5.cspdus_protocol_errors)); 30501da177e4SLinus Torvalds 30511da177e4SLinus Torvalds if (!left--) 30521da177e4SLinus Torvalds return sprintf(page,"\n" 30531da177e4SLinus Torvalds " AUX:\t\t allocation failures\n" 30541da177e4SLinus Torvalds " small b1:\t\t\t%10u\n" 30551da177e4SLinus Torvalds " large b1:\t\t\t%10u\n" 30561da177e4SLinus Torvalds " small b2:\t\t\t%10u\n" 30571da177e4SLinus Torvalds " large b2:\t\t\t%10u\n" 30581da177e4SLinus Torvalds " RX PDUs:\t\t\t%10u\n" 30591da177e4SLinus Torvalds " TX PDUs:\t\t\t%10lu\n", 306063734a32SAl Viro be32_to_cpu(fore200e->stats->aux.small_b1_failed), 306163734a32SAl Viro be32_to_cpu(fore200e->stats->aux.large_b1_failed), 306263734a32SAl Viro be32_to_cpu(fore200e->stats->aux.small_b2_failed), 306363734a32SAl Viro be32_to_cpu(fore200e->stats->aux.large_b2_failed), 306463734a32SAl Viro be32_to_cpu(fore200e->stats->aux.rpd_alloc_failed), 30651da177e4SLinus Torvalds fore200e->tx_sat); 30661da177e4SLinus Torvalds 30671da177e4SLinus Torvalds if (!left--) 30681da177e4SLinus Torvalds return sprintf(page,"\n" 30691da177e4SLinus Torvalds " receive carrier:\t\t\t%s\n", 30701da177e4SLinus Torvalds fore200e->stats->aux.receive_carrier ? "ON" : "OFF!"); 30711da177e4SLinus Torvalds 30721da177e4SLinus Torvalds if (!left--) { 30731da177e4SLinus Torvalds return sprintf(page,"\n" 30741da177e4SLinus Torvalds " VCCs:\n address VPI VCI AAL " 30751da177e4SLinus Torvalds "TX PDUs TX min/max size RX PDUs RX min/max size\n"); 30761da177e4SLinus Torvalds } 30771da177e4SLinus Torvalds 30781da177e4SLinus Torvalds for (i = 0; i < NBR_CONNECT; i++) { 30791da177e4SLinus Torvalds 30801da177e4SLinus Torvalds vcc = fore200e->vc_map[i].vcc; 30811da177e4SLinus Torvalds 30821da177e4SLinus Torvalds if (vcc == NULL) 30831da177e4SLinus Torvalds continue; 30841da177e4SLinus Torvalds 30851da177e4SLinus Torvalds spin_lock_irqsave(&fore200e->q_lock, flags); 30861da177e4SLinus Torvalds 30871da177e4SLinus Torvalds if (vcc && test_bit(ATM_VF_READY, &vcc->flags) && !left--) { 30881da177e4SLinus Torvalds 30891da177e4SLinus Torvalds fore200e_vcc = FORE200E_VCC(vcc); 30901da177e4SLinus Torvalds ASSERT(fore200e_vcc); 30911da177e4SLinus Torvalds 30921da177e4SLinus Torvalds len = sprintf(page, 30931da177e4SLinus Torvalds " %08x %03d %05d %1d %09lu %05d/%05d %09lu %05d/%05d\n", 30941da177e4SLinus Torvalds (u32)(unsigned long)vcc, 30951da177e4SLinus Torvalds vcc->vpi, vcc->vci, fore200e_atm2fore_aal(vcc->qos.aal), 30961da177e4SLinus Torvalds fore200e_vcc->tx_pdu, 30971da177e4SLinus Torvalds fore200e_vcc->tx_min_pdu > 0xFFFF ? 0 : fore200e_vcc->tx_min_pdu, 30981da177e4SLinus Torvalds fore200e_vcc->tx_max_pdu, 30991da177e4SLinus Torvalds fore200e_vcc->rx_pdu, 31001da177e4SLinus Torvalds fore200e_vcc->rx_min_pdu > 0xFFFF ? 0 : fore200e_vcc->rx_min_pdu, 31011da177e4SLinus Torvalds fore200e_vcc->rx_max_pdu); 31021da177e4SLinus Torvalds 31031da177e4SLinus Torvalds spin_unlock_irqrestore(&fore200e->q_lock, flags); 31041da177e4SLinus Torvalds return len; 31051da177e4SLinus Torvalds } 31061da177e4SLinus Torvalds 31071da177e4SLinus Torvalds spin_unlock_irqrestore(&fore200e->q_lock, flags); 31081da177e4SLinus Torvalds } 31091da177e4SLinus Torvalds 31101da177e4SLinus Torvalds return 0; 31111da177e4SLinus Torvalds } 31121da177e4SLinus Torvalds 31131da177e4SLinus Torvalds module_init(fore200e_module_init); 31141da177e4SLinus Torvalds module_exit(fore200e_module_cleanup); 31151da177e4SLinus Torvalds 31161da177e4SLinus Torvalds 31171da177e4SLinus Torvalds static const struct atmdev_ops fore200e_ops = 31181da177e4SLinus Torvalds { 31191da177e4SLinus Torvalds .open = fore200e_open, 31201da177e4SLinus Torvalds .close = fore200e_close, 31211da177e4SLinus Torvalds .ioctl = fore200e_ioctl, 31221da177e4SLinus Torvalds .getsockopt = fore200e_getsockopt, 31231da177e4SLinus Torvalds .setsockopt = fore200e_setsockopt, 31241da177e4SLinus Torvalds .send = fore200e_send, 31251da177e4SLinus Torvalds .change_qos = fore200e_change_qos, 31261da177e4SLinus Torvalds .proc_read = fore200e_proc_read, 31271da177e4SLinus Torvalds .owner = THIS_MODULE 31281da177e4SLinus Torvalds }; 31291da177e4SLinus Torvalds 31301da177e4SLinus Torvalds 31311da177e4SLinus Torvalds static const struct fore200e_bus fore200e_bus[] = { 3132e92481f9SChas Williams #ifdef CONFIG_PCI 31331da177e4SLinus Torvalds { "PCA-200E", "pca200e", 32, 4, 32, 31341da177e4SLinus Torvalds fore200e_pca_read, 31351da177e4SLinus Torvalds fore200e_pca_write, 31361da177e4SLinus Torvalds fore200e_pca_dma_map, 31371da177e4SLinus Torvalds fore200e_pca_dma_unmap, 31381da177e4SLinus Torvalds fore200e_pca_dma_sync_for_cpu, 31391da177e4SLinus Torvalds fore200e_pca_dma_sync_for_device, 31401da177e4SLinus Torvalds fore200e_pca_dma_chunk_alloc, 31411da177e4SLinus Torvalds fore200e_pca_dma_chunk_free, 31421da177e4SLinus Torvalds fore200e_pca_configure, 31431da177e4SLinus Torvalds fore200e_pca_map, 31441da177e4SLinus Torvalds fore200e_pca_reset, 31451da177e4SLinus Torvalds fore200e_pca_prom_read, 31461da177e4SLinus Torvalds fore200e_pca_unmap, 31471da177e4SLinus Torvalds NULL, 31481da177e4SLinus Torvalds fore200e_pca_irq_check, 31491da177e4SLinus Torvalds fore200e_pca_irq_ack, 31501da177e4SLinus Torvalds fore200e_pca_proc_read, 31511da177e4SLinus Torvalds }, 31521da177e4SLinus Torvalds #endif 3153e92481f9SChas Williams #ifdef CONFIG_SBUS 31541da177e4SLinus Torvalds { "SBA-200E", "sba200e", 32, 64, 32, 31551da177e4SLinus Torvalds fore200e_sba_read, 31561da177e4SLinus Torvalds fore200e_sba_write, 31571da177e4SLinus Torvalds fore200e_sba_dma_map, 31581da177e4SLinus Torvalds fore200e_sba_dma_unmap, 31591da177e4SLinus Torvalds fore200e_sba_dma_sync_for_cpu, 31601da177e4SLinus Torvalds fore200e_sba_dma_sync_for_device, 31611da177e4SLinus Torvalds fore200e_sba_dma_chunk_alloc, 31621da177e4SLinus Torvalds fore200e_sba_dma_chunk_free, 31631da177e4SLinus Torvalds fore200e_sba_configure, 31641da177e4SLinus Torvalds fore200e_sba_map, 31651da177e4SLinus Torvalds fore200e_sba_reset, 31661da177e4SLinus Torvalds fore200e_sba_prom_read, 31671da177e4SLinus Torvalds fore200e_sba_unmap, 31681da177e4SLinus Torvalds fore200e_sba_irq_enable, 31691da177e4SLinus Torvalds fore200e_sba_irq_check, 31701da177e4SLinus Torvalds fore200e_sba_irq_ack, 31711da177e4SLinus Torvalds fore200e_sba_proc_read, 31721da177e4SLinus Torvalds }, 31731da177e4SLinus Torvalds #endif 31741da177e4SLinus Torvalds {} 31751da177e4SLinus Torvalds }; 31761da177e4SLinus Torvalds 31771da177e4SLinus Torvalds MODULE_LICENSE("GPL"); 31786f75a9b6SChas Williams #ifdef CONFIG_PCI 31796f75a9b6SChas Williams #ifdef __LITTLE_ENDIAN__ 31806f75a9b6SChas Williams MODULE_FIRMWARE("pca200e.bin"); 31816f75a9b6SChas Williams #else 31826f75a9b6SChas Williams MODULE_FIRMWARE("pca200e_ecd.bin2"); 31836f75a9b6SChas Williams #endif 31846f75a9b6SChas Williams #endif /* CONFIG_PCI */ 31856f75a9b6SChas Williams #ifdef CONFIG_SBUS 31866f75a9b6SChas Williams MODULE_FIRMWARE("sba200e_ecd.bin2"); 31871da177e4SLinus Torvalds #endif 3188