1e689cf4aSJeff Kirsher /* sunvnet.c: Sun LDOM Virtual Network Driver. 2e689cf4aSJeff Kirsher * 3e689cf4aSJeff Kirsher * Copyright (C) 2007, 2008 David S. Miller <davem@davemloft.net> 467d0719fSAaron Young * Copyright (C) 2016 Oracle. All rights reserved. 5e689cf4aSJeff Kirsher */ 6e689cf4aSJeff Kirsher 7e689cf4aSJeff Kirsher #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt 8e689cf4aSJeff Kirsher 9e689cf4aSJeff Kirsher #include <linux/module.h> 10e689cf4aSJeff Kirsher #include <linux/kernel.h> 11e689cf4aSJeff Kirsher #include <linux/types.h> 12e689cf4aSJeff Kirsher #include <linux/slab.h> 13e689cf4aSJeff Kirsher #include <linux/delay.h> 14e689cf4aSJeff Kirsher #include <linux/init.h> 15e689cf4aSJeff Kirsher #include <linux/netdevice.h> 16e689cf4aSJeff Kirsher #include <linux/ethtool.h> 17e689cf4aSJeff Kirsher #include <linux/etherdevice.h> 18e689cf4aSJeff Kirsher #include <linux/mutex.h> 19da38c564SDavid L Stevens #include <linux/highmem.h> 20e4defc77SDavid L Stevens #include <linux/if_vlan.h> 21e689cf4aSJeff Kirsher 22a2b78e9bSDavid L Stevens #if IS_ENABLED(CONFIG_IPV6) 23a2b78e9bSDavid L Stevens #include <linux/icmpv6.h> 24a2b78e9bSDavid L Stevens #endif 25a2b78e9bSDavid L Stevens 266d0ba919SDavid L Stevens #include <net/ip.h> 27a2b78e9bSDavid L Stevens #include <net/icmp.h> 28a2b78e9bSDavid L Stevens #include <net/route.h> 29a2b78e9bSDavid L Stevens 30e689cf4aSJeff Kirsher #include <asm/vio.h> 31e689cf4aSJeff Kirsher #include <asm/ldc.h> 32e689cf4aSJeff Kirsher 3331762eaaSAaron Young #include "sunvnet_common.h" 3431762eaaSAaron Young 3531762eaaSAaron Young /* length of time before we decide the hardware is borked, 3631762eaaSAaron Young * and dev->tx_timeout() should be called to fix the problem 3731762eaaSAaron Young */ 3831762eaaSAaron Young #define VNET_TX_TIMEOUT (5 * HZ) 39e689cf4aSJeff Kirsher 40e689cf4aSJeff Kirsher #define DRV_MODULE_NAME "sunvnet" 41e689cf4aSJeff Kirsher #define DRV_MODULE_VERSION "1.0" 42e689cf4aSJeff Kirsher #define DRV_MODULE_RELDATE "June 25, 2007" 43e689cf4aSJeff Kirsher 44f73d12bdSBill Pemberton static char version[] = 45e689cf4aSJeff Kirsher DRV_MODULE_NAME ".c:v" DRV_MODULE_VERSION " (" DRV_MODULE_RELDATE ")\n"; 46e689cf4aSJeff Kirsher MODULE_AUTHOR("David S. Miller (davem@davemloft.net)"); 47e689cf4aSJeff Kirsher MODULE_DESCRIPTION("Sun LDOM virtual network driver"); 48e689cf4aSJeff Kirsher MODULE_LICENSE("GPL"); 49e689cf4aSJeff Kirsher MODULE_VERSION(DRV_MODULE_VERSION); 50e689cf4aSJeff Kirsher 51e689cf4aSJeff Kirsher /* Ordered from largest major to lowest */ 52e689cf4aSJeff Kirsher static struct vio_version vnet_versions[] = { 536d0ba919SDavid L Stevens { .major = 1, .minor = 8 }, 546d0ba919SDavid L Stevens { .major = 1, .minor = 7 }, 55e4defc77SDavid L Stevens { .major = 1, .minor = 6 }, 56e689cf4aSJeff Kirsher { .major = 1, .minor = 0 }, 57e689cf4aSJeff Kirsher }; 58e689cf4aSJeff Kirsher 59e689cf4aSJeff Kirsher static void vnet_get_drvinfo(struct net_device *dev, 60e689cf4aSJeff Kirsher struct ethtool_drvinfo *info) 61e689cf4aSJeff Kirsher { 627826d43fSJiri Pirko strlcpy(info->driver, DRV_MODULE_NAME, sizeof(info->driver)); 637826d43fSJiri Pirko strlcpy(info->version, DRV_MODULE_VERSION, sizeof(info->version)); 64e689cf4aSJeff Kirsher } 65e689cf4aSJeff Kirsher 66e689cf4aSJeff Kirsher static u32 vnet_get_msglevel(struct net_device *dev) 67e689cf4aSJeff Kirsher { 68e689cf4aSJeff Kirsher struct vnet *vp = netdev_priv(dev); 69dc153f85SAaron Young 70e689cf4aSJeff Kirsher return vp->msg_enable; 71e689cf4aSJeff Kirsher } 72e689cf4aSJeff Kirsher 73e689cf4aSJeff Kirsher static void vnet_set_msglevel(struct net_device *dev, u32 value) 74e689cf4aSJeff Kirsher { 75e689cf4aSJeff Kirsher struct vnet *vp = netdev_priv(dev); 76dc153f85SAaron Young 77e689cf4aSJeff Kirsher vp->msg_enable = value; 78e689cf4aSJeff Kirsher } 79e689cf4aSJeff Kirsher 80e689cf4aSJeff Kirsher static const struct ethtool_ops vnet_ethtool_ops = { 81e689cf4aSJeff Kirsher .get_drvinfo = vnet_get_drvinfo, 82e689cf4aSJeff Kirsher .get_msglevel = vnet_get_msglevel, 83e689cf4aSJeff Kirsher .set_msglevel = vnet_set_msglevel, 84e689cf4aSJeff Kirsher .get_link = ethtool_op_get_link, 85e689cf4aSJeff Kirsher }; 86e689cf4aSJeff Kirsher 87e689cf4aSJeff Kirsher static LIST_HEAD(vnet_list); 88e689cf4aSJeff Kirsher static DEFINE_MUTEX(vnet_list_mutex); 89e689cf4aSJeff Kirsher 9067d0719fSAaron Young static struct vnet_port *__tx_port_find(struct vnet *vp, struct sk_buff *skb) 9167d0719fSAaron Young { 9267d0719fSAaron Young unsigned int hash = vnet_hashfn(skb->data); 9367d0719fSAaron Young struct hlist_head *hp = &vp->port_hash[hash]; 9467d0719fSAaron Young struct vnet_port *port; 9567d0719fSAaron Young 9667d0719fSAaron Young hlist_for_each_entry_rcu(port, hp, hash) { 9767d0719fSAaron Young if (!sunvnet_port_is_up_common(port)) 9867d0719fSAaron Young continue; 9967d0719fSAaron Young if (ether_addr_equal(port->raddr, skb->data)) 10067d0719fSAaron Young return port; 10167d0719fSAaron Young } 10267d0719fSAaron Young list_for_each_entry_rcu(port, &vp->port_list, list) { 10367d0719fSAaron Young if (!port->switch_port) 10467d0719fSAaron Young continue; 10567d0719fSAaron Young if (!sunvnet_port_is_up_common(port)) 10667d0719fSAaron Young continue; 10767d0719fSAaron Young return port; 10867d0719fSAaron Young } 10967d0719fSAaron Young return NULL; 11067d0719fSAaron Young } 11167d0719fSAaron Young 11267d0719fSAaron Young /* func arg to vnet_start_xmit_common() to get the proper tx port */ 11367d0719fSAaron Young static struct vnet_port *vnet_tx_port_find(struct sk_buff *skb, 11467d0719fSAaron Young struct net_device *dev) 11567d0719fSAaron Young { 11667d0719fSAaron Young struct vnet *vp = netdev_priv(dev); 11767d0719fSAaron Young 11867d0719fSAaron Young return __tx_port_find(vp, skb); 11967d0719fSAaron Young } 12067d0719fSAaron Young 12167d0719fSAaron Young static u16 vnet_select_queue(struct net_device *dev, struct sk_buff *skb, 12267d0719fSAaron Young void *accel_priv, select_queue_fallback_t fallback) 12367d0719fSAaron Young { 12467d0719fSAaron Young struct vnet *vp = netdev_priv(dev); 12567d0719fSAaron Young struct vnet_port *port = __tx_port_find(vp, skb); 12667d0719fSAaron Young 12767d0719fSAaron Young if (!port) 12867d0719fSAaron Young return 0; 12967d0719fSAaron Young 13067d0719fSAaron Young return port->q_index; 13167d0719fSAaron Young } 13267d0719fSAaron Young 13367d0719fSAaron Young /* Wrappers to common functions */ 13467d0719fSAaron Young static int vnet_start_xmit(struct sk_buff *skb, struct net_device *dev) 13567d0719fSAaron Young { 13667d0719fSAaron Young return sunvnet_start_xmit_common(skb, dev, vnet_tx_port_find); 13767d0719fSAaron Young } 13867d0719fSAaron Young 13967d0719fSAaron Young static void vnet_set_rx_mode(struct net_device *dev) 14067d0719fSAaron Young { 14167d0719fSAaron Young struct vnet *vp = netdev_priv(dev); 14267d0719fSAaron Young 14367d0719fSAaron Young return sunvnet_set_rx_mode_common(dev, vp); 14467d0719fSAaron Young } 14567d0719fSAaron Young 14667d0719fSAaron Young #ifdef CONFIG_NET_POLL_CONTROLLER 14767d0719fSAaron Young static void vnet_poll_controller(struct net_device *dev) 14867d0719fSAaron Young { 14967d0719fSAaron Young struct vnet *vp = netdev_priv(dev); 15067d0719fSAaron Young 15167d0719fSAaron Young return sunvnet_poll_controller_common(dev, vp); 15267d0719fSAaron Young } 15367d0719fSAaron Young #endif 15467d0719fSAaron Young 155e689cf4aSJeff Kirsher static const struct net_device_ops vnet_ops = { 15631762eaaSAaron Young .ndo_open = sunvnet_open_common, 15731762eaaSAaron Young .ndo_stop = sunvnet_close_common, 15867d0719fSAaron Young .ndo_set_rx_mode = vnet_set_rx_mode, 15931762eaaSAaron Young .ndo_set_mac_address = sunvnet_set_mac_addr_common, 160e689cf4aSJeff Kirsher .ndo_validate_addr = eth_validate_addr, 16131762eaaSAaron Young .ndo_tx_timeout = sunvnet_tx_timeout_common, 16231762eaaSAaron Young .ndo_change_mtu = sunvnet_change_mtu_common, 16367d0719fSAaron Young .ndo_start_xmit = vnet_start_xmit, 16467d0719fSAaron Young .ndo_select_queue = vnet_select_queue, 16569088822SSowmini Varadhan #ifdef CONFIG_NET_POLL_CONTROLLER 16667d0719fSAaron Young .ndo_poll_controller = vnet_poll_controller, 16769088822SSowmini Varadhan #endif 168e689cf4aSJeff Kirsher }; 169e689cf4aSJeff Kirsher 1704c5d283aSSowmini Varadhan static struct vnet *vnet_new(const u64 *local_mac, 1714c5d283aSSowmini Varadhan struct vio_dev *vdev) 172e689cf4aSJeff Kirsher { 173e689cf4aSJeff Kirsher struct net_device *dev; 174e689cf4aSJeff Kirsher struct vnet *vp; 175e689cf4aSJeff Kirsher int err, i; 176e689cf4aSJeff Kirsher 177d51bffd1SSowmini Varadhan dev = alloc_etherdev_mqs(sizeof(*vp), VNET_MAX_TXQS, 1); 17841de8d4cSJoe Perches if (!dev) 179e689cf4aSJeff Kirsher return ERR_PTR(-ENOMEM); 1808e845f4cSDavid L Stevens dev->needed_headroom = VNET_PACKET_SKIP + 8; 1818e845f4cSDavid L Stevens dev->needed_tailroom = 8; 182e689cf4aSJeff Kirsher 183e689cf4aSJeff Kirsher for (i = 0; i < ETH_ALEN; i++) 184e689cf4aSJeff Kirsher dev->dev_addr[i] = (*local_mac >> (5 - i) * 8) & 0xff; 185e689cf4aSJeff Kirsher 186e689cf4aSJeff Kirsher vp = netdev_priv(dev); 187e689cf4aSJeff Kirsher 188e689cf4aSJeff Kirsher spin_lock_init(&vp->lock); 189e689cf4aSJeff Kirsher vp->dev = dev; 190e689cf4aSJeff Kirsher 191e689cf4aSJeff Kirsher INIT_LIST_HEAD(&vp->port_list); 192e689cf4aSJeff Kirsher for (i = 0; i < VNET_PORT_HASH_SIZE; i++) 193e689cf4aSJeff Kirsher INIT_HLIST_HEAD(&vp->port_hash[i]); 194e689cf4aSJeff Kirsher INIT_LIST_HEAD(&vp->list); 195e689cf4aSJeff Kirsher vp->local_mac = *local_mac; 196e689cf4aSJeff Kirsher 197e689cf4aSJeff Kirsher dev->netdev_ops = &vnet_ops; 198e689cf4aSJeff Kirsher dev->ethtool_ops = &vnet_ethtool_ops; 199e689cf4aSJeff Kirsher dev->watchdog_timeo = VNET_TX_TIMEOUT; 200e689cf4aSJeff Kirsher 201368e36edSDavid L Stevens dev->hw_features = NETIF_F_TSO | NETIF_F_GSO | NETIF_F_GSO_SOFTWARE | 2029a72dd4dSDavid L Stevens NETIF_F_HW_CSUM | NETIF_F_SG; 203da38c564SDavid L Stevens dev->features = dev->hw_features; 204da38c564SDavid L Stevens 2054c5d283aSSowmini Varadhan SET_NETDEV_DEV(dev, &vdev->dev); 2064c5d283aSSowmini Varadhan 207e689cf4aSJeff Kirsher err = register_netdev(dev); 208e689cf4aSJeff Kirsher if (err) { 209e689cf4aSJeff Kirsher pr_err("Cannot register net device, aborting\n"); 210e689cf4aSJeff Kirsher goto err_out_free_dev; 211e689cf4aSJeff Kirsher } 212e689cf4aSJeff Kirsher 213e689cf4aSJeff Kirsher netdev_info(dev, "Sun LDOM vnet %pM\n", dev->dev_addr); 214e689cf4aSJeff Kirsher 215e689cf4aSJeff Kirsher list_add(&vp->list, &vnet_list); 216e689cf4aSJeff Kirsher 217e689cf4aSJeff Kirsher return vp; 218e689cf4aSJeff Kirsher 219e689cf4aSJeff Kirsher err_out_free_dev: 220e689cf4aSJeff Kirsher free_netdev(dev); 221e689cf4aSJeff Kirsher 222e689cf4aSJeff Kirsher return ERR_PTR(err); 223e689cf4aSJeff Kirsher } 224e689cf4aSJeff Kirsher 2254c5d283aSSowmini Varadhan static struct vnet *vnet_find_or_create(const u64 *local_mac, 2264c5d283aSSowmini Varadhan struct vio_dev *vdev) 227e689cf4aSJeff Kirsher { 228e689cf4aSJeff Kirsher struct vnet *iter, *vp; 229e689cf4aSJeff Kirsher 230e689cf4aSJeff Kirsher mutex_lock(&vnet_list_mutex); 231e689cf4aSJeff Kirsher vp = NULL; 232e689cf4aSJeff Kirsher list_for_each_entry(iter, &vnet_list, list) { 233e689cf4aSJeff Kirsher if (iter->local_mac == *local_mac) { 234e689cf4aSJeff Kirsher vp = iter; 235e689cf4aSJeff Kirsher break; 236e689cf4aSJeff Kirsher } 237e689cf4aSJeff Kirsher } 238e689cf4aSJeff Kirsher if (!vp) 2394c5d283aSSowmini Varadhan vp = vnet_new(local_mac, vdev); 240e689cf4aSJeff Kirsher mutex_unlock(&vnet_list_mutex); 241e689cf4aSJeff Kirsher 242e689cf4aSJeff Kirsher return vp; 243e689cf4aSJeff Kirsher } 244e689cf4aSJeff Kirsher 245a4b70a07SSowmini Varadhan static void vnet_cleanup(void) 246a4b70a07SSowmini Varadhan { 247a4b70a07SSowmini Varadhan struct vnet *vp; 248a4b70a07SSowmini Varadhan struct net_device *dev; 249a4b70a07SSowmini Varadhan 250a4b70a07SSowmini Varadhan mutex_lock(&vnet_list_mutex); 251a4b70a07SSowmini Varadhan while (!list_empty(&vnet_list)) { 252a4b70a07SSowmini Varadhan vp = list_first_entry(&vnet_list, struct vnet, list); 253a4b70a07SSowmini Varadhan list_del(&vp->list); 254a4b70a07SSowmini Varadhan dev = vp->dev; 255a4b70a07SSowmini Varadhan /* vio_unregister_driver() should have cleaned up port_list */ 256a4b70a07SSowmini Varadhan BUG_ON(!list_empty(&vp->port_list)); 257a4b70a07SSowmini Varadhan unregister_netdev(dev); 258a4b70a07SSowmini Varadhan free_netdev(dev); 259a4b70a07SSowmini Varadhan } 260a4b70a07SSowmini Varadhan mutex_unlock(&vnet_list_mutex); 261a4b70a07SSowmini Varadhan } 262a4b70a07SSowmini Varadhan 263e689cf4aSJeff Kirsher static const char *local_mac_prop = "local-mac-address"; 264e689cf4aSJeff Kirsher 265f73d12bdSBill Pemberton static struct vnet *vnet_find_parent(struct mdesc_handle *hp, 2664c5d283aSSowmini Varadhan u64 port_node, 2674c5d283aSSowmini Varadhan struct vio_dev *vdev) 268e689cf4aSJeff Kirsher { 269e689cf4aSJeff Kirsher const u64 *local_mac = NULL; 270e689cf4aSJeff Kirsher u64 a; 271e689cf4aSJeff Kirsher 272e689cf4aSJeff Kirsher mdesc_for_each_arc(a, hp, port_node, MDESC_ARC_TYPE_BACK) { 273e689cf4aSJeff Kirsher u64 target = mdesc_arc_target(hp, a); 274e689cf4aSJeff Kirsher const char *name; 275e689cf4aSJeff Kirsher 276e689cf4aSJeff Kirsher name = mdesc_get_property(hp, target, "name", NULL); 277e689cf4aSJeff Kirsher if (!name || strcmp(name, "network")) 278e689cf4aSJeff Kirsher continue; 279e689cf4aSJeff Kirsher 280e689cf4aSJeff Kirsher local_mac = mdesc_get_property(hp, target, 281e689cf4aSJeff Kirsher local_mac_prop, NULL); 282e689cf4aSJeff Kirsher if (local_mac) 283e689cf4aSJeff Kirsher break; 284e689cf4aSJeff Kirsher } 285e689cf4aSJeff Kirsher if (!local_mac) 286e689cf4aSJeff Kirsher return ERR_PTR(-ENODEV); 287e689cf4aSJeff Kirsher 2884c5d283aSSowmini Varadhan return vnet_find_or_create(local_mac, vdev); 289e689cf4aSJeff Kirsher } 290e689cf4aSJeff Kirsher 291e689cf4aSJeff Kirsher static struct ldc_channel_config vnet_ldc_cfg = { 29231762eaaSAaron Young .event = sunvnet_event_common, 293e689cf4aSJeff Kirsher .mtu = 64, 294e689cf4aSJeff Kirsher .mode = LDC_MODE_UNRELIABLE, 295e689cf4aSJeff Kirsher }; 296e689cf4aSJeff Kirsher 297e689cf4aSJeff Kirsher static struct vio_driver_ops vnet_vio_ops = { 29831762eaaSAaron Young .send_attr = sunvnet_send_attr_common, 29931762eaaSAaron Young .handle_attr = sunvnet_handle_attr_common, 30031762eaaSAaron Young .handshake_complete = sunvnet_handshake_complete_common, 301e689cf4aSJeff Kirsher }; 302e689cf4aSJeff Kirsher 303f73d12bdSBill Pemberton static void print_version(void) 304e689cf4aSJeff Kirsher { 305e689cf4aSJeff Kirsher printk_once(KERN_INFO "%s", version); 306e689cf4aSJeff Kirsher } 307e689cf4aSJeff Kirsher 308e689cf4aSJeff Kirsher const char *remote_macaddr_prop = "remote-mac-address"; 309e689cf4aSJeff Kirsher 3101dd06ae8SGreg Kroah-Hartman static int vnet_port_probe(struct vio_dev *vdev, const struct vio_device_id *id) 311e689cf4aSJeff Kirsher { 312e689cf4aSJeff Kirsher struct mdesc_handle *hp; 313e689cf4aSJeff Kirsher struct vnet_port *port; 314e689cf4aSJeff Kirsher unsigned long flags; 315e689cf4aSJeff Kirsher struct vnet *vp; 316e689cf4aSJeff Kirsher const u64 *rmac; 317e689cf4aSJeff Kirsher int len, i, err, switch_port; 318e689cf4aSJeff Kirsher 319e689cf4aSJeff Kirsher print_version(); 320e689cf4aSJeff Kirsher 321e689cf4aSJeff Kirsher hp = mdesc_grab(); 322e689cf4aSJeff Kirsher 3234c5d283aSSowmini Varadhan vp = vnet_find_parent(hp, vdev->mp, vdev); 324e689cf4aSJeff Kirsher if (IS_ERR(vp)) { 325e689cf4aSJeff Kirsher pr_err("Cannot find port parent vnet\n"); 326e689cf4aSJeff Kirsher err = PTR_ERR(vp); 327e689cf4aSJeff Kirsher goto err_out_put_mdesc; 328e689cf4aSJeff Kirsher } 329e689cf4aSJeff Kirsher 330e689cf4aSJeff Kirsher rmac = mdesc_get_property(hp, vdev->mp, remote_macaddr_prop, &len); 331e689cf4aSJeff Kirsher err = -ENODEV; 332e689cf4aSJeff Kirsher if (!rmac) { 333e689cf4aSJeff Kirsher pr_err("Port lacks %s property\n", remote_macaddr_prop); 334e689cf4aSJeff Kirsher goto err_out_put_mdesc; 335e689cf4aSJeff Kirsher } 336e689cf4aSJeff Kirsher 337e689cf4aSJeff Kirsher port = kzalloc(sizeof(*port), GFP_KERNEL); 338e689cf4aSJeff Kirsher err = -ENOMEM; 339e404decbSJoe Perches if (!port) 340e689cf4aSJeff Kirsher goto err_out_put_mdesc; 341e689cf4aSJeff Kirsher 342e689cf4aSJeff Kirsher for (i = 0; i < ETH_ALEN; i++) 343e689cf4aSJeff Kirsher port->raddr[i] = (*rmac >> (5 - i) * 8) & 0xff; 344e689cf4aSJeff Kirsher 345e689cf4aSJeff Kirsher port->vp = vp; 346e689cf4aSJeff Kirsher 347e689cf4aSJeff Kirsher err = vio_driver_init(&port->vio, vdev, VDEV_NETWORK, 348e689cf4aSJeff Kirsher vnet_versions, ARRAY_SIZE(vnet_versions), 349e689cf4aSJeff Kirsher &vnet_vio_ops, vp->dev->name); 350e689cf4aSJeff Kirsher if (err) 351e689cf4aSJeff Kirsher goto err_out_free_port; 352e689cf4aSJeff Kirsher 353e689cf4aSJeff Kirsher err = vio_ldc_alloc(&port->vio, &vnet_ldc_cfg, port); 354e689cf4aSJeff Kirsher if (err) 355e689cf4aSJeff Kirsher goto err_out_free_port; 356e689cf4aSJeff Kirsher 35731762eaaSAaron Young netif_napi_add(port->vp->dev, &port->napi, sunvnet_poll_common, 35831762eaaSAaron Young NAPI_POLL_WEIGHT); 35969088822SSowmini Varadhan 360e689cf4aSJeff Kirsher INIT_HLIST_NODE(&port->hash); 361e689cf4aSJeff Kirsher INIT_LIST_HEAD(&port->list); 362e689cf4aSJeff Kirsher 363e689cf4aSJeff Kirsher switch_port = 0; 364dc153f85SAaron Young if (mdesc_get_property(hp, vdev->mp, "switch-port", NULL)) 365e689cf4aSJeff Kirsher switch_port = 1; 366e689cf4aSJeff Kirsher port->switch_port = switch_port; 367368e36edSDavid L Stevens port->tso = true; 368368e36edSDavid L Stevens port->tsolen = 0; 369e689cf4aSJeff Kirsher 370e689cf4aSJeff Kirsher spin_lock_irqsave(&vp->lock, flags); 371e689cf4aSJeff Kirsher if (switch_port) 3722a968dd8SSowmini Varadhan list_add_rcu(&port->list, &vp->port_list); 373e689cf4aSJeff Kirsher else 3742a968dd8SSowmini Varadhan list_add_tail_rcu(&port->list, &vp->port_list); 3752a968dd8SSowmini Varadhan hlist_add_head_rcu(&port->hash, 3762a968dd8SSowmini Varadhan &vp->port_hash[vnet_hashfn(port->raddr)]); 37731762eaaSAaron Young sunvnet_port_add_txq_common(port); 378e689cf4aSJeff Kirsher spin_unlock_irqrestore(&vp->lock, flags); 379e689cf4aSJeff Kirsher 380e689cf4aSJeff Kirsher dev_set_drvdata(&vdev->dev, port); 381e689cf4aSJeff Kirsher 382e689cf4aSJeff Kirsher pr_info("%s: PORT ( remote-mac %pM%s )\n", 383e689cf4aSJeff Kirsher vp->dev->name, port->raddr, switch_port ? " switch-port" : ""); 384e689cf4aSJeff Kirsher 38531762eaaSAaron Young setup_timer(&port->clean_timer, sunvnet_clean_timer_expire_common, 3868e845f4cSDavid L Stevens (unsigned long)port); 3878e845f4cSDavid L Stevens 38869088822SSowmini Varadhan napi_enable(&port->napi); 389e689cf4aSJeff Kirsher vio_port_up(&port->vio); 390e689cf4aSJeff Kirsher 391e689cf4aSJeff Kirsher mdesc_release(hp); 392e689cf4aSJeff Kirsher 393e689cf4aSJeff Kirsher return 0; 394e689cf4aSJeff Kirsher 395e689cf4aSJeff Kirsher err_out_free_port: 396e689cf4aSJeff Kirsher kfree(port); 397e689cf4aSJeff Kirsher 398e689cf4aSJeff Kirsher err_out_put_mdesc: 399e689cf4aSJeff Kirsher mdesc_release(hp); 400e689cf4aSJeff Kirsher return err; 401e689cf4aSJeff Kirsher } 402e689cf4aSJeff Kirsher 403e689cf4aSJeff Kirsher static int vnet_port_remove(struct vio_dev *vdev) 404e689cf4aSJeff Kirsher { 405e689cf4aSJeff Kirsher struct vnet_port *port = dev_get_drvdata(&vdev->dev); 406e689cf4aSJeff Kirsher 407e689cf4aSJeff Kirsher if (port) { 408e689cf4aSJeff Kirsher del_timer_sync(&port->vio.timer); 409e689cf4aSJeff Kirsher 41069088822SSowmini Varadhan napi_disable(&port->napi); 411e689cf4aSJeff Kirsher 4122a968dd8SSowmini Varadhan list_del_rcu(&port->list); 4132a968dd8SSowmini Varadhan hlist_del_rcu(&port->hash); 4142a968dd8SSowmini Varadhan 4152a968dd8SSowmini Varadhan synchronize_rcu(); 4162a968dd8SSowmini Varadhan del_timer_sync(&port->clean_timer); 41731762eaaSAaron Young sunvnet_port_rm_txq_common(port); 41869088822SSowmini Varadhan netif_napi_del(&port->napi); 41931762eaaSAaron Young sunvnet_port_free_tx_bufs_common(port); 420e689cf4aSJeff Kirsher vio_ldc_free(&port->vio); 421e689cf4aSJeff Kirsher 422e689cf4aSJeff Kirsher dev_set_drvdata(&vdev->dev, NULL); 423e689cf4aSJeff Kirsher 424e689cf4aSJeff Kirsher kfree(port); 425e689cf4aSJeff Kirsher } 426e689cf4aSJeff Kirsher return 0; 427e689cf4aSJeff Kirsher } 428e689cf4aSJeff Kirsher 429e689cf4aSJeff Kirsher static const struct vio_device_id vnet_port_match[] = { 430e689cf4aSJeff Kirsher { 431e689cf4aSJeff Kirsher .type = "vnet-port", 432e689cf4aSJeff Kirsher }, 433e689cf4aSJeff Kirsher {}, 434e689cf4aSJeff Kirsher }; 435e689cf4aSJeff Kirsher MODULE_DEVICE_TABLE(vio, vnet_port_match); 436e689cf4aSJeff Kirsher 437e689cf4aSJeff Kirsher static struct vio_driver vnet_port_driver = { 438e689cf4aSJeff Kirsher .id_table = vnet_port_match, 439e689cf4aSJeff Kirsher .probe = vnet_port_probe, 440e689cf4aSJeff Kirsher .remove = vnet_port_remove, 441e689cf4aSJeff Kirsher .name = "vnet_port", 442e689cf4aSJeff Kirsher }; 443e689cf4aSJeff Kirsher 444e689cf4aSJeff Kirsher static int __init vnet_init(void) 445e689cf4aSJeff Kirsher { 446e689cf4aSJeff Kirsher return vio_register_driver(&vnet_port_driver); 447e689cf4aSJeff Kirsher } 448e689cf4aSJeff Kirsher 449e689cf4aSJeff Kirsher static void __exit vnet_exit(void) 450e689cf4aSJeff Kirsher { 451e689cf4aSJeff Kirsher vio_unregister_driver(&vnet_port_driver); 452a4b70a07SSowmini Varadhan vnet_cleanup(); 453e689cf4aSJeff Kirsher } 454e689cf4aSJeff Kirsher 455e689cf4aSJeff Kirsher module_init(vnet_init); 456e689cf4aSJeff Kirsher module_exit(vnet_exit); 457