OpenWrt – Blame information for rev 4

Subversion Repositories:
Rev:
Rev Author Line No. Line
4 office 1 /* This program is free software; you can redistribute it and/or modify
2 * it under the terms of the GNU General Public License as published by
3 * the Free Software Foundation; version 2 of the License
4 *
5 * This program is distributed in the hope that it will be useful,
6 * but WITHOUT ANY WARRANTY; without even the implied warranty of
7 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
8 * GNU General Public License for more details.
9 *
10 * Copyright (C) 2009-2015 John Crispin <blogic@openwrt.org>
11 * Copyright (C) 2009-2015 Felix Fietkau <nbd@nbd.name>
12 * Copyright (C) 2013-2015 Michael Lee <igvtee@gmail.com>
13 */
14  
15 #include "mtk_eth_soc.h"
16  
17 static const char fe_gdma_str[][ETH_GSTRING_LEN] = {
18 #define _FE(x...) # x,
19 FE_STAT_REG_DECLARE
20 #undef _FE
21 };
22  
23 static int fe_get_link_ksettings(struct net_device *ndev,
24 struct ethtool_link_ksettings *cmd)
25 {
26 struct fe_priv *priv = netdev_priv(ndev);
27  
28 if (!priv->phy_dev)
29 return -ENODEV;
30  
31 if (priv->phy_flags == FE_PHY_FLAG_ATTACH) {
32 if (phy_read_status(priv->phy_dev))
33 return -ENODEV;
34 }
35  
36 phy_ethtool_ksettings_get(ndev->phydev, cmd);
37  
38 return 0;
39 }
40  
41 static int fe_set_link_ksettings(struct net_device *ndev,
42 const struct ethtool_link_ksettings *cmd)
43 {
44 struct fe_priv *priv = netdev_priv(ndev);
45  
46 if (!priv->phy_dev)
47 goto out_sset;
48  
49 if (cmd->base.phy_address != priv->phy_dev->mdio.addr) {
50 if (priv->phy->phy_node[cmd->base.phy_address]) {
51 priv->phy_dev = priv->phy->phy[cmd->base.phy_address];
52 priv->phy_flags = FE_PHY_FLAG_PORT;
53 } else if (priv->mii_bus && mdiobus_get_phy(priv->mii_bus, cmd->base.phy_address)) {
54 priv->phy_dev = mdiobus_get_phy(priv->mii_bus, cmd->base.phy_address);
55 priv->phy_flags = FE_PHY_FLAG_ATTACH;
56 } else {
57 goto out_sset;
58 }
59 }
60  
61 return phy_ethtool_ksettings_set(ndev->phydev, cmd);
62  
63 out_sset:
64 return -ENODEV;
65 }
66  
67 static void fe_get_drvinfo(struct net_device *dev,
68 struct ethtool_drvinfo *info)
69 {
70 struct fe_priv *priv = netdev_priv(dev);
71 struct fe_soc_data *soc = priv->soc;
72  
73 strlcpy(info->driver, priv->dev->driver->name, sizeof(info->driver));
74 strlcpy(info->version, MTK_FE_DRV_VERSION, sizeof(info->version));
75 strlcpy(info->bus_info, dev_name(priv->dev), sizeof(info->bus_info));
76  
77 if (soc->reg_table[FE_REG_FE_COUNTER_BASE])
78 info->n_stats = ARRAY_SIZE(fe_gdma_str);
79 }
80  
81 static u32 fe_get_msglevel(struct net_device *dev)
82 {
83 struct fe_priv *priv = netdev_priv(dev);
84  
85 return priv->msg_enable;
86 }
87  
88 static void fe_set_msglevel(struct net_device *dev, u32 value)
89 {
90 struct fe_priv *priv = netdev_priv(dev);
91  
92 priv->msg_enable = value;
93 }
94  
95 static int fe_nway_reset(struct net_device *dev)
96 {
97 struct fe_priv *priv = netdev_priv(dev);
98  
99 if (!priv->phy_dev)
100 goto out_nway_reset;
101  
102 return genphy_restart_aneg(priv->phy_dev);
103  
104 out_nway_reset:
105 return -EOPNOTSUPP;
106 }
107  
108 static u32 fe_get_link(struct net_device *dev)
109 {
110 struct fe_priv *priv = netdev_priv(dev);
111 int err;
112  
113 if (!priv->phy_dev)
114 goto out_get_link;
115  
116 if (priv->phy_flags == FE_PHY_FLAG_ATTACH) {
117 err = genphy_update_link(priv->phy_dev);
118 if (err)
119 goto out_get_link;
120 }
121  
122 return priv->phy_dev->link;
123  
124 out_get_link:
125 return ethtool_op_get_link(dev);
126 }
127  
128 static int fe_set_ringparam(struct net_device *dev,
129 struct ethtool_ringparam *ring)
130 {
131 struct fe_priv *priv = netdev_priv(dev);
132  
133 if ((ring->tx_pending < 2) ||
134 (ring->rx_pending < 2) ||
135 (ring->rx_pending > MAX_DMA_DESC) ||
136 (ring->tx_pending > MAX_DMA_DESC))
137 return -EINVAL;
138  
139 dev->netdev_ops->ndo_stop(dev);
140  
141 priv->tx_ring.tx_ring_size = BIT(fls(ring->tx_pending) - 1);
142 priv->rx_ring.rx_ring_size = BIT(fls(ring->rx_pending) - 1);
143  
144 dev->netdev_ops->ndo_open(dev);
145  
146 return 0;
147 }
148  
149 static void fe_get_ringparam(struct net_device *dev,
150 struct ethtool_ringparam *ring)
151 {
152 struct fe_priv *priv = netdev_priv(dev);
153  
154 ring->rx_max_pending = MAX_DMA_DESC;
155 ring->tx_max_pending = MAX_DMA_DESC;
156 ring->rx_pending = priv->rx_ring.rx_ring_size;
157 ring->tx_pending = priv->tx_ring.tx_ring_size;
158 }
159  
160 static void fe_get_strings(struct net_device *dev, u32 stringset, u8 *data)
161 {
162 switch (stringset) {
163 case ETH_SS_STATS:
164 memcpy(data, *fe_gdma_str, sizeof(fe_gdma_str));
165 break;
166 }
167 }
168  
169 static int fe_get_sset_count(struct net_device *dev, int sset)
170 {
171 switch (sset) {
172 case ETH_SS_STATS:
173 return ARRAY_SIZE(fe_gdma_str);
174 default:
175 return -EOPNOTSUPP;
176 }
177 }
178  
179 static void fe_get_ethtool_stats(struct net_device *dev,
180 struct ethtool_stats *stats, u64 *data)
181 {
182 struct fe_priv *priv = netdev_priv(dev);
183 struct fe_hw_stats *hwstats = priv->hw_stats;
184 u64 *data_src, *data_dst;
185 unsigned int start;
186 int i;
187  
188 if (netif_running(dev) && netif_device_present(dev)) {
189 if (spin_trylock(&hwstats->stats_lock)) {
190 fe_stats_update(priv);
191 spin_unlock(&hwstats->stats_lock);
192 }
193 }
194  
195 do {
196 data_src = &hwstats->tx_bytes;
197 data_dst = data;
198 start = u64_stats_fetch_begin_irq(&hwstats->syncp);
199  
200 for (i = 0; i < ARRAY_SIZE(fe_gdma_str); i++)
201 *data_dst++ = *data_src++;
202  
203 } while (u64_stats_fetch_retry_irq(&hwstats->syncp, start));
204 }
205  
206 static struct ethtool_ops fe_ethtool_ops = {
207 .get_link_ksettings = fe_get_link_ksettings,
208 .set_link_ksettings = fe_set_link_ksettings,
209 .get_drvinfo = fe_get_drvinfo,
210 .get_msglevel = fe_get_msglevel,
211 .set_msglevel = fe_set_msglevel,
212 .nway_reset = fe_nway_reset,
213 .get_link = fe_get_link,
214 .set_ringparam = fe_set_ringparam,
215 .get_ringparam = fe_get_ringparam,
216 };
217  
218 void fe_set_ethtool_ops(struct net_device *netdev)
219 {
220 struct fe_priv *priv = netdev_priv(netdev);
221 struct fe_soc_data *soc = priv->soc;
222  
223 if (soc->reg_table[FE_REG_FE_COUNTER_BASE]) {
224 fe_ethtool_ops.get_strings = fe_get_strings;
225 fe_ethtool_ops.get_sset_count = fe_get_sset_count;
226 fe_ethtool_ops.get_ethtool_stats = fe_get_ethtool_stats;
227 }
228  
229 netdev->ethtool_ops = &fe_ethtool_ops;
230 }