forked from Minki/linux
Altera TSE: Add Miscellaneous Files for Altera Ethernet Driver
This patch adds miscellaneous files for the Altera Ethernet Driver, including ethtool support. Signed-off-by: Vince Bridgers <vbridgers2013@gmail.com> Signed-off-by: David S. Miller <davem@davemloft.net>
This commit is contained in:
Vince Bridgers
David S. Miller
parent
f64f8808bc
commit
6c3324a96b
227
drivers/net/ethernet/altera/altera_tse_ethtool.c
Normal file
227
drivers/net/ethernet/altera/altera_tse_ethtool.c
Normal file
@ -0,0 +1,227 @@
|
||||
/* Ethtool support for Altera Triple-Speed Ethernet MAC driver
|
||||
* Copyright (C) 2008-2014 Altera Corporation. All rights reserved
|
||||
*
|
||||
* Contributors:
|
||||
* Dalon Westergreen
|
||||
* Thomas Chou
|
||||
* Ian Abbott
|
||||
* Yuriy Kozlov
|
||||
* Tobias Klauser
|
||||
* Andriy Smolskyy
|
||||
* Roman Bulgakov
|
||||
* Dmytro Mytarchuk
|
||||
*
|
||||
* Original driver contributed by SLS.
|
||||
* Major updates contributed by GlobalLogic
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify it
|
||||
* under the terms and conditions of the GNU General Public License,
|
||||
* version 2, as published by the Free Software Foundation.
|
||||
*
|
||||
* This program is distributed in the hope it will be useful, but WITHOUT
|
||||
* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
|
||||
* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
|
||||
* more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License along with
|
||||
* this program. If not, see <http://www.gnu.org/licenses/>.
|
||||
*/
|
||||
|
||||
#include <linux/ethtool.h>
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/netdevice.h>
|
||||
#include <linux/phy.h>
|
||||
|
||||
#include "altera_tse.h"
|
||||
|
||||
#define TSE_STATS_LEN 31
|
||||
#define TSE_NUM_REGS 128
|
||||
|
||||
static char const stat_gstrings[][ETH_GSTRING_LEN] = {
|
||||
"tx_packets",
|
||||
"rx_packets",
|
||||
"rx_crc_errors",
|
||||
"rx_align_errors",
|
||||
"tx_bytes",
|
||||
"rx_bytes",
|
||||
"tx_pause",
|
||||
"rx_pause",
|
||||
"rx_errors",
|
||||
"tx_errors",
|
||||
"rx_unicast",
|
||||
"rx_multicast",
|
||||
"rx_broadcast",
|
||||
"tx_discards",
|
||||
"tx_unicast",
|
||||
"tx_multicast",
|
||||
"tx_broadcast",
|
||||
"ether_drops",
|
||||
"rx_total_bytes",
|
||||
"rx_total_packets",
|
||||
"rx_undersize",
|
||||
"rx_oversize",
|
||||
"rx_64_bytes",
|
||||
"rx_65_127_bytes",
|
||||
"rx_128_255_bytes",
|
||||
"rx_256_511_bytes",
|
||||
"rx_512_1023_bytes",
|
||||
"rx_1024_1518_bytes",
|
||||
"rx_gte_1519_bytes",
|
||||
"rx_jabbers",
|
||||
"rx_runts",
|
||||
};
|
||||
|
||||
static void tse_get_drvinfo(struct net_device *dev,
|
||||
struct ethtool_drvinfo *info)
|
||||
{
|
||||
struct altera_tse_private *priv = netdev_priv(dev);
|
||||
u32 rev = ioread32(&priv->mac_dev->megacore_revision);
|
||||
|
||||
strcpy(info->driver, "Altera TSE MAC IP Driver");
|
||||
strcpy(info->version, "v8.0");
|
||||
snprintf(info->fw_version, ETHTOOL_FWVERS_LEN, "v%d.%d",
|
||||
rev & 0xFFFF, (rev & 0xFFFF0000) >> 16);
|
||||
sprintf(info->bus_info, "platform");
|
||||
}
|
||||
|
||||
/* Fill in a buffer with the strings which correspond to the
|
||||
* stats
|
||||
*/
|
||||
static void tse_gstrings(struct net_device *dev, u32 stringset, u8 *buf)
|
||||
{
|
||||
memcpy(buf, stat_gstrings, TSE_STATS_LEN * ETH_GSTRING_LEN);
|
||||
}
|
||||
|
||||
static void tse_fill_stats(struct net_device *dev, struct ethtool_stats *dummy,
|
||||
u64 *buf)
|
||||
{
|
||||
struct altera_tse_private *priv = netdev_priv(dev);
|
||||
struct altera_tse_mac *mac = priv->mac_dev;
|
||||
u64 ext;
|
||||
|
||||
buf[0] = ioread32(&mac->frames_transmitted_ok);
|
||||
buf[1] = ioread32(&mac->frames_received_ok);
|
||||
buf[2] = ioread32(&mac->frames_check_sequence_errors);
|
||||
buf[3] = ioread32(&mac->alignment_errors);
|
||||
|
||||
/* Extended aOctetsTransmittedOK counter */
|
||||
ext = (u64) ioread32(&mac->msb_octets_transmitted_ok) << 32;
|
||||
ext |= ioread32(&mac->octets_transmitted_ok);
|
||||
buf[4] = ext;
|
||||
|
||||
/* Extended aOctetsReceivedOK counter */
|
||||
ext = (u64) ioread32(&mac->msb_octets_received_ok) << 32;
|
||||
ext |= ioread32(&mac->octets_received_ok);
|
||||
buf[5] = ext;
|
||||
|
||||
buf[6] = ioread32(&mac->tx_pause_mac_ctrl_frames);
|
||||
buf[7] = ioread32(&mac->rx_pause_mac_ctrl_frames);
|
||||
buf[8] = ioread32(&mac->if_in_errors);
|
||||
buf[9] = ioread32(&mac->if_out_errors);
|
||||
buf[10] = ioread32(&mac->if_in_ucast_pkts);
|
||||
buf[11] = ioread32(&mac->if_in_multicast_pkts);
|
||||
buf[12] = ioread32(&mac->if_in_broadcast_pkts);
|
||||
buf[13] = ioread32(&mac->if_out_discards);
|
||||
buf[14] = ioread32(&mac->if_out_ucast_pkts);
|
||||
buf[15] = ioread32(&mac->if_out_multicast_pkts);
|
||||
buf[16] = ioread32(&mac->if_out_broadcast_pkts);
|
||||
buf[17] = ioread32(&mac->ether_stats_drop_events);
|
||||
|
||||
/* Extended etherStatsOctets counter */
|
||||
ext = (u64) ioread32(&mac->msb_ether_stats_octets) << 32;
|
||||
ext |= ioread32(&mac->ether_stats_octets);
|
||||
buf[18] = ext;
|
||||
|
||||
buf[19] = ioread32(&mac->ether_stats_pkts);
|
||||
buf[20] = ioread32(&mac->ether_stats_undersize_pkts);
|
||||
buf[21] = ioread32(&mac->ether_stats_oversize_pkts);
|
||||
buf[22] = ioread32(&mac->ether_stats_pkts_64_octets);
|
||||
buf[23] = ioread32(&mac->ether_stats_pkts_65to127_octets);
|
||||
buf[24] = ioread32(&mac->ether_stats_pkts_128to255_octets);
|
||||
buf[25] = ioread32(&mac->ether_stats_pkts_256to511_octets);
|
||||
buf[26] = ioread32(&mac->ether_stats_pkts_512to1023_octets);
|
||||
buf[27] = ioread32(&mac->ether_stats_pkts_1024to1518_octets);
|
||||
buf[28] = ioread32(&mac->ether_stats_pkts_1519tox_octets);
|
||||
buf[29] = ioread32(&mac->ether_stats_jabbers);
|
||||
buf[30] = ioread32(&mac->ether_stats_fragments);
|
||||
}
|
||||
|
||||
static int tse_sset_count(struct net_device *dev, int sset)
|
||||
{
|
||||
switch (sset) {
|
||||
case ETH_SS_STATS:
|
||||
return TSE_STATS_LEN;
|
||||
default:
|
||||
return -EOPNOTSUPP;
|
||||
}
|
||||
}
|
||||
|
||||
static u32 tse_get_msglevel(struct net_device *dev)
|
||||
{
|
||||
struct altera_tse_private *priv = netdev_priv(dev);
|
||||
return priv->msg_enable;
|
||||
}
|
||||
|
||||
static void tse_set_msglevel(struct net_device *dev, uint32_t data)
|
||||
{
|
||||
struct altera_tse_private *priv = netdev_priv(dev);
|
||||
priv->msg_enable = data;
|
||||
}
|
||||
|
||||
static int tse_reglen(struct net_device *dev)
|
||||
{
|
||||
return TSE_NUM_REGS * sizeof(u32);
|
||||
}
|
||||
|
||||
static void tse_get_regs(struct net_device *dev, struct ethtool_regs *regs,
|
||||
void *regbuf)
|
||||
{
|
||||
int i;
|
||||
struct altera_tse_private *priv = netdev_priv(dev);
|
||||
u32 *tse_mac_regs = (u32 *)priv->mac_dev;
|
||||
u32 *buf = regbuf;
|
||||
|
||||
for (i = 0; i < TSE_NUM_REGS; i++)
|
||||
buf[i] = ioread32(&tse_mac_regs[i]);
|
||||
}
|
||||
|
||||
static int tse_get_settings(struct net_device *dev, struct ethtool_cmd *cmd)
|
||||
{
|
||||
struct altera_tse_private *priv = netdev_priv(dev);
|
||||
struct phy_device *phydev = priv->phydev;
|
||||
|
||||
if (phydev == NULL)
|
||||
return -ENODEV;
|
||||
|
||||
return phy_ethtool_gset(phydev, cmd);
|
||||
}
|
||||
|
||||
static int tse_set_settings(struct net_device *dev, struct ethtool_cmd *cmd)
|
||||
{
|
||||
struct altera_tse_private *priv = netdev_priv(dev);
|
||||
struct phy_device *phydev = priv->phydev;
|
||||
|
||||
if (phydev == NULL)
|
||||
return -ENODEV;
|
||||
|
||||
return phy_ethtool_sset(phydev, cmd);
|
||||
}
|
||||
|
||||
static const struct ethtool_ops tse_ethtool_ops = {
|
||||
.get_drvinfo = tse_get_drvinfo,
|
||||
.get_regs_len = tse_reglen,
|
||||
.get_regs = tse_get_regs,
|
||||
.get_link = ethtool_op_get_link,
|
||||
.get_settings = tse_get_settings,
|
||||
.set_settings = tse_set_settings,
|
||||
.get_strings = tse_gstrings,
|
||||
.get_sset_count = tse_sset_count,
|
||||
.get_ethtool_stats = tse_fill_stats,
|
||||
.get_msglevel = tse_get_msglevel,
|
||||
.set_msglevel = tse_set_msglevel,
|
||||
};
|
||||
|
||||
void altera_tse_set_ethtool_ops(struct net_device *netdev)
|
||||
{
|
||||
SET_ETHTOOL_OPS(netdev, &tse_ethtool_ops);
|
||||
}
|
||||
44
drivers/net/ethernet/altera/altera_utils.c
Normal file
44
drivers/net/ethernet/altera/altera_utils.c
Normal file
@ -0,0 +1,44 @@
|
||||
/* Altera TSE SGDMA and MSGDMA Linux driver
|
||||
* Copyright (C) 2014 Altera Corporation. All rights reserved
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify it
|
||||
* under the terms and conditions of the GNU General Public License,
|
||||
* version 2, as published by the Free Software Foundation.
|
||||
*
|
||||
* This program is distributed in the hope it will be useful, but WITHOUT
|
||||
* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
|
||||
* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
|
||||
* more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License along with
|
||||
* this program. If not, see <http://www.gnu.org/licenses/>.
|
||||
*/
|
||||
|
||||
#include "altera_tse.h"
|
||||
#include "altera_utils.h"
|
||||
|
||||
void tse_set_bit(void __iomem *ioaddr, u32 bit_mask)
|
||||
{
|
||||
u32 value = ioread32(ioaddr);
|
||||
value |= bit_mask;
|
||||
iowrite32(value, ioaddr);
|
||||
}
|
||||
|
||||
void tse_clear_bit(void __iomem *ioaddr, u32 bit_mask)
|
||||
{
|
||||
u32 value = ioread32(ioaddr);
|
||||
value &= ~bit_mask;
|
||||
iowrite32(value, ioaddr);
|
||||
}
|
||||
|
||||
int tse_bit_is_set(void __iomem *ioaddr, u32 bit_mask)
|
||||
{
|
||||
u32 value = ioread32(ioaddr);
|
||||
return (value & bit_mask) ? 1 : 0;
|
||||
}
|
||||
|
||||
int tse_bit_is_clear(void __iomem *ioaddr, u32 bit_mask)
|
||||
{
|
||||
u32 value = ioread32(ioaddr);
|
||||
return (value & bit_mask) ? 0 : 1;
|
||||
}
|
||||
27
drivers/net/ethernet/altera/altera_utils.h
Normal file
27
drivers/net/ethernet/altera/altera_utils.h
Normal file
@ -0,0 +1,27 @@
|
||||
/* Altera TSE SGDMA and MSGDMA Linux driver
|
||||
* Copyright (C) 2014 Altera Corporation. All rights reserved
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify it
|
||||
* under the terms and conditions of the GNU General Public License,
|
||||
* version 2, as published by the Free Software Foundation.
|
||||
*
|
||||
* This program is distributed in the hope it will be useful, but WITHOUT
|
||||
* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
|
||||
* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
|
||||
* more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License along with
|
||||
* this program. If not, see <http://www.gnu.org/licenses/>.
|
||||
*/
|
||||
|
||||
#include <linux/kernel.h>
|
||||
|
||||
#ifndef __ALTERA_UTILS_H__
|
||||
#define __ALTERA_UTILS_H__
|
||||
|
||||
void tse_set_bit(void __iomem *ioaddr, u32 bit_mask);
|
||||
void tse_clear_bit(void __iomem *ioaddr, u32 bit_mask);
|
||||
int tse_bit_is_set(void __iomem *ioaddr, u32 bit_mask);
|
||||
int tse_bit_is_clear(void __iomem *ioaddr, u32 bit_mask);
|
||||
|
||||
#endif /* __ALTERA_UTILS_H__*/
|
||||
Loading…
Reference in New Issue
Block a user