1 /* 2 * debugfs code for HSR & PRP 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 25 /* hsr_node_table_show - Formats and prints node_table entries */ 26 static int 27 hsr_node_table_show(struct seq_file *sfp, void *data) 28 { 29 struct hsr_priv *priv = (struct hsr_priv *)sfp->private; 30 struct hsr_node *node; 31 32 seq_printf(sfp, "Node Table entries for (%s) device\n", 33 (priv->prot_version == PRP_V1 ? "PRP" : "HSR")); 34 seq_puts(sfp, "MAC-Address-A, MAC-Address-B, time_in[A], "); 35 seq_puts(sfp, "time_in[B], Address-B port, "); 36 if (priv->prot_version == PRP_V1) 37 seq_puts(sfp, "SAN-A, SAN-B, DAN-P\n"); 38 else 39 seq_puts(sfp, "DAN-H\n"); 40 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 seq_printf(sfp, "%pM ", &node->macaddress_A[0]); 47 seq_printf(sfp, "%pM ", &node->macaddress_B[0]); 48 seq_printf(sfp, "%10lx, ", node->time_in[HSR_PT_SLAVE_A]); 49 seq_printf(sfp, "%10lx, ", node->time_in[HSR_PT_SLAVE_B]); 50 seq_printf(sfp, "%14x, ", node->addr_B_port); 51 52 if (priv->prot_version == PRP_V1) 53 seq_printf(sfp, "%5x, %5x, %5x\n", 54 node->san_a, node->san_b, 55 (node->san_a == 0 && node->san_b == 0)); 56 else 57 seq_printf(sfp, "%5x\n", 1); 58 } 59 rcu_read_unlock(); 60 return 0; 61 } 62 63 /* hsr_node_table_open - Open the node_table file 64 * 65 * Description: 66 * This routine opens a debugfs file node_table of specific hsr 67 * or prp device 68 */ 69 static int 70 hsr_node_table_open(struct inode *inode, struct file *filp) 71 { 72 return single_open(filp, hsr_node_table_show, inode->i_private); 73 } 74 75 void hsr_debugfs_rename(struct net_device *dev) 76 { 77 struct hsr_priv *priv = netdev_priv(dev); 78 struct dentry *d; 79 80 d = debugfs_rename(hsr_debugfs_root_dir, priv->node_tbl_root, 81 hsr_debugfs_root_dir, dev->name); 82 if (IS_ERR(d)) 83 netdev_warn(dev, "failed to rename\n"); 84 else 85 priv->node_tbl_root = d; 86 } 87 88 static const struct file_operations hsr_fops = { 89 .open = hsr_node_table_open, 90 .read = seq_read, 91 .llseek = seq_lseek, 92 .release = single_release, 93 }; 94 95 /* hsr_debugfs_init - create hsr node_table file for dumping 96 * the node table 97 * 98 * Description: 99 * When debugfs is configured this routine sets up the node_table file per 100 * hsr device for dumping the node_table entries 101 */ 102 void hsr_debugfs_init(struct hsr_priv *priv, struct net_device *hsr_dev) 103 { 104 struct dentry *de = NULL; 105 106 de = debugfs_create_dir(hsr_dev->name, hsr_debugfs_root_dir); 107 if (IS_ERR(de)) { 108 pr_err("Cannot create hsr debugfs directory\n"); 109 return; 110 } 111 112 priv->node_tbl_root = de; 113 114 de = debugfs_create_file("node_table", S_IFREG | 0444, 115 priv->node_tbl_root, priv, 116 &hsr_fops); 117 if (IS_ERR(de)) { 118 pr_err("Cannot create hsr node_table file\n"); 119 debugfs_remove(priv->node_tbl_root); 120 priv->node_tbl_root = NULL; 121 return; 122 } 123 } 124 125 /* hsr_debugfs_term - Tear down debugfs intrastructure 126 * 127 * Description: 128 * When Debufs is configured this routine removes debugfs file system 129 * elements that are specific to hsr 130 */ 131 void 132 hsr_debugfs_term(struct hsr_priv *priv) 133 { 134 debugfs_remove_recursive(priv->node_tbl_root); 135 priv->node_tbl_root = NULL; 136 } 137 138 void hsr_debugfs_create_root(void) 139 { 140 hsr_debugfs_root_dir = debugfs_create_dir("hsr", NULL); 141 if (IS_ERR(hsr_debugfs_root_dir)) { 142 pr_err("Cannot create hsr debugfs root directory\n"); 143 hsr_debugfs_root_dir = NULL; 144 } 145 } 146 147 void hsr_debugfs_remove_root(void) 148 { 149 /* debugfs_remove() internally checks NULL and ERROR */ 150 debugfs_remove(hsr_debugfs_root_dir); 151 } 152