Linux kernel & device driver programming

Cross-Referenced Linux and Device Driver Code

[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ]
Version: [ 2.6.11.8 ] [ 2.6.25 ] [ 2.6.25.8 ] [ 2.6.31.13 ] Architecture: [ i386 ]
  1 /*
  2  *      Comtrol SV11 card driver
  3  *
  4  *      This is a slightly odd Z85230 synchronous driver. All you need to
  5  *      know basically is
  6  *
  7  *      Its a genuine Z85230
  8  *
  9  *      It supports DMA using two DMA channels in SYNC mode. The driver doesn't
 10  *      use these facilities
 11  *      
 12  *      The control port is at io+1, the data at io+3 and turning off the DMA
 13  *      is done by writing 0 to io+4
 14  *
 15  *      The hardware does the bus handling to avoid the need for delays between
 16  *      touching control registers.
 17  *
 18  *      Port B isnt wired (why - beats me)
 19  *
 20  *      Generic HDLC port Copyright (C) 2008 Krzysztof Halasa <khc@pm.waw.pl>
 21  */
 22 
 23 #include <linux/module.h>
 24 #include <linux/kernel.h>
 25 #include <linux/mm.h>
 26 #include <linux/net.h>
 27 #include <linux/skbuff.h>
 28 #include <linux/netdevice.h>
 29 #include <linux/if_arp.h>
 30 #include <linux/delay.h>
 31 #include <linux/hdlc.h>
 32 #include <linux/ioport.h>
 33 #include <net/arp.h>
 34 
 35 #include <asm/irq.h>
 36 #include <asm/io.h>
 37 #include <asm/dma.h>
 38 #include <asm/byteorder.h>
 39 #include "z85230.h"
 40 
 41 static int dma;
 42 
 43 /*
 44  *      Network driver support routines
 45  */
 46 
 47 static inline struct z8530_dev* dev_to_sv(struct net_device *dev)
 48 {
 49         return (struct z8530_dev *)dev_to_hdlc(dev)->priv;
 50 }
 51 
 52 /*
 53  *      Frame receive. Simple for our card as we do HDLC and there
 54  *      is no funny garbage involved
 55  */
 56 
 57 static void hostess_input(struct z8530_channel *c, struct sk_buff *skb)
 58 {
 59         /* Drop the CRC - it's not a good idea to try and negotiate it ;) */
 60         skb_trim(skb, skb->len - 2);
 61         skb->protocol = hdlc_type_trans(skb, c->netdevice);
 62         skb_reset_mac_header(skb);
 63         skb->dev = c->netdevice;
 64         /*
 65          *      Send it to the PPP layer. We don't have time to process
 66          *      it right now.
 67          */
 68         netif_rx(skb);
 69 }
 70 
 71 /*
 72  *      We've been placed in the UP state
 73  */
 74 
 75 static int hostess_open(struct net_device *d)
 76 {
 77         struct z8530_dev *sv11 = dev_to_sv(d);
 78         int err = -1;
 79 
 80         /*
 81          *      Link layer up
 82          */
 83         switch (dma) {
 84                 case 0:
 85                         err = z8530_sync_open(d, &sv11->chanA);
 86                         break;
 87                 case 1:
 88                         err = z8530_sync_dma_open(d, &sv11->chanA);
 89                         break;
 90                 case 2:
 91                         err = z8530_sync_txdma_open(d, &sv11->chanA);
 92                         break;
 93         }
 94 
 95         if (err)
 96                 return err;
 97 
 98         err = hdlc_open(d);
 99         if (err) {
100                 switch (dma) {
101                         case 0:
102                                 z8530_sync_close(d, &sv11->chanA);
103                                 break;
104                         case 1:
105                                 z8530_sync_dma_close(d, &sv11->chanA);
106                                 break;
107                         case 2:
108                                 z8530_sync_txdma_close(d, &sv11->chanA);
109                                 break;
110                 }
111                 return err;
112         }
113         sv11->chanA.rx_function = hostess_input;
114 
115         /*
116          *      Go go go
117          */
118 
119         netif_start_queue(d);
120         return 0;
121 }
122 
123 static int hostess_close(struct net_device *d)
124 {
125         struct z8530_dev *sv11 = dev_to_sv(d);
126         /*
127          *      Discard new frames
128          */
129         sv11->chanA.rx_function = z8530_null_rx;
130 
131         hdlc_close(d);
132         netif_stop_queue(d);
133 
134         switch (dma) {
135                 case 0:
136                         z8530_sync_close(d, &sv11->chanA);
137                         break;
138                 case 1:
139                         z8530_sync_dma_close(d, &sv11->chanA);
140                         break;
141                 case 2:
142                         z8530_sync_txdma_close(d, &sv11->chanA);
143                         break;
144         }
145         return 0;
146 }
147 
148 static int hostess_ioctl(struct net_device *d, struct ifreq *ifr, int cmd)
149 {
150         /* struct z8530_dev *sv11=dev_to_sv(d);
151            z8530_ioctl(d,&sv11->chanA,ifr,cmd) */
152         return hdlc_ioctl(d, ifr, cmd);
153 }
154 
155 /*
156  *      Passed network frames, fire them downwind.
157  */
158 
159 static int hostess_queue_xmit(struct sk_buff *skb, struct net_device *d)
160 {
161         return z8530_queue_xmit(&dev_to_sv(d)->chanA, skb);
162 }
163 
164 static int hostess_attach(struct net_device *dev, unsigned short encoding,
165                           unsigned short parity)
166 {
167         if (encoding == ENCODING_NRZ && parity == PARITY_CRC16_PR1_CCITT)
168                 return 0;
169         return -EINVAL;
170 }
171 
172 /*
173  *      Description block for a Comtrol Hostess SV11 card
174  */
175 
176 static const struct net_device_ops hostess_ops = {
177         .ndo_open       = hostess_open,
178         .ndo_stop       = hostess_close,
179         .ndo_change_mtu = hdlc_change_mtu,
180         .ndo_start_xmit = hdlc_start_xmit,
181         .ndo_do_ioctl   = hostess_ioctl,
182 };
183 
184 static struct z8530_dev *sv11_init(int iobase, int irq)
185 {
186         struct z8530_dev *sv;
187         struct net_device *netdev;
188         /*
189          *      Get the needed I/O space
190          */
191 
192         if (!request_region(iobase, 8, "Comtrol SV11")) {
193                 printk(KERN_WARNING "hostess: I/O 0x%X already in use.\n",
194                        iobase);
195                 return NULL;
196         }
197 
198         sv = kzalloc(sizeof(struct z8530_dev), GFP_KERNEL);
199         if (!sv)
200                 goto err_kzalloc;
201 
202         /*
203          *      Stuff in the I/O addressing
204          */
205 
206         sv->active = 0;
207 
208         sv->chanA.ctrlio = iobase + 1;
209         sv->chanA.dataio = iobase + 3;
210         sv->chanB.ctrlio = -1;
211         sv->chanB.dataio = -1;
212         sv->chanA.irqs = &z8530_nop;
213         sv->chanB.irqs = &z8530_nop;
214 
215         outb(0, iobase + 4);            /* DMA off */
216 
217         /* We want a fast IRQ for this device. Actually we'd like an even faster
218            IRQ ;) - This is one driver RtLinux is made for */
219 
220         if (request_irq(irq, &z8530_interrupt, IRQF_DISABLED,
221                         "Hostess SV11", sv) < 0) {
222                 printk(KERN_WARNING "hostess: IRQ %d already in use.\n", irq);
223                 goto err_irq;
224         }
225 
226         sv->irq = irq;
227         sv->chanA.private = sv;
228         sv->chanA.dev = sv;
229         sv->chanB.dev = sv;
230 
231         if (dma) {
232                 /*
233                  *      You can have DMA off or 1 and 3 thats the lot
234                  *      on the Comtrol.
235                  */
236                 sv->chanA.txdma = 3;
237                 sv->chanA.rxdma = 1;
238                 outb(0x03 | 0x08, iobase + 4);          /* DMA on */
239                 if (request_dma(sv->chanA.txdma, "Hostess SV/11 (TX)"))
240                         goto err_txdma;
241 
242                 if (dma == 1)
243                         if (request_dma(sv->chanA.rxdma, "Hostess SV/11 (RX)"))
244                                 goto err_rxdma;
245         }
246 
247         /* Kill our private IRQ line the hostess can end up chattering
248            until the configuration is set */
249         disable_irq(irq);
250 
251         /*
252          *      Begin normal initialise
253          */
254 
255         if (z8530_init(sv)) {
256                 printk(KERN_ERR "Z8530 series device not found.\n");
257                 enable_irq(irq);
258                 goto free_dma;
259         }
260         z8530_channel_load(&sv->chanB, z8530_dead_port);
261         if (sv->type == Z85C30)
262                 z8530_channel_load(&sv->chanA, z8530_hdlc_kilostream);
263         else
264                 z8530_channel_load(&sv->chanA, z8530_hdlc_kilostream_85230);
265 
266         enable_irq(irq);
267 
268         /*
269          *      Now we can take the IRQ
270          */
271 
272         sv->chanA.netdevice = netdev = alloc_hdlcdev(sv);
273         if (!netdev)
274                 goto free_dma;
275 
276         dev_to_hdlc(netdev)->attach = hostess_attach;
277         dev_to_hdlc(netdev)->xmit = hostess_queue_xmit;
278         netdev->netdev_ops = &hostess_ops;
279         netdev->base_addr = iobase;
280         netdev->irq = irq;
281 
282         if (register_hdlc_device(netdev)) {
283                 printk(KERN_ERR "hostess: unable to register HDLC device.\n");
284                 free_netdev(netdev);
285                 goto free_dma;
286         }
287 
288         z8530_describe(sv, "I/O", iobase);
289         sv->active = 1;
290         return sv;
291 
292 free_dma:
293         if (dma == 1)
294                 free_dma(sv->chanA.rxdma);
295 err_rxdma:
296         if (dma)
297                 free_dma(sv->chanA.txdma);
298 err_txdma:
299         free_irq(irq, sv);
300 err_irq:
301         kfree(sv);
302 err_kzalloc:
303         release_region(iobase, 8);
304         return NULL;
305 }
306 
307 static void sv11_shutdown(struct z8530_dev *dev)
308 {
309         unregister_hdlc_device(dev->chanA.netdevice);
310         z8530_shutdown(dev);
311         free_irq(dev->irq, dev);
312         if (dma) {
313                 if (dma == 1)
314                         free_dma(dev->chanA.rxdma);
315                 free_dma(dev->chanA.txdma);
316         }
317         release_region(dev->chanA.ctrlio - 1, 8);
318         free_netdev(dev->chanA.netdevice);
319         kfree(dev);
320 }
321 
322 static int io = 0x200;
323 static int irq = 9;
324 
325 module_param(io, int, 0);
326 MODULE_PARM_DESC(io, "The I/O base of the Comtrol Hostess SV11 card");
327 module_param(dma, int, 0);
328 MODULE_PARM_DESC(dma, "Set this to 1 to use DMA1/DMA3 for TX/RX");
329 module_param(irq, int, 0);
330 MODULE_PARM_DESC(irq, "The interrupt line setting for the Comtrol Hostess SV11 card");
331 
332 MODULE_AUTHOR("Alan Cox");
333 MODULE_LICENSE("GPL");
334 MODULE_DESCRIPTION("Modular driver for the Comtrol Hostess SV11");
335 
336 static struct z8530_dev *sv11_unit;
337 
338 int init_module(void)
339 {
340         if ((sv11_unit = sv11_init(io, irq)) == NULL)
341                 return -ENODEV;
342         return 0;
343 }
344 
345 void cleanup_module(void)
346 {
347         if (sv11_unit)
348                 sv11_shutdown(sv11_unit);
349 }
350 
  This page was automatically generated by the LXR engine.