Commit a7f4f13a authored by Oleksij Rempel's avatar Oleksij Rempel Committed by David S. Miller
Browse files

net: dsa: microchip: ksz9477: export HW stats over stats64 interface 



Provide access to HW offloaded packets over stats64 interface.
The rx/tx_bytes values needed some fixing since HW is accounting size of
the Ethernet frame together with FCS.

Signed-off-by: default avatarOleksij Rempel <o.rempel@pengutronix.de>
Reviewed-by: default avatarVladimir Oltean <olteanv@gmail.com>
Signed-off-by: default avatarDavid S. Miller <davem@davemloft.net>
parent 0d0350c4

drivers/net/dsa/microchip/ksz9477.c

+97 −0
Original line number Diff line number Diff line
@@ -64,6 +64,100 @@ static const struct { 
	{ 0x83, "tx_discards" },

};



struct ksz9477_stats_raw {

	u64 rx_hi;

	u64 rx_undersize;

	u64 rx_fragments;

	u64 rx_oversize;

	u64 rx_jabbers;

	u64 rx_symbol_err;

	u64 rx_crc_err;

	u64 rx_align_err;

	u64 rx_mac_ctrl;

	u64 rx_pause;

	u64 rx_bcast;

	u64 rx_mcast;

	u64 rx_ucast;

	u64 rx_64_or_less;

	u64 rx_65_127;

	u64 rx_128_255;

	u64 rx_256_511;

	u64 rx_512_1023;

	u64 rx_1024_1522;

	u64 rx_1523_2000;

	u64 rx_2001;

	u64 tx_hi;

	u64 tx_late_col;

	u64 tx_pause;

	u64 tx_bcast;

	u64 tx_mcast;

	u64 tx_ucast;

	u64 tx_deferred;

	u64 tx_total_col;

	u64 tx_exc_col;

	u64 tx_single_col;

	u64 tx_mult_col;

	u64 rx_total;

	u64 tx_total;

	u64 rx_discards;

	u64 tx_discards;

};



static void ksz9477_r_mib_stats64(struct ksz_device *dev, int port)

{

	struct rtnl_link_stats64 *stats;

	struct ksz9477_stats_raw *raw;

	struct ksz_port_mib *mib;



	mib = &dev->ports[port].mib;

	stats = &mib->stats64;

	raw = (struct ksz9477_stats_raw *)mib->counters;



	spin_lock(&mib->stats64_lock);



	stats->rx_packets = raw->rx_bcast + raw->rx_mcast + raw->rx_ucast;

	stats->tx_packets = raw->tx_bcast + raw->tx_mcast + raw->tx_ucast;



	/* HW counters are counting bytes + FCS which is not acceptable

	 * for rtnl_link_stats64 interface

	 */

	stats->rx_bytes = raw->rx_total - stats->rx_packets * ETH_FCS_LEN;

	stats->tx_bytes = raw->tx_total - stats->tx_packets * ETH_FCS_LEN;



	stats->rx_length_errors = raw->rx_undersize + raw->rx_fragments +

		raw->rx_oversize;



	stats->rx_crc_errors = raw->rx_crc_err;

	stats->rx_frame_errors = raw->rx_align_err;

	stats->rx_dropped = raw->rx_discards;

	stats->rx_errors = stats->rx_length_errors + stats->rx_crc_errors +

		stats->rx_frame_errors  + stats->rx_dropped;



	stats->tx_window_errors = raw->tx_late_col;

	stats->tx_fifo_errors = raw->tx_discards;

	stats->tx_aborted_errors = raw->tx_exc_col;

	stats->tx_errors = stats->tx_window_errors + stats->tx_fifo_errors +

		stats->tx_aborted_errors;



	stats->multicast = raw->rx_mcast;

	stats->collisions = raw->tx_total_col;



	spin_unlock(&mib->stats64_lock);

}



static void ksz9477_get_stats64(struct dsa_switch *ds, int port,

			       struct rtnl_link_stats64 *s)

{

	struct ksz_device *dev = ds->priv;

	struct ksz_port_mib *mib;



	mib = &dev->ports[port].mib;



	spin_lock(&mib->stats64_lock);

	memcpy(s, &mib->stats64, sizeof(*s));

	spin_unlock(&mib->stats64_lock);

}



static void ksz_cfg(struct ksz_device *dev, u32 addr, u8 bits, bool set)

{

	regmap_update_bits(dev->regmap[0], addr, bits, set ? bits : 0);
@@ -1365,6 +1459,7 @@ static const struct dsa_switch_ops ksz9477_switch_ops = { 
	.port_mdb_del           = ksz9477_port_mdb_del,

	.port_mirror_add	= ksz9477_port_mirror_add,

	.port_mirror_del	= ksz9477_port_mirror_del,

	.get_stats64		= ksz9477_get_stats64,

};



static u32 ksz9477_get_port_addr(int port, int offset)
@@ -1524,6 +1619,7 @@ static int ksz9477_switch_init(struct ksz_device *dev) 
	if (!dev->ports)

		return -ENOMEM;

	for (i = 0; i < dev->port_cnt; i++) {

		spin_lock_init(&dev->ports[i].mib.stats64_lock);

		mutex_init(&dev->ports[i].mib.cnt_mutex);

		dev->ports[i].mib.counters =

			devm_kzalloc(dev->dev,
@@ -1552,6 +1648,7 @@ static const struct ksz_dev_ops ksz9477_dev_ops = { 
	.port_setup = ksz9477_port_setup,

	.r_mib_cnt = ksz9477_r_mib_cnt,

	.r_mib_pkt = ksz9477_r_mib_pkt,

	.r_mib_stat64 = ksz9477_r_mib_stats64,

	.freeze_mib = ksz9477_freeze_mib,

	.port_init_cnt = ksz9477_port_init_cnt,

	.shutdown = ksz9477_reset_switch,

drivers/net/dsa/microchip/ksz_common.c

+4 −0
Original line number Diff line number Diff line
@@ -110,6 +110,10 @@ static void ksz_mib_read_work(struct work_struct *work) 
		}

		port_r_cnt(dev, i);

		p->read = false;



		if (dev->dev_ops->r_mib_stat64)

			dev->dev_ops->r_mib_stat64(dev, i);



		mutex_unlock(&mib->cnt_mutex);

	}

drivers/net/dsa/microchip/ksz_common.h

+3 −0
Original line number Diff line number Diff line
@@ -22,6 +22,8 @@ struct ksz_port_mib { 
	struct mutex cnt_mutex;		/* structure access */

	u8 cnt_ptr;

	u64 *counters;

	struct rtnl_link_stats64 stats64;

	struct spinlock stats64_lock;

};



struct ksz_port {
@@ -128,6 +130,7 @@ struct ksz_dev_ops { 
			  u64 *cnt);

	void (*r_mib_pkt)(struct ksz_device *dev, int port, u16 addr,

			  u64 *dropped, u64 *cnt);

	void (*r_mib_stat64)(struct ksz_device *dev, int port);

	void (*freeze_mib)(struct ksz_device *dev, int port, bool freeze);

	void (*port_init_cnt)(struct ksz_device *dev, int port);

	int (*shutdown)(struct ksz_device *dev);