1 // SPDX-License-Identifier: GPL-2.0
2 /* Copyright (c) 2015 - 2023 Beijing WangXun Technology Co., Ltd. */
3
4 #include <linux/pci.h>
5 #include <linux/phy.h>
6 #include <linux/netdevice.h>
7
8 #include "../libwx/wx_ethtool.h"
9 #include "../libwx/wx_type.h"
10 #include "../libwx/wx_lib.h"
11 #include "../libwx/wx_hw.h"
12 #include "ngbe_ethtool.h"
13 #include "ngbe_type.h"
14
ngbe_get_wol(struct net_device * netdev,struct ethtool_wolinfo * wol)15 static void ngbe_get_wol(struct net_device *netdev,
16 struct ethtool_wolinfo *wol)
17 {
18 struct wx *wx = netdev_priv(netdev);
19
20 if (!wx->wol_hw_supported)
21 return;
22 wol->supported = WAKE_MAGIC;
23 wol->wolopts = 0;
24 if (wx->wol & WX_PSR_WKUP_CTL_MAG)
25 wol->wolopts |= WAKE_MAGIC;
26 }
27
ngbe_set_wol(struct net_device * netdev,struct ethtool_wolinfo * wol)28 static int ngbe_set_wol(struct net_device *netdev,
29 struct ethtool_wolinfo *wol)
30 {
31 struct wx *wx = netdev_priv(netdev);
32 struct pci_dev *pdev = wx->pdev;
33
34 if (!wx->wol_hw_supported)
35 return -EOPNOTSUPP;
36
37 wx->wol = 0;
38 if (wol->wolopts & WAKE_MAGIC)
39 wx->wol = WX_PSR_WKUP_CTL_MAG;
40 netdev->ethtool->wol_enabled = !!(wx->wol);
41 wr32(wx, WX_PSR_WKUP_CTL, wx->wol);
42 device_set_wakeup_enable(&pdev->dev, netdev->ethtool->wol_enabled);
43
44 return 0;
45 }
46
ngbe_set_ringparam(struct net_device * netdev,struct ethtool_ringparam * ring,struct kernel_ethtool_ringparam * kernel_ring,struct netlink_ext_ack * extack)47 static int ngbe_set_ringparam(struct net_device *netdev,
48 struct ethtool_ringparam *ring,
49 struct kernel_ethtool_ringparam *kernel_ring,
50 struct netlink_ext_ack *extack)
51 {
52 struct wx *wx = netdev_priv(netdev);
53 u32 new_rx_count, new_tx_count;
54 struct wx_ring *temp_ring;
55 int i, err = 0;
56
57 new_tx_count = clamp_t(u32, ring->tx_pending, WX_MIN_TXD, WX_MAX_TXD);
58 new_tx_count = ALIGN(new_tx_count, WX_REQ_TX_DESCRIPTOR_MULTIPLE);
59
60 new_rx_count = clamp_t(u32, ring->rx_pending, WX_MIN_RXD, WX_MAX_RXD);
61 new_rx_count = ALIGN(new_rx_count, WX_REQ_RX_DESCRIPTOR_MULTIPLE);
62
63 if (new_tx_count == wx->tx_ring_count &&
64 new_rx_count == wx->rx_ring_count)
65 return 0;
66
67 err = wx_set_state_reset(wx);
68 if (err)
69 return err;
70
71 if (!netif_running(wx->netdev)) {
72 for (i = 0; i < wx->num_tx_queues; i++)
73 wx->tx_ring[i]->count = new_tx_count;
74 for (i = 0; i < wx->num_rx_queues; i++)
75 wx->rx_ring[i]->count = new_rx_count;
76 wx->tx_ring_count = new_tx_count;
77 wx->rx_ring_count = new_rx_count;
78
79 goto clear_reset;
80 }
81
82 /* allocate temporary buffer to store rings in */
83 i = max_t(int, wx->num_tx_queues, wx->num_rx_queues);
84 temp_ring = kvmalloc_array(i, sizeof(struct wx_ring), GFP_KERNEL);
85 if (!temp_ring) {
86 err = -ENOMEM;
87 goto clear_reset;
88 }
89
90 ngbe_down(wx);
91
92 wx_set_ring(wx, new_tx_count, new_rx_count, temp_ring);
93 kvfree(temp_ring);
94
95 wx_configure(wx);
96 ngbe_up(wx);
97
98 clear_reset:
99 clear_bit(WX_STATE_RESETTING, wx->state);
100 return err;
101 }
102
ngbe_set_channels(struct net_device * dev,struct ethtool_channels * ch)103 static int ngbe_set_channels(struct net_device *dev,
104 struct ethtool_channels *ch)
105 {
106 int err;
107
108 err = wx_set_channels(dev, ch);
109 if (err < 0)
110 return err;
111
112 /* use setup TC to update any traffic class queue mapping */
113 return ngbe_setup_tc(dev, netdev_get_num_tc(dev));
114 }
115
116 static const struct ethtool_ops ngbe_ethtool_ops = {
117 .supported_coalesce_params = ETHTOOL_COALESCE_USECS |
118 ETHTOOL_COALESCE_TX_MAX_FRAMES_IRQ,
119 .get_drvinfo = wx_get_drvinfo,
120 .get_link = ethtool_op_get_link,
121 .get_link_ksettings = wx_get_link_ksettings,
122 .set_link_ksettings = wx_set_link_ksettings,
123 .nway_reset = wx_nway_reset,
124 .get_wol = ngbe_get_wol,
125 .set_wol = ngbe_set_wol,
126 .get_sset_count = wx_get_sset_count,
127 .get_strings = wx_get_strings,
128 .get_ethtool_stats = wx_get_ethtool_stats,
129 .get_eth_mac_stats = wx_get_mac_stats,
130 .get_pause_stats = wx_get_pause_stats,
131 .get_pauseparam = wx_get_pauseparam,
132 .set_pauseparam = wx_set_pauseparam,
133 .get_ringparam = wx_get_ringparam,
134 .set_ringparam = ngbe_set_ringparam,
135 .get_coalesce = wx_get_coalesce,
136 .set_coalesce = wx_set_coalesce,
137 .get_channels = wx_get_channels,
138 .set_channels = ngbe_set_channels,
139 .get_msglevel = wx_get_msglevel,
140 .set_msglevel = wx_set_msglevel,
141 };
142
ngbe_set_ethtool_ops(struct net_device * netdev)143 void ngbe_set_ethtool_ops(struct net_device *netdev)
144 {
145 netdev->ethtool_ops = &ngbe_ethtool_ops;
146 }
147