11da177e4SLinus Torvalds /* 21da177e4SLinus Torvalds * Copyright (c) 2004 Topspin Communications. All rights reserved. 32a1d9b7fSRoland Dreier * Copyright (c) 2005 Sun Microsystems, Inc. All rights reserved. 42a1d9b7fSRoland Dreier * Copyright (c) 2004 Voltaire, Inc. All rights reserved. 51da177e4SLinus Torvalds * 61da177e4SLinus Torvalds * This software is available to you under a choice of one of two 71da177e4SLinus Torvalds * licenses. You may choose to be licensed under the terms of the GNU 81da177e4SLinus Torvalds * General Public License (GPL) Version 2, available from the file 91da177e4SLinus Torvalds * COPYING in the main directory of this source tree, or the 101da177e4SLinus Torvalds * OpenIB.org BSD license below: 111da177e4SLinus Torvalds * 121da177e4SLinus Torvalds * Redistribution and use in source and binary forms, with or 131da177e4SLinus Torvalds * without modification, are permitted provided that the following 141da177e4SLinus Torvalds * conditions are met: 151da177e4SLinus Torvalds * 161da177e4SLinus Torvalds * - Redistributions of source code must retain the above 171da177e4SLinus Torvalds * copyright notice, this list of conditions and the following 181da177e4SLinus Torvalds * disclaimer. 191da177e4SLinus Torvalds * 201da177e4SLinus Torvalds * - Redistributions in binary form must reproduce the above 211da177e4SLinus Torvalds * copyright notice, this list of conditions and the following 221da177e4SLinus Torvalds * disclaimer in the documentation and/or other materials 231da177e4SLinus Torvalds * provided with the distribution. 241da177e4SLinus Torvalds * 251da177e4SLinus Torvalds * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, 261da177e4SLinus Torvalds * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF 271da177e4SLinus Torvalds * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND 281da177e4SLinus Torvalds * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS 291da177e4SLinus Torvalds * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN 301da177e4SLinus Torvalds * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN 311da177e4SLinus Torvalds * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE 321da177e4SLinus Torvalds * SOFTWARE. 331da177e4SLinus Torvalds */ 341da177e4SLinus Torvalds 351da177e4SLinus Torvalds #include "ipoib.h" 361da177e4SLinus Torvalds 371da177e4SLinus Torvalds #include <linux/module.h> 381da177e4SLinus Torvalds 391da177e4SLinus Torvalds #include <linux/init.h> 401da177e4SLinus Torvalds #include <linux/slab.h> 410f485251SShirley Ma #include <linux/kernel.h> 4210313cbbSRoland Dreier #include <linux/vmalloc.h> 431da177e4SLinus Torvalds 441da177e4SLinus Torvalds #include <linux/if_arp.h> /* For ARPHRD_xxx */ 451da177e4SLinus Torvalds 461da177e4SLinus Torvalds #include <linux/ip.h> 471da177e4SLinus Torvalds #include <linux/in.h> 481da177e4SLinus Torvalds 4914c85021SArnaldo Carvalho de Melo #include <net/dst.h> 5014c85021SArnaldo Carvalho de Melo 511da177e4SLinus Torvalds MODULE_AUTHOR("Roland Dreier"); 521da177e4SLinus Torvalds MODULE_DESCRIPTION("IP-over-InfiniBand net driver"); 531da177e4SLinus Torvalds MODULE_LICENSE("Dual BSD/GPL"); 541da177e4SLinus Torvalds 550f485251SShirley Ma int ipoib_sendq_size __read_mostly = IPOIB_TX_RING_SIZE; 560f485251SShirley Ma int ipoib_recvq_size __read_mostly = IPOIB_RX_RING_SIZE; 570f485251SShirley Ma 580f485251SShirley Ma module_param_named(send_queue_size, ipoib_sendq_size, int, 0444); 590f485251SShirley Ma MODULE_PARM_DESC(send_queue_size, "Number of descriptors in send queue"); 600f485251SShirley Ma module_param_named(recv_queue_size, ipoib_recvq_size, int, 0444); 610f485251SShirley Ma MODULE_PARM_DESC(recv_queue_size, "Number of descriptors in receive queue"); 620f485251SShirley Ma 631da177e4SLinus Torvalds #ifdef CONFIG_INFINIBAND_IPOIB_DEBUG 641da177e4SLinus Torvalds int ipoib_debug_level; 651da177e4SLinus Torvalds 661da177e4SLinus Torvalds module_param_named(debug_level, ipoib_debug_level, int, 0644); 671da177e4SLinus Torvalds MODULE_PARM_DESC(debug_level, "Enable debug tracing if > 0"); 681da177e4SLinus Torvalds #endif 691da177e4SLinus Torvalds 701732b0efSRoland Dreier struct ipoib_path_iter { 711732b0efSRoland Dreier struct net_device *dev; 721732b0efSRoland Dreier struct ipoib_path path; 731732b0efSRoland Dreier }; 741732b0efSRoland Dreier 751da177e4SLinus Torvalds static const u8 ipv4_bcast_addr[] = { 761da177e4SLinus Torvalds 0x00, 0xff, 0xff, 0xff, 771da177e4SLinus Torvalds 0xff, 0x12, 0x40, 0x1b, 0x00, 0x00, 0x00, 0x00, 781da177e4SLinus Torvalds 0x00, 0x00, 0x00, 0x00, 0xff, 0xff, 0xff, 0xff 791da177e4SLinus Torvalds }; 801da177e4SLinus Torvalds 811da177e4SLinus Torvalds struct workqueue_struct *ipoib_workqueue; 821da177e4SLinus Torvalds 83c1a0b23bSMichael S. Tsirkin struct ib_sa_client ipoib_sa_client; 84c1a0b23bSMichael S. Tsirkin 851da177e4SLinus Torvalds static void ipoib_add_one(struct ib_device *device); 861da177e4SLinus Torvalds static void ipoib_remove_one(struct ib_device *device); 871da177e4SLinus Torvalds 881da177e4SLinus Torvalds static struct ib_client ipoib_client = { 891da177e4SLinus Torvalds .name = "ipoib", 901da177e4SLinus Torvalds .add = ipoib_add_one, 911da177e4SLinus Torvalds .remove = ipoib_remove_one 921da177e4SLinus Torvalds }; 931da177e4SLinus Torvalds 941da177e4SLinus Torvalds int ipoib_open(struct net_device *dev) 951da177e4SLinus Torvalds { 961da177e4SLinus Torvalds struct ipoib_dev_priv *priv = netdev_priv(dev); 971da177e4SLinus Torvalds 981da177e4SLinus Torvalds ipoib_dbg(priv, "bringing up interface\n"); 991da177e4SLinus Torvalds 100e028cc55SYossi Etigin set_bit(IPOIB_FLAG_ADMIN_UP, &priv->flags); 1011da177e4SLinus Torvalds 1021da177e4SLinus Torvalds if (ipoib_pkey_dev_delay_open(dev)) 1031da177e4SLinus Torvalds return 0; 1041da177e4SLinus Torvalds 105b8a1b1ceSRoland Dreier if (ipoib_ib_dev_open(dev)) 106b8a1b1ceSRoland Dreier goto err_disable; 107fe25c561SYossi Etigin 108b8a1b1ceSRoland Dreier if (ipoib_ib_dev_up(dev)) 109b8a1b1ceSRoland Dreier goto err_stop; 1101da177e4SLinus Torvalds 1111da177e4SLinus Torvalds if (!test_bit(IPOIB_FLAG_SUBINTERFACE, &priv->flags)) { 1121da177e4SLinus Torvalds struct ipoib_dev_priv *cpriv; 1131da177e4SLinus Torvalds 1141da177e4SLinus Torvalds /* Bring up any child interfaces too */ 11595ed644fSIngo Molnar mutex_lock(&priv->vlan_mutex); 1161da177e4SLinus Torvalds list_for_each_entry(cpriv, &priv->child_intfs, list) { 1171da177e4SLinus Torvalds int flags; 1181da177e4SLinus Torvalds 1191da177e4SLinus Torvalds flags = cpriv->dev->flags; 1201da177e4SLinus Torvalds if (flags & IFF_UP) 1211da177e4SLinus Torvalds continue; 1221da177e4SLinus Torvalds 1231da177e4SLinus Torvalds dev_change_flags(cpriv->dev, flags | IFF_UP); 1241da177e4SLinus Torvalds } 12595ed644fSIngo Molnar mutex_unlock(&priv->vlan_mutex); 1261da177e4SLinus Torvalds } 1271da177e4SLinus Torvalds 1281da177e4SLinus Torvalds netif_start_queue(dev); 1291da177e4SLinus Torvalds 1301da177e4SLinus Torvalds return 0; 131b8a1b1ceSRoland Dreier 132b8a1b1ceSRoland Dreier err_stop: 133b8a1b1ceSRoland Dreier ipoib_ib_dev_stop(dev, 1); 134b8a1b1ceSRoland Dreier 135b8a1b1ceSRoland Dreier err_disable: 136b8a1b1ceSRoland Dreier clear_bit(IPOIB_FLAG_ADMIN_UP, &priv->flags); 137b8a1b1ceSRoland Dreier 138b8a1b1ceSRoland Dreier return -EINVAL; 1391da177e4SLinus Torvalds } 1401da177e4SLinus Torvalds 1411da177e4SLinus Torvalds static int ipoib_stop(struct net_device *dev) 1421da177e4SLinus Torvalds { 1431da177e4SLinus Torvalds struct ipoib_dev_priv *priv = netdev_priv(dev); 1441da177e4SLinus Torvalds 1451da177e4SLinus Torvalds ipoib_dbg(priv, "stopping interface\n"); 1461da177e4SLinus Torvalds 1471da177e4SLinus Torvalds clear_bit(IPOIB_FLAG_ADMIN_UP, &priv->flags); 1481da177e4SLinus Torvalds 1491da177e4SLinus Torvalds netif_stop_queue(dev); 1501da177e4SLinus Torvalds 151a77a57a1SRoland Dreier ipoib_ib_dev_down(dev, 0); 152a77a57a1SRoland Dreier ipoib_ib_dev_stop(dev, 0); 1531da177e4SLinus Torvalds 1541da177e4SLinus Torvalds if (!test_bit(IPOIB_FLAG_SUBINTERFACE, &priv->flags)) { 1551da177e4SLinus Torvalds struct ipoib_dev_priv *cpriv; 1561da177e4SLinus Torvalds 1571da177e4SLinus Torvalds /* Bring down any child interfaces too */ 15895ed644fSIngo Molnar mutex_lock(&priv->vlan_mutex); 1591da177e4SLinus Torvalds list_for_each_entry(cpriv, &priv->child_intfs, list) { 1601da177e4SLinus Torvalds int flags; 1611da177e4SLinus Torvalds 1621da177e4SLinus Torvalds flags = cpriv->dev->flags; 1631da177e4SLinus Torvalds if (!(flags & IFF_UP)) 1641da177e4SLinus Torvalds continue; 1651da177e4SLinus Torvalds 1661da177e4SLinus Torvalds dev_change_flags(cpriv->dev, flags & ~IFF_UP); 1671da177e4SLinus Torvalds } 16895ed644fSIngo Molnar mutex_unlock(&priv->vlan_mutex); 1691da177e4SLinus Torvalds } 1701da177e4SLinus Torvalds 1711da177e4SLinus Torvalds return 0; 1721da177e4SLinus Torvalds } 1731da177e4SLinus Torvalds 1741da177e4SLinus Torvalds static int ipoib_change_mtu(struct net_device *dev, int new_mtu) 1751da177e4SLinus Torvalds { 1761da177e4SLinus Torvalds struct ipoib_dev_priv *priv = netdev_priv(dev); 1771da177e4SLinus Torvalds 178839fcabaSMichael S. Tsirkin /* dev->mtu > 2K ==> connected mode */ 179586a6934SPradeep Satyanarayana if (ipoib_cm_admin_enabled(dev)) { 180586a6934SPradeep Satyanarayana if (new_mtu > ipoib_cm_max_mtu(dev)) 181586a6934SPradeep Satyanarayana return -EINVAL; 182586a6934SPradeep Satyanarayana 183839fcabaSMichael S. Tsirkin if (new_mtu > priv->mcast_mtu) 184839fcabaSMichael S. Tsirkin ipoib_warn(priv, "mtu > %d will cause multicast packet drops.\n", 185839fcabaSMichael S. Tsirkin priv->mcast_mtu); 186586a6934SPradeep Satyanarayana 187839fcabaSMichael S. Tsirkin dev->mtu = new_mtu; 188839fcabaSMichael S. Tsirkin return 0; 189839fcabaSMichael S. Tsirkin } 190839fcabaSMichael S. Tsirkin 191bc7b3a36SShirley Ma if (new_mtu > IPOIB_UD_MTU(priv->max_ib_mtu)) 1921da177e4SLinus Torvalds return -EINVAL; 1931da177e4SLinus Torvalds 1941da177e4SLinus Torvalds priv->admin_mtu = new_mtu; 1951da177e4SLinus Torvalds 1961da177e4SLinus Torvalds dev->mtu = min(priv->mcast_mtu, priv->admin_mtu); 1971da177e4SLinus Torvalds 1981da177e4SLinus Torvalds return 0; 1991da177e4SLinus Torvalds } 2001da177e4SLinus Torvalds 20137c22a77SJack Morgenstein static struct ipoib_path *__path_find(struct net_device *dev, void *gid) 2021da177e4SLinus Torvalds { 2031da177e4SLinus Torvalds struct ipoib_dev_priv *priv = netdev_priv(dev); 2041da177e4SLinus Torvalds struct rb_node *n = priv->path_tree.rb_node; 2051da177e4SLinus Torvalds struct ipoib_path *path; 2061da177e4SLinus Torvalds int ret; 2071da177e4SLinus Torvalds 2081da177e4SLinus Torvalds while (n) { 2091da177e4SLinus Torvalds path = rb_entry(n, struct ipoib_path, rb_node); 2101da177e4SLinus Torvalds 21137c22a77SJack Morgenstein ret = memcmp(gid, path->pathrec.dgid.raw, 2121da177e4SLinus Torvalds sizeof (union ib_gid)); 2131da177e4SLinus Torvalds 2141da177e4SLinus Torvalds if (ret < 0) 2151da177e4SLinus Torvalds n = n->rb_left; 2161da177e4SLinus Torvalds else if (ret > 0) 2171da177e4SLinus Torvalds n = n->rb_right; 2181da177e4SLinus Torvalds else 2191da177e4SLinus Torvalds return path; 2201da177e4SLinus Torvalds } 2211da177e4SLinus Torvalds 2221da177e4SLinus Torvalds return NULL; 2231da177e4SLinus Torvalds } 2241da177e4SLinus Torvalds 2251da177e4SLinus Torvalds static int __path_add(struct net_device *dev, struct ipoib_path *path) 2261da177e4SLinus Torvalds { 2271da177e4SLinus Torvalds struct ipoib_dev_priv *priv = netdev_priv(dev); 2281da177e4SLinus Torvalds struct rb_node **n = &priv->path_tree.rb_node; 2291da177e4SLinus Torvalds struct rb_node *pn = NULL; 2301da177e4SLinus Torvalds struct ipoib_path *tpath; 2311da177e4SLinus Torvalds int ret; 2321da177e4SLinus Torvalds 2331da177e4SLinus Torvalds while (*n) { 2341da177e4SLinus Torvalds pn = *n; 2351da177e4SLinus Torvalds tpath = rb_entry(pn, struct ipoib_path, rb_node); 2361da177e4SLinus Torvalds 2371da177e4SLinus Torvalds ret = memcmp(path->pathrec.dgid.raw, tpath->pathrec.dgid.raw, 2381da177e4SLinus Torvalds sizeof (union ib_gid)); 2391da177e4SLinus Torvalds if (ret < 0) 2401da177e4SLinus Torvalds n = &pn->rb_left; 2411da177e4SLinus Torvalds else if (ret > 0) 2421da177e4SLinus Torvalds n = &pn->rb_right; 2431da177e4SLinus Torvalds else 2441da177e4SLinus Torvalds return -EEXIST; 2451da177e4SLinus Torvalds } 2461da177e4SLinus Torvalds 2471da177e4SLinus Torvalds rb_link_node(&path->rb_node, pn, n); 2481da177e4SLinus Torvalds rb_insert_color(&path->rb_node, &priv->path_tree); 2491da177e4SLinus Torvalds 2501da177e4SLinus Torvalds list_add_tail(&path->list, &priv->path_list); 2511da177e4SLinus Torvalds 2521da177e4SLinus Torvalds return 0; 2531da177e4SLinus Torvalds } 2541da177e4SLinus Torvalds 2551da177e4SLinus Torvalds static void path_free(struct net_device *dev, struct ipoib_path *path) 2561da177e4SLinus Torvalds { 2571da177e4SLinus Torvalds struct ipoib_dev_priv *priv = netdev_priv(dev); 2581da177e4SLinus Torvalds struct ipoib_neigh *neigh, *tn; 2591da177e4SLinus Torvalds struct sk_buff *skb; 2601da177e4SLinus Torvalds unsigned long flags; 2611da177e4SLinus Torvalds 2621da177e4SLinus Torvalds while ((skb = __skb_dequeue(&path->queue))) 2631da177e4SLinus Torvalds dev_kfree_skb_irq(skb); 2641da177e4SLinus Torvalds 2651da177e4SLinus Torvalds spin_lock_irqsave(&priv->lock, flags); 2661da177e4SLinus Torvalds 2671da177e4SLinus Torvalds list_for_each_entry_safe(neigh, tn, &path->neigh_list, list) { 2681da177e4SLinus Torvalds /* 2691da177e4SLinus Torvalds * It's safe to call ipoib_put_ah() inside priv->lock 2701da177e4SLinus Torvalds * here, because we know that path->ah will always 2711da177e4SLinus Torvalds * hold one more reference, so ipoib_put_ah() will 2721da177e4SLinus Torvalds * never do more than decrement the ref count. 2731da177e4SLinus Torvalds */ 2741da177e4SLinus Torvalds if (neigh->ah) 2751da177e4SLinus Torvalds ipoib_put_ah(neigh->ah); 276d2e0655eSMichael S. Tsirkin 2772745b5b7SMichael S. Tsirkin ipoib_neigh_free(dev, neigh); 2781da177e4SLinus Torvalds } 2791da177e4SLinus Torvalds 2801da177e4SLinus Torvalds spin_unlock_irqrestore(&priv->lock, flags); 2811da177e4SLinus Torvalds 2821da177e4SLinus Torvalds if (path->ah) 2831da177e4SLinus Torvalds ipoib_put_ah(path->ah); 2841da177e4SLinus Torvalds 2851da177e4SLinus Torvalds kfree(path); 2861da177e4SLinus Torvalds } 2871da177e4SLinus Torvalds 2881732b0efSRoland Dreier #ifdef CONFIG_INFINIBAND_IPOIB_DEBUG 2891732b0efSRoland Dreier 2901732b0efSRoland Dreier struct ipoib_path_iter *ipoib_path_iter_init(struct net_device *dev) 2911732b0efSRoland Dreier { 2921732b0efSRoland Dreier struct ipoib_path_iter *iter; 2931732b0efSRoland Dreier 2941732b0efSRoland Dreier iter = kmalloc(sizeof *iter, GFP_KERNEL); 2951732b0efSRoland Dreier if (!iter) 2961732b0efSRoland Dreier return NULL; 2971732b0efSRoland Dreier 2981732b0efSRoland Dreier iter->dev = dev; 2991732b0efSRoland Dreier memset(iter->path.pathrec.dgid.raw, 0, 16); 3001732b0efSRoland Dreier 3011732b0efSRoland Dreier if (ipoib_path_iter_next(iter)) { 3021732b0efSRoland Dreier kfree(iter); 3031732b0efSRoland Dreier return NULL; 3041732b0efSRoland Dreier } 3051732b0efSRoland Dreier 3061732b0efSRoland Dreier return iter; 3071732b0efSRoland Dreier } 3081732b0efSRoland Dreier 3091732b0efSRoland Dreier int ipoib_path_iter_next(struct ipoib_path_iter *iter) 3101732b0efSRoland Dreier { 3111732b0efSRoland Dreier struct ipoib_dev_priv *priv = netdev_priv(iter->dev); 3121732b0efSRoland Dreier struct rb_node *n; 3131732b0efSRoland Dreier struct ipoib_path *path; 3141732b0efSRoland Dreier int ret = 1; 3151732b0efSRoland Dreier 3161732b0efSRoland Dreier spin_lock_irq(&priv->lock); 3171732b0efSRoland Dreier 3181732b0efSRoland Dreier n = rb_first(&priv->path_tree); 3191732b0efSRoland Dreier 3201732b0efSRoland Dreier while (n) { 3211732b0efSRoland Dreier path = rb_entry(n, struct ipoib_path, rb_node); 3221732b0efSRoland Dreier 3231732b0efSRoland Dreier if (memcmp(iter->path.pathrec.dgid.raw, path->pathrec.dgid.raw, 3241732b0efSRoland Dreier sizeof (union ib_gid)) < 0) { 3251732b0efSRoland Dreier iter->path = *path; 3261732b0efSRoland Dreier ret = 0; 3271732b0efSRoland Dreier break; 3281732b0efSRoland Dreier } 3291732b0efSRoland Dreier 3301732b0efSRoland Dreier n = rb_next(n); 3311732b0efSRoland Dreier } 3321732b0efSRoland Dreier 3331732b0efSRoland Dreier spin_unlock_irq(&priv->lock); 3341732b0efSRoland Dreier 3351732b0efSRoland Dreier return ret; 3361732b0efSRoland Dreier } 3371732b0efSRoland Dreier 3381732b0efSRoland Dreier void ipoib_path_iter_read(struct ipoib_path_iter *iter, 3391732b0efSRoland Dreier struct ipoib_path *path) 3401732b0efSRoland Dreier { 3411732b0efSRoland Dreier *path = iter->path; 3421732b0efSRoland Dreier } 3431732b0efSRoland Dreier 3441732b0efSRoland Dreier #endif /* CONFIG_INFINIBAND_IPOIB_DEBUG */ 3451732b0efSRoland Dreier 346ee1e2c82SMoni Shoua void ipoib_mark_paths_invalid(struct net_device *dev) 347ee1e2c82SMoni Shoua { 348ee1e2c82SMoni Shoua struct ipoib_dev_priv *priv = netdev_priv(dev); 349ee1e2c82SMoni Shoua struct ipoib_path *path, *tp; 350ee1e2c82SMoni Shoua 351ee1e2c82SMoni Shoua spin_lock_irq(&priv->lock); 352ee1e2c82SMoni Shoua 353ee1e2c82SMoni Shoua list_for_each_entry_safe(path, tp, &priv->path_list, list) { 3545b095d98SHarvey Harrison ipoib_dbg(priv, "mark path LID 0x%04x GID %pI6 invalid\n", 355ee1e2c82SMoni Shoua be16_to_cpu(path->pathrec.dlid), 356fcace2feSHarvey Harrison path->pathrec.dgid.raw); 357ee1e2c82SMoni Shoua path->valid = 0; 358ee1e2c82SMoni Shoua } 359ee1e2c82SMoni Shoua 360ee1e2c82SMoni Shoua spin_unlock_irq(&priv->lock); 361ee1e2c82SMoni Shoua } 362ee1e2c82SMoni Shoua 3631da177e4SLinus Torvalds void ipoib_flush_paths(struct net_device *dev) 3641da177e4SLinus Torvalds { 3651da177e4SLinus Torvalds struct ipoib_dev_priv *priv = netdev_priv(dev); 3661da177e4SLinus Torvalds struct ipoib_path *path, *tp; 3671da177e4SLinus Torvalds LIST_HEAD(remove_list); 368943c246eSRoland Dreier unsigned long flags; 3691da177e4SLinus Torvalds 370943c246eSRoland Dreier netif_tx_lock_bh(dev); 371943c246eSRoland Dreier spin_lock_irqsave(&priv->lock, flags); 3721da177e4SLinus Torvalds 373157de229SRobert P. J. Day list_splice_init(&priv->path_list, &remove_list); 3741da177e4SLinus Torvalds 3751da177e4SLinus Torvalds list_for_each_entry(path, &remove_list, list) 3761da177e4SLinus Torvalds rb_erase(&path->rb_node, &priv->path_tree); 3771da177e4SLinus Torvalds 3781da177e4SLinus Torvalds list_for_each_entry_safe(path, tp, &remove_list, list) { 3791da177e4SLinus Torvalds if (path->query) 3801da177e4SLinus Torvalds ib_sa_cancel_query(path->query_id, path->query); 381943c246eSRoland Dreier spin_unlock_irqrestore(&priv->lock, flags); 382943c246eSRoland Dreier netif_tx_unlock_bh(dev); 3831da177e4SLinus Torvalds wait_for_completion(&path->done); 3841da177e4SLinus Torvalds path_free(dev, path); 385943c246eSRoland Dreier netif_tx_lock_bh(dev); 386943c246eSRoland Dreier spin_lock_irqsave(&priv->lock, flags); 3871da177e4SLinus Torvalds } 388943c246eSRoland Dreier 389943c246eSRoland Dreier spin_unlock_irqrestore(&priv->lock, flags); 390943c246eSRoland Dreier netif_tx_unlock_bh(dev); 3911da177e4SLinus Torvalds } 3921da177e4SLinus Torvalds 3931da177e4SLinus Torvalds static void path_rec_completion(int status, 3941da177e4SLinus Torvalds struct ib_sa_path_rec *pathrec, 3951da177e4SLinus Torvalds void *path_ptr) 3961da177e4SLinus Torvalds { 3971da177e4SLinus Torvalds struct ipoib_path *path = path_ptr; 3981da177e4SLinus Torvalds struct net_device *dev = path->dev; 3991da177e4SLinus Torvalds struct ipoib_dev_priv *priv = netdev_priv(dev); 4001da177e4SLinus Torvalds struct ipoib_ah *ah = NULL; 401c9da4badSRoland Dreier struct ipoib_ah *old_ah = NULL; 402d04d01b1SMichael S. Tsirkin struct ipoib_neigh *neigh, *tn; 4031da177e4SLinus Torvalds struct sk_buff_head skqueue; 4041da177e4SLinus Torvalds struct sk_buff *skb; 4051da177e4SLinus Torvalds unsigned long flags; 4061da177e4SLinus Torvalds 407843613b0SRoland Dreier if (!status) 4085b095d98SHarvey Harrison ipoib_dbg(priv, "PathRec LID 0x%04x for GID %pI6\n", 409fcace2feSHarvey Harrison be16_to_cpu(pathrec->dlid), pathrec->dgid.raw); 4101da177e4SLinus Torvalds else 4115b095d98SHarvey Harrison ipoib_dbg(priv, "PathRec status %d for GID %pI6\n", 412fcace2feSHarvey Harrison status, path->pathrec.dgid.raw); 4131da177e4SLinus Torvalds 4141da177e4SLinus Torvalds skb_queue_head_init(&skqueue); 4151da177e4SLinus Torvalds 4161da177e4SLinus Torvalds if (!status) { 41746f1b3d7SSean Hefty struct ib_ah_attr av; 4181da177e4SLinus Torvalds 41946f1b3d7SSean Hefty if (!ib_init_ah_from_path(priv->ca, priv->port, pathrec, &av)) 4201da177e4SLinus Torvalds ah = ipoib_create_ah(dev, priv->pd, &av); 4211da177e4SLinus Torvalds } 4221da177e4SLinus Torvalds 4231da177e4SLinus Torvalds spin_lock_irqsave(&priv->lock, flags); 4241da177e4SLinus Torvalds 4251da177e4SLinus Torvalds if (ah) { 4261da177e4SLinus Torvalds path->pathrec = *pathrec; 4271da177e4SLinus Torvalds 428c9da4badSRoland Dreier old_ah = path->ah; 429c9da4badSRoland Dreier path->ah = ah; 430c9da4badSRoland Dreier 4311da177e4SLinus Torvalds ipoib_dbg(priv, "created address handle %p for LID 0x%04x, SL %d\n", 4321da177e4SLinus Torvalds ah, be16_to_cpu(pathrec->dlid), pathrec->sl); 4331da177e4SLinus Torvalds 4341da177e4SLinus Torvalds while ((skb = __skb_dequeue(&path->queue))) 4351da177e4SLinus Torvalds __skb_queue_tail(&skqueue, skb); 4361da177e4SLinus Torvalds 437d04d01b1SMichael S. Tsirkin list_for_each_entry_safe(neigh, tn, &path->neigh_list, list) { 438ee1e2c82SMoni Shoua if (neigh->ah) { 439ee1e2c82SMoni Shoua WARN_ON(neigh->ah != old_ah); 440ee1e2c82SMoni Shoua /* 441ee1e2c82SMoni Shoua * Dropping the ah reference inside 442ee1e2c82SMoni Shoua * priv->lock is safe here, because we 443ee1e2c82SMoni Shoua * will hold one more reference from 444ee1e2c82SMoni Shoua * the original value of path->ah (ie 445ee1e2c82SMoni Shoua * old_ah). 446ee1e2c82SMoni Shoua */ 447ee1e2c82SMoni Shoua ipoib_put_ah(neigh->ah); 448ee1e2c82SMoni Shoua } 4491da177e4SLinus Torvalds kref_get(&path->ah->ref); 4501da177e4SLinus Torvalds neigh->ah = path->ah; 4518a7f7521SMichael S. Tsirkin memcpy(&neigh->dgid.raw, &path->pathrec.dgid.raw, 4528a7f7521SMichael S. Tsirkin sizeof(union ib_gid)); 4531da177e4SLinus Torvalds 454839fcabaSMichael S. Tsirkin if (ipoib_cm_enabled(dev, neigh->neighbour)) { 455839fcabaSMichael S. Tsirkin if (!ipoib_cm_get(neigh)) 456839fcabaSMichael S. Tsirkin ipoib_cm_set(neigh, ipoib_cm_create_tx(dev, 457839fcabaSMichael S. Tsirkin path, 458839fcabaSMichael S. Tsirkin neigh)); 459839fcabaSMichael S. Tsirkin if (!ipoib_cm_get(neigh)) { 460839fcabaSMichael S. Tsirkin list_del(&neigh->list); 461839fcabaSMichael S. Tsirkin if (neigh->ah) 462839fcabaSMichael S. Tsirkin ipoib_put_ah(neigh->ah); 463839fcabaSMichael S. Tsirkin ipoib_neigh_free(dev, neigh); 464839fcabaSMichael S. Tsirkin continue; 465839fcabaSMichael S. Tsirkin } 466839fcabaSMichael S. Tsirkin } 467839fcabaSMichael S. Tsirkin 4681da177e4SLinus Torvalds while ((skb = __skb_dequeue(&neigh->queue))) 4691da177e4SLinus Torvalds __skb_queue_tail(&skqueue, skb); 4701da177e4SLinus Torvalds } 471ee1e2c82SMoni Shoua path->valid = 1; 4725872a9fcSRoland Dreier } 4731da177e4SLinus Torvalds 4745872a9fcSRoland Dreier path->query = NULL; 4751da177e4SLinus Torvalds complete(&path->done); 4761da177e4SLinus Torvalds 4771da177e4SLinus Torvalds spin_unlock_irqrestore(&priv->lock, flags); 4781da177e4SLinus Torvalds 479ee1e2c82SMoni Shoua if (old_ah) 480ee1e2c82SMoni Shoua ipoib_put_ah(old_ah); 481ee1e2c82SMoni Shoua 4821da177e4SLinus Torvalds while ((skb = __skb_dequeue(&skqueue))) { 4831da177e4SLinus Torvalds skb->dev = dev; 4841da177e4SLinus Torvalds if (dev_queue_xmit(skb)) 4851da177e4SLinus Torvalds ipoib_warn(priv, "dev_queue_xmit failed " 4861da177e4SLinus Torvalds "to requeue packet\n"); 4871da177e4SLinus Torvalds } 4881da177e4SLinus Torvalds } 4891da177e4SLinus Torvalds 49037c22a77SJack Morgenstein static struct ipoib_path *path_rec_create(struct net_device *dev, void *gid) 4911da177e4SLinus Torvalds { 4921da177e4SLinus Torvalds struct ipoib_dev_priv *priv = netdev_priv(dev); 4931da177e4SLinus Torvalds struct ipoib_path *path; 4941da177e4SLinus Torvalds 4951401b53aSJack Morgenstein if (!priv->broadcast) 4961401b53aSJack Morgenstein return NULL; 4971401b53aSJack Morgenstein 49821a38489SRoland Dreier path = kzalloc(sizeof *path, GFP_ATOMIC); 4991da177e4SLinus Torvalds if (!path) 5001da177e4SLinus Torvalds return NULL; 5011da177e4SLinus Torvalds 5021da177e4SLinus Torvalds path->dev = dev; 5031da177e4SLinus Torvalds 5041da177e4SLinus Torvalds skb_queue_head_init(&path->queue); 5051da177e4SLinus Torvalds 5061da177e4SLinus Torvalds INIT_LIST_HEAD(&path->neigh_list); 5071da177e4SLinus Torvalds 50837c22a77SJack Morgenstein memcpy(path->pathrec.dgid.raw, gid, sizeof (union ib_gid)); 5091da177e4SLinus Torvalds path->pathrec.sgid = priv->local_gid; 5101da177e4SLinus Torvalds path->pathrec.pkey = cpu_to_be16(priv->pkey); 5111da177e4SLinus Torvalds path->pathrec.numb_path = 1; 51281668838SSean Hefty path->pathrec.traffic_class = priv->broadcast->mcmember.traffic_class; 5131da177e4SLinus Torvalds 5141da177e4SLinus Torvalds return path; 5151da177e4SLinus Torvalds } 5161da177e4SLinus Torvalds 5171da177e4SLinus Torvalds static int path_rec_start(struct net_device *dev, 5181da177e4SLinus Torvalds struct ipoib_path *path) 5191da177e4SLinus Torvalds { 5201da177e4SLinus Torvalds struct ipoib_dev_priv *priv = netdev_priv(dev); 5211da177e4SLinus Torvalds 5225b095d98SHarvey Harrison ipoib_dbg(priv, "Start path record lookup for %pI6\n", 523fcace2feSHarvey Harrison path->pathrec.dgid.raw); 5241da177e4SLinus Torvalds 52565c7eddaSRoland Dreier init_completion(&path->done); 52665c7eddaSRoland Dreier 5271da177e4SLinus Torvalds path->query_id = 528c1a0b23bSMichael S. Tsirkin ib_sa_path_rec_get(&ipoib_sa_client, priv->ca, priv->port, 5291da177e4SLinus Torvalds &path->pathrec, 5301da177e4SLinus Torvalds IB_SA_PATH_REC_DGID | 5311da177e4SLinus Torvalds IB_SA_PATH_REC_SGID | 5321da177e4SLinus Torvalds IB_SA_PATH_REC_NUMB_PATH | 53381668838SSean Hefty IB_SA_PATH_REC_TRAFFIC_CLASS | 5341da177e4SLinus Torvalds IB_SA_PATH_REC_PKEY, 5351da177e4SLinus Torvalds 1000, GFP_ATOMIC, 5361da177e4SLinus Torvalds path_rec_completion, 5371da177e4SLinus Torvalds path, &path->query); 5381da177e4SLinus Torvalds if (path->query_id < 0) { 53901b3fc8bSOr Gerlitz ipoib_warn(priv, "ib_sa_path_rec_get failed: %d\n", path->query_id); 5401da177e4SLinus Torvalds path->query = NULL; 54193a3ab93SYossi Etigin complete(&path->done); 5421da177e4SLinus Torvalds return path->query_id; 5431da177e4SLinus Torvalds } 5441da177e4SLinus Torvalds 5451da177e4SLinus Torvalds return 0; 5461da177e4SLinus Torvalds } 5471da177e4SLinus Torvalds 5481da177e4SLinus Torvalds static void neigh_add_path(struct sk_buff *skb, struct net_device *dev) 5491da177e4SLinus Torvalds { 5501da177e4SLinus Torvalds struct ipoib_dev_priv *priv = netdev_priv(dev); 5511da177e4SLinus Torvalds struct ipoib_path *path; 5521da177e4SLinus Torvalds struct ipoib_neigh *neigh; 553943c246eSRoland Dreier unsigned long flags; 5541da177e4SLinus Torvalds 555adf30907SEric Dumazet neigh = ipoib_neigh_alloc(skb_dst(skb)->neighbour, skb->dev); 5561da177e4SLinus Torvalds if (!neigh) { 557de903512SRoland Dreier ++dev->stats.tx_dropped; 5581da177e4SLinus Torvalds dev_kfree_skb_any(skb); 5591da177e4SLinus Torvalds return; 5601da177e4SLinus Torvalds } 5611da177e4SLinus Torvalds 562943c246eSRoland Dreier spin_lock_irqsave(&priv->lock, flags); 5631da177e4SLinus Torvalds 564adf30907SEric Dumazet path = __path_find(dev, skb_dst(skb)->neighbour->ha + 4); 5651da177e4SLinus Torvalds if (!path) { 566adf30907SEric Dumazet path = path_rec_create(dev, skb_dst(skb)->neighbour->ha + 4); 5671da177e4SLinus Torvalds if (!path) 568d2e0655eSMichael S. Tsirkin goto err_path; 5691da177e4SLinus Torvalds 5701da177e4SLinus Torvalds __path_add(dev, path); 5711da177e4SLinus Torvalds } 5721da177e4SLinus Torvalds 5731da177e4SLinus Torvalds list_add_tail(&neigh->list, &path->neigh_list); 5741da177e4SLinus Torvalds 57547f7a071SMichael S. Tsirkin if (path->ah) { 5761da177e4SLinus Torvalds kref_get(&path->ah->ref); 5771da177e4SLinus Torvalds neigh->ah = path->ah; 5788a7f7521SMichael S. Tsirkin memcpy(&neigh->dgid.raw, &path->pathrec.dgid.raw, 5798a7f7521SMichael S. Tsirkin sizeof(union ib_gid)); 5801da177e4SLinus Torvalds 581839fcabaSMichael S. Tsirkin if (ipoib_cm_enabled(dev, neigh->neighbour)) { 582839fcabaSMichael S. Tsirkin if (!ipoib_cm_get(neigh)) 583839fcabaSMichael S. Tsirkin ipoib_cm_set(neigh, ipoib_cm_create_tx(dev, path, neigh)); 584839fcabaSMichael S. Tsirkin if (!ipoib_cm_get(neigh)) { 585839fcabaSMichael S. Tsirkin list_del(&neigh->list); 586839fcabaSMichael S. Tsirkin if (neigh->ah) 587839fcabaSMichael S. Tsirkin ipoib_put_ah(neigh->ah); 588839fcabaSMichael S. Tsirkin ipoib_neigh_free(dev, neigh); 589839fcabaSMichael S. Tsirkin goto err_drop; 590839fcabaSMichael S. Tsirkin } 591839fcabaSMichael S. Tsirkin if (skb_queue_len(&neigh->queue) < IPOIB_MAX_PATH_REC_QUEUE) 592839fcabaSMichael S. Tsirkin __skb_queue_tail(&neigh->queue, skb); 593839fcabaSMichael S. Tsirkin else { 594839fcabaSMichael S. Tsirkin ipoib_warn(priv, "queue length limit %d. Packet drop.\n", 595839fcabaSMichael S. Tsirkin skb_queue_len(&neigh->queue)); 596839fcabaSMichael S. Tsirkin goto err_drop; 597839fcabaSMichael S. Tsirkin } 598721d67cdSRoland Dreier } else { 599721d67cdSRoland Dreier spin_unlock_irqrestore(&priv->lock, flags); 600adf30907SEric Dumazet ipoib_send(dev, skb, path->ah, IPOIB_QPN(skb_dst(skb)->neighbour->ha)); 601721d67cdSRoland Dreier return; 602721d67cdSRoland Dreier } 6031da177e4SLinus Torvalds } else { 6041da177e4SLinus Torvalds neigh->ah = NULL; 6051da177e4SLinus Torvalds 6061da177e4SLinus Torvalds if (!path->query && path_rec_start(dev, path)) 607d2e0655eSMichael S. Tsirkin goto err_list; 6082745b5b7SMichael S. Tsirkin 6092745b5b7SMichael S. Tsirkin __skb_queue_tail(&neigh->queue, skb); 6101da177e4SLinus Torvalds } 6111da177e4SLinus Torvalds 612943c246eSRoland Dreier spin_unlock_irqrestore(&priv->lock, flags); 6131da177e4SLinus Torvalds return; 6141da177e4SLinus Torvalds 615d2e0655eSMichael S. Tsirkin err_list: 6161da177e4SLinus Torvalds list_del(&neigh->list); 6171da177e4SLinus Torvalds 618d2e0655eSMichael S. Tsirkin err_path: 6192745b5b7SMichael S. Tsirkin ipoib_neigh_free(dev, neigh); 620839fcabaSMichael S. Tsirkin err_drop: 621de903512SRoland Dreier ++dev->stats.tx_dropped; 6221da177e4SLinus Torvalds dev_kfree_skb_any(skb); 6231da177e4SLinus Torvalds 624943c246eSRoland Dreier spin_unlock_irqrestore(&priv->lock, flags); 6251da177e4SLinus Torvalds } 6261da177e4SLinus Torvalds 627d70ed607SRoland Dreier static void ipoib_path_lookup(struct sk_buff *skb, struct net_device *dev) 6281da177e4SLinus Torvalds { 6291da177e4SLinus Torvalds struct ipoib_dev_priv *priv = netdev_priv(skb->dev); 6301da177e4SLinus Torvalds 6311da177e4SLinus Torvalds /* Look up path record for unicasts */ 632adf30907SEric Dumazet if (skb_dst(skb)->neighbour->ha[4] != 0xff) { 6331da177e4SLinus Torvalds neigh_add_path(skb, dev); 6341da177e4SLinus Torvalds return; 6351da177e4SLinus Torvalds } 6361da177e4SLinus Torvalds 6371da177e4SLinus Torvalds /* Add in the P_Key for multicasts */ 638adf30907SEric Dumazet skb_dst(skb)->neighbour->ha[8] = (priv->pkey >> 8) & 0xff; 639adf30907SEric Dumazet skb_dst(skb)->neighbour->ha[9] = priv->pkey & 0xff; 640adf30907SEric Dumazet ipoib_mcast_send(dev, skb_dst(skb)->neighbour->ha + 4, skb); 6411da177e4SLinus Torvalds } 6421da177e4SLinus Torvalds 6431da177e4SLinus Torvalds static void unicast_arp_send(struct sk_buff *skb, struct net_device *dev, 6441da177e4SLinus Torvalds struct ipoib_pseudoheader *phdr) 6451da177e4SLinus Torvalds { 6461da177e4SLinus Torvalds struct ipoib_dev_priv *priv = netdev_priv(dev); 6471da177e4SLinus Torvalds struct ipoib_path *path; 648943c246eSRoland Dreier unsigned long flags; 6491da177e4SLinus Torvalds 650943c246eSRoland Dreier spin_lock_irqsave(&priv->lock, flags); 6511da177e4SLinus Torvalds 65237c22a77SJack Morgenstein path = __path_find(dev, phdr->hwaddr + 4); 653ee1e2c82SMoni Shoua if (!path || !path->valid) { 65471d98b46SJack Morgenstein int new_path = 0; 65571d98b46SJack Morgenstein 65671d98b46SJack Morgenstein if (!path) { 65737c22a77SJack Morgenstein path = path_rec_create(dev, phdr->hwaddr + 4); 65871d98b46SJack Morgenstein new_path = 1; 65971d98b46SJack Morgenstein } 6601da177e4SLinus Torvalds if (path) { 6611da177e4SLinus Torvalds /* put pseudoheader back on for next time */ 6621da177e4SLinus Torvalds skb_push(skb, sizeof *phdr); 6631da177e4SLinus Torvalds __skb_queue_tail(&path->queue, skb); 6641da177e4SLinus Torvalds 665ff79ae80SYossi Etigin if (!path->query && path_rec_start(dev, path)) { 666943c246eSRoland Dreier spin_unlock_irqrestore(&priv->lock, flags); 66771d98b46SJack Morgenstein if (new_path) 6681da177e4SLinus Torvalds path_free(dev, path); 6691da177e4SLinus Torvalds return; 6701da177e4SLinus Torvalds } else 6711da177e4SLinus Torvalds __path_add(dev, path); 6721da177e4SLinus Torvalds } else { 673de903512SRoland Dreier ++dev->stats.tx_dropped; 6741da177e4SLinus Torvalds dev_kfree_skb_any(skb); 6751da177e4SLinus Torvalds } 6761da177e4SLinus Torvalds 677943c246eSRoland Dreier spin_unlock_irqrestore(&priv->lock, flags); 6781da177e4SLinus Torvalds return; 6791da177e4SLinus Torvalds } 6801da177e4SLinus Torvalds 68147f7a071SMichael S. Tsirkin if (path->ah) { 6821da177e4SLinus Torvalds ipoib_dbg(priv, "Send unicast ARP to %04x\n", 6831da177e4SLinus Torvalds be16_to_cpu(path->pathrec.dlid)); 6841da177e4SLinus Torvalds 685721d67cdSRoland Dreier spin_unlock_irqrestore(&priv->lock, flags); 686073ae841SMichael S. Tsirkin ipoib_send(dev, skb, path->ah, IPOIB_QPN(phdr->hwaddr)); 687721d67cdSRoland Dreier return; 6881da177e4SLinus Torvalds } else if ((path->query || !path_rec_start(dev, path)) && 6891da177e4SLinus Torvalds skb_queue_len(&path->queue) < IPOIB_MAX_PATH_REC_QUEUE) { 6901da177e4SLinus Torvalds /* put pseudoheader back on for next time */ 6911da177e4SLinus Torvalds skb_push(skb, sizeof *phdr); 6921da177e4SLinus Torvalds __skb_queue_tail(&path->queue, skb); 6931da177e4SLinus Torvalds } else { 694de903512SRoland Dreier ++dev->stats.tx_dropped; 6951da177e4SLinus Torvalds dev_kfree_skb_any(skb); 6961da177e4SLinus Torvalds } 6971da177e4SLinus Torvalds 698943c246eSRoland Dreier spin_unlock_irqrestore(&priv->lock, flags); 6991da177e4SLinus Torvalds } 7001da177e4SLinus Torvalds 7011da177e4SLinus Torvalds static int ipoib_start_xmit(struct sk_buff *skb, struct net_device *dev) 7021da177e4SLinus Torvalds { 7031da177e4SLinus Torvalds struct ipoib_dev_priv *priv = netdev_priv(dev); 7041da177e4SLinus Torvalds struct ipoib_neigh *neigh; 7051da177e4SLinus Torvalds unsigned long flags; 7061da177e4SLinus Torvalds 707adf30907SEric Dumazet if (likely(skb_dst(skb) && skb_dst(skb)->neighbour)) { 708adf30907SEric Dumazet if (unlikely(!*to_ipoib_neigh(skb_dst(skb)->neighbour))) { 709d70ed607SRoland Dreier ipoib_path_lookup(skb, dev); 710943c246eSRoland Dreier return NETDEV_TX_OK; 7111da177e4SLinus Torvalds } 7121da177e4SLinus Torvalds 713adf30907SEric Dumazet neigh = *to_ipoib_neigh(skb_dst(skb)->neighbour); 7141da177e4SLinus Torvalds 715200d1713SMoni Shoua if (unlikely((memcmp(&neigh->dgid.raw, 716adf30907SEric Dumazet skb_dst(skb)->neighbour->ha + 4, 717200d1713SMoni Shoua sizeof(union ib_gid))) || 718200d1713SMoni Shoua (neigh->dev != dev))) { 719943c246eSRoland Dreier spin_lock_irqsave(&priv->lock, flags); 7208a7f7521SMichael S. Tsirkin /* 7218a7f7521SMichael S. Tsirkin * It's safe to call ipoib_put_ah() inside 7228a7f7521SMichael S. Tsirkin * priv->lock here, because we know that 7238a7f7521SMichael S. Tsirkin * path->ah will always hold one more reference, 7248a7f7521SMichael S. Tsirkin * so ipoib_put_ah() will never do more than 7258a7f7521SMichael S. Tsirkin * decrement the ref count. 7268a7f7521SMichael S. Tsirkin */ 727a50df398SYossi Etigin if (neigh->ah) 7288a7f7521SMichael S. Tsirkin ipoib_put_ah(neigh->ah); 7298a7f7521SMichael S. Tsirkin list_del(&neigh->list); 7302745b5b7SMichael S. Tsirkin ipoib_neigh_free(dev, neigh); 731943c246eSRoland Dreier spin_unlock_irqrestore(&priv->lock, flags); 7328a7f7521SMichael S. Tsirkin ipoib_path_lookup(skb, dev); 733943c246eSRoland Dreier return NETDEV_TX_OK; 7348a7f7521SMichael S. Tsirkin } 7358a7f7521SMichael S. Tsirkin 736bafff974SOr Gerlitz if (ipoib_cm_get(neigh)) { 737bafff974SOr Gerlitz if (ipoib_cm_up(neigh)) { 738bafff974SOr Gerlitz ipoib_cm_send(dev, skb, ipoib_cm_get(neigh)); 739943c246eSRoland Dreier return NETDEV_TX_OK; 740bafff974SOr Gerlitz } 741bafff974SOr Gerlitz } else if (neigh->ah) { 742adf30907SEric Dumazet ipoib_send(dev, skb, neigh->ah, IPOIB_QPN(skb_dst(skb)->neighbour->ha)); 743943c246eSRoland Dreier return NETDEV_TX_OK; 7441da177e4SLinus Torvalds } 7451da177e4SLinus Torvalds 7461da177e4SLinus Torvalds if (skb_queue_len(&neigh->queue) < IPOIB_MAX_PATH_REC_QUEUE) { 747943c246eSRoland Dreier spin_lock_irqsave(&priv->lock, flags); 7481da177e4SLinus Torvalds __skb_queue_tail(&neigh->queue, skb); 749943c246eSRoland Dreier spin_unlock_irqrestore(&priv->lock, flags); 7501da177e4SLinus Torvalds } else { 751de903512SRoland Dreier ++dev->stats.tx_dropped; 7521da177e4SLinus Torvalds dev_kfree_skb_any(skb); 7531da177e4SLinus Torvalds } 7541da177e4SLinus Torvalds } else { 7551da177e4SLinus Torvalds struct ipoib_pseudoheader *phdr = 7561da177e4SLinus Torvalds (struct ipoib_pseudoheader *) skb->data; 7571da177e4SLinus Torvalds skb_pull(skb, sizeof *phdr); 7581da177e4SLinus Torvalds 7591da177e4SLinus Torvalds if (phdr->hwaddr[4] == 0xff) { 7601da177e4SLinus Torvalds /* Add in the P_Key for multicast*/ 7611da177e4SLinus Torvalds phdr->hwaddr[8] = (priv->pkey >> 8) & 0xff; 7621da177e4SLinus Torvalds phdr->hwaddr[9] = priv->pkey & 0xff; 7631da177e4SLinus Torvalds 76437c22a77SJack Morgenstein ipoib_mcast_send(dev, phdr->hwaddr + 4, skb); 7651da177e4SLinus Torvalds } else { 7660dca0f7bSHal Rosenstock /* unicast GID -- should be ARP or RARP reply */ 7671da177e4SLinus Torvalds 7680dca0f7bSHal Rosenstock if ((be16_to_cpup((__be16 *) skb->data) != ETH_P_ARP) && 7690dca0f7bSHal Rosenstock (be16_to_cpup((__be16 *) skb->data) != ETH_P_RARP)) { 7705b095d98SHarvey Harrison ipoib_warn(priv, "Unicast, no %s: type %04x, QPN %06x %pI6\n", 771adf30907SEric Dumazet skb_dst(skb) ? "neigh" : "dst", 77297f52eb4SSean Hefty be16_to_cpup((__be16 *) skb->data), 773073ae841SMichael S. Tsirkin IPOIB_QPN(phdr->hwaddr), 774fcace2feSHarvey Harrison phdr->hwaddr + 4); 7751da177e4SLinus Torvalds dev_kfree_skb_any(skb); 776de903512SRoland Dreier ++dev->stats.tx_dropped; 777943c246eSRoland Dreier return NETDEV_TX_OK; 7781da177e4SLinus Torvalds } 7791da177e4SLinus Torvalds 7801da177e4SLinus Torvalds unicast_arp_send(skb, dev, phdr); 7811da177e4SLinus Torvalds } 7821da177e4SLinus Torvalds } 7831da177e4SLinus Torvalds 7841da177e4SLinus Torvalds return NETDEV_TX_OK; 7851da177e4SLinus Torvalds } 7861da177e4SLinus Torvalds 7871da177e4SLinus Torvalds static void ipoib_timeout(struct net_device *dev) 7881da177e4SLinus Torvalds { 7891da177e4SLinus Torvalds struct ipoib_dev_priv *priv = netdev_priv(dev); 7901da177e4SLinus Torvalds 7914b2d319bSRoland Dreier ipoib_warn(priv, "transmit timeout: latency %d msecs\n", 7924b2d319bSRoland Dreier jiffies_to_msecs(jiffies - dev->trans_start)); 7934b2d319bSRoland Dreier ipoib_warn(priv, "queue stopped %d, tx_head %u, tx_tail %u\n", 7944b2d319bSRoland Dreier netif_queue_stopped(dev), 7954b2d319bSRoland Dreier priv->tx_head, priv->tx_tail); 7961da177e4SLinus Torvalds /* XXX reset QP, etc. */ 7971da177e4SLinus Torvalds } 7981da177e4SLinus Torvalds 7991da177e4SLinus Torvalds static int ipoib_hard_header(struct sk_buff *skb, 8001da177e4SLinus Torvalds struct net_device *dev, 8011da177e4SLinus Torvalds unsigned short type, 8023b04dddeSStephen Hemminger const void *daddr, const void *saddr, unsigned len) 8031da177e4SLinus Torvalds { 8041da177e4SLinus Torvalds struct ipoib_header *header; 8051da177e4SLinus Torvalds 8061da177e4SLinus Torvalds header = (struct ipoib_header *) skb_push(skb, sizeof *header); 8071da177e4SLinus Torvalds 8081da177e4SLinus Torvalds header->proto = htons(type); 8091da177e4SLinus Torvalds header->reserved = 0; 8101da177e4SLinus Torvalds 8111da177e4SLinus Torvalds /* 8121da177e4SLinus Torvalds * If we don't have a neighbour structure, stuff the 8131da177e4SLinus Torvalds * destination address onto the front of the skb so we can 8141da177e4SLinus Torvalds * figure out where to send the packet later. 8151da177e4SLinus Torvalds */ 816adf30907SEric Dumazet if ((!skb_dst(skb) || !skb_dst(skb)->neighbour) && daddr) { 8171da177e4SLinus Torvalds struct ipoib_pseudoheader *phdr = 8181da177e4SLinus Torvalds (struct ipoib_pseudoheader *) skb_push(skb, sizeof *phdr); 8191da177e4SLinus Torvalds memcpy(phdr->hwaddr, daddr, INFINIBAND_ALEN); 8201da177e4SLinus Torvalds } 8211da177e4SLinus Torvalds 8221da177e4SLinus Torvalds return 0; 8231da177e4SLinus Torvalds } 8241da177e4SLinus Torvalds 8251da177e4SLinus Torvalds static void ipoib_set_mcast_list(struct net_device *dev) 8261da177e4SLinus Torvalds { 8271da177e4SLinus Torvalds struct ipoib_dev_priv *priv = netdev_priv(dev); 8281da177e4SLinus Torvalds 8297a343d4cSLeonid Arsh if (!test_bit(IPOIB_FLAG_OPER_UP, &priv->flags)) { 8307a343d4cSLeonid Arsh ipoib_dbg(priv, "IPOIB_FLAG_OPER_UP not set"); 8317a343d4cSLeonid Arsh return; 8327a343d4cSLeonid Arsh } 8337a343d4cSLeonid Arsh 8341ad62a19SMichael S. Tsirkin queue_work(ipoib_workqueue, &priv->restart_task); 8351da177e4SLinus Torvalds } 8361da177e4SLinus Torvalds 837ecbb4169SAlexey Kuznetsov static void ipoib_neigh_cleanup(struct neighbour *n) 8381da177e4SLinus Torvalds { 8391da177e4SLinus Torvalds struct ipoib_neigh *neigh; 8401da177e4SLinus Torvalds struct ipoib_dev_priv *priv = netdev_priv(n->dev); 8411da177e4SLinus Torvalds unsigned long flags; 8421da177e4SLinus Torvalds struct ipoib_ah *ah = NULL; 8431da177e4SLinus Torvalds 844732a2170SMoni Shoua neigh = *to_ipoib_neigh(n); 8457bc531ddSOr Gerlitz if (neigh) 846732a2170SMoni Shoua priv = netdev_priv(neigh->dev); 8477bc531ddSOr Gerlitz else 848732a2170SMoni Shoua return; 8491da177e4SLinus Torvalds ipoib_dbg(priv, 8505b095d98SHarvey Harrison "neigh_cleanup for %06x %pI6\n", 851073ae841SMichael S. Tsirkin IPOIB_QPN(n->ha), 852fcace2feSHarvey Harrison n->ha + 4); 8531da177e4SLinus Torvalds 8541da177e4SLinus Torvalds spin_lock_irqsave(&priv->lock, flags); 8551da177e4SLinus Torvalds 8561da177e4SLinus Torvalds if (neigh->ah) 8571da177e4SLinus Torvalds ah = neigh->ah; 8581da177e4SLinus Torvalds list_del(&neigh->list); 8592745b5b7SMichael S. Tsirkin ipoib_neigh_free(n->dev, neigh); 8601da177e4SLinus Torvalds 8611da177e4SLinus Torvalds spin_unlock_irqrestore(&priv->lock, flags); 8621da177e4SLinus Torvalds 8631da177e4SLinus Torvalds if (ah) 8641da177e4SLinus Torvalds ipoib_put_ah(ah); 8651da177e4SLinus Torvalds } 8661da177e4SLinus Torvalds 867732a2170SMoni Shoua struct ipoib_neigh *ipoib_neigh_alloc(struct neighbour *neighbour, 868732a2170SMoni Shoua struct net_device *dev) 869d2e0655eSMichael S. Tsirkin { 870d2e0655eSMichael S. Tsirkin struct ipoib_neigh *neigh; 871d2e0655eSMichael S. Tsirkin 872d2e0655eSMichael S. Tsirkin neigh = kmalloc(sizeof *neigh, GFP_ATOMIC); 873d2e0655eSMichael S. Tsirkin if (!neigh) 874d2e0655eSMichael S. Tsirkin return NULL; 875d2e0655eSMichael S. Tsirkin 876d2e0655eSMichael S. Tsirkin neigh->neighbour = neighbour; 877732a2170SMoni Shoua neigh->dev = dev; 8780cd4d0fdSDavid J. Wilder memset(&neigh->dgid.raw, 0, sizeof (union ib_gid)); 879d2e0655eSMichael S. Tsirkin *to_ipoib_neigh(neighbour) = neigh; 88082b39913SRoland Dreier skb_queue_head_init(&neigh->queue); 881839fcabaSMichael S. Tsirkin ipoib_cm_set(neigh, NULL); 882d2e0655eSMichael S. Tsirkin 883d2e0655eSMichael S. Tsirkin return neigh; 884d2e0655eSMichael S. Tsirkin } 885d2e0655eSMichael S. Tsirkin 8862745b5b7SMichael S. Tsirkin void ipoib_neigh_free(struct net_device *dev, struct ipoib_neigh *neigh) 887d2e0655eSMichael S. Tsirkin { 8882745b5b7SMichael S. Tsirkin struct sk_buff *skb; 889d2e0655eSMichael S. Tsirkin *to_ipoib_neigh(neigh->neighbour) = NULL; 8902745b5b7SMichael S. Tsirkin while ((skb = __skb_dequeue(&neigh->queue))) { 891de903512SRoland Dreier ++dev->stats.tx_dropped; 8922745b5b7SMichael S. Tsirkin dev_kfree_skb_any(skb); 8932745b5b7SMichael S. Tsirkin } 894839fcabaSMichael S. Tsirkin if (ipoib_cm_get(neigh)) 895839fcabaSMichael S. Tsirkin ipoib_cm_destroy_tx(ipoib_cm_get(neigh)); 896d2e0655eSMichael S. Tsirkin kfree(neigh); 897d2e0655eSMichael S. Tsirkin } 898d2e0655eSMichael S. Tsirkin 8991da177e4SLinus Torvalds static int ipoib_neigh_setup_dev(struct net_device *dev, struct neigh_parms *parms) 9001da177e4SLinus Torvalds { 901ecbb4169SAlexey Kuznetsov parms->neigh_cleanup = ipoib_neigh_cleanup; 9021da177e4SLinus Torvalds 9031da177e4SLinus Torvalds return 0; 9041da177e4SLinus Torvalds } 9051da177e4SLinus Torvalds 9061da177e4SLinus Torvalds int ipoib_dev_init(struct net_device *dev, struct ib_device *ca, int port) 9071da177e4SLinus Torvalds { 9081da177e4SLinus Torvalds struct ipoib_dev_priv *priv = netdev_priv(dev); 9091da177e4SLinus Torvalds 9101da177e4SLinus Torvalds /* Allocate RX/TX "rings" to hold queued skbs */ 9110f485251SShirley Ma priv->rx_ring = kzalloc(ipoib_recvq_size * sizeof *priv->rx_ring, 9121da177e4SLinus Torvalds GFP_KERNEL); 9131da177e4SLinus Torvalds if (!priv->rx_ring) { 9141da177e4SLinus Torvalds printk(KERN_WARNING "%s: failed to allocate RX ring (%d entries)\n", 9150f485251SShirley Ma ca->name, ipoib_recvq_size); 9161da177e4SLinus Torvalds goto out; 9171da177e4SLinus Torvalds } 9181da177e4SLinus Torvalds 919948579cdSJoe Perches priv->tx_ring = vzalloc(ipoib_sendq_size * sizeof *priv->tx_ring); 9201da177e4SLinus Torvalds if (!priv->tx_ring) { 9211da177e4SLinus Torvalds printk(KERN_WARNING "%s: failed to allocate TX ring (%d entries)\n", 9220f485251SShirley Ma ca->name, ipoib_sendq_size); 9231da177e4SLinus Torvalds goto out_rx_ring_cleanup; 9241da177e4SLinus Torvalds } 9251da177e4SLinus Torvalds 9261b524963SMichael S. Tsirkin /* priv->tx_head, tx_tail & tx_outstanding are already 0 */ 9271da177e4SLinus Torvalds 9281da177e4SLinus Torvalds if (ipoib_ib_dev_init(dev, ca, port)) 9291da177e4SLinus Torvalds goto out_tx_ring_cleanup; 9301da177e4SLinus Torvalds 9311da177e4SLinus Torvalds return 0; 9321da177e4SLinus Torvalds 9331da177e4SLinus Torvalds out_tx_ring_cleanup: 93410313cbbSRoland Dreier vfree(priv->tx_ring); 9351da177e4SLinus Torvalds 9361da177e4SLinus Torvalds out_rx_ring_cleanup: 9371da177e4SLinus Torvalds kfree(priv->rx_ring); 9381da177e4SLinus Torvalds 9391da177e4SLinus Torvalds out: 9401da177e4SLinus Torvalds return -ENOMEM; 9411da177e4SLinus Torvalds } 9421da177e4SLinus Torvalds 9431da177e4SLinus Torvalds void ipoib_dev_cleanup(struct net_device *dev) 9441da177e4SLinus Torvalds { 9451da177e4SLinus Torvalds struct ipoib_dev_priv *priv = netdev_priv(dev), *cpriv, *tcpriv; 9461da177e4SLinus Torvalds 9471732b0efSRoland Dreier ipoib_delete_debug_files(dev); 9481da177e4SLinus Torvalds 9491da177e4SLinus Torvalds /* Delete any child interfaces first */ 9501da177e4SLinus Torvalds list_for_each_entry_safe(cpriv, tcpriv, &priv->child_intfs, list) { 9511da177e4SLinus Torvalds unregister_netdev(cpriv->dev); 9521da177e4SLinus Torvalds ipoib_dev_cleanup(cpriv->dev); 9531da177e4SLinus Torvalds free_netdev(cpriv->dev); 9541da177e4SLinus Torvalds } 9551da177e4SLinus Torvalds 9561da177e4SLinus Torvalds ipoib_ib_dev_cleanup(dev); 9571da177e4SLinus Torvalds 9581da177e4SLinus Torvalds kfree(priv->rx_ring); 95910313cbbSRoland Dreier vfree(priv->tx_ring); 96092a6b34bSHal Rosenstock 96192a6b34bSHal Rosenstock priv->rx_ring = NULL; 9621da177e4SLinus Torvalds priv->tx_ring = NULL; 9631da177e4SLinus Torvalds } 9641da177e4SLinus Torvalds 9653b04dddeSStephen Hemminger static const struct header_ops ipoib_header_ops = { 9663b04dddeSStephen Hemminger .create = ipoib_hard_header, 9673b04dddeSStephen Hemminger }; 9683b04dddeSStephen Hemminger 969fe8114e8SStephen Hemminger static const struct net_device_ops ipoib_netdev_ops = { 970fe8114e8SStephen Hemminger .ndo_open = ipoib_open, 971fe8114e8SStephen Hemminger .ndo_stop = ipoib_stop, 972fe8114e8SStephen Hemminger .ndo_change_mtu = ipoib_change_mtu, 973fe8114e8SStephen Hemminger .ndo_start_xmit = ipoib_start_xmit, 974fe8114e8SStephen Hemminger .ndo_tx_timeout = ipoib_timeout, 975fe8114e8SStephen Hemminger .ndo_set_multicast_list = ipoib_set_mcast_list, 976fe8114e8SStephen Hemminger .ndo_neigh_setup = ipoib_neigh_setup_dev, 977fe8114e8SStephen Hemminger }; 978fe8114e8SStephen Hemminger 9791da177e4SLinus Torvalds static void ipoib_setup(struct net_device *dev) 9801da177e4SLinus Torvalds { 9811da177e4SLinus Torvalds struct ipoib_dev_priv *priv = netdev_priv(dev); 9821da177e4SLinus Torvalds 983fe8114e8SStephen Hemminger dev->netdev_ops = &ipoib_netdev_ops; 9843b04dddeSStephen Hemminger dev->header_ops = &ipoib_header_ops; 985bea3348eSStephen Hemminger 98682c24c18SEli Cohen ipoib_set_ethtool_ops(dev); 98782c24c18SEli Cohen 988bea3348eSStephen Hemminger netif_napi_add(dev, &priv->napi, ipoib_poll, 100); 9891da177e4SLinus Torvalds 9901da177e4SLinus Torvalds dev->watchdog_timeo = HZ; 9911da177e4SLinus Torvalds 9921da177e4SLinus Torvalds dev->flags |= IFF_BROADCAST | IFF_MULTICAST; 9931da177e4SLinus Torvalds 9941da177e4SLinus Torvalds /* 9951da177e4SLinus Torvalds * We add in INFINIBAND_ALEN to allow for the destination 9961da177e4SLinus Torvalds * address "pseudoheader" for skbs without neighbour struct. 9971da177e4SLinus Torvalds */ 9981da177e4SLinus Torvalds dev->hard_header_len = IPOIB_ENCAP_LEN + INFINIBAND_ALEN; 9991da177e4SLinus Torvalds dev->addr_len = INFINIBAND_ALEN; 10001da177e4SLinus Torvalds dev->type = ARPHRD_INFINIBAND; 10010f485251SShirley Ma dev->tx_queue_len = ipoib_sendq_size * 2; 1002eb14032fSEli Cohen dev->features = (NETIF_F_VLAN_CHALLENGED | 1003eb14032fSEli Cohen NETIF_F_HIGHDMA); 100486d15cd8SEric Dumazet dev->priv_flags &= ~IFF_XMIT_DST_RELEASE; 10051da177e4SLinus Torvalds 10061da177e4SLinus Torvalds memcpy(dev->broadcast, ipv4_bcast_addr, INFINIBAND_ALEN); 10071da177e4SLinus Torvalds 10081da177e4SLinus Torvalds netif_carrier_off(dev); 10091da177e4SLinus Torvalds 10101da177e4SLinus Torvalds priv->dev = dev; 10111da177e4SLinus Torvalds 10121da177e4SLinus Torvalds spin_lock_init(&priv->lock); 10131da177e4SLinus Torvalds 101495ed644fSIngo Molnar mutex_init(&priv->vlan_mutex); 10151da177e4SLinus Torvalds 10161da177e4SLinus Torvalds INIT_LIST_HEAD(&priv->path_list); 10171da177e4SLinus Torvalds INIT_LIST_HEAD(&priv->child_intfs); 10181da177e4SLinus Torvalds INIT_LIST_HEAD(&priv->dead_ahs); 10191da177e4SLinus Torvalds INIT_LIST_HEAD(&priv->multicast_list); 10201da177e4SLinus Torvalds 102126bbf13cSYosef Etigin INIT_DELAYED_WORK(&priv->pkey_poll_task, ipoib_pkey_poll); 1022c4028958SDavid Howells INIT_DELAYED_WORK(&priv->mcast_task, ipoib_mcast_join_task); 1023e8224e4bSYossi Etigin INIT_WORK(&priv->carrier_on_task, ipoib_mcast_carrier_on_task); 1024ee1e2c82SMoni Shoua INIT_WORK(&priv->flush_light, ipoib_ib_dev_flush_light); 1025ee1e2c82SMoni Shoua INIT_WORK(&priv->flush_normal, ipoib_ib_dev_flush_normal); 1026ee1e2c82SMoni Shoua INIT_WORK(&priv->flush_heavy, ipoib_ib_dev_flush_heavy); 1027c4028958SDavid Howells INIT_WORK(&priv->restart_task, ipoib_mcast_restart_task); 1028c4028958SDavid Howells INIT_DELAYED_WORK(&priv->ah_reap_task, ipoib_reap_ah); 10291da177e4SLinus Torvalds } 10301da177e4SLinus Torvalds 10311da177e4SLinus Torvalds struct ipoib_dev_priv *ipoib_intf_alloc(const char *name) 10321da177e4SLinus Torvalds { 10331da177e4SLinus Torvalds struct net_device *dev; 10341da177e4SLinus Torvalds 10351da177e4SLinus Torvalds dev = alloc_netdev((int) sizeof (struct ipoib_dev_priv), name, 10361da177e4SLinus Torvalds ipoib_setup); 10371da177e4SLinus Torvalds if (!dev) 10381da177e4SLinus Torvalds return NULL; 10391da177e4SLinus Torvalds 10401da177e4SLinus Torvalds return netdev_priv(dev); 10411da177e4SLinus Torvalds } 10421da177e4SLinus Torvalds 104343cb76d9SGreg Kroah-Hartman static ssize_t show_pkey(struct device *dev, 104443cb76d9SGreg Kroah-Hartman struct device_attribute *attr, char *buf) 10451da177e4SLinus Torvalds { 104643cb76d9SGreg Kroah-Hartman struct ipoib_dev_priv *priv = netdev_priv(to_net_dev(dev)); 10471da177e4SLinus Torvalds 10481da177e4SLinus Torvalds return sprintf(buf, "0x%04x\n", priv->pkey); 10491da177e4SLinus Torvalds } 105043cb76d9SGreg Kroah-Hartman static DEVICE_ATTR(pkey, S_IRUGO, show_pkey, NULL); 10511da177e4SLinus Torvalds 1052335a64a5SOr Gerlitz static ssize_t show_umcast(struct device *dev, 1053335a64a5SOr Gerlitz struct device_attribute *attr, char *buf) 1054335a64a5SOr Gerlitz { 1055335a64a5SOr Gerlitz struct ipoib_dev_priv *priv = netdev_priv(to_net_dev(dev)); 1056335a64a5SOr Gerlitz 1057335a64a5SOr Gerlitz return sprintf(buf, "%d\n", test_bit(IPOIB_FLAG_UMCAST, &priv->flags)); 1058335a64a5SOr Gerlitz } 1059335a64a5SOr Gerlitz 1060335a64a5SOr Gerlitz static ssize_t set_umcast(struct device *dev, 1061335a64a5SOr Gerlitz struct device_attribute *attr, 1062335a64a5SOr Gerlitz const char *buf, size_t count) 1063335a64a5SOr Gerlitz { 1064335a64a5SOr Gerlitz struct ipoib_dev_priv *priv = netdev_priv(to_net_dev(dev)); 1065335a64a5SOr Gerlitz unsigned long umcast_val = simple_strtoul(buf, NULL, 0); 1066335a64a5SOr Gerlitz 1067335a64a5SOr Gerlitz if (umcast_val > 0) { 1068335a64a5SOr Gerlitz set_bit(IPOIB_FLAG_UMCAST, &priv->flags); 1069335a64a5SOr Gerlitz ipoib_warn(priv, "ignoring multicast groups joined directly " 1070335a64a5SOr Gerlitz "by userspace\n"); 1071335a64a5SOr Gerlitz } else 1072335a64a5SOr Gerlitz clear_bit(IPOIB_FLAG_UMCAST, &priv->flags); 1073335a64a5SOr Gerlitz 1074335a64a5SOr Gerlitz return count; 1075335a64a5SOr Gerlitz } 1076335a64a5SOr Gerlitz static DEVICE_ATTR(umcast, S_IWUSR | S_IRUGO, show_umcast, set_umcast); 1077335a64a5SOr Gerlitz 1078335a64a5SOr Gerlitz int ipoib_add_umcast_attr(struct net_device *dev) 1079335a64a5SOr Gerlitz { 1080335a64a5SOr Gerlitz return device_create_file(&dev->dev, &dev_attr_umcast); 1081335a64a5SOr Gerlitz } 1082335a64a5SOr Gerlitz 108343cb76d9SGreg Kroah-Hartman static ssize_t create_child(struct device *dev, 108443cb76d9SGreg Kroah-Hartman struct device_attribute *attr, 10851da177e4SLinus Torvalds const char *buf, size_t count) 10861da177e4SLinus Torvalds { 10871da177e4SLinus Torvalds int pkey; 10881da177e4SLinus Torvalds int ret; 10891da177e4SLinus Torvalds 10901da177e4SLinus Torvalds if (sscanf(buf, "%i", &pkey) != 1) 10911da177e4SLinus Torvalds return -EINVAL; 10921da177e4SLinus Torvalds 10931da177e4SLinus Torvalds if (pkey < 0 || pkey > 0xffff) 10941da177e4SLinus Torvalds return -EINVAL; 10951da177e4SLinus Torvalds 10964ce05937SRoland Dreier /* 10974ce05937SRoland Dreier * Set the full membership bit, so that we join the right 10984ce05937SRoland Dreier * broadcast group, etc. 10994ce05937SRoland Dreier */ 11004ce05937SRoland Dreier pkey |= 0x8000; 11014ce05937SRoland Dreier 110243cb76d9SGreg Kroah-Hartman ret = ipoib_vlan_add(to_net_dev(dev), pkey); 11031da177e4SLinus Torvalds 11041da177e4SLinus Torvalds return ret ? ret : count; 11051da177e4SLinus Torvalds } 11067a52b34bSOr Gerlitz static DEVICE_ATTR(create_child, S_IWUSR, NULL, create_child); 11071da177e4SLinus Torvalds 110843cb76d9SGreg Kroah-Hartman static ssize_t delete_child(struct device *dev, 110943cb76d9SGreg Kroah-Hartman struct device_attribute *attr, 11101da177e4SLinus Torvalds const char *buf, size_t count) 11111da177e4SLinus Torvalds { 11121da177e4SLinus Torvalds int pkey; 11131da177e4SLinus Torvalds int ret; 11141da177e4SLinus Torvalds 11151da177e4SLinus Torvalds if (sscanf(buf, "%i", &pkey) != 1) 11161da177e4SLinus Torvalds return -EINVAL; 11171da177e4SLinus Torvalds 11181da177e4SLinus Torvalds if (pkey < 0 || pkey > 0xffff) 11191da177e4SLinus Torvalds return -EINVAL; 11201da177e4SLinus Torvalds 112143cb76d9SGreg Kroah-Hartman ret = ipoib_vlan_delete(to_net_dev(dev), pkey); 11221da177e4SLinus Torvalds 11231da177e4SLinus Torvalds return ret ? ret : count; 11241da177e4SLinus Torvalds 11251da177e4SLinus Torvalds } 11267a52b34bSOr Gerlitz static DEVICE_ATTR(delete_child, S_IWUSR, NULL, delete_child); 11271da177e4SLinus Torvalds 11281da177e4SLinus Torvalds int ipoib_add_pkey_attr(struct net_device *dev) 11291da177e4SLinus Torvalds { 113043cb76d9SGreg Kroah-Hartman return device_create_file(&dev->dev, &dev_attr_pkey); 11311da177e4SLinus Torvalds } 11321da177e4SLinus Torvalds 113383bb63f6SOr Gerlitz int ipoib_set_dev_features(struct ipoib_dev_priv *priv, struct ib_device *hca) 113483bb63f6SOr Gerlitz { 113583bb63f6SOr Gerlitz struct ib_device_attr *device_attr; 113683bb63f6SOr Gerlitz int result = -ENOMEM; 113783bb63f6SOr Gerlitz 113883bb63f6SOr Gerlitz device_attr = kmalloc(sizeof *device_attr, GFP_KERNEL); 113983bb63f6SOr Gerlitz if (!device_attr) { 114083bb63f6SOr Gerlitz printk(KERN_WARNING "%s: allocation of %zu bytes failed\n", 114183bb63f6SOr Gerlitz hca->name, sizeof *device_attr); 114283bb63f6SOr Gerlitz return result; 114383bb63f6SOr Gerlitz } 114483bb63f6SOr Gerlitz 114583bb63f6SOr Gerlitz result = ib_query_device(hca, device_attr); 114683bb63f6SOr Gerlitz if (result) { 114783bb63f6SOr Gerlitz printk(KERN_WARNING "%s: ib_query_device failed (ret = %d)\n", 114883bb63f6SOr Gerlitz hca->name, result); 114983bb63f6SOr Gerlitz kfree(device_attr); 115083bb63f6SOr Gerlitz return result; 115183bb63f6SOr Gerlitz } 115283bb63f6SOr Gerlitz priv->hca_caps = device_attr->device_cap_flags; 115383bb63f6SOr Gerlitz 115483bb63f6SOr Gerlitz kfree(device_attr); 115583bb63f6SOr Gerlitz 115683bb63f6SOr Gerlitz if (priv->hca_caps & IB_DEVICE_UD_IP_CSUM) { 115783bb63f6SOr Gerlitz set_bit(IPOIB_FLAG_CSUM, &priv->flags); 115883bb63f6SOr Gerlitz priv->dev->features |= NETIF_F_SG | NETIF_F_IP_CSUM; 115983bb63f6SOr Gerlitz } 116083bb63f6SOr Gerlitz 11618ae31e5bSOr Gerlitz priv->dev->features |= NETIF_F_GRO; 11628ae31e5bSOr Gerlitz 116383bb63f6SOr Gerlitz if (priv->dev->features & NETIF_F_SG && priv->hca_caps & IB_DEVICE_UD_TSO) 116483bb63f6SOr Gerlitz priv->dev->features |= NETIF_F_TSO; 116583bb63f6SOr Gerlitz 116683bb63f6SOr Gerlitz return 0; 116783bb63f6SOr Gerlitz } 116883bb63f6SOr Gerlitz 116983bb63f6SOr Gerlitz 11701da177e4SLinus Torvalds static struct net_device *ipoib_add_port(const char *format, 11711da177e4SLinus Torvalds struct ib_device *hca, u8 port) 11721da177e4SLinus Torvalds { 11731da177e4SLinus Torvalds struct ipoib_dev_priv *priv; 1174bc7b3a36SShirley Ma struct ib_port_attr attr; 11751da177e4SLinus Torvalds int result = -ENOMEM; 11761da177e4SLinus Torvalds 11771da177e4SLinus Torvalds priv = ipoib_intf_alloc(format); 11781da177e4SLinus Torvalds if (!priv) 11791da177e4SLinus Torvalds goto alloc_mem_failed; 11801da177e4SLinus Torvalds 11811da177e4SLinus Torvalds SET_NETDEV_DEV(priv->dev, hca->dma_device); 1182c3aa9b18SEli Cohen priv->dev->dev_id = port - 1; 11831da177e4SLinus Torvalds 1184bc7b3a36SShirley Ma if (!ib_query_port(hca, port, &attr)) 1185bc7b3a36SShirley Ma priv->max_ib_mtu = ib_mtu_enum_to_int(attr.max_mtu); 1186bc7b3a36SShirley Ma else { 1187bc7b3a36SShirley Ma printk(KERN_WARNING "%s: ib_query_port %d failed\n", 1188bc7b3a36SShirley Ma hca->name, port); 1189bc7b3a36SShirley Ma goto device_init_failed; 1190bc7b3a36SShirley Ma } 1191bc7b3a36SShirley Ma 1192bc7b3a36SShirley Ma /* MTU will be reset when mcast join happens */ 1193bc7b3a36SShirley Ma priv->dev->mtu = IPOIB_UD_MTU(priv->max_ib_mtu); 1194bc7b3a36SShirley Ma priv->mcast_mtu = priv->admin_mtu = priv->dev->mtu; 1195bc7b3a36SShirley Ma 11961da177e4SLinus Torvalds result = ib_query_pkey(hca, port, 0, &priv->pkey); 11971da177e4SLinus Torvalds if (result) { 11981da177e4SLinus Torvalds printk(KERN_WARNING "%s: ib_query_pkey port %d failed (ret = %d)\n", 11991da177e4SLinus Torvalds hca->name, port, result); 1200ca6de177SEli Cohen goto device_init_failed; 12011da177e4SLinus Torvalds } 12021da177e4SLinus Torvalds 120383bb63f6SOr Gerlitz if (ipoib_set_dev_features(priv, hca)) 12046046136cSEli Cohen goto device_init_failed; 1205af40da89SVladimir Sokolovsky 12064ce05937SRoland Dreier /* 12074ce05937SRoland Dreier * Set the full membership bit, so that we join the right 12084ce05937SRoland Dreier * broadcast group, etc. 12094ce05937SRoland Dreier */ 12104ce05937SRoland Dreier priv->pkey |= 0x8000; 12114ce05937SRoland Dreier 12121da177e4SLinus Torvalds priv->dev->broadcast[8] = priv->pkey >> 8; 12131da177e4SLinus Torvalds priv->dev->broadcast[9] = priv->pkey & 0xff; 12141da177e4SLinus Torvalds 12151da177e4SLinus Torvalds result = ib_query_gid(hca, port, 0, &priv->local_gid); 12161da177e4SLinus Torvalds if (result) { 12171da177e4SLinus Torvalds printk(KERN_WARNING "%s: ib_query_gid port %d failed (ret = %d)\n", 12181da177e4SLinus Torvalds hca->name, port, result); 1219ca6de177SEli Cohen goto device_init_failed; 12201da177e4SLinus Torvalds } else 12211da177e4SLinus Torvalds memcpy(priv->dev->dev_addr + 4, priv->local_gid.raw, sizeof (union ib_gid)); 12221da177e4SLinus Torvalds 12231da177e4SLinus Torvalds result = ipoib_dev_init(priv->dev, hca, port); 12241da177e4SLinus Torvalds if (result < 0) { 12251da177e4SLinus Torvalds printk(KERN_WARNING "%s: failed to initialize port %d (ret = %d)\n", 12261da177e4SLinus Torvalds hca->name, port, result); 12271da177e4SLinus Torvalds goto device_init_failed; 12281da177e4SLinus Torvalds } 12291da177e4SLinus Torvalds 12301da177e4SLinus Torvalds INIT_IB_EVENT_HANDLER(&priv->event_handler, 12311da177e4SLinus Torvalds priv->ca, ipoib_event); 12321da177e4SLinus Torvalds result = ib_register_event_handler(&priv->event_handler); 12331da177e4SLinus Torvalds if (result < 0) { 12341da177e4SLinus Torvalds printk(KERN_WARNING "%s: ib_register_event_handler failed for " 12351da177e4SLinus Torvalds "port %d (ret = %d)\n", 12361da177e4SLinus Torvalds hca->name, port, result); 12371da177e4SLinus Torvalds goto event_failed; 12381da177e4SLinus Torvalds } 12391da177e4SLinus Torvalds 12401da177e4SLinus Torvalds result = register_netdev(priv->dev); 12411da177e4SLinus Torvalds if (result) { 12421da177e4SLinus Torvalds printk(KERN_WARNING "%s: couldn't register ipoib port %d; error %d\n", 12431da177e4SLinus Torvalds hca->name, port, result); 12441da177e4SLinus Torvalds goto register_failed; 12451da177e4SLinus Torvalds } 12461da177e4SLinus Torvalds 12471732b0efSRoland Dreier ipoib_create_debug_files(priv->dev); 12481da177e4SLinus Torvalds 1249839fcabaSMichael S. Tsirkin if (ipoib_cm_add_mode_attr(priv->dev)) 1250839fcabaSMichael S. Tsirkin goto sysfs_failed; 12511da177e4SLinus Torvalds if (ipoib_add_pkey_attr(priv->dev)) 12521da177e4SLinus Torvalds goto sysfs_failed; 1253335a64a5SOr Gerlitz if (ipoib_add_umcast_attr(priv->dev)) 1254335a64a5SOr Gerlitz goto sysfs_failed; 125543cb76d9SGreg Kroah-Hartman if (device_create_file(&priv->dev->dev, &dev_attr_create_child)) 12561da177e4SLinus Torvalds goto sysfs_failed; 125743cb76d9SGreg Kroah-Hartman if (device_create_file(&priv->dev->dev, &dev_attr_delete_child)) 12581da177e4SLinus Torvalds goto sysfs_failed; 12591da177e4SLinus Torvalds 12601da177e4SLinus Torvalds return priv->dev; 12611da177e4SLinus Torvalds 12621da177e4SLinus Torvalds sysfs_failed: 12631732b0efSRoland Dreier ipoib_delete_debug_files(priv->dev); 12641da177e4SLinus Torvalds unregister_netdev(priv->dev); 12651da177e4SLinus Torvalds 12661da177e4SLinus Torvalds register_failed: 12671da177e4SLinus Torvalds ib_unregister_event_handler(&priv->event_handler); 1268a77a57a1SRoland Dreier flush_workqueue(ipoib_workqueue); 12691da177e4SLinus Torvalds 12701da177e4SLinus Torvalds event_failed: 12711da177e4SLinus Torvalds ipoib_dev_cleanup(priv->dev); 12721da177e4SLinus Torvalds 12731da177e4SLinus Torvalds device_init_failed: 12741da177e4SLinus Torvalds free_netdev(priv->dev); 12751da177e4SLinus Torvalds 12761da177e4SLinus Torvalds alloc_mem_failed: 12771da177e4SLinus Torvalds return ERR_PTR(result); 12781da177e4SLinus Torvalds } 12791da177e4SLinus Torvalds 12801da177e4SLinus Torvalds static void ipoib_add_one(struct ib_device *device) 12811da177e4SLinus Torvalds { 12821da177e4SLinus Torvalds struct list_head *dev_list; 12831da177e4SLinus Torvalds struct net_device *dev; 12841da177e4SLinus Torvalds struct ipoib_dev_priv *priv; 12851da177e4SLinus Torvalds int s, e, p; 12861da177e4SLinus Torvalds 128707ebafbaSTom Tucker if (rdma_node_get_transport(device->node_type) != RDMA_TRANSPORT_IB) 128807ebafbaSTom Tucker return; 128907ebafbaSTom Tucker 12901da177e4SLinus Torvalds dev_list = kmalloc(sizeof *dev_list, GFP_KERNEL); 12911da177e4SLinus Torvalds if (!dev_list) 12921da177e4SLinus Torvalds return; 12931da177e4SLinus Torvalds 12941da177e4SLinus Torvalds INIT_LIST_HEAD(dev_list); 12951da177e4SLinus Torvalds 129607ebafbaSTom Tucker if (device->node_type == RDMA_NODE_IB_SWITCH) { 12971da177e4SLinus Torvalds s = 0; 12981da177e4SLinus Torvalds e = 0; 12991da177e4SLinus Torvalds } else { 13001da177e4SLinus Torvalds s = 1; 13011da177e4SLinus Torvalds e = device->phys_port_cnt; 13021da177e4SLinus Torvalds } 13031da177e4SLinus Torvalds 13041da177e4SLinus Torvalds for (p = s; p <= e; ++p) { 13057b4c8769SEli Cohen if (rdma_port_get_link_layer(device, p) != IB_LINK_LAYER_INFINIBAND) 13067b4c8769SEli Cohen continue; 13071da177e4SLinus Torvalds dev = ipoib_add_port("ib%d", device, p); 13081da177e4SLinus Torvalds if (!IS_ERR(dev)) { 13091da177e4SLinus Torvalds priv = netdev_priv(dev); 13101da177e4SLinus Torvalds list_add_tail(&priv->list, dev_list); 13111da177e4SLinus Torvalds } 13121da177e4SLinus Torvalds } 13131da177e4SLinus Torvalds 13141da177e4SLinus Torvalds ib_set_client_data(device, &ipoib_client, dev_list); 13151da177e4SLinus Torvalds } 13161da177e4SLinus Torvalds 13171da177e4SLinus Torvalds static void ipoib_remove_one(struct ib_device *device) 13181da177e4SLinus Torvalds { 13191da177e4SLinus Torvalds struct ipoib_dev_priv *priv, *tmp; 13201da177e4SLinus Torvalds struct list_head *dev_list; 13211da177e4SLinus Torvalds 132207ebafbaSTom Tucker if (rdma_node_get_transport(device->node_type) != RDMA_TRANSPORT_IB) 132307ebafbaSTom Tucker return; 132407ebafbaSTom Tucker 13251da177e4SLinus Torvalds dev_list = ib_get_client_data(device, &ipoib_client); 13261da177e4SLinus Torvalds 13271da177e4SLinus Torvalds list_for_each_entry_safe(priv, tmp, dev_list, list) { 13281da177e4SLinus Torvalds ib_unregister_event_handler(&priv->event_handler); 1329a77a57a1SRoland Dreier 1330a77a57a1SRoland Dreier rtnl_lock(); 1331a77a57a1SRoland Dreier dev_change_flags(priv->dev, priv->dev->flags & ~IFF_UP); 1332a77a57a1SRoland Dreier rtnl_unlock(); 1333a77a57a1SRoland Dreier 1334a77a57a1SRoland Dreier flush_workqueue(ipoib_workqueue); 13351da177e4SLinus Torvalds 13361da177e4SLinus Torvalds unregister_netdev(priv->dev); 13371da177e4SLinus Torvalds ipoib_dev_cleanup(priv->dev); 13381da177e4SLinus Torvalds free_netdev(priv->dev); 13391da177e4SLinus Torvalds } 134006c56e44SMichael S. Tsirkin 134106c56e44SMichael S. Tsirkin kfree(dev_list); 13421da177e4SLinus Torvalds } 13431da177e4SLinus Torvalds 13441da177e4SLinus Torvalds static int __init ipoib_init_module(void) 13451da177e4SLinus Torvalds { 13461da177e4SLinus Torvalds int ret; 13471da177e4SLinus Torvalds 13480f485251SShirley Ma ipoib_recvq_size = roundup_pow_of_two(ipoib_recvq_size); 13490f485251SShirley Ma ipoib_recvq_size = min(ipoib_recvq_size, IPOIB_MAX_QUEUE_SIZE); 13500f485251SShirley Ma ipoib_recvq_size = max(ipoib_recvq_size, IPOIB_MIN_QUEUE_SIZE); 13510f485251SShirley Ma 13520f485251SShirley Ma ipoib_sendq_size = roundup_pow_of_two(ipoib_sendq_size); 13530f485251SShirley Ma ipoib_sendq_size = min(ipoib_sendq_size, IPOIB_MAX_QUEUE_SIZE); 1354732eacc0SHagen Paul Pfeifer ipoib_sendq_size = max3(ipoib_sendq_size, 2 * MAX_SEND_CQE, IPOIB_MIN_QUEUE_SIZE); 135568e995a2SPradeep Satyanarayana #ifdef CONFIG_INFINIBAND_IPOIB_CM 135668e995a2SPradeep Satyanarayana ipoib_max_conn_qp = min(ipoib_max_conn_qp, IPOIB_CM_MAX_CONN_QP); 135768e995a2SPradeep Satyanarayana #endif 13580f485251SShirley Ma 1359f89271daSEli Cohen /* 1360f89271daSEli Cohen * When copying small received packets, we only copy from the 1361f89271daSEli Cohen * linear data part of the SKB, so we rely on this condition. 1362f89271daSEli Cohen */ 1363f89271daSEli Cohen BUILD_BUG_ON(IPOIB_CM_COPYBREAK > IPOIB_CM_HEAD_SIZE); 1364f89271daSEli Cohen 13651da177e4SLinus Torvalds ret = ipoib_register_debugfs(); 13661da177e4SLinus Torvalds if (ret) 13671da177e4SLinus Torvalds return ret; 13681da177e4SLinus Torvalds 13691da177e4SLinus Torvalds /* 13701da177e4SLinus Torvalds * We create our own workqueue mainly because we want to be 13711da177e4SLinus Torvalds * able to flush it when devices are being removed. We can't 13721da177e4SLinus Torvalds * use schedule_work()/flush_scheduled_work() because both 13731da177e4SLinus Torvalds * unregister_netdev() and linkwatch_event take the rtnl lock, 13741da177e4SLinus Torvalds * so flush_scheduled_work() can deadlock during device 13751da177e4SLinus Torvalds * removal. 13761da177e4SLinus Torvalds */ 13771da177e4SLinus Torvalds ipoib_workqueue = create_singlethread_workqueue("ipoib"); 13781da177e4SLinus Torvalds if (!ipoib_workqueue) { 13791da177e4SLinus Torvalds ret = -ENOMEM; 13801da177e4SLinus Torvalds goto err_fs; 13811da177e4SLinus Torvalds } 13821da177e4SLinus Torvalds 1383c1a0b23bSMichael S. Tsirkin ib_sa_register_client(&ipoib_sa_client); 1384c1a0b23bSMichael S. Tsirkin 13851da177e4SLinus Torvalds ret = ib_register_client(&ipoib_client); 13861da177e4SLinus Torvalds if (ret) 1387c1a0b23bSMichael S. Tsirkin goto err_sa; 13881da177e4SLinus Torvalds 13891da177e4SLinus Torvalds return 0; 13901da177e4SLinus Torvalds 1391c1a0b23bSMichael S. Tsirkin err_sa: 1392c1a0b23bSMichael S. Tsirkin ib_sa_unregister_client(&ipoib_sa_client); 13931da177e4SLinus Torvalds destroy_workqueue(ipoib_workqueue); 13941da177e4SLinus Torvalds 13959adec1a8SRoland Dreier err_fs: 13969adec1a8SRoland Dreier ipoib_unregister_debugfs(); 13979adec1a8SRoland Dreier 13981da177e4SLinus Torvalds return ret; 13991da177e4SLinus Torvalds } 14001da177e4SLinus Torvalds 14011da177e4SLinus Torvalds static void __exit ipoib_cleanup_module(void) 14021da177e4SLinus Torvalds { 14031da177e4SLinus Torvalds ib_unregister_client(&ipoib_client); 1404c1a0b23bSMichael S. Tsirkin ib_sa_unregister_client(&ipoib_sa_client); 14059adec1a8SRoland Dreier ipoib_unregister_debugfs(); 14061da177e4SLinus Torvalds destroy_workqueue(ipoib_workqueue); 14071da177e4SLinus Torvalds } 14081da177e4SLinus Torvalds 14091da177e4SLinus Torvalds module_init(ipoib_init_module); 14101da177e4SLinus Torvalds module_exit(ipoib_cleanup_module); 1411