Commit | Line | Data |
---|---|---|
09c434b8 | 1 | // SPDX-License-Identifier: GPL-2.0-only |
1da177e4 LT |
2 | /* drivers/atm/uPD98402.c - NEC uPD98402 (PHY) declarations */ |
3 | ||
4 | /* Written 1995-2000 by Werner Almesberger, EPFL LRC/ICA */ | |
5 | ||
6 | ||
7 | #include <linux/module.h> | |
1da177e4 LT |
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> | |
5a0e3ad6 | 13 | #include <linux/slab.h> |
7c0f6ba6 | 14 | #include <linux/uaccess.h> |
60063497 | 15 | #include <linux/atomic.h> |
1da177e4 LT |
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 | ||
27 | struct uPD98402_priv { | |
28 | struct k_sonet_stats sonet_stats;/* link diagnostics */ | |
29 | unsigned char framing; /* SONET/SDH framing */ | |
30 | int loop_mode; /* loopback 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 | ||
41 | static 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 | /* unused fields are reported as -1, but we must not "adjust" | |
51 | them */ | |
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 | ||
59 | static 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 | ||
87 | static 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 | ||
103 | static 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 | ||
136 | static 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 | ||
170 | static 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 | ||
186 | static 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); /* clear interrupt cause */ | |
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 | ||
211 | static int uPD98402_start(struct atm_dev *dev) | |
212 | { | |
213 | DPRINTK("phy_start\n"); | |
214 | if (!(dev->dev_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); /* clear performance events */ | |
219 | PUT(uPD98402_PFM_FJ,PCMR); /* ignore frequency adj */ | |
220 | (void) GET(PCOCR); /* clear overflows */ | |
221 | PUT(~uPD98402_PCO_HECC,PCOMR); | |
222 | (void) GET(PICR); /* clear interrupts */ | |
223 | PUT(~(uPD98402_INT_PFM | uPD98402_INT_ALM | uPD98402_INT_RFO | | |
224 | uPD98402_INT_LOS),PIMR); /* enable them */ | |
225 | (void) fetch_stats(dev,NULL,1); /* clear kernel counters */ | |
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 | ||
233 | static int uPD98402_stop(struct atm_dev *dev) | |
234 | { | |
235 | /* let SAR driver worry about stopping interrupts */ | |
236 | kfree(PRIV(dev)); | |
237 | return 0; | |
238 | } | |
239 | ||
240 | ||
241 | static 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 | ||
249 | int uPD98402_init(struct atm_dev *dev) | |
250 | { | |
251 | DPRINTK("phy_init\n"); | |
252 | dev->phy = &uPD98402_ops; | |
253 | return 0; | |
254 | } | |
255 | ||
256 | ||
257 | MODULE_LICENSE("GPL"); | |
258 | ||
259 | EXPORT_SYMBOL(uPD98402_init); | |
260 | ||
261 | static __init int uPD98402_module_init(void) | |
262 | { | |
263 | return 0; | |
264 | } | |
265 | module_init(uPD98402_module_init); | |
266 | /* module_exit not defined so not unloadable */ |