1 // SPDX-License-Identifier: ISC
2 /*
3 * Copyright (c) 2014,2017 Qualcomm Atheros, Inc.
4 * Copyright (c) 2018, The Linux Foundation. All rights reserved.
5 */
6
7 #include <linux/etherdevice.h>
8 #include <linux/pci.h>
9 #include <linux/rtnetlink.h>
10 #include <net/cfg80211.h>
11
12 #include "wil6210.h"
13
14 static int
wil_ethtoolops_get_coalesce(struct net_device * ndev,struct ethtool_coalesce * cp,struct kernel_ethtool_coalesce * kernel_coal,struct netlink_ext_ack * extack)15 wil_ethtoolops_get_coalesce(struct net_device *ndev,
16 struct ethtool_coalesce *cp,
17 struct kernel_ethtool_coalesce *kernel_coal,
18 struct netlink_ext_ack *extack)
19 {
20 struct wil6210_priv *wil = ndev_to_wil(ndev);
21 u32 tx_itr_en, tx_itr_val = 0;
22 u32 rx_itr_en, rx_itr_val = 0;
23 int ret;
24
25 mutex_lock(&wil->mutex);
26 wil_dbg_misc(wil, "ethtoolops_get_coalesce\n");
27
28 ret = wil_pm_runtime_get(wil);
29 if (ret < 0)
30 goto out;
31
32 tx_itr_en = wil_r(wil, RGF_DMA_ITR_TX_CNT_CTL);
33 if (tx_itr_en & BIT_DMA_ITR_TX_CNT_CTL_EN)
34 tx_itr_val = wil_r(wil, RGF_DMA_ITR_TX_CNT_TRSH);
35
36 rx_itr_en = wil_r(wil, RGF_DMA_ITR_RX_CNT_CTL);
37 if (rx_itr_en & BIT_DMA_ITR_RX_CNT_CTL_EN)
38 rx_itr_val = wil_r(wil, RGF_DMA_ITR_RX_CNT_TRSH);
39
40 wil_pm_runtime_put(wil);
41
42 cp->tx_coalesce_usecs = tx_itr_val;
43 cp->rx_coalesce_usecs = rx_itr_val;
44 ret = 0;
45
46 out:
47 mutex_unlock(&wil->mutex);
48 return ret;
49 }
50
51 static int
wil_ethtoolops_set_coalesce(struct net_device * ndev,struct ethtool_coalesce * cp,struct kernel_ethtool_coalesce * kernel_coal,struct netlink_ext_ack * extack)52 wil_ethtoolops_set_coalesce(struct net_device *ndev,
53 struct ethtool_coalesce *cp,
54 struct kernel_ethtool_coalesce *kernel_coal,
55 struct netlink_ext_ack *extack)
56 {
57 struct wil6210_priv *wil = ndev_to_wil(ndev);
58 struct wireless_dev *wdev = ndev->ieee80211_ptr;
59 int ret;
60
61 mutex_lock(&wil->mutex);
62 wil_dbg_misc(wil, "ethtoolops_set_coalesce: rx %d usec, tx %d usec\n",
63 cp->rx_coalesce_usecs, cp->tx_coalesce_usecs);
64
65 if (wdev->iftype == NL80211_IFTYPE_MONITOR) {
66 wil_dbg_misc(wil, "No IRQ coalescing in monitor mode\n");
67 ret = -EINVAL;
68 goto out;
69 }
70
71 /* only @rx_coalesce_usecs and @tx_coalesce_usecs supported,
72 * ignore other parameters
73 */
74
75 if (cp->rx_coalesce_usecs > WIL6210_ITR_TRSH_MAX ||
76 cp->tx_coalesce_usecs > WIL6210_ITR_TRSH_MAX)
77 goto out_bad;
78
79 wil->tx_max_burst_duration = cp->tx_coalesce_usecs;
80 wil->rx_max_burst_duration = cp->rx_coalesce_usecs;
81
82 ret = wil_pm_runtime_get(wil);
83 if (ret < 0)
84 goto out;
85
86 wil->txrx_ops.configure_interrupt_moderation(wil);
87
88 wil_pm_runtime_put(wil);
89 ret = 0;
90
91 out:
92 mutex_unlock(&wil->mutex);
93 return ret;
94
95 out_bad:
96 wil_dbg_misc(wil, "Unsupported coalescing params. Raw command:\n");
97 print_hex_dump_debug("DBG[MISC] coal ", DUMP_PREFIX_OFFSET, 16, 4,
98 cp, sizeof(*cp), false);
99 mutex_unlock(&wil->mutex);
100 return -EINVAL;
101 }
102
103 static const struct ethtool_ops wil_ethtool_ops = {
104 .supported_coalesce_params = ETHTOOL_COALESCE_USECS,
105 .get_drvinfo = cfg80211_get_drvinfo,
106 .get_coalesce = wil_ethtoolops_get_coalesce,
107 .set_coalesce = wil_ethtoolops_set_coalesce,
108 };
109
wil_set_ethtoolops(struct net_device * ndev)110 void wil_set_ethtoolops(struct net_device *ndev)
111 {
112 ndev->ethtool_ops = &wil_ethtool_ops;
113 }
114