162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci A FORE Systems 200E-series driver for ATM on Linux. 462306a36Sopenharmony_ci Christophe Lizzi (lizzi@cnam.fr), October 1999-March 2003. 562306a36Sopenharmony_ci 662306a36Sopenharmony_ci Based on the PCA-200E driver from Uwe Dannowski (Uwe.Dannowski@inf.tu-dresden.de). 762306a36Sopenharmony_ci 862306a36Sopenharmony_ci This driver simultaneously supports PCA-200E and SBA-200E adapters 962306a36Sopenharmony_ci on i386, alpha (untested), powerpc, sparc and sparc64 architectures. 1062306a36Sopenharmony_ci 1162306a36Sopenharmony_ci*/ 1262306a36Sopenharmony_ci 1362306a36Sopenharmony_ci 1462306a36Sopenharmony_ci#include <linux/kernel.h> 1562306a36Sopenharmony_ci#include <linux/slab.h> 1662306a36Sopenharmony_ci#include <linux/init.h> 1762306a36Sopenharmony_ci#include <linux/capability.h> 1862306a36Sopenharmony_ci#include <linux/interrupt.h> 1962306a36Sopenharmony_ci#include <linux/bitops.h> 2062306a36Sopenharmony_ci#include <linux/pci.h> 2162306a36Sopenharmony_ci#include <linux/module.h> 2262306a36Sopenharmony_ci#include <linux/atmdev.h> 2362306a36Sopenharmony_ci#include <linux/sonet.h> 2462306a36Sopenharmony_ci#include <linux/dma-mapping.h> 2562306a36Sopenharmony_ci#include <linux/delay.h> 2662306a36Sopenharmony_ci#include <linux/firmware.h> 2762306a36Sopenharmony_ci#include <linux/pgtable.h> 2862306a36Sopenharmony_ci#include <asm/io.h> 2962306a36Sopenharmony_ci#include <asm/string.h> 3062306a36Sopenharmony_ci#include <asm/page.h> 3162306a36Sopenharmony_ci#include <asm/irq.h> 3262306a36Sopenharmony_ci#include <asm/dma.h> 3362306a36Sopenharmony_ci#include <asm/byteorder.h> 3462306a36Sopenharmony_ci#include <linux/uaccess.h> 3562306a36Sopenharmony_ci#include <linux/atomic.h> 3662306a36Sopenharmony_ci 3762306a36Sopenharmony_ci#ifdef CONFIG_SBUS 3862306a36Sopenharmony_ci#include <linux/of.h> 3962306a36Sopenharmony_ci#include <linux/of_device.h> 4062306a36Sopenharmony_ci#include <asm/idprom.h> 4162306a36Sopenharmony_ci#include <asm/openprom.h> 4262306a36Sopenharmony_ci#include <asm/oplib.h> 4362306a36Sopenharmony_ci#endif 4462306a36Sopenharmony_ci 4562306a36Sopenharmony_ci#if defined(CONFIG_ATM_FORE200E_USE_TASKLET) /* defer interrupt work to a tasklet */ 4662306a36Sopenharmony_ci#define FORE200E_USE_TASKLET 4762306a36Sopenharmony_ci#endif 4862306a36Sopenharmony_ci 4962306a36Sopenharmony_ci#if 0 /* enable the debugging code of the buffer supply queues */ 5062306a36Sopenharmony_ci#define FORE200E_BSQ_DEBUG 5162306a36Sopenharmony_ci#endif 5262306a36Sopenharmony_ci 5362306a36Sopenharmony_ci#if 1 /* ensure correct handling of 52-byte AAL0 SDUs expected by atmdump-like apps */ 5462306a36Sopenharmony_ci#define FORE200E_52BYTE_AAL0_SDU 5562306a36Sopenharmony_ci#endif 5662306a36Sopenharmony_ci 5762306a36Sopenharmony_ci#include "fore200e.h" 5862306a36Sopenharmony_ci#include "suni.h" 5962306a36Sopenharmony_ci 6062306a36Sopenharmony_ci#define FORE200E_VERSION "0.3e" 6162306a36Sopenharmony_ci 6262306a36Sopenharmony_ci#define FORE200E "fore200e: " 6362306a36Sopenharmony_ci 6462306a36Sopenharmony_ci#if 0 /* override .config */ 6562306a36Sopenharmony_ci#define CONFIG_ATM_FORE200E_DEBUG 1 6662306a36Sopenharmony_ci#endif 6762306a36Sopenharmony_ci#if defined(CONFIG_ATM_FORE200E_DEBUG) && (CONFIG_ATM_FORE200E_DEBUG > 0) 6862306a36Sopenharmony_ci#define DPRINTK(level, format, args...) do { if (CONFIG_ATM_FORE200E_DEBUG >= (level)) \ 6962306a36Sopenharmony_ci printk(FORE200E format, ##args); } while (0) 7062306a36Sopenharmony_ci#else 7162306a36Sopenharmony_ci#define DPRINTK(level, format, args...) do {} while (0) 7262306a36Sopenharmony_ci#endif 7362306a36Sopenharmony_ci 7462306a36Sopenharmony_ci 7562306a36Sopenharmony_ci#define FORE200E_ALIGN(addr, alignment) \ 7662306a36Sopenharmony_ci ((((unsigned long)(addr) + (alignment - 1)) & ~(alignment - 1)) - (unsigned long)(addr)) 7762306a36Sopenharmony_ci 7862306a36Sopenharmony_ci#define FORE200E_DMA_INDEX(dma_addr, type, index) ((dma_addr) + (index) * sizeof(type)) 7962306a36Sopenharmony_ci 8062306a36Sopenharmony_ci#define FORE200E_INDEX(virt_addr, type, index) (&((type *)(virt_addr))[ index ]) 8162306a36Sopenharmony_ci 8262306a36Sopenharmony_ci#define FORE200E_NEXT_ENTRY(index, modulo) (index = ((index) + 1) % (modulo)) 8362306a36Sopenharmony_ci 8462306a36Sopenharmony_ci#if 1 8562306a36Sopenharmony_ci#define ASSERT(expr) if (!(expr)) { \ 8662306a36Sopenharmony_ci printk(FORE200E "assertion failed! %s[%d]: %s\n", \ 8762306a36Sopenharmony_ci __func__, __LINE__, #expr); \ 8862306a36Sopenharmony_ci panic(FORE200E "%s", __func__); \ 8962306a36Sopenharmony_ci } 9062306a36Sopenharmony_ci#else 9162306a36Sopenharmony_ci#define ASSERT(expr) do {} while (0) 9262306a36Sopenharmony_ci#endif 9362306a36Sopenharmony_ci 9462306a36Sopenharmony_ci 9562306a36Sopenharmony_cistatic const struct atmdev_ops fore200e_ops; 9662306a36Sopenharmony_ci 9762306a36Sopenharmony_cistatic LIST_HEAD(fore200e_boards); 9862306a36Sopenharmony_ci 9962306a36Sopenharmony_ci 10062306a36Sopenharmony_ciMODULE_AUTHOR("Christophe Lizzi - credits to Uwe Dannowski and Heikki Vatiainen"); 10162306a36Sopenharmony_ciMODULE_DESCRIPTION("FORE Systems 200E-series ATM driver - version " FORE200E_VERSION); 10262306a36Sopenharmony_ci 10362306a36Sopenharmony_cistatic const int fore200e_rx_buf_nbr[ BUFFER_SCHEME_NBR ][ BUFFER_MAGN_NBR ] = { 10462306a36Sopenharmony_ci { BUFFER_S1_NBR, BUFFER_L1_NBR }, 10562306a36Sopenharmony_ci { BUFFER_S2_NBR, BUFFER_L2_NBR } 10662306a36Sopenharmony_ci}; 10762306a36Sopenharmony_ci 10862306a36Sopenharmony_cistatic const int fore200e_rx_buf_size[ BUFFER_SCHEME_NBR ][ BUFFER_MAGN_NBR ] = { 10962306a36Sopenharmony_ci { BUFFER_S1_SIZE, BUFFER_L1_SIZE }, 11062306a36Sopenharmony_ci { BUFFER_S2_SIZE, BUFFER_L2_SIZE } 11162306a36Sopenharmony_ci}; 11262306a36Sopenharmony_ci 11362306a36Sopenharmony_ci 11462306a36Sopenharmony_ci#if defined(CONFIG_ATM_FORE200E_DEBUG) && (CONFIG_ATM_FORE200E_DEBUG > 0) 11562306a36Sopenharmony_cistatic const char* fore200e_traffic_class[] = { "NONE", "UBR", "CBR", "VBR", "ABR", "ANY" }; 11662306a36Sopenharmony_ci#endif 11762306a36Sopenharmony_ci 11862306a36Sopenharmony_ci 11962306a36Sopenharmony_ci#if 0 /* currently unused */ 12062306a36Sopenharmony_cistatic int 12162306a36Sopenharmony_cifore200e_fore2atm_aal(enum fore200e_aal aal) 12262306a36Sopenharmony_ci{ 12362306a36Sopenharmony_ci switch(aal) { 12462306a36Sopenharmony_ci case FORE200E_AAL0: return ATM_AAL0; 12562306a36Sopenharmony_ci case FORE200E_AAL34: return ATM_AAL34; 12662306a36Sopenharmony_ci case FORE200E_AAL5: return ATM_AAL5; 12762306a36Sopenharmony_ci } 12862306a36Sopenharmony_ci 12962306a36Sopenharmony_ci return -EINVAL; 13062306a36Sopenharmony_ci} 13162306a36Sopenharmony_ci#endif 13262306a36Sopenharmony_ci 13362306a36Sopenharmony_ci 13462306a36Sopenharmony_cistatic enum fore200e_aal 13562306a36Sopenharmony_cifore200e_atm2fore_aal(int aal) 13662306a36Sopenharmony_ci{ 13762306a36Sopenharmony_ci switch(aal) { 13862306a36Sopenharmony_ci case ATM_AAL0: return FORE200E_AAL0; 13962306a36Sopenharmony_ci case ATM_AAL34: return FORE200E_AAL34; 14062306a36Sopenharmony_ci case ATM_AAL1: 14162306a36Sopenharmony_ci case ATM_AAL2: 14262306a36Sopenharmony_ci case ATM_AAL5: return FORE200E_AAL5; 14362306a36Sopenharmony_ci } 14462306a36Sopenharmony_ci 14562306a36Sopenharmony_ci return -EINVAL; 14662306a36Sopenharmony_ci} 14762306a36Sopenharmony_ci 14862306a36Sopenharmony_ci 14962306a36Sopenharmony_cistatic char* 15062306a36Sopenharmony_cifore200e_irq_itoa(int irq) 15162306a36Sopenharmony_ci{ 15262306a36Sopenharmony_ci static char str[8]; 15362306a36Sopenharmony_ci sprintf(str, "%d", irq); 15462306a36Sopenharmony_ci return str; 15562306a36Sopenharmony_ci} 15662306a36Sopenharmony_ci 15762306a36Sopenharmony_ci 15862306a36Sopenharmony_ci/* allocate and align a chunk of memory intended to hold the data behing exchanged 15962306a36Sopenharmony_ci between the driver and the adapter (using streaming DVMA) */ 16062306a36Sopenharmony_ci 16162306a36Sopenharmony_cistatic int 16262306a36Sopenharmony_cifore200e_chunk_alloc(struct fore200e* fore200e, struct chunk* chunk, int size, int alignment, int direction) 16362306a36Sopenharmony_ci{ 16462306a36Sopenharmony_ci unsigned long offset = 0; 16562306a36Sopenharmony_ci 16662306a36Sopenharmony_ci if (alignment <= sizeof(int)) 16762306a36Sopenharmony_ci alignment = 0; 16862306a36Sopenharmony_ci 16962306a36Sopenharmony_ci chunk->alloc_size = size + alignment; 17062306a36Sopenharmony_ci chunk->direction = direction; 17162306a36Sopenharmony_ci 17262306a36Sopenharmony_ci chunk->alloc_addr = kzalloc(chunk->alloc_size, GFP_KERNEL); 17362306a36Sopenharmony_ci if (chunk->alloc_addr == NULL) 17462306a36Sopenharmony_ci return -ENOMEM; 17562306a36Sopenharmony_ci 17662306a36Sopenharmony_ci if (alignment > 0) 17762306a36Sopenharmony_ci offset = FORE200E_ALIGN(chunk->alloc_addr, alignment); 17862306a36Sopenharmony_ci 17962306a36Sopenharmony_ci chunk->align_addr = chunk->alloc_addr + offset; 18062306a36Sopenharmony_ci 18162306a36Sopenharmony_ci chunk->dma_addr = dma_map_single(fore200e->dev, chunk->align_addr, 18262306a36Sopenharmony_ci size, direction); 18362306a36Sopenharmony_ci if (dma_mapping_error(fore200e->dev, chunk->dma_addr)) { 18462306a36Sopenharmony_ci kfree(chunk->alloc_addr); 18562306a36Sopenharmony_ci return -ENOMEM; 18662306a36Sopenharmony_ci } 18762306a36Sopenharmony_ci return 0; 18862306a36Sopenharmony_ci} 18962306a36Sopenharmony_ci 19062306a36Sopenharmony_ci 19162306a36Sopenharmony_ci/* free a chunk of memory */ 19262306a36Sopenharmony_ci 19362306a36Sopenharmony_cistatic void 19462306a36Sopenharmony_cifore200e_chunk_free(struct fore200e* fore200e, struct chunk* chunk) 19562306a36Sopenharmony_ci{ 19662306a36Sopenharmony_ci dma_unmap_single(fore200e->dev, chunk->dma_addr, chunk->dma_size, 19762306a36Sopenharmony_ci chunk->direction); 19862306a36Sopenharmony_ci kfree(chunk->alloc_addr); 19962306a36Sopenharmony_ci} 20062306a36Sopenharmony_ci 20162306a36Sopenharmony_ci/* 20262306a36Sopenharmony_ci * Allocate a DMA consistent chunk of memory intended to act as a communication 20362306a36Sopenharmony_ci * mechanism (to hold descriptors, status, queues, etc.) shared by the driver 20462306a36Sopenharmony_ci * and the adapter. 20562306a36Sopenharmony_ci */ 20662306a36Sopenharmony_cistatic int 20762306a36Sopenharmony_cifore200e_dma_chunk_alloc(struct fore200e *fore200e, struct chunk *chunk, 20862306a36Sopenharmony_ci int size, int nbr, int alignment) 20962306a36Sopenharmony_ci{ 21062306a36Sopenharmony_ci /* returned chunks are page-aligned */ 21162306a36Sopenharmony_ci chunk->alloc_size = size * nbr; 21262306a36Sopenharmony_ci chunk->alloc_addr = dma_alloc_coherent(fore200e->dev, chunk->alloc_size, 21362306a36Sopenharmony_ci &chunk->dma_addr, GFP_KERNEL); 21462306a36Sopenharmony_ci if (!chunk->alloc_addr) 21562306a36Sopenharmony_ci return -ENOMEM; 21662306a36Sopenharmony_ci chunk->align_addr = chunk->alloc_addr; 21762306a36Sopenharmony_ci return 0; 21862306a36Sopenharmony_ci} 21962306a36Sopenharmony_ci 22062306a36Sopenharmony_ci/* 22162306a36Sopenharmony_ci * Free a DMA consistent chunk of memory. 22262306a36Sopenharmony_ci */ 22362306a36Sopenharmony_cistatic void 22462306a36Sopenharmony_cifore200e_dma_chunk_free(struct fore200e* fore200e, struct chunk* chunk) 22562306a36Sopenharmony_ci{ 22662306a36Sopenharmony_ci dma_free_coherent(fore200e->dev, chunk->alloc_size, chunk->alloc_addr, 22762306a36Sopenharmony_ci chunk->dma_addr); 22862306a36Sopenharmony_ci} 22962306a36Sopenharmony_ci 23062306a36Sopenharmony_cistatic void 23162306a36Sopenharmony_cifore200e_spin(int msecs) 23262306a36Sopenharmony_ci{ 23362306a36Sopenharmony_ci unsigned long timeout = jiffies + msecs_to_jiffies(msecs); 23462306a36Sopenharmony_ci while (time_before(jiffies, timeout)); 23562306a36Sopenharmony_ci} 23662306a36Sopenharmony_ci 23762306a36Sopenharmony_ci 23862306a36Sopenharmony_cistatic int 23962306a36Sopenharmony_cifore200e_poll(struct fore200e* fore200e, volatile u32* addr, u32 val, int msecs) 24062306a36Sopenharmony_ci{ 24162306a36Sopenharmony_ci unsigned long timeout = jiffies + msecs_to_jiffies(msecs); 24262306a36Sopenharmony_ci int ok; 24362306a36Sopenharmony_ci 24462306a36Sopenharmony_ci mb(); 24562306a36Sopenharmony_ci do { 24662306a36Sopenharmony_ci if ((ok = (*addr == val)) || (*addr & STATUS_ERROR)) 24762306a36Sopenharmony_ci break; 24862306a36Sopenharmony_ci 24962306a36Sopenharmony_ci } while (time_before(jiffies, timeout)); 25062306a36Sopenharmony_ci 25162306a36Sopenharmony_ci#if 1 25262306a36Sopenharmony_ci if (!ok) { 25362306a36Sopenharmony_ci printk(FORE200E "cmd polling failed, got status 0x%08x, expected 0x%08x\n", 25462306a36Sopenharmony_ci *addr, val); 25562306a36Sopenharmony_ci } 25662306a36Sopenharmony_ci#endif 25762306a36Sopenharmony_ci 25862306a36Sopenharmony_ci return ok; 25962306a36Sopenharmony_ci} 26062306a36Sopenharmony_ci 26162306a36Sopenharmony_ci 26262306a36Sopenharmony_cistatic int 26362306a36Sopenharmony_cifore200e_io_poll(struct fore200e* fore200e, volatile u32 __iomem *addr, u32 val, int msecs) 26462306a36Sopenharmony_ci{ 26562306a36Sopenharmony_ci unsigned long timeout = jiffies + msecs_to_jiffies(msecs); 26662306a36Sopenharmony_ci int ok; 26762306a36Sopenharmony_ci 26862306a36Sopenharmony_ci do { 26962306a36Sopenharmony_ci if ((ok = (fore200e->bus->read(addr) == val))) 27062306a36Sopenharmony_ci break; 27162306a36Sopenharmony_ci 27262306a36Sopenharmony_ci } while (time_before(jiffies, timeout)); 27362306a36Sopenharmony_ci 27462306a36Sopenharmony_ci#if 1 27562306a36Sopenharmony_ci if (!ok) { 27662306a36Sopenharmony_ci printk(FORE200E "I/O polling failed, got status 0x%08x, expected 0x%08x\n", 27762306a36Sopenharmony_ci fore200e->bus->read(addr), val); 27862306a36Sopenharmony_ci } 27962306a36Sopenharmony_ci#endif 28062306a36Sopenharmony_ci 28162306a36Sopenharmony_ci return ok; 28262306a36Sopenharmony_ci} 28362306a36Sopenharmony_ci 28462306a36Sopenharmony_ci 28562306a36Sopenharmony_cistatic void 28662306a36Sopenharmony_cifore200e_free_rx_buf(struct fore200e* fore200e) 28762306a36Sopenharmony_ci{ 28862306a36Sopenharmony_ci int scheme, magn, nbr; 28962306a36Sopenharmony_ci struct buffer* buffer; 29062306a36Sopenharmony_ci 29162306a36Sopenharmony_ci for (scheme = 0; scheme < BUFFER_SCHEME_NBR; scheme++) { 29262306a36Sopenharmony_ci for (magn = 0; magn < BUFFER_MAGN_NBR; magn++) { 29362306a36Sopenharmony_ci 29462306a36Sopenharmony_ci if ((buffer = fore200e->host_bsq[ scheme ][ magn ].buffer) != NULL) { 29562306a36Sopenharmony_ci 29662306a36Sopenharmony_ci for (nbr = 0; nbr < fore200e_rx_buf_nbr[ scheme ][ magn ]; nbr++) { 29762306a36Sopenharmony_ci 29862306a36Sopenharmony_ci struct chunk* data = &buffer[ nbr ].data; 29962306a36Sopenharmony_ci 30062306a36Sopenharmony_ci if (data->alloc_addr != NULL) 30162306a36Sopenharmony_ci fore200e_chunk_free(fore200e, data); 30262306a36Sopenharmony_ci } 30362306a36Sopenharmony_ci } 30462306a36Sopenharmony_ci } 30562306a36Sopenharmony_ci } 30662306a36Sopenharmony_ci} 30762306a36Sopenharmony_ci 30862306a36Sopenharmony_ci 30962306a36Sopenharmony_cistatic void 31062306a36Sopenharmony_cifore200e_uninit_bs_queue(struct fore200e* fore200e) 31162306a36Sopenharmony_ci{ 31262306a36Sopenharmony_ci int scheme, magn; 31362306a36Sopenharmony_ci 31462306a36Sopenharmony_ci for (scheme = 0; scheme < BUFFER_SCHEME_NBR; scheme++) { 31562306a36Sopenharmony_ci for (magn = 0; magn < BUFFER_MAGN_NBR; magn++) { 31662306a36Sopenharmony_ci 31762306a36Sopenharmony_ci struct chunk* status = &fore200e->host_bsq[ scheme ][ magn ].status; 31862306a36Sopenharmony_ci struct chunk* rbd_block = &fore200e->host_bsq[ scheme ][ magn ].rbd_block; 31962306a36Sopenharmony_ci 32062306a36Sopenharmony_ci if (status->alloc_addr) 32162306a36Sopenharmony_ci fore200e_dma_chunk_free(fore200e, status); 32262306a36Sopenharmony_ci 32362306a36Sopenharmony_ci if (rbd_block->alloc_addr) 32462306a36Sopenharmony_ci fore200e_dma_chunk_free(fore200e, rbd_block); 32562306a36Sopenharmony_ci } 32662306a36Sopenharmony_ci } 32762306a36Sopenharmony_ci} 32862306a36Sopenharmony_ci 32962306a36Sopenharmony_ci 33062306a36Sopenharmony_cistatic int 33162306a36Sopenharmony_cifore200e_reset(struct fore200e* fore200e, int diag) 33262306a36Sopenharmony_ci{ 33362306a36Sopenharmony_ci int ok; 33462306a36Sopenharmony_ci 33562306a36Sopenharmony_ci fore200e->cp_monitor = fore200e->virt_base + FORE200E_CP_MONITOR_OFFSET; 33662306a36Sopenharmony_ci 33762306a36Sopenharmony_ci fore200e->bus->write(BSTAT_COLD_START, &fore200e->cp_monitor->bstat); 33862306a36Sopenharmony_ci 33962306a36Sopenharmony_ci fore200e->bus->reset(fore200e); 34062306a36Sopenharmony_ci 34162306a36Sopenharmony_ci if (diag) { 34262306a36Sopenharmony_ci ok = fore200e_io_poll(fore200e, &fore200e->cp_monitor->bstat, BSTAT_SELFTEST_OK, 1000); 34362306a36Sopenharmony_ci if (ok == 0) { 34462306a36Sopenharmony_ci 34562306a36Sopenharmony_ci printk(FORE200E "device %s self-test failed\n", fore200e->name); 34662306a36Sopenharmony_ci return -ENODEV; 34762306a36Sopenharmony_ci } 34862306a36Sopenharmony_ci 34962306a36Sopenharmony_ci printk(FORE200E "device %s self-test passed\n", fore200e->name); 35062306a36Sopenharmony_ci 35162306a36Sopenharmony_ci fore200e->state = FORE200E_STATE_RESET; 35262306a36Sopenharmony_ci } 35362306a36Sopenharmony_ci 35462306a36Sopenharmony_ci return 0; 35562306a36Sopenharmony_ci} 35662306a36Sopenharmony_ci 35762306a36Sopenharmony_ci 35862306a36Sopenharmony_cistatic void 35962306a36Sopenharmony_cifore200e_shutdown(struct fore200e* fore200e) 36062306a36Sopenharmony_ci{ 36162306a36Sopenharmony_ci printk(FORE200E "removing device %s at 0x%lx, IRQ %s\n", 36262306a36Sopenharmony_ci fore200e->name, fore200e->phys_base, 36362306a36Sopenharmony_ci fore200e_irq_itoa(fore200e->irq)); 36462306a36Sopenharmony_ci 36562306a36Sopenharmony_ci if (fore200e->state > FORE200E_STATE_RESET) { 36662306a36Sopenharmony_ci /* first, reset the board to prevent further interrupts or data transfers */ 36762306a36Sopenharmony_ci fore200e_reset(fore200e, 0); 36862306a36Sopenharmony_ci } 36962306a36Sopenharmony_ci 37062306a36Sopenharmony_ci /* then, release all allocated resources */ 37162306a36Sopenharmony_ci switch(fore200e->state) { 37262306a36Sopenharmony_ci 37362306a36Sopenharmony_ci case FORE200E_STATE_COMPLETE: 37462306a36Sopenharmony_ci kfree(fore200e->stats); 37562306a36Sopenharmony_ci 37662306a36Sopenharmony_ci fallthrough; 37762306a36Sopenharmony_ci case FORE200E_STATE_IRQ: 37862306a36Sopenharmony_ci free_irq(fore200e->irq, fore200e->atm_dev); 37962306a36Sopenharmony_ci 38062306a36Sopenharmony_ci fallthrough; 38162306a36Sopenharmony_ci case FORE200E_STATE_ALLOC_BUF: 38262306a36Sopenharmony_ci fore200e_free_rx_buf(fore200e); 38362306a36Sopenharmony_ci 38462306a36Sopenharmony_ci fallthrough; 38562306a36Sopenharmony_ci case FORE200E_STATE_INIT_BSQ: 38662306a36Sopenharmony_ci fore200e_uninit_bs_queue(fore200e); 38762306a36Sopenharmony_ci 38862306a36Sopenharmony_ci fallthrough; 38962306a36Sopenharmony_ci case FORE200E_STATE_INIT_RXQ: 39062306a36Sopenharmony_ci fore200e_dma_chunk_free(fore200e, &fore200e->host_rxq.status); 39162306a36Sopenharmony_ci fore200e_dma_chunk_free(fore200e, &fore200e->host_rxq.rpd); 39262306a36Sopenharmony_ci 39362306a36Sopenharmony_ci fallthrough; 39462306a36Sopenharmony_ci case FORE200E_STATE_INIT_TXQ: 39562306a36Sopenharmony_ci fore200e_dma_chunk_free(fore200e, &fore200e->host_txq.status); 39662306a36Sopenharmony_ci fore200e_dma_chunk_free(fore200e, &fore200e->host_txq.tpd); 39762306a36Sopenharmony_ci 39862306a36Sopenharmony_ci fallthrough; 39962306a36Sopenharmony_ci case FORE200E_STATE_INIT_CMDQ: 40062306a36Sopenharmony_ci fore200e_dma_chunk_free(fore200e, &fore200e->host_cmdq.status); 40162306a36Sopenharmony_ci 40262306a36Sopenharmony_ci fallthrough; 40362306a36Sopenharmony_ci case FORE200E_STATE_INITIALIZE: 40462306a36Sopenharmony_ci /* nothing to do for that state */ 40562306a36Sopenharmony_ci 40662306a36Sopenharmony_ci case FORE200E_STATE_START_FW: 40762306a36Sopenharmony_ci /* nothing to do for that state */ 40862306a36Sopenharmony_ci 40962306a36Sopenharmony_ci case FORE200E_STATE_RESET: 41062306a36Sopenharmony_ci /* nothing to do for that state */ 41162306a36Sopenharmony_ci 41262306a36Sopenharmony_ci case FORE200E_STATE_MAP: 41362306a36Sopenharmony_ci fore200e->bus->unmap(fore200e); 41462306a36Sopenharmony_ci 41562306a36Sopenharmony_ci fallthrough; 41662306a36Sopenharmony_ci case FORE200E_STATE_CONFIGURE: 41762306a36Sopenharmony_ci /* nothing to do for that state */ 41862306a36Sopenharmony_ci 41962306a36Sopenharmony_ci case FORE200E_STATE_REGISTER: 42062306a36Sopenharmony_ci /* XXX shouldn't we *start* by deregistering the device? */ 42162306a36Sopenharmony_ci atm_dev_deregister(fore200e->atm_dev); 42262306a36Sopenharmony_ci 42362306a36Sopenharmony_ci fallthrough; 42462306a36Sopenharmony_ci case FORE200E_STATE_BLANK: 42562306a36Sopenharmony_ci /* nothing to do for that state */ 42662306a36Sopenharmony_ci break; 42762306a36Sopenharmony_ci } 42862306a36Sopenharmony_ci} 42962306a36Sopenharmony_ci 43062306a36Sopenharmony_ci 43162306a36Sopenharmony_ci#ifdef CONFIG_PCI 43262306a36Sopenharmony_ci 43362306a36Sopenharmony_cistatic u32 fore200e_pca_read(volatile u32 __iomem *addr) 43462306a36Sopenharmony_ci{ 43562306a36Sopenharmony_ci /* on big-endian hosts, the board is configured to convert 43662306a36Sopenharmony_ci the endianess of slave RAM accesses */ 43762306a36Sopenharmony_ci return le32_to_cpu(readl(addr)); 43862306a36Sopenharmony_ci} 43962306a36Sopenharmony_ci 44062306a36Sopenharmony_ci 44162306a36Sopenharmony_cistatic void fore200e_pca_write(u32 val, volatile u32 __iomem *addr) 44262306a36Sopenharmony_ci{ 44362306a36Sopenharmony_ci /* on big-endian hosts, the board is configured to convert 44462306a36Sopenharmony_ci the endianess of slave RAM accesses */ 44562306a36Sopenharmony_ci writel(cpu_to_le32(val), addr); 44662306a36Sopenharmony_ci} 44762306a36Sopenharmony_ci 44862306a36Sopenharmony_cistatic int 44962306a36Sopenharmony_cifore200e_pca_irq_check(struct fore200e* fore200e) 45062306a36Sopenharmony_ci{ 45162306a36Sopenharmony_ci /* this is a 1 bit register */ 45262306a36Sopenharmony_ci int irq_posted = readl(fore200e->regs.pca.psr); 45362306a36Sopenharmony_ci 45462306a36Sopenharmony_ci#if defined(CONFIG_ATM_FORE200E_DEBUG) && (CONFIG_ATM_FORE200E_DEBUG == 2) 45562306a36Sopenharmony_ci if (irq_posted && (readl(fore200e->regs.pca.hcr) & PCA200E_HCR_OUTFULL)) { 45662306a36Sopenharmony_ci DPRINTK(2,"FIFO OUT full, device %d\n", fore200e->atm_dev->number); 45762306a36Sopenharmony_ci } 45862306a36Sopenharmony_ci#endif 45962306a36Sopenharmony_ci 46062306a36Sopenharmony_ci return irq_posted; 46162306a36Sopenharmony_ci} 46262306a36Sopenharmony_ci 46362306a36Sopenharmony_ci 46462306a36Sopenharmony_cistatic void 46562306a36Sopenharmony_cifore200e_pca_irq_ack(struct fore200e* fore200e) 46662306a36Sopenharmony_ci{ 46762306a36Sopenharmony_ci writel(PCA200E_HCR_CLRINTR, fore200e->regs.pca.hcr); 46862306a36Sopenharmony_ci} 46962306a36Sopenharmony_ci 47062306a36Sopenharmony_ci 47162306a36Sopenharmony_cistatic void 47262306a36Sopenharmony_cifore200e_pca_reset(struct fore200e* fore200e) 47362306a36Sopenharmony_ci{ 47462306a36Sopenharmony_ci writel(PCA200E_HCR_RESET, fore200e->regs.pca.hcr); 47562306a36Sopenharmony_ci fore200e_spin(10); 47662306a36Sopenharmony_ci writel(0, fore200e->regs.pca.hcr); 47762306a36Sopenharmony_ci} 47862306a36Sopenharmony_ci 47962306a36Sopenharmony_ci 48062306a36Sopenharmony_cistatic int fore200e_pca_map(struct fore200e* fore200e) 48162306a36Sopenharmony_ci{ 48262306a36Sopenharmony_ci DPRINTK(2, "device %s being mapped in memory\n", fore200e->name); 48362306a36Sopenharmony_ci 48462306a36Sopenharmony_ci fore200e->virt_base = ioremap(fore200e->phys_base, PCA200E_IOSPACE_LENGTH); 48562306a36Sopenharmony_ci 48662306a36Sopenharmony_ci if (fore200e->virt_base == NULL) { 48762306a36Sopenharmony_ci printk(FORE200E "can't map device %s\n", fore200e->name); 48862306a36Sopenharmony_ci return -EFAULT; 48962306a36Sopenharmony_ci } 49062306a36Sopenharmony_ci 49162306a36Sopenharmony_ci DPRINTK(1, "device %s mapped to 0x%p\n", fore200e->name, fore200e->virt_base); 49262306a36Sopenharmony_ci 49362306a36Sopenharmony_ci /* gain access to the PCA specific registers */ 49462306a36Sopenharmony_ci fore200e->regs.pca.hcr = fore200e->virt_base + PCA200E_HCR_OFFSET; 49562306a36Sopenharmony_ci fore200e->regs.pca.imr = fore200e->virt_base + PCA200E_IMR_OFFSET; 49662306a36Sopenharmony_ci fore200e->regs.pca.psr = fore200e->virt_base + PCA200E_PSR_OFFSET; 49762306a36Sopenharmony_ci 49862306a36Sopenharmony_ci fore200e->state = FORE200E_STATE_MAP; 49962306a36Sopenharmony_ci return 0; 50062306a36Sopenharmony_ci} 50162306a36Sopenharmony_ci 50262306a36Sopenharmony_ci 50362306a36Sopenharmony_cistatic void 50462306a36Sopenharmony_cifore200e_pca_unmap(struct fore200e* fore200e) 50562306a36Sopenharmony_ci{ 50662306a36Sopenharmony_ci DPRINTK(2, "device %s being unmapped from memory\n", fore200e->name); 50762306a36Sopenharmony_ci 50862306a36Sopenharmony_ci if (fore200e->virt_base != NULL) 50962306a36Sopenharmony_ci iounmap(fore200e->virt_base); 51062306a36Sopenharmony_ci} 51162306a36Sopenharmony_ci 51262306a36Sopenharmony_ci 51362306a36Sopenharmony_cistatic int fore200e_pca_configure(struct fore200e *fore200e) 51462306a36Sopenharmony_ci{ 51562306a36Sopenharmony_ci struct pci_dev *pci_dev = to_pci_dev(fore200e->dev); 51662306a36Sopenharmony_ci u8 master_ctrl, latency; 51762306a36Sopenharmony_ci 51862306a36Sopenharmony_ci DPRINTK(2, "device %s being configured\n", fore200e->name); 51962306a36Sopenharmony_ci 52062306a36Sopenharmony_ci if ((pci_dev->irq == 0) || (pci_dev->irq == 0xFF)) { 52162306a36Sopenharmony_ci printk(FORE200E "incorrect IRQ setting - misconfigured PCI-PCI bridge?\n"); 52262306a36Sopenharmony_ci return -EIO; 52362306a36Sopenharmony_ci } 52462306a36Sopenharmony_ci 52562306a36Sopenharmony_ci pci_read_config_byte(pci_dev, PCA200E_PCI_MASTER_CTRL, &master_ctrl); 52662306a36Sopenharmony_ci 52762306a36Sopenharmony_ci master_ctrl = master_ctrl 52862306a36Sopenharmony_ci#if defined(__BIG_ENDIAN) 52962306a36Sopenharmony_ci /* request the PCA board to convert the endianess of slave RAM accesses */ 53062306a36Sopenharmony_ci | PCA200E_CTRL_CONVERT_ENDIAN 53162306a36Sopenharmony_ci#endif 53262306a36Sopenharmony_ci#if 0 53362306a36Sopenharmony_ci | PCA200E_CTRL_DIS_CACHE_RD 53462306a36Sopenharmony_ci | PCA200E_CTRL_DIS_WRT_INVAL 53562306a36Sopenharmony_ci | PCA200E_CTRL_ENA_CONT_REQ_MODE 53662306a36Sopenharmony_ci | PCA200E_CTRL_2_CACHE_WRT_INVAL 53762306a36Sopenharmony_ci#endif 53862306a36Sopenharmony_ci | PCA200E_CTRL_LARGE_PCI_BURSTS; 53962306a36Sopenharmony_ci 54062306a36Sopenharmony_ci pci_write_config_byte(pci_dev, PCA200E_PCI_MASTER_CTRL, master_ctrl); 54162306a36Sopenharmony_ci 54262306a36Sopenharmony_ci /* raise latency from 32 (default) to 192, as this seems to prevent NIC 54362306a36Sopenharmony_ci lockups (under heavy rx loads) due to continuous 'FIFO OUT full' condition. 54462306a36Sopenharmony_ci this may impact the performances of other PCI devices on the same bus, though */ 54562306a36Sopenharmony_ci latency = 192; 54662306a36Sopenharmony_ci pci_write_config_byte(pci_dev, PCI_LATENCY_TIMER, latency); 54762306a36Sopenharmony_ci 54862306a36Sopenharmony_ci fore200e->state = FORE200E_STATE_CONFIGURE; 54962306a36Sopenharmony_ci return 0; 55062306a36Sopenharmony_ci} 55162306a36Sopenharmony_ci 55262306a36Sopenharmony_ci 55362306a36Sopenharmony_cistatic int __init 55462306a36Sopenharmony_cifore200e_pca_prom_read(struct fore200e* fore200e, struct prom_data* prom) 55562306a36Sopenharmony_ci{ 55662306a36Sopenharmony_ci struct host_cmdq* cmdq = &fore200e->host_cmdq; 55762306a36Sopenharmony_ci struct host_cmdq_entry* entry = &cmdq->host_entry[ cmdq->head ]; 55862306a36Sopenharmony_ci struct prom_opcode opcode; 55962306a36Sopenharmony_ci int ok; 56062306a36Sopenharmony_ci u32 prom_dma; 56162306a36Sopenharmony_ci 56262306a36Sopenharmony_ci FORE200E_NEXT_ENTRY(cmdq->head, QUEUE_SIZE_CMD); 56362306a36Sopenharmony_ci 56462306a36Sopenharmony_ci opcode.opcode = OPCODE_GET_PROM; 56562306a36Sopenharmony_ci opcode.pad = 0; 56662306a36Sopenharmony_ci 56762306a36Sopenharmony_ci prom_dma = dma_map_single(fore200e->dev, prom, sizeof(struct prom_data), 56862306a36Sopenharmony_ci DMA_FROM_DEVICE); 56962306a36Sopenharmony_ci if (dma_mapping_error(fore200e->dev, prom_dma)) 57062306a36Sopenharmony_ci return -ENOMEM; 57162306a36Sopenharmony_ci 57262306a36Sopenharmony_ci fore200e->bus->write(prom_dma, &entry->cp_entry->cmd.prom_block.prom_haddr); 57362306a36Sopenharmony_ci 57462306a36Sopenharmony_ci *entry->status = STATUS_PENDING; 57562306a36Sopenharmony_ci 57662306a36Sopenharmony_ci fore200e->bus->write(*(u32*)&opcode, (u32 __iomem *)&entry->cp_entry->cmd.prom_block.opcode); 57762306a36Sopenharmony_ci 57862306a36Sopenharmony_ci ok = fore200e_poll(fore200e, entry->status, STATUS_COMPLETE, 400); 57962306a36Sopenharmony_ci 58062306a36Sopenharmony_ci *entry->status = STATUS_FREE; 58162306a36Sopenharmony_ci 58262306a36Sopenharmony_ci dma_unmap_single(fore200e->dev, prom_dma, sizeof(struct prom_data), DMA_FROM_DEVICE); 58362306a36Sopenharmony_ci 58462306a36Sopenharmony_ci if (ok == 0) { 58562306a36Sopenharmony_ci printk(FORE200E "unable to get PROM data from device %s\n", fore200e->name); 58662306a36Sopenharmony_ci return -EIO; 58762306a36Sopenharmony_ci } 58862306a36Sopenharmony_ci 58962306a36Sopenharmony_ci#if defined(__BIG_ENDIAN) 59062306a36Sopenharmony_ci 59162306a36Sopenharmony_ci#define swap_here(addr) (*((u32*)(addr)) = swab32( *((u32*)(addr)) )) 59262306a36Sopenharmony_ci 59362306a36Sopenharmony_ci /* MAC address is stored as little-endian */ 59462306a36Sopenharmony_ci swap_here(&prom->mac_addr[0]); 59562306a36Sopenharmony_ci swap_here(&prom->mac_addr[4]); 59662306a36Sopenharmony_ci#endif 59762306a36Sopenharmony_ci 59862306a36Sopenharmony_ci return 0; 59962306a36Sopenharmony_ci} 60062306a36Sopenharmony_ci 60162306a36Sopenharmony_ci 60262306a36Sopenharmony_cistatic int 60362306a36Sopenharmony_cifore200e_pca_proc_read(struct fore200e* fore200e, char *page) 60462306a36Sopenharmony_ci{ 60562306a36Sopenharmony_ci struct pci_dev *pci_dev = to_pci_dev(fore200e->dev); 60662306a36Sopenharmony_ci 60762306a36Sopenharmony_ci return sprintf(page, " PCI bus/slot/function:\t%d/%d/%d\n", 60862306a36Sopenharmony_ci pci_dev->bus->number, PCI_SLOT(pci_dev->devfn), PCI_FUNC(pci_dev->devfn)); 60962306a36Sopenharmony_ci} 61062306a36Sopenharmony_ci 61162306a36Sopenharmony_cistatic const struct fore200e_bus fore200e_pci_ops = { 61262306a36Sopenharmony_ci .model_name = "PCA-200E", 61362306a36Sopenharmony_ci .proc_name = "pca200e", 61462306a36Sopenharmony_ci .descr_alignment = 32, 61562306a36Sopenharmony_ci .buffer_alignment = 4, 61662306a36Sopenharmony_ci .status_alignment = 32, 61762306a36Sopenharmony_ci .read = fore200e_pca_read, 61862306a36Sopenharmony_ci .write = fore200e_pca_write, 61962306a36Sopenharmony_ci .configure = fore200e_pca_configure, 62062306a36Sopenharmony_ci .map = fore200e_pca_map, 62162306a36Sopenharmony_ci .reset = fore200e_pca_reset, 62262306a36Sopenharmony_ci .prom_read = fore200e_pca_prom_read, 62362306a36Sopenharmony_ci .unmap = fore200e_pca_unmap, 62462306a36Sopenharmony_ci .irq_check = fore200e_pca_irq_check, 62562306a36Sopenharmony_ci .irq_ack = fore200e_pca_irq_ack, 62662306a36Sopenharmony_ci .proc_read = fore200e_pca_proc_read, 62762306a36Sopenharmony_ci}; 62862306a36Sopenharmony_ci#endif /* CONFIG_PCI */ 62962306a36Sopenharmony_ci 63062306a36Sopenharmony_ci#ifdef CONFIG_SBUS 63162306a36Sopenharmony_ci 63262306a36Sopenharmony_cistatic u32 fore200e_sba_read(volatile u32 __iomem *addr) 63362306a36Sopenharmony_ci{ 63462306a36Sopenharmony_ci return sbus_readl(addr); 63562306a36Sopenharmony_ci} 63662306a36Sopenharmony_ci 63762306a36Sopenharmony_cistatic void fore200e_sba_write(u32 val, volatile u32 __iomem *addr) 63862306a36Sopenharmony_ci{ 63962306a36Sopenharmony_ci sbus_writel(val, addr); 64062306a36Sopenharmony_ci} 64162306a36Sopenharmony_ci 64262306a36Sopenharmony_cistatic void fore200e_sba_irq_enable(struct fore200e *fore200e) 64362306a36Sopenharmony_ci{ 64462306a36Sopenharmony_ci u32 hcr = fore200e->bus->read(fore200e->regs.sba.hcr) & SBA200E_HCR_STICKY; 64562306a36Sopenharmony_ci fore200e->bus->write(hcr | SBA200E_HCR_INTR_ENA, fore200e->regs.sba.hcr); 64662306a36Sopenharmony_ci} 64762306a36Sopenharmony_ci 64862306a36Sopenharmony_cistatic int fore200e_sba_irq_check(struct fore200e *fore200e) 64962306a36Sopenharmony_ci{ 65062306a36Sopenharmony_ci return fore200e->bus->read(fore200e->regs.sba.hcr) & SBA200E_HCR_INTR_REQ; 65162306a36Sopenharmony_ci} 65262306a36Sopenharmony_ci 65362306a36Sopenharmony_cistatic void fore200e_sba_irq_ack(struct fore200e *fore200e) 65462306a36Sopenharmony_ci{ 65562306a36Sopenharmony_ci u32 hcr = fore200e->bus->read(fore200e->regs.sba.hcr) & SBA200E_HCR_STICKY; 65662306a36Sopenharmony_ci fore200e->bus->write(hcr | SBA200E_HCR_INTR_CLR, fore200e->regs.sba.hcr); 65762306a36Sopenharmony_ci} 65862306a36Sopenharmony_ci 65962306a36Sopenharmony_cistatic void fore200e_sba_reset(struct fore200e *fore200e) 66062306a36Sopenharmony_ci{ 66162306a36Sopenharmony_ci fore200e->bus->write(SBA200E_HCR_RESET, fore200e->regs.sba.hcr); 66262306a36Sopenharmony_ci fore200e_spin(10); 66362306a36Sopenharmony_ci fore200e->bus->write(0, fore200e->regs.sba.hcr); 66462306a36Sopenharmony_ci} 66562306a36Sopenharmony_ci 66662306a36Sopenharmony_cistatic int __init fore200e_sba_map(struct fore200e *fore200e) 66762306a36Sopenharmony_ci{ 66862306a36Sopenharmony_ci struct platform_device *op = to_platform_device(fore200e->dev); 66962306a36Sopenharmony_ci unsigned int bursts; 67062306a36Sopenharmony_ci 67162306a36Sopenharmony_ci /* gain access to the SBA specific registers */ 67262306a36Sopenharmony_ci fore200e->regs.sba.hcr = of_ioremap(&op->resource[0], 0, SBA200E_HCR_LENGTH, "SBA HCR"); 67362306a36Sopenharmony_ci fore200e->regs.sba.bsr = of_ioremap(&op->resource[1], 0, SBA200E_BSR_LENGTH, "SBA BSR"); 67462306a36Sopenharmony_ci fore200e->regs.sba.isr = of_ioremap(&op->resource[2], 0, SBA200E_ISR_LENGTH, "SBA ISR"); 67562306a36Sopenharmony_ci fore200e->virt_base = of_ioremap(&op->resource[3], 0, SBA200E_RAM_LENGTH, "SBA RAM"); 67662306a36Sopenharmony_ci 67762306a36Sopenharmony_ci if (!fore200e->virt_base) { 67862306a36Sopenharmony_ci printk(FORE200E "unable to map RAM of device %s\n", fore200e->name); 67962306a36Sopenharmony_ci return -EFAULT; 68062306a36Sopenharmony_ci } 68162306a36Sopenharmony_ci 68262306a36Sopenharmony_ci DPRINTK(1, "device %s mapped to 0x%p\n", fore200e->name, fore200e->virt_base); 68362306a36Sopenharmony_ci 68462306a36Sopenharmony_ci fore200e->bus->write(0x02, fore200e->regs.sba.isr); /* XXX hardwired interrupt level */ 68562306a36Sopenharmony_ci 68662306a36Sopenharmony_ci /* get the supported DVMA burst sizes */ 68762306a36Sopenharmony_ci bursts = of_getintprop_default(op->dev.of_node->parent, "burst-sizes", 0x00); 68862306a36Sopenharmony_ci 68962306a36Sopenharmony_ci if (sbus_can_dma_64bit()) 69062306a36Sopenharmony_ci sbus_set_sbus64(&op->dev, bursts); 69162306a36Sopenharmony_ci 69262306a36Sopenharmony_ci fore200e->state = FORE200E_STATE_MAP; 69362306a36Sopenharmony_ci return 0; 69462306a36Sopenharmony_ci} 69562306a36Sopenharmony_ci 69662306a36Sopenharmony_cistatic void fore200e_sba_unmap(struct fore200e *fore200e) 69762306a36Sopenharmony_ci{ 69862306a36Sopenharmony_ci struct platform_device *op = to_platform_device(fore200e->dev); 69962306a36Sopenharmony_ci 70062306a36Sopenharmony_ci of_iounmap(&op->resource[0], fore200e->regs.sba.hcr, SBA200E_HCR_LENGTH); 70162306a36Sopenharmony_ci of_iounmap(&op->resource[1], fore200e->regs.sba.bsr, SBA200E_BSR_LENGTH); 70262306a36Sopenharmony_ci of_iounmap(&op->resource[2], fore200e->regs.sba.isr, SBA200E_ISR_LENGTH); 70362306a36Sopenharmony_ci of_iounmap(&op->resource[3], fore200e->virt_base, SBA200E_RAM_LENGTH); 70462306a36Sopenharmony_ci} 70562306a36Sopenharmony_ci 70662306a36Sopenharmony_cistatic int __init fore200e_sba_configure(struct fore200e *fore200e) 70762306a36Sopenharmony_ci{ 70862306a36Sopenharmony_ci fore200e->state = FORE200E_STATE_CONFIGURE; 70962306a36Sopenharmony_ci return 0; 71062306a36Sopenharmony_ci} 71162306a36Sopenharmony_ci 71262306a36Sopenharmony_cistatic int __init fore200e_sba_prom_read(struct fore200e *fore200e, struct prom_data *prom) 71362306a36Sopenharmony_ci{ 71462306a36Sopenharmony_ci struct platform_device *op = to_platform_device(fore200e->dev); 71562306a36Sopenharmony_ci const u8 *prop; 71662306a36Sopenharmony_ci int len; 71762306a36Sopenharmony_ci 71862306a36Sopenharmony_ci prop = of_get_property(op->dev.of_node, "madaddrlo2", &len); 71962306a36Sopenharmony_ci if (!prop) 72062306a36Sopenharmony_ci return -ENODEV; 72162306a36Sopenharmony_ci memcpy(&prom->mac_addr[4], prop, 4); 72262306a36Sopenharmony_ci 72362306a36Sopenharmony_ci prop = of_get_property(op->dev.of_node, "madaddrhi4", &len); 72462306a36Sopenharmony_ci if (!prop) 72562306a36Sopenharmony_ci return -ENODEV; 72662306a36Sopenharmony_ci memcpy(&prom->mac_addr[2], prop, 4); 72762306a36Sopenharmony_ci 72862306a36Sopenharmony_ci prom->serial_number = of_getintprop_default(op->dev.of_node, 72962306a36Sopenharmony_ci "serialnumber", 0); 73062306a36Sopenharmony_ci prom->hw_revision = of_getintprop_default(op->dev.of_node, 73162306a36Sopenharmony_ci "promversion", 0); 73262306a36Sopenharmony_ci 73362306a36Sopenharmony_ci return 0; 73462306a36Sopenharmony_ci} 73562306a36Sopenharmony_ci 73662306a36Sopenharmony_cistatic int fore200e_sba_proc_read(struct fore200e *fore200e, char *page) 73762306a36Sopenharmony_ci{ 73862306a36Sopenharmony_ci struct platform_device *op = to_platform_device(fore200e->dev); 73962306a36Sopenharmony_ci const struct linux_prom_registers *regs; 74062306a36Sopenharmony_ci 74162306a36Sopenharmony_ci regs = of_get_property(op->dev.of_node, "reg", NULL); 74262306a36Sopenharmony_ci 74362306a36Sopenharmony_ci return sprintf(page, " SBUS slot/device:\t\t%d/'%pOFn'\n", 74462306a36Sopenharmony_ci (regs ? regs->which_io : 0), op->dev.of_node); 74562306a36Sopenharmony_ci} 74662306a36Sopenharmony_ci 74762306a36Sopenharmony_cistatic const struct fore200e_bus fore200e_sbus_ops = { 74862306a36Sopenharmony_ci .model_name = "SBA-200E", 74962306a36Sopenharmony_ci .proc_name = "sba200e", 75062306a36Sopenharmony_ci .descr_alignment = 32, 75162306a36Sopenharmony_ci .buffer_alignment = 64, 75262306a36Sopenharmony_ci .status_alignment = 32, 75362306a36Sopenharmony_ci .read = fore200e_sba_read, 75462306a36Sopenharmony_ci .write = fore200e_sba_write, 75562306a36Sopenharmony_ci .configure = fore200e_sba_configure, 75662306a36Sopenharmony_ci .map = fore200e_sba_map, 75762306a36Sopenharmony_ci .reset = fore200e_sba_reset, 75862306a36Sopenharmony_ci .prom_read = fore200e_sba_prom_read, 75962306a36Sopenharmony_ci .unmap = fore200e_sba_unmap, 76062306a36Sopenharmony_ci .irq_enable = fore200e_sba_irq_enable, 76162306a36Sopenharmony_ci .irq_check = fore200e_sba_irq_check, 76262306a36Sopenharmony_ci .irq_ack = fore200e_sba_irq_ack, 76362306a36Sopenharmony_ci .proc_read = fore200e_sba_proc_read, 76462306a36Sopenharmony_ci}; 76562306a36Sopenharmony_ci#endif /* CONFIG_SBUS */ 76662306a36Sopenharmony_ci 76762306a36Sopenharmony_cistatic void 76862306a36Sopenharmony_cifore200e_tx_irq(struct fore200e* fore200e) 76962306a36Sopenharmony_ci{ 77062306a36Sopenharmony_ci struct host_txq* txq = &fore200e->host_txq; 77162306a36Sopenharmony_ci struct host_txq_entry* entry; 77262306a36Sopenharmony_ci struct atm_vcc* vcc; 77362306a36Sopenharmony_ci struct fore200e_vc_map* vc_map; 77462306a36Sopenharmony_ci 77562306a36Sopenharmony_ci if (fore200e->host_txq.txing == 0) 77662306a36Sopenharmony_ci return; 77762306a36Sopenharmony_ci 77862306a36Sopenharmony_ci for (;;) { 77962306a36Sopenharmony_ci 78062306a36Sopenharmony_ci entry = &txq->host_entry[ txq->tail ]; 78162306a36Sopenharmony_ci 78262306a36Sopenharmony_ci if ((*entry->status & STATUS_COMPLETE) == 0) { 78362306a36Sopenharmony_ci break; 78462306a36Sopenharmony_ci } 78562306a36Sopenharmony_ci 78662306a36Sopenharmony_ci DPRINTK(3, "TX COMPLETED: entry = %p [tail = %d], vc_map = %p, skb = %p\n", 78762306a36Sopenharmony_ci entry, txq->tail, entry->vc_map, entry->skb); 78862306a36Sopenharmony_ci 78962306a36Sopenharmony_ci /* free copy of misaligned data */ 79062306a36Sopenharmony_ci kfree(entry->data); 79162306a36Sopenharmony_ci 79262306a36Sopenharmony_ci /* remove DMA mapping */ 79362306a36Sopenharmony_ci dma_unmap_single(fore200e->dev, entry->tpd->tsd[ 0 ].buffer, entry->tpd->tsd[ 0 ].length, 79462306a36Sopenharmony_ci DMA_TO_DEVICE); 79562306a36Sopenharmony_ci 79662306a36Sopenharmony_ci vc_map = entry->vc_map; 79762306a36Sopenharmony_ci 79862306a36Sopenharmony_ci /* vcc closed since the time the entry was submitted for tx? */ 79962306a36Sopenharmony_ci if ((vc_map->vcc == NULL) || 80062306a36Sopenharmony_ci (test_bit(ATM_VF_READY, &vc_map->vcc->flags) == 0)) { 80162306a36Sopenharmony_ci 80262306a36Sopenharmony_ci DPRINTK(1, "no ready vcc found for PDU sent on device %d\n", 80362306a36Sopenharmony_ci fore200e->atm_dev->number); 80462306a36Sopenharmony_ci 80562306a36Sopenharmony_ci dev_kfree_skb_any(entry->skb); 80662306a36Sopenharmony_ci } 80762306a36Sopenharmony_ci else { 80862306a36Sopenharmony_ci ASSERT(vc_map->vcc); 80962306a36Sopenharmony_ci 81062306a36Sopenharmony_ci /* vcc closed then immediately re-opened? */ 81162306a36Sopenharmony_ci if (vc_map->incarn != entry->incarn) { 81262306a36Sopenharmony_ci 81362306a36Sopenharmony_ci /* when a vcc is closed, some PDUs may be still pending in the tx queue. 81462306a36Sopenharmony_ci if the same vcc is immediately re-opened, those pending PDUs must 81562306a36Sopenharmony_ci not be popped after the completion of their emission, as they refer 81662306a36Sopenharmony_ci to the prior incarnation of that vcc. otherwise, sk_atm(vcc)->sk_wmem_alloc 81762306a36Sopenharmony_ci would be decremented by the size of the (unrelated) skb, possibly 81862306a36Sopenharmony_ci leading to a negative sk->sk_wmem_alloc count, ultimately freezing the vcc. 81962306a36Sopenharmony_ci we thus bind the tx entry to the current incarnation of the vcc 82062306a36Sopenharmony_ci when the entry is submitted for tx. When the tx later completes, 82162306a36Sopenharmony_ci if the incarnation number of the tx entry does not match the one 82262306a36Sopenharmony_ci of the vcc, then this implies that the vcc has been closed then re-opened. 82362306a36Sopenharmony_ci we thus just drop the skb here. */ 82462306a36Sopenharmony_ci 82562306a36Sopenharmony_ci DPRINTK(1, "vcc closed-then-re-opened; dropping PDU sent on device %d\n", 82662306a36Sopenharmony_ci fore200e->atm_dev->number); 82762306a36Sopenharmony_ci 82862306a36Sopenharmony_ci dev_kfree_skb_any(entry->skb); 82962306a36Sopenharmony_ci } 83062306a36Sopenharmony_ci else { 83162306a36Sopenharmony_ci vcc = vc_map->vcc; 83262306a36Sopenharmony_ci ASSERT(vcc); 83362306a36Sopenharmony_ci 83462306a36Sopenharmony_ci /* notify tx completion */ 83562306a36Sopenharmony_ci if (vcc->pop) { 83662306a36Sopenharmony_ci vcc->pop(vcc, entry->skb); 83762306a36Sopenharmony_ci } 83862306a36Sopenharmony_ci else { 83962306a36Sopenharmony_ci dev_kfree_skb_any(entry->skb); 84062306a36Sopenharmony_ci } 84162306a36Sopenharmony_ci 84262306a36Sopenharmony_ci /* check error condition */ 84362306a36Sopenharmony_ci if (*entry->status & STATUS_ERROR) 84462306a36Sopenharmony_ci atomic_inc(&vcc->stats->tx_err); 84562306a36Sopenharmony_ci else 84662306a36Sopenharmony_ci atomic_inc(&vcc->stats->tx); 84762306a36Sopenharmony_ci } 84862306a36Sopenharmony_ci } 84962306a36Sopenharmony_ci 85062306a36Sopenharmony_ci *entry->status = STATUS_FREE; 85162306a36Sopenharmony_ci 85262306a36Sopenharmony_ci fore200e->host_txq.txing--; 85362306a36Sopenharmony_ci 85462306a36Sopenharmony_ci FORE200E_NEXT_ENTRY(txq->tail, QUEUE_SIZE_TX); 85562306a36Sopenharmony_ci } 85662306a36Sopenharmony_ci} 85762306a36Sopenharmony_ci 85862306a36Sopenharmony_ci 85962306a36Sopenharmony_ci#ifdef FORE200E_BSQ_DEBUG 86062306a36Sopenharmony_ciint bsq_audit(int where, struct host_bsq* bsq, int scheme, int magn) 86162306a36Sopenharmony_ci{ 86262306a36Sopenharmony_ci struct buffer* buffer; 86362306a36Sopenharmony_ci int count = 0; 86462306a36Sopenharmony_ci 86562306a36Sopenharmony_ci buffer = bsq->freebuf; 86662306a36Sopenharmony_ci while (buffer) { 86762306a36Sopenharmony_ci 86862306a36Sopenharmony_ci if (buffer->supplied) { 86962306a36Sopenharmony_ci printk(FORE200E "bsq_audit(%d): queue %d.%d, buffer %ld supplied but in free list!\n", 87062306a36Sopenharmony_ci where, scheme, magn, buffer->index); 87162306a36Sopenharmony_ci } 87262306a36Sopenharmony_ci 87362306a36Sopenharmony_ci if (buffer->magn != magn) { 87462306a36Sopenharmony_ci printk(FORE200E "bsq_audit(%d): queue %d.%d, buffer %ld, unexpected magn = %d\n", 87562306a36Sopenharmony_ci where, scheme, magn, buffer->index, buffer->magn); 87662306a36Sopenharmony_ci } 87762306a36Sopenharmony_ci 87862306a36Sopenharmony_ci if (buffer->scheme != scheme) { 87962306a36Sopenharmony_ci printk(FORE200E "bsq_audit(%d): queue %d.%d, buffer %ld, unexpected scheme = %d\n", 88062306a36Sopenharmony_ci where, scheme, magn, buffer->index, buffer->scheme); 88162306a36Sopenharmony_ci } 88262306a36Sopenharmony_ci 88362306a36Sopenharmony_ci if ((buffer->index < 0) || (buffer->index >= fore200e_rx_buf_nbr[ scheme ][ magn ])) { 88462306a36Sopenharmony_ci printk(FORE200E "bsq_audit(%d): queue %d.%d, out of range buffer index = %ld !\n", 88562306a36Sopenharmony_ci where, scheme, magn, buffer->index); 88662306a36Sopenharmony_ci } 88762306a36Sopenharmony_ci 88862306a36Sopenharmony_ci count++; 88962306a36Sopenharmony_ci buffer = buffer->next; 89062306a36Sopenharmony_ci } 89162306a36Sopenharmony_ci 89262306a36Sopenharmony_ci if (count != bsq->freebuf_count) { 89362306a36Sopenharmony_ci printk(FORE200E "bsq_audit(%d): queue %d.%d, %d bufs in free list, but freebuf_count = %d\n", 89462306a36Sopenharmony_ci where, scheme, magn, count, bsq->freebuf_count); 89562306a36Sopenharmony_ci } 89662306a36Sopenharmony_ci return 0; 89762306a36Sopenharmony_ci} 89862306a36Sopenharmony_ci#endif 89962306a36Sopenharmony_ci 90062306a36Sopenharmony_ci 90162306a36Sopenharmony_cistatic void 90262306a36Sopenharmony_cifore200e_supply(struct fore200e* fore200e) 90362306a36Sopenharmony_ci{ 90462306a36Sopenharmony_ci int scheme, magn, i; 90562306a36Sopenharmony_ci 90662306a36Sopenharmony_ci struct host_bsq* bsq; 90762306a36Sopenharmony_ci struct host_bsq_entry* entry; 90862306a36Sopenharmony_ci struct buffer* buffer; 90962306a36Sopenharmony_ci 91062306a36Sopenharmony_ci for (scheme = 0; scheme < BUFFER_SCHEME_NBR; scheme++) { 91162306a36Sopenharmony_ci for (magn = 0; magn < BUFFER_MAGN_NBR; magn++) { 91262306a36Sopenharmony_ci 91362306a36Sopenharmony_ci bsq = &fore200e->host_bsq[ scheme ][ magn ]; 91462306a36Sopenharmony_ci 91562306a36Sopenharmony_ci#ifdef FORE200E_BSQ_DEBUG 91662306a36Sopenharmony_ci bsq_audit(1, bsq, scheme, magn); 91762306a36Sopenharmony_ci#endif 91862306a36Sopenharmony_ci while (bsq->freebuf_count >= RBD_BLK_SIZE) { 91962306a36Sopenharmony_ci 92062306a36Sopenharmony_ci DPRINTK(2, "supplying %d rx buffers to queue %d / %d, freebuf_count = %d\n", 92162306a36Sopenharmony_ci RBD_BLK_SIZE, scheme, magn, bsq->freebuf_count); 92262306a36Sopenharmony_ci 92362306a36Sopenharmony_ci entry = &bsq->host_entry[ bsq->head ]; 92462306a36Sopenharmony_ci 92562306a36Sopenharmony_ci for (i = 0; i < RBD_BLK_SIZE; i++) { 92662306a36Sopenharmony_ci 92762306a36Sopenharmony_ci /* take the first buffer in the free buffer list */ 92862306a36Sopenharmony_ci buffer = bsq->freebuf; 92962306a36Sopenharmony_ci if (!buffer) { 93062306a36Sopenharmony_ci printk(FORE200E "no more free bufs in queue %d.%d, but freebuf_count = %d\n", 93162306a36Sopenharmony_ci scheme, magn, bsq->freebuf_count); 93262306a36Sopenharmony_ci return; 93362306a36Sopenharmony_ci } 93462306a36Sopenharmony_ci bsq->freebuf = buffer->next; 93562306a36Sopenharmony_ci 93662306a36Sopenharmony_ci#ifdef FORE200E_BSQ_DEBUG 93762306a36Sopenharmony_ci if (buffer->supplied) 93862306a36Sopenharmony_ci printk(FORE200E "queue %d.%d, buffer %lu already supplied\n", 93962306a36Sopenharmony_ci scheme, magn, buffer->index); 94062306a36Sopenharmony_ci buffer->supplied = 1; 94162306a36Sopenharmony_ci#endif 94262306a36Sopenharmony_ci entry->rbd_block->rbd[ i ].buffer_haddr = buffer->data.dma_addr; 94362306a36Sopenharmony_ci entry->rbd_block->rbd[ i ].handle = FORE200E_BUF2HDL(buffer); 94462306a36Sopenharmony_ci } 94562306a36Sopenharmony_ci 94662306a36Sopenharmony_ci FORE200E_NEXT_ENTRY(bsq->head, QUEUE_SIZE_BS); 94762306a36Sopenharmony_ci 94862306a36Sopenharmony_ci /* decrease accordingly the number of free rx buffers */ 94962306a36Sopenharmony_ci bsq->freebuf_count -= RBD_BLK_SIZE; 95062306a36Sopenharmony_ci 95162306a36Sopenharmony_ci *entry->status = STATUS_PENDING; 95262306a36Sopenharmony_ci fore200e->bus->write(entry->rbd_block_dma, &entry->cp_entry->rbd_block_haddr); 95362306a36Sopenharmony_ci } 95462306a36Sopenharmony_ci } 95562306a36Sopenharmony_ci } 95662306a36Sopenharmony_ci} 95762306a36Sopenharmony_ci 95862306a36Sopenharmony_ci 95962306a36Sopenharmony_cistatic int 96062306a36Sopenharmony_cifore200e_push_rpd(struct fore200e* fore200e, struct atm_vcc* vcc, struct rpd* rpd) 96162306a36Sopenharmony_ci{ 96262306a36Sopenharmony_ci struct sk_buff* skb; 96362306a36Sopenharmony_ci struct buffer* buffer; 96462306a36Sopenharmony_ci struct fore200e_vcc* fore200e_vcc; 96562306a36Sopenharmony_ci int i, pdu_len = 0; 96662306a36Sopenharmony_ci#ifdef FORE200E_52BYTE_AAL0_SDU 96762306a36Sopenharmony_ci u32 cell_header = 0; 96862306a36Sopenharmony_ci#endif 96962306a36Sopenharmony_ci 97062306a36Sopenharmony_ci ASSERT(vcc); 97162306a36Sopenharmony_ci 97262306a36Sopenharmony_ci fore200e_vcc = FORE200E_VCC(vcc); 97362306a36Sopenharmony_ci ASSERT(fore200e_vcc); 97462306a36Sopenharmony_ci 97562306a36Sopenharmony_ci#ifdef FORE200E_52BYTE_AAL0_SDU 97662306a36Sopenharmony_ci if ((vcc->qos.aal == ATM_AAL0) && (vcc->qos.rxtp.max_sdu == ATM_AAL0_SDU)) { 97762306a36Sopenharmony_ci 97862306a36Sopenharmony_ci cell_header = (rpd->atm_header.gfc << ATM_HDR_GFC_SHIFT) | 97962306a36Sopenharmony_ci (rpd->atm_header.vpi << ATM_HDR_VPI_SHIFT) | 98062306a36Sopenharmony_ci (rpd->atm_header.vci << ATM_HDR_VCI_SHIFT) | 98162306a36Sopenharmony_ci (rpd->atm_header.plt << ATM_HDR_PTI_SHIFT) | 98262306a36Sopenharmony_ci rpd->atm_header.clp; 98362306a36Sopenharmony_ci pdu_len = 4; 98462306a36Sopenharmony_ci } 98562306a36Sopenharmony_ci#endif 98662306a36Sopenharmony_ci 98762306a36Sopenharmony_ci /* compute total PDU length */ 98862306a36Sopenharmony_ci for (i = 0; i < rpd->nseg; i++) 98962306a36Sopenharmony_ci pdu_len += rpd->rsd[ i ].length; 99062306a36Sopenharmony_ci 99162306a36Sopenharmony_ci skb = alloc_skb(pdu_len, GFP_ATOMIC); 99262306a36Sopenharmony_ci if (skb == NULL) { 99362306a36Sopenharmony_ci DPRINTK(2, "unable to alloc new skb, rx PDU length = %d\n", pdu_len); 99462306a36Sopenharmony_ci 99562306a36Sopenharmony_ci atomic_inc(&vcc->stats->rx_drop); 99662306a36Sopenharmony_ci return -ENOMEM; 99762306a36Sopenharmony_ci } 99862306a36Sopenharmony_ci 99962306a36Sopenharmony_ci __net_timestamp(skb); 100062306a36Sopenharmony_ci 100162306a36Sopenharmony_ci#ifdef FORE200E_52BYTE_AAL0_SDU 100262306a36Sopenharmony_ci if (cell_header) { 100362306a36Sopenharmony_ci *((u32*)skb_put(skb, 4)) = cell_header; 100462306a36Sopenharmony_ci } 100562306a36Sopenharmony_ci#endif 100662306a36Sopenharmony_ci 100762306a36Sopenharmony_ci /* reassemble segments */ 100862306a36Sopenharmony_ci for (i = 0; i < rpd->nseg; i++) { 100962306a36Sopenharmony_ci 101062306a36Sopenharmony_ci /* rebuild rx buffer address from rsd handle */ 101162306a36Sopenharmony_ci buffer = FORE200E_HDL2BUF(rpd->rsd[ i ].handle); 101262306a36Sopenharmony_ci 101362306a36Sopenharmony_ci /* Make device DMA transfer visible to CPU. */ 101462306a36Sopenharmony_ci dma_sync_single_for_cpu(fore200e->dev, buffer->data.dma_addr, 101562306a36Sopenharmony_ci rpd->rsd[i].length, DMA_FROM_DEVICE); 101662306a36Sopenharmony_ci 101762306a36Sopenharmony_ci skb_put_data(skb, buffer->data.align_addr, rpd->rsd[i].length); 101862306a36Sopenharmony_ci 101962306a36Sopenharmony_ci /* Now let the device get at it again. */ 102062306a36Sopenharmony_ci dma_sync_single_for_device(fore200e->dev, buffer->data.dma_addr, 102162306a36Sopenharmony_ci rpd->rsd[i].length, DMA_FROM_DEVICE); 102262306a36Sopenharmony_ci } 102362306a36Sopenharmony_ci 102462306a36Sopenharmony_ci DPRINTK(3, "rx skb: len = %d, truesize = %d\n", skb->len, skb->truesize); 102562306a36Sopenharmony_ci 102662306a36Sopenharmony_ci if (pdu_len < fore200e_vcc->rx_min_pdu) 102762306a36Sopenharmony_ci fore200e_vcc->rx_min_pdu = pdu_len; 102862306a36Sopenharmony_ci if (pdu_len > fore200e_vcc->rx_max_pdu) 102962306a36Sopenharmony_ci fore200e_vcc->rx_max_pdu = pdu_len; 103062306a36Sopenharmony_ci fore200e_vcc->rx_pdu++; 103162306a36Sopenharmony_ci 103262306a36Sopenharmony_ci /* push PDU */ 103362306a36Sopenharmony_ci if (atm_charge(vcc, skb->truesize) == 0) { 103462306a36Sopenharmony_ci 103562306a36Sopenharmony_ci DPRINTK(2, "receive buffers saturated for %d.%d.%d - PDU dropped\n", 103662306a36Sopenharmony_ci vcc->itf, vcc->vpi, vcc->vci); 103762306a36Sopenharmony_ci 103862306a36Sopenharmony_ci dev_kfree_skb_any(skb); 103962306a36Sopenharmony_ci 104062306a36Sopenharmony_ci atomic_inc(&vcc->stats->rx_drop); 104162306a36Sopenharmony_ci return -ENOMEM; 104262306a36Sopenharmony_ci } 104362306a36Sopenharmony_ci 104462306a36Sopenharmony_ci vcc->push(vcc, skb); 104562306a36Sopenharmony_ci atomic_inc(&vcc->stats->rx); 104662306a36Sopenharmony_ci 104762306a36Sopenharmony_ci return 0; 104862306a36Sopenharmony_ci} 104962306a36Sopenharmony_ci 105062306a36Sopenharmony_ci 105162306a36Sopenharmony_cistatic void 105262306a36Sopenharmony_cifore200e_collect_rpd(struct fore200e* fore200e, struct rpd* rpd) 105362306a36Sopenharmony_ci{ 105462306a36Sopenharmony_ci struct host_bsq* bsq; 105562306a36Sopenharmony_ci struct buffer* buffer; 105662306a36Sopenharmony_ci int i; 105762306a36Sopenharmony_ci 105862306a36Sopenharmony_ci for (i = 0; i < rpd->nseg; i++) { 105962306a36Sopenharmony_ci 106062306a36Sopenharmony_ci /* rebuild rx buffer address from rsd handle */ 106162306a36Sopenharmony_ci buffer = FORE200E_HDL2BUF(rpd->rsd[ i ].handle); 106262306a36Sopenharmony_ci 106362306a36Sopenharmony_ci bsq = &fore200e->host_bsq[ buffer->scheme ][ buffer->magn ]; 106462306a36Sopenharmony_ci 106562306a36Sopenharmony_ci#ifdef FORE200E_BSQ_DEBUG 106662306a36Sopenharmony_ci bsq_audit(2, bsq, buffer->scheme, buffer->magn); 106762306a36Sopenharmony_ci 106862306a36Sopenharmony_ci if (buffer->supplied == 0) 106962306a36Sopenharmony_ci printk(FORE200E "queue %d.%d, buffer %ld was not supplied\n", 107062306a36Sopenharmony_ci buffer->scheme, buffer->magn, buffer->index); 107162306a36Sopenharmony_ci buffer->supplied = 0; 107262306a36Sopenharmony_ci#endif 107362306a36Sopenharmony_ci 107462306a36Sopenharmony_ci /* re-insert the buffer into the free buffer list */ 107562306a36Sopenharmony_ci buffer->next = bsq->freebuf; 107662306a36Sopenharmony_ci bsq->freebuf = buffer; 107762306a36Sopenharmony_ci 107862306a36Sopenharmony_ci /* then increment the number of free rx buffers */ 107962306a36Sopenharmony_ci bsq->freebuf_count++; 108062306a36Sopenharmony_ci } 108162306a36Sopenharmony_ci} 108262306a36Sopenharmony_ci 108362306a36Sopenharmony_ci 108462306a36Sopenharmony_cistatic void 108562306a36Sopenharmony_cifore200e_rx_irq(struct fore200e* fore200e) 108662306a36Sopenharmony_ci{ 108762306a36Sopenharmony_ci struct host_rxq* rxq = &fore200e->host_rxq; 108862306a36Sopenharmony_ci struct host_rxq_entry* entry; 108962306a36Sopenharmony_ci struct atm_vcc* vcc; 109062306a36Sopenharmony_ci struct fore200e_vc_map* vc_map; 109162306a36Sopenharmony_ci 109262306a36Sopenharmony_ci for (;;) { 109362306a36Sopenharmony_ci 109462306a36Sopenharmony_ci entry = &rxq->host_entry[ rxq->head ]; 109562306a36Sopenharmony_ci 109662306a36Sopenharmony_ci /* no more received PDUs */ 109762306a36Sopenharmony_ci if ((*entry->status & STATUS_COMPLETE) == 0) 109862306a36Sopenharmony_ci break; 109962306a36Sopenharmony_ci 110062306a36Sopenharmony_ci vc_map = FORE200E_VC_MAP(fore200e, entry->rpd->atm_header.vpi, entry->rpd->atm_header.vci); 110162306a36Sopenharmony_ci 110262306a36Sopenharmony_ci if ((vc_map->vcc == NULL) || 110362306a36Sopenharmony_ci (test_bit(ATM_VF_READY, &vc_map->vcc->flags) == 0)) { 110462306a36Sopenharmony_ci 110562306a36Sopenharmony_ci DPRINTK(1, "no ready VC found for PDU received on %d.%d.%d\n", 110662306a36Sopenharmony_ci fore200e->atm_dev->number, 110762306a36Sopenharmony_ci entry->rpd->atm_header.vpi, entry->rpd->atm_header.vci); 110862306a36Sopenharmony_ci } 110962306a36Sopenharmony_ci else { 111062306a36Sopenharmony_ci vcc = vc_map->vcc; 111162306a36Sopenharmony_ci ASSERT(vcc); 111262306a36Sopenharmony_ci 111362306a36Sopenharmony_ci if ((*entry->status & STATUS_ERROR) == 0) { 111462306a36Sopenharmony_ci 111562306a36Sopenharmony_ci fore200e_push_rpd(fore200e, vcc, entry->rpd); 111662306a36Sopenharmony_ci } 111762306a36Sopenharmony_ci else { 111862306a36Sopenharmony_ci DPRINTK(2, "damaged PDU on %d.%d.%d\n", 111962306a36Sopenharmony_ci fore200e->atm_dev->number, 112062306a36Sopenharmony_ci entry->rpd->atm_header.vpi, entry->rpd->atm_header.vci); 112162306a36Sopenharmony_ci atomic_inc(&vcc->stats->rx_err); 112262306a36Sopenharmony_ci } 112362306a36Sopenharmony_ci } 112462306a36Sopenharmony_ci 112562306a36Sopenharmony_ci FORE200E_NEXT_ENTRY(rxq->head, QUEUE_SIZE_RX); 112662306a36Sopenharmony_ci 112762306a36Sopenharmony_ci fore200e_collect_rpd(fore200e, entry->rpd); 112862306a36Sopenharmony_ci 112962306a36Sopenharmony_ci /* rewrite the rpd address to ack the received PDU */ 113062306a36Sopenharmony_ci fore200e->bus->write(entry->rpd_dma, &entry->cp_entry->rpd_haddr); 113162306a36Sopenharmony_ci *entry->status = STATUS_FREE; 113262306a36Sopenharmony_ci 113362306a36Sopenharmony_ci fore200e_supply(fore200e); 113462306a36Sopenharmony_ci } 113562306a36Sopenharmony_ci} 113662306a36Sopenharmony_ci 113762306a36Sopenharmony_ci 113862306a36Sopenharmony_ci#ifndef FORE200E_USE_TASKLET 113962306a36Sopenharmony_cistatic void 114062306a36Sopenharmony_cifore200e_irq(struct fore200e* fore200e) 114162306a36Sopenharmony_ci{ 114262306a36Sopenharmony_ci unsigned long flags; 114362306a36Sopenharmony_ci 114462306a36Sopenharmony_ci spin_lock_irqsave(&fore200e->q_lock, flags); 114562306a36Sopenharmony_ci fore200e_rx_irq(fore200e); 114662306a36Sopenharmony_ci spin_unlock_irqrestore(&fore200e->q_lock, flags); 114762306a36Sopenharmony_ci 114862306a36Sopenharmony_ci spin_lock_irqsave(&fore200e->q_lock, flags); 114962306a36Sopenharmony_ci fore200e_tx_irq(fore200e); 115062306a36Sopenharmony_ci spin_unlock_irqrestore(&fore200e->q_lock, flags); 115162306a36Sopenharmony_ci} 115262306a36Sopenharmony_ci#endif 115362306a36Sopenharmony_ci 115462306a36Sopenharmony_ci 115562306a36Sopenharmony_cistatic irqreturn_t 115662306a36Sopenharmony_cifore200e_interrupt(int irq, void* dev) 115762306a36Sopenharmony_ci{ 115862306a36Sopenharmony_ci struct fore200e* fore200e = FORE200E_DEV((struct atm_dev*)dev); 115962306a36Sopenharmony_ci 116062306a36Sopenharmony_ci if (fore200e->bus->irq_check(fore200e) == 0) { 116162306a36Sopenharmony_ci 116262306a36Sopenharmony_ci DPRINTK(3, "interrupt NOT triggered by device %d\n", fore200e->atm_dev->number); 116362306a36Sopenharmony_ci return IRQ_NONE; 116462306a36Sopenharmony_ci } 116562306a36Sopenharmony_ci DPRINTK(3, "interrupt triggered by device %d\n", fore200e->atm_dev->number); 116662306a36Sopenharmony_ci 116762306a36Sopenharmony_ci#ifdef FORE200E_USE_TASKLET 116862306a36Sopenharmony_ci tasklet_schedule(&fore200e->tx_tasklet); 116962306a36Sopenharmony_ci tasklet_schedule(&fore200e->rx_tasklet); 117062306a36Sopenharmony_ci#else 117162306a36Sopenharmony_ci fore200e_irq(fore200e); 117262306a36Sopenharmony_ci#endif 117362306a36Sopenharmony_ci 117462306a36Sopenharmony_ci fore200e->bus->irq_ack(fore200e); 117562306a36Sopenharmony_ci return IRQ_HANDLED; 117662306a36Sopenharmony_ci} 117762306a36Sopenharmony_ci 117862306a36Sopenharmony_ci 117962306a36Sopenharmony_ci#ifdef FORE200E_USE_TASKLET 118062306a36Sopenharmony_cistatic void 118162306a36Sopenharmony_cifore200e_tx_tasklet(unsigned long data) 118262306a36Sopenharmony_ci{ 118362306a36Sopenharmony_ci struct fore200e* fore200e = (struct fore200e*) data; 118462306a36Sopenharmony_ci unsigned long flags; 118562306a36Sopenharmony_ci 118662306a36Sopenharmony_ci DPRINTK(3, "tx tasklet scheduled for device %d\n", fore200e->atm_dev->number); 118762306a36Sopenharmony_ci 118862306a36Sopenharmony_ci spin_lock_irqsave(&fore200e->q_lock, flags); 118962306a36Sopenharmony_ci fore200e_tx_irq(fore200e); 119062306a36Sopenharmony_ci spin_unlock_irqrestore(&fore200e->q_lock, flags); 119162306a36Sopenharmony_ci} 119262306a36Sopenharmony_ci 119362306a36Sopenharmony_ci 119462306a36Sopenharmony_cistatic void 119562306a36Sopenharmony_cifore200e_rx_tasklet(unsigned long data) 119662306a36Sopenharmony_ci{ 119762306a36Sopenharmony_ci struct fore200e* fore200e = (struct fore200e*) data; 119862306a36Sopenharmony_ci unsigned long flags; 119962306a36Sopenharmony_ci 120062306a36Sopenharmony_ci DPRINTK(3, "rx tasklet scheduled for device %d\n", fore200e->atm_dev->number); 120162306a36Sopenharmony_ci 120262306a36Sopenharmony_ci spin_lock_irqsave(&fore200e->q_lock, flags); 120362306a36Sopenharmony_ci fore200e_rx_irq((struct fore200e*) data); 120462306a36Sopenharmony_ci spin_unlock_irqrestore(&fore200e->q_lock, flags); 120562306a36Sopenharmony_ci} 120662306a36Sopenharmony_ci#endif 120762306a36Sopenharmony_ci 120862306a36Sopenharmony_ci 120962306a36Sopenharmony_cistatic int 121062306a36Sopenharmony_cifore200e_select_scheme(struct atm_vcc* vcc) 121162306a36Sopenharmony_ci{ 121262306a36Sopenharmony_ci /* fairly balance the VCs over (identical) buffer schemes */ 121362306a36Sopenharmony_ci int scheme = vcc->vci % 2 ? BUFFER_SCHEME_ONE : BUFFER_SCHEME_TWO; 121462306a36Sopenharmony_ci 121562306a36Sopenharmony_ci DPRINTK(1, "VC %d.%d.%d uses buffer scheme %d\n", 121662306a36Sopenharmony_ci vcc->itf, vcc->vpi, vcc->vci, scheme); 121762306a36Sopenharmony_ci 121862306a36Sopenharmony_ci return scheme; 121962306a36Sopenharmony_ci} 122062306a36Sopenharmony_ci 122162306a36Sopenharmony_ci 122262306a36Sopenharmony_cistatic int 122362306a36Sopenharmony_cifore200e_activate_vcin(struct fore200e* fore200e, int activate, struct atm_vcc* vcc, int mtu) 122462306a36Sopenharmony_ci{ 122562306a36Sopenharmony_ci struct host_cmdq* cmdq = &fore200e->host_cmdq; 122662306a36Sopenharmony_ci struct host_cmdq_entry* entry = &cmdq->host_entry[ cmdq->head ]; 122762306a36Sopenharmony_ci struct activate_opcode activ_opcode; 122862306a36Sopenharmony_ci struct deactivate_opcode deactiv_opcode; 122962306a36Sopenharmony_ci struct vpvc vpvc; 123062306a36Sopenharmony_ci int ok; 123162306a36Sopenharmony_ci enum fore200e_aal aal = fore200e_atm2fore_aal(vcc->qos.aal); 123262306a36Sopenharmony_ci 123362306a36Sopenharmony_ci FORE200E_NEXT_ENTRY(cmdq->head, QUEUE_SIZE_CMD); 123462306a36Sopenharmony_ci 123562306a36Sopenharmony_ci if (activate) { 123662306a36Sopenharmony_ci FORE200E_VCC(vcc)->scheme = fore200e_select_scheme(vcc); 123762306a36Sopenharmony_ci 123862306a36Sopenharmony_ci activ_opcode.opcode = OPCODE_ACTIVATE_VCIN; 123962306a36Sopenharmony_ci activ_opcode.aal = aal; 124062306a36Sopenharmony_ci activ_opcode.scheme = FORE200E_VCC(vcc)->scheme; 124162306a36Sopenharmony_ci activ_opcode.pad = 0; 124262306a36Sopenharmony_ci } 124362306a36Sopenharmony_ci else { 124462306a36Sopenharmony_ci deactiv_opcode.opcode = OPCODE_DEACTIVATE_VCIN; 124562306a36Sopenharmony_ci deactiv_opcode.pad = 0; 124662306a36Sopenharmony_ci } 124762306a36Sopenharmony_ci 124862306a36Sopenharmony_ci vpvc.vci = vcc->vci; 124962306a36Sopenharmony_ci vpvc.vpi = vcc->vpi; 125062306a36Sopenharmony_ci 125162306a36Sopenharmony_ci *entry->status = STATUS_PENDING; 125262306a36Sopenharmony_ci 125362306a36Sopenharmony_ci if (activate) { 125462306a36Sopenharmony_ci 125562306a36Sopenharmony_ci#ifdef FORE200E_52BYTE_AAL0_SDU 125662306a36Sopenharmony_ci mtu = 48; 125762306a36Sopenharmony_ci#endif 125862306a36Sopenharmony_ci /* the MTU is not used by the cp, except in the case of AAL0 */ 125962306a36Sopenharmony_ci fore200e->bus->write(mtu, &entry->cp_entry->cmd.activate_block.mtu); 126062306a36Sopenharmony_ci fore200e->bus->write(*(u32*)&vpvc, (u32 __iomem *)&entry->cp_entry->cmd.activate_block.vpvc); 126162306a36Sopenharmony_ci fore200e->bus->write(*(u32*)&activ_opcode, (u32 __iomem *)&entry->cp_entry->cmd.activate_block.opcode); 126262306a36Sopenharmony_ci } 126362306a36Sopenharmony_ci else { 126462306a36Sopenharmony_ci fore200e->bus->write(*(u32*)&vpvc, (u32 __iomem *)&entry->cp_entry->cmd.deactivate_block.vpvc); 126562306a36Sopenharmony_ci fore200e->bus->write(*(u32*)&deactiv_opcode, (u32 __iomem *)&entry->cp_entry->cmd.deactivate_block.opcode); 126662306a36Sopenharmony_ci } 126762306a36Sopenharmony_ci 126862306a36Sopenharmony_ci ok = fore200e_poll(fore200e, entry->status, STATUS_COMPLETE, 400); 126962306a36Sopenharmony_ci 127062306a36Sopenharmony_ci *entry->status = STATUS_FREE; 127162306a36Sopenharmony_ci 127262306a36Sopenharmony_ci if (ok == 0) { 127362306a36Sopenharmony_ci printk(FORE200E "unable to %s VC %d.%d.%d\n", 127462306a36Sopenharmony_ci activate ? "open" : "close", vcc->itf, vcc->vpi, vcc->vci); 127562306a36Sopenharmony_ci return -EIO; 127662306a36Sopenharmony_ci } 127762306a36Sopenharmony_ci 127862306a36Sopenharmony_ci DPRINTK(1, "VC %d.%d.%d %sed\n", vcc->itf, vcc->vpi, vcc->vci, 127962306a36Sopenharmony_ci activate ? "open" : "clos"); 128062306a36Sopenharmony_ci 128162306a36Sopenharmony_ci return 0; 128262306a36Sopenharmony_ci} 128362306a36Sopenharmony_ci 128462306a36Sopenharmony_ci 128562306a36Sopenharmony_ci#define FORE200E_MAX_BACK2BACK_CELLS 255 /* XXX depends on CDVT */ 128662306a36Sopenharmony_ci 128762306a36Sopenharmony_cistatic void 128862306a36Sopenharmony_cifore200e_rate_ctrl(struct atm_qos* qos, struct tpd_rate* rate) 128962306a36Sopenharmony_ci{ 129062306a36Sopenharmony_ci if (qos->txtp.max_pcr < ATM_OC3_PCR) { 129162306a36Sopenharmony_ci 129262306a36Sopenharmony_ci /* compute the data cells to idle cells ratio from the tx PCR */ 129362306a36Sopenharmony_ci rate->data_cells = qos->txtp.max_pcr * FORE200E_MAX_BACK2BACK_CELLS / ATM_OC3_PCR; 129462306a36Sopenharmony_ci rate->idle_cells = FORE200E_MAX_BACK2BACK_CELLS - rate->data_cells; 129562306a36Sopenharmony_ci } 129662306a36Sopenharmony_ci else { 129762306a36Sopenharmony_ci /* disable rate control */ 129862306a36Sopenharmony_ci rate->data_cells = rate->idle_cells = 0; 129962306a36Sopenharmony_ci } 130062306a36Sopenharmony_ci} 130162306a36Sopenharmony_ci 130262306a36Sopenharmony_ci 130362306a36Sopenharmony_cistatic int 130462306a36Sopenharmony_cifore200e_open(struct atm_vcc *vcc) 130562306a36Sopenharmony_ci{ 130662306a36Sopenharmony_ci struct fore200e* fore200e = FORE200E_DEV(vcc->dev); 130762306a36Sopenharmony_ci struct fore200e_vcc* fore200e_vcc; 130862306a36Sopenharmony_ci struct fore200e_vc_map* vc_map; 130962306a36Sopenharmony_ci unsigned long flags; 131062306a36Sopenharmony_ci int vci = vcc->vci; 131162306a36Sopenharmony_ci short vpi = vcc->vpi; 131262306a36Sopenharmony_ci 131362306a36Sopenharmony_ci ASSERT((vpi >= 0) && (vpi < 1<<FORE200E_VPI_BITS)); 131462306a36Sopenharmony_ci ASSERT((vci >= 0) && (vci < 1<<FORE200E_VCI_BITS)); 131562306a36Sopenharmony_ci 131662306a36Sopenharmony_ci spin_lock_irqsave(&fore200e->q_lock, flags); 131762306a36Sopenharmony_ci 131862306a36Sopenharmony_ci vc_map = FORE200E_VC_MAP(fore200e, vpi, vci); 131962306a36Sopenharmony_ci if (vc_map->vcc) { 132062306a36Sopenharmony_ci 132162306a36Sopenharmony_ci spin_unlock_irqrestore(&fore200e->q_lock, flags); 132262306a36Sopenharmony_ci 132362306a36Sopenharmony_ci printk(FORE200E "VC %d.%d.%d already in use\n", 132462306a36Sopenharmony_ci fore200e->atm_dev->number, vpi, vci); 132562306a36Sopenharmony_ci 132662306a36Sopenharmony_ci return -EINVAL; 132762306a36Sopenharmony_ci } 132862306a36Sopenharmony_ci 132962306a36Sopenharmony_ci vc_map->vcc = vcc; 133062306a36Sopenharmony_ci 133162306a36Sopenharmony_ci spin_unlock_irqrestore(&fore200e->q_lock, flags); 133262306a36Sopenharmony_ci 133362306a36Sopenharmony_ci fore200e_vcc = kzalloc(sizeof(struct fore200e_vcc), GFP_ATOMIC); 133462306a36Sopenharmony_ci if (fore200e_vcc == NULL) { 133562306a36Sopenharmony_ci vc_map->vcc = NULL; 133662306a36Sopenharmony_ci return -ENOMEM; 133762306a36Sopenharmony_ci } 133862306a36Sopenharmony_ci 133962306a36Sopenharmony_ci DPRINTK(2, "opening %d.%d.%d:%d QoS = (tx: cl=%s, pcr=%d-%d, cdv=%d, max_sdu=%d; " 134062306a36Sopenharmony_ci "rx: cl=%s, pcr=%d-%d, cdv=%d, max_sdu=%d)\n", 134162306a36Sopenharmony_ci vcc->itf, vcc->vpi, vcc->vci, fore200e_atm2fore_aal(vcc->qos.aal), 134262306a36Sopenharmony_ci fore200e_traffic_class[ vcc->qos.txtp.traffic_class ], 134362306a36Sopenharmony_ci vcc->qos.txtp.min_pcr, vcc->qos.txtp.max_pcr, vcc->qos.txtp.max_cdv, vcc->qos.txtp.max_sdu, 134462306a36Sopenharmony_ci fore200e_traffic_class[ vcc->qos.rxtp.traffic_class ], 134562306a36Sopenharmony_ci vcc->qos.rxtp.min_pcr, vcc->qos.rxtp.max_pcr, vcc->qos.rxtp.max_cdv, vcc->qos.rxtp.max_sdu); 134662306a36Sopenharmony_ci 134762306a36Sopenharmony_ci /* pseudo-CBR bandwidth requested? */ 134862306a36Sopenharmony_ci if ((vcc->qos.txtp.traffic_class == ATM_CBR) && (vcc->qos.txtp.max_pcr > 0)) { 134962306a36Sopenharmony_ci 135062306a36Sopenharmony_ci mutex_lock(&fore200e->rate_mtx); 135162306a36Sopenharmony_ci if (fore200e->available_cell_rate < vcc->qos.txtp.max_pcr) { 135262306a36Sopenharmony_ci mutex_unlock(&fore200e->rate_mtx); 135362306a36Sopenharmony_ci 135462306a36Sopenharmony_ci kfree(fore200e_vcc); 135562306a36Sopenharmony_ci vc_map->vcc = NULL; 135662306a36Sopenharmony_ci return -EAGAIN; 135762306a36Sopenharmony_ci } 135862306a36Sopenharmony_ci 135962306a36Sopenharmony_ci /* reserve bandwidth */ 136062306a36Sopenharmony_ci fore200e->available_cell_rate -= vcc->qos.txtp.max_pcr; 136162306a36Sopenharmony_ci mutex_unlock(&fore200e->rate_mtx); 136262306a36Sopenharmony_ci } 136362306a36Sopenharmony_ci 136462306a36Sopenharmony_ci vcc->itf = vcc->dev->number; 136562306a36Sopenharmony_ci 136662306a36Sopenharmony_ci set_bit(ATM_VF_PARTIAL,&vcc->flags); 136762306a36Sopenharmony_ci set_bit(ATM_VF_ADDR, &vcc->flags); 136862306a36Sopenharmony_ci 136962306a36Sopenharmony_ci vcc->dev_data = fore200e_vcc; 137062306a36Sopenharmony_ci 137162306a36Sopenharmony_ci if (fore200e_activate_vcin(fore200e, 1, vcc, vcc->qos.rxtp.max_sdu) < 0) { 137262306a36Sopenharmony_ci 137362306a36Sopenharmony_ci vc_map->vcc = NULL; 137462306a36Sopenharmony_ci 137562306a36Sopenharmony_ci clear_bit(ATM_VF_ADDR, &vcc->flags); 137662306a36Sopenharmony_ci clear_bit(ATM_VF_PARTIAL,&vcc->flags); 137762306a36Sopenharmony_ci 137862306a36Sopenharmony_ci vcc->dev_data = NULL; 137962306a36Sopenharmony_ci 138062306a36Sopenharmony_ci fore200e->available_cell_rate += vcc->qos.txtp.max_pcr; 138162306a36Sopenharmony_ci 138262306a36Sopenharmony_ci kfree(fore200e_vcc); 138362306a36Sopenharmony_ci return -EINVAL; 138462306a36Sopenharmony_ci } 138562306a36Sopenharmony_ci 138662306a36Sopenharmony_ci /* compute rate control parameters */ 138762306a36Sopenharmony_ci if ((vcc->qos.txtp.traffic_class == ATM_CBR) && (vcc->qos.txtp.max_pcr > 0)) { 138862306a36Sopenharmony_ci 138962306a36Sopenharmony_ci fore200e_rate_ctrl(&vcc->qos, &fore200e_vcc->rate); 139062306a36Sopenharmony_ci set_bit(ATM_VF_HASQOS, &vcc->flags); 139162306a36Sopenharmony_ci 139262306a36Sopenharmony_ci DPRINTK(3, "tx on %d.%d.%d:%d, tx PCR = %d, rx PCR = %d, data_cells = %u, idle_cells = %u\n", 139362306a36Sopenharmony_ci vcc->itf, vcc->vpi, vcc->vci, fore200e_atm2fore_aal(vcc->qos.aal), 139462306a36Sopenharmony_ci vcc->qos.txtp.max_pcr, vcc->qos.rxtp.max_pcr, 139562306a36Sopenharmony_ci fore200e_vcc->rate.data_cells, fore200e_vcc->rate.idle_cells); 139662306a36Sopenharmony_ci } 139762306a36Sopenharmony_ci 139862306a36Sopenharmony_ci fore200e_vcc->tx_min_pdu = fore200e_vcc->rx_min_pdu = MAX_PDU_SIZE + 1; 139962306a36Sopenharmony_ci fore200e_vcc->tx_max_pdu = fore200e_vcc->rx_max_pdu = 0; 140062306a36Sopenharmony_ci fore200e_vcc->tx_pdu = fore200e_vcc->rx_pdu = 0; 140162306a36Sopenharmony_ci 140262306a36Sopenharmony_ci /* new incarnation of the vcc */ 140362306a36Sopenharmony_ci vc_map->incarn = ++fore200e->incarn_count; 140462306a36Sopenharmony_ci 140562306a36Sopenharmony_ci /* VC unusable before this flag is set */ 140662306a36Sopenharmony_ci set_bit(ATM_VF_READY, &vcc->flags); 140762306a36Sopenharmony_ci 140862306a36Sopenharmony_ci return 0; 140962306a36Sopenharmony_ci} 141062306a36Sopenharmony_ci 141162306a36Sopenharmony_ci 141262306a36Sopenharmony_cistatic void 141362306a36Sopenharmony_cifore200e_close(struct atm_vcc* vcc) 141462306a36Sopenharmony_ci{ 141562306a36Sopenharmony_ci struct fore200e_vcc* fore200e_vcc; 141662306a36Sopenharmony_ci struct fore200e* fore200e; 141762306a36Sopenharmony_ci struct fore200e_vc_map* vc_map; 141862306a36Sopenharmony_ci unsigned long flags; 141962306a36Sopenharmony_ci 142062306a36Sopenharmony_ci ASSERT(vcc); 142162306a36Sopenharmony_ci fore200e = FORE200E_DEV(vcc->dev); 142262306a36Sopenharmony_ci 142362306a36Sopenharmony_ci ASSERT((vcc->vpi >= 0) && (vcc->vpi < 1<<FORE200E_VPI_BITS)); 142462306a36Sopenharmony_ci ASSERT((vcc->vci >= 0) && (vcc->vci < 1<<FORE200E_VCI_BITS)); 142562306a36Sopenharmony_ci 142662306a36Sopenharmony_ci DPRINTK(2, "closing %d.%d.%d:%d\n", vcc->itf, vcc->vpi, vcc->vci, fore200e_atm2fore_aal(vcc->qos.aal)); 142762306a36Sopenharmony_ci 142862306a36Sopenharmony_ci clear_bit(ATM_VF_READY, &vcc->flags); 142962306a36Sopenharmony_ci 143062306a36Sopenharmony_ci fore200e_activate_vcin(fore200e, 0, vcc, 0); 143162306a36Sopenharmony_ci 143262306a36Sopenharmony_ci spin_lock_irqsave(&fore200e->q_lock, flags); 143362306a36Sopenharmony_ci 143462306a36Sopenharmony_ci vc_map = FORE200E_VC_MAP(fore200e, vcc->vpi, vcc->vci); 143562306a36Sopenharmony_ci 143662306a36Sopenharmony_ci /* the vc is no longer considered as "in use" by fore200e_open() */ 143762306a36Sopenharmony_ci vc_map->vcc = NULL; 143862306a36Sopenharmony_ci 143962306a36Sopenharmony_ci vcc->itf = vcc->vci = vcc->vpi = 0; 144062306a36Sopenharmony_ci 144162306a36Sopenharmony_ci fore200e_vcc = FORE200E_VCC(vcc); 144262306a36Sopenharmony_ci vcc->dev_data = NULL; 144362306a36Sopenharmony_ci 144462306a36Sopenharmony_ci spin_unlock_irqrestore(&fore200e->q_lock, flags); 144562306a36Sopenharmony_ci 144662306a36Sopenharmony_ci /* release reserved bandwidth, if any */ 144762306a36Sopenharmony_ci if ((vcc->qos.txtp.traffic_class == ATM_CBR) && (vcc->qos.txtp.max_pcr > 0)) { 144862306a36Sopenharmony_ci 144962306a36Sopenharmony_ci mutex_lock(&fore200e->rate_mtx); 145062306a36Sopenharmony_ci fore200e->available_cell_rate += vcc->qos.txtp.max_pcr; 145162306a36Sopenharmony_ci mutex_unlock(&fore200e->rate_mtx); 145262306a36Sopenharmony_ci 145362306a36Sopenharmony_ci clear_bit(ATM_VF_HASQOS, &vcc->flags); 145462306a36Sopenharmony_ci } 145562306a36Sopenharmony_ci 145662306a36Sopenharmony_ci clear_bit(ATM_VF_ADDR, &vcc->flags); 145762306a36Sopenharmony_ci clear_bit(ATM_VF_PARTIAL,&vcc->flags); 145862306a36Sopenharmony_ci 145962306a36Sopenharmony_ci ASSERT(fore200e_vcc); 146062306a36Sopenharmony_ci kfree(fore200e_vcc); 146162306a36Sopenharmony_ci} 146262306a36Sopenharmony_ci 146362306a36Sopenharmony_ci 146462306a36Sopenharmony_cistatic int 146562306a36Sopenharmony_cifore200e_send(struct atm_vcc *vcc, struct sk_buff *skb) 146662306a36Sopenharmony_ci{ 146762306a36Sopenharmony_ci struct fore200e* fore200e; 146862306a36Sopenharmony_ci struct fore200e_vcc* fore200e_vcc; 146962306a36Sopenharmony_ci struct fore200e_vc_map* vc_map; 147062306a36Sopenharmony_ci struct host_txq* txq; 147162306a36Sopenharmony_ci struct host_txq_entry* entry; 147262306a36Sopenharmony_ci struct tpd* tpd; 147362306a36Sopenharmony_ci struct tpd_haddr tpd_haddr; 147462306a36Sopenharmony_ci int retry = CONFIG_ATM_FORE200E_TX_RETRY; 147562306a36Sopenharmony_ci int tx_copy = 0; 147662306a36Sopenharmony_ci int tx_len = skb->len; 147762306a36Sopenharmony_ci u32* cell_header = NULL; 147862306a36Sopenharmony_ci unsigned char* skb_data; 147962306a36Sopenharmony_ci int skb_len; 148062306a36Sopenharmony_ci unsigned char* data; 148162306a36Sopenharmony_ci unsigned long flags; 148262306a36Sopenharmony_ci 148362306a36Sopenharmony_ci if (!vcc) 148462306a36Sopenharmony_ci return -EINVAL; 148562306a36Sopenharmony_ci 148662306a36Sopenharmony_ci fore200e = FORE200E_DEV(vcc->dev); 148762306a36Sopenharmony_ci fore200e_vcc = FORE200E_VCC(vcc); 148862306a36Sopenharmony_ci 148962306a36Sopenharmony_ci if (!fore200e) 149062306a36Sopenharmony_ci return -EINVAL; 149162306a36Sopenharmony_ci 149262306a36Sopenharmony_ci txq = &fore200e->host_txq; 149362306a36Sopenharmony_ci if (!fore200e_vcc) 149462306a36Sopenharmony_ci return -EINVAL; 149562306a36Sopenharmony_ci 149662306a36Sopenharmony_ci if (!test_bit(ATM_VF_READY, &vcc->flags)) { 149762306a36Sopenharmony_ci DPRINTK(1, "VC %d.%d.%d not ready for tx\n", vcc->itf, vcc->vpi, vcc->vpi); 149862306a36Sopenharmony_ci dev_kfree_skb_any(skb); 149962306a36Sopenharmony_ci return -EINVAL; 150062306a36Sopenharmony_ci } 150162306a36Sopenharmony_ci 150262306a36Sopenharmony_ci#ifdef FORE200E_52BYTE_AAL0_SDU 150362306a36Sopenharmony_ci if ((vcc->qos.aal == ATM_AAL0) && (vcc->qos.txtp.max_sdu == ATM_AAL0_SDU)) { 150462306a36Sopenharmony_ci cell_header = (u32*) skb->data; 150562306a36Sopenharmony_ci skb_data = skb->data + 4; /* skip 4-byte cell header */ 150662306a36Sopenharmony_ci skb_len = tx_len = skb->len - 4; 150762306a36Sopenharmony_ci 150862306a36Sopenharmony_ci DPRINTK(3, "user-supplied cell header = 0x%08x\n", *cell_header); 150962306a36Sopenharmony_ci } 151062306a36Sopenharmony_ci else 151162306a36Sopenharmony_ci#endif 151262306a36Sopenharmony_ci { 151362306a36Sopenharmony_ci skb_data = skb->data; 151462306a36Sopenharmony_ci skb_len = skb->len; 151562306a36Sopenharmony_ci } 151662306a36Sopenharmony_ci 151762306a36Sopenharmony_ci if (((unsigned long)skb_data) & 0x3) { 151862306a36Sopenharmony_ci 151962306a36Sopenharmony_ci DPRINTK(2, "misaligned tx PDU on device %s\n", fore200e->name); 152062306a36Sopenharmony_ci tx_copy = 1; 152162306a36Sopenharmony_ci tx_len = skb_len; 152262306a36Sopenharmony_ci } 152362306a36Sopenharmony_ci 152462306a36Sopenharmony_ci if ((vcc->qos.aal == ATM_AAL0) && (skb_len % ATM_CELL_PAYLOAD)) { 152562306a36Sopenharmony_ci 152662306a36Sopenharmony_ci /* this simply NUKES the PCA board */ 152762306a36Sopenharmony_ci DPRINTK(2, "incomplete tx AAL0 PDU on device %s\n", fore200e->name); 152862306a36Sopenharmony_ci tx_copy = 1; 152962306a36Sopenharmony_ci tx_len = ((skb_len / ATM_CELL_PAYLOAD) + 1) * ATM_CELL_PAYLOAD; 153062306a36Sopenharmony_ci } 153162306a36Sopenharmony_ci 153262306a36Sopenharmony_ci if (tx_copy) { 153362306a36Sopenharmony_ci data = kmalloc(tx_len, GFP_ATOMIC); 153462306a36Sopenharmony_ci if (data == NULL) { 153562306a36Sopenharmony_ci if (vcc->pop) { 153662306a36Sopenharmony_ci vcc->pop(vcc, skb); 153762306a36Sopenharmony_ci } 153862306a36Sopenharmony_ci else { 153962306a36Sopenharmony_ci dev_kfree_skb_any(skb); 154062306a36Sopenharmony_ci } 154162306a36Sopenharmony_ci return -ENOMEM; 154262306a36Sopenharmony_ci } 154362306a36Sopenharmony_ci 154462306a36Sopenharmony_ci memcpy(data, skb_data, skb_len); 154562306a36Sopenharmony_ci if (skb_len < tx_len) 154662306a36Sopenharmony_ci memset(data + skb_len, 0x00, tx_len - skb_len); 154762306a36Sopenharmony_ci } 154862306a36Sopenharmony_ci else { 154962306a36Sopenharmony_ci data = skb_data; 155062306a36Sopenharmony_ci } 155162306a36Sopenharmony_ci 155262306a36Sopenharmony_ci vc_map = FORE200E_VC_MAP(fore200e, vcc->vpi, vcc->vci); 155362306a36Sopenharmony_ci ASSERT(vc_map->vcc == vcc); 155462306a36Sopenharmony_ci 155562306a36Sopenharmony_ci retry_here: 155662306a36Sopenharmony_ci 155762306a36Sopenharmony_ci spin_lock_irqsave(&fore200e->q_lock, flags); 155862306a36Sopenharmony_ci 155962306a36Sopenharmony_ci entry = &txq->host_entry[ txq->head ]; 156062306a36Sopenharmony_ci 156162306a36Sopenharmony_ci if ((*entry->status != STATUS_FREE) || (txq->txing >= QUEUE_SIZE_TX - 2)) { 156262306a36Sopenharmony_ci 156362306a36Sopenharmony_ci /* try to free completed tx queue entries */ 156462306a36Sopenharmony_ci fore200e_tx_irq(fore200e); 156562306a36Sopenharmony_ci 156662306a36Sopenharmony_ci if (*entry->status != STATUS_FREE) { 156762306a36Sopenharmony_ci 156862306a36Sopenharmony_ci spin_unlock_irqrestore(&fore200e->q_lock, flags); 156962306a36Sopenharmony_ci 157062306a36Sopenharmony_ci /* retry once again? */ 157162306a36Sopenharmony_ci if (--retry > 0) { 157262306a36Sopenharmony_ci udelay(50); 157362306a36Sopenharmony_ci goto retry_here; 157462306a36Sopenharmony_ci } 157562306a36Sopenharmony_ci 157662306a36Sopenharmony_ci atomic_inc(&vcc->stats->tx_err); 157762306a36Sopenharmony_ci 157862306a36Sopenharmony_ci fore200e->tx_sat++; 157962306a36Sopenharmony_ci DPRINTK(2, "tx queue of device %s is saturated, PDU dropped - heartbeat is %08x\n", 158062306a36Sopenharmony_ci fore200e->name, fore200e->cp_queues->heartbeat); 158162306a36Sopenharmony_ci if (vcc->pop) { 158262306a36Sopenharmony_ci vcc->pop(vcc, skb); 158362306a36Sopenharmony_ci } 158462306a36Sopenharmony_ci else { 158562306a36Sopenharmony_ci dev_kfree_skb_any(skb); 158662306a36Sopenharmony_ci } 158762306a36Sopenharmony_ci 158862306a36Sopenharmony_ci if (tx_copy) 158962306a36Sopenharmony_ci kfree(data); 159062306a36Sopenharmony_ci 159162306a36Sopenharmony_ci return -ENOBUFS; 159262306a36Sopenharmony_ci } 159362306a36Sopenharmony_ci } 159462306a36Sopenharmony_ci 159562306a36Sopenharmony_ci entry->incarn = vc_map->incarn; 159662306a36Sopenharmony_ci entry->vc_map = vc_map; 159762306a36Sopenharmony_ci entry->skb = skb; 159862306a36Sopenharmony_ci entry->data = tx_copy ? data : NULL; 159962306a36Sopenharmony_ci 160062306a36Sopenharmony_ci tpd = entry->tpd; 160162306a36Sopenharmony_ci tpd->tsd[ 0 ].buffer = dma_map_single(fore200e->dev, data, tx_len, 160262306a36Sopenharmony_ci DMA_TO_DEVICE); 160362306a36Sopenharmony_ci if (dma_mapping_error(fore200e->dev, tpd->tsd[0].buffer)) { 160462306a36Sopenharmony_ci if (tx_copy) 160562306a36Sopenharmony_ci kfree(data); 160662306a36Sopenharmony_ci spin_unlock_irqrestore(&fore200e->q_lock, flags); 160762306a36Sopenharmony_ci return -ENOMEM; 160862306a36Sopenharmony_ci } 160962306a36Sopenharmony_ci tpd->tsd[ 0 ].length = tx_len; 161062306a36Sopenharmony_ci 161162306a36Sopenharmony_ci FORE200E_NEXT_ENTRY(txq->head, QUEUE_SIZE_TX); 161262306a36Sopenharmony_ci txq->txing++; 161362306a36Sopenharmony_ci 161462306a36Sopenharmony_ci /* The dma_map call above implies a dma_sync so the device can use it, 161562306a36Sopenharmony_ci * thus no explicit dma_sync call is necessary here. 161662306a36Sopenharmony_ci */ 161762306a36Sopenharmony_ci 161862306a36Sopenharmony_ci DPRINTK(3, "tx on %d.%d.%d:%d, len = %u (%u)\n", 161962306a36Sopenharmony_ci vcc->itf, vcc->vpi, vcc->vci, fore200e_atm2fore_aal(vcc->qos.aal), 162062306a36Sopenharmony_ci tpd->tsd[0].length, skb_len); 162162306a36Sopenharmony_ci 162262306a36Sopenharmony_ci if (skb_len < fore200e_vcc->tx_min_pdu) 162362306a36Sopenharmony_ci fore200e_vcc->tx_min_pdu = skb_len; 162462306a36Sopenharmony_ci if (skb_len > fore200e_vcc->tx_max_pdu) 162562306a36Sopenharmony_ci fore200e_vcc->tx_max_pdu = skb_len; 162662306a36Sopenharmony_ci fore200e_vcc->tx_pdu++; 162762306a36Sopenharmony_ci 162862306a36Sopenharmony_ci /* set tx rate control information */ 162962306a36Sopenharmony_ci tpd->rate.data_cells = fore200e_vcc->rate.data_cells; 163062306a36Sopenharmony_ci tpd->rate.idle_cells = fore200e_vcc->rate.idle_cells; 163162306a36Sopenharmony_ci 163262306a36Sopenharmony_ci if (cell_header) { 163362306a36Sopenharmony_ci tpd->atm_header.clp = (*cell_header & ATM_HDR_CLP); 163462306a36Sopenharmony_ci tpd->atm_header.plt = (*cell_header & ATM_HDR_PTI_MASK) >> ATM_HDR_PTI_SHIFT; 163562306a36Sopenharmony_ci tpd->atm_header.vci = (*cell_header & ATM_HDR_VCI_MASK) >> ATM_HDR_VCI_SHIFT; 163662306a36Sopenharmony_ci tpd->atm_header.vpi = (*cell_header & ATM_HDR_VPI_MASK) >> ATM_HDR_VPI_SHIFT; 163762306a36Sopenharmony_ci tpd->atm_header.gfc = (*cell_header & ATM_HDR_GFC_MASK) >> ATM_HDR_GFC_SHIFT; 163862306a36Sopenharmony_ci } 163962306a36Sopenharmony_ci else { 164062306a36Sopenharmony_ci /* set the ATM header, common to all cells conveying the PDU */ 164162306a36Sopenharmony_ci tpd->atm_header.clp = 0; 164262306a36Sopenharmony_ci tpd->atm_header.plt = 0; 164362306a36Sopenharmony_ci tpd->atm_header.vci = vcc->vci; 164462306a36Sopenharmony_ci tpd->atm_header.vpi = vcc->vpi; 164562306a36Sopenharmony_ci tpd->atm_header.gfc = 0; 164662306a36Sopenharmony_ci } 164762306a36Sopenharmony_ci 164862306a36Sopenharmony_ci tpd->spec.length = tx_len; 164962306a36Sopenharmony_ci tpd->spec.nseg = 1; 165062306a36Sopenharmony_ci tpd->spec.aal = fore200e_atm2fore_aal(vcc->qos.aal); 165162306a36Sopenharmony_ci tpd->spec.intr = 1; 165262306a36Sopenharmony_ci 165362306a36Sopenharmony_ci tpd_haddr.size = sizeof(struct tpd) / (1<<TPD_HADDR_SHIFT); /* size is expressed in 32 byte blocks */ 165462306a36Sopenharmony_ci tpd_haddr.pad = 0; 165562306a36Sopenharmony_ci tpd_haddr.haddr = entry->tpd_dma >> TPD_HADDR_SHIFT; /* shift the address, as we are in a bitfield */ 165662306a36Sopenharmony_ci 165762306a36Sopenharmony_ci *entry->status = STATUS_PENDING; 165862306a36Sopenharmony_ci fore200e->bus->write(*(u32*)&tpd_haddr, (u32 __iomem *)&entry->cp_entry->tpd_haddr); 165962306a36Sopenharmony_ci 166062306a36Sopenharmony_ci spin_unlock_irqrestore(&fore200e->q_lock, flags); 166162306a36Sopenharmony_ci 166262306a36Sopenharmony_ci return 0; 166362306a36Sopenharmony_ci} 166462306a36Sopenharmony_ci 166562306a36Sopenharmony_ci 166662306a36Sopenharmony_cistatic int 166762306a36Sopenharmony_cifore200e_getstats(struct fore200e* fore200e) 166862306a36Sopenharmony_ci{ 166962306a36Sopenharmony_ci struct host_cmdq* cmdq = &fore200e->host_cmdq; 167062306a36Sopenharmony_ci struct host_cmdq_entry* entry = &cmdq->host_entry[ cmdq->head ]; 167162306a36Sopenharmony_ci struct stats_opcode opcode; 167262306a36Sopenharmony_ci int ok; 167362306a36Sopenharmony_ci u32 stats_dma_addr; 167462306a36Sopenharmony_ci 167562306a36Sopenharmony_ci if (fore200e->stats == NULL) { 167662306a36Sopenharmony_ci fore200e->stats = kzalloc(sizeof(struct stats), GFP_KERNEL); 167762306a36Sopenharmony_ci if (fore200e->stats == NULL) 167862306a36Sopenharmony_ci return -ENOMEM; 167962306a36Sopenharmony_ci } 168062306a36Sopenharmony_ci 168162306a36Sopenharmony_ci stats_dma_addr = dma_map_single(fore200e->dev, fore200e->stats, 168262306a36Sopenharmony_ci sizeof(struct stats), DMA_FROM_DEVICE); 168362306a36Sopenharmony_ci if (dma_mapping_error(fore200e->dev, stats_dma_addr)) 168462306a36Sopenharmony_ci return -ENOMEM; 168562306a36Sopenharmony_ci 168662306a36Sopenharmony_ci FORE200E_NEXT_ENTRY(cmdq->head, QUEUE_SIZE_CMD); 168762306a36Sopenharmony_ci 168862306a36Sopenharmony_ci opcode.opcode = OPCODE_GET_STATS; 168962306a36Sopenharmony_ci opcode.pad = 0; 169062306a36Sopenharmony_ci 169162306a36Sopenharmony_ci fore200e->bus->write(stats_dma_addr, &entry->cp_entry->cmd.stats_block.stats_haddr); 169262306a36Sopenharmony_ci 169362306a36Sopenharmony_ci *entry->status = STATUS_PENDING; 169462306a36Sopenharmony_ci 169562306a36Sopenharmony_ci fore200e->bus->write(*(u32*)&opcode, (u32 __iomem *)&entry->cp_entry->cmd.stats_block.opcode); 169662306a36Sopenharmony_ci 169762306a36Sopenharmony_ci ok = fore200e_poll(fore200e, entry->status, STATUS_COMPLETE, 400); 169862306a36Sopenharmony_ci 169962306a36Sopenharmony_ci *entry->status = STATUS_FREE; 170062306a36Sopenharmony_ci 170162306a36Sopenharmony_ci dma_unmap_single(fore200e->dev, stats_dma_addr, sizeof(struct stats), DMA_FROM_DEVICE); 170262306a36Sopenharmony_ci 170362306a36Sopenharmony_ci if (ok == 0) { 170462306a36Sopenharmony_ci printk(FORE200E "unable to get statistics from device %s\n", fore200e->name); 170562306a36Sopenharmony_ci return -EIO; 170662306a36Sopenharmony_ci } 170762306a36Sopenharmony_ci 170862306a36Sopenharmony_ci return 0; 170962306a36Sopenharmony_ci} 171062306a36Sopenharmony_ci 171162306a36Sopenharmony_ci#if 0 /* currently unused */ 171262306a36Sopenharmony_cistatic int 171362306a36Sopenharmony_cifore200e_get_oc3(struct fore200e* fore200e, struct oc3_regs* regs) 171462306a36Sopenharmony_ci{ 171562306a36Sopenharmony_ci struct host_cmdq* cmdq = &fore200e->host_cmdq; 171662306a36Sopenharmony_ci struct host_cmdq_entry* entry = &cmdq->host_entry[ cmdq->head ]; 171762306a36Sopenharmony_ci struct oc3_opcode opcode; 171862306a36Sopenharmony_ci int ok; 171962306a36Sopenharmony_ci u32 oc3_regs_dma_addr; 172062306a36Sopenharmony_ci 172162306a36Sopenharmony_ci oc3_regs_dma_addr = fore200e->bus->dma_map(fore200e, regs, sizeof(struct oc3_regs), DMA_FROM_DEVICE); 172262306a36Sopenharmony_ci 172362306a36Sopenharmony_ci FORE200E_NEXT_ENTRY(cmdq->head, QUEUE_SIZE_CMD); 172462306a36Sopenharmony_ci 172562306a36Sopenharmony_ci opcode.opcode = OPCODE_GET_OC3; 172662306a36Sopenharmony_ci opcode.reg = 0; 172762306a36Sopenharmony_ci opcode.value = 0; 172862306a36Sopenharmony_ci opcode.mask = 0; 172962306a36Sopenharmony_ci 173062306a36Sopenharmony_ci fore200e->bus->write(oc3_regs_dma_addr, &entry->cp_entry->cmd.oc3_block.regs_haddr); 173162306a36Sopenharmony_ci 173262306a36Sopenharmony_ci *entry->status = STATUS_PENDING; 173362306a36Sopenharmony_ci 173462306a36Sopenharmony_ci fore200e->bus->write(*(u32*)&opcode, (u32*)&entry->cp_entry->cmd.oc3_block.opcode); 173562306a36Sopenharmony_ci 173662306a36Sopenharmony_ci ok = fore200e_poll(fore200e, entry->status, STATUS_COMPLETE, 400); 173762306a36Sopenharmony_ci 173862306a36Sopenharmony_ci *entry->status = STATUS_FREE; 173962306a36Sopenharmony_ci 174062306a36Sopenharmony_ci fore200e->bus->dma_unmap(fore200e, oc3_regs_dma_addr, sizeof(struct oc3_regs), DMA_FROM_DEVICE); 174162306a36Sopenharmony_ci 174262306a36Sopenharmony_ci if (ok == 0) { 174362306a36Sopenharmony_ci printk(FORE200E "unable to get OC-3 regs of device %s\n", fore200e->name); 174462306a36Sopenharmony_ci return -EIO; 174562306a36Sopenharmony_ci } 174662306a36Sopenharmony_ci 174762306a36Sopenharmony_ci return 0; 174862306a36Sopenharmony_ci} 174962306a36Sopenharmony_ci#endif 175062306a36Sopenharmony_ci 175162306a36Sopenharmony_ci 175262306a36Sopenharmony_cistatic int 175362306a36Sopenharmony_cifore200e_set_oc3(struct fore200e* fore200e, u32 reg, u32 value, u32 mask) 175462306a36Sopenharmony_ci{ 175562306a36Sopenharmony_ci struct host_cmdq* cmdq = &fore200e->host_cmdq; 175662306a36Sopenharmony_ci struct host_cmdq_entry* entry = &cmdq->host_entry[ cmdq->head ]; 175762306a36Sopenharmony_ci struct oc3_opcode opcode; 175862306a36Sopenharmony_ci int ok; 175962306a36Sopenharmony_ci 176062306a36Sopenharmony_ci DPRINTK(2, "set OC-3 reg = 0x%02x, value = 0x%02x, mask = 0x%02x\n", reg, value, mask); 176162306a36Sopenharmony_ci 176262306a36Sopenharmony_ci FORE200E_NEXT_ENTRY(cmdq->head, QUEUE_SIZE_CMD); 176362306a36Sopenharmony_ci 176462306a36Sopenharmony_ci opcode.opcode = OPCODE_SET_OC3; 176562306a36Sopenharmony_ci opcode.reg = reg; 176662306a36Sopenharmony_ci opcode.value = value; 176762306a36Sopenharmony_ci opcode.mask = mask; 176862306a36Sopenharmony_ci 176962306a36Sopenharmony_ci fore200e->bus->write(0, &entry->cp_entry->cmd.oc3_block.regs_haddr); 177062306a36Sopenharmony_ci 177162306a36Sopenharmony_ci *entry->status = STATUS_PENDING; 177262306a36Sopenharmony_ci 177362306a36Sopenharmony_ci fore200e->bus->write(*(u32*)&opcode, (u32 __iomem *)&entry->cp_entry->cmd.oc3_block.opcode); 177462306a36Sopenharmony_ci 177562306a36Sopenharmony_ci ok = fore200e_poll(fore200e, entry->status, STATUS_COMPLETE, 400); 177662306a36Sopenharmony_ci 177762306a36Sopenharmony_ci *entry->status = STATUS_FREE; 177862306a36Sopenharmony_ci 177962306a36Sopenharmony_ci if (ok == 0) { 178062306a36Sopenharmony_ci printk(FORE200E "unable to set OC-3 reg 0x%02x of device %s\n", reg, fore200e->name); 178162306a36Sopenharmony_ci return -EIO; 178262306a36Sopenharmony_ci } 178362306a36Sopenharmony_ci 178462306a36Sopenharmony_ci return 0; 178562306a36Sopenharmony_ci} 178662306a36Sopenharmony_ci 178762306a36Sopenharmony_ci 178862306a36Sopenharmony_cistatic int 178962306a36Sopenharmony_cifore200e_setloop(struct fore200e* fore200e, int loop_mode) 179062306a36Sopenharmony_ci{ 179162306a36Sopenharmony_ci u32 mct_value, mct_mask; 179262306a36Sopenharmony_ci int error; 179362306a36Sopenharmony_ci 179462306a36Sopenharmony_ci if (!capable(CAP_NET_ADMIN)) 179562306a36Sopenharmony_ci return -EPERM; 179662306a36Sopenharmony_ci 179762306a36Sopenharmony_ci switch (loop_mode) { 179862306a36Sopenharmony_ci 179962306a36Sopenharmony_ci case ATM_LM_NONE: 180062306a36Sopenharmony_ci mct_value = 0; 180162306a36Sopenharmony_ci mct_mask = SUNI_MCT_DLE | SUNI_MCT_LLE; 180262306a36Sopenharmony_ci break; 180362306a36Sopenharmony_ci 180462306a36Sopenharmony_ci case ATM_LM_LOC_PHY: 180562306a36Sopenharmony_ci mct_value = mct_mask = SUNI_MCT_DLE; 180662306a36Sopenharmony_ci break; 180762306a36Sopenharmony_ci 180862306a36Sopenharmony_ci case ATM_LM_RMT_PHY: 180962306a36Sopenharmony_ci mct_value = mct_mask = SUNI_MCT_LLE; 181062306a36Sopenharmony_ci break; 181162306a36Sopenharmony_ci 181262306a36Sopenharmony_ci default: 181362306a36Sopenharmony_ci return -EINVAL; 181462306a36Sopenharmony_ci } 181562306a36Sopenharmony_ci 181662306a36Sopenharmony_ci error = fore200e_set_oc3(fore200e, SUNI_MCT, mct_value, mct_mask); 181762306a36Sopenharmony_ci if (error == 0) 181862306a36Sopenharmony_ci fore200e->loop_mode = loop_mode; 181962306a36Sopenharmony_ci 182062306a36Sopenharmony_ci return error; 182162306a36Sopenharmony_ci} 182262306a36Sopenharmony_ci 182362306a36Sopenharmony_ci 182462306a36Sopenharmony_cistatic int 182562306a36Sopenharmony_cifore200e_fetch_stats(struct fore200e* fore200e, struct sonet_stats __user *arg) 182662306a36Sopenharmony_ci{ 182762306a36Sopenharmony_ci struct sonet_stats tmp; 182862306a36Sopenharmony_ci 182962306a36Sopenharmony_ci if (fore200e_getstats(fore200e) < 0) 183062306a36Sopenharmony_ci return -EIO; 183162306a36Sopenharmony_ci 183262306a36Sopenharmony_ci tmp.section_bip = be32_to_cpu(fore200e->stats->oc3.section_bip8_errors); 183362306a36Sopenharmony_ci tmp.line_bip = be32_to_cpu(fore200e->stats->oc3.line_bip24_errors); 183462306a36Sopenharmony_ci tmp.path_bip = be32_to_cpu(fore200e->stats->oc3.path_bip8_errors); 183562306a36Sopenharmony_ci tmp.line_febe = be32_to_cpu(fore200e->stats->oc3.line_febe_errors); 183662306a36Sopenharmony_ci tmp.path_febe = be32_to_cpu(fore200e->stats->oc3.path_febe_errors); 183762306a36Sopenharmony_ci tmp.corr_hcs = be32_to_cpu(fore200e->stats->oc3.corr_hcs_errors); 183862306a36Sopenharmony_ci tmp.uncorr_hcs = be32_to_cpu(fore200e->stats->oc3.ucorr_hcs_errors); 183962306a36Sopenharmony_ci tmp.tx_cells = be32_to_cpu(fore200e->stats->aal0.cells_transmitted) + 184062306a36Sopenharmony_ci be32_to_cpu(fore200e->stats->aal34.cells_transmitted) + 184162306a36Sopenharmony_ci be32_to_cpu(fore200e->stats->aal5.cells_transmitted); 184262306a36Sopenharmony_ci tmp.rx_cells = be32_to_cpu(fore200e->stats->aal0.cells_received) + 184362306a36Sopenharmony_ci be32_to_cpu(fore200e->stats->aal34.cells_received) + 184462306a36Sopenharmony_ci be32_to_cpu(fore200e->stats->aal5.cells_received); 184562306a36Sopenharmony_ci 184662306a36Sopenharmony_ci if (arg) 184762306a36Sopenharmony_ci return copy_to_user(arg, &tmp, sizeof(struct sonet_stats)) ? -EFAULT : 0; 184862306a36Sopenharmony_ci 184962306a36Sopenharmony_ci return 0; 185062306a36Sopenharmony_ci} 185162306a36Sopenharmony_ci 185262306a36Sopenharmony_ci 185362306a36Sopenharmony_cistatic int 185462306a36Sopenharmony_cifore200e_ioctl(struct atm_dev* dev, unsigned int cmd, void __user * arg) 185562306a36Sopenharmony_ci{ 185662306a36Sopenharmony_ci struct fore200e* fore200e = FORE200E_DEV(dev); 185762306a36Sopenharmony_ci 185862306a36Sopenharmony_ci DPRINTK(2, "ioctl cmd = 0x%x (%u), arg = 0x%p (%lu)\n", cmd, cmd, arg, (unsigned long)arg); 185962306a36Sopenharmony_ci 186062306a36Sopenharmony_ci switch (cmd) { 186162306a36Sopenharmony_ci 186262306a36Sopenharmony_ci case SONET_GETSTAT: 186362306a36Sopenharmony_ci return fore200e_fetch_stats(fore200e, (struct sonet_stats __user *)arg); 186462306a36Sopenharmony_ci 186562306a36Sopenharmony_ci case SONET_GETDIAG: 186662306a36Sopenharmony_ci return put_user(0, (int __user *)arg) ? -EFAULT : 0; 186762306a36Sopenharmony_ci 186862306a36Sopenharmony_ci case ATM_SETLOOP: 186962306a36Sopenharmony_ci return fore200e_setloop(fore200e, (int)(unsigned long)arg); 187062306a36Sopenharmony_ci 187162306a36Sopenharmony_ci case ATM_GETLOOP: 187262306a36Sopenharmony_ci return put_user(fore200e->loop_mode, (int __user *)arg) ? -EFAULT : 0; 187362306a36Sopenharmony_ci 187462306a36Sopenharmony_ci case ATM_QUERYLOOP: 187562306a36Sopenharmony_ci return put_user(ATM_LM_LOC_PHY | ATM_LM_RMT_PHY, (int __user *)arg) ? -EFAULT : 0; 187662306a36Sopenharmony_ci } 187762306a36Sopenharmony_ci 187862306a36Sopenharmony_ci return -ENOSYS; /* not implemented */ 187962306a36Sopenharmony_ci} 188062306a36Sopenharmony_ci 188162306a36Sopenharmony_ci 188262306a36Sopenharmony_cistatic int 188362306a36Sopenharmony_cifore200e_change_qos(struct atm_vcc* vcc,struct atm_qos* qos, int flags) 188462306a36Sopenharmony_ci{ 188562306a36Sopenharmony_ci struct fore200e_vcc* fore200e_vcc = FORE200E_VCC(vcc); 188662306a36Sopenharmony_ci struct fore200e* fore200e = FORE200E_DEV(vcc->dev); 188762306a36Sopenharmony_ci 188862306a36Sopenharmony_ci if (!test_bit(ATM_VF_READY, &vcc->flags)) { 188962306a36Sopenharmony_ci DPRINTK(1, "VC %d.%d.%d not ready for QoS change\n", vcc->itf, vcc->vpi, vcc->vpi); 189062306a36Sopenharmony_ci return -EINVAL; 189162306a36Sopenharmony_ci } 189262306a36Sopenharmony_ci 189362306a36Sopenharmony_ci DPRINTK(2, "change_qos %d.%d.%d, " 189462306a36Sopenharmony_ci "(tx: cl=%s, pcr=%d-%d, cdv=%d, max_sdu=%d; " 189562306a36Sopenharmony_ci "rx: cl=%s, pcr=%d-%d, cdv=%d, max_sdu=%d), flags = 0x%x\n" 189662306a36Sopenharmony_ci "available_cell_rate = %u", 189762306a36Sopenharmony_ci vcc->itf, vcc->vpi, vcc->vci, 189862306a36Sopenharmony_ci fore200e_traffic_class[ qos->txtp.traffic_class ], 189962306a36Sopenharmony_ci qos->txtp.min_pcr, qos->txtp.max_pcr, qos->txtp.max_cdv, qos->txtp.max_sdu, 190062306a36Sopenharmony_ci fore200e_traffic_class[ qos->rxtp.traffic_class ], 190162306a36Sopenharmony_ci qos->rxtp.min_pcr, qos->rxtp.max_pcr, qos->rxtp.max_cdv, qos->rxtp.max_sdu, 190262306a36Sopenharmony_ci flags, fore200e->available_cell_rate); 190362306a36Sopenharmony_ci 190462306a36Sopenharmony_ci if ((qos->txtp.traffic_class == ATM_CBR) && (qos->txtp.max_pcr > 0)) { 190562306a36Sopenharmony_ci 190662306a36Sopenharmony_ci mutex_lock(&fore200e->rate_mtx); 190762306a36Sopenharmony_ci if (fore200e->available_cell_rate + vcc->qos.txtp.max_pcr < qos->txtp.max_pcr) { 190862306a36Sopenharmony_ci mutex_unlock(&fore200e->rate_mtx); 190962306a36Sopenharmony_ci return -EAGAIN; 191062306a36Sopenharmony_ci } 191162306a36Sopenharmony_ci 191262306a36Sopenharmony_ci fore200e->available_cell_rate += vcc->qos.txtp.max_pcr; 191362306a36Sopenharmony_ci fore200e->available_cell_rate -= qos->txtp.max_pcr; 191462306a36Sopenharmony_ci 191562306a36Sopenharmony_ci mutex_unlock(&fore200e->rate_mtx); 191662306a36Sopenharmony_ci 191762306a36Sopenharmony_ci memcpy(&vcc->qos, qos, sizeof(struct atm_qos)); 191862306a36Sopenharmony_ci 191962306a36Sopenharmony_ci /* update rate control parameters */ 192062306a36Sopenharmony_ci fore200e_rate_ctrl(qos, &fore200e_vcc->rate); 192162306a36Sopenharmony_ci 192262306a36Sopenharmony_ci set_bit(ATM_VF_HASQOS, &vcc->flags); 192362306a36Sopenharmony_ci 192462306a36Sopenharmony_ci return 0; 192562306a36Sopenharmony_ci } 192662306a36Sopenharmony_ci 192762306a36Sopenharmony_ci return -EINVAL; 192862306a36Sopenharmony_ci} 192962306a36Sopenharmony_ci 193062306a36Sopenharmony_ci 193162306a36Sopenharmony_cistatic int fore200e_irq_request(struct fore200e *fore200e) 193262306a36Sopenharmony_ci{ 193362306a36Sopenharmony_ci if (request_irq(fore200e->irq, fore200e_interrupt, IRQF_SHARED, fore200e->name, fore200e->atm_dev) < 0) { 193462306a36Sopenharmony_ci 193562306a36Sopenharmony_ci printk(FORE200E "unable to reserve IRQ %s for device %s\n", 193662306a36Sopenharmony_ci fore200e_irq_itoa(fore200e->irq), fore200e->name); 193762306a36Sopenharmony_ci return -EBUSY; 193862306a36Sopenharmony_ci } 193962306a36Sopenharmony_ci 194062306a36Sopenharmony_ci printk(FORE200E "IRQ %s reserved for device %s\n", 194162306a36Sopenharmony_ci fore200e_irq_itoa(fore200e->irq), fore200e->name); 194262306a36Sopenharmony_ci 194362306a36Sopenharmony_ci#ifdef FORE200E_USE_TASKLET 194462306a36Sopenharmony_ci tasklet_init(&fore200e->tx_tasklet, fore200e_tx_tasklet, (unsigned long)fore200e); 194562306a36Sopenharmony_ci tasklet_init(&fore200e->rx_tasklet, fore200e_rx_tasklet, (unsigned long)fore200e); 194662306a36Sopenharmony_ci#endif 194762306a36Sopenharmony_ci 194862306a36Sopenharmony_ci fore200e->state = FORE200E_STATE_IRQ; 194962306a36Sopenharmony_ci return 0; 195062306a36Sopenharmony_ci} 195162306a36Sopenharmony_ci 195262306a36Sopenharmony_ci 195362306a36Sopenharmony_cistatic int fore200e_get_esi(struct fore200e *fore200e) 195462306a36Sopenharmony_ci{ 195562306a36Sopenharmony_ci struct prom_data* prom = kzalloc(sizeof(struct prom_data), GFP_KERNEL); 195662306a36Sopenharmony_ci int ok, i; 195762306a36Sopenharmony_ci 195862306a36Sopenharmony_ci if (!prom) 195962306a36Sopenharmony_ci return -ENOMEM; 196062306a36Sopenharmony_ci 196162306a36Sopenharmony_ci ok = fore200e->bus->prom_read(fore200e, prom); 196262306a36Sopenharmony_ci if (ok < 0) { 196362306a36Sopenharmony_ci kfree(prom); 196462306a36Sopenharmony_ci return -EBUSY; 196562306a36Sopenharmony_ci } 196662306a36Sopenharmony_ci 196762306a36Sopenharmony_ci printk(FORE200E "device %s, rev. %c, S/N: %d, ESI: %pM\n", 196862306a36Sopenharmony_ci fore200e->name, 196962306a36Sopenharmony_ci (prom->hw_revision & 0xFF) + '@', /* probably meaningless with SBA boards */ 197062306a36Sopenharmony_ci prom->serial_number & 0xFFFF, &prom->mac_addr[2]); 197162306a36Sopenharmony_ci 197262306a36Sopenharmony_ci for (i = 0; i < ESI_LEN; i++) { 197362306a36Sopenharmony_ci fore200e->esi[ i ] = fore200e->atm_dev->esi[ i ] = prom->mac_addr[ i + 2 ]; 197462306a36Sopenharmony_ci } 197562306a36Sopenharmony_ci 197662306a36Sopenharmony_ci kfree(prom); 197762306a36Sopenharmony_ci 197862306a36Sopenharmony_ci return 0; 197962306a36Sopenharmony_ci} 198062306a36Sopenharmony_ci 198162306a36Sopenharmony_ci 198262306a36Sopenharmony_cistatic int fore200e_alloc_rx_buf(struct fore200e *fore200e) 198362306a36Sopenharmony_ci{ 198462306a36Sopenharmony_ci int scheme, magn, nbr, size, i; 198562306a36Sopenharmony_ci 198662306a36Sopenharmony_ci struct host_bsq* bsq; 198762306a36Sopenharmony_ci struct buffer* buffer; 198862306a36Sopenharmony_ci 198962306a36Sopenharmony_ci for (scheme = 0; scheme < BUFFER_SCHEME_NBR; scheme++) { 199062306a36Sopenharmony_ci for (magn = 0; magn < BUFFER_MAGN_NBR; magn++) { 199162306a36Sopenharmony_ci 199262306a36Sopenharmony_ci bsq = &fore200e->host_bsq[ scheme ][ magn ]; 199362306a36Sopenharmony_ci 199462306a36Sopenharmony_ci nbr = fore200e_rx_buf_nbr[ scheme ][ magn ]; 199562306a36Sopenharmony_ci size = fore200e_rx_buf_size[ scheme ][ magn ]; 199662306a36Sopenharmony_ci 199762306a36Sopenharmony_ci DPRINTK(2, "rx buffers %d / %d are being allocated\n", scheme, magn); 199862306a36Sopenharmony_ci 199962306a36Sopenharmony_ci /* allocate the array of receive buffers */ 200062306a36Sopenharmony_ci buffer = bsq->buffer = kcalloc(nbr, sizeof(struct buffer), 200162306a36Sopenharmony_ci GFP_KERNEL); 200262306a36Sopenharmony_ci 200362306a36Sopenharmony_ci if (buffer == NULL) 200462306a36Sopenharmony_ci return -ENOMEM; 200562306a36Sopenharmony_ci 200662306a36Sopenharmony_ci bsq->freebuf = NULL; 200762306a36Sopenharmony_ci 200862306a36Sopenharmony_ci for (i = 0; i < nbr; i++) { 200962306a36Sopenharmony_ci 201062306a36Sopenharmony_ci buffer[ i ].scheme = scheme; 201162306a36Sopenharmony_ci buffer[ i ].magn = magn; 201262306a36Sopenharmony_ci#ifdef FORE200E_BSQ_DEBUG 201362306a36Sopenharmony_ci buffer[ i ].index = i; 201462306a36Sopenharmony_ci buffer[ i ].supplied = 0; 201562306a36Sopenharmony_ci#endif 201662306a36Sopenharmony_ci 201762306a36Sopenharmony_ci /* allocate the receive buffer body */ 201862306a36Sopenharmony_ci if (fore200e_chunk_alloc(fore200e, 201962306a36Sopenharmony_ci &buffer[ i ].data, size, fore200e->bus->buffer_alignment, 202062306a36Sopenharmony_ci DMA_FROM_DEVICE) < 0) { 202162306a36Sopenharmony_ci 202262306a36Sopenharmony_ci while (i > 0) 202362306a36Sopenharmony_ci fore200e_chunk_free(fore200e, &buffer[ --i ].data); 202462306a36Sopenharmony_ci kfree(buffer); 202562306a36Sopenharmony_ci 202662306a36Sopenharmony_ci return -ENOMEM; 202762306a36Sopenharmony_ci } 202862306a36Sopenharmony_ci 202962306a36Sopenharmony_ci /* insert the buffer into the free buffer list */ 203062306a36Sopenharmony_ci buffer[ i ].next = bsq->freebuf; 203162306a36Sopenharmony_ci bsq->freebuf = &buffer[ i ]; 203262306a36Sopenharmony_ci } 203362306a36Sopenharmony_ci /* all the buffers are free, initially */ 203462306a36Sopenharmony_ci bsq->freebuf_count = nbr; 203562306a36Sopenharmony_ci 203662306a36Sopenharmony_ci#ifdef FORE200E_BSQ_DEBUG 203762306a36Sopenharmony_ci bsq_audit(3, bsq, scheme, magn); 203862306a36Sopenharmony_ci#endif 203962306a36Sopenharmony_ci } 204062306a36Sopenharmony_ci } 204162306a36Sopenharmony_ci 204262306a36Sopenharmony_ci fore200e->state = FORE200E_STATE_ALLOC_BUF; 204362306a36Sopenharmony_ci return 0; 204462306a36Sopenharmony_ci} 204562306a36Sopenharmony_ci 204662306a36Sopenharmony_ci 204762306a36Sopenharmony_cistatic int fore200e_init_bs_queue(struct fore200e *fore200e) 204862306a36Sopenharmony_ci{ 204962306a36Sopenharmony_ci int scheme, magn, i; 205062306a36Sopenharmony_ci 205162306a36Sopenharmony_ci struct host_bsq* bsq; 205262306a36Sopenharmony_ci struct cp_bsq_entry __iomem * cp_entry; 205362306a36Sopenharmony_ci 205462306a36Sopenharmony_ci for (scheme = 0; scheme < BUFFER_SCHEME_NBR; scheme++) { 205562306a36Sopenharmony_ci for (magn = 0; magn < BUFFER_MAGN_NBR; magn++) { 205662306a36Sopenharmony_ci 205762306a36Sopenharmony_ci DPRINTK(2, "buffer supply queue %d / %d is being initialized\n", scheme, magn); 205862306a36Sopenharmony_ci 205962306a36Sopenharmony_ci bsq = &fore200e->host_bsq[ scheme ][ magn ]; 206062306a36Sopenharmony_ci 206162306a36Sopenharmony_ci /* allocate and align the array of status words */ 206262306a36Sopenharmony_ci if (fore200e_dma_chunk_alloc(fore200e, 206362306a36Sopenharmony_ci &bsq->status, 206462306a36Sopenharmony_ci sizeof(enum status), 206562306a36Sopenharmony_ci QUEUE_SIZE_BS, 206662306a36Sopenharmony_ci fore200e->bus->status_alignment) < 0) { 206762306a36Sopenharmony_ci return -ENOMEM; 206862306a36Sopenharmony_ci } 206962306a36Sopenharmony_ci 207062306a36Sopenharmony_ci /* allocate and align the array of receive buffer descriptors */ 207162306a36Sopenharmony_ci if (fore200e_dma_chunk_alloc(fore200e, 207262306a36Sopenharmony_ci &bsq->rbd_block, 207362306a36Sopenharmony_ci sizeof(struct rbd_block), 207462306a36Sopenharmony_ci QUEUE_SIZE_BS, 207562306a36Sopenharmony_ci fore200e->bus->descr_alignment) < 0) { 207662306a36Sopenharmony_ci 207762306a36Sopenharmony_ci fore200e_dma_chunk_free(fore200e, &bsq->status); 207862306a36Sopenharmony_ci return -ENOMEM; 207962306a36Sopenharmony_ci } 208062306a36Sopenharmony_ci 208162306a36Sopenharmony_ci /* get the base address of the cp resident buffer supply queue entries */ 208262306a36Sopenharmony_ci cp_entry = fore200e->virt_base + 208362306a36Sopenharmony_ci fore200e->bus->read(&fore200e->cp_queues->cp_bsq[ scheme ][ magn ]); 208462306a36Sopenharmony_ci 208562306a36Sopenharmony_ci /* fill the host resident and cp resident buffer supply queue entries */ 208662306a36Sopenharmony_ci for (i = 0; i < QUEUE_SIZE_BS; i++) { 208762306a36Sopenharmony_ci 208862306a36Sopenharmony_ci bsq->host_entry[ i ].status = 208962306a36Sopenharmony_ci FORE200E_INDEX(bsq->status.align_addr, enum status, i); 209062306a36Sopenharmony_ci bsq->host_entry[ i ].rbd_block = 209162306a36Sopenharmony_ci FORE200E_INDEX(bsq->rbd_block.align_addr, struct rbd_block, i); 209262306a36Sopenharmony_ci bsq->host_entry[ i ].rbd_block_dma = 209362306a36Sopenharmony_ci FORE200E_DMA_INDEX(bsq->rbd_block.dma_addr, struct rbd_block, i); 209462306a36Sopenharmony_ci bsq->host_entry[ i ].cp_entry = &cp_entry[ i ]; 209562306a36Sopenharmony_ci 209662306a36Sopenharmony_ci *bsq->host_entry[ i ].status = STATUS_FREE; 209762306a36Sopenharmony_ci 209862306a36Sopenharmony_ci fore200e->bus->write(FORE200E_DMA_INDEX(bsq->status.dma_addr, enum status, i), 209962306a36Sopenharmony_ci &cp_entry[ i ].status_haddr); 210062306a36Sopenharmony_ci } 210162306a36Sopenharmony_ci } 210262306a36Sopenharmony_ci } 210362306a36Sopenharmony_ci 210462306a36Sopenharmony_ci fore200e->state = FORE200E_STATE_INIT_BSQ; 210562306a36Sopenharmony_ci return 0; 210662306a36Sopenharmony_ci} 210762306a36Sopenharmony_ci 210862306a36Sopenharmony_ci 210962306a36Sopenharmony_cistatic int fore200e_init_rx_queue(struct fore200e *fore200e) 211062306a36Sopenharmony_ci{ 211162306a36Sopenharmony_ci struct host_rxq* rxq = &fore200e->host_rxq; 211262306a36Sopenharmony_ci struct cp_rxq_entry __iomem * cp_entry; 211362306a36Sopenharmony_ci int i; 211462306a36Sopenharmony_ci 211562306a36Sopenharmony_ci DPRINTK(2, "receive queue is being initialized\n"); 211662306a36Sopenharmony_ci 211762306a36Sopenharmony_ci /* allocate and align the array of status words */ 211862306a36Sopenharmony_ci if (fore200e_dma_chunk_alloc(fore200e, 211962306a36Sopenharmony_ci &rxq->status, 212062306a36Sopenharmony_ci sizeof(enum status), 212162306a36Sopenharmony_ci QUEUE_SIZE_RX, 212262306a36Sopenharmony_ci fore200e->bus->status_alignment) < 0) { 212362306a36Sopenharmony_ci return -ENOMEM; 212462306a36Sopenharmony_ci } 212562306a36Sopenharmony_ci 212662306a36Sopenharmony_ci /* allocate and align the array of receive PDU descriptors */ 212762306a36Sopenharmony_ci if (fore200e_dma_chunk_alloc(fore200e, 212862306a36Sopenharmony_ci &rxq->rpd, 212962306a36Sopenharmony_ci sizeof(struct rpd), 213062306a36Sopenharmony_ci QUEUE_SIZE_RX, 213162306a36Sopenharmony_ci fore200e->bus->descr_alignment) < 0) { 213262306a36Sopenharmony_ci 213362306a36Sopenharmony_ci fore200e_dma_chunk_free(fore200e, &rxq->status); 213462306a36Sopenharmony_ci return -ENOMEM; 213562306a36Sopenharmony_ci } 213662306a36Sopenharmony_ci 213762306a36Sopenharmony_ci /* get the base address of the cp resident rx queue entries */ 213862306a36Sopenharmony_ci cp_entry = fore200e->virt_base + fore200e->bus->read(&fore200e->cp_queues->cp_rxq); 213962306a36Sopenharmony_ci 214062306a36Sopenharmony_ci /* fill the host resident and cp resident rx entries */ 214162306a36Sopenharmony_ci for (i=0; i < QUEUE_SIZE_RX; i++) { 214262306a36Sopenharmony_ci 214362306a36Sopenharmony_ci rxq->host_entry[ i ].status = 214462306a36Sopenharmony_ci FORE200E_INDEX(rxq->status.align_addr, enum status, i); 214562306a36Sopenharmony_ci rxq->host_entry[ i ].rpd = 214662306a36Sopenharmony_ci FORE200E_INDEX(rxq->rpd.align_addr, struct rpd, i); 214762306a36Sopenharmony_ci rxq->host_entry[ i ].rpd_dma = 214862306a36Sopenharmony_ci FORE200E_DMA_INDEX(rxq->rpd.dma_addr, struct rpd, i); 214962306a36Sopenharmony_ci rxq->host_entry[ i ].cp_entry = &cp_entry[ i ]; 215062306a36Sopenharmony_ci 215162306a36Sopenharmony_ci *rxq->host_entry[ i ].status = STATUS_FREE; 215262306a36Sopenharmony_ci 215362306a36Sopenharmony_ci fore200e->bus->write(FORE200E_DMA_INDEX(rxq->status.dma_addr, enum status, i), 215462306a36Sopenharmony_ci &cp_entry[ i ].status_haddr); 215562306a36Sopenharmony_ci 215662306a36Sopenharmony_ci fore200e->bus->write(FORE200E_DMA_INDEX(rxq->rpd.dma_addr, struct rpd, i), 215762306a36Sopenharmony_ci &cp_entry[ i ].rpd_haddr); 215862306a36Sopenharmony_ci } 215962306a36Sopenharmony_ci 216062306a36Sopenharmony_ci /* set the head entry of the queue */ 216162306a36Sopenharmony_ci rxq->head = 0; 216262306a36Sopenharmony_ci 216362306a36Sopenharmony_ci fore200e->state = FORE200E_STATE_INIT_RXQ; 216462306a36Sopenharmony_ci return 0; 216562306a36Sopenharmony_ci} 216662306a36Sopenharmony_ci 216762306a36Sopenharmony_ci 216862306a36Sopenharmony_cistatic int fore200e_init_tx_queue(struct fore200e *fore200e) 216962306a36Sopenharmony_ci{ 217062306a36Sopenharmony_ci struct host_txq* txq = &fore200e->host_txq; 217162306a36Sopenharmony_ci struct cp_txq_entry __iomem * cp_entry; 217262306a36Sopenharmony_ci int i; 217362306a36Sopenharmony_ci 217462306a36Sopenharmony_ci DPRINTK(2, "transmit queue is being initialized\n"); 217562306a36Sopenharmony_ci 217662306a36Sopenharmony_ci /* allocate and align the array of status words */ 217762306a36Sopenharmony_ci if (fore200e_dma_chunk_alloc(fore200e, 217862306a36Sopenharmony_ci &txq->status, 217962306a36Sopenharmony_ci sizeof(enum status), 218062306a36Sopenharmony_ci QUEUE_SIZE_TX, 218162306a36Sopenharmony_ci fore200e->bus->status_alignment) < 0) { 218262306a36Sopenharmony_ci return -ENOMEM; 218362306a36Sopenharmony_ci } 218462306a36Sopenharmony_ci 218562306a36Sopenharmony_ci /* allocate and align the array of transmit PDU descriptors */ 218662306a36Sopenharmony_ci if (fore200e_dma_chunk_alloc(fore200e, 218762306a36Sopenharmony_ci &txq->tpd, 218862306a36Sopenharmony_ci sizeof(struct tpd), 218962306a36Sopenharmony_ci QUEUE_SIZE_TX, 219062306a36Sopenharmony_ci fore200e->bus->descr_alignment) < 0) { 219162306a36Sopenharmony_ci 219262306a36Sopenharmony_ci fore200e_dma_chunk_free(fore200e, &txq->status); 219362306a36Sopenharmony_ci return -ENOMEM; 219462306a36Sopenharmony_ci } 219562306a36Sopenharmony_ci 219662306a36Sopenharmony_ci /* get the base address of the cp resident tx queue entries */ 219762306a36Sopenharmony_ci cp_entry = fore200e->virt_base + fore200e->bus->read(&fore200e->cp_queues->cp_txq); 219862306a36Sopenharmony_ci 219962306a36Sopenharmony_ci /* fill the host resident and cp resident tx entries */ 220062306a36Sopenharmony_ci for (i=0; i < QUEUE_SIZE_TX; i++) { 220162306a36Sopenharmony_ci 220262306a36Sopenharmony_ci txq->host_entry[ i ].status = 220362306a36Sopenharmony_ci FORE200E_INDEX(txq->status.align_addr, enum status, i); 220462306a36Sopenharmony_ci txq->host_entry[ i ].tpd = 220562306a36Sopenharmony_ci FORE200E_INDEX(txq->tpd.align_addr, struct tpd, i); 220662306a36Sopenharmony_ci txq->host_entry[ i ].tpd_dma = 220762306a36Sopenharmony_ci FORE200E_DMA_INDEX(txq->tpd.dma_addr, struct tpd, i); 220862306a36Sopenharmony_ci txq->host_entry[ i ].cp_entry = &cp_entry[ i ]; 220962306a36Sopenharmony_ci 221062306a36Sopenharmony_ci *txq->host_entry[ i ].status = STATUS_FREE; 221162306a36Sopenharmony_ci 221262306a36Sopenharmony_ci fore200e->bus->write(FORE200E_DMA_INDEX(txq->status.dma_addr, enum status, i), 221362306a36Sopenharmony_ci &cp_entry[ i ].status_haddr); 221462306a36Sopenharmony_ci 221562306a36Sopenharmony_ci /* although there is a one-to-one mapping of tx queue entries and tpds, 221662306a36Sopenharmony_ci we do not write here the DMA (physical) base address of each tpd into 221762306a36Sopenharmony_ci the related cp resident entry, because the cp relies on this write 221862306a36Sopenharmony_ci operation to detect that a new pdu has been submitted for tx */ 221962306a36Sopenharmony_ci } 222062306a36Sopenharmony_ci 222162306a36Sopenharmony_ci /* set the head and tail entries of the queue */ 222262306a36Sopenharmony_ci txq->head = 0; 222362306a36Sopenharmony_ci txq->tail = 0; 222462306a36Sopenharmony_ci 222562306a36Sopenharmony_ci fore200e->state = FORE200E_STATE_INIT_TXQ; 222662306a36Sopenharmony_ci return 0; 222762306a36Sopenharmony_ci} 222862306a36Sopenharmony_ci 222962306a36Sopenharmony_ci 223062306a36Sopenharmony_cistatic int fore200e_init_cmd_queue(struct fore200e *fore200e) 223162306a36Sopenharmony_ci{ 223262306a36Sopenharmony_ci struct host_cmdq* cmdq = &fore200e->host_cmdq; 223362306a36Sopenharmony_ci struct cp_cmdq_entry __iomem * cp_entry; 223462306a36Sopenharmony_ci int i; 223562306a36Sopenharmony_ci 223662306a36Sopenharmony_ci DPRINTK(2, "command queue is being initialized\n"); 223762306a36Sopenharmony_ci 223862306a36Sopenharmony_ci /* allocate and align the array of status words */ 223962306a36Sopenharmony_ci if (fore200e_dma_chunk_alloc(fore200e, 224062306a36Sopenharmony_ci &cmdq->status, 224162306a36Sopenharmony_ci sizeof(enum status), 224262306a36Sopenharmony_ci QUEUE_SIZE_CMD, 224362306a36Sopenharmony_ci fore200e->bus->status_alignment) < 0) { 224462306a36Sopenharmony_ci return -ENOMEM; 224562306a36Sopenharmony_ci } 224662306a36Sopenharmony_ci 224762306a36Sopenharmony_ci /* get the base address of the cp resident cmd queue entries */ 224862306a36Sopenharmony_ci cp_entry = fore200e->virt_base + fore200e->bus->read(&fore200e->cp_queues->cp_cmdq); 224962306a36Sopenharmony_ci 225062306a36Sopenharmony_ci /* fill the host resident and cp resident cmd entries */ 225162306a36Sopenharmony_ci for (i=0; i < QUEUE_SIZE_CMD; i++) { 225262306a36Sopenharmony_ci 225362306a36Sopenharmony_ci cmdq->host_entry[ i ].status = 225462306a36Sopenharmony_ci FORE200E_INDEX(cmdq->status.align_addr, enum status, i); 225562306a36Sopenharmony_ci cmdq->host_entry[ i ].cp_entry = &cp_entry[ i ]; 225662306a36Sopenharmony_ci 225762306a36Sopenharmony_ci *cmdq->host_entry[ i ].status = STATUS_FREE; 225862306a36Sopenharmony_ci 225962306a36Sopenharmony_ci fore200e->bus->write(FORE200E_DMA_INDEX(cmdq->status.dma_addr, enum status, i), 226062306a36Sopenharmony_ci &cp_entry[ i ].status_haddr); 226162306a36Sopenharmony_ci } 226262306a36Sopenharmony_ci 226362306a36Sopenharmony_ci /* set the head entry of the queue */ 226462306a36Sopenharmony_ci cmdq->head = 0; 226562306a36Sopenharmony_ci 226662306a36Sopenharmony_ci fore200e->state = FORE200E_STATE_INIT_CMDQ; 226762306a36Sopenharmony_ci return 0; 226862306a36Sopenharmony_ci} 226962306a36Sopenharmony_ci 227062306a36Sopenharmony_ci 227162306a36Sopenharmony_cistatic void fore200e_param_bs_queue(struct fore200e *fore200e, 227262306a36Sopenharmony_ci enum buffer_scheme scheme, 227362306a36Sopenharmony_ci enum buffer_magn magn, int queue_length, 227462306a36Sopenharmony_ci int pool_size, int supply_blksize) 227562306a36Sopenharmony_ci{ 227662306a36Sopenharmony_ci struct bs_spec __iomem * bs_spec = &fore200e->cp_queues->init.bs_spec[ scheme ][ magn ]; 227762306a36Sopenharmony_ci 227862306a36Sopenharmony_ci fore200e->bus->write(queue_length, &bs_spec->queue_length); 227962306a36Sopenharmony_ci fore200e->bus->write(fore200e_rx_buf_size[ scheme ][ magn ], &bs_spec->buffer_size); 228062306a36Sopenharmony_ci fore200e->bus->write(pool_size, &bs_spec->pool_size); 228162306a36Sopenharmony_ci fore200e->bus->write(supply_blksize, &bs_spec->supply_blksize); 228262306a36Sopenharmony_ci} 228362306a36Sopenharmony_ci 228462306a36Sopenharmony_ci 228562306a36Sopenharmony_cistatic int fore200e_initialize(struct fore200e *fore200e) 228662306a36Sopenharmony_ci{ 228762306a36Sopenharmony_ci struct cp_queues __iomem * cpq; 228862306a36Sopenharmony_ci int ok, scheme, magn; 228962306a36Sopenharmony_ci 229062306a36Sopenharmony_ci DPRINTK(2, "device %s being initialized\n", fore200e->name); 229162306a36Sopenharmony_ci 229262306a36Sopenharmony_ci mutex_init(&fore200e->rate_mtx); 229362306a36Sopenharmony_ci spin_lock_init(&fore200e->q_lock); 229462306a36Sopenharmony_ci 229562306a36Sopenharmony_ci cpq = fore200e->cp_queues = fore200e->virt_base + FORE200E_CP_QUEUES_OFFSET; 229662306a36Sopenharmony_ci 229762306a36Sopenharmony_ci /* enable cp to host interrupts */ 229862306a36Sopenharmony_ci fore200e->bus->write(1, &cpq->imask); 229962306a36Sopenharmony_ci 230062306a36Sopenharmony_ci if (fore200e->bus->irq_enable) 230162306a36Sopenharmony_ci fore200e->bus->irq_enable(fore200e); 230262306a36Sopenharmony_ci 230362306a36Sopenharmony_ci fore200e->bus->write(NBR_CONNECT, &cpq->init.num_connect); 230462306a36Sopenharmony_ci 230562306a36Sopenharmony_ci fore200e->bus->write(QUEUE_SIZE_CMD, &cpq->init.cmd_queue_len); 230662306a36Sopenharmony_ci fore200e->bus->write(QUEUE_SIZE_RX, &cpq->init.rx_queue_len); 230762306a36Sopenharmony_ci fore200e->bus->write(QUEUE_SIZE_TX, &cpq->init.tx_queue_len); 230862306a36Sopenharmony_ci 230962306a36Sopenharmony_ci fore200e->bus->write(RSD_EXTENSION, &cpq->init.rsd_extension); 231062306a36Sopenharmony_ci fore200e->bus->write(TSD_EXTENSION, &cpq->init.tsd_extension); 231162306a36Sopenharmony_ci 231262306a36Sopenharmony_ci for (scheme = 0; scheme < BUFFER_SCHEME_NBR; scheme++) 231362306a36Sopenharmony_ci for (magn = 0; magn < BUFFER_MAGN_NBR; magn++) 231462306a36Sopenharmony_ci fore200e_param_bs_queue(fore200e, scheme, magn, 231562306a36Sopenharmony_ci QUEUE_SIZE_BS, 231662306a36Sopenharmony_ci fore200e_rx_buf_nbr[ scheme ][ magn ], 231762306a36Sopenharmony_ci RBD_BLK_SIZE); 231862306a36Sopenharmony_ci 231962306a36Sopenharmony_ci /* issue the initialize command */ 232062306a36Sopenharmony_ci fore200e->bus->write(STATUS_PENDING, &cpq->init.status); 232162306a36Sopenharmony_ci fore200e->bus->write(OPCODE_INITIALIZE, &cpq->init.opcode); 232262306a36Sopenharmony_ci 232362306a36Sopenharmony_ci ok = fore200e_io_poll(fore200e, &cpq->init.status, STATUS_COMPLETE, 3000); 232462306a36Sopenharmony_ci if (ok == 0) { 232562306a36Sopenharmony_ci printk(FORE200E "device %s initialization failed\n", fore200e->name); 232662306a36Sopenharmony_ci return -ENODEV; 232762306a36Sopenharmony_ci } 232862306a36Sopenharmony_ci 232962306a36Sopenharmony_ci printk(FORE200E "device %s initialized\n", fore200e->name); 233062306a36Sopenharmony_ci 233162306a36Sopenharmony_ci fore200e->state = FORE200E_STATE_INITIALIZE; 233262306a36Sopenharmony_ci return 0; 233362306a36Sopenharmony_ci} 233462306a36Sopenharmony_ci 233562306a36Sopenharmony_ci 233662306a36Sopenharmony_cistatic void fore200e_monitor_putc(struct fore200e *fore200e, char c) 233762306a36Sopenharmony_ci{ 233862306a36Sopenharmony_ci struct cp_monitor __iomem * monitor = fore200e->cp_monitor; 233962306a36Sopenharmony_ci 234062306a36Sopenharmony_ci#if 0 234162306a36Sopenharmony_ci printk("%c", c); 234262306a36Sopenharmony_ci#endif 234362306a36Sopenharmony_ci fore200e->bus->write(((u32) c) | FORE200E_CP_MONITOR_UART_AVAIL, &monitor->soft_uart.send); 234462306a36Sopenharmony_ci} 234562306a36Sopenharmony_ci 234662306a36Sopenharmony_ci 234762306a36Sopenharmony_cistatic int fore200e_monitor_getc(struct fore200e *fore200e) 234862306a36Sopenharmony_ci{ 234962306a36Sopenharmony_ci struct cp_monitor __iomem * monitor = fore200e->cp_monitor; 235062306a36Sopenharmony_ci unsigned long timeout = jiffies + msecs_to_jiffies(50); 235162306a36Sopenharmony_ci int c; 235262306a36Sopenharmony_ci 235362306a36Sopenharmony_ci while (time_before(jiffies, timeout)) { 235462306a36Sopenharmony_ci 235562306a36Sopenharmony_ci c = (int) fore200e->bus->read(&monitor->soft_uart.recv); 235662306a36Sopenharmony_ci 235762306a36Sopenharmony_ci if (c & FORE200E_CP_MONITOR_UART_AVAIL) { 235862306a36Sopenharmony_ci 235962306a36Sopenharmony_ci fore200e->bus->write(FORE200E_CP_MONITOR_UART_FREE, &monitor->soft_uart.recv); 236062306a36Sopenharmony_ci#if 0 236162306a36Sopenharmony_ci printk("%c", c & 0xFF); 236262306a36Sopenharmony_ci#endif 236362306a36Sopenharmony_ci return c & 0xFF; 236462306a36Sopenharmony_ci } 236562306a36Sopenharmony_ci } 236662306a36Sopenharmony_ci 236762306a36Sopenharmony_ci return -1; 236862306a36Sopenharmony_ci} 236962306a36Sopenharmony_ci 237062306a36Sopenharmony_ci 237162306a36Sopenharmony_cistatic void fore200e_monitor_puts(struct fore200e *fore200e, char *str) 237262306a36Sopenharmony_ci{ 237362306a36Sopenharmony_ci while (*str) { 237462306a36Sopenharmony_ci 237562306a36Sopenharmony_ci /* the i960 monitor doesn't accept any new character if it has something to say */ 237662306a36Sopenharmony_ci while (fore200e_monitor_getc(fore200e) >= 0); 237762306a36Sopenharmony_ci 237862306a36Sopenharmony_ci fore200e_monitor_putc(fore200e, *str++); 237962306a36Sopenharmony_ci } 238062306a36Sopenharmony_ci 238162306a36Sopenharmony_ci while (fore200e_monitor_getc(fore200e) >= 0); 238262306a36Sopenharmony_ci} 238362306a36Sopenharmony_ci 238462306a36Sopenharmony_ci#ifdef __LITTLE_ENDIAN 238562306a36Sopenharmony_ci#define FW_EXT ".bin" 238662306a36Sopenharmony_ci#else 238762306a36Sopenharmony_ci#define FW_EXT "_ecd.bin2" 238862306a36Sopenharmony_ci#endif 238962306a36Sopenharmony_ci 239062306a36Sopenharmony_cistatic int fore200e_load_and_start_fw(struct fore200e *fore200e) 239162306a36Sopenharmony_ci{ 239262306a36Sopenharmony_ci const struct firmware *firmware; 239362306a36Sopenharmony_ci const struct fw_header *fw_header; 239462306a36Sopenharmony_ci const __le32 *fw_data; 239562306a36Sopenharmony_ci u32 fw_size; 239662306a36Sopenharmony_ci u32 __iomem *load_addr; 239762306a36Sopenharmony_ci char buf[48]; 239862306a36Sopenharmony_ci int err; 239962306a36Sopenharmony_ci 240062306a36Sopenharmony_ci sprintf(buf, "%s%s", fore200e->bus->proc_name, FW_EXT); 240162306a36Sopenharmony_ci if ((err = request_firmware(&firmware, buf, fore200e->dev)) < 0) { 240262306a36Sopenharmony_ci printk(FORE200E "problem loading firmware image %s\n", fore200e->bus->model_name); 240362306a36Sopenharmony_ci return err; 240462306a36Sopenharmony_ci } 240562306a36Sopenharmony_ci 240662306a36Sopenharmony_ci fw_data = (const __le32 *)firmware->data; 240762306a36Sopenharmony_ci fw_size = firmware->size / sizeof(u32); 240862306a36Sopenharmony_ci fw_header = (const struct fw_header *)firmware->data; 240962306a36Sopenharmony_ci load_addr = fore200e->virt_base + le32_to_cpu(fw_header->load_offset); 241062306a36Sopenharmony_ci 241162306a36Sopenharmony_ci DPRINTK(2, "device %s firmware being loaded at 0x%p (%d words)\n", 241262306a36Sopenharmony_ci fore200e->name, load_addr, fw_size); 241362306a36Sopenharmony_ci 241462306a36Sopenharmony_ci if (le32_to_cpu(fw_header->magic) != FW_HEADER_MAGIC) { 241562306a36Sopenharmony_ci printk(FORE200E "corrupted %s firmware image\n", fore200e->bus->model_name); 241662306a36Sopenharmony_ci goto release; 241762306a36Sopenharmony_ci } 241862306a36Sopenharmony_ci 241962306a36Sopenharmony_ci for (; fw_size--; fw_data++, load_addr++) 242062306a36Sopenharmony_ci fore200e->bus->write(le32_to_cpu(*fw_data), load_addr); 242162306a36Sopenharmony_ci 242262306a36Sopenharmony_ci DPRINTK(2, "device %s firmware being started\n", fore200e->name); 242362306a36Sopenharmony_ci 242462306a36Sopenharmony_ci#if defined(__sparc_v9__) 242562306a36Sopenharmony_ci /* reported to be required by SBA cards on some sparc64 hosts */ 242662306a36Sopenharmony_ci fore200e_spin(100); 242762306a36Sopenharmony_ci#endif 242862306a36Sopenharmony_ci 242962306a36Sopenharmony_ci sprintf(buf, "\rgo %x\r", le32_to_cpu(fw_header->start_offset)); 243062306a36Sopenharmony_ci fore200e_monitor_puts(fore200e, buf); 243162306a36Sopenharmony_ci 243262306a36Sopenharmony_ci if (fore200e_io_poll(fore200e, &fore200e->cp_monitor->bstat, BSTAT_CP_RUNNING, 1000) == 0) { 243362306a36Sopenharmony_ci printk(FORE200E "device %s firmware didn't start\n", fore200e->name); 243462306a36Sopenharmony_ci goto release; 243562306a36Sopenharmony_ci } 243662306a36Sopenharmony_ci 243762306a36Sopenharmony_ci printk(FORE200E "device %s firmware started\n", fore200e->name); 243862306a36Sopenharmony_ci 243962306a36Sopenharmony_ci fore200e->state = FORE200E_STATE_START_FW; 244062306a36Sopenharmony_ci err = 0; 244162306a36Sopenharmony_ci 244262306a36Sopenharmony_cirelease: 244362306a36Sopenharmony_ci release_firmware(firmware); 244462306a36Sopenharmony_ci return err; 244562306a36Sopenharmony_ci} 244662306a36Sopenharmony_ci 244762306a36Sopenharmony_ci 244862306a36Sopenharmony_cistatic int fore200e_register(struct fore200e *fore200e, struct device *parent) 244962306a36Sopenharmony_ci{ 245062306a36Sopenharmony_ci struct atm_dev* atm_dev; 245162306a36Sopenharmony_ci 245262306a36Sopenharmony_ci DPRINTK(2, "device %s being registered\n", fore200e->name); 245362306a36Sopenharmony_ci 245462306a36Sopenharmony_ci atm_dev = atm_dev_register(fore200e->bus->proc_name, parent, &fore200e_ops, 245562306a36Sopenharmony_ci -1, NULL); 245662306a36Sopenharmony_ci if (atm_dev == NULL) { 245762306a36Sopenharmony_ci printk(FORE200E "unable to register device %s\n", fore200e->name); 245862306a36Sopenharmony_ci return -ENODEV; 245962306a36Sopenharmony_ci } 246062306a36Sopenharmony_ci 246162306a36Sopenharmony_ci atm_dev->dev_data = fore200e; 246262306a36Sopenharmony_ci fore200e->atm_dev = atm_dev; 246362306a36Sopenharmony_ci 246462306a36Sopenharmony_ci atm_dev->ci_range.vpi_bits = FORE200E_VPI_BITS; 246562306a36Sopenharmony_ci atm_dev->ci_range.vci_bits = FORE200E_VCI_BITS; 246662306a36Sopenharmony_ci 246762306a36Sopenharmony_ci fore200e->available_cell_rate = ATM_OC3_PCR; 246862306a36Sopenharmony_ci 246962306a36Sopenharmony_ci fore200e->state = FORE200E_STATE_REGISTER; 247062306a36Sopenharmony_ci return 0; 247162306a36Sopenharmony_ci} 247262306a36Sopenharmony_ci 247362306a36Sopenharmony_ci 247462306a36Sopenharmony_cistatic int fore200e_init(struct fore200e *fore200e, struct device *parent) 247562306a36Sopenharmony_ci{ 247662306a36Sopenharmony_ci if (fore200e_register(fore200e, parent) < 0) 247762306a36Sopenharmony_ci return -ENODEV; 247862306a36Sopenharmony_ci 247962306a36Sopenharmony_ci if (fore200e->bus->configure(fore200e) < 0) 248062306a36Sopenharmony_ci return -ENODEV; 248162306a36Sopenharmony_ci 248262306a36Sopenharmony_ci if (fore200e->bus->map(fore200e) < 0) 248362306a36Sopenharmony_ci return -ENODEV; 248462306a36Sopenharmony_ci 248562306a36Sopenharmony_ci if (fore200e_reset(fore200e, 1) < 0) 248662306a36Sopenharmony_ci return -ENODEV; 248762306a36Sopenharmony_ci 248862306a36Sopenharmony_ci if (fore200e_load_and_start_fw(fore200e) < 0) 248962306a36Sopenharmony_ci return -ENODEV; 249062306a36Sopenharmony_ci 249162306a36Sopenharmony_ci if (fore200e_initialize(fore200e) < 0) 249262306a36Sopenharmony_ci return -ENODEV; 249362306a36Sopenharmony_ci 249462306a36Sopenharmony_ci if (fore200e_init_cmd_queue(fore200e) < 0) 249562306a36Sopenharmony_ci return -ENOMEM; 249662306a36Sopenharmony_ci 249762306a36Sopenharmony_ci if (fore200e_init_tx_queue(fore200e) < 0) 249862306a36Sopenharmony_ci return -ENOMEM; 249962306a36Sopenharmony_ci 250062306a36Sopenharmony_ci if (fore200e_init_rx_queue(fore200e) < 0) 250162306a36Sopenharmony_ci return -ENOMEM; 250262306a36Sopenharmony_ci 250362306a36Sopenharmony_ci if (fore200e_init_bs_queue(fore200e) < 0) 250462306a36Sopenharmony_ci return -ENOMEM; 250562306a36Sopenharmony_ci 250662306a36Sopenharmony_ci if (fore200e_alloc_rx_buf(fore200e) < 0) 250762306a36Sopenharmony_ci return -ENOMEM; 250862306a36Sopenharmony_ci 250962306a36Sopenharmony_ci if (fore200e_get_esi(fore200e) < 0) 251062306a36Sopenharmony_ci return -EIO; 251162306a36Sopenharmony_ci 251262306a36Sopenharmony_ci if (fore200e_irq_request(fore200e) < 0) 251362306a36Sopenharmony_ci return -EBUSY; 251462306a36Sopenharmony_ci 251562306a36Sopenharmony_ci fore200e_supply(fore200e); 251662306a36Sopenharmony_ci 251762306a36Sopenharmony_ci /* all done, board initialization is now complete */ 251862306a36Sopenharmony_ci fore200e->state = FORE200E_STATE_COMPLETE; 251962306a36Sopenharmony_ci return 0; 252062306a36Sopenharmony_ci} 252162306a36Sopenharmony_ci 252262306a36Sopenharmony_ci#ifdef CONFIG_SBUS 252362306a36Sopenharmony_cistatic const struct of_device_id fore200e_sba_match[]; 252462306a36Sopenharmony_cistatic int fore200e_sba_probe(struct platform_device *op) 252562306a36Sopenharmony_ci{ 252662306a36Sopenharmony_ci const struct of_device_id *match; 252762306a36Sopenharmony_ci struct fore200e *fore200e; 252862306a36Sopenharmony_ci static int index = 0; 252962306a36Sopenharmony_ci int err; 253062306a36Sopenharmony_ci 253162306a36Sopenharmony_ci match = of_match_device(fore200e_sba_match, &op->dev); 253262306a36Sopenharmony_ci if (!match) 253362306a36Sopenharmony_ci return -EINVAL; 253462306a36Sopenharmony_ci 253562306a36Sopenharmony_ci fore200e = kzalloc(sizeof(struct fore200e), GFP_KERNEL); 253662306a36Sopenharmony_ci if (!fore200e) 253762306a36Sopenharmony_ci return -ENOMEM; 253862306a36Sopenharmony_ci 253962306a36Sopenharmony_ci fore200e->bus = &fore200e_sbus_ops; 254062306a36Sopenharmony_ci fore200e->dev = &op->dev; 254162306a36Sopenharmony_ci fore200e->irq = op->archdata.irqs[0]; 254262306a36Sopenharmony_ci fore200e->phys_base = op->resource[0].start; 254362306a36Sopenharmony_ci 254462306a36Sopenharmony_ci sprintf(fore200e->name, "SBA-200E-%d", index); 254562306a36Sopenharmony_ci 254662306a36Sopenharmony_ci err = fore200e_init(fore200e, &op->dev); 254762306a36Sopenharmony_ci if (err < 0) { 254862306a36Sopenharmony_ci fore200e_shutdown(fore200e); 254962306a36Sopenharmony_ci kfree(fore200e); 255062306a36Sopenharmony_ci return err; 255162306a36Sopenharmony_ci } 255262306a36Sopenharmony_ci 255362306a36Sopenharmony_ci index++; 255462306a36Sopenharmony_ci dev_set_drvdata(&op->dev, fore200e); 255562306a36Sopenharmony_ci 255662306a36Sopenharmony_ci return 0; 255762306a36Sopenharmony_ci} 255862306a36Sopenharmony_ci 255962306a36Sopenharmony_cistatic int fore200e_sba_remove(struct platform_device *op) 256062306a36Sopenharmony_ci{ 256162306a36Sopenharmony_ci struct fore200e *fore200e = dev_get_drvdata(&op->dev); 256262306a36Sopenharmony_ci 256362306a36Sopenharmony_ci fore200e_shutdown(fore200e); 256462306a36Sopenharmony_ci kfree(fore200e); 256562306a36Sopenharmony_ci 256662306a36Sopenharmony_ci return 0; 256762306a36Sopenharmony_ci} 256862306a36Sopenharmony_ci 256962306a36Sopenharmony_cistatic const struct of_device_id fore200e_sba_match[] = { 257062306a36Sopenharmony_ci { 257162306a36Sopenharmony_ci .name = SBA200E_PROM_NAME, 257262306a36Sopenharmony_ci }, 257362306a36Sopenharmony_ci {}, 257462306a36Sopenharmony_ci}; 257562306a36Sopenharmony_ciMODULE_DEVICE_TABLE(of, fore200e_sba_match); 257662306a36Sopenharmony_ci 257762306a36Sopenharmony_cistatic struct platform_driver fore200e_sba_driver = { 257862306a36Sopenharmony_ci .driver = { 257962306a36Sopenharmony_ci .name = "fore_200e", 258062306a36Sopenharmony_ci .of_match_table = fore200e_sba_match, 258162306a36Sopenharmony_ci }, 258262306a36Sopenharmony_ci .probe = fore200e_sba_probe, 258362306a36Sopenharmony_ci .remove = fore200e_sba_remove, 258462306a36Sopenharmony_ci}; 258562306a36Sopenharmony_ci#endif 258662306a36Sopenharmony_ci 258762306a36Sopenharmony_ci#ifdef CONFIG_PCI 258862306a36Sopenharmony_cistatic int fore200e_pca_detect(struct pci_dev *pci_dev, 258962306a36Sopenharmony_ci const struct pci_device_id *pci_ent) 259062306a36Sopenharmony_ci{ 259162306a36Sopenharmony_ci struct fore200e* fore200e; 259262306a36Sopenharmony_ci int err = 0; 259362306a36Sopenharmony_ci static int index = 0; 259462306a36Sopenharmony_ci 259562306a36Sopenharmony_ci if (pci_enable_device(pci_dev)) { 259662306a36Sopenharmony_ci err = -EINVAL; 259762306a36Sopenharmony_ci goto out; 259862306a36Sopenharmony_ci } 259962306a36Sopenharmony_ci 260062306a36Sopenharmony_ci if (dma_set_mask_and_coherent(&pci_dev->dev, DMA_BIT_MASK(32))) { 260162306a36Sopenharmony_ci err = -EINVAL; 260262306a36Sopenharmony_ci goto out; 260362306a36Sopenharmony_ci } 260462306a36Sopenharmony_ci 260562306a36Sopenharmony_ci fore200e = kzalloc(sizeof(struct fore200e), GFP_KERNEL); 260662306a36Sopenharmony_ci if (fore200e == NULL) { 260762306a36Sopenharmony_ci err = -ENOMEM; 260862306a36Sopenharmony_ci goto out_disable; 260962306a36Sopenharmony_ci } 261062306a36Sopenharmony_ci 261162306a36Sopenharmony_ci fore200e->bus = &fore200e_pci_ops; 261262306a36Sopenharmony_ci fore200e->dev = &pci_dev->dev; 261362306a36Sopenharmony_ci fore200e->irq = pci_dev->irq; 261462306a36Sopenharmony_ci fore200e->phys_base = pci_resource_start(pci_dev, 0); 261562306a36Sopenharmony_ci 261662306a36Sopenharmony_ci sprintf(fore200e->name, "PCA-200E-%d", index - 1); 261762306a36Sopenharmony_ci 261862306a36Sopenharmony_ci pci_set_master(pci_dev); 261962306a36Sopenharmony_ci 262062306a36Sopenharmony_ci printk(FORE200E "device PCA-200E found at 0x%lx, IRQ %s\n", 262162306a36Sopenharmony_ci fore200e->phys_base, fore200e_irq_itoa(fore200e->irq)); 262262306a36Sopenharmony_ci 262362306a36Sopenharmony_ci sprintf(fore200e->name, "PCA-200E-%d", index); 262462306a36Sopenharmony_ci 262562306a36Sopenharmony_ci err = fore200e_init(fore200e, &pci_dev->dev); 262662306a36Sopenharmony_ci if (err < 0) { 262762306a36Sopenharmony_ci fore200e_shutdown(fore200e); 262862306a36Sopenharmony_ci goto out_free; 262962306a36Sopenharmony_ci } 263062306a36Sopenharmony_ci 263162306a36Sopenharmony_ci ++index; 263262306a36Sopenharmony_ci pci_set_drvdata(pci_dev, fore200e); 263362306a36Sopenharmony_ci 263462306a36Sopenharmony_ciout: 263562306a36Sopenharmony_ci return err; 263662306a36Sopenharmony_ci 263762306a36Sopenharmony_ciout_free: 263862306a36Sopenharmony_ci kfree(fore200e); 263962306a36Sopenharmony_ciout_disable: 264062306a36Sopenharmony_ci pci_disable_device(pci_dev); 264162306a36Sopenharmony_ci goto out; 264262306a36Sopenharmony_ci} 264362306a36Sopenharmony_ci 264462306a36Sopenharmony_ci 264562306a36Sopenharmony_cistatic void fore200e_pca_remove_one(struct pci_dev *pci_dev) 264662306a36Sopenharmony_ci{ 264762306a36Sopenharmony_ci struct fore200e *fore200e; 264862306a36Sopenharmony_ci 264962306a36Sopenharmony_ci fore200e = pci_get_drvdata(pci_dev); 265062306a36Sopenharmony_ci 265162306a36Sopenharmony_ci fore200e_shutdown(fore200e); 265262306a36Sopenharmony_ci kfree(fore200e); 265362306a36Sopenharmony_ci pci_disable_device(pci_dev); 265462306a36Sopenharmony_ci} 265562306a36Sopenharmony_ci 265662306a36Sopenharmony_ci 265762306a36Sopenharmony_cistatic const struct pci_device_id fore200e_pca_tbl[] = { 265862306a36Sopenharmony_ci { PCI_VENDOR_ID_FORE, PCI_DEVICE_ID_FORE_PCA200E, PCI_ANY_ID, PCI_ANY_ID }, 265962306a36Sopenharmony_ci { 0, } 266062306a36Sopenharmony_ci}; 266162306a36Sopenharmony_ci 266262306a36Sopenharmony_ciMODULE_DEVICE_TABLE(pci, fore200e_pca_tbl); 266362306a36Sopenharmony_ci 266462306a36Sopenharmony_cistatic struct pci_driver fore200e_pca_driver = { 266562306a36Sopenharmony_ci .name = "fore_200e", 266662306a36Sopenharmony_ci .probe = fore200e_pca_detect, 266762306a36Sopenharmony_ci .remove = fore200e_pca_remove_one, 266862306a36Sopenharmony_ci .id_table = fore200e_pca_tbl, 266962306a36Sopenharmony_ci}; 267062306a36Sopenharmony_ci#endif 267162306a36Sopenharmony_ci 267262306a36Sopenharmony_cistatic int __init fore200e_module_init(void) 267362306a36Sopenharmony_ci{ 267462306a36Sopenharmony_ci int err = 0; 267562306a36Sopenharmony_ci 267662306a36Sopenharmony_ci printk(FORE200E "FORE Systems 200E-series ATM driver - version " FORE200E_VERSION "\n"); 267762306a36Sopenharmony_ci 267862306a36Sopenharmony_ci#ifdef CONFIG_SBUS 267962306a36Sopenharmony_ci err = platform_driver_register(&fore200e_sba_driver); 268062306a36Sopenharmony_ci if (err) 268162306a36Sopenharmony_ci return err; 268262306a36Sopenharmony_ci#endif 268362306a36Sopenharmony_ci 268462306a36Sopenharmony_ci#ifdef CONFIG_PCI 268562306a36Sopenharmony_ci err = pci_register_driver(&fore200e_pca_driver); 268662306a36Sopenharmony_ci#endif 268762306a36Sopenharmony_ci 268862306a36Sopenharmony_ci#ifdef CONFIG_SBUS 268962306a36Sopenharmony_ci if (err) 269062306a36Sopenharmony_ci platform_driver_unregister(&fore200e_sba_driver); 269162306a36Sopenharmony_ci#endif 269262306a36Sopenharmony_ci 269362306a36Sopenharmony_ci return err; 269462306a36Sopenharmony_ci} 269562306a36Sopenharmony_ci 269662306a36Sopenharmony_cistatic void __exit fore200e_module_cleanup(void) 269762306a36Sopenharmony_ci{ 269862306a36Sopenharmony_ci#ifdef CONFIG_PCI 269962306a36Sopenharmony_ci pci_unregister_driver(&fore200e_pca_driver); 270062306a36Sopenharmony_ci#endif 270162306a36Sopenharmony_ci#ifdef CONFIG_SBUS 270262306a36Sopenharmony_ci platform_driver_unregister(&fore200e_sba_driver); 270362306a36Sopenharmony_ci#endif 270462306a36Sopenharmony_ci} 270562306a36Sopenharmony_ci 270662306a36Sopenharmony_cistatic int 270762306a36Sopenharmony_cifore200e_proc_read(struct atm_dev *dev, loff_t* pos, char* page) 270862306a36Sopenharmony_ci{ 270962306a36Sopenharmony_ci struct fore200e* fore200e = FORE200E_DEV(dev); 271062306a36Sopenharmony_ci struct fore200e_vcc* fore200e_vcc; 271162306a36Sopenharmony_ci struct atm_vcc* vcc; 271262306a36Sopenharmony_ci int i, len, left = *pos; 271362306a36Sopenharmony_ci unsigned long flags; 271462306a36Sopenharmony_ci 271562306a36Sopenharmony_ci if (!left--) { 271662306a36Sopenharmony_ci 271762306a36Sopenharmony_ci if (fore200e_getstats(fore200e) < 0) 271862306a36Sopenharmony_ci return -EIO; 271962306a36Sopenharmony_ci 272062306a36Sopenharmony_ci len = sprintf(page,"\n" 272162306a36Sopenharmony_ci " device:\n" 272262306a36Sopenharmony_ci " internal name:\t\t%s\n", fore200e->name); 272362306a36Sopenharmony_ci 272462306a36Sopenharmony_ci /* print bus-specific information */ 272562306a36Sopenharmony_ci if (fore200e->bus->proc_read) 272662306a36Sopenharmony_ci len += fore200e->bus->proc_read(fore200e, page + len); 272762306a36Sopenharmony_ci 272862306a36Sopenharmony_ci len += sprintf(page + len, 272962306a36Sopenharmony_ci " interrupt line:\t\t%s\n" 273062306a36Sopenharmony_ci " physical base address:\t0x%p\n" 273162306a36Sopenharmony_ci " virtual base address:\t0x%p\n" 273262306a36Sopenharmony_ci " factory address (ESI):\t%pM\n" 273362306a36Sopenharmony_ci " board serial number:\t\t%d\n\n", 273462306a36Sopenharmony_ci fore200e_irq_itoa(fore200e->irq), 273562306a36Sopenharmony_ci (void*)fore200e->phys_base, 273662306a36Sopenharmony_ci fore200e->virt_base, 273762306a36Sopenharmony_ci fore200e->esi, 273862306a36Sopenharmony_ci fore200e->esi[4] * 256 + fore200e->esi[5]); 273962306a36Sopenharmony_ci 274062306a36Sopenharmony_ci return len; 274162306a36Sopenharmony_ci } 274262306a36Sopenharmony_ci 274362306a36Sopenharmony_ci if (!left--) 274462306a36Sopenharmony_ci return sprintf(page, 274562306a36Sopenharmony_ci " free small bufs, scheme 1:\t%d\n" 274662306a36Sopenharmony_ci " free large bufs, scheme 1:\t%d\n" 274762306a36Sopenharmony_ci " free small bufs, scheme 2:\t%d\n" 274862306a36Sopenharmony_ci " free large bufs, scheme 2:\t%d\n", 274962306a36Sopenharmony_ci fore200e->host_bsq[ BUFFER_SCHEME_ONE ][ BUFFER_MAGN_SMALL ].freebuf_count, 275062306a36Sopenharmony_ci fore200e->host_bsq[ BUFFER_SCHEME_ONE ][ BUFFER_MAGN_LARGE ].freebuf_count, 275162306a36Sopenharmony_ci fore200e->host_bsq[ BUFFER_SCHEME_TWO ][ BUFFER_MAGN_SMALL ].freebuf_count, 275262306a36Sopenharmony_ci fore200e->host_bsq[ BUFFER_SCHEME_TWO ][ BUFFER_MAGN_LARGE ].freebuf_count); 275362306a36Sopenharmony_ci 275462306a36Sopenharmony_ci if (!left--) { 275562306a36Sopenharmony_ci u32 hb = fore200e->bus->read(&fore200e->cp_queues->heartbeat); 275662306a36Sopenharmony_ci 275762306a36Sopenharmony_ci len = sprintf(page,"\n\n" 275862306a36Sopenharmony_ci " cell processor:\n" 275962306a36Sopenharmony_ci " heartbeat state:\t\t"); 276062306a36Sopenharmony_ci 276162306a36Sopenharmony_ci if (hb >> 16 != 0xDEAD) 276262306a36Sopenharmony_ci len += sprintf(page + len, "0x%08x\n", hb); 276362306a36Sopenharmony_ci else 276462306a36Sopenharmony_ci len += sprintf(page + len, "*** FATAL ERROR %04x ***\n", hb & 0xFFFF); 276562306a36Sopenharmony_ci 276662306a36Sopenharmony_ci return len; 276762306a36Sopenharmony_ci } 276862306a36Sopenharmony_ci 276962306a36Sopenharmony_ci if (!left--) { 277062306a36Sopenharmony_ci static const char* media_name[] = { 277162306a36Sopenharmony_ci "unshielded twisted pair", 277262306a36Sopenharmony_ci "multimode optical fiber ST", 277362306a36Sopenharmony_ci "multimode optical fiber SC", 277462306a36Sopenharmony_ci "single-mode optical fiber ST", 277562306a36Sopenharmony_ci "single-mode optical fiber SC", 277662306a36Sopenharmony_ci "unknown" 277762306a36Sopenharmony_ci }; 277862306a36Sopenharmony_ci 277962306a36Sopenharmony_ci static const char* oc3_mode[] = { 278062306a36Sopenharmony_ci "normal operation", 278162306a36Sopenharmony_ci "diagnostic loopback", 278262306a36Sopenharmony_ci "line loopback", 278362306a36Sopenharmony_ci "unknown" 278462306a36Sopenharmony_ci }; 278562306a36Sopenharmony_ci 278662306a36Sopenharmony_ci u32 fw_release = fore200e->bus->read(&fore200e->cp_queues->fw_release); 278762306a36Sopenharmony_ci u32 mon960_release = fore200e->bus->read(&fore200e->cp_queues->mon960_release); 278862306a36Sopenharmony_ci u32 oc3_revision = fore200e->bus->read(&fore200e->cp_queues->oc3_revision); 278962306a36Sopenharmony_ci u32 media_index = FORE200E_MEDIA_INDEX(fore200e->bus->read(&fore200e->cp_queues->media_type)); 279062306a36Sopenharmony_ci u32 oc3_index; 279162306a36Sopenharmony_ci 279262306a36Sopenharmony_ci if (media_index > 4) 279362306a36Sopenharmony_ci media_index = 5; 279462306a36Sopenharmony_ci 279562306a36Sopenharmony_ci switch (fore200e->loop_mode) { 279662306a36Sopenharmony_ci case ATM_LM_NONE: oc3_index = 0; 279762306a36Sopenharmony_ci break; 279862306a36Sopenharmony_ci case ATM_LM_LOC_PHY: oc3_index = 1; 279962306a36Sopenharmony_ci break; 280062306a36Sopenharmony_ci case ATM_LM_RMT_PHY: oc3_index = 2; 280162306a36Sopenharmony_ci break; 280262306a36Sopenharmony_ci default: oc3_index = 3; 280362306a36Sopenharmony_ci } 280462306a36Sopenharmony_ci 280562306a36Sopenharmony_ci return sprintf(page, 280662306a36Sopenharmony_ci " firmware release:\t\t%d.%d.%d\n" 280762306a36Sopenharmony_ci " monitor release:\t\t%d.%d\n" 280862306a36Sopenharmony_ci " media type:\t\t\t%s\n" 280962306a36Sopenharmony_ci " OC-3 revision:\t\t0x%x\n" 281062306a36Sopenharmony_ci " OC-3 mode:\t\t\t%s", 281162306a36Sopenharmony_ci fw_release >> 16, fw_release << 16 >> 24, fw_release << 24 >> 24, 281262306a36Sopenharmony_ci mon960_release >> 16, mon960_release << 16 >> 16, 281362306a36Sopenharmony_ci media_name[ media_index ], 281462306a36Sopenharmony_ci oc3_revision, 281562306a36Sopenharmony_ci oc3_mode[ oc3_index ]); 281662306a36Sopenharmony_ci } 281762306a36Sopenharmony_ci 281862306a36Sopenharmony_ci if (!left--) { 281962306a36Sopenharmony_ci struct cp_monitor __iomem * cp_monitor = fore200e->cp_monitor; 282062306a36Sopenharmony_ci 282162306a36Sopenharmony_ci return sprintf(page, 282262306a36Sopenharmony_ci "\n\n" 282362306a36Sopenharmony_ci " monitor:\n" 282462306a36Sopenharmony_ci " version number:\t\t%d\n" 282562306a36Sopenharmony_ci " boot status word:\t\t0x%08x\n", 282662306a36Sopenharmony_ci fore200e->bus->read(&cp_monitor->mon_version), 282762306a36Sopenharmony_ci fore200e->bus->read(&cp_monitor->bstat)); 282862306a36Sopenharmony_ci } 282962306a36Sopenharmony_ci 283062306a36Sopenharmony_ci if (!left--) 283162306a36Sopenharmony_ci return sprintf(page, 283262306a36Sopenharmony_ci "\n" 283362306a36Sopenharmony_ci " device statistics:\n" 283462306a36Sopenharmony_ci " 4b5b:\n" 283562306a36Sopenharmony_ci " crc_header_errors:\t\t%10u\n" 283662306a36Sopenharmony_ci " framing_errors:\t\t%10u\n", 283762306a36Sopenharmony_ci be32_to_cpu(fore200e->stats->phy.crc_header_errors), 283862306a36Sopenharmony_ci be32_to_cpu(fore200e->stats->phy.framing_errors)); 283962306a36Sopenharmony_ci 284062306a36Sopenharmony_ci if (!left--) 284162306a36Sopenharmony_ci return sprintf(page, "\n" 284262306a36Sopenharmony_ci " OC-3:\n" 284362306a36Sopenharmony_ci " section_bip8_errors:\t%10u\n" 284462306a36Sopenharmony_ci " path_bip8_errors:\t\t%10u\n" 284562306a36Sopenharmony_ci " line_bip24_errors:\t\t%10u\n" 284662306a36Sopenharmony_ci " line_febe_errors:\t\t%10u\n" 284762306a36Sopenharmony_ci " path_febe_errors:\t\t%10u\n" 284862306a36Sopenharmony_ci " corr_hcs_errors:\t\t%10u\n" 284962306a36Sopenharmony_ci " ucorr_hcs_errors:\t\t%10u\n", 285062306a36Sopenharmony_ci be32_to_cpu(fore200e->stats->oc3.section_bip8_errors), 285162306a36Sopenharmony_ci be32_to_cpu(fore200e->stats->oc3.path_bip8_errors), 285262306a36Sopenharmony_ci be32_to_cpu(fore200e->stats->oc3.line_bip24_errors), 285362306a36Sopenharmony_ci be32_to_cpu(fore200e->stats->oc3.line_febe_errors), 285462306a36Sopenharmony_ci be32_to_cpu(fore200e->stats->oc3.path_febe_errors), 285562306a36Sopenharmony_ci be32_to_cpu(fore200e->stats->oc3.corr_hcs_errors), 285662306a36Sopenharmony_ci be32_to_cpu(fore200e->stats->oc3.ucorr_hcs_errors)); 285762306a36Sopenharmony_ci 285862306a36Sopenharmony_ci if (!left--) 285962306a36Sopenharmony_ci return sprintf(page,"\n" 286062306a36Sopenharmony_ci " ATM:\t\t\t\t cells\n" 286162306a36Sopenharmony_ci " TX:\t\t\t%10u\n" 286262306a36Sopenharmony_ci " RX:\t\t\t%10u\n" 286362306a36Sopenharmony_ci " vpi out of range:\t\t%10u\n" 286462306a36Sopenharmony_ci " vpi no conn:\t\t%10u\n" 286562306a36Sopenharmony_ci " vci out of range:\t\t%10u\n" 286662306a36Sopenharmony_ci " vci no conn:\t\t%10u\n", 286762306a36Sopenharmony_ci be32_to_cpu(fore200e->stats->atm.cells_transmitted), 286862306a36Sopenharmony_ci be32_to_cpu(fore200e->stats->atm.cells_received), 286962306a36Sopenharmony_ci be32_to_cpu(fore200e->stats->atm.vpi_bad_range), 287062306a36Sopenharmony_ci be32_to_cpu(fore200e->stats->atm.vpi_no_conn), 287162306a36Sopenharmony_ci be32_to_cpu(fore200e->stats->atm.vci_bad_range), 287262306a36Sopenharmony_ci be32_to_cpu(fore200e->stats->atm.vci_no_conn)); 287362306a36Sopenharmony_ci 287462306a36Sopenharmony_ci if (!left--) 287562306a36Sopenharmony_ci return sprintf(page,"\n" 287662306a36Sopenharmony_ci " AAL0:\t\t\t cells\n" 287762306a36Sopenharmony_ci " TX:\t\t\t%10u\n" 287862306a36Sopenharmony_ci " RX:\t\t\t%10u\n" 287962306a36Sopenharmony_ci " dropped:\t\t\t%10u\n", 288062306a36Sopenharmony_ci be32_to_cpu(fore200e->stats->aal0.cells_transmitted), 288162306a36Sopenharmony_ci be32_to_cpu(fore200e->stats->aal0.cells_received), 288262306a36Sopenharmony_ci be32_to_cpu(fore200e->stats->aal0.cells_dropped)); 288362306a36Sopenharmony_ci 288462306a36Sopenharmony_ci if (!left--) 288562306a36Sopenharmony_ci return sprintf(page,"\n" 288662306a36Sopenharmony_ci " AAL3/4:\n" 288762306a36Sopenharmony_ci " SAR sublayer:\t\t cells\n" 288862306a36Sopenharmony_ci " TX:\t\t\t%10u\n" 288962306a36Sopenharmony_ci " RX:\t\t\t%10u\n" 289062306a36Sopenharmony_ci " dropped:\t\t\t%10u\n" 289162306a36Sopenharmony_ci " CRC errors:\t\t%10u\n" 289262306a36Sopenharmony_ci " protocol errors:\t\t%10u\n\n" 289362306a36Sopenharmony_ci " CS sublayer:\t\t PDUs\n" 289462306a36Sopenharmony_ci " TX:\t\t\t%10u\n" 289562306a36Sopenharmony_ci " RX:\t\t\t%10u\n" 289662306a36Sopenharmony_ci " dropped:\t\t\t%10u\n" 289762306a36Sopenharmony_ci " protocol errors:\t\t%10u\n", 289862306a36Sopenharmony_ci be32_to_cpu(fore200e->stats->aal34.cells_transmitted), 289962306a36Sopenharmony_ci be32_to_cpu(fore200e->stats->aal34.cells_received), 290062306a36Sopenharmony_ci be32_to_cpu(fore200e->stats->aal34.cells_dropped), 290162306a36Sopenharmony_ci be32_to_cpu(fore200e->stats->aal34.cells_crc_errors), 290262306a36Sopenharmony_ci be32_to_cpu(fore200e->stats->aal34.cells_protocol_errors), 290362306a36Sopenharmony_ci be32_to_cpu(fore200e->stats->aal34.cspdus_transmitted), 290462306a36Sopenharmony_ci be32_to_cpu(fore200e->stats->aal34.cspdus_received), 290562306a36Sopenharmony_ci be32_to_cpu(fore200e->stats->aal34.cspdus_dropped), 290662306a36Sopenharmony_ci be32_to_cpu(fore200e->stats->aal34.cspdus_protocol_errors)); 290762306a36Sopenharmony_ci 290862306a36Sopenharmony_ci if (!left--) 290962306a36Sopenharmony_ci return sprintf(page,"\n" 291062306a36Sopenharmony_ci " AAL5:\n" 291162306a36Sopenharmony_ci " SAR sublayer:\t\t cells\n" 291262306a36Sopenharmony_ci " TX:\t\t\t%10u\n" 291362306a36Sopenharmony_ci " RX:\t\t\t%10u\n" 291462306a36Sopenharmony_ci " dropped:\t\t\t%10u\n" 291562306a36Sopenharmony_ci " congestions:\t\t%10u\n\n" 291662306a36Sopenharmony_ci " CS sublayer:\t\t PDUs\n" 291762306a36Sopenharmony_ci " TX:\t\t\t%10u\n" 291862306a36Sopenharmony_ci " RX:\t\t\t%10u\n" 291962306a36Sopenharmony_ci " dropped:\t\t\t%10u\n" 292062306a36Sopenharmony_ci " CRC errors:\t\t%10u\n" 292162306a36Sopenharmony_ci " protocol errors:\t\t%10u\n", 292262306a36Sopenharmony_ci be32_to_cpu(fore200e->stats->aal5.cells_transmitted), 292362306a36Sopenharmony_ci be32_to_cpu(fore200e->stats->aal5.cells_received), 292462306a36Sopenharmony_ci be32_to_cpu(fore200e->stats->aal5.cells_dropped), 292562306a36Sopenharmony_ci be32_to_cpu(fore200e->stats->aal5.congestion_experienced), 292662306a36Sopenharmony_ci be32_to_cpu(fore200e->stats->aal5.cspdus_transmitted), 292762306a36Sopenharmony_ci be32_to_cpu(fore200e->stats->aal5.cspdus_received), 292862306a36Sopenharmony_ci be32_to_cpu(fore200e->stats->aal5.cspdus_dropped), 292962306a36Sopenharmony_ci be32_to_cpu(fore200e->stats->aal5.cspdus_crc_errors), 293062306a36Sopenharmony_ci be32_to_cpu(fore200e->stats->aal5.cspdus_protocol_errors)); 293162306a36Sopenharmony_ci 293262306a36Sopenharmony_ci if (!left--) 293362306a36Sopenharmony_ci return sprintf(page,"\n" 293462306a36Sopenharmony_ci " AUX:\t\t allocation failures\n" 293562306a36Sopenharmony_ci " small b1:\t\t\t%10u\n" 293662306a36Sopenharmony_ci " large b1:\t\t\t%10u\n" 293762306a36Sopenharmony_ci " small b2:\t\t\t%10u\n" 293862306a36Sopenharmony_ci " large b2:\t\t\t%10u\n" 293962306a36Sopenharmony_ci " RX PDUs:\t\t\t%10u\n" 294062306a36Sopenharmony_ci " TX PDUs:\t\t\t%10lu\n", 294162306a36Sopenharmony_ci be32_to_cpu(fore200e->stats->aux.small_b1_failed), 294262306a36Sopenharmony_ci be32_to_cpu(fore200e->stats->aux.large_b1_failed), 294362306a36Sopenharmony_ci be32_to_cpu(fore200e->stats->aux.small_b2_failed), 294462306a36Sopenharmony_ci be32_to_cpu(fore200e->stats->aux.large_b2_failed), 294562306a36Sopenharmony_ci be32_to_cpu(fore200e->stats->aux.rpd_alloc_failed), 294662306a36Sopenharmony_ci fore200e->tx_sat); 294762306a36Sopenharmony_ci 294862306a36Sopenharmony_ci if (!left--) 294962306a36Sopenharmony_ci return sprintf(page,"\n" 295062306a36Sopenharmony_ci " receive carrier:\t\t\t%s\n", 295162306a36Sopenharmony_ci fore200e->stats->aux.receive_carrier ? "ON" : "OFF!"); 295262306a36Sopenharmony_ci 295362306a36Sopenharmony_ci if (!left--) { 295462306a36Sopenharmony_ci return sprintf(page,"\n" 295562306a36Sopenharmony_ci " VCCs:\n address VPI VCI AAL " 295662306a36Sopenharmony_ci "TX PDUs TX min/max size RX PDUs RX min/max size\n"); 295762306a36Sopenharmony_ci } 295862306a36Sopenharmony_ci 295962306a36Sopenharmony_ci for (i = 0; i < NBR_CONNECT; i++) { 296062306a36Sopenharmony_ci 296162306a36Sopenharmony_ci vcc = fore200e->vc_map[i].vcc; 296262306a36Sopenharmony_ci 296362306a36Sopenharmony_ci if (vcc == NULL) 296462306a36Sopenharmony_ci continue; 296562306a36Sopenharmony_ci 296662306a36Sopenharmony_ci spin_lock_irqsave(&fore200e->q_lock, flags); 296762306a36Sopenharmony_ci 296862306a36Sopenharmony_ci if (vcc && test_bit(ATM_VF_READY, &vcc->flags) && !left--) { 296962306a36Sopenharmony_ci 297062306a36Sopenharmony_ci fore200e_vcc = FORE200E_VCC(vcc); 297162306a36Sopenharmony_ci ASSERT(fore200e_vcc); 297262306a36Sopenharmony_ci 297362306a36Sopenharmony_ci len = sprintf(page, 297462306a36Sopenharmony_ci " %pK %03d %05d %1d %09lu %05d/%05d %09lu %05d/%05d\n", 297562306a36Sopenharmony_ci vcc, 297662306a36Sopenharmony_ci vcc->vpi, vcc->vci, fore200e_atm2fore_aal(vcc->qos.aal), 297762306a36Sopenharmony_ci fore200e_vcc->tx_pdu, 297862306a36Sopenharmony_ci fore200e_vcc->tx_min_pdu > 0xFFFF ? 0 : fore200e_vcc->tx_min_pdu, 297962306a36Sopenharmony_ci fore200e_vcc->tx_max_pdu, 298062306a36Sopenharmony_ci fore200e_vcc->rx_pdu, 298162306a36Sopenharmony_ci fore200e_vcc->rx_min_pdu > 0xFFFF ? 0 : fore200e_vcc->rx_min_pdu, 298262306a36Sopenharmony_ci fore200e_vcc->rx_max_pdu); 298362306a36Sopenharmony_ci 298462306a36Sopenharmony_ci spin_unlock_irqrestore(&fore200e->q_lock, flags); 298562306a36Sopenharmony_ci return len; 298662306a36Sopenharmony_ci } 298762306a36Sopenharmony_ci 298862306a36Sopenharmony_ci spin_unlock_irqrestore(&fore200e->q_lock, flags); 298962306a36Sopenharmony_ci } 299062306a36Sopenharmony_ci 299162306a36Sopenharmony_ci return 0; 299262306a36Sopenharmony_ci} 299362306a36Sopenharmony_ci 299462306a36Sopenharmony_cimodule_init(fore200e_module_init); 299562306a36Sopenharmony_cimodule_exit(fore200e_module_cleanup); 299662306a36Sopenharmony_ci 299762306a36Sopenharmony_ci 299862306a36Sopenharmony_cistatic const struct atmdev_ops fore200e_ops = { 299962306a36Sopenharmony_ci .open = fore200e_open, 300062306a36Sopenharmony_ci .close = fore200e_close, 300162306a36Sopenharmony_ci .ioctl = fore200e_ioctl, 300262306a36Sopenharmony_ci .send = fore200e_send, 300362306a36Sopenharmony_ci .change_qos = fore200e_change_qos, 300462306a36Sopenharmony_ci .proc_read = fore200e_proc_read, 300562306a36Sopenharmony_ci .owner = THIS_MODULE 300662306a36Sopenharmony_ci}; 300762306a36Sopenharmony_ci 300862306a36Sopenharmony_ciMODULE_LICENSE("GPL"); 300962306a36Sopenharmony_ci#ifdef CONFIG_PCI 301062306a36Sopenharmony_ci#ifdef __LITTLE_ENDIAN__ 301162306a36Sopenharmony_ciMODULE_FIRMWARE("pca200e.bin"); 301262306a36Sopenharmony_ci#else 301362306a36Sopenharmony_ciMODULE_FIRMWARE("pca200e_ecd.bin2"); 301462306a36Sopenharmony_ci#endif 301562306a36Sopenharmony_ci#endif /* CONFIG_PCI */ 301662306a36Sopenharmony_ci#ifdef CONFIG_SBUS 301762306a36Sopenharmony_ciMODULE_FIRMWARE("sba200e_ecd.bin2"); 301862306a36Sopenharmony_ci#endif 3019