11da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* net/sched/sch_teql.c "True" (or "trivial") link equalizer. 21da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 31da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * This program is free software; you can redistribute it and/or 41da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * modify it under the terms of the GNU General Public License 51da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * as published by the Free Software Foundation; either version 61da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 2 of the License, or (at your option) any later version. 71da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 81da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Authors: Alexey Kuznetsov, <kuznet@ms2.inr.ac.ru> 91da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/module.h> 121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/types.h> 131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/kernel.h> 145a0e3ad6af8660be21ca98a971cd00f331318c05Tejun Heo#include <linux/slab.h> 151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/string.h> 161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/errno.h> 1714c850212ed8f8cbb5972ad6b8812e08a0bc901cArnaldo Carvalho de Melo#include <linux/if_arp.h> 181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/netdevice.h> 191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/init.h> 201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/skbuff.h> 211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/moduleparam.h> 220ba48053831d5b89ee2afaefaae1c06eae80cb05Patrick McHardy#include <net/dst.h> 230ba48053831d5b89ee2afaefaae1c06eae80cb05Patrick McHardy#include <net/neighbour.h> 241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <net/pkt_sched.h> 251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds How to setup it. 281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ---------------- 291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds After loading this module you will find a new device teqlN 311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds and new qdisc with the same name. To join a slave to the equalizer 321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds you should just set this qdisc on a device f.e. 331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds # tc qdisc add dev eth0 root teql0 351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds # tc qdisc add dev eth1 root teql0 361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds That's all. Full PnP 8) 381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds Applicability. 401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds -------------- 411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1. Slave devices MUST be active devices, i.e., they must raise the tbusy 431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds signal and generate EOI events. If you want to equalize virtual devices 441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds like tunnels, use a normal eql device. 451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2. This device puts no limitations on physical slave characteristics 461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds f.e. it will equalize 9600baud line and 100Mb ethernet perfectly :-) 471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds Certainly, large difference in link speeds will make the resulting 481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds eqalized link unusable, because of huge packet reordering. 491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds I estimate an upper useful difference as ~10 times. 501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3. If the slave requires address resolution, only protocols using 511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds neighbour cache (IPv4/IPv6) will work over the equalized link. 521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds Other protocols are still allowed to use the slave device directly, 531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds which will not break load balancing, though native slave 541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds traffic will have the highest priority. */ 551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 56cc7ec456f82da7f89a5b376e613b3ac4311b3e9aEric Dumazetstruct teql_master { 571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct Qdisc_ops qops; 581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct net_device *dev; 591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct Qdisc *slaves; 601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct list_head master_list; 611ac9ad1394fa542ac7ae0dc943ee3cda678799faEric Dumazet unsigned long tx_bytes; 621ac9ad1394fa542ac7ae0dc943ee3cda678799faEric Dumazet unsigned long tx_packets; 631ac9ad1394fa542ac7ae0dc943ee3cda678799faEric Dumazet unsigned long tx_errors; 641ac9ad1394fa542ac7ae0dc943ee3cda678799faEric Dumazet unsigned long tx_dropped; 651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 67cc7ec456f82da7f89a5b376e613b3ac4311b3e9aEric Dumazetstruct teql_sched_data { 681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct Qdisc *next; 691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct teql_master *m; 701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct sk_buff_head q; 711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 73cc7ec456f82da7f89a5b376e613b3ac4311b3e9aEric Dumazet#define NEXT_SLAVE(q) (((struct teql_sched_data *)qdisc_priv(q))->next) 741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 75cc7ec456f82da7f89a5b376e613b3ac4311b3e9aEric Dumazet#define FMASK (IFF_BROADCAST | IFF_POINTOPOINT) 761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* "teql*" qdisc routines */ 781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int 80cc7ec456f82da7f89a5b376e613b3ac4311b3e9aEric Dumazetteql_enqueue(struct sk_buff *skb, struct Qdisc *sch) 811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 825ce2d488fe039ddd86a638496cf704df86c74eebDavid S. Miller struct net_device *dev = qdisc_dev(sch); 831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct teql_sched_data *q = qdisc_priv(sch); 841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 854cd8c9e87be7ea891050ff1bebbf767a837eb5cfKrishna Kumar if (q->q.qlen < dev->tx_queue_len) { 864cd8c9e87be7ea891050ff1bebbf767a837eb5cfKrishna Kumar __skb_queue_tail(&q->q, skb); 879871e50edd25e2adf69b369817100821cb1e6de8Ben Greear return NET_XMIT_SUCCESS; 881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9017045755193a93fbd2d97db9aad5e726fc8c2a6dEric Dumazet return qdisc_drop(skb, sch); 911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct sk_buff * 94cc7ec456f82da7f89a5b376e613b3ac4311b3e9aEric Dumazetteql_dequeue(struct Qdisc *sch) 951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct teql_sched_data *dat = qdisc_priv(sch); 97b0e1e6462df3c5944010b3328a546d8fe5d932cdDavid S. Miller struct netdev_queue *dat_queue; 981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct sk_buff *skb; 9946e5da40aec256155cfedee96dd21a75da941f2cJohn Fastabend struct Qdisc *q; 1001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds skb = __skb_dequeue(&dat->q); 102e8a0464cc950972824e2e128028ae3db666ec1edDavid S. Miller dat_queue = netdev_get_tx_queue(dat->m->dev, 0); 10346e5da40aec256155cfedee96dd21a75da941f2cJohn Fastabend q = rcu_dereference_bh(dat_queue->qdisc); 10446e5da40aec256155cfedee96dd21a75da941f2cJohn Fastabend 1051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (skb == NULL) { 10646e5da40aec256155cfedee96dd21a75da941f2cJohn Fastabend struct net_device *m = qdisc_dev(q); 1071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (m) { 1081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dat->m->slaves = sch; 1091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds netif_wake_queue(m); 1101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1119190b3b3208d052d98cb601fcc192f3f71a5658bEric Dumazet } else { 1129190b3b3208d052d98cb601fcc192f3f71a5658bEric Dumazet qdisc_bstats_update(sch, skb); 1131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 11446e5da40aec256155cfedee96dd21a75da941f2cJohn Fastabend sch->q.qlen = dat->q.qlen + q->q.qlen; 1151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return skb; 1161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1188e3af97899db433111287e07d5105189f56fe191Jarek Poplawskistatic struct sk_buff * 119cc7ec456f82da7f89a5b376e613b3ac4311b3e9aEric Dumazetteql_peek(struct Qdisc *sch) 1208e3af97899db433111287e07d5105189f56fe191Jarek Poplawski{ 1218e3af97899db433111287e07d5105189f56fe191Jarek Poplawski /* teql is meant to be used as root qdisc */ 1228e3af97899db433111287e07d5105189f56fe191Jarek Poplawski return NULL; 1238e3af97899db433111287e07d5105189f56fe191Jarek Poplawski} 1248e3af97899db433111287e07d5105189f56fe191Jarek Poplawski 125cc7ec456f82da7f89a5b376e613b3ac4311b3e9aEric Dumazetstatic inline void 1261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsteql_neigh_release(struct neighbour *n) 1271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (n) 1291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds neigh_release(n); 1301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void 133cc7ec456f82da7f89a5b376e613b3ac4311b3e9aEric Dumazetteql_reset(struct Qdisc *sch) 1341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct teql_sched_data *dat = qdisc_priv(sch); 1361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds skb_queue_purge(&dat->q); 1381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sch->q.qlen = 0; 1391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void 142cc7ec456f82da7f89a5b376e613b3ac4311b3e9aEric Dumazetteql_destroy(struct Qdisc *sch) 1431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct Qdisc *q, *prev; 1451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct teql_sched_data *dat = qdisc_priv(sch); 1461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct teql_master *master = dat->m; 1471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 148cc7ec456f82da7f89a5b376e613b3ac4311b3e9aEric Dumazet prev = master->slaves; 149cc7ec456f82da7f89a5b376e613b3ac4311b3e9aEric Dumazet if (prev) { 1501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds do { 1511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds q = NEXT_SLAVE(prev); 1521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (q == sch) { 1531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds NEXT_SLAVE(prev) = NEXT_SLAVE(q); 1541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (q == master->slaves) { 1551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds master->slaves = NEXT_SLAVE(q); 1561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (q == master->slaves) { 157e8a0464cc950972824e2e128028ae3db666ec1edDavid S. Miller struct netdev_queue *txq; 15883874000929ed63aef30b44083a9f713135ff040David S. Miller spinlock_t *root_lock; 159e8a0464cc950972824e2e128028ae3db666ec1edDavid S. Miller 160e8a0464cc950972824e2e128028ae3db666ec1edDavid S. Miller txq = netdev_get_tx_queue(master->dev, 0); 1611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds master->slaves = NULL; 16283874000929ed63aef30b44083a9f713135ff040David S. Miller 16346e5da40aec256155cfedee96dd21a75da941f2cJohn Fastabend root_lock = qdisc_root_sleeping_lock(rtnl_dereference(txq->qdisc)); 16483874000929ed63aef30b44083a9f713135ff040David S. Miller spin_lock_bh(root_lock); 16546e5da40aec256155cfedee96dd21a75da941f2cJohn Fastabend qdisc_reset(rtnl_dereference(txq->qdisc)); 16683874000929ed63aef30b44083a9f713135ff040David S. Miller spin_unlock_bh(root_lock); 1671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds skb_queue_purge(&dat->q); 1701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 1711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 17210297b99315e5e08fe623ba56da35db1fee69ba9YOSHIFUJI Hideaki 1731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } while ((prev = q) != master->slaves); 1741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1771e90474c377e92db7262a8968a45c1dd980ca9e5Patrick McHardystatic int teql_qdisc_init(struct Qdisc *sch, struct nlattr *opt) 1781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1795ce2d488fe039ddd86a638496cf704df86c74eebDavid S. Miller struct net_device *dev = qdisc_dev(sch); 180cc7ec456f82da7f89a5b376e613b3ac4311b3e9aEric Dumazet struct teql_master *m = (struct teql_master *)sch->ops; 1811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct teql_sched_data *q = qdisc_priv(sch); 1821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (dev->hard_header_len > m->dev->hard_header_len) 1841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 1851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (m->dev == dev) 1871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ELOOP; 1881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds q->m = m; 1901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds skb_queue_head_init(&q->q); 1921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (m->slaves) { 1941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (m->dev->flags & IFF_UP) { 195f64f9e719261a87818dd192a3a2352e5b20fbd0fJoe Perches if ((m->dev->flags & IFF_POINTOPOINT && 196f64f9e719261a87818dd192a3a2352e5b20fbd0fJoe Perches !(dev->flags & IFF_POINTOPOINT)) || 197f64f9e719261a87818dd192a3a2352e5b20fbd0fJoe Perches (m->dev->flags & IFF_BROADCAST && 198f64f9e719261a87818dd192a3a2352e5b20fbd0fJoe Perches !(dev->flags & IFF_BROADCAST)) || 199f64f9e719261a87818dd192a3a2352e5b20fbd0fJoe Perches (m->dev->flags & IFF_MULTICAST && 200f64f9e719261a87818dd192a3a2352e5b20fbd0fJoe Perches !(dev->flags & IFF_MULTICAST)) || 201f64f9e719261a87818dd192a3a2352e5b20fbd0fJoe Perches dev->mtu < m->dev->mtu) 2021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 2031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 2041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!(dev->flags&IFF_POINTOPOINT)) 2051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds m->dev->flags &= ~IFF_POINTOPOINT; 2061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!(dev->flags&IFF_BROADCAST)) 2071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds m->dev->flags &= ~IFF_BROADCAST; 2081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!(dev->flags&IFF_MULTICAST)) 2091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds m->dev->flags &= ~IFF_MULTICAST; 2101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (dev->mtu < m->dev->mtu) 2111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds m->dev->mtu = dev->mtu; 2121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 2131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds q->next = NEXT_SLAVE(m->slaves); 2141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds NEXT_SLAVE(m->slaves) = sch; 2151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 2161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds q->next = sch; 2171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds m->slaves = sch; 2181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds m->dev->mtu = dev->mtu; 2191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds m->dev->flags = (m->dev->flags&~FMASK)|(dev->flags&FMASK); 2201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 2211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 2221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int 226f7e57044eeb1841847c24aa06766c8290c202583Eric Dumazet__teql_resolve(struct sk_buff *skb, struct sk_buff *skb_res, 227f7e57044eeb1841847c24aa06766c8290c202583Eric Dumazet struct net_device *dev, struct netdev_queue *txq, 228dbedbe6d56e8944f220e34deb9ebdf4bec2a2afdDavid S. Miller struct dst_entry *dst) 2291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 230dbedbe6d56e8944f220e34deb9ebdf4bec2a2afdDavid S. Miller struct neighbour *n; 231dbedbe6d56e8944f220e34deb9ebdf4bec2a2afdDavid S. Miller int err = 0; 2321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 233dbedbe6d56e8944f220e34deb9ebdf4bec2a2afdDavid S. Miller n = dst_neigh_lookup_skb(dst, skb); 234dbedbe6d56e8944f220e34deb9ebdf4bec2a2afdDavid S. Miller if (!n) 235dbedbe6d56e8944f220e34deb9ebdf4bec2a2afdDavid S. Miller return -ENOENT; 236dbedbe6d56e8944f220e34deb9ebdf4bec2a2afdDavid S. Miller 237dbedbe6d56e8944f220e34deb9ebdf4bec2a2afdDavid S. Miller if (dst->dev != dev) { 238dbedbe6d56e8944f220e34deb9ebdf4bec2a2afdDavid S. Miller struct neighbour *mn; 239dbedbe6d56e8944f220e34deb9ebdf4bec2a2afdDavid S. Miller 240dbedbe6d56e8944f220e34deb9ebdf4bec2a2afdDavid S. Miller mn = __neigh_lookup_errno(n->tbl, n->primary_key, dev); 241dbedbe6d56e8944f220e34deb9ebdf4bec2a2afdDavid S. Miller neigh_release(n); 242dbedbe6d56e8944f220e34deb9ebdf4bec2a2afdDavid S. Miller if (IS_ERR(mn)) 243dbedbe6d56e8944f220e34deb9ebdf4bec2a2afdDavid S. Miller return PTR_ERR(mn); 244dbedbe6d56e8944f220e34deb9ebdf4bec2a2afdDavid S. Miller n = mn; 2451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 246dbedbe6d56e8944f220e34deb9ebdf4bec2a2afdDavid S. Miller 2471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (neigh_event_send(n, skb_res) == 0) { 2481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int err; 2490ed8ddf4045fcfcac36bad753dc4046118c603ecEric Dumazet char haddr[MAX_ADDR_LEN]; 2500c4e85813d0a94eeb8bf813397a4907bdd7bb610Stephen Hemminger 2510ed8ddf4045fcfcac36bad753dc4046118c603ecEric Dumazet neigh_ha_snapshot(haddr, n, dev); 2520ed8ddf4045fcfcac36bad753dc4046118c603ecEric Dumazet err = dev_hard_header(skb, dev, ntohs(skb->protocol), haddr, 2530ed8ddf4045fcfcac36bad753dc4046118c603ecEric Dumazet NULL, skb->len); 2540c4e85813d0a94eeb8bf813397a4907bdd7bb610Stephen Hemminger 255dbedbe6d56e8944f220e34deb9ebdf4bec2a2afdDavid S. Miller if (err < 0) 256dbedbe6d56e8944f220e34deb9ebdf4bec2a2afdDavid S. Miller err = -EINVAL; 257dbedbe6d56e8944f220e34deb9ebdf4bec2a2afdDavid S. Miller } else { 258dbedbe6d56e8944f220e34deb9ebdf4bec2a2afdDavid S. Miller err = (skb_res == NULL) ? -EAGAIN : 1; 2591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 2601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds neigh_release(n); 261dbedbe6d56e8944f220e34deb9ebdf4bec2a2afdDavid S. Miller return err; 2621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2643b04ddde02cf1b6f14f2697da5c20eca5715017fStephen Hemmingerstatic inline int teql_resolve(struct sk_buff *skb, 265f7e57044eeb1841847c24aa06766c8290c202583Eric Dumazet struct sk_buff *skb_res, 266f7e57044eeb1841847c24aa06766c8290c202583Eric Dumazet struct net_device *dev, 267f7e57044eeb1841847c24aa06766c8290c202583Eric Dumazet struct netdev_queue *txq) 2681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 269f7e57044eeb1841847c24aa06766c8290c202583Eric Dumazet struct dst_entry *dst = skb_dst(skb); 270f7e57044eeb1841847c24aa06766c8290c202583Eric Dumazet int res; 271f7e57044eeb1841847c24aa06766c8290c202583Eric Dumazet 27246e5da40aec256155cfedee96dd21a75da941f2cJohn Fastabend if (rcu_access_pointer(txq->qdisc) == &noop_qdisc) 2734f9f8311a08c0d95c70261264a2b47f2ae99683aEvgeniy Polyakov return -ENODEV; 2744f9f8311a08c0d95c70261264a2b47f2ae99683aEvgeniy Polyakov 275f7e57044eeb1841847c24aa06766c8290c202583Eric Dumazet if (!dev->header_ops || !dst) 2761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 277f7e57044eeb1841847c24aa06766c8290c202583Eric Dumazet 278f7e57044eeb1841847c24aa06766c8290c202583Eric Dumazet rcu_read_lock(); 279dbedbe6d56e8944f220e34deb9ebdf4bec2a2afdDavid S. Miller res = __teql_resolve(skb, skb_res, dev, txq, dst); 280f7e57044eeb1841847c24aa06766c8290c202583Eric Dumazet rcu_read_unlock(); 281f7e57044eeb1841847c24aa06766c8290c202583Eric Dumazet 282f7e57044eeb1841847c24aa06766c8290c202583Eric Dumazet return res; 2831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2856fef4c0c8eeff7de13007a5f56113475444a253dStephen Hemmingerstatic netdev_tx_t teql_master_xmit(struct sk_buff *skb, struct net_device *dev) 2861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2872941a4863154982918d39a639632c76eeacfa884Patrick McHardy struct teql_master *master = netdev_priv(dev); 2881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct Qdisc *start, *q; 2891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int busy; 2901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int nores; 2914e3ab47a547616e583c7a5458beced6aa34c8ef3Pavel Emelyanov int subq = skb_get_queue_mapping(skb); 2921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct sk_buff *skb_res = NULL; 2931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds start = master->slaves; 2951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsrestart: 2971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds nores = 0; 2981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds busy = 0; 2991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 300cc7ec456f82da7f89a5b376e613b3ac4311b3e9aEric Dumazet q = start; 301cc7ec456f82da7f89a5b376e613b3ac4311b3e9aEric Dumazet if (!q) 3021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto drop; 3031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds do { 3055ce2d488fe039ddd86a638496cf704df86c74eebDavid S. Miller struct net_device *slave = qdisc_dev(q); 30661294e2e2730f24b833d9a713add5f4f6672c2a4Stephen Hemminger struct netdev_queue *slave_txq = netdev_get_tx_queue(slave, 0); 30710297b99315e5e08fe623ba56da35db1fee69ba9YOSHIFUJI Hideaki 308e8a0464cc950972824e2e128028ae3db666ec1edDavid S. Miller if (slave_txq->qdisc_sleeping != q) 3091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds continue; 3107346649826382b769cfadf4a2fe8a84d060c55e9Tom Herbert if (netif_xmit_stopped(netdev_get_tx_queue(slave, subq)) || 311f25f4e44808f0f6c9875d94ef1c41ef86c288eb2Peter P Waskiewicz Jr !netif_running(slave)) { 3121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds busy = 1; 3131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds continue; 3141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 316f7e57044eeb1841847c24aa06766c8290c202583Eric Dumazet switch (teql_resolve(skb, skb_res, slave, slave_txq)) { 3171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 0: 318c3f26a269c2421f97f10cf8ed05d5099b573af4dDavid S. Miller if (__netif_tx_trylock(slave_txq)) { 319c0f84d0d4be3f7d818b4ffb04d27f9bae64397f0Eric Dumazet unsigned int length = qdisc_pkt_len(skb); 320c0f84d0d4be3f7d818b4ffb04d27f9bae64397f0Eric Dumazet 3217346649826382b769cfadf4a2fe8a84d060c55e9Tom Herbert if (!netif_xmit_frozen_or_stopped(slave_txq) && 322fa2dbdc253c2aee2a760c64de454cb62469ec11dDavid S. Miller netdev_start_xmit(skb, slave, slave_txq, false) == 323fa2dbdc253c2aee2a760c64de454cb62469ec11dDavid S. Miller NETDEV_TX_OK) { 324c3f26a269c2421f97f10cf8ed05d5099b573af4dDavid S. Miller __netif_tx_unlock(slave_txq); 3251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds master->slaves = NEXT_SLAVE(q); 3261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds netif_wake_queue(dev); 3271ac9ad1394fa542ac7ae0dc943ee3cda678799faEric Dumazet master->tx_packets++; 3281ac9ad1394fa542ac7ae0dc943ee3cda678799faEric Dumazet master->tx_bytes += length; 3296ed106549d17474ca17a16057f4c0ed4eba5a7caPatrick McHardy return NETDEV_TX_OK; 3301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 331c3f26a269c2421f97f10cf8ed05d5099b573af4dDavid S. Miller __netif_tx_unlock(slave_txq); 3321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3337346649826382b769cfadf4a2fe8a84d060c55e9Tom Herbert if (netif_xmit_stopped(netdev_get_tx_queue(dev, 0))) 3341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds busy = 1; 3351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 3361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 1: 3371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds master->slaves = NEXT_SLAVE(q); 3386ed106549d17474ca17a16057f4c0ed4eba5a7caPatrick McHardy return NETDEV_TX_OK; 3391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds default: 3401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds nores = 1; 3411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 3421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 343bbe735e4247dba32568a305553b010081c8dea99Arnaldo Carvalho de Melo __skb_pull(skb, skb_network_offset(skb)); 3441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } while ((q = NEXT_SLAVE(q)) != start); 3451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (nores && skb_res == NULL) { 3471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds skb_res = skb; 3481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto restart; 3491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (busy) { 3521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds netif_stop_queue(dev); 3535b548140225c6bbbbd560551dd1048b2c0ce58bePatrick McHardy return NETDEV_TX_BUSY; 3541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3551ac9ad1394fa542ac7ae0dc943ee3cda678799faEric Dumazet master->tx_errors++; 3561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsdrop: 3581ac9ad1394fa542ac7ae0dc943ee3cda678799faEric Dumazet master->tx_dropped++; 3591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev_kfree_skb(skb); 3606ed106549d17474ca17a16057f4c0ed4eba5a7caPatrick McHardy return NETDEV_TX_OK; 3611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 3621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int teql_master_open(struct net_device *dev) 3641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 365cc7ec456f82da7f89a5b376e613b3ac4311b3e9aEric Dumazet struct Qdisc *q; 3662941a4863154982918d39a639632c76eeacfa884Patrick McHardy struct teql_master *m = netdev_priv(dev); 3671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int mtu = 0xFFFE; 368cc7ec456f82da7f89a5b376e613b3ac4311b3e9aEric Dumazet unsigned int flags = IFF_NOARP | IFF_MULTICAST; 3691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (m->slaves == NULL) 3711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EUNATCH; 3721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds flags = FMASK; 3741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds q = m->slaves; 3761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds do { 3775ce2d488fe039ddd86a638496cf704df86c74eebDavid S. Miller struct net_device *slave = qdisc_dev(q); 3781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (slave == NULL) 3801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EUNATCH; 3811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (slave->mtu < mtu) 3831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mtu = slave->mtu; 3841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (slave->hard_header_len > LL_MAX_HEADER) 3851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 3861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* If all the slaves are BROADCAST, master is BROADCAST 3881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds If all the slaves are PtP, master is PtP 3891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds Otherwise, master is NBMA. 3901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 3911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!(slave->flags&IFF_POINTOPOINT)) 3921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds flags &= ~IFF_POINTOPOINT; 3931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!(slave->flags&IFF_BROADCAST)) 3941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds flags &= ~IFF_BROADCAST; 3951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!(slave->flags&IFF_MULTICAST)) 3961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds flags &= ~IFF_MULTICAST; 3971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } while ((q = NEXT_SLAVE(q)) != m->slaves); 3981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds m->dev->mtu = mtu; 4001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds m->dev->flags = (m->dev->flags&~FMASK) | flags; 4011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds netif_start_queue(m->dev); 4021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 4031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 4041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int teql_master_close(struct net_device *dev) 4061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 4071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds netif_stop_queue(dev); 4081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 4091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 4101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4111ac9ad1394fa542ac7ae0dc943ee3cda678799faEric Dumazetstatic struct rtnl_link_stats64 *teql_master_stats64(struct net_device *dev, 4121ac9ad1394fa542ac7ae0dc943ee3cda678799faEric Dumazet struct rtnl_link_stats64 *stats) 4131ac9ad1394fa542ac7ae0dc943ee3cda678799faEric Dumazet{ 4141ac9ad1394fa542ac7ae0dc943ee3cda678799faEric Dumazet struct teql_master *m = netdev_priv(dev); 4151ac9ad1394fa542ac7ae0dc943ee3cda678799faEric Dumazet 4161ac9ad1394fa542ac7ae0dc943ee3cda678799faEric Dumazet stats->tx_packets = m->tx_packets; 4171ac9ad1394fa542ac7ae0dc943ee3cda678799faEric Dumazet stats->tx_bytes = m->tx_bytes; 4181ac9ad1394fa542ac7ae0dc943ee3cda678799faEric Dumazet stats->tx_errors = m->tx_errors; 4191ac9ad1394fa542ac7ae0dc943ee3cda678799faEric Dumazet stats->tx_dropped = m->tx_dropped; 4201ac9ad1394fa542ac7ae0dc943ee3cda678799faEric Dumazet return stats; 4211ac9ad1394fa542ac7ae0dc943ee3cda678799faEric Dumazet} 4221ac9ad1394fa542ac7ae0dc943ee3cda678799faEric Dumazet 4231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int teql_master_mtu(struct net_device *dev, int new_mtu) 4241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 4252941a4863154982918d39a639632c76eeacfa884Patrick McHardy struct teql_master *m = netdev_priv(dev); 4261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct Qdisc *q; 4271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (new_mtu < 68) 4291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 4301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds q = m->slaves; 4321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (q) { 4331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds do { 4345ce2d488fe039ddd86a638496cf704df86c74eebDavid S. Miller if (new_mtu > qdisc_dev(q)->mtu) 4351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 436cc7ec456f82da7f89a5b376e613b3ac4311b3e9aEric Dumazet } while ((q = NEXT_SLAVE(q)) != m->slaves); 4371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->mtu = new_mtu; 4401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 4411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 4421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 44361294e2e2730f24b833d9a713add5f4f6672c2a4Stephen Hemmingerstatic const struct net_device_ops teql_netdev_ops = { 44461294e2e2730f24b833d9a713add5f4f6672c2a4Stephen Hemminger .ndo_open = teql_master_open, 44561294e2e2730f24b833d9a713add5f4f6672c2a4Stephen Hemminger .ndo_stop = teql_master_close, 44661294e2e2730f24b833d9a713add5f4f6672c2a4Stephen Hemminger .ndo_start_xmit = teql_master_xmit, 4471ac9ad1394fa542ac7ae0dc943ee3cda678799faEric Dumazet .ndo_get_stats64 = teql_master_stats64, 44861294e2e2730f24b833d9a713add5f4f6672c2a4Stephen Hemminger .ndo_change_mtu = teql_master_mtu, 44961294e2e2730f24b833d9a713add5f4f6672c2a4Stephen Hemminger}; 45061294e2e2730f24b833d9a713add5f4f6672c2a4Stephen Hemminger 4511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic __init void teql_master_setup(struct net_device *dev) 4521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 4532941a4863154982918d39a639632c76eeacfa884Patrick McHardy struct teql_master *master = netdev_priv(dev); 4541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct Qdisc_ops *ops = &master->qops; 4551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds master->dev = dev; 4571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ops->priv_size = sizeof(struct teql_sched_data); 45810297b99315e5e08fe623ba56da35db1fee69ba9YOSHIFUJI Hideaki 4591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ops->enqueue = teql_enqueue; 4601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ops->dequeue = teql_dequeue; 4618e3af97899db433111287e07d5105189f56fe191Jarek Poplawski ops->peek = teql_peek; 4621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ops->init = teql_qdisc_init; 4631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ops->reset = teql_reset; 4641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ops->destroy = teql_destroy; 4651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ops->owner = THIS_MODULE; 4661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 46761294e2e2730f24b833d9a713add5f4f6672c2a4Stephen Hemminger dev->netdev_ops = &teql_netdev_ops; 4681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->type = ARPHRD_VOID; 4691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->mtu = 1500; 4701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->tx_queue_len = 100; 4711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->flags = IFF_NOARP; 4721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->hard_header_len = LL_MAX_HEADER; 4730287587884b15041203b3a362d485e1ab1f24445Eric Dumazet netif_keep_dst(dev); 4741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 4751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic LIST_HEAD(master_dev_list); 4771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int max_equalizers = 1; 4781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmodule_param(max_equalizers, int, 0); 4791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_PARM_DESC(max_equalizers, "Max number of link equalizers"); 4801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int __init teql_init(void) 4821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 4831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int i; 4841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int err = -ENODEV; 4851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (i = 0; i < max_equalizers; i++) { 4871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct net_device *dev; 4881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct teql_master *master; 4891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 490c835a677331495cf137a7f8a023463afd9f032f8Tom Gundersen dev = alloc_netdev(sizeof(struct teql_master), "teql%d", 491c835a677331495cf137a7f8a023463afd9f032f8Tom Gundersen NET_NAME_UNKNOWN, teql_master_setup); 4921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!dev) { 4931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = -ENOMEM; 4941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 4951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((err = register_netdev(dev))) { 4981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds free_netdev(dev); 4991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 5001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5022941a4863154982918d39a639632c76eeacfa884Patrick McHardy master = netdev_priv(dev); 5031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds strlcpy(master->qops.id, dev->name, IFNAMSIZ); 5051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = register_qdisc(&master->qops); 5061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (err) { 5081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unregister_netdev(dev); 5091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds free_netdev(dev); 5101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 5111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_add_tail(&master->master_list, &master_dev_list); 5141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return i ? 0 : err; 5161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 51810297b99315e5e08fe623ba56da35db1fee69ba9YOSHIFUJI Hideakistatic void __exit teql_exit(void) 5191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 5201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct teql_master *master, *nxt; 5211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_for_each_entry_safe(master, nxt, &master_dev_list, master_list) { 5231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_del(&master->master_list); 5251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unregister_qdisc(&master->qops); 5271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unregister_netdev(master->dev); 5281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds free_netdev(master->dev); 5291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmodule_init(teql_init); 5331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmodule_exit(teql_exit); 5341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_LICENSE("GPL"); 536