arch/m68k/emu/nfeth.c

   1 /*
   2  * atari_nfeth.c - ARAnyM ethernet card driver for GNU/Linux
   3  *
   4  * Copyright (c) 2005 Milan Jurik, Petr Stehlik of ARAnyM dev team
   5  *
   6  * Based on ARAnyM driver for FreeMiNT written by Standa Opichal
   7  *
   8  * This software may be used and distributed according to the terms of
   9  * the GNU General Public License (GPL), incorporated herein by reference.
  10  */
  11
  12 #define DRV_VERSION     "0.3"
  13 #define DRV_RELDATE     "10/12/2005"
  14
  15 #define pr_fmt(fmt)     KBUILD_MODNAME ": " fmt
  16
  17 #include <linux/netdevice.h>
  18 #include <linux/etherdevice.h>
  19 #include <linux/module.h>
  20 #include <asm/natfeat.h>
  21 #include <asm/virtconvert.h>
  22
  23 enum {
  24         GET_VERSION = 0,/* no parameters, return NFAPI_VERSION in d0 */
  25         XIF_INTLEVEL,   /* no parameters, return Interrupt Level in d0 */
  26         XIF_IRQ,        /* acknowledge interrupt from host */
  27         XIF_START,      /* (ethX), called on 'ifup', start receiver thread */
  28         XIF_STOP,       /* (ethX), called on 'ifdown', stop the thread */
  29         XIF_READLENGTH, /* (ethX), return size of network data block to read */
  30         XIF_READBLOCK,  /* (ethX, buffer, size), read block of network data */
  31         XIF_WRITEBLOCK, /* (ethX, buffer, size), write block of network data */
  32         XIF_GET_MAC,    /* (ethX, buffer, size), return MAC HW addr in buffer */
  33         XIF_GET_IPHOST, /* (ethX, buffer, size), return IP address of host */
  34         XIF_GET_IPATARI,/* (ethX, buffer, size), return IP address of atari */
  35         XIF_GET_NETMASK /* (ethX, buffer, size), return IP netmask */
  36 };
  37
  38 #define MAX_UNIT        8
  39
  40 /* These identify the driver base version and may not be removed. */
  41 static const char version[] __devinitdata =
  42         KERN_INFO KBUILD_MODNAME ".c:v" DRV_VERSION " " DRV_RELDATE
  43         " S.Opichal, M.Jurik, P.Stehlik\n"
  44         KERN_INFO " http://aranym.org/\n";
  45
  46 MODULE_AUTHOR("Milan Jurik");
  47 MODULE_DESCRIPTION("Atari NFeth driver");
  48 MODULE_LICENSE("GPL");
  49 /*
  50 MODULE_PARM(nfeth_debug, "i");
  51 MODULE_PARM_DESC(nfeth_debug, "nfeth_debug level (1-2)");
  52 */
  53
  54
  55 static long nfEtherID;
  56 static int nfEtherIRQ;
  57
  58 struct nfeth_private {
  59         int ethX;
  60 };
  61
  62 static struct net_device *nfeth_dev[MAX_UNIT];
  63
  64 static int nfeth_open(struct net_device *dev)
  65 {
  66         struct nfeth_private *priv = netdev_priv(dev);
  67         int res;
  68
  69         res = nf_call(nfEtherID + XIF_START, priv->ethX);
  70         netdev_dbg(dev, "%s: %d\n", __func__, res);
  71
  72         /* Ready for data */
  73         netif_start_queue(dev);
  74
  75         return 0;
  76 }
  77
  78 static int nfeth_stop(struct net_device *dev)
  79 {
  80         struct nfeth_private *priv = netdev_priv(dev);
  81
  82         /* No more data */
  83         netif_stop_queue(dev);
  84
  85         nf_call(nfEtherID + XIF_STOP, priv->ethX);
  86
  87         return 0;
  88 }
  89
  90 /*
  91  * Read a packet out of the adapter and pass it to the upper layers
  92  */
  93 static inline void recv_packet(struct net_device *dev)
  94 {
  95         struct nfeth_private *priv = netdev_priv(dev);
  96         unsigned short pktlen;
  97         struct sk_buff *skb;
  98
  99         /* read packet length (excluding 32 bit crc) */
 100         pktlen = nf_call(nfEtherID + XIF_READLENGTH, priv->ethX);
 101
 102         netdev_dbg(dev, "%s: %u\n", __func__, pktlen);
 103
 104         if (!pktlen) {
 105                 netdev_dbg(dev, "%s: pktlen == 0\n", __func__);
 106                 dev->stats.rx_errors++;
 107                 return;
 108         }
 109
 110         skb = dev_alloc_skb(pktlen + 2);
 111         if (!skb) {
 112                 netdev_dbg(dev, "%s: out of mem (buf_alloc failed)\n",
 113                            __func__);
 114                 dev->stats.rx_dropped++;
 115                 return;
 116         }
 117
 118         skb->dev = dev;
 119         skb_reserve(skb, 2);            /* 16 Byte align  */
 120         skb_put(skb, pktlen);           /* make room */
 121         nf_call(nfEtherID + XIF_READBLOCK, priv->ethX, virt_to_phys(skb->data),
 122                 pktlen);
 123
 124         skb->protocol = eth_type_trans(skb, dev);
 125         netif_rx(skb);
 126         dev->last_rx = jiffies;
 127         dev->stats.rx_packets++;
 128         dev->stats.rx_bytes += pktlen;
 129
 130         /* and enqueue packet */
 131         return;
 132 }
 133
 134 static irqreturn_t nfeth_interrupt(int irq, void *dev_id)
 135 {
 136         int i, m, mask;
 137
 138         mask = nf_call(nfEtherID + XIF_IRQ, 0);
 139         for (i = 0, m = 1; i < MAX_UNIT; m <<= 1, i++) {
 140                 if (mask & m && nfeth_dev[i]) {
 141                         recv_packet(nfeth_dev[i]);
 142                         nf_call(nfEtherID + XIF_IRQ, m);
 143                 }
 144         }
 145         return IRQ_HANDLED;
 146 }
 147
 148 static int nfeth_xmit(struct sk_buff *skb, struct net_device *dev)
 149 {
 150         unsigned int len;
 151         char *data, shortpkt[ETH_ZLEN];
 152         struct nfeth_private *priv = netdev_priv(dev);
 153
 154         data = skb->data;
 155         len = skb->len;
 156         if (len < ETH_ZLEN) {
 157                 memset(shortpkt, 0, ETH_ZLEN);
 158                 memcpy(shortpkt, data, len);
 159                 data = shortpkt;
 160                 len = ETH_ZLEN;
 161         }
 162
 163         netdev_dbg(dev, "%s: send %u bytes\n", __func__, len);
 164         nf_call(nfEtherID + XIF_WRITEBLOCK, priv->ethX, virt_to_phys(data),
 165                 len);
 166
 167         dev->stats.tx_packets++;
 168         dev->stats.tx_bytes += len;
 169
 170         dev_kfree_skb(skb);
 171         return 0;
 172 }
 173
 174 static void nfeth_tx_timeout(struct net_device *dev)
 175 {
 176         dev->stats.tx_errors++;
 177         netif_wake_queue(dev);
 178 }
 179
 180 static const struct net_device_ops nfeth_netdev_ops = {
 181         .ndo_open               = nfeth_open,
 182         .ndo_stop               = nfeth_stop,
 183         .ndo_start_xmit         = nfeth_xmit,
 184         .ndo_tx_timeout         = nfeth_tx_timeout,
 185         .ndo_validate_addr      = eth_validate_addr,
 186         .ndo_change_mtu         = eth_change_mtu,
 187         .ndo_set_mac_address    = eth_mac_addr,
 188 };
 189
 190 static struct net_device * __init nfeth_probe(int unit)
 191 {
 192         struct net_device *dev;
 193         struct nfeth_private *priv;
 194         char mac[ETH_ALEN], host_ip[32], local_ip[32];
 195         int err;
 196
 197         if (!nf_call(nfEtherID + XIF_GET_MAC, unit, mac, ETH_ALEN))
 198                 return NULL;
 199
 200         dev = alloc_etherdev(sizeof(struct nfeth_private));
 201         if (!dev)
 202                 return NULL;
 203
 204         dev->irq = nfEtherIRQ;
 205         dev->netdev_ops = &nfeth_netdev_ops;
 206
 207         dev->flags |= NETIF_F_NO_CSUM;
 208         memcpy(dev->dev_addr, mac, ETH_ALEN);
 209
 210         priv = netdev_priv(dev);
 211         priv->ethX = unit;
 212
 213         err = register_netdev(dev);
 214         if (err) {
 215                 free_netdev(dev);
 216                 return NULL;
 217         }
 218
 219         nf_call(nfEtherID + XIF_GET_IPHOST, unit,
 220                 host_ip, sizeof(host_ip));
 221         nf_call(nfEtherID + XIF_GET_IPATARI, unit,
 222                 local_ip, sizeof(local_ip));
 223
 224         netdev_info(dev, KBUILD_MODNAME " addr:%s (%s) HWaddr:%pM\n", host_ip,
 225                     local_ip, mac);
 226
 227         return dev;
 228 }
 229
 230 static int __init nfeth_init(void)
 231 {
 232         long ver;
 233         int error, i;
 234
 235         nfEtherID = nf_get_id("ETHERNET");
 236         if (!nfEtherID)
 237                 return -ENODEV;
 238
 239         ver = nf_call(nfEtherID + GET_VERSION);
 240         pr_info("API %lu\n", ver);
 241
 242         nfEtherIRQ = nf_call(nfEtherID + XIF_INTLEVEL);
 243         error = request_irq(nfEtherIRQ, nfeth_interrupt, IRQF_SHARED,
 244                             "eth emu", nfeth_interrupt);
 245         if (error) {
 246                 pr_err("request for irq %d failed %d", nfEtherIRQ, error);
 247                 return error;
 248         }
 249
 250         for (i = 0; i < MAX_UNIT; i++)
 251                 nfeth_dev[i] = nfeth_probe(i);
 252
 253         return 0;
 254 }
 255
 256 static void __exit nfeth_cleanup(void)
 257 {
 258         int i;
 259
 260         for (i = 0; i < MAX_UNIT; i++) {
 261                 if (nfeth_dev[i]) {
 262                         unregister_netdev(nfeth_dev[0]);
 263                         free_netdev(nfeth_dev[0]);
 264                 }
 265         }
 266         free_irq(nfEtherIRQ, nfeth_interrupt);
 267 }
 268
 269 module_init(nfeth_init);
 270 module_exit(nfeth_cleanup);