1 /*
2 * hsr_debugfs code
3 * Copyright (C) 2019 Texas Instruments Incorporated
4 *
5 * Author(s):
6 * Murali Karicheri <m-karicheri2@ti.com>
7 *
8 * This program is free software; you can redistribute it and/or
9 * modify it under the terms of the GNU General Public License as
10 * published by the Free Software Foundation version 2.
11 *
12 * This program is distributed "as is" WITHOUT ANY WARRANTY of any
13 * kind, whether express or implied; without even the implied warranty
14 * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
16 */
17 #include <linux/module.h>
18 #include <linux/errno.h>
19 #include <linux/debugfs.h>
20 #include "hsr_main.h"
21 #include "hsr_framereg.h"
22
23 static struct dentry *hsr_debugfs_root_dir;
24
print_mac_address(struct seq_file * sfp,unsigned char * mac)25 static void print_mac_address(struct seq_file *sfp, unsigned char *mac)
26 {
27 seq_printf(sfp, "%02x:%02x:%02x:%02x:%02x:%02x:",
28 mac[0], mac[1], mac[2], mac[3], mac[4], mac[5]);
29 }
30
31 /* hsr_node_table_show - Formats and prints node_table entries */
32 static int
hsr_node_table_show(struct seq_file * sfp,void * data)33 hsr_node_table_show(struct seq_file *sfp, void *data)
34 {
35 struct hsr_priv *priv = (struct hsr_priv *)sfp->private;
36 struct hsr_node *node;
37
38 seq_puts(sfp, "Node Table entries\n");
39 seq_puts(sfp, "MAC-Address-A, MAC-Address-B, time_in[A], ");
40 seq_puts(sfp, "time_in[B], Address-B port\n");
41 rcu_read_lock();
42 list_for_each_entry_rcu(node, &priv->node_db, mac_list) {
43 /* skip self node */
44 if (hsr_addr_is_self(priv, node->macaddress_A))
45 continue;
46 print_mac_address(sfp, &node->macaddress_A[0]);
47 seq_puts(sfp, " ");
48 print_mac_address(sfp, &node->macaddress_B[0]);
49 seq_printf(sfp, "0x%lx, ", node->time_in[HSR_PT_SLAVE_A]);
50 seq_printf(sfp, "0x%lx ", node->time_in[HSR_PT_SLAVE_B]);
51 seq_printf(sfp, "0x%x\n", node->addr_B_port);
52 }
53 rcu_read_unlock();
54 return 0;
55 }
56
57 /* hsr_node_table_open - Open the node_table file
58 *
59 * Description:
60 * This routine opens a debugfs file node_table of specific hsr device
61 */
62 static int
hsr_node_table_open(struct inode * inode,struct file * filp)63 hsr_node_table_open(struct inode *inode, struct file *filp)
64 {
65 return single_open(filp, hsr_node_table_show, inode->i_private);
66 }
67
hsr_debugfs_rename(struct net_device * dev)68 void hsr_debugfs_rename(struct net_device *dev)
69 {
70 struct hsr_priv *priv = netdev_priv(dev);
71 struct dentry *d;
72
73 d = debugfs_rename(hsr_debugfs_root_dir, priv->node_tbl_root,
74 hsr_debugfs_root_dir, dev->name);
75 if (IS_ERR(d))
76 netdev_warn(dev, "failed to rename\n");
77 else
78 priv->node_tbl_root = d;
79 }
80
81 static const struct file_operations hsr_fops = {
82 .open = hsr_node_table_open,
83 .read = seq_read,
84 .llseek = seq_lseek,
85 .release = single_release,
86 };
87
88 /* hsr_debugfs_init - create hsr node_table file for dumping
89 * the node table
90 *
91 * Description:
92 * When debugfs is configured this routine sets up the node_table file per
93 * hsr device for dumping the node_table entries
94 */
hsr_debugfs_init(struct hsr_priv * priv,struct net_device * hsr_dev)95 void hsr_debugfs_init(struct hsr_priv *priv, struct net_device *hsr_dev)
96 {
97 struct dentry *de = NULL;
98
99 de = debugfs_create_dir(hsr_dev->name, hsr_debugfs_root_dir);
100 if (IS_ERR(de)) {
101 pr_err("Cannot create hsr debugfs directory\n");
102 return;
103 }
104
105 priv->node_tbl_root = de;
106
107 de = debugfs_create_file("node_table", S_IFREG | 0444,
108 priv->node_tbl_root, priv,
109 &hsr_fops);
110 if (IS_ERR(de)) {
111 pr_err("Cannot create hsr node_table file\n");
112 debugfs_remove(priv->node_tbl_root);
113 priv->node_tbl_root = NULL;
114 return;
115 }
116 priv->node_tbl_file = de;
117 }
118
119 /* hsr_debugfs_term - Tear down debugfs intrastructure
120 *
121 * Description:
122 * When Debufs is configured this routine removes debugfs file system
123 * elements that are specific to hsr
124 */
125 void
hsr_debugfs_term(struct hsr_priv * priv)126 hsr_debugfs_term(struct hsr_priv *priv)
127 {
128 debugfs_remove(priv->node_tbl_file);
129 priv->node_tbl_file = NULL;
130 debugfs_remove(priv->node_tbl_root);
131 priv->node_tbl_root = NULL;
132 }
133
hsr_debugfs_create_root(void)134 void hsr_debugfs_create_root(void)
135 {
136 hsr_debugfs_root_dir = debugfs_create_dir("hsr", NULL);
137 if (IS_ERR(hsr_debugfs_root_dir)) {
138 pr_err("Cannot create hsr debugfs root directory\n");
139 hsr_debugfs_root_dir = NULL;
140 }
141 }
142
hsr_debugfs_remove_root(void)143 void hsr_debugfs_remove_root(void)
144 {
145 /* debugfs_remove() internally checks NULL and ERROR */
146 debugfs_remove(hsr_debugfs_root_dir);
147 }
148