diff options
author | Linus Torvalds <torvalds@ppc970.osdl.org> | 2005-04-16 18:20:36 -0400 |
---|---|---|
committer | Linus Torvalds <torvalds@ppc970.osdl.org> | 2005-04-16 18:20:36 -0400 |
commit | 1da177e4c3f41524e886b7f1b8a0c1fc7321cac2 (patch) | |
tree | 0bba044c4ce775e45a88a51686b5d9f90697ea9d /drivers/atm/uPD98402.c |
Linux-2.6.12-rc2v2.6.12-rc2
Initial git repository build. I'm not bothering with the full history,
even though we have it. We can create a separate "historical" git
archive of that later if we want to, and in the meantime it's about
3.2GB when imported into git - space that would just make the early
git days unnecessarily complicated, when we don't have a lot of good
infrastructure for it.
Let it rip!
Diffstat (limited to 'drivers/atm/uPD98402.c')
-rw-r--r-- | drivers/atm/uPD98402.c | 265 |
1 files changed, 265 insertions, 0 deletions
diff --git a/drivers/atm/uPD98402.c b/drivers/atm/uPD98402.c new file mode 100644 index 000000000000..9504cce51bfb --- /dev/null +++ b/drivers/atm/uPD98402.c | |||
@@ -0,0 +1,265 @@ | |||
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/sched.h> /* for jiffies */ | ||
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 <asm/uaccess.h> | ||
14 | #include <asm/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 | |||
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 */ | ||
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 | |||
40 | static 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 | |||
58 | static 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 | |||
86 | static 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 | |||
102 | static 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 | |||
135 | static 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 | |||
169 | static 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 | |||
185 | static 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 | |||
210 | static 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 | |||
232 | static 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 | |||
240 | static 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 | |||
248 | int uPD98402_init(struct atm_dev *dev) | ||
249 | { | ||
250 | DPRINTK("phy_init\n"); | ||
251 | dev->phy = &uPD98402_ops; | ||
252 | return 0; | ||
253 | } | ||
254 | |||
255 | |||
256 | MODULE_LICENSE("GPL"); | ||
257 | |||
258 | EXPORT_SYMBOL(uPD98402_init); | ||
259 | |||
260 | static __init int uPD98402_module_init(void) | ||
261 | { | ||
262 | return 0; | ||
263 | } | ||
264 | module_init(uPD98402_module_init); | ||
265 | /* module_exit not defined so not unloadable */ | ||