N-sim Emulation and simulation of Wireless Sensor Networks    Home    Project Page    Download    CVS    Installation    Configuration    Plug-ins  Hosted by

/home/brennan/n-sim/OrbisQuartus/server/xen/backend/sdev_if.c Go to the documentation of this file. /* * Copyright (c) 2004-2005, Keir Fraser * * Copyright 2006. Los Alamos National Security, LLC. This material * was produced under U.S. Government contract DE-AC52-06NA25396 for * Los Alamos National Laboratory (LANL), which is operated by Los * Alamos National Security, LLC, for the Department of Energy. The * U.S. Government has rights to use, reproduce, and distribute this * software. NEITHER THE GOVERNMENT NOR LOS ALAMOS NATIONAL SECURITY, * LLC, MAKES ANY WARRANTY, EXPRESS OR IMPLIED, OR ASSUMES ANY LEGAL * LIABILITY FOR THE USE OF THIS SOFTWARE. If software is modified to * produce derivative works, such modified software should be clearly * marked, so as not to confuse it with the version available from LANL. * Additionally, 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. Accordingly, this * program is distributed in the hope it will be useful, but WITHOUT ANY * WARRANTY; without even the implied warranty of MERCHANTABILITY or * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License * for more details. ****************************** * * This program is free software; you can redistribute it and/or * modify it under the terms of the GNU General Public License version 2 * as published by the Free Software Foundation; or, when distributed * separately from the Linux kernel or incorporated into other * software packages, subject to the following license: * * Permission is hereby granted, free of charge, to any person obtaining a copy * of this source file (the "Software"), to deal in the Software without * restriction, including without limitation the rights to use, copy, modify, * merge, publish, distribute, sublicense, and/or sell copies of the Software, * and to permit persons to whom the Software is furnished to do so, subject to * the following conditions: * * The above copyright notice and this permission notice shall be included in * all copies or substantial portions of the Software. * * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS * IN THE SOFTWARE. * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA */ #include "sdev.h" static void __sdev_up(sdev_t *sdev) { struct net_device *dev = sdev->dev; spin_lock_bh(&dev->xmit_lock); sdev->active = 1; spin_unlock_bh(&dev->xmit_lock); enable_irq(sdev->irq); sdev_schedule_work(sdev); } static void __sdev_down(sdev_t *sdev) { struct net_device *dev = sdev->dev; disable_irq(sdev->irq); spin_lock_bh(&dev->xmit_lock); sdev->active = 0; spin_unlock_bh(&dev->xmit_lock); sdev_deschedule_work(sdev); } static int net_open(struct net_device *dev) { sdev_t *sdev = netdev_priv(dev); if (sdev->status == CONNECTED) __sdev_up(sdev); netif_start_queue(dev); return 0; } static int net_close(struct net_device *dev) { sdev_t *sdev = netdev_priv(dev); netif_stop_queue(dev); if (sdev->status == CONNECTED) __sdev_down(sdev); return 0; } sdev_t *alloc_sdev(domid_t domid, unsigned int handle, u8 be_mac[ETH_ALEN]) { int err = 0, i; struct net_device *dev; sdev_t *sdev; char name[IFNAMSIZ] = {}; snprintf(name, IFNAMSIZ - 1, "vwif%u.%u", domid, handle); dev = alloc_netdev(sizeof(sdev_t), name, ether_setup); if (dev == NULL) { DPRINTK("Could not create sdev: out of memory\n"); return ERR_PTR(-ENOMEM); } sdev = netdev_priv(dev); memset(sdev, 0, sizeof(*sdev)); sdev->domid = domid; sdev->handle = handle; sdev->status = DISCONNECTED; atomic_set(&sdev->refcnt, 0); sdev->dev = dev; sdev->credit_bytes = sdev->remaining_credit = ~0UL; sdev->credit_usec = 0UL; init_timer(&sdev->credit_timeout); dev->hard_start_xmit = sdev_be_start_xmit; dev->get_stats = sdev_be_get_stats; dev->open = net_open; dev->stop = net_close; dev->features = NETIF_F_NO_CSUM; /* Disable queuing. */ dev->tx_queue_len = 0; for (i = 0; i < ETH_ALEN; i++) if (be_mac[i] != 0) break; if (i == ETH_ALEN) { /* * Initialise a dummy MAC address. We choose the numerically * largest non-broadcast address to prevent the address getting * stolen by an Ethernet bridge for STP purposes. * (FE:FF:FF:FF:FF:FF) */ memset(dev->dev_addr, 0xFF, ETH_ALEN); dev->dev_addr[0] &= ~0x01; } else memcpy(dev->dev_addr, be_mac, ETH_ALEN); rtnl_lock(); err = register_netdevice(dev); rtnl_unlock(); if (err) { DPRINTK("Could not register new net device %s: err=%d\n", dev->name, err); free_netdev(dev); return ERR_PTR(err); } DPRINTK("Successfully created sdev\n"); return sdev; } static int map_frontend_pages( sdev_t *sdev, grant_ref_t tx_ring_ref, grant_ref_t rx_ring_ref) { struct gnttab_map_grant_ref op; int ret; op.host_addr = (unsigned long)sdev->tx_comms_area->addr; op.flags = GNTMAP_host_map; op.ref = tx_ring_ref; op.dom = sdev->domid; lock_vm_area(sdev->tx_comms_area); ret = HYPERVISOR_grant_table_op(GNTTABOP_map_grant_ref, &op, 1); unlock_vm_area(sdev->tx_comms_area); BUG_ON(ret); if (op.status) { DPRINTK(" Gnttab failure mapping tx_ring_ref!\n"); return op.status; } sdev->tx_shmem_ref = tx_ring_ref; sdev->tx_shmem_handle = op.handle; op.host_addr = (unsigned long)sdev->rx_comms_area->addr; op.flags = GNTMAP_host_map; op.ref = rx_ring_ref; op.dom = sdev->domid; lock_vm_area(sdev->rx_comms_area); ret = HYPERVISOR_grant_table_op(GNTTABOP_map_grant_ref, &op, 1); unlock_vm_area(sdev->rx_comms_area); BUG_ON(ret); if (op.status) { DPRINTK(" Gnttab failure mapping rx_ring_ref!\n"); return op.status; } sdev->rx_shmem_ref = rx_ring_ref; sdev->rx_shmem_handle = op.handle; return 0; } static void unmap_frontend_pages(sdev_t *sdev) { struct gnttab_unmap_grant_ref op; int ret; op.host_addr = (unsigned long)sdev->tx_comms_area->addr; op.handle = sdev->tx_shmem_handle; op.dev_bus_addr = 0; lock_vm_area(sdev->tx_comms_area); ret = HYPERVISOR_grant_table_op(GNTTABOP_unmap_grant_ref, &op, 1); unlock_vm_area(sdev->tx_comms_area); BUG_ON(ret); op.host_addr = (unsigned long)sdev->rx_comms_area->addr; op.handle = sdev->rx_shmem_handle; op.dev_bus_addr = 0; lock_vm_area(sdev->rx_comms_area); ret = HYPERVISOR_grant_table_op(GNTTABOP_unmap_grant_ref, &op, 1); unlock_vm_area(sdev->rx_comms_area); BUG_ON(ret); } int sdev_map(sdev_t *sdev, unsigned long tx_ring_ref, unsigned long rx_ring_ref, unsigned int evtchn) { int err = -ENOMEM; netif_tx_sring_t *txs; netif_rx_sring_t *rxs; evtchn_op_t op = { .cmd = EVTCHNOP_bind_interdomain, .u.bind_interdomain.remote_dom = sdev->domid, .u.bind_interdomain.remote_port = evtchn }; /* Already connected through? */ if (sdev->irq) return 0; sdev->tx_comms_area = alloc_vm_area(PAGE_SIZE); if (sdev->tx_comms_area == NULL) return -ENOMEM; sdev->rx_comms_area = alloc_vm_area(PAGE_SIZE); if (sdev->rx_comms_area == NULL) goto err_rx; err = map_frontend_pages(sdev, tx_ring_ref, rx_ring_ref); if (err) goto err_map; err = HYPERVISOR_event_channel_op(&op); if (err) goto err_hypervisor; sdev->evtchn = op.u.bind_interdomain.local_port; sdev->irq = bind_evtchn_to_irqhandler( sdev->evtchn, sdev_be_int, 0, sdev->dev->name, sdev); disable_irq(sdev->irq); txs = (netif_tx_sring_t *)sdev->tx_comms_area->addr; BACK_RING_INIT(&sdev->tx, txs, PAGE_SIZE); rxs = (netif_rx_sring_t *) ((char *)sdev->rx_comms_area->addr); BACK_RING_INIT(&sdev->rx, rxs, PAGE_SIZE); sdev->rx_req_cons_peek = 0; sdev_get(sdev); wmb(); /* Other CPUs see new state before interface is started. */ rtnl_lock(); sdev->status = CONNECTED; wmb(); if (netif_running(sdev->dev)) __sdev_up(sdev); rtnl_unlock(); return 0; err_hypervisor: unmap_frontend_pages(sdev); err_map: free_vm_area(sdev->rx_comms_area); err_rx: free_vm_area(sdev->tx_comms_area); return err; } static void free_sdev_callback(void *arg) { sdev_t *sdev = (sdev_t *)arg; if (sdev->irq) unbind_from_irqhandler(sdev->irq, sdev); unregister_netdev(sdev->dev); if (sdev->tx.sring) { unmap_frontend_pages(sdev); free_vm_area(sdev->tx_comms_area); free_vm_area(sdev->rx_comms_area); } free_netdev(sdev->dev); } void free_sdev(sdev_t *sdev) { INIT_WORK(&sdev->free_work, free_sdev_callback, (void *)sdev); schedule_work(&sdev->free_work); } void sdev_creditlimit(sdev_t *sdev) { #if 0 /* Set the credit limit (reset remaining credit to new limit). */ sdev->credit_bytes = creditlimit->credit_bytes; sdev->remaining_credit = creditlimit->credit_bytes; sdev->credit_usec = creditlimit->period_usec; if (sdev->status == CONNECTED) { /* * Schedule work so that any packets waiting under previous * credit limit are dealt with (acts as a replenishment point). */ sdev->credit_timeout.expires = jiffies; sdev_schedule_work(sdev); } #endif } void sdev_disconnect(sdev_t *sdev) { switch (sdev->status) { case CONNECTED: rtnl_lock(); sdev->status = DISCONNECTING; wmb(); if (netif_running(sdev->dev)) __sdev_down(sdev); rtnl_unlock(); sdev_put(sdev); break; case DISCONNECTED: BUG_ON(atomic_read(&sdev->refcnt) != 0); free_sdev(sdev); break; default: BUG(); } }

© 2007, Los Alamos National Security, LLC.