net/hsr/hsr_debugfs.c

   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
  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
  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
  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
  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  */
  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 }
 117
 118 /* hsr_debugfs_term - Tear down debugfs intrastructure
 119  *
 120  * Description:
 121  * When Debufs is configured this routine removes debugfs file system
 122  * elements that are specific to hsr
 123  */
 124 void
 125 hsr_debugfs_term(struct hsr_priv *priv)
 126 {
 127         debugfs_remove_recursive(priv->node_tbl_root);
 128         priv->node_tbl_root = NULL;
 129 }
 130
 131 void hsr_debugfs_create_root(void)
 132 {
 133         hsr_debugfs_root_dir = debugfs_create_dir("hsr", NULL);
 134         if (IS_ERR(hsr_debugfs_root_dir)) {
 135                 pr_err("Cannot create hsr debugfs root directory\n");
 136                 hsr_debugfs_root_dir = NULL;
 137         }
 138 }
 139
 140 void hsr_debugfs_remove_root(void)
 141 {
 142         /* debugfs_remove() internally checks NULL and ERROR */
 143         debugfs_remove(hsr_debugfs_root_dir);
 144 }