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