Orange Pi5 kernel

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