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 static const struct file_operations hsr_fops = {
  69         .open   = hsr_node_table_open,
  70         .read   = seq_read,
  71         .llseek = seq_lseek,
  72         .release = single_release,
  73 };
  74
  75 /* hsr_debugfs_init - create hsr node_table file for dumping
  76  * the node table
  77  *
  78  * Description:
  79  * When debugfs is configured this routine sets up the node_table file per
  80  * hsr device for dumping the node_table entries
  81  */
  82 void hsr_debugfs_init(struct hsr_priv *priv, struct net_device *hsr_dev)
  83 {
  84         struct dentry *de = NULL;
  85
  86         de = debugfs_create_dir(hsr_dev->name, hsr_debugfs_root_dir);
  87         if (IS_ERR(de)) {
  88                 pr_err("Cannot create hsr debugfs directory\n");
  89                 return;
  90         }
  91
  92         priv->node_tbl_root = de;
  93
  94         de = debugfs_create_file("node_table", S_IFREG | 0444,
  95                                  priv->node_tbl_root, priv,
  96                                  &hsr_fops);
  97         if (IS_ERR(de)) {
  98                 pr_err("Cannot create hsr node_table file\n");
  99                 debugfs_remove(priv->node_tbl_root);
 100                 priv->node_tbl_root = NULL;
 101                 return;
 102         }
 103         priv->node_tbl_file = de;
 104 }
 105
 106 /* hsr_debugfs_term - Tear down debugfs intrastructure
 107  *
 108  * Description:
 109  * When Debufs is configured this routine removes debugfs file system
 110  * elements that are specific to hsr
 111  */
 112 void
 113 hsr_debugfs_term(struct hsr_priv *priv)
 114 {
 115         debugfs_remove(priv->node_tbl_file);
 116         priv->node_tbl_file = NULL;
 117         debugfs_remove(priv->node_tbl_root);
 118         priv->node_tbl_root = NULL;
 119 }
 120
 121 void hsr_debugfs_create_root(void)
 122 {
 123         hsr_debugfs_root_dir = debugfs_create_dir("hsr", NULL);
 124         if (IS_ERR(hsr_debugfs_root_dir)) {
 125                 pr_err("Cannot create hsr debugfs root directory\n");
 126                 hsr_debugfs_root_dir = NULL;
 127         }
 128 }
 129
 130 void hsr_debugfs_remove_root(void)
 131 {
 132         /* debugfs_remove() internally checks NULL and ERROR */
 133         debugfs_remove(hsr_debugfs_root_dir);
 134 }