anydevice.cc

Click is a modular router toolkit. To use it you ll need to know how to compile and install the sof

// -*- mode: c++; c-basic-offset: 4 -*-
/*
 * anydevice.{cc,hh} -- support Linux device interaction
 * Eddie Kohler
 *
 * Copyright (c) 2001 International Computer Science Institute
 * Copyright (c) 2000 Massachusetts Institute of Technology
 * Copyright (c) 2000 Mazu Networks, Inc.
 * Copyright (c) 2004-2008 Regents of the University of California
 *
 * Permission is hereby granted, free of charge, to any person obtaining a
 * copy of this software and associated documentation files (the "Software"),
 * to deal in the Software without restriction, subject to the conditions
 * listed in the Click LICENSE file. These conditions include: you must
 * preserve this copyright notice, and you cannot mention the copyright
 * holders in advertising related to the Software without their permission.
 * The Software is provided WITHOUT ANY WARRANTY, EXPRESS OR IMPLIED. This
 * notice is a summary of the Click LICENSE file; the license in that file is
 * legally binding.
 */

#include <click/config.h>
#include <click/glue.hh>
#include "anydevice.hh"
#include <click/confparse.hh>
#include <click/error.hh>
#include <click/handlercall.hh>
#include <clicknet/ether.h>
#include <click/cxxprotect.h>
CLICK_CXX_PROTECT
#if LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 0)
# include <linux/if_arp.h>
#endif
#if LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 24)
# include <linux/rtnetlink.h>
# include <net/net_namespace.h>
#endif
#include <linux/smp_lock.h>
CLICK_CXX_UNPROTECT
#include <click/cxxunprotect.h>

AnyDevice::AnyDevice()
    : _dev(0), _promisc(false), _timestamp(true), _in_map(false),
      _quiet(false), _allow_nonexistent(false), _devname_exists(false),
      _carrier_ok(false), _next(0), _up_call(0), _down_call(0)
{
}

AnyDevice::~AnyDevice()
{
    if (_in_map || _dev)
	click_chatter("%s: bad device destructor!", name().c_str());
    delete _up_call;
    delete _down_call;
}

int
AnyDevice::configure_keywords(Vector<String> &conf, ErrorHandler *errh,
			      bool is_reader)
{
    bool allow_nonexistent = _allow_nonexistent;
    bool quiet = _quiet;
    bool promisc = _promisc;
    bool timestamp = _timestamp;

    if (cp_va_kparse_remove_keywords(conf, this, errh,
			"UP_CALL", 0, cpHandlerCallPtrWrite, &_up_call,
			"DOWN_CALL", 0, cpHandlerCallPtrWrite, &_down_call,
			"ALLOW_NONEXISTENT", 0, cpBool, &allow_nonexistent,
			"QUIET", 0, cpBool, &quiet,
			cpEnd) < 0)
	return -1;
    if (is_reader && cp_va_kparse_remove_keywords(conf, this, errh,
			"PROMISC", 0, cpBool, &promisc,
			"TIMESTAMP", 0, cpBool, &timestamp,
			cpEnd) < 0)
	return -1;

    _allow_nonexistent = allow_nonexistent;
    _quiet = quiet;
    _promisc = promisc;
    _timestamp = timestamp;
    return 0;
}

int
AnyDevice::initialize_keywords(ErrorHandler *errh)
{
    if ((_up_call && _up_call->initialize_write(this, errh) < 0)
	|| (_down_call && _down_call->initialize_write(this, errh) < 0))
	return -1;
    if (_up_call && _carrier_ok)
	_up_call->call_write(errh);
    else if (_down_call && !_carrier_ok)
	_down_call->call_write(errh);
    return 0;
}

void
AnyDevice::alter_promiscuity(int delta)
{
#if LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 24)
    rtnl_lock();
    dev_set_promiscuity(_dev, delta);
    rtnl_unlock();
#else
    dev_set_promiscuity(_dev, delta);
#endif
}

int
AnyDevice::find_device(AnyDeviceMap *adm, ErrorHandler *errh)
{
    _dev = get_by_name(_devname.c_str());
    _devname_exists = (bool) _dev;
    if (!_dev)
	_dev = get_by_ether_address(_devname, this);

    if (!_dev && !_allow_nonexistent)
	return errh->error("unknown device '%s'", _devname.c_str());
    else if (!_dev && !_quiet)
	errh->warning("unknown device '%s'", _devname.c_str());
    else if (_dev && !(_dev->flags & IFF_UP)) {
	if (!_quiet)
	    errh->warning("device '%s' is down", _devname.c_str());
	dev_put(_dev);
	_dev = 0;
    }

    if (_dev && _promisc)
	alter_promiscuity(1);
#if HAVE_NET_ENABLE_TIMESTAMP
    if (_dev && _timestamp)
	net_enable_timestamp();
#endif
    _carrier_ok = (_dev && netif_carrier_ok(_dev));
    if (adm)
	adm->insert(this, false);

    return 0;
}

void
AnyDevice::set_device(net_device *dev, AnyDeviceMap *adm, bool locked)
{
    if (_dev == dev) {		// no device change == carrier sense only
	bool carrier_ok = (_dev && netif_carrier_ok(_dev));
	if (carrier_ok != _carrier_ok) {
	    _carrier_ok = carrier_ok;
	    if (_down_call && !_carrier_ok)
		_down_call->call_write(ErrorHandler::default_handler());
	    if (_up_call && _carrier_ok)
		_up_call->call_write(ErrorHandler::default_handler());
	}
	return;
    }

    // call going-down notifiers
    if (_dev) {
	if (_down_call && _carrier_ok)
	    _down_call->call_write(ErrorHandler::default_handler());
	if (!_down_call && !_quiet)
	    click_chatter("%s: device '%s' went down", declaration().c_str(), _devname.c_str());
    }

    if (_dev && _promisc)
	alter_promiscuity(-1);
#if HAVE_NET_ENABLE_TIMESTAMP
    if (_dev && _timestamp)
	net_disable_timestamp();
#endif

    if (adm && _in_map)
	adm->remove(this, locked);
    if (_dev)
	dev_put(_dev);
    _dev = dev;
    if (_dev)
	dev_hold(_dev);
    if (adm)
	adm->insert(this, locked);

    if (_dev && _promisc)
	alter_promiscuity(1);
#if HAVE_NET_ENABLE_TIMESTAMP
    if (_dev && _timestamp)
	net_enable_timestamp();
#endif
    _carrier_ok = (_dev && netif_carrier_ok(_dev));

    // call going-up notifiers
    if (_dev) {
	if (_up_call && _carrier_ok)
	    _up_call->call_write(ErrorHandler::default_handler());
	if (!_up_call && !_quiet)
	    click_chatter("%s: device '%s' came up", declaration().c_str(), _devname.c_str());
    }
}

void
AnyDevice::clear_device(AnyDeviceMap *adm)
{
    if (_dev && _promisc)
	alter_promiscuity(-1);
#if HAVE_NET_ENABLE_TIMESTAMP
    if (_dev && _timestamp)
	net_disable_timestamp();
#endif
    if (adm && _in_map)
	adm->remove(this, false);
    if (_dev)
	dev_put(_dev);
    _dev = 0;
    _carrier_ok = false;
}


AnyTaskDevice::AnyTaskDevice()
    : _task(this), _idles(0)
{
}


void
AnyDeviceMap::initialize()
{
    _unknown_map = 0;
    for (int i = 0; i < MAP_SIZE; i++)
	_map[i] = 0;
    rwlock_init(&_lock);
}

void
AnyDeviceMap::insert(AnyDevice *d, bool locked)
{
    // lock when manipulating device map
    unsigned long lock_flags;
    if (!locked)
	lock(true, lock_flags);

    // put new devices last on list
    int ifi = d->ifindex();
    AnyDevice **pprev = (ifi >= 0 ? &_map[ifi % MAP_SIZE] : &_unknown_map);
    AnyDevice *trav = *pprev;
    while (trav) {
	pprev = &trav->_next;
	trav = *pprev;
    }
    d->_next = 0;
    *pprev = d;

    d->_in_map = true;
    if (!locked)
	unlock(true, lock_flags);
}

void
AnyDeviceMap::remove(AnyDevice *d, bool locked)
{
    unsigned long lock_flags;
    if (!locked)
	lock(true, lock_flags);
    int ifi = d->ifindex();
    AnyDevice **pprev = (ifi >= 0 ? &_map[ifi % MAP_SIZE] : &_unknown_map);
    AnyDevice *trav = *pprev;
    while (trav && trav != d) {
	pprev = &trav->_next;
	trav = *pprev;
    }
    if (trav)
	*pprev = d->_next;
    d->_in_map = false;
    if (!locked)
	unlock(true, lock_flags);
}

AnyDevice *
AnyDeviceMap::lookup_unknown(net_device *dev, AnyDevice *last) const
    // must be called between AnyDeviceMap::lock() ... unlock()
{
    // make sure device is valid
    if (!dev)
	return 0;

    // look by device name and Ethernet address
    int dev_name_len = strlen(dev->name);
    unsigned char en[6];

    for (AnyDevice *d = (last ? last->_next : _unknown_map); d; d = d->_next)
	if (d->devname().equals(dev->name, dev_name_len)) {
	    d->_devname_exists = true;
	    return d;
	} else if ((dev->type == ARPHRD_ETHER || dev->type == ARPHRD_80211)
		   && !d->_devname_exists
		   && cp_ethernet_address(d->devname(), en, d)
		   && memcmp(en, dev->dev_addr, 6) == 0)
	    return d;

    return 0;
}

int
AnyDeviceMap::lookup_all(net_device *dev, bool known, AnyDevice **dev_store,
			 int ndev) const
    // must be called between AnyDeviceMap::lock() ... unlock()
{
    int i = 0;
    if (known)
	for (AnyDevice *d = 0; i < ndev && (d = lookup(dev, d)); ++i)
	    dev_store[i] = d;
    else
	for (AnyDevice *d = 0; i < ndev && (d = lookup_unknown(dev, d)); ++i)
	    dev_store[i] = d;
    return i;
}


net_device *
AnyDevice::get_by_ether_address(const String &name, Element *context)
{
    unsigned char en[6];
    if (!cp_ethernet_address(name, en, context))
	return 0;
    read_lock(&dev_base_lock);
    net_device *dev;
#if LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 24)
    for_each_netdev(&init_net, dev)
#else
    for (dev = dev_base; dev; dev = dev->next)
#endif
	if ((dev->type == ARPHRD_ETHER || dev->type == ARPHRD_80211)
	    && memcmp(en, dev->dev_addr, 6) == 0) {
	    dev_hold(dev);	// dev_get_by_name does dev_hold; so
				// should we
	    break;
	}
    read_unlock(&dev_base_lock);
    return dev;
}

ELEMENT_REQUIRES(linuxmodule)
ELEMENT_PROVIDES(AnyDevice)