1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * debugfs code for HSR & PRP
4 * Copyright (C) 2019 Texas Instruments Incorporated
5 *
6 * Author(s):
7 * Murali Karicheri <m-karicheri2@ti.com>
8 */
9 #include <linux/module.h>
10 #include <linux/errno.h>
11 #include <linux/debugfs.h>
12 #include "hsr_main.h"
13 #include "hsr_framereg.h"
14
15 static struct dentry *hsr_debugfs_root_dir;
16
17 /* hsr_node_table_show - Formats and prints node_table entries */
18 static int
hsr_node_table_show(struct seq_file * sfp,void * data)19 hsr_node_table_show(struct seq_file *sfp, void *data)
20 {
21 struct hsr_priv *priv = (struct hsr_priv *)sfp->private;
22 struct hsr_node *node;
23
24 seq_printf(sfp, "Node Table entries for (%s) device\n",
25 (priv->prot_version == PRP_V1 ? "PRP" : "HSR"));
26 seq_puts(sfp, "MAC-Address-A, MAC-Address-B, time_in[A], ");
27 seq_puts(sfp, "time_in[B], Address-B port, ");
28 if (priv->prot_version == PRP_V1)
29 seq_puts(sfp, "SAN-A, SAN-B, DAN-P\n");
30 else
31 seq_puts(sfp, "DAN-H\n");
32
33 rcu_read_lock();
34 list_for_each_entry_rcu(node, &priv->node_db, mac_list) {
35 /* skip self node */
36 if (hsr_addr_is_self(priv, node->macaddress_A))
37 continue;
38 seq_printf(sfp, "%pM ", &node->macaddress_A[0]);
39 seq_printf(sfp, "%pM ", &node->macaddress_B[0]);
40 seq_printf(sfp, "%10lx, ", node->time_in[HSR_PT_SLAVE_A]);
41 seq_printf(sfp, "%10lx, ", node->time_in[HSR_PT_SLAVE_B]);
42 seq_printf(sfp, "%14x, ", node->addr_B_port);
43
44 if (priv->prot_version == PRP_V1)
45 seq_printf(sfp, "%5x, %5x, %5x\n",
46 node->san_a, node->san_b,
47 (node->san_a == 0 && node->san_b == 0));
48 else
49 seq_printf(sfp, "%5x\n", 1);
50 }
51 rcu_read_unlock();
52 return 0;
53 }
54
55 DEFINE_SHOW_ATTRIBUTE(hsr_node_table);
56
hsr_debugfs_rename(struct net_device * dev)57 void hsr_debugfs_rename(struct net_device *dev)
58 {
59 struct hsr_priv *priv = netdev_priv(dev);
60 struct dentry *d;
61
62 d = debugfs_rename(hsr_debugfs_root_dir, priv->node_tbl_root,
63 hsr_debugfs_root_dir, dev->name);
64 if (IS_ERR(d))
65 netdev_warn(dev, "failed to rename\n");
66 else
67 priv->node_tbl_root = d;
68 }
69
70 /* hsr_debugfs_init - create hsr node_table file for dumping
71 * the node table
72 *
73 * Description:
74 * When debugfs is configured this routine sets up the node_table file per
75 * hsr device for dumping the node_table entries
76 */
hsr_debugfs_init(struct hsr_priv * priv,struct net_device * hsr_dev)77 void hsr_debugfs_init(struct hsr_priv *priv, struct net_device *hsr_dev)
78 {
79 struct dentry *de = NULL;
80
81 de = debugfs_create_dir(hsr_dev->name, hsr_debugfs_root_dir);
82 if (IS_ERR(de)) {
83 pr_err("Cannot create hsr debugfs directory\n");
84 return;
85 }
86
87 priv->node_tbl_root = de;
88
89 de = debugfs_create_file("node_table", S_IFREG | 0444,
90 priv->node_tbl_root, priv,
91 &hsr_node_table_fops);
92 if (IS_ERR(de)) {
93 pr_err("Cannot create hsr node_table file\n");
94 debugfs_remove(priv->node_tbl_root);
95 priv->node_tbl_root = NULL;
96 return;
97 }
98 }
99
100 /* hsr_debugfs_term - Tear down debugfs intrastructure
101 *
102 * Description:
103 * When Debugfs is configured this routine removes debugfs file system
104 * elements that are specific to hsr
105 */
106 void
hsr_debugfs_term(struct hsr_priv * priv)107 hsr_debugfs_term(struct hsr_priv *priv)
108 {
109 debugfs_remove_recursive(priv->node_tbl_root);
110 priv->node_tbl_root = NULL;
111 }
112
hsr_debugfs_create_root(void)113 void hsr_debugfs_create_root(void)
114 {
115 hsr_debugfs_root_dir = debugfs_create_dir("hsr", NULL);
116 if (IS_ERR(hsr_debugfs_root_dir)) {
117 pr_err("Cannot create hsr debugfs root directory\n");
118 hsr_debugfs_root_dir = NULL;
119 }
120 }
121
hsr_debugfs_remove_root(void)122 void hsr_debugfs_remove_root(void)
123 {
124 /* debugfs_remove() internally checks NULL and ERROR */
125 debugfs_remove(hsr_debugfs_root_dir);
126 }
127