Merge branch 'for-linus' of master.kernel.org:/pub/scm/linux/kernel/git/roland/infiniband
[linux-2.6] / drivers / net / mipsnet.c
1 /*
2  * This file is subject to the terms and conditions of the GNU General Public
3  * License.  See the file "COPYING" in the main directory of this archive
4  * for more details.
5  */
6
7 #define DEBUG
8
9 #include <linux/init.h>
10 #include <linux/kernel.h>
11 #include <linux/module.h>
12 #include <linux/netdevice.h>
13 #include <linux/sched.h>
14 #include <linux/etherdevice.h>
15 #include <linux/netdevice.h>
16 #include <linux/platform_device.h>
17 #include <asm/io.h>
18 #include <asm/mips-boards/simint.h>
19
20 #include "mipsnet.h"            /* actual device IO mapping */
21
22 #define MIPSNET_VERSION "2005-06-20"
23
24 #define mipsnet_reg_address(dev, field) (dev->base_addr + field_offset(field))
25
26 struct mipsnet_priv {
27         struct net_device_stats stats;
28 };
29
30 static struct platform_device *mips_plat_dev;
31
32 static char mipsnet_string[] = "mipsnet";
33
34 /*
35  * Copy data from the MIPSNET rx data port
36  */
37 static int ioiocpy_frommipsnet(struct net_device *dev, unsigned char *kdata,
38                         int len)
39 {
40         uint32_t available_len = inl(mipsnet_reg_address(dev, rxDataCount));
41         if (available_len < len)
42                 return -EFAULT;
43
44         for (; len > 0; len--, kdata++) {
45                 *kdata = inb(mipsnet_reg_address(dev, rxDataBuffer));
46         }
47
48         return inl(mipsnet_reg_address(dev, rxDataCount));
49 }
50
51 static inline ssize_t mipsnet_put_todevice(struct net_device *dev,
52         struct sk_buff *skb)
53 {
54         int count_to_go = skb->len;
55         char *buf_ptr = skb->data;
56         struct mipsnet_priv *mp = netdev_priv(dev);
57
58         pr_debug("%s: %s(): telling MIPSNET txDataCount(%d)\n",
59                  dev->name, __FUNCTION__, skb->len);
60
61         outl(skb->len, mipsnet_reg_address(dev, txDataCount));
62
63         pr_debug("%s: %s(): sending data to MIPSNET txDataBuffer(%d)\n",
64                  dev->name, __FUNCTION__, skb->len);
65
66         for (; count_to_go; buf_ptr++, count_to_go--) {
67                 outb(*buf_ptr, mipsnet_reg_address(dev, txDataBuffer));
68         }
69
70         mp->stats.tx_packets++;
71         mp->stats.tx_bytes += skb->len;
72
73         return skb->len;
74 }
75
76 static int mipsnet_xmit(struct sk_buff *skb, struct net_device *dev)
77 {
78         pr_debug("%s:%s(): transmitting %d bytes\n",
79                  dev->name, __FUNCTION__, skb->len);
80
81         /* Only one packet at a time. Once TXDONE interrupt is serviced, the
82          * queue will be restarted.
83          */
84         netif_stop_queue(dev);
85         mipsnet_put_todevice(dev, skb);
86
87         return 0;
88 }
89
90 static inline ssize_t mipsnet_get_fromdev(struct net_device *dev, size_t count)
91 {
92         struct sk_buff *skb;
93         size_t len = count;
94         struct mipsnet_priv *mp = netdev_priv(dev);
95
96         if (!(skb = alloc_skb(len + 2, GFP_KERNEL))) {
97                 mp->stats.rx_dropped++;
98                 return -ENOMEM;
99         }
100
101         skb_reserve(skb, 2);
102         if (ioiocpy_frommipsnet(dev, skb_put(skb, len), len))
103                 return -EFAULT;
104
105         skb->dev = dev;
106         skb->protocol = eth_type_trans(skb, dev);
107         skb->ip_summed = CHECKSUM_UNNECESSARY;
108
109         pr_debug("%s:%s(): pushing RXed data to kernel\n",
110                  dev->name, __FUNCTION__);
111         netif_rx(skb);
112
113         mp->stats.rx_packets++;
114         mp->stats.rx_bytes += len;
115
116         return count;
117 }
118
119 static irqreturn_t
120 mipsnet_interrupt(int irq, void *dev_id, struct pt_regs *regs)
121 {
122         struct net_device *dev = dev_id;
123
124         irqreturn_t retval = IRQ_NONE;
125         uint64_t interruptFlags;
126
127         if (irq == dev->irq) {
128                 pr_debug("%s:%s(): irq %d for device\n",
129                          dev->name, __FUNCTION__, irq);
130
131                 retval = IRQ_HANDLED;
132
133                 interruptFlags =
134                     inl(mipsnet_reg_address(dev, interruptControl));
135                 pr_debug("%s:%s(): intCtl=0x%016llx\n", dev->name,
136                          __FUNCTION__, interruptFlags);
137
138                 if (interruptFlags & MIPSNET_INTCTL_TXDONE) {
139                         pr_debug("%s:%s(): got TXDone\n",
140                                  dev->name, __FUNCTION__);
141                         outl(MIPSNET_INTCTL_TXDONE,
142                              mipsnet_reg_address(dev, interruptControl));
143                         // only one packet at a time, we are done.
144                         netif_wake_queue(dev);
145                 } else if (interruptFlags & MIPSNET_INTCTL_RXDONE) {
146                         pr_debug("%s:%s(): got RX data\n",
147                                  dev->name, __FUNCTION__);
148                         mipsnet_get_fromdev(dev,
149                                     inl(mipsnet_reg_address(dev, rxDataCount)));
150                         pr_debug("%s:%s(): clearing RX int\n",
151                                  dev->name, __FUNCTION__);
152                         outl(MIPSNET_INTCTL_RXDONE,
153                              mipsnet_reg_address(dev, interruptControl));
154
155                 } else if (interruptFlags & MIPSNET_INTCTL_TESTBIT) {
156                         pr_debug("%s:%s(): got test interrupt\n",
157                                  dev->name, __FUNCTION__);
158                         // TESTBIT is cleared on read.
159                         //    And takes effect after a write with 0
160                         outl(0, mipsnet_reg_address(dev, interruptControl));
161                 } else {
162                         pr_debug("%s:%s(): no valid fags 0x%016llx\n",
163                                  dev->name, __FUNCTION__, interruptFlags);
164                         // Maybe shared IRQ, just ignore, no clearing.
165                         retval = IRQ_NONE;
166                 }
167
168         } else {
169                 printk(KERN_INFO "%s: %s(): irq %d for unknown device\n",
170                        dev->name, __FUNCTION__, irq);
171                 retval = IRQ_NONE;
172         }
173         return retval;
174 }                               //mipsnet_interrupt()
175
176 static int mipsnet_open(struct net_device *dev)
177 {
178         int err;
179         pr_debug("%s: mipsnet_open\n", dev->name);
180
181         err = request_irq(dev->irq, &mipsnet_interrupt,
182                           SA_SHIRQ, dev->name, (void *) dev);
183
184         if (err) {
185                 pr_debug("%s: %s(): can't get irq %d\n",
186                          dev->name, __FUNCTION__, dev->irq);
187                 release_region(dev->base_addr, MIPSNET_IO_EXTENT);
188                 return err;
189         }
190
191         pr_debug("%s: %s(): got IO region at 0x%04lx and irq %d for dev.\n",
192                  dev->name, __FUNCTION__, dev->base_addr, dev->irq);
193
194
195         netif_start_queue(dev);
196
197         // test interrupt handler
198         outl(MIPSNET_INTCTL_TESTBIT,
199              mipsnet_reg_address(dev, interruptControl));
200
201
202         return 0;
203 }
204
205 static int mipsnet_close(struct net_device *dev)
206 {
207         pr_debug("%s: %s()\n", dev->name, __FUNCTION__);
208         netif_stop_queue(dev);
209         return 0;
210 }
211
212 static struct net_device_stats *mipsnet_get_stats(struct net_device *dev)
213 {
214         struct mipsnet_priv *mp = netdev_priv(dev);
215
216         return &mp->stats;
217 }
218
219 static void mipsnet_set_mclist(struct net_device *dev)
220 {
221         // we don't do anything
222         return;
223 }
224
225 static int __init mipsnet_probe(struct device *dev)
226 {
227         struct net_device *netdev;
228         int err;
229
230         netdev = alloc_etherdev(sizeof(struct mipsnet_priv));
231         if (!netdev) {
232                 err = -ENOMEM;
233                 goto out;
234         }
235
236         dev_set_drvdata(dev, netdev);
237
238         netdev->open                    = mipsnet_open;
239         netdev->stop                    = mipsnet_close;
240         netdev->hard_start_xmit         = mipsnet_xmit;
241         netdev->get_stats               = mipsnet_get_stats;
242         netdev->set_multicast_list      = mipsnet_set_mclist;
243
244         /*
245          * TODO: probe for these or load them from PARAM
246          */
247         netdev->base_addr = 0x4200;
248         netdev->irq = MIPSCPU_INT_BASE + MIPSCPU_INT_MB0 +
249                       inl(mipsnet_reg_address(netdev, interruptInfo));
250
251         // Get the io region now, get irq on open()
252         if (!request_region(netdev->base_addr, MIPSNET_IO_EXTENT, "mipsnet")) {
253                 pr_debug("%s: %s(): IO region {start: 0x%04lux, len: %d} "
254                          "for dev is not availble.\n", netdev->name,
255                          __FUNCTION__, netdev->base_addr, MIPSNET_IO_EXTENT);
256                 err = -EBUSY;
257                 goto out_free_netdev;
258         }
259
260         /*
261          * Lacking any better mechanism to allocate a MAC address we use a
262          * random one ...
263          */
264         random_ether_addr(netdev->dev_addr);
265
266         err = register_netdev(netdev);
267         if (err) {
268                 printk(KERN_ERR "MIPSNet: failed to register netdev.\n");
269                 goto out_free_region;
270         }
271
272         return 0;
273
274 out_free_region:
275         release_region(netdev->base_addr, MIPSNET_IO_EXTENT);
276
277 out_free_netdev:
278         free_netdev(netdev);
279
280 out:
281         return err;
282 }
283
284 static int __devexit mipsnet_device_remove(struct device *device)
285 {
286         struct net_device *dev = dev_get_drvdata(device);
287
288         unregister_netdev(dev);
289         release_region(dev->base_addr, MIPSNET_IO_EXTENT);
290         free_netdev(dev);
291         dev_set_drvdata(device, NULL);
292
293         return 0;
294 }
295
296 static struct device_driver mipsnet_driver = {
297         .name   = mipsnet_string,
298         .bus    = &platform_bus_type,
299         .probe  = mipsnet_probe,
300         .remove = __devexit_p(mipsnet_device_remove),
301 };
302
303 static void mipsnet_platform_release(struct device *device)
304 {
305         struct platform_device *pldev;
306
307         /* free device */
308         pldev = to_platform_device(device);
309         kfree(pldev);
310 }
311
312 static int __init mipsnet_init_module(void)
313 {
314         struct platform_device *pldev;
315         int err;
316
317         printk(KERN_INFO "MIPSNet Ethernet driver. Version: %s. "
318                "(c)2005 MIPS Technologies, Inc.\n", MIPSNET_VERSION);
319
320         if (driver_register(&mipsnet_driver)) {
321                 printk(KERN_ERR "Driver registration failed\n");
322                 err = -ENODEV;
323                 goto out;
324         }
325
326         if (!(pldev = kmalloc (sizeof (*pldev), GFP_KERNEL))) {
327                 err = -ENOMEM;
328                 goto out_unregister_driver;
329         }
330
331         memset (pldev, 0, sizeof (*pldev));
332         pldev->name             = mipsnet_string;
333         pldev->id               = 0;
334         pldev->dev.release      = mipsnet_platform_release;
335
336         if (platform_device_register(pldev)) {
337                 err = -ENODEV;
338                 goto out_free_pldev;
339         }
340
341         if (!pldev->dev.driver) {
342                 /*
343                  * The driver was not bound to this device, there was
344                  * no hardware at this address. Unregister it, as the
345                  * release fuction will take care of freeing the
346                  * allocated structure
347                  */
348                 platform_device_unregister (pldev);
349         }
350
351         mips_plat_dev           = pldev;
352
353         return 0;
354
355 out_free_pldev:
356         kfree(pldev);
357
358 out_unregister_driver:
359         driver_unregister(&mipsnet_driver);
360 out:
361         return err;
362 }
363
364 static void __exit mipsnet_exit_module(void)
365 {
366         pr_debug("MIPSNet Ethernet driver exiting\n");
367
368         driver_unregister(&mipsnet_driver);
369 }
370
371 module_init(mipsnet_init_module);
372 module_exit(mipsnet_exit_module);