linux-imx

/*

 * Linux network device link state notification

 *

 * Author:

 *     Stefan Rompf <sux@loplof.de>

 *

 * 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/module.h>

#include <linux/netdevice.h>

#include <linux/if.h>

#include <net/sock.h>

#include <net/pkt_sched.h>

#include <linux/rtnetlink.h>

#include <linux/jiffies.h>

#include <linux/spinlock.h>

#include <linux/workqueue.h>

#include <linux/bitops.h>

#include <linux/types.h>

​

​

enum lw_bits {

    LW_URGENT = 0,

};

​

static unsigned long linkwatch_flags;

static unsigned long linkwatch_nextevent;

​

static void linkwatch_event(struct work_struct *dummy);

static DECLARE_DELAYED_WORK(linkwatch_work, linkwatch_event);

​

static LIST_HEAD(lweventlist);

static DEFINE_SPINLOCK(lweventlist_lock);

​

static unsigned char default_operstate(const struct net_device *dev)

{

    if (!netif_carrier_ok(dev))

        return (dev->ifindex != dev_get_iflink(dev) ?

            IF_OPER_LOWERLAYERDOWN : IF_OPER_DOWN);

​

    if (netif_dormant(dev))

        return IF_OPER_DORMANT;

​

    return IF_OPER_UP;

}

​

​

static void rfc2863_policy(struct net_device *dev)

{

    unsigned char operstate = default_operstate(dev);

​

    if (operstate == dev->operstate)

        return;

​

    write_lock_bh(&dev_base_lock);

​

    switch(dev->link_mode) {

    case IF_LINK_MODE_DORMANT:

        if (operstate == IF_OPER_UP)

            operstate = IF_OPER_DORMANT;

        break;

​

    case IF_LINK_MODE_DEFAULT:

    default:

        break;

    }

​

    dev->operstate = operstate;

​

    write_unlock_bh(&dev_base_lock);

}

​

​

void linkwatch_init_dev(struct net_device *dev)

{

    /* Handle pre-registration link state changes */

    if (!netif_carrier_ok(dev) || netif_dormant(dev))

        rfc2863_policy(dev);

}

​

​

static bool linkwatch_urgent_event(struct net_device *dev)

{

    if (!netif_running(dev))

        return false;

​

    if (dev->ifindex != dev_get_iflink(dev))