1 /* drivers/atm/uPD98402.c - NEC uPD98402 (PHY) declarations */
3 /* Written 1995-2000 by Werner Almesberger, EPFL LRC/ICA */
6 #include <linux/module.h>
7 #include <linux/sched.h> /* for jiffies */
9 #include <linux/errno.h>
10 #include <linux/atmdev.h>
11 #include <linux/sonet.h>
12 #include <linux/init.h>
13 #include <asm/uaccess.h>
14 #include <asm/atomic.h>
20 #define DPRINTK(format,args...) printk(KERN_DEBUG format,##args)
22 #define DPRINTK(format,args...)
26 struct uPD98402_priv {
27 struct k_sonet_stats sonet_stats;/* link diagnostics */
28 unsigned char framing; /* SONET/SDH framing */
29 int loop_mode; /* loopback mode */
33 #define PRIV(dev) ((struct uPD98402_priv *) dev->phy_data)
35 #define PUT(val,reg) dev->ops->phy_put(dev,val,uPD98402_##reg)
36 #define GET(reg) dev->ops->phy_get(dev,uPD98402_##reg)
39 static int fetch_stats(struct atm_dev *dev,struct sonet_stats *arg,int zero)
41 struct sonet_stats tmp;
44 atomic_add(GET(HECCT),&PRIV(dev)->sonet_stats.uncorr_hcs);
45 sonet_copy_stats(&PRIV(dev)->sonet_stats,&tmp);
46 if (arg) error = copy_to_user(arg,&tmp,sizeof(tmp));
48 /* unused fields are reported as -1, but we must not "adjust"
50 tmp.corr_hcs = tmp.tx_cells = tmp.rx_cells = 0;
51 sonet_subtract_stats(&PRIV(dev)->sonet_stats,&tmp);
53 return error ? -EFAULT : 0;
57 static int set_framing(struct atm_dev *dev,unsigned char framing)
59 static const unsigned char sonet[] = { 1,2,3,0 };
60 static const unsigned char sdh[] = { 1,0,0,2 };
65 case SONET_FRAME_SONET:
79 PUT((GET(MDR) & ~uPD98402_MDR_SS_MASK) | (set[3] <<
80 uPD98402_MDR_SS_SHIFT),MDR);
86 static int get_sense(struct atm_dev *dev,u8 *arg)
93 error = put_user(GET(C11R),arg) || put_user(GET(C12R),arg+1) ||
94 put_user(GET(C13R),arg+2);
96 error = error || put_user(0xff,arg+3) || put_user(0xff,arg+4) ||
98 return error ? -EFAULT : 0;
102 static int set_loopback(struct atm_dev *dev,int mode)
104 unsigned char mode_reg;
106 mode_reg = GET(MDR) & ~(uPD98402_MDR_TPLP | uPD98402_MDR_ALP |
108 switch (__ATM_LM_XTLOC(mode)) {
112 mode_reg |= uPD98402_MDR_TPLP;
115 mode_reg |= uPD98402_MDR_ALP;
120 switch (__ATM_LM_XTRMT(mode)) {
124 mode_reg |= uPD98402_MDR_RPLP;
130 PRIV(dev)->loop_mode = mode;
135 static int uPD98402_ioctl(struct atm_dev *dev,unsigned int cmd,void *arg)
141 return fetch_stats(dev,(struct sonet_stats *) arg,
142 cmd == SONET_GETSTATZ);
143 case SONET_SETFRAMING:
144 return set_framing(dev,(int) (long) arg);
145 case SONET_GETFRAMING:
146 return put_user(PRIV(dev)->framing,(int *) arg) ?
148 case SONET_GETFRSENSE:
149 return get_sense(dev,arg);
151 return set_loopback(dev,(int) (long) arg);
153 return put_user(PRIV(dev)->loop_mode,(int *) arg) ?
156 return put_user(ATM_LM_LOC_PHY | ATM_LM_LOC_ATM |
157 ATM_LM_RMT_PHY,(int *) arg) ? -EFAULT : 0;
164 #define ADD_LIMITED(s,v) \
165 { atomic_add(GET(v),&PRIV(dev)->sonet_stats.s); \
166 if (atomic_read(&PRIV(dev)->sonet_stats.s) < 0) \
167 atomic_set(&PRIV(dev)->sonet_stats.s,INT_MAX); }
170 static void stat_event(struct atm_dev *dev)
172 unsigned char events;
175 if (events & uPD98402_PFM_PFEB) ADD_LIMITED(path_febe,PFECB);
176 if (events & uPD98402_PFM_LFEB) ADD_LIMITED(line_febe,LECCT);
177 if (events & uPD98402_PFM_B3E) ADD_LIMITED(path_bip,B3ECT);
178 if (events & uPD98402_PFM_B2E) ADD_LIMITED(line_bip,B2ECT);
179 if (events & uPD98402_PFM_B1E) ADD_LIMITED(section_bip,B1ECT);
186 static void uPD98402_int(struct atm_dev *dev)
188 static unsigned long silence = 0;
189 unsigned char reason;
191 while ((reason = GET(PICR))) {
192 if (reason & uPD98402_INT_LOS)
193 printk(KERN_NOTICE "%s(itf %d): signal lost\n",
194 dev->type,dev->number);
195 if (reason & uPD98402_INT_PFM) stat_event(dev);
196 if (reason & uPD98402_INT_PCO) {
197 (void) GET(PCOCR); /* clear interrupt cause */
198 atomic_add(GET(HECCT),
199 &PRIV(dev)->sonet_stats.uncorr_hcs);
201 if ((reason & uPD98402_INT_RFO) &&
202 (time_after(jiffies, silence) || silence == 0)) {
203 printk(KERN_WARNING "%s(itf %d): uPD98402 receive "
204 "FIFO overflow\n",dev->type,dev->number);
205 silence = (jiffies+HZ/2)|1;
211 static int uPD98402_start(struct atm_dev *dev)
213 DPRINTK("phy_start\n");
214 if (!(PRIV(dev) = kmalloc(sizeof(struct uPD98402_priv),GFP_KERNEL)))
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);
232 static int uPD98402_stop(struct atm_dev *dev)
234 /* let SAR driver worry about stopping interrupts */
240 static const struct atmphy_ops uPD98402_ops = {
241 start: uPD98402_start,
242 ioctl: uPD98402_ioctl,
243 interrupt: uPD98402_int,
248 int __init uPD98402_init(struct atm_dev *dev)
250 DPRINTK("phy_init\n");
251 dev->phy = &uPD98402_ops;
258 EXPORT_SYMBOL(uPD98402_init);
261 int init_module(void)
268 void cleanup_module(void)