[mirror_ubuntu-hirsute-kernel.git] / arch / xtensa / platforms / iss / network.c

/*
 *
 * arch/xtensa/platforms/iss/network.c
 *
 * Platform specific initialization.
 *
 * Authors: Chris Zankel <chris@zankel.net>
 * Based on work form the UML team.
 *
 * Copyright 2005 Tensilica Inc.
 *
 * This program is free software; you can redistribute  it and/or modify it
 * under  the terms of  the GNU General  Public License as published by the
 * Free Software Foundation;  either version 2 of the  License, or (at your
 * option) any later version.
 *
 */

#include <linux/list.h>
#include <linux/irq.h>
#include <linux/spinlock.h>
#include <linux/slab.h>
#include <linux/timer.h>
#include <linux/if_ether.h>
#include <linux/inetdevice.h>
#include <linux/init.h>
#include <linux/if_tun.h>
#include <linux/etherdevice.h>
#include <linux/interrupt.h>
#include <linux/ioctl.h>
#include <linux/bootmem.h>
#include <linux/ethtool.h>
#include <linux/rtnetlink.h>
#include <linux/platform_device.h>

#include <platform/simcall.h>

#define DRIVER_NAME "iss-netdev"
#define ETH_MAX_PACKET 1500
#define ETH_HEADER_OTHER 14
#define ISS_NET_TIMER_VALUE (HZ / 10)


static DEFINE_SPINLOCK(opened_lock);
static LIST_HEAD(opened);

static DEFINE_SPINLOCK(devices_lock);
static LIST_HEAD(devices);

/* ------------------------------------------------------------------------- */

/* We currently only support the TUNTAP transport protocol. */

#define TRANSPORT_TUNTAP_NAME "tuntap"
#define TRANSPORT_TUNTAP_MTU ETH_MAX_PACKET

struct tuntap_info {
	char dev_name[IFNAMSIZ];
	int fd;
};

/* ------------------------------------------------------------------------- */


/* This structure contains out private information for the driver. */

struct iss_net_private {
	struct list_head device_list;
	struct list_head opened_list;

	spinlock_t lock;
	struct net_device *dev;
	struct platform_device pdev;
	struct timer_list tl;
	struct net_device_stats stats;

	struct timer_list timer;
	unsigned int timer_val;

	int index;
	int mtu;

	struct {
		union {
			struct tuntap_info tuntap;
		} info;

		int (*open)(struct iss_net_private *lp);
		void (*close)(struct iss_net_private *lp);
		int (*read)(struct iss_net_private *lp, struct sk_buff **skb);
		int (*write)(struct iss_net_private *lp, struct sk_buff **skb);
		unsigned short (*protocol)(struct sk_buff *skb);
		int (*poll)(struct iss_net_private *lp);
	} tp;

};

/* ================================ HELPERS ================================ */


static char *split_if_spec(char *str, ...)
{
	char **arg, *end;
	va_list ap;

	va_start(ap, str);
	while ((arg = va_arg(ap, char**)) != NULL) {
		if (*str == '\0') {
			va_end(ap);
			return NULL;
		}
		end = strchr(str, ',');
		if (end != str)
			*arg = str;
		if (end == NULL) {
			va_end(ap);
			return NULL;
		}
		*end++ = '\0';
		str = end;
	}
	va_end(ap);
	return str;
}

/* Set Ethernet address of the specified device. */

static void setup_etheraddr(struct net_device *dev, char *str)
{
	unsigned char *addr = dev->dev_addr;

	if (str == NULL)
		goto random;

	if (!mac_pton(str, addr)) {
		pr_err("%s: failed to parse '%s' as an ethernet address\n",
		       dev->name, str);
		goto random;
	}
	if (is_multicast_ether_addr(addr)) {
		pr_err("%s: attempt to assign a multicast ethernet address\n",
		       dev->name);
		goto random;
	}
	if (!is_valid_ether_addr(addr)) {
		pr_err("%s: attempt to assign an invalid ethernet address\n",
		       dev->name);
		goto random;
	}
	if (!is_local_ether_addr(addr))
		pr_warn("%s: assigning a globally valid ethernet address\n",
			dev->name);
	return;

random:
	pr_info("%s: choosing a random ethernet address\n",
		dev->name);
	eth_hw_addr_random(dev);
}

/* ======================= TUNTAP TRANSPORT INTERFACE ====================== */

static int tuntap_open(struct iss_net_private *lp)
{
	struct ifreq ifr;
	char *dev_name = lp->tp.info.tuntap.dev_name;
	int err = -EINVAL;
	int fd;

	fd = simc_open("/dev/net/tun", 02, 0); /* O_RDWR */
	if (fd < 0) {
		pr_err("%s: failed to open /dev/net/tun, returned %d (errno = %d)\n",
		       lp->dev->name, fd, errno);
		return fd;
	}

	memset(&ifr, 0, sizeof(ifr));
	ifr.ifr_flags = IFF_TAP | IFF_NO_PI;
	strlcpy(ifr.ifr_name, dev_name, sizeof(ifr.ifr_name));

	err = simc_ioctl(fd, TUNSETIFF, &ifr);
	if (err < 0) {
		pr_err("%s: failed to set interface %s, returned %d (errno = %d)\n",
		       lp->dev->name, dev_name, err, errno);
		simc_close(fd);
		return err;
	}

	lp->tp.info.tuntap.fd = fd;
	return err;
}

static void tuntap_close(struct iss_net_private *lp)
{
	simc_close(lp->tp.info.tuntap.fd);
	lp->tp.info.tuntap.fd = -1;
}

static int tuntap_read(struct iss_net_private *lp, struct sk_buff **skb)
{
	return simc_read(lp->tp.info.tuntap.fd,
			(*skb)->data, (*skb)->dev->mtu + ETH_HEADER_OTHER);
}

static int tuntap_write(struct iss_net_private *lp, struct sk_buff **skb)
{
	return simc_write(lp->tp.info.tuntap.fd, (*skb)->data, (*skb)->len);
}

unsigned short tuntap_protocol(struct sk_buff *skb)
{
	return eth_type_trans(skb, skb->dev);
}

static int tuntap_poll(struct iss_net_private *lp)
{
	return simc_poll(lp->tp.info.tuntap.fd);
}

/*
 * ethX=tuntap,[mac address],device name
 */

static int tuntap_probe(struct iss_net_private *lp, int index, char *init)
{
	struct net_device *dev = lp->dev;
	char *dev_name = NULL, *mac_str = NULL, *rem = NULL;

	/* Transport should be 'tuntap': ethX=tuntap,mac,dev_name */

	if (strncmp(init, TRANSPORT_TUNTAP_NAME,
		    sizeof(TRANSPORT_TUNTAP_NAME) - 1))
		return 0;

	init += sizeof(TRANSPORT_TUNTAP_NAME) - 1;
	if (*init == ',') {
		rem = split_if_spec(init + 1, &mac_str, &dev_name);
		if (rem != NULL) {
			pr_err("%s: extra garbage on specification : '%s'\n",
			       dev->name, rem);
			return 0;
		}
	} else if (*init != '\0') {
		pr_err("%s: invalid argument: %s. Skipping device!\n",
		       dev->name, init);
		return 0;
	}

	if (!dev_name) {
		pr_err("%s: missing tuntap device name\n", dev->name);
		return 0;
	}

	strlcpy(lp->tp.info.tuntap.dev_name, dev_name,
		sizeof(lp->tp.info.tuntap.dev_name));

	setup_etheraddr(dev, mac_str);

	lp->mtu = TRANSPORT_TUNTAP_MTU;

	lp->tp.info.tuntap.fd = -1;

	lp->tp.open = tuntap_open;
	lp->tp.close = tuntap_close;
	lp->tp.read = tuntap_read;
	lp->tp.write = tuntap_write;
	lp->tp.protocol = tuntap_protocol;
	lp->tp.poll = tuntap_poll;

	return 1;
}

/* ================================ ISS NET ================================ */

static int iss_net_rx(struct net_device *dev)
{
	struct iss_net_private *lp = netdev_priv(dev);
	int pkt_len;
	struct sk_buff *skb;

	/* Check if there is any new data. */

	if (lp->tp.poll(lp) == 0)
		return 0;

	/* Try to allocate memory, if it fails, try again next round. */

	skb = dev_alloc_skb(dev->mtu + 2 + ETH_HEADER_OTHER);
	if (skb == NULL) {
		lp->stats.rx_dropped++;
		return 0;
	}

	skb_reserve(skb, 2);

	/* Setup skb */

	skb->dev = dev;
	skb_reset_mac_header(skb);
	pkt_len = lp->tp.read(lp, &skb);
	skb_put(skb, pkt_len);

	if (pkt_len > 0) {
		skb_trim(skb, pkt_len);
		skb->protocol = lp->tp.protocol(skb);

		lp->stats.rx_bytes += skb->len;
		lp->stats.rx_packets++;
		netif_rx_ni(skb);
		return pkt_len;
	}
	kfree_skb(skb);
	return pkt_len;
}

static int iss_net_poll(void)
{
	struct list_head *ele;
	int err, ret = 0;

	spin_lock(&opened_lock);

	list_for_each(ele, &opened) {
		struct iss_net_private *lp;

		lp = list_entry(ele, struct iss_net_private, opened_list);

		if (!netif_running(lp->dev))
			break;

		spin_lock(&lp->lock);

		while ((err = iss_net_rx(lp->dev)) > 0)
			ret++;

		spin_unlock(&lp->lock);

		if (err < 0) {
			pr_err("Device '%s' read returned %d, shutting it down\n",
			       lp->dev->name, err);
			dev_close(lp->dev);
		} else {
			/* FIXME reactivate_fd(lp->fd, ISS_ETH_IRQ); */
		}
	}

	spin_unlock(&opened_lock);
	return ret;
}


static void iss_net_timer(unsigned long priv)
{
	struct iss_net_private *lp = (struct iss_net_private *)priv;

	iss_net_poll();
	spin_lock(&lp->lock);
	mod_timer(&lp->timer, jiffies + lp->timer_val);
	spin_unlock(&lp->lock);
}


static int iss_net_open(struct net_device *dev)
{
	struct iss_net_private *lp = netdev_priv(dev);
	int err;

	spin_lock_bh(&lp->lock);

	err = lp->tp.open(lp);
	if (err < 0)
		goto out;

	netif_start_queue(dev);

	/* clear buffer - it can happen that the host side of the interface
	 * is full when we get here. In this case, new data is never queued,
	 * SIGIOs never arrive, and the net never works.
	 */
	while ((err = iss_net_rx(dev)) > 0)
		;

	spin_unlock_bh(&lp->lock);
	spin_lock_bh(&opened_lock);
	list_add(&lp->opened_list, &opened);
	spin_unlock_bh(&opened_lock);
	spin_lock_bh(&lp->lock);

	init_timer(&lp->timer);
	lp->timer_val = ISS_NET_TIMER_VALUE;
	lp->timer.data = (unsigned long) lp;
	lp->timer.function = iss_net_timer;
	mod_timer(&lp->timer, jiffies + lp->timer_val);

out:
	spin_unlock_bh(&lp->lock);
	return err;
}

static int iss_net_close(struct net_device *dev)
{
	struct iss_net_private *lp = netdev_priv(dev);
	netif_stop_queue(dev);
	spin_lock_bh(&lp->lock);

	spin_lock(&opened_lock);
	list_del(&opened);
	spin_unlock(&opened_lock);

	del_timer_sync(&lp->timer);

	lp->tp.close(lp);

	spin_unlock_bh(&lp->lock);
	return 0;
}

static int iss_net_start_xmit(struct sk_buff *skb, struct net_device *dev)
{
	struct iss_net_private *lp = netdev_priv(dev);
	int len;

	netif_stop_queue(dev);
	spin_lock_bh(&lp->lock);

	len = lp->tp.write(lp, &skb);

	if (len == skb->len) {
		lp->stats.tx_packets++;
		lp->stats.tx_bytes += skb->len;
		netif_trans_update(dev);
		netif_start_queue(dev);

		/* this is normally done in the interrupt when tx finishes */
		netif_wake_queue(dev);

	} else if (len == 0) {
		netif_start_queue(dev);
		lp->stats.tx_dropped++;

	} else {
		netif_start_queue(dev);
		pr_err("%s: %s failed(%d)\n", dev->name, __func__, len);
	}

	spin_unlock_bh(&lp->lock);

	dev_kfree_skb(skb);
	return NETDEV_TX_OK;
}


static struct net_device_stats *iss_net_get_stats(struct net_device *dev)
{
	struct iss_net_private *lp = netdev_priv(dev);
	return &lp->stats;
}

static void iss_net_set_multicast_list(struct net_device *dev)
{
}

static void iss_net_tx_timeout(struct net_device *dev)
{
}

static int iss_net_set_mac(struct net_device *dev, void *addr)
{
	struct iss_net_private *lp = netdev_priv(dev);
	struct sockaddr *hwaddr = addr;

	if (!is_valid_ether_addr(hwaddr->sa_data))
		return -EADDRNOTAVAIL;
	spin_lock_bh(&lp->lock);
	memcpy(dev->dev_addr, hwaddr->sa_data, ETH_ALEN);
	spin_unlock_bh(&lp->lock);
	return 0;
}

static int iss_net_change_mtu(struct net_device *dev, int new_mtu)
{
	return -EINVAL;
}

void iss_net_user_timer_expire(unsigned long _conn)
{
}


static struct platform_driver iss_net_driver = {
	.driver = {
		.name  = DRIVER_NAME,
	},
};

static int driver_registered;

static const struct net_device_ops iss_netdev_ops = {
	.ndo_open		= iss_net_open,
	.ndo_stop		= iss_net_close,
	.ndo_get_stats		= iss_net_get_stats,
	.ndo_start_xmit		= iss_net_start_xmit,
	.ndo_validate_addr	= eth_validate_addr,
	.ndo_change_mtu		= iss_net_change_mtu,
	.ndo_set_mac_address	= iss_net_set_mac,
	.ndo_tx_timeout		= iss_net_tx_timeout,
	.ndo_set_rx_mode	= iss_net_set_multicast_list,
};

static int iss_net_configure(int index, char *init)
{
	struct net_device *dev;
	struct iss_net_private *lp;
	int err;

	dev = alloc_etherdev(sizeof(*lp));
	if (dev == NULL) {
		pr_err("eth_configure: failed to allocate device\n");
		return 1;
	}

	/* Initialize private element. */

	lp = netdev_priv(dev);
	*lp = (struct iss_net_private) {
		.device_list		= LIST_HEAD_INIT(lp->device_list),
		.opened_list		= LIST_HEAD_INIT(lp->opened_list),
		.dev			= dev,
		.index			= index,
	};

	spin_lock_init(&lp->lock);
	/*
	 * If this name ends up conflicting with an existing registered
	 * netdevice, that is OK, register_netdev{,ice}() will notice this
	 * and fail.
	 */
	snprintf(dev->name, sizeof(dev->name), "eth%d", index);

	/*
	 * Try all transport protocols.
	 * Note: more protocols can be added by adding '&& !X_init(lp, eth)'.
	 */

	if (!tuntap_probe(lp, index, init)) {
		pr_err("%s: invalid arguments. Skipping device!\n",
		       dev->name);
		goto errout;
	}

	pr_info("Netdevice %d (%pM)\n", index, dev->dev_addr);

	/* sysfs register */

	if (!driver_registered) {
		platform_driver_register(&iss_net_driver);
		driver_registered = 1;
	}

	spin_lock(&devices_lock);
	list_add(&lp->device_list, &devices);
	spin_unlock(&devices_lock);

	lp->pdev.id = index;
	lp->pdev.name = DRIVER_NAME;
	platform_device_register(&lp->pdev);
	SET_NETDEV_DEV(dev, &lp->pdev.dev);

	dev->netdev_ops = &iss_netdev_ops;
	dev->mtu = lp->mtu;
	dev->watchdog_timeo = (HZ >> 1);
	dev->irq = -1;

	rtnl_lock();
	err = register_netdevice(dev);
	rtnl_unlock();

	if (err) {
		pr_err("%s: error registering net device!\n", dev->name);
		/* XXX: should we call ->remove() here? */
		free_netdev(dev);
		return 1;
	}

	init_timer(&lp->tl);
	lp->tl.function = iss_net_user_timer_expire;

	return 0;

errout:
	/* FIXME: unregister; free, etc.. */
	return -EIO;
}

/* ------------------------------------------------------------------------- */

/* Filled in during early boot */

struct list_head eth_cmd_line = LIST_HEAD_INIT(eth_cmd_line);

struct iss_net_init {
	struct list_head list;
	char *init;		/* init string */
	int index;
};

/*
 * Parse the command line and look for 'ethX=...' fields, and register all
 * those fields. They will be later initialized in iss_net_init.
 */

#define ERR KERN_ERR "iss_net_setup: "

static int __init iss_net_setup(char *str)
{
	struct iss_net_private *device = NULL;
	struct iss_net_init *new;
	struct list_head *ele;
	char *end;
	int rc;
	unsigned n;

	end = strchr(str, '=');
	if (!end) {
		printk(ERR "Expected '=' after device number\n");
		return 1;
	}
	*end = 0;
	rc = kstrtouint(str, 0, &n);
	*end = '=';
	if (rc < 0) {
		printk(ERR "Failed to parse '%s'\n", str);
		return 1;
	}
	str = end;

	spin_lock(&devices_lock);

	list_for_each(ele, &devices) {
		device = list_entry(ele, struct iss_net_private, device_list);
		if (device->index == n)
			break;
	}

	spin_unlock(&devices_lock);

	if (device && device->index == n) {
		printk(ERR "Device %u already configured\n", n);
		return 1;
	}

	new = alloc_bootmem(sizeof(*new));
	if (new == NULL) {
		printk(ERR "Alloc_bootmem failed\n");
		return 1;
	}

	INIT_LIST_HEAD(&new->list);
	new->index = n;
	new->init = str + 1;

	list_add_tail(&new->list, &eth_cmd_line);
	return 1;
}

#undef ERR

__setup("eth", iss_net_setup);

/*
 * Initialize all ISS Ethernet devices previously registered in iss_net_setup.
 */

static int iss_net_init(void)
{
	struct list_head *ele, *next;

	/* Walk through all Ethernet devices specified in the command line. */

	list_for_each_safe(ele, next, &eth_cmd_line) {
		struct iss_net_init *eth;
		eth = list_entry(ele, struct iss_net_init, list);
		iss_net_configure(eth->index, eth->init);
	}

	return 1;
}
device_initcall(iss_net_init);
Commit	Line	Data
7282bee7 CZ	1	/*
7282bee7 CZ	2	*
5fee325e	3	* arch/xtensa/platforms/iss/network.c
7282bee7 CZ	4	*
	5	* Platform specific initialization.
	6	*
	7	* Authors: Chris Zankel <chris@zankel.net>
	8	* Based on work form the UML team.
	9	*
	10	* Copyright 2005 Tensilica Inc.
	11	*
	12	* This program is free software; you can redistribute it and/or modify it
	13	* under the terms of the GNU General Public License as published by the
	14	* Free Software Foundation; either version 2 of the License, or (at your
	15	* option) any later version.
	16	*
	17	*/
	18
7282bee7 CZ	19	#include <linux/list.h>
	20	#include <linux/irq.h>
	21	#include <linux/spinlock.h>
	22	#include <linux/slab.h>
	23	#include <linux/timer.h>
	24	#include <linux/if_ether.h>
	25	#include <linux/inetdevice.h>
	26	#include <linux/init.h>
	27	#include <linux/if_tun.h>
	28	#include <linux/etherdevice.h>
	29	#include <linux/interrupt.h>
	30	#include <linux/ioctl.h>
	31	#include <linux/bootmem.h>
	32	#include <linux/ethtool.h>
	33	#include <linux/rtnetlink.h>
d052d1be	34	#include <linux/platform_device.h>
7282bee7	35
5fee325e	36	#include <platform/simcall.h>
7282bee7 CZ	37
	38	#define DRIVER_NAME "iss-netdev"
	39	#define ETH_MAX_PACKET 1500
	40	#define ETH_HEADER_OTHER 14
306ab544	41	#define ISS_NET_TIMER_VALUE (HZ / 10)
7282bee7 CZ	42
	43
	44	static DEFINE_SPINLOCK(opened_lock);
	45	static LIST_HEAD(opened);
	46
	47	static DEFINE_SPINLOCK(devices_lock);
	48	static LIST_HEAD(devices);
	49
	50	/* ------------------------------------------------------------------------- */
	51
	52	/* We currently only support the TUNTAP transport protocol. */
	53
	54	#define TRANSPORT_TUNTAP_NAME "tuntap"
	55	#define TRANSPORT_TUNTAP_MTU ETH_MAX_PACKET
	56
	57	struct tuntap_info {
	58	char dev_name[IFNAMSIZ];
7282bee7 CZ	59	int fd;
	60	};
	61
	62	/* ------------------------------------------------------------------------- */
	63
	64
	65	/* This structure contains out private information for the driver. */
	66
	67	struct iss_net_private {
7282bee7 CZ	68	struct list_head device_list;
	69	struct list_head opened_list;
	70
	71	spinlock_t lock;
	72	struct net_device *dev;
	73	struct platform_device pdev;
	74	struct timer_list tl;
	75	struct net_device_stats stats;
	76
	77	struct timer_list timer;
	78	unsigned int timer_val;
	79
	80	int index;
	81	int mtu;
	82
7282bee7 CZ	83	struct {
	84	union {
	85	struct tuntap_info tuntap;
	86	} info;
	87
	88	int (open)(struct iss_net_private lp);
	89	void (close)(struct iss_net_private lp);
	90	int (read)(struct iss_net_private lp, struct sk_buff **skb);
	91	int (write)(struct iss_net_private lp, struct sk_buff **skb);
	92	unsigned short (protocol)(struct sk_buff skb);
	93	int (poll)(struct iss_net_private lp);
	94	} tp;
	95
	96	};
	97
7282bee7 CZ	98	/* ================================ HELPERS ================================ */
	99
	100
	101	static char split_if_spec(char str, ...)
	102	{
	103	char *arg, end;
	104	va_list ap;
	105
	106	va_start(ap, str);
	107	while ((arg = va_arg(ap, char**)) != NULL) {
72ce6787 MF	108	if (*str == '\0') {
72ce6787 MF	109	va_end(ap);
7282bee7	110	return NULL;
72ce6787	111	}
7282bee7 CZ	112	end = strchr(str, ',');
	113	if (end != str)
	114	*arg = str;
72ce6787 MF	115	if (end == NULL) {
72ce6787 MF	116	va_end(ap);
7282bee7	117	return NULL;
72ce6787	118	}
3f3cd60b	119	*end++ = '\0';
7282bee7 CZ	120	str = end;
	121	}
	122	va_end(ap);
	123	return str;
	124	}
	125
8991fd88	126	/* Set Ethernet address of the specified device. */
7282bee7	127
8991fd88	128	static void setup_etheraddr(struct net_device dev, char str)
7282bee7	129	{
8991fd88	130	unsigned char *addr = dev->dev_addr;
7282bee7	131
8991fd88 MF	132	if (str == NULL)
8991fd88 MF	133	goto random;
3f3cd60b	134
8991fd88 MF	135	if (!mac_pton(str, addr)) {
	136	pr_err("%s: failed to parse '%s' as an ethernet address\n",
	137	dev->name, str);
	138	goto random;
7282bee7	139	}
8991fd88 MF	140	if (is_multicast_ether_addr(addr)) {
	141	pr_err("%s: attempt to assign a multicast ethernet address\n",
	142	dev->name);
	143	goto random;
	144	}
	145	if (!is_valid_ether_addr(addr)) {
	146	pr_err("%s: attempt to assign an invalid ethernet address\n",
	147	dev->name);
	148	goto random;
	149	}
	150	if (!is_local_ether_addr(addr))
	151	pr_warn("%s: assigning a globally valid ethernet address\n",
	152	dev->name);
	153	return;
	154
	155	random:
	156	pr_info("%s: choosing a random ethernet address\n",
	157	dev->name);
	158	eth_hw_addr_random(dev);
7282bee7 CZ	159	}
7282bee7 CZ	160
7282bee7 CZ	161	/* ======================= TUNTAP TRANSPORT INTERFACE ====================== */
	162
	163	static int tuntap_open(struct iss_net_private *lp)
	164	{
	165	struct ifreq ifr;
	166	char *dev_name = lp->tp.info.tuntap.dev_name;
	167	int err = -EINVAL;
	168	int fd;
	169
3f3cd60b MF	170	fd = simc_open("/dev/net/tun", 02, 0); /* O_RDWR */
3f3cd60b MF	171	if (fd < 0) {
a6e16b9a MF	172	pr_err("%s: failed to open /dev/net/tun, returned %d (errno = %d)\n",
a6e16b9a MF	173	lp->dev->name, fd, errno);
7282bee7 CZ	174	return fd;
	175	}
	176
3f3cd60b	177	memset(&ifr, 0, sizeof(ifr));
7282bee7	178	ifr.ifr_flags = IFF_TAP \| IFF_NO_PI;
3f3cd60b	179	strlcpy(ifr.ifr_name, dev_name, sizeof(ifr.ifr_name));
7282bee7	180
3f3cd60b MF	181	err = simc_ioctl(fd, TUNSETIFF, &ifr);
3f3cd60b MF	182	if (err < 0) {
a6e16b9a MF	183	pr_err("%s: failed to set interface %s, returned %d (errno = %d)\n",
a6e16b9a MF	184	lp->dev->name, dev_name, err, errno);
7282bee7 CZ	185	simc_close(fd);
	186	return err;
	187	}
	188
	189	lp->tp.info.tuntap.fd = fd;
	190	return err;
	191	}
	192
	193	static void tuntap_close(struct iss_net_private *lp)
	194	{
7282bee7 CZ	195	simc_close(lp->tp.info.tuntap.fd);
	196	lp->tp.info.tuntap.fd = -1;
	197	}
	198
3f3cd60b	199	static int tuntap_read(struct iss_net_private lp, struct sk_buff *skb)
7282bee7	200	{
7282bee7 CZ	201	return simc_read(lp->tp.info.tuntap.fd,
	202	(skb)->data, (skb)->dev->mtu + ETH_HEADER_OTHER);
	203	}
	204
3f3cd60b	205	static int tuntap_write(struct iss_net_private lp, struct sk_buff *skb)
7282bee7 CZ	206	{
	207	return simc_write(lp->tp.info.tuntap.fd, (skb)->data, (skb)->len);
	208	}
	209
	210	unsigned short tuntap_protocol(struct sk_buff *skb)
	211	{
	212	return eth_type_trans(skb, skb->dev);
	213	}
	214
	215	static int tuntap_poll(struct iss_net_private *lp)
	216	{
	217	return simc_poll(lp->tp.info.tuntap.fd);
	218	}
	219
	220	/*
35e14b44	221	* ethX=tuntap,[mac address],device name
7282bee7 CZ	222	*/
	223
	224	static int tuntap_probe(struct iss_net_private lp, int index, char init)
	225	{
8991fd88	226	struct net_device *dev = lp->dev;
7282bee7 CZ	227	char dev_name = NULL, mac_str = NULL, *rem = NULL;
	228
	229	/* Transport should be 'tuntap': ethX=tuntap,mac,dev_name */
	230
3f3cd60b MF	231	if (strncmp(init, TRANSPORT_TUNTAP_NAME,
3f3cd60b MF	232	sizeof(TRANSPORT_TUNTAP_NAME) - 1))
7282bee7 CZ	233	return 0;
7282bee7 CZ	234
3f3cd60b MF	235	init += sizeof(TRANSPORT_TUNTAP_NAME) - 1;
	236	if (*init == ',') {
	237	rem = split_if_spec(init + 1, &mac_str, &dev_name);
	238	if (rem != NULL) {
a6e16b9a MF	239	pr_err("%s: extra garbage on specification : '%s'\n",
a6e16b9a MF	240	dev->name, rem);
7282bee7 CZ	241	return 0;
	242	}
	243	} else if (*init != '\0') {
a6e16b9a MF	244	pr_err("%s: invalid argument: %s. Skipping device!\n",
a6e16b9a MF	245	dev->name, init);
7282bee7 CZ	246	return 0;
	247	}
	248
35e14b44 MF	249	if (!dev_name) {
	250	pr_err("%s: missing tuntap device name\n", dev->name);
	251	return 0;
	252	}
	253
	254	strlcpy(lp->tp.info.tuntap.dev_name, dev_name,
	255	sizeof(lp->tp.info.tuntap.dev_name));
7282bee7	256
8991fd88	257	setup_etheraddr(dev, mac_str);
7282bee7	258
7282bee7 CZ	259	lp->mtu = TRANSPORT_TUNTAP_MTU;
7282bee7 CZ	260
7282bee7 CZ	261	lp->tp.info.tuntap.fd = -1;
	262
	263	lp->tp.open = tuntap_open;
	264	lp->tp.close = tuntap_close;
	265	lp->tp.read = tuntap_read;
	266	lp->tp.write = tuntap_write;
	267	lp->tp.protocol = tuntap_protocol;
	268	lp->tp.poll = tuntap_poll;
	269
7282bee7 CZ	270	return 1;
	271	}
	272
	273	/* ================================ ISS NET ================================ */
	274
	275	static int iss_net_rx(struct net_device *dev)
	276	{
6cbeba55	277	struct iss_net_private *lp = netdev_priv(dev);
7282bee7 CZ	278	int pkt_len;
	279	struct sk_buff *skb;
	280
	281	/* Check if there is any new data. */
	282
	283	if (lp->tp.poll(lp) == 0)
	284	return 0;
	285
	286	/* Try to allocate memory, if it fails, try again next round. */
	287
3f3cd60b MF	288	skb = dev_alloc_skb(dev->mtu + 2 + ETH_HEADER_OTHER);
3f3cd60b MF	289	if (skb == NULL) {
7282bee7 CZ	290	lp->stats.rx_dropped++;
	291	return 0;
	292	}
	293
	294	skb_reserve(skb, 2);
	295
	296	/* Setup skb */
	297
	298	skb->dev = dev;
459a98ed	299	skb_reset_mac_header(skb);
7282bee7 CZ	300	pkt_len = lp->tp.read(lp, &skb);
	301	skb_put(skb, pkt_len);
	302
	303	if (pkt_len > 0) {
	304	skb_trim(skb, pkt_len);
	305	skb->protocol = lp->tp.protocol(skb);
7282bee7 CZ	306
	307	lp->stats.rx_bytes += skb->len;
	308	lp->stats.rx_packets++;
299f590f	309	netif_rx_ni(skb);
7282bee7 CZ	310	return pkt_len;
	311	}
	312	kfree_skb(skb);
	313	return pkt_len;
	314	}
	315
	316	static int iss_net_poll(void)
	317	{
	318	struct list_head *ele;
	319	int err, ret = 0;
	320
	321	spin_lock(&opened_lock);
	322
	323	list_for_each(ele, &opened) {
	324	struct iss_net_private *lp;
	325
	326	lp = list_entry(ele, struct iss_net_private, opened_list);
	327
	328	if (!netif_running(lp->dev))
	329	break;
	330
	331	spin_lock(&lp->lock);
	332
	333	while ((err = iss_net_rx(lp->dev)) > 0)
	334	ret++;
	335
	336	spin_unlock(&lp->lock);
	337
	338	if (err < 0) {
3f3cd60b MF	339	pr_err("Device '%s' read returned %d, shutting it down\n",
3f3cd60b MF	340	lp->dev->name, err);
7282bee7 CZ	341	dev_close(lp->dev);
7282bee7 CZ	342	} else {
3f3cd60b	343	/* FIXME reactivate_fd(lp->fd, ISS_ETH_IRQ); */
7282bee7 CZ	344	}
	345	}
	346
	347	spin_unlock(&opened_lock);
	348	return ret;
	349	}
	350
	351
	352	static void iss_net_timer(unsigned long priv)
	353	{
3f3cd60b	354	struct iss_net_private lp = (struct iss_net_private )priv;
7282bee7	355
7282bee7	356	iss_net_poll();
24e94454	357	spin_lock(&lp->lock);
7282bee7	358	mod_timer(&lp->timer, jiffies + lp->timer_val);
7282bee7 CZ	359	spin_unlock(&lp->lock);
	360	}
	361
	362
	363	static int iss_net_open(struct net_device *dev)
	364	{
6cbeba55	365	struct iss_net_private *lp = netdev_priv(dev);
7282bee7 CZ	366	int err;
7282bee7 CZ	367
24e94454	368	spin_lock_bh(&lp->lock);
7282bee7	369
3f3cd60b MF	370	err = lp->tp.open(lp);
3f3cd60b MF	371	if (err < 0)
7282bee7 CZ	372	goto out;
7282bee7 CZ	373
7282bee7 CZ	374	netif_start_queue(dev);
	375
	376	/* clear buffer - it can happen that the host side of the interface
4af410a8	377	* is full when we get here. In this case, new data is never queued,
7282bee7 CZ	378	* SIGIOs never arrive, and the net never works.
	379	*/
	380	while ((err = iss_net_rx(dev)) > 0)
	381	;
	382
24e94454 MF	383	spin_unlock_bh(&lp->lock);
24e94454 MF	384	spin_lock_bh(&opened_lock);
7282bee7	385	list_add(&lp->opened_list, &opened);
24e94454 MF	386	spin_unlock_bh(&opened_lock);
24e94454 MF	387	spin_lock_bh(&lp->lock);
7282bee7 CZ	388
	389	init_timer(&lp->timer);
	390	lp->timer_val = ISS_NET_TIMER_VALUE;
	391	lp->timer.data = (unsigned long) lp;
	392	lp->timer.function = iss_net_timer;
	393	mod_timer(&lp->timer, jiffies + lp->timer_val);
	394
	395	out:
24e94454	396	spin_unlock_bh(&lp->lock);
7282bee7 CZ	397	return err;
	398	}
	399
	400	static int iss_net_close(struct net_device *dev)
	401	{
6cbeba55	402	struct iss_net_private *lp = netdev_priv(dev);
7282bee7	403	netif_stop_queue(dev);
24e94454	404	spin_lock_bh(&lp->lock);
7282bee7 CZ	405
	406	spin_lock(&opened_lock);
	407	list_del(&opened);
	408	spin_unlock(&opened_lock);
	409
	410	del_timer_sync(&lp->timer);
	411
	412	lp->tp.close(lp);
	413
24e94454	414	spin_unlock_bh(&lp->lock);
7282bee7 CZ	415	return 0;
	416	}
	417
	418	static int iss_net_start_xmit(struct sk_buff skb, struct net_device dev)
	419	{
6cbeba55	420	struct iss_net_private *lp = netdev_priv(dev);
7282bee7 CZ	421	int len;
	422
	423	netif_stop_queue(dev);
24e94454	424	spin_lock_bh(&lp->lock);
7282bee7 CZ	425
	426	len = lp->tp.write(lp, &skb);
	427
	428	if (len == skb->len) {
	429	lp->stats.tx_packets++;
	430	lp->stats.tx_bytes += skb->len;
860e9538	431	netif_trans_update(dev);
7282bee7 CZ	432	netif_start_queue(dev);
	433
	434	/* this is normally done in the interrupt when tx finishes */
	435	netif_wake_queue(dev);
	436
	437	} else if (len == 0) {
	438	netif_start_queue(dev);
	439	lp->stats.tx_dropped++;
	440
	441	} else {
	442	netif_start_queue(dev);
a6e16b9a	443	pr_err("%s: %s failed(%d)\n", dev->name, __func__, len);
7282bee7 CZ	444	}
7282bee7 CZ	445
24e94454	446	spin_unlock_bh(&lp->lock);
7282bee7 CZ	447
7282bee7 CZ	448	dev_kfree_skb(skb);
ec634fe3	449	return NETDEV_TX_OK;
7282bee7 CZ	450	}
	451
	452
	453	static struct net_device_stats iss_net_get_stats(struct net_device dev)
	454	{
6cbeba55	455	struct iss_net_private *lp = netdev_priv(dev);
7282bee7 CZ	456	return &lp->stats;
	457	}
	458
	459	static void iss_net_set_multicast_list(struct net_device *dev)
	460	{
7282bee7 CZ	461	}
	462
	463	static void iss_net_tx_timeout(struct net_device *dev)
	464	{
7282bee7 CZ	465	}
	466
	467	static int iss_net_set_mac(struct net_device dev, void addr)
	468	{
6cbeba55	469	struct iss_net_private *lp = netdev_priv(dev);
7282bee7 CZ	470	struct sockaddr *hwaddr = addr;
7282bee7 CZ	471
f6ac5a17 MF	472	if (!is_valid_ether_addr(hwaddr->sa_data))
f6ac5a17 MF	473	return -EADDRNOTAVAIL;
24e94454	474	spin_lock_bh(&lp->lock);
7282bee7	475	memcpy(dev->dev_addr, hwaddr->sa_data, ETH_ALEN);
24e94454	476	spin_unlock_bh(&lp->lock);
7282bee7 CZ	477	return 0;
	478	}
	479
	480	static int iss_net_change_mtu(struct net_device *dev, int new_mtu)
	481	{
7282bee7 CZ	482	return -EINVAL;
	483	}
	484
7282bee7 CZ	485	void iss_net_user_timer_expire(unsigned long _conn)
	486	{
	487	}
	488
	489
3ae5eaec RK	490	static struct platform_driver iss_net_driver = {
	491	.driver = {
	492	.name = DRIVER_NAME,
	493	},
7282bee7 CZ	494	};
	495
	496	static int driver_registered;
	497
0a972468 CZ	498	static const struct net_device_ops iss_netdev_ops = {
	499	.ndo_open = iss_net_open,
	500	.ndo_stop = iss_net_close,
	501	.ndo_get_stats = iss_net_get_stats,
	502	.ndo_start_xmit = iss_net_start_xmit,
	503	.ndo_validate_addr = eth_validate_addr,
	504	.ndo_change_mtu = iss_net_change_mtu,
	505	.ndo_set_mac_address = iss_net_set_mac,
0a972468	506	.ndo_tx_timeout = iss_net_tx_timeout,
afc4b13d	507	.ndo_set_rx_mode = iss_net_set_multicast_list,
0a972468 CZ	508	};
0a972468 CZ	509
7282bee7 CZ	510	static int iss_net_configure(int index, char *init)
	511	{
	512	struct net_device *dev;
	513	struct iss_net_private *lp;
	514	int err;
	515
3f3cd60b MF	516	dev = alloc_etherdev(sizeof(*lp));
	517	if (dev == NULL) {
	518	pr_err("eth_configure: failed to allocate device\n");
7282bee7 CZ	519	return 1;
	520	}
	521
	522	/* Initialize private element. */
	523
6cbeba55	524	lp = netdev_priv(dev);
3f3cd60b	525	*lp = (struct iss_net_private) {
7282bee7 CZ	526	.device_list = LIST_HEAD_INIT(lp->device_list),
7282bee7 CZ	527	.opened_list = LIST_HEAD_INIT(lp->opened_list),
7282bee7 CZ	528	.dev = dev,
7282bee7 CZ	529	.index = index,
24e94454	530	};
7282bee7	531
24e94454	532	spin_lock_init(&lp->lock);
358b1810 MF	533	/*
	534	* If this name ends up conflicting with an existing registered
	535	* netdevice, that is OK, register_netdev{,ice}() will notice this
	536	* and fail.
	537	*/
	538	snprintf(dev->name, sizeof(dev->name), "eth%d", index);
	539
7282bee7 CZ	540	/*
	541	* Try all transport protocols.
	542	* Note: more protocols can be added by adding '&& !X_init(lp, eth)'.
	543	*/
	544
	545	if (!tuntap_probe(lp, index, init)) {
a6e16b9a MF	546	pr_err("%s: invalid arguments. Skipping device!\n",
a6e16b9a MF	547	dev->name);
7282bee7 CZ	548	goto errout;
	549	}
	550
8991fd88	551	pr_info("Netdevice %d (%pM)\n", index, dev->dev_addr);
7282bee7 CZ	552
	553	/* sysfs register */
	554
	555	if (!driver_registered) {
3ae5eaec	556	platform_driver_register(&iss_net_driver);
7282bee7 CZ	557	driver_registered = 1;
	558	}
	559
	560	spin_lock(&devices_lock);
	561	list_add(&lp->device_list, &devices);
	562	spin_unlock(&devices_lock);
	563
	564	lp->pdev.id = index;
	565	lp->pdev.name = DRIVER_NAME;
	566	platform_device_register(&lp->pdev);
3f3cd60b	567	SET_NETDEV_DEV(dev, &lp->pdev.dev);
7282bee7	568
0a972468	569	dev->netdev_ops = &iss_netdev_ops;
7282bee7	570	dev->mtu = lp->mtu;
7282bee7 CZ	571	dev->watchdog_timeo = (HZ >> 1);
	572	dev->irq = -1;
	573
	574	rtnl_lock();
	575	err = register_netdevice(dev);
	576	rtnl_unlock();
	577
	578	if (err) {
a6e16b9a	579	pr_err("%s: error registering net device!\n", dev->name);
7282bee7 CZ	580	/* XXX: should we call ->remove() here? */
	581	free_netdev(dev);
	582	return 1;
	583	}
	584
	585	init_timer(&lp->tl);
	586	lp->tl.function = iss_net_user_timer_expire;
	587
7282bee7 CZ	588	return 0;
	589
	590	errout:
3f3cd60b	591	/* FIXME: unregister; free, etc.. */
7282bee7	592	return -EIO;
7282bee7 CZ	593	}
	594
	595	/* ------------------------------------------------------------------------- */
	596
	597	/* Filled in during early boot */
	598
	599	struct list_head eth_cmd_line = LIST_HEAD_INIT(eth_cmd_line);
	600
	601	struct iss_net_init {
	602	struct list_head list;
	603	char init; / init string */
	604	int index;
	605	};
	606
	607	/*
	608	* Parse the command line and look for 'ethX=...' fields, and register all
	609	* those fields. They will be later initialized in iss_net_init.
	610	*/
	611
	612	#define ERR KERN_ERR "iss_net_setup: "
	613
dc2bffa7	614	static int __init iss_net_setup(char *str)
7282bee7 CZ	615	{
	616	struct iss_net_private *device = NULL;
	617	struct iss_net_init *new;
	618	struct list_head *ele;
	619	char *end;
8be54d77 MF	620	int rc;
8be54d77 MF	621	unsigned n;
7282bee7	622
8be54d77 MF	623	end = strchr(str, '=');
	624	if (!end) {
	625	printk(ERR "Expected '=' after device number\n");
7282bee7 CZ	626	return 1;
7282bee7 CZ	627	}
8be54d77 MF	628	*end = 0;
	629	rc = kstrtouint(str, 0, &n);
	630	*end = '=';
	631	if (rc < 0) {
	632	printk(ERR "Failed to parse '%s'\n", str);
7282bee7 CZ	633	return 1;
7282bee7 CZ	634	}
3f3cd60b	635	str = end;
7282bee7 CZ	636
	637	spin_lock(&devices_lock);
	638
	639	list_for_each(ele, &devices) {
	640	device = list_entry(ele, struct iss_net_private, device_list);
	641	if (device->index == n)
	642	break;
	643	}
	644
	645	spin_unlock(&devices_lock);
	646
	647	if (device && device->index == n) {
8be54d77	648	printk(ERR "Device %u already configured\n", n);
7282bee7 CZ	649	return 1;
	650	}
	651
f447fd30 TM	652	new = alloc_bootmem(sizeof(*new));
f447fd30 TM	653	if (new == NULL) {
3f3cd60b	654	printk(ERR "Alloc_bootmem failed\n");
7282bee7 CZ	655	return 1;
	656	}
	657
	658	INIT_LIST_HEAD(&new->list);
	659	new->index = n;
	660	new->init = str + 1;
	661
	662	list_add_tail(&new->list, &eth_cmd_line);
	663	return 1;
	664	}
	665
	666	#undef ERR
	667
8c8ad85f	668	__setup("eth", iss_net_setup);
7282bee7 CZ	669
	670	/*
	671	* Initialize all ISS Ethernet devices previously registered in iss_net_setup.
	672	*/
	673
	674	static int iss_net_init(void)
	675	{
	676	struct list_head ele, next;
	677
	678	/* Walk through all Ethernet devices specified in the command line. */
	679
	680	list_for_each_safe(ele, next, &eth_cmd_line) {
	681	struct iss_net_init *eth;
	682	eth = list_entry(ele, struct iss_net_init, list);
	683	iss_net_configure(eth->index, eth->init);
	684	}
	685
	686	return 1;
	687	}
30e3c642	688	device_initcall(iss_net_init);