Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * Sealevel Systems 4021 driver. | |
3 | * | |
4 | * This program is free software; you can redistribute it and/or | |
5 | * modify it under the terms of the GNU General Public License | |
6 | * as published by the Free Software Foundation; either version | |
7 | * 2 of the License, or (at your option) any later version. | |
8 | * | |
9 | * (c) Copyright 1999, 2001 Alan Cox | |
10 | * (c) Copyright 2001 Red Hat Inc. | |
52e8a6a2 | 11 | * Generic HDLC port Copyright (C) 2008 Krzysztof Halasa <khc@pm.waw.pl> |
1da177e4 LT |
12 | * |
13 | */ | |
14 | ||
15 | #include <linux/module.h> | |
16 | #include <linux/kernel.h> | |
17 | #include <linux/mm.h> | |
18 | #include <linux/net.h> | |
19 | #include <linux/skbuff.h> | |
20 | #include <linux/netdevice.h> | |
21 | #include <linux/if_arp.h> | |
22 | #include <linux/delay.h> | |
52e8a6a2 | 23 | #include <linux/hdlc.h> |
1da177e4 LT |
24 | #include <linux/ioport.h> |
25 | #include <linux/init.h> | |
26 | #include <net/arp.h> | |
27 | ||
82729971 | 28 | #include <asm/irq.h> |
1da177e4 LT |
29 | #include <asm/io.h> |
30 | #include <asm/dma.h> | |
31 | #include <asm/byteorder.h> | |
1da177e4 LT |
32 | #include "z85230.h" |
33 | ||
34 | ||
35 | struct slvl_device | |
36 | { | |
1da177e4 | 37 | struct z8530_channel *chan; |
1da177e4 LT |
38 | int channel; |
39 | }; | |
40 | ||
41 | ||
42 | struct slvl_board | |
43 | { | |
52e8a6a2 | 44 | struct slvl_device dev[2]; |
1da177e4 LT |
45 | struct z8530_dev board; |
46 | int iobase; | |
47 | }; | |
48 | ||
49 | /* | |
50 | * Network driver support routines | |
51 | */ | |
52 | ||
52e8a6a2 KH |
53 | static inline struct slvl_device* dev_to_chan(struct net_device *dev) |
54 | { | |
55 | return (struct slvl_device *)dev_to_hdlc(dev)->priv; | |
56 | } | |
57 | ||
1da177e4 | 58 | /* |
52e8a6a2 | 59 | * Frame receive. Simple for our card as we do HDLC and there |
1da177e4 LT |
60 | * is no funny garbage involved |
61 | */ | |
52e8a6a2 | 62 | |
1da177e4 LT |
63 | static void sealevel_input(struct z8530_channel *c, struct sk_buff *skb) |
64 | { | |
65 | /* Drop the CRC - it's not a good idea to try and negotiate it ;) */ | |
52e8a6a2 KH |
66 | skb_trim(skb, skb->len - 2); |
67 | skb->protocol = hdlc_type_trans(skb, c->netdevice); | |
98e399f8 | 68 | skb_reset_mac_header(skb); |
52e8a6a2 | 69 | skb->dev = c->netdevice; |
1da177e4 | 70 | netif_rx(skb); |
1da177e4 | 71 | } |
52e8a6a2 | 72 | |
1da177e4 LT |
73 | /* |
74 | * We've been placed in the UP state | |
52e8a6a2 KH |
75 | */ |
76 | ||
1da177e4 LT |
77 | static int sealevel_open(struct net_device *d) |
78 | { | |
52e8a6a2 | 79 | struct slvl_device *slvl = dev_to_chan(d); |
1da177e4 LT |
80 | int err = -1; |
81 | int unit = slvl->channel; | |
52e8a6a2 | 82 | |
1da177e4 | 83 | /* |
52e8a6a2 | 84 | * Link layer up. |
1da177e4 LT |
85 | */ |
86 | ||
614c12a1 | 87 | switch (unit) { |
1da177e4 | 88 | case 0: |
52e8a6a2 | 89 | err = z8530_sync_dma_open(d, slvl->chan); |
1da177e4 LT |
90 | break; |
91 | case 1: | |
52e8a6a2 | 92 | err = z8530_sync_open(d, slvl->chan); |
1da177e4 LT |
93 | break; |
94 | } | |
52e8a6a2 KH |
95 | |
96 | if (err) | |
1da177e4 | 97 | return err; |
52e8a6a2 KH |
98 | |
99 | err = hdlc_open(d); | |
100 | if (err) { | |
101 | switch (unit) { | |
1da177e4 LT |
102 | case 0: |
103 | z8530_sync_dma_close(d, slvl->chan); | |
104 | break; | |
105 | case 1: | |
106 | z8530_sync_close(d, slvl->chan); | |
107 | break; | |
52e8a6a2 | 108 | } |
1da177e4 LT |
109 | return err; |
110 | } | |
52e8a6a2 KH |
111 | |
112 | slvl->chan->rx_function = sealevel_input; | |
113 | ||
1da177e4 LT |
114 | /* |
115 | * Go go go | |
116 | */ | |
117 | netif_start_queue(d); | |
118 | return 0; | |
119 | } | |
120 | ||
121 | static int sealevel_close(struct net_device *d) | |
122 | { | |
52e8a6a2 | 123 | struct slvl_device *slvl = dev_to_chan(d); |
1da177e4 | 124 | int unit = slvl->channel; |
52e8a6a2 | 125 | |
1da177e4 LT |
126 | /* |
127 | * Discard new frames | |
128 | */ | |
1da177e4 | 129 | |
52e8a6a2 KH |
130 | slvl->chan->rx_function = z8530_null_rx; |
131 | ||
132 | hdlc_close(d); | |
1da177e4 | 133 | netif_stop_queue(d); |
52e8a6a2 | 134 | |
614c12a1 | 135 | switch (unit) { |
1da177e4 LT |
136 | case 0: |
137 | z8530_sync_dma_close(d, slvl->chan); | |
138 | break; | |
139 | case 1: | |
140 | z8530_sync_close(d, slvl->chan); | |
141 | break; | |
142 | } | |
143 | return 0; | |
144 | } | |
145 | ||
146 | static int sealevel_ioctl(struct net_device *d, struct ifreq *ifr, int cmd) | |
147 | { | |
52e8a6a2 | 148 | /* struct slvl_device *slvl=dev_to_chan(d); |
1da177e4 | 149 | z8530_ioctl(d,&slvl->sync.chanA,ifr,cmd) */ |
52e8a6a2 | 150 | return hdlc_ioctl(d, ifr, cmd); |
1da177e4 LT |
151 | } |
152 | ||
153 | /* | |
52e8a6a2 | 154 | * Passed network frames, fire them downwind. |
1da177e4 | 155 | */ |
52e8a6a2 | 156 | |
d71a6749 SH |
157 | static netdev_tx_t sealevel_queue_xmit(struct sk_buff *skb, |
158 | struct net_device *d) | |
1da177e4 | 159 | { |
52e8a6a2 | 160 | return z8530_queue_xmit(dev_to_chan(d)->chan, skb); |
1da177e4 LT |
161 | } |
162 | ||
52e8a6a2 KH |
163 | static int sealevel_attach(struct net_device *dev, unsigned short encoding, |
164 | unsigned short parity) | |
1da177e4 | 165 | { |
52e8a6a2 KH |
166 | if (encoding == ENCODING_NRZ && parity == PARITY_CRC16_PR1_CCITT) |
167 | return 0; | |
168 | return -EINVAL; | |
1da177e4 LT |
169 | } |
170 | ||
991990a1 KH |
171 | static const struct net_device_ops sealevel_ops = { |
172 | .ndo_open = sealevel_open, | |
173 | .ndo_stop = sealevel_close, | |
174 | .ndo_change_mtu = hdlc_change_mtu, | |
175 | .ndo_start_xmit = hdlc_start_xmit, | |
176 | .ndo_do_ioctl = sealevel_ioctl, | |
177 | }; | |
178 | ||
52e8a6a2 | 179 | static int slvl_setup(struct slvl_device *sv, int iobase, int irq) |
1da177e4 | 180 | { |
52e8a6a2 KH |
181 | struct net_device *dev = alloc_hdlcdev(sv); |
182 | if (!dev) | |
183 | return -1; | |
184 | ||
185 | dev_to_hdlc(dev)->attach = sealevel_attach; | |
186 | dev_to_hdlc(dev)->xmit = sealevel_queue_xmit; | |
991990a1 | 187 | dev->netdev_ops = &sealevel_ops; |
52e8a6a2 KH |
188 | dev->base_addr = iobase; |
189 | dev->irq = irq; | |
190 | ||
191 | if (register_hdlc_device(dev)) { | |
192 | printk(KERN_ERR "sealevel: unable to register HDLC device\n"); | |
193 | free_netdev(dev); | |
194 | return -1; | |
1da177e4 | 195 | } |
1da177e4 | 196 | |
52e8a6a2 | 197 | sv->chan->netdevice = dev; |
1da177e4 LT |
198 | return 0; |
199 | } | |
200 | ||
1da177e4 LT |
201 | |
202 | /* | |
203 | * Allocate and setup Sealevel board. | |
204 | */ | |
52e8a6a2 KH |
205 | |
206 | static __init struct slvl_board *slvl_init(int iobase, int irq, | |
1da177e4 LT |
207 | int txdma, int rxdma, int slow) |
208 | { | |
209 | struct z8530_dev *dev; | |
210 | struct slvl_board *b; | |
52e8a6a2 | 211 | |
1da177e4 LT |
212 | /* |
213 | * Get the needed I/O space | |
214 | */ | |
215 | ||
52e8a6a2 KH |
216 | if (!request_region(iobase, 8, "Sealevel 4021")) { |
217 | printk(KERN_WARNING "sealevel: I/O 0x%X already in use.\n", | |
218 | iobase); | |
1da177e4 LT |
219 | return NULL; |
220 | } | |
1da177e4 | 221 | |
52e8a6a2 KH |
222 | b = kzalloc(sizeof(struct slvl_board), GFP_KERNEL); |
223 | if (!b) | |
224 | goto err_kzalloc; | |
1da177e4 | 225 | |
52e8a6a2 KH |
226 | b->dev[0].chan = &b->board.chanA; |
227 | b->dev[0].channel = 0; | |
1da177e4 | 228 | |
52e8a6a2 KH |
229 | b->dev[1].chan = &b->board.chanB; |
230 | b->dev[1].channel = 1; | |
1da177e4 LT |
231 | |
232 | dev = &b->board; | |
52e8a6a2 | 233 | |
1da177e4 LT |
234 | /* |
235 | * Stuff in the I/O addressing | |
236 | */ | |
52e8a6a2 | 237 | |
1da177e4 LT |
238 | dev->active = 0; |
239 | ||
240 | b->iobase = iobase; | |
52e8a6a2 | 241 | |
1da177e4 LT |
242 | /* |
243 | * Select 8530 delays for the old board | |
244 | */ | |
52e8a6a2 KH |
245 | |
246 | if (slow) | |
1da177e4 | 247 | iobase |= Z8530_PORT_SLEEP; |
52e8a6a2 KH |
248 | |
249 | dev->chanA.ctrlio = iobase + 1; | |
250 | dev->chanA.dataio = iobase; | |
251 | dev->chanB.ctrlio = iobase + 3; | |
252 | dev->chanB.dataio = iobase + 2; | |
253 | ||
254 | dev->chanA.irqs = &z8530_nop; | |
255 | dev->chanB.irqs = &z8530_nop; | |
256 | ||
1da177e4 LT |
257 | /* |
258 | * Assert DTR enable DMA | |
259 | */ | |
52e8a6a2 KH |
260 | |
261 | outb(3 | (1 << 7), b->iobase + 4); | |
262 | ||
1da177e4 LT |
263 | |
264 | /* We want a fast IRQ for this device. Actually we'd like an even faster | |
265 | IRQ ;) - This is one driver RtLinux is made for */ | |
52e8a6a2 | 266 | |
a0607fd3 | 267 | if (request_irq(irq, z8530_interrupt, IRQF_DISABLED, |
52e8a6a2 | 268 | "SeaLevel", dev) < 0) { |
1da177e4 | 269 | printk(KERN_WARNING "sealevel: IRQ %d already in use.\n", irq); |
52e8a6a2 | 270 | goto err_request_irq; |
1da177e4 | 271 | } |
52e8a6a2 KH |
272 | |
273 | dev->irq = irq; | |
274 | dev->chanA.private = &b->dev[0]; | |
275 | dev->chanB.private = &b->dev[1]; | |
276 | dev->chanA.dev = dev; | |
277 | dev->chanB.dev = dev; | |
278 | ||
279 | dev->chanA.txdma = 3; | |
280 | dev->chanA.rxdma = 1; | |
281 | if (request_dma(dev->chanA.txdma, "SeaLevel (TX)")) | |
282 | goto err_dma_tx; | |
283 | ||
284 | if (request_dma(dev->chanA.rxdma, "SeaLevel (RX)")) | |
285 | goto err_dma_rx; | |
286 | ||
1da177e4 | 287 | disable_irq(irq); |
52e8a6a2 | 288 | |
1da177e4 LT |
289 | /* |
290 | * Begin normal initialise | |
291 | */ | |
52e8a6a2 KH |
292 | |
293 | if (z8530_init(dev) != 0) { | |
1da177e4 LT |
294 | printk(KERN_ERR "Z8530 series device not found.\n"); |
295 | enable_irq(irq); | |
52e8a6a2 | 296 | goto free_hw; |
1da177e4 | 297 | } |
52e8a6a2 | 298 | if (dev->type == Z85C30) { |
1da177e4 LT |
299 | z8530_channel_load(&dev->chanA, z8530_hdlc_kilostream); |
300 | z8530_channel_load(&dev->chanB, z8530_hdlc_kilostream); | |
52e8a6a2 | 301 | } else { |
1da177e4 LT |
302 | z8530_channel_load(&dev->chanA, z8530_hdlc_kilostream_85230); |
303 | z8530_channel_load(&dev->chanB, z8530_hdlc_kilostream_85230); | |
304 | } | |
305 | ||
306 | /* | |
307 | * Now we can take the IRQ | |
308 | */ | |
52e8a6a2 | 309 | |
1da177e4 LT |
310 | enable_irq(irq); |
311 | ||
52e8a6a2 KH |
312 | if (slvl_setup(&b->dev[0], iobase, irq)) |
313 | goto free_hw; | |
314 | if (slvl_setup(&b->dev[1], iobase, irq)) | |
315 | goto free_netdev0; | |
1da177e4 LT |
316 | |
317 | z8530_describe(dev, "I/O", iobase); | |
52e8a6a2 | 318 | dev->active = 1; |
1da177e4 LT |
319 | return b; |
320 | ||
52e8a6a2 KH |
321 | free_netdev0: |
322 | unregister_hdlc_device(b->dev[0].chan->netdevice); | |
323 | free_netdev(b->dev[0].chan->netdevice); | |
324 | free_hw: | |
1da177e4 | 325 | free_dma(dev->chanA.rxdma); |
52e8a6a2 | 326 | err_dma_rx: |
1da177e4 | 327 | free_dma(dev->chanA.txdma); |
52e8a6a2 | 328 | err_dma_tx: |
1da177e4 | 329 | free_irq(irq, dev); |
52e8a6a2 | 330 | err_request_irq: |
1da177e4 | 331 | kfree(b); |
52e8a6a2 KH |
332 | err_kzalloc: |
333 | release_region(iobase, 8); | |
1da177e4 LT |
334 | return NULL; |
335 | } | |
336 | ||
337 | static void __exit slvl_shutdown(struct slvl_board *b) | |
338 | { | |
339 | int u; | |
340 | ||
341 | z8530_shutdown(&b->board); | |
52e8a6a2 | 342 | |
614c12a1 | 343 | for (u = 0; u < 2; u++) { |
52e8a6a2 KH |
344 | struct net_device *d = b->dev[u].chan->netdevice; |
345 | unregister_hdlc_device(d); | |
1da177e4 LT |
346 | free_netdev(d); |
347 | } | |
52e8a6a2 | 348 | |
1da177e4 LT |
349 | free_irq(b->board.irq, &b->board); |
350 | free_dma(b->board.chanA.rxdma); | |
351 | free_dma(b->board.chanA.txdma); | |
352 | /* DMA off on the card, drop DTR */ | |
353 | outb(0, b->iobase); | |
354 | release_region(b->iobase, 8); | |
355 | kfree(b); | |
356 | } | |
357 | ||
358 | ||
359 | static int io=0x238; | |
360 | static int txdma=1; | |
361 | static int rxdma=3; | |
362 | static int irq=5; | |
363 | static int slow=0; | |
364 | ||
365 | module_param(io, int, 0); | |
366 | MODULE_PARM_DESC(io, "The I/O base of the Sealevel card"); | |
367 | module_param(txdma, int, 0); | |
368 | MODULE_PARM_DESC(txdma, "Transmit DMA channel"); | |
369 | module_param(rxdma, int, 0); | |
370 | MODULE_PARM_DESC(rxdma, "Receive DMA channel"); | |
371 | module_param(irq, int, 0); | |
372 | MODULE_PARM_DESC(irq, "The interrupt line setting for the SeaLevel card"); | |
373 | module_param(slow, bool, 0); | |
374 | MODULE_PARM_DESC(slow, "Set this for an older Sealevel card such as the 4012"); | |
375 | ||
376 | MODULE_AUTHOR("Alan Cox"); | |
377 | MODULE_LICENSE("GPL"); | |
378 | MODULE_DESCRIPTION("Modular driver for the SeaLevel 4021"); | |
379 | ||
380 | static struct slvl_board *slvl_unit; | |
381 | ||
382 | static int __init slvl_init_module(void) | |
383 | { | |
1da177e4 LT |
384 | slvl_unit = slvl_init(io, irq, txdma, rxdma, slow); |
385 | ||
386 | return slvl_unit ? 0 : -ENODEV; | |
387 | } | |
388 | ||
389 | static void __exit slvl_cleanup_module(void) | |
390 | { | |
614c12a1 | 391 | if (slvl_unit) |
1da177e4 LT |
392 | slvl_shutdown(slvl_unit); |
393 | } | |
394 | ||
395 | module_init(slvl_init_module); | |
396 | module_exit(slvl_cleanup_module); |