2 * atari_nfeth.c - ARAnyM ethernet card driver for GNU/Linux
4 * Copyright (c) 2005 Milan Jurik, Petr Stehlik of ARAnyM dev team
6 * Based on ARAnyM driver for FreeMiNT written by Standa Opichal
8 * This software may be used and distributed according to the terms of
9 * the GNU General Public License (GPL), incorporated herein by reference.
12 #define DRV_VERSION "0.3"
13 #define DRV_RELDATE "10/12/2005"
15 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
17 #include <linux/netdevice.h>
18 #include <linux/etherdevice.h>
19 #include <linux/interrupt.h>
20 #include <linux/module.h>
21 #include <asm/natfeat.h>
22 #include <asm/virtconvert.h>
25 GET_VERSION
= 0,/* no parameters, return NFAPI_VERSION in d0 */
26 XIF_INTLEVEL
, /* no parameters, return Interrupt Level in d0 */
27 XIF_IRQ
, /* acknowledge interrupt from host */
28 XIF_START
, /* (ethX), called on 'ifup', start receiver thread */
29 XIF_STOP
, /* (ethX), called on 'ifdown', stop the thread */
30 XIF_READLENGTH
, /* (ethX), return size of network data block to read */
31 XIF_READBLOCK
, /* (ethX, buffer, size), read block of network data */
32 XIF_WRITEBLOCK
, /* (ethX, buffer, size), write block of network data */
33 XIF_GET_MAC
, /* (ethX, buffer, size), return MAC HW addr in buffer */
34 XIF_GET_IPHOST
, /* (ethX, buffer, size), return IP address of host */
35 XIF_GET_IPATARI
,/* (ethX, buffer, size), return IP address of atari */
36 XIF_GET_NETMASK
/* (ethX, buffer, size), return IP netmask */
41 /* These identify the driver base version and may not be removed. */
42 static const char version
[] __devinitconst
=
43 KERN_INFO KBUILD_MODNAME
".c:v" DRV_VERSION
" " DRV_RELDATE
44 " S.Opichal, M.Jurik, P.Stehlik\n"
45 KERN_INFO
" http://aranym.org/\n";
47 MODULE_AUTHOR("Milan Jurik");
48 MODULE_DESCRIPTION("Atari NFeth driver");
49 MODULE_LICENSE("GPL");
51 MODULE_PARM(nfeth_debug, "i");
52 MODULE_PARM_DESC(nfeth_debug, "nfeth_debug level (1-2)");
56 static long nfEtherID
;
57 static int nfEtherIRQ
;
59 struct nfeth_private
{
63 static struct net_device
*nfeth_dev
[MAX_UNIT
];
65 static int nfeth_open(struct net_device
*dev
)
67 struct nfeth_private
*priv
= netdev_priv(dev
);
70 res
= nf_call(nfEtherID
+ XIF_START
, priv
->ethX
);
71 netdev_dbg(dev
, "%s: %d\n", __func__
, res
);
74 netif_start_queue(dev
);
79 static int nfeth_stop(struct net_device
*dev
)
81 struct nfeth_private
*priv
= netdev_priv(dev
);
84 netif_stop_queue(dev
);
86 nf_call(nfEtherID
+ XIF_STOP
, priv
->ethX
);
92 * Read a packet out of the adapter and pass it to the upper layers
94 static inline void recv_packet(struct net_device
*dev
)
96 struct nfeth_private
*priv
= netdev_priv(dev
);
97 unsigned short pktlen
;
100 /* read packet length (excluding 32 bit crc) */
101 pktlen
= nf_call(nfEtherID
+ XIF_READLENGTH
, priv
->ethX
);
103 netdev_dbg(dev
, "%s: %u\n", __func__
, pktlen
);
106 netdev_dbg(dev
, "%s: pktlen == 0\n", __func__
);
107 dev
->stats
.rx_errors
++;
111 skb
= dev_alloc_skb(pktlen
+ 2);
113 netdev_dbg(dev
, "%s: out of mem (buf_alloc failed)\n",
115 dev
->stats
.rx_dropped
++;
120 skb_reserve(skb
, 2); /* 16 Byte align */
121 skb_put(skb
, pktlen
); /* make room */
122 nf_call(nfEtherID
+ XIF_READBLOCK
, priv
->ethX
, virt_to_phys(skb
->data
),
125 skb
->protocol
= eth_type_trans(skb
, dev
);
127 dev
->last_rx
= jiffies
;
128 dev
->stats
.rx_packets
++;
129 dev
->stats
.rx_bytes
+= pktlen
;
131 /* and enqueue packet */
135 static irqreturn_t
nfeth_interrupt(int irq
, void *dev_id
)
139 mask
= nf_call(nfEtherID
+ XIF_IRQ
, 0);
140 for (i
= 0, m
= 1; i
< MAX_UNIT
; m
<<= 1, i
++) {
141 if (mask
& m
&& nfeth_dev
[i
]) {
142 recv_packet(nfeth_dev
[i
]);
143 nf_call(nfEtherID
+ XIF_IRQ
, m
);
149 static int nfeth_xmit(struct sk_buff
*skb
, struct net_device
*dev
)
152 char *data
, shortpkt
[ETH_ZLEN
];
153 struct nfeth_private
*priv
= netdev_priv(dev
);
157 if (len
< ETH_ZLEN
) {
158 memset(shortpkt
, 0, ETH_ZLEN
);
159 memcpy(shortpkt
, data
, len
);
164 netdev_dbg(dev
, "%s: send %u bytes\n", __func__
, len
);
165 nf_call(nfEtherID
+ XIF_WRITEBLOCK
, priv
->ethX
, virt_to_phys(data
),
168 dev
->stats
.tx_packets
++;
169 dev
->stats
.tx_bytes
+= len
;
175 static void nfeth_tx_timeout(struct net_device
*dev
)
177 dev
->stats
.tx_errors
++;
178 netif_wake_queue(dev
);
181 static const struct net_device_ops nfeth_netdev_ops
= {
182 .ndo_open
= nfeth_open
,
183 .ndo_stop
= nfeth_stop
,
184 .ndo_start_xmit
= nfeth_xmit
,
185 .ndo_tx_timeout
= nfeth_tx_timeout
,
186 .ndo_validate_addr
= eth_validate_addr
,
187 .ndo_change_mtu
= eth_change_mtu
,
188 .ndo_set_mac_address
= eth_mac_addr
,
191 static struct net_device
* __init
nfeth_probe(int unit
)
193 struct net_device
*dev
;
194 struct nfeth_private
*priv
;
195 char mac
[ETH_ALEN
], host_ip
[32], local_ip
[32];
198 if (!nf_call(nfEtherID
+ XIF_GET_MAC
, unit
, mac
, ETH_ALEN
))
201 dev
= alloc_etherdev(sizeof(struct nfeth_private
));
205 dev
->irq
= nfEtherIRQ
;
206 dev
->netdev_ops
= &nfeth_netdev_ops
;
208 memcpy(dev
->dev_addr
, mac
, ETH_ALEN
);
210 priv
= netdev_priv(dev
);
213 err
= register_netdev(dev
);
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
));
224 netdev_info(dev
, KBUILD_MODNAME
" addr:%s (%s) HWaddr:%pM\n", host_ip
,
230 static int __init
nfeth_init(void)
235 nfEtherID
= nf_get_id("ETHERNET");
239 ver
= nf_call(nfEtherID
+ GET_VERSION
);
240 pr_info("API %lu\n", ver
);
242 nfEtherIRQ
= nf_call(nfEtherID
+ XIF_INTLEVEL
);
243 error
= request_irq(nfEtherIRQ
, nfeth_interrupt
, IRQF_SHARED
,
244 "eth emu", nfeth_interrupt
);
246 pr_err("request for irq %d failed %d", nfEtherIRQ
, error
);
250 for (i
= 0; i
< MAX_UNIT
; i
++)
251 nfeth_dev
[i
] = nfeth_probe(i
);
256 static void __exit
nfeth_cleanup(void)
260 for (i
= 0; i
< MAX_UNIT
; i
++) {
262 unregister_netdev(nfeth_dev
[0]);
263 free_netdev(nfeth_dev
[0]);
266 free_irq(nfEtherIRQ
, nfeth_interrupt
);
269 module_init(nfeth_init
);
270 module_exit(nfeth_cleanup
);