[GitHub/mt8127/android_kernel_alcatel_ttab.git] / arch / m68k / emu / nfeth.c

/*
 * atari_nfeth.c - ARAnyM ethernet card driver for GNU/Linux
 *
 * Copyright (c) 2005 Milan Jurik, Petr Stehlik of ARAnyM dev team
 *
 * Based on ARAnyM driver for FreeMiNT written by Standa Opichal
 *
 * This software may be used and distributed according to the terms of
 * the GNU General Public License (GPL), incorporated herein by reference.
 */

#define DRV_VERSION	"0.3"
#define DRV_RELDATE	"10/12/2005"

#define pr_fmt(fmt)	KBUILD_MODNAME ": " fmt

#include <linux/netdevice.h>
#include <linux/etherdevice.h>
#include <linux/interrupt.h>
#include <linux/module.h>
#include <asm/natfeat.h>
#include <asm/virtconvert.h>

enum {
	GET_VERSION = 0,/* no parameters, return NFAPI_VERSION in d0 */
	XIF_INTLEVEL,	/* no parameters, return Interrupt Level in d0 */
	XIF_IRQ,	/* acknowledge interrupt from host */
	XIF_START,	/* (ethX), called on 'ifup', start receiver thread */
	XIF_STOP,	/* (ethX), called on 'ifdown', stop the thread */
	XIF_READLENGTH,	/* (ethX), return size of network data block to read */
	XIF_READBLOCK,	/* (ethX, buffer, size), read block of network data */
	XIF_WRITEBLOCK,	/* (ethX, buffer, size), write block of network data */
	XIF_GET_MAC,	/* (ethX, buffer, size), return MAC HW addr in buffer */
	XIF_GET_IPHOST,	/* (ethX, buffer, size), return IP address of host */
	XIF_GET_IPATARI,/* (ethX, buffer, size), return IP address of atari */
	XIF_GET_NETMASK	/* (ethX, buffer, size), return IP netmask */
};

#define MAX_UNIT	8

/* These identify the driver base version and may not be removed. */
static const char version[] =
	KERN_INFO KBUILD_MODNAME ".c:v" DRV_VERSION " " DRV_RELDATE
	" S.Opichal, M.Jurik, P.Stehlik\n"
	KERN_INFO " http://aranym.org/\n";

MODULE_AUTHOR("Milan Jurik");
MODULE_DESCRIPTION("Atari NFeth driver");
MODULE_LICENSE("GPL");
/*
MODULE_PARM(nfeth_debug, "i");
MODULE_PARM_DESC(nfeth_debug, "nfeth_debug level (1-2)");
*/


static long nfEtherID;
static int nfEtherIRQ;

struct nfeth_private {
	int ethX;
};

static struct net_device *nfeth_dev[MAX_UNIT];

static int nfeth_open(struct net_device *dev)
{
	struct nfeth_private *priv = netdev_priv(dev);
	int res;

	res = nf_call(nfEtherID + XIF_START, priv->ethX);
	netdev_dbg(dev, "%s: %d\n", __func__, res);

	/* Ready for data */
	netif_start_queue(dev);

	return 0;
}

static int nfeth_stop(struct net_device *dev)
{
	struct nfeth_private *priv = netdev_priv(dev);

	/* No more data */
	netif_stop_queue(dev);

	nf_call(nfEtherID + XIF_STOP, priv->ethX);

	return 0;
}

/*
 * Read a packet out of the adapter and pass it to the upper layers
 */
static inline void recv_packet(struct net_device *dev)
{
	struct nfeth_private *priv = netdev_priv(dev);
	unsigned short pktlen;
	struct sk_buff *skb;

	/* read packet length (excluding 32 bit crc) */
	pktlen = nf_call(nfEtherID + XIF_READLENGTH, priv->ethX);

	netdev_dbg(dev, "%s: %u\n", __func__, pktlen);

	if (!pktlen) {
		netdev_dbg(dev, "%s: pktlen == 0\n", __func__);
		dev->stats.rx_errors++;
		return;
	}

	skb = dev_alloc_skb(pktlen + 2);
	if (!skb) {
		netdev_dbg(dev, "%s: out of mem (buf_alloc failed)\n",
			   __func__);
		dev->stats.rx_dropped++;
		return;
	}

	skb->dev = dev;
	skb_reserve(skb, 2);		/* 16 Byte align  */
	skb_put(skb, pktlen);		/* make room */
	nf_call(nfEtherID + XIF_READBLOCK, priv->ethX, virt_to_phys(skb->data),
		pktlen);

	skb->protocol = eth_type_trans(skb, dev);
	netif_rx(skb);
	dev->last_rx = jiffies;
	dev->stats.rx_packets++;
	dev->stats.rx_bytes += pktlen;

	/* and enqueue packet */
	return;
}

static irqreturn_t nfeth_interrupt(int irq, void *dev_id)
{
	int i, m, mask;

	mask = nf_call(nfEtherID + XIF_IRQ, 0);
	for (i = 0, m = 1; i < MAX_UNIT; m <<= 1, i++) {
		if (mask & m && nfeth_dev[i]) {
			recv_packet(nfeth_dev[i]);
			nf_call(nfEtherID + XIF_IRQ, m);
		}
	}
	return IRQ_HANDLED;
}

static int nfeth_xmit(struct sk_buff *skb, struct net_device *dev)
{
	unsigned int len;
	char *data, shortpkt[ETH_ZLEN];
	struct nfeth_private *priv = netdev_priv(dev);

	data = skb->data;
	len = skb->len;
	if (len < ETH_ZLEN) {
		memset(shortpkt, 0, ETH_ZLEN);
		memcpy(shortpkt, data, len);
		data = shortpkt;
		len = ETH_ZLEN;
	}

	netdev_dbg(dev, "%s: send %u bytes\n", __func__, len);
	nf_call(nfEtherID + XIF_WRITEBLOCK, priv->ethX, virt_to_phys(data),
		len);

	dev->stats.tx_packets++;
	dev->stats.tx_bytes += len;

	dev_kfree_skb(skb);
	return 0;
}

static void nfeth_tx_timeout(struct net_device *dev)
{
	dev->stats.tx_errors++;
	netif_wake_queue(dev);
}

static const struct net_device_ops nfeth_netdev_ops = {
	.ndo_open		= nfeth_open,
	.ndo_stop		= nfeth_stop,
	.ndo_start_xmit		= nfeth_xmit,
	.ndo_tx_timeout		= nfeth_tx_timeout,
	.ndo_validate_addr	= eth_validate_addr,
	.ndo_change_mtu		= eth_change_mtu,
	.ndo_set_mac_address	= eth_mac_addr,
};

static struct net_device * __init nfeth_probe(int unit)
{
	struct net_device *dev;
	struct nfeth_private *priv;
	char mac[ETH_ALEN], host_ip[32], local_ip[32];
	int err;

	if (!nf_call(nfEtherID + XIF_GET_MAC, unit, mac, ETH_ALEN))
		return NULL;

	dev = alloc_etherdev(sizeof(struct nfeth_private));
	if (!dev)
		return NULL;

	dev->irq = nfEtherIRQ;
	dev->netdev_ops = &nfeth_netdev_ops;

	memcpy(dev->dev_addr, mac, ETH_ALEN);

	priv = netdev_priv(dev);
	priv->ethX = unit;

	err = register_netdev(dev);
	if (err) {
		free_netdev(dev);
		return NULL;
	}

	nf_call(nfEtherID + XIF_GET_IPHOST, unit,
		host_ip, sizeof(host_ip));
	nf_call(nfEtherID + XIF_GET_IPATARI, unit,
		local_ip, sizeof(local_ip));

	netdev_info(dev, KBUILD_MODNAME " addr:%s (%s) HWaddr:%pM\n", host_ip,
		    local_ip, mac);

	return dev;
}

static int __init nfeth_init(void)
{
	long ver;
	int error, i;

	nfEtherID = nf_get_id("ETHERNET");
	if (!nfEtherID)
		return -ENODEV;

	ver = nf_call(nfEtherID + GET_VERSION);
	pr_info("API %lu\n", ver);

	nfEtherIRQ = nf_call(nfEtherID + XIF_INTLEVEL);
	error = request_irq(nfEtherIRQ, nfeth_interrupt, IRQF_SHARED,
			    "eth emu", nfeth_interrupt);
	if (error) {
		pr_err("request for irq %d failed %d", nfEtherIRQ, error);
		return error;
	}

	for (i = 0; i < MAX_UNIT; i++)
		nfeth_dev[i] = nfeth_probe(i);

	return 0;
}

static void __exit nfeth_cleanup(void)
{
	int i;

	for (i = 0; i < MAX_UNIT; i++) {
		if (nfeth_dev[i]) {
			unregister_netdev(nfeth_dev[0]);
			free_netdev(nfeth_dev[0]);
		}
	}
	free_irq(nfEtherIRQ, nfeth_interrupt);
}

module_init(nfeth_init);
module_exit(nfeth_cleanup);
Commit	Line	Data
9cd7b148 MJ	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>
ac752277	19	#include <linux/interrupt.h>
9cd7b148 MJ	20	#include <linux/module.h>
	21	#include <asm/natfeat.h>
	22	#include <asm/virtconvert.h>
	23
	24	enum {
	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 */
	37	};
	38
	39	#define MAX_UNIT 8
	40
	41	/* These identify the driver base version and may not be removed. */
b881bc46	42	static const char version[] =
9cd7b148 MJ	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";
	46
	47	MODULE_AUTHOR("Milan Jurik");
	48	MODULE_DESCRIPTION("Atari NFeth driver");
	49	MODULE_LICENSE("GPL");
	50	/*
	51	MODULE_PARM(nfeth_debug, "i");
	52	MODULE_PARM_DESC(nfeth_debug, "nfeth_debug level (1-2)");
	53	*/
	54
	55
	56	static long nfEtherID;
	57	static int nfEtherIRQ;
	58
	59	struct nfeth_private {
	60	int ethX;
	61	};
	62
	63	static struct net_device *nfeth_dev[MAX_UNIT];
	64
	65	static int nfeth_open(struct net_device *dev)
	66	{
	67	struct nfeth_private *priv = netdev_priv(dev);
	68	int res;
	69
	70	res = nf_call(nfEtherID + XIF_START, priv->ethX);
	71	netdev_dbg(dev, "%s: %d\n", __func__, res);
	72
	73	/* Ready for data */
	74	netif_start_queue(dev);
	75
	76	return 0;
	77	}
	78
	79	static int nfeth_stop(struct net_device *dev)
	80	{
	81	struct nfeth_private *priv = netdev_priv(dev);
	82
	83	/* No more data */
	84	netif_stop_queue(dev);
	85
	86	nf_call(nfEtherID + XIF_STOP, priv->ethX);
	87
	88	return 0;
	89	}
	90
	91	/*
	92	* Read a packet out of the adapter and pass it to the upper layers
	93	*/
	94	static inline void recv_packet(struct net_device *dev)
	95	{
	96	struct nfeth_private *priv = netdev_priv(dev);
	97	unsigned short pktlen;
	98	struct sk_buff *skb;
	99
	100	/* read packet length (excluding 32 bit crc) */
	101	pktlen = nf_call(nfEtherID + XIF_READLENGTH, priv->ethX);
	102
	103	netdev_dbg(dev, "%s: %u\n", __func__, pktlen);
	104
	105	if (!pktlen) {
	106	netdev_dbg(dev, "%s: pktlen == 0\n", __func__);
107	dev->stats.rx_errors++;
108	return;
109	}
110
111	skb = dev_alloc_skb(pktlen + 2);
112	if (!skb) {
113	netdev_dbg(dev, "%s: out of mem (buf_alloc failed)\n",
114	__func__);
115	dev->stats.rx_dropped++;
116	return;
117	}
118
119	skb->dev = dev;
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),
123	pktlen);
124
125	skb->protocol = eth_type_trans(skb, dev);
126	netif_rx(skb);
127	dev->last_rx = jiffies;
128	dev->stats.rx_packets++;
129	dev->stats.rx_bytes += pktlen;
130
131	/* and enqueue packet */
132	return;
133	}
134
135	static irqreturn_t nfeth_interrupt(int irq, void *dev_id)
136	{
137	int i, m, mask;
138
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);
144	}
145	}
146	return IRQ_HANDLED;
147	}
148
149	static int nfeth_xmit(struct sk_buff skb, struct net_device dev)
150	{
151	unsigned int len;
152	char *data, shortpkt[ETH_ZLEN];
153	struct nfeth_private *priv = netdev_priv(dev);
154
155	data = skb->data;
156	len = skb->len;
157	if (len < ETH_ZLEN) {
158	memset(shortpkt, 0, ETH_ZLEN);
159	memcpy(shortpkt, data, len);
160	data = shortpkt;
161	len = ETH_ZLEN;
162	}
163
164	netdev_dbg(dev, "%s: send %u bytes\n", __func__, len);
165	nf_call(nfEtherID + XIF_WRITEBLOCK, priv->ethX, virt_to_phys(data),
166	len);
167
168	dev->stats.tx_packets++;
169	dev->stats.tx_bytes += len;
170
171	dev_kfree_skb(skb);
172	return 0;
173	}
174
175	static void nfeth_tx_timeout(struct net_device *dev)
176	{
177	dev->stats.tx_errors++;
178	netif_wake_queue(dev);
179	}
180
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,
189	};
190
191	static struct net_device * __init nfeth_probe(int unit)
192	{
193	struct net_device *dev;
194	struct nfeth_private *priv;
195	char mac[ETH_ALEN], host_ip[32], local_ip[32];
196	int err;
197
198	if (!nf_call(nfEtherID + XIF_GET_MAC, unit, mac, ETH_ALEN))
199	return NULL;
200
201	dev = alloc_etherdev(sizeof(struct nfeth_private));
202	if (!dev)
203	return NULL;
204
205	dev->irq = nfEtherIRQ;
206	dev->netdev_ops = &nfeth_netdev_ops;
207
9cd7b148 MJ	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);