/* * * arch/xtensa/platform-iss/network.c * * Platform specific initialization. * * Authors: Chris Zankel * 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 #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #define DRIVER_NAME "iss-netdev" #define ETH_MAX_PACKET 1500 #define ETH_HEADER_OTHER 14 #define ISS_NET_TIMER_VALUE (2 * HZ) 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 fixed_config; unsigned char gw[ETH_ALEN]; 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; unsigned char mac[ETH_ALEN]; int have_mac; 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; }; /* ======================= ISS SIMCALL INTERFACE =========================== */ /* Note: __simc must _not_ be declared inline! */ static int errno; static int __simc (int a, int b, int c, int d, int e, int f) { int ret; __asm__ __volatile__ ("simcall\n" "mov %0, a2\n" "mov %1, a3\n" : "=a" (ret), "=a" (errno) : : "a2", "a3"); return ret; } static int inline simc_open(char *file, int flags, int mode) { return __simc(SYS_open, (int) file, flags, mode, 0, 0); } static int inline simc_close(int fd) { return __simc(SYS_close, fd, 0, 0, 0, 0); } static int inline simc_ioctl(int fd, int request, void *arg) { return __simc(SYS_ioctl, fd, request, (int) arg, 0, 0); } static int inline simc_read(int fd, void *buf, size_t count) { return __simc(SYS_read, fd, (int) buf, count, 0, 0); } static int inline simc_write(int fd, void *buf, size_t count) { return __simc(SYS_write, fd, (int) buf, count, 0, 0); } static int inline simc_poll(int fd) { struct timeval tv = { .tv_sec = 0, .tv_usec = 0 }; return __simc(SYS_select_one, fd, XTISS_SELECT_ONE_READ, (int)&tv,0,0); } /* ================================ 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') return NULL; end = strchr(str, ','); if (end != str) *arg = str; if (end == NULL) return NULL; *end ++ = '\0'; str = end; } va_end(ap); return str; } #if 0 /* Adjust SKB. */ struct sk_buff *ether_adjust_skb(struct sk_buff *skb, int extra) { if ((skb != NULL) && (skb_tailroom(skb) < extra)) { struct sk_buff *skb2; skb2 = skb_copy_expand(skb, 0, extra, GFP_ATOMIC); dev_kfree_skb(skb); skb = skb2; } if (skb != NULL) skb_put(skb, extra); return skb; } #endif /* Return the IP address as a string for a given device. */ static void dev_ip_addr(void *d, char *buf, char *bin_buf) { struct net_device *dev = d; struct in_device *ip = dev->ip_ptr; struct in_ifaddr *in; u32 addr; if ((ip == NULL) || ((in = ip->ifa_list) == NULL)) { printk(KERN_WARNING "Device not assigned an IP address!\n"); return; } addr = in->ifa_address; sprintf(buf, "%d.%d.%d.%d", addr & 0xff, (addr >> 8) & 0xff, (addr >> 16) & 0xff, addr >> 24); if (bin_buf) { bin_buf[0] = addr & 0xff; bin_buf[1] = (addr >> 8) & 0xff; bin_buf[2] = (addr >> 16) & 0xff; bin_buf[3] = addr >> 24; } } /* Set Ethernet address of the specified device. */ static void inline set_ether_mac(void *d, unsigned char *addr) { struct net_device *dev = d; memcpy(dev->dev_addr, addr, ETH_ALEN); } /* ======================= 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; /* We currently only support a fixed configuration. */ if (!lp->tp.info.tuntap.fixed_config) return -EINVAL; if ((fd = simc_open("/dev/net/tun", 02, 0)) < 0) { /* O_RDWR */ printk("Failed to open /dev/net/tun, returned %d " "(errno = %d)\n", 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 - 1); if ((err = simc_ioctl(fd, TUNSETIFF, (void*) &ifr)) < 0) { printk("Failed to set interface, returned %d " "(errno = %d)\n", err, errno); simc_close(fd); return err; } lp->tp.info.tuntap.fd = fd; return err; } static void tuntap_close(struct iss_net_private *lp) { #if 0 if (lp->tp.info.tuntap.fixed_config) iter_addresses(lp->tp.info.tuntap.dev, close_addr, lp->host.dev_name); #endif 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) { #if 0 *skb = ether_adjust_skb(*skb, ETH_HEADER_OTHER); if (*skb == NULL) return -ENOMEM; #endif 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); } /* * Currently only a device name is supported. * ethX=tuntap[,[mac address][,[device name]]] */ static int tuntap_probe(struct iss_net_private *lp, int index, char *init) { const int len = strlen(TRANSPORT_TUNTAP_NAME); char *dev_name = NULL, *mac_str = NULL, *rem = NULL; /* Transport should be 'tuntap': ethX=tuntap,mac,dev_name */ if (strncmp(init, TRANSPORT_TUNTAP_NAME, len)) return 0; if (*(init += strlen(TRANSPORT_TUNTAP_NAME)) == ',') { if ((rem=split_if_spec(init+1, &mac_str, &dev_name)) != NULL) { printk("Extra garbage on specification : '%s'\n", rem); return 0; } } else if (*init != '\0') { printk("Invalid argument: %s. Skipping device!\n", init); return 0; } if (dev_name) { strncpy(lp->tp.info.tuntap.dev_name, dev_name, sizeof lp->tp.info.tuntap.dev_name); lp->tp.info.tuntap.fixed_config = 1; } else strcpy(lp->tp.info.tuntap.dev_name, TRANSPORT_TUNTAP_NAME); #if 0 if (setup_etheraddr(mac_str, lp->mac)) lp->have_mac = 1; #endif lp->mtu = TRANSPORT_TUNTAP_MTU; //lp->info.tuntap.gate_addr = gate_addr; 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; printk("TUN/TAP backend - "); #if 0 if (lp->host.gate_addr != NULL) printk("IP = %s", lp->host.gate_addr); #endif printk("\n"); return 1; } /* ================================ ISS NET ================================ */ static int iss_net_rx(struct net_device *dev) { struct iss_net_private *lp = dev->priv; 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. */ if ((skb = dev_alloc_skb(dev->mtu + 2 + ETH_HEADER_OTHER)) == NULL) { lp->stats.rx_dropped++; return 0; } skb_reserve(skb, 2); /* Setup skb */ skb->dev = dev; skb->mac.raw = skb->data; 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); // netif_rx(skb); netif_rx_ni(skb); lp->stats.rx_bytes += skb->len; lp->stats.rx_packets++; 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) { printk(KERN_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; spin_lock(&lp->lock); iss_net_poll(); 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 = dev->priv; char addr[sizeof "255.255.255.255\0"]; int err; spin_lock(&lp->lock); if ((err = lp->tp.open(lp)) < 0) goto out; if (!lp->have_mac) { dev_ip_addr(dev, addr, &lp->mac[2]); set_ether_mac(dev, lp->mac); } netif_start_queue(dev); /* clear buffer - it can happen that the host side of the interface * is full when we gethere. In this case, new data is never queued, * SIGIOs never arrive, and the net never works. */ while ((err = iss_net_rx(dev)) > 0) ; spin_lock(&opened_lock); list_add(&lp->opened_list, &opened); spin_unlock(&opened_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(&lp->lock); return err; } static int iss_net_close(struct net_device *dev) { struct iss_net_private *lp = dev->priv; printk("iss_net_close!\n"); netif_stop_queue(dev); spin_lock(&lp->lock); spin_lock(&opened_lock); list_del(&opened); spin_unlock(&opened_lock); del_timer_sync(&lp->timer); lp->tp.close(lp); spin_unlock(&lp->lock); return 0; } static int iss_net_start_xmit(struct sk_buff *skb, struct net_device *dev) { struct iss_net_private *lp = dev->priv; unsigned long flags; int len; netif_stop_queue(dev); spin_lock_irqsave(&lp->lock, flags); len = lp->tp.write(lp, &skb); if (len == skb->len) { lp->stats.tx_packets++; lp->stats.tx_bytes += skb->len; dev->trans_start = jiffies; 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); printk(KERN_ERR "iss_net_start_xmit: failed(%d)\n", len); } spin_unlock_irqrestore(&lp->lock, flags); dev_kfree_skb(skb); return 0; } static struct net_device_stats *iss_net_get_stats(struct net_device *dev) { struct iss_net_private *lp = dev->priv; return &lp->stats; } static void iss_net_set_multicast_list(struct net_device *dev) { #if 0 if (dev->flags & IFF_PROMISC) return; else if (dev->mc_count) dev->flags |= IFF_ALLMULTI; else dev->flags &= ~IFF_ALLMULTI; #endif } static void iss_net_tx_timeout(struct net_device *dev) { #if 0 dev->trans_start = jiffies; netif_wake_queue(dev); #endif } static int iss_net_set_mac(struct net_device *dev, void *addr) { #if 0 struct iss_net_private *lp = dev->priv; struct sockaddr *hwaddr = addr; spin_lock(&lp->lock); memcpy(dev->dev_addr, hwaddr->sa_data, ETH_ALEN); spin_unlock(&lp->lock); #endif return 0; } static int iss_net_change_mtu(struct net_device *dev, int new_mtu) { #if 0 struct iss_net_private *lp = dev->priv; int err = 0; spin_lock(&lp->lock); // FIXME not needed new_mtu = transport_set_mtu(new_mtu, &lp->user); if (new_mtu < 0) err = new_mtu; else dev->mtu = new_mtu; spin_unlock(&lp->lock); return err; #endif return -EINVAL; } static int iss_net_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd) { #if 0 static const struct ethtool_drvinfo info = { .cmd = ETHTOOL_GDRVINFO, .driver = DRIVER_NAME, .version = "42", }; void *useraddr; u32 ethcmd; switch (cmd) { case SIOCETHTOOL: useraddr = ifr->ifr_data; if (copy_from_user(ðcmd, useraddr, sizeof(ethcmd))) return -EFAULT; switch (ethcmd) { case ETHTOOL_GDRVINFO: if (copy_to_user(useraddr, &info, sizeof(info))) return -EFAULT; return 0; default: return -EOPNOTSUPP; } default: return -EINVAL; } #endif return -EINVAL; } void iss_net_user_timer_expire(unsigned long _conn) { } static struct device_driver iss_net_driver = { .name = DRIVER_NAME, .bus = &platform_bus_type, }; static int driver_registered; static int iss_net_configure(int index, char *init) { struct net_device *dev; struct iss_net_private *lp; int err; if ((dev = alloc_etherdev(sizeof *lp)) == NULL) { printk(KERN_ERR "eth_configure: failed to allocate device\n"); return 1; } /* Initialize private element. */ lp = dev->priv; *lp = ((struct iss_net_private) { .device_list = LIST_HEAD_INIT(lp->device_list), .opened_list = LIST_HEAD_INIT(lp->opened_list), .lock = SPIN_LOCK_UNLOCKED, .dev = dev, .index = index, //.fd = -1, .mac = { 0xfe, 0xfd, 0x0, 0x0, 0x0, 0x0 }, .have_mac = 0, }); /* * Try all transport protocols. * Note: more protocols can be added by adding '&& !X_init(lp, eth)'. */ if (!tuntap_probe(lp, index, init)) { printk("Invalid arguments. Skipping device!\n"); goto errout; } printk(KERN_INFO "Netdevice %d ", index); if (lp->have_mac) printk("(%02x:%02x:%02x:%02x:%02x:%02x) ", lp->mac[0], lp->mac[1], lp->mac[2], lp->mac[3], lp->mac[4], lp->mac[5]); printk(": "); /* sysfs register */ if (!driver_registered) { 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); /* * 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); dev->mtu = lp->mtu; dev->open = iss_net_open; dev->hard_start_xmit = iss_net_start_xmit; dev->stop = iss_net_close; dev->get_stats = iss_net_get_stats; dev->set_multicast_list = iss_net_set_multicast_list; dev->tx_timeout = iss_net_tx_timeout; dev->set_mac_address = iss_net_set_mac; dev->change_mtu = iss_net_change_mtu; dev->do_ioctl = iss_net_ioctl; dev->watchdog_timeo = (HZ >> 1); dev->irq = -1; rtnl_lock(); err = register_netdevice(dev); rtnl_unlock(); if (err) { printk("Error registering net device!\n"); /* XXX: should we call ->remove() here? */ free_netdev(dev); return 1; } init_timer(&lp->tl); lp->tl.function = iss_net_user_timer_expire; #if 0 if (lp->have_mac) set_ether_mac(dev, lp->mac); #endif 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 iss_net_setup(char *str) { struct iss_net_private *device = NULL; struct iss_net_init *new; struct list_head *ele; char *end; int n; n = simple_strtoul(str, &end, 0); if (end == str) { printk(ERR "Failed to parse '%s'\n", str); return 1; } if (n < 0) { printk(ERR "Device %d is negative\n", n); return 1; } if (*(str = end) != '=') { printk(ERR "Expected '=' after device number\n"); return 1; } 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 %d already configured\n", n); return 1; } if ((new = alloc_bootmem(sizeof new)) == NULL) { printk("Alloc_bootmem failed\n"); return 1; } INIT_LIST_HEAD(&new->list); new->index = n; new->init = str + 1; list_add_tail(&new->list, ð_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, ð_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; } module_init(iss_net_init);