| /* |
| * Copyright (C) 2001 Lennert Buytenhek (buytenh@gnu.org) and |
| * James Leu (jleu@mindspring.net). |
| * Copyright (C) 2001 by various other people who didn't put their name here. |
| * Licensed under the GPL. |
| */ |
| |
| #include "linux/config.h" |
| #include "linux/kernel.h" |
| #include "linux/netdevice.h" |
| #include "linux/rtnetlink.h" |
| #include "linux/skbuff.h" |
| #include "linux/socket.h" |
| #include "linux/spinlock.h" |
| #include "linux/module.h" |
| #include "linux/init.h" |
| #include "linux/etherdevice.h" |
| #include "linux/list.h" |
| #include "linux/inetdevice.h" |
| #include "linux/ctype.h" |
| #include "linux/bootmem.h" |
| #include "linux/ethtool.h" |
| #include "linux/platform_device.h" |
| #include "asm/uaccess.h" |
| #include "user_util.h" |
| #include "kern_util.h" |
| #include "net_kern.h" |
| #include "net_user.h" |
| #include "mconsole_kern.h" |
| #include "init.h" |
| #include "irq_user.h" |
| #include "irq_kern.h" |
| |
| #define DRIVER_NAME "uml-netdev" |
| |
| static DEFINE_SPINLOCK(opened_lock); |
| LIST_HEAD(opened); |
| |
| static int uml_net_rx(struct net_device *dev) |
| { |
| struct uml_net_private *lp = dev->priv; |
| int pkt_len; |
| struct sk_buff *skb; |
| |
| /* If we can't allocate memory, try again next round. */ |
| skb = dev_alloc_skb(dev->mtu); |
| if (skb == NULL) { |
| lp->stats.rx_dropped++; |
| return 0; |
| } |
| |
| skb->dev = dev; |
| skb_put(skb, dev->mtu); |
| skb->mac.raw = skb->data; |
| pkt_len = (*lp->read)(lp->fd, &skb, lp); |
| |
| if (pkt_len > 0) { |
| skb_trim(skb, pkt_len); |
| skb->protocol = (*lp->protocol)(skb); |
| netif_rx(skb); |
| |
| lp->stats.rx_bytes += skb->len; |
| lp->stats.rx_packets++; |
| return pkt_len; |
| } |
| |
| kfree_skb(skb); |
| return pkt_len; |
| } |
| |
| irqreturn_t uml_net_interrupt(int irq, void *dev_id, struct pt_regs *regs) |
| { |
| struct net_device *dev = dev_id; |
| struct uml_net_private *lp = dev->priv; |
| int err; |
| |
| if(!netif_running(dev)) |
| return(IRQ_NONE); |
| |
| spin_lock(&lp->lock); |
| while((err = uml_net_rx(dev)) > 0) ; |
| if(err < 0) { |
| printk(KERN_ERR |
| "Device '%s' read returned %d, shutting it down\n", |
| dev->name, err); |
| dev_close(dev); |
| goto out; |
| } |
| reactivate_fd(lp->fd, UM_ETH_IRQ); |
| |
| out: |
| spin_unlock(&lp->lock); |
| return(IRQ_HANDLED); |
| } |
| |
| static int uml_net_open(struct net_device *dev) |
| { |
| struct uml_net_private *lp = dev->priv; |
| char addr[sizeof("255.255.255.255\0")]; |
| int err; |
| |
| spin_lock(&lp->lock); |
| |
| if(lp->fd >= 0){ |
| err = -ENXIO; |
| goto out; |
| } |
| |
| if(!lp->have_mac){ |
| dev_ip_addr(dev, addr, &lp->mac[2]); |
| set_ether_mac(dev, lp->mac); |
| } |
| |
| lp->fd = (*lp->open)(&lp->user); |
| if(lp->fd < 0){ |
| err = lp->fd; |
| goto out; |
| } |
| |
| err = um_request_irq(dev->irq, lp->fd, IRQ_READ, uml_net_interrupt, |
| SA_INTERRUPT | SA_SHIRQ, dev->name, dev); |
| if(err != 0){ |
| printk(KERN_ERR "uml_net_open: failed to get irq(%d)\n", err); |
| if(lp->close != NULL) (*lp->close)(lp->fd, &lp->user); |
| lp->fd = -1; |
| err = -ENETUNREACH; |
| } |
| |
| lp->tl.data = (unsigned long) &lp->user; |
| 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 = uml_net_rx(dev)) > 0) ; |
| |
| out: |
| spin_unlock(&lp->lock); |
| return(err); |
| } |
| |
| static int uml_net_close(struct net_device *dev) |
| { |
| struct uml_net_private *lp = dev->priv; |
| |
| netif_stop_queue(dev); |
| spin_lock(&lp->lock); |
| |
| free_irq(dev->irq, dev); |
| if(lp->close != NULL) |
| (*lp->close)(lp->fd, &lp->user); |
| lp->fd = -1; |
| |
| spin_unlock(&lp->lock); |
| return 0; |
| } |
| |
| static int uml_net_start_xmit(struct sk_buff *skb, struct net_device *dev) |
| { |
| struct uml_net_private *lp = dev->priv; |
| unsigned long flags; |
| int len; |
| |
| netif_stop_queue(dev); |
| |
| spin_lock_irqsave(&lp->lock, flags); |
| |
| len = (*lp->write)(lp->fd, &skb, lp); |
| |
| 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 "uml_net_start_xmit: failed(%d)\n", len); |
| } |
| |
| spin_unlock_irqrestore(&lp->lock, flags); |
| |
| dev_kfree_skb(skb); |
| |
| return 0; |
| } |
| |
| static struct net_device_stats *uml_net_get_stats(struct net_device *dev) |
| { |
| struct uml_net_private *lp = dev->priv; |
| return &lp->stats; |
| } |
| |
| static void uml_net_set_multicast_list(struct net_device *dev) |
| { |
| if (dev->flags & IFF_PROMISC) return; |
| else if (dev->mc_count) dev->flags |= IFF_ALLMULTI; |
| else dev->flags &= ~IFF_ALLMULTI; |
| } |
| |
| static void uml_net_tx_timeout(struct net_device *dev) |
| { |
| dev->trans_start = jiffies; |
| netif_wake_queue(dev); |
| } |
| |
| static int uml_net_set_mac(struct net_device *dev, void *addr) |
| { |
| struct uml_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); |
| |
| return(0); |
| } |
| |
| static int uml_net_change_mtu(struct net_device *dev, int new_mtu) |
| { |
| struct uml_net_private *lp = dev->priv; |
| int err = 0; |
| |
| spin_lock(&lp->lock); |
| |
| new_mtu = (*lp->set_mtu)(new_mtu, &lp->user); |
| if(new_mtu < 0){ |
| err = new_mtu; |
| goto out; |
| } |
| |
| dev->mtu = new_mtu; |
| |
| out: |
| spin_unlock(&lp->lock); |
| return err; |
| } |
| |
| static int uml_net_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd) |
| { |
| 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; |
| } |
| } |
| |
| void uml_net_user_timer_expire(unsigned long _conn) |
| { |
| #ifdef undef |
| struct connection *conn = (struct connection *)_conn; |
| |
| dprintk(KERN_INFO "uml_net_user_timer_expire [%p]\n", conn); |
| do_connect(conn); |
| #endif |
| } |
| |
| static DEFINE_SPINLOCK(devices_lock); |
| static struct list_head devices = LIST_HEAD_INIT(devices); |
| |
| static struct device_driver uml_net_driver = { |
| .name = DRIVER_NAME, |
| .bus = &platform_bus_type, |
| }; |
| static int driver_registered; |
| |
| static int eth_configure(int n, void *init, char *mac, |
| struct transport *transport) |
| { |
| struct uml_net *device; |
| struct net_device *dev; |
| struct uml_net_private *lp; |
| int save, err, size; |
| |
| size = transport->private_size + sizeof(struct uml_net_private) + |
| sizeof(((struct uml_net_private *) 0)->user); |
| |
| device = kmalloc(sizeof(*device), GFP_KERNEL); |
| if (device == NULL) { |
| printk(KERN_ERR "eth_configure failed to allocate uml_net\n"); |
| return(1); |
| } |
| |
| memset(device, 0, sizeof(*device)); |
| INIT_LIST_HEAD(&device->list); |
| device->index = n; |
| |
| spin_lock(&devices_lock); |
| list_add(&device->list, &devices); |
| spin_unlock(&devices_lock); |
| |
| if (setup_etheraddr(mac, device->mac)) |
| device->have_mac = 1; |
| |
| printk(KERN_INFO "Netdevice %d ", n); |
| if (device->have_mac) |
| printk("(%02x:%02x:%02x:%02x:%02x:%02x) ", |
| device->mac[0], device->mac[1], |
| device->mac[2], device->mac[3], |
| device->mac[4], device->mac[5]); |
| printk(": "); |
| dev = alloc_etherdev(size); |
| if (dev == NULL) { |
| printk(KERN_ERR "eth_configure: failed to allocate device\n"); |
| return 1; |
| } |
| |
| /* sysfs register */ |
| if (!driver_registered) { |
| driver_register(¨_net_driver); |
| driver_registered = 1; |
| } |
| device->pdev.id = n; |
| device->pdev.name = DRIVER_NAME; |
| platform_device_register(&device->pdev); |
| SET_NETDEV_DEV(dev,&device->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", n); |
| device->dev = dev; |
| |
| (*transport->kern->init)(dev, init); |
| |
| dev->mtu = transport->user->max_packet; |
| dev->open = uml_net_open; |
| dev->hard_start_xmit = uml_net_start_xmit; |
| dev->stop = uml_net_close; |
| dev->get_stats = uml_net_get_stats; |
| dev->set_multicast_list = uml_net_set_multicast_list; |
| dev->tx_timeout = uml_net_tx_timeout; |
| dev->set_mac_address = uml_net_set_mac; |
| dev->change_mtu = uml_net_change_mtu; |
| dev->do_ioctl = uml_net_ioctl; |
| dev->watchdog_timeo = (HZ >> 1); |
| dev->irq = UM_ETH_IRQ; |
| |
| rtnl_lock(); |
| err = register_netdevice(dev); |
| rtnl_unlock(); |
| if (err) { |
| device->dev = NULL; |
| /* XXX: should we call ->remove() here? */ |
| free_netdev(dev); |
| return 1; |
| } |
| lp = dev->priv; |
| |
| /* lp.user is the first four bytes of the transport data, which |
| * has already been initialized. This structure assignment will |
| * overwrite that, so we make sure that .user gets overwritten with |
| * what it already has. |
| */ |
| save = lp->user[0]; |
| *lp = ((struct uml_net_private) |
| { .list = LIST_HEAD_INIT(lp->list), |
| .dev = dev, |
| .fd = -1, |
| .mac = { 0xfe, 0xfd, 0x0, 0x0, 0x0, 0x0}, |
| .have_mac = device->have_mac, |
| .protocol = transport->kern->protocol, |
| .open = transport->user->open, |
| .close = transport->user->close, |
| .remove = transport->user->remove, |
| .read = transport->kern->read, |
| .write = transport->kern->write, |
| .add_address = transport->user->add_address, |
| .delete_address = transport->user->delete_address, |
| .set_mtu = transport->user->set_mtu, |
| .user = { save } }); |
| |
| init_timer(&lp->tl); |
| spin_lock_init(&lp->lock); |
| lp->tl.function = uml_net_user_timer_expire; |
| if (lp->have_mac) |
| memcpy(lp->mac, device->mac, sizeof(lp->mac)); |
| |
| if (transport->user->init) |
| (*transport->user->init)(&lp->user, dev); |
| |
| if (device->have_mac) |
| set_ether_mac(dev, device->mac); |
| |
| spin_lock(&opened_lock); |
| list_add(&lp->list, &opened); |
| spin_unlock(&opened_lock); |
| |
| return(0); |
| } |
| |
| static struct uml_net *find_device(int n) |
| { |
| struct uml_net *device; |
| struct list_head *ele; |
| |
| spin_lock(&devices_lock); |
| list_for_each(ele, &devices){ |
| device = list_entry(ele, struct uml_net, list); |
| if(device->index == n) |
| goto out; |
| } |
| device = NULL; |
| out: |
| spin_unlock(&devices_lock); |
| return(device); |
| } |
| |
| static int eth_parse(char *str, int *index_out, char **str_out) |
| { |
| char *end; |
| int n; |
| |
| n = simple_strtoul(str, &end, 0); |
| if(end == str){ |
| printk(KERN_ERR "eth_setup: Failed to parse '%s'\n", str); |
| return(1); |
| } |
| if(n < 0){ |
| printk(KERN_ERR "eth_setup: device %d is negative\n", n); |
| return(1); |
| } |
| str = end; |
| if(*str != '='){ |
| printk(KERN_ERR |
| "eth_setup: expected '=' after device number\n"); |
| return(1); |
| } |
| str++; |
| if(find_device(n)){ |
| printk(KERN_ERR "eth_setup: Device %d already configured\n", |
| n); |
| return(1); |
| } |
| if(index_out) *index_out = n; |
| *str_out = str; |
| return(0); |
| } |
| |
| struct eth_init { |
| struct list_head list; |
| char *init; |
| int index; |
| }; |
| |
| /* Filled in at boot time. Will need locking if the transports become |
| * modular. |
| */ |
| struct list_head transports = LIST_HEAD_INIT(transports); |
| |
| /* Filled in during early boot */ |
| struct list_head eth_cmd_line = LIST_HEAD_INIT(eth_cmd_line); |
| |
| static int check_transport(struct transport *transport, char *eth, int n, |
| void **init_out, char **mac_out) |
| { |
| int len; |
| |
| len = strlen(transport->name); |
| if(strncmp(eth, transport->name, len)) |
| return(0); |
| |
| eth += len; |
| if(*eth == ',') |
| eth++; |
| else if(*eth != '\0') |
| return(0); |
| |
| *init_out = kmalloc(transport->setup_size, GFP_KERNEL); |
| if(*init_out == NULL) |
| return(1); |
| |
| if(!transport->setup(eth, mac_out, *init_out)){ |
| kfree(*init_out); |
| *init_out = NULL; |
| } |
| return(1); |
| } |
| |
| void register_transport(struct transport *new) |
| { |
| struct list_head *ele, *next; |
| struct eth_init *eth; |
| void *init; |
| char *mac = NULL; |
| int match; |
| |
| list_add(&new->list, &transports); |
| |
| list_for_each_safe(ele, next, ð_cmd_line){ |
| eth = list_entry(ele, struct eth_init, list); |
| match = check_transport(new, eth->init, eth->index, &init, |
| &mac); |
| if(!match) |
| continue; |
| else if(init != NULL){ |
| eth_configure(eth->index, init, mac, new); |
| kfree(init); |
| } |
| list_del(ð->list); |
| } |
| } |
| |
| static int eth_setup_common(char *str, int index) |
| { |
| struct list_head *ele; |
| struct transport *transport; |
| void *init; |
| char *mac = NULL; |
| |
| list_for_each(ele, &transports){ |
| transport = list_entry(ele, struct transport, list); |
| if(!check_transport(transport, str, index, &init, &mac)) |
| continue; |
| if(init != NULL){ |
| eth_configure(index, init, mac, transport); |
| kfree(init); |
| } |
| return(1); |
| } |
| return(0); |
| } |
| |
| static int eth_setup(char *str) |
| { |
| struct eth_init *new; |
| int n, err; |
| |
| err = eth_parse(str, &n, &str); |
| if(err) return(1); |
| |
| new = alloc_bootmem(sizeof(new)); |
| if (new == NULL){ |
| printk("eth_init : alloc_bootmem failed\n"); |
| return(1); |
| } |
| |
| INIT_LIST_HEAD(&new->list); |
| new->index = n; |
| new->init = str; |
| |
| list_add_tail(&new->list, ð_cmd_line); |
| return(1); |
| } |
| |
| __setup("eth", eth_setup); |
| __uml_help(eth_setup, |
| "eth[0-9]+=<transport>,<options>\n" |
| " Configure a network device.\n\n" |
| ); |
| |
| #if 0 |
| static int eth_init(void) |
| { |
| struct list_head *ele, *next; |
| struct eth_init *eth; |
| |
| list_for_each_safe(ele, next, ð_cmd_line){ |
| eth = list_entry(ele, struct eth_init, list); |
| |
| if(eth_setup_common(eth->init, eth->index)) |
| list_del(ð->list); |
| } |
| |
| return(1); |
| } |
| __initcall(eth_init); |
| #endif |
| |
| static int net_config(char *str) |
| { |
| int n, err; |
| |
| err = eth_parse(str, &n, &str); |
| if(err) return(err); |
| |
| str = uml_strdup(str); |
| if(str == NULL){ |
| printk(KERN_ERR "net_config failed to strdup string\n"); |
| return(-1); |
| } |
| err = !eth_setup_common(str, n); |
| if(err) |
| kfree(str); |
| return(err); |
| } |
| |
| static int net_id(char **str, int *start_out, int *end_out) |
| { |
| char *end; |
| int n; |
| |
| n = simple_strtoul(*str, &end, 0); |
| if((*end != '\0') || (end == *str)) |
| return -1; |
| |
| *start_out = n; |
| *end_out = n; |
| *str = end; |
| return n; |
| } |
| |
| static int net_remove(int n) |
| { |
| struct uml_net *device; |
| struct net_device *dev; |
| struct uml_net_private *lp; |
| |
| device = find_device(n); |
| if(device == NULL) |
| return -ENODEV; |
| |
| dev = device->dev; |
| lp = dev->priv; |
| if(lp->fd > 0) |
| return -EBUSY; |
| if(lp->remove != NULL) (*lp->remove)(&lp->user); |
| unregister_netdev(dev); |
| platform_device_unregister(&device->pdev); |
| |
| list_del(&device->list); |
| kfree(device); |
| free_netdev(dev); |
| return 0; |
| } |
| |
| static struct mc_device net_mc = { |
| .name = "eth", |
| .config = net_config, |
| .get_config = NULL, |
| .id = net_id, |
| .remove = net_remove, |
| }; |
| |
| static int uml_inetaddr_event(struct notifier_block *this, unsigned long event, |
| void *ptr) |
| { |
| struct in_ifaddr *ifa = ptr; |
| u32 addr = ifa->ifa_address; |
| u32 netmask = ifa->ifa_mask; |
| struct net_device *dev = ifa->ifa_dev->dev; |
| struct uml_net_private *lp; |
| void (*proc)(unsigned char *, unsigned char *, void *); |
| unsigned char addr_buf[4], netmask_buf[4]; |
| |
| if(dev->open != uml_net_open) return(NOTIFY_DONE); |
| |
| lp = dev->priv; |
| |
| proc = NULL; |
| switch (event){ |
| case NETDEV_UP: |
| proc = lp->add_address; |
| break; |
| case NETDEV_DOWN: |
| proc = lp->delete_address; |
| break; |
| } |
| if(proc != NULL){ |
| addr_buf[0] = addr & 0xff; |
| addr_buf[1] = (addr >> 8) & 0xff; |
| addr_buf[2] = (addr >> 16) & 0xff; |
| addr_buf[3] = addr >> 24; |
| netmask_buf[0] = netmask & 0xff; |
| netmask_buf[1] = (netmask >> 8) & 0xff; |
| netmask_buf[2] = (netmask >> 16) & 0xff; |
| netmask_buf[3] = netmask >> 24; |
| (*proc)(addr_buf, netmask_buf, &lp->user); |
| } |
| return(NOTIFY_DONE); |
| } |
| |
| struct notifier_block uml_inetaddr_notifier = { |
| .notifier_call = uml_inetaddr_event, |
| }; |
| |
| static int uml_net_init(void) |
| { |
| struct list_head *ele; |
| struct uml_net_private *lp; |
| struct in_device *ip; |
| struct in_ifaddr *in; |
| |
| mconsole_register_dev(&net_mc); |
| register_inetaddr_notifier(¨_inetaddr_notifier); |
| |
| /* Devices may have been opened already, so the uml_inetaddr_notifier |
| * didn't get a chance to run for them. This fakes it so that |
| * addresses which have already been set up get handled properly. |
| */ |
| list_for_each(ele, &opened){ |
| lp = list_entry(ele, struct uml_net_private, list); |
| ip = lp->dev->ip_ptr; |
| if(ip == NULL) continue; |
| in = ip->ifa_list; |
| while(in != NULL){ |
| uml_inetaddr_event(NULL, NETDEV_UP, in); |
| in = in->ifa_next; |
| } |
| } |
| |
| return(0); |
| } |
| |
| __initcall(uml_net_init); |
| |
| static void close_devices(void) |
| { |
| struct list_head *ele; |
| struct uml_net_private *lp; |
| |
| list_for_each(ele, &opened){ |
| lp = list_entry(ele, struct uml_net_private, list); |
| if((lp->close != NULL) && (lp->fd >= 0)) |
| (*lp->close)(lp->fd, &lp->user); |
| if(lp->remove != NULL) (*lp->remove)(&lp->user); |
| } |
| } |
| |
| __uml_exitcall(close_devices); |
| |
| int setup_etheraddr(char *str, unsigned char *addr) |
| { |
| char *end; |
| int i; |
| |
| if(str == NULL) |
| return(0); |
| for(i=0;i<6;i++){ |
| addr[i] = simple_strtoul(str, &end, 16); |
| if((end == str) || |
| ((*end != ':') && (*end != ',') && (*end != '\0'))){ |
| printk(KERN_ERR |
| "setup_etheraddr: failed to parse '%s' " |
| "as an ethernet address\n", str); |
| return(0); |
| } |
| str = end + 1; |
| } |
| if(addr[0] & 1){ |
| printk(KERN_ERR |
| "Attempt to assign a broadcast ethernet address to a " |
| "device disallowed\n"); |
| return(0); |
| } |
| return(1); |
| } |
| |
| 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 "dev_ip_addr - 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; |
| } |
| } |
| |
| void set_ether_mac(void *d, unsigned char *addr) |
| { |
| struct net_device *dev = d; |
| |
| memcpy(dev->dev_addr, addr, ETH_ALEN); |
| } |
| |
| 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); |
| } |
| |
| void iter_addresses(void *d, void (*cb)(unsigned char *, unsigned char *, |
| void *), |
| void *arg) |
| { |
| struct net_device *dev = d; |
| struct in_device *ip = dev->ip_ptr; |
| struct in_ifaddr *in; |
| unsigned char address[4], netmask[4]; |
| |
| if(ip == NULL) return; |
| in = ip->ifa_list; |
| while(in != NULL){ |
| address[0] = in->ifa_address & 0xff; |
| address[1] = (in->ifa_address >> 8) & 0xff; |
| address[2] = (in->ifa_address >> 16) & 0xff; |
| address[3] = in->ifa_address >> 24; |
| netmask[0] = in->ifa_mask & 0xff; |
| netmask[1] = (in->ifa_mask >> 8) & 0xff; |
| netmask[2] = (in->ifa_mask >> 16) & 0xff; |
| netmask[3] = in->ifa_mask >> 24; |
| (*cb)(address, netmask, arg); |
| in = in->ifa_next; |
| } |
| } |
| |
| int dev_netmask(void *d, void *m) |
| { |
| struct net_device *dev = d; |
| struct in_device *ip = dev->ip_ptr; |
| struct in_ifaddr *in; |
| __u32 *mask_out = m; |
| |
| if(ip == NULL) |
| return(1); |
| |
| in = ip->ifa_list; |
| if(in == NULL) |
| return(1); |
| |
| *mask_out = in->ifa_mask; |
| return(0); |
| } |
| |
| void *get_output_buffer(int *len_out) |
| { |
| void *ret; |
| |
| ret = (void *) __get_free_pages(GFP_KERNEL, 0); |
| if(ret) *len_out = PAGE_SIZE; |
| else *len_out = 0; |
| return(ret); |
| } |
| |
| void free_output_buffer(void *buffer) |
| { |
| free_pages((unsigned long) buffer, 0); |
| } |
| |
| int tap_setup_common(char *str, char *type, char **dev_name, char **mac_out, |
| char **gate_addr) |
| { |
| char *remain; |
| |
| remain = split_if_spec(str, dev_name, mac_out, gate_addr, NULL); |
| if(remain != NULL){ |
| printk("tap_setup_common - Extra garbage on specification : " |
| "'%s'\n", remain); |
| return(1); |
| } |
| |
| return(0); |
| } |
| |
| unsigned short eth_protocol(struct sk_buff *skb) |
| { |
| return(eth_type_trans(skb, skb->dev)); |
| } |
| |
| /* |
| * Overrides for Emacs so that we follow Linus's tabbing style. |
| * Emacs will notice this stuff at the end of the file and automatically |
| * adjust the settings for this buffer only. This must remain at the end |
| * of the file. |
| * --------------------------------------------------------------------------- |
| * Local variables: |
| * c-file-style: "linux" |
| * End: |
| */ |