1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * Copyright (C) 2006-2008 PA Semi, Inc
4  *
5  * Ethtool hooks for the PA Semi PWRficient onchip 1G/10G Ethernet MACs
6  */
7 
8 
9 #include <linux/netdevice.h>
10 #include <linux/ethtool.h>
11 #include <linux/pci.h>
12 
13 #include <asm/pasemi_dma.h>
14 #include "pasemi_mac.h"
15 
16 static struct {
17 	const char str[ETH_GSTRING_LEN];
18 } ethtool_stats_keys[] = {
19 	{ "rx-drops" },
20 	{ "rx-bytes" },
21 	{ "rx-packets" },
22 	{ "rx-broadcast-packets" },
23 	{ "rx-multicast-packets" },
24 	{ "rx-crc-errors" },
25 	{ "rx-undersize-errors" },
26 	{ "rx-oversize-errors" },
27 	{ "rx-short-fragment-errors" },
28 	{ "rx-jabber-errors" },
29 	{ "rx-64-byte-packets" },
30 	{ "rx-65-127-byte-packets" },
31 	{ "rx-128-255-byte-packets" },
32 	{ "rx-256-511-byte-packets" },
33 	{ "rx-512-1023-byte-packets" },
34 	{ "rx-1024-1518-byte-packets" },
35 	{ "rx-pause-frames" },
36 	{ "tx-bytes" },
37 	{ "tx-packets" },
38 	{ "tx-broadcast-packets" },
39 	{ "tx-multicast-packets" },
40 	{ "tx-collisions" },
41 	{ "tx-late-collisions" },
42 	{ "tx-excessive-collisions" },
43 	{ "tx-crc-errors" },
44 	{ "tx-undersize-errors" },
45 	{ "tx-oversize-errors" },
46 	{ "tx-64-byte-packets" },
47 	{ "tx-65-127-byte-packets" },
48 	{ "tx-128-255-byte-packets" },
49 	{ "tx-256-511-byte-packets" },
50 	{ "tx-512-1023-byte-packets" },
51 	{ "tx-1024-1518-byte-packets" },
52 };
53 
54 static u32
pasemi_mac_ethtool_get_msglevel(struct net_device * netdev)55 pasemi_mac_ethtool_get_msglevel(struct net_device *netdev)
56 {
57 	struct pasemi_mac *mac = netdev_priv(netdev);
58 	return mac->msg_enable;
59 }
60 
61 static void
pasemi_mac_ethtool_set_msglevel(struct net_device * netdev,u32 level)62 pasemi_mac_ethtool_set_msglevel(struct net_device *netdev,
63 				u32 level)
64 {
65 	struct pasemi_mac *mac = netdev_priv(netdev);
66 	mac->msg_enable = level;
67 }
68 
69 
70 static void
pasemi_mac_ethtool_get_ringparam(struct net_device * netdev,struct ethtool_ringparam * ering,struct kernel_ethtool_ringparam * kernel_ering,struct netlink_ext_ack * extack)71 pasemi_mac_ethtool_get_ringparam(struct net_device *netdev,
72 				 struct ethtool_ringparam *ering,
73 				 struct kernel_ethtool_ringparam *kernel_ering,
74 				 struct netlink_ext_ack *extack)
75 {
76 	struct pasemi_mac *mac = netdev_priv(netdev);
77 
78 	ering->tx_max_pending = TX_RING_SIZE/2;
79 	ering->tx_pending = RING_USED(mac->tx)/2;
80 	ering->rx_max_pending = RX_RING_SIZE/4;
81 	ering->rx_pending = RING_USED(mac->rx)/4;
82 }
83 
pasemi_mac_get_sset_count(struct net_device * netdev,int sset)84 static int pasemi_mac_get_sset_count(struct net_device *netdev, int sset)
85 {
86 	switch (sset) {
87 	case ETH_SS_STATS:
88 		return ARRAY_SIZE(ethtool_stats_keys);
89 	default:
90 		return -EOPNOTSUPP;
91 	}
92 }
93 
pasemi_mac_get_ethtool_stats(struct net_device * netdev,struct ethtool_stats * stats,u64 * data)94 static void pasemi_mac_get_ethtool_stats(struct net_device *netdev,
95 		struct ethtool_stats *stats, u64 *data)
96 {
97 	struct pasemi_mac *mac = netdev_priv(netdev);
98 	int i;
99 
100 	data[0] = pasemi_read_dma_reg(PAS_DMA_RXINT_RCMDSTA(mac->dma_if))
101 			>> PAS_DMA_RXINT_RCMDSTA_DROPS_S;
102 	for (i = 0; i < 32; i++)
103 		data[1+i] = pasemi_read_mac_reg(mac->dma_if, PAS_MAC_RMON(i));
104 }
105 
pasemi_mac_get_strings(struct net_device * netdev,u32 stringset,u8 * data)106 static void pasemi_mac_get_strings(struct net_device *netdev, u32 stringset,
107 				   u8 *data)
108 {
109 	memcpy(data, ethtool_stats_keys, sizeof(ethtool_stats_keys));
110 }
111 
112 const struct ethtool_ops pasemi_mac_ethtool_ops = {
113 	.get_msglevel		= pasemi_mac_ethtool_get_msglevel,
114 	.set_msglevel		= pasemi_mac_ethtool_set_msglevel,
115 	.get_link		= ethtool_op_get_link,
116 	.get_ringparam          = pasemi_mac_ethtool_get_ringparam,
117 	.get_strings		= pasemi_mac_get_strings,
118 	.get_sset_count		= pasemi_mac_get_sset_count,
119 	.get_ethtool_stats	= pasemi_mac_get_ethtool_stats,
120 	.get_link_ksettings	= phy_ethtool_get_link_ksettings,
121 	.set_link_ksettings	= phy_ethtool_set_link_ksettings,
122 };
123 
124