linux/drivers/atm/uPD98402.c
<<
>>
Prefs
   1/* drivers/atm/uPD98402.c - NEC uPD98402 (PHY) declarations */
   2 
   3/* Written 1995-2000 by Werner Almesberger, EPFL LRC/ICA */
   4 
   5
   6#include <linux/module.h>
   7#include <linux/mm.h>
   8#include <linux/errno.h>
   9#include <linux/atmdev.h>
  10#include <linux/sonet.h>
  11#include <linux/init.h>
  12#include <linux/slab.h>
  13#include <asm/uaccess.h>
  14#include <linux/atomic.h>
  15
  16#include "uPD98402.h"
  17
  18
  19#if 0
  20#define DPRINTK(format,args...) printk(KERN_DEBUG format,##args)
  21#else
  22#define DPRINTK(format,args...)
  23#endif
  24
  25
  26struct uPD98402_priv {
  27        struct k_sonet_stats sonet_stats;/* link diagnostics */
  28        unsigned char framing;          /* SONET/SDH framing */
  29        int loop_mode;                  /* loopback mode */
  30        spinlock_t lock;
  31};
  32
  33
  34#define PRIV(dev) ((struct uPD98402_priv *) dev->phy_data)
  35
  36#define PUT(val,reg) dev->ops->phy_put(dev,val,uPD98402_##reg)
  37#define GET(reg) dev->ops->phy_get(dev,uPD98402_##reg)
  38
  39
  40static int fetch_stats(struct atm_dev *dev,struct sonet_stats __user *arg,int zero)
  41{
  42        struct sonet_stats tmp;
  43        int error = 0;
  44
  45        atomic_add(GET(HECCT),&PRIV(dev)->sonet_stats.uncorr_hcs);
  46        sonet_copy_stats(&PRIV(dev)->sonet_stats,&tmp);
  47        if (arg) error = copy_to_user(arg,&tmp,sizeof(tmp));
  48        if (zero && !error) {
  49                /* unused fields are reported as -1, but we must not "adjust"
  50                   them */
  51                tmp.corr_hcs = tmp.tx_cells = tmp.rx_cells = 0;
  52                sonet_subtract_stats(&PRIV(dev)->sonet_stats,&tmp);
  53        }
  54        return error ? -EFAULT : 0;
  55}
  56
  57
  58static int set_framing(struct atm_dev *dev,unsigned char framing)
  59{
  60        static const unsigned char sonet[] = { 1,2,3,0 };
  61        static const unsigned char sdh[] = { 1,0,0,2 };
  62        const char *set;
  63        unsigned long flags;
  64 
  65        switch (framing) {
  66                case SONET_FRAME_SONET:
  67                        set = sonet;
  68                        break;
  69                case SONET_FRAME_SDH:
  70                        set = sdh;
  71                        break;
  72                default:
  73                        return -EINVAL;
  74        }
  75        spin_lock_irqsave(&PRIV(dev)->lock, flags);
  76        PUT(set[0],C11T);
  77        PUT(set[1],C12T);
  78        PUT(set[2],C13T);
  79        PUT((GET(MDR) & ~uPD98402_MDR_SS_MASK) | (set[3] <<
  80            uPD98402_MDR_SS_SHIFT),MDR);
  81        spin_unlock_irqrestore(&PRIV(dev)->lock, flags);
  82        return 0;
  83}
  84
  85
  86static int get_sense(struct atm_dev *dev,u8 __user *arg)
  87{
  88        unsigned long flags;
  89        unsigned char s[3];
  90
  91        spin_lock_irqsave(&PRIV(dev)->lock, flags);
  92        s[0] = GET(C11R);
  93        s[1] = GET(C12R);
  94        s[2] = GET(C13R);
  95        spin_unlock_irqrestore(&PRIV(dev)->lock, flags);
  96        return (put_user(s[0], arg) || put_user(s[1], arg+1) ||
  97            put_user(s[2], arg+2) || put_user(0xff, arg+3) ||
  98            put_user(0xff, arg+4) || put_user(0xff, arg+5)) ? -EFAULT : 0;
  99}
 100
 101
 102static int set_loopback(struct atm_dev *dev,int mode)
 103{
 104        unsigned char mode_reg;
 105
 106        mode_reg = GET(MDR) & ~(uPD98402_MDR_TPLP | uPD98402_MDR_ALP |
 107            uPD98402_MDR_RPLP);
 108        switch (__ATM_LM_XTLOC(mode)) {
 109                case __ATM_LM_NONE:
 110                        break;
 111                case __ATM_LM_PHY:
 112                        mode_reg |= uPD98402_MDR_TPLP;
 113                        break;
 114                case __ATM_LM_ATM:
 115                        mode_reg |= uPD98402_MDR_ALP;
 116                        break;
 117                default:
 118                        return -EINVAL;
 119        }
 120        switch (__ATM_LM_XTRMT(mode)) {
 121                case __ATM_LM_NONE:
 122                        break;
 123                case __ATM_LM_PHY:
 124                        mode_reg |= uPD98402_MDR_RPLP;
 125                        break;
 126                default:
 127                        return -EINVAL;
 128        }
 129        PUT(mode_reg,MDR);
 130        PRIV(dev)->loop_mode = mode;
 131        return 0;
 132}
 133
 134
 135static int uPD98402_ioctl(struct atm_dev *dev,unsigned int cmd,void __user *arg)
 136{
 137        switch (cmd) {
 138
 139                case SONET_GETSTATZ:
 140                case SONET_GETSTAT:
 141                        return fetch_stats(dev,arg, cmd == SONET_GETSTATZ);
 142                case SONET_SETFRAMING:
 143                        return set_framing(dev, (int)(unsigned long)arg);
 144                case SONET_GETFRAMING:
 145                        return put_user(PRIV(dev)->framing,(int __user *)arg) ?
 146                            -EFAULT : 0;
 147                case SONET_GETFRSENSE:
 148                        return get_sense(dev,arg);
 149                case ATM_SETLOOP:
 150                        return set_loopback(dev, (int)(unsigned long)arg);
 151                case ATM_GETLOOP:
 152                        return put_user(PRIV(dev)->loop_mode,(int __user *)arg) ?
 153                            -EFAULT : 0;
 154                case ATM_QUERYLOOP:
 155                        return put_user(ATM_LM_LOC_PHY | ATM_LM_LOC_ATM |
 156                            ATM_LM_RMT_PHY,(int __user *)arg) ? -EFAULT : 0;
 157                default:
 158                        return -ENOIOCTLCMD;
 159        }
 160}
 161
 162
 163#define ADD_LIMITED(s,v) \
 164    { atomic_add(GET(v),&PRIV(dev)->sonet_stats.s); \
 165    if (atomic_read(&PRIV(dev)->sonet_stats.s) < 0) \
 166        atomic_set(&PRIV(dev)->sonet_stats.s,INT_MAX); }
 167
 168
 169static void stat_event(struct atm_dev *dev)
 170{
 171        unsigned char events;
 172
 173        events = GET(PCR);
 174        if (events & uPD98402_PFM_PFEB) ADD_LIMITED(path_febe,PFECB);
 175        if (events & uPD98402_PFM_LFEB) ADD_LIMITED(line_febe,LECCT);
 176        if (events & uPD98402_PFM_B3E) ADD_LIMITED(path_bip,B3ECT);
 177        if (events & uPD98402_PFM_B2E) ADD_LIMITED(line_bip,B2ECT);
 178        if (events & uPD98402_PFM_B1E) ADD_LIMITED(section_bip,B1ECT);
 179}
 180
 181
 182#undef ADD_LIMITED
 183
 184
 185static void uPD98402_int(struct atm_dev *dev)
 186{
 187        static unsigned long silence = 0;
 188        unsigned char reason;
 189
 190        while ((reason = GET(PICR))) {
 191                if (reason & uPD98402_INT_LOS)
 192                        printk(KERN_NOTICE "%s(itf %d): signal lost\n",
 193                            dev->type,dev->number);
 194                if (reason & uPD98402_INT_PFM) stat_event(dev);
 195                if (reason & uPD98402_INT_PCO) {
 196                        (void) GET(PCOCR); /* clear interrupt cause */
 197                        atomic_add(GET(HECCT),
 198                            &PRIV(dev)->sonet_stats.uncorr_hcs);
 199                }
 200                if ((reason & uPD98402_INT_RFO) && 
 201                    (time_after(jiffies, silence) || silence == 0)) {
 202                        printk(KERN_WARNING "%s(itf %d): uPD98402 receive "
 203                            "FIFO overflow\n",dev->type,dev->number);
 204                        silence = (jiffies+HZ/2)|1;
 205                }
 206        }
 207}
 208
 209
 210static int uPD98402_start(struct atm_dev *dev)
 211{
 212        DPRINTK("phy_start\n");
 213        if (!(dev->dev_data = kmalloc(sizeof(struct uPD98402_priv),GFP_KERNEL)))
 214                return -ENOMEM;
 215        spin_lock_init(&PRIV(dev)->lock);
 216        memset(&PRIV(dev)->sonet_stats,0,sizeof(struct k_sonet_stats));
 217        (void) GET(PCR); /* clear performance events */
 218        PUT(uPD98402_PFM_FJ,PCMR); /* ignore frequency adj */
 219        (void) GET(PCOCR); /* clear overflows */
 220        PUT(~uPD98402_PCO_HECC,PCOMR);
 221        (void) GET(PICR); /* clear interrupts */
 222        PUT(~(uPD98402_INT_PFM | uPD98402_INT_ALM | uPD98402_INT_RFO |
 223          uPD98402_INT_LOS),PIMR); /* enable them */
 224        (void) fetch_stats(dev,NULL,1); /* clear kernel counters */
 225        atomic_set(&PRIV(dev)->sonet_stats.corr_hcs,-1);
 226        atomic_set(&PRIV(dev)->sonet_stats.tx_cells,-1);
 227        atomic_set(&PRIV(dev)->sonet_stats.rx_cells,-1);
 228        return 0;
 229}
 230
 231
 232static int uPD98402_stop(struct atm_dev *dev)
 233{
 234        /* let SAR driver worry about stopping interrupts */
 235        kfree(PRIV(dev));
 236        return 0;
 237}
 238
 239
 240static const struct atmphy_ops uPD98402_ops = {
 241        .start          = uPD98402_start,
 242        .ioctl          = uPD98402_ioctl,
 243        .interrupt      = uPD98402_int,
 244        .stop           = uPD98402_stop,
 245};
 246
 247
 248int uPD98402_init(struct atm_dev *dev)
 249{
 250DPRINTK("phy_init\n");
 251        dev->phy = &uPD98402_ops;
 252        return 0;
 253}
 254
 255
 256MODULE_LICENSE("GPL");
 257
 258EXPORT_SYMBOL(uPD98402_init);
 259
 260static __init int uPD98402_module_init(void)
 261{
 262        return 0;
 263}
 264module_init(uPD98402_module_init);
 265/* module_exit not defined so not unloadable */
 266
lxr.linux.no kindly hosted by Redpill Linpro AS, provider of Linux consulting and operations services since 1995.