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 void print_mac_address(struct seq_file *sfp, unsigned char *mac)
  24 {
  25         seq_printf(sfp, "%02x:%02x:%02x:%02x:%02x:%02x:",
  26                    mac[0], mac[1], mac[2], mac[3], mac[4], mac[5]);
  27 }
  28
  29 /* hsr_node_table_show - Formats and prints node_table entries */
  30 static int
  31 hsr_node_table_show(struct seq_file *sfp, void *data)
  32 {
  33         struct hsr_priv *priv = (struct hsr_priv *)sfp->private;
  34         struct hsr_node *node;
  35
  36         seq_puts(sfp, "Node Table entries\n");
  37         seq_puts(sfp, "MAC-Address-A,   MAC-Address-B, time_in[A], ");
  38         seq_puts(sfp, "time_in[B], Address-B port\n");
  39         rcu_read_lock();
  40         list_for_each_entry_rcu(node, &priv->node_db, mac_list) {
  41                 /* skip self node */
  42                 if (hsr_addr_is_self(priv, node->macaddress_A))
  43                         continue;
  44                 print_mac_address(sfp, &node->macaddress_A[0]);
  45                 seq_puts(sfp, " ");
  46                 print_mac_address(sfp, &node->macaddress_B[0]);
  47                 seq_printf(sfp, "0x%lx, ", node->time_in[HSR_PT_SLAVE_A]);
  48                 seq_printf(sfp, "0x%lx ", node->time_in[HSR_PT_SLAVE_B]);
  49                 seq_printf(sfp, "0x%x\n", node->addr_B_port);
  50         }
  51         rcu_read_unlock();
  52         return 0;
  53 }
  54
  55 /* hsr_node_table_open - Open the node_table file
  56  *
  57  * Description:
  58  * This routine opens a debugfs file node_table of specific hsr device
  59  */
  60 static int
  61 hsr_node_table_open(struct inode *inode, struct file *filp)
  62 {
  63         return single_open(filp, hsr_node_table_show, inode->i_private);
  64 }
  65
  66 static const struct file_operations hsr_fops = {
  67         .owner  = THIS_MODULE,
  68         .open   = hsr_node_table_open,
  69         .read   = seq_read,
  70         .llseek = seq_lseek,
  71         .release = single_release,
  72 };
  73
  74 /* hsr_debugfs_init - create hsr node_table file for dumping
  75  * the node table
  76  *
  77  * Description:
  78  * When debugfs is configured this routine sets up the node_table file per
  79  * hsr device for dumping the node_table entries
  80  */
  81 int hsr_debugfs_init(struct hsr_priv *priv, struct net_device *hsr_dev)
  82 {
  83         int rc = -1;
  84         struct dentry *de = NULL;
  85
  86         de = debugfs_create_dir(hsr_dev->name, NULL);
  87         if (!de) {
  88                 pr_err("Cannot create hsr debugfs root\n");
  89                 return rc;
  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 (!de) {
  98                 pr_err("Cannot create hsr node_table directory\n");
  99                 return rc;
 100         }
 101         priv->node_tbl_file = de;
 102
 103         return 0;
 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 }