1
2
3
4
5
6
7#include <linux/module.h>
8#include <linux/mm.h>
9#include <linux/errno.h>
10#include <linux/atmdev.h>
11#include <linux/sonet.h>
12#include <linux/init.h>
13#include <linux/slab.h>
14#include <linux/uaccess.h>
15#include <linux/atomic.h>
16
17#include "uPD98402.h"
18
19
20#if 0
21#define DPRINTK(format,args...) printk(KERN_DEBUG format,##args)
22#else
23#define DPRINTK(format,args...)
24#endif
25
26
27struct uPD98402_priv {
28 struct k_sonet_stats sonet_stats;
29 unsigned char framing;
30 int loop_mode;
31 spinlock_t lock;
32};
33
34
35#define PRIV(dev) ((struct uPD98402_priv *) dev->phy_data)
36
37#define PUT(val,reg) dev->ops->phy_put(dev,val,uPD98402_##reg)
38#define GET(reg) dev->ops->phy_get(dev,uPD98402_##reg)
39
40
41static int fetch_stats(struct atm_dev *dev,struct sonet_stats __user *arg,int zero)
42{
43 struct sonet_stats tmp;
44 int error = 0;
45
46 atomic_add(GET(HECCT),&PRIV(dev)->sonet_stats.uncorr_hcs);
47 sonet_copy_stats(&PRIV(dev)->sonet_stats,&tmp);
48 if (arg) error = copy_to_user(arg,&tmp,sizeof(tmp));
49 if (zero && !error) {
50
51
52 tmp.corr_hcs = tmp.tx_cells = tmp.rx_cells = 0;
53 sonet_subtract_stats(&PRIV(dev)->sonet_stats,&tmp);
54 }
55 return error ? -EFAULT : 0;
56}
57
58
59static int set_framing(struct atm_dev *dev,unsigned char framing)
60{
61 static const unsigned char sonet[] = { 1,2,3,0 };
62 static const unsigned char sdh[] = { 1,0,0,2 };
63 const char *set;
64 unsigned long flags;
65
66 switch (framing) {
67 case SONET_FRAME_SONET:
68 set = sonet;
69 break;
70 case SONET_FRAME_SDH:
71 set = sdh;
72 break;
73 default:
74 return -EINVAL;
75 }
76 spin_lock_irqsave(&PRIV(dev)->lock, flags);
77 PUT(set[0],C11T);
78 PUT(set[1],C12T);
79 PUT(set[2],C13T);
80 PUT((GET(MDR) & ~uPD98402_MDR_SS_MASK) | (set[3] <<
81 uPD98402_MDR_SS_SHIFT),MDR);
82 spin_unlock_irqrestore(&PRIV(dev)->lock, flags);
83 return 0;
84}
85
86
87static int get_sense(struct atm_dev *dev,u8 __user *arg)
88{
89 unsigned long flags;
90 unsigned char s[3];
91
92 spin_lock_irqsave(&PRIV(dev)->lock, flags);
93 s[0] = GET(C11R);
94 s[1] = GET(C12R);
95 s[2] = GET(C13R);
96 spin_unlock_irqrestore(&PRIV(dev)->lock, flags);
97 return (put_user(s[0], arg) || put_user(s[1], arg+1) ||
98 put_user(s[2], arg+2) || put_user(0xff, arg+3) ||
99 put_user(0xff, arg+4) || put_user(0xff, arg+5)) ? -EFAULT : 0;
100}
101
102
103static int set_loopback(struct atm_dev *dev,int mode)
104{
105 unsigned char mode_reg;
106
107 mode_reg = GET(MDR) & ~(uPD98402_MDR_TPLP | uPD98402_MDR_ALP |
108 uPD98402_MDR_RPLP);
109 switch (__ATM_LM_XTLOC(mode)) {
110 case __ATM_LM_NONE:
111 break;
112 case __ATM_LM_PHY:
113 mode_reg |= uPD98402_MDR_TPLP;
114 break;
115 case __ATM_LM_ATM:
116 mode_reg |= uPD98402_MDR_ALP;
117 break;
118 default:
119 return -EINVAL;
120 }
121 switch (__ATM_LM_XTRMT(mode)) {
122 case __ATM_LM_NONE:
123 break;
124 case __ATM_LM_PHY:
125 mode_reg |= uPD98402_MDR_RPLP;
126 break;
127 default:
128 return -EINVAL;
129 }
130 PUT(mode_reg,MDR);
131 PRIV(dev)->loop_mode = mode;
132 return 0;
133}
134
135
136static int uPD98402_ioctl(struct atm_dev *dev,unsigned int cmd,void __user *arg)
137{
138 switch (cmd) {
139
140 case SONET_GETSTATZ:
141 case SONET_GETSTAT:
142 return fetch_stats(dev,arg, cmd == SONET_GETSTATZ);
143 case SONET_SETFRAMING:
144 return set_framing(dev, (int)(unsigned long)arg);
145 case SONET_GETFRAMING:
146 return put_user(PRIV(dev)->framing,(int __user *)arg) ?
147 -EFAULT : 0;
148 case SONET_GETFRSENSE:
149 return get_sense(dev,arg);
150 case ATM_SETLOOP:
151 return set_loopback(dev, (int)(unsigned long)arg);
152 case ATM_GETLOOP:
153 return put_user(PRIV(dev)->loop_mode,(int __user *)arg) ?
154 -EFAULT : 0;
155 case ATM_QUERYLOOP:
156 return put_user(ATM_LM_LOC_PHY | ATM_LM_LOC_ATM |
157 ATM_LM_RMT_PHY,(int __user *)arg) ? -EFAULT : 0;
158 default:
159 return -ENOIOCTLCMD;
160 }
161}
162
163
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); }
168
169
170static void stat_event(struct atm_dev *dev)
171{
172 unsigned char events;
173
174 events = GET(PCR);
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);
180}
181
182
183#undef ADD_LIMITED
184
185
186static void uPD98402_int(struct atm_dev *dev)
187{
188 static unsigned long silence = 0;
189 unsigned char reason;
190
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);
198 atomic_add(GET(HECCT),
199 &PRIV(dev)->sonet_stats.uncorr_hcs);
200 }
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;
206 }
207 }
208}
209
210
211static int uPD98402_start(struct atm_dev *dev)
212{
213 DPRINTK("phy_start\n");
214 if (!(dev->phy_data = kmalloc(sizeof(struct uPD98402_priv),GFP_KERNEL)))
215 return -ENOMEM;
216 spin_lock_init(&PRIV(dev)->lock);
217 memset(&PRIV(dev)->sonet_stats,0,sizeof(struct k_sonet_stats));
218 (void) GET(PCR);
219 PUT(uPD98402_PFM_FJ,PCMR);
220 (void) GET(PCOCR);
221 PUT(~uPD98402_PCO_HECC,PCOMR);
222 (void) GET(PICR);
223 PUT(~(uPD98402_INT_PFM | uPD98402_INT_ALM | uPD98402_INT_RFO |
224 uPD98402_INT_LOS),PIMR);
225 (void) fetch_stats(dev,NULL,1);
226 atomic_set(&PRIV(dev)->sonet_stats.corr_hcs,-1);
227 atomic_set(&PRIV(dev)->sonet_stats.tx_cells,-1);
228 atomic_set(&PRIV(dev)->sonet_stats.rx_cells,-1);
229 return 0;
230}
231
232
233static int uPD98402_stop(struct atm_dev *dev)
234{
235
236 kfree(PRIV(dev));
237 return 0;
238}
239
240
241static const struct atmphy_ops uPD98402_ops = {
242 .start = uPD98402_start,
243 .ioctl = uPD98402_ioctl,
244 .interrupt = uPD98402_int,
245 .stop = uPD98402_stop,
246};
247
248
249int uPD98402_init(struct atm_dev *dev)
250{
251DPRINTK("phy_init\n");
252 dev->phy = &uPD98402_ops;
253 return 0;
254}
255
256
257MODULE_LICENSE("GPL");
258
259EXPORT_SYMBOL(uPD98402_init);
260
261static __init int uPD98402_module_init(void)
262{
263 return 0;
264}
265module_init(uPD98402_module_init);
266
267
