11da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* drivers/atm/idt77105.c - IDT77105 (PHY) driver */ 21da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 31da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* Written 1999 by Greg Banks, NEC Australia <gnb@linuxfan.com>. Based on suni.c */ 41da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 51da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 61da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/module.h> 71da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/kernel.h> 81da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/mm.h> 91da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/errno.h> 101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/atmdev.h> 111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/sonet.h> 121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/delay.h> 131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/timer.h> 141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/init.h> 151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/capability.h> 161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/atm_idt77105.h> 171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/spinlock.h> 185a0e3ad6af8660be21ca98a971cd00f331318c05Tejun Heo#include <linux/slab.h> 191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/param.h> 201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/uaccess.h> 211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include "idt77105.h" 231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#undef GENERAL_DEBUG 251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#ifdef GENERAL_DEBUG 271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define DPRINTK(format,args...) printk(KERN_DEBUG format,##args) 281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#else 291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define DPRINTK(format,args...) 301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstruct idt77105_priv { 341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct idt77105_stats stats; /* link diagnostics */ 351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct atm_dev *dev; /* device back-pointer */ 361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct idt77105_priv *next; 371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int loop_mode; 381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned char old_mcr; /* storage of MCR reg while signal lost */ 391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic DEFINE_SPINLOCK(idt77105_priv_lock); 421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define PRIV(dev) ((struct idt77105_priv *) dev->phy_data) 441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define PUT(val,reg) dev->ops->phy_put(dev,val,IDT77105_##reg) 461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define GET(reg) dev->ops->phy_get(dev,IDT77105_##reg) 471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void idt77105_stats_timer_func(unsigned long); 491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void idt77105_restart_timer_func(unsigned long); 501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 528d06afab73a75f40ae2864e6c296356bab1ab473Ingo Molnarstatic DEFINE_TIMER(stats_timer, idt77105_stats_timer_func, 0, 0); 538d06afab73a75f40ae2864e6c296356bab1ab473Ingo Molnarstatic DEFINE_TIMER(restart_timer, idt77105_restart_timer_func, 0, 0); 541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int start_timer = 1; 551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct idt77105_priv *idt77105_all = NULL; 561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Retrieve the value of one of the IDT77105's counters. 591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * `counter' is one of the IDT77105_CTRSEL_* constants. 601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic u16 get_counter(struct atm_dev *dev, int counter) 621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u16 val; 641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* write the counter bit into PHY register 6 */ 661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds PUT(counter, CTRSEL); 671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* read the low 8 bits from register 4 */ 681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds val = GET(CTRLO); 691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* read the high 8 bits from register 5 */ 701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds val |= GET(CTRHI)<<8; 711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return val; 731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Timer function called every second to gather statistics 771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * from the 77105. This is done because the h/w registers 781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * will overflow if not read at least once per second. The 791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * kernel's stats are much higher precision. Also, having 801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * a separate copy of the stats allows implementation of 811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * an ioctl which gathers the stats *without* zero'ing them. 821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void idt77105_stats_timer_func(unsigned long dummy) 841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct idt77105_priv *walk; 861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct atm_dev *dev; 871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct idt77105_stats *stats; 881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DPRINTK("IDT77105 gathering statistics\n"); 901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (walk = idt77105_all; walk; walk = walk->next) { 911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev = walk->dev; 921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds stats = &walk->stats; 941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds stats->symbol_errors += get_counter(dev, IDT77105_CTRSEL_SEC); 951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds stats->tx_cells += get_counter(dev, IDT77105_CTRSEL_TCC); 961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds stats->rx_cells += get_counter(dev, IDT77105_CTRSEL_RCC); 971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds stats->rx_hec_errors += get_counter(dev, IDT77105_CTRSEL_RHEC); 981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!start_timer) mod_timer(&stats_timer,jiffies+IDT77105_STATS_TIMER_PERIOD); 1001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 1041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * A separate timer func which handles restarting PHY chips which 1051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * have had the cable re-inserted after being pulled out. This is 1061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * done by polling the Good Signal Bit in the Interrupt Status 1071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * register every 5 seconds. The other technique (checking Good 1081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Signal Bit in the interrupt handler) cannot be used because PHY 1091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * interrupts need to be disabled when the cable is pulled out 1101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * to avoid lots of spurious cell error interrupts. 1111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 1121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void idt77105_restart_timer_func(unsigned long dummy) 1131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct idt77105_priv *walk; 1151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct atm_dev *dev; 1161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned char istat; 1171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DPRINTK("IDT77105 checking for cable re-insertion\n"); 1191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (walk = idt77105_all; walk; walk = walk->next) { 1201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev = walk->dev; 1211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (dev->signal != ATM_PHY_SIG_LOST) 1231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds continue; 1241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds istat = GET(ISTAT); /* side effect: clears all interrupt status bits */ 1261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (istat & IDT77105_ISTAT_GOODSIG) { 1271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Found signal again */ 1280753455322a957e6a8fd8a9db163ba5aec92ce76Karl Hiramoto atm_dev_signal_change(dev, ATM_PHY_SIG_FOUND); 1291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_NOTICE "%s(itf %d): signal detected again\n", 1301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->type,dev->number); 1311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* flush the receive FIFO */ 1321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds PUT( GET(DIAG) | IDT77105_DIAG_RFLUSH, DIAG); 1331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* re-enable interrupts */ 1341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds PUT( walk->old_mcr ,MCR); 1351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!start_timer) mod_timer(&restart_timer,jiffies+IDT77105_RESTART_TIMER_PERIOD); 1381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int fetch_stats(struct atm_dev *dev,struct idt77105_stats __user *arg,int zero) 1421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long flags; 1441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct idt77105_stats stats; 1451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irqsave(&idt77105_priv_lock, flags); 1471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memcpy(&stats, &PRIV(dev)->stats, sizeof(struct idt77105_stats)); 1481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (zero) 1491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memset(&PRIV(dev)->stats, 0, sizeof(struct idt77105_stats)); 1501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irqrestore(&idt77105_priv_lock, flags); 1511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (arg == NULL) 1521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 1532221eca0a2c0f7f9918efdcaa52fb8e1adff991fVasiliy Kulikov return copy_to_user(arg, &stats, 1541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sizeof(struct idt77105_stats)) ? -EFAULT : 0; 1551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int set_loopback(struct atm_dev *dev,int mode) 1591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int diag; 1611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds diag = GET(DIAG) & ~IDT77105_DIAG_LCMASK; 1631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (mode) { 1641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case ATM_LM_NONE: 1651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 1661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case ATM_LM_LOC_ATM: 1671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds diag |= IDT77105_DIAG_LC_PHY_LOOPBACK; 1681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 1691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case ATM_LM_RMT_ATM: 1701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds diag |= IDT77105_DIAG_LC_LINE_LOOPBACK; 1711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 1721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds default: 1731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 1741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds PUT(diag,DIAG); 1761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_NOTICE "%s(%d) Loopback mode is: %s\n", dev->type, 1771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->number, 1781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (mode == ATM_LM_NONE ? "NONE" : 1791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (mode == ATM_LM_LOC_ATM ? "DIAG (local)" : 1801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (mode == IDT77105_DIAG_LC_LINE_LOOPBACK ? "LOOP (remote)" : 1811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds "unknown"))) 1821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ); 1831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds PRIV(dev)->loop_mode = mode; 1841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 1851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int idt77105_ioctl(struct atm_dev *dev,unsigned int cmd,void __user *arg) 1891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_NOTICE "%s(%d) idt77105_ioctl() called\n",dev->type,dev->number); 1911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (cmd) { 1921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case IDT77105_GETSTATZ: 1931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!capable(CAP_NET_ADMIN)) return -EPERM; 1941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* fall through */ 1951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case IDT77105_GETSTAT: 1961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return fetch_stats(dev, arg, cmd == IDT77105_GETSTATZ); 1971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case ATM_SETLOOP: 1981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return set_loopback(dev,(int)(unsigned long) arg); 1991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case ATM_GETLOOP: 2001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return put_user(PRIV(dev)->loop_mode,(int __user *)arg) ? 2011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds -EFAULT : 0; 2021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case ATM_QUERYLOOP: 2031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return put_user(ATM_LM_LOC_ATM | ATM_LM_RMT_ATM, 2041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (int __user *) arg) ? -EFAULT : 0; 2051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds default: 2061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENOIOCTLCMD; 2071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 2081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void idt77105_int(struct atm_dev *dev) 2131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned char istat; 2151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds istat = GET(ISTAT); /* side effect: clears all interrupt status bits */ 2171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DPRINTK("IDT77105 generated an interrupt, istat=%02x\n", (unsigned)istat); 2191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (istat & IDT77105_ISTAT_RSCC) { 2211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Rx Signal Condition Change - line went up or down */ 2221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (istat & IDT77105_ISTAT_GOODSIG) { /* signal detected again */ 2231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* This should not happen (restart timer does it) but JIC */ 2240753455322a957e6a8fd8a9db163ba5aec92ce76Karl Hiramoto atm_dev_signal_change(dev, ATM_PHY_SIG_FOUND); 2251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { /* signal lost */ 2261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 2271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Disable interrupts and stop all transmission and 2281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * reception - the restart timer will restore these. 2291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 2301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds PRIV(dev)->old_mcr = GET(MCR); 2311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds PUT( 2321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (PRIV(dev)->old_mcr| 2331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds IDT77105_MCR_DREC| 2341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds IDT77105_MCR_DRIC| 2351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds IDT77105_MCR_HALTTX 2361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ) & ~IDT77105_MCR_EIP, MCR); 2370753455322a957e6a8fd8a9db163ba5aec92ce76Karl Hiramoto atm_dev_signal_change(dev, ATM_PHY_SIG_LOST); 2381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_NOTICE "%s(itf %d): signal lost\n", 2391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->type,dev->number); 2401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 2411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 2421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (istat & IDT77105_ISTAT_RFO) { 2441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Rx FIFO Overrun -- perform a FIFO flush */ 2451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds PUT( GET(DIAG) | IDT77105_DIAG_RFLUSH, DIAG); 2461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_NOTICE "%s(itf %d): receive FIFO overrun\n", 2471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->type,dev->number); 2481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 2491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#ifdef GENERAL_DEBUG 2501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (istat & (IDT77105_ISTAT_HECERR | IDT77105_ISTAT_SCR | 2511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds IDT77105_ISTAT_RSE)) { 2521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* normally don't care - just report in stats */ 2531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_NOTICE "%s(itf %d): received cell with error\n", 2541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->type,dev->number); 2551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 2561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 2571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int idt77105_start(struct atm_dev *dev) 2611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long flags; 2631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!(dev->dev_data = kmalloc(sizeof(struct idt77105_priv),GFP_KERNEL))) 2651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENOMEM; 2661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds PRIV(dev)->dev = dev; 2671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irqsave(&idt77105_priv_lock, flags); 2681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds PRIV(dev)->next = idt77105_all; 2691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds idt77105_all = PRIV(dev); 2701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irqrestore(&idt77105_priv_lock, flags); 2711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memset(&PRIV(dev)->stats,0,sizeof(struct idt77105_stats)); 2721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* initialise dev->signal from Good Signal Bit */ 2740753455322a957e6a8fd8a9db163ba5aec92ce76Karl Hiramoto atm_dev_signal_change(dev, 2750753455322a957e6a8fd8a9db163ba5aec92ce76Karl Hiramoto GET(ISTAT) & IDT77105_ISTAT_GOODSIG ? 2760753455322a957e6a8fd8a9db163ba5aec92ce76Karl Hiramoto ATM_PHY_SIG_FOUND : ATM_PHY_SIG_LOST); 2771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (dev->signal == ATM_PHY_SIG_LOST) 2781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_WARNING "%s(itf %d): no signal\n",dev->type, 2791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->number); 2801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* initialise loop mode from hardware */ 2821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch ( GET(DIAG) & IDT77105_DIAG_LCMASK ) { 2831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case IDT77105_DIAG_LC_NORMAL: 2841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds PRIV(dev)->loop_mode = ATM_LM_NONE; 2851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 2861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case IDT77105_DIAG_LC_PHY_LOOPBACK: 2871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds PRIV(dev)->loop_mode = ATM_LM_LOC_ATM; 2881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 2891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case IDT77105_DIAG_LC_LINE_LOOPBACK: 2901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds PRIV(dev)->loop_mode = ATM_LM_RMT_ATM; 2911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 2921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 2931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* enable interrupts, e.g. on loss of signal */ 2951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds PRIV(dev)->old_mcr = GET(MCR); 2961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (dev->signal == ATM_PHY_SIG_FOUND) { 2971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds PRIV(dev)->old_mcr |= IDT77105_MCR_EIP; 2981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds PUT(PRIV(dev)->old_mcr, MCR); 2991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds idt77105_stats_timer_func(0); /* clear 77105 counters */ 3031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (void) fetch_stats(dev,NULL,1); /* clear kernel counters */ 3041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irqsave(&idt77105_priv_lock, flags); 3061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (start_timer) { 3071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds start_timer = 0; 3081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_timer(&stats_timer); 3101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds stats_timer.expires = jiffies+IDT77105_STATS_TIMER_PERIOD; 3111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds stats_timer.function = idt77105_stats_timer_func; 3121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds add_timer(&stats_timer); 3131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_timer(&restart_timer); 3151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds restart_timer.expires = jiffies+IDT77105_RESTART_TIMER_PERIOD; 3161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds restart_timer.function = idt77105_restart_timer_func; 3171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds add_timer(&restart_timer); 3181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irqrestore(&idt77105_priv_lock, flags); 3201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 3211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 3221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int idt77105_stop(struct atm_dev *dev) 3251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 3261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct idt77105_priv *walk, *prev; 3271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DPRINTK("%s(itf %d): stopping IDT77105\n",dev->type,dev->number); 3291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* disable interrupts */ 3311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds PUT( GET(MCR) & ~IDT77105_MCR_EIP, MCR ); 3321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* detach private struct from atm_dev & free */ 3341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (prev = NULL, walk = idt77105_all ; 3351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds walk != NULL; 3361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds prev = walk, walk = walk->next) { 3371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (walk->dev == dev) { 3381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (prev != NULL) 3391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds prev->next = walk->next; 3401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 3411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds idt77105_all = walk->next; 3421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->phy = NULL; 3431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->dev_data = NULL; 3441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kfree(walk); 3451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 3461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 3501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 3511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic const struct atmphy_ops idt77105_ops = { 3541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .start = idt77105_start, 3551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .ioctl = idt77105_ioctl, 3561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .interrupt = idt77105_int, 3571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .stop = idt77105_stop, 3581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 3591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 361799fa6779bc870a32377000b42a3e6297446ed10Adrian Bunkint idt77105_init(struct atm_dev *dev) 3621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 3631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->phy = &idt77105_ops; 3641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 3651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 3661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsEXPORT_SYMBOL(idt77105_init); 3681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void __exit idt77105_exit(void) 3701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 371869f273911dd37ed9086d6ab25ef832d10813ccdThomas Gleixner /* turn off timers */ 372869f273911dd37ed9086d6ab25ef832d10813ccdThomas Gleixner del_timer_sync(&stats_timer); 373869f273911dd37ed9086d6ab25ef832d10813ccdThomas Gleixner del_timer_sync(&restart_timer); 3741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 3751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmodule_exit(idt77105_exit); 3771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_LICENSE("GPL"); 379