1c1e10d5dSMD Danish Anwar // SPDX-License-Identifier: GPL-2.0
2c1e10d5dSMD Danish Anwar /* Texas Instruments ICSSG Ethernet driver
3c1e10d5dSMD Danish Anwar *
4c1e10d5dSMD Danish Anwar * Copyright (C) 2018-2021 Texas Instruments Incorporated - https://www.ti.com/
5c1e10d5dSMD Danish Anwar *
6c1e10d5dSMD Danish Anwar */
7c1e10d5dSMD Danish Anwar
8c1e10d5dSMD Danish Anwar #include "icssg_prueth.h"
9c1e10d5dSMD Danish Anwar #include "icssg_stats.h"
10c1e10d5dSMD Danish Anwar #include <linux/regmap.h>
11c1e10d5dSMD Danish Anwar
12*2c0d808fSMD Danish Anwar #define ICSSG_TX_PACKET_OFFSET 0xA0
13*2c0d808fSMD Danish Anwar #define ICSSG_TX_BYTE_OFFSET 0xEC
14*2c0d808fSMD Danish Anwar
15c1e10d5dSMD Danish Anwar static u32 stats_base[] = { 0x54c, /* Slice 0 stats start */
16c1e10d5dSMD Danish Anwar 0xb18, /* Slice 1 stats start */
17c1e10d5dSMD Danish Anwar };
18c1e10d5dSMD Danish Anwar
emac_update_hardware_stats(struct prueth_emac * emac)19c1e10d5dSMD Danish Anwar void emac_update_hardware_stats(struct prueth_emac *emac)
20c1e10d5dSMD Danish Anwar {
21c1e10d5dSMD Danish Anwar struct prueth *prueth = emac->prueth;
22c1e10d5dSMD Danish Anwar int slice = prueth_emac_slice(emac);
23c1e10d5dSMD Danish Anwar u32 base = stats_base[slice];
24*2c0d808fSMD Danish Anwar u32 tx_pkt_cnt = 0;
25c1e10d5dSMD Danish Anwar u32 val;
26c1e10d5dSMD Danish Anwar int i;
27c1e10d5dSMD Danish Anwar
28c1e10d5dSMD Danish Anwar for (i = 0; i < ARRAY_SIZE(icssg_all_stats); i++) {
29c1e10d5dSMD Danish Anwar regmap_read(prueth->miig_rt,
30c1e10d5dSMD Danish Anwar base + icssg_all_stats[i].offset,
31c1e10d5dSMD Danish Anwar &val);
32c1e10d5dSMD Danish Anwar regmap_write(prueth->miig_rt,
33c1e10d5dSMD Danish Anwar base + icssg_all_stats[i].offset,
34c1e10d5dSMD Danish Anwar val);
35c1e10d5dSMD Danish Anwar
36*2c0d808fSMD Danish Anwar if (icssg_all_stats[i].offset == ICSSG_TX_PACKET_OFFSET)
37*2c0d808fSMD Danish Anwar tx_pkt_cnt = val;
38*2c0d808fSMD Danish Anwar
39c1e10d5dSMD Danish Anwar emac->stats[i] += val;
40*2c0d808fSMD Danish Anwar if (icssg_all_stats[i].offset == ICSSG_TX_BYTE_OFFSET)
41*2c0d808fSMD Danish Anwar emac->stats[i] -= tx_pkt_cnt * 8;
42c1e10d5dSMD Danish Anwar }
43c1e10d5dSMD Danish Anwar }
44c1e10d5dSMD Danish Anwar
emac_stats_work_handler(struct work_struct * work)45c1e10d5dSMD Danish Anwar void emac_stats_work_handler(struct work_struct *work)
46c1e10d5dSMD Danish Anwar {
47c1e10d5dSMD Danish Anwar struct prueth_emac *emac = container_of(work, struct prueth_emac,
48c1e10d5dSMD Danish Anwar stats_work.work);
49c1e10d5dSMD Danish Anwar emac_update_hardware_stats(emac);
50c1e10d5dSMD Danish Anwar
51c1e10d5dSMD Danish Anwar queue_delayed_work(system_long_wq, &emac->stats_work,
52c1e10d5dSMD Danish Anwar msecs_to_jiffies((STATS_TIME_LIMIT_1G_MS * 1000) / emac->speed));
53c1e10d5dSMD Danish Anwar }
54c2f67d19SMD Danish Anwar
emac_get_stat_by_name(struct prueth_emac * emac,char * stat_name)55c2f67d19SMD Danish Anwar int emac_get_stat_by_name(struct prueth_emac *emac, char *stat_name)
56c2f67d19SMD Danish Anwar {
57c2f67d19SMD Danish Anwar int i;
58c2f67d19SMD Danish Anwar
59c2f67d19SMD Danish Anwar for (i = 0; i < ARRAY_SIZE(icssg_all_stats); i++) {
60c2f67d19SMD Danish Anwar if (!strcmp(icssg_all_stats[i].name, stat_name))
61c2f67d19SMD Danish Anwar return emac->stats[icssg_all_stats[i].offset / sizeof(u32)];
62c2f67d19SMD Danish Anwar }
63c2f67d19SMD Danish Anwar
64c2f67d19SMD Danish Anwar netdev_err(emac->ndev, "Invalid stats %s\n", stat_name);
65c2f67d19SMD Danish Anwar return -EINVAL;
66c2f67d19SMD Danish Anwar }
67