^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0-only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * drivers/atm/suni.c - S/UNI PHY driver
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * Supports the following:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) * PMC PM5346 S/UNI LITE
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) * PMC PM5350 S/UNI 155 ULTRA
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) * PMC PM5355 S/UNI 622
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) /* Written 1995-2000 by Werner Almesberger, EPFL LRC/ICA */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <linux/jiffies.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include <linux/mm.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #include <linux/errno.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) #include <linux/atmdev.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) #include <linux/sonet.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) #include <linux/delay.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) #include <linux/timer.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) #include <linux/init.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) #include <linux/capability.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) #include <linux/atm_suni.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) #include <asm/param.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) #include <linux/uaccess.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) #include <linux/atomic.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) #include "suni.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) #if 0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) #define DPRINTK(format,args...) printk(KERN_DEBUG format,##args)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) #else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) #define DPRINTK(format,args...)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) #define PRIV(dev) ((struct suni_priv *) dev->phy_data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) #define PUT(val,reg) dev->ops->phy_put(dev,val,SUNI_##reg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) #define GET(reg) dev->ops->phy_get(dev,SUNI_##reg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) #define REG_CHANGE(mask,shift,value,reg) \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) PUT((GET(reg) & ~(mask)) | ((value) << (shift)),reg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) static struct timer_list poll_timer;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) static struct suni_priv *sunis = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) static DEFINE_SPINLOCK(sunis_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) #define ADD_LIMITED(s,v) \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) atomic_add((v),&stats->s); \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) if (atomic_read(&stats->s) < 0) atomic_set(&stats->s,INT_MAX);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) static void suni_hz(struct timer_list *timer)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) struct suni_priv *walk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) struct atm_dev *dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) struct k_sonet_stats *stats;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) for (walk = sunis; walk; walk = walk->next) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) dev = walk->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) stats = &walk->sonet_stats;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) PUT(0,MRI); /* latch counters */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) udelay(1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) ADD_LIMITED(section_bip,(GET(RSOP_SBL) & 0xff) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) ((GET(RSOP_SBM) & 0xff) << 8));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) ADD_LIMITED(line_bip,(GET(RLOP_LBL) & 0xff) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) ((GET(RLOP_LB) & 0xff) << 8) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) ((GET(RLOP_LBM) & 0xf) << 16));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) ADD_LIMITED(path_bip,(GET(RPOP_PBL) & 0xff) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) ((GET(RPOP_PBM) & 0xff) << 8));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) ADD_LIMITED(line_febe,(GET(RLOP_LFL) & 0xff) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) ((GET(RLOP_LF) & 0xff) << 8) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) ((GET(RLOP_LFM) & 0xf) << 16));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) ADD_LIMITED(path_febe,(GET(RPOP_PFL) & 0xff) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) ((GET(RPOP_PFM) & 0xff) << 8));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) ADD_LIMITED(corr_hcs,GET(RACP_CHEC) & 0xff);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) ADD_LIMITED(uncorr_hcs,GET(RACP_UHEC) & 0xff);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) ADD_LIMITED(rx_cells,(GET(RACP_RCCL) & 0xff) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) ((GET(RACP_RCC) & 0xff) << 8) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) ((GET(RACP_RCCM) & 7) << 16));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) ADD_LIMITED(tx_cells,(GET(TACP_TCCL) & 0xff) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) ((GET(TACP_TCC) & 0xff) << 8) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) ((GET(TACP_TCCM) & 7) << 16));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) if (timer) mod_timer(&poll_timer,jiffies+HZ);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) #undef ADD_LIMITED
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) static int fetch_stats(struct atm_dev *dev,struct sonet_stats __user *arg,int zero)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) struct sonet_stats tmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) int error = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) sonet_copy_stats(&PRIV(dev)->sonet_stats,&tmp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) if (arg) error = copy_to_user(arg,&tmp,sizeof(tmp));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) if (zero && !error) sonet_subtract_stats(&PRIV(dev)->sonet_stats,&tmp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) return error ? -EFAULT : 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) #define HANDLE_FLAG(flag,reg,bit) \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) if (todo & flag) { \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) if (set) PUT(GET(reg) | bit,reg); \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) else PUT(GET(reg) & ~bit,reg); \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) todo &= ~flag; \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) static int change_diag(struct atm_dev *dev,void __user *arg,int set)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) int todo;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) if (get_user(todo,(int __user *)arg)) return -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) HANDLE_FLAG(SONET_INS_SBIP,TSOP_DIAG,SUNI_TSOP_DIAG_DBIP8);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) HANDLE_FLAG(SONET_INS_LBIP,TLOP_DIAG,SUNI_TLOP_DIAG_DBIP);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) HANDLE_FLAG(SONET_INS_PBIP,TPOP_CD,SUNI_TPOP_DIAG_DB3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) HANDLE_FLAG(SONET_INS_FRAME,RSOP_CIE,SUNI_RSOP_CIE_FOOF);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) HANDLE_FLAG(SONET_INS_LAIS,TSOP_CTRL,SUNI_TSOP_CTRL_LAIS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) HANDLE_FLAG(SONET_INS_PAIS,TPOP_CD,SUNI_TPOP_DIAG_PAIS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) HANDLE_FLAG(SONET_INS_LOS,TSOP_DIAG,SUNI_TSOP_DIAG_DLOS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) HANDLE_FLAG(SONET_INS_HCS,TACP_CS,SUNI_TACP_CS_DHCS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) return put_user(todo,(int __user *)arg) ? -EFAULT : 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) #undef HANDLE_FLAG
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) static int get_diag(struct atm_dev *dev,void __user *arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) int set;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) set = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) if (GET(TSOP_DIAG) & SUNI_TSOP_DIAG_DBIP8) set |= SONET_INS_SBIP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) if (GET(TLOP_DIAG) & SUNI_TLOP_DIAG_DBIP) set |= SONET_INS_LBIP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) if (GET(TPOP_CD) & SUNI_TPOP_DIAG_DB3) set |= SONET_INS_PBIP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) /* SONET_INS_FRAME is one-shot only */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) if (GET(TSOP_CTRL) & SUNI_TSOP_CTRL_LAIS) set |= SONET_INS_LAIS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) if (GET(TPOP_CD) & SUNI_TPOP_DIAG_PAIS) set |= SONET_INS_PAIS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) if (GET(TSOP_DIAG) & SUNI_TSOP_DIAG_DLOS) set |= SONET_INS_LOS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) if (GET(TACP_CS) & SUNI_TACP_CS_DHCS) set |= SONET_INS_HCS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) return put_user(set,(int __user *)arg) ? -EFAULT : 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) static int set_loopback(struct atm_dev *dev,int mode)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) unsigned char control;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) int reg, dle, lle;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) if (PRIV(dev)->type == SUNI_MRI_TYPE_PM5355) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) reg = SUNI_MCM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) dle = SUNI_MCM_DLE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) lle = SUNI_MCM_LLE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) reg = SUNI_MCT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) dle = SUNI_MCT_DLE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) lle = SUNI_MCT_LLE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) control = dev->ops->phy_get(dev, reg) & ~(dle | lle);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) switch (mode) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) case ATM_LM_NONE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) case ATM_LM_LOC_PHY:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) control |= dle;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) case ATM_LM_RMT_PHY:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) control |= lle;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) dev->ops->phy_put(dev, control, reg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) PRIV(dev)->loop_mode = mode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) * SONET vs. SDH Configuration
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) * Z0INS (register 0x06): 0 for SONET, 1 for SDH
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) * ENSS (register 0x3D): 0 for SONET, 1 for SDH
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) * LEN16 (register 0x28): 0 for SONET, 1 for SDH (n/a for S/UNI 155 QUAD)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) * LEN16 (register 0x50): 0 for SONET, 1 for SDH (n/a for S/UNI 155 QUAD)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) * S[1:0] (register 0x46): 00 for SONET, 10 for SDH
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) static int set_sonet(struct atm_dev *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) if (PRIV(dev)->type == SUNI_MRI_TYPE_PM5355) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) PUT(GET(RPOP_RC) & ~SUNI_RPOP_RC_ENSS, RPOP_RC);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) PUT(GET(SSTB_CTRL) & ~SUNI_SSTB_CTRL_LEN16, SSTB_CTRL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) PUT(GET(SPTB_CTRL) & ~SUNI_SPTB_CTRL_LEN16, SPTB_CTRL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) REG_CHANGE(SUNI_TPOP_APM_S, SUNI_TPOP_APM_S_SHIFT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) SUNI_TPOP_S_SONET, TPOP_APM);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) static int set_sdh(struct atm_dev *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) if (PRIV(dev)->type == SUNI_MRI_TYPE_PM5355) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) PUT(GET(RPOP_RC) | SUNI_RPOP_RC_ENSS, RPOP_RC);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) PUT(GET(SSTB_CTRL) | SUNI_SSTB_CTRL_LEN16, SSTB_CTRL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) PUT(GET(SPTB_CTRL) | SUNI_SPTB_CTRL_LEN16, SPTB_CTRL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) REG_CHANGE(SUNI_TPOP_APM_S, SUNI_TPOP_APM_S_SHIFT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) SUNI_TPOP_S_SDH, TPOP_APM);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) static int get_framing(struct atm_dev *dev, void __user *arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) int framing;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) unsigned char s;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) s = (GET(TPOP_APM) & SUNI_TPOP_APM_S) >> SUNI_TPOP_APM_S_SHIFT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) if (s == SUNI_TPOP_S_SONET)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) framing = SONET_FRAME_SONET;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) framing = SONET_FRAME_SDH;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) return put_user(framing, (int __user *) arg) ? -EFAULT : 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) static int set_framing(struct atm_dev *dev, void __user *arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) int mode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) if (get_user(mode, (int __user *) arg))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) return -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) if (mode == SONET_FRAME_SONET)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) return set_sonet(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) else if (mode == SONET_FRAME_SDH)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) return set_sdh(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) static int suni_ioctl(struct atm_dev *dev,unsigned int cmd,void __user *arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) switch (cmd) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) case SONET_GETSTATZ:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) case SONET_GETSTAT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) return fetch_stats(dev, arg, cmd == SONET_GETSTATZ);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) case SONET_SETDIAG:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) return change_diag(dev,arg,1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) case SONET_CLRDIAG:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) return change_diag(dev,arg,0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) case SONET_GETDIAG:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) return get_diag(dev,arg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) case SONET_SETFRAMING:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) if (!capable(CAP_NET_ADMIN))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) return -EPERM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) return set_framing(dev, arg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) case SONET_GETFRAMING:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) return get_framing(dev, arg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) case SONET_GETFRSENSE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) case ATM_SETLOOP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) if (!capable(CAP_NET_ADMIN))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) return -EPERM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) return set_loopback(dev,(int)(unsigned long)arg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) case ATM_GETLOOP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) return put_user(PRIV(dev)->loop_mode,(int __user *)arg) ?
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) -EFAULT : 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) case ATM_QUERYLOOP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) return put_user(ATM_LM_LOC_PHY | ATM_LM_RMT_PHY,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) (int __user *) arg) ? -EFAULT : 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) return -ENOIOCTLCMD;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) static void poll_los(struct atm_dev *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) atm_dev_signal_change(dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) GET(RSOP_SIS) & SUNI_RSOP_SIS_LOSV ?
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) ATM_PHY_SIG_LOST : ATM_PHY_SIG_FOUND);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) static void suni_int(struct atm_dev *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) poll_los(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) printk(KERN_NOTICE "%s(itf %d): signal %s\n",dev->type,dev->number,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) dev->signal == ATM_PHY_SIG_LOST ? "lost" : "detected again");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) static int suni_start(struct atm_dev *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) int first;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) spin_lock_irqsave(&sunis_lock,flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) first = !sunis;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) PRIV(dev)->next = sunis;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) sunis = PRIV(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) spin_unlock_irqrestore(&sunis_lock,flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) memset(&PRIV(dev)->sonet_stats,0,sizeof(struct k_sonet_stats));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) PUT(GET(RSOP_CIE) | SUNI_RSOP_CIE_LOSE,RSOP_CIE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) /* interrupt on loss of signal */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) poll_los(dev); /* ... and clear SUNI interrupts */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) if (dev->signal == ATM_PHY_SIG_LOST)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) printk(KERN_WARNING "%s(itf %d): no signal\n",dev->type,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) dev->number);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) PRIV(dev)->loop_mode = ATM_LM_NONE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) suni_hz(NULL); /* clear SUNI counters */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) (void) fetch_stats(dev,NULL,1); /* clear kernel counters */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) if (first) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) timer_setup(&poll_timer, suni_hz, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) poll_timer.expires = jiffies+HZ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) #if 0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) printk(KERN_DEBUG "[u] p=0x%lx,n=0x%lx\n",(unsigned long) poll_timer.list.prev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) (unsigned long) poll_timer.list.next);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) add_timer(&poll_timer);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) static int suni_stop(struct atm_dev *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) struct suni_priv **walk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) /* let SAR driver worry about stopping interrupts */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) spin_lock_irqsave(&sunis_lock,flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) for (walk = &sunis; *walk != PRIV(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) walk = &PRIV((*walk)->dev)->next);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) *walk = PRIV((*walk)->dev)->next;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) if (!sunis) del_timer_sync(&poll_timer);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) spin_unlock_irqrestore(&sunis_lock,flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) kfree(PRIV(dev));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) static const struct atmphy_ops suni_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) .start = suni_start,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) .ioctl = suni_ioctl,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) .interrupt = suni_int,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) .stop = suni_stop,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) int suni_init(struct atm_dev *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) unsigned char mri;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) if (!(dev->phy_data = kmalloc(sizeof(struct suni_priv),GFP_KERNEL)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) PRIV(dev)->dev = dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) mri = GET(MRI); /* reset SUNI */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) PRIV(dev)->type = (mri & SUNI_MRI_TYPE) >> SUNI_MRI_TYPE_SHIFT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) PUT(mri | SUNI_MRI_RESET,MRI);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) PUT(mri,MRI);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) PUT((GET(MT) & SUNI_MT_DS27_53),MT); /* disable all tests */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) set_sonet(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) REG_CHANGE(SUNI_TACP_IUCHP_CLP,0,SUNI_TACP_IUCHP_CLP,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) TACP_IUCHP); /* idle cells */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) PUT(SUNI_IDLE_PATTERN,TACP_IUCPOP);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) dev->phy = &suni_ops;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) EXPORT_SYMBOL(suni_init);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) MODULE_LICENSE("GPL");
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags