162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci * debugfs code for HSR & PRP
462306a36Sopenharmony_ci * Copyright (C) 2019 Texas Instruments Incorporated
562306a36Sopenharmony_ci *
662306a36Sopenharmony_ci * Author(s):
762306a36Sopenharmony_ci *	Murali Karicheri <m-karicheri2@ti.com>
862306a36Sopenharmony_ci */
962306a36Sopenharmony_ci#include <linux/module.h>
1062306a36Sopenharmony_ci#include <linux/errno.h>
1162306a36Sopenharmony_ci#include <linux/debugfs.h>
1262306a36Sopenharmony_ci#include "hsr_main.h"
1362306a36Sopenharmony_ci#include "hsr_framereg.h"
1462306a36Sopenharmony_ci
1562306a36Sopenharmony_cistatic struct dentry *hsr_debugfs_root_dir;
1662306a36Sopenharmony_ci
1762306a36Sopenharmony_ci/* hsr_node_table_show - Formats and prints node_table entries */
1862306a36Sopenharmony_cistatic int
1962306a36Sopenharmony_cihsr_node_table_show(struct seq_file *sfp, void *data)
2062306a36Sopenharmony_ci{
2162306a36Sopenharmony_ci	struct hsr_priv *priv = (struct hsr_priv *)sfp->private;
2262306a36Sopenharmony_ci	struct hsr_node *node;
2362306a36Sopenharmony_ci
2462306a36Sopenharmony_ci	seq_printf(sfp, "Node Table entries for (%s) device\n",
2562306a36Sopenharmony_ci		   (priv->prot_version == PRP_V1 ? "PRP" : "HSR"));
2662306a36Sopenharmony_ci	seq_puts(sfp, "MAC-Address-A,    MAC-Address-B,    time_in[A], ");
2762306a36Sopenharmony_ci	seq_puts(sfp, "time_in[B], Address-B port, ");
2862306a36Sopenharmony_ci	if (priv->prot_version == PRP_V1)
2962306a36Sopenharmony_ci		seq_puts(sfp, "SAN-A, SAN-B, DAN-P\n");
3062306a36Sopenharmony_ci	else
3162306a36Sopenharmony_ci		seq_puts(sfp, "DAN-H\n");
3262306a36Sopenharmony_ci
3362306a36Sopenharmony_ci	rcu_read_lock();
3462306a36Sopenharmony_ci	list_for_each_entry_rcu(node, &priv->node_db, mac_list) {
3562306a36Sopenharmony_ci		/* skip self node */
3662306a36Sopenharmony_ci		if (hsr_addr_is_self(priv, node->macaddress_A))
3762306a36Sopenharmony_ci			continue;
3862306a36Sopenharmony_ci		seq_printf(sfp, "%pM ", &node->macaddress_A[0]);
3962306a36Sopenharmony_ci		seq_printf(sfp, "%pM ", &node->macaddress_B[0]);
4062306a36Sopenharmony_ci		seq_printf(sfp, "%10lx, ", node->time_in[HSR_PT_SLAVE_A]);
4162306a36Sopenharmony_ci		seq_printf(sfp, "%10lx, ", node->time_in[HSR_PT_SLAVE_B]);
4262306a36Sopenharmony_ci		seq_printf(sfp, "%14x, ", node->addr_B_port);
4362306a36Sopenharmony_ci
4462306a36Sopenharmony_ci		if (priv->prot_version == PRP_V1)
4562306a36Sopenharmony_ci			seq_printf(sfp, "%5x, %5x, %5x\n",
4662306a36Sopenharmony_ci				   node->san_a, node->san_b,
4762306a36Sopenharmony_ci				   (node->san_a == 0 && node->san_b == 0));
4862306a36Sopenharmony_ci		else
4962306a36Sopenharmony_ci			seq_printf(sfp, "%5x\n", 1);
5062306a36Sopenharmony_ci	}
5162306a36Sopenharmony_ci	rcu_read_unlock();
5262306a36Sopenharmony_ci	return 0;
5362306a36Sopenharmony_ci}
5462306a36Sopenharmony_ci
5562306a36Sopenharmony_ciDEFINE_SHOW_ATTRIBUTE(hsr_node_table);
5662306a36Sopenharmony_ci
5762306a36Sopenharmony_civoid hsr_debugfs_rename(struct net_device *dev)
5862306a36Sopenharmony_ci{
5962306a36Sopenharmony_ci	struct hsr_priv *priv = netdev_priv(dev);
6062306a36Sopenharmony_ci	struct dentry *d;
6162306a36Sopenharmony_ci
6262306a36Sopenharmony_ci	d = debugfs_rename(hsr_debugfs_root_dir, priv->node_tbl_root,
6362306a36Sopenharmony_ci			   hsr_debugfs_root_dir, dev->name);
6462306a36Sopenharmony_ci	if (IS_ERR(d))
6562306a36Sopenharmony_ci		netdev_warn(dev, "failed to rename\n");
6662306a36Sopenharmony_ci	else
6762306a36Sopenharmony_ci		priv->node_tbl_root = d;
6862306a36Sopenharmony_ci}
6962306a36Sopenharmony_ci
7062306a36Sopenharmony_ci/* hsr_debugfs_init - create hsr node_table file for dumping
7162306a36Sopenharmony_ci * the node table
7262306a36Sopenharmony_ci *
7362306a36Sopenharmony_ci * Description:
7462306a36Sopenharmony_ci * When debugfs is configured this routine sets up the node_table file per
7562306a36Sopenharmony_ci * hsr device for dumping the node_table entries
7662306a36Sopenharmony_ci */
7762306a36Sopenharmony_civoid hsr_debugfs_init(struct hsr_priv *priv, struct net_device *hsr_dev)
7862306a36Sopenharmony_ci{
7962306a36Sopenharmony_ci	struct dentry *de = NULL;
8062306a36Sopenharmony_ci
8162306a36Sopenharmony_ci	de = debugfs_create_dir(hsr_dev->name, hsr_debugfs_root_dir);
8262306a36Sopenharmony_ci	if (IS_ERR(de)) {
8362306a36Sopenharmony_ci		pr_err("Cannot create hsr debugfs directory\n");
8462306a36Sopenharmony_ci		return;
8562306a36Sopenharmony_ci	}
8662306a36Sopenharmony_ci
8762306a36Sopenharmony_ci	priv->node_tbl_root = de;
8862306a36Sopenharmony_ci
8962306a36Sopenharmony_ci	de = debugfs_create_file("node_table", S_IFREG | 0444,
9062306a36Sopenharmony_ci				 priv->node_tbl_root, priv,
9162306a36Sopenharmony_ci				 &hsr_node_table_fops);
9262306a36Sopenharmony_ci	if (IS_ERR(de)) {
9362306a36Sopenharmony_ci		pr_err("Cannot create hsr node_table file\n");
9462306a36Sopenharmony_ci		debugfs_remove(priv->node_tbl_root);
9562306a36Sopenharmony_ci		priv->node_tbl_root = NULL;
9662306a36Sopenharmony_ci		return;
9762306a36Sopenharmony_ci	}
9862306a36Sopenharmony_ci}
9962306a36Sopenharmony_ci
10062306a36Sopenharmony_ci/* hsr_debugfs_term - Tear down debugfs intrastructure
10162306a36Sopenharmony_ci *
10262306a36Sopenharmony_ci * Description:
10362306a36Sopenharmony_ci * When Debugfs is configured this routine removes debugfs file system
10462306a36Sopenharmony_ci * elements that are specific to hsr
10562306a36Sopenharmony_ci */
10662306a36Sopenharmony_civoid
10762306a36Sopenharmony_cihsr_debugfs_term(struct hsr_priv *priv)
10862306a36Sopenharmony_ci{
10962306a36Sopenharmony_ci	debugfs_remove_recursive(priv->node_tbl_root);
11062306a36Sopenharmony_ci	priv->node_tbl_root = NULL;
11162306a36Sopenharmony_ci}
11262306a36Sopenharmony_ci
11362306a36Sopenharmony_civoid hsr_debugfs_create_root(void)
11462306a36Sopenharmony_ci{
11562306a36Sopenharmony_ci	hsr_debugfs_root_dir = debugfs_create_dir("hsr", NULL);
11662306a36Sopenharmony_ci	if (IS_ERR(hsr_debugfs_root_dir)) {
11762306a36Sopenharmony_ci		pr_err("Cannot create hsr debugfs root directory\n");
11862306a36Sopenharmony_ci		hsr_debugfs_root_dir = NULL;
11962306a36Sopenharmony_ci	}
12062306a36Sopenharmony_ci}
12162306a36Sopenharmony_ci
12262306a36Sopenharmony_civoid hsr_debugfs_remove_root(void)
12362306a36Sopenharmony_ci{
12462306a36Sopenharmony_ci	/* debugfs_remove() internally checks NULL and ERROR */
12562306a36Sopenharmony_ci	debugfs_remove(hsr_debugfs_root_dir);
12662306a36Sopenharmony_ci}
127