drivers/net/ethernet/aquantia/atlantic/aq_main.c

   1 /*
   2  * aQuantia Corporation Network Driver
   3  * Copyright (C) 2014-2017 aQuantia Corporation. All rights reserved
   4  *
   5  * This program is free software; you can redistribute it and/or modify it
   6  * under the terms and conditions of the GNU General Public License,
   7  * version 2, as published by the Free Software Foundation.
   8  */
   9
  10 /* File aq_main.c: Main file for aQuantia Linux driver. */
  11
  12 #include "aq_main.h"
  13 #include "aq_nic.h"
  14 #include "aq_pci_func.h"
  15 #include "aq_ethtool.h"
  16 #include "hw_atl/hw_atl_a0.h"
  17 #include "hw_atl/hw_atl_b0.h"
  18
  19 #include <linux/netdevice.h>
  20 #include <linux/module.h>
  21
  22 static const struct pci_device_id aq_pci_tbl[] = {
  23         { PCI_VDEVICE(AQUANTIA, HW_ATL_DEVICE_ID_0001), },
  24         { PCI_VDEVICE(AQUANTIA, HW_ATL_DEVICE_ID_D100), },
  25         { PCI_VDEVICE(AQUANTIA, HW_ATL_DEVICE_ID_D107), },
  26         { PCI_VDEVICE(AQUANTIA, HW_ATL_DEVICE_ID_D108), },
  27         { PCI_VDEVICE(AQUANTIA, HW_ATL_DEVICE_ID_D109), },
  28         {}
  29 };
  30
  31 MODULE_DEVICE_TABLE(pci, aq_pci_tbl);
  32
  33 MODULE_LICENSE("GPL v2");
  34 MODULE_VERSION(AQ_CFG_DRV_VERSION);
  35 MODULE_AUTHOR(AQ_CFG_DRV_AUTHOR);
  36 MODULE_DESCRIPTION(AQ_CFG_DRV_DESC);
  37
  38 static struct aq_hw_ops *aq_pci_probe_get_hw_ops_by_id(struct pci_dev *pdev)
  39 {
  40         struct aq_hw_ops *ops = NULL;
  41
  42         ops = hw_atl_a0_get_ops_by_id(pdev);
  43         if (!ops)
  44                 ops = hw_atl_b0_get_ops_by_id(pdev);
  45
  46         return ops;
  47 }
  48
  49 static int aq_ndev_open(struct net_device *ndev)
  50 {
  51         struct aq_nic_s *aq_nic = NULL;
  52         int err = 0;
  53
  54         aq_nic = aq_nic_alloc_hot(ndev);
  55         if (!aq_nic) {
  56                 err = -ENOMEM;
  57                 goto err_exit;
  58         }
  59         err = aq_nic_init(aq_nic);
  60         if (err < 0)
  61                 goto err_exit;
  62         err = aq_nic_start(aq_nic);
  63         if (err < 0)
  64                 goto err_exit;
  65
  66 err_exit:
  67         if (err < 0)
  68                 aq_nic_deinit(aq_nic);
  69         return err;
  70 }
  71
  72 static int aq_ndev_close(struct net_device *ndev)
  73 {
  74         int err = 0;
  75         struct aq_nic_s *aq_nic = netdev_priv(ndev);
  76
  77         err = aq_nic_stop(aq_nic);
  78         if (err < 0)
  79                 goto err_exit;
  80         aq_nic_deinit(aq_nic);
  81         aq_nic_free_hot_resources(aq_nic);
  82
  83 err_exit:
  84         return err;
  85 }
  86
  87 static int aq_ndev_start_xmit(struct sk_buff *skb, struct net_device *ndev)
  88 {
  89         struct aq_nic_s *aq_nic = netdev_priv(ndev);
  90
  91         return aq_nic_xmit(aq_nic, skb);
  92 }
  93
  94 static int aq_ndev_change_mtu(struct net_device *ndev, int new_mtu)
  95 {
  96         struct aq_nic_s *aq_nic = netdev_priv(ndev);
  97         int err = aq_nic_set_mtu(aq_nic, new_mtu + ETH_HLEN);
  98
  99         if (err < 0)
 100                 goto err_exit;
 101         ndev->mtu = new_mtu;
 102
 103         if (netif_running(ndev)) {
 104                 aq_ndev_close(ndev);
 105                 aq_ndev_open(ndev);
 106         }
 107
 108 err_exit:
 109         return err;
 110 }
 111
 112 static int aq_ndev_set_features(struct net_device *ndev,
 113                                 netdev_features_t features)
 114 {
 115         struct aq_nic_s *aq_nic = netdev_priv(ndev);
 116         struct aq_nic_cfg_s *aq_cfg = aq_nic_get_cfg(aq_nic);
 117         bool is_lro = false;
 118
 119         if (aq_cfg->hw_features & NETIF_F_LRO) {
 120                 is_lro = features & NETIF_F_LRO;
 121
 122                 if (aq_cfg->is_lro != is_lro) {
 123                         aq_cfg->is_lro = is_lro;
 124
 125                         if (netif_running(ndev)) {
 126                                 aq_ndev_close(ndev);
 127                                 aq_ndev_open(ndev);
 128                         }
 129                 }
 130         }
 131
 132         return 0;
 133 }
 134
 135 static int aq_ndev_set_mac_address(struct net_device *ndev, void *addr)
 136 {
 137         struct aq_nic_s *aq_nic = netdev_priv(ndev);
 138         int err = 0;
 139
 140         err = eth_mac_addr(ndev, addr);
 141         if (err < 0)
 142                 goto err_exit;
 143         err = aq_nic_set_mac(aq_nic, ndev);
 144         if (err < 0)
 145                 goto err_exit;
 146
 147 err_exit:
 148         return err;
 149 }
 150
 151 static void aq_ndev_set_multicast_settings(struct net_device *ndev)
 152 {
 153         struct aq_nic_s *aq_nic = netdev_priv(ndev);
 154         int err = 0;
 155
 156         err = aq_nic_set_packet_filter(aq_nic, ndev->flags);
 157         if (err < 0)
 158                 goto err_exit;
 159
 160         if (netdev_mc_count(ndev)) {
 161                 err = aq_nic_set_multicast_list(aq_nic, ndev);
 162                 if (err < 0)
 163                         goto err_exit;
 164         }
 165
 166 err_exit:;
 167 }
 168
 169 static const struct net_device_ops aq_ndev_ops = {
 170         .ndo_open = aq_ndev_open,
 171         .ndo_stop = aq_ndev_close,
 172         .ndo_start_xmit = aq_ndev_start_xmit,
 173         .ndo_set_rx_mode = aq_ndev_set_multicast_settings,
 174         .ndo_change_mtu = aq_ndev_change_mtu,
 175         .ndo_set_mac_address = aq_ndev_set_mac_address,
 176         .ndo_set_features = aq_ndev_set_features
 177 };
 178
 179 static int aq_pci_probe(struct pci_dev *pdev,
 180                         const struct pci_device_id *pci_id)
 181 {
 182         struct aq_hw_ops *aq_hw_ops = NULL;
 183         struct aq_pci_func_s *aq_pci_func = NULL;
 184         int err = 0;
 185
 186         err = pci_enable_device(pdev);
 187         if (err < 0)
 188                 goto err_exit;
 189         aq_hw_ops = aq_pci_probe_get_hw_ops_by_id(pdev);
 190         aq_pci_func = aq_pci_func_alloc(aq_hw_ops, pdev,
 191                                         &aq_ndev_ops, &aq_ethtool_ops);
 192         if (!aq_pci_func) {
 193                 err = -ENOMEM;
 194                 goto err_exit;
 195         }
 196         err = aq_pci_func_init(aq_pci_func);
 197         if (err < 0)
 198                 goto err_exit;
 199
 200 err_exit:
 201         if (err < 0) {
 202                 if (aq_pci_func)
 203                         aq_pci_func_free(aq_pci_func);
 204         }
 205         return err;
 206 }
 207
 208 static void aq_pci_remove(struct pci_dev *pdev)
 209 {
 210         struct aq_pci_func_s *aq_pci_func = pci_get_drvdata(pdev);
 211
 212         aq_pci_func_deinit(aq_pci_func);
 213         aq_pci_func_free(aq_pci_func);
 214 }
 215
 216 static int aq_pci_suspend(struct pci_dev *pdev, pm_message_t pm_msg)
 217 {
 218         struct aq_pci_func_s *aq_pci_func = pci_get_drvdata(pdev);
 219
 220         return aq_pci_func_change_pm_state(aq_pci_func, &pm_msg);
 221 }
 222
 223 static int aq_pci_resume(struct pci_dev *pdev)
 224 {
 225         struct aq_pci_func_s *aq_pci_func = pci_get_drvdata(pdev);
 226         pm_message_t pm_msg = PMSG_RESTORE;
 227
 228         return aq_pci_func_change_pm_state(aq_pci_func, &pm_msg);
 229 }
 230
 231 static struct pci_driver aq_pci_ops = {
 232         .name = AQ_CFG_DRV_NAME,
 233         .id_table = aq_pci_tbl,
 234         .probe = aq_pci_probe,
 235         .remove = aq_pci_remove,
 236         .suspend = aq_pci_suspend,
 237         .resume = aq_pci_resume,
 238 };
 239
 240 module_pci_driver(aq_pci_ops);